fix: limits of steering speed control (#2)

brisa-robotics · Aug 5, 2022 · a123baa · a123baa
1 parent b77bfc4
commit a123baa
Showing 1 changed file with 1 addition and 1 deletion.
diff --git a/gazebo_plugins/src/gazebo_ros_tricycle_drive.cpp b/gazebo_plugins/src/gazebo_ros_tricycle_drive.cpp
@@ -566,7 +566,7 @@ void GazeboRosTricycleDrivePrivate::MotorController(
     if (fabs(diff_angle) < max_steering_angle_tol_) {
       // we're withing angle tolerance
       applied_steering_speed = 0;
-    } else if (diff_angle < target_speed) {
+    } else if (diff_angle >= max_steering_angle_tol_) {
       // steer toward target angle
       applied_steering_speed = max_steering_speed_;
     } else {