mcp3k.c revision 1.2.36.2 1 1.2.36.2 thorpej /* $NetBSD: mcp3k.c,v 1.2.36.2 2021/05/19 03:46:26 thorpej Exp $ */
2 1.1 phx
3 1.1 phx /*-
4 1.1 phx * Copyright (c) 2015 The NetBSD Foundation, Inc.
5 1.1 phx * All rights reserved.
6 1.1 phx *
7 1.1 phx * This code is derived from software contributed to The NetBSD Foundation
8 1.1 phx * by Frank Wille.
9 1.1 phx *
10 1.1 phx * Redistribution and use in source and binary forms, with or without
11 1.1 phx * modification, are permitted provided that the following conditions
12 1.1 phx * are met:
13 1.1 phx * 1. Redistributions of source code must retain the above copyright
14 1.1 phx * notice, this list of conditions and the following disclaimer.
15 1.1 phx * 2. Redistributions in binary form must reproduce the above copyright
16 1.1 phx * notice, this list of conditions and the following disclaimer in the
17 1.1 phx * documentation and/or other materials provided with the distribution.
18 1.1 phx *
19 1.1 phx * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
20 1.1 phx * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
21 1.1 phx * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
22 1.1 phx * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
23 1.1 phx * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
24 1.1 phx * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
25 1.1 phx * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
26 1.1 phx * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
27 1.1 phx * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
28 1.1 phx * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
29 1.1 phx * POSSIBILITY OF SUCH DAMAGE.
30 1.1 phx */
31 1.1 phx
32 1.1 phx /*
33 1.1 phx * Microchip MCP3x0x SAR analog to digital converters.
34 1.1 phx * The driver supports various ADCs with different resolutions, operation
35 1.1 phx * modes and number of input channels.
36 1.1 phx * The reference voltage Vref defaults to the maximum output value in mV,
37 1.1 phx * but can be changed via sysctl(3).
38 1.1 phx *
39 1.1 phx * MCP3001: http://ww1.microchip.com/downloads/en/DeviceDoc/21293C.pdf
40 1.1 phx * MCP3002: http://ww1.microchip.com/downloads/en/DeviceDoc/21294E.pdf
41 1.1 phx * MCP3004/3008: http://ww1.microchip.com/downloads/en/DeviceDoc/21295C.pdf
42 1.1 phx * MCP3201: http://ww1.microchip.com/downloads/en/DeviceDoc/21290D.pdf
43 1.1 phx * MCP3204/3208: http://ww1.microchip.com/downloads/en/DeviceDoc/21298c.pdf
44 1.1 phx * MCP3301: http://ww1.microchip.com/downloads/en/DeviceDoc/21700E.pdf
45 1.1 phx * MPC3302/3304: http://ww1.microchip.com/downloads/en/DeviceDoc/21697F.pdf
46 1.1 phx */
47 1.1 phx
48 1.1 phx #include <sys/param.h>
49 1.1 phx #include <sys/systm.h>
50 1.1 phx #include <sys/device.h>
51 1.1 phx #include <sys/kernel.h>
52 1.1 phx #include <sys/types.h>
53 1.1 phx #include <sys/sysctl.h>
54 1.1 phx
55 1.1 phx #include <dev/sysmon/sysmonvar.h>
56 1.1 phx #include <dev/spi/spivar.h>
57 1.1 phx
58 1.1 phx #define M3K_MAX_SENSORS 16 /* 8 single-ended & 8 diff. */
59 1.1 phx
60 1.1 phx /* mcp3x0x model description */
61 1.1 phx struct mcp3kadc_model {
62 1.1 phx uint32_t name;
63 1.1 phx uint8_t bits;
64 1.1 phx uint8_t channels;
65 1.1 phx uint8_t lead; /* leading bits to ignore */
66 1.1 phx uint8_t flags;
67 1.1 phx #define M3K_SGLDIFF 0x01 /* single-ended/differential */
68 1.1 phx #define M3K_D2D1D0 0x02 /* 3 channel select bits */
69 1.1 phx #define M3K_MSBF 0x04 /* MSBF select bit */
70 1.1 phx #define M3K_SIGNED 0x80 /* result is signed */
71 1.1 phx #define M3K_CTRL_NEEDED (M3K_SGLDIFF | M3K_D2D1D0 | M3K_MSBF)
72 1.1 phx };
73 1.1 phx
74 1.1 phx struct mcp3kadc_softc {
75 1.2.36.1 thorpej device_t sc_dev;
76 1.2.36.1 thorpej struct spi_handle *sc_sh;
77 1.2.36.1 thorpej const struct mcp3kadc_model *sc_model;
78 1.2.36.1 thorpej uint32_t sc_adc_max;
79 1.2.36.1 thorpej int32_t sc_vref_mv;
80 1.1 phx
81 1.2.36.1 thorpej struct sysmon_envsys *sc_sme;
82 1.2.36.1 thorpej envsys_data_t sc_sensors[M3K_MAX_SENSORS];
83 1.1 phx };
84 1.1 phx
85 1.1 phx static int mcp3kadc_match(device_t, cfdata_t, void *);
86 1.1 phx static void mcp3kadc_attach(device_t, device_t, void *);
87 1.1 phx static void mcp3kadc_envsys_refresh(struct sysmon_envsys *,
88 1.1 phx envsys_data_t *);
89 1.1 phx static int sysctl_mcp3kadc_vref(SYSCTLFN_ARGS);
90 1.1 phx
91 1.1 phx CFATTACH_DECL_NEW(mcp3kadc, sizeof(struct mcp3kadc_softc),
92 1.1 phx mcp3kadc_match, mcp3kadc_attach, NULL, NULL);
93 1.1 phx
94 1.2.36.1 thorpej static const struct mcp3kadc_model mcp3001 = {
95 1.2.36.1 thorpej .name = 3001,
96 1.2.36.1 thorpej .bits = 10,
97 1.2.36.1 thorpej .channels = 1,
98 1.2.36.1 thorpej .lead = 3,
99 1.2.36.1 thorpej .flags = 0
100 1.1 phx };
101 1.1 phx
102 1.2.36.1 thorpej static const struct mcp3kadc_model mcp3002 = {
103 1.2.36.1 thorpej .name = 3002,
104 1.2.36.1 thorpej .bits = 10,
105 1.2.36.1 thorpej .channels = 2,
106 1.2.36.1 thorpej .lead = 2,
107 1.2.36.1 thorpej .flags = M3K_SGLDIFF | M3K_MSBF
108 1.2.36.1 thorpej };
109 1.2.36.1 thorpej
110 1.2.36.1 thorpej static const struct mcp3kadc_model mcp3004 = {
111 1.2.36.1 thorpej .name = 3004,
112 1.2.36.1 thorpej .bits = 10,
113 1.2.36.1 thorpej .channels = 4,
114 1.2.36.1 thorpej .lead = 2,
115 1.2.36.1 thorpej .flags = M3K_SGLDIFF | M3K_D2D1D0
116 1.2.36.1 thorpej };
117 1.2.36.1 thorpej
118 1.2.36.1 thorpej static const struct mcp3kadc_model mcp3008 = {
119 1.2.36.1 thorpej .name = 3008,
120 1.2.36.1 thorpej .bits = 10,
121 1.2.36.1 thorpej .channels = 8,
122 1.2.36.1 thorpej .lead = 2,
123 1.2.36.1 thorpej .flags = M3K_SGLDIFF | M3K_D2D1D0
124 1.2.36.1 thorpej };
125 1.2.36.1 thorpej
126 1.2.36.1 thorpej static const struct mcp3kadc_model mcp3201 = {
127 1.2.36.1 thorpej .name = 3201,
128 1.2.36.1 thorpej .bits = 12,
129 1.2.36.1 thorpej .channels = 1,
130 1.2.36.1 thorpej .lead = 3,
131 1.2.36.1 thorpej .flags = 0
132 1.2.36.1 thorpej };
133 1.2.36.1 thorpej
134 1.2.36.1 thorpej static const struct mcp3kadc_model mcp3202 = {
135 1.2.36.1 thorpej .name = 3202,
136 1.2.36.1 thorpej .bits = 12,
137 1.2.36.1 thorpej .channels = 2,
138 1.2.36.1 thorpej .lead = 2,
139 1.2.36.1 thorpej .flags = M3K_SGLDIFF | M3K_MSBF
140 1.2.36.1 thorpej };
141 1.2.36.1 thorpej
142 1.2.36.1 thorpej static const struct mcp3kadc_model mcp3204 = {
143 1.2.36.1 thorpej .name = 3204,
144 1.2.36.1 thorpej .bits = 12,
145 1.2.36.1 thorpej .channels = 4,
146 1.2.36.1 thorpej .lead = 2,
147 1.2.36.1 thorpej .flags = M3K_SGLDIFF | M3K_D2D1D0
148 1.2.36.1 thorpej };
149 1.2.36.1 thorpej
150 1.2.36.1 thorpej static const struct mcp3kadc_model mcp3208 = {
151 1.2.36.1 thorpej .name = 3208,
152 1.2.36.1 thorpej .bits = 12,
153 1.2.36.1 thorpej .channels = 8,
154 1.2.36.1 thorpej .lead = 2,
155 1.2.36.1 thorpej .flags = M3K_SGLDIFF | M3K_D2D1D0
156 1.2.36.1 thorpej };
157 1.2.36.1 thorpej
158 1.2.36.1 thorpej static const struct mcp3kadc_model mcp3301 = {
159 1.2.36.1 thorpej .name = 3301,
160 1.2.36.1 thorpej .bits = 13,
161 1.2.36.1 thorpej .channels = 1,
162 1.2.36.1 thorpej .lead = 3,
163 1.2.36.1 thorpej .flags = M3K_SIGNED
164 1.2.36.1 thorpej };
165 1.2.36.1 thorpej
166 1.2.36.1 thorpej static const struct mcp3kadc_model mcp3302 = {
167 1.2.36.1 thorpej .name = 3302,
168 1.2.36.1 thorpej .bits = 13,
169 1.2.36.1 thorpej .channels = 4,
170 1.2.36.1 thorpej .lead = 2,
171 1.2.36.1 thorpej .flags = M3K_SIGNED | M3K_SGLDIFF | M3K_D2D1D0
172 1.2.36.1 thorpej };
173 1.2.36.1 thorpej
174 1.2.36.1 thorpej static const struct mcp3kadc_model mcp3304 = {
175 1.2.36.1 thorpej .name = 3304,
176 1.2.36.1 thorpej .bits = 13,
177 1.2.36.1 thorpej .channels = 8,
178 1.2.36.1 thorpej .lead = 2,
179 1.2.36.1 thorpej .flags = M3K_SIGNED | M3K_SGLDIFF | M3K_D2D1D0
180 1.2.36.1 thorpej };
181 1.2.36.1 thorpej
182 1.2.36.1 thorpej static const struct device_compatible_entry compat_data[] = {
183 1.2.36.1 thorpej { .compat = "microchip,mcp3001", .data = &mcp3001 },
184 1.2.36.1 thorpej { .compat = "microchip,mcp3002", .data = &mcp3002 },
185 1.2.36.1 thorpej { .compat = "microchip,mcp3004", .data = &mcp3004 },
186 1.2.36.1 thorpej { .compat = "microchip,mcp3008", .data = &mcp3008 },
187 1.2.36.1 thorpej { .compat = "microchip,mcp3201", .data = &mcp3201 },
188 1.2.36.1 thorpej { .compat = "microchip,mcp3202", .data = &mcp3202 },
189 1.2.36.1 thorpej { .compat = "microchip,mcp3204", .data = &mcp3204 },
190 1.2.36.1 thorpej { .compat = "microchip,mcp3208", .data = &mcp3208 },
191 1.2.36.1 thorpej { .compat = "microchip,mcp3301", .data = &mcp3301 },
192 1.2.36.1 thorpej { .compat = "microchip,mcp3302", .data = &mcp3302 },
193 1.2.36.1 thorpej { .compat = "microchip,mcp3304", .data = &mcp3304 },
194 1.2.36.1 thorpej
195 1.2.36.1 thorpej #if 0 /* We should also add support for these: */
196 1.2.36.1 thorpej { .compat = "microchip,mcp3550-50" },
197 1.2.36.1 thorpej { .compat = "microchip,mcp3550-60" },
198 1.2.36.1 thorpej { .compat = "microchip,mcp3551" },
199 1.2.36.1 thorpej { .compat = "microchip,mcp3553" },
200 1.2.36.1 thorpej #endif
201 1.2.36.1 thorpej
202 1.2.36.1 thorpej DEVICE_COMPAT_EOL
203 1.2.36.1 thorpej };
204 1.2.36.1 thorpej
205 1.2.36.1 thorpej static const struct mcp3kadc_model *
206 1.2.36.1 thorpej mcp3kadc_lookup(const struct spi_attach_args *sa, const cfdata_t cf)
207 1.2.36.1 thorpej {
208 1.2.36.1 thorpej const struct device_compatible_entry *dce;
209 1.2.36.1 thorpej
210 1.2.36.1 thorpej if (sa->sa_clist != NULL) {
211 1.2.36.1 thorpej dce = device_compatible_lookup_strlist(sa->sa_clist,
212 1.2.36.1 thorpej sa->sa_clist_size, compat_data);
213 1.2.36.1 thorpej if (dce == NULL) {
214 1.2.36.1 thorpej return NULL;
215 1.2.36.1 thorpej }
216 1.2.36.1 thorpej return dce->data;
217 1.2.36.1 thorpej } else {
218 1.2.36.1 thorpej const struct mcp3kadc_model *model;
219 1.2.36.1 thorpej
220 1.2.36.1 thorpej for (dce = compat_data; dce->compat != NULL; dce++) {
221 1.2.36.1 thorpej model = dce->data;
222 1.2.36.1 thorpej if (model->name == cf->cf_flags) {
223 1.2.36.1 thorpej return model;
224 1.2.36.1 thorpej }
225 1.2.36.1 thorpej }
226 1.2.36.1 thorpej return NULL;
227 1.2.36.1 thorpej }
228 1.2.36.1 thorpej }
229 1.2.36.1 thorpej
230 1.1 phx static int
231 1.1 phx mcp3kadc_match(device_t parent, cfdata_t cf, void *aux)
232 1.1 phx {
233 1.1 phx struct spi_attach_args *sa = aux;
234 1.2.36.1 thorpej int rv;
235 1.1 phx
236 1.2.36.1 thorpej rv = spi_compatible_match(sa, cf, compat_data);
237 1.2.36.1 thorpej if (rv != 0) {
238 1.2.36.1 thorpej /*
239 1.2.36.1 thorpej * If we're doing indirect config, the user must
240 1.2.36.1 thorpej * have specified the correct model.
241 1.2.36.1 thorpej */
242 1.2.36.1 thorpej if (sa->sa_clist == NULL && mcp3kadc_lookup(sa, cf) == NULL) {
243 1.2.36.1 thorpej return 0;
244 1.2.36.1 thorpej }
245 1.2.36.1 thorpej }
246 1.1 phx
247 1.2.36.1 thorpej return rv;
248 1.1 phx }
249 1.1 phx
250 1.1 phx static void
251 1.1 phx mcp3kadc_attach(device_t parent, device_t self, void *aux)
252 1.1 phx {
253 1.1 phx const struct sysctlnode *rnode, *node;
254 1.2.36.1 thorpej struct spi_attach_args *sa = aux;
255 1.2.36.1 thorpej struct mcp3kadc_softc *sc = device_private(self);
256 1.2.36.1 thorpej const struct mcp3kadc_model *model;
257 1.2.36.2 thorpej int ch, i, error;
258 1.1 phx
259 1.1 phx sc->sc_dev = self;
260 1.1 phx sc->sc_sh = sa->sa_handle;
261 1.1 phx
262 1.2.36.1 thorpej model = mcp3kadc_lookup(sa, device_cfdata(self));
263 1.2.36.1 thorpej KASSERT(model != NULL);
264 1.2.36.1 thorpej
265 1.2.36.1 thorpej sc->sc_model = model;
266 1.1 phx
267 1.1 phx aprint_naive(": Analog to Digital converter\n");
268 1.1 phx aprint_normal(": MCP%u %u-channel %u-bit ADC\n",
269 1.1 phx (unsigned)model->name, (unsigned)model->channels,
270 1.1 phx (unsigned)model->bits);
271 1.1 phx
272 1.2.36.2 thorpej /* configure for 1MHz */
273 1.2.36.2 thorpej error = spi_configure(sa->sa_handle, SPI_MODE_0, 1000000);
274 1.2.36.2 thorpej if (error) {
275 1.2.36.2 thorpej aprint_error_dev(self, "spi_configure failed (error = %d)\n",
276 1.2.36.2 thorpej error);
277 1.2.36.2 thorpej return;
278 1.2.36.2 thorpej }
279 1.2.36.2 thorpej
280 1.2.36.1 thorpej /*
281 1.2.36.1 thorpej * XXX Get vref-supply from device tree and make the sysctl
282 1.2.36.1 thorpej * XXX read-only in that case.
283 1.2.36.1 thorpej */
284 1.1 phx /* set a default Vref in mV according to the chip's ADC resolution */
285 1.1 phx sc->sc_vref_mv = 1 << ((model->flags & M3K_SIGNED) ?
286 1.1 phx model->bits - 1 : model->bits);
287 1.1 phx
288 1.1 phx /* remember maximum value for this ADC - also used for masking */
289 1.1 phx sc->sc_adc_max = (1 << model->bits) - 1;
290 1.1 phx
291 1.1 phx /* attach voltage sensors to envsys */
292 1.1 phx sc->sc_sme = sysmon_envsys_create();
293 1.1 phx
294 1.1 phx /* adc difference from two neighbouring channels */
295 1.1 phx for (ch = 0; ch < model->channels; ch++) {
296 1.1 phx KASSERT(ch < M3K_MAX_SENSORS);
297 1.1 phx sc->sc_sensors[ch].units = ENVSYS_SVOLTS_DC;
298 1.1 phx sc->sc_sensors[ch].state = ENVSYS_SINVALID;
299 1.1 phx if (model->channels == 1)
300 1.1 phx strlcpy(sc->sc_sensors[ch].desc, "adc diff ch0",
301 1.1 phx sizeof(sc->sc_sensors[ch].desc));
302 1.1 phx else
303 1.1 phx snprintf(sc->sc_sensors[ch].desc,
304 1.1 phx sizeof(sc->sc_sensors[ch].desc),
305 1.1 phx "adc diff ch%d-ch%d", ch, ch ^ 1);
306 1.1 phx sc->sc_sensors[ch].private = ch;
307 1.1 phx sysmon_envsys_sensor_attach(sc->sc_sme, &sc->sc_sensors[ch]);
308 1.1 phx }
309 1.1 phx
310 1.1 phx if (model->flags & M3K_SGLDIFF) {
311 1.1 phx /* adc from single ended channels */
312 1.1 phx for (i = 0; i < model->channels; i++, ch++) {
313 1.1 phx KASSERT(ch < M3K_MAX_SENSORS);
314 1.1 phx sc->sc_sensors[ch].units = ENVSYS_SVOLTS_DC;
315 1.1 phx sc->sc_sensors[ch].state = ENVSYS_SINVALID;
316 1.1 phx snprintf(sc->sc_sensors[ch].desc,
317 1.1 phx sizeof(sc->sc_sensors[ch].desc),
318 1.1 phx "adc single ch%d", i);
319 1.1 phx sc->sc_sensors[ch].private = ch;
320 1.1 phx sysmon_envsys_sensor_attach(sc->sc_sme,
321 1.1 phx &sc->sc_sensors[ch]);
322 1.1 phx }
323 1.1 phx }
324 1.1 phx
325 1.1 phx sc->sc_sme->sme_name = device_xname(self);
326 1.1 phx sc->sc_sme->sme_refresh = mcp3kadc_envsys_refresh;
327 1.1 phx sc->sc_sme->sme_cookie = sc;
328 1.1 phx if (sysmon_envsys_register(sc->sc_sme)) {
329 1.1 phx aprint_error_dev(self, "unable to register with sysmon\n");
330 1.1 phx sysmon_envsys_destroy(sc->sc_sme);
331 1.1 phx }
332 1.1 phx
333 1.1 phx /* create a sysctl node for adjusting the ADC's reference voltage */
334 1.1 phx rnode = node = NULL;
335 1.1 phx sysctl_createv(NULL, 0, NULL, &rnode,
336 1.1 phx CTLFLAG_READWRITE,
337 1.1 phx CTLTYPE_NODE, device_xname(sc->sc_dev), NULL,
338 1.1 phx NULL, 0, NULL, 0,
339 1.1 phx CTL_HW, CTL_CREATE, CTL_EOL);
340 1.1 phx
341 1.1 phx if (rnode != NULL)
342 1.1 phx sysctl_createv(NULL, 0, NULL, &node,
343 1.1 phx CTLFLAG_READWRITE | CTLFLAG_OWNDESC,
344 1.1 phx CTLTYPE_INT, "vref",
345 1.1 phx SYSCTL_DESCR("ADC reference voltage"),
346 1.1 phx sysctl_mcp3kadc_vref, 0, (void *)sc, 0,
347 1.1 phx CTL_HW, rnode->sysctl_num, CTL_CREATE, CTL_EOL);
348 1.1 phx }
349 1.1 phx
350 1.1 phx static void
351 1.1 phx mcp3kadc_envsys_refresh(struct sysmon_envsys *sme, envsys_data_t *edata)
352 1.1 phx {
353 1.1 phx struct mcp3kadc_softc *sc;
354 1.2.36.1 thorpej const struct mcp3kadc_model *model;
355 1.1 phx uint8_t buf[2], ctrl;
356 1.1 phx int32_t val, scale;
357 1.1 phx
358 1.1 phx sc = sme->sme_cookie;
359 1.2.36.1 thorpej model = sc->sc_model;
360 1.1 phx scale = sc->sc_adc_max + 1;
361 1.1 phx
362 1.1 phx if (model->flags & M3K_CTRL_NEEDED) {
363 1.1 phx /* we need to send some control bits first */
364 1.1 phx ctrl = 1; /* start bit */
365 1.1 phx
366 1.1 phx if (model->flags & M3K_SGLDIFF) {
367 1.1 phx /* bit set to select single-ended mode */
368 1.1 phx ctrl <<= 1;
369 1.1 phx ctrl |= edata->private >= model->channels;
370 1.1 phx }
371 1.1 phx
372 1.1 phx if (model->flags & M3K_D2D1D0) {
373 1.1 phx /* 3 bits select the channel */
374 1.1 phx ctrl <<= 3;
375 1.1 phx ctrl |= edata->private & (model->channels - 1);
376 1.1 phx } else {
377 1.1 phx /* 1 bit selects between two channels */
378 1.1 phx ctrl <<= 1;
379 1.1 phx ctrl |= edata->private & 1;
380 1.1 phx }
381 1.1 phx
382 1.1 phx if (model->flags & M3K_MSBF) {
383 1.1 phx /* bit select MSB first format */
384 1.1 phx ctrl <<= 1;
385 1.1 phx ctrl |= 1;
386 1.1 phx }
387 1.1 phx
388 1.1 phx /* send control bits, receive ADC data */
389 1.1 phx if (spi_send_recv(sc->sc_sh, 1, &ctrl, 2, buf) != 0) {
390 1.1 phx edata->state = ENVSYS_SINVALID;
391 1.1 phx return;
392 1.1 phx }
393 1.1 phx } else {
394 1.1 phx
395 1.1 phx /* just read data from the ADC */
396 1.1 phx if (spi_recv(sc->sc_sh, 2, buf) != 0) {
397 1.1 phx edata->state = ENVSYS_SINVALID;
398 1.1 phx return;
399 1.1 phx }
400 1.1 phx }
401 1.1 phx
402 1.1 phx /* extract big-endian ADC data from buffer */
403 1.1 phx val = (buf[0] << 8) | buf[1];
404 1.1 phx val = (val >> (16 - (model->bits + model->lead))) & sc->sc_adc_max;
405 1.1 phx
406 1.1 phx /* sign-extend the result, when needed */
407 1.1 phx if (model->flags & M3K_SIGNED) {
408 1.1 phx if (val & (1 << (model->bits - 1)))
409 1.1 phx val -= sc->sc_adc_max + 1;
410 1.1 phx scale >>= 1; /* MSB is the sign */
411 1.1 phx }
412 1.1 phx
413 1.1 phx /* scale the value for Vref and convert to mV */
414 1.1 phx edata->value_cur = (sc->sc_vref_mv * val / scale) * 1000;
415 1.1 phx edata->state = ENVSYS_SVALID;
416 1.1 phx }
417 1.1 phx
418 1.1 phx static int
419 1.1 phx sysctl_mcp3kadc_vref(SYSCTLFN_ARGS)
420 1.1 phx {
421 1.1 phx struct sysctlnode node;
422 1.1 phx struct mcp3kadc_softc *sc;
423 1.1 phx int32_t t;
424 1.1 phx int error;
425 1.1 phx
426 1.1 phx node = *rnode;
427 1.1 phx sc = node.sysctl_data;
428 1.1 phx
429 1.1 phx t = sc->sc_vref_mv;
430 1.1 phx node.sysctl_data = &t;
431 1.1 phx
432 1.1 phx error = sysctl_lookup(SYSCTLFN_CALL(&node));
433 1.1 phx if (error || newp == NULL)
434 1.1 phx return error;
435 1.1 phx if (t <= 0)
436 1.1 phx return EINVAL;
437 1.1 phx
438 1.1 phx sc->sc_vref_mv = t;
439 1.1 phx return 0;
440 1.1 phx }
441