irframe.c revision 1.12 1 1.12 augustss /* $NetBSD: irframe.c,v 1.12 2001/12/13 17:15:09 augustss Exp $ */
2 1.1 augustss
3 1.1 augustss /*
4 1.1 augustss * Copyright (c) 2001 The NetBSD Foundation, Inc.
5 1.1 augustss * All rights reserved.
6 1.1 augustss *
7 1.1 augustss * This code is derived from software contributed to The NetBSD Foundation
8 1.1 augustss * by Lennart Augustsson (lennart (at) augustsson.net).
9 1.1 augustss *
10 1.1 augustss * Redistribution and use in source and binary forms, with or without
11 1.1 augustss * modification, are permitted provided that the following conditions
12 1.1 augustss * are met:
13 1.1 augustss * 1. Redistributions of source code must retain the above copyright
14 1.1 augustss * notice, this list of conditions and the following disclaimer.
15 1.1 augustss * 2. Redistributions in binary form must reproduce the above copyright
16 1.1 augustss * notice, this list of conditions and the following disclaimer in the
17 1.1 augustss * documentation and/or other materials provided with the distribution.
18 1.1 augustss * 3. All advertising materials mentioning features or use of this software
19 1.1 augustss * must display the following acknowledgement:
20 1.1 augustss * This product includes software developed by the NetBSD
21 1.1 augustss * Foundation, Inc. and its contributors.
22 1.1 augustss * 4. Neither the name of The NetBSD Foundation nor the names of its
23 1.1 augustss * contributors may be used to endorse or promote products derived
24 1.1 augustss * from this software without specific prior written permission.
25 1.1 augustss *
26 1.1 augustss * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
27 1.1 augustss * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
28 1.1 augustss * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
29 1.1 augustss * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
30 1.1 augustss * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
31 1.1 augustss * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
32 1.1 augustss * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
33 1.1 augustss * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
34 1.1 augustss * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
35 1.1 augustss * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
36 1.1 augustss * POSSIBILITY OF SUCH DAMAGE.
37 1.1 augustss */
38 1.1 augustss
39 1.4 augustss #include "irframe.h"
40 1.4 augustss
41 1.1 augustss #include <sys/param.h>
42 1.1 augustss #include <sys/systm.h>
43 1.1 augustss #include <sys/ioctl.h>
44 1.1 augustss #include <sys/kernel.h>
45 1.1 augustss #include <sys/device.h>
46 1.1 augustss #include <sys/conf.h>
47 1.1 augustss #include <sys/malloc.h>
48 1.1 augustss #include <sys/poll.h>
49 1.1 augustss #include <sys/select.h>
50 1.1 augustss #include <sys/vnode.h>
51 1.1 augustss
52 1.1 augustss #include <dev/ir/ir.h>
53 1.1 augustss #include <dev/ir/irdaio.h>
54 1.1 augustss #include <dev/ir/irframevar.h>
55 1.1 augustss
56 1.12 augustss #ifdef IRFRAME_DEBUG
57 1.12 augustss #define DPRINTF(x) if (irframedebug) printf x
58 1.12 augustss #define Static
59 1.12 augustss int irframedebug = 0;
60 1.12 augustss #else
61 1.12 augustss #define DPRINTF(x)
62 1.12 augustss #define Static static
63 1.12 augustss #endif
64 1.12 augustss
65 1.1 augustss cdev_decl(irframe);
66 1.1 augustss
67 1.1 augustss int irframe_match(struct device *parent, struct cfdata *match, void *aux);
68 1.1 augustss void irframe_attach(struct device *parent, struct device *self, void *aux);
69 1.1 augustss int irframe_activate(struct device *self, enum devact act);
70 1.1 augustss int irframe_detach(struct device *self, int flags);
71 1.1 augustss
72 1.12 augustss Static int irf_reset_params(struct irframe_softc *sc);
73 1.6 augustss
74 1.4 augustss #if NIRFRAME == 0
75 1.4 augustss /* In case we just have tty attachment. */
76 1.4 augustss struct cfdriver irframe_cd = {
77 1.4 augustss NULL, "irframe", DV_DULL
78 1.4 augustss };
79 1.4 augustss #endif
80 1.4 augustss
81 1.1 augustss struct cfattach irframe_ca = {
82 1.1 augustss sizeof(struct irframe_softc), irframe_match, irframe_attach,
83 1.1 augustss irframe_detach, irframe_activate
84 1.1 augustss };
85 1.1 augustss
86 1.1 augustss extern struct cfattach irframe_ca;
87 1.1 augustss extern struct cfdriver irframe_cd;
88 1.1 augustss
89 1.1 augustss #define IRFRAMEUNIT(dev) (minor(dev))
90 1.1 augustss
91 1.1 augustss int
92 1.1 augustss irframe_match(struct device *parent, struct cfdata *match, void *aux)
93 1.1 augustss {
94 1.1 augustss struct ir_attach_args *ia = aux;
95 1.1 augustss
96 1.1 augustss return (ia->ia_type == IR_TYPE_IRFRAME);
97 1.1 augustss }
98 1.1 augustss
99 1.1 augustss void
100 1.1 augustss irframe_attach(struct device *parent, struct device *self, void *aux)
101 1.1 augustss {
102 1.1 augustss struct irframe_softc *sc = (struct irframe_softc *)self;
103 1.1 augustss struct ir_attach_args *ia = aux;
104 1.1 augustss const char *delim;
105 1.1 augustss int speeds = 0;
106 1.1 augustss
107 1.1 augustss sc->sc_methods = ia->ia_methods;
108 1.1 augustss sc->sc_handle = ia->ia_handle;
109 1.1 augustss
110 1.1 augustss #ifdef DIAGNOSTIC
111 1.1 augustss if (sc->sc_methods->im_read == NULL ||
112 1.1 augustss sc->sc_methods->im_write == NULL ||
113 1.4 augustss sc->sc_methods->im_poll == NULL ||
114 1.1 augustss sc->sc_methods->im_set_params == NULL ||
115 1.1 augustss sc->sc_methods->im_get_speeds == NULL ||
116 1.1 augustss sc->sc_methods->im_get_turnarounds == NULL)
117 1.1 augustss panic("%s: missing methods\n", sc->sc_dev.dv_xname);
118 1.1 augustss #endif
119 1.1 augustss
120 1.1 augustss (void)sc->sc_methods->im_get_speeds(sc->sc_handle, &speeds);
121 1.11 augustss sc->sc_speedmask = speeds;
122 1.1 augustss delim = ":";
123 1.1 augustss if (speeds & IRDA_SPEEDS_SIR) {
124 1.1 augustss printf("%s SIR", delim);
125 1.1 augustss delim = ",";
126 1.1 augustss }
127 1.1 augustss if (speeds & IRDA_SPEEDS_MIR) {
128 1.1 augustss printf("%s MIR", delim);
129 1.1 augustss delim = ",";
130 1.1 augustss }
131 1.1 augustss if (speeds & IRDA_SPEEDS_FIR) {
132 1.1 augustss printf("%s FIR", delim);
133 1.1 augustss delim = ",";
134 1.1 augustss }
135 1.1 augustss if (speeds & IRDA_SPEEDS_VFIR) {
136 1.1 augustss printf("%s VFIR", delim);
137 1.1 augustss delim = ",";
138 1.1 augustss }
139 1.1 augustss printf("\n");
140 1.1 augustss }
141 1.1 augustss
142 1.1 augustss int
143 1.1 augustss irframe_activate(struct device *self, enum devact act)
144 1.1 augustss {
145 1.1 augustss /*struct irframe_softc *sc = (struct irframe_softc *)self;*/
146 1.1 augustss
147 1.1 augustss switch (act) {
148 1.1 augustss case DVACT_ACTIVATE:
149 1.1 augustss return (EOPNOTSUPP);
150 1.1 augustss break;
151 1.1 augustss
152 1.1 augustss case DVACT_DEACTIVATE:
153 1.1 augustss break;
154 1.1 augustss }
155 1.1 augustss return (0);
156 1.1 augustss }
157 1.1 augustss
158 1.1 augustss int
159 1.1 augustss irframe_detach(struct device *self, int flags)
160 1.1 augustss {
161 1.1 augustss /*struct irframe_softc *sc = (struct irframe_softc *)self;*/
162 1.1 augustss int maj, mn;
163 1.1 augustss
164 1.1 augustss /* locate the major number */
165 1.1 augustss for (maj = 0; maj < nchrdev; maj++)
166 1.1 augustss if (cdevsw[maj].d_open == irframeopen)
167 1.1 augustss break;
168 1.1 augustss
169 1.1 augustss /* Nuke the vnodes for any open instances (calls close). */
170 1.1 augustss mn = self->dv_unit;
171 1.1 augustss vdevgone(maj, mn, mn, VCHR);
172 1.1 augustss
173 1.1 augustss return (0);
174 1.1 augustss }
175 1.1 augustss
176 1.1 augustss int
177 1.1 augustss irframeopen(dev_t dev, int flag, int mode, struct proc *p)
178 1.1 augustss {
179 1.1 augustss struct irframe_softc *sc;
180 1.1 augustss int error;
181 1.1 augustss
182 1.1 augustss sc = device_lookup(&irframe_cd, IRFRAMEUNIT(dev));
183 1.1 augustss if (sc == NULL)
184 1.1 augustss return (ENXIO);
185 1.1 augustss if ((sc->sc_dev.dv_flags & DVF_ACTIVE) == 0)
186 1.1 augustss return (EIO);
187 1.1 augustss if (sc->sc_open)
188 1.1 augustss return (EBUSY);
189 1.1 augustss if (sc->sc_methods->im_open != NULL) {
190 1.1 augustss error = sc->sc_methods->im_open(sc->sc_handle, flag, mode, p);
191 1.1 augustss if (error)
192 1.1 augustss return (error);
193 1.1 augustss }
194 1.1 augustss sc->sc_open = 1;
195 1.11 augustss #ifdef DIAGNOSTIC
196 1.11 augustss sc->sc_speed = IRDA_DEFAULT_SPEED;
197 1.11 augustss #endif
198 1.8 augustss (void)irf_reset_params(sc);
199 1.1 augustss return (0);
200 1.1 augustss }
201 1.1 augustss
202 1.1 augustss int
203 1.1 augustss irframeclose(dev_t dev, int flag, int mode, struct proc *p)
204 1.1 augustss {
205 1.1 augustss struct irframe_softc *sc;
206 1.1 augustss int error;
207 1.1 augustss
208 1.1 augustss sc = device_lookup(&irframe_cd, IRFRAMEUNIT(dev));
209 1.1 augustss if (sc == NULL)
210 1.1 augustss return (ENXIO);
211 1.1 augustss if (sc->sc_methods->im_close != NULL)
212 1.1 augustss error = sc->sc_methods->im_close(sc->sc_handle, flag, mode, p);
213 1.1 augustss else
214 1.1 augustss error = 0;
215 1.1 augustss sc->sc_open = 0;
216 1.1 augustss return (error);
217 1.1 augustss }
218 1.1 augustss
219 1.1 augustss int
220 1.1 augustss irframeread(dev_t dev, struct uio *uio, int flag)
221 1.1 augustss {
222 1.1 augustss struct irframe_softc *sc;
223 1.1 augustss
224 1.1 augustss sc = device_lookup(&irframe_cd, IRFRAMEUNIT(dev));
225 1.1 augustss if (sc == NULL)
226 1.1 augustss return (ENXIO);
227 1.1 augustss if ((sc->sc_dev.dv_flags & DVF_ACTIVE) == 0)
228 1.1 augustss return (EIO);
229 1.12 augustss if (uio->uio_resid < sc->sc_params.maxsize) {
230 1.12 augustss #ifdef DIAGNOSTIC
231 1.12 augustss printf("irframeread: short read %d < %d\n", uio->uio_resid,
232 1.12 augustss sc->sc_params.maxsize);
233 1.12 augustss #endif
234 1.11 augustss return (EINVAL);
235 1.12 augustss }
236 1.1 augustss return (sc->sc_methods->im_read(sc->sc_handle, uio, flag));
237 1.1 augustss }
238 1.1 augustss
239 1.1 augustss int
240 1.1 augustss irframewrite(dev_t dev, struct uio *uio, int flag)
241 1.1 augustss {
242 1.1 augustss struct irframe_softc *sc;
243 1.1 augustss
244 1.1 augustss sc = device_lookup(&irframe_cd, IRFRAMEUNIT(dev));
245 1.1 augustss if (sc == NULL)
246 1.1 augustss return (ENXIO);
247 1.1 augustss if ((sc->sc_dev.dv_flags & DVF_ACTIVE) == 0)
248 1.1 augustss return (EIO);
249 1.12 augustss if (uio->uio_resid > sc->sc_params.maxsize) {
250 1.12 augustss #ifdef DIAGNOSTIC
251 1.12 augustss printf("irframeread: long write %d > %d\n", uio->uio_resid,
252 1.12 augustss sc->sc_params.maxsize);
253 1.12 augustss #endif
254 1.11 augustss return (EINVAL);
255 1.12 augustss }
256 1.2 augustss return (sc->sc_methods->im_write(sc->sc_handle, uio, flag));
257 1.1 augustss }
258 1.1 augustss
259 1.1 augustss int
260 1.6 augustss irf_reset_params(struct irframe_softc *sc)
261 1.6 augustss {
262 1.6 augustss struct irda_params params;
263 1.12 augustss int error;
264 1.6 augustss
265 1.6 augustss params.speed = IRDA_DEFAULT_SPEED;
266 1.6 augustss params.ebofs = IRDA_DEFAULT_EBOFS;
267 1.6 augustss params.maxsize = IRDA_DEFAULT_SIZE;
268 1.12 augustss error = sc->sc_methods->im_set_params(sc->sc_handle, ¶ms);
269 1.12 augustss if (!error)
270 1.12 augustss sc->sc_params = params;
271 1.12 augustss return (error);
272 1.6 augustss }
273 1.6 augustss
274 1.6 augustss int
275 1.1 augustss irframeioctl(dev_t dev, u_long cmd, caddr_t addr, int flag, struct proc *p)
276 1.1 augustss {
277 1.1 augustss struct irframe_softc *sc;
278 1.2 augustss void *vaddr = addr;
279 1.11 augustss struct irda_params *parms = vaddr;
280 1.1 augustss int error;
281 1.1 augustss
282 1.1 augustss sc = device_lookup(&irframe_cd, IRFRAMEUNIT(dev));
283 1.1 augustss if (sc == NULL)
284 1.1 augustss return (ENXIO);
285 1.1 augustss if ((sc->sc_dev.dv_flags & DVF_ACTIVE) == 0)
286 1.1 augustss return (EIO);
287 1.1 augustss
288 1.1 augustss switch (cmd) {
289 1.1 augustss case FIONBIO:
290 1.1 augustss /* All handled in the upper FS layer. */
291 1.1 augustss error = 0;
292 1.1 augustss break;
293 1.1 augustss
294 1.1 augustss case IRDA_SET_PARAMS:
295 1.12 augustss DPRINTF(("irframeioctl: set params speed=%u ebofs=%u maxsize=%u\n", parms->speed, parms->ebofs, parms->maxsize));
296 1.10 augustss #ifdef DIAGNOSTIC
297 1.11 augustss if (parms->speed != sc->sc_speed) {
298 1.11 augustss sc->sc_speed = parms->speed;
299 1.10 augustss printf("%s: set speed %u\n", sc->sc_dev.dv_xname,
300 1.10 augustss sc->sc_speed);
301 1.10 augustss }
302 1.10 augustss #endif
303 1.11 augustss if (parms->maxsize > IRDA_MAX_FRAME_SIZE)
304 1.11 augustss return (EINVAL);
305 1.11 augustss if (parms->ebofs > IRDA_MAX_EBOFS)
306 1.11 augustss return (EINVAL);
307 1.11 augustss /* XXX check speed */
308 1.2 augustss error = sc->sc_methods->im_set_params(sc->sc_handle, vaddr);
309 1.12 augustss if (!error) {
310 1.11 augustss sc->sc_params = *parms;
311 1.12 augustss DPRINTF(("irframeioctl: ok\n"));
312 1.12 augustss }
313 1.1 augustss break;
314 1.1 augustss
315 1.1 augustss case IRDA_RESET_PARAMS:
316 1.7 augustss error = irf_reset_params(sc);
317 1.1 augustss break;
318 1.1 augustss
319 1.1 augustss case IRDA_GET_SPEEDMASK:
320 1.2 augustss error = sc->sc_methods->im_get_speeds(sc->sc_handle, vaddr);
321 1.1 augustss break;
322 1.1 augustss
323 1.1 augustss case IRDA_GET_TURNAROUNDMASK:
324 1.2 augustss error = sc->sc_methods->im_get_turnarounds(sc->sc_handle,vaddr);
325 1.1 augustss break;
326 1.1 augustss
327 1.1 augustss default:
328 1.1 augustss error = EINVAL;
329 1.1 augustss break;
330 1.1 augustss }
331 1.1 augustss return (error);
332 1.1 augustss }
333 1.1 augustss
334 1.1 augustss int
335 1.1 augustss irframepoll(dev_t dev, int events, struct proc *p)
336 1.1 augustss {
337 1.1 augustss struct irframe_softc *sc;
338 1.1 augustss
339 1.1 augustss sc = device_lookup(&irframe_cd, IRFRAMEUNIT(dev));
340 1.1 augustss if (sc == NULL)
341 1.1 augustss return (ENXIO);
342 1.1 augustss if ((sc->sc_dev.dv_flags & DVF_ACTIVE) == 0)
343 1.1 augustss return (EIO);
344 1.1 augustss
345 1.4 augustss return (sc->sc_methods->im_poll(sc->sc_handle, events, p));
346 1.1 augustss }
347 1.1 augustss
348 1.1 augustss /*********/
349 1.1 augustss
350 1.1 augustss
351 1.1 augustss struct device *
352 1.9 augustss irframe_alloc(size_t size, const struct irframe_methods *m, void *h)
353 1.1 augustss {
354 1.1 augustss struct cfdriver *cd = &irframe_cd;
355 1.1 augustss struct device *dev;
356 1.4 augustss struct ir_attach_args ia;
357 1.1 augustss int unit;
358 1.1 augustss
359 1.1 augustss for (unit = 0; unit < cd->cd_ndevs; unit++)
360 1.1 augustss if (cd->cd_devs[unit] == NULL)
361 1.1 augustss break;
362 1.1 augustss dev = malloc(size, M_DEVBUF, M_WAITOK);
363 1.1 augustss memset(dev, 0, size);
364 1.1 augustss snprintf(dev->dv_xname, sizeof dev->dv_xname, "irframe%d", unit);
365 1.1 augustss dev->dv_unit = unit;
366 1.1 augustss dev->dv_flags = DVF_ACTIVE; /* always initially active */
367 1.1 augustss
368 1.1 augustss config_makeroom(unit, cd);
369 1.1 augustss cd->cd_devs[unit] = dev;
370 1.4 augustss
371 1.4 augustss ia.ia_methods = m;
372 1.4 augustss ia.ia_handle = h;
373 1.6 augustss printf("%s", dev->dv_xname);
374 1.4 augustss irframe_attach(NULL, dev, &ia);
375 1.1 augustss
376 1.1 augustss return (dev);
377 1.1 augustss }
378 1.1 augustss
379 1.1 augustss void
380 1.1 augustss irframe_dealloc(struct device *dev)
381 1.1 augustss {
382 1.1 augustss struct cfdriver *cd = &irframe_cd;
383 1.1 augustss int unit;
384 1.1 augustss
385 1.1 augustss for (unit = 0; unit < cd->cd_ndevs; unit++) {
386 1.1 augustss if (cd->cd_devs[unit] == dev) {
387 1.1 augustss cd->cd_devs[unit] = NULL;
388 1.1 augustss free(dev, M_DEVBUF);
389 1.1 augustss return;
390 1.1 augustss }
391 1.1 augustss }
392 1.1 augustss panic("irframe_dealloc: device not found\n");
393 1.1 augustss }
394