]> sigrok.org Git - libsigrok.git/blob - src/hardware/manson-hcs-3xxx/api.c
Use g_malloc0() consistently, simplify error handling.
[libsigrok.git] / src / hardware / manson-hcs-3xxx / api.c
1 /*
2  * This file is part of the libsigrok project.
3  *
4  * Copyright (C) 2014 Uwe Hermann <uwe@hermann-uwe.de>
5  * Copyright (C) 2014 Matthias Heidbrink <m-sigrok@heidbrink.biz>
6  *
7  * This program is free software; you can redistribute it and/or modify
8  * it under the terms of the GNU General Public License as published by
9  * the Free Software Foundation; either version 2 of the License, or
10  * (at your option) any later version.
11  *
12  * This program is distributed in the hope that it will be useful,
13  * but WITHOUT ANY WARRANTY; without even the implied warranty of
14  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
15  * GNU General Public License for more details.
16  *
17  * You should have received a copy of the GNU General Public License
18  * along with this program; if not, write to the Free Software
19  * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301 USA
20  */
21
22 /** @file
23   *  <em>Manson HCS-3xxx Series</em> power supply driver
24   *  @internal
25   */
26
27 #include "protocol.h"
28
29 static const uint32_t drvopts[] = {
30         /* Device class */
31         SR_CONF_POWER_SUPPLY,
32 };
33
34 static const uint32_t scanopts[] = {
35         SR_CONF_CONN,
36         SR_CONF_SERIALCOMM,
37 };
38
39 static const uint32_t devopts[] = {
40         /* Device class */
41         SR_CONF_POWER_SUPPLY,
42         /* Aquisition modes. */
43         SR_CONF_CONTINUOUS,
44         SR_CONF_LIMIT_SAMPLES | SR_CONF_GET | SR_CONF_SET,
45         SR_CONF_LIMIT_MSEC | SR_CONF_GET | SR_CONF_SET,
46         /* Device configuration */
47         SR_CONF_OUTPUT_VOLTAGE | SR_CONF_GET,
48         SR_CONF_OUTPUT_VOLTAGE_TARGET | SR_CONF_GET | SR_CONF_SET | SR_CONF_LIST,
49         SR_CONF_OUTPUT_CURRENT | SR_CONF_GET,
50         SR_CONF_OUTPUT_CURRENT_LIMIT | SR_CONF_GET | SR_CONF_SET | SR_CONF_LIST,
51         SR_CONF_OUTPUT_ENABLED | SR_CONF_GET | SR_CONF_SET,
52 };
53
54 /* Note: All models have one power supply output only. */
55 static struct hcs_model models[] = {
56         { MANSON_HCS_3100, "HCS-3100",     "3100", { 1, 18, 0.1 }, { 0, 10,   0.10 } },
57         { MANSON_HCS_3102, "HCS-3102",     "3102", { 1, 36, 0.1 }, { 0,  5,   0.01 } },
58         { MANSON_HCS_3104, "HCS-3104",     "3104", { 1, 60, 0.1 }, { 0,  2.5, 0.01 } },
59         { MANSON_HCS_3150, "HCS-3150",     "3150", { 1, 18, 0.1 }, { 0, 15,   0.10 } },
60         { MANSON_HCS_3200, "HCS-3200",     "3200", { 1, 18, 0.1 }, { 0, 20,   0.10 } },
61         { MANSON_HCS_3202, "HCS-3202",     "3202", { 1, 36, 0.1 }, { 0, 10,   0.10 } },
62         { MANSON_HCS_3204, "HCS-3204",     "3204", { 1, 60, 0.1 }, { 0,  5,   0.01 } },
63         { MANSON_HCS_3300, "HCS-3300-USB", "3300", { 1, 16, 0.1 }, { 0, 30,   0.10 } },
64         { MANSON_HCS_3302, "HCS-3302-USB", "3302", { 1, 32, 0.1 }, { 0, 15,   0.10 } },
65         { MANSON_HCS_3304, "HCS-3304-USB", "3304", { 1, 60, 0.1 }, { 0,  8,   0.10 } },
66         { MANSON_HCS_3400, "HCS-3400-USB", "3400", { 1, 16, 0.1 }, { 0, 40,   0.10 } },
67         { MANSON_HCS_3402, "HCS-3402-USB", "3402", { 1, 32, 0.1 }, { 0, 20,   0.10 } },
68         { MANSON_HCS_3404, "HCS-3404-USB", "3404", { 1, 60, 0.1 }, { 0, 10,   0.10 } },
69         { MANSON_HCS_3600, "HCS-3600-USB", "3600", { 1, 16, 0.1 }, { 0, 60,   0.10 } },
70         { MANSON_HCS_3602, "HCS-3602-USB", "3602", { 1, 32, 0.1 }, { 0, 30,   0.10 } },
71         { MANSON_HCS_3604, "HCS-3604-USB", "3604", { 1, 60, 0.1 }, { 0, 15,   0.10 } },
72         { 0, NULL, NULL, { 0, 0, 0 }, { 0, 0, 0 }, },
73 };
74
75 SR_PRIV struct sr_dev_driver manson_hcs_3xxx_driver_info;
76 static struct sr_dev_driver *di = &manson_hcs_3xxx_driver_info;
77
78 static int dev_clear(void)
79 {
80         return std_dev_clear(di, NULL);
81 }
82
83 static int init(struct sr_context *sr_ctx)
84 {
85         return std_init(sr_ctx, di, LOG_PREFIX);
86 }
87
88 static GSList *scan(GSList *options)
89 {
90         int i, model_id;
91         struct drv_context *drvc;
92         struct dev_context *devc;
93         struct sr_dev_inst *sdi;
94         struct sr_config *src;
95         struct sr_channel *ch;
96         GSList *devices, *l;
97         const char *conn, *serialcomm;
98         struct sr_serial_dev_inst *serial;
99         char reply[50], **tokens, *dummy;
100
101         drvc = di->priv;
102         drvc->instances = NULL;
103         devices = NULL;
104         conn = NULL;
105         serialcomm = NULL;
106         devc = NULL;
107
108         for (l = options; l; l = l->next) {
109                 src = l->data;
110                 switch (src->key) {
111                 case SR_CONF_CONN:
112                         conn = g_variant_get_string(src->data, NULL);
113                         break;
114                 case SR_CONF_SERIALCOMM:
115                         serialcomm = g_variant_get_string(src->data, NULL);
116                         break;
117                 default:
118                         sr_err("Unknown option %d, skipping.", src->key);
119                         break;
120                 }
121         }
122
123         if (!conn)
124                 return NULL;
125         if (!serialcomm)
126                 serialcomm = "9600/8n1";
127
128         serial = sr_serial_dev_inst_new(conn, serialcomm);
129
130         if (serial_open(serial, SERIAL_RDWR) != SR_OK)
131                 return NULL;
132
133         serial_flush(serial);
134
135         sr_info("Probing serial port %s.", conn);
136
137         /* Get the device model. */
138         memset(&reply, 0, sizeof(reply));
139         if ((hcs_send_cmd(serial, "GMOD\r") < 0) ||
140             (hcs_read_reply(serial, 2, reply, sizeof(reply)) < 0))
141                 return NULL;
142         tokens = g_strsplit((const gchar *)&reply, "\r", 2);
143
144         model_id = -1;
145         for (i = 0; models[i].id != NULL; i++) {
146                 if (!strcmp(models[i].id, tokens[0]))
147                         model_id = i;
148         }
149         g_strfreev(tokens);
150
151         if (model_id < 0) {
152                 sr_err("Unknown model id '%s' detected, aborting.", tokens[0]);
153                 return NULL;
154         }
155
156         /* Init device instance, etc. */
157         sdi = g_malloc0(sizeof(struct sr_dev_inst));
158         sdi->status = SR_ST_INACTIVE;
159         sdi->vendor = g_strdup("Manson");
160         sdi->model = g_strdup(models[model_id].name);
161         sdi->inst_type = SR_INST_SERIAL;
162         sdi->conn = serial;
163         sdi->driver = di;
164
165         ch = sr_channel_new(0, SR_CHANNEL_ANALOG, TRUE, "CH1");
166         sdi->channels = g_slist_append(sdi->channels, ch);
167
168         devc = g_malloc0(sizeof(struct dev_context));
169         devc->model = &models[model_id];
170
171         sdi->priv = devc;
172
173         /* Get current voltage, current, status. */
174         if ((hcs_send_cmd(serial, "GETD\r") < 0) ||
175             (hcs_read_reply(serial, 2, reply, sizeof(reply)) < 0))
176                 goto exit_err;
177         tokens = g_strsplit((const gchar *)&reply, "\r", 2);
178         if (hcs_parse_volt_curr_mode(sdi, tokens) < 0)
179                 goto exit_err;
180         g_strfreev(tokens);
181
182         /* Get max. voltage and current. */
183         if ((hcs_send_cmd(serial, "GMAX\r") < 0) ||
184             (hcs_read_reply(serial, 2, reply, sizeof(reply)) < 0))
185                 goto exit_err;
186         tokens = g_strsplit((const gchar *)&reply, "\r", 2);
187         devc->current_max_device = g_strtod(&tokens[0][3], &dummy) * devc->model->current[2];
188         tokens[0][3] = '\0';
189         devc->voltage_max_device = g_strtod(tokens[0], &dummy) * devc->model->voltage[2];
190         g_strfreev(tokens);
191
192         drvc->instances = g_slist_append(drvc->instances, sdi);
193         devices = g_slist_append(devices, sdi);
194
195         serial_close(serial);
196         if (!devices)
197                 sr_serial_dev_inst_free(serial);
198
199         return devices;
200
201 exit_err:
202         sr_dev_inst_free(sdi);
203         if (devc)
204                 g_free(devc);
205         return NULL;
206 }
207
208 static GSList *dev_list(void)
209 {
210         return ((struct drv_context *)(di->priv))->instances;
211 }
212
213 static int cleanup(void)
214 {
215         return dev_clear();
216 }
217
218 static int config_get(uint32_t key, GVariant **data, const struct sr_dev_inst *sdi,
219                 const struct sr_channel_group *cg)
220 {
221         struct dev_context *devc;
222
223         (void)cg;
224
225         if (!sdi)
226                 return SR_ERR_ARG;
227
228         devc = sdi->priv;
229
230         switch (key) {
231         case SR_CONF_LIMIT_SAMPLES:
232                 *data = g_variant_new_uint64(devc->limit_samples);
233                 break;
234         case SR_CONF_LIMIT_MSEC:
235                 *data = g_variant_new_uint64(devc->limit_msec);
236                 break;
237         case SR_CONF_OUTPUT_VOLTAGE:
238                 *data = g_variant_new_double(devc->voltage);
239                 break;
240         case SR_CONF_OUTPUT_VOLTAGE_TARGET:
241                 *data = g_variant_new_double(devc->voltage_max);
242                 break;
243         case SR_CONF_OUTPUT_CURRENT:
244                 *data = g_variant_new_double(devc->current);
245                 break;
246         case SR_CONF_OUTPUT_CURRENT_LIMIT:
247                 *data = g_variant_new_double(devc->current_max);
248                 break;
249         case SR_CONF_OUTPUT_ENABLED:
250                 *data = g_variant_new_boolean(devc->output_enabled);
251                 break;
252         default:
253                 return SR_ERR_NA;
254         }
255
256         return SR_OK;
257 }
258
259 static int config_set(uint32_t key, GVariant *data, const struct sr_dev_inst *sdi,
260                 const struct sr_channel_group *cg)
261 {
262         struct dev_context *devc;
263         gboolean bval;
264         gdouble dval;
265
266         (void)cg;
267
268         if (sdi->status != SR_ST_ACTIVE)
269                 return SR_ERR_DEV_CLOSED;
270
271         devc = sdi->priv;
272
273         switch (key) {
274         case SR_CONF_LIMIT_MSEC:
275                 if (g_variant_get_uint64(data) == 0)
276                         return SR_ERR_ARG;
277                 devc->limit_msec = g_variant_get_uint64(data);
278                 break;
279         case SR_CONF_LIMIT_SAMPLES:
280                 if (g_variant_get_uint64(data) == 0)
281                         return SR_ERR_ARG;
282                 devc->limit_samples = g_variant_get_uint64(data);
283                 break;
284         case SR_CONF_OUTPUT_VOLTAGE_TARGET:
285                 dval = g_variant_get_double(data);
286                 if (dval < devc->model->voltage[0] || dval > devc->voltage_max_device)
287                         return SR_ERR_ARG;
288
289                 if ((hcs_send_cmd(sdi->conn, "VOLT%03.0f\r",
290                         (dval / devc->model->voltage[2])) < 0) ||
291                     (hcs_read_reply(sdi->conn, 1, devc->buf, sizeof(devc->buf)) < 0))
292                         return SR_ERR;
293                 devc->voltage_max = dval;
294                 break;
295         case SR_CONF_OUTPUT_CURRENT_LIMIT:
296                 dval = g_variant_get_double(data);
297                 if (dval < devc->model->current[0] || dval > devc->current_max_device)
298                         return SR_ERR_ARG;
299
300                 if ((hcs_send_cmd(sdi->conn, "CURR%03.0f\r",
301                         (dval / devc->model->current[2])) < 0) ||
302                     (hcs_read_reply(sdi->conn, 1, devc->buf, sizeof(devc->buf)) < 0))
303                         return SR_ERR;
304                 devc->current_max = dval;
305                 break;
306         case SR_CONF_OUTPUT_ENABLED:
307                 bval = g_variant_get_boolean(data);
308                 if (bval == devc->output_enabled) /* Nothing to do. */
309                         break;
310                 if ((hcs_send_cmd(sdi->conn, "SOUT%1d\r", !bval) < 0) ||
311                     (hcs_read_reply(sdi->conn, 1, devc->buf, sizeof(devc->buf)) < 0))
312                         return SR_ERR;
313                 devc->output_enabled = bval;
314                 break;
315         default:
316                 return SR_ERR_NA;
317         }
318
319         return SR_OK;
320 }
321
322 static int config_list(uint32_t key, GVariant **data, const struct sr_dev_inst *sdi,
323                 const struct sr_channel_group *cg)
324 {
325         struct dev_context *devc;
326         GVariant *gvar;
327         GVariantBuilder gvb;
328         double dval;
329         int idx;
330
331         (void)cg;
332
333         if (key == SR_CONF_DEVICE_OPTIONS && !sdi) {
334                 *data = g_variant_new_fixed_array(G_VARIANT_TYPE_UINT32,
335                                 drvopts, ARRAY_SIZE(drvopts), sizeof(uint32_t));
336                 return SR_OK;
337         }
338
339         if (!sdi)
340                 return SR_ERR_ARG;
341         devc = sdi->priv;
342
343         switch (key) {
344         case SR_CONF_SCAN_OPTIONS:
345                 *data = g_variant_new_fixed_array(G_VARIANT_TYPE_UINT32,
346                         scanopts, ARRAY_SIZE(scanopts), sizeof(uint32_t));
347                 break;
348         case SR_CONF_DEVICE_OPTIONS:
349                 *data = g_variant_new_fixed_array(G_VARIANT_TYPE_UINT32,
350                                 devopts, ARRAY_SIZE(devopts), sizeof(uint32_t));
351                 break;
352         case SR_CONF_OUTPUT_VOLTAGE_TARGET:
353                 g_variant_builder_init(&gvb, G_VARIANT_TYPE_ARRAY);
354                 /* Min, max, step. */
355                 for (idx = 0; idx < 3; idx++) {
356                         if (idx == 1)
357                                 dval = devc->voltage_max_device;
358                         else
359                                 dval = devc->model->voltage[idx];
360                         gvar = g_variant_new_double(dval);
361                         g_variant_builder_add_value(&gvb, gvar);
362                 }
363                 *data = g_variant_builder_end(&gvb);
364                 break;
365         case SR_CONF_OUTPUT_CURRENT_LIMIT:
366                 g_variant_builder_init(&gvb, G_VARIANT_TYPE_ARRAY);
367                 /* Min, max, step. */
368                 for (idx = 0; idx < 3; idx++) {
369                         if (idx == 1)
370                                 dval = devc->current_max_device;
371                         else
372                                 dval = devc->model->current[idx];
373                         gvar = g_variant_new_double(dval);
374                         g_variant_builder_add_value(&gvb, gvar);
375                 }
376                 *data = g_variant_builder_end(&gvb);
377                 break;
378         default:
379                 return SR_ERR_NA;
380         }
381
382         return SR_OK;
383 }
384
385 static int dev_acquisition_start(const struct sr_dev_inst *sdi, void *cb_data)
386 {
387         struct dev_context *devc;
388         struct sr_serial_dev_inst *serial;
389
390         if (sdi->status != SR_ST_ACTIVE)
391                 return SR_ERR_DEV_CLOSED;
392
393         devc = sdi->priv;
394         devc->cb_data = cb_data;
395
396         /* Send header packet to the session bus. */
397         std_session_send_df_header(cb_data, LOG_PREFIX);
398
399         devc->starttime = g_get_monotonic_time();
400         devc->num_samples = 0;
401         devc->reply_pending = FALSE;
402         devc->req_sent_at = 0;
403
404         /* Poll every 10ms, or whenever some data comes in. */
405         serial = sdi->conn;
406         serial_source_add(sdi->session, serial, G_IO_IN, 10,
407                         hcs_receive_data, (void *)sdi);
408
409         return SR_OK;
410 }
411
412 static int dev_acquisition_stop(struct sr_dev_inst *sdi, void *cb_data)
413 {
414         return std_serial_dev_acquisition_stop(sdi, cb_data,
415                         std_serial_dev_close, sdi->conn, LOG_PREFIX);
416 }
417
418 SR_PRIV struct sr_dev_driver manson_hcs_3xxx_driver_info = {
419         .name = "manson-hcs-3xxx",
420         .longname = "Manson HCS-3xxx",
421         .api_version = 1,
422         .init = init,
423         .cleanup = cleanup,
424         .scan = scan,
425         .dev_list = dev_list,
426         .dev_clear = dev_clear,
427         .config_get = config_get,
428         .config_set = config_set,
429         .config_list = config_list,
430         .dev_open = std_serial_dev_open,
431         .dev_close = std_serial_dev_close,
432         .dev_acquisition_start = dev_acquisition_start,
433         .dev_acquisition_stop = dev_acquisition_stop,
434         .priv = NULL,
435 };