]> sigrok.org Git - libsigrok.git/blame_incremental - src/hardware/agilent-dmm/sched.c
agilent-dmm: fix handling of AC/DC flags in volts mode
[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, "ACDC", 4)) {
453 /* AC + DC offset */
454 devc->cur_mqflags |= SR_MQFLAG_AC | SR_MQFLAG_DC | SR_MQFLAG_RMS;
455 } else if (!strncmp(mstr + 5, "AC", 2)) {
456 devc->cur_mqflags |= SR_MQFLAG_AC | SR_MQFLAG_RMS;
457 } else if (!strncmp(mstr + 5, "DC", 2)) {
458 devc->cur_mqflags |= SR_MQFLAG_DC;
459 }
460 } else
461 devc->cur_mqflags |= SR_MQFLAG_DC;
462 } else if (!strcmp(mstr, "CURR")) {
463 devc->cur_mq = SR_MQ_CURRENT;
464 devc->cur_unit = SR_UNIT_AMPERE;
465 devc->cur_mqflags = 0;
466 devc->cur_exponent = 0;
467 } else if (!strcmp(mstr, "RES")) {
468 devc->cur_mq = SR_MQ_RESISTANCE;
469 devc->cur_unit = SR_UNIT_OHM;
470 devc->cur_mqflags = 0;
471 devc->cur_exponent = 0;
472 } else if (!strcmp(mstr, "CAP")) {
473 devc->cur_mq = SR_MQ_CAPACITANCE;
474 devc->cur_unit = SR_UNIT_FARAD;
475 devc->cur_mqflags = 0;
476 devc->cur_exponent = 0;
477 } else if (!strcmp(mstr, "FREQ")) {
478 devc->cur_mq = SR_MQ_FREQUENCY;
479 devc->cur_unit = SR_UNIT_HERTZ;
480 devc->cur_mqflags = 0;
481 devc->cur_exponent = 0;
482 } else if (!strcmp(mstr, "CONT")) {
483 devc->cur_mq = SR_MQ_CONTINUITY;
484 devc->cur_unit = SR_UNIT_BOOLEAN;
485 devc->cur_mqflags = 0;
486 devc->cur_exponent = 0;
487 } else if (!strcmp(mstr, "DIOD")) {
488 devc->cur_mq = SR_MQ_VOLTAGE;
489 devc->cur_unit = SR_UNIT_VOLT;
490 devc->cur_mqflags = SR_MQFLAG_DIODE;
491 devc->cur_exponent = 0;
492 devc->cur_digits = 4;
493 devc->cur_encoding = 5;
494 } else if (!strncmp(mstr, "T1", 2) || !strncmp(mstr, "T2", 2)) {
495 devc->cur_mq = SR_MQ_TEMPERATURE;
496 m2 = g_match_info_fetch(match, 2);
497 if (!strcmp(m2, "FAR"))
498 devc->cur_unit = SR_UNIT_FAHRENHEIT;
499 else
500 devc->cur_unit = SR_UNIT_CELSIUS;
501 g_free(m2);
502 devc->cur_mqflags = 0;
503 devc->cur_exponent = 0;
504 devc->cur_digits = 1;
505 devc->cur_encoding = 2;
506 } else if (!strcmp(mstr, "SCOU")) {
507 /*
508 * Switch counter, not supported. Not sure what values
509 * come from FETC in this mode, or how they would map
510 * into libsigrok.
511 */
512 } else if (!strncmp(mstr, "CPER:", 5)) {
513 devc->cur_mq = SR_MQ_CURRENT;
514 devc->cur_unit = SR_UNIT_PERCENTAGE;
515 devc->cur_mqflags = 0;
516 devc->cur_exponent = 0;
517 devc->cur_digits = 2;
518 devc->cur_encoding = 3;
519 } else {
520 sr_dbg("Unknown first argument '%s'.", mstr);
521 }
522 g_free(mstr);
523
524 return SR_OK;
525}
526
527/* This comes in whenever the rotary switch is changed to a new position.
528 * We could use it to determine the major measurement mode, but we already
529 * have the output of CONF? for that, which is more detailed. However
530 * we do need to catch this here, or it'll show up in some other output. */
531static int recv_switch(const struct sr_dev_inst *sdi, GMatchInfo *match)
532{
533 (void)sdi;
534
535 sr_spew("Switch '%s'.", g_match_info_get_string(match));
536
537 return SR_OK;
538}
539
540/* Poll keys/switches and values at 7Hz, mode at 1Hz. */
541SR_PRIV const struct agdmm_job agdmm_jobs_u12xx[] = {
542 { 143, send_stat },
543 { 1000, send_conf },
544 { 143, send_fetc },
545 ALL_ZERO
546};
547
548SR_PRIV const struct agdmm_recv agdmm_recvs_u123x[] = {
549 { "^\"(\\d\\d.{18}\\d)\"$", recv_stat_u123x },
550 { "^\\*([0-9])$", recv_switch },
551 { "^([-+][0-9]\\.[0-9]{8}E[-+][0-9]{2})$", recv_fetc },
552 { "^\"(V|MV|A|UA|FREQ),(\\d),(AC|DC)\"$", recv_conf_u123x },
553 { "^\"(RES|CAP),(\\d)\"$", recv_conf_u123x},
554 { "^\"(DIOD)\"$", recv_conf_u123x },
555 ALL_ZERO
556};
557
558SR_PRIV const struct agdmm_recv agdmm_recvs_u124x[] = {
559 { "^\"(\\d\\d.{18}\\d)\"$", recv_stat_u124x },
560 { "^\\*([0-9])$", recv_switch },
561 { "^([-+][0-9]\\.[0-9]{8}E[-+][0-9]{2})$", recv_fetc },
562 { "^\"(VOLT|CURR|RES|CAP|FREQ) ([-+][0-9\\.E\\-+]+),([-+][0-9]\\.[0-9]{8}E([-+][0-9]{2}))\"$", recv_conf_u124x_5x },
563 { "^\"(VOLT:[ACD]+) ([-+][0-9\\.E\\-+]+),([-+][0-9]\\.[0-9]{8}E([-+][0-9]{2}))\"$", recv_conf_u124x_5x },
564 { "^\"(CPER:[40]-20mA) ([-+][0-9\\.E\\-+]+),([-+][0-9]\\.[0-9]{8}E([-+][0-9]{2}))\"$", recv_conf_u124x_5x },
565 { "^\"(T[0-9]:[A-Z]+) ([A-Z]+)\"$", recv_conf_u124x_5x },
566 { "^\"(DIOD)\"$", recv_conf_u124x_5x },
567 ALL_ZERO
568};
569
570SR_PRIV const struct agdmm_recv agdmm_recvs_u125x[] = {
571 { "^\"(\\d\\d.{18}\\d)\"$", recv_stat_u125x },
572 { "^\\*([0-9])$", recv_switch },
573 { "^([-+][0-9]\\.[0-9]{8}E[-+][0-9]{2})$", recv_fetc },
574 { "^\"(VOLT|CURR|RES|CAP|FREQ) ([-+][0-9\\.E\\-+]+),([-+][0-9]\\.[0-9]{8}E([-+][0-9]{2}))\"$", recv_conf_u124x_5x },
575 { "^\"(VOLT:[ACD]+) ([-+][0-9\\.E\\-+]+),([-+][0-9]\\.[0-9]{8}E([-+][0-9]{2}))\"$", recv_conf_u124x_5x },
576 { "^\"(CPER:[40]-20mA) ([-+][0-9\\.E\\-+]+),([-+][0-9]\\.[0-9]{8}E([-+][0-9]{2}))\"$", recv_conf_u124x_5x },
577 { "^\"(T[0-9]:[A-Z]+) ([A-Z]+)\"$", recv_conf_u124x_5x },
578 { "^\"(DIOD)\"$", recv_conf_u124x_5x },
579 ALL_ZERO
580};