Home | History | Annotate | Line # | Download | only in ir
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, &params);
    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