altos: Share getnibble function

[fw/altos] / src / core / ao_cmd.c

diff --git a/src/core/ao_cmd.c b/src/core/ao_cmd.c
index 05dbfb51f04a57d6281de37ee92d19c8928d1d4e..a33309745430d51d8dd3137df057ec1e7752cf1b 100644 (file)
--- a/src/core/ao_cmd.c
+++ b/src/core/ao_cmd.c
@@ -110,6 +110,22 @@ putnibble(uint8_t v)
                putchar(v + ('a' - 10));
 }
 
+uint8_t
+ao_getnibble(void)
+{
+       char    c;
+
+       c = getchar();
+       if ('0' <= c && c <= '9')
+               return c - '0';
+       if ('a' <= c && c <= 'f')
+               return c - ('a' - 10);
+       if ('A' <= c && c <= 'F')
+               return c - ('A' - 10);
+       ao_cmd_status = ao_cmd_lex_error;
+       return 0;
+}
+
 void
 ao_cmd_put16(uint16_t v)
 {
@@ -278,8 +294,10 @@ help(void)
 
        for (cmds = 0; cmds < ao_ncmds; cmds++) {
                cs = ao_cmds[cmds];
-               for (cmd = 0; (h = cs[cmd].help); cmd++)
+               for (cmd = 0; cs[cmd].func; cmd++) {
+                       h = cs[cmd].help;
                        printf("%-45s %s\n", h, h + 1 + strlen(h));
+               }
        }
 }