]> sigrok.org Git - libsigrok.git/blob - src/hardware/norma-dmm/api.c
Consistently use g_malloc0() for allocating devc.
[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                         if (!(ch = sr_channel_new(0, SR_CHANNEL_ANALOG, TRUE,
160                                 "P1")))
161                                 return NULL;
162                         sdi->channels = g_slist_append(sdi->channels, ch);
163                         drvc->instances = g_slist_append(drvc->instances, sdi);
164                         devices = g_slist_append(devices, sdi);
165                         break;
166                 }
167
168                 /*
169                  * The interface of the DM9x0 contains a cap that needs to
170                  * charge for up to 10s before the interface works, if not
171                  * powered externally. Therefore wait a little to improve
172                  * chances.
173                  */
174                 if (cnt == 3) {
175                         sr_info("Waiting 5s to allow interface to settle.");
176                         g_usleep(5 * 1000 * 1000);
177                 }
178         }
179
180         g_free(buf);
181
182         serial_close(serial);
183         if (!devices)
184                 sr_serial_dev_inst_free(serial);
185
186         return devices;
187 }
188
189 static GSList *scan_norma_dmm(GSList *options)
190 {
191         return do_scan(&norma_dmm_driver_info, options);
192 }
193
194 static GSList *scan_siemens_b102x(GSList *options)
195 {
196         return do_scan(&siemens_b102x_driver_info, options);
197 }
198
199 static GSList *dev_list_norma_dmm(void)
200 {
201         return ((struct drv_context *)(norma_dmm_driver_info.priv))->instances;
202 }
203
204 static GSList *dev_list_siemens_b102x(void)
205 {
206         return ((struct drv_context *)(siemens_b102x_driver_info.priv))->instances;
207 }
208
209 static int dev_close(struct sr_dev_inst *sdi)
210 {
211         struct dev_context *devc;
212
213         std_serial_dev_close(sdi);
214
215         /* Free dynamically allocated resources. */
216         if ((devc = sdi->priv) && devc->version) {
217                 g_free(devc->version);
218                 devc->version = NULL;
219                 g_timer_destroy(devc->elapsed_msec);
220         }
221
222         return SR_OK;
223 }
224
225 static int cleanup_norma_dmm(void)
226 {
227         return std_dev_clear(&norma_dmm_driver_info, NULL);
228 }
229
230 static int cleanup_siemens_b102x(void)
231 {
232         return std_dev_clear(&siemens_b102x_driver_info, NULL);
233 }
234
235 static int config_set(uint32_t key, GVariant *data, const struct sr_dev_inst *sdi,
236                 const struct sr_channel_group *cg)
237 {
238         struct dev_context *devc;
239
240         (void)cg;
241
242         if (sdi->status != SR_ST_ACTIVE)
243                 return SR_ERR_DEV_CLOSED;
244
245         if (!(devc = sdi->priv)) {
246                 sr_err("sdi->priv was NULL.");
247                 return SR_ERR_BUG;
248         }
249
250         switch (key) {
251         case SR_CONF_LIMIT_MSEC:
252                 if (g_variant_get_uint64(data) == 0) {
253                         sr_err("LIMIT_MSEC can't be 0.");
254                         return SR_ERR;
255                 }
256                 devc->limit_msec = g_variant_get_uint64(data);
257                 sr_dbg("Setting time limit to %" PRIu64 "ms.",
258                        devc->limit_msec);
259                 break;
260         case SR_CONF_LIMIT_SAMPLES:
261                 devc->limit_samples = g_variant_get_uint64(data);
262                 sr_dbg("Setting sample limit to %" PRIu64 ".",
263                        devc->limit_samples);
264                 break;
265         default:
266                 return SR_ERR_NA;
267         }
268
269         return SR_OK;
270 }
271
272 static int config_list(uint32_t key, GVariant **data, const struct sr_dev_inst *sdi,
273                 const struct sr_channel_group *cg)
274 {
275         (void)sdi;
276         (void)cg;
277
278         switch (key) {
279         case SR_CONF_SCAN_OPTIONS:
280                 *data = g_variant_new_fixed_array(G_VARIANT_TYPE_UINT32,
281                                 scanopts, ARRAY_SIZE(scanopts), sizeof(uint32_t));
282                 break;
283         case SR_CONF_DEVICE_OPTIONS:
284                 *data = g_variant_new_fixed_array(G_VARIANT_TYPE_UINT32,
285                                 devopts, ARRAY_SIZE(devopts), sizeof(uint32_t));
286                 break;
287         default:
288                 return SR_ERR_NA;
289         }
290
291         return SR_OK;
292 }
293
294 static int dev_acquisition_start(const struct sr_dev_inst *sdi,
295                                     void *cb_data)
296 {
297         struct dev_context *devc;
298         struct sr_serial_dev_inst *serial;
299
300         if (!sdi || !cb_data || !(devc = sdi->priv))
301                 return SR_ERR_BUG;
302
303         if (sdi->status != SR_ST_ACTIVE)
304                 return SR_ERR_DEV_CLOSED;
305
306         devc->cb_data = cb_data;
307
308         /* Send header packet to the session bus. */
309         std_session_send_df_header(cb_data, LOG_PREFIX);
310
311         /* Start timer, if required. */
312         if (devc->limit_msec)
313                 g_timer_start(devc->elapsed_msec);
314
315         /* Poll every 100ms, or whenever some data comes in. */
316         serial = sdi->conn;
317         serial_source_add(sdi->session, serial, G_IO_IN, 100,
318                         norma_dmm_receive_data, (void *)sdi);
319
320         return SR_OK;
321 }
322
323 static int dev_acquisition_stop(struct sr_dev_inst *sdi, void *cb_data)
324 {
325         struct dev_context *devc;
326
327         /* Stop timer, if required. */
328         if (sdi && (devc = sdi->priv) && devc->limit_msec)
329                 g_timer_stop(devc->elapsed_msec);
330
331         return std_serial_dev_acquisition_stop(sdi, cb_data, dev_close,
332                         sdi->conn, LOG_PREFIX);
333 }
334
335 SR_PRIV struct sr_dev_driver norma_dmm_driver_info = {
336         .name = "norma-dmm",
337         .longname = "Norma DM9x0 DMMs",
338         .api_version = 1,
339         .init = init_norma_dmm,
340         .cleanup = cleanup_norma_dmm,
341         .scan = scan_norma_dmm,
342         .dev_list = dev_list_norma_dmm,
343         .dev_clear = NULL,
344         .config_get = NULL,
345         .config_set = config_set,
346         .config_list = config_list,
347         .dev_open = std_serial_dev_open,
348         .dev_close = dev_close,
349         .dev_acquisition_start = dev_acquisition_start,
350         .dev_acquisition_stop = dev_acquisition_stop,
351         .priv = NULL,
352 };
353
354
355 SR_PRIV struct sr_dev_driver siemens_b102x_driver_info = {
356         .name = "siemens-b102x",
357         .longname = "Siemens B102x DMMs",
358         .api_version = 1,
359         .init = init_siemens_b102x,
360         .cleanup = cleanup_siemens_b102x,
361         .scan = scan_siemens_b102x,
362         .dev_list = dev_list_siemens_b102x,
363         .dev_clear = NULL,
364         .config_get = NULL,
365         .config_set = config_set,
366         .config_list = config_list,
367         .dev_open = std_serial_dev_open,
368         .dev_close = dev_close,
369         .dev_acquisition_start = dev_acquisition_start,
370         .dev_acquisition_stop = dev_acquisition_stop,
371         .priv = NULL,
372 };