Movement script

Finished the main figure movement, and corrected bugs.