Testing hacks for BMX160 driver

[fw/altos] / src / drivers / ao_bmx160.c

diff --git a/src/drivers/ao_bmx160.c b/src/drivers/ao_bmx160.c
index 4c3c2a9f935cce8628924db4b17999cda2febd95..f206bfcfa5fa829327ef8c99c63cffe778e125ed 100644 (file)
--- a/src/drivers/ao_bmx160.c
+++ b/src/drivers/ao_bmx160.c
@@ -90,6 +90,7 @@ _ao_bmm150_reg_write(uint8_t addr, uint8_t data)
        _ao_bmm150_wait_manual();
 }
 
+#if BMX160_TEST
 static uint8_t
 _ao_bmm150_reg_read(uint8_t addr)
 {
@@ -97,6 +98,7 @@ _ao_bmm150_reg_read(uint8_t addr)
        _ao_bmm150_wait_manual();
        return _ao_bmx160_reg_read(BMX160_DATA_0);
 }
+#endif
 
 static void
 _ao_bmx160_sample(struct ao_bmx160_sample *sample)
@@ -310,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,
@@ -320,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