| | |
| | | static size_t writeNewLine(scpi_t * context) { |
| | | if (context->output_count > 0) { |
| | | size_t len; |
| | | len = writeData(context, "\r\n", 2); |
| | | #ifndef SCPI_LINE_ENDING |
| | | #error no termination character defined |
| | | #endif |
| | | len = writeData(context, SCPI_LINE_ENDING, strlen(SCPI_LINE_ENDING)); |
| | | flushData(context); |
| | | return len; |
| | | } else { |
| | |
| | | context->output_count = 0; |
| | | context->input_count = 0; |
| | | |
| | | SCPI_DEBUG_COMMAND(context); |
| | | /* if callback exists - call command callback */ |
| | | if (cmd->callback != NULL) { |
| | | if ((cmd->callback(context) != SCPI_RES_OK) && !context->cmd_error) { |
| | |
| | | |
| | | for (i = 0; context->cmdlist[i].pattern != NULL; i++) { |
| | | cmd = &context->cmdlist[i]; |
| | | if (matchCommand(cmd->pattern, header, len, NULL, 0)) { |
| | | if (matchCommand(cmd->pattern, header, len, NULL, 0, 0)) { |
| | | context->param_list.cmd = cmd; |
| | | return TRUE; |
| | | } |
| | |
| | | } |
| | | |
| | | /** |
| | | * Write integer value to the result |
| | | * Write signed 32 bit integer value to the result |
| | | * @param context |
| | | * @param val |
| | | * @return |
| | | */ |
| | | size_t SCPI_ResultInt(scpi_t * context, int32_t val) { |
| | | return SCPI_ResultIntBase(context, val, 10); |
| | | size_t SCPI_ResultInt32(scpi_t * context, int32_t val) { |
| | | return SCPI_ResultInt32Base(context, val, 10); |
| | | } |
| | | |
| | | /** |
| | | * Write unsigned 32 bit integer value to the result |
| | | * @param context |
| | | * @param val |
| | | * @return |
| | | */ |
| | | size_t SCPI_ResultUInt32(scpi_t * context, uint32_t val) { |
| | | return SCPI_ResultUInt32Base(context, val, 10); |
| | | } |
| | | |
| | | /** |
| | | * Write signed 64 bit integer value to the result |
| | | * @param context |
| | | * @param val |
| | | * @return |
| | | */ |
| | | size_t SCPI_ResultInt64(scpi_t * context, int64_t val) { |
| | | return SCPI_ResultInt64Base(context, val, 10); |
| | | } |
| | | |
| | | /** |
| | | * Write unsigned 64 bit integer value to the result |
| | | * @param context |
| | | * @param val |
| | | * @return |
| | | */ |
| | | size_t SCPI_ResultUInt64(scpi_t * context, uint64_t val) { |
| | | return SCPI_ResultUInt64Base(context, val, 10); |
| | | } |
| | | |
| | | /** |
| | | * Return prefix of nondecimal base |
| | | * @param base |
| | | * @return |
| | | * @return |
| | | */ |
| | | static const char * getBasePrefix(int8_t base) { |
| | | switch (base) { |
| | |
| | | } |
| | | |
| | | /** |
| | | * Write integer value in specific base to the result |
| | | * Write signed 32 bit integer value in specific base to the result |
| | | * @param context |
| | | * @param val |
| | | * @param base |
| | | * @return |
| | | * @return |
| | | */ |
| | | size_t SCPI_ResultIntBase(scpi_t * context, int32_t val, int8_t base) { |
| | | size_t SCPI_ResultInt32Base(scpi_t * context, int32_t val, int8_t base) { |
| | | char buffer[33]; |
| | | const char * basePrefix; |
| | | size_t result = 0; |
| | | size_t len; |
| | | |
| | | len = SCPI_LongToStr(val, buffer, sizeof (buffer), base); |
| | | len = SCPI_Int32ToStr(val, buffer, sizeof (buffer), base); |
| | | basePrefix = getBasePrefix(base); |
| | | |
| | | result += writeDelimiter(context); |
| | |
| | | } |
| | | |
| | | /** |
| | | * Write double walue to the result |
| | | * Write unsigned 32 bit integer value in specific base to the result |
| | | * @param context |
| | | * @param val |
| | | * @param base |
| | | * @return |
| | | */ |
| | | size_t SCPI_ResultUInt32Base(scpi_t * context, uint32_t val, int8_t base) { |
| | | char buffer[33]; |
| | | const char * basePrefix; |
| | | size_t result = 0; |
| | | size_t len; |
| | | |
| | | len = SCPI_UInt32ToStr(val, buffer, sizeof (buffer), base); |
| | | basePrefix = getBasePrefix(base); |
| | | |
| | | result += writeDelimiter(context); |
| | | if (basePrefix != NULL) { |
| | | result += writeData(context, basePrefix, 2); |
| | | } |
| | | result += writeData(context, buffer, len); |
| | | context->output_count++; |
| | | return result; |
| | | } |
| | | |
| | | /** |
| | | * Write signed 64 bit integer value in specific base to the result |
| | | * @param context |
| | | * @param val |
| | | * @param base |
| | | * @return |
| | | */ |
| | | size_t SCPI_ResultInt64Base(scpi_t * context, int64_t val, int8_t base) { |
| | | char buffer[33]; //TODO |
| | | const char * basePrefix; |
| | | size_t result = 0; |
| | | size_t len; |
| | | |
| | | len = SCPI_Int64ToStr(val, buffer, sizeof (buffer), base); |
| | | basePrefix = getBasePrefix(base); |
| | | |
| | | result += writeDelimiter(context); |
| | | if (basePrefix != NULL) { |
| | | result += writeData(context, basePrefix, 2); |
| | | } |
| | | result += writeData(context, buffer, len); |
| | | context->output_count++; |
| | | return result; |
| | | } |
| | | |
| | | /** |
| | | * Write unsigned 64 bit integer value in specific base to the result |
| | | * @param context |
| | | * @param val |
| | | * @param base |
| | | * @return |
| | | */ |
| | | size_t SCPI_ResultUInt64Base(scpi_t * context, uint64_t val, int8_t base) { |
| | | char buffer[33]; //TODO |
| | | const char * basePrefix; |
| | | size_t result = 0; |
| | | size_t len; |
| | | |
| | | len = SCPI_UInt64ToStr(val, buffer, sizeof (buffer), base); |
| | | basePrefix = getBasePrefix(base); |
| | | |
| | | result += writeDelimiter(context); |
| | | if (basePrefix != NULL) { |
| | | result += writeData(context, basePrefix, 2); |
| | | } |
| | | result += writeData(context, buffer, len); |
| | | context->output_count++; |
| | | return result; |
| | | } |
| | | |
| | | /** |
| | | * Write double value to the result |
| | | * @param context |
| | | * @param val |
| | | * @return |
| | |
| | | * @param context |
| | | * @param data |
| | | * @param len |
| | | * @return |
| | | * @return |
| | | */ |
| | | size_t SCPI_ResultArbitraryBlock(scpi_t * context, const char * data, size_t len) { |
| | | size_t result = 0; |
| | | char block_header[12]; |
| | | size_t header_len; |
| | | block_header[0] = '#'; |
| | | SCPI_LongToStr(len, block_header + 2, 10, 10); |
| | | SCPI_Int32ToStr(len, block_header + 2, 10, 10); |
| | | |
| | | header_len = strlen(block_header + 2); |
| | | block_header[1] = header_len + '0'; |
| | | block_header[1] = (char)(header_len + '0'); |
| | | |
| | | result += writeData(context, block_header, header_len + 2); |
| | | result += writeData(context, data, len); |
| | |
| | | * @return |
| | | */ |
| | | size_t SCPI_ResultBool(scpi_t * context, scpi_bool_t val) { |
| | | return SCPI_ResultIntBase(context, val ? 1 : 0, 10); |
| | | return SCPI_ResultInt32Base(context, val ? 1 : 0, 10); |
| | | } |
| | | |
| | | /* parsing parameters */ |
| | |
| | | * @param context |
| | | * @param parameter |
| | | * @param mandatory |
| | | * @return |
| | | * @return |
| | | */ |
| | | scpi_bool_t SCPI_Parameter(scpi_t * context, scpi_parameter_t * parameter, scpi_bool_t mandatory) { |
| | | lex_state_t * state; |
| | |
| | | * Detect if parameter is number |
| | | * @param parameter |
| | | * @param suffixAllowed |
| | | * @return |
| | | * @return |
| | | */ |
| | | scpi_bool_t SCPI_ParamIsNumber(scpi_parameter_t * parameter, scpi_bool_t suffixAllowed) { |
| | | switch (parameter->type) { |
| | |
| | | } |
| | | |
| | | /** |
| | | * Convert parameter to integer |
| | | * Convert parameter to signed/unsigned 32 bit integer |
| | | * @param context |
| | | * @param parameter |
| | | * @param value result |
| | | * @return true if succesful |
| | | * @return TRUE if succesful |
| | | */ |
| | | scpi_bool_t SCPI_ParamToInt(scpi_t * context, scpi_parameter_t * parameter, int32_t * value) { |
| | | static scpi_bool_t ParamToInt32(scpi_t * context, scpi_parameter_t * parameter, int32_t * value, scpi_bool_t sign) { |
| | | |
| | | if (!value) { |
| | | SCPI_ErrorPush(context, SCPI_ERROR_SYSTEM_ERROR); |
| | |
| | | |
| | | switch (parameter->type) { |
| | | case SCPI_TOKEN_HEXNUM: |
| | | return strToLong(parameter->ptr, value, 16) > 0 ? TRUE : FALSE; |
| | | return strToUInt32(parameter->ptr, (uint32_t *)value, 16) > 0 ? TRUE : FALSE; |
| | | case SCPI_TOKEN_OCTNUM: |
| | | return strToLong(parameter->ptr, value, 8) > 0 ? TRUE : FALSE; |
| | | return strToUInt32(parameter->ptr, (uint32_t *)value, 8) > 0 ? TRUE : FALSE; |
| | | case SCPI_TOKEN_BINNUM: |
| | | return strToLong(parameter->ptr, value, 2) > 0 ? TRUE : FALSE; |
| | | return strToUInt32(parameter->ptr, (uint32_t *)value, 2) > 0 ? TRUE : FALSE; |
| | | case SCPI_TOKEN_DECIMAL_NUMERIC_PROGRAM_DATA: |
| | | case SCPI_TOKEN_DECIMAL_NUMERIC_PROGRAM_DATA_WITH_SUFFIX: |
| | | return strToLong(parameter->ptr, value, 10) > 0 ? TRUE : FALSE; |
| | | if (sign) { |
| | | return strToInt32(parameter->ptr, value, 10) > 0 ? TRUE : FALSE; |
| | | } else { |
| | | return strToUInt32(parameter->ptr, (uint32_t *)value, 10) > 0 ? TRUE : FALSE; |
| | | } |
| | | default: |
| | | return FALSE; |
| | | } |
| | | return FALSE; |
| | | } |
| | | |
| | | /** |
| | | * Convert parameter to signed 32 bit integer |
| | | * @param context |
| | | * @param parameter |
| | | * @param value result |
| | | * @return TRUE if succesful |
| | | */ |
| | | scpi_bool_t SCPI_ParamToInt32(scpi_t * context, scpi_parameter_t * parameter, int32_t * value) { |
| | | return ParamToInt32(context, parameter, value, TRUE); |
| | | } |
| | | |
| | | /** |
| | | * Convert parameter to unsigned 32 bit integer |
| | | * @param context |
| | | * @param parameter |
| | | * @param value result |
| | | * @return TRUE if succesful |
| | | */ |
| | | scpi_bool_t SCPI_ParamToUInt32(scpi_t * context, scpi_parameter_t * parameter, uint32_t * value) { |
| | | return ParamToInt32(context, parameter, (int32_t *)value, FALSE); |
| | | } |
| | | |
| | | /** |
| | |
| | | * @param context |
| | | * @param parameter |
| | | * @param value result |
| | | * @return true if succesful |
| | | * @return TRUE if succesful |
| | | */ |
| | | #include "stdio.h" |
| | | scpi_bool_t SCPI_ParamToDouble(scpi_t * context, scpi_parameter_t * parameter, double * value) { |
| | | scpi_bool_t result = FALSE; |
| | | int32_t valint; |
| | | scpi_bool_t result; |
| | | uint32_t valint; |
| | | |
| | | if (!value) { |
| | | SCPI_ErrorPush(context, SCPI_ERROR_SYSTEM_ERROR); |
| | |
| | | case SCPI_TOKEN_HEXNUM: |
| | | case SCPI_TOKEN_OCTNUM: |
| | | case SCPI_TOKEN_BINNUM: |
| | | result = SCPI_ParamToInt(context, parameter, &valint); |
| | | result = SCPI_ParamToUInt32(context, parameter, &valint); |
| | | *value = valint; |
| | | break; |
| | | case SCPI_TOKEN_DECIMAL_NUMERIC_PROGRAM_DATA: |
| | | case SCPI_TOKEN_DECIMAL_NUMERIC_PROGRAM_DATA_WITH_SUFFIX: |
| | | result = strToDouble(parameter->ptr, value) > 0 ? TRUE : FALSE; |
| | | break; |
| | | default: |
| | | result = FALSE; |
| | | } |
| | | return result; |
| | | } |
| | |
| | | * @param context |
| | | * @param value |
| | | * @param mandatory |
| | | * @return |
| | | * @return |
| | | */ |
| | | scpi_bool_t SCPI_ParamDouble(scpi_t * context, double * value, scpi_bool_t mandatory) { |
| | | scpi_bool_t result; |
| | |
| | | } |
| | | |
| | | /** |
| | | * Read integer parameter |
| | | * Read signed/unsigned 32 bit integer parameter |
| | | * @param context |
| | | * @param value |
| | | * @param mandatory |
| | | * @return |
| | | * @return |
| | | */ |
| | | scpi_bool_t SCPI_ParamInt(scpi_t * context, int32_t * value, scpi_bool_t mandatory) { |
| | | static scpi_bool_t ParamInt32(scpi_t * context, int32_t * value, scpi_bool_t mandatory, scpi_bool_t sign) { |
| | | scpi_bool_t result; |
| | | scpi_parameter_t param; |
| | | |
| | |
| | | result = SCPI_Parameter(context, ¶m, mandatory); |
| | | if (result) { |
| | | if (SCPI_ParamIsNumber(¶m, FALSE)) { |
| | | SCPI_ParamToInt(context, ¶m, value); |
| | | result = ParamToInt32(context, ¶m, value, sign); |
| | | } else if (SCPI_ParamIsNumber(¶m, TRUE)) { |
| | | SCPI_ErrorPush(context, SCPI_ERROR_SUFFIX_NOT_ALLOWED); |
| | | result = FALSE; |
| | |
| | | } |
| | | |
| | | /** |
| | | * Read signed 32 bit integer parameter |
| | | * @param context |
| | | * @param value |
| | | * @param mandatory |
| | | * @return |
| | | */ |
| | | scpi_bool_t SCPI_ParamInt32(scpi_t * context, int32_t * value, scpi_bool_t mandatory) { |
| | | return ParamInt32(context, value, mandatory, TRUE); |
| | | } |
| | | |
| | | /** |
| | | * Read unsigned 32 bit integer parameter |
| | | * @param context |
| | | * @param value |
| | | * @param mandatory |
| | | * @return |
| | | */ |
| | | scpi_bool_t SCPI_ParamUInt32(scpi_t * context, uint32_t * value, scpi_bool_t mandatory) { |
| | | return ParamInt32(context, (int32_t *)value, mandatory, FALSE); |
| | | } |
| | | |
| | | /** |
| | | * Read character parameter |
| | | * @param context |
| | | * @param value |
| | | * @param len |
| | | * @param mandatory |
| | | * @return |
| | | * @return |
| | | */ |
| | | scpi_bool_t SCPI_ParamCharacters(scpi_t * context, const char ** value, size_t * len, scpi_bool_t mandatory) { |
| | | scpi_bool_t result; |
| | |
| | | |
| | | result = SCPI_Parameter(context, ¶m, mandatory); |
| | | if (result) { |
| | | *value = param.ptr; |
| | | *len = param.len; |
| | | switch(param.type) { |
| | | case SCPI_TOKEN_SINGLE_QUOTE_PROGRAM_DATA: |
| | | case SCPI_TOKEN_DOUBLE_QUOTE_PROGRAM_DATA: |
| | | *value = param.ptr + 1; |
| | | *len = param.len - 2; |
| | | break; |
| | | default: |
| | | *value = param.ptr; |
| | | *len = param.len; |
| | | break; |
| | | } |
| | | |
| | | // TODO: return also parameter type (ProgramMnemonic, ArbitraryBlockProgramData, SingleQuoteProgramData, DoubleQuoteProgramData |
| | | } |
| | |
| | | * @param value result pointer to data |
| | | * @param len result length of data |
| | | * @param mandatory |
| | | * @return |
| | | * @return |
| | | */ |
| | | scpi_bool_t SCPI_ParamArbitraryBlock(scpi_t * context, const char ** value, size_t * len, scpi_bool_t mandatory) { |
| | | scpi_bool_t result; |
| | |
| | | case SCPI_TOKEN_SINGLE_QUOTE_PROGRAM_DATA: |
| | | case SCPI_TOKEN_DOUBLE_QUOTE_PROGRAM_DATA: |
| | | quote = param.type == SCPI_TOKEN_SINGLE_QUOTE_PROGRAM_DATA ? '\'' : '"'; |
| | | for (i_from = 0, i_to = 0; i_from < (size_t) param.len; i_from++) { |
| | | for (i_from = 1, i_to = 0; i_from < (size_t) (param.len - 1); i_from++) { |
| | | if (i_from >= buffer_len) { |
| | | break; |
| | | } |
| | |
| | | if (param.ptr[i_from] == quote) { |
| | | i_from++; |
| | | } |
| | | } |
| | | *copy_len = i_to; |
| | | if (i_to < buffer_len) { |
| | | buffer[i_to] = 0; |
| | | } |
| | | break; |
| | | default: |
| | |
| | | * @param parameter - should be PROGRAM_MNEMONIC |
| | | * @param options - NULL terminated list of choices |
| | | * @param value - index to options |
| | | * @return |
| | | * @return |
| | | */ |
| | | scpi_bool_t SCPI_ParamToChoice(scpi_t * context, scpi_parameter_t * parameter, const scpi_choice_def_t * options, int32_t * value) { |
| | | size_t res; |
| | |
| | | * @param options specifications of choices numbers (patterns) |
| | | * @param tag numerical representatio of choice |
| | | * @param text result text |
| | | * @return true if succesfule, else false |
| | | * @return TRUE if succesfule, else FALSE |
| | | */ |
| | | scpi_bool_t SCPI_ChoiceToName(const scpi_choice_def_t * options, int32_t tag, const char ** text) { |
| | | int i; |
| | |
| | | * @param context |
| | | * @param value |
| | | * @param mandatory |
| | | * @return |
| | | * @return |
| | | */ |
| | | scpi_bool_t SCPI_ParamBool(scpi_t * context, scpi_bool_t * value, scpi_bool_t mandatory) { |
| | | scpi_bool_t result; |
| | |
| | | |
| | | if (result) { |
| | | if (param.type == SCPI_TOKEN_DECIMAL_NUMERIC_PROGRAM_DATA) { |
| | | SCPI_ParamToInt(context, ¶m, &intval); |
| | | SCPI_ParamToInt32(context, ¶m, &intval); |
| | | *value = intval ? TRUE : FALSE; |
| | | } else { |
| | | result = SCPI_ParamToChoice(context, ¶m, bool_options, &intval); |
| | |
| | | * @param options |
| | | * @param value |
| | | * @param mandatory |
| | | * @return |
| | | * @return |
| | | */ |
| | | scpi_bool_t SCPI_ParamChoice(scpi_t * context, const scpi_choice_def_t * options, int32_t * value, scpi_bool_t mandatory) { |
| | | scpi_bool_t result; |
| | |
| | | * Parse one parameter and detect type |
| | | * @param state |
| | | * @param token |
| | | * @return |
| | | * @return |
| | | */ |
| | | int scpiParser_parseProgramData(lex_state_t * state, scpi_token_t * token) { |
| | | scpi_token_t tmp; |
| | |
| | | * @param state |
| | | * @param token |
| | | * @param numberOfParameters |
| | | * @return |
| | | * @return |
| | | */ |
| | | int scpiParser_parseAllProgramData(lex_state_t * state, scpi_token_t * token, int * numberOfParameters) { |
| | | |
| | |
| | | * @param state |
| | | * @param buffer |
| | | * @param len |
| | | * @return |
| | | * @return |
| | | */ |
| | | int scpiParser_detectProgramMessageUnit(scpi_parser_state_t * state, char * buffer, int len) { |
| | | lex_state_t lex_state; |
| | |
| | | * - suitable for one handle to multiple commands |
| | | * @param context |
| | | * @param cmd |
| | | * @return |
| | | * @return |
| | | */ |
| | | scpi_bool_t SCPI_IsCmd(scpi_t * context, const char * cmd) { |
| | | const char * pattern; |
| | | |
| | | if (!context->param_list.cmd) { |
| | | return FALSE; |
| | | } |
| | | |
| | | const char * pattern = context->param_list.cmd->pattern; |
| | | return matchCommand (pattern, cmd, strlen (cmd), NULL, 0); |
| | | pattern = context->param_list.cmd->pattern; |
| | | return matchCommand (pattern, cmd, strlen (cmd), NULL, 0, 0); |
| | | } |
| | | |
| | | /** |
| | |
| | | } |
| | | |
| | | scpi_bool_t SCPI_Match(const char * pattern, const char * value, size_t len) { |
| | | return matchCommand (pattern, value, len, NULL, 0); |
| | | return matchCommand (pattern, value, len, NULL, 0, 0); |
| | | } |
| | | |
| | | scpi_bool_t SCPI_CommandNumbers(scpi_t * context, int32_t * numbers, size_t len) { |
| | | return matchCommand (context->param_list.cmd->pattern, context->param_list.cmd_raw.data, context->param_list.cmd_raw.length, numbers, len); |
| | | scpi_bool_t SCPI_CommandNumbers(scpi_t * context, int32_t * numbers, size_t len, int32_t default_value) { |
| | | return matchCommand (context->param_list.cmd->pattern, context->param_list.cmd_raw.data, context->param_list.cmd_raw.length, numbers, len, default_value); |
| | | } |
| | | |
| | | /** |
| | | * If SCPI_Parameter() returns FALSE, this function can detect, if the parameter |
| | | * is just missing (TRUE) or if there was an error during processing of the command (FALSE) |
| | | * @param parameter |
| | | * @return |
| | | */ |
| | | scpi_bool_t SCPI_ParamIsValid(scpi_parameter_t * parameter) |
| | | { |
| | | return parameter->type == SCPI_TOKEN_UNKNOWN ? FALSE : TRUE; |
| | | } |
| | | |
| | | /** |
| | | * Returns TRUE if there was an error during parameter handling |
| | | * @param context |
| | | * @return |
| | | */ |
| | | scpi_bool_t SCPI_ParamErrorOccurred(scpi_t * context) |
| | | { |
| | | return context->cmd_error; |
| | | } |