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@2:32e9437348ad, 2013-09-05 (annotated)

Committer:
va009039
Date:
Thu Sep 05 09:34:12 2013 +0000
Revision:
2:32e9437348ad
Parent:
1:eb30547ba84d
Child:
3:d7a7cde0bfb8
bug fix sys_writec,sys_exit not resume.

Who changed what in which revision?

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