scpi.c: Minor cleanups, cosmetics.
This commit is contained in:
parent
c6e35004cb
commit
d5976d8be5
|
@ -45,7 +45,7 @@
|
|||
*
|
||||
* @return SR_OK on success, SR_ERR on failure.
|
||||
*/
|
||||
static int sr_parse_strict_bool(const char *str, gboolean *ret)
|
||||
static int parse_strict_bool(const char *str, gboolean *ret)
|
||||
{
|
||||
if (!str)
|
||||
return SR_ERR_ARG;
|
||||
|
@ -56,17 +56,14 @@ static int sr_parse_strict_bool(const char *str, gboolean *ret)
|
|||
!g_ascii_strncasecmp(str, "yes", 3) ||
|
||||
!g_ascii_strncasecmp(str, "true", 4) ||
|
||||
!g_ascii_strncasecmp(str, "on", 2)) {
|
||||
|
||||
*ret = TRUE;
|
||||
return SR_OK;
|
||||
|
||||
} else if (!g_strcmp0(str, "0") ||
|
||||
!g_ascii_strncasecmp(str, "n", 1) ||
|
||||
!g_ascii_strncasecmp(str, "f", 1) ||
|
||||
!g_ascii_strncasecmp(str, "no", 2) ||
|
||||
!g_ascii_strncasecmp(str, "false", 5) ||
|
||||
!g_ascii_strncasecmp(str, "off", 3)) {
|
||||
|
||||
*ret = FALSE;
|
||||
return SR_OK;
|
||||
}
|
||||
|
@ -85,16 +82,12 @@ static int sr_parse_strict_bool(const char *str, gboolean *ret)
|
|||
SR_PRIV int sr_scpi_send(struct sr_serial_dev_inst *serial,
|
||||
const char *command)
|
||||
{
|
||||
int len;
|
||||
int out;
|
||||
int len, out;
|
||||
gchar *terminated_command;
|
||||
|
||||
terminated_command = g_strconcat(command, "\n", NULL);
|
||||
len = strlen(terminated_command);
|
||||
|
||||
out = serial_write(serial, terminated_command,
|
||||
strlen(terminated_command));
|
||||
|
||||
out = serial_write(serial, terminated_command, len);
|
||||
g_free(terminated_command);
|
||||
|
||||
if (out != len) {
|
||||
|
@ -113,17 +106,17 @@ SR_PRIV int sr_scpi_send(struct sr_serial_dev_inst *serial,
|
|||
*
|
||||
* @param serial Previously initialized serial port structure.
|
||||
* @param command The SCPI command to send to the device (can be NULL).
|
||||
* @param scpi_response Pointer where to store the scpi response.
|
||||
* @param scpi_response Pointer where to store the SCPI response.
|
||||
*
|
||||
* @return SR_OK upon fetching a full SCPI response, SR_ERR upon fetching a
|
||||
* incomplete or no response. The allocated response must be freed by the caller
|
||||
* in the case of a full response as well in the case of an incomplete.
|
||||
* @return SR_OK upon fetching a full SCPI response, SR_ERR upon fetching an
|
||||
* incomplete or no response. The allocated response must be freed by
|
||||
* the caller in the case of a full response as well in the case of
|
||||
* an incomplete.
|
||||
*/
|
||||
SR_PRIV int sr_scpi_get_string(struct sr_serial_dev_inst *serial,
|
||||
const char *command, char **scpi_response)
|
||||
{
|
||||
int len;
|
||||
int ret;
|
||||
int len, ret;
|
||||
char buf[256];
|
||||
unsigned int i;
|
||||
GString *response;
|
||||
|
@ -140,7 +133,7 @@ SR_PRIV int sr_scpi_get_string(struct sr_serial_dev_inst *serial,
|
|||
|
||||
if (response->len > 0 &&
|
||||
response->str[response->len-1] == '\n') {
|
||||
sr_spew("Fetched full SCPI response");
|
||||
sr_spew("Fetched full SCPI response.");
|
||||
break;
|
||||
}
|
||||
|
||||
|
@ -148,12 +141,11 @@ SR_PRIV int sr_scpi_get_string(struct sr_serial_dev_inst *serial,
|
|||
}
|
||||
|
||||
if (response->len == 0) {
|
||||
sr_dbg("No SCPI response received");
|
||||
sr_dbg("No SCPI response received.");
|
||||
g_string_free(response, TRUE);
|
||||
*scpi_response = NULL;
|
||||
return SR_ERR;
|
||||
|
||||
} else if (response->str[response->len-1] == '\n') {
|
||||
} else if (response->str[response->len - 1] == '\n') {
|
||||
/*
|
||||
* The SCPI response contains a LF ('\n') at the end and we
|
||||
* don't need this so replace it with a '\0' and decrement
|
||||
|
@ -161,7 +153,6 @@ SR_PRIV int sr_scpi_get_string(struct sr_serial_dev_inst *serial,
|
|||
*/
|
||||
response->str[--response->len] = '\0';
|
||||
ret = SR_OK;
|
||||
|
||||
} else {
|
||||
sr_warn("Incomplete SCPI response received!");
|
||||
ret = SR_ERR;
|
||||
|
@ -170,7 +161,7 @@ SR_PRIV int sr_scpi_get_string(struct sr_serial_dev_inst *serial,
|
|||
/* Minor optimization: steal the string instead of copying. */
|
||||
*scpi_response = response->str;
|
||||
|
||||
/* A SCPI response can be quite large, print at most 50 characters */
|
||||
/* A SCPI response can be quite large, print at most 50 characters. */
|
||||
sr_dbg("SCPI response for command %s received (length %d): '%.50s'",
|
||||
command, response->len, response->str);
|
||||
|
||||
|
@ -201,7 +192,7 @@ SR_PRIV int sr_scpi_get_bool(struct sr_serial_dev_inst *serial,
|
|||
if (!response)
|
||||
return SR_ERR;
|
||||
|
||||
if (sr_parse_strict_bool(response, scpi_response) == SR_OK)
|
||||
if (parse_strict_bool(response, scpi_response) == SR_OK)
|
||||
ret = SR_OK;
|
||||
else
|
||||
ret = SR_ERR;
|
||||
|
@ -322,10 +313,8 @@ SR_PRIV int sr_scpi_get_opc(struct sr_serial_dev_inst *serial)
|
|||
|
||||
for (i = 0; i < SCPI_READ_RETRIES; ++i) {
|
||||
sr_scpi_get_bool(serial, SCPI_CMD_OPC, &opc);
|
||||
|
||||
if (opc)
|
||||
return SR_OK;
|
||||
|
||||
g_usleep(SCPI_READ_RETRY_TIMEOUT);
|
||||
}
|
||||
|
||||
|
@ -341,8 +330,9 @@ SR_PRIV int sr_scpi_get_opc(struct sr_serial_dev_inst *serial)
|
|||
* @param scpi_response Pointer where to store the parsed result.
|
||||
*
|
||||
* @return SR_OK upon successfully parsing all values, SR_ERR upon a parsing
|
||||
* error or upon no response. The allocated response must be freed by the caller
|
||||
* in the case of an SR_OK as well as in the case of parsing error.
|
||||
* error or upon no response. The allocated response must be freed by
|
||||
* the caller in the case of an SR_OK as well as in the case of
|
||||
* parsing error.
|
||||
*/
|
||||
SR_PRIV int sr_scpi_get_floatv(struct sr_serial_dev_inst *serial,
|
||||
const char *command, GArray **scpi_response)
|
||||
|
@ -350,9 +340,7 @@ SR_PRIV int sr_scpi_get_floatv(struct sr_serial_dev_inst *serial,
|
|||
int ret;
|
||||
float tmp;
|
||||
char *response;
|
||||
|
||||
gchar **ptr;
|
||||
gchar **tokens;
|
||||
gchar **ptr, **tokens;
|
||||
GArray *response_array;
|
||||
|
||||
ret = SR_OK;
|
||||
|
@ -368,7 +356,7 @@ SR_PRIV int sr_scpi_get_floatv(struct sr_serial_dev_inst *serial,
|
|||
|
||||
response_array = g_array_sized_new(TRUE, FALSE, sizeof(float), 256);
|
||||
|
||||
while(*ptr) {
|
||||
while (*ptr) {
|
||||
if (sr_atof(*ptr, &tmp) == SR_OK)
|
||||
response_array = g_array_append_val(response_array,
|
||||
tmp);
|
||||
|
@ -400,18 +388,16 @@ SR_PRIV int sr_scpi_get_floatv(struct sr_serial_dev_inst *serial,
|
|||
* @param scpi_response Pointer where to store the parsed result.
|
||||
*
|
||||
* @return SR_OK upon successfully parsing all values, SR_ERR upon a parsing
|
||||
* error or upon no response. The allocated response must be freed by the caller
|
||||
* in the case of an SR_OK as well as in the case of parsing error.
|
||||
* error or upon no response. The allocated response must be freed by
|
||||
* the caller in the case of an SR_OK as well as in the case of
|
||||
* parsing error.
|
||||
*/
|
||||
SR_PRIV int sr_scpi_get_uint8v(struct sr_serial_dev_inst *serial,
|
||||
const char *command, GArray **scpi_response)
|
||||
{
|
||||
int tmp;
|
||||
int ret;
|
||||
int tmp, ret;
|
||||
char *response;
|
||||
|
||||
gchar **ptr;
|
||||
gchar **tokens;
|
||||
gchar **ptr, **tokens;
|
||||
GArray *response_array;
|
||||
|
||||
ret = SR_OK;
|
||||
|
@ -427,7 +413,7 @@ SR_PRIV int sr_scpi_get_uint8v(struct sr_serial_dev_inst *serial,
|
|||
|
||||
response_array = g_array_sized_new(TRUE, FALSE, sizeof(uint8_t), 256);
|
||||
|
||||
while(*ptr) {
|
||||
while (*ptr) {
|
||||
if (sr_atoi(*ptr, &tmp) == SR_OK)
|
||||
response_array = g_array_append_val(response_array,
|
||||
tmp);
|
||||
|
@ -454,11 +440,12 @@ SR_PRIV int sr_scpi_get_uint8v(struct sr_serial_dev_inst *serial,
|
|||
* Send the *IDN? SCPI command, receive the reply, parse it and store the
|
||||
* reply as a sr_scpi_hw_info structure in the supplied scpi_response pointer.
|
||||
*
|
||||
* The hw_info structure must be freed by the caller via sr_scpi_hw_info_free().
|
||||
*
|
||||
* @param serial Previously initialized serial port structure.
|
||||
* @param scpi_response Pointer where to store the hw_info structure.
|
||||
*
|
||||
* @return SR_OK upon success, SR_ERR on failure.
|
||||
* The hw_info structure must be freed by the caller with sr_scpi_hw_info_free().
|
||||
*/
|
||||
SR_PRIV int sr_scpi_get_hw_id(struct sr_serial_dev_inst *serial,
|
||||
struct sr_scpi_hw_info **scpi_response)
|
||||
|
@ -466,7 +453,6 @@ SR_PRIV int sr_scpi_get_hw_id(struct sr_serial_dev_inst *serial,
|
|||
int num_tokens;
|
||||
char *response;
|
||||
gchar **tokens;
|
||||
|
||||
struct sr_scpi_hw_info *hw_info;
|
||||
|
||||
response = NULL;
|
||||
|
@ -486,7 +472,7 @@ SR_PRIV int sr_scpi_get_hw_id(struct sr_serial_dev_inst *serial,
|
|||
for (num_tokens = 0; tokens[num_tokens] != NULL; num_tokens++);
|
||||
|
||||
if (num_tokens != 4) {
|
||||
sr_dbg("IDN response not according to spec: %80.s", response);
|
||||
sr_dbg("IDN response not according to spec: %80.s.", response);
|
||||
g_strfreev(tokens);
|
||||
g_free(response);
|
||||
return SR_ERR;
|
||||
|
|
Loading…
Reference in New Issue