Fixed turning error in ackermann steering (#2342)

This is a fix to the error seen in Ackermann Steering's <steering_only> mode. The steps to reproduce this error are described in issue #2314. Signed-off-by: Saurabh Kamat <[email protected]>
gazebosim · Mar 27, 2024 · 1d5114b · 1d5114b
1 parent 5944188
commit 1d5114b
Showing 1 changed file with 2 additions and 2 deletions.
diff --git a/src/systems/ackermann_steering/AckermannSteering.cc b/src/systems/ackermann_steering/AckermannSteering.cc
@@ -968,11 +968,11 @@ void AckermannSteeringPrivate::UpdateAngle(
 
   double leftSteeringJointAngle =
       atan((2.0 * this->wheelBase * sin(ang)) / \
-      ((2.0 * this->wheelBase * cos(ang)) + \
+      ((2.0 * this->wheelBase * cos(ang)) - \
       (1.0 * this->wheelSeparation * sin(ang))));
   double rightSteeringJointAngle =
       atan((2.0 * this->wheelBase * sin(ang)) / \
-      ((2.0 * this->wheelBase * cos(ang)) - \
+      ((2.0 * this->wheelBase * cos(ang)) + \
       (1.0 * this->wheelSeparation * sin(ang))));
 
   auto leftSteeringPos = _ecm.Component<components::JointPosition>(