| | |
| | | while (1) { |
| | | result = 0; |
| | | |
| | | r = detectProgramMessageUnit(state, data, len); |
| | | r = scpiParser_detectProgramMessageUnit(state, data, len); |
| | | |
| | | if (state->programHeader.type == TokInvalid) { |
| | | if (state->programHeader.type == SCPI_TOKEN_INVALID) { |
| | | SCPI_ErrorPush(context, SCPI_ERROR_INVALID_CHARACTER); |
| | | } else if (state->programHeader.len > 0) { |
| | | if (findCommandHeader(context, state->programHeader.ptr, state->programHeader.len)) { |
| | |
| | | |
| | | |
| | | while (1) { |
| | | cmdlen = detectProgramMessageUnit(&context->parser_state, context->buffer.data + totcmdlen, context->buffer.position - totcmdlen); |
| | | cmdlen = scpiParser_detectProgramMessageUnit(&context->parser_state, context->buffer.data + totcmdlen, context->buffer.position - totcmdlen); |
| | | totcmdlen += cmdlen; |
| | | if (context->parser_state.termination == PmutNewLine) break; |
| | | if (context->parser_state.programHeader.type == TokUnknown) break; |
| | | if (context->parser_state.termination == SCPI_MESSAGE_TERMINATION_NL) break; |
| | | if (context->parser_state.programHeader.type == SCPI_TOKEN_UNKNOWN) break; |
| | | if (totcmdlen >= context->buffer.position) break; |
| | | } |
| | | |
| | | if (context->parser_state.termination == PmutNewLine) { |
| | | if (context->parser_state.termination == SCPI_MESSAGE_TERMINATION_NL) { |
| | | result = SCPI_Parse(context, context->buffer.data, totcmdlen); |
| | | memmove(context->buffer.data, context->buffer.data + totcmdlen, context->buffer.position - totcmdlen); |
| | | context->buffer.position -= totcmdlen; |
| | |
| | | return SCPI_ResultIntBase(context, val, 10); |
| | | } |
| | | |
| | | /** |
| | | * Return prefix of nondecimal base |
| | | * @param base |
| | | * @return |
| | | */ |
| | | static const char * getBasePrefix(int8_t base) { |
| | | switch (base) { |
| | | case 2: return "#B"; |
| | |
| | | } |
| | | } |
| | | |
| | | /** |
| | | * Write integer value in specific base to the result |
| | | * @param context |
| | | * @param val |
| | | * @param base |
| | | * @return |
| | | */ |
| | | size_t SCPI_ResultIntBase(scpi_t * context, int32_t val, int8_t base) { |
| | | char buffer[33]; |
| | | const char * basePrefix; |
| | |
| | | size_t result = 0; |
| | | result += writeDelimiter(context); |
| | | result += writeData(context, "\"", 1); |
| | | // TODO: convert " to "" |
| | | result += writeData(context, data, strlen(data)); |
| | | result += writeData(context, "\"", 1); |
| | | context->output_count++; |
| | |
| | | |
| | | |
| | | /* parsing parameters */ |
| | | |
| | | /** |
| | | * Get one parameter from command line |
| | | * @param context |
| | | * @param parameter |
| | | * @param mandatory |
| | | * @return |
| | | */ |
| | | scpi_bool_t SCPI_Parameter(scpi_t * context, scpi_parameter_t * parameter, scpi_bool_t mandatory) { |
| | | scpi_token_t token; |
| | | lex_state_t * state; |
| | |
| | | parameter->number.base = 10; |
| | | parameter->number.unit = SCPI_UNIT_NONE; |
| | | parameter->number.type = SCPI_NUM_NUMBER; |
| | | parameter->type = TokUnknown; |
| | | parameter->type = SCPI_TOKEN_UNKNOWN; |
| | | |
| | | state = &context->param_list.lex_state; |
| | | |
| | |
| | | SCPI_ErrorPush(context, SCPI_ERROR_MISSING_PARAMETER); |
| | | } else { |
| | | parameter->number.type = SCPI_NUM_DEF; |
| | | parameter->type = TokProgramMnemonic; // TODO: select something different |
| | | parameter->type = SCPI_TOKEN_PROGRAM_MNEMONIC; // TODO: select something different |
| | | } |
| | | return FALSE; |
| | | } |
| | | if (context->input_count != 0) { |
| | | lexComma(state, &token); |
| | | if (token.type != TokComma) { |
| | | scpiLex_Comma(state, &token); |
| | | if (token.type != SCPI_TOKEN_COMMA) { |
| | | SCPI_ErrorPush(context, SCPI_ERROR_INVALID_SEPARATOR); |
| | | return FALSE; |
| | | } |
| | |
| | | |
| | | context->input_count++; |
| | | |
| | | parseProgramData(&context->param_list.lex_state, &token); |
| | | scpiParser_parseProgramData(&context->param_list.lex_state, &token); |
| | | |
| | | parameter->type = token.type; |
| | | parameter->data.ptr = token.ptr; |
| | | parameter->data.len = token.len; |
| | | |
| | | switch (token.type) { |
| | | case TokHexnum: |
| | | case SCPI_TOKEN_HEXNUM: |
| | | parameter->number.base = 16; |
| | | strToLong(token.ptr, &value, 16); |
| | | parameter->number.value = value; |
| | | return TRUE; |
| | | case TokOctnum: |
| | | case SCPI_TOKEN_OCTNUM: |
| | | parameter->number.base = 8; |
| | | strToLong(token.ptr, &value, 8); |
| | | parameter->number.value = value; |
| | | return TRUE; |
| | | case TokBinnum: |
| | | case SCPI_TOKEN_BINNUM: |
| | | parameter->number.base = 2; |
| | | strToLong(token.ptr, &value, 2); |
| | | parameter->number.value = value; |
| | | return TRUE; |
| | | case TokProgramMnemonic: |
| | | case SCPI_TOKEN_PROGRAM_MNEMONIC: |
| | | return TRUE; |
| | | case TokDecimalNumericProgramData: |
| | | case SCPI_TOKEN_DECIMAL_NUMERIC_PROGRAM_DATA: |
| | | strToDouble(token.ptr, ¶meter->number.value); |
| | | return TRUE; |
| | | case TokDecimalNumericProgramDataWithSuffix: |
| | | case SCPI_TOKEN_DECIMAL_NUMERIC_PROGRAM_DATA_WITH_SUFFIX: |
| | | strToDouble(token.ptr, ¶meter->number.value); |
| | | return TRUE; |
| | | case TokArbitraryBlockProgramData: |
| | | case SCPI_TOKEN_ARBITRARY_BLOCK_PROGRAM_DATA: |
| | | return TRUE; |
| | | case TokSingleQuoteProgramData: |
| | | case SCPI_TOKEN_SINGLE_QUOTE_PROGRAM_DATA: |
| | | // TODO: replace double "single qoute" |
| | | return TRUE; |
| | | case TokDoubleQuoteProgramData: |
| | | case SCPI_TOKEN_DOUBLE_QUOTE_PROGRAM_DATA: |
| | | // TODO: replace double "double qoute" |
| | | return TRUE; |
| | | case TokProgramExpression: |
| | | case SCPI_TOKEN_PROGRAM_EXPRESSION: |
| | | return TRUE; |
| | | default: |
| | | parameter->type = TokUnknown; |
| | | parameter->type = SCPI_TOKEN_UNKNOWN; |
| | | parameter->data.ptr = NULL; |
| | | parameter->data.len = 0; |
| | | SCPI_ErrorPush(context, SCPI_ERROR_INVALID_STRING_DATA); |
| | |
| | | } |
| | | } |
| | | |
| | | /** |
| | | * Detect if parameter is number |
| | | * @param parameter |
| | | * @param suffixAllowed |
| | | * @return |
| | | */ |
| | | scpi_bool_t SCPI_ParamIsNumber(scpi_parameter_t * parameter, scpi_bool_t suffixAllowed) { |
| | | switch (parameter->type) { |
| | | case TokHexnum: |
| | | case TokOctnum: |
| | | case TokBinnum: |
| | | case TokDecimalNumericProgramData: |
| | | case SCPI_TOKEN_HEXNUM: |
| | | case SCPI_TOKEN_OCTNUM: |
| | | case SCPI_TOKEN_BINNUM: |
| | | case SCPI_TOKEN_DECIMAL_NUMERIC_PROGRAM_DATA: |
| | | return TRUE; |
| | | case TokDecimalNumericProgramDataWithSuffix: |
| | | case SCPI_TOKEN_DECIMAL_NUMERIC_PROGRAM_DATA_WITH_SUFFIX: |
| | | return suffixAllowed; |
| | | default: |
| | | return FALSE; |
| | | } |
| | | } |
| | | |
| | | /** |
| | | * Read floating point parameter |
| | | * @param context |
| | | * @param value |
| | | * @param mandatory |
| | | * @return |
| | | */ |
| | | scpi_bool_t SCPI_ParamDouble(scpi_t * context, double * value, scpi_bool_t mandatory) |
| | | { |
| | | scpi_bool_t result; |
| | |
| | | return result; |
| | | } |
| | | |
| | | /** |
| | | * Read integer parameter |
| | | * @param context |
| | | * @param value |
| | | * @param mandatory |
| | | * @return |
| | | */ |
| | | scpi_bool_t SCPI_ParamInt(scpi_t * context, int32_t * value, scpi_bool_t mandatory) |
| | | { |
| | | // TODO: remove dependency on double |
| | |
| | | return result; |
| | | } |
| | | |
| | | /** |
| | | * Read character parameter |
| | | * @param context |
| | | * @param value |
| | | * @param len |
| | | * @param mandatory |
| | | * @return |
| | | */ |
| | | scpi_bool_t SCPI_ParamCharacters(scpi_t * context, const char ** value, size_t * len, scpi_bool_t mandatory) |
| | | { |
| | | scpi_bool_t result; |
| | |
| | | return result; |
| | | } |
| | | |
| | | /** |
| | | * Read BOOL parameter (0,1,ON,OFF) |
| | | * @param context |
| | | * @param value |
| | | * @param mandatory |
| | | * @return |
| | | */ |
| | | scpi_bool_t SCPI_ParamBool(scpi_t * context, scpi_bool_t * value, scpi_bool_t mandatory) |
| | | { |
| | | scpi_bool_t result; |
| | |
| | | |
| | | if (result) { |
| | | switch (param.type) { |
| | | case TokDecimalNumericProgramData: |
| | | case SCPI_TOKEN_DECIMAL_NUMERIC_PROGRAM_DATA: |
| | | *value = param.number.value ? 1 : 0; |
| | | break; |
| | | case TokProgramMnemonic: |
| | | case SCPI_TOKEN_PROGRAM_MNEMONIC: |
| | | if (compareStr("ON", 2, param.data.ptr, param.data.len)) { |
| | | *value = TRUE; |
| | | } else if (compareStr("OFF", 3, param.data.ptr, param.data.len)) { |
| | |
| | | return result; |
| | | } |
| | | |
| | | /** |
| | | * Read value from list of options |
| | | * @param context |
| | | * @param options |
| | | * @param value |
| | | * @param mandatory |
| | | * @return |
| | | */ |
| | | scpi_bool_t SCPI_ParamChoice(scpi_t * context, const char * options[], int32_t * value, scpi_bool_t mandatory) |
| | | { |
| | | size_t res; |
| | |
| | | |
| | | result = SCPI_Parameter(context, ¶m, mandatory); |
| | | if (result) { |
| | | if (param.type == TokProgramMnemonic) { |
| | | if (param.type == SCPI_TOKEN_PROGRAM_MNEMONIC) { |
| | | for (res = 0; options[res]; ++res) { |
| | | if (matchPattern(options[res], strlen(options[res]), param.data.ptr, param.data.len)) { |
| | | *value = res; |
| | |
| | | return result; |
| | | } |
| | | |
| | | int parseProgramData(lex_state_t * state, scpi_token_t * token) { |
| | | /** |
| | | * Parse one parameter and detect type |
| | | * @param state |
| | | * @param token |
| | | * @return |
| | | */ |
| | | int scpiParser_parseProgramData(lex_state_t * state, scpi_token_t * token) { |
| | | scpi_token_t tmp; |
| | | int result = 0; |
| | | int wsLen; |
| | | int suffixLen; |
| | | int realLen = 0; |
| | | realLen += lexWhiteSpace(state, &tmp); |
| | | realLen += scpiLex_WhiteSpace(state, &tmp); |
| | | |
| | | if (result == 0) result = lexNondecimalNumericData(state, token); |
| | | if (result == 0) result = lexCharacterProgramData(state, token); |
| | | if (result == 0) result = scpiLex_NondecimalNumericData(state, token); |
| | | if (result == 0) result = scpiLex_CharacterProgramData(state, token); |
| | | if (result == 0) { |
| | | result = lexDecimalNumericProgramData(state, token); |
| | | result = scpiLex_DecimalNumericProgramData(state, token); |
| | | if (result != 0) { |
| | | wsLen = lexWhiteSpace(state, &tmp); |
| | | suffixLen = lexSuffixProgramData(state, &tmp); |
| | | wsLen = scpiLex_WhiteSpace(state, &tmp); |
| | | suffixLen = scpiLex_SuffixProgramData(state, &tmp); |
| | | if (suffixLen > 0) { |
| | | token->len += wsLen + suffixLen; |
| | | token->type = TokDecimalNumericProgramDataWithSuffix; |
| | | token->type = SCPI_TOKEN_DECIMAL_NUMERIC_PROGRAM_DATA_WITH_SUFFIX; |
| | | result = token->len; |
| | | } |
| | | } |
| | | } |
| | | |
| | | if (result == 0) result = lexStringProgramData(state, token); |
| | | if (result == 0) result = lexArbitraryBlockProgramData(state, token); |
| | | if (result == 0) result = lexProgramExpression(state, token); |
| | | if (result == 0) result = scpiLex_StringProgramData(state, token); |
| | | if (result == 0) result = scpiLex_ArbitraryBlockProgramData(state, token); |
| | | if (result == 0) result = scpiLex_ProgramExpression(state, token); |
| | | |
| | | realLen += lexWhiteSpace(state, &tmp); |
| | | realLen += scpiLex_WhiteSpace(state, &tmp); |
| | | |
| | | return result + realLen; |
| | | } |
| | | |
| | | int parseAllProgramData(lex_state_t * state, scpi_token_t * token, int * numberOfParameters) { |
| | | /** |
| | | * Skip all parameters to correctly detect end of command line. |
| | | * @param state |
| | | * @param token |
| | | * @param numberOfParameters |
| | | * @return |
| | | */ |
| | | int scpiParser_parseAllProgramData(lex_state_t * state, scpi_token_t * token, int * numberOfParameters) { |
| | | |
| | | int result; |
| | | scpi_token_t tmp; |
| | | int paramCount = 0; |
| | | |
| | | token->len = -1; |
| | | token->type = TokAllProgramData; |
| | | token->type = SCPI_TOKEN_ALL_PROGRAM_DATA; |
| | | token->ptr = state->pos; |
| | | |
| | | |
| | | for (result = 1; result != 0; result = lexComma(state, &tmp)) { |
| | | for (result = 1; result != 0; result = scpiLex_Comma(state, &tmp)) { |
| | | token->len += result; |
| | | |
| | | if (result == 0) { |
| | | token->type = TokUnknown; |
| | | token->type = SCPI_TOKEN_UNKNOWN; |
| | | token->len = 0; |
| | | paramCount = -1; |
| | | break; |
| | | } |
| | | |
| | | result = parseProgramData(state, &tmp); |
| | | if (tmp.type != TokUnknown) { |
| | | result = scpiParser_parseProgramData(state, &tmp); |
| | | if (tmp.type != SCPI_TOKEN_UNKNOWN) { |
| | | token->len += result; |
| | | } else { |
| | | token->type = TokUnknown; |
| | | token->type = SCPI_TOKEN_UNKNOWN; |
| | | token->len = 0; |
| | | paramCount = -1; |
| | | break; |
| | |
| | | static void invalidateToken(scpi_token_t * token, const char * ptr) { |
| | | token->len = 0; |
| | | token->ptr = ptr; |
| | | token->type = TokUnknown; |
| | | token->type = SCPI_TOKEN_UNKNOWN; |
| | | } |
| | | |
| | | int detectProgramMessageUnit(scpi_parser_state_t * state, const char * buffer, int len) { |
| | | /** |
| | | * Skip complete command line - program header and parameters |
| | | * @param state |
| | | * @param buffer |
| | | * @param len |
| | | * @return |
| | | */ |
| | | int scpiParser_detectProgramMessageUnit(scpi_parser_state_t * state, const char * buffer, int len) { |
| | | lex_state_t lex_state; |
| | | scpi_token_t tmp; |
| | | int result = 0; |
| | |
| | | state->numberOfParameters = 0; |
| | | |
| | | /* ignore whitespace at the begginig */ |
| | | lexWhiteSpace(&lex_state, &tmp); |
| | | scpiLex_WhiteSpace(&lex_state, &tmp); |
| | | |
| | | if (lexProgramHeader(&lex_state, &state->programHeader) >= 0) { |
| | | if (lexWhiteSpace(&lex_state, &tmp) > 0) { |
| | | parseAllProgramData(&lex_state, &state->programData, &state->numberOfParameters); |
| | | if (scpiLex_ProgramHeader(&lex_state, &state->programHeader) >= 0) { |
| | | if (scpiLex_WhiteSpace(&lex_state, &tmp) > 0) { |
| | | scpiParser_parseAllProgramData(&lex_state, &state->programData, &state->numberOfParameters); |
| | | } else { |
| | | invalidateToken(&state->programData, lex_state.pos); |
| | | } |
| | |
| | | invalidateToken(&state->programData, lex_state.buffer); |
| | | } |
| | | |
| | | if (result == 0) result = lexNewLine(&lex_state, &tmp); |
| | | if (result == 0) result = lexSemicolon(&lex_state, &tmp); |
| | | if (result == 0) result = scpiLex_NewLine(&lex_state, &tmp); |
| | | if (result == 0) result = scpiLex_Semicolon(&lex_state, &tmp); |
| | | |
| | | if (!lexIsEos(&lex_state) && (result == 0)) { |
| | | if (!scpiLex_IsEos(&lex_state) && (result == 0)) { |
| | | lex_state.pos++; |
| | | |
| | | state->programHeader.len = 1; |
| | | state->programHeader.type = TokInvalid; |
| | | state->programHeader.type = SCPI_TOKEN_INVALID; |
| | | |
| | | invalidateToken(&state->programData, lex_state.buffer); |
| | | } |
| | | |
| | | if (TokSemicolon == tmp.type) { |
| | | state->termination = PmutSemicolon; |
| | | } else if (TokNewLine == tmp.type) { |
| | | state->termination = PmutNewLine; |
| | | if (SCPI_TOKEN_SEMICOLON == tmp.type) { |
| | | state->termination = SCPI_MESSAGE_TERMINATION_SEMICOLON; |
| | | } else if (SCPI_TOKEN_NL == tmp.type) { |
| | | state->termination = SCPI_MESSAGE_TERMINATION_NL; |
| | | } else { |
| | | state->termination = PmutNone; |
| | | state->termination = SCPI_MESSAGE_TERMINATION_NONE; |
| | | } |
| | | |
| | | return lex_state.pos - lex_state.buffer; |