]> sigrok.org Git - libsigrok.git/blobdiff - hardware/common/scpi.c
Make sr_scpi_send() take printf-style arguments.
[libsigrok.git] / hardware / common / scpi.c
index ff18b6e507fb75287850f70db2b0e3cf2221f24f..10218ba9820379ebcead81f896e59a019b508270 100644 (file)
@@ -22,6 +22,7 @@
 
 #include <glib.h>
 #include <string.h>
+#include <stdarg.h>
 
 /* Message logging helpers with subsystem-specific prefix string. */
 #define LOG_PREFIX "scpi: "
@@ -71,40 +72,148 @@ static int parse_strict_bool(const char *str, gboolean *ret)
        return SR_ERR;
 }
 
+/**
+ * Open SCPI device.
+ *
+ * @param scpi Previously initialized SCPI device structure.
+ *
+ * @return SR_OK on success, SR_ERR on failure.
+ */
+SR_PRIV int sr_scpi_open(struct sr_scpi_dev_inst *scpi)
+{
+       return scpi->open(scpi->priv);
+}
+
+/**
+ * Add an event source for an SCPI device.
+ *
+ * @param scpi Previously initialized SCPI device structure.
+ * @param events Events to check for.
+ * @param timeout Max time to wait before the callback is called, ignored if 0.
+ * @param cb Callback function to add. Must not be NULL.
+ * @param cb_data Data for the callback function. Can be NULL.
+ *
+ * @return SR_OK upon success, SR_ERR_ARG upon invalid arguments, or
+ *         SR_ERR_MALLOC upon memory allocation errors.
+ */
+SR_PRIV int sr_scpi_source_add(struct sr_scpi_dev_inst *scpi, int events,
+               int timeout, sr_receive_data_callback_t cb, void *cb_data)
+{
+       return scpi->source_add(scpi->priv, events, timeout, cb, cb_data);
+}
+
+/**
+ * Remove event source for an SCPI device.
+ *
+ * @param scpi Previously initialized SCPI device structure.
+ *
+ * @return SR_OK upon success, SR_ERR_ARG upon invalid arguments, or
+ *         SR_ERR_MALLOC upon memory allocation errors, SR_ERR_BUG upon
+ *         internal errors.
+ */
+SR_PRIV int sr_scpi_source_remove(struct sr_scpi_dev_inst *scpi)
+{
+       return scpi->source_remove(scpi->priv);
+}
+
 /**
  * Send a SCPI command.
  *
- * @param serial Previously initialized serial port structure.
- * @param command The SCPI command to send to the device.
+ * @param scpi Previously initialized SCPI device structure.
+ * @param format Format string, to be followed by any necessary arguments.
  *
  * @return SR_OK on success, SR_ERR on failure.
  */
-SR_PRIV int sr_scpi_send(struct sr_serial_dev_inst *serial,
-                        const char *command)
+SR_PRIV int sr_scpi_send(struct sr_scpi_dev_inst *scpi,
+                        const char *format, ...)
 {
-       int len, out;
-       gchar *terminated_command;
+       va_list args1, args2;
+       char *buf;
+       int len, ret;
 
-       terminated_command = g_strconcat(command, "\n", NULL);
-       len = strlen(terminated_command);
-       out = serial_write(serial, terminated_command, len);
-       g_free(terminated_command);
+       /* Copy arguments since we need to make two variadic calls. */
+       va_start(args1, format);
+       va_copy(args2, args1);
 
-       if (out != len) {
-               sr_dbg("Only sent %d/%d bytes of SCPI command: '%s'.", out,
-                      len, command);
-               return SR_ERR;
-       }
+       /* Get length of buffer required. */
+       len = vsnprintf(NULL, 0, format, args1);
+       va_end(args1);
 
-       sr_spew("Successfully sent SCPI command: '%s'.", command);
+       /* Allocate buffer and write out command. */
+       buf = g_malloc(len + 1);
+       vsprintf(buf, format, args2);
+       va_end(args2);
 
-       return SR_OK;
+       /* Send command. */
+       ret = scpi->send(scpi->priv, buf);
+
+       /* Free command buffer. */
+       g_free(buf);
+
+       return ret;
+}
+
+/**
+ * Receive an SCPI reply and store the reply in scpi_response.
+ *
+ * @param scpi Previously initialised SCPI device structure.
+ * @param scpi_response Pointer where to store the SCPI response.
+ *
+ * @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_receive(struct sr_scpi_dev_inst *scpi,
+                       char **scpi_response)
+{
+       return scpi->receive(scpi->priv, scpi_response);
+}
+
+/**
+ * Read part of a response from SCPI device.
+ *
+ * @param scpi Previously initialised SCPI device structure.
+ * @param buf Buffer to store result.
+ * @param maxlen Maximum number of bytes to read.
+ *
+ * @return Number of bytes read, or SR_ERR upon failure.
+ */
+SR_PRIV int sr_scpi_read(struct sr_scpi_dev_inst *scpi,
+                       char *buf, int maxlen)
+{
+       return scpi->read(scpi->priv, buf, maxlen);
+}
+
+/**
+ * Close SCPI device.
+ *
+ * @param scpi Previously initialized SCPI device structure.
+ *
+ * @return SR_OK on success, SR_ERR on failure.
+ */
+SR_PRIV int sr_scpi_close(struct sr_scpi_dev_inst *scpi)
+{
+       return scpi->close(scpi->priv);
+}
+
+/**
+ * Free SCPI device.
+ *
+ * @param scpi Previously initialized SCPI device structure.
+ *
+ * @return SR_OK on success, SR_ERR on failure.
+ */
+SR_PRIV void sr_scpi_free(struct sr_scpi_dev_inst *scpi)
+{
+       scpi->free(scpi->priv);
+       g_free(scpi);
 }
 
 /**
  * Send a SCPI command, receive the reply and store the reply in scpi_response.
  *
- * @param serial Previously initialized serial port structure.
+ * @param scpi Previously initialised SCPI device structure.
  * @param command The SCPI command to send to the device (can be NULL).
  * @param scpi_response Pointer where to store the SCPI response.
  *
@@ -113,74 +222,27 @@ SR_PRIV int sr_scpi_send(struct sr_serial_dev_inst *serial,
  *         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,
+SR_PRIV int sr_scpi_get_string(struct sr_scpi_dev_inst *scpi,
                               const char *command, char **scpi_response)
 {
-       int len, ret;
-       char buf[256];
-       unsigned int i;
-       GString *response;
-
        if (command)
-               if (sr_scpi_send(serial, command) != SR_OK)
+               if (sr_scpi_send(scpi, command) != SR_OK)
                        return SR_ERR;
 
-       response = g_string_sized_new(1024);
-
-       for (i = 0; i <= SCPI_READ_RETRIES; i++) {
-               while ((len = serial_read(serial, buf, sizeof(buf))) > 0)
-                       response = g_string_append_len(response, buf, len);
-
-               if (response->len > 0 &&
-                   response->str[response->len-1] == '\n') {
-                       sr_spew("Fetched full SCPI response.");
-                       break;
-               }
-
-               g_usleep(SCPI_READ_RETRY_TIMEOUT);
-       }
-
-       if (response->len == 0) {
-               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') {
-               /*
-                * The SCPI response contains a LF ('\n') at the end and we
-                * don't need this so replace it with a '\0' and decrement
-                * the length.
-                */
-               response->str[--response->len] = '\0';
-               ret = SR_OK;
-       } else {
-               sr_warn("Incomplete SCPI response received!");
-               ret = SR_ERR;
-       }
-
-       /* Minor optimization: steal the string instead of copying. */
-       *scpi_response = response->str;
-
-       /* 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);
-
-       g_string_free(response, FALSE);
-
-       return ret;
+       return sr_scpi_receive(scpi, scpi_response);
 }
 
 /**
  * Send a SCPI command, read the reply, parse it as a bool value and store the
  * result in scpi_response.
  *
- * @param serial Previously initialized serial port structure.
+ * @param scpi Previously initialised SCPI device structure.
  * @param command The SCPI command to send to the device (can be NULL).
  * @param scpi_response Pointer where to store the parsed result.
  *
  * @return SR_OK on success, SR_ERR on failure.
  */
-SR_PRIV int sr_scpi_get_bool(struct sr_serial_dev_inst *serial,
+SR_PRIV int sr_scpi_get_bool(struct sr_scpi_dev_inst *scpi,
                             const char *command, gboolean *scpi_response)
 {
        int ret;
@@ -188,7 +250,7 @@ SR_PRIV int sr_scpi_get_bool(struct sr_serial_dev_inst *serial,
 
        response = NULL;
 
-       if (sr_scpi_get_string(serial, command, &response) != SR_OK)
+       if (sr_scpi_get_string(scpi, command, &response) != SR_OK)
                if (!response)
                        return SR_ERR;
 
@@ -206,13 +268,13 @@ SR_PRIV int sr_scpi_get_bool(struct sr_serial_dev_inst *serial,
  * Send a SCPI command, read the reply, parse it as an integer and store the
  * result in scpi_response.
  *
- * @param serial Previously initialized serial port structure.
+ * @param scpi Previously initialised SCPI device structure.
  * @param command The SCPI command to send to the device (can be NULL).
  * @param scpi_response Pointer where to store the parsed result.
  *
  * @return SR_OK on success, SR_ERR on failure.
  */
-SR_PRIV int sr_scpi_get_int(struct sr_serial_dev_inst *serial,
+SR_PRIV int sr_scpi_get_int(struct sr_scpi_dev_inst *scpi,
                            const char *command, int *scpi_response)
 {
        int ret;
@@ -220,7 +282,7 @@ SR_PRIV int sr_scpi_get_int(struct sr_serial_dev_inst *serial,
 
        response = NULL;
 
-       if (sr_scpi_get_string(serial, command, &response) != SR_OK)
+       if (sr_scpi_get_string(scpi, command, &response) != SR_OK)
                if (!response)
                        return SR_ERR;
 
@@ -238,13 +300,13 @@ SR_PRIV int sr_scpi_get_int(struct sr_serial_dev_inst *serial,
  * Send a SCPI command, read the reply, parse it as a float and store the
  * result in scpi_response.
  *
- * @param serial Previously initialized serial port structure.
+ * @param scpi Previously initialised SCPI device structure.
  * @param command The SCPI command to send to the device (can be NULL).
  * @param scpi_response Pointer where to store the parsed result.
  *
  * @return SR_OK on success, SR_ERR on failure.
  */
-SR_PRIV int sr_scpi_get_float(struct sr_serial_dev_inst *serial,
+SR_PRIV int sr_scpi_get_float(struct sr_scpi_dev_inst *scpi,
                              const char *command, float *scpi_response)
 {
        int ret;
@@ -252,7 +314,7 @@ SR_PRIV int sr_scpi_get_float(struct sr_serial_dev_inst *serial,
 
        response = NULL;
 
-       if (sr_scpi_get_string(serial, command, &response) != SR_OK)
+       if (sr_scpi_get_string(scpi, command, &response) != SR_OK)
                if (!response)
                        return SR_ERR;
 
@@ -270,13 +332,13 @@ SR_PRIV int sr_scpi_get_float(struct sr_serial_dev_inst *serial,
  * Send a SCPI command, read the reply, parse it as a double and store the
  * result in scpi_response.
  *
- * @param serial Previously initialized serial port structure.
+ * @param scpi Previously initialised SCPI device structure.
  * @param command The SCPI command to send to the device (can be NULL).
  * @param scpi_response Pointer where to store the parsed result.
  *
  * @return SR_OK on success, SR_ERR on failure.
  */
-SR_PRIV int sr_scpi_get_double(struct sr_serial_dev_inst *serial,
+SR_PRIV int sr_scpi_get_double(struct sr_scpi_dev_inst *scpi,
                               const char *command, double *scpi_response)
 {
        int ret;
@@ -284,7 +346,7 @@ SR_PRIV int sr_scpi_get_double(struct sr_serial_dev_inst *serial,
 
        response = NULL;
 
-       if (sr_scpi_get_string(serial, command, &response) != SR_OK)
+       if (sr_scpi_get_string(scpi, command, &response) != SR_OK)
                if (!response)
                        return SR_ERR;
 
@@ -302,17 +364,17 @@ SR_PRIV int sr_scpi_get_double(struct sr_serial_dev_inst *serial,
  * Send a SCPI *OPC? command, read the reply and return the result of the
  * command.
  *
- * @param serial Previously initialized serial port structure.
+ * @param scpi Previously initialised SCPI device structure.
  *
  * @return SR_OK on success, SR_ERR on failure.
  */
-SR_PRIV int sr_scpi_get_opc(struct sr_serial_dev_inst *serial)
+SR_PRIV int sr_scpi_get_opc(struct sr_scpi_dev_inst *scpi)
 {
        unsigned int i;
        gboolean opc;
 
        for (i = 0; i < SCPI_READ_RETRIES; ++i) {
-               sr_scpi_get_bool(serial, SCPI_CMD_OPC, &opc);
+               sr_scpi_get_bool(scpi, SCPI_CMD_OPC, &opc);
                if (opc)
                        return SR_OK;
                g_usleep(SCPI_READ_RETRY_TIMEOUT);
@@ -325,7 +387,7 @@ SR_PRIV int sr_scpi_get_opc(struct sr_serial_dev_inst *serial)
  * Send a SCPI command, read the reply, parse it as comma separated list of
  * floats and store the as an result in scpi_response.
  *
- * @param serial Previously initialized serial port structure.
+ * @param scpi Previously initialised SCPI device structure.
  * @param command The SCPI command to send to the device (can be NULL).
  * @param scpi_response Pointer where to store the parsed result.
  *
@@ -334,7 +396,7 @@ SR_PRIV int sr_scpi_get_opc(struct sr_serial_dev_inst *serial)
  *         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,
+SR_PRIV int sr_scpi_get_floatv(struct sr_scpi_dev_inst *scpi,
                               const char *command, GArray **scpi_response)
 {
        int ret;
@@ -347,7 +409,7 @@ SR_PRIV int sr_scpi_get_floatv(struct sr_serial_dev_inst *serial,
        response = NULL;
        tokens = NULL;
 
-       if (sr_scpi_get_string(serial, command, &response) != SR_OK)
+       if (sr_scpi_get_string(scpi, command, &response) != SR_OK)
                if (!response)
                        return SR_ERR;
 
@@ -383,7 +445,7 @@ SR_PRIV int sr_scpi_get_floatv(struct sr_serial_dev_inst *serial,
  * Send a SCPI command, read the reply, parse it as comma separated list of
  * unsigned 8 bit integers and store the as an result in scpi_response.
  *
- * @param serial Previously initialized serial port structure.
+ * @param scpi Previously initialised SCPI device structure.
  * @param command The SCPI command to send to the device (can be NULL).
  * @param scpi_response Pointer where to store the parsed result.
  *
@@ -392,7 +454,7 @@ SR_PRIV int sr_scpi_get_floatv(struct sr_serial_dev_inst *serial,
  *         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,
+SR_PRIV int sr_scpi_get_uint8v(struct sr_scpi_dev_inst *scpi,
                               const char *command, GArray **scpi_response)
 {
        int tmp, ret;
@@ -404,7 +466,7 @@ SR_PRIV int sr_scpi_get_uint8v(struct sr_serial_dev_inst *serial,
        response = NULL;
        tokens = NULL;
 
-       if (sr_scpi_get_string(serial, command, &response) != SR_OK)
+       if (sr_scpi_get_string(scpi, command, &response) != SR_OK)
                if (!response)
                        return SR_ERR;
 
@@ -442,12 +504,12 @@ SR_PRIV int sr_scpi_get_uint8v(struct sr_serial_dev_inst *serial,
  *
  * 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 Previously initialised SCPI device structure.
  * @param scpi_response Pointer where to store the hw_info structure.
  *
  * @return SR_OK upon success, SR_ERR on failure.
  */
-SR_PRIV int sr_scpi_get_hw_id(struct sr_serial_dev_inst *serial,
+SR_PRIV int sr_scpi_get_hw_id(struct sr_scpi_dev_inst *scpi,
                              struct sr_scpi_hw_info **scpi_response)
 {
        int num_tokens;
@@ -458,7 +520,7 @@ SR_PRIV int sr_scpi_get_hw_id(struct sr_serial_dev_inst *serial,
        response = NULL;
        tokens = NULL;
 
-       if (sr_scpi_get_string(serial, SCPI_CMD_IDN, &response) != SR_OK)
+       if (sr_scpi_get_string(scpi, SCPI_CMD_IDN, &response) != SR_OK)
                if (!response)
                        return SR_ERR;