Merge branch '1-list-of-bugs-discovered-developing-follow_local_planner-branch-splines' into 'splines'

Fixed listed bugs

See merge request !6