Vassilis/rover pathfollower

This is a first pass of a PathFollower for ground vehicles. It has been tested with a single waypoint of FlyEndpoint type. A bug was also fixed in the PathPlanner, it will now reset to the start of the flight plan when the flight mode is changed. More testing is needed for multiple waypoints.