this code i have from the lite-c kingdom heart movement code
works very well
you can find it here

http://www.coniserver.net/wiki/index.php/Modified_Kingdom_Hearts_Movement