]> sigrok.org Git - libsigrok.git/blob - src/hardware/lecroy-xstream/api.c
drivers: Factor out std_*_idx*().
[libsigrok.git] / src / hardware / lecroy-xstream / api.c
1 /*
2  * This file is part of the libsigrok project.
3  *
4  * Copyright (C) 2017 Sven Schnelle <svens@stackframe.org>
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 3 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, see <http://www.gnu.org/licenses/>.
18  */
19
20 #include <config.h>
21 #include <stdlib.h>
22 #include "scpi.h"
23 #include "protocol.h"
24
25 static struct sr_dev_driver lecroy_xstream_driver_info;
26
27 static const char *manufacturers[] = {
28         "LECROY",
29 };
30
31 static const uint32_t scanopts[] = {
32         SR_CONF_CONN,
33 };
34
35 static const uint32_t drvopts[] = {
36         SR_CONF_OSCILLOSCOPE,
37 };
38
39 static const uint32_t devopts[] = {
40         SR_CONF_LIMIT_FRAMES | SR_CONF_GET | SR_CONF_SET,
41         SR_CONF_SAMPLERATE | SR_CONF_GET,
42         SR_CONF_TIMEBASE | SR_CONF_GET | SR_CONF_SET | SR_CONF_LIST,
43         SR_CONF_NUM_HDIV | SR_CONF_GET,
44         SR_CONF_HORIZ_TRIGGERPOS | SR_CONF_GET | SR_CONF_SET,
45         SR_CONF_TRIGGER_SOURCE | SR_CONF_GET | SR_CONF_SET | SR_CONF_LIST,
46         SR_CONF_TRIGGER_SLOPE | SR_CONF_GET | SR_CONF_SET | SR_CONF_LIST,
47 };
48
49 static const uint32_t devopts_cg_analog[] = {
50         SR_CONF_NUM_VDIV | SR_CONF_GET,
51         SR_CONF_VDIV | SR_CONF_GET | SR_CONF_SET | SR_CONF_LIST,
52         SR_CONF_COUPLING | SR_CONF_GET | SR_CONF_SET | SR_CONF_LIST,
53 };
54
55 static struct sr_dev_inst *probe_serial_device(struct sr_scpi_dev_inst *scpi)
56 {
57         struct sr_dev_inst *sdi;
58         struct dev_context *devc;
59         struct sr_scpi_hw_info *hw_info;
60
61         sdi = NULL;
62         devc = NULL;
63         hw_info = NULL;
64
65         if (sr_scpi_get_hw_id(scpi, &hw_info) != SR_OK) {
66                 sr_info("Couldn't get IDN response.");
67                 goto fail;
68         }
69
70         if (std_str_idx_s(hw_info->manufacturer, ARRAY_AND_SIZE(manufacturers)) < 0)
71                 goto fail;
72
73         sdi = g_malloc0(sizeof(struct sr_dev_inst));
74         sdi->vendor = g_strdup(hw_info->manufacturer);
75         sdi->model = g_strdup(hw_info->model);
76         sdi->version = g_strdup(hw_info->firmware_version);
77         sdi->serial_num = g_strdup(hw_info->serial_number);
78         sdi->driver = &lecroy_xstream_driver_info;
79         sdi->inst_type = SR_INST_SCPI;
80         sdi->conn = scpi;
81
82         sr_scpi_hw_info_free(hw_info);
83         hw_info = NULL;
84
85         devc = g_malloc0(sizeof(struct dev_context));
86
87         sdi->priv = devc;
88
89         if (lecroy_xstream_init_device(sdi) != SR_OK)
90                 goto fail;
91
92         return sdi;
93
94 fail:
95         sr_scpi_hw_info_free(hw_info);
96         sr_dev_inst_free(sdi);
97         g_free(devc);
98
99         return NULL;
100 }
101
102 static GSList *scan(struct sr_dev_driver *di, GSList *options)
103 {
104         return sr_scpi_scan(di->context, options, probe_serial_device);
105 }
106
107 static void clear_helper(struct dev_context *devc)
108 {
109         lecroy_xstream_state_free(devc->model_state);
110         g_free(devc->analog_groups);
111 }
112
113 static int dev_clear(const struct sr_dev_driver *di)
114 {
115         return std_dev_clear_with_callback(di, (std_dev_clear_callback)clear_helper);
116 }
117
118 static int dev_open(struct sr_dev_inst *sdi)
119 {
120         if (sr_scpi_open(sdi->conn) != SR_OK)
121                 return SR_ERR;
122
123         if (lecroy_xstream_state_get(sdi) != SR_OK)
124                 return SR_ERR;
125
126         return SR_OK;
127 }
128
129 static int dev_close(struct sr_dev_inst *sdi)
130 {
131         return sr_scpi_close(sdi->conn);
132 }
133
134 static int config_get(uint32_t key, GVariant **data,
135         const struct sr_dev_inst *sdi, const struct sr_channel_group *cg)
136 {
137         unsigned int i;
138         struct dev_context *devc;
139         const struct scope_config *model;
140         struct scope_state *state;
141
142         if (!sdi)
143                 return SR_ERR_ARG;
144
145         devc = sdi->priv;
146
147         model = devc->model_config;
148         state = devc->model_state;
149         *data = NULL;
150
151         switch (key) {
152         case SR_CONF_NUM_HDIV:
153                 *data = g_variant_new_int32(model->num_xdivs);
154                 break;
155         case SR_CONF_TIMEBASE:
156                 *data = g_variant_new("(tt)",
157                                 model->timebases[state->timebase].p,
158                                 model->timebases[state->timebase].q);
159                 break;
160         case SR_CONF_NUM_VDIV:
161                 for (i = 0; i < model->analog_channels; i++) {
162                         if (cg != devc->analog_groups[i])
163                                 continue;
164                         *data = g_variant_new_int32(model->num_ydivs);
165                 }
166                 break;
167         case SR_CONF_VDIV:
168                 for (i = 0; i < model->analog_channels; i++) {
169                         if (cg != devc->analog_groups[i])
170                                 continue;
171                         *data = g_variant_new("(tt)",
172                                 model->vdivs[state->analog_channels[i].vdiv].p,
173                                 model->vdivs[state->analog_channels[i].vdiv].q);
174                 }
175                 break;
176         case SR_CONF_TRIGGER_SOURCE:
177                 *data = g_variant_new_string((*model->trigger_sources)[state->trigger_source]);
178                 break;
179         case SR_CONF_TRIGGER_SLOPE:
180                 *data = g_variant_new_string((*model->trigger_slopes)[state->trigger_slope]);
181                 break;
182         case SR_CONF_HORIZ_TRIGGERPOS:
183                 *data = g_variant_new_double(state->horiz_triggerpos);
184                 break;
185         case SR_CONF_COUPLING:
186                 for (i = 0; i < model->analog_channels; i++) {
187                         if (cg != devc->analog_groups[i])
188                                 continue;
189                         *data = g_variant_new_string((*model->coupling_options)[state->analog_channels[i].coupling]);
190                 }
191                 break;
192         case SR_CONF_SAMPLERATE:
193                 *data = g_variant_new_uint64(state->sample_rate);
194                 break;
195         case SR_CONF_ENABLED:
196                 *data = g_variant_new_boolean(FALSE);
197                 break;
198         default:
199                 return SR_ERR_NA;
200         }
201
202         return SR_OK;
203 }
204
205 static int config_set(uint32_t key, GVariant *data,
206         const struct sr_dev_inst *sdi, const struct sr_channel_group *cg)
207 {
208         int ret;
209         unsigned int i, j;
210         char command[MAX_COMMAND_SIZE];
211         struct dev_context *devc;
212         const struct scope_config *model;
213         struct scope_state *state;
214         const char *tmp;
215         int64_t p;
216         uint64_t q;
217         double tmp_d;
218         gboolean update_sample_rate;
219
220         if (!sdi)
221                 return SR_ERR_ARG;
222
223         devc = sdi->priv;
224
225         model = devc->model_config;
226         state = devc->model_state;
227         update_sample_rate = FALSE;
228
229         ret = SR_ERR_NA;
230
231         switch (key) {
232         case SR_CONF_LIMIT_FRAMES:
233                 devc->frame_limit = g_variant_get_uint64(data);
234                 ret = SR_OK;
235                 break;
236         case SR_CONF_TRIGGER_SOURCE:
237                 tmp = g_variant_get_string(data, NULL);
238                 for (i = 0; (*model->trigger_sources)[i]; i++) {
239                         if (g_strcmp0(tmp, (*model->trigger_sources)[i]) != 0)
240                                 continue;
241                         state->trigger_source = i;
242                         g_snprintf(command, sizeof(command),
243                                         "SET TRIGGER SOURCE %s",
244                                         (*model->trigger_sources)[i]);
245
246                         ret = sr_scpi_send(sdi->conn, command);
247                         break;
248                 }
249                 break;
250         case SR_CONF_VDIV:
251                 g_variant_get(data, "(tt)", &p, &q);
252
253                 for (i = 0; i < model->num_vdivs; i++) {
254                         if (p != model->vdivs[i].p || q != model->vdivs[i].q)
255                                 continue;
256                         for (j = 1; j <= model->analog_channels; j++) {
257                                 if (cg != devc->analog_groups[j - 1])
258                                         continue;
259                                 state->analog_channels[j - 1].vdiv = i;
260                                 g_snprintf(command, sizeof(command),
261                                                 "C%d:VDIV %E", j, (float)p/q);
262
263                                 if (sr_scpi_send(sdi->conn, command) != SR_OK ||
264                                     sr_scpi_get_opc(sdi->conn) != SR_OK)
265                                         return SR_ERR;
266
267                                 break;
268                         }
269
270                         ret = SR_OK;
271                         break;
272                 }
273                 break;
274         case SR_CONF_TIMEBASE:
275                 g_variant_get(data, "(tt)", &p, &q);
276
277                 for (i = 0; i < model->num_timebases; i++) {
278                         if (p != model->timebases[i].p ||
279                             q != model->timebases[i].q)
280                                 continue;
281                         state->timebase = i;
282                         g_snprintf(command, sizeof(command),
283                                         "TIME_DIV %E", (float)p/q);
284
285                         ret = sr_scpi_send(sdi->conn, command);
286                         update_sample_rate = TRUE;
287                         break;
288                 }
289                 break;
290         case SR_CONF_HORIZ_TRIGGERPOS:
291                 tmp_d = g_variant_get_double(data);
292
293                 if (tmp_d < 0.0 || tmp_d > 1.0)
294                         return SR_ERR;
295
296                 state->horiz_triggerpos = tmp_d;
297                 tmp_d = -(tmp_d - 0.5) *
298                         ((double)model->timebases[state->timebase].p /
299                          model->timebases[state->timebase].q)
300                          * model->num_xdivs;
301
302                 g_snprintf(command, sizeof(command), "TRIG POS %e S", tmp_d);
303
304                 ret = sr_scpi_send(sdi->conn, command);
305                 break;
306         case SR_CONF_TRIGGER_SLOPE:
307                 tmp = g_variant_get_string(data, NULL);
308                 for (i = 0; (*model->trigger_slopes)[i]; i++) {
309                         if (g_strcmp0(tmp, (*model->trigger_slopes)[i]) != 0)
310                                 continue;
311                         state->trigger_slope = i;
312                         g_snprintf(command, sizeof(command),
313                                         "SET TRIGGER SLOPE %s",
314                                         (*model->trigger_slopes)[i]);
315
316                         ret = sr_scpi_send(sdi->conn, command);
317                         break;
318                 }
319                 break;
320         case SR_CONF_COUPLING:
321                 tmp = g_variant_get_string(data, NULL);
322
323                 for (i = 0; (*model->coupling_options)[i]; i++) {
324                         if (strcmp(tmp, (*model->coupling_options)[i]) != 0)
325                                 continue;
326                         for (j = 1; j <= model->analog_channels; j++) {
327                                 if (cg != devc->analog_groups[j - 1])
328                                         continue;
329                                 state->analog_channels[j - 1].coupling = i;
330
331                                 g_snprintf(command, sizeof(command),
332                                                 "C%d:COUPLING %s", j, tmp);
333
334                                 if (sr_scpi_send(sdi->conn, command) != SR_OK ||
335                                     sr_scpi_get_opc(sdi->conn) != SR_OK)
336                                         return SR_ERR;
337                                 break;
338                         }
339
340                         ret = SR_OK;
341                         break;
342                 }
343                 break;
344         default:
345                 ret = SR_ERR_NA;
346                 break;
347         }
348
349         if (ret == SR_OK)
350                 ret = sr_scpi_get_opc(sdi->conn);
351
352         if (ret == SR_OK && update_sample_rate)
353                 ret = lecroy_xstream_update_sample_rate(sdi);
354
355         return ret;
356 }
357
358 static int config_list(uint32_t key, GVariant **data,
359         const struct sr_dev_inst *sdi, const struct sr_channel_group *cg)
360 {
361         struct dev_context *devc;
362         const struct scope_config *model;
363
364         devc = (sdi) ? sdi->priv : NULL;
365         model = (devc) ? devc->model_config : NULL;
366
367         switch (key) {
368         case SR_CONF_SCAN_OPTIONS:
369                 return STD_CONFIG_LIST(key, data, sdi, cg, scanopts, NULL, NULL);
370         case SR_CONF_DEVICE_OPTIONS:
371                 if (!cg)
372                         return STD_CONFIG_LIST(key, data, sdi, cg, NULL, drvopts, devopts);
373                 *data = std_gvar_array_u32(ARRAY_AND_SIZE(devopts_cg_analog));
374                 break;
375         case SR_CONF_COUPLING:
376                 *data = g_variant_new_strv(*model->coupling_options,
377                            g_strv_length((char **)*model->coupling_options));
378                 break;
379         case SR_CONF_TRIGGER_SOURCE:
380                 if (!model)
381                         return SR_ERR_ARG;
382                 *data = g_variant_new_strv(*model->trigger_sources,
383                            g_strv_length((char **)*model->trigger_sources));
384                 break;
385         case SR_CONF_TRIGGER_SLOPE:
386                 if (!model)
387                         return SR_ERR_ARG;
388                 *data = g_variant_new_strv(*model->trigger_slopes,
389                            g_strv_length((char **)*model->trigger_slopes));
390                 break;
391         case SR_CONF_TIMEBASE:
392                 if (!model)
393                         return SR_ERR_ARG;
394                 *data = std_gvar_tuple_rational(model->timebases, model->num_timebases);
395                 break;
396         case SR_CONF_VDIV:
397                 if (!model)
398                         return SR_ERR_ARG;
399                 *data = std_gvar_tuple_rational(model->vdivs, model->num_vdivs);
400                 break;
401         default:
402                 return SR_ERR_NA;
403         }
404         return SR_OK;
405 }
406
407 SR_PRIV int lecroy_xstream_request_data(const struct sr_dev_inst *sdi)
408 {
409         char command[MAX_COMMAND_SIZE];
410         struct sr_channel *ch;
411         struct dev_context *devc;
412
413         devc = sdi->priv;
414
415         ch = devc->current_channel->data;
416
417         if (ch->type != SR_CHANNEL_ANALOG)
418                 return SR_ERR;
419
420         g_snprintf(command, sizeof(command),
421                 "COMM_FORMAT DEF9,WORD,BIN;C%d:WAVEFORM?", ch->index + 1);
422         return sr_scpi_send(sdi->conn, command);
423 }
424
425 static int setup_channels(const struct sr_dev_inst *sdi)
426 {
427         GSList *l;
428         gboolean setup_changed;
429         char command[MAX_COMMAND_SIZE];
430         struct scope_state *state;
431         struct sr_channel *ch;
432         struct dev_context *devc;
433         struct sr_scpi_dev_inst *scpi;
434
435         devc = sdi->priv;
436         scpi = sdi->conn;
437         state = devc->model_state;
438         setup_changed = FALSE;
439
440         for (l = sdi->channels; l; l = l->next) {
441                 ch = l->data;
442                 switch (ch->type) {
443                 case SR_CHANNEL_ANALOG:
444                         if (ch->enabled == state->analog_channels[ch->index].state)
445                                 break;
446                         g_snprintf(command, sizeof(command), "C%d:TRACE %s",
447                                    ch->index + 1, ch->enabled ? "ON" : "OFF");
448
449                         if (sr_scpi_send(scpi, command) != SR_OK)
450                                 return SR_ERR;
451                         state->analog_channels[ch->index].state = ch->enabled;
452                         setup_changed = TRUE;
453                         break;
454                 default:
455                         return SR_ERR;
456                 }
457         }
458
459         if (setup_changed && lecroy_xstream_update_sample_rate(sdi) != SR_OK)
460                 return SR_ERR;
461
462         return SR_OK;
463 }
464
465 static int dev_acquisition_start(const struct sr_dev_inst *sdi)
466 {
467         GSList *l;
468         struct sr_channel *ch;
469         struct dev_context *devc;
470         int ret;
471         struct sr_scpi_dev_inst *scpi;
472
473         devc = sdi->priv;
474         scpi = sdi->conn;
475
476         /* Preset empty results. */
477         g_slist_free(devc->enabled_channels);
478         devc->enabled_channels = NULL;
479
480         /*
481          * Contruct the list of enabled channels. Determine the highest
482          * number of digital pods involved in the acquisition.
483          */
484
485         for (l = sdi->channels; l; l = l->next) {
486                 ch = l->data;
487                 if (!ch->enabled)
488                         continue;
489                 /* Only add a single digital channel per group (pod). */
490                 devc->enabled_channels = g_slist_append(
491                         devc->enabled_channels, ch);
492         }
493
494         if (!devc->enabled_channels)
495                 return SR_ERR;
496
497         /*
498          * Configure the analog channels and the
499          * corresponding digital pods.
500          */
501         if (setup_channels(sdi) != SR_OK) {
502                 sr_err("Failed to setup channel configuration!");
503                 ret = SR_ERR;
504                 goto free_enabled;
505         }
506
507         /*
508          * Start acquisition on the first enabled channel. The
509          * receive routine will continue driving the acquisition.
510          */
511         sr_scpi_source_add(sdi->session, scpi, G_IO_IN, 50,
512                         lecroy_xstream_receive_data, (void *)sdi);
513
514         std_session_send_df_header(sdi);
515
516         devc->current_channel = devc->enabled_channels;
517
518         return lecroy_xstream_request_data(sdi);
519
520 free_enabled:
521         g_slist_free(devc->enabled_channels);
522         devc->enabled_channels = NULL;
523
524         return ret;
525 }
526
527 static int dev_acquisition_stop(struct sr_dev_inst *sdi)
528 {
529         struct dev_context *devc;
530         struct sr_scpi_dev_inst *scpi;
531
532         std_session_send_df_end(sdi);
533
534         devc = sdi->priv;
535
536         devc->num_frames = 0;
537         g_slist_free(devc->enabled_channels);
538         devc->enabled_channels = NULL;
539         scpi = sdi->conn;
540         sr_scpi_source_remove(sdi->session, scpi);
541
542         return SR_OK;
543 }
544
545 static struct sr_dev_driver lecroy_xstream_driver_info = {
546         .name = "lecroy-xstream",
547         .longname = "LeCroy X-Stream",
548         .api_version = 1,
549         .init = std_init,
550         .cleanup = std_cleanup,
551         .scan = scan,
552         .dev_list = std_dev_list,
553         .dev_clear = dev_clear,
554         .config_get = config_get,
555         .config_set = config_set,
556         .config_list = config_list,
557         .dev_open = dev_open,
558         .dev_close = dev_close,
559         .dev_acquisition_start = dev_acquisition_start,
560         .dev_acquisition_stop = dev_acquisition_stop,
561         .context = NULL,
562 };
563 SR_REGISTER_DEV_DRIVER(lecroy_xstream_driver_info);