Basic Move Test

[Kevin Allen]

Write a ROS test to execute basic move commands using submove and verify the sub moves to the correct position + orientation, failing otherwise. You can test this in the simulator