/** * Push error to queue * @param context * @param err - error number * @param info - additional text information or NULL for no text * @param info_len - length of text or 0 for automatic length */ void SCPI_ErrorPushEx(scpi_t * context, int16_t err, char * info, size_t info_len) { int i; /* automatic calculation of length */ if (info && info_len == 0) { info_len = SCPIDEFINE_strnlen(info, SCPI_STD_ERROR_DESC_MAX_STRING_LENGTH); } scpi_bool_t queue_overflow = !SCPI_ErrorAddInternal(context, err, info, info_len); for (i = 0; i < ERROR_DEFS_N; i++) { if ((err <= errs[i].from) && (err >= errs[i].to)) { SCPI_RegSetBits(context, SCPI_REG_ESR, errs[i].esrBit); } } SCPI_ErrorEmit(context, err); if (queue_overflow) { SCPI_ErrorEmit(context, SCPI_ERROR_QUEUE_OVERFLOW); } if (context) { context->cmd_error = TRUE; } }
/** * Compare pattern and command * @param pattern eg. [:MEASure]:VOLTage:DC? * @param cmd - command * @param len - max search length * @return TRUE if pattern matches, FALSE otherwise */ scpi_bool_t matchCommand(const char * pattern, const char * cmd, size_t len, int32_t *numbers, size_t numbers_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; size_t numbers_idx = 0; int32_t *number_ptr = NULL; const char * pattern_ptr = pattern; int pattern_len = strlen(pattern); const char * pattern_end = pattern + pattern_len; const char * cmd_ptr = cmd; size_t cmd_len = SCPIDEFINE_strnlen(cmd, len); const char * cmd_end = cmd + cmd_len; /* now support optional keywords in pattern style, e.g. [:MEASure]:VOLTage:DC? */ if (pattern_ptr[0] == '[') { // skip first '[' pattern_len--; pattern_ptr++; leftFlag++; } if (pattern_ptr[0] == ':') { // skip first ':' pattern_len--; pattern_ptr++; } if (cmd_ptr[0] == ':') { /* 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); if ((leftFlag > 0) && (rightFlag > 0)) { leftFlag--; rightFlag--; } else { cmd_sep_pos = cmdSeparatorPos(cmd_ptr, cmd_end - cmd_ptr); } if (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; cmd_ptr = cmd_ptr + cmd_sep_pos; result = TRUE; /* command is complete */ if ((pattern_ptr == pattern_end) && (cmd_ptr >= cmd_end)) { break; } /* pattern complete, but command not */ if ((pattern_ptr == pattern_end) && (cmd_ptr < cmd_end)) { result = FALSE; break; } /* command complete, but pattern not */ if (cmd_ptr >= cmd_end) { if (cmd_end == cmd_ptr) { if (cmd_ptr[0] == pattern_ptr[pattern_end - pattern_ptr - 1]) { break; /* exist optional keyword, command is complete */ } if (']' == pattern_ptr[pattern_end - pattern_ptr - 1]) { break; /* exist optional keyword, command is complete */ } } result = FALSE; break; } /* 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; cmd_ptr = cmd_ptr + 1; } else if ((pattern_ptr[1] == cmd_ptr[0]) && (pattern_ptr[0] == '[') && (pattern_ptr[1] == ':')) { pattern_ptr = pattern_ptr + 2; // for skip '[' in "[:" cmd_ptr = cmd_ptr + 1; leftFlag++; } else if ((pattern_ptr[1] == cmd_ptr[0]) && (pattern_ptr[0] == ']') && (pattern_ptr[1] == ':')) { pattern_ptr = pattern_ptr + 2; // for skip ']' in "]:" cmd_ptr = cmd_ptr + 1; } else if ((pattern_ptr[2] == cmd_ptr[0]) && (pattern_ptr[0] == ']') && (pattern_ptr[1] == '[') && (pattern_ptr[2] == ':')) { pattern_ptr = pattern_ptr + 3; // for skip '][' in "][:" cmd_ptr = cmd_ptr + 1; leftFlag++; } else if (((pattern_ptr[0] == ']') || (pattern_ptr[0] == '[')) && (*(pattern_end - 1) == '?') // last is '?' && (cmd_ptr[0] == '?')) { result = TRUE; // exist optional keyword, and they are end with '?' break; // command is complete OK } else { result = FALSE; break; } } else { pattern_ptr = pattern_ptr + 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 rightFlag++; } else if ((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 rightFlag++; } else { result = FALSE; break; } } } return result; }
/** * Compare pattern and command * @param pattern eg. [:MEASure]:VOLTage:DC? * @param cmd - command * @param len - max search length * @return TRUE if pattern matches, FALSE otherwise */ scpi_bool_t matchCommand(const char * pattern, const char * cmd, size_t len, int32_t *numbers, size_t numbers_len, int32_t default_value) { #define SKIP_PATTERN(n) do {pattern_ptr += (n); pattern_len -= (n);} while(0) #define SKIP_CMD(n) do {cmd_ptr += (n); cmd_len -= (n);} while(0) scpi_bool_t result = FALSE; int brackets = 0; int cmd_sep_pos = 0; size_t numbers_idx = 0; int32_t *number_ptr = NULL; const char * pattern_ptr = pattern; int pattern_len = strlen(pattern); const char * cmd_ptr = cmd; size_t cmd_len = SCPIDEFINE_strnlen(cmd, len); /* both commands are query commands? */ if (pattern_ptr[pattern_len - 1] == '?') { if (cmd_ptr[cmd_len - 1] == '?') { cmd_len -= 1; pattern_len -= 1; } else { return FALSE; } } /* now support optional keywords in pattern style, e.g. [:MEASure]:VOLTage:DC? */ if (pattern_ptr[0] == '[') { // skip first '[' SKIP_PATTERN(1); brackets++; } if (pattern_ptr[0] == ':') { // skip first ':' SKIP_PATTERN(1); } if (cmd_ptr[0] == ':') { /* handle errornouse ":*IDN?" */ if (cmd_len >= 2) { if (cmd_ptr[1] != '*') { SKIP_CMD(1); } else { return FALSE; } } } while (1) { int pattern_sep_pos = patternSeparatorPos(pattern_ptr, pattern_len); cmd_sep_pos = cmdSeparatorPos(cmd_ptr, cmd_len); if ((pattern_sep_pos > 0) && pattern_ptr[pattern_sep_pos - 1] == '#') { if (numbers && (numbers_idx < numbers_len)) { number_ptr = numbers + numbers_idx; *number_ptr = default_value; // 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)) { SKIP_PATTERN(pattern_sep_pos); SKIP_CMD(cmd_sep_pos); result = TRUE; /* command is complete */ if ((pattern_len == 0) && (cmd_len == 0)) { break; } /* pattern complete, but command not */ if ((pattern_len == 0) && (cmd_len > 0)) { result = FALSE; break; } /* command complete, but pattern not */ if (cmd_len == 0) { // verify all subsequent pattern parts are also optional while (pattern_len) { pattern_sep_pos = patternSeparatorPos(pattern_ptr, pattern_len); switch (pattern_ptr[pattern_sep_pos]) { case '[': brackets++; break; case ']': brackets--; break; default: break; } SKIP_PATTERN(pattern_sep_pos + 1); if (brackets == 0) { if ((pattern_len > 0) && (pattern_ptr[0] == '[')) { continue; } else { break; } } } if (pattern_len != 0) { result = FALSE; } break; /* exist optional keyword, command is complete */ } /* both command and patter contains command separator at this position */ if ((pattern_len > 0) && ((pattern_ptr[0] == cmd_ptr[0]) && (pattern_ptr[0] == ':'))) { SKIP_PATTERN(1); SKIP_CMD(1); } else if ((pattern_len > 1) && (pattern_ptr[1] == cmd_ptr[0]) && (pattern_ptr[0] == '[') && (pattern_ptr[1] == ':')) { SKIP_PATTERN(2); // for skip '[' in "[:" SKIP_CMD(1); brackets++; } else if ((pattern_len > 1) && (pattern_ptr[1] == cmd_ptr[0]) && (pattern_ptr[0] == ']') && (pattern_ptr[1] == ':')) { SKIP_PATTERN(2); // for skip ']' in "]:" SKIP_CMD(1); brackets--; } else if ((pattern_len > 2) && (pattern_ptr[2] == cmd_ptr[0]) && (pattern_ptr[0] == ']') && (pattern_ptr[1] == '[') && (pattern_ptr[2] == ':')) { SKIP_PATTERN(3); // for skip '][' in "][:" SKIP_CMD(1); //brackets++; //brackets--; } else { result = FALSE; break; } } else { SKIP_PATTERN(pattern_sep_pos); if ((pattern_ptr[0] == ']') && (pattern_ptr[1] == ':')) { SKIP_PATTERN(2); // for skip ']' in "]:" , pattern_ptr continue, while cmd_ptr remain unchanged brackets--; } else if ((pattern_len > 2) && (pattern_ptr[0] == ']') && (pattern_ptr[1] == '[') && (pattern_ptr[2] == ':')) { SKIP_PATTERN(3); // for skip ']' in "][:" , pattern_ptr continue, while cmd_ptr remain unchanged //brackets++; //brackets--; } else { result = FALSE; break; } } } return result; #undef SKIP_PATTERN #undef SKIP_CMD }