diff --git a/diff_drive_controller/src/speed_limiter.cpp b/diff_drive_controller/src/speed_limiter.cpp index 630ec8201..9f15a7882 100644 --- a/diff_drive_controller/src/speed_limiter.cpp +++ b/diff_drive_controller/src/speed_limiter.cpp @@ -121,7 +121,7 @@ namespace diff_drive_controller const double dv = v - v0; const double dv0 = v0 - v1; - const double dt2 = 2. * dt * dt; + const double dt2 = dt * dt; const double da_min = min_jerk * dt2; const double da_max = max_jerk * dt2; diff --git a/diff_drive_controller/test/diffbot_limits.yaml b/diff_drive_controller/test/diffbot_limits.yaml index 78f0bf96b..8d3241eb8 100644 --- a/diff_drive_controller/test/diffbot_limits.yaml +++ b/diff_drive_controller/test/diffbot_limits.yaml @@ -8,7 +8,7 @@ diffbot_controller: min_acceleration: -0.5 max_acceleration: 1.0 has_jerk_limits: true - max_jerk: 5.0 + max_jerk: 10.0 angular: z: has_velocity_limits: true @@ -16,4 +16,4 @@ diffbot_controller: has_acceleration_limits: true max_acceleration: 2.0 has_jerk_limits: true - max_jerk: 10.0 + max_jerk: 20.0 diff --git a/four_wheel_steering_controller/src/speed_limiter.cpp b/four_wheel_steering_controller/src/speed_limiter.cpp index aea38e2d4..f227eae60 100644 --- a/four_wheel_steering_controller/src/speed_limiter.cpp +++ b/four_wheel_steering_controller/src/speed_limiter.cpp @@ -115,7 +115,7 @@ namespace four_wheel_steering_controller const double dv = v - v0; const double dv0 = v0 - v1; - const double dt2 = 2. * dt * dt; + const double dt2 = dt * dt; const double da_min = min_jerk * dt2; const double da_max = max_jerk * dt2;