/* Get length of buffer required. */
va_copy(args_copy, args);
- len = vsnprintf(NULL, 0, format, args_copy);
+ len = sr_vsnprintf_ascii(NULL, 0, format, args_copy);
va_end(args_copy);
/* Allocate buffer and write out command. */
buf = g_malloc0(len + 2);
- vsprintf(buf, format, args);
+ sr_vsprintf_ascii(buf, format, args);
if (buf[len - 1] != '\n')
buf[len] = '\n';
*
* @return SR_OK on success, SR_ERR on failure.
*/
-static int scpi_send(struct sr_scpi_dev_inst *scpi, const char *format,
- va_list args)
+static int scpi_send(struct sr_scpi_dev_inst *scpi, const char *format, ...)
{
- return scpi_send_variadic(scpi, format, args);
+ va_list args;
+ int ret;
+
+ va_start(args, format);
+ ret = scpi_send_variadic(scpi, format, args);
+ va_end(args);
+
+ return ret;
}
/**
GString *response;
int space;
gint64 timeout;
- va_list empty_va_list;
/* Optionally send caller provided command. */
if (command) {
- if (scpi_send(scpi, command, empty_va_list) != SR_OK)
+ if (scpi_send(scpi, command) != SR_OK)
return SR_ERR;
}
scpi->free(scpi->priv);
g_free(scpi->priv);
+ g_free(scpi->actual_channel_name);
g_free(scpi);
}
long llen;
long datalen;
gint64 timeout;
- va_list empty_va_list;
g_mutex_lock(&scpi->scpi_mutex);
if (command)
- if (scpi_send(scpi, command, empty_va_list) != SR_OK) {
+ if (scpi_send(scpi, command) != SR_OK) {
g_mutex_unlock(&scpi->scpi_mutex);
return SR_ERR;
}
g_free(hw_info);
}
+/**
+ * Remove potentially enclosing pairs of quotes, un-escape content.
+ * This implementation modifies the caller's buffer when quotes are found
+ * and doubled quote characters need to get removed from the content.
+ *
+ * @param[in, out] s The SCPI string to check and un-quote.
+ *
+ * @return The start of the un-quoted string.
+ */
+SR_PRIV const char *sr_scpi_unquote_string(char *s)
+{
+ size_t s_len;
+ char quotes[3];
+ char *rdptr;
+
+ /* Immediately bail out on invalid or short input. */
+ if (!s || !*s)
+ return s;
+ s_len = strlen(s);
+ if (s_len < 2)
+ return s;
+
+ /* Check for matching quote characters front and back. */
+ if (s[0] != '\'' && s[0] != '"')
+ return s;
+ if (s[0] != s[s_len - 1])
+ return s;
+
+ /* Need to strip quotes, and un-double quote chars inside. */
+ quotes[0] = quotes[1] = *s;
+ quotes[2] = '\0';
+ s[s_len - 1] = '\0';
+ s++;
+ rdptr = s;
+ while ((rdptr = strstr(rdptr, quotes)) != NULL) {
+ memmove(rdptr, rdptr + 1, strlen(rdptr));
+ rdptr++;
+ }
+
+ return s;
+}
+
SR_PRIV const char *sr_vendor_alias(const char *raw_vendor)
{
unsigned int i;
return raw_vendor;
}
-SR_PRIV const char *sr_scpi_cmd_get(const struct scpi_command *cmdtable, int command)
+SR_PRIV const char *sr_scpi_cmd_get(const struct scpi_command *cmdtable,
+ int command)
{
unsigned int i;
const char *cmd;
return cmd;
}
-SR_PRIV int sr_scpi_cmd(const struct sr_dev_inst *sdi, const struct scpi_command *cmdtable,
+SR_PRIV int sr_scpi_cmd(const struct sr_dev_inst *sdi,
+ const struct scpi_command *cmdtable,
+ int channel_command, const char *channel_name,
int command, ...)
{
struct sr_scpi_dev_inst *scpi;
va_list args;
int ret;
+ const char *channel_cmd;
const char *cmd;
+ scpi = sdi->conn;
+
if (!(cmd = sr_scpi_cmd_get(cmdtable, command))) {
/* Device does not implement this command, that's OK. */
return SR_OK;
}
- scpi = sdi->conn;
+ g_mutex_lock(&scpi->scpi_mutex);
+
+ /* Select channel. */
+ channel_cmd = sr_scpi_cmd_get(cmdtable, channel_command);
+ if (channel_cmd && channel_name &&
+ g_strcmp0(channel_name, scpi->actual_channel_name)) {
+ sr_spew("sr_scpi_cmd(): new channel = %s", channel_name);
+ g_free(scpi->actual_channel_name);
+ scpi->actual_channel_name = g_strdup(channel_name);
+ ret = scpi_send(scpi, channel_cmd, channel_name);
+ if (ret != SR_OK)
+ return ret;
+ }
+
va_start(args, command);
- ret = sr_scpi_send_variadic(scpi, cmd, args);
+ ret = scpi_send_variadic(scpi, cmd, args);
va_end(args);
+ g_mutex_unlock(&scpi->scpi_mutex);
+
return ret;
}
SR_PRIV int sr_scpi_cmd_resp(const struct sr_dev_inst *sdi,
const struct scpi_command *cmdtable,
+ int channel_command, const char *channel_name,
GVariant **gvar, const GVariantType *gvtype, int command, ...)
{
struct sr_scpi_dev_inst *scpi;
va_list args;
+ const char *channel_cmd;
const char *cmd;
GString *response;
char *s;
g_mutex_lock(&scpi->scpi_mutex);
+ /* Select channel. */
+ channel_cmd = sr_scpi_cmd_get(cmdtable, channel_command);
+ if (channel_cmd && channel_name &&
+ g_strcmp0(channel_name, scpi->actual_channel_name)) {
+ sr_spew("sr_scpi_cmd_get(): new channel = %s", channel_name);
+ g_free(scpi->actual_channel_name);
+ scpi->actual_channel_name = g_strdup(channel_name);
+ ret = scpi_send(scpi, channel_cmd, channel_name);
+ if (ret != SR_OK)
+ return ret;
+ }
+
va_start(args, command);
ret = scpi_send_variadic(scpi, cmd, args);
va_end(args);