#include "ao.h"
-uint8_t ao_btm_running;
int8_t ao_btm_stdio;
__xdata uint8_t ao_btm_connected;
-uint8_t ao_btm_chat;
-
-__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];
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')
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
void
ao_btm_putchar(char c)
{
- ao_btm_log_out_char(c);
ao_serial_putchar(c);
ao_delay(1);
}
NULL);
ao_btm_echo(0);
- ao_btm_running = 1;
for (;;) {
- while (!ao_btm_connected && !ao_btm_chat)
+ while (!ao_btm_connected)
ao_sleep(&ao_btm_connected);
- if (ao_btm_chat) {
- ao_btm_running = 0;
- while (ao_btm_chat) {
- char c;
- c = ao_serial_pollchar();
- if (c != AO_READ_AGAIN) {
- ao_btm_log_in_char(c);
- ao_usb_putchar(c);
- } else {
- ao_usb_flush();
- ao_sleep(&ao_usart1_rx_fifo);
- }
- }
- ao_btm_running = 1;
- }
while (ao_btm_connected) {
ao_led_for(AO_LED_GREEN, AO_MS_TO_TICKS(20));
ao_delay(AO_SEC_TO_TICKS(3));
__xdata struct ao_task ao_btm_task;
-/*
- * Connect directly to the bluetooth device, mostly
- * useful for testing
- */
-static void
-ao_btm_forward(void)
-{
- char c;
-
- ao_btm_chat = 1;
- ao_wakeup(&ao_btm_connected);
- ao_usb_flush();
- while ((c = ao_usb_getchar()) != '~') {
- if (c == '\n') c = '\r';
- ao_btm_putchar(c);
- }
- ao_btm_chat = 0;
- while (!ao_btm_running) {
- ao_wakeup(&ao_usart1_rx_fifo);
- ao_delay(AO_MS_TO_TICKS(10));
- }
-}
-
-/*
- * 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
{
P2IFG = 0;
}
-__code struct ao_cmds ao_btm_cmds[] = {
- { ao_btm_forward, "B\0BTM serial link." },
- { ao_btm_dump, "d\0Dump btm buffer." },
- { ao_btm_speed, "s <19200,57600>\0Set btm serial speed." },
- { 0, NULL },
-};
-
void
ao_btm_init (void)
{
PICTL |= PICTL_P2IEN;
ao_add_task(&ao_btm_task, ao_btm, "bt");
- ao_cmd_register(&ao_btm_cmds[0]);
}