Add smach for End Effector Planner. Add an action to communicate with the agent. Fix existing actions.