Gill Wei / Mbed 2 deprecated NNN40_CLI

fork test

Dependencies:   BLE_API WIFI_API_32kRAM mbed nRF51822

Fork of NNN40_CLI by Delta

CLI_Source/command-interpreter.cpp@0:5c195ab2f696, 2015-09-11 (annotated)

Committer:
gillwei7
Date:
Fri Sep 11 07:29:31 2015 +0000
Revision:
0:5c195ab2f696
Child:
3:38ec8ad317f4
Gill first commit 20150911 for NNN40_CLI Version 0; Merge mbed library to offline Keil Wifi/BLE CLI program

Who changed what in which revision?

UserRevisionLine numberNew contents of line
gillwei7 0:5c195ab2f696 1 /**
gillwei7 0:5c195ab2f696 2 * File: command-interpreter.c
gillwei7 0:5c195ab2f696 3 * Description: processes commands incoming over the serial port.
gillwei7 0:5c195ab2f696 4 *
gillwei7 0:5c195ab2f696 5 * Copyright 2014 by CYNTEC Corporation. All rights reserved.
gillwei7 0:5c195ab2f696 6 */
gillwei7 0:5c195ab2f696 7
gillwei7 0:5c195ab2f696 8 #include <stdint.h>
gillwei7 0:5c195ab2f696 9 #include <string.h>
gillwei7 0:5c195ab2f696 10 #include "mbed.h"
gillwei7 0:5c195ab2f696 11 #include "command-interpreter.h"
gillwei7 0:5c195ab2f696 12
gillwei7 0:5c195ab2f696 13 extern Serial console;
gillwei7 0:5c195ab2f696 14
gillwei7 0:5c195ab2f696 15 // Command parsing state
gillwei7 0:5c195ab2f696 16 typedef struct {
gillwei7 0:5c195ab2f696 17
gillwei7 0:5c195ab2f696 18 // Finite-state machine's current state.
gillwei7 0:5c195ab2f696 19 uint8_t state;
gillwei7 0:5c195ab2f696 20
gillwei7 0:5c195ab2f696 21 // The command line is stored in this buffer.
gillwei7 0:5c195ab2f696 22 uint8_t buffer[CYNTEC_COMMAND_BUFFER_LENGTH];
gillwei7 0:5c195ab2f696 23
gillwei7 0:5c195ab2f696 24 // Indices of the tokens (command(s) and arguments) in the above buffer.
gillwei7 0:5c195ab2f696 25 uint8_t tokenIndices[MAX_TOKEN_COUNT];
gillwei7 0:5c195ab2f696 26
gillwei7 0:5c195ab2f696 27 // The number of tokens read in, including the command(s).
gillwei7 0:5c195ab2f696 28 uint8_t tokenCount;
gillwei7 0:5c195ab2f696 29
gillwei7 0:5c195ab2f696 30 // Used while reading in the command line.
gillwei7 0:5c195ab2f696 31 uint8_t index;
gillwei7 0:5c195ab2f696 32
gillwei7 0:5c195ab2f696 33 // First error found in this command.
gillwei7 0:5c195ab2f696 34 uint8_t error;
gillwei7 0:5c195ab2f696 35
gillwei7 0:5c195ab2f696 36 // The token number of the first true argument after possible nested commands.
gillwei7 0:5c195ab2f696 37 uint8_t argOffset;
gillwei7 0:5c195ab2f696 38
gillwei7 0:5c195ab2f696 39 //gill
gillwei7 0:5c195ab2f696 40 uint8_t totalBuffer[CYNTEC_COMMAND_BUFFER_LENGTH];
gillwei7 0:5c195ab2f696 41 uint8_t totalIndex;
gillwei7 0:5c195ab2f696 42
gillwei7 0:5c195ab2f696 43 } CyntecCommandState;
gillwei7 0:5c195ab2f696 44
gillwei7 0:5c195ab2f696 45 static CyntecCommandState commandState;
gillwei7 0:5c195ab2f696 46
gillwei7 0:5c195ab2f696 47 // Remember the previous character seen by emberProcessCommandString() to ignore
gillwei7 0:5c195ab2f696 48 // an LF following a CR.
gillwei7 0:5c195ab2f696 49 static uint8_t previousCharacter = 0;
gillwei7 0:5c195ab2f696 50 CyntecCommandEntry *cyntecCurrentCommand;
gillwei7 0:5c195ab2f696 51
gillwei7 0:5c195ab2f696 52 enum {
gillwei7 0:5c195ab2f696 53 CMD_AWAITING_ARGUMENT,
gillwei7 0:5c195ab2f696 54 CMD_READING_ARGUMENT,
gillwei7 0:5c195ab2f696 55 CMD_READING_TO_EOL // clean up after error
gillwei7 0:5c195ab2f696 56 };
gillwei7 0:5c195ab2f696 57
gillwei7 0:5c195ab2f696 58
gillwei7 0:5c195ab2f696 59
gillwei7 0:5c195ab2f696 60 const char* cyntecCommandErrorNames[] =
gillwei7 0:5c195ab2f696 61 {
gillwei7 0:5c195ab2f696 62 "",
gillwei7 0:5c195ab2f696 63 "No such command;",
gillwei7 0:5c195ab2f696 64 "Wrong number of arguments;",
gillwei7 0:5c195ab2f696 65 "Argument out of range;",
gillwei7 0:5c195ab2f696 66 "Argument syntax error;",
gillwei7 0:5c195ab2f696 67 "No matched argument;",
gillwei7 0:5c195ab2f696 68 "Wrong command order;",
gillwei7 0:5c195ab2f696 69 "Invalid state to perform operation;",
gillwei7 0:5c195ab2f696 70 "Function call fail;"
gillwei7 0:5c195ab2f696 71 };
gillwei7 0:5c195ab2f696 72
gillwei7 0:5c195ab2f696 73 /**
gillwei7 0:5c195ab2f696 74 * @brief Converts a character representation of a hex to real value.
gillwei7 0:5c195ab2f696 75 * @param c is the hex value in char format
gillwei7 0:5c195ab2f696 76 * @return the value of the hex otherwise INVALID_HEX_CHARACTER
gillwei7 0:5c195ab2f696 77 */
gillwei7 0:5c195ab2f696 78
gillwei7 0:5c195ab2f696 79 uint8_t cyntecAtoi(uint8_t *str, uint8_t len)
gillwei7 0:5c195ab2f696 80 {
gillwei7 0:5c195ab2f696 81 uint8_t result = 0;
gillwei7 0:5c195ab2f696 82 uint8_t i = 0;
gillwei7 0:5c195ab2f696 83
gillwei7 0:5c195ab2f696 84 while( *str != '\0' && i < len)
gillwei7 0:5c195ab2f696 85 {
gillwei7 0:5c195ab2f696 86 result *= 10;
gillwei7 0:5c195ab2f696 87 result = result + ( *str - '0' );
gillwei7 0:5c195ab2f696 88 str++;
gillwei7 0:5c195ab2f696 89 i++;
gillwei7 0:5c195ab2f696 90 }
gillwei7 0:5c195ab2f696 91
gillwei7 0:5c195ab2f696 92 return result;
gillwei7 0:5c195ab2f696 93 }
gillwei7 0:5c195ab2f696 94
gillwei7 0:5c195ab2f696 95 uint8_t cyntecArgToUint8(uint8_t *str, uint8_t len)
gillwei7 0:5c195ab2f696 96 {
gillwei7 0:5c195ab2f696 97 uint8_t result = 0;
gillwei7 0:5c195ab2f696 98 uint8_t num[2];
gillwei7 0:5c195ab2f696 99 uint8_t i;
gillwei7 0:5c195ab2f696 100
gillwei7 0:5c195ab2f696 101 if ( len != 2 )
gillwei7 0:5c195ab2f696 102 {
gillwei7 0:5c195ab2f696 103 return 0;
gillwei7 0:5c195ab2f696 104 }
gillwei7 0:5c195ab2f696 105
gillwei7 0:5c195ab2f696 106 for ( i = 0 ; i < 2 ; i++ )
gillwei7 0:5c195ab2f696 107 {
gillwei7 0:5c195ab2f696 108 if ('0' <= str[i] && str[i] <= '9')
gillwei7 0:5c195ab2f696 109 num[i] = str[i] - '0';
gillwei7 0:5c195ab2f696 110 else if ('a' <= str[i] && str[i] <= 'f')
gillwei7 0:5c195ab2f696 111 num[i] = str[i] - 'a' + 10;
gillwei7 0:5c195ab2f696 112 else if ('A' <= str[i] && str[i] <= 'F')
gillwei7 0:5c195ab2f696 113 num[i] = str[i] - 'A' + 10;
gillwei7 0:5c195ab2f696 114 else
gillwei7 0:5c195ab2f696 115 return 0;
gillwei7 0:5c195ab2f696 116 }
gillwei7 0:5c195ab2f696 117
gillwei7 0:5c195ab2f696 118 result |= num[0] << 4;
gillwei7 0:5c195ab2f696 119 result |= num[1] << 0;
gillwei7 0:5c195ab2f696 120
gillwei7 0:5c195ab2f696 121 return result;
gillwei7 0:5c195ab2f696 122 }
gillwei7 0:5c195ab2f696 123
gillwei7 0:5c195ab2f696 124 uint16_t cyntecAtoiUint16(uint8_t *str, uint8_t len)
gillwei7 0:5c195ab2f696 125 {
gillwei7 0:5c195ab2f696 126 uint16_t result = 0;
gillwei7 0:5c195ab2f696 127 uint16_t i = 0;
gillwei7 0:5c195ab2f696 128
gillwei7 0:5c195ab2f696 129 while( *str != '\0' && i < len)
gillwei7 0:5c195ab2f696 130 {
gillwei7 0:5c195ab2f696 131 result *= 10;
gillwei7 0:5c195ab2f696 132 result = result + ( *str - '0' );
gillwei7 0:5c195ab2f696 133 str++;
gillwei7 0:5c195ab2f696 134 i++;
gillwei7 0:5c195ab2f696 135 }
gillwei7 0:5c195ab2f696 136
gillwei7 0:5c195ab2f696 137 return result;
gillwei7 0:5c195ab2f696 138 }
gillwei7 0:5c195ab2f696 139
gillwei7 0:5c195ab2f696 140 uint16_t cyntecArgToUint16(uint8_t *str, uint8_t len)
gillwei7 0:5c195ab2f696 141 {
gillwei7 0:5c195ab2f696 142 uint16_t result = 0;
gillwei7 0:5c195ab2f696 143 uint8_t num[4];
gillwei7 0:5c195ab2f696 144 uint8_t i;
gillwei7 0:5c195ab2f696 145
gillwei7 0:5c195ab2f696 146 if ( len != 4 )
gillwei7 0:5c195ab2f696 147 {
gillwei7 0:5c195ab2f696 148 return 0;
gillwei7 0:5c195ab2f696 149 }
gillwei7 0:5c195ab2f696 150
gillwei7 0:5c195ab2f696 151 for ( i = 0 ; i < 4 ; i++ )
gillwei7 0:5c195ab2f696 152 {
gillwei7 0:5c195ab2f696 153 if ('0' <= str[i] && str[i] <= '9')
gillwei7 0:5c195ab2f696 154 num[i] = str[i] - '0';
gillwei7 0:5c195ab2f696 155 else if ('a' <= str[i] && str[i] <= 'f')
gillwei7 0:5c195ab2f696 156 num[i] = str[i] - 'a' + 10;
gillwei7 0:5c195ab2f696 157 else if ('A' <= str[i] && str[i] <= 'F')
gillwei7 0:5c195ab2f696 158 num[i] = str[i] - 'A' + 10;
gillwei7 0:5c195ab2f696 159 else
gillwei7 0:5c195ab2f696 160 return 0;
gillwei7 0:5c195ab2f696 161 }
gillwei7 0:5c195ab2f696 162
gillwei7 0:5c195ab2f696 163 result |= num[0] << 12;
gillwei7 0:5c195ab2f696 164 result |= num[1] << 8;
gillwei7 0:5c195ab2f696 165 result |= num[2] << 4;
gillwei7 0:5c195ab2f696 166 result |= num[3] << 0;
gillwei7 0:5c195ab2f696 167
gillwei7 0:5c195ab2f696 168 return result;
gillwei7 0:5c195ab2f696 169 }
gillwei7 0:5c195ab2f696 170
gillwei7 0:5c195ab2f696 171 uint8_t cyntecStrCmp(uint8_t *src, uint8_t *dst, uint8_t len)
gillwei7 0:5c195ab2f696 172 {
gillwei7 0:5c195ab2f696 173 uint8_t i = 0;
gillwei7 0:5c195ab2f696 174
gillwei7 0:5c195ab2f696 175 while ( *src != '\0' && *dst != '\0' && i < len )
gillwei7 0:5c195ab2f696 176 {
gillwei7 0:5c195ab2f696 177 if ( *src != *dst )
gillwei7 0:5c195ab2f696 178 return 0;
gillwei7 0:5c195ab2f696 179 i++;
gillwei7 0:5c195ab2f696 180 src++;
gillwei7 0:5c195ab2f696 181 dst++;
gillwei7 0:5c195ab2f696 182 }
gillwei7 0:5c195ab2f696 183
gillwei7 0:5c195ab2f696 184 return 1;
gillwei7 0:5c195ab2f696 185 }
gillwei7 0:5c195ab2f696 186
gillwei7 0:5c195ab2f696 187 // Initialize the state machine.
gillwei7 0:5c195ab2f696 188 void cyntecCommandReaderInit(void)
gillwei7 0:5c195ab2f696 189 {
gillwei7 0:5c195ab2f696 190 commandState.state = CMD_AWAITING_ARGUMENT;
gillwei7 0:5c195ab2f696 191 commandState.index = 0;
gillwei7 0:5c195ab2f696 192 commandState.tokenIndices[0] = 0;
gillwei7 0:5c195ab2f696 193 commandState.tokenCount = 0;
gillwei7 0:5c195ab2f696 194 commandState.error = CYNTEC_CMD_SUCCESS;
gillwei7 0:5c195ab2f696 195 commandState.argOffset = 0;
gillwei7 0:5c195ab2f696 196 cyntecCurrentCommand = NULL;
gillwei7 0:5c195ab2f696 197 commandState.totalIndex = 0; //gill
gillwei7 0:5c195ab2f696 198 }
gillwei7 0:5c195ab2f696 199
gillwei7 0:5c195ab2f696 200 static uint8_t tokenLength(uint8_t num)
gillwei7 0:5c195ab2f696 201 {
gillwei7 0:5c195ab2f696 202 return (commandState.tokenIndices[num + 1]
gillwei7 0:5c195ab2f696 203 - commandState.tokenIndices[num]);
gillwei7 0:5c195ab2f696 204 }
gillwei7 0:5c195ab2f696 205
gillwei7 0:5c195ab2f696 206 static uint8_t *tokenPointer(uint8_t tokenNum)
gillwei7 0:5c195ab2f696 207 {
gillwei7 0:5c195ab2f696 208 return (commandState.buffer + commandState.tokenIndices[tokenNum]);
gillwei7 0:5c195ab2f696 209 }
gillwei7 0:5c195ab2f696 210
gillwei7 0:5c195ab2f696 211 void cyntecCommandActionHandler(const CommandAction action)
gillwei7 0:5c195ab2f696 212 {
gillwei7 0:5c195ab2f696 213 (*action)();
gillwei7 0:5c195ab2f696 214 clearBuffer();
gillwei7 0:5c195ab2f696 215 }
gillwei7 0:5c195ab2f696 216
gillwei7 0:5c195ab2f696 217 static bool getNestedCommand(CyntecCommandEntry *entry,
gillwei7 0:5c195ab2f696 218 CyntecCommandEntry **nestedCommand)
gillwei7 0:5c195ab2f696 219 {
gillwei7 0:5c195ab2f696 220 if ( entry -> action == NULL ) {
gillwei7 0:5c195ab2f696 221 *nestedCommand = (CyntecCommandEntry*)entry->subMenu;
gillwei7 0:5c195ab2f696 222 return true;
gillwei7 0:5c195ab2f696 223 } else {
gillwei7 0:5c195ab2f696 224 return false;
gillwei7 0:5c195ab2f696 225 }
gillwei7 0:5c195ab2f696 226 }
gillwei7 0:5c195ab2f696 227
gillwei7 0:5c195ab2f696 228 static void cyntecPrintCommandUsage(CyntecCommandEntry *entry)
gillwei7 0:5c195ab2f696 229 {
gillwei7 0:5c195ab2f696 230 CyntecCommandEntry *commandFinger;
gillwei7 0:5c195ab2f696 231
gillwei7 0:5c195ab2f696 232 if (entry == NULL) {
gillwei7 0:5c195ab2f696 233 entry = commandFinger = cyntecCommandTable;
gillwei7 0:5c195ab2f696 234 } else {
gillwei7 0:5c195ab2f696 235 getNestedCommand(entry, &commandFinger);
gillwei7 0:5c195ab2f696 236
gillwei7 0:5c195ab2f696 237 console.printf("%s - %s\r\n",entry->name,entry->description);
gillwei7 0:5c195ab2f696 238 }
gillwei7 0:5c195ab2f696 239
gillwei7 0:5c195ab2f696 240 if ( commandFinger != NULL ) {
gillwei7 0:5c195ab2f696 241 for (; commandFinger->name != NULL; commandFinger++) {
gillwei7 0:5c195ab2f696 242 console.printf("%s - %s\r\n",commandFinger->name,commandFinger->description);
gillwei7 0:5c195ab2f696 243 }
gillwei7 0:5c195ab2f696 244 }
gillwei7 0:5c195ab2f696 245
gillwei7 0:5c195ab2f696 246 }
gillwei7 0:5c195ab2f696 247
gillwei7 0:5c195ab2f696 248 void cyntecCommandErrorHandler(uint8_t status)
gillwei7 0:5c195ab2f696 249 {
gillwei7 0:5c195ab2f696 250 console.printf("%s\r\n",cyntecCommandErrorNames[status]);
gillwei7 0:5c195ab2f696 251 cyntecPrintCommandUsage(cyntecCurrentCommand);
gillwei7 0:5c195ab2f696 252 }
gillwei7 0:5c195ab2f696 253
gillwei7 0:5c195ab2f696 254 static CyntecCommandEntry *commandLookup(CyntecCommandEntry *commandFinger,
gillwei7 0:5c195ab2f696 255 uint8_t tokenNum)
gillwei7 0:5c195ab2f696 256 {
gillwei7 0:5c195ab2f696 257 uint8_t *inputCommand = tokenPointer(tokenNum);
gillwei7 0:5c195ab2f696 258 uint8_t inputLength = tokenLength(tokenNum);
gillwei7 0:5c195ab2f696 259
gillwei7 0:5c195ab2f696 260 for (; commandFinger->name != NULL; commandFinger++) {
gillwei7 0:5c195ab2f696 261 const char *entryFinger = commandFinger->name;
gillwei7 0:5c195ab2f696 262 uint8_t *inputFinger = inputCommand;
gillwei7 0:5c195ab2f696 263 for (;; entryFinger++, inputFinger++) {
gillwei7 0:5c195ab2f696 264 bool endInput = (inputFinger - inputCommand == inputLength);
gillwei7 0:5c195ab2f696 265 bool endEntry = (*entryFinger == 0);
gillwei7 0:5c195ab2f696 266 if (endInput && endEntry) {
gillwei7 0:5c195ab2f696 267 return commandFinger; // Exact match.
gillwei7 0:5c195ab2f696 268 } else if ((*inputFinger) != (*entryFinger)) {
gillwei7 0:5c195ab2f696 269 break;
gillwei7 0:5c195ab2f696 270 }
gillwei7 0:5c195ab2f696 271 }
gillwei7 0:5c195ab2f696 272 }
gillwei7 0:5c195ab2f696 273 return NULL;
gillwei7 0:5c195ab2f696 274 }
gillwei7 0:5c195ab2f696 275
gillwei7 0:5c195ab2f696 276 void callCommandAction(void)
gillwei7 0:5c195ab2f696 277 {
gillwei7 0:5c195ab2f696 278 CyntecCommandEntry *commandFinger = cyntecCommandTable;
gillwei7 0:5c195ab2f696 279 uint8_t tokenNum = 0;
gillwei7 0:5c195ab2f696 280
gillwei7 0:5c195ab2f696 281 if (commandState.tokenCount == 0) {
gillwei7 0:5c195ab2f696 282 cyntecCommandReaderInit();
gillwei7 0:5c195ab2f696 283 return;
gillwei7 0:5c195ab2f696 284 }
gillwei7 0:5c195ab2f696 285
gillwei7 0:5c195ab2f696 286 // Lookup the command.
gillwei7 0:5c195ab2f696 287 while (true) {
gillwei7 0:5c195ab2f696 288 commandFinger = commandLookup(commandFinger, tokenNum);
gillwei7 0:5c195ab2f696 289 if (commandFinger == NULL) {
gillwei7 0:5c195ab2f696 290 commandState.error = CYNTEC_CMD_ERR_NO_SUCH_COMMAND;
gillwei7 0:5c195ab2f696 291 break;
gillwei7 0:5c195ab2f696 292 } else {
gillwei7 0:5c195ab2f696 293 cyntecCurrentCommand = commandFinger;
gillwei7 0:5c195ab2f696 294 tokenNum += 1;
gillwei7 0:5c195ab2f696 295 commandState.argOffset += 1;
gillwei7 0:5c195ab2f696 296
gillwei7 0:5c195ab2f696 297 if ( getNestedCommand(commandFinger, &commandFinger) ) {
gillwei7 0:5c195ab2f696 298 if (tokenNum >= commandState.tokenCount) {
gillwei7 0:5c195ab2f696 299 commandState.error = CYNTEC_CMD_ERR_WRONG_NUMBER_OF_ARGUMENTS;
gillwei7 0:5c195ab2f696 300 break;
gillwei7 0:5c195ab2f696 301 }
gillwei7 0:5c195ab2f696 302 } else {
gillwei7 0:5c195ab2f696 303 break;
gillwei7 0:5c195ab2f696 304 }
gillwei7 0:5c195ab2f696 305 }
gillwei7 0:5c195ab2f696 306 }
gillwei7 0:5c195ab2f696 307
gillwei7 0:5c195ab2f696 308 if (commandState.error == CYNTEC_CMD_SUCCESS) {
gillwei7 0:5c195ab2f696 309 cyntecCommandActionHandler(commandFinger->action);
gillwei7 0:5c195ab2f696 310 } else {
gillwei7 0:5c195ab2f696 311 cyntecCommandErrorHandler(commandState.error);;
gillwei7 0:5c195ab2f696 312 }
gillwei7 0:5c195ab2f696 313
gillwei7 0:5c195ab2f696 314 cyntecCommandReaderInit();
gillwei7 0:5c195ab2f696 315 }
gillwei7 0:5c195ab2f696 316
gillwei7 0:5c195ab2f696 317 /*
gillwei7 0:5c195ab2f696 318 *
gillwei7 0:5c195ab2f696 319 */
gillwei7 0:5c195ab2f696 320 void cyntecEndArgument(uint8_t input)
gillwei7 0:5c195ab2f696 321 {
gillwei7 0:5c195ab2f696 322 if (commandState.tokenCount == MAX_TOKEN_COUNT) {
gillwei7 0:5c195ab2f696 323 commandState.error = CYNTEC_CMD_ERR_WRONG_NUMBER_OF_ARGUMENTS;
gillwei7 0:5c195ab2f696 324 commandState.state = CMD_READING_TO_EOL;
gillwei7 0:5c195ab2f696 325 }
gillwei7 0:5c195ab2f696 326
gillwei7 0:5c195ab2f696 327 commandState.tokenCount += 1;
gillwei7 0:5c195ab2f696 328 commandState.tokenIndices[commandState.tokenCount] = commandState.index;
gillwei7 0:5c195ab2f696 329 commandState.state = CMD_AWAITING_ARGUMENT;
gillwei7 0:5c195ab2f696 330
gillwei7 0:5c195ab2f696 331 if (input == '\r' || input == '\n') {
gillwei7 0:5c195ab2f696 332 callCommandAction();
gillwei7 0:5c195ab2f696 333 }
gillwei7 0:5c195ab2f696 334 }
gillwei7 0:5c195ab2f696 335
gillwei7 0:5c195ab2f696 336 /*
gillwei7 0:5c195ab2f696 337 *
gillwei7 0:5c195ab2f696 338 */
gillwei7 0:5c195ab2f696 339 void cyntecWriteToBuffer(uint8_t input)
gillwei7 0:5c195ab2f696 340 {
gillwei7 0:5c195ab2f696 341 if (commandState.index == CYNTEC_COMMAND_BUFFER_LENGTH) {
gillwei7 0:5c195ab2f696 342 commandState.error = CYNTEC_CMD_ERR_WRONG_NUMBER_OF_ARGUMENTS;
gillwei7 0:5c195ab2f696 343 commandState.state = CMD_READING_TO_EOL;
gillwei7 0:5c195ab2f696 344 } else {
gillwei7 0:5c195ab2f696 345 commandState.buffer[commandState.index] = input;
gillwei7 0:5c195ab2f696 346 commandState.index += 1;
gillwei7 0:5c195ab2f696 347 }
gillwei7 0:5c195ab2f696 348 }
gillwei7 0:5c195ab2f696 349
gillwei7 0:5c195ab2f696 350 /*
gillwei7 0:5c195ab2f696 351 * Process the given char as a command.
gillwei7 0:5c195ab2f696 352 */
gillwei7 0:5c195ab2f696 353 //void cyntecProcessCommandInput(uint8_t input) {
gillwei7 0:5c195ab2f696 354 // bool isEol = false;
gillwei7 0:5c195ab2f696 355 // bool isSpace = false;
gillwei7 0:5c195ab2f696 356 //
gillwei7 0:5c195ab2f696 357 // if (previousCharacter == '\r' && input == '\n') {
gillwei7 0:5c195ab2f696 358 // previousCharacter = input;
gillwei7 0:5c195ab2f696 359 // return;
gillwei7 0:5c195ab2f696 360 // }
gillwei7 0:5c195ab2f696 361 //
gillwei7 0:5c195ab2f696 362 // previousCharacter = input;
gillwei7 0:5c195ab2f696 363 // isEol = ((input == '\r') || (input == '\n'));
gillwei7 0:5c195ab2f696 364 // isSpace = (input == ' ');
gillwei7 0:5c195ab2f696 365 //
gillwei7 0:5c195ab2f696 366 // switch (commandState.state) {
gillwei7 0:5c195ab2f696 367 // case CMD_AWAITING_ARGUMENT:
gillwei7 0:5c195ab2f696 368 // if (isEol) {
gillwei7 0:5c195ab2f696 369 // callCommandAction();
gillwei7 0:5c195ab2f696 370 // } else if (! isSpace) {
gillwei7 0:5c195ab2f696 371 // commandState.state = CMD_READING_ARGUMENT;
gillwei7 0:5c195ab2f696 372 // cyntecWriteToBuffer(input);
gillwei7 0:5c195ab2f696 373 // }
gillwei7 0:5c195ab2f696 374 // break;
gillwei7 0:5c195ab2f696 375 // case CMD_READING_ARGUMENT:
gillwei7 0:5c195ab2f696 376 // if (isEol || isSpace) {
gillwei7 0:5c195ab2f696 377 // cyntecEndArgument(input);
gillwei7 0:5c195ab2f696 378 // } else {
gillwei7 0:5c195ab2f696 379 // cyntecWriteToBuffer(input);
gillwei7 0:5c195ab2f696 380 // }
gillwei7 0:5c195ab2f696 381 // break;
gillwei7 0:5c195ab2f696 382 // case CMD_READING_TO_EOL:
gillwei7 0:5c195ab2f696 383 // if (isEol) {
gillwei7 0:5c195ab2f696 384 // if (commandState.error != CYNTEC_CMD_SUCCESS) {
gillwei7 0:5c195ab2f696 385 // cyntecCommandErrorHandler(commandState.error);
gillwei7 0:5c195ab2f696 386 // }
gillwei7 0:5c195ab2f696 387 // cyntecCommandReaderInit();
gillwei7 0:5c195ab2f696 388 // }
gillwei7 0:5c195ab2f696 389 // break;
gillwei7 0:5c195ab2f696 390 // }
gillwei7 0:5c195ab2f696 391 //}
gillwei7 0:5c195ab2f696 392
gillwei7 0:5c195ab2f696 393 void cyntecProcessCommandInput(uint8_t input) {
gillwei7 0:5c195ab2f696 394 bool isEol = false;
gillwei7 0:5c195ab2f696 395 bool isSpace = false;
gillwei7 0:5c195ab2f696 396
gillwei7 0:5c195ab2f696 397 if (previousCharacter == '\r' && input == '\n') {
gillwei7 0:5c195ab2f696 398 previousCharacter = input;
gillwei7 0:5c195ab2f696 399 return;
gillwei7 0:5c195ab2f696 400 }
gillwei7 0:5c195ab2f696 401
gillwei7 0:5c195ab2f696 402 previousCharacter = input;
gillwei7 0:5c195ab2f696 403 isEol = ((input == '\r') || (input == '\n'));
gillwei7 0:5c195ab2f696 404 isSpace = (input == ' ');
gillwei7 0:5c195ab2f696 405
gillwei7 0:5c195ab2f696 406 switch (commandState.state) {
gillwei7 0:5c195ab2f696 407 case CMD_AWAITING_ARGUMENT:
gillwei7 0:5c195ab2f696 408 if (!isEol)
gillwei7 0:5c195ab2f696 409 cyntecWriteToTotalBuffer(input);
gillwei7 0:5c195ab2f696 410 if (isEol) {
gillwei7 0:5c195ab2f696 411 callCommandAction();
gillwei7 0:5c195ab2f696 412 } else if (! isSpace) {
gillwei7 0:5c195ab2f696 413 commandState.state = CMD_READING_ARGUMENT;
gillwei7 0:5c195ab2f696 414 cyntecWriteToBuffer(input);
gillwei7 0:5c195ab2f696 415 }
gillwei7 0:5c195ab2f696 416 break;
gillwei7 0:5c195ab2f696 417 case CMD_READING_ARGUMENT:
gillwei7 0:5c195ab2f696 418 if (!isEol)
gillwei7 0:5c195ab2f696 419 cyntecWriteToTotalBuffer(input);
gillwei7 0:5c195ab2f696 420 if (isEol || isSpace) {
gillwei7 0:5c195ab2f696 421 cyntecEndArgument(input);
gillwei7 0:5c195ab2f696 422 } else {
gillwei7 0:5c195ab2f696 423 cyntecWriteToBuffer(input);
gillwei7 0:5c195ab2f696 424 }
gillwei7 0:5c195ab2f696 425 break;
gillwei7 0:5c195ab2f696 426 case CMD_READING_TO_EOL:
gillwei7 0:5c195ab2f696 427 if (isEol) {
gillwei7 0:5c195ab2f696 428 if (commandState.error != CYNTEC_CMD_SUCCESS) {
gillwei7 0:5c195ab2f696 429 cyntecCommandErrorHandler(commandState.error);
gillwei7 0:5c195ab2f696 430 }
gillwei7 0:5c195ab2f696 431 cyntecCommandReaderInit();
gillwei7 0:5c195ab2f696 432 }
gillwei7 0:5c195ab2f696 433 break;
gillwei7 0:5c195ab2f696 434 }
gillwei7 0:5c195ab2f696 435 }
gillwei7 0:5c195ab2f696 436
gillwei7 0:5c195ab2f696 437
gillwei7 0:5c195ab2f696 438 /** Retrieves unsigned integer arguments. */
gillwei7 0:5c195ab2f696 439 uint8_t *cyntecGetCommandArgument(uint8_t argNum, uint8_t *length)
gillwei7 0:5c195ab2f696 440 {
gillwei7 0:5c195ab2f696 441 uint8_t tokenNum = argNum + commandState.argOffset;
gillwei7 0:5c195ab2f696 442
gillwei7 0:5c195ab2f696 443 if (length != NULL) {
gillwei7 0:5c195ab2f696 444 *length = tokenLength(tokenNum);
gillwei7 0:5c195ab2f696 445 }
gillwei7 0:5c195ab2f696 446 return tokenPointer(tokenNum);
gillwei7 0:5c195ab2f696 447 }
gillwei7 0:5c195ab2f696 448
gillwei7 0:5c195ab2f696 449 void clearBuffer(void)
gillwei7 0:5c195ab2f696 450 {
gillwei7 0:5c195ab2f696 451 uint16_t i;
gillwei7 0:5c195ab2f696 452 for (i=0;i<CYNTEC_COMMAND_BUFFER_LENGTH;i++)
gillwei7 0:5c195ab2f696 453 {
gillwei7 0:5c195ab2f696 454 commandState.buffer[i] = NULL;
gillwei7 0:5c195ab2f696 455 }
gillwei7 0:5c195ab2f696 456 }
gillwei7 0:5c195ab2f696 457
gillwei7 0:5c195ab2f696 458 /** Retrieves the token count. */
gillwei7 0:5c195ab2f696 459 uint8_t cyntecGetCommandTokenCnt()
gillwei7 0:5c195ab2f696 460 {
gillwei7 0:5c195ab2f696 461 return commandState.tokenCount;
gillwei7 0:5c195ab2f696 462 }
gillwei7 0:5c195ab2f696 463
gillwei7 0:5c195ab2f696 464 /*
gillwei7 0:5c195ab2f696 465 gill add for accept blank in name 20150904
gillwei7 0:5c195ab2f696 466 uint8_t *cyntecGetCommandBuffer()
gillwei7 0:5c195ab2f696 467 void cyntecWriteToTotalBuffer(uint8_t input)
gillwei7 0:5c195ab2f696 468 uint8_t *cyntecGetCommandTotalBuffer(void)
gillwei7 0:5c195ab2f696 469 uint8_t cyntecGetTotalIndex(void)
gillwei7 0:5c195ab2f696 470 */
gillwei7 0:5c195ab2f696 471 //uint8_t *cyntecGetCommandBuffer()
gillwei7 0:5c195ab2f696 472 //{
gillwei7 0:5c195ab2f696 473 // return commandState.buffer;
gillwei7 0:5c195ab2f696 474 //}
gillwei7 0:5c195ab2f696 475
gillwei7 0:5c195ab2f696 476 void cyntecWriteToTotalBuffer(uint8_t input)
gillwei7 0:5c195ab2f696 477 {
gillwei7 0:5c195ab2f696 478 if (commandState.totalIndex == CYNTEC_COMMAND_BUFFER_LENGTH) {
gillwei7 0:5c195ab2f696 479 commandState.error = CYNTEC_CMD_ERR_WRONG_NUMBER_OF_ARGUMENTS;
gillwei7 0:5c195ab2f696 480 commandState.state = CMD_READING_TO_EOL;
gillwei7 0:5c195ab2f696 481 } else {
gillwei7 0:5c195ab2f696 482 commandState.totalBuffer[commandState.totalIndex] = input;
gillwei7 0:5c195ab2f696 483 commandState.totalIndex += 1;
gillwei7 0:5c195ab2f696 484 }
gillwei7 0:5c195ab2f696 485 }
gillwei7 0:5c195ab2f696 486
gillwei7 0:5c195ab2f696 487 uint8_t *cyntecGetCommandTotalBuffer(void)
gillwei7 0:5c195ab2f696 488 {
gillwei7 0:5c195ab2f696 489 return commandState.totalBuffer;
gillwei7 0:5c195ab2f696 490 }
gillwei7 0:5c195ab2f696 491
gillwei7 0:5c195ab2f696 492 uint8_t cyntecGetTotalIndex(void)
gillwei7 0:5c195ab2f696 493 {
gillwei7 0:5c195ab2f696 494 return commandState.totalIndex;
gillwei7 0:5c195ab2f696 495 }