| | |
| | | * Write data to SCPI output |
| | | * @param context |
| | | * @param data |
| | | * @param len - lenght of data to be written |
| | | * @param len - length of data to be written |
| | | * @return number of bytes written |
| | | */ |
| | | static size_t writeData(scpi_t * context, const char * data, size_t len) { |
| | | if (len > 0) { |
| | | if ((len > 0) && (data != NULL)) { |
| | | return context->interface->write(context, data, len); |
| | | } else { |
| | | return 0; |
| | |
| | | context->cmd_error = FALSE; |
| | | context->output_count = 0; |
| | | context->input_count = 0; |
| | | context->arbitrary_reminding = 0; |
| | | context->arbitrary_remaining = 0; |
| | | |
| | | /* if callback exists - call command callback */ |
| | | if (cmd->callback != NULL) { |
| | |
| | | cmd_prev = state->programHeader; |
| | | } else { |
| | | /* place undefined header with error */ |
| | | /* calculate length of errornouse header and trim \r\n */ |
| | | /* calculate length of errorenous header and trim \r\n */ |
| | | size_t r2 = r; |
| | | while (r2 > 0 && (data[r2 - 1] == '\r' || data[r2 - 1] == '\n')) r2--; |
| | | SCPI_ErrorPushEx(context, SCPI_ERROR_UNDEFINED_HEADER, data, r2); |
| | |
| | | |
| | | } |
| | | |
| | | /* conditionaly write new line */ |
| | | /* conditionally write new line */ |
| | | writeNewLine(context); |
| | | |
| | | return result; |
| | |
| | | } |
| | | |
| | | /** |
| | | * Write string withn " to the result |
| | | * Write string within "" to the result |
| | | * @param context |
| | | * @param data |
| | | * @return |
| | |
| | | * @return |
| | | */ |
| | | size_t SCPI_ResultArbitraryBlockHeader(scpi_t * context, size_t len) { |
| | | size_t result = 0; |
| | | char block_header[12]; |
| | | size_t header_len; |
| | | block_header[0] = '#'; |
| | |
| | | header_len = strlen(block_header + 2); |
| | | block_header[1] = (char) (header_len + '0'); |
| | | |
| | | context->arbitrary_reminding = len; |
| | | return writeData(context, block_header, header_len + 2); |
| | | context->arbitrary_remaining = len; |
| | | result = writeDelimiter(context); |
| | | result += writeData(context, block_header, header_len + 2); |
| | | return result; |
| | | } |
| | | |
| | | /** |
| | |
| | | */ |
| | | size_t SCPI_ResultArbitraryBlockData(scpi_t * context, const void * data, size_t len) { |
| | | |
| | | if (context->arbitrary_reminding < len) { |
| | | if (context->arbitrary_remaining < len) { |
| | | SCPI_ErrorPush(context, SCPI_ERROR_SYSTEM_ERROR); |
| | | return 0; |
| | | } |
| | | |
| | | context->arbitrary_reminding -= len; |
| | | context->arbitrary_remaining -= len; |
| | | |
| | | if (context->arbitrary_reminding == 0) { |
| | | if (context->arbitrary_remaining == 0) { |
| | | context->output_count++; |
| | | } |
| | | |
| | |
| | | for (result = 1; result != 0; result = scpiLex_Comma(state, &tmp)) { |
| | | token->len += result; |
| | | |
| | | if (result == 0) { |
| | | token->type = SCPI_TOKEN_UNKNOWN; |
| | | token->len = 0; |
| | | paramCount = -1; |
| | | break; |
| | | } |
| | | |
| | | result = scpiParser_parseProgramData(state, &tmp); |
| | | if (tmp.type != SCPI_TOKEN_UNKNOWN) { |
| | | token->len += result; |
| | |
| | | break; |
| | | } |
| | | paramCount++; |
| | | } |
| | | |
| | | if (token->len == -1) { |
| | | token->len = 0; |
| | | } |
| | | |
| | | if (numberOfParameters != NULL) { |