[In progress] modifying gps utils

ut-amrl · Nov 15, 2024 · 4b51857 · 4b51857
1 parent 08ca139
commit 4b51857
Showing 1 changed file with 6 additions and 0 deletions.
diff --git a/math/gps_util.h b/math/gps_util.h
@@ -57,6 +57,12 @@ struct GPSTranslator {
     return true;
   }
 
+  void SetOrigin(double latitude, double longitude, double orientation) {
+    gps_origin_latitude = latitude;
+    gps_origin_longitude = longitude;
+    map_orientation = orientation;
+  }
+
   Vector2d GPSToMetric(const double latitude, const double longitude) {
     const double theta = DegToRad(latitude);
     const double c = std::cos(theta);