Bicycle Model & Path Follower fixes