From edf4f2883a71e71b5dd27243d1128647e00f40ee Mon Sep 17 00:00:00 2001 From: Jan Breuer <jan.breuer@jaybee.cz> Date: ćšć, 19 3æ 2015 03:33:52 +0800 Subject: [PATCH] Update documentation --- libscpi/src/utils.c | 147 +++++++++++++++++++++++++++++++++++++++--------- 1 files changed, 118 insertions(+), 29 deletions(-) diff --git a/libscpi/src/utils.c b/libscpi/src/utils.c index f8e09fa..26670b9 100644 --- a/libscpi/src/utils.c +++ b/libscpi/src/utils.c @@ -41,7 +41,7 @@ #include <string.h> #include <ctype.h> -#include "utils.h" +#include "utils_private.h" static size_t patternSeparatorShortPos(const char * pattern, size_t len); static size_t patternSeparatorPos(const char * pattern, size_t len); @@ -74,35 +74,60 @@ * @param len string buffer length * @return number of bytes written to str (without '\0') */ -// TODO: add support for other bases - size_t longToStr(int32_t val, char * str, size_t len, int8_t base) { - uint32_t x = 1000000000L; + const char digits[] = "0123456789ABCDEF"; + +#define ADD_CHAR(c) if (pos < len) str[pos++] = (c) + uint32_t x = 0; int_fast8_t digit; size_t pos = 0; + uint32_t uval = val; - if (val == 0) { - if (pos < len) str[pos++] = '0'; + if (uval == 0) { + ADD_CHAR('0'); } else { - if (val < 0) { - val = -val; - if (pos < len) str[pos++] = '-'; + + switch (base) { + case 2: + x = 0x80000000L; + break; + case 8: + x = 0x40000000L; + break; + case 10: + x = 1000000000L; + break; + case 0x10: + x = 0x10000000L; + break; + default: + x = 1000000000L; + base = 10; + break; } - while ((val / x) == 0) { - x /= 10; + // add sign for numbers in base 10 + if ((val < 0) && (base == 10)) { + uval = -val; + ADD_CHAR('-'); + } + + // remove leading zeros + while ((uval / x) == 0) { + x /= base; } do { - digit = (uint8_t) (val / x); - if (pos < len) str[pos++] = digit + '0'; - val -= digit * x; - x /= 10; + digit = (uint8_t) (uval / x); + ADD_CHAR(digits[digit]); + uval -= digit * x; + x /= base; } while (x && (pos < len)); } if (pos < len) str[pos] = 0; return pos; +#undef ADD_CHAR } /** @@ -148,7 +173,7 @@ * @param len2 * @return TRUE if len1==len2 and "len" characters of both strings are equal */ -bool_t compareStr(const char * str1, size_t len1, const char * str2, size_t len2) { +scpi_bool_t compareStr(const char * str1, size_t len1, const char * str2, size_t len2) { if (len1 != len2) { return FALSE; } @@ -158,6 +183,36 @@ } return FALSE; +} + +/** + * Compare two strings, one be longer but may contains only numbers in that section + * @param str1 + * @param len1 + * @param str2 + * @param len2 + * @return TRUE if strings match + */ +scpi_bool_t compareStrAndNum(const char * str1, size_t len1, const char * str2, size_t len2) { + scpi_bool_t result = FALSE; + size_t i; + + if (len2 < len1) { + return FALSE; + } + + if (SCPI_strncasecmp(str1, str2, len1) == 0) { + result = TRUE; + } + + for (i = len1; i < len2; i++) { + if (!isdigit(str2[i])) { + result = FALSE; + break; + } + } + + return result; } /** @@ -235,23 +290,37 @@ * @param str_len * @return */ -bool_t matchPattern(const char * pattern, size_t pattern_len, const char * str, size_t str_len) { - int pattern_sep_pos_short = patternSeparatorShortPos(pattern, pattern_len); - return compareStr(pattern, pattern_len, str, str_len) || - compareStr(pattern, pattern_sep_pos_short, str, str_len); +scpi_bool_t matchPattern(const char * pattern, size_t pattern_len, const char * str, size_t str_len) { + int pattern_sep_pos_short; + + if (pattern[pattern_len - 1] == '#') { + size_t new_pattern_len = pattern_len - 1; + + pattern_sep_pos_short = patternSeparatorShortPos(pattern, new_pattern_len); + + return compareStrAndNum(pattern, new_pattern_len, str, str_len) || + compareStrAndNum(pattern, pattern_sep_pos_short, str, str_len); + } else { + + pattern_sep_pos_short = patternSeparatorShortPos(pattern, pattern_len); + + return compareStr(pattern, pattern_len, str, str_len) || + compareStr(pattern, pattern_sep_pos_short, str, str_len); + } } /** * Compare pattern and command - * @param pattern + * @param pattern eg. [:MEASure]:VOLTage:DC? * @param cmd - command * @param len - max search length * @return TRUE if pattern matches, FALSE otherwise */ -bool_t matchCommand(const char * pattern, const char * cmd, size_t len) { - bool_t result = FALSE; +scpi_bool_t matchCommand(const char * pattern, const char * cmd, size_t len) { + scpi_bool_t result = FALSE; int leftFlag = 0; // flag for '[' on left int rightFlag = 0; // flag for ']' on right + int cmd_sep_pos = 0; const char * pattern_ptr = pattern; int pattern_len = strlen(pattern); @@ -261,7 +330,7 @@ size_t cmd_len = SCPI_strnlen(cmd, len); const char * cmd_end = cmd + cmd_len; - /* TODO: now support optional keywords in pattern style, e.g. [:MEASure]:VOLTage:DC? */ + /* now support optional keywords in pattern style, e.g. [:MEASure]:VOLTage:DC? */ if (pattern_ptr[0] == '[') { // skip first '[' pattern_len--; pattern_ptr++; @@ -272,16 +341,17 @@ pattern_ptr++; } - /* errornouse ":*IDN?" is handled in parser */ if (cmd_ptr[0] == ':') { - cmd_len--; - cmd_ptr++; + /* handle errornouse ":*IDN?" */ + if ((cmd_len >= 2) && (cmd_ptr[1] != '*')) { + cmd_len--; + cmd_ptr++; + } } while (1) { int pattern_sep_pos = patternSeparatorPos(pattern_ptr, pattern_end - pattern_ptr); - int cmd_sep_pos; - + if ((leftFlag > 0) && (rightFlag > 0)) { leftFlag--; rightFlag--; @@ -391,3 +461,22 @@ } #endif +#if !HAVE_STRNCASECMP && !HAVE_STRNICMP + +int OUR_strncasecmp(const char *s1, const char *s2, size_t n) { + unsigned char c1, c2; + + for (; n != 0; n--) { + c1 = tolower((unsigned char) *s1++); + c2 = tolower((unsigned char) *s2++); + if (c1 != c2) { + return c1 - c2; + } + if (c1 = '\0') { + return 0; + } + } + return 0; +} +#endif + -- Gitblit v1.9.1