Home | History | Annotate | Line # | Download | only in dev
mediabay.c revision 1.8.2.3
      1  1.8.2.3    skrll /*	$NetBSD: mediabay.c,v 1.8.2.3 2004/09/21 13:18:19 skrll 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.8.2.1    skrll #include <sys/cdefs.h>
     30  1.8.2.3    skrll __KERNEL_RCSID(0, "$NetBSD: mediabay.c,v 1.8.2.3 2004/09/21 13:18:19 skrll Exp $");
     31  1.8.2.1    skrll 
     32      1.1   tsubai #include <sys/param.h>
     33      1.2   tsubai #include <sys/device.h>
     34      1.2   tsubai #include <sys/kernel.h>
     35      1.2   tsubai #include <sys/kthread.h>
     36      1.1   tsubai #include <sys/systm.h>
     37      1.2   tsubai 
     38      1.8  thorpej #include <uvm/uvm_extern.h>
     39      1.8  thorpej 
     40      1.2   tsubai #include <dev/ofw/openfirm.h>
     41      1.1   tsubai 
     42      1.1   tsubai #include <machine/autoconf.h>
     43      1.1   tsubai #include <machine/pio.h>
     44      1.1   tsubai 
     45      1.1   tsubai struct mediabay_softc {
     46      1.1   tsubai 	struct device sc_dev;
     47      1.1   tsubai 	int sc_node;
     48      1.1   tsubai 	u_int *sc_addr;
     49      1.1   tsubai 	u_int *sc_fcr;
     50      1.2   tsubai 	u_int sc_baseaddr;
     51      1.2   tsubai 	struct device *sc_content;
     52      1.2   tsubai 	struct proc *sc_kthread;
     53      1.1   tsubai };
     54      1.1   tsubai 
     55      1.2   tsubai void mediabay_attach __P((struct device *, struct device *, void *));
     56      1.2   tsubai int mediabay_match __P((struct device *, struct cfdata *, void *));
     57      1.2   tsubai int mediabay_print __P((void *, const char *));
     58      1.2   tsubai void mediabay_attach_content __P((struct mediabay_softc *));
     59      1.2   tsubai int mediabay_intr __P((void *));
     60      1.2   tsubai void mediabay_create_kthread __P((void *));
     61      1.2   tsubai void mediabay_kthread __P((void *));
     62      1.1   tsubai 
     63      1.6  thorpej CFATTACH_DECL(mediabay, sizeof(struct mediabay_softc),
     64      1.6  thorpej     mediabay_match, mediabay_attach, NULL, NULL);
     65      1.1   tsubai 
     66      1.2   tsubai #ifdef MEDIABAY_DEBUG
     67      1.2   tsubai # define DPRINTF printf
     68      1.2   tsubai #else
     69      1.2   tsubai # define DPRINTF while (0) printf
     70      1.2   tsubai #endif
     71      1.1   tsubai 
     72      1.1   tsubai #define FCR_MEDIABAY_RESET	0x00000002
     73      1.1   tsubai #define FCR_MEDIABAY_IDE_ENABLE	0x00000008
     74      1.1   tsubai #define FCR_MEDIABAY_FD_ENABLE	0x00000010
     75      1.1   tsubai #define FCR_MEDIABAY_ENABLE	0x00000080
     76      1.1   tsubai #define FCR_MEDIABAY_CD_POWER	0x00800000
     77      1.1   tsubai 
     78      1.2   tsubai #define MEDIABAY_ID(x)		(((x) >> 12) & 0xf)
     79      1.1   tsubai #define MEDIABAY_ID_FD		0
     80      1.1   tsubai #define MEDIABAY_ID_CD		3
     81      1.1   tsubai #define MEDIABAY_ID_NONE	7
     82      1.1   tsubai 
     83      1.1   tsubai int
     84      1.1   tsubai mediabay_match(parent, cf, aux)
     85      1.1   tsubai 	struct device *parent;
     86      1.1   tsubai 	struct cfdata *cf;
     87      1.1   tsubai 	void *aux;
     88      1.1   tsubai {
     89      1.1   tsubai 	struct confargs *ca = aux;
     90      1.1   tsubai 
     91      1.1   tsubai 	if (strcmp(ca->ca_name, "media-bay") == 0)
     92      1.1   tsubai 		return 1;
     93      1.1   tsubai 
     94      1.1   tsubai 	return 0;
     95      1.1   tsubai }
     96      1.1   tsubai 
     97      1.1   tsubai /*
     98      1.1   tsubai  * Attach all the sub-devices we can find
     99      1.1   tsubai  */
    100      1.1   tsubai void
    101      1.1   tsubai mediabay_attach(parent, self, aux)
    102      1.1   tsubai 	struct device *parent, *self;
    103      1.1   tsubai 	void *aux;
    104      1.1   tsubai {
    105      1.1   tsubai 	struct mediabay_softc *sc = (struct mediabay_softc *)self;
    106      1.2   tsubai 	struct confargs *ca = aux;
    107      1.3   tsubai 	int irq, type;
    108      1.2   tsubai 
    109      1.2   tsubai 	ca->ca_reg[0] += ca->ca_baseaddr;
    110      1.1   tsubai 
    111      1.8  thorpej 	sc->sc_addr = mapiodev(ca->ca_reg[0], PAGE_SIZE);
    112      1.1   tsubai 	sc->sc_fcr = sc->sc_addr + 1;
    113      1.2   tsubai 	sc->sc_node = ca->ca_node;
    114      1.2   tsubai 	sc->sc_baseaddr = ca->ca_baseaddr;
    115      1.2   tsubai 	irq = ca->ca_intr[0];
    116      1.3   tsubai 	type = IST_LEVEL;
    117      1.1   tsubai 
    118      1.3   tsubai 	if (ca->ca_nintr == 8 && ca->ca_intr[1] == 0)
    119      1.3   tsubai 		type = IST_EDGE;
    120      1.3   tsubai 
    121      1.3   tsubai 	printf(" irq %d %s\n", irq, intr_typename(type));
    122      1.3   tsubai 	intr_establish(irq, type, IPL_BIO, mediabay_intr, sc);
    123      1.1   tsubai 
    124      1.2   tsubai 	kthread_create(mediabay_create_kthread, sc);
    125      1.2   tsubai 
    126      1.2   tsubai 	sc->sc_content = NULL;
    127      1.2   tsubai 
    128      1.2   tsubai 	if (MEDIABAY_ID(in32rb(sc->sc_addr)) != MEDIABAY_ID_NONE)
    129      1.2   tsubai 		mediabay_attach_content(sc);
    130      1.2   tsubai }
    131      1.2   tsubai 
    132      1.2   tsubai void
    133      1.2   tsubai mediabay_attach_content(sc)
    134      1.2   tsubai 	struct mediabay_softc *sc;
    135      1.2   tsubai {
    136      1.2   tsubai 	int child;
    137      1.2   tsubai 	u_int fcr;
    138      1.2   tsubai 	struct device *content;
    139      1.2   tsubai 	struct confargs ca;
    140      1.2   tsubai 	u_int reg[20], intr[5];
    141      1.2   tsubai 	char name[32];
    142      1.2   tsubai 
    143      1.1   tsubai 	fcr = in32rb(sc->sc_fcr);
    144      1.1   tsubai 	fcr |= FCR_MEDIABAY_ENABLE | FCR_MEDIABAY_RESET;
    145      1.1   tsubai 	out32rb(sc->sc_fcr, fcr);
    146      1.1   tsubai 	delay(50000);
    147      1.1   tsubai 
    148      1.1   tsubai 	fcr &= ~FCR_MEDIABAY_RESET;
    149      1.1   tsubai 	out32rb(sc->sc_fcr, fcr);
    150      1.1   tsubai 	delay(50000);
    151      1.1   tsubai 
    152      1.1   tsubai 	fcr |= FCR_MEDIABAY_IDE_ENABLE | FCR_MEDIABAY_CD_POWER;
    153      1.1   tsubai 	out32rb(sc->sc_fcr, fcr);
    154      1.1   tsubai 	delay(50000);
    155      1.1   tsubai 
    156      1.1   tsubai 	for (child = OF_child(sc->sc_node); child; child = OF_peer(child)) {
    157      1.4      wiz 		memset(name, 0, sizeof(name));
    158      1.1   tsubai 		if (OF_getprop(child, "name", name, sizeof(name)) == -1)
    159      1.1   tsubai 			continue;
    160      1.1   tsubai 		ca.ca_name = name;
    161      1.1   tsubai 		ca.ca_node = child;
    162      1.2   tsubai 		ca.ca_baseaddr = sc->sc_baseaddr;
    163      1.1   tsubai 
    164      1.1   tsubai 		ca.ca_nreg  = OF_getprop(child, "reg", reg, sizeof(reg));
    165      1.1   tsubai 		ca.ca_nintr = OF_getprop(child, "AAPL,interrupts", intr,
    166      1.1   tsubai 				sizeof(intr));
    167      1.1   tsubai 		if (ca.ca_nintr == -1)
    168      1.1   tsubai 			ca.ca_nintr = OF_getprop(child, "interrupts", intr,
    169      1.1   tsubai 					sizeof(intr));
    170      1.1   tsubai 		ca.ca_reg = reg;
    171      1.1   tsubai 		ca.ca_intr = intr;
    172      1.1   tsubai 
    173      1.2   tsubai 		content = config_found(&sc->sc_dev, &ca, mediabay_print);
    174      1.2   tsubai 		if (content) {
    175      1.2   tsubai 			sc->sc_content = content;
    176      1.2   tsubai 			return;
    177      1.2   tsubai 		}
    178      1.1   tsubai 	}
    179      1.2   tsubai 
    180      1.2   tsubai 	/* No devices found.  Disable media-bay. */
    181      1.2   tsubai 	fcr &= ~(FCR_MEDIABAY_ENABLE | FCR_MEDIABAY_IDE_ENABLE |
    182      1.2   tsubai 		 FCR_MEDIABAY_CD_POWER | FCR_MEDIABAY_FD_ENABLE);
    183      1.2   tsubai 	out32rb(sc->sc_fcr, fcr);
    184      1.1   tsubai }
    185      1.1   tsubai 
    186      1.1   tsubai int
    187      1.1   tsubai mediabay_print(aux, mediabay)
    188      1.1   tsubai 	void *aux;
    189      1.1   tsubai 	const char *mediabay;
    190      1.1   tsubai {
    191      1.1   tsubai 	struct confargs *ca = aux;
    192      1.1   tsubai 
    193      1.2   tsubai 	if (mediabay == NULL && ca->ca_nreg > 0)
    194      1.7  thorpej 		aprint_normal(" offset 0x%x", ca->ca_reg[0]);
    195      1.1   tsubai 
    196      1.2   tsubai 	return QUIET;
    197      1.1   tsubai }
    198      1.1   tsubai 
    199      1.1   tsubai int
    200      1.1   tsubai mediabay_intr(v)
    201      1.1   tsubai 	void *v;
    202      1.1   tsubai {
    203      1.1   tsubai 	struct mediabay_softc *sc = v;
    204      1.1   tsubai 
    205      1.2   tsubai 	wakeup(&sc->sc_kthread);
    206      1.2   tsubai 	return 1;
    207      1.2   tsubai }
    208      1.2   tsubai 
    209      1.2   tsubai void
    210      1.2   tsubai mediabay_create_kthread(v)
    211      1.2   tsubai 	void *v;
    212      1.2   tsubai {
    213      1.2   tsubai 	struct mediabay_softc *sc = v;
    214      1.2   tsubai 
    215      1.2   tsubai 	kthread_create1(mediabay_kthread, sc, &sc->sc_kthread, "media-bay");
    216      1.2   tsubai }
    217      1.2   tsubai 
    218      1.2   tsubai void
    219      1.2   tsubai mediabay_kthread(v)
    220      1.2   tsubai 	void *v;
    221      1.2   tsubai {
    222      1.2   tsubai 	struct mediabay_softc *sc = v;
    223      1.2   tsubai 	u_int x, fcr;
    224      1.2   tsubai 
    225      1.2   tsubai sleep:
    226      1.2   tsubai 	tsleep(&sc->sc_kthread, PRIBIO, "mbayev", 0);
    227      1.2   tsubai 
    228      1.2   tsubai 	/* sleep 0.25 sec */
    229      1.2   tsubai 	tsleep(mediabay_kthread, PRIBIO, "mbayev", hz/4);
    230      1.2   tsubai 
    231      1.2   tsubai 	DPRINTF("%s: ", sc->sc_dev.dv_xname);
    232      1.1   tsubai 	x = in32rb(sc->sc_addr);
    233      1.1   tsubai 
    234      1.1   tsubai 	switch (MEDIABAY_ID(x)) {
    235      1.1   tsubai 	case MEDIABAY_ID_NONE:
    236      1.2   tsubai 		DPRINTF("removed\n");
    237      1.2   tsubai 		if (sc->sc_content != NULL) {
    238      1.2   tsubai 			config_detach(sc->sc_content, DETACH_FORCE);
    239      1.2   tsubai 			DPRINTF("%s: detach done\n", sc->sc_dev.dv_xname);
    240      1.2   tsubai 			sc->sc_content = NULL;
    241      1.2   tsubai 
    242      1.2   tsubai 			/* disable media-bay */
    243      1.2   tsubai 			fcr = in32rb(sc->sc_fcr);
    244      1.2   tsubai 			fcr &= ~(FCR_MEDIABAY_ENABLE |
    245      1.2   tsubai 				 FCR_MEDIABAY_IDE_ENABLE |
    246      1.2   tsubai 				 FCR_MEDIABAY_CD_POWER |
    247      1.2   tsubai 				 FCR_MEDIABAY_FD_ENABLE);
    248      1.2   tsubai 			out32rb(sc->sc_fcr, fcr);
    249      1.2   tsubai 		}
    250      1.1   tsubai 		break;
    251      1.1   tsubai 	case MEDIABAY_ID_FD:
    252      1.2   tsubai 		DPRINTF("FD inserted\n");
    253      1.1   tsubai 		break;
    254      1.1   tsubai 	case MEDIABAY_ID_CD:
    255      1.2   tsubai 		DPRINTF("CD inserted\n");
    256      1.2   tsubai 
    257      1.2   tsubai 		if (sc->sc_content == NULL)
    258      1.2   tsubai 			mediabay_attach_content(sc);
    259      1.1   tsubai 		break;
    260      1.1   tsubai 	default:
    261      1.1   tsubai 		printf("unknown event (0x%x)\n", x);
    262      1.1   tsubai 	}
    263      1.1   tsubai 
    264      1.2   tsubai 	goto sleep;
    265      1.1   tsubai }
    266      1.1   tsubai 
    267      1.1   tsubai /* PBG3: 0x7025X0c0 */
    268      1.1   tsubai /* 2400: 0x0070X0a8 */
    269