altos/telelco-v2.0: A bit fancier with the drag-mode LED show

[fw/altos] / src / stmf0 / ao_adc_fast.h

diff --git a/src/stmf0/ao_adc_fast.h b/src/stmf0/ao_adc_fast.h
index a2408d147914c3b471d3db455e50013beebb27a3..504651e5856c7b43c0fb1a120bffb93a001eaec3 100644 (file)
--- a/src/stmf0/ao_adc_fast.h
+++ b/src/stmf0/ao_adc_fast.h
@@ -3,7 +3,8 @@
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License as published by
- * the Free Software Foundation; version 2 of the License.
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
  *
  * This program is distributed in the hope that it will be useful, but
  * WITHOUT ANY WARRANTY; without even the implied warranty of
@@ -24,4 +25,63 @@ ao_adc_read(uint16_t *dest, int len);
 void
 ao_adc_init(void);
 
+/* Total ring size in samples */
+#define AO_ADC_RING_SIZE       1024
+
+extern uint16_t        ao_adc_ring[AO_ADC_RING_SIZE] __attribute__((aligned(4)));
+
+#define ao_adc_ring_step(pos,inc)      (((pos) + (inc)) & (AO_ADC_RING_SIZE - 1))
+
+extern uint16_t        ao_adc_ring_head, ao_adc_ring_remain;
+extern uint16_t        ao_adc_running;
+
+/*
+ * Place to start fetching values from
+ */
+static inline uint16_t
+ao_adc_ring_tail(void)
+{
+       return (ao_adc_ring_head - ao_adc_ring_remain) & (AO_ADC_RING_SIZE - 1);
+}
+
+void
+_ao_adc_start(void);
+
+/*
+ * Space available to write ADC values into
+ */
+static inline uint16_t
+_ao_adc_space(void)
+{
+       /* Free to end of buffer? */
+       if (ao_adc_ring_remain <= ao_adc_ring_head)
+               return AO_ADC_RING_SIZE - ao_adc_ring_head;
+
+       /* no, return just the unused entries beyond head */
+       return AO_ADC_RING_SIZE - ao_adc_ring_remain;
+}
+
+static inline uint16_t
+ao_adc_get(uint16_t n)
+{
+       ao_arch_block_interrupts();
+       while (ao_adc_ring_remain < n) {
+               if (!ao_adc_running)
+                       _ao_adc_start();
+               ao_sleep(&ao_adc_ring_head);
+       }
+       ao_arch_release_interrupts();
+       return ao_adc_ring_tail();
+}
+
+static inline void
+ao_adc_ack(uint16_t n)
+{
+       ao_arch_block_interrupts();
+       ao_adc_ring_remain -= n;
+       if (!ao_adc_running)
+               _ao_adc_start();
+       ao_arch_release_interrupts();
+}
+
 #endif /* _AO_ADC_FAST_H_ */