fixing robot dancing moves
- minor fixes to have planner now working