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@9:7e71c20c96e4, 2014-02-20 (annotated)

Committer:
va009039
Date:
Thu Feb 20 09:43:03 2014 +0000
Revision:
9:7e71c20c96e4
Parent:
4:5e4107edcbdb
Child:
17:4e1205ce031f
update ramdisk

Who changed what in which revision?

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