X-Git-Url: https://git.gag.com/?a=blobdiff_plain;f=src%2Fdrivers%2Fao_pad.c;h=b6dbcefef0e0e9c5c2b034356e04c2c97ffdbd7b;hb=7a0ed0ff4192060854d69e640de2c30105eb2f62;hp=21aa788d0e17a9d7b830e1e2548c73d3aae1fd4e;hpb=659c0cd3ee4b9581c12ac2cd1b4162bf07a921ce;p=fw%2Faltos

diff --git a/src/drivers/ao_pad.c b/src/drivers/ao_pad.c
index 21aa788d..b6dbcefe 100644
--- a/src/drivers/ao_pad.c
+++ b/src/drivers/ao_pad.c
@@ -71,6 +71,23 @@ ao_pad_status(void)
 static __pdata uint8_t	ao_pad_armed;
 static __pdata uint16_t	ao_pad_arm_time;
 static __pdata uint8_t	ao_pad_box;
+static __xdata uint8_t	ao_pad_disabled;
+
+void
+ao_pad_disable(void)
+{
+	if (!ao_pad_disabled) {
+		ao_pad_disabled = 1;
+		ao_radio_recv_abort();
+	}
+}
+
+void
+ao_pad_enable(void)
+{
+	ao_pad_disabled = 0;
+	ao_wakeup (&ao_pad_disabled);
+}
 
 static void
 ao_pad(void)
@@ -85,6 +102,8 @@ ao_pad(void)
 	ao_pad_box = ao_74hc497_read();
 	for (;;) {
 		flush();
+		while (ao_pad_disabled)
+			ao_sleep(&ao_pad_disabled);
 		if (ao_radio_cmac_recv(&command, sizeof (command), 0) != AO_RADIO_CMAC_OK)
 			continue;