1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
306
307
308
309
310
311
312
313
314
315
316
317
318
319
320
321
322
323
324
325
326
327
328
329
330
331
332
333
334
335
336
337
338
339
340
341
342
343
344
345
346
347
348
349
350
351
352
353
354
355
356
357
358
359
360
361
362
363
364
365
366
367
368
369
370
371
372
373
374
375
376
377
378
379
380
381
382
383
384
385
386
387
388
389
390
391
392
393
394
395
396
397
398
399
400
401
402
403
404
405
406
407
408
409
410
411
412
413
414
415
416
417
418
419
420
421
422
423
424
425
426
427
428
|
/**************************************************************************
*
* Copyright (c) 2013 Alcatel-Lucent
*
* Alcatel Lucent licenses this file to You under the Apache License,
* Version 2.0 (the "License"); you may not use this file except in
* compliance with the License. A copy of the License is contained the
* file LICENSE at the top level of this repository.
* You may also obtain a copy of the License at:
*
* http://www.apache.org/licenses/LICENSE-2.0
*
* Unless required by applicable law or agreed to in writing, software
* distributed under the License is distributed on an "AS IS" BASIS,
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
* See the License for the specific language governing permissions and
* limitations under the License.
*
**************************************************************************
*
* moncom.c:
*
* This function is used by the application to interface to code that
* is part of the monitor. A pointer to this function exists at some
* "well-known" address in the monitors space. This location must be
* known by the application (hence... "well-known").
*
* Original author: Ed Sutter (ed.sutter@alcatel-lucent.com)
*
*/
#include "config.h"
#include "monlib.h"
#include "genlib.h"
#include "stddefs.h"
#include "tfs.h"
#include "tfsprivate.h"
#include "monflags.h"
#include "pci.h"
#include "i2c.h"
#include "ether.h"
#include "flash.h"
#include "date.h"
#include "timer.h"
extern int addcommand(struct monCommand *cmdlist, char *cmdlvl);
extern int profiler(void *);
static int moncom_pcnt;
int monErrorStub(void);
int
moncom(int cmd, void *arg1, void *arg2, void *arg3)
{
int retval;
/* eliminate warnings due to arg2 & arg3 not being used...
*/
if(arg2 == arg3) {
retval = 0;
} else {
retval = 0;
}
switch(cmd) {
case GETMONFUNC_PUTCHAR:
*(unsigned long *)arg1 = (unsigned long)putchar;
break;
case GETMONFUNC_GETCHAR:
*(unsigned long *)arg1 = (unsigned long)getchar;
break;
case GETMONFUNC_GOTACHAR:
*(unsigned long *)arg1 = (unsigned long)gotachar;
break;
case GETMONFUNC_GETBYTES:
*(unsigned long *)arg1 = (unsigned long)getbytes;
break;
case GETMONFUNC_PRINTF:
*(unsigned long *)arg1 = (unsigned long)printf;
break;
case GETMONFUNC_CPRINTF:
*(unsigned long *)arg1 = (unsigned long)cprintf;
break;
case GETMONFUNC_SPRINTF:
*(unsigned long *)arg1 = (unsigned long)sprintf;
break;
case GETMONFUNC_RESTART:
*(unsigned long *)arg1 = (unsigned long)monrestart;
break;
case GETMONFUNC_GETENV:
*(unsigned long *)arg1 = (unsigned long)getenv;
break;
case GETMONFUNC_SETENV:
*(unsigned long *)arg1 = (unsigned long)setenv;
break;
#if !INCLUDE_TFS
case GETMONFUNC_TFSINIT:
case GETMONFUNC_TFSADD:
case GETMONFUNC_TFSUNLINK:
case GETMONFUNC_TFSRUN:
case GETMONFUNC_TFSNEXT:
case GETMONFUNC_TFSFSTAT:
case GETMONFUNC_TFSTRUNCATE:
case GETMONFUNC_TFSEOF:
case GETMONFUNC_TFSSTAT:
case GETMONFUNC_TFSREAD:
case GETMONFUNC_TFSWRITE:
case GETMONFUNC_TFSOPEN:
case GETMONFUNC_TFSCLOSE:
case GETMONFUNC_TFSSEEK:
case GETMONFUNC_TFSGETLINE:
case GETMONFUNC_TFSIPMOD:
case GETMONFUNC_TFSCTRL:
case GETMONFUNC_TFSLINK:
case GETMONFUNC_TFSTELL:
#endif
#if !INCLUDE_UNZIP
case GETMONFUNC_DECOMPRESS:
#endif
#if !INCLUDE_MALLOC
case GETMONFUNC_MALLOC:
case GETMONFUNC_FREE:
case GETMONFUNC_HEAPXTEND:
#endif
#if !INCLUDE_PROFILER
case GETMONFUNC_PROFILER:
#endif
#if !INCLUDE_BBC
case GETMONFUNC_BBC:
#endif
#if !INCLUDE_MEMTRACE
case GETMONFUNC_MEMTRACE:
#endif
#if !INCLUDE_ETHERNET
case GETMONFUNC_SENDENETPKT:
case GETMONFUNC_RECVENETPKT:
#endif
#if !INCLUDE_ETHERVERBOSE
case GETMONFUNC_PRINTPKT:
#endif
#if !INCLUDE_FLASH
case GETMONFUNC_FLASHWRITE:
case GETMONFUNC_FLASHERASE:
case GETMONFUNC_FLASHINFO:
case GETMONFUNC_FLASHOVRRD:
#endif
#if !INCLUDE_PORTCMD
case GETMONFUNC_PORTCMD:
#endif
#ifndef ALLOW_HANDLER_ASSIGNMENT
case GETMONFUNC_ASSIGNHDLR:
#endif
#ifndef NO_MONLIB_PCI_STUBS
case GETMONFUNC_PCICFGREAD:
case GETMONFUNC_PCICFGWRITE:
case GETMONFUNC_PCICONTROL:
#endif
#ifndef NO_MONLIB_I2C_STUBS
case GETMONFUNC_I2CWRITE:
case GETMONFUNC_I2CREAD:
case GETMONFUNC_I2CCONTROL:
#endif
#if !INCLUDE_TIMEOFDAY
case GETMONFUNC_TIMEOFDAY:
#endif
#if !INCLUDE_SHELLVARS
case GETMONFUNC_GETARGV:
#endif
case GETMONFUNC_PIOGET: /* As of uMon 1.0, these are */
case GETMONFUNC_PIOSET: /* no longer supported. */
case GETMONFUNC_PIOCLR:
*(unsigned long *)arg1 = (unsigned long)monErrorStub;
break;
#if INCLUDE_TFS
case GETMONFUNC_TFSINIT:
*(unsigned long *)arg1 = (unsigned long)tfsinit;
break;
case GETMONFUNC_TFSADD:
*(unsigned long *)arg1 = (unsigned long)tfsadd;
break;
case GETMONFUNC_TFSUNLINK:
*(unsigned long *)arg1 = (unsigned long)tfsunlink;
break;
case GETMONFUNC_TFSRUN:
*(unsigned long *)arg1 = (unsigned long)tfsrun;
break;
case GETMONFUNC_TFSNEXT:
*(unsigned long *)arg1 = (unsigned long)tfsnext;
break;
case GETMONFUNC_TFSFSTAT:
*(unsigned long *)arg1 = (unsigned long)tfsfstat;
break;
case GETMONFUNC_TFSTRUNCATE:
*(unsigned long *)arg1 = (unsigned long)tfstruncate;
break;
case GETMONFUNC_TFSEOF:
*(unsigned long *)arg1 = (unsigned long)tfseof;
break;
case GETMONFUNC_TFSSTAT:
*(unsigned long *)arg1 = (unsigned long)tfsstat;
break;
case GETMONFUNC_TFSREAD:
*(unsigned long *)arg1 = (unsigned long)tfsread;
break;
case GETMONFUNC_TFSWRITE:
*(unsigned long *)arg1 = (unsigned long)tfswrite;
break;
case GETMONFUNC_TFSOPEN:
*(unsigned long *)arg1 = (unsigned long)tfsopen;
break;
case GETMONFUNC_TFSCLOSE:
*(unsigned long *)arg1 = (unsigned long)tfsclose;
break;
case GETMONFUNC_TFSSEEK:
*(unsigned long *)arg1 = (unsigned long)tfsseek;
break;
case GETMONFUNC_TFSGETLINE:
*(unsigned long *)arg1 = (unsigned long)tfsgetline;
break;
case GETMONFUNC_TFSIPMOD:
*(unsigned long *)arg1 = (unsigned long)tfsipmod;
break;
case GETMONFUNC_TFSCTRL:
*(unsigned long *)arg1 = (unsigned long)tfsctrl;
break;
case GETMONFUNC_TFSLINK:
*(unsigned long *)arg1 = (unsigned long)tfslink;
break;
case GETMONFUNC_TFSTELL:
*(unsigned long *)arg1 = (unsigned long)tfstell;
break;
#endif
#if INCLUDE_UNZIP
case GETMONFUNC_DECOMPRESS:
*(unsigned long *)arg1 = (unsigned long)decompress;
break;
#endif
#if INCLUDE_MALLOC
case GETMONFUNC_MALLOC:
*(unsigned long *)arg1 = (unsigned long)malloc;
break;
case GETMONFUNC_FREE:
*(unsigned long *)arg1 = (unsigned long)free;
break;
case GETMONFUNC_HEAPXTEND:
*(unsigned long *)arg1 = (unsigned long)extendHeap;
break;
#endif
#if INCLUDE_PROFILER
case GETMONFUNC_PROFILER:
*(unsigned long *)arg1 = (unsigned long)profiler;
break;
#endif
#if INCLUDE_BBC
case GETMONFUNC_BBC:
*(unsigned long *)arg1 = (unsigned long)bbc;
break;
#endif
#if INCLUDE_MEMTRACE
case GETMONFUNC_MEMTRACE:
*(unsigned long *)arg1 = (unsigned long)Mtrace;
break;
#endif
#if INCLUDE_ETHERNET
case GETMONFUNC_SENDENETPKT:
*(unsigned long *)arg1 = (unsigned long)monSendEnetPkt;
break;
case GETMONFUNC_RECVENETPKT:
*(unsigned long *)arg1 = (unsigned long)monRecvEnetPkt;
break;
#endif
#if INCLUDE_ETHERVERBOSE
case GETMONFUNC_PRINTPKT:
*(unsigned long *)arg1 = (unsigned long)AppPrintPkt;
break;
#endif
#if INCLUDE_FLASH
case GETMONFUNC_FLASHOVRRD:
*(unsigned long *)arg1 = (unsigned long)FlashOpOverride;
break;
case GETMONFUNC_FLASHWRITE:
*(unsigned long *)arg1 = (unsigned long)AppFlashWrite;
break;
case GETMONFUNC_FLASHERASE:
*(unsigned long *)arg1 = (unsigned long)AppFlashErase;
break;
case GETMONFUNC_FLASHINFO:
*(unsigned long *)arg1 = (unsigned long)sectortoaddr;
break;
#endif
#if INCLUDE_PORTCMD
case GETMONFUNC_PORTCMD:
*(unsigned long *)arg1 = (unsigned long)portCmd;
break;
#endif
#ifdef ALLOW_HANDLER_ASSIGNMENT
case GETMONFUNC_ASSIGNHDLR:
*(unsigned long *)arg1 = (unsigned long)assign_handler;
break;
#endif
#ifdef NO_MONLIB_I2C_STUBS
case GETMONFUNC_I2CWRITE:
*(unsigned long *)arg1 = (unsigned long)i2cWrite;
break;
case GETMONFUNC_I2CREAD:
*(unsigned long *)arg1 = (unsigned long)i2cRead;
break;
case GETMONFUNC_I2CCONTROL:
*(unsigned long *)arg1 = (unsigned long)i2cCtrl;
break;
#endif
#ifdef NO_MONLIB_PCI_STUBS
case GETMONFUNC_PCICFGREAD:
*(unsigned long *)arg1 = (unsigned long)pciCfgRead;
break;
case GETMONFUNC_PCICFGWRITE:
*(unsigned long *)arg1 = (unsigned long)pciCfgWrite;
break;
case GETMONFUNC_PCICONTROL:
*(unsigned long *)arg1 = (unsigned long)pciCtrl;
break;
#endif
#if INCLUDE_TIMEOFDAY
case GETMONFUNC_TIMEOFDAY:
*(unsigned long *)arg1 = (unsigned long)timeofday;
break;
#endif
#if INCLUDE_SHELLVARS
case GETMONFUNC_GETARGV:
*(unsigned long *)arg1 = (unsigned long)getargv;
break;
#endif
case GETMONFUNC_ADDCOMMAND:
*(unsigned long *)arg1 = (unsigned long)addcommand;
break;
case GETMONFUNC_DOCOMMAND:
*(unsigned long *)arg1 = (unsigned long)docommand;
break;
case GETMONFUNC_CRC16:
*(unsigned long *)arg1 = (unsigned long)xcrc16;
break;
case GETMONFUNC_CRC32:
*(unsigned long *)arg1 = (unsigned long)crc32;
break;
case GETMONFUNC_INTSOFF:
*(unsigned long *)arg1 = (unsigned long)intsoff;
break;
case GETMONFUNC_INTSRESTORE:
*(unsigned long *)arg1 = (unsigned long)intsrestore;
break;
case GETMONFUNC_APPEXIT:
*(unsigned long *)arg1 = (unsigned long)appexit;
break;
case GETMONFUNC_GETLINE:
*(unsigned long *)arg1 = (unsigned long)getline;
break;
case GETMONFUNC_VERSION:
*(unsigned long *)arg1 = (unsigned long)monVersion;
break;
case GETMONFUNC_WARMSTART:
*(unsigned long *)arg1 = (unsigned long)AppWarmStart;
break;
case GETMONFUNC_MONDELAY:
*(unsigned long *)arg1 = (unsigned long)monDelay;
break;
case GETMONFUNC_GETENVP:
*(unsigned long *)arg1 = (unsigned long)getenvp;
break;
case GETMONFUNC_REALLOC:
*(unsigned long *)arg1 = (unsigned long)realloc;
break;
case GETMONFUNC_GETSYM:
*(unsigned long *)arg1 = (unsigned long)getsym;
break;
case GETMONFUNC_WATCHDOG:
*(unsigned long *)arg1 = (unsigned long)monWatchDog;
break;
case GETMONFUNC_PRINTMEM:
*(unsigned long *)arg1 = (unsigned long)printMem;
break;
case GETMONFUNC_TIMER:
*(unsigned long *)arg1 = (unsigned long)monTimer;
break;
case CACHEFTYPE_DFLUSH:
dcacheFlush = (int(*)(char *,int))arg1;
break;
case CACHEFTYPE_IINVALIDATE:
icacheInvalidate = (int(*)(char *,int))arg1;
break;
case CHARFUNC_PUTCHAR:
remoteputchar = (int(*)(int))arg1;
break;
case CHARFUNC_GETCHAR:
remotegetchar = (int(*)(void))arg1;
break;
case CHARFUNC_GOTACHAR:
remotegotachar = (int(*)(void))arg1;
break;
case CHARFUNC_RAWMODEON:
remoterawon = (int(*)(void))arg1;
break;
case CHARFUNC_RAWMODEOFF:
remoterawoff = (int(*)(void))arg1;
break;
case ASSIGNFUNC_GETUSERLEVEL:
extgetUsrLvl = (int(*)(void))arg1;
break;
#ifdef WATCHDOG_ENABLED
case ASSIGNFUNC_WATCHDOG:
remoteWatchDog = (int(*)(void))arg1;
break;
#endif
default:
printf("moncom unknown command: 0x%x\n",cmd);
retval = -1;
break;
}
moncom_pcnt++;
return(retval);
}
int
monErrorStub(void)
{
printf("ERROR: Facility not included in monitor build\n");
return(-1);
}
|
