Plan first and then act when stepping through waypoints
rverted back to no time stamps on the IMs as it should be.
Merge branch 'refactor' of https://github.com/swhart115/affordance_templates into refactor
Merge branch 'refactor' into ros_control