Robbie Navagation Test Smach

Running with the action server was one goal but using ROS smach and the ability
to use multiple goals  or way points to get to the target was always the plan
in the attached video shows Robbie moving in a triangle to achieve a target.
Next we are going to add arm actions to the routine