Browse Source

AP_InertialSensor: debugging code for EK2 bug

mission-4.1.18
Andrew Tridgell 7 years ago
parent
commit
a0af4af5b5
  1. 7
      libraries/AP_InertialSensor/AP_InertialSensor_SITL.cpp

7
libraries/AP_InertialSensor/AP_InertialSensor_SITL.cpp

@ -136,6 +136,13 @@ void AP_InertialSensor_SITL::generate_gyro(uint8_t instance) @@ -136,6 +136,13 @@ void AP_InertialSensor_SITL::generate_gyro(uint8_t instance)
void AP_InertialSensor_SITL::timer_update(void)
{
uint64_t now = AP_HAL::micros64();
#if 0
// insert a 1s pause in IMU data. This triggers a pause in EK2
// processing that leads to some interesting issues
if (now > 5e6 && now < 6e6) {
return;
}
#endif
for (uint8_t i=0; i<INS_SITL_INSTANCES; i++) {
if (now >= next_accel_sample[i]) {
generate_accel(i);

Loading…
Cancel
Save