mcp3k.c revision 1.2.36.1 1 1.2.36.1 thorpej /* $NetBSD: mcp3k.c,v 1.2.36.1 2021/05/19 03:33:05 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.1 phx
246 1.2.36.1 thorpej /* configure for 1MHz */
247 1.2.36.1 thorpej if (spi_configure(sa->sa_handle, SPI_MODE_0, 1000000))
248 1.2.36.1 thorpej return 0;
249 1.2.36.1 thorpej }
250 1.1 phx
251 1.2.36.1 thorpej return rv;
252 1.1 phx }
253 1.1 phx
254 1.1 phx static void
255 1.1 phx mcp3kadc_attach(device_t parent, device_t self, void *aux)
256 1.1 phx {
257 1.1 phx const struct sysctlnode *rnode, *node;
258 1.2.36.1 thorpej struct spi_attach_args *sa = aux;
259 1.2.36.1 thorpej struct mcp3kadc_softc *sc = device_private(self);
260 1.2.36.1 thorpej const struct mcp3kadc_model *model;
261 1.1 phx int ch, i;
262 1.1 phx
263 1.1 phx sc->sc_dev = self;
264 1.1 phx sc->sc_sh = sa->sa_handle;
265 1.1 phx
266 1.2.36.1 thorpej model = mcp3kadc_lookup(sa, device_cfdata(self));
267 1.2.36.1 thorpej KASSERT(model != NULL);
268 1.2.36.1 thorpej
269 1.2.36.1 thorpej sc->sc_model = model;
270 1.1 phx
271 1.1 phx aprint_naive(": Analog to Digital converter\n");
272 1.1 phx aprint_normal(": MCP%u %u-channel %u-bit ADC\n",
273 1.1 phx (unsigned)model->name, (unsigned)model->channels,
274 1.1 phx (unsigned)model->bits);
275 1.1 phx
276 1.2.36.1 thorpej /*
277 1.2.36.1 thorpej * XXX Get vref-supply from device tree and make the sysctl
278 1.2.36.1 thorpej * XXX read-only in that case.
279 1.2.36.1 thorpej */
280 1.1 phx /* set a default Vref in mV according to the chip's ADC resolution */
281 1.1 phx sc->sc_vref_mv = 1 << ((model->flags & M3K_SIGNED) ?
282 1.1 phx model->bits - 1 : model->bits);
283 1.1 phx
284 1.1 phx /* remember maximum value for this ADC - also used for masking */
285 1.1 phx sc->sc_adc_max = (1 << model->bits) - 1;
286 1.1 phx
287 1.1 phx /* attach voltage sensors to envsys */
288 1.1 phx sc->sc_sme = sysmon_envsys_create();
289 1.1 phx
290 1.1 phx /* adc difference from two neighbouring channels */
291 1.1 phx for (ch = 0; ch < model->channels; ch++) {
292 1.1 phx KASSERT(ch < M3K_MAX_SENSORS);
293 1.1 phx sc->sc_sensors[ch].units = ENVSYS_SVOLTS_DC;
294 1.1 phx sc->sc_sensors[ch].state = ENVSYS_SINVALID;
295 1.1 phx if (model->channels == 1)
296 1.1 phx strlcpy(sc->sc_sensors[ch].desc, "adc diff ch0",
297 1.1 phx sizeof(sc->sc_sensors[ch].desc));
298 1.1 phx else
299 1.1 phx snprintf(sc->sc_sensors[ch].desc,
300 1.1 phx sizeof(sc->sc_sensors[ch].desc),
301 1.1 phx "adc diff ch%d-ch%d", ch, ch ^ 1);
302 1.1 phx sc->sc_sensors[ch].private = ch;
303 1.1 phx sysmon_envsys_sensor_attach(sc->sc_sme, &sc->sc_sensors[ch]);
304 1.1 phx }
305 1.1 phx
306 1.1 phx if (model->flags & M3K_SGLDIFF) {
307 1.1 phx /* adc from single ended channels */
308 1.1 phx for (i = 0; i < model->channels; i++, ch++) {
309 1.1 phx KASSERT(ch < M3K_MAX_SENSORS);
310 1.1 phx sc->sc_sensors[ch].units = ENVSYS_SVOLTS_DC;
311 1.1 phx sc->sc_sensors[ch].state = ENVSYS_SINVALID;
312 1.1 phx snprintf(sc->sc_sensors[ch].desc,
313 1.1 phx sizeof(sc->sc_sensors[ch].desc),
314 1.1 phx "adc single ch%d", i);
315 1.1 phx sc->sc_sensors[ch].private = ch;
316 1.1 phx sysmon_envsys_sensor_attach(sc->sc_sme,
317 1.1 phx &sc->sc_sensors[ch]);
318 1.1 phx }
319 1.1 phx }
320 1.1 phx
321 1.1 phx sc->sc_sme->sme_name = device_xname(self);
322 1.1 phx sc->sc_sme->sme_refresh = mcp3kadc_envsys_refresh;
323 1.1 phx sc->sc_sme->sme_cookie = sc;
324 1.1 phx if (sysmon_envsys_register(sc->sc_sme)) {
325 1.1 phx aprint_error_dev(self, "unable to register with sysmon\n");
326 1.1 phx sysmon_envsys_destroy(sc->sc_sme);
327 1.1 phx }
328 1.1 phx
329 1.1 phx /* create a sysctl node for adjusting the ADC's reference voltage */
330 1.1 phx rnode = node = NULL;
331 1.1 phx sysctl_createv(NULL, 0, NULL, &rnode,
332 1.1 phx CTLFLAG_READWRITE,
333 1.1 phx CTLTYPE_NODE, device_xname(sc->sc_dev), NULL,
334 1.1 phx NULL, 0, NULL, 0,
335 1.1 phx CTL_HW, CTL_CREATE, CTL_EOL);
336 1.1 phx
337 1.1 phx if (rnode != NULL)
338 1.1 phx sysctl_createv(NULL, 0, NULL, &node,
339 1.1 phx CTLFLAG_READWRITE | CTLFLAG_OWNDESC,
340 1.1 phx CTLTYPE_INT, "vref",
341 1.1 phx SYSCTL_DESCR("ADC reference voltage"),
342 1.1 phx sysctl_mcp3kadc_vref, 0, (void *)sc, 0,
343 1.1 phx CTL_HW, rnode->sysctl_num, CTL_CREATE, CTL_EOL);
344 1.1 phx }
345 1.1 phx
346 1.1 phx static void
347 1.1 phx mcp3kadc_envsys_refresh(struct sysmon_envsys *sme, envsys_data_t *edata)
348 1.1 phx {
349 1.1 phx struct mcp3kadc_softc *sc;
350 1.2.36.1 thorpej const struct mcp3kadc_model *model;
351 1.1 phx uint8_t buf[2], ctrl;
352 1.1 phx int32_t val, scale;
353 1.1 phx
354 1.1 phx sc = sme->sme_cookie;
355 1.2.36.1 thorpej model = sc->sc_model;
356 1.1 phx scale = sc->sc_adc_max + 1;
357 1.1 phx
358 1.1 phx if (model->flags & M3K_CTRL_NEEDED) {
359 1.1 phx /* we need to send some control bits first */
360 1.1 phx ctrl = 1; /* start bit */
361 1.1 phx
362 1.1 phx if (model->flags & M3K_SGLDIFF) {
363 1.1 phx /* bit set to select single-ended mode */
364 1.1 phx ctrl <<= 1;
365 1.1 phx ctrl |= edata->private >= model->channels;
366 1.1 phx }
367 1.1 phx
368 1.1 phx if (model->flags & M3K_D2D1D0) {
369 1.1 phx /* 3 bits select the channel */
370 1.1 phx ctrl <<= 3;
371 1.1 phx ctrl |= edata->private & (model->channels - 1);
372 1.1 phx } else {
373 1.1 phx /* 1 bit selects between two channels */
374 1.1 phx ctrl <<= 1;
375 1.1 phx ctrl |= edata->private & 1;
376 1.1 phx }
377 1.1 phx
378 1.1 phx if (model->flags & M3K_MSBF) {
379 1.1 phx /* bit select MSB first format */
380 1.1 phx ctrl <<= 1;
381 1.1 phx ctrl |= 1;
382 1.1 phx }
383 1.1 phx
384 1.1 phx /* send control bits, receive ADC data */
385 1.1 phx if (spi_send_recv(sc->sc_sh, 1, &ctrl, 2, buf) != 0) {
386 1.1 phx edata->state = ENVSYS_SINVALID;
387 1.1 phx return;
388 1.1 phx }
389 1.1 phx } else {
390 1.1 phx
391 1.1 phx /* just read data from the ADC */
392 1.1 phx if (spi_recv(sc->sc_sh, 2, buf) != 0) {
393 1.1 phx edata->state = ENVSYS_SINVALID;
394 1.1 phx return;
395 1.1 phx }
396 1.1 phx }
397 1.1 phx
398 1.1 phx /* extract big-endian ADC data from buffer */
399 1.1 phx val = (buf[0] << 8) | buf[1];
400 1.1 phx val = (val >> (16 - (model->bits + model->lead))) & sc->sc_adc_max;
401 1.1 phx
402 1.1 phx /* sign-extend the result, when needed */
403 1.1 phx if (model->flags & M3K_SIGNED) {
404 1.1 phx if (val & (1 << (model->bits - 1)))
405 1.1 phx val -= sc->sc_adc_max + 1;
406 1.1 phx scale >>= 1; /* MSB is the sign */
407 1.1 phx }
408 1.1 phx
409 1.1 phx /* scale the value for Vref and convert to mV */
410 1.1 phx edata->value_cur = (sc->sc_vref_mv * val / scale) * 1000;
411 1.1 phx edata->state = ENVSYS_SVALID;
412 1.1 phx }
413 1.1 phx
414 1.1 phx static int
415 1.1 phx sysctl_mcp3kadc_vref(SYSCTLFN_ARGS)
416 1.1 phx {
417 1.1 phx struct sysctlnode node;
418 1.1 phx struct mcp3kadc_softc *sc;
419 1.1 phx int32_t t;
420 1.1 phx int error;
421 1.1 phx
422 1.1 phx node = *rnode;
423 1.1 phx sc = node.sysctl_data;
424 1.1 phx
425 1.1 phx t = sc->sc_vref_mv;
426 1.1 phx node.sysctl_data = &t;
427 1.1 phx
428 1.1 phx error = sysctl_lookup(SYSCTLFN_CALL(&node));
429 1.1 phx if (error || newp == NULL)
430 1.1 phx return error;
431 1.1 phx if (t <= 0)
432 1.1 phx return EINVAL;
433 1.1 phx
434 1.1 phx sc->sc_vref_mv = t;
435 1.1 phx return 0;
436 1.1 phx }
437