Coded up most (I think) of the logic to run / stop / abort the planner / robot-traj-exec code (with UDP stream). It will need polishing and testing (sim).