X-Git-Url: https://sigrok.org/gitweb/?a=blobdiff_plain;f=src%2Fhardware%2Flascar-el-usb%2Fprotocol.c;h=f7b053f3bf19f45c7f1fd91c53b6181f5d75ec69;hb=4237fbcaac84160a04333244ba0a309b952d3a8f;hp=576d974943230a38c3a78863ead382071a928237;hpb=5e23fcab889c62864b92aa3ad6902ce3e9f5be49;p=libsigrok.git diff --git a/src/hardware/lascar-el-usb/protocol.c b/src/hardware/lascar-el-usb/protocol.c index 576d9749..f7b053f3 100644 --- a/src/hardware/lascar-el-usb/protocol.c +++ b/src/hardware/lascar-el-usb/protocol.c @@ -17,17 +17,18 @@ * along with this program. If not, see . */ +#include #include #include #include #include #include -#include "libsigrok.h" +#include #include "libsigrok-internal.h" #include "protocol.h" extern struct sr_dev_driver lascar_el_usb_driver_info; -static struct sr_dev_driver *di = &lascar_el_usb_driver_info; +struct sr_dev_driver *di = &lascar_el_usb_driver_info; static const struct elusb_profile profiles[] = { { 1, "EL-USB-1", LOG_UNSUPPORTED }, @@ -51,10 +52,9 @@ static const struct elusb_profile profiles[] = { { 19, "EL-USB-1-LCD", LOG_UNSUPPORTED }, { 20, "EL-OEM-3", LOG_UNSUPPORTED }, { 21, "EL-USB-1-LCD", LOG_UNSUPPORTED }, - { 0, NULL, 0 } + ALL_ZERO }; - static libusb_device_handle *lascar_open(struct libusb_device *dev) { libusb_device_handle *dev_hdl; @@ -67,7 +67,7 @@ static libusb_device_handle *lascar_open(struct libusb_device *dev) } /* Some of these fail, but it needs doing -- some sort of mode - * setup for the SILabs F32x. */ + * setup for the SiLabs F32x. */ libusb_control_transfer(dev_hdl, LIBUSB_REQUEST_TYPE_VENDOR, 0x00, 0xffff, 0x00, NULL, 0, 50); libusb_control_transfer(dev_hdl, LIBUSB_REQUEST_TYPE_VENDOR, @@ -78,7 +78,7 @@ static libusb_device_handle *lascar_open(struct libusb_device *dev) return dev_hdl; } -static void mark_xfer(struct libusb_transfer *xfer) +static void LIBUSB_CALL mark_xfer(struct libusb_transfer *xfer) { xfer->user_data = GINT_TO_POINTER(1); @@ -97,7 +97,7 @@ SR_PRIV int lascar_get_config(libusb_device_handle *dev_hdl, sr_spew("Reading config block."); - drvc = di->priv; + drvc = di->context; *configlen = 0; if (!(xfer_in = libusb_alloc_transfer(0)) || @@ -112,7 +112,7 @@ SR_PRIV int lascar_get_config(libusb_device_handle *dev_hdl, /* Keep a read request waiting in the wings, ready to pounce * the moment the device sends something. */ libusb_fill_bulk_transfer(xfer_in, dev_hdl, LASCAR_EP_IN, - buf, 256, mark_xfer, 0, 10000); + buf, 256, mark_xfer, 0, BULK_XFER_TIMEOUT); if (libusb_submit_transfer(xfer_in) != 0) goto cleanup; @@ -133,7 +133,7 @@ SR_PRIV int lascar_get_config(libusb_device_handle *dev_hdl, start = 0; break; } - g_usleep(5000); + g_usleep(SLEEP_US_LONG); libusb_handle_events_timeout(drvc->sr_ctx->libusb_ctx, &tv); } if (!start) { @@ -166,7 +166,7 @@ SR_PRIV int lascar_get_config(libusb_device_handle *dev_hdl, start = 0; break; } - g_usleep(5000); + g_usleep(SLEEP_US_LONG); libusb_handle_events_timeout(drvc->sr_ctx->libusb_ctx, &tv); } if (!start) { @@ -183,16 +183,16 @@ SR_PRIV int lascar_get_config(libusb_device_handle *dev_hdl, *configlen = buflen; cleanup: - if (!xfer_in->user_data || !xfer_in->user_data) { + if (!xfer_in->user_data || !xfer_out->user_data) { if (!xfer_in->user_data) libusb_cancel_transfer(xfer_in); if (!xfer_out->user_data) libusb_cancel_transfer(xfer_out); start = g_get_monotonic_time(); while (!xfer_in->user_data || !xfer_out->user_data) { - if (g_get_monotonic_time() - start > 10000) + if (g_get_monotonic_time() - start > EVENTS_TIMEOUT) break; - g_usleep(1000); + g_usleep(SLEEP_US_SHORT); libusb_handle_events_timeout(drvc->sr_ctx->libusb_ctx, &tv); } } @@ -214,7 +214,7 @@ static int lascar_save_config(libusb_device_handle *dev_hdl, sr_spew("Writing config block."); - drvc = di->priv; + drvc = di->context; if (!(xfer_in = libusb_alloc_transfer(0)) || !(xfer_out = libusb_alloc_transfer(0))) @@ -229,7 +229,7 @@ static int lascar_save_config(libusb_device_handle *dev_hdl, /* Keep a read request waiting in the wings, ready to pounce * the moment the device sends something. */ libusb_fill_bulk_transfer(xfer_in, dev_hdl, LASCAR_EP_IN, - buf, 256, mark_xfer, 0, 10000); + buf, 256, mark_xfer, 0, BULK_XFER_TIMEOUT); if (libusb_submit_transfer(xfer_in) != 0) { ret = SR_ERR; goto cleanup; @@ -248,7 +248,7 @@ static int lascar_save_config(libusb_device_handle *dev_hdl, tv.tv_sec = 0; tv.tv_usec = 0; while (!xfer_out->user_data) { - g_usleep(5000); + g_usleep(SLEEP_US_LONG); libusb_handle_events_timeout(drvc->sr_ctx->libusb_ctx, &tv); } @@ -259,7 +259,7 @@ static int lascar_save_config(libusb_device_handle *dev_hdl, goto cleanup; } while (!xfer_in->user_data || !xfer_out->user_data) { - g_usleep(5000); + g_usleep(SLEEP_US_LONG); libusb_handle_events_timeout(drvc->sr_ctx->libusb_ctx, &tv); } @@ -269,16 +269,16 @@ static int lascar_save_config(libusb_device_handle *dev_hdl, } cleanup: - if (!xfer_in->user_data || !xfer_in->user_data) { + if (!xfer_in->user_data || !xfer_out->user_data) { if (!xfer_in->user_data) libusb_cancel_transfer(xfer_in); if (!xfer_out->user_data) libusb_cancel_transfer(xfer_out); start = g_get_monotonic_time(); while (!xfer_in->user_data || !xfer_out->user_data) { - if (g_get_monotonic_time() - start > 10000) + if (g_get_monotonic_time() - start > EVENTS_TIMEOUT) break; - g_usleep(1000); + g_usleep(SLEEP_US_SHORT); libusb_handle_events_timeout(drvc->sr_ctx->libusb_ctx, &tv); } } @@ -352,21 +352,19 @@ SR_PRIV struct sr_dev_inst *lascar_scan(int bus, int address) struct drv_context *drvc; struct sr_dev_inst *sdi; struct libusb_device **devlist; - struct libusb_device_descriptor des; libusb_device_handle *dev_hdl; - int dummy, ret, i; + int dummy, i; + int ret; unsigned char config[MAX_CONFIGBLOCK_SIZE]; - drvc = di->priv; + drvc = di->context; sdi = NULL; - libusb_get_device_list(drvc->sr_ctx->libusb_ctx, &devlist); - for (i = 0; devlist[i]; i++) { - if ((ret = libusb_get_device_descriptor(devlist[i], &des))) { - sr_err("Failed to get device descriptor: %d.", ret); - continue; - } + ret = libusb_get_device_list(drvc->sr_ctx->libusb_ctx, &devlist); + if (ret < 0) + return NULL; + for (i = 0; devlist[i]; i++) { if (libusb_get_bus_number(devlist[i]) != bus || libusb_get_device_address(devlist[i]) != address) continue; @@ -380,6 +378,7 @@ SR_PRIV struct sr_dev_inst *lascar_scan(int bus, int address) libusb_close(dev_hdl); sdi = lascar_identify(config); } + libusb_free_device_list(devlist, 1); return sdi; } @@ -389,7 +388,7 @@ static void lascar_el_usb_dispatch(struct sr_dev_inst *sdi, unsigned char *buf, { struct dev_context *devc; struct sr_datafeed_packet packet; - struct sr_datafeed_analog analog; + struct sr_datafeed_analog_old analog; struct sr_channel *ch; float *temp, *rh; uint16_t s; @@ -403,7 +402,7 @@ static void lascar_el_usb_dispatch(struct sr_dev_inst *sdi, unsigned char *buf, samples = samples_left; switch (devc->profile->logformat) { case LOG_TEMP_RH: - packet.type = SR_DF_ANALOG; + packet.type = SR_DF_ANALOG_OLD; packet.payload = &analog; analog.mqflags = 0; if (!(temp = g_try_malloc(sizeof(float) * samples))) @@ -411,9 +410,9 @@ static void lascar_el_usb_dispatch(struct sr_dev_inst *sdi, unsigned char *buf, if (!(rh = g_try_malloc(sizeof(float) * samples))) break; for (i = 0, j = 0; i < samples; i++) { - /* Both Celcius and Fahrenheit stored at base -40. */ + /* Both Celsius and Fahrenheit stored at base -40. */ if (devc->temp_unit == 0) - /* Celcius is stored in half-degree increments. */ + /* Celsius is stored in half-degree increments. */ temp[j] = buf[i * 2] / 2 - 40; else temp[j] = buf[i * 2] - 40; @@ -436,7 +435,8 @@ static void lascar_el_usb_dispatch(struct sr_dev_inst *sdi, unsigned char *buf, else analog.unit = SR_UNIT_CELSIUS; analog.data = temp; - sr_session_send(devc->cb_data, &packet); + sr_session_send(sdi, &packet); + g_slist_free(analog.channels); } ch = sdi->channels->next->data; @@ -445,14 +445,15 @@ static void lascar_el_usb_dispatch(struct sr_dev_inst *sdi, unsigned char *buf, analog.mq = SR_MQ_RELATIVE_HUMIDITY; analog.unit = SR_UNIT_PERCENTAGE; analog.data = rh; - sr_session_send(devc->cb_data, &packet); + sr_session_send(sdi, &packet); + g_slist_free(analog.channels); } g_free(temp); g_free(rh); break; case LOG_CO: - packet.type = SR_DF_ANALOG; + packet.type = SR_DF_ANALOG_OLD; packet.payload = &analog; analog.channels = sdi->channels; analog.num_samples = samples; @@ -463,11 +464,11 @@ static void lascar_el_usb_dispatch(struct sr_dev_inst *sdi, unsigned char *buf, break; for (i = 0; i < samples; i++) { s = (buf[i * 2] << 8) | buf[i * 2 + 1]; - analog.data[i] = (s * devc->co_high + devc->co_low) / 1000000; + analog.data[i] = (s * devc->co_high + devc->co_low) / (1000 * 1000); if (analog.data[i] < 0.0) analog.data[i] = 0.0; } - sr_session_send(devc->cb_data, &packet); + sr_session_send(sdi, &packet); g_free(analog.data); break; default: @@ -480,8 +481,7 @@ static void lascar_el_usb_dispatch(struct sr_dev_inst *sdi, unsigned char *buf, SR_PRIV int lascar_el_usb_handle_events(int fd, int revents, void *cb_data) { - struct drv_context *drvc = di->priv; - struct sr_datafeed_packet packet; + struct drv_context *drvc = di->context; struct sr_dev_inst *sdi; struct timeval tv; @@ -492,9 +492,7 @@ SR_PRIV int lascar_el_usb_handle_events(int fd, int revents, void *cb_data) if (sdi->status == SR_ST_STOPPING) { usb_source_remove(sdi->session, drvc->sr_ctx); - - packet.type = SR_DF_END; - sr_session_send(cb_data, &packet); + std_session_send_df_end(sdi, LOG_PREFIX); } memset(&tv, 0, sizeof(struct timeval)); @@ -504,7 +502,7 @@ SR_PRIV int lascar_el_usb_handle_events(int fd, int revents, void *cb_data) return TRUE; } -SR_PRIV void lascar_el_usb_receive_transfer(struct libusb_transfer *transfer) +SR_PRIV void LIBUSB_CALL lascar_el_usb_receive_transfer(struct libusb_transfer *transfer) { struct dev_context *devc; struct sr_dev_inst *sdi; @@ -518,7 +516,7 @@ SR_PRIV void lascar_el_usb_receive_transfer(struct libusb_transfer *transfer) switch (transfer->status) { case LIBUSB_TRANSFER_NO_DEVICE: /* USB device was unplugged. */ - dev_acquisition_stop(sdi, sdi); + dev_acquisition_stop(sdi); return; case LIBUSB_TRANSFER_COMPLETED: case LIBUSB_TRANSFER_TIMED_OUT: /* We may have received some data though */ @@ -537,7 +535,7 @@ SR_PRIV void lascar_el_usb_receive_transfer(struct libusb_transfer *transfer) devc->rcvd_bytes, devc->log_size, devc->rcvd_samples, devc->logged_samples); if (devc->rcvd_bytes >= devc->log_size) - dev_acquisition_stop(sdi, sdi); + dev_acquisition_stop(sdi); } if (sdi->status == SR_ST_ACTIVE) { @@ -547,7 +545,7 @@ SR_PRIV void lascar_el_usb_receive_transfer(struct libusb_transfer *transfer) libusb_error_name(ret)); g_free(transfer->buffer); libusb_free_transfer(transfer); - dev_acquisition_stop(sdi, sdi); + dev_acquisition_stop(sdi); } } else { /* This was the last transfer we're going to receive, so