Finished First draft of complete movement Code

I have finished implementing a first draft of the movement handling
function.
It handles cost as well (Hopefully!)

My code should be ready for testing tommorrow.