| | |
| | | } |
| | | |
| | | /** |
| | | * Converts string to unsigned 32bit integer representation |
| | | * @param str string value |
| | | * @param val 32bit integer result |
| | | * @return number of bytes used in string |
| | | */ |
| | | size_t strToULong(const char * str, uint32_t * val, int8_t base) { |
| | | char * endptr; |
| | | *val = strtoul(str, &endptr, base); |
| | | return endptr - str; |
| | | } |
| | | |
| | | |
| | | /** |
| | | * Converts string to double representation |
| | | * @param str string value |
| | | * @param val double result |
| | |
| | | * @param len - max search length |
| | | * @return position of separator or len |
| | | */ |
| | | size_t patternSeparatorShortPos(const char * pattern, size_t len) { |
| | | static size_t patternSeparatorShortPos(const char * pattern, size_t len) { |
| | | size_t i; |
| | | for (i = 0; (i < len) && pattern[i]; i++) { |
| | | if (islower((unsigned char) pattern[i])) { |
| | |
| | | * @param len - max search length |
| | | * @return position of separator or len |
| | | */ |
| | | size_t patternSeparatorPos(const char * pattern, size_t len) { |
| | | static size_t patternSeparatorPos(const char * pattern, size_t len) { |
| | | |
| | | char * separator = strnpbrk(pattern, len, "?:[]"); |
| | | if (separator == NULL) { |
| | |
| | | * @param len - max search length |
| | | * @return position of separator or len |
| | | */ |
| | | size_t cmdSeparatorPos(const char * cmd, size_t len) { |
| | | static size_t cmdSeparatorPos(const char * cmd, size_t len) { |
| | | char * separator = strnpbrk(cmd, len, ":?"); |
| | | size_t result; |
| | | if (separator == NULL) { |
| | |
| | | scpi_bool_t matchPattern(const char * pattern, size_t pattern_len, const char * str, size_t str_len, int32_t * num) { |
| | | int pattern_sep_pos_short; |
| | | |
| | | if (pattern[pattern_len - 1] == '#') { |
| | | if ((pattern_len > 0) && pattern[pattern_len - 1] == '#') { |
| | | size_t new_pattern_len = pattern_len - 1; |
| | | |
| | | pattern_sep_pos_short = patternSeparatorShortPos(pattern, new_pattern_len); |
| | |
| | | int rightFlag = 0; // flag for ']' on right |
| | | int cmd_sep_pos = 0; |
| | | |
| | | int32_t numbers_idx = -1; /* Lutz Hoerl, Thorlabs: changed type from size_t to int, size_t is positive only, int does not produce unsigne warnings */ |
| | | size_t numbers_idx = 0; |
| | | int32_t *number_ptr = NULL; |
| | | |
| | | const char * pattern_ptr = pattern; |
| | |
| | | cmd_sep_pos = cmdSeparatorPos(cmd_ptr, cmd_end - cmd_ptr); |
| | | } |
| | | |
| | | if (pattern_ptr[pattern_sep_pos - 1] == '#') { |
| | | numbers_idx++; |
| | | if ((pattern_sep_pos > 0) && pattern_ptr[pattern_sep_pos - 1] == '#') { |
| | | if (numbers && (numbers_idx < numbers_len)) { |
| | | number_ptr = numbers + numbers_idx; |
| | | *number_ptr = 1; // default value |
| | | } else { |
| | | number_ptr = NULL; |
| | | } |
| | | numbers_idx++; |
| | | } else { |
| | | number_ptr = NULL; |
| | | } |
| | | |
| | | if (matchPattern(pattern_ptr, pattern_sep_pos, cmd_ptr, cmd_sep_pos, number_ptr)) { |
| | | pattern_ptr = pattern_ptr + pattern_sep_pos; |
| | | pattern_ptr += pattern_sep_pos; |
| | | pattern_len -= pattern_sep_pos; |
| | | cmd_ptr = cmd_ptr + cmd_sep_pos; |
| | | result = TRUE; |
| | | |
| | |
| | | |
| | | /* both command and patter contains command separator at this position */ |
| | | if ((pattern_ptr[0] == cmd_ptr[0]) && ((pattern_ptr[0] == ':') || (pattern_ptr[0] == '?'))) { |
| | | pattern_ptr = pattern_ptr + 1; |
| | | pattern_ptr += 1; |
| | | pattern_len -= 1; |
| | | cmd_ptr = cmd_ptr + 1; |
| | | } else if ((pattern_ptr[1] == cmd_ptr[0]) |
| | | } else if ((pattern_len > 1) && (pattern_ptr[1] == cmd_ptr[0]) |
| | | && (pattern_ptr[0] == '[') |
| | | && (pattern_ptr[1] == ':')) { |
| | | pattern_ptr = pattern_ptr + 2; // for skip '[' in "[:" |
| | | pattern_ptr += 2; // for skip '[' in "[:" |
| | | pattern_len -= 2; |
| | | cmd_ptr = cmd_ptr + 1; |
| | | leftFlag++; |
| | | } else if ((pattern_ptr[1] == cmd_ptr[0]) |
| | | } else if ((pattern_len > 1) && (pattern_ptr[1] == cmd_ptr[0]) |
| | | && (pattern_ptr[0] == ']') |
| | | && (pattern_ptr[1] == ':')) { |
| | | pattern_ptr = pattern_ptr + 2; // for skip ']' in "]:" |
| | | pattern_ptr += 2; // for skip ']' in "]:" |
| | | pattern_len -= 2; |
| | | cmd_ptr = cmd_ptr + 1; |
| | | } else if ((pattern_ptr[2] == cmd_ptr[0]) |
| | | } else if ((pattern_len > 2) && (pattern_ptr[2] == cmd_ptr[0]) |
| | | && (pattern_ptr[0] == ']') |
| | | && (pattern_ptr[1] == '[') |
| | | && (pattern_ptr[2] == ':')) { |
| | | pattern_ptr = pattern_ptr + 3; // for skip '][' in "][:" |
| | | pattern_ptr += 3; // for skip '][' in "][:" |
| | | pattern_len -= 3; |
| | | cmd_ptr = cmd_ptr + 1; |
| | | leftFlag++; |
| | | } else if (((pattern_ptr[0] == ']') |
| | |
| | | break; |
| | | } |
| | | } else { |
| | | pattern_ptr = pattern_ptr + pattern_sep_pos; |
| | | pattern_ptr += pattern_sep_pos; |
| | | pattern_len -= pattern_sep_pos; |
| | | if ((pattern_ptr[0] == ']') && (pattern_ptr[1] == ':')) { |
| | | pattern_ptr = pattern_ptr + 2; // for skip ']' in "]:" , pattern_ptr continue, while cmd_ptr remain unchanged |
| | | pattern_ptr += 2; // for skip ']' in "]:" , pattern_ptr continue, while cmd_ptr remain unchanged |
| | | pattern_len -= 2; |
| | | rightFlag++; |
| | | } else if ((pattern_ptr[0] == ']') |
| | | } else if ((pattern_len > 2) && (pattern_ptr[0] == ']') |
| | | && (pattern_ptr[1] == '[') |
| | | && (pattern_ptr[2] == ':')) { |
| | | pattern_ptr = pattern_ptr + 3; // for skip ']' in "][:" , pattern_ptr continue, while cmd_ptr remain unchanged |
| | | pattern_ptr += 3; // for skip ']' in "][:" , pattern_ptr continue, while cmd_ptr remain unchanged |
| | | pattern_len -= 3; |
| | | rightFlag++; |
| | | } else { |
| | | result = FALSE; |
| | |
| | | if (c1 != c2) { |
| | | return c1 - c2; |
| | | } |
| | | if (c1 == '\0') { /* Lutz Hoerl, Thorlabs: think this (c1 = '\0') was really a bug */ |
| | | if (c1 == '\0') { |
| | | return 0; |
| | | } |
| | | } |