X-Git-Url: https://git.gag.com/?p=fw%2Faltos;a=blobdiff_plain;f=src%2Fdrivers%2Fao_mpu6000.c;h=79658c552bf2e38b7c917d287523f148df86d271;hp=dd3da8dee3837f504a6df05d4633a0d5e03bf9cf;hb=8a830c7f9ed41565c72edb85852e2df8bfa351f5;hpb=cdfa9303a024300141e8b328f81404a9b7466207 diff --git a/src/drivers/ao_mpu6000.c b/src/drivers/ao_mpu6000.c index dd3da8de..79658c55 100644 --- a/src/drivers/ao_mpu6000.c +++ b/src/drivers/ao_mpu6000.c @@ -357,14 +357,23 @@ static struct ao_task ao_mpu6000_task; static void ao_mpu6000_show(void) { - printf ("Accel: %7d %7d %7d Gyro: %7d %7d %7d id %02x\n", +#ifdef AO_LOG_NORMALIZED + printf ("MPU6000: %7d %7d %7d %7d %7d %7d\n", + ao_mpu6000_along(&ao_mpu6000_current), + ao_mpu6000_across(&ao_mpu6000_current), + ao_mpu6000_through(&ao_mpu6000_current), + ao_mpu6000_roll(&ao_mpu6000_current), + ao_mpu6000_pitch(&ao_mpu6000_current), + ao_mpu6000_yaw(&ao_mpu6000_current)); +#else + printf ("Accel: %7d %7d %7d Gyro: %7d %7d %7d\n", ao_mpu6000_current.accel_x, ao_mpu6000_current.accel_y, ao_mpu6000_current.accel_z, ao_mpu6000_current.gyro_x, ao_mpu6000_current.gyro_y, - ao_mpu6000_current.gyro_z, - mpu_id); + ao_mpu6000_current.gyro_z); +#endif } static const struct ao_cmds ao_mpu6000_cmds[] = {