altos: Remove MPU6000 debuging hacks

Appears to be working now

Signed-off-by: Keith Packard <keithp@keithp.com>

diff --git a/src/drivers/ao_mpu6000.c b/src/drivers/ao_mpu6000.c
index fb2d54c03a162da20b22599bb84a4152db62b5f0..fc768cc9ae1cdc166f4add87866d4e505df101f9 100644 (file)
--- a/src/drivers/ao_mpu6000.c
+++ b/src/drivers/ao_mpu6000.c
@@ -305,7 +305,6 @@ static struct ao_task ao_mpu6000_task;
 static void
 ao_mpu6000_show(void)
 {
-#if 0
        struct ao_data  sample;
 
        ao_data_get(&sample);
@@ -316,8 +315,6 @@ ao_mpu6000_show(void)
                sample.mpu6000.gyro_x,
                sample.mpu6000.gyro_y,
                sample.mpu6000.gyro_z);
-#endif
-       printf ("who-am-i: %02x\n", ao_mpu6000_reg_read(MPU6000_WHO_AM_I));
 }
 
 static const struct ao_cmds ao_mpu6000_cmds[] = {
@@ -330,7 +327,7 @@ ao_mpu6000_init(void)
 {
        ao_mpu6000_configured = 0;
 
-//     ao_add_task(&ao_mpu6000_task, ao_mpu6000, "mpu6000");
+       ao_add_task(&ao_mpu6000_task, ao_mpu6000, "mpu6000");
 #ifndef AO_MPU6000_I2C_INDEX
        ao_spi_init_cs(AO_MPU6000_SPI_CS_PORT, (1 << AO_MPU6000_SPI_CS_PIN));
 #endif