From 811671aca2ffc9dec349d7e6a2d5a2e7f44df292 Mon Sep 17 00:00:00 2001 From: Jan Breuer <jan.breuer@jaybee.cz> Date: ćšć, 08 10æ 2015 03:00:33 +0800 Subject: [PATCH] Fix conversion constants for 64bit int to str --- libscpi/src/parser.c | 300 ++++++++++++++++++++++++++++++++++++++++++++++++----------- 1 files changed, 242 insertions(+), 58 deletions(-) diff --git a/libscpi/src/parser.c b/libscpi/src/parser.c index 21ac60a..fc343ed 100644 --- a/libscpi/src/parser.c +++ b/libscpi/src/parser.c @@ -44,7 +44,6 @@ #include "scpi/error.h" #include "scpi/constants.h" #include "scpi/utils.h" -#include "scpi/scpi_debug.h" /** * Write data to SCPI output @@ -91,15 +90,10 @@ static size_t writeNewLine(scpi_t * context) { if (context->output_count > 0) { size_t len; -#if (USED_ENDCODE == ENDCODE_CR) - len = writeData(context, "\r", 1); -#elif (USED_ENDCODE == ENDCODE_LF) - len = writeData(context, "\n", 1); -#elif (USED_ENDCODE == ENDCODE_CRLF) - len = writeData(context, "\r\n", 2); -#else +#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 { @@ -135,7 +129,6 @@ 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) { @@ -160,7 +153,7 @@ 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; } @@ -324,19 +317,49 @@ } /** - * 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) { @@ -348,19 +371,19 @@ } /** - * 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); @@ -373,7 +396,82 @@ } /** - * 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 @@ -411,17 +509,17 @@ * @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); @@ -437,7 +535,7 @@ * @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 */ @@ -458,7 +556,7 @@ * @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; @@ -516,7 +614,7 @@ * 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) { @@ -533,13 +631,13 @@ } /** - * Convert parameter to integer + * Convert parameter to signed/unsigned 32 bit integer * @param context * @param parameter * @param value result * @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); @@ -548,16 +646,43 @@ 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); } /** @@ -567,9 +692,10 @@ * @param value result * @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); @@ -580,13 +706,15 @@ 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; } @@ -596,7 +724,7 @@ * @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; @@ -623,13 +751,13 @@ } /** - * 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; @@ -641,7 +769,7 @@ 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; @@ -654,12 +782,34 @@ } /** + * 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; @@ -672,8 +822,17 @@ 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 } @@ -687,7 +846,7 @@ * @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; @@ -731,7 +890,7 @@ 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; } @@ -740,6 +899,10 @@ if (param.ptr[i_from] == quote) { i_from++; } + } + *copy_len = i_to; + if (i_to < buffer_len) { + buffer[i_to] = 0; } break; default: @@ -757,7 +920,7 @@ * @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; @@ -792,7 +955,7 @@ * @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; @@ -812,7 +975,7 @@ * @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; @@ -834,7 +997,7 @@ 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); @@ -853,7 +1016,7 @@ * @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; @@ -876,7 +1039,7 @@ * 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; @@ -915,7 +1078,7 @@ * @param state * @param token * @param numberOfParameters - * @return + * @return */ int scpiParser_parseAllProgramData(lex_state_t * state, scpi_token_t * token, int * numberOfParameters) { @@ -965,7 +1128,7 @@ * @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; @@ -1018,7 +1181,7 @@ * - 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; @@ -1028,7 +1191,7 @@ } pattern = context->param_list.cmd->pattern; - return matchCommand (pattern, cmd, strlen (cmd), NULL, 0); + return matchCommand (pattern, cmd, strlen (cmd), NULL, 0, 0); } /** @@ -1045,9 +1208,30 @@ } 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; } -- Gitblit v1.9.1