Fix pathing starting with heading 0

tritonuas / obcpp

The code for the Onboard Computer, now written in C++.

GNU Affero General Public License v3.0

7 stars 0 forks source link

Fix pathing starting with heading 0 #170

Closed Tyler-Lentz closed 2 months ago

Tyler-Lentz commented 2 months ago

Observed behavior: the first waypoint of a waypoint path will always have a heading of 0 (east) Expected behavior: the first waypoint should have a heading pointing towards the second waypoint