diff --git a/rm_common/include/rm_common/decision/command_sender.h b/rm_common/include/rm_common/decision/command_sender.h index 827e9b8b..d07533dc 100644 --- a/rm_common/include/rm_common/decision/command_sender.h +++ b/rm_common/include/rm_common/decision/command_sender.h @@ -352,6 +352,7 @@ class ShooterCommandSender : public TimeStampCommandSenderBase 1.0 || shoot_data_.bullet_speed > speed_limit_) + if (last_bullet_speed_ - speed_des_ >= speed_oscillation_ || shoot_data_.bullet_speed > speed_limit_) { total_extra_wheel_speed_ -= 5.0; } - else if (speed_des_ - last_bullet_speed_ > 1.0) + else if (speed_des_ - last_bullet_speed_ > speed_oscillation_) { total_extra_wheel_speed_ += 5.0; } @@ -519,7 +520,7 @@ class ShooterCommandSender : public TimeStampCommandSenderBase