altos: Flip acceleration data consistently for orientation changes
[fw/altos] / src / core / ao_data.h
index c873e9d34d7ebe6ad1b9aaf7912051d3a4099c22..c4b062fdb1d0f9f4631354ada9b2baa30df9910a 100644 (file)
@@ -18,6 +18,8 @@
 #ifndef _AO_DATA_H_
 #define _AO_DATA_H_
 
+#define GRAVITY 9.80665
+
 #if HAS_ADC
 #define AO_DATA_ADC    (1 << 0)
 #else
@@ -101,7 +103,7 @@ extern volatile __data uint8_t              ao_data_count;
  * signaled by the timer tick
  */
 #define AO_DATA_WAIT() do {                            \
-               ao_sleep((void *) &ao_data_count);      \
+               ao_sleep(DATA_TO_XDATA ((void *) &ao_data_count));      \
        } while (0)
 
 #endif /* AO_DATA_RING */
@@ -271,14 +273,16 @@ typedef int16_t accel_t;
 
 /* MMA655X is hooked up so that positive values represent negative acceleration */
 
+#define AO_ACCEL_INVERT                4095
+
 #define ao_data_accel(packet)                  ((packet)->mma655x)
 #if AO_MMA655X_INVERT
-#define ao_data_accel_cook(packet)             (4095 - (packet)->mma655x)
+#define ao_data_accel_cook(packet)             (AO_ACCEL_INVERT - (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))
+#define ao_data_accel_invert(accel)            (AO_ACCEL_INVERT - (accel))
 
 #endif
 
@@ -286,6 +290,8 @@ typedef int16_t accel_t;
 
 #define HAS_ACCEL      1
 
+#define AO_ACCEL_INVERT                0
+
 typedef int16_t accel_t;
 
 /* MPU6000 is hooked up so that positive y is positive acceleration */
@@ -300,8 +306,8 @@ typedef int16_t accel_t;
 
 #define HAS_GYRO       1
 
-typedef int16_t        gyro_t;
-typedef int32_t angle_t;
+typedef int16_t        gyro_t;         /* in raw sample units */
+typedef int16_t angle_t;       /* in degrees */
 
 /* Y axis is aligned with the direction of motion (along) */
 /* X axis is aligned in the other board axis (across) */
@@ -317,4 +323,16 @@ typedef int32_t angle_t;
 
 #endif
 
+#if !HAS_MAG && HAS_HMC5883
+
+#define HAS_MAG                1
+
+typedef int16_t ao_mag_t;              /* in raw sample units */
+
+#define ao_data_mag_along(packet)      ((packet)->hmc5883.x)
+#define ao_data_mag_across(packet)     ((packet)->hmc5883.y)
+#define ao_data_mag_through(packet)    ((packet)->hmc5883.z)
+
+#endif
+
 #endif /* _AO_DATA_H_ */