Home | History | Annotate | Line # | Download | only in dev
mediabay.c revision 1.2
      1  1.2  tsubai /*	$NetBSD: mediabay.c,v 1.2 1999/10/04 22:58:10 tsubai Exp $	*/
      2  1.1  tsubai 
      3  1.1  tsubai /*-
      4  1.1  tsubai  * Copyright (C) 1999 Tsubai Masanari.  All rights reserved.
      5  1.1  tsubai  *
      6  1.1  tsubai  * Redistribution and use in source and binary forms, with or without
      7  1.1  tsubai  * modification, are permitted provided that the following conditions
      8  1.1  tsubai  * are met:
      9  1.1  tsubai  * 1. Redistributions of source code must retain the above copyright
     10  1.1  tsubai  *    notice, this list of conditions and the following disclaimer.
     11  1.1  tsubai  * 2. Redistributions in binary form must reproduce the above copyright
     12  1.1  tsubai  *    notice, this list of conditions and the following disclaimer in the
     13  1.1  tsubai  *    documentation and/or other materials provided with the distribution.
     14  1.1  tsubai  * 3. The name of the author may not be used to endorse or promote products
     15  1.1  tsubai  *    derived from this software without specific prior written permission.
     16  1.1  tsubai  *
     17  1.1  tsubai  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     18  1.1  tsubai  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     19  1.1  tsubai  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     20  1.1  tsubai  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     21  1.1  tsubai  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     22  1.1  tsubai  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     23  1.1  tsubai  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     24  1.1  tsubai  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     25  1.1  tsubai  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
     26  1.1  tsubai  * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     27  1.1  tsubai  */
     28  1.1  tsubai 
     29  1.1  tsubai #include <sys/param.h>
     30  1.2  tsubai #include <sys/device.h>
     31  1.2  tsubai #include <sys/kernel.h>
     32  1.2  tsubai #include <sys/kthread.h>
     33  1.1  tsubai #include <sys/systm.h>
     34  1.2  tsubai 
     35  1.2  tsubai #include <dev/ofw/openfirm.h>
     36  1.1  tsubai 
     37  1.1  tsubai #include <machine/autoconf.h>
     38  1.1  tsubai #include <machine/pio.h>
     39  1.1  tsubai 
     40  1.1  tsubai struct mediabay_softc {
     41  1.1  tsubai 	struct device sc_dev;
     42  1.1  tsubai 	int sc_node;
     43  1.1  tsubai 	u_int *sc_addr;
     44  1.1  tsubai 	u_int *sc_fcr;
     45  1.2  tsubai 	u_int sc_baseaddr;
     46  1.2  tsubai 	struct device *sc_content;
     47  1.2  tsubai 	struct proc *sc_kthread;
     48  1.1  tsubai };
     49  1.1  tsubai 
     50  1.2  tsubai void mediabay_attach __P((struct device *, struct device *, void *));
     51  1.2  tsubai int mediabay_match __P((struct device *, struct cfdata *, void *));
     52  1.2  tsubai int mediabay_print __P((void *, const char *));
     53  1.2  tsubai void mediabay_attach_content __P((struct mediabay_softc *));
     54  1.2  tsubai int mediabay_intr __P((void *));
     55  1.2  tsubai void mediabay_create_kthread __P((void *));
     56  1.2  tsubai void mediabay_kthread __P((void *));
     57  1.1  tsubai 
     58  1.1  tsubai struct cfattach mediabay_ca = {
     59  1.1  tsubai 	sizeof(struct mediabay_softc), mediabay_match, mediabay_attach
     60  1.1  tsubai };
     61  1.1  tsubai 
     62  1.2  tsubai #ifdef MEDIABAY_DEBUG
     63  1.2  tsubai # define DPRINTF printf
     64  1.2  tsubai #else
     65  1.2  tsubai # define DPRINTF while (0) printf
     66  1.2  tsubai #endif
     67  1.1  tsubai 
     68  1.1  tsubai #define FCR_MEDIABAY_RESET	0x00000002
     69  1.1  tsubai #define FCR_MEDIABAY_IDE_ENABLE	0x00000008
     70  1.1  tsubai #define FCR_MEDIABAY_FD_ENABLE	0x00000010
     71  1.1  tsubai #define FCR_MEDIABAY_ENABLE	0x00000080
     72  1.1  tsubai #define FCR_MEDIABAY_CD_POWER	0x00800000
     73  1.1  tsubai 
     74  1.2  tsubai #define MEDIABAY_ID(x)		(((x) >> 12) & 0xf)
     75  1.1  tsubai #define MEDIABAY_ID_FD		0
     76  1.1  tsubai #define MEDIABAY_ID_CD		3
     77  1.1  tsubai #define MEDIABAY_ID_NONE	7
     78  1.1  tsubai 
     79  1.1  tsubai int
     80  1.1  tsubai mediabay_match(parent, cf, aux)
     81  1.1  tsubai 	struct device *parent;
     82  1.1  tsubai 	struct cfdata *cf;
     83  1.1  tsubai 	void *aux;
     84  1.1  tsubai {
     85  1.1  tsubai 	struct confargs *ca = aux;
     86  1.1  tsubai 
     87  1.1  tsubai 	if (strcmp(ca->ca_name, "media-bay") == 0)
     88  1.1  tsubai 		return 1;
     89  1.1  tsubai 
     90  1.1  tsubai 	return 0;
     91  1.1  tsubai }
     92  1.1  tsubai 
     93  1.1  tsubai /*
     94  1.1  tsubai  * Attach all the sub-devices we can find
     95  1.1  tsubai  */
     96  1.1  tsubai void
     97  1.1  tsubai mediabay_attach(parent, self, aux)
     98  1.1  tsubai 	struct device *parent, *self;
     99  1.1  tsubai 	void *aux;
    100  1.1  tsubai {
    101  1.1  tsubai 	struct mediabay_softc *sc = (struct mediabay_softc *)self;
    102  1.2  tsubai 	struct confargs *ca = aux;
    103  1.2  tsubai 	int irq;
    104  1.2  tsubai 
    105  1.2  tsubai 	ca->ca_reg[0] += ca->ca_baseaddr;
    106  1.1  tsubai 
    107  1.2  tsubai 	sc->sc_addr = mapiodev(ca->ca_reg[0], NBPG);
    108  1.1  tsubai 	sc->sc_fcr = sc->sc_addr + 1;
    109  1.2  tsubai 	sc->sc_node = ca->ca_node;
    110  1.2  tsubai 	sc->sc_baseaddr = ca->ca_baseaddr;
    111  1.2  tsubai 	irq = ca->ca_intr[0];
    112  1.1  tsubai 
    113  1.1  tsubai 	printf(" irq %d\n", irq);
    114  1.1  tsubai 	intr_establish(irq, IST_LEVEL, IPL_BIO, mediabay_intr, sc);
    115  1.1  tsubai 
    116  1.2  tsubai 	kthread_create(mediabay_create_kthread, sc);
    117  1.2  tsubai 
    118  1.2  tsubai 	sc->sc_content = NULL;
    119  1.2  tsubai 
    120  1.2  tsubai 	if (MEDIABAY_ID(in32rb(sc->sc_addr)) != MEDIABAY_ID_NONE)
    121  1.2  tsubai 		mediabay_attach_content(sc);
    122  1.2  tsubai }
    123  1.2  tsubai 
    124  1.2  tsubai void
    125  1.2  tsubai mediabay_attach_content(sc)
    126  1.2  tsubai 	struct mediabay_softc *sc;
    127  1.2  tsubai {
    128  1.2  tsubai 	int child;
    129  1.2  tsubai 	u_int fcr;
    130  1.2  tsubai 	struct device *content;
    131  1.2  tsubai 	struct confargs ca;
    132  1.2  tsubai 	u_int reg[20], intr[5];
    133  1.2  tsubai 	char name[32];
    134  1.2  tsubai 
    135  1.1  tsubai 	fcr = in32rb(sc->sc_fcr);
    136  1.1  tsubai 	fcr |= FCR_MEDIABAY_ENABLE | FCR_MEDIABAY_RESET;
    137  1.1  tsubai 	out32rb(sc->sc_fcr, fcr);
    138  1.1  tsubai 	delay(50000);
    139  1.1  tsubai 
    140  1.1  tsubai 	fcr &= ~FCR_MEDIABAY_RESET;
    141  1.1  tsubai 	out32rb(sc->sc_fcr, fcr);
    142  1.1  tsubai 	delay(50000);
    143  1.1  tsubai 
    144  1.1  tsubai 	fcr |= FCR_MEDIABAY_IDE_ENABLE | FCR_MEDIABAY_CD_POWER;
    145  1.1  tsubai 	out32rb(sc->sc_fcr, fcr);
    146  1.1  tsubai 	delay(50000);
    147  1.1  tsubai 
    148  1.1  tsubai 	for (child = OF_child(sc->sc_node); child; child = OF_peer(child)) {
    149  1.1  tsubai 		bzero(name, sizeof(name));
    150  1.1  tsubai 		if (OF_getprop(child, "name", name, sizeof(name)) == -1)
    151  1.1  tsubai 			continue;
    152  1.1  tsubai 		ca.ca_name = name;
    153  1.1  tsubai 		ca.ca_node = child;
    154  1.2  tsubai 		ca.ca_baseaddr = sc->sc_baseaddr;
    155  1.1  tsubai 
    156  1.1  tsubai 		ca.ca_nreg  = OF_getprop(child, "reg", reg, sizeof(reg));
    157  1.1  tsubai 		ca.ca_nintr = OF_getprop(child, "AAPL,interrupts", intr,
    158  1.1  tsubai 				sizeof(intr));
    159  1.1  tsubai 		if (ca.ca_nintr == -1)
    160  1.1  tsubai 			ca.ca_nintr = OF_getprop(child, "interrupts", intr,
    161  1.1  tsubai 					sizeof(intr));
    162  1.1  tsubai 		ca.ca_reg = reg;
    163  1.1  tsubai 		ca.ca_intr = intr;
    164  1.1  tsubai 
    165  1.2  tsubai 		content = config_found(&sc->sc_dev, &ca, mediabay_print);
    166  1.2  tsubai 		if (content) {
    167  1.2  tsubai 			sc->sc_content = content;
    168  1.2  tsubai 			return;
    169  1.2  tsubai 		}
    170  1.1  tsubai 	}
    171  1.2  tsubai 
    172  1.2  tsubai 	/* No devices found.  Disable media-bay. */
    173  1.2  tsubai 	fcr &= ~(FCR_MEDIABAY_ENABLE | FCR_MEDIABAY_IDE_ENABLE |
    174  1.2  tsubai 		 FCR_MEDIABAY_CD_POWER | FCR_MEDIABAY_FD_ENABLE);
    175  1.2  tsubai 	out32rb(sc->sc_fcr, fcr);
    176  1.1  tsubai }
    177  1.1  tsubai 
    178  1.1  tsubai int
    179  1.1  tsubai mediabay_print(aux, mediabay)
    180  1.1  tsubai 	void *aux;
    181  1.1  tsubai 	const char *mediabay;
    182  1.1  tsubai {
    183  1.1  tsubai 	struct confargs *ca = aux;
    184  1.1  tsubai 
    185  1.2  tsubai 	if (mediabay == NULL && ca->ca_nreg > 0)
    186  1.1  tsubai 		printf(" offset 0x%x", ca->ca_reg[0]);
    187  1.1  tsubai 
    188  1.2  tsubai 	return QUIET;
    189  1.1  tsubai }
    190  1.1  tsubai 
    191  1.1  tsubai int
    192  1.1  tsubai mediabay_intr(v)
    193  1.1  tsubai 	void *v;
    194  1.1  tsubai {
    195  1.1  tsubai 	struct mediabay_softc *sc = v;
    196  1.1  tsubai 
    197  1.2  tsubai 	wakeup(&sc->sc_kthread);
    198  1.2  tsubai 	return 1;
    199  1.2  tsubai }
    200  1.2  tsubai 
    201  1.2  tsubai void
    202  1.2  tsubai mediabay_create_kthread(v)
    203  1.2  tsubai 	void *v;
    204  1.2  tsubai {
    205  1.2  tsubai 	struct mediabay_softc *sc = v;
    206  1.2  tsubai 
    207  1.2  tsubai 	kthread_create1(mediabay_kthread, sc, &sc->sc_kthread, "media-bay");
    208  1.2  tsubai }
    209  1.2  tsubai 
    210  1.2  tsubai void
    211  1.2  tsubai mediabay_kthread(v)
    212  1.2  tsubai 	void *v;
    213  1.2  tsubai {
    214  1.2  tsubai 	struct mediabay_softc *sc = v;
    215  1.2  tsubai 	u_int x, fcr;
    216  1.2  tsubai 
    217  1.2  tsubai sleep:
    218  1.2  tsubai 	tsleep(&sc->sc_kthread, PRIBIO, "mbayev", 0);
    219  1.2  tsubai 
    220  1.2  tsubai 	/* sleep 0.25 sec */
    221  1.2  tsubai 	tsleep(mediabay_kthread, PRIBIO, "mbayev", hz/4);
    222  1.2  tsubai 
    223  1.2  tsubai 	DPRINTF("%s: ", sc->sc_dev.dv_xname);
    224  1.1  tsubai 	x = in32rb(sc->sc_addr);
    225  1.1  tsubai 
    226  1.1  tsubai 	switch (MEDIABAY_ID(x)) {
    227  1.1  tsubai 	case MEDIABAY_ID_NONE:
    228  1.2  tsubai 		DPRINTF("removed\n");
    229  1.2  tsubai 		if (sc->sc_content != NULL) {
    230  1.2  tsubai 			config_detach(sc->sc_content, DETACH_FORCE);
    231  1.2  tsubai 			DPRINTF("%s: detach done\n", sc->sc_dev.dv_xname);
    232  1.2  tsubai 			sc->sc_content = NULL;
    233  1.2  tsubai 
    234  1.2  tsubai 			/* disable media-bay */
    235  1.2  tsubai 			fcr = in32rb(sc->sc_fcr);
    236  1.2  tsubai 			fcr &= ~(FCR_MEDIABAY_ENABLE |
    237  1.2  tsubai 				 FCR_MEDIABAY_IDE_ENABLE |
    238  1.2  tsubai 				 FCR_MEDIABAY_CD_POWER |
    239  1.2  tsubai 				 FCR_MEDIABAY_FD_ENABLE);
    240  1.2  tsubai 			out32rb(sc->sc_fcr, fcr);
    241  1.2  tsubai 		}
    242  1.1  tsubai 		break;
    243  1.1  tsubai 	case MEDIABAY_ID_FD:
    244  1.2  tsubai 		DPRINTF("FD inserted\n");
    245  1.1  tsubai 		break;
    246  1.1  tsubai 	case MEDIABAY_ID_CD:
    247  1.2  tsubai 		DPRINTF("CD inserted\n");
    248  1.2  tsubai 
    249  1.2  tsubai 		if (sc->sc_content == NULL)
    250  1.2  tsubai 			mediabay_attach_content(sc);
    251  1.1  tsubai 		break;
    252  1.1  tsubai 	default:
    253  1.1  tsubai 		printf("unknown event (0x%x)\n", x);
    254  1.1  tsubai 	}
    255  1.1  tsubai 
    256  1.2  tsubai 	goto sleep;
    257  1.1  tsubai }
    258  1.1  tsubai 
    259  1.1  tsubai /* PBG3: 0x7025X0c0 */
    260  1.1  tsubai /* 2400: 0x0070X0a8 */
    261