Fix Rectangle2d::FindNearestPoint()

Braykoff · Jun 2, 2024 · 2dfbfc6 · 2dfbfc6
1 parent 67a1784
commit 2dfbfc6
Showing 1 changed file with 2 additions and 2 deletions.
diff --git a/wpimath/src/main/native/include/frc/geometry/Rectangle2d.h b/wpimath/src/main/native/include/frc/geometry/Rectangle2d.h
@@ -175,9 +175,9 @@ class Rectangle2d {
 
     // Find nearest point
     rotPoint =
-        Translation2d{std::clamp(point.X(), m_center.X() - m_xWidth / 2.0,
+        Translation2d{std::clamp(rotPoint.X(), m_center.X() - m_xWidth / 2.0,
                                  m_center.X() + m_xWidth / 2.0),
-                      std::clamp(point.Y(), m_center.Y() - m_yWidth / 2.0,
+                      std::clamp(rotPoint.Y(), m_center.Y() - m_yWidth / 2.0,
                                  m_center.Y() + m_yWidth / 2.0)};
 
     // Undo rotation