mediabay driver to configure ata bus attached to CD on pismo Powerbook

tested by Glen Barney and Okan Demirmen.

1 files changed, 280 insertions, 0 deletions

diff --git a/sys/arch/macppc/dev/mediabay.c b/sys/arch/macppc/dev/mediabay.c
new file mode 100644
index 00000000000..6eeb0720ac4
--- /dev/null
+++ b/sys/arch/macppc/dev/mediabay.c
@@ -0,0 +1,280 @@
+/*	$OpenBSD: mediabay.c,v 1.1 2004/05/10 21:29:53 drahn Exp $	*/
+/*	$NetBSD: mediabay.c,v 1.9 2003/07/15 02:43:29 lukem Exp $	*/
+
+/*-
+ * Copyright (C) 1999 Tsubai Masanari.  All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions
+ * are met:
+ * 1. Redistributions of source code must retain the above copyright
+ *    notice, this list of conditions and the following disclaimer.
+ * 2. Redistributions in binary form must reproduce the above copyright
+ *    notice, this list of conditions and the following disclaimer in the
+ *    documentation and/or other materials provided with the distribution.
+ * 3. The name of the author may not be used to endorse or promote products
+ *    derived from this software without specific prior written permission.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
+ * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
+ * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
+ * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
+ * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
+ * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
+ * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ */
+
+#include <sys/cdefs.h>
+
+#include <sys/param.h>
+#include <sys/device.h>
+#include <sys/kernel.h>
+#include <sys/kthread.h>
+#include <sys/systm.h>
+
+#include <uvm/uvm_extern.h>
+
+#include <dev/ofw/openfirm.h>
+
+#include <machine/autoconf.h>
+#include <machine/pio.h>
+
+struct mediabay_softc {
+	struct device sc_dev;
+	int sc_node;
+	u_int *sc_addr;
+	u_int *sc_fcr;
+	u_int sc_baseaddr;
+	bus_space_tag_t sc_iot;
+	bus_dma_tag_t sc_dmat;
+	struct device *sc_content;
+	struct proc *sc_kthread;
+};
+
+void mediabay_attach __P((struct device *, struct device *, void *));
+int mediabay_match __P((struct device *, void *, void *));
+int mediabay_print __P((void *, const char *));
+void mediabay_attach_content __P((struct mediabay_softc *));
+int mediabay_intr __P((void *));
+void mediabay_create_kthread __P((void *));
+void mediabay_kthread __P((void *));
+
+struct cfattach mediabay_ca = {
+	sizeof(struct mediabay_softc), mediabay_match, mediabay_attach
+};
+struct cfdriver mediabay_cd = {
+	NULL, "mediabay", DV_DULL
+};
+
+
+#ifdef MEDIABAY_DEBUG
+# define DPRINTF printf
+#else
+# define DPRINTF while (0) printf
+#endif
+
+#define FCR_MEDIABAY_RESET	0x00000002
+#define FCR_MEDIABAY_IDE_ENABLE	0x00000008
+#define FCR_MEDIABAY_FD_ENABLE	0x00000010
+#define FCR_MEDIABAY_ENABLE	0x00000080
+#define FCR_MEDIABAY_CD_POWER	0x00800000
+
+#define MEDIABAY_ID(x)		(((x) >> 12) & 0xf)
+#define MEDIABAY_ID_FD		0
+#define MEDIABAY_ID_CD		3
+#define MEDIABAY_ID_NONE	7
+
+int
+mediabay_match(parent, v, aux)
+	struct device *parent;
+	void *v;
+	void *aux;
+{
+	struct confargs *ca = aux;
+
+	if (strcmp(ca->ca_name, "media-bay") == 0)
+		return 1;
+
+	return 0;
+}
+
+/*
+ * Attach all the sub-devices we can find
+ */
+void
+mediabay_attach(parent, self, aux)
+	struct device *parent, *self;
+	void *aux;
+{
+	struct mediabay_softc *sc = (struct mediabay_softc *)self;
+	struct confargs *ca = aux;
+	int irq, type;
+
+	ca->ca_reg[0] += ca->ca_baseaddr;
+
+	sc->sc_addr = mapiodev(ca->ca_reg[0], PAGE_SIZE);
+	sc->sc_fcr = sc->sc_addr + 1;
+	sc->sc_node = ca->ca_node;
+	sc->sc_baseaddr = ca->ca_baseaddr;
+	sc->sc_iot = ca->ca_iot;
+	sc->sc_dmat = ca->ca_dmat;
+	irq = ca->ca_intr[0];
+	type = IST_LEVEL;
+
+	if (ca->ca_nintr == 8 && ca->ca_intr[1] == 0)
+		type = IST_EDGE;
+
+	printf(" irq %d\n", irq);
+	mac_intr_establish(parent, irq, type, IPL_BIO, mediabay_intr, sc,
+	    "mediabay");
+
+	kthread_create_deferred(mediabay_create_kthread, sc);
+
+	sc->sc_content = NULL;
+
+	if (MEDIABAY_ID(in32rb(sc->sc_addr)) != MEDIABAY_ID_NONE)
+		mediabay_attach_content(sc);
+}
+
+void
+mediabay_attach_content(sc)
+	struct mediabay_softc *sc;
+{
+	int child;
+	u_int fcr;
+	struct device *content;
+	struct confargs ca;
+	u_int reg[20], intr[5];
+	char name[32];
+
+	fcr = in32rb(sc->sc_fcr);
+	fcr |= FCR_MEDIABAY_ENABLE | FCR_MEDIABAY_RESET;
+	out32rb(sc->sc_fcr, fcr);
+	delay(50000);
+
+	fcr &= ~FCR_MEDIABAY_RESET;
+	out32rb(sc->sc_fcr, fcr);
+	delay(50000);
+
+	fcr |= FCR_MEDIABAY_IDE_ENABLE | FCR_MEDIABAY_CD_POWER;
+	out32rb(sc->sc_fcr, fcr);
+	delay(50000);
+
+	for (child = OF_child(sc->sc_node); child; child = OF_peer(child)) {
+		memset(name, 0, sizeof(name));
+		if (OF_getprop(child, "name", name, sizeof(name)) == -1)
+			continue;
+		ca.ca_name = name;
+		ca.ca_node = child;
+		ca.ca_baseaddr = sc->sc_baseaddr;
+		ca.ca_iot = sc->sc_iot;
+		ca.ca_dmat = sc->sc_dmat;
+
+		ca.ca_nreg  = OF_getprop(child, "reg", reg, sizeof(reg));
+		ca.ca_nintr = OF_getprop(child, "AAPL,interrupts", intr,
+				sizeof(intr));
+		if (ca.ca_nintr == -1)
+			ca.ca_nintr = OF_getprop(child, "interrupts", intr,
+					sizeof(intr));
+		ca.ca_reg = reg;
+		ca.ca_intr = intr;
+
+		content = config_found(&sc->sc_dev, &ca, mediabay_print);
+		if (content) {
+			sc->sc_content = content;
+			return;
+		}
+	}
+
+	/* No devices found.  Disable media-bay. */
+	fcr &= ~(FCR_MEDIABAY_ENABLE | FCR_MEDIABAY_IDE_ENABLE |
+		 FCR_MEDIABAY_CD_POWER | FCR_MEDIABAY_FD_ENABLE);
+	out32rb(sc->sc_fcr, fcr);
+}
+
+int
+mediabay_print(aux, mediabay)
+	void *aux;
+	const char *mediabay;
+{
+	struct confargs *ca = aux;
+
+	if (mediabay == NULL && ca->ca_nreg > 0)
+		printf(" offset 0x%x", ca->ca_reg[0]);
+
+	return QUIET;
+}
+
+int
+mediabay_intr(v)
+	void *v;
+{
+	struct mediabay_softc *sc = v;
+
+	wakeup(&sc->sc_kthread);
+	return 1;
+}
+
+void
+mediabay_create_kthread(v)
+	void *v;
+{
+	struct mediabay_softc *sc = v;
+
+	kthread_create(mediabay_kthread, sc, &sc->sc_kthread, "media-bay");
+}
+
+void
+mediabay_kthread(v)
+	void *v;
+{
+	struct mediabay_softc *sc = v;
+	u_int x, fcr;
+
+sleep:
+	tsleep(&sc->sc_kthread, PRIBIO, "mbayev", 0);
+
+	/* sleep 0.25 sec */
+	tsleep(mediabay_kthread, PRIBIO, "mbayev", hz/4);
+
+	DPRINTF("%s: ", sc->sc_dev.dv_xname);
+	x = in32rb(sc->sc_addr);
+
+	switch (MEDIABAY_ID(x)) {
+	case MEDIABAY_ID_NONE:
+		DPRINTF("removed\n");
+		if (sc->sc_content != NULL) {
+			config_detach(sc->sc_content, DETACH_FORCE);
+			DPRINTF("%s: detach done\n", sc->sc_dev.dv_xname);
+			sc->sc_content = NULL;
+
+			/* disable media-bay */
+			fcr = in32rb(sc->sc_fcr);
+			fcr &= ~(FCR_MEDIABAY_ENABLE |
+				 FCR_MEDIABAY_IDE_ENABLE |
+				 FCR_MEDIABAY_CD_POWER |
+				 FCR_MEDIABAY_FD_ENABLE);
+			out32rb(sc->sc_fcr, fcr);
+		}
+		break;
+	case MEDIABAY_ID_FD:
+		DPRINTF("FD inserted\n");
+		break;
+	case MEDIABAY_ID_CD:
+		DPRINTF("CD inserted\n");
+
+		if (sc->sc_content == NULL)
+			mediabay_attach_content(sc);
+		break;
+	default:
+		printf("unknown event (0x%x)\n", x);
+	}
+
+	goto sleep;
+}
+
+/* PBG3: 0x7025X0c0 */
+/* 2400: 0x0070X0a8 */