Finished the very basic movement functions and added a test.