First commit of the PathFollower for ground vehicles. A fix for the
PathPlanner is also included (would not properly reset the
ActiveWaypointIndex when the PathPlanner is disabled)
Add manual override option and fix yaw control
Cleanup
Merge remote-tracking branch 'upstream/next' into next
Merge pull request #445 from vassilisv/vassilis/rover_pathfollower

Vassilis/rover pathfollower