semihost server example program
Dependencies: SWD mbed USBLocalFileSystem BaseDAP USBDAP
LPCXpresso LPC11U68 | LPCXpresso LPC1549 | FRDM-KL46Z | EA LPC4088 QSB app-board | LPC1768 app-board | LPC810 | LPC1114FN28 | |
---|---|---|---|---|---|---|---|
server | server | server | server | server | client | client | |
SWDIO | D12 | D12 | D12 | p25 | p21 | p4(P0_2) | p12 |
SWCLK | D10 | D10 | D10 | p26 | p22 | p3(P0_3) | p3 |
nRESET *option | D6 | D6 | D6 | p34 | p30 | p1(P0_5) | p23 |
GND | GND | GND | GND | p1 | p1 | p7 | p22 |
3.3V | P3V3 | P3V3 | P3V3 | p44 | p40 | p6 | p21 |
flash write | SW2(P0_1) | SW3(P1_9) | SW1 | p14 joystick center | p14 joystick center |
client example:
Import programlpc810-semihost_helloworld
semihost client example program
Flash.cpp@2:32e9437348ad, 2013-09-05 (annotated)
- Committer:
- va009039
- Date:
- Thu Sep 05 09:34:12 2013 +0000
- Revision:
- 2:32e9437348ad
- Parent:
- 0:27d35fa263b5
- Child:
- 3:d7a7cde0bfb8
bug fix sys_writec,sys_exit not resume.
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
va009039 | 2:32e9437348ad | 1 | // Flash.cpp 2013/9/5 |
va009039 | 0:27d35fa263b5 | 2 | #include "Flash.h" |
va009039 | 0:27d35fa263b5 | 3 | #include "Target2.h" |
va009039 | 0:27d35fa263b5 | 4 | #include "mydebug.h" |
va009039 | 0:27d35fa263b5 | 5 | |
va009039 | 0:27d35fa263b5 | 6 | Flash::Flash(Target2* target, Serial* usbpc) :_target(target),_pc(usbpc) |
va009039 | 0:27d35fa263b5 | 7 | { |
va009039 | 0:27d35fa263b5 | 8 | _setup(); |
va009039 | 0:27d35fa263b5 | 9 | } |
va009039 | 0:27d35fa263b5 | 10 | |
va009039 | 0:27d35fa263b5 | 11 | void Flash::_setup() |
va009039 | 0:27d35fa263b5 | 12 | { |
va009039 | 0:27d35fa263b5 | 13 | _target->halt(); |
va009039 | 0:27d35fa263b5 | 14 | _target->wait_status(TARGET_HALTED); |
va009039 | 0:27d35fa263b5 | 15 | } |
va009039 | 0:27d35fa263b5 | 16 | |
va009039 | 0:27d35fa263b5 | 17 | bool Flash::write(const char* filename) |
va009039 | 0:27d35fa263b5 | 18 | { |
va009039 | 0:27d35fa263b5 | 19 | FILE* fp = fopen(filename, "rb"); |
va009039 | 0:27d35fa263b5 | 20 | if (fp == NULL) { |
va009039 | 0:27d35fa263b5 | 21 | _pc->printf("file open error [%s]\n", filename); |
va009039 | 0:27d35fa263b5 | 22 | return false; |
va009039 | 0:27d35fa263b5 | 23 | } |
va009039 | 0:27d35fa263b5 | 24 | _pc->printf("Writing."); |
va009039 | 0:27d35fa263b5 | 25 | uint8_t buf[256]; |
va009039 | 0:27d35fa263b5 | 26 | bool passed = false; |
va009039 | 0:27d35fa263b5 | 27 | for(int addr = 0; addr < 0x8000; addr += sizeof(buf)) { |
va009039 | 0:27d35fa263b5 | 28 | if (feof(fp)) { |
va009039 | 0:27d35fa263b5 | 29 | passed = true; |
va009039 | 0:27d35fa263b5 | 30 | break; |
va009039 | 0:27d35fa263b5 | 31 | } |
va009039 | 0:27d35fa263b5 | 32 | fread(buf, sizeof(buf), 1, fp); |
va009039 | 0:27d35fa263b5 | 33 | if (!_patch(buf, sizeof(buf), addr)) { |
va009039 | 0:27d35fa263b5 | 34 | break; |
va009039 | 0:27d35fa263b5 | 35 | } |
va009039 | 0:27d35fa263b5 | 36 | const int ram = 0x10000200; |
va009039 | 0:27d35fa263b5 | 37 | if (!_write_to_ram(ram, sizeof(buf), buf)) { |
va009039 | 0:27d35fa263b5 | 38 | break; |
va009039 | 0:27d35fa263b5 | 39 | } |
va009039 | 2:32e9437348ad | 40 | if (remoteIAP(PREPARE_SECTOR, _sector(addr), _sector(addr)) != CMD_SUCCESS) { |
va009039 | 2:32e9437348ad | 41 | _pc->printf("faild. PREPARE_SECTOR %d %d\n", _sector(addr), _sector(addr)); |
va009039 | 0:27d35fa263b5 | 42 | break; |
va009039 | 0:27d35fa263b5 | 43 | } |
va009039 | 2:32e9437348ad | 44 | if (remoteIAP(COPY_RAM_TO_FLASH, addr, ram, sizeof(buf), IAP_CCLK) != CMD_SUCCESS) { |
va009039 | 2:32e9437348ad | 45 | _pc->printf("faild. COPY_RAM_TO_FLASH %d %d %d %dn", addr, ram, sizeof(buf)); |
va009039 | 0:27d35fa263b5 | 46 | break; |
va009039 | 0:27d35fa263b5 | 47 | } |
va009039 | 0:27d35fa263b5 | 48 | if (addr >= 512) { |
va009039 | 2:32e9437348ad | 49 | if (remoteIAP(COMPARE, addr, ram, sizeof(buf)) != CMD_SUCCESS) { |
va009039 | 2:32e9437348ad | 50 | _pc->printf("faild. COMPARE %d %d %d", addr, ram, sizeof(buf)); |
va009039 | 0:27d35fa263b5 | 51 | break; |
va009039 | 0:27d35fa263b5 | 52 | } |
va009039 | 0:27d35fa263b5 | 53 | } |
va009039 | 0:27d35fa263b5 | 54 | _pc->printf("."); |
va009039 | 0:27d35fa263b5 | 55 | } |
va009039 | 0:27d35fa263b5 | 56 | fclose(fp); |
va009039 | 0:27d35fa263b5 | 57 | if (passed) { |
va009039 | 0:27d35fa263b5 | 58 | _pc->printf("passed.\n"); |
va009039 | 0:27d35fa263b5 | 59 | } |
va009039 | 0:27d35fa263b5 | 60 | return passed; |
va009039 | 0:27d35fa263b5 | 61 | } |
va009039 | 0:27d35fa263b5 | 62 | |
va009039 | 0:27d35fa263b5 | 63 | bool Flash::eraseAll() |
va009039 | 0:27d35fa263b5 | 64 | { |
va009039 | 0:27d35fa263b5 | 65 | _pc->printf("Erasing."); |
va009039 | 0:27d35fa263b5 | 66 | for(int sector = 0; sector <= 7; sector++) { |
va009039 | 2:32e9437348ad | 67 | IAP_STATUS status = remoteIAP(PREPARE_SECTOR, sector, sector); |
va009039 | 2:32e9437348ad | 68 | if (status != CMD_SUCCESS) { |
va009039 | 2:32e9437348ad | 69 | _pc->printf("faild. PREPARE_SECTOR %d %d status=%d\n", sector, sector, status); |
va009039 | 0:27d35fa263b5 | 70 | return false; |
va009039 | 0:27d35fa263b5 | 71 | } |
va009039 | 2:32e9437348ad | 72 | if (remoteIAP(ERASE_SECTOR, sector, sector, IAP_CCLK) != CMD_SUCCESS) { |
va009039 | 2:32e9437348ad | 73 | _pc->printf("faild. ERASE_SECTOR %d %d %d\n", sector, sector, IAP_CCLK); |
va009039 | 0:27d35fa263b5 | 74 | return false; |
va009039 | 0:27d35fa263b5 | 75 | } |
va009039 | 2:32e9437348ad | 76 | if (remoteIAP(BLANK_CHECK, sector, sector, IAP_CCLK) != CMD_SUCCESS) { |
va009039 | 2:32e9437348ad | 77 | _pc->printf("faild. BLANK_CHECK %d %d %d\n", sector, sector, IAP_CCLK); |
va009039 | 0:27d35fa263b5 | 78 | return false; |
va009039 | 0:27d35fa263b5 | 79 | } |
va009039 | 0:27d35fa263b5 | 80 | _pc->printf("."); |
va009039 | 0:27d35fa263b5 | 81 | } |
va009039 | 0:27d35fa263b5 | 82 | _pc->printf("passed.\n"); |
va009039 | 0:27d35fa263b5 | 83 | return true; |
va009039 | 0:27d35fa263b5 | 84 | } |
va009039 | 0:27d35fa263b5 | 85 | |
va009039 | 0:27d35fa263b5 | 86 | bool Flash::_write_to_ram(int addr, int size, uint8_t* buf) |
va009039 | 0:27d35fa263b5 | 87 | { |
va009039 | 0:27d35fa263b5 | 88 | _target->writeMemory(addr, (uint32_t*)buf, size / sizeof(uint32_t)); |
va009039 | 0:27d35fa263b5 | 89 | return true; |
va009039 | 0:27d35fa263b5 | 90 | } |
va009039 | 0:27d35fa263b5 | 91 | |
va009039 | 0:27d35fa263b5 | 92 | int Flash::_sector(int addr) |
va009039 | 0:27d35fa263b5 | 93 | { |
va009039 | 0:27d35fa263b5 | 94 | return addr / 4096; |
va009039 | 0:27d35fa263b5 | 95 | } |
va009039 | 0:27d35fa263b5 | 96 | |
va009039 | 0:27d35fa263b5 | 97 | bool Flash::_patch(uint8_t* buf, int size, int addr) |
va009039 | 0:27d35fa263b5 | 98 | { |
va009039 | 0:27d35fa263b5 | 99 | const int crp_start = 0x2fc; // Code Read Protection location |
va009039 | 0:27d35fa263b5 | 100 | if (crp_start >= addr && crp_start < addr+size) { |
va009039 | 0:27d35fa263b5 | 101 | uint32_t pat = *reinterpret_cast<uint32_t*>(crp_start-addr+buf); |
va009039 | 0:27d35fa263b5 | 102 | if (pat != 0xffffffff) { // NO_CRP ? |
va009039 | 0:27d35fa263b5 | 103 | _pc->printf("\nCAUTION: CRP Pattern is not NO_CRP; %08x\n", pat); |
va009039 | 0:27d35fa263b5 | 104 | return false; |
va009039 | 0:27d35fa263b5 | 105 | } |
va009039 | 0:27d35fa263b5 | 106 | } |
va009039 | 0:27d35fa263b5 | 107 | return true; |
va009039 | 0:27d35fa263b5 | 108 | } |
va009039 | 0:27d35fa263b5 | 109 | |
va009039 | 2:32e9437348ad | 110 | Flash::IAP_STATUS Flash::remoteIAP(Flash::IAP_CMD cmd, uint32_t p0, uint32_t p1, uint32_t p2, uint32_t p3) |
va009039 | 0:27d35fa263b5 | 111 | { |
va009039 | 0:27d35fa263b5 | 112 | struct { |
va009039 | 0:27d35fa263b5 | 113 | uint32_t bkpt; // +0 |
va009039 | 0:27d35fa263b5 | 114 | struct { // IAP Structure |
va009039 | 0:27d35fa263b5 | 115 | uint32_t cmd; // +4 Command |
va009039 | 0:27d35fa263b5 | 116 | uint32_t par[4]; // +8 Parameters |
va009039 | 0:27d35fa263b5 | 117 | uint32_t stat; // +24 Status |
va009039 | 0:27d35fa263b5 | 118 | uint32_t res[4]; // +28 Result |
va009039 | 0:27d35fa263b5 | 119 | } IAP; // +44 |
va009039 | 0:27d35fa263b5 | 120 | } ram; |
va009039 | 0:27d35fa263b5 | 121 | |
va009039 | 2:32e9437348ad | 122 | ram.bkpt = 0xe00abe00; // bpkt #00 |
va009039 | 0:27d35fa263b5 | 123 | ram.IAP.cmd = cmd; |
va009039 | 0:27d35fa263b5 | 124 | ram.IAP.par[0] = p0; |
va009039 | 0:27d35fa263b5 | 125 | ram.IAP.par[1] = p1; |
va009039 | 0:27d35fa263b5 | 126 | ram.IAP.par[2] = p2; |
va009039 | 0:27d35fa263b5 | 127 | ram.IAP.par[3] = p3; |
va009039 | 0:27d35fa263b5 | 128 | _target->halt(); |
va009039 | 0:27d35fa263b5 | 129 | _target->wait_status(TARGET_HALTED); |
va009039 | 0:27d35fa263b5 | 130 | const uint32_t ram_addr = 0x10000100; |
va009039 | 0:27d35fa263b5 | 131 | _target->writeMemory(ram_addr, (uint32_t*)&ram, sizeof(ram)/sizeof(uint32_t)); |
va009039 | 2:32e9437348ad | 132 | _target->r0 = ram_addr + 4; // command addr |
va009039 | 2:32e9437348ad | 133 | _target->r1 = ram_addr + 24; // status addr |
va009039 | 2:32e9437348ad | 134 | _target->sp = 0x10000400-32; // IAP use ram top 32bytes |
va009039 | 0:27d35fa263b5 | 135 | _target->lr = ram_addr + 1; // return to bkpt |
va009039 | 0:27d35fa263b5 | 136 | _target->pc = 0x1fff1ff1; // IAP_Call |
va009039 | 0:27d35fa263b5 | 137 | _target->resume(); |
va009039 | 0:27d35fa263b5 | 138 | _target->wait_status(TARGET_HALTED); |
va009039 | 2:32e9437348ad | 139 | return (IAP_STATUS)_target->readMemory(ram_addr + 24); |
va009039 | 0:27d35fa263b5 | 140 | } |
va009039 | 0:27d35fa263b5 | 141 | |
va009039 | 0:27d35fa263b5 | 142 | bool Flash::verify(const char* filename) |
va009039 | 0:27d35fa263b5 | 143 | { |
va009039 | 0:27d35fa263b5 | 144 | FILE* fp = fopen(filename, "rb"); |
va009039 | 0:27d35fa263b5 | 145 | if (fp == NULL) { |
va009039 | 0:27d35fa263b5 | 146 | _pc->printf("file open error [%s]\n", filename); |
va009039 | 0:27d35fa263b5 | 147 | return false; |
va009039 | 0:27d35fa263b5 | 148 | } |
va009039 | 0:27d35fa263b5 | 149 | _pc->printf("Verifying."); |
va009039 | 0:27d35fa263b5 | 150 | uint8_t buf[256]; |
va009039 | 0:27d35fa263b5 | 151 | bool passed = false; |
va009039 | 0:27d35fa263b5 | 152 | for(int addr = 0; addr < 0x8000; addr++) { |
va009039 | 0:27d35fa263b5 | 153 | int c = fgetc(fp); |
va009039 | 0:27d35fa263b5 | 154 | if (c == EOF) { |
va009039 | 0:27d35fa263b5 | 155 | passed = true; |
va009039 | 0:27d35fa263b5 | 156 | break; |
va009039 | 0:27d35fa263b5 | 157 | } |
va009039 | 0:27d35fa263b5 | 158 | if ((addr % sizeof(buf)) == 0) { |
va009039 | 0:27d35fa263b5 | 159 | _target->readMemory(addr, (uint32_t*)buf, sizeof(buf)/sizeof(uint32_t)); |
va009039 | 0:27d35fa263b5 | 160 | _pc->printf("."); |
va009039 | 0:27d35fa263b5 | 161 | } |
va009039 | 0:27d35fa263b5 | 162 | if (c != buf[addr % sizeof(buf)]) { |
va009039 | 0:27d35fa263b5 | 163 | _pc->printf("\nError at %08x(%02x:%02x)\n", addr, c, buf[addr % sizeof(buf)]); |
va009039 | 0:27d35fa263b5 | 164 | if (addr >= 512) { |
va009039 | 0:27d35fa263b5 | 165 | break; |
va009039 | 0:27d35fa263b5 | 166 | } |
va009039 | 0:27d35fa263b5 | 167 | } |
va009039 | 0:27d35fa263b5 | 168 | } |
va009039 | 0:27d35fa263b5 | 169 | fclose(fp); |
va009039 | 0:27d35fa263b5 | 170 | if (passed) { |
va009039 | 0:27d35fa263b5 | 171 | _pc->printf("passed.\n"); |
va009039 | 0:27d35fa263b5 | 172 | } |
va009039 | 0:27d35fa263b5 | 173 | return passed; |
va009039 | 0:27d35fa263b5 | 174 | } |