Browse Source

DataFlash: fixed dual sensor dataflash logging

mission-4.1.18
Andrew Tridgell 11 years ago
parent
commit
513f4074ce
  1. 8
      libraries/DataFlash/LogFile.cpp

8
libraries/DataFlash/LogFile.cpp

@ -688,8 +688,8 @@ void DataFlash_Class::Log_Write_RCOUT(void) @@ -688,8 +688,8 @@ void DataFlash_Class::Log_Write_RCOUT(void)
void DataFlash_Class::Log_Write_IMU(const AP_InertialSensor &ins)
{
uint32_t tstamp = hal.scheduler->millis();
const Vector3f &gyro = ins.get_gyro();
const Vector3f &accel = ins.get_accel();
const Vector3f &gyro = ins.get_gyro(0);
const Vector3f &accel = ins.get_accel(0);
struct log_IMU pkt = {
LOG_PACKET_HEADER_INIT(LOG_IMU_MSG),
timestamp : tstamp,
@ -704,8 +704,8 @@ void DataFlash_Class::Log_Write_IMU(const AP_InertialSensor &ins) @@ -704,8 +704,8 @@ void DataFlash_Class::Log_Write_IMU(const AP_InertialSensor &ins)
if (ins.get_gyro_count() < 2 && ins.get_accel_count() < 2) {
return;
}
const Vector3f &gyro2 = ins.get_gyro();
const Vector3f &accel2 = ins.get_accel();
const Vector3f &gyro2 = ins.get_gyro(1);
const Vector3f &accel2 = ins.get_accel(1);
struct log_IMU pkt2 = {
LOG_PACKET_HEADER_INIT(LOG_IMU2_MSG),
timestamp : tstamp,

Loading…
Cancel
Save