Added test code to drive a bunch of movements (commented out as well)