Refactored to pave the way for easier fixing of the coordinate problem

Added a basic and incomplete movement function, but with the coordinates being off it doesn't work very well.