projects
/
fw
/
altos
/ blobdiff
commit
grep
author
committer
pickaxe
?
search:
re
summary
|
shortlog
|
log
|
commit
|
commitdiff
|
tree
raw
|
inline
| side by side
altos/stm32f4: Align stack to 8 bytes
[fw/altos]
/
src
/
kernel
/
ao_cmd.c
diff --git
a/src/kernel/ao_cmd.c
b/src/kernel/ao_cmd.c
index 605a2f205e58c69411b931cd2f273ac5197cdedd..d1c049ac78aaf5b03905dc13542905f74cb01d71 100644
(file)
--- a/
src/kernel/ao_cmd.c
+++ b/
src/kernel/ao_cmd.c
@@
-19,41
+19,37
@@
#include "ao.h"
#include "ao_task.h"
#include "ao.h"
#include "ao_task.h"
-__pdata uint16_t ao_cmd_lex_i;
-__pdata uint32_t ao_cmd_lex_u32;
-__pdata char ao_cmd_lex_c;
-__pdata enum ao_cmd_status ao_cmd_status;
+char ao_cmd_lex_c;
+enum ao_cmd_status ao_cmd_status;
+#ifndef AO_CMD_LEN
#if AO_PYRO_NUM
#if AO_PYRO_NUM
-#define CMD_LEN 128
+#define
AO_
CMD_LEN 128
#else
#else
-#define
CMD_LEN
48
+#define
AO_CMD_LEN
48
#endif
#endif
+#endif
+
+static char cmd_line[AO_CMD_LEN];
+static uint8_t cmd_len;
+static uint8_t cmd_i;
-static __xdata char cmd_line[CMD_LEN];
-static __pdata uint8_t cmd_len;
-static __pdata uint8_t cmd_i;
+static const char backspace[] = "\010 \010";
void
void
-ao_put_string(
__code
char *s)
+ao_put_string(
const
char *s)
{
char c;
while ((c = *s++))
putchar(c);
}
{
char c;
while ((c = *s++))
putchar(c);
}
-static void
-backspace(void)
-{
- ao_put_string ("\010 \010");
-}
-
-static void
-readline(void)
+void
+ao_cmd_readline(const char *prompt)
{
char c;
if (ao_echo())
{
char c;
if (ao_echo())
- ao_put_string(
"> "
);
+ ao_put_string(
prompt
);
cmd_len = 0;
for (;;) {
flush();
cmd_len = 0;
for (;;) {
flush();
@@
-62,7
+58,7
@@
readline(void)
if (c == '\010' || c == '\177') {
if (cmd_len != 0) {
if (ao_echo())
if (c == '\010' || c == '\177') {
if (cmd_len != 0) {
if (ao_echo())
-
backspace(
);
+
ao_put_string(backspace
);
--cmd_len;
}
continue;
--cmd_len;
}
continue;
@@
-72,7
+68,7
@@
readline(void)
if (c == '\025') {
while (cmd_len != 0) {
if (ao_echo())
if (c == '\025') {
while (cmd_len != 0) {
if (ao_echo())
-
backspace(
);
+
ao_put_string(backspace
);
--cmd_len;
}
continue;
--cmd_len;
}
continue;
@@
-88,7
+84,7
@@
readline(void)
break;
}
break;
}
- if (cmd_len >= CMD_LEN - 2)
+ if (cmd_len >=
AO_
CMD_LEN - 2)
continue;
cmd_line[cmd_len++] = c;
if (ao_echo())
continue;
cmd_line[cmd_len++] = c;
if (ao_echo())
@@
-99,12
+95,13
@@
readline(void)
cmd_i = 0;
}
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++];
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
}
static void
@@
-171,55
+168,48
@@
ao_cmd_hexchar(char c)
return -1;
}
return -1;
}
-void
-
ao_cmd_hexbyte(void
)
+static uint32_t
+
get_hex(uint8_t lim
)
{
{
+ uint32_t result = 0;
uint8_t i;
uint8_t i;
- int8_t n;
- ao_cmd_lex_i = 0;
ao_cmd_white();
ao_cmd_white();
- for (i = 0; i <
2
; i++) {
- n = ao_cmd_hexchar(ao_cmd_lex_c);
+ for (i = 0; i <
lim
; i++) {
+
int8_t
n = ao_cmd_hexchar(ao_cmd_lex_c);
if (n < 0) {
if (n < 0) {
- ao_cmd_status = ao_cmd_syntax_error;
+ if (i == 0 || lim != 0xff)
+ ao_cmd_status = ao_cmd_lex_error;
break;
}
break;
}
-
ao_cmd_lex_i = (ao_cmd_lex_i
<< 4) | n;
+
result = (result
<< 4) | n;
ao_cmd_lex();
}
ao_cmd_lex();
}
+ return result;
}
}
-void
-ao_cmd_hex(void)
+uint8_t
+ao_cmd_hex
byte
(void)
{
{
-
__pdata uint8_t r = ao_cmd_lex_error
;
- int8_t n;
+
return get_hex(2)
;
+}
- ao_cmd_lex_i = 0;
- ao_cmd_white();
- for(;;) {
- n = ao_cmd_hexchar(ao_cmd_lex_c);
- if (n < 0)
- break;
- ao_cmd_lex_i = (ao_cmd_lex_i << 4) | n;
- r = ao_cmd_success;
- ao_cmd_lex();
- }
- if (r != ao_cmd_success)
- ao_cmd_status = r;
+uint32_t
+ao_cmd_hex(void)
+{
+ return get_hex(0xff);
}
}
-void
-ao_cmd_decimal(void)
__reentrant
+uint32_t
+ao_cmd_decimal(void)
{
{
+ uint32_t result = 0;
uint8_t r = ao_cmd_lex_error;
uint8_t r = ao_cmd_lex_error;
- ao_cmd_lex_u32 = 0;
ao_cmd_white();
for(;;) {
if ('0' <= ao_cmd_lex_c && ao_cmd_lex_c <= '9')
ao_cmd_white();
for(;;) {
if ('0' <= ao_cmd_lex_c && ao_cmd_lex_c <= '9')
-
ao_cmd_lex_u32 = (ao_cmd_lex_u32 * 10)
+ (ao_cmd_lex_c - '0');
+
result = result * 10
+ (ao_cmd_lex_c - '0');
else
break;
r = ao_cmd_success;
else
break;
r = ao_cmd_success;
@@
-227,11
+217,11
@@
ao_cmd_decimal(void) __reentrant
}
if (r != ao_cmd_success)
ao_cmd_status = r;
}
if (r != ao_cmd_success)
ao_cmd_status = r;
-
ao_cmd_lex_i = (uint16_t) ao_cmd_lex_u32
;
+
return result
;
}
uint8_t
}
uint8_t
-ao_match_word(
__code
char *word)
+ao_match_word(
const
char *word)
{
while (*word) {
if (ao_cmd_lex_c != *word) {
{
while (*word) {
if (ao_cmd_lex_c != *word) {
@@
-247,9
+237,9
@@
ao_match_word(__code char *word)
static void
echo(void)
{
static void
echo(void)
{
- ao_cmd_hex();
+
uint32_t v =
ao_cmd_hex();
if (ao_cmd_status == ao_cmd_success)
if (ao_cmd_status == ao_cmd_success)
- ao_stdios[ao_cur_stdio].echo =
ao_cmd_lex_i
!= 0;
+ ao_stdios[ao_cur_stdio].echo =
v
!= 0;
}
static void
}
static void
@@
-301,13
+291,13
@@
version(void)
, ao_flight_number
#endif
#if HAS_LOG
, ao_flight_number
#endif
#if HAS_LOG
- ,
ao_log_format
+ ,
AO_LOG_FORMAT
#if !DISABLE_LOG_SPACE
, (unsigned long) ao_storage_log_max
#endif
#endif
#if defined(AO_BOOT_APPLICATION_BASE) && defined(AO_BOOT_APPLICATION_BOUND)
#if !DISABLE_LOG_SPACE
, (unsigned long) ao_storage_log_max
#endif
#endif
#if defined(AO_BOOT_APPLICATION_BASE) && defined(AO_BOOT_APPLICATION_BOUND)
- , (u
int32_t) AO_BOOT_APPLICATION_BOUND - (uint32_t) AO_BOOT_APPLICATION_BASE
+ , (u
nsigned) ((uint32_t) AO_BOOT_APPLICATION_BOUND - (uint32_t) AO_BOOT_APPLICATION_BASE)
#endif
);
printf("software-version %s\n", ao_version);
#endif
);
printf("software-version %s\n", ao_version);
@@
-318,16
+308,16
@@
version(void)
#define NUM_CMDS 11
#endif
#define NUM_CMDS 11
#endif
-static
__code struct ao_cmds *__xdata
(ao_cmds[NUM_CMDS]);
-static
__pdata
uint8_t ao_ncmds;
+static
const struct ao_cmds *
(ao_cmds[NUM_CMDS]);
+static uint8_t ao_ncmds;
static void
help(void)
{
static void
help(void)
{
-
__pdata
uint8_t cmds;
-
__pdata
uint8_t cmd;
-
__code struct ao_cmds * __pdata
cs;
-
__code
const char *h;
+ uint8_t cmds;
+ uint8_t cmd;
+
const struct ao_cmds *
cs;
+ const char *h;
uint8_t e;
for (cmds = 0; cmds < ao_ncmds; cmds++) {
uint8_t e;
for (cmds = 0; cmds < ao_ncmds; cmds++) {
@@
-352,7
+342,7
@@
report(void)
switch(ao_cmd_status) {
case ao_cmd_lex_error:
case ao_cmd_syntax_error:
switch(ao_cmd_status) {
case ao_cmd_lex_error:
case ao_cmd_syntax_error:
-
puts("Syntax error
");
+
ao_put_string("Syntax error\n
");
ao_cmd_status = 0;
default:
break;
ao_cmd_status = 0;
default:
break;
@@
-360,7
+350,7
@@
report(void)
}
void
}
void
-ao_cmd_register(
__code
struct ao_cmds *cmds)
+ao_cmd_register(
const
struct ao_cmds *cmds)
{
if (ao_ncmds >= NUM_CMDS)
ao_panic(AO_PANIC_CMD);
{
if (ao_ncmds >= NUM_CMDS)
ao_panic(AO_PANIC_CMD);
@@
-370,13
+360,13
@@
ao_cmd_register(__code struct ao_cmds *cmds)
void
ao_cmd(void)
{
void
ao_cmd(void)
{
-
__pdata
char c;
+ char c;
uint8_t cmd, cmds;
uint8_t cmd, cmds;
-
__code struct ao_cmds * __xdata
cs;
- void (*
__xdata
func)(void);
+
const struct ao_cmds *
cs;
+ void (*func)(void);
for (;;) {
for (;;) {
-
readline(
);
+
ao_cmd_readline("> "
);
ao_cmd_lex();
ao_cmd_white();
c = ao_cmd_lex_c;
ao_cmd_lex();
ao_cmd_white();
c = ao_cmd_lex_c;
@@
-394,11
+384,17
@@
ao_cmd(void)
if (func)
break;
}
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 (func)
(*func)();
else
ao_cmd_status = ao_cmd_syntax_error;
report();
+#if HAS_MONITOR
+ ao_mutex_put(&ao_monitoring_mutex);
+#endif
}
}
}
}
@@
-414,11
+410,13
@@
ao_loader(void)
}
#endif
}
#endif
-__xdata struct ao_task ao_cmd_task;
+#if HAS_TASK
+struct ao_task ao_cmd_task;
+#endif
-
__code struct ao_cmds
ao_base_cmds[] = {
+
const struct ao_cmds
ao_base_cmds[] = {
{ help, "?\0Help" },
{ help, "?\0Help" },
-#if HAS_TASK_INFO
+#if HAS_TASK_INFO
&& HAS_TASK
{ ao_task_info, "T\0Tasks" },
#endif
{ echo, "E <0 off, 1 on>\0Echo" },
{ ao_task_info, "T\0Tasks" },
#endif
{ echo, "E <0 off, 1 on>\0Echo" },
@@
-436,5
+434,7
@@
void
ao_cmd_init(void)
{
ao_cmd_register(&ao_base_cmds[0]);
ao_cmd_init(void)
{
ao_cmd_register(&ao_base_cmds[0]);
+#if HAS_TASK
ao_add_task(&ao_cmd_task, ao_cmd, "cmd");
ao_add_task(&ao_cmd_task, ao_cmd, "cmd");
+#endif
}
}