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@3:d7a7cde0bfb8, 2013-09-08 (annotated)
- Committer:
- va009039
- Date:
- Sun Sep 08 14:13:15 2013 +0000
- Revision:
- 3:d7a7cde0bfb8
- Parent:
- 2:32e9437348ad
- Child:
- 4:5e4107edcbdb
add softwarereset(),flash.init()
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
va009039 | 3:d7a7cde0bfb8 | 1 | // Flash.cpp 2013/9/6 |
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 | 3:d7a7cde0bfb8 | 6 | #define SYSMEMREMAP 0x40048000 |
va009039 | 3:d7a7cde0bfb8 | 7 | #define MAINCLKSEL 0x40048070 |
va009039 | 3:d7a7cde0bfb8 | 8 | #define MAINCLKUEN 0x40048074 |
va009039 | 3:d7a7cde0bfb8 | 9 | #define SYSAHBCLKDIV 0x40048078 |
va009039 | 3:d7a7cde0bfb8 | 10 | |
va009039 | 0:27d35fa263b5 | 11 | Flash::Flash(Target2* target, Serial* usbpc) :_target(target),_pc(usbpc) |
va009039 | 0:27d35fa263b5 | 12 | { |
va009039 | 0:27d35fa263b5 | 13 | _setup(); |
va009039 | 0:27d35fa263b5 | 14 | } |
va009039 | 0:27d35fa263b5 | 15 | |
va009039 | 0:27d35fa263b5 | 16 | void Flash::_setup() |
va009039 | 0:27d35fa263b5 | 17 | { |
va009039 | 0:27d35fa263b5 | 18 | _target->halt(); |
va009039 | 0:27d35fa263b5 | 19 | _target->wait_status(TARGET_HALTED); |
va009039 | 0:27d35fa263b5 | 20 | } |
va009039 | 0:27d35fa263b5 | 21 | |
va009039 | 3:d7a7cde0bfb8 | 22 | bool Flash::init() |
va009039 | 3:d7a7cde0bfb8 | 23 | { |
va009039 | 3:d7a7cde0bfb8 | 24 | _pc->printf("Initializing."); |
va009039 | 3:d7a7cde0bfb8 | 25 | if (_target->idcode == 0x0bb11477) { // LPC1114FN28 |
va009039 | 3:d7a7cde0bfb8 | 26 | _target->writeMemory(MAINCLKSEL, 0); // Select Internal RC Oscillator |
va009039 | 3:d7a7cde0bfb8 | 27 | _target->writeMemory(MAINCLKUEN, 1); // Update Main Clock Source |
va009039 | 3:d7a7cde0bfb8 | 28 | _target->writeMemory(MAINCLKUEN, 0); // Toggle Update Register |
va009039 | 3:d7a7cde0bfb8 | 29 | _target->writeMemory(MAINCLKUEN, 1); |
va009039 | 3:d7a7cde0bfb8 | 30 | uint32_t data = _target->readMemory(MAINCLKUEN); // Wait until updated |
va009039 | 3:d7a7cde0bfb8 | 31 | if (!(data & 1)) { |
va009039 | 3:d7a7cde0bfb8 | 32 | _pc->printf("\nerror MAINCLKUEN=%08x\n", data); |
va009039 | 3:d7a7cde0bfb8 | 33 | return false; |
va009039 | 3:d7a7cde0bfb8 | 34 | } |
va009039 | 3:d7a7cde0bfb8 | 35 | _target->writeMemory(SYSAHBCLKDIV, 1);// Set Main Clock divider to 1 |
va009039 | 3:d7a7cde0bfb8 | 36 | _target->writeMemory(SYSMEMREMAP, 2); // User Flash Mode |
va009039 | 3:d7a7cde0bfb8 | 37 | } else { |
va009039 | 3:d7a7cde0bfb8 | 38 | _pc->printf("\nerror idcode=%08x\n", _target->idcode); |
va009039 | 3:d7a7cde0bfb8 | 39 | return false; |
va009039 | 3:d7a7cde0bfb8 | 40 | } |
va009039 | 3:d7a7cde0bfb8 | 41 | _pc->printf("passed.\n"); |
va009039 | 3:d7a7cde0bfb8 | 42 | return true; |
va009039 | 3:d7a7cde0bfb8 | 43 | } |
va009039 | 3:d7a7cde0bfb8 | 44 | |
va009039 | 0:27d35fa263b5 | 45 | bool Flash::write(const char* filename) |
va009039 | 0:27d35fa263b5 | 46 | { |
va009039 | 0:27d35fa263b5 | 47 | FILE* fp = fopen(filename, "rb"); |
va009039 | 0:27d35fa263b5 | 48 | if (fp == NULL) { |
va009039 | 0:27d35fa263b5 | 49 | _pc->printf("file open error [%s]\n", filename); |
va009039 | 0:27d35fa263b5 | 50 | return false; |
va009039 | 0:27d35fa263b5 | 51 | } |
va009039 | 0:27d35fa263b5 | 52 | _pc->printf("Writing."); |
va009039 | 0:27d35fa263b5 | 53 | uint8_t buf[256]; |
va009039 | 0:27d35fa263b5 | 54 | bool passed = false; |
va009039 | 0:27d35fa263b5 | 55 | for(int addr = 0; addr < 0x8000; addr += sizeof(buf)) { |
va009039 | 3:d7a7cde0bfb8 | 56 | int ret = fread(buf, 1, sizeof(buf), fp); |
va009039 | 0:27d35fa263b5 | 57 | if (!_patch(buf, sizeof(buf), addr)) { |
va009039 | 0:27d35fa263b5 | 58 | break; |
va009039 | 0:27d35fa263b5 | 59 | } |
va009039 | 0:27d35fa263b5 | 60 | const int ram = 0x10000200; |
va009039 | 0:27d35fa263b5 | 61 | if (!_write_to_ram(ram, sizeof(buf), buf)) { |
va009039 | 0:27d35fa263b5 | 62 | break; |
va009039 | 0:27d35fa263b5 | 63 | } |
va009039 | 2:32e9437348ad | 64 | if (remoteIAP(PREPARE_SECTOR, _sector(addr), _sector(addr)) != CMD_SUCCESS) { |
va009039 | 2:32e9437348ad | 65 | _pc->printf("faild. PREPARE_SECTOR %d %d\n", _sector(addr), _sector(addr)); |
va009039 | 0:27d35fa263b5 | 66 | break; |
va009039 | 0:27d35fa263b5 | 67 | } |
va009039 | 2:32e9437348ad | 68 | if (remoteIAP(COPY_RAM_TO_FLASH, addr, ram, sizeof(buf), IAP_CCLK) != CMD_SUCCESS) { |
va009039 | 2:32e9437348ad | 69 | _pc->printf("faild. COPY_RAM_TO_FLASH %d %d %d %dn", addr, ram, sizeof(buf)); |
va009039 | 0:27d35fa263b5 | 70 | break; |
va009039 | 0:27d35fa263b5 | 71 | } |
va009039 | 0:27d35fa263b5 | 72 | if (addr >= 512) { |
va009039 | 2:32e9437348ad | 73 | if (remoteIAP(COMPARE, addr, ram, sizeof(buf)) != CMD_SUCCESS) { |
va009039 | 2:32e9437348ad | 74 | _pc->printf("faild. COMPARE %d %d %d", addr, ram, sizeof(buf)); |
va009039 | 0:27d35fa263b5 | 75 | break; |
va009039 | 0:27d35fa263b5 | 76 | } |
va009039 | 0:27d35fa263b5 | 77 | } |
va009039 | 0:27d35fa263b5 | 78 | _pc->printf("."); |
va009039 | 3:d7a7cde0bfb8 | 79 | if (ret < sizeof(buf)) { |
va009039 | 3:d7a7cde0bfb8 | 80 | passed = true; |
va009039 | 3:d7a7cde0bfb8 | 81 | break; |
va009039 | 3:d7a7cde0bfb8 | 82 | } |
va009039 | 0:27d35fa263b5 | 83 | } |
va009039 | 0:27d35fa263b5 | 84 | fclose(fp); |
va009039 | 0:27d35fa263b5 | 85 | if (passed) { |
va009039 | 0:27d35fa263b5 | 86 | _pc->printf("passed.\n"); |
va009039 | 0:27d35fa263b5 | 87 | } |
va009039 | 0:27d35fa263b5 | 88 | return passed; |
va009039 | 0:27d35fa263b5 | 89 | } |
va009039 | 0:27d35fa263b5 | 90 | |
va009039 | 0:27d35fa263b5 | 91 | bool Flash::eraseAll() |
va009039 | 0:27d35fa263b5 | 92 | { |
va009039 | 0:27d35fa263b5 | 93 | _pc->printf("Erasing."); |
va009039 | 0:27d35fa263b5 | 94 | for(int sector = 0; sector <= 7; sector++) { |
va009039 | 2:32e9437348ad | 95 | IAP_STATUS status = remoteIAP(PREPARE_SECTOR, sector, sector); |
va009039 | 2:32e9437348ad | 96 | if (status != CMD_SUCCESS) { |
va009039 | 2:32e9437348ad | 97 | _pc->printf("faild. PREPARE_SECTOR %d %d status=%d\n", sector, sector, status); |
va009039 | 0:27d35fa263b5 | 98 | return false; |
va009039 | 0:27d35fa263b5 | 99 | } |
va009039 | 2:32e9437348ad | 100 | if (remoteIAP(ERASE_SECTOR, sector, sector, IAP_CCLK) != CMD_SUCCESS) { |
va009039 | 2:32e9437348ad | 101 | _pc->printf("faild. ERASE_SECTOR %d %d %d\n", sector, sector, IAP_CCLK); |
va009039 | 0:27d35fa263b5 | 102 | return false; |
va009039 | 0:27d35fa263b5 | 103 | } |
va009039 | 2:32e9437348ad | 104 | if (remoteIAP(BLANK_CHECK, sector, sector, IAP_CCLK) != CMD_SUCCESS) { |
va009039 | 2:32e9437348ad | 105 | _pc->printf("faild. BLANK_CHECK %d %d %d\n", sector, sector, IAP_CCLK); |
va009039 | 0:27d35fa263b5 | 106 | return false; |
va009039 | 0:27d35fa263b5 | 107 | } |
va009039 | 0:27d35fa263b5 | 108 | _pc->printf("."); |
va009039 | 0:27d35fa263b5 | 109 | } |
va009039 | 0:27d35fa263b5 | 110 | _pc->printf("passed.\n"); |
va009039 | 0:27d35fa263b5 | 111 | return true; |
va009039 | 0:27d35fa263b5 | 112 | } |
va009039 | 0:27d35fa263b5 | 113 | |
va009039 | 0:27d35fa263b5 | 114 | bool Flash::_write_to_ram(int addr, int size, uint8_t* buf) |
va009039 | 0:27d35fa263b5 | 115 | { |
va009039 | 0:27d35fa263b5 | 116 | _target->writeMemory(addr, (uint32_t*)buf, size / sizeof(uint32_t)); |
va009039 | 0:27d35fa263b5 | 117 | return true; |
va009039 | 0:27d35fa263b5 | 118 | } |
va009039 | 0:27d35fa263b5 | 119 | |
va009039 | 0:27d35fa263b5 | 120 | int Flash::_sector(int addr) |
va009039 | 0:27d35fa263b5 | 121 | { |
va009039 | 0:27d35fa263b5 | 122 | return addr / 4096; |
va009039 | 0:27d35fa263b5 | 123 | } |
va009039 | 0:27d35fa263b5 | 124 | |
va009039 | 0:27d35fa263b5 | 125 | bool Flash::_patch(uint8_t* buf, int size, int addr) |
va009039 | 0:27d35fa263b5 | 126 | { |
va009039 | 0:27d35fa263b5 | 127 | const int crp_start = 0x2fc; // Code Read Protection location |
va009039 | 0:27d35fa263b5 | 128 | if (crp_start >= addr && crp_start < addr+size) { |
va009039 | 0:27d35fa263b5 | 129 | uint32_t pat = *reinterpret_cast<uint32_t*>(crp_start-addr+buf); |
va009039 | 0:27d35fa263b5 | 130 | if (pat != 0xffffffff) { // NO_CRP ? |
va009039 | 0:27d35fa263b5 | 131 | _pc->printf("\nCAUTION: CRP Pattern is not NO_CRP; %08x\n", pat); |
va009039 | 0:27d35fa263b5 | 132 | return false; |
va009039 | 0:27d35fa263b5 | 133 | } |
va009039 | 0:27d35fa263b5 | 134 | } |
va009039 | 0:27d35fa263b5 | 135 | return true; |
va009039 | 0:27d35fa263b5 | 136 | } |
va009039 | 0:27d35fa263b5 | 137 | |
va009039 | 2:32e9437348ad | 138 | Flash::IAP_STATUS Flash::remoteIAP(Flash::IAP_CMD cmd, uint32_t p0, uint32_t p1, uint32_t p2, uint32_t p3) |
va009039 | 0:27d35fa263b5 | 139 | { |
va009039 | 0:27d35fa263b5 | 140 | struct { |
va009039 | 0:27d35fa263b5 | 141 | uint32_t bkpt; // +0 |
va009039 | 0:27d35fa263b5 | 142 | struct { // IAP Structure |
va009039 | 0:27d35fa263b5 | 143 | uint32_t cmd; // +4 Command |
va009039 | 0:27d35fa263b5 | 144 | uint32_t par[4]; // +8 Parameters |
va009039 | 0:27d35fa263b5 | 145 | uint32_t stat; // +24 Status |
va009039 | 0:27d35fa263b5 | 146 | uint32_t res[4]; // +28 Result |
va009039 | 0:27d35fa263b5 | 147 | } IAP; // +44 |
va009039 | 0:27d35fa263b5 | 148 | } ram; |
va009039 | 0:27d35fa263b5 | 149 | |
va009039 | 2:32e9437348ad | 150 | ram.bkpt = 0xe00abe00; // bpkt #00 |
va009039 | 0:27d35fa263b5 | 151 | ram.IAP.cmd = cmd; |
va009039 | 0:27d35fa263b5 | 152 | ram.IAP.par[0] = p0; |
va009039 | 0:27d35fa263b5 | 153 | ram.IAP.par[1] = p1; |
va009039 | 0:27d35fa263b5 | 154 | ram.IAP.par[2] = p2; |
va009039 | 0:27d35fa263b5 | 155 | ram.IAP.par[3] = p3; |
va009039 | 0:27d35fa263b5 | 156 | _target->halt(); |
va009039 | 0:27d35fa263b5 | 157 | _target->wait_status(TARGET_HALTED); |
va009039 | 0:27d35fa263b5 | 158 | const uint32_t ram_addr = 0x10000100; |
va009039 | 0:27d35fa263b5 | 159 | _target->writeMemory(ram_addr, (uint32_t*)&ram, sizeof(ram)/sizeof(uint32_t)); |
va009039 | 2:32e9437348ad | 160 | _target->r0 = ram_addr + 4; // command addr |
va009039 | 2:32e9437348ad | 161 | _target->r1 = ram_addr + 24; // status addr |
va009039 | 2:32e9437348ad | 162 | _target->sp = 0x10000400-32; // IAP use ram top 32bytes |
va009039 | 0:27d35fa263b5 | 163 | _target->lr = ram_addr + 1; // return to bkpt |
va009039 | 0:27d35fa263b5 | 164 | _target->pc = 0x1fff1ff1; // IAP_Call |
va009039 | 0:27d35fa263b5 | 165 | _target->resume(); |
va009039 | 0:27d35fa263b5 | 166 | _target->wait_status(TARGET_HALTED); |
va009039 | 2:32e9437348ad | 167 | return (IAP_STATUS)_target->readMemory(ram_addr + 24); |
va009039 | 0:27d35fa263b5 | 168 | } |
va009039 | 0:27d35fa263b5 | 169 | |
va009039 | 0:27d35fa263b5 | 170 | bool Flash::verify(const char* filename) |
va009039 | 0:27d35fa263b5 | 171 | { |
va009039 | 0:27d35fa263b5 | 172 | FILE* fp = fopen(filename, "rb"); |
va009039 | 0:27d35fa263b5 | 173 | if (fp == NULL) { |
va009039 | 0:27d35fa263b5 | 174 | _pc->printf("file open error [%s]\n", filename); |
va009039 | 0:27d35fa263b5 | 175 | return false; |
va009039 | 0:27d35fa263b5 | 176 | } |
va009039 | 0:27d35fa263b5 | 177 | _pc->printf("Verifying."); |
va009039 | 0:27d35fa263b5 | 178 | uint8_t buf[256]; |
va009039 | 0:27d35fa263b5 | 179 | bool passed = false; |
va009039 | 0:27d35fa263b5 | 180 | for(int addr = 0; addr < 0x8000; addr++) { |
va009039 | 0:27d35fa263b5 | 181 | int c = fgetc(fp); |
va009039 | 0:27d35fa263b5 | 182 | if (c == EOF) { |
va009039 | 0:27d35fa263b5 | 183 | passed = true; |
va009039 | 0:27d35fa263b5 | 184 | break; |
va009039 | 0:27d35fa263b5 | 185 | } |
va009039 | 0:27d35fa263b5 | 186 | if ((addr % sizeof(buf)) == 0) { |
va009039 | 0:27d35fa263b5 | 187 | _target->readMemory(addr, (uint32_t*)buf, sizeof(buf)/sizeof(uint32_t)); |
va009039 | 0:27d35fa263b5 | 188 | _pc->printf("."); |
va009039 | 0:27d35fa263b5 | 189 | } |
va009039 | 0:27d35fa263b5 | 190 | if (c != buf[addr % sizeof(buf)]) { |
va009039 | 0:27d35fa263b5 | 191 | _pc->printf("\nError at %08x(%02x:%02x)\n", addr, c, buf[addr % sizeof(buf)]); |
va009039 | 0:27d35fa263b5 | 192 | if (addr >= 512) { |
va009039 | 0:27d35fa263b5 | 193 | break; |
va009039 | 0:27d35fa263b5 | 194 | } |
va009039 | 0:27d35fa263b5 | 195 | } |
va009039 | 0:27d35fa263b5 | 196 | } |
va009039 | 0:27d35fa263b5 | 197 | fclose(fp); |
va009039 | 0:27d35fa263b5 | 198 | if (passed) { |
va009039 | 0:27d35fa263b5 | 199 | _pc->printf("passed.\n"); |
va009039 | 0:27d35fa263b5 | 200 | } |
va009039 | 0:27d35fa263b5 | 201 | return passed; |
va009039 | 0:27d35fa263b5 | 202 | } |