Implemented xoft suggestion. Using MoveToPosition as tigerw suggested.
+ Implemented better pathfinding - Removed lots of unused variables, functions, etc. * Changed some variable types * Other miscellaneous fixes, and also completes the previous PRs