altos: TM v2 places the MMA6555 upside down compared to Tmega

[fw/altos] / src / core / ao_data.h

diff --git a/src/core/ao_data.h b/src/core/ao_data.h
index b0f086f867285cf111d865b48bd0a684d0fd41d6..c873e9d34d7ebe6ad1b9aaf7912051d3a4099c22 100644 (file)
--- a/src/core/ao_data.h
+++ b/src/core/ao_data.h
@@ -272,7 +272,11 @@ typedef int16_t accel_t;
 /* MMA655X is hooked up so that positive values represent negative acceleration */
 
 #define ao_data_accel(packet)                  ((packet)->mma655x)
+#if AO_MMA655X_INVERT
+#define ao_data_accel_cook(packet)             (4095 - (packet)->mma655x)
+#else
 #define ao_data_accel_cook(packet)             ((packet)->mma655x)
+#endif
 #define ao_data_set_accel(packet, accel)       ((packet)->mma655x = (accel))
 #define ao_data_accel_invert(accel)            (4095 - (accel))