Completed the routine for moving the motor in a path.
Not yet tested on hardware.