Browse Source

DataFlash: remove check for max INS instances

For all supported boards the maximum number of instances is 3.
master
Lucas De Marchi 9 years ago committed by Andrew Tridgell
parent
commit
f99d64e621
  1. 6
      libraries/DataFlash/LogFile.cpp

6
libraries/DataFlash/LogFile.cpp

@ -884,7 +884,7 @@ void DataFlash_Class::Log_Write_IMU(const AP_InertialSensor &ins) @@ -884,7 +884,7 @@ void DataFlash_Class::Log_Write_IMU(const AP_InertialSensor &ins)
if (ins.get_gyro_count() < 2 && ins.get_accel_count() < 2) {
return;
}
#if INS_MAX_INSTANCES > 1
const Vector3f &gyro2 = ins.get_gyro(1);
const Vector3f &accel2 = ins.get_accel(1);
struct log_IMU pkt2 = {
@ -924,7 +924,6 @@ void DataFlash_Class::Log_Write_IMU(const AP_InertialSensor &ins) @@ -924,7 +924,6 @@ void DataFlash_Class::Log_Write_IMU(const AP_InertialSensor &ins)
accel_health : (uint8_t)ins.get_accel_health(2)
};
WriteBlock(&pkt3, sizeof(pkt3));
#endif
}
// Write an accel/gyro delta time data packet
@ -953,7 +952,7 @@ void DataFlash_Class::Log_Write_IMUDT(const AP_InertialSensor &ins) @@ -953,7 +952,7 @@ void DataFlash_Class::Log_Write_IMUDT(const AP_InertialSensor &ins)
if (ins.get_gyro_count() < 2 && ins.get_accel_count() < 2) {
return;
}
#if INS_MAX_INSTANCES > 1
delta_vel_t = ins.get_delta_velocity_dt(1);
if (!ins.get_delta_angle(1, delta_angle)) {
delta_angle.zero();
@ -998,7 +997,6 @@ void DataFlash_Class::Log_Write_IMUDT(const AP_InertialSensor &ins) @@ -998,7 +997,6 @@ void DataFlash_Class::Log_Write_IMUDT(const AP_InertialSensor &ins)
delta_vel_z : delta_velocity.z
};
WriteBlock(&pkt3, sizeof(pkt3));
#endif
}
void DataFlash_Class::Log_Write_Vibration(const AP_InertialSensor &ins)

Loading…
Cancel
Save