Norimasa Okamoto / Mbed 2 deprecated lpcterm2

semihost server example program

Dependencies:   SWD mbed USBLocalFileSystem BaseDAP USBDAP

/media/uploads/va009039/kl46z-lpc800-360x480.jpg

LPCXpresso
LPC11U68		LPCXpresso
LPC1549		FRDM-KL46ZEA LPC4088 QSB
app-board		LPC1768
app-board		LPC810LPC1114FN28
serverserverserverserverserverclientclient
SWDIOD12D12D12p25p21p4(P0_2)p12
SWCLKD10D10D10p26p22p3(P0_3)p3
nRESET
*option		D6D6D6p34p30p1(P0_5)p23
GNDGNDGNDGNDp1p1p7p22
3.3VP3V3P3V3P3V3p44p40p6p21
flash writeSW2(P0_1)SW3(P1_9)SW1p14
joystick
center		p14
joystick
center

client example:

Import programlpc810-semihost_helloworld

semihost client example program

Last commit 20 Feb 2014 by Norimasa Okamoto

Semihost.cpp@4:5e4107edcbdb, 2013-09-11 (annotated)

Committer:
va009039
Date:
Wed Sep 11 14:00:40 2013 +0000
Revision:
4:5e4107edcbdb
Parent:
3:d7a7cde0bfb8
Child:
9:7e71c20c96e4
add flash.verify(),breakpoint0()

Who changed what in which revision?

UserRevisionLine numberNew contents of line
va009039 4:5e4107edcbdb 1 // Semihost.cpp 2013/9/10
va009039 1:eb30547ba84d 2 #include "Semihost.h"
va009039 1:eb30547ba84d 3 #include "mydebug.h"
va009039 1:eb30547ba84d 4
va009039 1:eb30547ba84d 5 Semihost::Semihost(Target2* target, Serial* usbpc) : _target(target),_pc(usbpc)
va009039 1:eb30547ba84d 6 {
va009039 1:eb30547ba84d 7 _dirpath = "/local";
va009039 1:eb30547ba84d 8 }
va009039 1:eb30547ba84d 9
va009039 1:eb30547ba84d 10 void Semihost::mount(const char* dirpath)
va009039 1:eb30547ba84d 11 {
va009039 1:eb30547ba84d 12 _dirpath = (char*)dirpath;
va009039 1:eb30547ba84d 13 }
va009039 1:eb30547ba84d 14
va009039 1:eb30547ba84d 15 int Semihost::poll()
va009039 1:eb30547ba84d 16 {
va009039 1:eb30547ba84d 17 if (_target->getStatus() != TARGET_HALTED) {
va009039 1:eb30547ba84d 18 return 0;
va009039 1:eb30547ba84d 19 }
va009039 1:eb30547ba84d 20 uint32_t pc = _target->pc;
va009039 1:eb30547ba84d 21 if (pc & 1) {
va009039 1:eb30547ba84d 22 return 0;
va009039 1:eb30547ba84d 23 }
va009039 1:eb30547ba84d 24 if (rd<uint16_t>(pc) != 0xbeab) { // BKPT #171
va009039 1:eb30547ba84d 25 return 0;
va009039 1:eb30547ba84d 26 }
va009039 2:32e9437348ad 27 uint32_t reason = _target->r0;
va009039 2:32e9437348ad 28 _target->r0 = exec(reason, _target->r1);
va009039 2:32e9437348ad 29 if (reason == SYS_EXIT) {
va009039 2:32e9437348ad 30 return SYS_EXIT;
va009039 2:32e9437348ad 31 }
va009039 1:eb30547ba84d 32 _target->pc = pc + 3; // skip bkpt #171
va009039 1:eb30547ba84d 33 _target->resume();
va009039 2:32e9437348ad 34 return reason;
va009039 1:eb30547ba84d 35 }
va009039 1:eb30547ba84d 36
va009039 1:eb30547ba84d 37 int Semihost::exec(uint32_t reason, uint32_t arg)
va009039 1:eb30547ba84d 38 {
va009039 1:eb30547ba84d 39 switch(reason) {
va009039 4:5e4107edcbdb 40 case 0x01: return sys_open(arg);
va009039 4:5e4107edcbdb 41 case 0x02: return sys_close(arg);
va009039 4:5e4107edcbdb 42 case 0x03: return sys_writec(arg);
va009039 4:5e4107edcbdb 43 case 0x04: return sys_write0(arg);
va009039 4:5e4107edcbdb 44 case 0x05: return sys_write(arg);
va009039 4:5e4107edcbdb 45 case 0x06: return sys_read(arg);
va009039 4:5e4107edcbdb 46 case 0x07: return sys_readc(arg);
va009039 4:5e4107edcbdb 47 case 0x09: return sys_istty(arg);
va009039 4:5e4107edcbdb 48 case 0x0a: return sys_fseek(arg);
va009039 4:5e4107edcbdb 49 case 0x0b: return sys_ensure(arg);
va009039 4:5e4107edcbdb 50 case 0x0c: return sys_flen(arg);
va009039 4:5e4107edcbdb 51 case 0x0e: return sys_remove(arg);
va009039 4:5e4107edcbdb 52 case 0x0f: return sys_rename(arg);
va009039 4:5e4107edcbdb 53 case 0x18: return sys_exit(arg);
va009039 1:eb30547ba84d 54
va009039 4:5e4107edcbdb 55 case 0x100: return usr_xffind(arg);
va009039 4:5e4107edcbdb 56 case 0x101: return usr_uid(arg);
va009039 4:5e4107edcbdb 57 case 0x102: return usr_reset(arg);
va009039 4:5e4107edcbdb 58 case 0x103: return usr_vbus(arg);
va009039 4:5e4107edcbdb 59 case 0x104: return usr_powerdown(arg);
va009039 4:5e4107edcbdb 60 case 0x105: return usr_disabledebug(arg);
va009039 1:eb30547ba84d 61 }
va009039 4:5e4107edcbdb 62 _pc->printf("[semihost]error reason=%08x arg=%08x\n", reason, arg);
va009039 4:5e4107edcbdb 63 return -1;
va009039 1:eb30547ba84d 64 }
va009039 1:eb30547ba84d 65
va009039 1:eb30547ba84d 66 int Semihost::sys_open(uint32_t arg) // 0x01
va009039 1:eb30547ba84d 67 {
va009039 1:eb30547ba84d 68 char name[64];
va009039 1:eb30547ba84d 69 _build_name(name, sizeof(name), arg, arg+8);
va009039 1:eb30547ba84d 70 const char* mode[] = {"r", "rb", "r+", "r+b", "w", "wb", "w+", "w+b", "a", "ab", "a+", "a+b"};
va009039 1:eb30547ba84d 71 uint32_t mode_index = rd<uint32_t>(arg+4);
va009039 1:eb30547ba84d 72 FILE* fp = fopen(name, mode[mode_index]);
va009039 1:eb30547ba84d 73 if (fp) {
va009039 1:eb30547ba84d 74 return (uint32_t)fp;
va009039 1:eb30547ba84d 75 }
va009039 1:eb30547ba84d 76 _pc->printf("\n[semihost]file open error [%s]\n", name);
va009039 1:eb30547ba84d 77 return -1;
va009039 1:eb30547ba84d 78 }
va009039 1:eb30547ba84d 79
va009039 1:eb30547ba84d 80 int Semihost::sys_close(uint32_t arg) // 0x02
va009039 1:eb30547ba84d 81 {
va009039 1:eb30547ba84d 82 FILE* fp = reinterpret_cast<FILE*>(rd<uint32_t>(arg));
va009039 1:eb30547ba84d 83 int r = fclose(fp);
va009039 1:eb30547ba84d 84 if (r == 0) {
va009039 1:eb30547ba84d 85 return 0;
va009039 1:eb30547ba84d 86 }
va009039 1:eb30547ba84d 87 return -1;
va009039 1:eb30547ba84d 88 }
va009039 1:eb30547ba84d 89
va009039 1:eb30547ba84d 90 int Semihost::sys_writec(uint32_t arg) // 0x03
va009039 1:eb30547ba84d 91 {
va009039 2:32e9437348ad 92 uint8_t c = rd<uint8_t>(arg);
va009039 2:32e9437348ad 93 return _pc->putc(c);
va009039 1:eb30547ba84d 94 }
va009039 1:eb30547ba84d 95
va009039 1:eb30547ba84d 96 int Semihost::sys_write0(uint32_t arg) // 0x04
va009039 1:eb30547ba84d 97 {
va009039 1:eb30547ba84d 98 uint32_t p = rd<uint32_t>(arg);
va009039 1:eb30547ba84d 99 while(1) {
va009039 1:eb30547ba84d 100 uint8_t c = rd<uint8_t>(p++);
va009039 1:eb30547ba84d 101 if (c == '\0') {
va009039 1:eb30547ba84d 102 break;
va009039 1:eb30547ba84d 103 }
va009039 1:eb30547ba84d 104 _pc->putc(c & 0xff);
va009039 1:eb30547ba84d 105 }
va009039 1:eb30547ba84d 106 return 0;
va009039 1:eb30547ba84d 107 }
va009039 1:eb30547ba84d 108
va009039 1:eb30547ba84d 109 int Semihost::sys_write(uint32_t arg) // 0x05
va009039 1:eb30547ba84d 110 {
va009039 1:eb30547ba84d 111 FILE* fp = reinterpret_cast<FILE*>(rd<uint32_t>(arg));
va009039 1:eb30547ba84d 112 uint32_t p = rd<uint32_t>(arg+4);
va009039 1:eb30547ba84d 113 int count = rd<uint32_t>(arg+8);
va009039 1:eb30547ba84d 114 while(count > 0) {
va009039 1:eb30547ba84d 115 uint8_t c = rd<uint8_t>(p++);
va009039 1:eb30547ba84d 116 if (fputc(c, fp) == EOF) {
va009039 1:eb30547ba84d 117 return count;
va009039 1:eb30547ba84d 118 }
va009039 1:eb30547ba84d 119 count--;
va009039 1:eb30547ba84d 120 }
va009039 1:eb30547ba84d 121 return 0;
va009039 1:eb30547ba84d 122 }
va009039 1:eb30547ba84d 123
va009039 1:eb30547ba84d 124 int Semihost::sys_read(uint32_t arg) // 0x06
va009039 1:eb30547ba84d 125 {
va009039 1:eb30547ba84d 126 FILE* fp = reinterpret_cast<FILE*>(rd<uint32_t>(arg));
va009039 1:eb30547ba84d 127 uint32_t p = rd<uint32_t>(arg+4);
va009039 1:eb30547ba84d 128 int count = rd<uint32_t>(arg+8);
va009039 1:eb30547ba84d 129 while(count > 0) {
va009039 1:eb30547ba84d 130 int c = fgetc(fp);
va009039 1:eb30547ba84d 131 if (c == EOF) {
va009039 1:eb30547ba84d 132 return count;
va009039 1:eb30547ba84d 133 }
va009039 1:eb30547ba84d 134 wr<uint8_t>(p++, c);
va009039 1:eb30547ba84d 135 count--;
va009039 1:eb30547ba84d 136 }
va009039 1:eb30547ba84d 137 return 0;
va009039 1:eb30547ba84d 138 }
va009039 1:eb30547ba84d 139
va009039 1:eb30547ba84d 140 int Semihost::sys_readc(uint32_t arg) // 0x07
va009039 1:eb30547ba84d 141 {
va009039 1:eb30547ba84d 142 return _pc->getc() & 0xff;
va009039 1:eb30547ba84d 143 }
va009039 1:eb30547ba84d 144
va009039 1:eb30547ba84d 145 int Semihost::sys_istty(uint32_t arg) // 0x09
va009039 1:eb30547ba84d 146 {
va009039 1:eb30547ba84d 147 FILE* fp = reinterpret_cast<FILE*>(rd<uint32_t>(arg));
va009039 1:eb30547ba84d 148 return 0;
va009039 1:eb30547ba84d 149 }
va009039 1:eb30547ba84d 150
va009039 1:eb30547ba84d 151 int Semihost::sys_fseek(uint32_t arg) // 0x0a
va009039 1:eb30547ba84d 152 {
va009039 1:eb30547ba84d 153 FILE* fp = reinterpret_cast<FILE*>(rd<uint32_t>(arg));
va009039 1:eb30547ba84d 154 int offset = rd<uint32_t>(arg+4);
va009039 1:eb30547ba84d 155 return fseek(fp, offset, SEEK_SET);
va009039 1:eb30547ba84d 156 }
va009039 1:eb30547ba84d 157
va009039 1:eb30547ba84d 158 int Semihost::sys_ensure(uint32_t arg) // 0x0b
va009039 1:eb30547ba84d 159 {
va009039 1:eb30547ba84d 160 FILE* fp = reinterpret_cast<FILE*>(rd<uint32_t>(arg));
va009039 1:eb30547ba84d 161 return -1;
va009039 1:eb30547ba84d 162 }
va009039 1:eb30547ba84d 163
va009039 1:eb30547ba84d 164 int Semihost::sys_flen(uint32_t arg) // 0x0c
va009039 1:eb30547ba84d 165 {
va009039 1:eb30547ba84d 166 FILE* fp = reinterpret_cast<FILE*>(rd<uint32_t>(arg));
va009039 1:eb30547ba84d 167 return ftell(fp);
va009039 1:eb30547ba84d 168 }
va009039 1:eb30547ba84d 169
va009039 1:eb30547ba84d 170 int Semihost::sys_remove(uint32_t arg) // 0x0e
va009039 1:eb30547ba84d 171 {
va009039 1:eb30547ba84d 172
va009039 1:eb30547ba84d 173 char name[64];
va009039 1:eb30547ba84d 174 _build_name(name, sizeof(name), arg, arg+4);
va009039 1:eb30547ba84d 175 return remove(name);
va009039 1:eb30547ba84d 176 }
va009039 1:eb30547ba84d 177
va009039 1:eb30547ba84d 178 int Semihost::sys_rename(uint32_t arg) // 0x0f
va009039 1:eb30547ba84d 179 {
va009039 1:eb30547ba84d 180 char oldname[64];
va009039 1:eb30547ba84d 181 char newname[64];
va009039 1:eb30547ba84d 182 _build_name(oldname, sizeof(oldname), arg, arg+4);
va009039 1:eb30547ba84d 183 _build_name(newname, sizeof(newname), arg+8, arg+12);
va009039 1:eb30547ba84d 184 return rename(oldname, newname);
va009039 1:eb30547ba84d 185 }
va009039 1:eb30547ba84d 186
va009039 1:eb30547ba84d 187 int Semihost::sys_exit(uint32_t arg) // 0x18
va009039 1:eb30547ba84d 188 {
va009039 1:eb30547ba84d 189 _pc->printf("\n[semihost]EXIT!!!\n");
va009039 2:32e9437348ad 190 _pc->printf("r0=%08x r1=%08x r2=%08x r3=%08x\n",
va009039 2:32e9437348ad 191 _target->r0.read(),_target->r1.read(),_target->r2.read(),_target->r3.read());
va009039 2:32e9437348ad 192 _pc->printf("r4=%08x r5=%08x r6=%08x r7=%08x\n",
va009039 2:32e9437348ad 193 _target->r4.read(),_target->r5.read(),_target->r6.read(),_target->r7.read());
va009039 2:32e9437348ad 194 _pc->printf("sp=%08x lr=%08x pc=%08x xpsr=%08x\n",
va009039 2:32e9437348ad 195 _target->sp.read(),_target->lr.read(),_target->pc.read(),_target->xpsr.read());
va009039 1:eb30547ba84d 196 return -1;
va009039 1:eb30547ba84d 197 }
va009039 1:eb30547ba84d 198
va009039 1:eb30547ba84d 199 void Semihost::_build_name(char* buf, int size, uint32_t arg1, uint32_t arg2)
va009039 1:eb30547ba84d 200 {
va009039 1:eb30547ba84d 201 strcpy(buf, _dirpath);
va009039 1:eb30547ba84d 202 uint32_t p = rd<uint32_t>(arg1);
va009039 1:eb30547ba84d 203 int len = rd<uint32_t>(arg2);
va009039 1:eb30547ba84d 204 int pos = strlen(buf);
va009039 1:eb30547ba84d 205 if (buf[pos-1] != '/') {
va009039 1:eb30547ba84d 206 buf[pos++] = '/';
va009039 1:eb30547ba84d 207 buf[pos] = '\0';
va009039 1:eb30547ba84d 208 }
va009039 1:eb30547ba84d 209 for(int i = 0; i < len && pos < size-1; i++) {
va009039 1:eb30547ba84d 210 buf[pos++] = rd<uint8_t>(p++);
va009039 1:eb30547ba84d 211 }
va009039 1:eb30547ba84d 212 buf[pos] = '\0';
va009039 1:eb30547ba84d 213 }
va009039 1:eb30547ba84d 214
va009039 1:eb30547ba84d 215 int Semihost::usr_xffind(uint32_t arg) // 0x100
va009039 1:eb30547ba84d 216 {
va009039 1:eb30547ba84d 217 return -1;
va009039 1:eb30547ba84d 218 }
va009039 1:eb30547ba84d 219
va009039 1:eb30547ba84d 220 int Semihost::usr_uid(uint32_t arg) // 0x101
va009039 1:eb30547ba84d 221 {
va009039 2:32e9437348ad 222 uint32_t p = rd<uint32_t>(arg);
va009039 1:eb30547ba84d 223 uint32_t len = rd<uint32_t>(arg+4);
va009039 2:32e9437348ad 224 const char* uid = "101000000000000000000002F7F00000";
va009039 2:32e9437348ad 225 for(int i = 0; i < 32 && i < len; i++) {
va009039 2:32e9437348ad 226 wr<uint8_t>(p++, uid[i]);
va009039 1:eb30547ba84d 227 }
va009039 1:eb30547ba84d 228 return 0;
va009039 1:eb30547ba84d 229 }
va009039 1:eb30547ba84d 230
va009039 1:eb30547ba84d 231 int Semihost::usr_reset(uint32_t arg) // 0x102
va009039 1:eb30547ba84d 232 {
va009039 3:d7a7cde0bfb8 233 _target->SoftwareReset();
va009039 1:eb30547ba84d 234 _target->setup();
va009039 1:eb30547ba84d 235 return 0;
va009039 1:eb30547ba84d 236 }
va009039 1:eb30547ba84d 237
va009039 1:eb30547ba84d 238 int Semihost::usr_vbus(uint32_t arg) // 0x103
va009039 1:eb30547ba84d 239 {
va009039 1:eb30547ba84d 240 return -1;
va009039 1:eb30547ba84d 241 }
va009039 1:eb30547ba84d 242
va009039 1:eb30547ba84d 243 int Semihost::usr_powerdown(uint32_t arg) // 0x104
va009039 1:eb30547ba84d 244 {
va009039 1:eb30547ba84d 245 return -1;
va009039 1:eb30547ba84d 246 }
va009039 1:eb30547ba84d 247
va009039 1:eb30547ba84d 248 int Semihost::usr_disabledebug(uint32_t arg) // 0x105
va009039 1:eb30547ba84d 249 {
va009039 1:eb30547ba84d 250 return -1;
va009039 1:eb30547ba84d 251 }