X-Git-Url: https://git.gag.com/?p=fw%2Faltos;a=blobdiff_plain;f=src%2Fkernel%2Fao_data.c;h=77cd98e40cdc577bbfd7d998cdfb9f21b1fb5887;hp=536ffa2bb295556686a64fc534dccdc9bda27fc3;hb=fa30825d015d92bdbc95d2684386beef9fe9dc01;hpb=c246a366a6e0117e70abafc30db71c0545b88f6f

diff --git a/src/kernel/ao_data.c b/src/kernel/ao_data.c
index 536ffa2b..77cd98e4 100644
--- a/src/kernel/ao_data.c
+++ b/src/kernel/ao_data.c
@@ -27,11 +27,18 @@ volatile uint8_t		ao_data_present;
 void
 ao_data_get(struct ao_data *packet)
 {
-#if HAS_FLIGHT
-	uint8_t	i = ao_data_ring_prev(ao_sample_data);
-#else
 	uint8_t	i = ao_data_ring_prev(ao_data_head);
-#endif
 	memcpy(packet, (void *) &ao_data_ring[i], sizeof (struct ao_data));
 }
 #endif
+
+#if HAS_ACCEL
+accel_t
+ao_data_accel(volatile struct ao_data *packet) {
+	accel_t raw;
+	raw = ao_data_accel_raw(packet);
+	if (ao_config.pad_orientation != AO_PAD_ORIENTATION_ANTENNA_UP)
+		raw = ao_data_accel_invert(raw);
+	return raw;
+}
+#endif