Skip to content

Commit e87b752

Browse files
committed
Fix have_backward_sls behavior
Signed-off-by: Gregory Mermet <g.mermet@ez-wheel.com>
1 parent 8fb2af1 commit e87b752

File tree

1 file changed

+2
-2
lines changed

1 file changed

+2
-2
lines changed

src/diff_drive_controller/DiffDriveController.cpp

Lines changed: 2 additions & 2 deletions
Original file line numberDiff line numberDiff line change
@@ -714,8 +714,8 @@ namespace ezw {
714714
// For example, if it has only one forward-facing safety LiDAR, when the robot move backwards, there's no
715715
// safety guarantees, hence speed is limited to SLS, otherwise, the safety limit will be decided by the
716716
// presence of the SLS signal.
717-
if (!m_have_backward_sls && (p_left_speed < 0) && (p_right_speed < 0) && (faster_motor_speed > m_max_motor_speed_rpm)) {
718-
speed_limit = m_max_motor_speed_rpm;
717+
if (!m_have_backward_sls && (p_left_speed < 0) && (p_right_speed < 0) && (faster_motor_speed > m_motor_sls_rpm)) {
718+
speed_limit = m_motor_sls_rpm;
719719
}
720720

721721
// Reading SLS

0 commit comments

Comments
 (0)