#error Please define USE_INTERNAL_FLASH
#endif
#endif
+#ifndef AO_CONFIG_DEFAULT_FLIGHT_LOG_MAX
#if USE_INTERNAL_FLASH
#define AO_CONFIG_DEFAULT_FLIGHT_LOG_MAX ao_storage_config
#else
#define AO_CONFIG_DEFAULT_FLIGHT_LOG_MAX ((uint32_t) 192 * (uint32_t) 1024)
#endif
+#endif
#if HAS_EEPROM
static void
}
#endif
+static void
+ao_config_set_radio(void)
+{
+ ao_config.radio_setting = ao_freq_to_set(ao_config.frequency, ao_config.radio_cal);
+}
+
static void
_ao_config_get(void)
{
if (ao_config.major != AO_CONFIG_MAJOR) {
ao_config.major = AO_CONFIG_MAJOR;
ao_config.minor = 0;
+
+ /* Version 0 stuff */
ao_config.main_deploy = AO_CONFIG_DEFAULT_MAIN_DEPLOY;
ao_config.radio_channel = AO_CONFIG_DEFAULT_RADIO_CHANNEL;
- memset(&ao_config.callsign, '\0', sizeof (ao_config.callsign));
- memcpy(&ao_config.callsign, AO_CONFIG_DEFAULT_CALLSIGN,
+ ao_xmemset(&ao_config.callsign, '\0', sizeof (ao_config.callsign));
+ ao_xmemcpy(&ao_config.callsign, CODE_TO_XDATA(AO_CONFIG_DEFAULT_CALLSIGN),
sizeof(AO_CONFIG_DEFAULT_CALLSIGN) - 1);
+ ao_config_dirty = 1;
}
if (ao_config.minor < AO_CONFIG_MINOR) {
/* Fixups for minor version 1 */
ao_config.ignite_mode = AO_CONFIG_DEFAULT_IGNITE_MODE;
if (ao_config.minor < 6)
ao_config.pad_orientation = AO_CONFIG_DEFAULT_PAD_ORIENTATION;
- if (ao_config.minor < 7)
- ao_config.radio_setting = ao_config.radio_cal;
if (ao_config.minor < 8)
ao_config.radio_enable = TRUE;
+ if (ao_config.minor < 9)
+ memset(&ao_config.aes_key, 0, AO_AES_LEN);
+ if (ao_config.minor < 10) {
+ ao_config.frequency = 434550;
+#if HAS_RADIO_CHANNELS
+ ao_xmemset(&ao_config.radio_channels, '\0', sizeof (ao_config.radio_channels));
+ ao_xmemcpy(&ao_config.radio_channels[0].name[0],
+ CODE_TO_XDATA("Channel 0"), sizeof("Channel 0"));
+ ao_config.radio_channels[0].kHz = 434550;
+#endif
+ }
ao_config.minor = AO_CONFIG_MINOR;
ao_config_dirty = 1;
}
+ ao_config_set_radio();
ao_config_loaded = 1;
}
uint8_t c;
static __xdata char callsign[AO_MAX_CALLSIGN + 1];
- memset(callsign, '\0', sizeof callsign);
+ ao_xmemset(callsign, '\0', sizeof callsign);
ao_cmd_white();
c = 0;
while (ao_cmd_lex_c != '\n') {
if (ao_cmd_status != ao_cmd_success)
return;
_ao_config_edit_start();
- memcpy(&ao_config.callsign, &callsign,
+ ao_xmemcpy(&ao_config.callsign, &callsign,
AO_MAX_CALLSIGN + 1);
_ao_config_edit_finish();
}
ao_radio_recv_abort();
}
+void
+ao_config_frequency_show(void) __reentrant
+{
+ printf("Frequency: %ld\n",
+ ao_config.frequency);
+}
+
+void
+ao_config_frequency_set(void) __reentrant
+{
+ ao_cmd_decimal();
+ if (ao_cmd_status != ao_cmd_success)
+ return;
+ _ao_config_edit_start();
+ ao_config.frequency = ao_cmd_lex_u32;
+ ao_config_set_radio();
+ _ao_config_edit_finish();
+ ao_radio_recv_abort();
+}
+
#if HAS_ADC
void
if (ao_cmd_status != ao_cmd_success)
return;
_ao_config_edit_start();
- ao_config.radio_setting = ao_config.radio_cal = ao_cmd_lex_u32;
+ ao_config.radio_cal = ao_cmd_lex_u32;
+ ao_config_set_radio();
_ao_config_edit_finish();
}
-#if HAS_EEPROM && HAS_FLIGHT
+#if HAS_LOG
void
ao_config_log_show(void) __reentrant
{
_ao_config_edit_finish();
}
}
-#endif /* HAS_EEPROM && HAS_FLIGHT */
+#endif /* HAS_LOG */
#if HAS_IGNITE
void
#endif
void
-ao_config_radio_setting_show(void) __reentrant
+ao_config_radio_enable_show(void) __reentrant
{
- printf("Radio setting: %ld\n", ao_config.radio_setting);
+ printf("Radio enable: %d\n", ao_config.radio_enable);
}
void
-ao_config_radio_setting_set(void) __reentrant
+ao_config_radio_enable_set(void) __reentrant
{
ao_cmd_decimal();
if (ao_cmd_status != ao_cmd_success)
return;
_ao_config_edit_start();
- ao_config.radio_setting = ao_cmd_lex_u32;
- ao_config.radio_channel = 0;
+ ao_config.radio_enable = ao_cmd_lex_i;
_ao_config_edit_finish();
- ao_radio_recv_abort();
+}
+
+#if HAS_AES
+void
+ao_config_key_show(void) __reentrant
+{
+ uint8_t i;
+ printf("AES key: ");
+ for (i = 0; i < AO_AES_LEN; i++)
+ printf ("%02x", ao_config.aes_key[i]);
+ printf("\n");
}
void
-ao_config_radio_enable_show(void) __reentrant
+ao_config_key_set(void) __reentrant
{
- printf("Radio enable: %d\n", ao_config.radio_enable);
+ uint8_t i;
+
+ _ao_config_edit_start();
+ for (i = 0; i < AO_AES_LEN; i++) {
+ ao_cmd_hexbyte();
+ if (ao_cmd_status != ao_cmd_success)
+ break;
+ ao_config.aes_key[i] = ao_cmd_lex_i;
+ }
+ _ao_config_edit_finish();
}
+#endif
+#if HAS_RADIO_CHANNELS
void
-ao_config_radio_enable_set(void) __reentrant
+ao_config_radio_config_show(void) __reentrant
+{
+ uint8_t i;
+ for (i = 0; i < AO_NUM_CHANNELS; i++)
+ if (ao_config.radio_channels[i].name[0]) {
+ printf("%2d %-16.16s %ld\n",
+ i,
+ ao_config.radio_channels[i].name,
+ ao_config.radio_channels[i].kHz);
+ }
+}
+
+void
+ao_config_radio_config_set(void) __reentrant
{
+ __xdata struct ao_radio_channel * ch;
+ uint8_t i;
ao_cmd_decimal();
if (ao_cmd_status != ao_cmd_success)
return;
+ if ((uint8_t) ao_cmd_lex_i >= AO_NUM_CHANNELS) {
+ ao_cmd_status = ao_cmd_syntax_error;
+ return;
+ }
+ ch = &ao_config.radio_channels[(uint8_t) ao_cmd_lex_i];
_ao_config_edit_start();
- ao_config.radio_enable = ao_cmd_lex_i;
+ ao_cmd_white();
+ i = 0;
+ while (ao_cmd_lex_c != '/' && ao_cmd_lex_c != '\n' && i < AO_CHANNEL_NAME_LEN) {
+ ch->name[i++] = ao_cmd_lex_c;
+ ao_cmd_lex();
+ }
+ if (i < AO_CHANNEL_NAME_LEN) {
+ ch->name[i] = '\0';
+ ao_cmd_lex();
+ }
+ ao_cmd_decimal();
+ ch->kHz = ao_cmd_lex_u32;
_ao_config_edit_finish();
}
-
+#endif
+
struct ao_config_var {
__code char *str;
void (*set)(void) __reentrant;
#endif /* HAS_ADC */
{ "r <channel>\0Radio channel (freq = 434.550 + chan * .1)",
ao_config_radio_channel_set, ao_config_radio_channel_show },
+ { "F <freq>\0Frequency (kHz)",
+ ao_config_frequency_set, ao_config_frequency_show },
{ "c <call>\0Callsign (8 char max)",
ao_config_callsign_set, ao_config_callsign_show },
- { "R <setting>\0Radio freq control (freq = 434.550 * setting/cal)",
- ao_config_radio_setting_set, ao_config_radio_setting_show },
{ "e <0 disable, 1 enable>\0Enable telemetry and RDF",
ao_config_radio_enable_set, ao_config_radio_enable_show },
#if HAS_ACCEL
#endif /* HAS_ACCEL */
{ "f <cal>\0Radio calib (cal = rf/(xtal/2^16))",
ao_config_radio_cal_set, ao_config_radio_cal_show },
-#if HAS_EEPROM && HAS_FLIGHT
+#if HAS_LOG
{ "l <size>\0Flight log size in kB",
ao_config_log_set, ao_config_log_show },
#endif
#if HAS_ACCEL
{ "o <0 antenna up, 1 antenna down>\0Set pad orientation",
ao_config_pad_orientation_set,ao_config_pad_orientation_show },
+#endif
+#if HAS_AES
+ { "k <32 hex digits>\0Set AES encryption key",
+ ao_config_key_set, ao_config_key_show },
+#endif
+#if HAS_RADIO_CHANNELS
+ { "C <n> <name>/<freq> <radio>\0Set radio chan config",
+ ao_config_radio_config_set,ao_config_radio_config_show },
#endif
{ "s\0Show",
ao_config_show, 0 },
for (cmd = 0; ao_config_vars[cmd].str != NULL; cmd++)
printf("%-20s %s\n",
ao_config_vars[cmd].str,
- ao_config_vars[cmd].str+1+strlen(ao_config_vars[cmd].str));
+ ao_config_vars[cmd].str+1+
+ strlen(ao_config_vars[cmd].str));
}
static void
projects / fw / altos / blobdiff