X-Git-Url: https://git.gag.com/?a=blobdiff_plain;f=src%2Fdrivers%2Fao_quadrature.c;h=6a2c1bba1af0e468831342b6f2cb130c81ce70a9;hb=46f87373bc8c28442273ee4f8da3a352223150f5;hp=aed4999e974cb666a6293934a85cd9f4ca5efe96;hpb=11046bc89b3ce6386f1005fc8476b08f54d6f5fb;p=fw%2Faltos

diff --git a/src/drivers/ao_quadrature.c b/src/drivers/ao_quadrature.c
index aed4999e..6a2c1bba 100644
--- a/src/drivers/ao_quadrature.c
+++ b/src/drivers/ao_quadrature.c
@@ -18,6 +18,12 @@
 #include <ao.h>
 #include <ao_quadrature.h>
 #include <ao_exti.h>
+#if AO_EVENT
+#include <ao_event.h>
+#define ao_quadrature_queue(q)	ao_event_put_isr(AO_EVENT_QUADRATURE, q, ao_quadrature_count[q])
+#else
+#define ao_quadrature_queue(q)
+#endif
 
 __xdata int32_t ao_quadrature_count[AO_QUADRATURE_COUNT];
 
@@ -59,6 +65,7 @@ ao_quadrature_isr(void)
 		default:
 			continue;
 		}
+		ao_quadrature_queue(q);
 		ao_wakeup(&ao_quadrature_count[q]);
 	}
 }