]> sigrok.org Git - libsigrok.git/blame_incremental - src/hardware/agilent-dmm/sched.c
projects / libsigrok.git / blame_incremental
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (non-incremental) | history | HEAD
agilent-dmm: output correct number of digits in analog packets
[libsigrok.git] / src / hardware / agilent-dmm / sched.c
... / ...
CommitLineData
1/*
2 * This file is part of the libsigrok project.
3 *
4 * Copyright (C) 2012 Bert Vermeulen <bert@biot.com>
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 <glib.h>
22#include <stdlib.h>
23#include <string.h>
24#include <math.h>
25#include <libsigrok/libsigrok.h>
26#include "libsigrok-internal.h"
27#include "agilent-dmm.h"
28
29static void dispatch(const struct sr_dev_inst *sdi)
30{
31 struct dev_context *devc;
32 const struct agdmm_job *jobs;
33 int64_t now;
34 int i;
35
36 devc = sdi->priv;
37 jobs = devc->profile->jobs;
38 now = g_get_monotonic_time() / 1000;
39 for (i = 0; (&jobs[i])->interval; i++) {
40 if (now - devc->jobqueue[i] > (&jobs[i])->interval) {
41 sr_spew("Running job %d.", i);
42 (&jobs[i])->send(sdi);
43 devc->jobqueue[i] = now;
44 }
45 }
46}
47
48static void receive_line(const struct sr_dev_inst *sdi)
49{
50 struct dev_context *devc;
51 const struct agdmm_recv *recvs, *recv;
52 GRegex *reg;
53 GMatchInfo *match;
54 int i;
55
56 devc = sdi->priv;
57
58 /* Strip CRLF */
59 while (devc->buflen) {
60 if (*(devc->buf + devc->buflen - 1) == '\r'
61 || *(devc->buf + devc->buflen - 1) == '\n')
62 *(devc->buf + --devc->buflen) = '\0';
63 else
64 break;
65 }
66 sr_spew("Received '%s'.", devc->buf);
67
68 recv = NULL;
69 recvs = devc->profile->recvs;
70 for (i = 0; (&recvs[i])->recv_regex; i++) {
71 reg = g_regex_new((&recvs[i])->recv_regex, 0, 0, NULL);
72 if (g_regex_match(reg, (char *)devc->buf, 0, &match)) {
73 recv = &recvs[i];
74 break;
75 }
76 g_match_info_unref(match);
77 g_regex_unref(reg);
78 }
79 if (recv) {
80 recv->recv(sdi, match);
81 g_match_info_unref(match);
82 g_regex_unref(reg);
83 } else
84 sr_dbg("Unknown line '%s'.", devc->buf);
85
86 /* Done with this. */
87 devc->buflen = 0;
88}
89
90SR_PRIV int agdmm_receive_data(int fd, int revents, void *cb_data)
91{
92 struct sr_dev_inst *sdi;
93 struct dev_context *devc;
94 struct sr_serial_dev_inst *serial;
95 int len;
96
97 (void)fd;
98
99 if (!(sdi = cb_data))
100 return TRUE;
101
102 if (!(devc = sdi->priv))
103 return TRUE;
104
105 serial = sdi->conn;
106 if (revents == G_IO_IN) {
107 /* Serial data arrived. */
108 while (AGDMM_BUFSIZE - devc->buflen - 1 > 0) {
109 len = serial_read_nonblocking(serial, devc->buf + devc->buflen, 1);
110 if (len < 1)
111 break;
112 devc->buflen += len;
113 *(devc->buf + devc->buflen) = '\0';
114 if (*(devc->buf + devc->buflen - 1) == '\n') {
115 /* End of line */
116 receive_line(sdi);
117 break;
118 }
119 }
120 }
121
122 dispatch(sdi);
123
124 if (sr_sw_limits_check(&devc->limits))
125 sdi->driver->dev_acquisition_stop(sdi);
126
127 return TRUE;
128}
129
130static int agdmm_send(const struct sr_dev_inst *sdi, const char *cmd)
131{
132 struct sr_serial_dev_inst *serial;
133 char buf[32];
134
135 serial = sdi->conn;
136
137 sr_spew("Sending '%s'.", cmd);
138 strncpy(buf, cmd, 28);
139 if (!strncmp(buf, "*IDN?", 5))
140 strcat(buf, "\r\n");
141 else
142 strcat(buf, "\n\r\n");
143 if (serial_write_blocking(serial, buf, strlen(buf), SERIAL_WRITE_TIMEOUT_MS) < (int)strlen(buf)) {
144 sr_err("Failed to send.");
145 return SR_ERR;
146 }
147
148 return SR_OK;
149}
150
151static int send_stat(const struct sr_dev_inst *sdi)
152{
153 return agdmm_send(sdi, "STAT?");
154}
155
156static int recv_stat_u123x(const struct sr_dev_inst *sdi, GMatchInfo *match)
157{
158 struct dev_context *devc;
159 char *s;
160
161 devc = sdi->priv;
162 s = g_match_info_fetch(match, 1);
163 sr_spew("STAT response '%s'.", s);
164
165 /* Max, Min or Avg mode -- no way to tell which, so we'll
166 * set both flags to denote it's not a normal measurement. */
167 if (s[0] == '1')
168 devc->cur_mqflags |= SR_MQFLAG_MAX | SR_MQFLAG_MIN;
169 else
170 devc->cur_mqflags &= ~(SR_MQFLAG_MAX | SR_MQFLAG_MIN);
171
172 if (s[1] == '1')
173 devc->cur_mqflags |= SR_MQFLAG_RELATIVE;
174 else
175 devc->cur_mqflags &= ~SR_MQFLAG_RELATIVE;
176
177 /* Triggered or auto hold modes. */
178 if (s[2] == '1' || s[3] == '1')
179 devc->cur_mqflags |= SR_MQFLAG_HOLD;
180 else
181 devc->cur_mqflags &= ~SR_MQFLAG_HOLD;
182
183 /* Temp/aux mode. */
184 if (s[7] == '1')
185 devc->mode_tempaux = TRUE;
186 else
187 devc->mode_tempaux = FALSE;
188
189 /* Continuity mode. */
190 if (s[16] == '1')
191 devc->mode_continuity = TRUE;
192 else
193 devc->mode_continuity = FALSE;
194
195 g_free(s);
196
197 return SR_OK;
198}
199
200static int recv_stat_u124x(const struct sr_dev_inst *sdi, GMatchInfo *match)
201{
202 struct dev_context *devc;
203 char *s;
204
205 devc = sdi->priv;
206 s = g_match_info_fetch(match, 1);
207 sr_spew("STAT response '%s'.", s);
208
209 /* Max, Min or Avg mode -- no way to tell which, so we'll
210 * set both flags to denote it's not a normal measurement. */
211 if (s[0] == '1')
212 devc->cur_mqflags |= SR_MQFLAG_MAX | SR_MQFLAG_MIN;
213 else
214 devc->cur_mqflags &= ~(SR_MQFLAG_MAX | SR_MQFLAG_MIN);
215
216 if (s[1] == '1')
217 devc->cur_mqflags |= SR_MQFLAG_RELATIVE;
218 else
219 devc->cur_mqflags &= ~SR_MQFLAG_RELATIVE;
220
221 /* Hold mode. */
222 if (s[7] == '1')
223 devc->cur_mqflags |= SR_MQFLAG_HOLD;
224 else
225 devc->cur_mqflags &= ~SR_MQFLAG_HOLD;
226
227 g_free(s);
228
229 return SR_OK;
230}
231
232static int recv_stat_u125x(const struct sr_dev_inst *sdi, GMatchInfo *match)
233{
234 struct dev_context *devc;
235 char *s;
236
237 devc = sdi->priv;
238 s = g_match_info_fetch(match, 1);
239 sr_spew("STAT response '%s'.", s);
240
241 /* Peak hold mode. */
242 if (s[4] == '1')
243 devc->cur_mqflags |= SR_MQFLAG_MAX;
244 else
245 devc->cur_mqflags &= ~SR_MQFLAG_MAX;
246
247 /* Triggered hold mode. */
248 if (s[7] == '1')
249 devc->cur_mqflags |= SR_MQFLAG_HOLD;
250 else
251 devc->cur_mqflags &= ~SR_MQFLAG_HOLD;
252
253 g_free(s);
254
255 return SR_OK;
256}
257
258static int send_fetc(const struct sr_dev_inst *sdi)
259{
260 return agdmm_send(sdi, "FETC?");
261}
262
263static int recv_fetc(const struct sr_dev_inst *sdi, GMatchInfo *match)
264{
265 struct dev_context *devc;
266 struct sr_datafeed_packet packet;
267 struct sr_datafeed_analog analog;
268 struct sr_analog_encoding encoding;
269 struct sr_analog_meaning meaning;
270 struct sr_analog_spec spec;
271 float fvalue;
272 const char *s;
273 char *mstr;
274
275 sr_spew("FETC reply '%s'.", g_match_info_get_string(match));
276 devc = sdi->priv;
277
278 if (devc->cur_mq == -1)
279 /* Haven't seen configuration yet, so can't know what
280 * the fetched float means. Not really an error, we'll
281 * get metadata soon enough. */
282 return SR_OK;
283
284 s = g_match_info_get_string(match);
285 if (!strcmp(s, "-9.90000000E+37") || !strcmp(s, "+9.90000000E+37")) {
286 /* An invalid measurement shows up on the display as "O.L", but
287 * comes through like this. Since comparing 38-digit floats
288 * is rather problematic, we'll cut through this here. */
289 fvalue = NAN;
290 } else {
291 mstr = g_match_info_fetch(match, 1);
292 if (sr_atof_ascii(mstr, &fvalue) != SR_OK) {
293 g_free(mstr);
294 sr_dbg("Invalid float.");
295 return SR_ERR;
296 }
297 g_free(mstr);
298 if (devc->cur_exponent != 0)
299 fvalue *= powf(10, devc->cur_exponent);
300 }
301
302 sr_analog_init(&analog, &encoding, &meaning, &spec,
303 devc->cur_digits - devc->cur_exponent);
304 analog.meaning->mq = devc->cur_mq;
305 analog.meaning->unit = devc->cur_unit;
306 analog.meaning->mqflags = devc->cur_mqflags;
307 analog.meaning->channels = sdi->channels;
308 analog.num_samples = 1;
309 analog.data = &fvalue;
310 encoding.digits = devc->cur_encoding - devc->cur_exponent;
311 packet.type = SR_DF_ANALOG;
312 packet.payload = &analog;
313 sr_session_send(sdi, &packet);
314
315 sr_sw_limits_update_samples_read(&devc->limits, 1);
316
317 return SR_OK;
318}
319
320static int send_conf(const struct sr_dev_inst *sdi)
321{
322 return agdmm_send(sdi, "CONF?");
323}
324
325static int recv_conf_u123x(const struct sr_dev_inst *sdi, GMatchInfo *match)
326{
327 struct dev_context *devc;
328 char *mstr, *rstr;
329 int resolution;
330
331 sr_spew("CONF? response '%s'.", g_match_info_get_string(match));
332 devc = sdi->priv;
333
334 rstr = g_match_info_fetch(match, 2);
335 if (rstr)
336 sr_atoi(rstr, &resolution);
337 g_free(rstr);
338
339 mstr = g_match_info_fetch(match, 1);
340 if (!strcmp(mstr, "V")) {
341 devc->cur_mq = SR_MQ_VOLTAGE;
342 devc->cur_unit = SR_UNIT_VOLT;
343 devc->cur_mqflags = 0;
344 devc->cur_exponent = 0;
345 devc->cur_digits = 4 - resolution;
346 } else if (!strcmp(mstr, "MV")) {
347 if (devc->mode_tempaux) {
348 devc->cur_mq = SR_MQ_TEMPERATURE;
349 /* No way to detect whether Fahrenheit or Celsius
350 * is used, so we'll just default to Celsius. */
351 devc->cur_unit = SR_UNIT_CELSIUS;
352 devc->cur_mqflags = 0;
353 devc->cur_exponent = 0;
354 devc->cur_digits = 1;
355 } else {
356 devc->cur_mq = SR_MQ_VOLTAGE;
357 devc->cur_unit = SR_UNIT_VOLT;
358 devc->cur_mqflags = 0;
359 devc->cur_exponent = -3;
360 devc->cur_digits = 5 - resolution;
361 }
362 } else if (!strcmp(mstr, "A")) {
363 devc->cur_mq = SR_MQ_CURRENT;
364 devc->cur_unit = SR_UNIT_AMPERE;
365 devc->cur_mqflags = 0;
366 devc->cur_exponent = 0;
367 devc->cur_digits = 3 - resolution;
368 } else if (!strcmp(mstr, "UA")) {
369 devc->cur_mq = SR_MQ_CURRENT;
370 devc->cur_unit = SR_UNIT_AMPERE;
371 devc->cur_mqflags = 0;
372 devc->cur_exponent = -6;
373 devc->cur_digits = 8 - resolution;
374 } else if (!strcmp(mstr, "FREQ")) {
375 devc->cur_mq = SR_MQ_FREQUENCY;
376 devc->cur_unit = SR_UNIT_HERTZ;
377 devc->cur_mqflags = 0;
378 devc->cur_exponent = 0;
379 devc->cur_digits = 2 - resolution;
380 } else if (!strcmp(mstr, "RES")) {
381 if (devc->mode_continuity) {
382 devc->cur_mq = SR_MQ_CONTINUITY;
383 devc->cur_unit = SR_UNIT_BOOLEAN;
384 } else {
385 devc->cur_mq = SR_MQ_RESISTANCE;
386 devc->cur_unit = SR_UNIT_OHM;
387 }
388 devc->cur_mqflags = 0;
389 devc->cur_exponent = 0;
390 devc->cur_digits = 1 - resolution;
391 } else if (!strcmp(mstr, "DIOD")) {
392 devc->cur_mq = SR_MQ_VOLTAGE;
393 devc->cur_unit = SR_UNIT_VOLT;
394 devc->cur_mqflags = SR_MQFLAG_DIODE;
395 devc->cur_exponent = 0;
396 devc->cur_digits = 3;
397 } else if (!strcmp(mstr, "CAP")) {
398 devc->cur_mq = SR_MQ_CAPACITANCE;
399 devc->cur_unit = SR_UNIT_FARAD;
400 devc->cur_mqflags = 0;
401 devc->cur_exponent = 0;
402 devc->cur_digits = 9 - resolution;
403 } else
404 sr_dbg("Unknown first argument.");
405 g_free(mstr);
406
407 /* This is based on guess, supposing similarity with other models. */
408 devc->cur_encoding = devc->cur_digits + 1;
409
410 if (g_match_info_get_match_count(match) == 4) {
411 mstr = g_match_info_fetch(match, 3);
412 /* Third value, if present, is always AC or DC. */
413 if (!strcmp(mstr, "AC")) {
414 devc->cur_mqflags |= SR_MQFLAG_AC;
415 if (devc->cur_mq == SR_MQ_VOLTAGE)
416 devc->cur_mqflags |= SR_MQFLAG_RMS;
417 } else if (!strcmp(mstr, "DC")) {
418 devc->cur_mqflags |= SR_MQFLAG_DC;
419 } else {
420 sr_dbg("Unknown first argument '%s'.", mstr);
421 }
422 g_free(mstr);
423 } else
424 devc->cur_mqflags &= ~(SR_MQFLAG_AC | SR_MQFLAG_DC);
425
426 return SR_OK;
427}
428
429static int recv_conf_u124x_5x(const struct sr_dev_inst *sdi, GMatchInfo *match)
430{
431 struct dev_context *devc;
432 char *mstr, *rstr, *m2;
433 int resolution;
434
435 sr_spew("CONF? response '%s'.", g_match_info_get_string(match));
436 devc = sdi->priv;
437
438 rstr = g_match_info_fetch(match, 4);
439 if (rstr && sr_atoi(rstr, &resolution) == SR_OK) {
440 devc->cur_digits = -resolution;
441 devc->cur_encoding = -resolution + 1;
442 }
443 g_free(rstr);
444
445 mstr = g_match_info_fetch(match, 1);
446 if (!strncmp(mstr, "VOLT", 4)) {
447 devc->cur_mq = SR_MQ_VOLTAGE;
448 devc->cur_unit = SR_UNIT_VOLT;
449 devc->cur_mqflags = 0;
450 devc->cur_exponent = 0;
451 if (mstr[4] == ':') {
452 if (!strncmp(mstr + 5, "AC", 2)) {
453 devc->cur_mqflags |= SR_MQFLAG_AC | SR_MQFLAG_RMS;
454 } else if (!strncmp(mstr + 5, "DC", 2)) {
455 devc->cur_mqflags |= SR_MQFLAG_DC;
456 } else if (!strncmp(mstr + 5, "ACDC", 4)) {
457 /* AC + DC offset */
458 devc->cur_mqflags |= SR_MQFLAG_AC | SR_MQFLAG_DC | SR_MQFLAG_RMS;
459 } else {
460 devc->cur_mqflags &= ~(SR_MQFLAG_AC | SR_MQFLAG_DC);
461 }
462 } else
463 devc->cur_mqflags &= ~(SR_MQFLAG_AC | SR_MQFLAG_DC);
464 } else if (!strcmp(mstr, "CURR")) {
465 devc->cur_mq = SR_MQ_CURRENT;
466 devc->cur_unit = SR_UNIT_AMPERE;
467 devc->cur_mqflags = 0;
468 devc->cur_exponent = 0;
469 } else if (!strcmp(mstr, "RES")) {
470 devc->cur_mq = SR_MQ_RESISTANCE;
471 devc->cur_unit = SR_UNIT_OHM;
472 devc->cur_mqflags = 0;
473 devc->cur_exponent = 0;
474 } else if (!strcmp(mstr, "CAP")) {
475 devc->cur_mq = SR_MQ_CAPACITANCE;
476 devc->cur_unit = SR_UNIT_FARAD;
477 devc->cur_mqflags = 0;
478 devc->cur_exponent = 0;
479 } else if (!strcmp(mstr, "FREQ")) {
480 devc->cur_mq = SR_MQ_FREQUENCY;
481 devc->cur_unit = SR_UNIT_HERTZ;
482 devc->cur_mqflags = 0;
483 devc->cur_exponent = 0;
484 } else if (!strcmp(mstr, "CONT")) {
485 devc->cur_mq = SR_MQ_CONTINUITY;
486 devc->cur_unit = SR_UNIT_BOOLEAN;
487 devc->cur_mqflags = 0;
488 devc->cur_exponent = 0;
489 } else if (!strcmp(mstr, "DIOD")) {
490 devc->cur_mq = SR_MQ_VOLTAGE;
491 devc->cur_unit = SR_UNIT_VOLT;
492 devc->cur_mqflags = SR_MQFLAG_DIODE;
493 devc->cur_exponent = 0;
494 devc->cur_digits = 4;
495 devc->cur_encoding = 5;
496 } else if (!strncmp(mstr, "T1", 2) || !strncmp(mstr, "T2", 2)) {
497 devc->cur_mq = SR_MQ_TEMPERATURE;
498 m2 = g_match_info_fetch(match, 2);
499 if (!strcmp(m2, "FAR"))
500 devc->cur_unit = SR_UNIT_FAHRENHEIT;
501 else
502 devc->cur_unit = SR_UNIT_CELSIUS;
503 g_free(m2);
504 devc->cur_mqflags = 0;
505 devc->cur_exponent = 0;
506 devc->cur_digits = 1;
507 devc->cur_encoding = 2;
508 } else if (!strcmp(mstr, "SCOU")) {
509 /*
510 * Switch counter, not supported. Not sure what values
511 * come from FETC in this mode, or how they would map
512 * into libsigrok.
513 */
514 } else if (!strncmp(mstr, "CPER:", 5)) {
515 devc->cur_mq = SR_MQ_CURRENT;
516 devc->cur_unit = SR_UNIT_PERCENTAGE;
517 devc->cur_mqflags = 0;
518 devc->cur_exponent = 0;
519 devc->cur_digits = 2;
520 devc->cur_encoding = 3;
521 } else {
522 sr_dbg("Unknown first argument '%s'.", mstr);
523 }
524 g_free(mstr);
525
526 return SR_OK;
527}
528
529/* This comes in whenever the rotary switch is changed to a new position.
530 * We could use it to determine the major measurement mode, but we already
531 * have the output of CONF? for that, which is more detailed. However
532 * we do need to catch this here, or it'll show up in some other output. */
533static int recv_switch(const struct sr_dev_inst *sdi, GMatchInfo *match)
534{
535 (void)sdi;
536
537 sr_spew("Switch '%s'.", g_match_info_get_string(match));
538
539 return SR_OK;
540}
541
542/* Poll keys/switches and values at 7Hz, mode at 1Hz. */
543SR_PRIV const struct agdmm_job agdmm_jobs_u12xx[] = {
544 { 143, send_stat },
545 { 1000, send_conf },
546 { 143, send_fetc },
547 ALL_ZERO
548};
549
550SR_PRIV const struct agdmm_recv agdmm_recvs_u123x[] = {
551 { "^\"(\\d\\d.{18}\\d)\"$", recv_stat_u123x },
552 { "^\\*([0-9])$", recv_switch },
553 { "^([-+][0-9]\\.[0-9]{8}E[-+][0-9]{2})$", recv_fetc },
554 { "^\"(V|MV|A|UA|FREQ),(\\d),(AC|DC)\"$", recv_conf_u123x },
555 { "^\"(RES|CAP),(\\d)\"$", recv_conf_u123x},
556 { "^\"(DIOD)\"$", recv_conf_u123x },
557 ALL_ZERO
558};
559
560SR_PRIV const struct agdmm_recv agdmm_recvs_u124x[] = {
561 { "^\"(\\d\\d.{18}\\d)\"$", recv_stat_u124x },
562 { "^\\*([0-9])$", recv_switch },
563 { "^([-+][0-9]\\.[0-9]{8}E[-+][0-9]{2})$", recv_fetc },
564 { "^\"(VOLT|CURR|RES|CAP|FREQ) ([-+][0-9\\.E\\-+]+),([-+][0-9]\\.[0-9]{8}E([-+][0-9]{2}))\"$", recv_conf_u124x_5x },
565 { "^\"(VOLT:[ACD]+) ([-+][0-9\\.E\\-+]+),([-+][0-9]\\.[0-9]{8}E([-+][0-9]{2}))\"$", recv_conf_u124x_5x },
566 { "^\"(CPER:[40]-20mA) ([-+][0-9\\.E\\-+]+),([-+][0-9]\\.[0-9]{8}E([-+][0-9]{2}))\"$", recv_conf_u124x_5x },
567 { "^\"(T[0-9]:[A-Z]+) ([A-Z]+)\"$", recv_conf_u124x_5x },
568 { "^\"(DIOD)\"$", recv_conf_u124x_5x },
569 ALL_ZERO
570};
571
572SR_PRIV const struct agdmm_recv agdmm_recvs_u125x[] = {
573 { "^\"(\\d\\d.{18}\\d)\"$", recv_stat_u125x },
574 { "^\\*([0-9])$", recv_switch },
575 { "^([-+][0-9]\\.[0-9]{8}E[-+][0-9]{2})$", recv_fetc },
576 { "^\"(VOLT|CURR|RES|CAP|FREQ) ([-+][0-9\\.E\\-+]+),([-+][0-9]\\.[0-9]{8}E([-+][0-9]{2}))\"$", recv_conf_u124x_5x },
577 { "^\"(VOLT:[ACD]+) ([-+][0-9\\.E\\-+]+),([-+][0-9]\\.[0-9]{8}E([-+][0-9]{2}))\"$", recv_conf_u124x_5x },
578 { "^\"(CPER:[40]-20mA) ([-+][0-9\\.E\\-+]+),([-+][0-9]\\.[0-9]{8}E([-+][0-9]{2}))\"$", recv_conf_u124x_5x },
579 { "^\"(T[0-9]:[A-Z]+) ([A-Z]+)\"$", recv_conf_u124x_5x },
580 { "^\"(DIOD)\"$", recv_conf_u124x_5x },
581 ALL_ZERO
582};
Hardware access and backend lib