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