add i2c support

[protos/xbee-avr.git] / commands.c

diff --git a/commands.c b/commands.c
index dc88a06..befd1c9 100644 (file)
--- a/commands.c
+++ b/commands.c
@@ -48,6 +48,7 @@
 #include "main.h"
 #include "cmdline.h"
 #include "beep.h"
+#include "i2c_protocol.h"
 #include "eeprom_config.h"
 
 /* commands_gen.c */
@@ -1742,6 +1743,12 @@ static void cmd_rc_proto_mode_parsed(void *parsed_result, void *data)
                else
                        flags &= ~RC_PROTO_FLAGS_TX_POW_PROBE;
        }
+       else if (!strcmp_P(res->cmd, PSTR("compute_best_pow"))) {
+               if (on == 1)
+                       flags |= RC_PROTO_FLAGS_COMPUTE_BEST_POW;
+               else
+                       flags &= ~RC_PROTO_FLAGS_COMPUTE_BEST_POW;
+       }
        else if (!strcmp_P(res->cmd, PSTR("tx"))) {
                flags &= ~RC_PROTO_FLAGS_TX_MASK;
                if (!strcmp_P(res->val, PSTR("bypass")))
@@ -1766,6 +1773,8 @@ static void cmd_rc_proto_mode_parsed(void *parsed_result, void *data)
                (flags & RC_PROTO_FLAGS_TX_STATS) ? "on" : "off");
        printf_P(PSTR("rc_proto_mode tx_power_probe %s\n"),
                (flags & RC_PROTO_FLAGS_TX_POW_PROBE) ? "on" : "off");
+       printf_P(PSTR("rc_proto_mode compute_best_pow %s\n"),
+               (flags & RC_PROTO_FLAGS_COMPUTE_BEST_POW) ? "on" : "off");
 }
 
 const char PROGMEM str_rc_proto_mode_arg0[] = "rc_proto_mode";
@@ -1774,7 +1783,7 @@ const parse_token_string_t PROGMEM cmd_rc_proto_mode_arg0 =
                                 str_rc_proto_mode_arg0);
 
 const char PROGMEM str_rc_proto_mode_cmd[] =
-       "rx_copy_spi#rx_autobypass#tx_stats#tx_power_probe";
+       "rx_copy_spi#rx_autobypass#tx_stats#tx_power_probe#compute_best_pow";
 const parse_token_string_t PROGMEM cmd_rc_proto_mode_cmd =
        TOKEN_STRING_INITIALIZER(struct cmd_rc_proto_mode_result, cmd,
                str_rc_proto_mode_cmd);
@@ -2236,6 +2245,38 @@ const parse_inst_t PROGMEM cmd_eeprom_list = {
 };
 
 
+/* ************* */
+
+struct cmd_test_result {
+       fixed_string_t cmd;
+};
+
+extern uint8_t imuboard; /* XXX test */
+static void cmd_test_parsed(void *parsed_result, void *data)
+{
+       (void)parsed_result;
+       (void)data;
+       printf("%d\n", imuboard);
+       i2c_protocol_debug();
+}
+
+const char PROGMEM str_test[] = "test";
+const parse_token_string_t PROGMEM cmd_test_cmd =
+       TOKEN_STRING_INITIALIZER(struct cmd_test_result, cmd,
+                                str_test);
+
+const char PROGMEM help_test[] = "test";
+const parse_inst_t PROGMEM cmd_test = {
+       .f = cmd_test_parsed,  /* function to call */
+       .data = NULL,      /* 2nd arg of func */
+       .help_str = help_test,
+       .tokens = {        /* token list, NULL terminated */
+               (PGM_P)&cmd_test_cmd,
+               NULL,
+       },
+};
+
+
 /* ************* */
 
 /* in progmem */
@@ -2293,5 +2334,6 @@ const parse_ctx_t PROGMEM main_ctx[] = {
        &cmd_eeprom_add,
        &cmd_eeprom_add2,
        &cmd_eeprom_list,
+       &cmd_test,
        NULL,
 };