X-Git-Url: https://git.gag.com/?p=fw%2Faltos;a=blobdiff_plain;f=src%2Fcore%2Fao_radio_cmac.c;h=3e8dce53ac0a95ab43293860f7f97b343661ea48;hp=32ce879310607f9bf3cd9174ca1c3e17fc5cc266;hb=83e0d4352041b3964ea7a133b0f67da9ebaa1c77;hpb=c64999c39d6d9242f98bdc9312436c3333115bfd

diff --git a/src/core/ao_radio_cmac.c b/src/core/ao_radio_cmac.c
index 32ce8793..3e8dce53 100644
--- a/src/core/ao_radio_cmac.c
+++ b/src/core/ao_radio_cmac.c
@@ -243,176 +243,3 @@ radio_cmac_recv_cmd(void) __reentrant
 	ao_mutex_put(&ao_radio_cmac_mutex);
 }
 
-static __xdata struct ao_launch_command	command;
-static __xdata struct ao_launch_query	query;
-static __pdata uint16_t	launch_serial;
-static __pdata uint8_t	launch_channel;
-static __pdata uint16_t	tick_offset;
-
-static void
-launch_args(void) __reentrant
-{
-	ao_cmd_decimal();
-	launch_serial = ao_cmd_lex_i;
-	ao_cmd_decimal();
-	launch_channel = ao_cmd_lex_i;
-}
-
-static int8_t
-launch_query(void)
-{
-	uint8_t	i;
-	int8_t	r = AO_RADIO_CMAC_OK;
-
-	tick_offset = ao_time();
-	for (i = 0; i < 10; i++) {
-		printf ("."); flush();
-		command.tick = ao_time();
-		command.serial = launch_serial;
-		command.cmd = AO_LAUNCH_QUERY;
-		command.channel = launch_channel;
-		ao_radio_cmac_send(&command, sizeof (command));
-		r = ao_radio_cmac_recv(&query, sizeof (query), AO_MS_TO_TICKS(500));
-		if (r == AO_RADIO_CMAC_OK)
-			break;
-	}
-	tick_offset -= query.tick;
-	printf("\n"); flush();
-	return r;
-}
-
-static void
-launch_report_cmd(void) __reentrant
-{
-	int8_t		r;
-
-	launch_args();
-	if (ao_cmd_status != ao_cmd_success)
-		return;
-	r = launch_query();
-	switch (r) {
-	case AO_RADIO_CMAC_OK:
-		if (query.valid) {
-			switch (query.arm_status) {
-			case ao_igniter_ready:
-			case ao_igniter_active:
-				printf ("Armed: ");
-				break;
-			default:
-				printf("Disarmed: ");
-			}
-			switch (query.igniter_status) {
-			default:
-				printf("unknown\n");
-				break;
-			case ao_igniter_ready:
-				printf("igniter good\n");
-				break;
-			case ao_igniter_open:
-				printf("igniter bad\n");
-				break;
-			}
-		} else {
-			printf("Invalid channel %d\n", launch_channel);
-		}
-		printf("Rssi: %d\n", ao_radio_cmac_rssi);
-		break;
-	default:
-		printf("Error %d\n", r);
-		break;
-	}
-}
-
-static void
-launch_arm(void) __reentrant
-{
-	command.tick = ao_time() - tick_offset;
-	command.serial = launch_serial;
-	command.cmd = AO_LAUNCH_ARM;
-	command.channel = launch_channel;
-	ao_radio_cmac_send(&command, sizeof (command));
-}
-
-static void
-launch_ignite(void) __reentrant
-{
-	command.tick = ao_time() - tick_offset;
-	command.serial = launch_serial;
-	command.cmd = AO_LAUNCH_FIRE;
-	command.channel = 0;
-	ao_radio_cmac_send(&command, sizeof (command));
-}
-
-static void
-launch_fire_cmd(void) __reentrant
-{
-	static __xdata struct ao_launch_command	command;
-	uint8_t		secs;
-	uint8_t		i;
-	int8_t		r;
-
-	launch_args();
-	ao_cmd_decimal();
-	secs = ao_cmd_lex_i;
-	if (ao_cmd_status != ao_cmd_success)
-		return;
-	r = launch_query();
-	if (r != AO_RADIO_CMAC_OK) {
-		printf("query failed %d\n", r);
-		return;
-	}
-
-	for (i = 0; i < 4; i++) {
-		printf("arm %d\n", i); flush();
-		launch_arm();
-	}
-
-	secs = secs * 10 - 5;
-	if (secs > 100)
-		secs = 100;
-	for (i = 0; i < secs; i++) {
-		printf("fire %d\n", i); flush();
-		launch_ignite();
-		ao_delay(AO_MS_TO_TICKS(100));
-	}
-}
-
-static void
-launch_arm_cmd(void) __reentrant
-{
-	uint8_t	i;
-	int8_t  r;
-	launch_args();
-	r = launch_query();
-	if (r != AO_RADIO_CMAC_OK) {
-		printf("query failed %d\n", r);
-		return;
-	}
-	for (i = 0; i < 4; i++)
-		launch_arm();
-}
-
-static void
-launch_ignite_cmd(void) __reentrant
-{
-	uint8_t i;
-	launch_args();
-	for (i = 0; i < 4; i++)
-		launch_ignite();
-}
-
-static __code struct ao_cmds ao_radio_cmac_cmds[] = {
-	{ radio_cmac_send_cmd,	"s <length>\0Send AES-CMAC packet. Bytes to send follow on next line" },
-	{ radio_cmac_recv_cmd,	"S <length> <timeout>\0Receive AES-CMAC packet. Timeout in ms" },
-	{ launch_report_cmd,    "l <serial> <channel>\0Get remote launch status" },
-	{ launch_fire_cmd,	"f <serial> <channel> <secs>\0Fire remote igniter" },
-	{ launch_arm_cmd,	"a <serial> <channel>\0Arm remote igniter" },
-	{ launch_ignite_cmd,	"i <serial> <channel>\0Pulse remote igniter" },
-	{ 0, NULL },
-};
-
-void
-ao_radio_cmac_init(void)
-{
-	ao_cmd_register(&ao_radio_cmac_cmds[0]);
-}