Provide a "simple" navigation stack

[francocipollone]

Summary

Provide a module capable of following a given path: Trajectory follower.
Obstacle avoidance is a bonus

Investigate rust's libraries that help to that end.
For example: https://alphaville.github.io/optimization-engine/