Home | History | Annotate | Line # | Download | only in ir
cir.c revision 1.18
      1  1.18     rmind /*	$NetBSD: cir.c,v 1.18 2008/03/01 14:16:50 rmind 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.9     lukem 
     39   1.9     lukem #include <sys/cdefs.h>
     40  1.18     rmind __KERNEL_RCSID(0, "$NetBSD: cir.c,v 1.18 2008/03/01 14:16:50 rmind Exp $");
     41   1.1  augustss 
     42   1.1  augustss #include <sys/param.h>
     43   1.1  augustss #include <sys/systm.h>
     44   1.1  augustss #include <sys/ioctl.h>
     45   1.1  augustss #include <sys/kernel.h>
     46   1.1  augustss #include <sys/device.h>
     47   1.1  augustss #include <sys/conf.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.2  augustss #include <dev/ir/ir.h>
     53   1.2  augustss #include <dev/ir/cirio.h>
     54   1.1  augustss #include <dev/ir/cirvar.h>
     55   1.1  augustss 
     56   1.3   gehenna dev_type_open(ciropen);
     57   1.3   gehenna dev_type_close(circlose);
     58   1.3   gehenna dev_type_read(cirread);
     59   1.3   gehenna dev_type_write(cirwrite);
     60   1.3   gehenna dev_type_ioctl(cirioctl);
     61   1.3   gehenna dev_type_poll(cirpoll);
     62   1.8  jdolecek dev_type_kqfilter(cirkqfilter);
     63   1.3   gehenna 
     64   1.3   gehenna const struct cdevsw cir_cdevsw = {
     65   1.3   gehenna 	ciropen, circlose, cirread, cirwrite, cirioctl,
     66   1.8  jdolecek 	nostop, notty, cirpoll, nommap, cirkqfilter,
     67  1.16      cube 	D_OTHER
     68   1.3   gehenna };
     69   1.1  augustss 
     70   1.1  augustss int cir_match(struct device *parent, struct cfdata *match, void *aux);
     71   1.1  augustss void cir_attach(struct device *parent, struct device *self, void *aux);
     72   1.1  augustss int cir_activate(struct device *self, enum devact act);
     73   1.1  augustss int cir_detach(struct device *self, int flags);
     74   1.1  augustss 
     75   1.6   thorpej CFATTACH_DECL(cir, sizeof(struct cir_softc),
     76   1.7   thorpej     cir_match, cir_attach, cir_detach, cir_activate);
     77   1.1  augustss 
     78   1.1  augustss extern struct cfdriver cir_cd;
     79   1.1  augustss 
     80   1.1  augustss #define CIRUNIT(dev) (minor(dev))
     81   1.1  augustss 
     82   1.1  augustss int
     83   1.1  augustss cir_match(struct device *parent, struct cfdata *match, void *aux)
     84   1.1  augustss {
     85   1.1  augustss 	struct ir_attach_args *ia = aux;
     86   1.1  augustss 
     87   1.1  augustss 	return (ia->ia_type == IR_TYPE_CIR);
     88   1.1  augustss }
     89   1.1  augustss 
     90   1.1  augustss void
     91   1.1  augustss cir_attach(struct device *parent, struct device *self, void *aux)
     92   1.1  augustss {
     93  1.14   thorpej 	struct cir_softc *sc = device_private(self);
     94   1.1  augustss 	struct ir_attach_args *ia = aux;
     95   1.1  augustss 
     96  1.18     rmind 	selinit(&sc->sc_rdsel);
     97   1.1  augustss 	sc->sc_methods = ia->ia_methods;
     98   1.1  augustss 	sc->sc_handle = ia->ia_handle;
     99   1.1  augustss 
    100   1.1  augustss #ifdef DIAGNOSTIC
    101   1.1  augustss 	if (sc->sc_methods->im_read == NULL ||
    102   1.2  augustss 	    sc->sc_methods->im_write == NULL ||
    103   1.2  augustss 	    sc->sc_methods->im_setparams == NULL)
    104   1.4    provos 		panic("%s: missing methods", sc->sc_dev.dv_xname);
    105   1.1  augustss #endif
    106   1.1  augustss 	printf("\n");
    107   1.1  augustss }
    108   1.1  augustss 
    109   1.1  augustss int
    110   1.1  augustss cir_activate(struct device *self, enum devact act)
    111   1.1  augustss {
    112  1.14   thorpej 	/*struct cir_softc *sc = device_private(self);*/
    113   1.1  augustss 
    114   1.1  augustss 	switch (act) {
    115   1.1  augustss 	case DVACT_ACTIVATE:
    116   1.1  augustss 		return (EOPNOTSUPP);
    117   1.1  augustss 		break;
    118   1.1  augustss 
    119   1.1  augustss 	case DVACT_DEACTIVATE:
    120   1.1  augustss 		break;
    121   1.1  augustss 	}
    122   1.1  augustss 	return (0);
    123   1.1  augustss }
    124   1.1  augustss 
    125   1.1  augustss int
    126   1.1  augustss cir_detach(struct device *self, int flags)
    127   1.1  augustss {
    128  1.18     rmind 	struct cir_softc *sc = device_private(self);
    129   1.1  augustss 	int maj, mn;
    130   1.1  augustss 
    131   1.1  augustss 	/* locate the major number */
    132   1.3   gehenna 	maj = cdevsw_lookup_major(&cir_cdevsw);
    133   1.1  augustss 
    134   1.1  augustss 	/* Nuke the vnodes for any open instances (calls close). */
    135  1.13   thorpej 	mn = device_unit(self);
    136   1.1  augustss 	vdevgone(maj, mn, mn, VCHR);
    137   1.1  augustss 
    138  1.18     rmind 	seldestroy(&sc->sc_rdsel);
    139  1.18     rmind 
    140   1.1  augustss 	return (0);
    141   1.1  augustss }
    142   1.1  augustss 
    143   1.1  augustss int
    144  1.16      cube ciropen(dev_t dev, int flag, int mode, struct lwp *l)
    145   1.1  augustss {
    146   1.1  augustss 	struct cir_softc *sc;
    147   1.1  augustss 	int error;
    148   1.1  augustss 
    149   1.1  augustss 	sc = device_lookup(&cir_cd, CIRUNIT(dev));
    150   1.1  augustss 	if (sc == NULL)
    151   1.1  augustss 		return (ENXIO);
    152  1.12   thorpej 	if (!device_is_active(&sc->sc_dev))
    153   1.1  augustss 		return (EIO);
    154   1.1  augustss 	if (sc->sc_open)
    155   1.1  augustss 		return (EBUSY);
    156   1.1  augustss 	if (sc->sc_methods->im_open != NULL) {
    157  1.16      cube 		error = sc->sc_methods->im_open(sc->sc_handle, flag, mode,
    158  1.16      cube 		    l->l_proc);
    159   1.1  augustss 		if (error)
    160   1.1  augustss 			return (error);
    161   1.1  augustss 	}
    162   1.1  augustss 	sc->sc_open = 1;
    163   1.1  augustss 	return (0);
    164   1.1  augustss }
    165   1.1  augustss 
    166   1.1  augustss int
    167  1.16      cube circlose(dev_t dev, int flag, int mode, struct lwp *l)
    168   1.1  augustss {
    169   1.1  augustss 	struct cir_softc *sc;
    170   1.1  augustss 	int error;
    171   1.1  augustss 
    172   1.1  augustss 	sc = device_lookup(&cir_cd, CIRUNIT(dev));
    173   1.1  augustss 	if (sc == NULL)
    174   1.1  augustss 		return (ENXIO);
    175   1.1  augustss 	if (sc->sc_methods->im_close != NULL)
    176  1.16      cube 		error = sc->sc_methods->im_close(sc->sc_handle, flag, mode,
    177  1.16      cube 		    l->l_proc);
    178   1.1  augustss 	else
    179   1.1  augustss 		error = 0;
    180   1.1  augustss 	sc->sc_open = 0;
    181   1.1  augustss 	return (error);
    182   1.1  augustss }
    183   1.1  augustss 
    184   1.1  augustss int
    185   1.1  augustss cirread(dev_t dev, struct uio *uio, int flag)
    186   1.1  augustss {
    187   1.1  augustss 	struct cir_softc *sc;
    188   1.1  augustss 
    189   1.1  augustss 	sc = device_lookup(&cir_cd, CIRUNIT(dev));
    190   1.1  augustss 	if (sc == NULL)
    191   1.1  augustss 		return (ENXIO);
    192  1.12   thorpej 	if (!device_is_active(&sc->sc_dev))
    193   1.1  augustss 		return (EIO);
    194   1.1  augustss 	return (sc->sc_methods->im_read(sc->sc_handle, uio, flag));
    195   1.1  augustss }
    196   1.1  augustss 
    197   1.1  augustss int
    198   1.1  augustss cirwrite(dev_t dev, struct uio *uio, int flag)
    199   1.1  augustss {
    200   1.1  augustss 	struct cir_softc *sc;
    201   1.1  augustss 
    202   1.1  augustss 	sc = device_lookup(&cir_cd, CIRUNIT(dev));
    203   1.1  augustss 	if (sc == NULL)
    204   1.1  augustss 		return (ENXIO);
    205  1.12   thorpej 	if (!device_is_active(&sc->sc_dev))
    206   1.1  augustss 		return (EIO);
    207   1.1  augustss 	return (sc->sc_methods->im_write(sc->sc_handle, uio, flag));
    208   1.1  augustss }
    209   1.1  augustss 
    210   1.1  augustss int
    211  1.17  christos cirioctl(dev_t dev, u_long cmd, void *addr, int flag, struct lwp *l)
    212   1.1  augustss {
    213   1.1  augustss 	struct cir_softc *sc;
    214   1.1  augustss 	int error;
    215   1.1  augustss 
    216   1.1  augustss 	sc = device_lookup(&cir_cd, CIRUNIT(dev));
    217   1.1  augustss 	if (sc == NULL)
    218   1.1  augustss 		return (ENXIO);
    219  1.12   thorpej 	if (!device_is_active(&sc->sc_dev))
    220   1.1  augustss 		return (EIO);
    221   1.1  augustss 
    222   1.1  augustss 	switch (cmd) {
    223   1.1  augustss 	case FIONBIO:
    224   1.1  augustss 		/* All handled in the upper FS layer. */
    225   1.1  augustss 		error = 0;
    226   1.2  augustss 		break;
    227   1.2  augustss 	case CIR_GET_PARAMS:
    228   1.2  augustss 		*(struct cir_params *)addr = sc->sc_params;
    229  1.16      cube 		error = 0;
    230   1.2  augustss 		break;
    231   1.2  augustss 	case CIR_SET_PARAMS:
    232   1.2  augustss 		error = sc->sc_methods->im_setparams(sc->sc_handle,
    233   1.2  augustss 			    (struct cir_params *)addr);
    234   1.2  augustss 		if (!error)
    235   1.2  augustss 			sc->sc_params = *(struct cir_params *)addr;
    236   1.1  augustss 		break;
    237   1.1  augustss 	default:
    238   1.1  augustss 		error = EINVAL;
    239   1.1  augustss 		break;
    240   1.1  augustss 	}
    241   1.1  augustss 	return (error);
    242   1.1  augustss }
    243   1.1  augustss 
    244   1.1  augustss int
    245  1.16      cube cirpoll(dev_t dev, int events, struct lwp *l)
    246   1.1  augustss {
    247   1.1  augustss 	struct cir_softc *sc;
    248   1.1  augustss 	int revents;
    249   1.1  augustss 	int s;
    250   1.1  augustss 
    251   1.1  augustss 	sc = device_lookup(&cir_cd, CIRUNIT(dev));
    252   1.1  augustss 	if (sc == NULL)
    253  1.11  augustss 		return (POLLERR);
    254  1.12   thorpej 	if (!device_is_active(&sc->sc_dev))
    255  1.11  augustss 		return (POLLERR);
    256   1.1  augustss 
    257   1.1  augustss 	revents = 0;
    258   1.1  augustss 	s = splir();
    259   1.1  augustss #if 0
    260   1.1  augustss 	if (events & (POLLIN | POLLRDNORM))
    261   1.1  augustss 		if (sc->sc_rdframes > 0)
    262   1.1  augustss 			revents |= events & (POLLIN | POLLRDNORM);
    263   1.1  augustss #endif
    264   1.1  augustss 
    265   1.1  augustss #if 0
    266   1.1  augustss 	/* How about write? */
    267   1.1  augustss 	if (events & (POLLOUT | POLLWRNORM))
    268  1.15      cube 		if (/* ??? */)
    269   1.1  augustss 			revents |= events & (POLLOUT | POLLWRNORM);
    270   1.1  augustss #endif
    271   1.1  augustss 
    272   1.1  augustss 	if (revents == 0) {
    273   1.1  augustss 		if (events & (POLLIN | POLLRDNORM))
    274  1.16      cube 			selrecord(l, &sc->sc_rdsel);
    275   1.1  augustss 
    276   1.1  augustss #if 0
    277   1.1  augustss 		if (events & (POLLOUT | POLLWRNORM))
    278   1.1  augustss 			selrecord(p, &sc->sc_wrsel);
    279   1.1  augustss #endif
    280   1.1  augustss 	}
    281   1.1  augustss 
    282   1.1  augustss 	splx(s);
    283   1.1  augustss 	return (revents);
    284   1.1  augustss }
    285