- Robot movement

- Waypoint generation
- Waypoint rewnewal