State Machine Week 8 Tasks

[JacquesCloete]

• Add a state to set the arm into a nice joint configuration
• Test the state for sending pose commands to the motion planner - give it some test poses
• Figure out the rotation we need to apply to the pose before sending to MoveIt
• Start making the other states to fill out the state machine