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