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