Restructuring of planning and execution (#12)
Restructuring of planning and execution (#12)

* Restructuring of planning and execution

* Put back lines accidently deleted due to branching

UbiquityRobotics/move_basic,UbiquityRobotics/move_basic