X-Git-Url: http://git.droids-corp.org/?a=blobdiff_plain;ds=sidebyside;f=commands.c;h=54e56d70fc88a04ebac813d34ec9b1822dea9b97;hb=a53014b7f52462e163a7d7ac64866aa75977422f;hp=319e1faf439807fff88f8227da03a57c7e208264;hpb=c552a01853bea12a3cd44e35be8c0df49ed7d7d0;p=protos%2Fxbee-avr.git diff --git a/commands.c b/commands.c index 319e1fa..54e56d7 100644 --- a/commands.c +++ b/commands.c @@ -56,7 +56,7 @@ extern const parse_inst_t PROGMEM cmd_log; extern const parse_inst_t PROGMEM cmd_log_show; extern const parse_inst_t PROGMEM cmd_log_type; extern const parse_inst_t PROGMEM cmd_stack_space; -extern const parse_inst_t PROGMEM cmd_scheduler; +extern const parse_inst_t PROGMEM cmd_callout; static int monitor_period_ms = 1000; static int monitor_running = 0; @@ -73,7 +73,7 @@ static struct callout range_event; static int range_count = 100; static int range_cur_count = 0; -static void monitor_cb(struct callout_manager *cm, +static void monitor_cb(struct callout_mgr *cm, struct callout *clt, void *dummy) { (void)clt; @@ -84,12 +84,10 @@ static void monitor_cb(struct callout_manager *cm, xbeeapp_send_atcmd(monitor_current->atcmd, NULL, 0, 0, NULL, NULL); monitor_current = LIST_NEXT(monitor_current, next); - callout_reset(cm, &monitor_event, - monitor_period_ms / monitor_count, - SINGLE, monitor_cb, NULL); + callout_reschedule(cm, clt, monitor_period_ms / monitor_count); } -static void range_cb(struct callout_manager *cm, +static void range_cb(struct callout_mgr *cm, struct callout *clt, void *dummy) { (void)cm; @@ -121,12 +119,10 @@ static void range_cb(struct callout_manager *cm, if (range_cur_count == 0) { range_running = 0; - return; + callout_stop(cm, clt); } - callout_reset(cm, &range_event, - range_period_ms, - SINGLE, range_cb, NULL); + callout_reschedule(cm, clt, range_period_ms); #endif } @@ -569,6 +565,105 @@ const parse_inst_t PROGMEM cmd_sendmsg = { /* ************* */ +/* this structure is filled when cmd_send_hello is parsed successfully */ +struct cmd_send_hello_result { + fixed_string_t send_hello; + uint64_t addr; + struct xbee_neigh *neigh; + uint16_t period; + uint16_t count; + fixed_string_t data; +}; + +/* function called when cmd_send_hello is parsed successfully */ +static void cmd_send_hello_parsed(void *parsed_result, void *use_neigh) +{ + struct cmd_send_hello_result *res = parsed_result; + uint16_t now, next, diff; + uint8_t flags; + uint64_t addr; + + if (use_neigh) + addr = res->neigh->addr; + else + addr = res->addr; + + IRQ_LOCK(flags); + now = global_ms; + IRQ_UNLOCK(flags); + + next = now; + + while (!cmdline_keypressed() && res->count != 0) { + IRQ_LOCK(flags); + now = global_ms; + IRQ_UNLOCK(flags); + + diff = now - next; + if (diff < res->period) + continue; + + rc_proto_send_hello(addr, res->data, strlen(res->data)); + next += res->period; + res->count--; + } +} + +const char PROGMEM str_send_hello[] = "send_hello"; + +const parse_token_string_t PROGMEM cmd_send_hello_send_hello = + TOKEN_STRING_INITIALIZER(struct cmd_send_hello_result, send_hello, + str_send_hello); + +const parse_token_num_t PROGMEM cmd_send_hello_addr = + TOKEN_NUM_INITIALIZER(struct cmd_send_hello_result, addr, UINT64); + +const parse_token_num_t PROGMEM cmd_send_hello_period = + TOKEN_NUM_INITIALIZER(struct cmd_send_hello_result, period, UINT16); + +const parse_token_num_t PROGMEM cmd_send_hello_count = + TOKEN_NUM_INITIALIZER(struct cmd_send_hello_result, count, UINT16); + +const parse_token_string_t PROGMEM cmd_send_hello_data = + TOKEN_STRING_INITIALIZER(struct cmd_send_hello_result, data, NULL); + +const char PROGMEM help_send_hello[] = + "Send hello msg to a node: addr, period_ms, count, str"; + +const parse_inst_t PROGMEM cmd_send_hello = { + .f = cmd_send_hello_parsed, /* function to call */ + .data = NULL, /* 2nd arg of func */ + .help_str = help_send_hello, + .tokens = { /* token list, NULL terminated */ + (PGM_P)&cmd_send_hello_send_hello, + (PGM_P)&cmd_send_hello_addr, + (PGM_P)&cmd_send_hello_period, + (PGM_P)&cmd_send_hello_count, + (PGM_P)&cmd_send_hello_data, + NULL, + }, +}; + +const parse_token_neighbor_t PROGMEM cmd_send_hello_neigh = + TOKEN_NEIGHBOR_INITIALIZER(struct cmd_send_hello_result, neigh, + &xbee_dev); + +const parse_inst_t PROGMEM cmd_send_hello_name = { + .f = cmd_send_hello_parsed, /* function to call */ + .data = (void *)1, /* 2nd arg of func */ + .help_str = help_send_hello, + .tokens = { /* token list, NULL terminated */ + (PGM_P)&cmd_send_hello_send_hello, + (PGM_P)&cmd_send_hello_neigh, + (PGM_P)&cmd_send_hello_period, + (PGM_P)&cmd_send_hello_count, + (PGM_P)&cmd_send_hello_data, + NULL, + }, +}; + +/* ************* */ + /* this structure is filled when cmd_sendmsg_name is parsed successfully */ struct cmd_sendmsg_name_result { fixed_string_t sendmsg_name; @@ -645,9 +740,9 @@ static void cmd_range_parsed(void *parsed_result, void *data) return; } range_cur_count = range_count; - callout_init(&range_event); - callout_reset(&cm, &range_event, 0, - SINGLE, range_cb, NULL); + callout_init(&range_event, range_cb, NULL, 0); + callout_schedule(&xbeeboard.mainloop_cm, + &range_event, 0); /* immediate */ range_running = 1; } else if (!strcmp(res->action, "end")) { @@ -656,7 +751,7 @@ static void cmd_range_parsed(void *parsed_result, void *data) return; } range_running = 0; - callout_stop(&cm, &range_event); + callout_stop(&xbeeboard.mainloop_cm, &range_event); } } @@ -895,8 +990,9 @@ static void cmd_monitor_parsed(void *parsed_result, void *data) printf_P(PSTR("no regs to be monitored\r\n")); return; } - callout_init(&monitor_event); - callout_reset(&cm, &monitor_event, 0, SINGLE, monitor_cb, NULL); + callout_init(&monitor_event, monitor_cb, NULL, 0); + callout_schedule(&xbeeboard.mainloop_cm, + &monitor_event, 0); /* immediate */ monitor_running = 1; monitor_current = LIST_FIRST(&xbee_monitor_list); printf_P(PSTR("monitor cb: %S %s\r\n"), @@ -910,7 +1006,7 @@ static void cmd_monitor_parsed(void *parsed_result, void *data) return; } monitor_running = 0; - callout_stop(&cm, &monitor_event); + callout_stop(&xbeeboard.mainloop_cm, &monitor_event); } } @@ -1073,7 +1169,7 @@ static void cmd_monitor_del_parsed(void *parsed_result, void *data) monitor_count --; if (monitor_count == 0) { printf_P(PSTR("Disable monitoring, no more event\r\n")); - callout_stop(&cm, &monitor_event); + callout_stop(&xbeeboard.mainloop_cm, &monitor_event); monitor_running = 0; return; } @@ -1798,7 +1894,7 @@ const parse_ctx_t PROGMEM main_ctx[] = { &cmd_log_show, &cmd_log_type, &cmd_stack_space, - &cmd_scheduler, + &cmd_callout, &cmd_help, &cmd_neigh_del, &cmd_neigh_add, @@ -1809,6 +1905,8 @@ const parse_ctx_t PROGMEM main_ctx[] = { &cmd_write_u16, &cmd_write_u32, &cmd_sendmsg, + &cmd_send_hello, + &cmd_send_hello_name, &cmd_sendmsg_name, &cmd_range, &cmd_range_period,