Move toward predefined poses

[mdepp]

A lot of parking states are easier if we have a general way to move to a predefined pose. Maybe put named waypoint poses on the parameter server and then make a smach state to go to one.