|
|
@ -146,8 +146,7 @@ bool VehicleIMU::ParametersUpdate(bool force) |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
// constrain IMU integration time 1-20 milliseconds (50-1000 Hz)
|
|
|
|
// constrain IMU integration time 1-20 milliseconds (50-1000 Hz)
|
|
|
|
int32_t imu_integration_rate_hz = constrain(_param_imu_integ_rate.get(), |
|
|
|
const int32_t imu_integration_rate_hz = constrain(_param_imu_integ_rate.get(), (int32_t)50, (int32_t)1000); |
|
|
|
(int32_t)50, math::min(_param_imu_gyro_ratemax.get(), (int32_t) 1000)); |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
if (imu_integration_rate_hz != _param_imu_integ_rate.get()) { |
|
|
|
if (imu_integration_rate_hz != _param_imu_integ_rate.get()) { |
|
|
|
PX4_WARN("IMU_INTEG_RATE updated %" PRId32 " -> %" PRIu32, _param_imu_integ_rate.get(), imu_integration_rate_hz); |
|
|
|
PX4_WARN("IMU_INTEG_RATE updated %" PRId32 " -> %" PRIu32, _param_imu_integ_rate.get(), imu_integration_rate_hz); |
|
|
|