X-Git-Url: https://git.gag.com/?a=blobdiff_plain;f=src%2Fao_btm.c;h=db0ff6b09371508a67c806856e7ec21b4c2b27c3;hb=d9cc27641fe1778c098b065bf110be7823e6c9f4;hp=aa7a7101edd269dca21e2b7c874d961e5f0a2ee5;hpb=0195ff442c1da5d363dfda3f88f41865d0c6b469;p=fw%2Faltos

diff --git a/src/ao_btm.c b/src/ao_btm.c
index aa7a7101..db0ff6b0 100644
--- a/src/ao_btm.c
+++ b/src/ao_btm.c
@@ -17,46 +17,9 @@
 
 #include "ao.h"
 
-uint8_t			ao_btm_running;
 int8_t			ao_btm_stdio;
 __xdata uint8_t		ao_btm_connected;
 
-__xdata char		ao_btm_buffer[1024];
-int			ao_btm_ptr;
-char			ao_btm_dir;
-
-void
-ao_btm_putchar(char c);
-
-static void
-ao_btm_add_char(char c)
-{
-	if (ao_btm_ptr < sizeof (ao_btm_buffer))
-		ao_btm_buffer[ao_btm_ptr++] = c;
-}
-
-static void
-ao_btm_log_char(char c, char dir)
-{
-	if (dir != ao_btm_dir) {
-		ao_btm_add_char(dir);
-		ao_btm_dir = dir;
-	}
-	ao_btm_add_char(c);
-}
-
-static void
-ao_btm_log_out_char(char c)
-{
-	ao_btm_log_char(c, '>');
-}
-
-static void
-ao_btm_log_in_char(char c)
-{
-	ao_btm_log_char(c, '<');
-}
-
 #define AO_BTM_MAX_REPLY	16
 __xdata char		ao_btm_reply[AO_BTM_MAX_REPLY];
 
@@ -76,7 +39,6 @@ ao_btm_get_line(void)
 	for (;;) {
 
 		while ((c = ao_serial_pollchar()) != AO_READ_AGAIN) {
-			ao_btm_log_in_char(c);
 			if (ao_btm_reply_len < sizeof (ao_btm_reply))
 				ao_btm_reply[ao_btm_reply_len++] = c;
 			if (c == '\r' || c == '\n')
@@ -115,32 +77,6 @@ ao_btm_echo(uint8_t echo)
 	ao_stdios[ao_btm_stdio].echo = echo;
 }
 
-/*
- * A command line pre-processor to detect connect/disconnect messages
- * and update the internal state
- */
-
-uint8_t
-ao_cmd_filter(void)
-{
-	if (ao_cur_stdio != ao_btm_stdio)
-		return 0;
-	ao_cmd_lex();
-	while (ao_cmd_lex_c != '\n') {
-		if (ao_match_word("CONNECT"))
-			return 1;
-		if (ao_match_word("DISCONNECT"))
-			return 1;
-		if (ao_match_word("ERROR"))
-			return 1;
-		if (ao_match_word("OK"))
-			return 1;
-		ao_cmd_lex();
-	}
-	ao_cmd_status = 0;
-	return 0;
-}
-
 /*
  * Delay between command charaters; the BT module
  * can't keep up with 57600 baud
@@ -149,7 +85,6 @@ ao_cmd_filter(void)
 void
 ao_btm_putchar(char c)
 {
-	ao_btm_log_out_char(c);
 	ao_serial_putchar(c);
 	ao_delay(1);
 }
@@ -261,7 +196,6 @@ ao_btm(void)
 				    NULL);
 	ao_btm_echo(0);
 
-	ao_btm_running = 1;
 	for (;;) {
 		while (!ao_btm_connected)
 			ao_sleep(&ao_btm_connected);
@@ -274,37 +208,6 @@ ao_btm(void)
 
 __xdata struct ao_task ao_btm_task;
 
-/*
- * Dump everything received from the bluetooth device during startup
- */
-static void
-ao_btm_dump(void)
-{
-	int i;
-	char c;
-
-	for (i = 0; i < ao_btm_ptr; i++) {
-		c = ao_btm_buffer[i];
-		if (c < ' ' && c != '\n')
-			printf("\\%03o", ((int) c) & 0xff);
-		else
-			putchar(ao_btm_buffer[i]);
-	}
-	putchar('\n');
-}
-
-static void
-ao_btm_speed(void)
-{
-	ao_cmd_decimal();
-	if (ao_cmd_lex_u32 == 57600)
-		ao_serial_set_speed(AO_SERIAL_SPEED_57600);
-	else if (ao_cmd_lex_u32 == 19200)
-		ao_serial_set_speed(AO_SERIAL_SPEED_19200);
-	else
-		ao_cmd_status = ao_cmd_syntax_error;
-}
-
 void
 ao_btm_check_link() __critical
 {
@@ -327,12 +230,6 @@ ao_btm_isr(void)
 	P2IFG = 0;
 }
 
-__code struct ao_cmds ao_btm_cmds[] = {
-	{ ao_btm_dump,		"d\0Dump btm buffer." },
-	{ ao_btm_speed,		"s <19200,57600>\0Set btm serial speed." },
-	{ 0, NULL },
-};
-
 void
 ao_btm_init (void)
 {
@@ -353,5 +250,4 @@ ao_btm_init (void)
 	PICTL |= PICTL_P2IEN;
 
 	ao_add_task(&ao_btm_task, ao_btm, "bt");
-	ao_cmd_register(&ao_btm_cmds[0]);
 }