altos/telelco-v3.0: Add contrast setting

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

diff --git a/src/drivers/ao_bmi088.c b/src/drivers/ao_bmi088.c
index 357d1d0ec9880b4a45db6eadca6584eed1cf1c4d..96e995f056035d2d7fa305e690f30a11fb6bce2b 100644 (file)
--- a/src/drivers/ao_bmi088.c
+++ b/src/drivers/ao_bmi088.c
@@ -20,7 +20,7 @@
 #include <ao_bmi088.h>
 #include <ao_data.h>
 
-#define AO_BMI088_SPI_SPEED    ao_spi_speed(100000)
+#define AO_BMI088_SPI_SPEED    ao_spi_speed(AO_BMI088_SPI_BUS, 100000)
 
 #define ao_bmi088_spi_get()    ao_spi_get(AO_BMI088_SPI_BUS, AO_BMI088_SPI_SPEED)
 #define ao_bmi088_spi_put()    ao_spi_put(AO_BMI088_SPI_BUS)
@@ -288,6 +288,15 @@ static struct ao_task ao_bmi088_task;
 static void
 ao_bmi088_show(void)
 {
+#ifdef AO_LOG_NORMALIZED
+       printf ("BMI088: %7d %7d %7d %7d %7d %7d\n",
+               ao_bmi088_along(&ao_bmi088_current),
+               ao_bmi088_across(&ao_bmi088_current),
+               ao_bmi088_through(&ao_bmi088_current),
+               ao_bmi088_roll(&ao_bmi088_current),
+               ao_bmi088_pitch(&ao_bmi088_current),
+               ao_bmi088_yaw(&ao_bmi088_current));
+#else
        printf ("Accel: %7d %7d %7d Gyro: %7d %7d %7d\n",
                ao_bmi088_current.acc.x,
                ao_bmi088_current.acc.y,
@@ -295,6 +304,7 @@ ao_bmi088_show(void)
                ao_bmi088_current.gyr.x,
                ao_bmi088_current.gyr.y,
                ao_bmi088_current.gyr.z);
+#endif
 }
 
 static const struct ao_cmds bmi_cmds[] = {