Wim van der Vegt / CMDB

A Command Interpreter with support for used defined commands, subsystems, macros, help and parameter parsing.

cmdb.cpp@7:269c2445b8f5, 2011-02-11 (annotated)

Committer:
wvd_vegt
Date:
Fri Feb 11 10:26:33 2011 +0000
Revision:
7:269c2445b8f5
Parent:
6:76b033971c3c
Child:
8:83edd6addbd5
Version 0.7

Who changed what in which revision?

UserRevisionLine numberNew contents of line
wvd_vegt 6:76b033971c3c 1 /*
wvd_vegt 6:76b033971c3c 2 _____________________________________________________________________________
wvd_vegt 6:76b033971c3c 3
wvd_vegt 6:76b033971c3c 4 Project: mBed Command Interpreter
wvd_vegt 6:76b033971c3c 5 Filename: cmdb.h
wvd_vegt 6:76b033971c3c 6 Version: 0.5.0
wvd_vegt 6:76b033971c3c 7 _____________________________________________________________________________
wvd_vegt 6:76b033971c3c 8 Date Comment
wvd_vegt 6:76b033971c3c 9 -------- --------------------------------------------------------------
wvd_vegt 6:76b033971c3c 10 10022011 -Rewritten into C++ class.
wvd_vegt 6:76b033971c3c 11 -Pass Serial into constructor for printf, putc and getc.
wvd_vegt 6:76b033971c3c 12 -CID_<subsystem> must be handled internally.
wvd_vegt 6:76b033971c3c 13 -Fixed a number of old Index/Id conflicts.
wvd_vegt 6:76b033971c3c 14 -Got a working version. Much work to be done though.
wvd_vegt 6:76b033971c3c 15 -Handle CID_HELP internally (like all system commands (IDLE/MACRO etc).
wvd_vegt 6:76b033971c3c 16 -Defined CID_LAST as Vector Size or Last Command Id fails.
wvd_vegt 7:269c2445b8f5 17 -Removed CMD_TBL_LEN.
wvd_vegt 7:269c2445b8f5 18 -CID_LAST is now defined as CID_HELP+1.
wvd_vegt 7:269c2445b8f5 19 -Added Documentation.
wvd_vegt 7:269c2445b8f5 20 -Added code to take number limits from the C++ Runtime instead of hard defined values.
wvd_vegt 7:269c2445b8f5 21 -Renamed id to cid in cmd.
wvd_vegt 7:269c2445b8f5 22 -Added MAX_LONG and MIN_LONG (long==int on mbed).
wvd_vegt 7:269c2445b8f5 23 -Removed cmdb_ prefix from members.
wvd_vegt 6:76b033971c3c 24 -------- --------------------------------------------------------------
wvd_vegt 6:76b033971c3c 25 TODO's
wvd_vegt 7:269c2445b8f5 26 10022011 -Tweak and Review Documentation.
wvd_vegt 7:269c2445b8f5 27 11022011 -Check & Test **PARM masks.
wvd_vegt 7:269c2445b8f5 28 -Remove prefix from class members?
wvd_vegt 6:76b033971c3c 29 -------- --------------------------------------------------------------
wvd_vegt 6:76b033971c3c 30 _____________________________________________________________________________
wvd_vegt 6:76b033971c3c 31 */
wvd_vegt 6:76b033971c3c 32
wvd_vegt 3:abbf43fab7d5 33 #include <vector>
wvd_vegt 3:abbf43fab7d5 34 #include <stdlib.h>
wvd_vegt 3:abbf43fab7d5 35 #include <stdio.h>
wvd_vegt 3:abbf43fab7d5 36 #include <stdarg.h>
wvd_vegt 3:abbf43fab7d5 37 #include <ctype.h>
wvd_vegt 3:abbf43fab7d5 38 #include <string.h>
wvd_vegt 3:abbf43fab7d5 39
wvd_vegt 3:abbf43fab7d5 40 #include "cmdb.h"
wvd_vegt 3:abbf43fab7d5 41 #include "mbed.h"
wvd_vegt 3:abbf43fab7d5 42
wvd_vegt 7:269c2445b8f5 43 //------------------------------------------------------------------------------
wvd_vegt 7:269c2445b8f5 44
wvd_vegt 7:269c2445b8f5 45 Cmdb::Cmdb(const Serial& serial, const std::vector<cmd>& cmds, void (*callback)(Cmdb&,int)) :
wvd_vegt 7:269c2445b8f5 46 serial(serial), cmds(cmds) {
wvd_vegt 3:abbf43fab7d5 47 echo = true;
wvd_vegt 3:abbf43fab7d5 48 bold = true;
wvd_vegt 7:269c2445b8f5 49
wvd_vegt 3:abbf43fab7d5 50 subsystem = -1;
wvd_vegt 3:abbf43fab7d5 51
wvd_vegt 7:269c2445b8f5 52 callback = callback;
wvd_vegt 6:76b033971c3c 53
wvd_vegt 7:269c2445b8f5 54 init(true);
wvd_vegt 3:abbf43fab7d5 55 }
wvd_vegt 3:abbf43fab7d5 56
wvd_vegt 7:269c2445b8f5 57 //------------------------------------------------------------------------------
wvd_vegt 7:269c2445b8f5 58 // Public Stuff.
wvd_vegt 7:269c2445b8f5 59 //------------------------------------------------------------------------------
wvd_vegt 7:269c2445b8f5 60
wvd_vegt 7:269c2445b8f5 61 bool Cmdb::macro_hasnext() {
wvd_vegt 3:abbf43fab7d5 62 return macro_ptr!=-1 && macro_ptr<MAX_CMD_LEN && macro_buf[macro_ptr];
wvd_vegt 3:abbf43fab7d5 63 }
wvd_vegt 3:abbf43fab7d5 64
wvd_vegt 7:269c2445b8f5 65 char Cmdb::macro_next() {
wvd_vegt 3:abbf43fab7d5 66 char ch = macro_buf[macro_ptr++];
wvd_vegt 6:76b033971c3c 67
wvd_vegt 3:abbf43fab7d5 68 if (macro_ptr==MAX_CMD_LEN) {
wvd_vegt 7:269c2445b8f5 69 macro_reset();
wvd_vegt 3:abbf43fab7d5 70 }
wvd_vegt 6:76b033971c3c 71
wvd_vegt 3:abbf43fab7d5 72 return ch;
wvd_vegt 3:abbf43fab7d5 73 }
wvd_vegt 3:abbf43fab7d5 74
wvd_vegt 7:269c2445b8f5 75 char Cmdb::macro_peek() {
wvd_vegt 3:abbf43fab7d5 76 return macro_buf[macro_ptr];
wvd_vegt 3:abbf43fab7d5 77 }
wvd_vegt 3:abbf43fab7d5 78
wvd_vegt 7:269c2445b8f5 79 void Cmdb::macro_reset() {
wvd_vegt 3:abbf43fab7d5 80 macro_ptr = -1;
wvd_vegt 3:abbf43fab7d5 81 macro_buf[0] = '\0';
wvd_vegt 3:abbf43fab7d5 82 }
wvd_vegt 3:abbf43fab7d5 83
wvd_vegt 7:269c2445b8f5 84 //------------------------------------------------------------------------------
wvd_vegt 7:269c2445b8f5 85
wvd_vegt 7:269c2445b8f5 86 bool Cmdb::hasnext() {
wvd_vegt 7:269c2445b8f5 87 return serial.readable()==1;
wvd_vegt 7:269c2445b8f5 88 }
wvd_vegt 7:269c2445b8f5 89
wvd_vegt 7:269c2445b8f5 90 char Cmdb::next() {
wvd_vegt 7:269c2445b8f5 91 return serial.getc();
wvd_vegt 3:abbf43fab7d5 92 }
wvd_vegt 3:abbf43fab7d5 93
wvd_vegt 7:269c2445b8f5 94 //------------------------------------------------------------------------------
wvd_vegt 7:269c2445b8f5 95
wvd_vegt 7:269c2445b8f5 96 bool Cmdb::scan(const char c) {
wvd_vegt 7:269c2445b8f5 97 int i;
wvd_vegt 7:269c2445b8f5 98
wvd_vegt 7:269c2445b8f5 99 //See http://www.interfacebus.com/ASCII_Table.html
wvd_vegt 7:269c2445b8f5 100
wvd_vegt 7:269c2445b8f5 101 if (c == '\r') { // cr?
wvd_vegt 7:269c2445b8f5 102 print(crlf); // Output it and ...
wvd_vegt 7:269c2445b8f5 103 if (cmdndx) {
wvd_vegt 7:269c2445b8f5 104 strncpy(lstbuf,cmdbuf,cmdndx);
wvd_vegt 7:269c2445b8f5 105 lstbuf[cmdndx]='\0';
wvd_vegt 7:269c2445b8f5 106
wvd_vegt 7:269c2445b8f5 107 cmd_dispatcher(cmdbuf);
wvd_vegt 7:269c2445b8f5 108 }
wvd_vegt 7:269c2445b8f5 109 init(false);
wvd_vegt 7:269c2445b8f5 110 prompt();
wvd_vegt 7:269c2445b8f5 111
wvd_vegt 7:269c2445b8f5 112 return true;
wvd_vegt 7:269c2445b8f5 113 }
wvd_vegt 7:269c2445b8f5 114
wvd_vegt 7:269c2445b8f5 115 //TODO BACKSPACE NOT CORRECT FOR TELNET!
wvd_vegt 7:269c2445b8f5 116
wvd_vegt 7:269c2445b8f5 117 if (c == '\b') { // Backspace
wvd_vegt 7:269c2445b8f5 118 if (cmdndx != 0) {
wvd_vegt 7:269c2445b8f5 119 print(bs);
wvd_vegt 7:269c2445b8f5 120 cmdbuf [--cmdndx] = '\0';
wvd_vegt 7:269c2445b8f5 121 } else {
wvd_vegt 7:269c2445b8f5 122 printch(bell); // Output Error
wvd_vegt 7:269c2445b8f5 123 }
wvd_vegt 7:269c2445b8f5 124 return false;
wvd_vegt 7:269c2445b8f5 125 }
wvd_vegt 7:269c2445b8f5 126
wvd_vegt 7:269c2445b8f5 127 if (c == '\177') { // Delete
wvd_vegt 7:269c2445b8f5 128 while (cmdndx>0) {
wvd_vegt 7:269c2445b8f5 129 print(bs);
wvd_vegt 7:269c2445b8f5 130 cmdbuf [--cmdndx] = '\0';
wvd_vegt 7:269c2445b8f5 131 }
wvd_vegt 7:269c2445b8f5 132 return false;
wvd_vegt 7:269c2445b8f5 133 }
wvd_vegt 7:269c2445b8f5 134
wvd_vegt 7:269c2445b8f5 135 //Reset Escape Buffer.
wvd_vegt 7:269c2445b8f5 136 if (c == '\033') {
wvd_vegt 7:269c2445b8f5 137 if (escndx!=0) {
wvd_vegt 7:269c2445b8f5 138 //_putchar(bell); // Output Error
wvd_vegt 7:269c2445b8f5 139 //printf("%s\r\n",escbuf);
wvd_vegt 7:269c2445b8f5 140 }
wvd_vegt 7:269c2445b8f5 141 escndx = 0;
wvd_vegt 7:269c2445b8f5 142 escbuf [escndx] = '\0'; // NULL-Terminate buffer
wvd_vegt 7:269c2445b8f5 143 }
wvd_vegt 7:269c2445b8f5 144
wvd_vegt 7:269c2445b8f5 145 //Extract Escape Sequence.
wvd_vegt 7:269c2445b8f5 146 if (c == '\033' || escndx ) { // Wait for escape
wvd_vegt 7:269c2445b8f5 147 escbuf [escndx++] = (unsigned char) c; // Add to the buffer
wvd_vegt 7:269c2445b8f5 148 escbuf [escndx] = '\0'; // NULL-Terminate buffer
wvd_vegt 7:269c2445b8f5 149 if (isalpha(c)) {
wvd_vegt 7:269c2445b8f5 150 switch (escid_search(escbuf)) {
wvd_vegt 7:269c2445b8f5 151 case EID_CURSOR_LEFT : {
wvd_vegt 7:269c2445b8f5 152 if (cmdndx != 0) { // Backspace?
wvd_vegt 7:269c2445b8f5 153 print(bs);
wvd_vegt 7:269c2445b8f5 154 cmdbuf [--cmdndx] = '\0';
wvd_vegt 7:269c2445b8f5 155 } else {
wvd_vegt 7:269c2445b8f5 156 printch(bell); // Output char
wvd_vegt 7:269c2445b8f5 157 }
wvd_vegt 7:269c2445b8f5 158 break;
wvd_vegt 7:269c2445b8f5 159 }
wvd_vegt 7:269c2445b8f5 160 case EID_CURSOR_UP : {
wvd_vegt 7:269c2445b8f5 161 for (i=0;i<cmdndx;i++) {
wvd_vegt 7:269c2445b8f5 162 print(bs);
wvd_vegt 7:269c2445b8f5 163 }
wvd_vegt 7:269c2445b8f5 164 cmdndx=strlen(lstbuf);
wvd_vegt 7:269c2445b8f5 165 strncpy(cmdbuf,lstbuf,cmdndx);
wvd_vegt 7:269c2445b8f5 166 cmdbuf[cmdndx]='\0';
wvd_vegt 7:269c2445b8f5 167 printf("%s",cmdbuf);
wvd_vegt 7:269c2445b8f5 168 break;
wvd_vegt 7:269c2445b8f5 169 }
wvd_vegt 7:269c2445b8f5 170 case EID_CURSOR_RIGHT:
wvd_vegt 7:269c2445b8f5 171 break;
wvd_vegt 7:269c2445b8f5 172 case EID_CURSOR_DOWN :
wvd_vegt 7:269c2445b8f5 173 break;
wvd_vegt 7:269c2445b8f5 174 case EID_LAST :
wvd_vegt 7:269c2445b8f5 175 break;
wvd_vegt 7:269c2445b8f5 176 default :
wvd_vegt 7:269c2445b8f5 177 printch(bell);
wvd_vegt 7:269c2445b8f5 178 break;
wvd_vegt 7:269c2445b8f5 179 }
wvd_vegt 7:269c2445b8f5 180 escndx=0;
wvd_vegt 7:269c2445b8f5 181 escbuf [escndx] = '\0'; // NULL-Terminate buffer
wvd_vegt 7:269c2445b8f5 182 }
wvd_vegt 7:269c2445b8f5 183 return false;
wvd_vegt 7:269c2445b8f5 184 }
wvd_vegt 7:269c2445b8f5 185
wvd_vegt 7:269c2445b8f5 186 if (c=='\n') { // LF
wvd_vegt 7:269c2445b8f5 187 return false; // Dump it
wvd_vegt 7:269c2445b8f5 188 }
wvd_vegt 7:269c2445b8f5 189
wvd_vegt 7:269c2445b8f5 190 if (!isprint (c)) { // Printable character?
wvd_vegt 7:269c2445b8f5 191 printch(bell);
wvd_vegt 7:269c2445b8f5 192 return false;
wvd_vegt 7:269c2445b8f5 193 }
wvd_vegt 7:269c2445b8f5 194
wvd_vegt 7:269c2445b8f5 195 if (cmdndx >= MAX_CMD_LEN) { // Past buffer length?
wvd_vegt 7:269c2445b8f5 196 printch(bell);
wvd_vegt 7:269c2445b8f5 197 return false;
wvd_vegt 7:269c2445b8f5 198 }
wvd_vegt 7:269c2445b8f5 199
wvd_vegt 7:269c2445b8f5 200 cmdbuf [cmdndx++] = (unsigned char) c; // Add to the buffer
wvd_vegt 7:269c2445b8f5 201 cmdbuf [cmdndx] = '\0'; // NULL-Terminate buffer
wvd_vegt 7:269c2445b8f5 202
wvd_vegt 7:269c2445b8f5 203 if (echo) {
wvd_vegt 7:269c2445b8f5 204 printch(c); // Output char
wvd_vegt 7:269c2445b8f5 205 }
wvd_vegt 7:269c2445b8f5 206
wvd_vegt 7:269c2445b8f5 207 return false;
wvd_vegt 3:abbf43fab7d5 208 }
wvd_vegt 3:abbf43fab7d5 209
wvd_vegt 7:269c2445b8f5 210 //------------------------------------------------------------------------------
wvd_vegt 7:269c2445b8f5 211
wvd_vegt 7:269c2445b8f5 212 int Cmdb::printf(const char *format, ...) {
wvd_vegt 7:269c2445b8f5 213 int cnt;
wvd_vegt 7:269c2445b8f5 214
wvd_vegt 7:269c2445b8f5 215 va_list args;
wvd_vegt 7:269c2445b8f5 216 char buf[1024];
wvd_vegt 7:269c2445b8f5 217
wvd_vegt 7:269c2445b8f5 218 memset(buf,'\0',sizeof(buf));
wvd_vegt 7:269c2445b8f5 219
wvd_vegt 7:269c2445b8f5 220 va_start(args, format);
wvd_vegt 7:269c2445b8f5 221 cnt = vsnprintf(buf, sizeof(buf), format, args);
wvd_vegt 7:269c2445b8f5 222 if (cnt==-1) {
wvd_vegt 7:269c2445b8f5 223 //Error
wvd_vegt 7:269c2445b8f5 224 }
wvd_vegt 7:269c2445b8f5 225 va_end(args);
wvd_vegt 7:269c2445b8f5 226
wvd_vegt 7:269c2445b8f5 227 return print(buf);
wvd_vegt 7:269c2445b8f5 228 }
wvd_vegt 7:269c2445b8f5 229
wvd_vegt 7:269c2445b8f5 230 int Cmdb::print(const char *msg) {
wvd_vegt 7:269c2445b8f5 231 return serial.printf(msg);
wvd_vegt 7:269c2445b8f5 232 }
wvd_vegt 7:269c2445b8f5 233
wvd_vegt 7:269c2445b8f5 234 char Cmdb::printch(const char ch) {
wvd_vegt 7:269c2445b8f5 235 return serial.putc(ch);
wvd_vegt 7:269c2445b8f5 236 }
wvd_vegt 3:abbf43fab7d5 237
wvd_vegt 7:269c2445b8f5 238 //------------------------------------------------------------------------------
wvd_vegt 7:269c2445b8f5 239
wvd_vegt 7:269c2445b8f5 240 void Cmdb::init(const char full) {
wvd_vegt 7:269c2445b8f5 241 if (full) {
wvd_vegt 7:269c2445b8f5 242 echo = true;
wvd_vegt 7:269c2445b8f5 243 bold = true;
wvd_vegt 7:269c2445b8f5 244
wvd_vegt 7:269c2445b8f5 245 subsystem = -1;
wvd_vegt 7:269c2445b8f5 246
wvd_vegt 7:269c2445b8f5 247 lstbuf [cmdndx] = '\0';
wvd_vegt 7:269c2445b8f5 248
wvd_vegt 7:269c2445b8f5 249 macro_reset();
wvd_vegt 7:269c2445b8f5 250
wvd_vegt 7:269c2445b8f5 251 prompt();
wvd_vegt 7:269c2445b8f5 252 }
wvd_vegt 7:269c2445b8f5 253
wvd_vegt 7:269c2445b8f5 254 cmdndx = 0;
wvd_vegt 7:269c2445b8f5 255 cmdbuf [cmdndx] = '\0';
wvd_vegt 7:269c2445b8f5 256
wvd_vegt 7:269c2445b8f5 257 escndx = 0;
wvd_vegt 7:269c2445b8f5 258 escbuf [escndx] = '\0';
wvd_vegt 7:269c2445b8f5 259 }
wvd_vegt 7:269c2445b8f5 260
wvd_vegt 7:269c2445b8f5 261 //------------------------------------------------------------------------------
wvd_vegt 7:269c2445b8f5 262 //Private Stuff.
wvd_vegt 7:269c2445b8f5 263 //------------------------------------------------------------------------------
wvd_vegt 7:269c2445b8f5 264
wvd_vegt 7:269c2445b8f5 265 int Cmdb::escid_search(char *escstr) {
wvd_vegt 3:abbf43fab7d5 266 for (int i=0; i<ESC_TBL_LEN; i++) {
wvd_vegt 3:abbf43fab7d5 267 if (strcmp (esc_tbl[i].escstr, escstr) == 0)
wvd_vegt 3:abbf43fab7d5 268 return (esc_tbl[i].id);
wvd_vegt 3:abbf43fab7d5 269 }
wvd_vegt 3:abbf43fab7d5 270
wvd_vegt 3:abbf43fab7d5 271 return (EID_LAST);
wvd_vegt 3:abbf43fab7d5 272 }
wvd_vegt 3:abbf43fab7d5 273
wvd_vegt 7:269c2445b8f5 274 int Cmdb::cmdid_search(char *cmdstr) {
wvd_vegt 3:abbf43fab7d5 275 //Warning, we return the ID but somewhere assume it's equal to the array index!
wvd_vegt 7:269c2445b8f5 276 for (int i=0; i<cmds.size(); i++) {
wvd_vegt 7:269c2445b8f5 277 if ((stricmp(cmds[i].cmdstr, cmdstr) == 0) && ((cmds[i].subs == subsystem) || (cmds[i].subs<0)))
wvd_vegt 7:269c2445b8f5 278 return (cmds[i].cid);
wvd_vegt 3:abbf43fab7d5 279 }
wvd_vegt 3:abbf43fab7d5 280
wvd_vegt 6:76b033971c3c 281 return CID_LAST;
wvd_vegt 3:abbf43fab7d5 282 }
wvd_vegt 3:abbf43fab7d5 283
wvd_vegt 7:269c2445b8f5 284 int Cmdb::cmdid_index(int cmdid) {
wvd_vegt 7:269c2445b8f5 285 for (int i=0; i<cmds.size(); i++) {
wvd_vegt 7:269c2445b8f5 286 if (cmds[i].cid==cmdid)
wvd_vegt 3:abbf43fab7d5 287 return i;
wvd_vegt 3:abbf43fab7d5 288 }
wvd_vegt 3:abbf43fab7d5 289
wvd_vegt 3:abbf43fab7d5 290 return -1;
wvd_vegt 3:abbf43fab7d5 291 }
wvd_vegt 3:abbf43fab7d5 292
wvd_vegt 7:269c2445b8f5 293 //------------------------------------------------------------------------------
wvd_vegt 7:269c2445b8f5 294
wvd_vegt 7:269c2445b8f5 295 int Cmdb::parse(char *cmd) {
wvd_vegt 3:abbf43fab7d5 296 //Command
wvd_vegt 3:abbf43fab7d5 297 char cmdstr_buf [1 + MAX_CMD_LEN];
wvd_vegt 3:abbf43fab7d5 298
wvd_vegt 3:abbf43fab7d5 299 //Parameters
wvd_vegt 3:abbf43fab7d5 300 char argstr_buf [1 + MAX_CMD_LEN];
wvd_vegt 3:abbf43fab7d5 301 char *argsep;
wvd_vegt 3:abbf43fab7d5 302
wvd_vegt 3:abbf43fab7d5 303 char prmstr_buf [1 + MAX_CMD_LEN]; //copy of sscanf pattern
wvd_vegt 3:abbf43fab7d5 304 char *tok; //current token
wvd_vegt 3:abbf43fab7d5 305 void *toks[MAX_ARGS]; //pointers to string tokens IN commandline (argstr_buf)
wvd_vegt 3:abbf43fab7d5 306 char *prms[MAX_ARGS]; //patterns IN copy of sscanf string (*parms)
wvd_vegt 3:abbf43fab7d5 307
wvd_vegt 3:abbf43fab7d5 308 char typ = '\0'; //Var type
wvd_vegt 3:abbf43fab7d5 309 char mod = '\0'; //Var modifier (for cardinal types)
wvd_vegt 3:abbf43fab7d5 310 unsigned int base; //Var number base (8,10,16)
wvd_vegt 3:abbf43fab7d5 311 //unsigned int bytes; //Var size in bytes (used for malloc)
wvd_vegt 3:abbf43fab7d5 312
wvd_vegt 3:abbf43fab7d5 313 float f; //Temp var for conversion, 4 bytes
wvd_vegt 3:abbf43fab7d5 314 //unsigned char b; //Temp var for conversion, 1 byte
wvd_vegt 3:abbf43fab7d5 315 //char c; //Temp var for conversion, 1 byte
wvd_vegt 3:abbf43fab7d5 316 //short h; //Temp var for conversion, 2 bytes
wvd_vegt 3:abbf43fab7d5 317 //int k; //Temp var for conversion, 2 bytes
wvd_vegt 3:abbf43fab7d5 318 long l; //Temp var for conversion, 4 bytes
wvd_vegt 3:abbf43fab7d5 319
wvd_vegt 3:abbf43fab7d5 320 char* endptr; //strtoXX() Error detection
wvd_vegt 3:abbf43fab7d5 321
wvd_vegt 6:76b033971c3c 322 int cid = -1; //Signals empty string...
wvd_vegt 6:76b033971c3c 323 int ndx = -1;
wvd_vegt 3:abbf43fab7d5 324
wvd_vegt 3:abbf43fab7d5 325 //Init (global) variables.
wvd_vegt 3:abbf43fab7d5 326 argfnd=0;
wvd_vegt 3:abbf43fab7d5 327 argcnt=0;
wvd_vegt 3:abbf43fab7d5 328 error =0;
wvd_vegt 3:abbf43fab7d5 329
wvd_vegt 3:abbf43fab7d5 330 //Zero the two string buffers for splitting cmd string into.
wvd_vegt 3:abbf43fab7d5 331 zeromemory((char*)cmdstr_buf,sizeof(cmdstr_buf));
wvd_vegt 3:abbf43fab7d5 332 zeromemory(argstr_buf,sizeof(argstr_buf));
wvd_vegt 3:abbf43fab7d5 333
wvd_vegt 3:abbf43fab7d5 334 //Make it worse in Lint
wvd_vegt 6:76b033971c3c 335 for (int i=0;i<MAX_ARGS;i++) {
wvd_vegt 3:abbf43fab7d5 336 parms[i].type=PARM_UNUSED;
wvd_vegt 3:abbf43fab7d5 337 zeromemory((char*)&(parms[i].val),sizeof(parms[i].val));
wvd_vegt 3:abbf43fab7d5 338 }
wvd_vegt 3:abbf43fab7d5 339
wvd_vegt 3:abbf43fab7d5 340 /*------------------------------------------------
wvd_vegt 3:abbf43fab7d5 341 First, copy the command and convert it to all
wvd_vegt 3:abbf43fab7d5 342 uppercase.
wvd_vegt 3:abbf43fab7d5 343 ------------------------------------------------*/
wvd_vegt 3:abbf43fab7d5 344
wvd_vegt 3:abbf43fab7d5 345 strncpy(cmdstr_buf, cmd, sizeof (cmdstr_buf) - 1);
wvd_vegt 3:abbf43fab7d5 346 cmdstr_buf [sizeof (cmdstr_buf) - 1] = '\0';
wvd_vegt 3:abbf43fab7d5 347
wvd_vegt 3:abbf43fab7d5 348 /*------------------------------------------------
wvd_vegt 3:abbf43fab7d5 349 Next, find the end of the first thing in the
wvd_vegt 3:abbf43fab7d5 350 buffer. Since the command ends with a space,
wvd_vegt 3:abbf43fab7d5 351 we'll look for that. NULL-Terminate the command
wvd_vegt 3:abbf43fab7d5 352 and keep a pointer to the arguments.
wvd_vegt 3:abbf43fab7d5 353 ------------------------------------------------*/
wvd_vegt 3:abbf43fab7d5 354
wvd_vegt 3:abbf43fab7d5 355 argsep = strchr(cmdstr_buf, ' ');
wvd_vegt 3:abbf43fab7d5 356
wvd_vegt 3:abbf43fab7d5 357 if (argsep == NULL) {
wvd_vegt 3:abbf43fab7d5 358 argstr_buf [0] = '\0';
wvd_vegt 3:abbf43fab7d5 359 } else {
wvd_vegt 3:abbf43fab7d5 360 strcpy (argstr_buf, argsep + 1);
wvd_vegt 3:abbf43fab7d5 361 *argsep = '\0';
wvd_vegt 3:abbf43fab7d5 362 }
wvd_vegt 3:abbf43fab7d5 363
wvd_vegt 3:abbf43fab7d5 364 /*------------------------------------------------
wvd_vegt 6:76b033971c3c 365 Search for a command ID, then switch on it.
wvd_vegt 3:abbf43fab7d5 366 ------------------------------------------------*/
wvd_vegt 3:abbf43fab7d5 367
wvd_vegt 3:abbf43fab7d5 368 //1) Find the Command Id
wvd_vegt 7:269c2445b8f5 369 cid = cmdid_search(cmdstr_buf);
wvd_vegt 3:abbf43fab7d5 370
wvd_vegt 6:76b033971c3c 371 if (cid!=CID_LAST) {
wvd_vegt 3:abbf43fab7d5 372 //2) Tokenize a copy of the parms from the cmd_tbl.
wvd_vegt 3:abbf43fab7d5 373
wvd_vegt 7:269c2445b8f5 374 ndx = cmdid_index(cid);
wvd_vegt 6:76b033971c3c 375
wvd_vegt 3:abbf43fab7d5 376 //Get Format patterns from cmd_tbl[id].parms.
wvd_vegt 7:269c2445b8f5 377 //note: strtok inserts \0 into the original string. Hence the copy.
wvd_vegt 3:abbf43fab7d5 378 zeromemory((char *)(&prmstr_buf),sizeof(prmstr_buf));
wvd_vegt 3:abbf43fab7d5 379
wvd_vegt 7:269c2445b8f5 380 strncpy (prmstr_buf, cmds[ndx].parms, sizeof (prmstr_buf) - 1);
wvd_vegt 3:abbf43fab7d5 381
wvd_vegt 3:abbf43fab7d5 382 argcnt=0;
wvd_vegt 3:abbf43fab7d5 383 tok = strtok(prmstr_buf, " ");
wvd_vegt 3:abbf43fab7d5 384 while (tok != NULL) {
wvd_vegt 3:abbf43fab7d5 385 //Store Pointers
wvd_vegt 3:abbf43fab7d5 386 prms[argcnt++] = tok;
wvd_vegt 3:abbf43fab7d5 387
wvd_vegt 7:269c2445b8f5 388 //printf("prm_%2.2d='%s'\r\n",argcnt, tok);
wvd_vegt 3:abbf43fab7d5 389
wvd_vegt 3:abbf43fab7d5 390 tok = strtok(NULL, " ");
wvd_vegt 3:abbf43fab7d5 391 }
wvd_vegt 3:abbf43fab7d5 392
wvd_vegt 3:abbf43fab7d5 393 //3) Tokenize the commandline.
wvd_vegt 3:abbf43fab7d5 394
wvd_vegt 3:abbf43fab7d5 395 //Get Tokens from arguments.
wvd_vegt 3:abbf43fab7d5 396 //Note: strtok inserts \0 into the original string. Won't harm here as we do not re-use it.
wvd_vegt 3:abbf43fab7d5 397
wvd_vegt 3:abbf43fab7d5 398 argfnd=0;
wvd_vegt 3:abbf43fab7d5 399
wvd_vegt 3:abbf43fab7d5 400 if (strlen(argstr_buf)!=0) {
wvd_vegt 3:abbf43fab7d5 401 tok = strtok(argstr_buf, " ");
wvd_vegt 3:abbf43fab7d5 402 } else {
wvd_vegt 3:abbf43fab7d5 403 tok=NULL;
wvd_vegt 3:abbf43fab7d5 404 }
wvd_vegt 3:abbf43fab7d5 405
wvd_vegt 3:abbf43fab7d5 406 while (tok != NULL) {
wvd_vegt 3:abbf43fab7d5 407 //Store Pointers
wvd_vegt 3:abbf43fab7d5 408 toks[argfnd++]=tok;
wvd_vegt 3:abbf43fab7d5 409
wvd_vegt 7:269c2445b8f5 410 //printf("tok_%2.2d='%s'\r\n",argfnd, tok);
wvd_vegt 3:abbf43fab7d5 411
wvd_vegt 3:abbf43fab7d5 412 tok = strtok(NULL, " ");
wvd_vegt 3:abbf43fab7d5 413 }
wvd_vegt 3:abbf43fab7d5 414
wvd_vegt 6:76b033971c3c 415 if (argfnd==argcnt || (cid==CID_HELP && argfnd==0)) {
wvd_vegt 3:abbf43fab7d5 416
wvd_vegt 3:abbf43fab7d5 417 error = 0;
wvd_vegt 3:abbf43fab7d5 418
wvd_vegt 6:76b033971c3c 419 for (int i=0;i<argcnt;i++) {
wvd_vegt 7:269c2445b8f5 420 //printf("prm_%2.2d=%s\r\n",i, prms[i]);
wvd_vegt 3:abbf43fab7d5 421
wvd_vegt 3:abbf43fab7d5 422 switch (strlen(prms[i])) {
wvd_vegt 3:abbf43fab7d5 423 case 0:
wvd_vegt 3:abbf43fab7d5 424 break;
wvd_vegt 3:abbf43fab7d5 425 case 1:
wvd_vegt 3:abbf43fab7d5 426 break;
wvd_vegt 3:abbf43fab7d5 427 case 2: //Simple pattern, no modifier
wvd_vegt 3:abbf43fab7d5 428 mod='\0';
wvd_vegt 3:abbf43fab7d5 429 typ=prms[i][1];
wvd_vegt 3:abbf43fab7d5 430
wvd_vegt 3:abbf43fab7d5 431 break;
wvd_vegt 3:abbf43fab7d5 432 case 3: //pattern with Modifier.
wvd_vegt 3:abbf43fab7d5 433 mod=prms[i][1];
wvd_vegt 3:abbf43fab7d5 434 typ=prms[i][2];
wvd_vegt 3:abbf43fab7d5 435
wvd_vegt 3:abbf43fab7d5 436 break;
wvd_vegt 3:abbf43fab7d5 437 default:
wvd_vegt 3:abbf43fab7d5 438 break;
wvd_vegt 3:abbf43fab7d5 439 }
wvd_vegt 3:abbf43fab7d5 440
wvd_vegt 3:abbf43fab7d5 441 switch (typ) {
wvd_vegt 3:abbf43fab7d5 442 case 'o' :
wvd_vegt 3:abbf43fab7d5 443 base=8;
wvd_vegt 3:abbf43fab7d5 444 break;
wvd_vegt 3:abbf43fab7d5 445 case 'x' :
wvd_vegt 3:abbf43fab7d5 446 base=16;
wvd_vegt 3:abbf43fab7d5 447 break;
wvd_vegt 3:abbf43fab7d5 448 default:
wvd_vegt 3:abbf43fab7d5 449 base=10;
wvd_vegt 3:abbf43fab7d5 450 break;
wvd_vegt 3:abbf43fab7d5 451 }
wvd_vegt 3:abbf43fab7d5 452
wvd_vegt 3:abbf43fab7d5 453 endptr = (char*)toks[i];
wvd_vegt 3:abbf43fab7d5 454
wvd_vegt 3:abbf43fab7d5 455 //Cardinal Types
wvd_vegt 3:abbf43fab7d5 456 switch (typ) {
wvd_vegt 3:abbf43fab7d5 457 case 'd' : //Check mod
wvd_vegt 3:abbf43fab7d5 458 case 'i' : //Check mod
wvd_vegt 3:abbf43fab7d5 459 case 'u' : //Check mod
wvd_vegt 3:abbf43fab7d5 460 case 'o' : //Check mod
wvd_vegt 3:abbf43fab7d5 461 case 'x' : //Check mod
wvd_vegt 3:abbf43fab7d5 462 switch (mod) {
wvd_vegt 3:abbf43fab7d5 463 case 'b' : //char
wvd_vegt 3:abbf43fab7d5 464 //test range
wvd_vegt 3:abbf43fab7d5 465 l=strtol((char*)toks[i], &endptr, base);
wvd_vegt 3:abbf43fab7d5 466 if (l>=MIN_BYTE && l<=MAX_BYTE) {
wvd_vegt 3:abbf43fab7d5 467 parms[i].type=PARM_CHAR;
wvd_vegt 3:abbf43fab7d5 468 parms[i].val.uc =(unsigned char)l;
wvd_vegt 3:abbf43fab7d5 469 } else {
wvd_vegt 3:abbf43fab7d5 470 error = i+1;
wvd_vegt 3:abbf43fab7d5 471 }
wvd_vegt 3:abbf43fab7d5 472
wvd_vegt 3:abbf43fab7d5 473 break;
wvd_vegt 3:abbf43fab7d5 474 case 'h' : //short
wvd_vegt 3:abbf43fab7d5 475 l=strtol((char*)toks[i], &endptr, base);
wvd_vegt 3:abbf43fab7d5 476 if (l>=MIN_SHORT && l<=MAX_SHORT) {
wvd_vegt 3:abbf43fab7d5 477 parms[i].type=PARM_SHORT;
wvd_vegt 3:abbf43fab7d5 478 parms[i].val.w=(short)l;
wvd_vegt 3:abbf43fab7d5 479 } else {
wvd_vegt 3:abbf43fab7d5 480 error = i+1;
wvd_vegt 3:abbf43fab7d5 481 }
wvd_vegt 3:abbf43fab7d5 482
wvd_vegt 3:abbf43fab7d5 483 break;
wvd_vegt 3:abbf43fab7d5 484 case 'l' : //long
wvd_vegt 3:abbf43fab7d5 485 l=strtol((char*)toks[i], &endptr, base);
wvd_vegt 3:abbf43fab7d5 486 parms[i].type=PARM_LONG;
wvd_vegt 3:abbf43fab7d5 487 parms[i].val.l=l;
wvd_vegt 3:abbf43fab7d5 488
wvd_vegt 3:abbf43fab7d5 489 break;
wvd_vegt 7:269c2445b8f5 490 default: //int
wvd_vegt 3:abbf43fab7d5 491 l=strtol((char*)toks[i], &endptr, base);
wvd_vegt 3:abbf43fab7d5 492 if (l>=MIN_INT && l<=MAX_INT) {
wvd_vegt 3:abbf43fab7d5 493 parms[i].type=PARM_INT;
wvd_vegt 3:abbf43fab7d5 494 parms[i].val.l=(int)l;
wvd_vegt 3:abbf43fab7d5 495 } else {
wvd_vegt 3:abbf43fab7d5 496 error = i+1;
wvd_vegt 3:abbf43fab7d5 497 }
wvd_vegt 3:abbf43fab7d5 498 break;
wvd_vegt 3:abbf43fab7d5 499 }
wvd_vegt 3:abbf43fab7d5 500
wvd_vegt 3:abbf43fab7d5 501 if (error==0 &&
wvd_vegt 3:abbf43fab7d5 502 (endptr==toks[i] //No Conversion at all.
wvd_vegt 3:abbf43fab7d5 503 || *endptr)) { //Incomplete conversion.
wvd_vegt 3:abbf43fab7d5 504 error = i+1;
wvd_vegt 3:abbf43fab7d5 505 }
wvd_vegt 3:abbf43fab7d5 506
wvd_vegt 3:abbf43fab7d5 507 break;
wvd_vegt 3:abbf43fab7d5 508 }
wvd_vegt 3:abbf43fab7d5 509
wvd_vegt 3:abbf43fab7d5 510 //Floating Point Types
wvd_vegt 3:abbf43fab7d5 511 switch (typ) {
wvd_vegt 3:abbf43fab7d5 512 case 'e' :
wvd_vegt 3:abbf43fab7d5 513 case 'f' :
wvd_vegt 3:abbf43fab7d5 514 case 'g' :
wvd_vegt 3:abbf43fab7d5 515 f = strtod((char*)toks[i], &endptr);
wvd_vegt 3:abbf43fab7d5 516
wvd_vegt 3:abbf43fab7d5 517 parms[i].type=PARM_FLOAT;
wvd_vegt 3:abbf43fab7d5 518 parms[i].val.f=f;
wvd_vegt 3:abbf43fab7d5 519
wvd_vegt 3:abbf43fab7d5 520 if (error==0 &&
wvd_vegt 3:abbf43fab7d5 521 (endptr==toks[i] //No Conversion at all.
wvd_vegt 3:abbf43fab7d5 522 || *endptr)) { //Incomplete conversion.
wvd_vegt 3:abbf43fab7d5 523 error = i;
wvd_vegt 3:abbf43fab7d5 524 }
wvd_vegt 3:abbf43fab7d5 525
wvd_vegt 3:abbf43fab7d5 526 break;
wvd_vegt 3:abbf43fab7d5 527 }
wvd_vegt 3:abbf43fab7d5 528
wvd_vegt 3:abbf43fab7d5 529 //String types
wvd_vegt 3:abbf43fab7d5 530 switch (typ) {
wvd_vegt 3:abbf43fab7d5 531 case 'c' :
wvd_vegt 3:abbf43fab7d5 532 parms[i].type=PARM_CHAR;
wvd_vegt 3:abbf43fab7d5 533 parms[i].val.c=((char*)toks[i])[0];
wvd_vegt 3:abbf43fab7d5 534
wvd_vegt 3:abbf43fab7d5 535 if (error==0 && strlen((char*)toks[i])!=1) { //Incomplete conversion.
wvd_vegt 3:abbf43fab7d5 536 error = i;
wvd_vegt 3:abbf43fab7d5 537 }
wvd_vegt 3:abbf43fab7d5 538
wvd_vegt 3:abbf43fab7d5 539 break;
wvd_vegt 3:abbf43fab7d5 540
wvd_vegt 3:abbf43fab7d5 541 case 's' :
wvd_vegt 3:abbf43fab7d5 542 parms[i].type=PARM_STRING;
wvd_vegt 3:abbf43fab7d5 543 strncpy(parms[i].val.s,(char*)toks[i], strlen((char*)toks[i]));
wvd_vegt 3:abbf43fab7d5 544
wvd_vegt 3:abbf43fab7d5 545 break;
wvd_vegt 3:abbf43fab7d5 546 }
wvd_vegt 3:abbf43fab7d5 547 }
wvd_vegt 3:abbf43fab7d5 548 } else {
wvd_vegt 7:269c2445b8f5 549 cid=CID_LAST;
wvd_vegt 3:abbf43fab7d5 550 }
wvd_vegt 3:abbf43fab7d5 551 }
wvd_vegt 3:abbf43fab7d5 552
wvd_vegt 6:76b033971c3c 553 return cid;
wvd_vegt 3:abbf43fab7d5 554 }
wvd_vegt 3:abbf43fab7d5 555
wvd_vegt 7:269c2445b8f5 556 //------------------------------------------------------------------------------
wvd_vegt 7:269c2445b8f5 557
wvd_vegt 7:269c2445b8f5 558 void Cmdb::cmd_dispatcher(char *cmd) {
wvd_vegt 3:abbf43fab7d5 559 int cid;
wvd_vegt 3:abbf43fab7d5 560 int ndx;
wvd_vegt 3:abbf43fab7d5 561
wvd_vegt 7:269c2445b8f5 562 cid = parse(cmd);
wvd_vegt 7:269c2445b8f5 563 ndx = cmdid_index(cid);
wvd_vegt 3:abbf43fab7d5 564
wvd_vegt 3:abbf43fab7d5 565 if (cid!=-1) {
wvd_vegt 7:269c2445b8f5 566 //printf("cmds[%d]=%d\r\n",ndx, cid);
wvd_vegt 3:abbf43fab7d5 567
wvd_vegt 3:abbf43fab7d5 568 /*------------------------------------------------
wvd_vegt 3:abbf43fab7d5 569 Process the command and it's arguments that are
wvd_vegt 3:abbf43fab7d5 570 found. id contains the command id and argcnt &
wvd_vegt 3:abbf43fab7d5 571 argfnd the number of found and expected paramaters
wvd_vegt 3:abbf43fab7d5 572 parms contains the parsed argument values and their
wvd_vegt 3:abbf43fab7d5 573 types.
wvd_vegt 3:abbf43fab7d5 574 ------------------------------------------------*/
wvd_vegt 3:abbf43fab7d5 575
wvd_vegt 3:abbf43fab7d5 576 if (cid==CID_LAST) {
wvd_vegt 7:269c2445b8f5 577 print("Unknown command, type 'Help' for a list of available commands.\r\n");
wvd_vegt 3:abbf43fab7d5 578 } else {
wvd_vegt 7:269c2445b8f5 579 //printf("cmds[%d]=%d [%s]\r\n",ndx, cid, _cmds[ndx].cmdstr);
wvd_vegt 3:abbf43fab7d5 580
wvd_vegt 3:abbf43fab7d5 581 //Test for more commandline than allowed too.
wvd_vegt 3:abbf43fab7d5 582 //i.e. run 1 is wrong.
wvd_vegt 3:abbf43fab7d5 583
wvd_vegt 7:269c2445b8f5 584 if (argcnt==0 && argfnd==0 && error==0 && ndx!=-1 && cmds[ndx].subs==SUBSYSTEM) {
wvd_vegt 6:76b033971c3c 585 //Handle all SubSystems.
wvd_vegt 3:abbf43fab7d5 586 subsystem=cid;
wvd_vegt 3:abbf43fab7d5 587 } else if ( ((cid==CID_HELP) || (argcnt==argfnd)) && error==0 ) {
wvd_vegt 3:abbf43fab7d5 588 switch (cid) {
wvd_vegt 3:abbf43fab7d5 589
wvd_vegt 7:269c2445b8f5 590 #ifdef ENABLEMACROS
wvd_vegt 3:abbf43fab7d5 591 /////// GLOBAL MACRO COMMANDS ///////
wvd_vegt 3:abbf43fab7d5 592
wvd_vegt 3:abbf43fab7d5 593 //Define Macro from commandline
wvd_vegt 3:abbf43fab7d5 594 case CID_MACRO:
wvd_vegt 3:abbf43fab7d5 595 macro_ptr=-1;
wvd_vegt 3:abbf43fab7d5 596 strncpy(macro_buf, STRINGPARM(0), sizeof(macro_buf) - 1);
wvd_vegt 3:abbf43fab7d5 597 break;
wvd_vegt 3:abbf43fab7d5 598
wvd_vegt 3:abbf43fab7d5 599 //Run Macro
wvd_vegt 3:abbf43fab7d5 600 case CID_RUN:
wvd_vegt 3:abbf43fab7d5 601 macro_ptr=0;
wvd_vegt 3:abbf43fab7d5 602 break;
wvd_vegt 3:abbf43fab7d5 603
wvd_vegt 3:abbf43fab7d5 604 //List Macro's
wvd_vegt 3:abbf43fab7d5 605 case CID_MACROS:
wvd_vegt 7:269c2445b8f5 606 print("[Macro]\r\n");
wvd_vegt 3:abbf43fab7d5 607 if (macro_buf[0]) {
wvd_vegt 7:269c2445b8f5 608 printf("Value=%s\r\n",macro_buf);
wvd_vegt 3:abbf43fab7d5 609 } else {
wvd_vegt 7:269c2445b8f5 610 printf(";No Macro Defined\r\n");
wvd_vegt 3:abbf43fab7d5 611 }
wvd_vegt 3:abbf43fab7d5 612 break;
wvd_vegt 3:abbf43fab7d5 613
wvd_vegt 7:269c2445b8f5 614 #endif //ENABLEMACROS
wvd_vegt 3:abbf43fab7d5 615
wvd_vegt 3:abbf43fab7d5 616 #ifdef STATEMACHINE
wvd_vegt 7:269c2445b8f5 617 /////// GLOBAL STATEMACHINE COMMANDS ///////
wvd_vegt 3:abbf43fab7d5 618
wvd_vegt 3:abbf43fab7d5 619 //Start State Machine
wvd_vegt 3:abbf43fab7d5 620 case CID_STATE:
wvd_vegt 3:abbf43fab7d5 621 statemachine(BYTEPARM(0));
wvd_vegt 3:abbf43fab7d5 622
wvd_vegt 3:abbf43fab7d5 623 break;
wvd_vegt 3:abbf43fab7d5 624 #endif
wvd_vegt 3:abbf43fab7d5 625
wvd_vegt 3:abbf43fab7d5 626 /////// GLOBAL COMMANDS ///////
wvd_vegt 3:abbf43fab7d5 627
wvd_vegt 3:abbf43fab7d5 628 //Echo
wvd_vegt 3:abbf43fab7d5 629 case CID_ECHO:
wvd_vegt 3:abbf43fab7d5 630 echo = BOOLPARM(0);
wvd_vegt 3:abbf43fab7d5 631 break;
wvd_vegt 3:abbf43fab7d5 632
wvd_vegt 3:abbf43fab7d5 633 //Bold
wvd_vegt 3:abbf43fab7d5 634 case CID_BOLD:
wvd_vegt 3:abbf43fab7d5 635 bold = BOOLPARM(0);
wvd_vegt 3:abbf43fab7d5 636 break;
wvd_vegt 3:abbf43fab7d5 637
wvd_vegt 3:abbf43fab7d5 638 //Warm Boot
wvd_vegt 3:abbf43fab7d5 639 case CID_BOOT:
wvd_vegt 7:269c2445b8f5 640 mbed_reset();
wvd_vegt 3:abbf43fab7d5 641 break;
wvd_vegt 3:abbf43fab7d5 642
wvd_vegt 3:abbf43fab7d5 643 //Sends an ANSI escape code to clear the screen.
wvd_vegt 3:abbf43fab7d5 644 case CID_CLS:
wvd_vegt 7:269c2445b8f5 645 print(cls);
wvd_vegt 3:abbf43fab7d5 646 break;
wvd_vegt 3:abbf43fab7d5 647
wvd_vegt 3:abbf43fab7d5 648 //Returns to CMD> prompt where most commands are disabled.
wvd_vegt 3:abbf43fab7d5 649 case CID_IDLE:
wvd_vegt 3:abbf43fab7d5 650 subsystem=-1;
wvd_vegt 3:abbf43fab7d5 651 break;
wvd_vegt 3:abbf43fab7d5 652
wvd_vegt 3:abbf43fab7d5 653 //Help
wvd_vegt 3:abbf43fab7d5 654 case CID_HELP: {
wvd_vegt 7:269c2445b8f5 655 print("\r\n");
wvd_vegt 3:abbf43fab7d5 656
wvd_vegt 3:abbf43fab7d5 657 if (argfnd>0) {
wvd_vegt 7:269c2445b8f5 658 cid = cmdid_search(STRINGPARM(0));
wvd_vegt 3:abbf43fab7d5 659 } else {
wvd_vegt 3:abbf43fab7d5 660 cid=CID_LAST;
wvd_vegt 3:abbf43fab7d5 661 }
wvd_vegt 3:abbf43fab7d5 662
wvd_vegt 3:abbf43fab7d5 663 if (argfnd>0 && cid!=CID_LAST) {
wvd_vegt 3:abbf43fab7d5 664
wvd_vegt 3:abbf43fab7d5 665 //Help with a valid command as first parameter
wvd_vegt 7:269c2445b8f5 666 ndx = cmdid_index(cid);
wvd_vegt 7:269c2445b8f5 667
wvd_vegt 7:269c2445b8f5 668 switch (cmds[ndx].subs) {
wvd_vegt 7:269c2445b8f5 669 case SUBSYSTEM: { //Dump whole subsystem
wvd_vegt 7:269c2445b8f5 670 printf("%s subsystem commands:\r\n\r\n",cmds[ndx].cmdstr);
wvd_vegt 3:abbf43fab7d5 671
wvd_vegt 7:269c2445b8f5 672 //Count SubSystem Commands.
wvd_vegt 7:269c2445b8f5 673 int subcmds =0;
wvd_vegt 7:269c2445b8f5 674 for (int i=0;i<cmds.size();i++) {
wvd_vegt 7:269c2445b8f5 675 if (cmds[i].subs==cid) {
wvd_vegt 7:269c2445b8f5 676 subcmds++;
wvd_vegt 3:abbf43fab7d5 677 }
wvd_vegt 3:abbf43fab7d5 678 }
wvd_vegt 3:abbf43fab7d5 679
wvd_vegt 7:269c2445b8f5 680 //Print SubSystem Commands.
wvd_vegt 7:269c2445b8f5 681 for (int i=0;i<cmds.size()-1;i++) {
wvd_vegt 7:269c2445b8f5 682 if (cmds[i].subs==cid) {
wvd_vegt 7:269c2445b8f5 683 subcmds--;
wvd_vegt 7:269c2445b8f5 684 if (subcmds!=0) {
wvd_vegt 7:269c2445b8f5 685 cmdhelp("",i,",\r\n");
wvd_vegt 7:269c2445b8f5 686 } else {
wvd_vegt 7:269c2445b8f5 687 cmdhelp("",i,".\r\n");
wvd_vegt 7:269c2445b8f5 688 }
wvd_vegt 7:269c2445b8f5 689 }
wvd_vegt 7:269c2445b8f5 690 }
wvd_vegt 7:269c2445b8f5 691 }
wvd_vegt 7:269c2445b8f5 692 break;
wvd_vegt 3:abbf43fab7d5 693
wvd_vegt 3:abbf43fab7d5 694 case GLOBALCMD: //Dump command only
wvd_vegt 7:269c2445b8f5 695 //print("Global command:\r\n\r\n",cmd_tbl[cmd_tbl[ndx].subs].cmdstr);
wvd_vegt 7:269c2445b8f5 696 cmdhelp("Syntax: ",ndx,".\r\n");
wvd_vegt 3:abbf43fab7d5 697 break;
wvd_vegt 3:abbf43fab7d5 698
wvd_vegt 3:abbf43fab7d5 699 default: //Dump one subsystem command
wvd_vegt 7:269c2445b8f5 700 printf("%s subsystem command:\r\n\r\n",cmds[cmds[ndx].subs].cmdstr);
wvd_vegt 7:269c2445b8f5 701 cmdhelp("Syntax: ",ndx,".\r\n");
wvd_vegt 3:abbf43fab7d5 702 break;
wvd_vegt 3:abbf43fab7d5 703 }
wvd_vegt 3:abbf43fab7d5 704 } else {
wvd_vegt 3:abbf43fab7d5 705 if (argfnd>0) {
wvd_vegt 3:abbf43fab7d5 706 //Help with invalid command as first parameter
wvd_vegt 7:269c2445b8f5 707 print("Unknown command, type 'Help' for a list of available commands.\r\n");
wvd_vegt 3:abbf43fab7d5 708 } else {
wvd_vegt 3:abbf43fab7d5 709 //Help
wvd_vegt 3:abbf43fab7d5 710
wvd_vegt 3:abbf43fab7d5 711 //Dump Active Subsystem, Global & Other (dormant) Subsystems
wvd_vegt 7:269c2445b8f5 712 //-1 because we want comma's and for the last a .
wvd_vegt 7:269c2445b8f5 713 for (int i=0;i<cmds.size()-1;i++) {
wvd_vegt 7:269c2445b8f5 714 if ((cmds[i].subs<0) || (cmds[i].subs==subsystem)) {
wvd_vegt 7:269c2445b8f5 715 cmdhelp("",i,",\r\n");
wvd_vegt 3:abbf43fab7d5 716 }
wvd_vegt 3:abbf43fab7d5 717 }
wvd_vegt 7:269c2445b8f5 718 cmdhelp("",cmds.size()-1,".\r\n");
wvd_vegt 3:abbf43fab7d5 719 }
wvd_vegt 3:abbf43fab7d5 720 }
wvd_vegt 7:269c2445b8f5 721 print("\r\n");
wvd_vegt 3:abbf43fab7d5 722 break;
wvd_vegt 3:abbf43fab7d5 723 } //CID_HELP
wvd_vegt 7:269c2445b8f5 724
wvd_vegt 6:76b033971c3c 725 default : {
wvd_vegt 7:269c2445b8f5 726 // Do a Call to the Application's Command Dispatcher.
wvd_vegt 7:269c2445b8f5 727 (*callback)(*this, cid);
wvd_vegt 6:76b033971c3c 728 }
wvd_vegt 3:abbf43fab7d5 729 }
wvd_vegt 3:abbf43fab7d5 730 } else {
wvd_vegt 7:269c2445b8f5 731 cmdhelp("Syntax: ",ndx,".\r\n");
wvd_vegt 3:abbf43fab7d5 732 }
wvd_vegt 6:76b033971c3c 733
wvd_vegt 7:269c2445b8f5 734 }
wvd_vegt 3:abbf43fab7d5 735
wvd_vegt 3:abbf43fab7d5 736 } else {
wvd_vegt 7:269c2445b8f5 737 //cid==-1
wvd_vegt 3:abbf43fab7d5 738 }
wvd_vegt 3:abbf43fab7d5 739 }
wvd_vegt 3:abbf43fab7d5 740
wvd_vegt 7:269c2445b8f5 741 void Cmdb::prompt(void) {
wvd_vegt 7:269c2445b8f5 742 #ifdef SUBSYSTEMPROMPTS
wvd_vegt 7:269c2445b8f5 743 if (subsystem!=-1) {
wvd_vegt 7:269c2445b8f5 744 int ndx = cmdid_index(subsystem);
wvd_vegt 3:abbf43fab7d5 745
wvd_vegt 7:269c2445b8f5 746 printf("%s>",_cmds[ndx].cmdstr);
wvd_vegt 7:269c2445b8f5 747
wvd_vegt 7:269c2445b8f5 748 return;
wvd_vegt 3:abbf43fab7d5 749 }
wvd_vegt 7:269c2445b8f5 750 #endif //SUBSYSTEMPROMPTS
wvd_vegt 3:abbf43fab7d5 751
wvd_vegt 7:269c2445b8f5 752 printf(PROMPT);
wvd_vegt 3:abbf43fab7d5 753 }
wvd_vegt 3:abbf43fab7d5 754
wvd_vegt 7:269c2445b8f5 755 void Cmdb::cmdhelp(char *pre, int ndx, char *post) {
wvd_vegt 3:abbf43fab7d5 756 int j;
wvd_vegt 3:abbf43fab7d5 757 int k;
wvd_vegt 3:abbf43fab7d5 758 int lastmod;
wvd_vegt 3:abbf43fab7d5 759
wvd_vegt 3:abbf43fab7d5 760 k=0;
wvd_vegt 3:abbf43fab7d5 761 lastmod=0;
wvd_vegt 3:abbf43fab7d5 762
wvd_vegt 7:269c2445b8f5 763 switch (cmds[ndx].subs) {
wvd_vegt 3:abbf43fab7d5 764 case SUBSYSTEM :
wvd_vegt 3:abbf43fab7d5 765 break;
wvd_vegt 3:abbf43fab7d5 766 case GLOBALCMD :
wvd_vegt 3:abbf43fab7d5 767 break;
wvd_vegt 3:abbf43fab7d5 768 case HIDDENSUB :
wvd_vegt 3:abbf43fab7d5 769 return;
wvd_vegt 3:abbf43fab7d5 770 default :
wvd_vegt 3:abbf43fab7d5 771 if (strlen(pre)==0 && bold) {
wvd_vegt 7:269c2445b8f5 772 print(boldon);
wvd_vegt 3:abbf43fab7d5 773 }
wvd_vegt 3:abbf43fab7d5 774 break;
wvd_vegt 3:abbf43fab7d5 775 }
wvd_vegt 3:abbf43fab7d5 776
wvd_vegt 7:269c2445b8f5 777 print(pre);
wvd_vegt 3:abbf43fab7d5 778 k+=strlen(pre);
wvd_vegt 3:abbf43fab7d5 779
wvd_vegt 3:abbf43fab7d5 780 if (k==0) {
wvd_vegt 7:269c2445b8f5 781 printf("%12s",cmds[ndx].cmdstr);
wvd_vegt 3:abbf43fab7d5 782 k+=12;
wvd_vegt 3:abbf43fab7d5 783 } else {
wvd_vegt 3:abbf43fab7d5 784 if (strlen(pre)>0 && bold) {
wvd_vegt 7:269c2445b8f5 785 print(boldon);
wvd_vegt 3:abbf43fab7d5 786 }
wvd_vegt 3:abbf43fab7d5 787
wvd_vegt 7:269c2445b8f5 788 printf("%s",cmds[ndx].cmdstr);
wvd_vegt 7:269c2445b8f5 789 k+=strlen(cmds[ndx].cmdstr);
wvd_vegt 3:abbf43fab7d5 790
wvd_vegt 3:abbf43fab7d5 791 if (strlen(pre)>0 && bold) {
wvd_vegt 7:269c2445b8f5 792 print(boldoff);
wvd_vegt 3:abbf43fab7d5 793 }
wvd_vegt 3:abbf43fab7d5 794 }
wvd_vegt 3:abbf43fab7d5 795
wvd_vegt 7:269c2445b8f5 796 if (strlen(cmds[ndx].parms)) {
wvd_vegt 7:269c2445b8f5 797 printch(sp);
wvd_vegt 3:abbf43fab7d5 798 k++;
wvd_vegt 3:abbf43fab7d5 799 }
wvd_vegt 3:abbf43fab7d5 800
wvd_vegt 7:269c2445b8f5 801 for (j=0;j<strlen(cmds[ndx].parms);j++) {
wvd_vegt 7:269c2445b8f5 802 switch (cmds[ndx].parms[j]) {
wvd_vegt 3:abbf43fab7d5 803 case '%' :
wvd_vegt 3:abbf43fab7d5 804 lastmod=0;
wvd_vegt 3:abbf43fab7d5 805 break;
wvd_vegt 3:abbf43fab7d5 806
wvd_vegt 3:abbf43fab7d5 807 case 'b' :
wvd_vegt 3:abbf43fab7d5 808 lastmod=8;
wvd_vegt 3:abbf43fab7d5 809 break;
wvd_vegt 3:abbf43fab7d5 810 case 'h' :
wvd_vegt 3:abbf43fab7d5 811 lastmod=16;
wvd_vegt 3:abbf43fab7d5 812 break;
wvd_vegt 3:abbf43fab7d5 813 case 'l' :
wvd_vegt 3:abbf43fab7d5 814 lastmod=32;
wvd_vegt 3:abbf43fab7d5 815 break;
wvd_vegt 3:abbf43fab7d5 816
wvd_vegt 3:abbf43fab7d5 817 case 'd' :
wvd_vegt 3:abbf43fab7d5 818 case 'i' : {
wvd_vegt 3:abbf43fab7d5 819 switch (lastmod) {
wvd_vegt 3:abbf43fab7d5 820 case 0 :
wvd_vegt 3:abbf43fab7d5 821 case 16 :
wvd_vegt 7:269c2445b8f5 822 print("int");
wvd_vegt 3:abbf43fab7d5 823 k+=3;
wvd_vegt 3:abbf43fab7d5 824 break;
wvd_vegt 3:abbf43fab7d5 825 case 8 :
wvd_vegt 7:269c2445b8f5 826 print("shortint");
wvd_vegt 3:abbf43fab7d5 827 k+=8;
wvd_vegt 3:abbf43fab7d5 828 break;
wvd_vegt 3:abbf43fab7d5 829 case 32:
wvd_vegt 7:269c2445b8f5 830 print("longint");
wvd_vegt 3:abbf43fab7d5 831 k+=7;
wvd_vegt 3:abbf43fab7d5 832 break;
wvd_vegt 3:abbf43fab7d5 833 }
wvd_vegt 3:abbf43fab7d5 834 break;
wvd_vegt 3:abbf43fab7d5 835 }
wvd_vegt 3:abbf43fab7d5 836
wvd_vegt 3:abbf43fab7d5 837 case 'u' :
wvd_vegt 3:abbf43fab7d5 838 case 'o' :
wvd_vegt 3:abbf43fab7d5 839 case 'x' : {
wvd_vegt 3:abbf43fab7d5 840 switch (lastmod) {
wvd_vegt 3:abbf43fab7d5 841 case 0 :
wvd_vegt 3:abbf43fab7d5 842 case 16 :
wvd_vegt 7:269c2445b8f5 843 print("word");
wvd_vegt 3:abbf43fab7d5 844 k+=4;
wvd_vegt 3:abbf43fab7d5 845 break;
wvd_vegt 3:abbf43fab7d5 846 case 8 :
wvd_vegt 7:269c2445b8f5 847 print("byte");
wvd_vegt 3:abbf43fab7d5 848 k+=4;
wvd_vegt 3:abbf43fab7d5 849 break;
wvd_vegt 3:abbf43fab7d5 850 case 32 :
wvd_vegt 7:269c2445b8f5 851 print("dword");
wvd_vegt 3:abbf43fab7d5 852 k+=5;
wvd_vegt 3:abbf43fab7d5 853 break;
wvd_vegt 3:abbf43fab7d5 854 }
wvd_vegt 3:abbf43fab7d5 855
wvd_vegt 7:269c2445b8f5 856 switch (cmds[ndx].parms[j]) {
wvd_vegt 3:abbf43fab7d5 857 case 'o' :
wvd_vegt 7:269c2445b8f5 858 print("[o]");
wvd_vegt 3:abbf43fab7d5 859 k+=3;
wvd_vegt 3:abbf43fab7d5 860 break;
wvd_vegt 3:abbf43fab7d5 861 case 'x' :
wvd_vegt 7:269c2445b8f5 862 print("[h]");
wvd_vegt 3:abbf43fab7d5 863 k+=3;
wvd_vegt 3:abbf43fab7d5 864 break;
wvd_vegt 3:abbf43fab7d5 865 }
wvd_vegt 3:abbf43fab7d5 866
wvd_vegt 3:abbf43fab7d5 867 break;
wvd_vegt 3:abbf43fab7d5 868 }
wvd_vegt 3:abbf43fab7d5 869
wvd_vegt 3:abbf43fab7d5 870 case 'e' :
wvd_vegt 3:abbf43fab7d5 871 case 'f' :
wvd_vegt 3:abbf43fab7d5 872 case 'g' :
wvd_vegt 7:269c2445b8f5 873 print("float");
wvd_vegt 3:abbf43fab7d5 874 k+=5;
wvd_vegt 3:abbf43fab7d5 875 break;
wvd_vegt 3:abbf43fab7d5 876
wvd_vegt 3:abbf43fab7d5 877 case 'c' :
wvd_vegt 7:269c2445b8f5 878 print("char");
wvd_vegt 3:abbf43fab7d5 879 k+=4;
wvd_vegt 3:abbf43fab7d5 880 break;
wvd_vegt 3:abbf43fab7d5 881
wvd_vegt 3:abbf43fab7d5 882 case 's' :
wvd_vegt 7:269c2445b8f5 883 print("string");
wvd_vegt 3:abbf43fab7d5 884 k+=6;
wvd_vegt 3:abbf43fab7d5 885 break;
wvd_vegt 3:abbf43fab7d5 886
wvd_vegt 3:abbf43fab7d5 887 case ' ' :
wvd_vegt 7:269c2445b8f5 888 printch(sp);
wvd_vegt 3:abbf43fab7d5 889 k++;
wvd_vegt 3:abbf43fab7d5 890 break;
wvd_vegt 3:abbf43fab7d5 891 }
wvd_vegt 3:abbf43fab7d5 892 }
wvd_vegt 3:abbf43fab7d5 893
wvd_vegt 7:269c2445b8f5 894 for (j=k;j<40;j++) printch(sp);
wvd_vegt 3:abbf43fab7d5 895
wvd_vegt 7:269c2445b8f5 896 switch (cmds[ndx].subs) {
wvd_vegt 3:abbf43fab7d5 897 case SUBSYSTEM :
wvd_vegt 3:abbf43fab7d5 898 if (ndx==subsystem) {
wvd_vegt 7:269c2445b8f5 899 printf("- %s (active subsystem)%s",cmds[ndx].cmddescr,post);
wvd_vegt 3:abbf43fab7d5 900 } else {
wvd_vegt 7:269c2445b8f5 901 printf("- %s (dormant subsystem)%s",cmds[ndx].cmddescr,post);
wvd_vegt 3:abbf43fab7d5 902 }
wvd_vegt 3:abbf43fab7d5 903 break;
wvd_vegt 3:abbf43fab7d5 904 case HIDDENSUB :
wvd_vegt 3:abbf43fab7d5 905 break;
wvd_vegt 3:abbf43fab7d5 906 case GLOBALCMD :
wvd_vegt 7:269c2445b8f5 907 printf("- %s (global command)%s",cmds[ndx].cmddescr,post);
wvd_vegt 3:abbf43fab7d5 908 break;
wvd_vegt 3:abbf43fab7d5 909 default :
wvd_vegt 7:269c2445b8f5 910 printf("- %s%s",cmds[ndx].cmddescr,post);
wvd_vegt 3:abbf43fab7d5 911 if (strlen(pre)==0 && bold) {
wvd_vegt 7:269c2445b8f5 912 print(boldoff);
wvd_vegt 3:abbf43fab7d5 913 }
wvd_vegt 3:abbf43fab7d5 914 break;
wvd_vegt 3:abbf43fab7d5 915 }
wvd_vegt 3:abbf43fab7d5 916
wvd_vegt 7:269c2445b8f5 917 if (strlen(pre)>0 && strlen(cmds[ndx].parmdescr)) {
wvd_vegt 7:269c2445b8f5 918 printf("Params: %s",cmds[ndx].parmdescr);
wvd_vegt 7:269c2445b8f5 919 print("\r\n");
wvd_vegt 3:abbf43fab7d5 920 }
wvd_vegt 3:abbf43fab7d5 921 }
wvd_vegt 3:abbf43fab7d5 922
wvd_vegt 3:abbf43fab7d5 923 //------------------------------------------------------------------------------
wvd_vegt 3:abbf43fab7d5 924 //----Wrappers
wvd_vegt 3:abbf43fab7d5 925 //------------------------------------------------------------------------------
wvd_vegt 3:abbf43fab7d5 926
wvd_vegt 3:abbf43fab7d5 927 void Cmdb::zeromemory(char *p,unsigned int siz) {
wvd_vegt 3:abbf43fab7d5 928 memset(p,'\0',siz);
wvd_vegt 3:abbf43fab7d5 929 }
wvd_vegt 3:abbf43fab7d5 930
wvd_vegt 3:abbf43fab7d5 931 int Cmdb::stricmp (char *s1, char *s2) {
wvd_vegt 3:abbf43fab7d5 932 int i;
wvd_vegt 3:abbf43fab7d5 933 int len1,len2;
wvd_vegt 3:abbf43fab7d5 934
wvd_vegt 3:abbf43fab7d5 935 len1=strlen(s1);
wvd_vegt 3:abbf43fab7d5 936 len2=strlen(s2);
wvd_vegt 3:abbf43fab7d5 937
wvd_vegt 3:abbf43fab7d5 938 for (i = 0; (i<len1) && (i<len2);i++) {
wvd_vegt 3:abbf43fab7d5 939 if ( toupper (s1[i])<toupper(s2[i]) ) return (-1);
wvd_vegt 3:abbf43fab7d5 940 if ( toupper (s1[i])>toupper(s2[i]) ) return (+1);
wvd_vegt 3:abbf43fab7d5 941 }
wvd_vegt 3:abbf43fab7d5 942
wvd_vegt 3:abbf43fab7d5 943 if (len1<len2) return (-1);
wvd_vegt 3:abbf43fab7d5 944 if (len1>len2) return (+1);
wvd_vegt 3:abbf43fab7d5 945
wvd_vegt 3:abbf43fab7d5 946 return (0);
wvd_vegt 3:abbf43fab7d5 947 }
wvd_vegt 7:269c2445b8f5 948
wvd_vegt 7:269c2445b8f5 949 //------------------------------------------------------------------------------