altos: Add actual flashing functions to stm-flash app

[fw/altos] / src / stm-flash / ao_stm_flash.c

diff --git a/src/stm-flash/ao_stm_flash.c b/src/stm-flash/ao_stm_flash.c
index df466d8553de86eb9c0d342071f85801732c42c5..4a91ef1fa4a5e1d234b003ae464e85b8305f1cb8 100644 (file)
--- a/src/stm-flash/ao_stm_flash.c
+++ b/src/stm-flash/ao_stm_flash.c
@@ -53,15 +53,6 @@ ao_cmd_hex32(void)
        return v;
 }
 
-void
-ao_block_erase(void)
-{
-       uint32_t        addr = ao_cmd_hex32();
-       uint32_t        *p = (uint32_t *) addr;
-
-       ao_flash_erase_page(p);
-}
-
 void
 ao_block_write(void)
 {
@@ -73,51 +64,30 @@ ao_block_write(void)
        } u;
        uint16_t        i;
 
-       if (addr < 0x08002000 || 0x08200000 <= addr) {
-               puts("Invalid address");
-               return;
-       }
        for (i = 0; i < 256; i++)
-               u.data8[i] = i;
+               u.data8[i] = getchar();
        ao_flash_page(p, u.data32);
 }
 
-static void
-puthex(uint8_t c)
-{
-       c &= 0xf;
-       if (c < 10)
-               c += '0';
-       else
-               c += 'a' - 10;
-       putchar (c);
-}
-
 void
 ao_block_read(void)
 {
        uint32_t        addr = ao_cmd_hex32();
        uint8_t         *p = (uint8_t *) addr;
        uint16_t        i;
-       uint8_t         c;
 
-       for (i = 0; i < 256; i++) {
-               c = *p++;
-               puthex(c);
-               puthex(c>>4);
-               if ((i & 0xf) == 0xf)
-                       putchar('\n');
-       }
+       for (i = 0; i < 256; i++)
+               putchar(*p++);
 }
 
 __code struct ao_cmds ao_flash_cmds[] = {
-       { ao_application, "a\0Switch to application" },
-       { ao_block_erase, "e <addr>\0Erase block." },
+       { ao_application, "A\0Switch to application" },
        { ao_block_write, "W <addr>\0Write block. 256 binary bytes follow newline" },
        { ao_block_read, "R <addr>\0Read block. Returns 256 bytes" },
        { 0, NULL },
 };
 
+
 int
 main(void)
 {