mirror of https://github.com/ArduPilot/ardupilot
ArduCopter, AP_InertialSensor: restore mpu6k sample rate to 200hz but keep default filtering at 42hz.
This commit is contained in:
parent
39013a33bc
commit
a4ee5d2c81
|
@ -193,7 +193,7 @@ DataFlash_APM1 DataFlash(&spi_semaphore);
|
|||
////////////////////////////////////////////////////////////////////////////////
|
||||
// the rate we run the main loop at
|
||||
////////////////////////////////////////////////////////////////////////////////
|
||||
static const AP_InertialSensor::Sample_rate ins_sample_rate = AP_InertialSensor::RATE_100HZ;
|
||||
static const AP_InertialSensor::Sample_rate ins_sample_rate = AP_InertialSensor::RATE_200HZ;
|
||||
|
||||
////////////////////////////////////////////////////////////////////////////////
|
||||
// Sensors
|
||||
|
@ -953,7 +953,7 @@ void loop()
|
|||
// We want this to execute fast
|
||||
// ----------------------------
|
||||
num_samples = ins.num_samples_available();
|
||||
if (num_samples >= 1) {
|
||||
if (num_samples >= 2) {
|
||||
|
||||
#if DEBUG_FAST_LOOP == ENABLED
|
||||
Log_Write_Data(DATA_FAST_LOOP, (int32_t)(timer - fast_loopTimer));
|
||||
|
|
|
@ -399,7 +399,7 @@ void AP_InertialSensor_MPU6000::hardware_init(Sample_rate sample_rate)
|
|||
case RATE_200HZ:
|
||||
default:
|
||||
rate = MPUREG_SMPLRT_200HZ;
|
||||
default_filter = BITS_DLPF_CFG_98HZ;
|
||||
default_filter = BITS_DLPF_CFG_42HZ;
|
||||
break;
|
||||
}
|
||||
|
||||
|
|
Loading…
Reference in New Issue