Luca Jel
/
mbed5a_testy
sdsd
Fork of mbed5a_testy by
Diff: command_decoder.cpp
- Revision:
- 1:b8d65b5745d1
- Parent:
- 0:e69a0b7f4b41
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/command_decoder.cpp Fri May 05 20:01:41 2017 +0000 @@ -0,0 +1,87 @@ +#include "string.h" +#include "command_decoder.h" + +struct Keyword asKeywordList[MAX_KEYWORD_NR]= + { + {CALLIB, "callib"}, + {GOTO, "goto"}, + {STEP, "step"}, + {ID, "id"} + }; +struct Token asToken[MAX_TOKEN_NR]; + +unsigned char ucTokenNr; + +unsigned char ucFindTokensInString(char *pcString){ + + enum LedState { TOKEN, DELIMITER}; + enum LedState eState = DELIMITER; + + unsigned char ucLicznikTokenu = 0; + unsigned char ucLicznikZnaku = 0; + char cAktualnyZnak; + + for(ucLicznikZnaku=0; pcString[ucLicznikZnaku] != NULL; ucLicznikZnaku++){ + cAktualnyZnak = pcString[ucLicznikZnaku]; + switch(eState){ + case DELIMITER: + if(cAktualnyZnak == DELIMITER_CHAR){ + eState = DELIMITER; + }else if(ucLicznikTokenu < MAX_TOKEN_NR){ + eState = TOKEN; + asToken[ucLicznikTokenu].uValue.pcString = pcString + ucLicznikZnaku; + ucLicznikTokenu++; + }else{ + return(ucLicznikTokenu); + } + break; + case TOKEN: + if(cAktualnyZnak!= DELIMITER_CHAR){ + eState = TOKEN; + }else{ + eState = DELIMITER; + } + break; + } + } + return(ucLicznikTokenu); +} + +enum Result eStringToKeyword(char pcStr[], enum KeywordCode *peKeywordCode){ + + unsigned char ucKeywordIndex; + + for(ucKeywordIndex=0; ucKeywordIndex < MAX_KEYWORD_NR; ucKeywordIndex++){ + if(eCompareString(pcStr, asKeywordList[ucKeywordIndex].cString) == EQUAL){ + *peKeywordCode = asKeywordList[ucKeywordIndex].eCode; + return(OK); + } + } + return(ERROR); +} + +void DecodeTokens(void){ + + unsigned int uiNumber; + unsigned char ucTokenIndex; + enum KeywordCode eKeyword; + + for(ucTokenIndex=0; ucTokenIndex < ucTokenNr; ucTokenIndex++){ + if((eStringToKeyword (asToken[ucTokenIndex].uValue.pcString, &eKeyword))== OK){ + asToken[ucTokenIndex].eType = KEYWORD; + asToken[ucTokenIndex].uValue.eKeyword=eKeyword; + }else if((eHexStringToUInt(asToken[ucTokenIndex].uValue.pcString,&uiNumber))== OK){ + asToken[ucTokenIndex].eType = NUMBER; + asToken[ucTokenIndex].uValue.uiNumber = uiNumber; + }else{ + asToken[ucTokenIndex].eType = STRING; + } + } +} + +void DecodeMsg(char *pcString){ + + ucTokenNr = ucFindTokensInString (pcString); + ReplaceCharactersInString(pcString,' ',NULL); + DecodeTokens(); +}