From 2cab856f9f8cf6798447f4e66559975692225706 Mon Sep 17 00:00:00 2001 From: bushing Date: Tue, 5 Jan 2010 00:02:12 +0000 Subject: [PATCH] removed support for s19 files in the flasher and replaced it with elf parsing. can we stop specifying the "partition" yet? --- client/elf.h | 31 +++++++++ client/flash.c | 165 +++++++++++++++++++---------------------------- client/flasher.c | 2 +- client/prox.c | 2 +- 4 files changed, 99 insertions(+), 101 deletions(-) create mode 100644 client/elf.h diff --git a/client/elf.h b/client/elf.h new file mode 100644 index 00000000..349e6c6c --- /dev/null +++ b/client/elf.h @@ -0,0 +1,31 @@ +#ifndef __ELF_H__ +#define __ELF_H__ + +#define EI_NIDENT 16 + +typedef struct { + unsigned char e_ident[EI_NIDENT]; + uint16_t e_type; + uint16_t e_machine; + uint32_t e_version; + uint32_t e_entry; + uint32_t e_phoff; + uint32_t e_shoff; + uint32_t e_flags; + uint16_t e_ehsize; + uint16_t e_phentsize; + uint16_t e_phnum; + uint16_t e_shentsize; + uint16_t e_shnum; + uint16_t e_shtrndx; +} __attribute__((__packed__)) Elf32_Ehdr; + +#define PT_NULL 0 +#define PT_LOAD 1 +#define PT_DYNAMIC 2 +#define PT_INTERP 3 +#define PT_NOTE 4 +#define PT_SHLIB 5 +#define PT_PHDR 6 +#endif + diff --git a/client/flash.c b/client/flash.c index af322d32..f11505ad 100644 --- a/client/flash.c +++ b/client/flash.c @@ -22,11 +22,13 @@ BOOL UsbConnect(void); #include "proxmark3.h" #endif #include "flash.h" +#include "elf.h" static uint32_t ExpectedAddr; static uint8_t QueuedToSend[256]; static bool AllWritten; #define PHYSICAL_FLASH_START 0x100000 +#define PHYSICAL_FLASH_END 0x200000 void WaitForAck(void) { UsbCommand ack; @@ -47,147 +49,112 @@ struct partition partitions[] = { /* If translate is set, subtract PHYSICAL_FLASH_START to translate for old * bootroms. */ -void FlushPrevious(int translate) +void WriteBlock(unsigned int block_start, unsigned int len, unsigned char *buf) { - UsbCommand c; - memset(&c, 0, sizeof(c)); + unsigned char temp_buf[256]; + if (block_start & 0xFF) { + printf("moving stuff forward by %d bytes\n", block_start & 0xFF); + memset(temp_buf, 0xFF, block_start & 0xFF); + memcpy(temp_buf + (block_start & 0xFF), buf, len); + block_start &= ~0xFF; + } else memcpy(temp_buf, buf, len); + + UsbCommand c = {CMD_SETUP_WRITE}; - printf("expected = %08x flush, ", ExpectedAddr); +// printf("expected = %08x flush, ", ExpectedAddr); int i; for(i = 0; i < 240; i += 48) { - c.cmd = CMD_SETUP_WRITE; - memcpy(c.d.asBytes, QueuedToSend+i, 48); + memcpy(c.d.asBytes, temp_buf+i, 48); c.arg[0] = (i/4); SendCommand(&c); WaitForAck(); } c.cmd = CMD_FINISH_WRITE; - c.arg[0] = (ExpectedAddr-1) & (~255); - if(translate) { - c.arg[0] -= PHYSICAL_FLASH_START; - } - printf("c.arg[0] = %08x\r", c.arg[0]); - memcpy(c.d.asBytes, QueuedToSend+240, 16); + c.arg[0] = block_start; + + printf("writing block %08x\r", c.arg[0]); + memcpy(c.d.asBytes, temp_buf+240, 16); SendCommand(&c); WaitForAck(); AllWritten = true; } -/* Where must be between start_addr (inclusive) and end_addr (exclusive). - */ -void GotByte(uint32_t where, uint8_t which, int start_addr, int end_addr, int translate) -{ - AllWritten = false; - - if(where < start_addr || where >= end_addr) { - printf("bad: got byte at %08x, outside of range %08x-%08x\n", where, start_addr, end_addr); - exit(-1); - } - - if(where != ExpectedAddr) { - printf("bad: got at %08x, expected at %08x\n", where, ExpectedAddr); - exit(-1); - } - QueuedToSend[where & 255] = which; - ExpectedAddr++; - - if((where & 255) == 255) { - // we have completed a full page - FlushPrevious(translate); - } -} - -int HexVal(int c) -{ - c = tolower(c); - if(c >= '0' && c <= '9') { - return c - '0'; - } else if(c >= 'a' && c <= 'f') { - return (c - 'a') + 10; - } else { - printf("bad hex digit '%c'\n", c); - exit(-1); - } -} - -uint8_t HexByte(char *s) -{ - return (HexVal(s[0]) << 4) | HexVal(s[1]); -} - -void LoadFlashFromSRecords(const char *file, int start_addr, int end_addr, int translate) +void LoadFlashFromFile(const char *file, int start_addr, int end_addr) { - ExpectedAddr = start_addr; - - FILE *f = fopen(file, "r"); + FILE *f = fopen(file, "rb"); if(!f) { printf("couldn't open file\n"); exit(-1); } - char line[512]; - while(fgets(line, sizeof(line), f)) { - if(memcmp(line, "S3", 2)==0) { - char *s = line + 2; - int len = HexByte(s) - 5; - s += 2; - - char addrStr[9]; - memcpy(addrStr, s, 8); - addrStr[8] = '\0'; - uint32_t addr; - sscanf(addrStr, "%x", &addr); - s += 8; - - /* Accept files that are located at PHYSICAL_FLASH_START, and files that are located at 0 */ - if(addr < PHYSICAL_FLASH_START) - addr += PHYSICAL_FLASH_START; - - int i; - for(i = 0; i < len; i++) { - while((addr+i) > ExpectedAddr) { - GotByte(ExpectedAddr, 0xff, start_addr, end_addr, translate); + char buf[4]; + fread(buf, 1, 4, f); + if (memcmp(buf, "\x7F" "ELF", 4) == 0) { + int i; + fseek(f, 0, SEEK_SET); + Elf32_Ehdr header; + fread(&header, 1, sizeof(header), f); + int count = header.e_phnum; + printf("count=%d phoff=%x\n", count, header.e_phoff); + Elf32_Phdr phdr; + + for (i=0; i 0 && phdr.p_paddr >= PHYSICAL_FLASH_START + && (phdr.p_paddr + phdr.p_filesz) < PHYSICAL_FLASH_END) { + printf("flashing offset=%x paddr=%x size=%x\n", phdr.p_offset, phdr.p_paddr, phdr.p_filesz); + if (phdr.p_offset == 0) { + printf("skipping forward 0x2000 because of strange linker thing\n"); + phdr.p_offset += 0x2000; + phdr.p_paddr += 0x2000; } - GotByte(addr+i, HexByte(s), start_addr, end_addr, translate); - s += 2; - } - } - } - if(!AllWritten) FlushPrevious(translate); + fseek(f, phdr.p_offset, SEEK_SET); + ExpectedAddr = phdr.p_paddr; + while (ExpectedAddr < (phdr.p_paddr + phdr.p_filesz)) { + unsigned int bytes_to_read = phdr.p_paddr + phdr.p_filesz - ExpectedAddr; + if (bytes_to_read > 256) bytes_to_read=256; + fread(QueuedToSend, 1, bytes_to_read, f); +// printf("read %d bytes\n", bytes_to_read); + printf("WriteBlock(%x, %d, %p)\n", ExpectedAddr, bytes_to_read, QueuedToSend); + WriteBlock(ExpectedAddr, bytes_to_read, QueuedToSend); + ExpectedAddr += bytes_to_read; + } + } + } - fclose(f); - printf("\ndone.\n"); + fclose(f); + printf("\ndone.\n"); + return; + } else printf("Bad file format\n"); } int PrepareFlash(struct partition *p, const char *filename, unsigned int state) { - int translate = 0; if(state & DEVICE_INFO_FLAG_UNDERSTANDS_START_FLASH) { - UsbCommand c; - c.cmd = CMD_START_FLASH; - c.arg[0] = p->start; - c.arg[1] = p->end; + UsbCommand c = {CMD_START_FLASH, {p->start, p->end, 0}}; /* Only send magic when flashing bootrom */ - if(p->precious) { + if(p->precious) c.arg[2] = START_FLASH_MAGIC; - } else { + else c.arg[2] = 0; - } + SendCommand(&c); WaitForAck(); - translate = 0; } else { fprintf(stderr, "Warning: Your bootloader does not understand the new START_FLASH command\n"); fprintf(stderr, " It is recommended that you update your bootloader\n\n"); - translate = 1; + exit(0); } - LoadFlashFromSRecords(filename, p->start, p->end, translate); + LoadFlashFromFile(filename, p->start, p->end); return 1; } diff --git a/client/flasher.c b/client/flasher.c index 3b5c1ad5..a425023d 100644 --- a/client/flasher.c +++ b/client/flasher.c @@ -30,7 +30,7 @@ static void usage(char **argv) fprintf(stderr, "\n"); fprintf(stderr, " image is the path to the corresponding image\n\n"); - fprintf(stderr, "Example: %s os,fpga path/to/osimage.s19 path/to/fpgaimage.s19\n", argv[0]); + fprintf(stderr, "Example: %s os,fpga path/to/osimage.elf path/to/fpgaimage.elf\n", argv[0]); } int main(int argc, char **argv) { diff --git a/client/prox.c b/client/prox.c index 43204745..7add1976 100644 --- a/client/prox.c +++ b/client/prox.c @@ -223,7 +223,7 @@ static void usage(char **argv) int i; printf("Usage: %s gui\n", argv[0]); printf(" %s offline\n", argv[0]); - printf(" %s areas file.s19\n", argv[0]); + printf(" %s areas file.elf\n", argv[0]); printf(" Known areas are:"); for(i=0; partitions[i].name != NULL; i++) { fprintf(stderr, " %s", partitions[i].name); -- 2.39.2