]> cvs.zerfleddert.de Git - proxmark3-svn/blobdiff - client/flash.c
projects / proxmark3-svn / blobdiff
? search:
summary | shortlog | log | commit | commitdiff | tree
raw | inline | side by side
Decreased BigBuff mem, some elf flasher fixes (needs more work) but flashing correctl...
[proxmark3-svn] / client / flash.c
diff --git a/client/flash.c b/client/flash.c
index af322d329357477b914c231dc666fdff4034c838..b01bb154a2545765feaa0e93a9d04459753fbd55 100644 (file)
--- a/client/flash.c
+++ b/client/flash.c
@@ -22,11 +22,13 @@ BOOL UsbConnect(void);
 #include "proxmark3.h"
 #endif
 #include "flash.h"
 #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
 
 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;
 
 void WaitForAck(void) {
        UsbCommand ack;
@@ -44,150 +46,118 @@ struct partition partitions[] = {
                {0, 0, 0, NULL},
 };
 
                {0, 0, 0, NULL},
 };
 
-/* 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));
-
-       printf("expected = %08x flush, ", ExpectedAddr);
+       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};
 
        int i;
        for(i = 0; i < 240; i += 48) {
 
        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] = (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;
 }
 
        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);
        }
 
        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<header.e_phnum; i++) {
+                       fseek(f, header.e_phoff + i * sizeof(Elf32_Phdr), SEEK_SET);
+                       fread(&phdr, 1, sizeof(phdr), f);
+                       printf("type=%d offset=%x paddr=%x vaddr=%x filesize=%x memsize=%x flags=%x align=%x\n",
+                               phdr.p_type, phdr.p_offset, phdr.p_paddr, phdr.p_vaddr, phdr.p_filesz, phdr.p_memsz, phdr.p_flags, phdr.p_align);
+                       if (phdr.p_type == PT_LOAD && phdr.p_filesz > 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;
+                                       phdr.p_filesz -= 0x2000;
+                                       phdr.p_memsz -= 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;
+                                       else
+                                               memset(QueuedToSend, 0xFF, 256);
+                                       fread(QueuedToSend, 1, bytes_to_read, f);
+                                       printf("WriteBlock(%x, %d, %02x %02x %02x %02x %02x %02x %02x %02x ... %02x %02x %02x %02x %02x %02x %02x %02x)\n", ExpectedAddr, bytes_to_read,
+                                                       QueuedToSend[0], QueuedToSend[1], QueuedToSend[2], QueuedToSend[3],
+                                                       QueuedToSend[4], QueuedToSend[5], QueuedToSend[6], QueuedToSend[7],
+                                                       QueuedToSend[248], QueuedToSend[249], QueuedToSend[250], QueuedToSend[251],
+                                                       QueuedToSend[252], QueuedToSend[253], QueuedToSend[254], QueuedToSend[255]);
+                                       WriteBlock(ExpectedAddr, 256, 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 PrepareFlash(struct partition *p, const char *filename, unsigned int state)
 {
-       int translate = 0;
        if(state & DEVICE_INFO_FLAG_UNDERSTANDS_START_FLASH) {
        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 */
                
                /* Only send magic when flashing bootrom */
-               if(p->precious) {
+               if(p->precious)
                        c.arg[2] = START_FLASH_MAGIC;
                        c.arg[2] = START_FLASH_MAGIC;
-               } else {
+               else
                        c.arg[2] = 0;
                        c.arg[2] = 0;
-               }
+
                SendCommand(&c);
                WaitForAck();
                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");
        } 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;
 }
 
        return 1;
 }
 
Proxmark3 GIT tracking
Impressum, Datenschutz