X-Git-Url: https://git.gag.com/?a=blobdiff_plain;f=src%2Fao_config.c;h=85fcff8c9262c9a91636109b78bb68c72f4ebe26;hb=036400a2db303f3db3be7cc0426f88359c6bd2b1;hp=657c7a8a17a976ab62ba2ea85e53a406d0535a4d;hpb=17d2432a8b9c15963cd3b821f025ad33972ef477;p=fw%2Faltos

diff --git a/src/ao_config.c b/src/ao_config.c
index 657c7a8a..85fcff8c 100644
--- a/src/ao_config.c
+++ b/src/ao_config.c
@@ -26,6 +26,7 @@ __xdata uint8_t ao_config_mutex;
 #define AO_CONFIG_DEFAULT_RADIO_CHANNEL	0
 #define AO_CONFIG_DEFAULT_CALLSIGN	"KD7SQG"
 #define AO_CONFIG_DEFAULT_ACCEL_ZERO_G	16000
+#define AO_CONFIG_DEFAULT_APOGEE_DELAY	0
 
 static void
 _ao_config_put(void)
@@ -44,13 +45,26 @@ _ao_config_get(void)
 		ao_config.minor = AO_CONFIG_MINOR;
 		ao_config.main_deploy = AO_CONFIG_DEFAULT_MAIN_DEPLOY;
 		ao_config.radio_channel = AO_CONFIG_DEFAULT_RADIO_CHANNEL;
-		ao_config.accel_zero_g = AO_CONFIG_DEFAULT_ACCEL_ZERO_G;
+		ao_config.accel_plus_g = 0;
+		ao_config.accel_minus_g = 0;
 		memset(&ao_config.callsign, '\0', sizeof (ao_config.callsign));
 		memcpy(&ao_config.callsign, AO_CONFIG_DEFAULT_CALLSIGN,
 		       sizeof(AO_CONFIG_DEFAULT_CALLSIGN) - 1);
+		ao_config.apogee_delay = AO_CONFIG_DEFAULT_APOGEE_DELAY;
+		ao_config_dirty = 1;
+	}
+	if (ao_config.minor < AO_CONFIG_MINOR) {
+		/* Fixups for mior version 1 */
+		if (ao_config.minor < 1)
+			ao_config.apogee_delay = AO_CONFIG_DEFAULT_APOGEE_DELAY;
+		/* Fixupes for minor version 2 */
+		if (ao_config.minor < 2) {
+			ao_config.accel_plus_g = 0;
+			ao_config.accel_minus_g = 0;
+		}
+		ao_config.minor = AO_CONFIG_MINOR;
 		ao_config_dirty = 1;
 	}
-	/* deal with minor version issues here, at 0 we haven't any */
 	ao_config_loaded = 1;
 }
 
@@ -124,7 +138,7 @@ ao_config_radio_channel_set(void) __reentrant
 void
 ao_config_main_deploy_show(void) __reentrant
 {
-	printf("Main deploy set to %d meters (%d feet)\n",
+	printf("Main deploy: %d meters (%d feet)\n",
 	       ao_config.main_deploy,
 	       (int16_t) ((int32_t) ao_config.main_deploy * 328 / 100));
 }
@@ -144,23 +158,28 @@ ao_config_main_deploy_set(void) __reentrant
 }
 
 void
-ao_config_accel_zero_g_show(void) __reentrant
+ao_config_accel_calibrate_show(void) __reentrant
 {
-	printf("Accel zero g point set to %d\n",
-	       ao_config.accel_zero_g);
+	printf("Accel cal +1g: %d -1g: %d\n",
+	       ao_config.accel_plus_g, ao_config.accel_minus_g);
 }
 
-#define ZERO_G_SAMPLES	1000
+#define ACCEL_CALIBRATE_SAMPLES	1024
+#define ACCEL_CALIBRATE_SHIFT	10
 
 static int16_t
-ao_config_accel_zero_g_auto(void) __reentrant
+ao_config_accel_calibrate_auto(char *orientation) __reentrant
 {
 	uint16_t	i;
 	int32_t		accel_total;
 	uint8_t		cal_adc_ring;
 
-	puts("Calibrating accelerometer..."); flush();
-	i = ZERO_G_SAMPLES;
+	printf("Orient %s and press a key...", orientation);
+	flush();
+	(void) getchar();
+	puts("\r\n"); flush();
+	puts("Calibrating..."); flush();
+	i = ACCEL_CALIBRATE_SAMPLES;
 	accel_total = 0;
 	cal_adc_ring = ao_adc_head;
 	while (i) {
@@ -171,22 +190,59 @@ ao_config_accel_zero_g_auto(void) __reentrant
 			i--;
 		}
 	}
-	return (int16_t) (accel_total / ZERO_G_SAMPLES);
+	return accel_total >> ACCEL_CALIBRATE_SHIFT;
 }
+
+void
+ao_config_accel_calibrate_set(void) __reentrant
+{
+	int16_t	up, down;
+	ao_cmd_decimal();
+	if (ao_cmd_status != ao_cmd_success)
+		return;
+	if (ao_cmd_lex_i == 0) {
+		up = ao_config_accel_calibrate_auto("antenna up");
+		down = ao_config_accel_calibrate_auto("antenna down");
+	} else {
+		up = ao_cmd_lex_i;
+		ao_cmd_decimal();
+		if (ao_cmd_status != ao_cmd_success)
+			return;
+		down = ao_cmd_lex_i;
+	}
+	if (up >= down) {
+		printf("Invalid accel calibration: antenna up (%d) should be less than antenna down (%d)\n",
+		       up, down);
+		return;
+	}
+	ao_mutex_get(&ao_config_mutex);
+	_ao_config_get();
+	ao_config.accel_plus_g = up;
+	ao_config.accel_minus_g = down;
+	ao_config_dirty = 1;
+	ao_mutex_put(&ao_config_mutex);
+	ao_config_accel_calibrate_show();
+}
+
+void
+ao_config_apogee_delay_show(void) __reentrant
+{
+	printf("Apogee delay: %d seconds\n",
+	       ao_config.apogee_delay);
+}
+
 void
-ao_config_accel_zero_g_set(void) __reentrant
+ao_config_apogee_delay_set(void) __reentrant
 {
 	ao_cmd_decimal();
 	if (ao_cmd_status != ao_cmd_success)
 		return;
-	if (ao_cmd_lex_i == 0)
-		ao_cmd_lex_i = ao_config_accel_zero_g_auto();
 	ao_mutex_get(&ao_config_mutex);
 	_ao_config_get();
-	ao_config.accel_zero_g = ao_cmd_lex_i;
+	ao_config.apogee_delay = ao_cmd_lex_i;
 	ao_config_dirty = 1;
 	ao_mutex_put(&ao_config_mutex);
-	ao_config_accel_zero_g_show();
+	ao_config_apogee_delay_show();
 }
 
 struct ao_config_var {
@@ -208,12 +264,14 @@ ao_config_write(void) __reentrant;
 __code struct ao_config_var ao_config_vars[] = {
 	{ 'm',	ao_config_main_deploy_set,	ao_config_main_deploy_show,
 		"m <meters>  Set height above launch for main deploy (in meters)" },
-	{ 'a',	ao_config_accel_zero_g_set,	ao_config_accel_zero_g_show,
-		"a <value>   Set accelerometer zero g point (0 for auto)" },
+	{ 'a',	ao_config_accel_calibrate_set,	ao_config_accel_calibrate_show,
+		"a <+g> <-g> Set accelerometer calibration (0 for auto)" },
 	{ 'r',	ao_config_radio_channel_set,	ao_config_radio_channel_show,
 		"r <channel> Set radio channel (freq = 434.550 + channel * .1)" },
 	{ 'c',	ao_config_callsign_set,		ao_config_callsign_show,
 		"c <call>    Set callsign broadcast in each packet (8 char max)" },
+	{ 'd',	ao_config_apogee_delay_set,	ao_config_apogee_delay_show,
+	        "d <delay>   Set apogee igniter delay (in seconds)" },
 	{ 's',	ao_config_show,			ao_config_show,
 		"s           Show current config values" },
 	{ 'w',	ao_config_write,		ao_config_write,
@@ -258,6 +316,8 @@ void
 ao_config_show(void) __reentrant
 {
 	uint8_t cmd;
+	printf("Config version: %d.%d\n",
+	       ao_config.major, ao_config.minor);
 	for (cmd = 0; ao_config_vars[cmd].cmd != '\0'; cmd++)
 		if (ao_config_vars[cmd].show != ao_config_vars[cmd].set)
 			(*ao_config_vars[cmd].show)();