]> sigrok.org Git - libsigrok.git/blob - src/hardware/norma-dmm/api.c
Don't check sr_channel_new() return value (always succeeds).
[libsigrok.git] / src / hardware / norma-dmm / api.c
1 /*
2  * This file is part of the libsigrok project.
3  *
4  * Copyright (C) 2013 Matthias Heidbrink <m-sigrok@heidbrink.biz>
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 /** @file
21  *  Norma DM9x0/Siemens B102x DMMs driver.
22  *  @internal
23  */
24
25 #include "protocol.h"
26
27 static const uint32_t scanopts[] = {
28         SR_CONF_CONN,
29         SR_CONF_SERIALCOMM,
30 };
31
32 static const uint32_t devopts[] = {
33         SR_CONF_MULTIMETER,
34         SR_CONF_CONTINUOUS,
35         SR_CONF_LIMIT_SAMPLES | SR_CONF_SET,
36         SR_CONF_LIMIT_MSEC | SR_CONF_SET,
37 };
38
39 #define BUF_MAX 50
40
41 #define SERIALCOMM "4800/8n1/dtr=1/rts=0/flow=1"
42
43 SR_PRIV struct sr_dev_driver norma_dmm_driver_info;
44 SR_PRIV struct sr_dev_driver siemens_b102x_driver_info;
45
46 static const char* get_brandstr(struct sr_dev_driver* drv)
47 {
48         if (drv == &norma_dmm_driver_info)
49                 return "Norma";
50         else
51                 return "Siemens";
52 }
53
54 static const char* get_typestr(int type, struct sr_dev_driver* drv)
55 {
56         static const char* nameref[5][2] = {
57                 {"DM910", "B1024"},
58                 {"DM920", "B1025"},
59                 {"DM930", "B1026"},
60                 {"DM940", "B1027"},
61                 {"DM950", "B1028"}};
62
63         if ((type < 1) || (type > 5))
64                 return "Unknown type!";
65
66         return nameref[type-1][(drv == &siemens_b102x_driver_info)];
67 }
68
69 static int init_norma_dmm(struct sr_context *sr_ctx)
70 {
71         return std_init(sr_ctx, &norma_dmm_driver_info, LOG_PREFIX);
72 }
73
74 static int init_siemens_b102x(struct sr_context *sr_ctx)
75 {
76         return std_init(sr_ctx, &siemens_b102x_driver_info, LOG_PREFIX);
77 }
78
79 static GSList *do_scan(struct sr_dev_driver* drv, GSList *options)
80 {
81         struct sr_dev_inst *sdi;
82         struct drv_context *drvc;
83         struct dev_context *devc;
84         struct sr_config *src;
85         struct sr_channel *ch;
86         struct sr_serial_dev_inst *serial;
87         GSList *l, *devices;
88         int len, cnt;
89         const char *conn, *serialcomm;
90         char *buf;
91         char req[10];
92         int auxtype;
93
94         devices = NULL;
95         drvc = drv->priv;
96         drvc->instances = NULL;
97         conn = serialcomm = NULL;
98
99         for (l = options; l; l = l->next) {
100                 src = l->data;
101                 switch (src->key) {
102                 case SR_CONF_CONN:
103                         conn = g_variant_get_string(src->data, NULL);
104                         break;
105                 case SR_CONF_SERIALCOMM:
106                         serialcomm = g_variant_get_string(src->data, NULL);
107                         break;
108                 }
109         }
110         if (!conn)
111                 return NULL;
112         if (!serialcomm)
113                 serialcomm = SERIALCOMM;
114
115         if (!(serial = sr_serial_dev_inst_new(conn, serialcomm)))
116                 return NULL;
117
118         if (serial_open(serial, SERIAL_RDWR) != SR_OK)
119                 return NULL;
120
121         serial_flush(serial);
122
123         if (!(buf = g_try_malloc(BUF_MAX))) {
124                 sr_err("Serial buffer malloc failed.");
125                 return NULL;
126         }
127
128         snprintf(req, sizeof(req), "%s\r\n",
129                  nmadmm_requests[NMADMM_REQ_IDN].req_str);
130         g_usleep(150 * 1000); /* Wait a little to allow serial port to settle. */
131         for (cnt = 0; cnt < 7; cnt++) {
132                 if (serial_write_blocking(serial, req, strlen(req), 0) < 0) {
133                         sr_err("Unable to send identification request.");
134                         return NULL;
135                 }
136                 len = BUF_MAX;
137                 serial_readline(serial, &buf, &len, NMADMM_TIMEOUT_MS);
138                 if (!len)
139                         continue;
140                 buf[BUF_MAX - 1] = '\0';
141
142                 /* Match ID string, e.g. "1834 065 V1.06,IF V1.02" (DM950) */
143                 if (g_regex_match_simple("^1834 [^,]*,IF V*", (char *)buf, 0, 0)) {
144                         auxtype = xgittoint(buf[7]);
145                         sr_spew("%s %s DMM %s detected!", get_brandstr(drv), get_typestr(auxtype, drv), buf + 9);
146
147                         sdi = g_malloc0(sizeof(struct sr_dev_inst));
148                         sdi->status = SR_ST_INACTIVE;
149                         sdi->vendor = g_strdup(get_brandstr(drv));
150                         sdi->model = g_strdup(get_typestr(auxtype, drv));
151                         sdi->version = g_strdup(buf + 9);
152                         devc = g_malloc0(sizeof(struct dev_context));
153                         devc->type = auxtype;
154                         devc->version = g_strdup(&buf[9]);
155                         devc->elapsed_msec = g_timer_new();
156                         sdi->conn = serial;
157                         sdi->priv = devc;
158                         sdi->driver = drv;
159                         ch = sr_channel_new(0, SR_CHANNEL_ANALOG, TRUE, "P1");
160                         sdi->channels = g_slist_append(sdi->channels, ch);
161                         drvc->instances = g_slist_append(drvc->instances, sdi);
162                         devices = g_slist_append(devices, sdi);
163                         break;
164                 }
165
166                 /*
167                  * The interface of the DM9x0 contains a cap that needs to
168                  * charge for up to 10s before the interface works, if not
169                  * powered externally. Therefore wait a little to improve
170                  * chances.
171                  */
172                 if (cnt == 3) {
173                         sr_info("Waiting 5s to allow interface to settle.");
174                         g_usleep(5 * 1000 * 1000);
175                 }
176         }
177
178         g_free(buf);
179
180         serial_close(serial);
181         if (!devices)
182                 sr_serial_dev_inst_free(serial);
183
184         return devices;
185 }
186
187 static GSList *scan_norma_dmm(GSList *options)
188 {
189         return do_scan(&norma_dmm_driver_info, options);
190 }
191
192 static GSList *scan_siemens_b102x(GSList *options)
193 {
194         return do_scan(&siemens_b102x_driver_info, options);
195 }
196
197 static GSList *dev_list_norma_dmm(void)
198 {
199         return ((struct drv_context *)(norma_dmm_driver_info.priv))->instances;
200 }
201
202 static GSList *dev_list_siemens_b102x(void)
203 {
204         return ((struct drv_context *)(siemens_b102x_driver_info.priv))->instances;
205 }
206
207 static int dev_close(struct sr_dev_inst *sdi)
208 {
209         struct dev_context *devc;
210
211         std_serial_dev_close(sdi);
212
213         /* Free dynamically allocated resources. */
214         if ((devc = sdi->priv) && devc->version) {
215                 g_free(devc->version);
216                 devc->version = NULL;
217                 g_timer_destroy(devc->elapsed_msec);
218         }
219
220         return SR_OK;
221 }
222
223 static int cleanup_norma_dmm(void)
224 {
225         return std_dev_clear(&norma_dmm_driver_info, NULL);
226 }
227
228 static int cleanup_siemens_b102x(void)
229 {
230         return std_dev_clear(&siemens_b102x_driver_info, NULL);
231 }
232
233 static int config_set(uint32_t key, GVariant *data, const struct sr_dev_inst *sdi,
234                 const struct sr_channel_group *cg)
235 {
236         struct dev_context *devc;
237
238         (void)cg;
239
240         if (sdi->status != SR_ST_ACTIVE)
241                 return SR_ERR_DEV_CLOSED;
242
243         if (!(devc = sdi->priv)) {
244                 sr_err("sdi->priv was NULL.");
245                 return SR_ERR_BUG;
246         }
247
248         switch (key) {
249         case SR_CONF_LIMIT_MSEC:
250                 if (g_variant_get_uint64(data) == 0) {
251                         sr_err("LIMIT_MSEC can't be 0.");
252                         return SR_ERR;
253                 }
254                 devc->limit_msec = g_variant_get_uint64(data);
255                 sr_dbg("Setting time limit to %" PRIu64 "ms.",
256                        devc->limit_msec);
257                 break;
258         case SR_CONF_LIMIT_SAMPLES:
259                 devc->limit_samples = g_variant_get_uint64(data);
260                 sr_dbg("Setting sample limit to %" PRIu64 ".",
261                        devc->limit_samples);
262                 break;
263         default:
264                 return SR_ERR_NA;
265         }
266
267         return SR_OK;
268 }
269
270 static int config_list(uint32_t key, GVariant **data, const struct sr_dev_inst *sdi,
271                 const struct sr_channel_group *cg)
272 {
273         (void)sdi;
274         (void)cg;
275
276         switch (key) {
277         case SR_CONF_SCAN_OPTIONS:
278                 *data = g_variant_new_fixed_array(G_VARIANT_TYPE_UINT32,
279                                 scanopts, ARRAY_SIZE(scanopts), sizeof(uint32_t));
280                 break;
281         case SR_CONF_DEVICE_OPTIONS:
282                 *data = g_variant_new_fixed_array(G_VARIANT_TYPE_UINT32,
283                                 devopts, ARRAY_SIZE(devopts), sizeof(uint32_t));
284                 break;
285         default:
286                 return SR_ERR_NA;
287         }
288
289         return SR_OK;
290 }
291
292 static int dev_acquisition_start(const struct sr_dev_inst *sdi,
293                                     void *cb_data)
294 {
295         struct dev_context *devc;
296         struct sr_serial_dev_inst *serial;
297
298         if (!sdi || !cb_data || !(devc = sdi->priv))
299                 return SR_ERR_BUG;
300
301         if (sdi->status != SR_ST_ACTIVE)
302                 return SR_ERR_DEV_CLOSED;
303
304         devc->cb_data = cb_data;
305
306         /* Send header packet to the session bus. */
307         std_session_send_df_header(cb_data, LOG_PREFIX);
308
309         /* Start timer, if required. */
310         if (devc->limit_msec)
311                 g_timer_start(devc->elapsed_msec);
312
313         /* Poll every 100ms, or whenever some data comes in. */
314         serial = sdi->conn;
315         serial_source_add(sdi->session, serial, G_IO_IN, 100,
316                         norma_dmm_receive_data, (void *)sdi);
317
318         return SR_OK;
319 }
320
321 static int dev_acquisition_stop(struct sr_dev_inst *sdi, void *cb_data)
322 {
323         struct dev_context *devc;
324
325         /* Stop timer, if required. */
326         if (sdi && (devc = sdi->priv) && devc->limit_msec)
327                 g_timer_stop(devc->elapsed_msec);
328
329         return std_serial_dev_acquisition_stop(sdi, cb_data, dev_close,
330                         sdi->conn, LOG_PREFIX);
331 }
332
333 SR_PRIV struct sr_dev_driver norma_dmm_driver_info = {
334         .name = "norma-dmm",
335         .longname = "Norma DM9x0 DMMs",
336         .api_version = 1,
337         .init = init_norma_dmm,
338         .cleanup = cleanup_norma_dmm,
339         .scan = scan_norma_dmm,
340         .dev_list = dev_list_norma_dmm,
341         .dev_clear = NULL,
342         .config_get = NULL,
343         .config_set = config_set,
344         .config_list = config_list,
345         .dev_open = std_serial_dev_open,
346         .dev_close = dev_close,
347         .dev_acquisition_start = dev_acquisition_start,
348         .dev_acquisition_stop = dev_acquisition_stop,
349         .priv = NULL,
350 };
351
352
353 SR_PRIV struct sr_dev_driver siemens_b102x_driver_info = {
354         .name = "siemens-b102x",
355         .longname = "Siemens B102x DMMs",
356         .api_version = 1,
357         .init = init_siemens_b102x,
358         .cleanup = cleanup_siemens_b102x,
359         .scan = scan_siemens_b102x,
360         .dev_list = dev_list_siemens_b102x,
361         .dev_clear = NULL,
362         .config_get = NULL,
363         .config_set = config_set,
364         .config_list = config_list,
365         .dev_open = std_serial_dev_open,
366         .dev_close = dev_close,
367         .dev_acquisition_start = dev_acquisition_start,
368         .dev_acquisition_stop = dev_acquisition_stop,
369         .priv = NULL,
370 };