Elementary navigation features

[Arrowana]

First:

• Simple path control of lines, then line+arcs (we might use more complex path later)
• Detect obstacles and stop the robot if the movement leads to a collision