]> sigrok.org Git - libsigrok.git/blob - src/hardware/brymen-bm86x/api.c
brymen-bm86x: add some error checking
[libsigrok.git] / src / hardware / brymen-bm86x / api.c
1 /*
2  * This file is part of the libsigrok project.
3  *
4  * Copyright (C) 2014 Aurelien Jacobs <aurel@gnuage.org>
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 "protocol.h"
21
22 #define BRYMEN_BC86X "0820.0001"
23
24 static const uint32_t scanopts[] = {
25         SR_CONF_CONN,
26 };
27
28 static const uint32_t devopts[] = {
29         SR_CONF_MULTIMETER,
30         SR_CONF_CONTINUOUS,
31         SR_CONF_LIMIT_SAMPLES | SR_CONF_GET | SR_CONF_SET,
32         SR_CONF_LIMIT_MSEC | SR_CONF_GET | SR_CONF_SET,
33 };
34
35 SR_PRIV struct sr_dev_driver brymen_bm86x_driver_info;
36
37 static int init(struct sr_dev_driver *di, struct sr_context *sr_ctx)
38 {
39         return std_init(sr_ctx, di, LOG_PREFIX);
40 }
41
42 static GSList *scan(struct sr_dev_driver *di, GSList *options)
43 {
44         GSList *usb_devices, *devices, *l;
45         struct drv_context *drvc;
46         struct dev_context *devc;
47         struct sr_dev_inst *sdi;
48         struct sr_usb_dev_inst *usb;
49         struct sr_config *src;
50         const char *conn;
51
52         drvc = di->context;
53         drvc->instances = NULL;
54
55         conn = BRYMEN_BC86X;
56         for (l = options; l; l = l->next) {
57                 src = l->data;
58                 switch (src->key) {
59                 case SR_CONF_CONN:
60                         conn = g_variant_get_string(src->data, NULL);
61                         break;
62                 }
63         }
64
65         devices = NULL;
66         if (!(usb_devices = sr_usb_find(drvc->sr_ctx->libusb_ctx, conn))) {
67                 g_slist_free_full(usb_devices, g_free);
68                 return NULL;
69         }
70
71         for (l = usb_devices; l; l = l->next) {
72                 usb = l->data;
73
74                 sdi = g_malloc0(sizeof(struct sr_dev_inst));
75                 sdi->status = SR_ST_INACTIVE;
76                 sdi->vendor = g_strdup("Brymen");
77                 sdi->model = g_strdup("BM869");
78                 devc = g_malloc0(sizeof(struct dev_context));
79                 sdi->priv = devc;
80                 sdi->driver = di;
81                 sr_channel_new(sdi, 0, SR_CHANNEL_ANALOG, TRUE, "P1");
82                 sr_channel_new(sdi, 0, SR_CHANNEL_ANALOG, TRUE, "P2");
83
84                 sdi->inst_type = SR_INST_USB;
85                 sdi->conn = usb;
86
87                 drvc->instances = g_slist_append(drvc->instances, sdi);
88                 devices = g_slist_append(devices, sdi);
89         }
90
91         return devices;
92 }
93
94 static GSList *dev_list(const struct sr_dev_driver *di)
95 {
96         return ((struct drv_context *)(di->context))->instances;
97 }
98
99 static int dev_open(struct sr_dev_inst *sdi)
100 {
101         struct sr_dev_driver *di = sdi->driver;
102         struct drv_context *drvc = di->context;
103         struct sr_usb_dev_inst *usb;
104         struct dev_context *devc;
105         int ret;
106
107         usb = sdi->conn;
108         devc = sdi->priv;
109
110         if ((ret = sr_usb_open(drvc->sr_ctx->libusb_ctx, usb)) == SR_OK)
111                 sdi->status = SR_ST_ACTIVE;
112         else
113                 return SR_ERR;
114
115         /* Detach kernel drivers which grabbed this device (if any). */
116         if (libusb_kernel_driver_active(usb->devhdl, 0) == 1) {
117                 ret = libusb_detach_kernel_driver(usb->devhdl, 0);
118                 if (ret < 0) {
119                         sr_err("Failed to detach kernel driver: %s.",
120                                libusb_error_name(ret));
121                         return SR_ERR;
122                 }
123                 devc->detached_kernel_driver = 1;
124                 sr_dbg("Successfully detached kernel driver.");
125         } else {
126                 sr_dbg("No need to detach a kernel driver.");
127         }
128
129         /* Claim interface 0. */
130         if ((ret = libusb_claim_interface(usb->devhdl, 0)) < 0) {
131                 sr_err("Failed to claim interface 0: %s.",
132                        libusb_error_name(ret));
133                 return SR_ERR;
134         }
135         sr_dbg("Successfully claimed interface 0.");
136
137         return ret;
138 }
139
140 static int dev_close(struct sr_dev_inst *sdi)
141 {
142         struct sr_usb_dev_inst *usb;
143         struct dev_context *devc;
144         int ret;
145
146         if (sdi->status != SR_ST_ACTIVE)
147                 return SR_ERR_DEV_CLOSED;
148
149         usb = sdi->conn;
150         devc = sdi->priv;
151
152         if ((ret = libusb_release_interface(usb->devhdl, 0)))
153                 sr_err("Failed to release interface 0: %s.\n", libusb_error_name(ret));
154         else
155                 sr_dbg("Successfully released interface 0.\n");
156
157         if (!ret && devc->detached_kernel_driver) {
158                 if ((ret = libusb_attach_kernel_driver(usb->devhdl, 0))) {
159                         sr_err("Failed to attach kernel driver: %s.\n",
160                                libusb_error_name(ret));
161                 } else {
162                         devc->detached_kernel_driver = 0;
163                         sr_dbg("Successfully attached kernel driver.\n");
164                 }
165         }
166
167         libusb_close(usb->devhdl);
168
169         sdi->status = SR_ST_INACTIVE;
170
171         return ret;
172 }
173
174 static int cleanup(const struct sr_dev_driver *di)
175 {
176         return std_dev_clear(di, NULL);
177 }
178
179 static int config_get(uint32_t key, GVariant **data, const struct sr_dev_inst *sdi,
180                 const struct sr_channel_group *cg)
181 {
182         struct dev_context *devc = sdi->priv;
183
184         (void)cg;
185
186         switch (key) {
187         case SR_CONF_LIMIT_SAMPLES:
188                 *data = g_variant_new_uint64(devc->limit_samples);
189                 break;
190         case SR_CONF_LIMIT_MSEC:
191                 *data = g_variant_new_uint64(devc->limit_msec);
192                 break;
193         default:
194                 return SR_ERR_NA;
195         }
196
197         return SR_OK;
198 }
199
200 static int config_set(uint32_t key, GVariant *data, const struct sr_dev_inst *sdi,
201                 const struct sr_channel_group *cg)
202 {
203         struct dev_context *devc;
204
205         (void)cg;
206
207         if (sdi->status != SR_ST_ACTIVE)
208                 return SR_ERR_DEV_CLOSED;
209
210         if (!(devc = sdi->priv)) {
211                 sr_err("sdi->priv was NULL.");
212                 return SR_ERR_BUG;
213         }
214
215         switch (key) {
216         case SR_CONF_LIMIT_SAMPLES:
217                 devc->limit_samples = g_variant_get_uint64(data);
218                 break;
219         case SR_CONF_LIMIT_MSEC:
220                 devc->limit_msec = g_variant_get_uint64(data);
221                 break;
222         default:
223                 return SR_ERR_NA;
224         }
225
226         return SR_OK;
227 }
228
229 static int config_list(uint32_t key, GVariant **data, const struct sr_dev_inst *sdi,
230                 const struct sr_channel_group *cg)
231 {
232         (void)sdi;
233         (void)cg;
234
235         switch (key) {
236         case SR_CONF_SCAN_OPTIONS:
237                 *data = g_variant_new_fixed_array(G_VARIANT_TYPE_UINT32,
238                                 scanopts, ARRAY_SIZE(scanopts), sizeof(uint32_t));
239                 break;
240         case SR_CONF_DEVICE_OPTIONS:
241                 *data = g_variant_new_fixed_array(G_VARIANT_TYPE_UINT32,
242                                 devopts, ARRAY_SIZE(devopts), sizeof(uint32_t));
243                 break;
244         default:
245                 return SR_ERR_NA;
246         }
247
248         return SR_OK;
249 }
250
251 static int dev_acquisition_start(const struct sr_dev_inst *sdi,
252                                     void *cb_data)
253 {
254         struct dev_context *devc;
255
256         (void)cb_data;
257
258         if (sdi->status != SR_ST_ACTIVE)
259                 return SR_ERR_DEV_CLOSED;
260
261         devc = sdi->priv;
262         devc->start_time = g_get_monotonic_time();
263
264         /* Send header packet to the session bus. */
265         std_session_send_df_header(sdi, LOG_PREFIX);
266
267         sr_session_source_add(sdi->session, 0, 0, 10,
268                         brymen_bm86x_receive_data, (void *)sdi);
269
270         return SR_OK;
271 }
272
273 static int dev_acquisition_stop(struct sr_dev_inst *sdi, void *cb_data)
274 {
275         struct sr_datafeed_packet packet;
276
277         (void)cb_data;
278
279         if (sdi->status != SR_ST_ACTIVE)
280                 return SR_ERR_DEV_CLOSED;
281
282         /* Send end packet to the session bus. */
283         packet.type = SR_DF_END;
284         sr_session_send(sdi, &packet);
285
286         sr_session_source_remove(sdi->session, 0);
287
288         return SR_OK;
289 }
290
291 SR_PRIV struct sr_dev_driver brymen_bm86x_driver_info = {
292         .name = "brymen-bm86x",
293         .longname = "Brymen BM86X",
294         .api_version = 1,
295         .init = init,
296         .cleanup = cleanup,
297         .scan = scan,
298         .dev_list = dev_list,
299         .dev_clear = NULL,
300         .config_get = config_get,
301         .config_set = config_set,
302         .config_list = config_list,
303         .dev_open = dev_open,
304         .dev_close = dev_close,
305         .dev_acquisition_start = dev_acquisition_start,
306         .dev_acquisition_stop = dev_acquisition_stop,
307         .context = NULL,
308 };