]> sigrok.org Git - libsigrok.git/blob - src/hardware/colead-slm/api.c
Use g_malloc0() consistently, simplify error handling.
[libsigrok.git] / src / hardware / colead-slm / api.c
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 <glib.h>
21 #include "libsigrok.h"
22 #include "libsigrok-internal.h"
23 #include "protocol.h"
24 #include <sys/types.h>
25 #include <sys/stat.h>
26 #include <fcntl.h>
27 #include <errno.h>
28 #include <string.h>
29
30 /* The Colead SL-5868P uses this. */
31 #define SERIALCOMM "2400/8n1"
32
33 static const uint32_t scanopts[] = {
34         SR_CONF_CONN,
35         SR_CONF_SERIALCOMM,
36 };
37
38 static const uint32_t devopts[] = {
39         SR_CONF_SOUNDLEVELMETER,
40         SR_CONF_CONTINUOUS,
41         SR_CONF_LIMIT_SAMPLES | SR_CONF_SET,
42         SR_CONF_LIMIT_MSEC | SR_CONF_SET,
43 };
44
45 SR_PRIV struct sr_dev_driver colead_slm_driver_info;
46 static struct sr_dev_driver *di = &colead_slm_driver_info;
47
48 static int init(struct sr_context *sr_ctx)
49 {
50         return std_init(sr_ctx, di, LOG_PREFIX);
51 }
52
53 static GSList *scan(GSList *options)
54 {
55         struct drv_context *drvc;
56         struct dev_context *devc;
57         struct sr_dev_inst *sdi;
58         struct sr_config *src;
59         struct sr_channel *ch;
60         GSList *devices, *l;
61         const char *conn, *serialcomm;
62
63         drvc = di->priv;
64         drvc->instances = NULL;
65
66         devices = NULL;
67
68         conn = serialcomm = NULL;
69         for (l = options; l; l = l->next) {
70                 src = l->data;
71                 switch (src->key) {
72                 case SR_CONF_CONN:
73                         conn = g_variant_get_string(src->data, NULL);
74                         break;
75                 case SR_CONF_SERIALCOMM:
76                         serialcomm = g_variant_get_string(src->data, NULL);
77                         break;
78                 }
79         }
80         if (!conn)
81                 return NULL;
82         if (!serialcomm)
83                 serialcomm = SERIALCOMM;
84
85         sdi = g_malloc0(sizeof(struct sr_dev_inst));
86         sdi->status = SR_ST_INACTIVE;
87         sdi->vendor = g_strdup("Colead");
88         sdi->model = g_strdup("SL-5868P");
89         devc = g_malloc0(sizeof(struct dev_context));
90         sdi->conn = sr_serial_dev_inst_new(conn, serialcomm);
91         sdi->inst_type = SR_INST_SERIAL;
92         sdi->priv = devc;
93         sdi->driver = di;
94         ch = sr_channel_new(0, SR_CHANNEL_ANALOG, TRUE, "P1");
95         sdi->channels = g_slist_append(sdi->channels, ch);
96         drvc->instances = g_slist_append(drvc->instances, sdi);
97         devices = g_slist_append(devices, sdi);
98
99         return devices;
100 }
101
102 static GSList *dev_list(void)
103 {
104         return ((struct drv_context *)(di->priv))->instances;
105 }
106
107 static int dev_open(struct sr_dev_inst *sdi)
108 {
109         struct sr_serial_dev_inst *serial;
110
111         serial = sdi->conn;
112         if (serial_open(serial, SERIAL_RDWR) != SR_OK)
113                 return SR_ERR;
114
115         sdi->status = SR_ST_ACTIVE;
116
117         return SR_OK;
118 }
119
120 static int cleanup(void)
121 {
122         return std_dev_clear(di, NULL);
123 }
124
125 static int config_set(uint32_t key, GVariant *data, const struct sr_dev_inst *sdi,
126                 const struct sr_channel_group *cg)
127 {
128         struct dev_context *devc;
129
130         (void)cg;
131
132         if (sdi->status != SR_ST_ACTIVE)
133                 return SR_ERR_DEV_CLOSED;
134
135         if (!(devc = sdi->priv)) {
136                 sr_err("sdi->priv was NULL.");
137                 return SR_ERR_BUG;
138         }
139
140         switch (key) {
141         case SR_CONF_LIMIT_MSEC:
142                 /* TODO: not yet implemented */
143                 if (g_variant_get_uint64(data) == 0) {
144                         sr_err("LIMIT_MSEC can't be 0.");
145                         return SR_ERR;
146                 }
147                 devc->limit_msec = g_variant_get_uint64(data);;
148                 sr_dbg("Setting time limit to %" PRIu64 "ms.",
149                        devc->limit_msec);
150                 break;
151         case SR_CONF_LIMIT_SAMPLES:
152                 devc->limit_samples = g_variant_get_uint64(data);
153                 sr_dbg("Setting sample limit to %" PRIu64 ".",
154                        devc->limit_samples);
155                 break;
156         default:
157                 return SR_ERR_NA;
158         }
159
160         return SR_OK;
161 }
162
163 static int config_list(uint32_t key, GVariant **data, const struct sr_dev_inst *sdi,
164                 const struct sr_channel_group *cg)
165 {
166         (void)sdi;
167         (void)cg;
168
169         switch (key) {
170         case SR_CONF_SCAN_OPTIONS:
171                 *data = g_variant_new_fixed_array(G_VARIANT_TYPE_UINT32,
172                                 scanopts, ARRAY_SIZE(scanopts), sizeof(uint32_t));
173                 break;
174         case SR_CONF_DEVICE_OPTIONS:
175                 *data = g_variant_new_fixed_array(G_VARIANT_TYPE_UINT32,
176                                 devopts, ARRAY_SIZE(devopts), sizeof(uint32_t));
177                 break;
178         default:
179                 return SR_ERR_NA;
180         }
181
182         return SR_OK;
183 }
184
185 static int dev_acquisition_start(const struct sr_dev_inst *sdi, void *cb_data)
186 {
187         struct dev_context *devc;
188         struct sr_serial_dev_inst *serial;
189
190         if (sdi->status != SR_ST_ACTIVE)
191                 return SR_ERR_DEV_CLOSED;
192
193         if (!(devc = sdi->priv)) {
194                 sr_err("sdi->priv was NULL.");
195                 return SR_ERR_BUG;
196         }
197
198         devc->cb_data = cb_data;
199
200         /* Send header packet to the session bus. */
201         std_session_send_df_header(cb_data, LOG_PREFIX);
202
203         /* Poll every 150ms, or whenever some data comes in. */
204         serial = sdi->conn;
205         serial_source_add(sdi->session, serial, G_IO_IN, 150,
206                         colead_slm_receive_data, (void *)sdi);
207
208         return SR_OK;
209 }
210
211 static int dev_acquisition_stop(struct sr_dev_inst *sdi, void *cb_data)
212 {
213         return std_serial_dev_acquisition_stop(sdi, cb_data, std_serial_dev_close,
214                         sdi->conn, LOG_PREFIX);
215 }
216
217 SR_PRIV struct sr_dev_driver colead_slm_driver_info = {
218         .name = "colead-slm",
219         .longname = "Colead SLM",
220         .api_version = 1,
221         .init = init,
222         .cleanup = cleanup,
223         .scan = scan,
224         .dev_list = dev_list,
225         .dev_clear = NULL,
226         .config_get = NULL,
227         .config_set = config_set,
228         .config_list = config_list,
229         .dev_open = dev_open,
230         .dev_close = std_serial_dev_close,
231         .dev_acquisition_start = dev_acquisition_start,
232         .dev_acquisition_stop = dev_acquisition_stop,
233         .priv = NULL,
234 };