Resolved path finder issue (last obstacle position was wrong)
resolved other path finder issue
Next point logic implemented
adjusted robot front (odometry cables are wrongly applied...)
making things faster...
Test changes
Ramp for the controller
interface clarifications
First driving :)
Merge branch 'origin/develop'