Home | History | Annotate | Line # | Download | only in vr
vr4181aiu.c revision 1.6
      1 /* $NetBSD: vr4181aiu.c,v 1.6 2008/06/11 23:53:15 cegger Exp $ */
      2 
      3 /*
      4  * Copyright (c) 2002 The NetBSD Foundation, Inc.
      5  * All rights reserved.
      6  *
      7  * This code is derived from software contributed to The NetBSD Foundation
      8  * by Naoto Shimazaki of YOKOGAWA Electric Corporation.
      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: vr4181aiu.c,v 1.6 2008/06/11 23:53:15 cegger Exp $");
     34 
     35 #include <sys/param.h>
     36 #include <sys/conf.h>
     37 #include <sys/device.h>
     38 #include <sys/errno.h>
     39 #include <sys/malloc.h>
     40 #include <sys/proc.h>
     41 #include <sys/systm.h>
     42 
     43 #include <mips/cpuregs.h>
     44 
     45 #include <machine/bus.h>
     46 
     47 #include <hpcmips/vr/vripif.h>
     48 #include <hpcmips/vr/vr4181aiureg.h>
     49 #include <hpcmips/vr/vr4181dcureg.h>
     50 
     51 #define INBUFLEN	1024	/* length in u_int16_t */
     52 #define INPUTLEN	1000
     53 #define SAMPLEFREQ	1000
     54 #define PICKUPFREQ	100
     55 #define PICKUPCOUNT	(SAMPLEFREQ / PICKUPFREQ)
     56 
     57 #define ST_BUSY		0x01
     58 #define ST_OVERRUN	0x02
     59 
     60 #define	INBUF_MASK	0x3ff	/* 2Kbyte */
     61 #define	INBUF_RAW_SIZE	(INBUFLEN * 4 + (INBUF_MASK + 1))
     62 
     63 #ifdef VR4181AIU_DEBUG
     64 int	vr4181aiu_debug = 0;
     65 #define DPRINTF(x)	if (vr4181aiu_debug) printf x
     66 #else
     67 #define DPRINTF(x)
     68 #endif
     69 
     70 
     71 struct vr4181aiu_softc {
     72 	struct device		sc_dev;
     73 	bus_space_tag_t		sc_iot;
     74 	bus_space_handle_t	sc_dcu1_ioh;
     75 	bus_space_handle_t	sc_dcu2_ioh;
     76 	bus_space_handle_t	sc_aiu_ioh;
     77 	u_int16_t		*sc_inbuf_head;
     78 	u_int16_t		*sc_inbuf_tail;
     79 	u_int16_t		*sc_inbuf_which;
     80 	u_int16_t		*sc_inbuf1;
     81 	u_int16_t		*sc_inbuf2;
     82 	u_int16_t		*sc_inbuf_raw;
     83 	int			sc_status;
     84 };
     85 
     86 static int vr4181aiu_match(struct device *, struct cfdata *, void *);
     87 static void vr4181aiu_attach(struct device *, struct device *, void *);
     88 static int vr4181aiu_intr(void *);
     89 
     90 extern struct cfdriver vr4181aiu_cd;
     91 
     92 CFATTACH_DECL(vr4181aiu, sizeof(struct vr4181aiu_softc),
     93 	      vr4181aiu_match, vr4181aiu_attach, NULL, NULL);
     94 
     95 dev_type_open(vr4181aiuopen);
     96 dev_type_close(vr4181aiuclose);
     97 dev_type_read(vr4181aiuread);
     98 dev_type_write(vr4181aiuwrite);
     99 
    100 const struct cdevsw vr4181aiu_cdevsw = {
    101 	vr4181aiuopen, vr4181aiuclose, vr4181aiuread, vr4181aiuwrite, noioctl,
    102 	nostop, notty, nopoll, nommap, nokqfilter,
    103 };
    104 
    105 static int
    106 vr4181aiu_match(struct device *parent, struct cfdata *cf, void *aux)
    107 {
    108 	return 1;
    109 }
    110 
    111 static void
    112 vr4181aiu_init_inbuf(struct vr4181aiu_softc *sc)
    113 {
    114 	/*
    115 	 * XXXXXXXXXXXXXXXXX
    116 	 *
    117 	 * this is just a quick and dirty hack to locate the buffer
    118 	 * in KSEG0 space.  the only reason is that i want the physical
    119 	 * address of the buffer.
    120 	 *
    121 	 * bus_dma framework should be used.
    122 	 */
    123 	static char inbufbase[INBUF_RAW_SIZE];
    124 
    125 	sc->sc_inbuf_raw = (u_int16_t *) inbufbase;
    126 
    127 	sc->sc_inbuf1 = (u_int16_t *) ((((u_int32_t) sc->sc_inbuf_raw)
    128 					+ INBUF_MASK)
    129 				       & ~INBUF_MASK);
    130 	sc->sc_inbuf2 = sc->sc_inbuf1 + INBUFLEN;
    131 }
    132 
    133 static void
    134 vr4181aiu_disable(struct vr4181aiu_softc *sc)
    135 {
    136 	/* irq clear */
    137 	bus_space_write_2(sc->sc_iot, sc->sc_dcu2_ioh,
    138 			  DCU_DMAITRQ_REG_W, DCU_MICEOP);
    139 	bus_space_write_2(sc->sc_iot, sc->sc_aiu_ioh,
    140 			  VR4181AIU_INT_REG_W,
    141 			  VR4181AIU_MIDLEINTR
    142 			  | VR4181AIU_MSTINTR
    143 			  | VR4181AIU_SIDLEINTR);
    144 
    145 	/* disable microphone */
    146 	bus_space_write_2(sc->sc_iot, sc->sc_aiu_ioh,
    147 			  VR4181AIU_SEQ_REG_W, 0);
    148 
    149 	/* disable ADC */
    150 	bus_space_write_2(sc->sc_iot, sc->sc_aiu_ioh,
    151 			  VR4181AIU_MCNT_REG_W, 0);
    152 
    153 	/* disable DMA */
    154 	bus_space_write_2(sc->sc_iot, sc->sc_dcu1_ioh,
    155 			  DCU_AIUDMAMSK_REG_W, 0);
    156 	bus_space_write_2(sc->sc_iot, sc->sc_dcu2_ioh,
    157 			  DCU_DMAITMK_REG_W, 0);
    158 
    159 	sc->sc_status = 0;
    160 }
    161 
    162 static void
    163 vr4181aiu_attach(struct device *parent, struct device *self, void *aux)
    164 {
    165 	struct vrip_attach_args	*va = aux;
    166 	struct vr4181aiu_softc	*sc = (void *) self;
    167 
    168 	vr4181aiu_init_inbuf(sc);
    169 	memset(sc->sc_inbuf1, 0x55, INBUFLEN * 2);
    170 	memset(sc->sc_inbuf2, 0xaa, INBUFLEN * 2);
    171 
    172 	sc->sc_status = 0;
    173 	sc->sc_iot = va->va_iot;
    174 
    175 	if (bus_space_map(sc->sc_iot,
    176 			  VR4181AIU_DCU1_BASE, VR4181AIU_DCU1_SIZE,
    177 			  0, &sc->sc_dcu1_ioh))
    178 		goto out_dcu1;
    179 	if (bus_space_map(sc->sc_iot,
    180 			  VR4181AIU_DCU2_BASE, VR4181AIU_DCU2_SIZE,
    181 			  0, &sc->sc_dcu2_ioh))
    182 		goto out_dcu2;
    183 	if (bus_space_map(sc->sc_iot,
    184 			  VR4181AIU_AIU_BASE, VR4181AIU_AIU_SIZE,
    185 			  0, &sc->sc_aiu_ioh))
    186 		goto out_aiu;
    187 
    188 	/*
    189 	 * reset AIU
    190 	 */
    191 	bus_space_write_2(sc->sc_iot, sc->sc_aiu_ioh,
    192 			  VR4181AIU_SEQ_REG_W, VR4181AIU_AIURST);
    193 	bus_space_write_2(sc->sc_iot, sc->sc_aiu_ioh,
    194 			  VR4181AIU_SEQ_REG_W, 0);
    195 
    196 	/*
    197 	 * set sample rate (1kHz fixed)
    198 	 * XXXX
    199 	 * assume to PCLK is 32.768MHz
    200 	 */
    201 	bus_space_write_2(sc->sc_iot, sc->sc_aiu_ioh,
    202 			  VR4181AIU_MCNVC_END,
    203 			  32768000 / SAMPLEFREQ);
    204 
    205 	/*
    206 	 * XXXX
    207 	 * assume to PCLK is 32.768MHz
    208 	 * DAVREF_SETUP = 5usec * PCLK = 163.84
    209 	 */
    210 	bus_space_write_2(sc->sc_iot, sc->sc_aiu_ioh,
    211 			  VR4181AIU_DAVREF_SETUP_REG_W, 164);
    212 
    213 	vr4181aiu_disable(sc);
    214 
    215 	if (vrip_intr_establish(va->va_vc, va->va_unit, 0,
    216 				IPL_BIO, vr4181aiu_intr, sc) == NULL) {
    217 		printf("%s: can't establish interrupt\n",
    218 		       sc->sc_dev.dv_xname);
    219 		return;
    220 	}
    221 
    222 	printf("\n");
    223 	return;
    224 
    225 out_aiu:
    226 	bus_space_unmap(sc->sc_iot, sc->sc_dcu2_ioh, VR4181AIU_DCU2_SIZE);
    227 out_dcu2:
    228 	bus_space_unmap(sc->sc_iot, sc->sc_dcu1_ioh, VR4181AIU_DCU1_SIZE);
    229 out_dcu1:
    230 	printf(": can't map i/o space\n");
    231 }
    232 
    233 int
    234 vr4181aiuopen(dev_t dev, int flag, int mode, struct lwp *l)
    235 {
    236 	struct vr4181aiu_softc	*sc;
    237 
    238 	sc = device_lookup_private(&vr4181aiu_cd, minor(dev);
    239 	if (sc == NULL)
    240 		return ENXIO;
    241 
    242 	if (sc->sc_status & ST_BUSY)
    243 		return EBUSY;
    244 
    245 	sc->sc_inbuf_head = sc->sc_inbuf_tail
    246 		= sc->sc_inbuf_which = sc->sc_inbuf1;
    247 	sc->sc_status &= ~ST_OVERRUN;
    248 
    249 	/* setup DMA */
    250 	/* reset */
    251 	bus_space_write_2(sc->sc_iot, sc->sc_dcu1_ioh,
    252 			  DCU_DMARST_REG_W, 0);
    253 	bus_space_write_2(sc->sc_iot, sc->sc_dcu1_ioh,
    254 			  DCU_DMARST_REG_W, DCU_DMARST);
    255 	/* dest1 <- sc_inbuf1 */
    256 	bus_space_write_2(sc->sc_iot, sc->sc_dcu1_ioh,
    257 			  DCU_MICDEST1REG1_W,
    258 			  MIPS_KSEG0_TO_PHYS(sc->sc_inbuf1) & 0xffff);
    259 	bus_space_write_2(sc->sc_iot, sc->sc_dcu1_ioh,
    260 			  DCU_MICDEST1REG2_W,
    261 			  MIPS_KSEG0_TO_PHYS(sc->sc_inbuf1) >> 16);
    262 	/* dest2 <- sc_inbuf2 */
    263 	bus_space_write_2(sc->sc_iot, sc->sc_dcu1_ioh,
    264 			  DCU_MICDEST2REG1_W,
    265 			  MIPS_KSEG0_TO_PHYS(sc->sc_inbuf2) & 0xffff);
    266 	bus_space_write_2(sc->sc_iot, sc->sc_dcu1_ioh,
    267 			  DCU_MICDEST2REG2_W,
    268 			  MIPS_KSEG0_TO_PHYS(sc->sc_inbuf2) >> 16);
    269 	/* record length <- INPUTLEN */
    270 	bus_space_write_2(sc->sc_iot, sc->sc_dcu2_ioh,
    271 			  DCU_MICRCLEN_REG_W, INPUTLEN);
    272 	/* config <- auto load */
    273 	bus_space_write_2(sc->sc_iot, sc->sc_dcu2_ioh,
    274 			  DCU_MICDMACFG_REG_W, DCU_MICLOAD);
    275 	/* irq <- irq clear */
    276 	bus_space_write_2(sc->sc_iot, sc->sc_dcu2_ioh,
    277 			  DCU_DMAITRQ_REG_W, DCU_MICEOP);
    278 	/* control <- INC */
    279 	bus_space_write_2(sc->sc_iot, sc->sc_dcu2_ioh,
    280 			  DCU_DMACTL_REG_W, DCU_MICCNT_INC);
    281 	/* irq mask <- microphone end of process */
    282 	bus_space_write_2(sc->sc_iot, sc->sc_dcu2_ioh,
    283 			  DCU_DMAITMK_REG_W, DCU_MICEOP_ENABLE);
    284 
    285 	/* enable DMA */
    286 	bus_space_write_2(sc->sc_iot, sc->sc_dcu1_ioh,
    287 			  DCU_AIUDMAMSK_REG_W, DCU_ENABLE_MIC);
    288 
    289 	/* enable ADC */
    290 	bus_space_write_2(sc->sc_iot, sc->sc_aiu_ioh,
    291 			  VR4181AIU_MCNT_REG_W, VR4181AIU_ADENAIU);
    292 
    293 	/* enable microphone */
    294 	bus_space_write_2(sc->sc_iot, sc->sc_aiu_ioh,
    295 			  VR4181AIU_SEQ_REG_W, VR4181AIU_AIUMEN);
    296 
    297 	sc->sc_status |= ST_BUSY;
    298 
    299 	return 0;
    300 }
    301 
    302 int
    303 vr4181aiuclose(dev_t dev, int flag, int mode, struct lwp *l)
    304 {
    305 	vr4181aiu_disable(device_lookup_private(&vr4181aiu_cd, minor(dev)));
    306 	return 0;
    307 }
    308 
    309 int
    310 vr4181aiuread(dev_t dev, struct uio *uio, int flag)
    311 {
    312 	struct vr4181aiu_softc	*sc;
    313 	int			s;
    314 	u_int16_t		*fence;
    315 	int			avail;
    316 	int			count;
    317 	u_int8_t		tmp[INPUTLEN / PICKUPCOUNT];
    318 	u_int16_t		*src;
    319 	u_int8_t		*dst;
    320 
    321 	sc = device_lookup_private(&vr4181aiu_cd, minor(dev));
    322 
    323 	src = sc->sc_inbuf_tail;
    324 	s = splbio();
    325 	if (src == sc->sc_inbuf_head) {
    326 		/* wait for DMA to complete writing */
    327 		tsleep(sc, PRIBIO, "aiu read", 0);
    328 		/* now sc_inbuf_head points alternate buffer */
    329 	}
    330 	splx(s);
    331 
    332 	fence = sc->sc_inbuf_which == sc->sc_inbuf1
    333 		? &sc->sc_inbuf1[INPUTLEN]
    334 		: &sc->sc_inbuf2[INPUTLEN];
    335 	avail = (fence - src) / PICKUPCOUNT;
    336 	count = min(avail, uio->uio_resid);
    337 	dst = tmp;
    338 	while (count > 0) {
    339 		*dst++ = (u_int8_t) (*src >> 2);
    340 		src += PICKUPCOUNT;
    341 		count--;
    342 	}
    343 
    344 	if (src < fence) {
    345 		sc->sc_inbuf_tail = src;
    346 	} else {
    347 		/* alter the buffer */
    348 		sc->sc_inbuf_tail
    349 			= sc->sc_inbuf_which
    350 			= sc->sc_inbuf_which == sc->sc_inbuf1
    351 			? sc->sc_inbuf2 : sc->sc_inbuf1;
    352 	}
    353 
    354 	return uiomove(tmp, dst - tmp, uio);
    355 }
    356 
    357 int
    358 vr4181aiuwrite(dev_t dev, struct uio *uio, int flag)
    359 {
    360 	return 0;
    361 }
    362 
    363 /*
    364  * interrupt handler
    365  */
    366 static int
    367 vr4181aiu_intr(void *arg)
    368 {
    369 	struct vr4181aiu_softc	*sc = arg;
    370 
    371 	if (!(sc->sc_status & ST_BUSY)) {
    372 		printf("vr4181aiu_intr: stray interrupt\n");
    373 		vr4181aiu_disable(sc);
    374 		return 0;
    375 	}
    376 
    377 	/* irq clear */
    378 	bus_space_write_2(sc->sc_iot, sc->sc_dcu2_ioh,
    379 			  DCU_DMAITRQ_REG_W, DCU_MICEOP);
    380 
    381 	if (sc->sc_inbuf_head == sc->sc_inbuf1) {
    382 		if (sc->sc_inbuf_tail != sc->sc_inbuf1)
    383 			sc->sc_status |= ST_OVERRUN;
    384 		sc->sc_inbuf_head = sc->sc_inbuf2;
    385 	} else {
    386 		if (sc->sc_inbuf_tail != sc->sc_inbuf2)
    387 			sc->sc_status |= ST_OVERRUN;
    388 		sc->sc_inbuf_head = sc->sc_inbuf1;
    389 	}
    390 
    391 	if (sc->sc_status & ST_OVERRUN) {
    392 		printf("vr4181aiu_intr: overrun\n");
    393 	}
    394 
    395 	DPRINTF(("vr4181aiu_intr: sc_inbuf1 = %04x, sc_inbuf2 = %04x\n",
    396 		 sc->sc_inbuf1[0], sc->sc_inbuf2[0]));
    397 
    398 	wakeup(sc);
    399 
    400 	return 0;
    401 }
    402