X-Git-Url: https://git.gag.com/?a=blobdiff_plain;f=src%2Fkernel%2Fao_cmd.c;h=881f3500ab7efd4c4d5dd992eef09269a3c0d11b;hb=f753ad3b9d0f3dc9794e5dd097063aab6cf9bdc4;hp=5d8683e132da42ab3a3a3c35419bc456e1604106;hpb=75df97b5f6ade3310618a477b685d39b7fd4666e;p=fw%2Faltos

diff --git a/src/kernel/ao_cmd.c b/src/kernel/ao_cmd.c
index 5d8683e1..881f3500 100644
--- a/src/kernel/ao_cmd.c
+++ b/src/kernel/ao_cmd.c
@@ -3,7 +3,8 @@
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License as published by
- * the Free Software Foundation; version 2 of the License.
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
  *
  * This program is distributed in the hope that it will be useful, but
  * WITHOUT ANY WARRANTY; without even the implied warranty of
@@ -23,13 +24,15 @@ __pdata uint32_t ao_cmd_lex_u32;
 __pdata char	ao_cmd_lex_c;
 __pdata enum ao_cmd_status ao_cmd_status;
 
+#ifndef AO_CMD_LEN
 #if AO_PYRO_NUM
-#define CMD_LEN 128
+#define AO_CMD_LEN 128
 #else
-#define CMD_LEN	48
+#define AO_CMD_LEN	48
+#endif
 #endif
 
-static __xdata char	cmd_line[CMD_LEN];
+static __xdata char	cmd_line[AO_CMD_LEN];
 static __pdata uint8_t	cmd_len;
 static __pdata uint8_t	cmd_i;
 
@@ -47,8 +50,8 @@ backspace(void)
 	ao_put_string ("\010 \010");
 }
 
-static void
-readline(void)
+void
+ao_cmd_readline(void)
 {
 	char c;
 	if (ao_echo())
@@ -87,7 +90,7 @@ readline(void)
 			break;
 		}
 
-		if (cmd_len >= CMD_LEN - 2)
+		if (cmd_len >= AO_CMD_LEN - 2)
 			continue;
 		cmd_line[cmd_len++] = c;
 		if (ao_echo())
@@ -98,12 +101,13 @@ readline(void)
 	cmd_i = 0;
 }
 
-void
+char
 ao_cmd_lex(void)
 {
 	ao_cmd_lex_c = '\n';
 	if (cmd_i < cmd_len)
 		ao_cmd_lex_c = cmd_line[cmd_i++];
+	return ao_cmd_lex_c;
 }
 
 static void
@@ -278,7 +282,7 @@ version(void)
 	printf("manufacturer     %s\n"
 	       "product          %s\n"
 	       "serial-number    %u\n"
-#if HAS_FLIGHT
+#if HAS_FLIGHT || HAS_TRACKER
 	       "current-flight   %u\n"
 #endif
 #if HAS_LOG
@@ -289,11 +293,14 @@ version(void)
 #endif
 #if defined(AO_BOOT_APPLICATION_BASE) && defined(AO_BOOT_APPLICATION_BOUND)
 	       "program-space    %u\n"
+#endif
+#if AO_VALUE_32
+	       "altitude-32      1\n"
 #endif
 	       , ao_manufacturer
 	       , ao_product
 	       , ao_serial_number
-#if HAS_FLIGHT
+#if HAS_FLIGHT || HAS_TRACKER
 	       , ao_flight_number
 #endif
 #if HAS_LOG
@@ -303,7 +310,7 @@ version(void)
 #endif
 #endif
 #if defined(AO_BOOT_APPLICATION_BASE) && defined(AO_BOOT_APPLICATION_BOUND)
-	       , (uint32_t) AO_BOOT_APPLICATION_BOUND - (uint32_t) AO_BOOT_APPLICATION_BASE
+	       , (unsigned) ((uint32_t) AO_BOOT_APPLICATION_BOUND - (uint32_t) AO_BOOT_APPLICATION_BASE)
 #endif
 		);
 	printf("software-version %s\n", ao_version);
@@ -372,7 +379,7 @@ ao_cmd(void)
 	void (*__xdata func)(void);
 
 	for (;;) {
-		readline();
+		ao_cmd_readline();
 		ao_cmd_lex();
 		ao_cmd_white();
 		c = ao_cmd_lex_c;
@@ -390,11 +397,17 @@ ao_cmd(void)
 			if (func)
 				break;
 		}
+#if HAS_MONITOR
+		ao_mutex_get(&ao_monitoring_mutex);
+#endif
 		if (func)
 			(*func)();
 		else
 			ao_cmd_status = ao_cmd_syntax_error;
 		report();
+#if HAS_MONITOR
+		ao_mutex_put(&ao_monitoring_mutex);
+#endif
 	}
 }