P1 - Prevent Caffeine from Driving Backwards

[Anthonyjlem]

Description:

• If we use the global path planner to navigate to the first way point, there is a risk that the global path may plan for the rover to go the wrong way/backwards to the way point. We want to prevent this and ensure the global path plans for the rover to go in the right direction.

Goals:

• The global path always plans for the rover to go through the course in the right direction.

Acceptance Criteria:

• The global path always plans for the rover to go through the course in the right direction for both the grass and pavement worlds.

Notes:

• One approach could be to create a fake obstacle behind the rover to prevent it from going backwards.

[spencerteetaert]

Adding corner waypoints to the course. Scratching fake obstacle idea because local backwards motion may be necessary. @kajananchinniah do we have additional waypoints integrated yet?