X-Git-Url: https://git.gag.com/?a=blobdiff_plain;f=src%2Fkernel%2Fao_log_mega.c;h=c6bdf1e23c53cba1d4329bccdfdc21a591c8c851;hb=master;hp=78dbd980d527288bbedb1797f9b7401c91872396;hpb=7f46240dfc57164f0c1b0c4c4ed9695bca63860d;p=fw%2Faltos diff --git a/src/kernel/ao_log_mega.c b/src/kernel/ao_log_mega.c index 78dbd980..ca7bc8bb 100644 --- a/src/kernel/ao_log_mega.c +++ b/src/kernel/ao_log_mega.c @@ -48,7 +48,7 @@ ao_log(void) #if HAS_FLIGHT ao_log_data.type = AO_LOG_FLIGHT; - ao_log_data.tick = ao_sample_tick; + ao_log_data.tick = (uint16_t) ao_sample_tick; #if HAS_ACCEL ao_log_data.u.flight.ground_accel = ao_ground_accel; #endif @@ -75,7 +75,7 @@ ao_log(void) /* Write samples to EEPROM */ while (ao_log_data_pos != ao_data_head) { AO_TICK_TYPE tick = ao_data_ring[ao_log_data_pos].tick; - ao_log_data.tick = tick; + ao_log_data.tick = (uint16_t) tick; volatile struct ao_data *d = &ao_data_ring[ao_log_data_pos]; if ((AO_TICK_SIGNED) (tick - next_sensor) >= 0) { ao_log_data.type = AO_LOG_SENSOR; @@ -83,15 +83,23 @@ ao_log(void) ao_log_data.u.sensor.pres = d->ms5607_raw.pres; ao_log_data.u.sensor.temp = d->ms5607_raw.temp; #endif -#if HAS_MPU6000 + #ifdef AO_LOG_NORMALIZED +# if HAS_IMU ao_log_data.u.sensor.accel_along = ao_data_along(d); ao_log_data.u.sensor.accel_across = ao_data_across(d); ao_log_data.u.sensor.accel_through = ao_data_through(d); ao_log_data.u.sensor.gyro_roll = ao_data_roll(d); ao_log_data.u.sensor.gyro_pitch = ao_data_pitch(d); ao_log_data.u.sensor.gyro_yaw = ao_data_yaw(d); -#else +# endif +# if HAS_MAG + ao_log_data.u.sensor.mag_along = ao_data_mag_along(d); + ao_log_data.u.sensor.mag_across = ao_data_mag_across(d); + ao_log_data.u.sensor.mag_through = ao_data_mag_through(d); +# endif +#else /* AO_LOG_NORMALIZED */ +#if HAS_MPU6000 ao_log_data.u.sensor.accel_x = d->mpu6000.accel_x; ao_log_data.u.sensor.accel_y = d->mpu6000.accel_y; ao_log_data.u.sensor.accel_z = d->mpu6000.accel_z; @@ -99,17 +107,11 @@ ao_log(void) ao_log_data.u.sensor.gyro_y = d->mpu6000.gyro_y; ao_log_data.u.sensor.gyro_z = d->mpu6000.gyro_z; #endif -#endif #if HAS_HMC5883 ao_log_data.u.sensor.mag_x = d->hmc5883.x; ao_log_data.u.sensor.mag_z = d->hmc5883.z; ao_log_data.u.sensor.mag_y = d->hmc5883.y; #endif -#ifdef HAS_MMC5983 - ao_log_data.u.sensor.mag_along = ao_data_mag_along(d); - ao_log_data.u.sensor.mag_across = ao_data_mag_across(d); - ao_log_data.u.sensor.mag_through = ao_data_mag_through(d); -#endif #if HAS_MPU9250 ao_log_data.u.sensor.accel_x = d->mpu9250.accel_x; ao_log_data.u.sensor.accel_y = d->mpu9250.accel_y; @@ -132,6 +134,7 @@ ao_log(void) ao_log_data.u.sensor.mag_z = d->bmx160.mag_z; ao_log_data.u.sensor.mag_y = d->bmx160.mag_y; #endif +#endif /* !AO_LOG_NORMALIZED */ ao_log_data.u.sensor.accel = ao_data_accel(&ao_data_ring[ao_log_data_pos]); ao_log_write(&ao_log_data); if (ao_log_state <= ao_flight_coast) @@ -157,7 +160,7 @@ ao_log(void) if (ao_flight_state != ao_log_state) { ao_log_state = ao_flight_state; ao_log_data.type = AO_LOG_STATE; - ao_log_data.tick = ao_time(); + ao_log_data.tick = (uint16_t) ao_time(); ao_log_data.u.state.state = ao_log_state; ao_log_data.u.state.reason = 0; ao_log_write(&ao_log_data);