From 4bc55ee8fabc9f4c997c2a515d74baada590c93e Mon Sep 17 00:00:00 2001 From: Keith Packard Date: Mon, 11 Mar 2013 18:14:28 -0700 Subject: [PATCH] altos: Add actual flashing functions to stm-flash app Signed-off-by: Keith Packard --- src/stm-flash/ao_stm_flash.c | 50 ++++++++++++++++++++++++++++++++++++ 1 file changed, 50 insertions(+) diff --git a/src/stm-flash/ao_stm_flash.c b/src/stm-flash/ao_stm_flash.c index 2988a937..4a91ef1f 100644 --- a/src/stm-flash/ao_stm_flash.c +++ b/src/stm-flash/ao_stm_flash.c @@ -32,8 +32,58 @@ ao_application(void) ao_boot_reboot(AO_BOOT_APPLICATION_BASE); } +static uint32_t +ao_cmd_hex32(void) +{ + __pdata uint8_t r = ao_cmd_lex_error; + int8_t n; + uint32_t v = 0; + + ao_cmd_white(); + for(;;) { + n = ao_cmd_hexchar(ao_cmd_lex_c); + if (n < 0) + break; + v = (v << 4) | n; + r = ao_cmd_success; + ao_cmd_lex(); + } + if (r != ao_cmd_success) + ao_cmd_status = r; + return v; +} + +void +ao_block_write(void) +{ + uint32_t addr = ao_cmd_hex32(); + uint32_t *p = (uint32_t *) addr; + union { + uint8_t data8[256]; + uint32_t data32[64]; + } u; + uint16_t i; + + for (i = 0; i < 256; i++) + u.data8[i] = getchar(); + ao_flash_page(p, u.data32); +} + +void +ao_block_read(void) +{ + uint32_t addr = ao_cmd_hex32(); + uint8_t *p = (uint8_t *) addr; + uint16_t i; + + for (i = 0; i < 256; i++) + putchar(*p++); +} + __code struct ao_cmds ao_flash_cmds[] = { { ao_application, "A\0Switch to application" }, + { ao_block_write, "W \0Write block. 256 binary bytes follow newline" }, + { ao_block_read, "R \0Read block. Returns 256 bytes" }, { 0, NULL }, }; -- 2.30.2