2 * This file is part of the libsigrok project.
4 * Copyright (C) 2012 Bert Vermeulen <bert@biot.com>
6 * This program is free software: you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation, either version 3 of the License, or
9 * (at your option) any later version.
11 * This program is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 * GNU General Public License for more details.
16 * You should have received a copy of the GNU General Public License
17 * along with this program. If not, see <http://www.gnu.org/licenses/>.
26 #include <libsigrok/libsigrok.h>
27 #include "libsigrok-internal.h"
30 extern SR_PRIV struct sr_dev_driver lascar_el_usb_driver_info;
31 struct sr_dev_driver *di = &lascar_el_usb_driver_info;
33 static const struct elusb_profile profiles[] = {
34 { 1, "EL-USB-1", LOG_UNSUPPORTED },
35 { 2, "EL-USB-1", LOG_UNSUPPORTED },
36 { 3, "EL-USB-2", LOG_TEMP_RH },
37 { 4, "EL-USB-3", LOG_UNSUPPORTED },
38 { 5, "EL-USB-4", LOG_UNSUPPORTED },
39 { 6, "EL-USB-3", LOG_UNSUPPORTED },
40 { 7, "EL-USB-4", LOG_UNSUPPORTED },
41 { 8, "EL-USB-LITE", LOG_UNSUPPORTED },
42 { 9, "EL-USB-CO", LOG_CO },
43 { 10, "EL-USB-TC", LOG_UNSUPPORTED },
44 { 11, "EL-USB-CO300", LOG_CO },
45 { 12, "EL-USB-2-LCD", LOG_TEMP_RH },
46 { 13, "EL-USB-2+", LOG_TEMP_RH },
47 { 14, "EL-USB-1-PRO", LOG_UNSUPPORTED },
48 { 15, "EL-USB-TC-LCD", LOG_UNSUPPORTED },
49 { 16, "EL-USB-2-LCD+", LOG_TEMP_RH },
50 { 17, "EL-USB-5", LOG_UNSUPPORTED },
51 { 18, "EL-USB-1-RCG", LOG_UNSUPPORTED },
52 { 19, "EL-USB-1-LCD", LOG_UNSUPPORTED },
53 { 20, "EL-OEM-3", LOG_UNSUPPORTED },
54 { 21, "EL-USB-1-LCD", LOG_UNSUPPORTED },
58 static libusb_device_handle *lascar_open(struct libusb_device *dev)
60 libusb_device_handle *dev_hdl;
63 if ((ret = libusb_open(dev, &dev_hdl)) != 0) {
64 sr_dbg("failed to open device for scan: %s",
65 libusb_error_name(ret));
69 /* Some of these fail, but it needs doing -- some sort of mode
70 * setup for the SiLabs F32x. */
71 libusb_control_transfer(dev_hdl, LIBUSB_REQUEST_TYPE_VENDOR,
72 0x00, 0xffff, 0x00, NULL, 0, 50);
73 libusb_control_transfer(dev_hdl, LIBUSB_REQUEST_TYPE_VENDOR,
74 0x02, 0x0002, 0x00, NULL, 0, 50);
75 libusb_control_transfer(dev_hdl, LIBUSB_REQUEST_TYPE_VENDOR,
76 0x02, 0x0001, 0x00, NULL, 0, 50);
81 static void LIBUSB_CALL mark_xfer(struct libusb_transfer *xfer)
84 xfer->user_data = GINT_TO_POINTER(1);
88 SR_PRIV int lascar_get_config(libusb_device_handle *dev_hdl,
89 unsigned char *configblock, int *configlen)
91 struct drv_context *drvc;
92 struct libusb_transfer *xfer_in, *xfer_out;
96 unsigned char cmd[3], buf[MAX_CONFIGBLOCK_SIZE];
98 sr_spew("Reading config block.");
103 if (!(xfer_in = libusb_alloc_transfer(0)) ||
104 !(xfer_out = libusb_alloc_transfer(0)))
107 /* Flush anything the F321 still has queued. */
108 while (libusb_bulk_transfer(dev_hdl, LASCAR_EP_IN, buf, 256, &buflen,
109 5) == 0 && buflen > 0)
112 /* Keep a read request waiting in the wings, ready to pounce
113 * the moment the device sends something. */
114 libusb_fill_bulk_transfer(xfer_in, dev_hdl, LASCAR_EP_IN,
115 buf, 256, mark_xfer, 0, BULK_XFER_TIMEOUT);
116 if (libusb_submit_transfer(xfer_in) != 0)
119 /* Request device configuration structure. */
123 libusb_fill_bulk_transfer(xfer_out, dev_hdl, LASCAR_EP_OUT,
124 cmd, 3, mark_xfer, 0, 100);
125 if (libusb_submit_transfer(xfer_out) != 0)
130 start = g_get_monotonic_time();
131 while (!xfer_in->user_data || !xfer_out->user_data) {
132 if (g_get_monotonic_time() - start > SCAN_TIMEOUT) {
136 g_usleep(SLEEP_US_LONG);
137 libusb_handle_events_timeout(drvc->sr_ctx->libusb_ctx, &tv);
140 sr_dbg("no response");
143 if (xfer_in->actual_length != 3) {
144 sr_dbg("expected 3-byte header, got %d bytes", xfer_in->actual_length);
148 /* Got configuration structure header. */
149 sr_spew("Response to config request: 0x%.2x 0x%.2x 0x%.2x ",
150 buf[0], buf[1], buf[2]);
151 buflen = buf[1] | (buf[2] << 8);
152 if (buf[0] != 0x02 || buflen > MAX_CONFIGBLOCK_SIZE) {
153 sr_dbg("Invalid response to config request: "
154 "0x%.2x 0x%.2x 0x%.2x ", buf[0], buf[1], buf[2]);
155 libusb_close(dev_hdl);
159 /* Get configuration structure. */
160 xfer_in->length = buflen;
161 xfer_in->user_data = 0;
162 if (libusb_submit_transfer(xfer_in) != 0)
164 while (!xfer_in->user_data) {
165 if (g_get_monotonic_time() - start > SCAN_TIMEOUT) {
169 g_usleep(SLEEP_US_LONG);
170 libusb_handle_events_timeout(drvc->sr_ctx->libusb_ctx, &tv);
173 sr_dbg("Timeout waiting for configuration structure.");
176 if (xfer_in->actual_length != buflen) {
177 sr_dbg("expected %d-byte structure, got %d bytes", buflen,
178 xfer_in->actual_length);
182 memcpy(configblock, buf, buflen);
186 if (!xfer_in->user_data || !xfer_out->user_data) {
187 if (!xfer_in->user_data)
188 libusb_cancel_transfer(xfer_in);
189 if (!xfer_out->user_data)
190 libusb_cancel_transfer(xfer_out);
191 start = g_get_monotonic_time();
192 while (!xfer_in->user_data || !xfer_out->user_data) {
193 if (g_get_monotonic_time() - start > EVENTS_TIMEOUT)
195 g_usleep(SLEEP_US_SHORT);
196 libusb_handle_events_timeout(drvc->sr_ctx->libusb_ctx, &tv);
199 libusb_free_transfer(xfer_in);
200 libusb_free_transfer(xfer_out);
202 return *configlen ? SR_OK : SR_ERR;
205 static int lascar_save_config(libusb_device_handle *dev_hdl,
206 unsigned char *config, int configlen)
208 struct drv_context *drvc;
209 struct libusb_transfer *xfer_in, *xfer_out;
213 unsigned char cmd[3], buf[256];
215 sr_spew("Writing config block.");
219 if (!(xfer_in = libusb_alloc_transfer(0)) ||
220 !(xfer_out = libusb_alloc_transfer(0)))
223 /* Flush anything the F321 still has queued. */
224 while (libusb_bulk_transfer(dev_hdl, LASCAR_EP_IN, buf, 256, &buflen,
225 5) == 0 && buflen > 0)
229 /* Keep a read request waiting in the wings, ready to pounce
230 * the moment the device sends something. */
231 libusb_fill_bulk_transfer(xfer_in, dev_hdl, LASCAR_EP_IN,
232 buf, 256, mark_xfer, 0, BULK_XFER_TIMEOUT);
233 if (libusb_submit_transfer(xfer_in) != 0) {
238 /* Request device configuration structure. */
240 cmd[1] = configlen & 0xff;
241 cmd[2] = (configlen >> 8) & 0xff;
242 libusb_fill_bulk_transfer(xfer_out, dev_hdl, LASCAR_EP_OUT,
243 cmd, 3, mark_xfer, 0, 100);
244 if (libusb_submit_transfer(xfer_out) != 0) {
250 while (!xfer_out->user_data) {
251 g_usleep(SLEEP_US_LONG);
252 libusb_handle_events_timeout(drvc->sr_ctx->libusb_ctx, &tv);
255 libusb_fill_bulk_transfer(xfer_out, dev_hdl, LASCAR_EP_OUT,
256 config, configlen, mark_xfer, 0, 100);
257 if (libusb_submit_transfer(xfer_out) != 0) {
261 while (!xfer_in->user_data || !xfer_out->user_data) {
262 g_usleep(SLEEP_US_LONG);
263 libusb_handle_events_timeout(drvc->sr_ctx->libusb_ctx, &tv);
266 if (xfer_in->actual_length != 1 || buf[0] != 0xff) {
267 sr_dbg("unexpected response after transfer");
272 if (!xfer_in->user_data || !xfer_out->user_data) {
273 if (!xfer_in->user_data)
274 libusb_cancel_transfer(xfer_in);
275 if (!xfer_out->user_data)
276 libusb_cancel_transfer(xfer_out);
277 start = g_get_monotonic_time();
278 while (!xfer_in->user_data || !xfer_out->user_data) {
279 if (g_get_monotonic_time() - start > EVENTS_TIMEOUT)
281 g_usleep(SLEEP_US_SHORT);
282 libusb_handle_events_timeout(drvc->sr_ctx->libusb_ctx, &tv);
285 libusb_free_transfer(xfer_in);
286 libusb_free_transfer(xfer_out);
291 static struct sr_dev_inst *lascar_identify(unsigned char *config)
293 struct dev_context *devc;
294 const struct elusb_profile *profile;
295 struct sr_dev_inst *sdi;
303 for (i = 0; profiles[i].modelid; i++) {
304 if (profiles[i].modelid == modelid) {
305 profile = &profiles[i];
310 sr_dbg("unknown EL-USB modelid %d", modelid);
314 i = config[52] | (config[53] << 8);
315 memcpy(firmware, config + 0x30, 4);
317 sr_dbg("found %s with firmware version %s serial %d",
318 profile->modelname, firmware, i);
320 if (profile->logformat == LOG_UNSUPPORTED) {
321 sr_dbg("unsupported EL-USB logformat for %s", profile->modelname);
325 sdi = g_malloc0(sizeof(struct sr_dev_inst));
326 sdi->status = SR_ST_INACTIVE;
327 sdi->vendor = g_strdup(LASCAR_VENDOR);
328 sdi->model = g_strdup(profile->modelname);
329 sdi->version = g_strdup(firmware);
331 if (profile->logformat == LOG_TEMP_RH) {
332 /* Model this as two channels: temperature and humidity. */
333 sr_channel_new(sdi, 0, SR_CHANNEL_ANALOG, TRUE, "Temp");
334 sr_channel_new(sdi, 0, SR_CHANNEL_ANALOG, TRUE, "Hum");
335 } else if (profile->logformat == LOG_CO) {
336 sr_channel_new(sdi, 0, SR_CHANNEL_ANALOG, TRUE, "CO");
338 sr_channel_new(sdi, 0, SR_CHANNEL_ANALOG, TRUE, "P1");
341 devc = g_malloc0(sizeof(struct dev_context));
343 devc->profile = profile;
349 SR_PRIV struct sr_dev_inst *lascar_scan(int bus, int address)
351 struct drv_context *drvc;
352 struct sr_dev_inst *sdi;
353 struct libusb_device **devlist;
354 libusb_device_handle *dev_hdl;
357 unsigned char config[MAX_CONFIGBLOCK_SIZE];
362 ret = libusb_get_device_list(drvc->sr_ctx->libusb_ctx, &devlist);
366 for (i = 0; devlist[i]; i++) {
367 if (libusb_get_bus_number(devlist[i]) != bus ||
368 libusb_get_device_address(devlist[i]) != address)
371 if (!(dev_hdl = lascar_open(devlist[i])))
374 if (lascar_get_config(dev_hdl, config, &dummy) != SR_OK)
377 libusb_close(dev_hdl);
378 sdi = lascar_identify(config);
380 libusb_free_device_list(devlist, 1);
385 static void lascar_el_usb_dispatch(struct sr_dev_inst *sdi, unsigned char *buf,
388 struct dev_context *devc;
389 struct sr_datafeed_packet packet;
390 struct sr_datafeed_analog analog;
391 struct sr_analog_encoding encoding;
392 struct sr_analog_meaning meaning;
393 struct sr_analog_spec spec;
394 struct sr_channel *ch;
397 int samples, samples_left, i, j;
401 /* Note: digits/spec_digits will be overridden later. */
402 sr_analog_init(&analog, &encoding, &meaning, &spec, 0);
404 samples = buflen / devc->sample_size;
405 samples_left = devc->logged_samples - devc->rcvd_samples;
406 if (samples_left < samples)
407 samples = samples_left;
408 switch (devc->profile->logformat) {
410 packet.type = SR_DF_ANALOG;
411 packet.payload = &analog;
412 analog.meaning->mqflags = 0;
413 if (!(temp = g_try_malloc(sizeof(float) * samples)))
415 if (!(rh = g_try_malloc(sizeof(float) * samples)))
417 for (i = 0, j = 0; i < samples; i++) {
418 /* Both Celsius and Fahrenheit stored at base -40. */
419 if (devc->temp_unit == 0)
420 /* Celsius is stored in half-degree increments. */
421 temp[j] = buf[i * 2] / 2 - 40;
423 temp[j] = buf[i * 2] - 40;
425 rh[j] = buf[i * 2 + 1] / 2;
427 if (temp[j] == 0.0 && rh[j] == 0.0)
428 /* Skip invalid measurement. */
432 analog.num_samples = j;
434 ch = sdi->channels->data;
436 analog.meaning->channels = g_slist_append(NULL, ch);
437 analog.meaning->mq = SR_MQ_TEMPERATURE;
438 if (devc->temp_unit == 1) {
439 analog.meaning->unit = SR_UNIT_FAHRENHEIT;
440 analog.encoding->digits = 0;
441 analog.spec->spec_digits = 0;
443 analog.meaning->unit = SR_UNIT_CELSIUS;
444 analog.encoding->digits = 1;
445 analog.spec->spec_digits = 1;
447 analog.data = (void *)temp;
448 sr_session_send(sdi, &packet);
449 g_slist_free(analog.meaning->channels);
452 ch = sdi->channels->next->data;
454 analog.meaning->channels = g_slist_append(NULL, ch);
455 analog.meaning->mq = SR_MQ_RELATIVE_HUMIDITY;
456 analog.meaning->unit = SR_UNIT_PERCENTAGE;
457 analog.encoding->digits = 1;
458 analog.spec->spec_digits = 1;
459 analog.data = (void *)rh;
460 sr_session_send(sdi, &packet);
461 g_slist_free(analog.meaning->channels);
468 packet.type = SR_DF_ANALOG;
469 packet.payload = &analog;
470 analog.meaning->channels = sdi->channels;
471 analog.num_samples = samples;
472 analog.meaning->mq = SR_MQ_CARBON_MONOXIDE;
473 analog.meaning->unit = SR_UNIT_CONCENTRATION;
474 analog.meaning->mqflags = 0;
475 if (!(analog.data = g_try_malloc(sizeof(float) * samples)))
477 for (i = 0; i < samples; i++) {
478 s = (buf[i * 2] << 8) | buf[i * 2 + 1];
479 ((float *)analog.data)[i] = (s * devc->co_high + devc->co_low) / (1000 * 1000);
480 if (((float *)analog.data)[i] < 0.0)
481 ((float *)analog.data)[i] = 0.0;
483 sr_session_send(sdi, &packet);
487 /* How did we even get this far? */
490 devc->rcvd_samples += samples;
494 SR_PRIV int lascar_el_usb_handle_events(int fd, int revents, void *cb_data)
496 struct drv_context *drvc = di->context;
497 struct sr_dev_inst *sdi;
505 if (sdi->status == SR_ST_STOPPING) {
506 usb_source_remove(sdi->session, drvc->sr_ctx);
507 std_session_send_df_end(sdi);
510 memset(&tv, 0, sizeof(struct timeval));
511 libusb_handle_events_timeout_completed(drvc->sr_ctx->libusb_ctx, &tv,
517 SR_PRIV void LIBUSB_CALL lascar_el_usb_receive_transfer(struct libusb_transfer *transfer)
519 struct dev_context *devc;
520 struct sr_dev_inst *sdi;
522 gboolean packet_has_error;
524 sdi = transfer->user_data;
527 packet_has_error = FALSE;
528 switch (transfer->status) {
529 case LIBUSB_TRANSFER_NO_DEVICE:
530 /* USB device was unplugged. */
531 sr_dev_acquisition_stop(sdi);
533 case LIBUSB_TRANSFER_COMPLETED:
534 case LIBUSB_TRANSFER_TIMED_OUT: /* We may have received some data though */
537 packet_has_error = TRUE;
541 if (!packet_has_error) {
542 if (devc->rcvd_samples < devc->logged_samples)
543 lascar_el_usb_dispatch(sdi, transfer->buffer,
544 transfer->actual_length);
545 devc->rcvd_bytes += transfer->actual_length;
546 sr_spew("received %d/%d bytes (%d/%d samples)",
547 devc->rcvd_bytes, devc->log_size,
548 devc->rcvd_samples, devc->logged_samples);
549 if (devc->rcvd_bytes >= devc->log_size)
550 sr_dev_acquisition_stop(sdi);
553 if (sdi->status == SR_ST_ACTIVE) {
554 /* Send the same request again. */
555 if ((ret = libusb_submit_transfer(transfer) != 0)) {
556 sr_err("Unable to resubmit transfer: %s.",
557 libusb_error_name(ret));
558 g_free(transfer->buffer);
559 libusb_free_transfer(transfer);
560 sr_dev_acquisition_stop(sdi);
563 /* This was the last transfer we're going to receive, so
565 g_free(transfer->buffer);
566 libusb_free_transfer(transfer);
571 static int get_flags(unsigned char *configblock)
575 flags = (configblock[32] | (configblock[33] << 8)) & 0x1fff;
576 sr_spew("Read flags (0x%.4x).", flags);
581 static int set_flags(unsigned char *configblock, int flags)
584 sr_spew("Setting flags to 0x%.4x.", flags);
585 configblock[32] = flags & 0xff;
586 configblock[33] = (flags >> 8) & 0x1f;
591 SR_PRIV int lascar_is_logging(const struct sr_dev_inst *sdi)
593 struct dev_context *devc;
594 struct sr_usb_dev_inst *usb;
595 int dummy, flags, ret;
600 if (lascar_get_config(usb->devhdl, devc->config, &dummy) != SR_OK)
603 flags = get_flags(devc->config);
612 SR_PRIV int lascar_start_logging(const struct sr_dev_inst *sdi)
614 struct dev_context *devc;
615 struct sr_usb_dev_inst *usb;
621 if (lascar_get_config(usb->devhdl, devc->config, &len) != SR_OK)
624 /* Turn on logging. */
625 flags = get_flags(devc->config);
627 set_flags(devc->config, flags);
629 /* Start logging in 0 seconds. */
630 memset(devc->config + 24, 0, 4);
632 ret = lascar_save_config(usb->devhdl, devc->config, len);
633 sr_info("Started internal logging.");
638 SR_PRIV int lascar_stop_logging(const struct sr_dev_inst *sdi)
640 struct dev_context *devc;
641 struct sr_usb_dev_inst *usb;
647 if (lascar_get_config(usb->devhdl, devc->config, &len) != SR_OK)
650 flags = get_flags(devc->config);
652 set_flags(devc->config, flags);
654 ret = lascar_save_config(usb->devhdl, devc->config, len);
655 sr_info("Stopped internal logging.");