X-Git-Url: https://sigrok.org/gitweb/?a=blobdiff_plain;f=src%2Fscpi%2Fscpi_serial.c;h=464924ce3086f2253c034339d22b0830917a5ce8;hb=379e95c587e1d76eb5d6d1a144b938e6a4916b1f;hp=650f9711c386cf24a11d031c422847c895dea66f;hpb=91219afc75c9aa1d0c5e2da5c03343c1e43eb6df;p=libsigrok.git diff --git a/src/scpi/scpi_serial.c b/src/scpi/scpi_serial.c index 650f9711..464924ce 100644 --- a/src/scpi/scpi_serial.c +++ b/src/scpi/scpi_serial.c @@ -18,31 +18,29 @@ * along with this program. If not, see . */ -#include "libsigrok.h" -#include "libsigrok-internal.h" - +#include #include #include #include +#include +#include "libsigrok-internal.h" +#include "scpi.h" #define LOG_PREFIX "scpi_serial" -#define BUFFER_SIZE 1024 - struct scpi_serial { struct sr_serial_dev_inst *serial; - char buffer[BUFFER_SIZE]; - size_t count; - size_t read; + gboolean got_newline; }; -static struct { +static const struct { uint16_t vendor_id; uint16_t product_id; const char *serialcomm; } scpi_serial_usb_ids[] = { { 0x0403, 0xed72, "115200/8n1/flow=1" }, /* Hameg HO720 */ { 0x0403, 0xed73, "115200/8n1/flow=1" }, /* Hameg HO730 */ + { 0x0aad, 0x0118, "115200/8n1" }, /* R&S HMO1002 */ }; static GSList *scpi_serial_scan(struct drv_context *drvc) @@ -54,8 +52,8 @@ static GSList *scpi_serial_scan(struct drv_context *drvc) (void)drvc; for (i = 0; i < ARRAY_SIZE(scpi_serial_usb_ids); i++) { - if ((l = sr_serial_find_usb(scpi_serial_usb_ids[i].vendor_id, - scpi_serial_usb_ids[i].product_id)) == NULL) + if (!(l = sr_serial_find_usb(scpi_serial_usb_ids[i].vendor_id, + scpi_serial_usb_ids[i].product_id))) continue; for (r = l; r; r = r->next) { if (scpi_serial_usb_ids[i].serialcomm) @@ -84,9 +82,9 @@ static int scpi_serial_dev_inst_new(void *priv, struct drv_context *drvc, return SR_OK; } -static int scpi_serial_open(void *priv) +static int scpi_serial_open(struct sr_scpi_dev_inst *scpi) { - struct scpi_serial *sscpi = priv; + struct scpi_serial *sscpi = scpi->priv; struct sr_serial_dev_inst *serial = sscpi->serial; if (serial_open(serial, SERIAL_RDWR) != SR_OK) @@ -95,8 +93,7 @@ static int scpi_serial_open(void *priv) if (serial_flush(serial) != SR_OK) return SR_ERR; - sscpi->count = 0; - sscpi->read = 0; + sscpi->got_newline = FALSE; return SR_OK; } @@ -120,27 +117,16 @@ static int scpi_serial_source_remove(struct sr_session *session, void *priv) static int scpi_serial_send(void *priv, const char *command) { - int len, result, written; - gchar *terminated_command; + int result; struct scpi_serial *sscpi = priv; struct sr_serial_dev_inst *serial = sscpi->serial; - terminated_command = g_strconcat(command, "\n", NULL); - len = strlen(terminated_command); - written = 0; - while (written < len) { - result = serial_write_nonblocking(serial, - terminated_command + written, len - written); - if (result < 0) { - sr_err("Error while sending SCPI command: '%s'.", command); - g_free(terminated_command); - return SR_ERR; - } - written += result; + result = serial_write_blocking(serial, command, strlen(command), 0); + if (result < 0) { + sr_err("Error while sending SCPI command: '%s'.", command); + return SR_ERR; } - g_free(terminated_command); - sr_spew("Successfully sent SCPI command: '%s'.", command); return SR_OK; @@ -148,7 +134,8 @@ static int scpi_serial_send(void *priv, const char *command) static int scpi_serial_read_begin(void *priv) { - (void) priv; + struct scpi_serial *sscpi = priv; + sscpi->got_newline = FALSE; return SR_OK; } @@ -156,61 +143,38 @@ static int scpi_serial_read_begin(void *priv) static int scpi_serial_read_data(void *priv, char *buf, int maxlen) { struct scpi_serial *sscpi = priv; - int len, ret; + int ret; - len = BUFFER_SIZE - sscpi->count; + /* Try to read new data into the buffer. */ + ret = serial_read_nonblocking(sscpi->serial, buf, maxlen); - /* Try to read new data into the buffer if there is space. */ - if (len > 0) { - ret = serial_read_nonblocking(sscpi->serial, sscpi->buffer + sscpi->read, - BUFFER_SIZE - sscpi->count); + if (ret < 0) + return ret; - if (ret < 0) - return ret; + if (ret > 0) { + sr_spew("Read %d bytes into buffer.", ret); - sscpi->count += ret; - - if (ret > 0) - sr_spew("Read %d bytes into buffer.", ret); - } - - /* Return as many bytes as possible from buffer, excluding any trailing newline. */ - if (sscpi->read < sscpi->count) { - len = sscpi->count - sscpi->read; - if (len > maxlen) - len = maxlen; - if (sscpi->buffer[sscpi->read + len - 1] == '\n') - len--; - sr_spew("Returning %d bytes from buffer.", len); - memcpy(buf, sscpi->buffer + sscpi->read, len); - sscpi->read += len; - if (sscpi->read == BUFFER_SIZE) { - sr_spew("Resetting buffer."); - sscpi->count = 0; - sscpi->read = 0; + if (buf[ret - 1] == '\n') { + sscpi->got_newline = TRUE; + sr_spew("Received terminator"); + } else { + sscpi->got_newline = FALSE; } - return len; } - return 0; + return ret; } static int scpi_serial_read_complete(void *priv) { struct scpi_serial *sscpi = priv; - /* If the next character is a newline, discard it and report complete. */ - if (sscpi->read < sscpi->count && sscpi->buffer[sscpi->read] == '\n') { - sscpi->read++; - return 1; - } else { - return 0; - } + return sscpi->got_newline; } -static int scpi_serial_close(void *priv) +static int scpi_serial_close(struct sr_scpi_dev_inst *scpi) { - struct scpi_serial *sscpi = priv; + struct scpi_serial *sscpi = scpi->priv; return serial_close(sscpi->serial); }