First control features

The robot's movement from hardcoded waypoints.