]> sigrok.org Git - libsigrok.git/blame_incremental - hardware/chronovu-la8/api.c
hw_dev_close(): Move common checks to wrapper.
[libsigrok.git] / hardware / chronovu-la8 / api.c
... / ...
CommitLineData
1/*
2 * This file is part of the sigrok project.
3 *
4 * Copyright (C) 2011-2012 Uwe Hermann <uwe@hermann-uwe.de>
5 *
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 2 of the License, or
9 * (at your option) any later version.
10 *
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.
15 *
16 * You should have received a copy of the GNU General Public License
17 * along with this program; if not, write to the Free Software
18 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
19 */
20
21#include <ftdi.h>
22#include <glib.h>
23#include <string.h>
24#include "libsigrok.h"
25#include "libsigrok-internal.h"
26#include "protocol.h"
27
28SR_PRIV struct sr_dev_driver chronovu_la8_driver_info;
29static struct sr_dev_driver *di = &chronovu_la8_driver_info;
30
31/*
32 * The ChronoVu LA8 can have multiple PIDs. Older versions shipped with
33 * a standard FTDI USB VID/PID of 0403:6001, newer ones have 0403:8867.
34 */
35static const uint16_t usb_pids[] = {
36 0x6001,
37 0x8867,
38};
39
40/* Function prototypes. */
41static int hw_dev_acquisition_stop(struct sr_dev_inst *sdi, void *cb_data);
42
43static int clear_instances(void)
44{
45 GSList *l;
46 struct sr_dev_inst *sdi;
47 struct drv_context *drvc;
48 struct dev_context *devc;
49
50 drvc = di->priv;
51
52 /* Properly close all devices. */
53 for (l = drvc->instances; l; l = l->next) {
54 if (!(sdi = l->data)) {
55 /* Log error, but continue cleaning up the rest. */
56 sr_err("%s: sdi was NULL, continuing.", __func__);
57 continue;
58 }
59 if (sdi->priv) {
60 devc = sdi->priv;
61 ftdi_free(devc->ftdic);
62 }
63 sr_dev_inst_free(sdi);
64 }
65 g_slist_free(drvc->instances);
66 drvc->instances = NULL;
67
68 return SR_OK;
69}
70
71static int hw_init(struct sr_context *sr_ctx)
72{
73 return std_hw_init(sr_ctx, di, DRIVER_LOG_DOMAIN);
74}
75
76static GSList *hw_scan(GSList *options)
77{
78 struct sr_dev_inst *sdi;
79 struct sr_probe *probe;
80 struct drv_context *drvc;
81 struct dev_context *devc;
82 GSList *devices;
83 unsigned int i;
84 int ret;
85
86 (void)options;
87
88 drvc = di->priv;
89
90 devices = NULL;
91
92 /* Allocate memory for our private device context. */
93 if (!(devc = g_try_malloc(sizeof(struct dev_context)))) {
94 sr_err("Device context malloc failed.");
95 goto err_free_nothing;
96 }
97
98 /* Set some sane defaults. */
99 devc->ftdic = NULL;
100 devc->cur_samplerate = SR_MHZ(100); /* 100MHz == max. samplerate */
101 devc->limit_msec = 0;
102 devc->limit_samples = 0;
103 devc->session_dev_id = NULL;
104 memset(devc->mangled_buf, 0, BS);
105 devc->final_buf = NULL;
106 devc->trigger_pattern = 0x00; /* Value irrelevant, see trigger_mask. */
107 devc->trigger_mask = 0x00; /* All probes are "don't care". */
108 devc->trigger_timeout = 10; /* Default to 10s trigger timeout. */
109 devc->trigger_found = 0;
110 devc->done = 0;
111 devc->block_counter = 0;
112 devc->divcount = 0; /* 10ns sample period == 100MHz samplerate */
113 devc->usb_pid = 0;
114
115 /* Allocate memory where we'll store the de-mangled data. */
116 if (!(devc->final_buf = g_try_malloc(SDRAM_SIZE))) {
117 sr_err("final_buf malloc failed.");
118 goto err_free_devc;
119 }
120
121 /* Allocate memory for the FTDI context (ftdic) and initialize it. */
122 if (!(devc->ftdic = ftdi_new())) {
123 sr_err("%s: ftdi_new failed.", __func__);
124 goto err_free_final_buf;
125 }
126
127 /* Check for the device and temporarily open it. */
128 for (i = 0; i < ARRAY_SIZE(usb_pids); i++) {
129 sr_dbg("Probing for VID/PID %04x:%04x.", USB_VENDOR_ID,
130 usb_pids[i]);
131 ret = ftdi_usb_open_desc(devc->ftdic, USB_VENDOR_ID,
132 usb_pids[i], USB_DESCRIPTION, NULL);
133 if (ret == 0) {
134 sr_dbg("Found LA8 device (%04x:%04x).",
135 USB_VENDOR_ID, usb_pids[i]);
136 devc->usb_pid = usb_pids[i];
137 }
138 }
139
140 if (devc->usb_pid == 0)
141 goto err_free_ftdic;
142
143 /* Register the device with libsigrok. */
144 sdi = sr_dev_inst_new(0, SR_ST_INITIALIZING,
145 USB_VENDOR_NAME, USB_MODEL_NAME, USB_MODEL_VERSION);
146 if (!sdi) {
147 sr_err("%s: sr_dev_inst_new failed.", __func__);
148 goto err_close_ftdic;
149 }
150 sdi->driver = di;
151 sdi->priv = devc;
152
153 for (i = 0; probe_names[i]; i++) {
154 if (!(probe = sr_probe_new(i, SR_PROBE_LOGIC, TRUE,
155 probe_names[i])))
156 return NULL;
157 sdi->probes = g_slist_append(sdi->probes, probe);
158 }
159
160 devices = g_slist_append(devices, sdi);
161 drvc->instances = g_slist_append(drvc->instances, sdi);
162
163 /* Close device. We'll reopen it again when we need it. */
164 (void) la8_close(devc); /* Log, but ignore errors. */
165
166 return devices;
167
168err_close_ftdic:
169 (void) la8_close(devc); /* Log, but ignore errors. */
170err_free_ftdic:
171 ftdi_free(devc->ftdic); /* NOT free() or g_free()! */
172err_free_final_buf:
173 g_free(devc->final_buf);
174err_free_devc:
175 g_free(devc);
176err_free_nothing:
177
178 return NULL;
179}
180
181static GSList *hw_dev_list(void)
182{
183 return ((struct drv_context *)(di->priv))->instances;
184}
185
186static int hw_dev_open(struct sr_dev_inst *sdi)
187{
188 struct dev_context *devc;
189 int ret;
190
191 if (!(devc = sdi->priv)) {
192 sr_err("%s: sdi->priv was NULL.", __func__);
193 return SR_ERR_BUG;
194 }
195
196 sr_dbg("Opening LA8 device (%04x:%04x).", USB_VENDOR_ID,
197 devc->usb_pid);
198
199 /* Open the device. */
200 if ((ret = ftdi_usb_open_desc(devc->ftdic, USB_VENDOR_ID,
201 devc->usb_pid, USB_DESCRIPTION, NULL)) < 0) {
202 sr_err("%s: ftdi_usb_open_desc: (%d) %s",
203 __func__, ret, ftdi_get_error_string(devc->ftdic));
204 (void) la8_close_usb_reset_sequencer(devc); /* Ignore errors. */
205 return SR_ERR;
206 }
207 sr_dbg("Device opened successfully.");
208
209 /* Purge RX/TX buffers in the FTDI chip. */
210 if ((ret = ftdi_usb_purge_buffers(devc->ftdic)) < 0) {
211 sr_err("%s: ftdi_usb_purge_buffers: (%d) %s",
212 __func__, ret, ftdi_get_error_string(devc->ftdic));
213 (void) la8_close_usb_reset_sequencer(devc); /* Ignore errors. */
214 goto err_dev_open_close_ftdic;
215 }
216 sr_dbg("FTDI buffers purged successfully.");
217
218 /* Enable flow control in the FTDI chip. */
219 if ((ret = ftdi_setflowctrl(devc->ftdic, SIO_RTS_CTS_HS)) < 0) {
220 sr_err("%s: ftdi_setflowcontrol: (%d) %s",
221 __func__, ret, ftdi_get_error_string(devc->ftdic));
222 (void) la8_close_usb_reset_sequencer(devc); /* Ignore errors. */
223 goto err_dev_open_close_ftdic;
224 }
225 sr_dbg("FTDI flow control enabled successfully.");
226
227 /* Wait 100ms. */
228 g_usleep(100 * 1000);
229
230 sdi->status = SR_ST_ACTIVE;
231
232 return SR_OK;
233
234err_dev_open_close_ftdic:
235 (void) la8_close(devc); /* Log, but ignore errors. */
236 return SR_ERR;
237}
238
239static int hw_dev_close(struct sr_dev_inst *sdi)
240{
241 struct dev_context *devc;
242
243 devc = sdi->priv;
244
245 if (sdi->status == SR_ST_ACTIVE) {
246 sr_dbg("Status ACTIVE, closing device.");
247 (void) la8_close_usb_reset_sequencer(devc); /* Ignore errors. */
248 } else {
249 sr_spew("Status not ACTIVE, nothing to do.");
250 }
251
252 sdi->status = SR_ST_INACTIVE;
253
254 g_free(devc->final_buf);
255
256 return SR_OK;
257}
258
259static int hw_cleanup(void)
260{
261 if (!di->priv)
262 /* Can get called on an unused driver, doesn't matter. */
263 return SR_OK;
264
265 clear_instances();
266
267 return SR_OK;
268}
269
270static int config_get(int id, const void **data, const struct sr_dev_inst *sdi)
271{
272 struct dev_context *devc;
273
274 switch (id) {
275 case SR_CONF_SAMPLERATE:
276 if (sdi) {
277 devc = sdi->priv;
278 *data = &devc->cur_samplerate;
279 sr_spew("%s: Returning samplerate: %" PRIu64 "Hz.",
280 __func__, devc->cur_samplerate);
281 } else
282 return SR_ERR;
283 break;
284 default:
285 return SR_ERR_ARG;
286 }
287
288 return SR_OK;
289}
290
291static int config_set(int id, const void *value, const struct sr_dev_inst *sdi)
292{
293 struct dev_context *devc;
294
295 if (!(devc = sdi->priv)) {
296 sr_err("%s: sdi->priv was NULL.", __func__);
297 return SR_ERR_BUG;
298 }
299
300 switch (id) {
301 case SR_CONF_SAMPLERATE:
302 if (set_samplerate(sdi, *(const uint64_t *)value) == SR_ERR) {
303 sr_err("%s: setting samplerate failed.", __func__);
304 return SR_ERR;
305 }
306 sr_dbg("SAMPLERATE = %" PRIu64, devc->cur_samplerate);
307 break;
308 case SR_CONF_LIMIT_MSEC:
309 if (*(const uint64_t *)value == 0) {
310 sr_err("%s: LIMIT_MSEC can't be 0.", __func__);
311 return SR_ERR;
312 }
313 devc->limit_msec = *(const uint64_t *)value;
314 sr_dbg("LIMIT_MSEC = %" PRIu64, devc->limit_msec);
315 break;
316 case SR_CONF_LIMIT_SAMPLES:
317 if (*(const uint64_t *)value < MIN_NUM_SAMPLES) {
318 sr_err("%s: LIMIT_SAMPLES too small.", __func__);
319 return SR_ERR;
320 }
321 devc->limit_samples = *(const uint64_t *)value;
322 sr_dbg("LIMIT_SAMPLES = %" PRIu64, devc->limit_samples);
323 break;
324 default:
325 /* Unknown capability, return SR_ERR. */
326 sr_err("%s: Unknown capability: %d.", __func__, id);
327 return SR_ERR;
328 break;
329 }
330
331 return SR_OK;
332}
333
334static int config_list(int key, const void **data, const struct sr_dev_inst *sdi)
335{
336
337 (void)sdi;
338
339 switch (key) {
340 case SR_CONF_DEVICE_OPTIONS:
341 *data = hwcaps;
342 break;
343 case SR_CONF_SAMPLERATE:
344 fill_supported_samplerates_if_needed();
345 *data = &samplerates;
346 break;
347 case SR_CONF_TRIGGER_TYPE:
348 *data = (char *)TRIGGER_TYPE;
349 break;
350 default:
351 return SR_ERR_ARG;
352 }
353
354 return SR_OK;
355}
356
357static int receive_data(int fd, int revents, void *cb_data)
358{
359 int i, ret;
360 struct sr_dev_inst *sdi;
361 struct dev_context *devc;
362
363 (void)fd;
364 (void)revents;
365
366 if (!(sdi = cb_data)) {
367 sr_err("%s: cb_data was NULL.", __func__);
368 return FALSE;
369 }
370
371 if (!(devc = sdi->priv)) {
372 sr_err("%s: sdi->priv was NULL.", __func__);
373 return FALSE;
374 }
375
376 if (!devc->ftdic) {
377 sr_err("%s: devc->ftdic was NULL.", __func__);
378 return FALSE;
379 }
380
381 /* Get one block of data. */
382 if ((ret = la8_read_block(devc)) < 0) {
383 sr_err("%s: la8_read_block error: %d.", __func__, ret);
384 hw_dev_acquisition_stop(sdi, sdi);
385 return FALSE;
386 }
387
388 /* We need to get exactly NUM_BLOCKS blocks (i.e. 8MB) of data. */
389 if (devc->block_counter != (NUM_BLOCKS - 1)) {
390 devc->block_counter++;
391 return TRUE;
392 }
393
394 sr_dbg("Sampling finished, sending data to session bus now.");
395
396 /* All data was received and demangled, send it to the session bus. */
397 for (i = 0; i < NUM_BLOCKS; i++)
398 send_block_to_session_bus(devc, i);
399
400 hw_dev_acquisition_stop(sdi, sdi);
401
402 return TRUE;
403}
404
405static int hw_dev_acquisition_start(const struct sr_dev_inst *sdi,
406 void *cb_data)
407{
408 struct dev_context *devc;
409 struct sr_datafeed_packet packet;
410 struct sr_datafeed_header header;
411 uint8_t buf[4];
412 int bytes_written;
413
414 if (!(devc = sdi->priv)) {
415 sr_err("%s: sdi->priv was NULL.", __func__);
416 return SR_ERR_BUG;
417 }
418
419 if (!devc->ftdic) {
420 sr_err("%s: devc->ftdic was NULL.", __func__);
421 return SR_ERR_BUG;
422 }
423
424 devc->divcount = samplerate_to_divcount(devc->cur_samplerate);
425 if (devc->divcount == 0xff) {
426 sr_err("%s: Invalid divcount/samplerate.", __func__);
427 return SR_ERR;
428 }
429
430 if (configure_probes(sdi) != SR_OK) {
431 sr_err("Failed to configure probes.");
432 return SR_ERR;
433 }
434
435 sr_dbg("Starting acquisition.");
436
437 /* Fill acquisition parameters into buf[]. */
438 buf[0] = devc->divcount;
439 buf[1] = 0xff; /* This byte must always be 0xff. */
440 buf[2] = devc->trigger_pattern;
441 buf[3] = devc->trigger_mask;
442
443 /* Start acquisition. */
444 bytes_written = la8_write(devc, buf, 4);
445
446 if (bytes_written < 0) {
447 sr_err("Acquisition failed to start: %d.", bytes_written);
448 return SR_ERR;
449 } else if (bytes_written != 4) {
450 sr_err("Acquisition failed to start: %d.", bytes_written);
451 return SR_ERR;
452 }
453
454 sr_dbg("Acquisition started successfully.");
455
456 devc->session_dev_id = cb_data;
457
458 /* Send header packet to the session bus. */
459 sr_dbg("Sending SR_DF_HEADER.");
460 packet.type = SR_DF_HEADER;
461 packet.payload = &header;
462 header.feed_version = 1;
463 gettimeofday(&header.starttime, NULL);
464 sr_session_send(devc->session_dev_id, &packet);
465
466 /* Time when we should be done (for detecting trigger timeouts). */
467 devc->done = (devc->divcount + 1) * 0.08388608 + time(NULL)
468 + devc->trigger_timeout;
469 devc->block_counter = 0;
470 devc->trigger_found = 0;
471
472 /* Hook up a dummy handler to receive data from the LA8. */
473 sr_source_add(-1, G_IO_IN, 0, receive_data, (void *)sdi);
474
475 return SR_OK;
476}
477
478static int hw_dev_acquisition_stop(struct sr_dev_inst *sdi, void *cb_data)
479{
480 struct sr_datafeed_packet packet;
481
482 (void)sdi;
483
484 sr_dbg("Stopping acquisition.");
485 sr_source_remove(-1);
486
487 /* Send end packet to the session bus. */
488 sr_dbg("Sending SR_DF_END.");
489 packet.type = SR_DF_END;
490 sr_session_send(cb_data, &packet);
491
492 return SR_OK;
493}
494
495SR_PRIV struct sr_dev_driver chronovu_la8_driver_info = {
496 .name = "chronovu-la8",
497 .longname = "ChronoVu LA8",
498 .api_version = 1,
499 .init = hw_init,
500 .cleanup = hw_cleanup,
501 .scan = hw_scan,
502 .dev_list = hw_dev_list,
503 .dev_clear = clear_instances,
504 .config_get = config_get,
505 .config_set = config_set,
506 .config_list = config_list,
507 .dev_open = hw_dev_open,
508 .dev_close = hw_dev_close,
509 .dev_acquisition_start = hw_dev_acquisition_start,
510 .dev_acquisition_stop = hw_dev_acquisition_stop,
511 .priv = NULL,
512};