X-Git-Url: https://git.gag.com/?a=blobdiff_plain;f=src%2Fdrivers%2Fao_bmx160.c;h=f206bfcfa5fa829327ef8c99c63cffe778e125ed;hb=a18e33dabee4dd1f2af4aacb0200d1aacd4fa0b7;hp=e1af23a1a7c471e4c41238af1832188059b3b392;hpb=ee38b3bea20f1e3a73e67aea151f9fc6abdc8483;p=fw%2Faltos diff --git a/src/drivers/ao_bmx160.c b/src/drivers/ao_bmx160.c index e1af23a1..f206bfcf 100644 --- a/src/drivers/ao_bmx160.c +++ b/src/drivers/ao_bmx160.c @@ -312,6 +312,17 @@ static struct ao_task ao_bmx160_task; static void ao_bmx160_show(void) { + ao_bmx160_spi_get(); + uint8_t acc_conf = _ao_bmx160_reg_read(BMX160_ACC_CONF); + uint8_t acc_range = _ao_bmx160_reg_read(BMX160_ACC_RANGE); + uint8_t gyr_conf = _ao_bmx160_reg_read(BMX160_GYR_CONF); + uint8_t gyr_range = _ao_bmx160_reg_read(BMX160_GYR_RANGE); + uint8_t mag_conf = _ao_bmx160_reg_read(BMX160_MAG_CONF); + ao_bmx160_spi_put(); + + printf("ACC_CONF %02x ACC_RANGE %02x GYR_CONF %02x GYR_RANGE %02x MAG_CONF %02x\n", + acc_conf, acc_range, gyr_conf, gyr_range, mag_conf); + printf ("Accel: %7d %7d %7d Gyro: %7d %7d %7d Mag: %7d %7d %7d\n", ao_bmx160_current.acc_x, ao_bmx160_current.acc_y, @@ -322,6 +333,7 @@ ao_bmx160_show(void) ao_bmx160_current.mag_x, ao_bmx160_current.mag_y, ao_bmx160_current.mag_z); + } #if BMX160_TEST