firehose controller driver (not quite working) for the e4500 (and others)

1 files changed, 197 insertions, 0 deletions

diff --git a/sys/arch/sparc64/dev/fhc.c b/sys/arch/sparc64/dev/fhc.c
new file mode 100644
index 00000000000..34c4c46e702
--- /dev/null
+++ b/sys/arch/sparc64/dev/fhc.c
@@ -0,0 +1,197 @@
+/*	$OpenBSD: fhc.c,v 1.1 2004/09/22 21:44:45 jason Exp $	*/
+
+/*
+ * Copyright (c) 2004 Jason L. Wright (jason@thought.net)
+ * 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.
+ *
+ * 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/types.h>
+#include <sys/param.h>
+#include <sys/systm.h>
+#include <sys/kernel.h>
+#include <sys/device.h>
+#include <sys/conf.h>
+#include <sys/timeout.h>
+#include <sys/malloc.h>
+
+#include <machine/bus.h>
+#include <machine/autoconf.h>
+#include <machine/openfirm.h>
+
+#include <sparc64/dev/fhcvar.h>
+
+struct cfdriver fhc_cd = {
+	NULL, "fhc", DV_DULL
+};
+
+int	fhc_print(void *, const char *);
+
+bus_space_tag_t fhc_alloc_bus_tag(struct fhc_softc *);
+int _fhc_bus_map(bus_space_tag_t, bus_space_tag_t, bus_addr_t, bus_size_t,
+    int, bus_space_handle_t *);
+
+void
+fhc_attach(struct fhc_softc *sc)
+{
+	int node0, node;
+
+	printf(": %s\n", getpropstring(sc->sc_node, "board-model"));
+
+	sc->sc_cbt = fhc_alloc_bus_tag(sc);
+
+	getprop(sc->sc_node, "ranges", sizeof(struct fhc_range),
+	    &sc->sc_nrange, (void **)&sc->sc_range);
+
+#if 0
+	for (node = 0; node < sc->sc_nrange; node++)
+	        printf("%d: cs %08x co %08x ps %08x po %08x sz %08x\n",
+	            node, sc->sc_range[node].cspace,
+		    sc->sc_range[node].coffset, sc->sc_range[node].pspace,
+		    sc->sc_range[node].poffset, sc->sc_range[node].size);
+#endif
+
+	node0 = firstchild(sc->sc_node);
+	for (node = node0; node; node = nextsibling(node)) {
+		struct fhc_attach_args fa;
+
+		bzero(&fa, sizeof(fa));
+
+		fa.fa_node = node;
+		fa.fa_bustag = sc->sc_cbt;
+
+		if (fhc_get_string(fa.fa_node, "name", &fa.fa_name)) {
+			printf("can't fetch name for node 0x%x\n", node);
+			continue;
+		}
+		getprop(node, "reg", sizeof(struct fhc_reg),
+		    &fa.fa_nreg, (void **)&fa.fa_reg);
+
+#if 0
+		printf("%s registers:\n", fa.fa_name);
+		for (i = 0; i < fa.fa_nreg; i++) {
+			printf(" %d slot 0x%x offset 0x%x size 0x%x\n", i,
+			    fa.fa_reg[i].fbr_slot,
+			    fa.fa_reg[i].fbr_offset,
+			    fa.fa_reg[i].fbr_size);
+		}
+
+		(void)config_found(&sc->sc_dv, (void *)&fa, fhc_print);
+#endif
+
+		if (fa.fa_name != NULL)
+			free(fa.fa_name, M_DEVBUF);
+		if (fa.fa_reg != NULL)
+			free(fa.fa_reg, M_DEVBUF);
+	}
+}
+
+int
+fhc_print(void *args, const char *busname)
+{
+	struct fhc_attach_args *fa = args;
+	char *class;
+
+	if (busname != NULL) {
+		printf("%s at %s", fa->fa_name, busname);
+		class = getpropstring(fa->fa_node, "device_type");
+		if (*class != '\0')
+			printf(" class %s", class);
+	}
+	return (UNCONF);
+}
+
+int
+fhc_get_string(int node, char *name, char **buf)
+{
+	int len;
+
+	len = getproplen(node, name);
+	if (len < 0)
+		return (len);
+	*buf = (char *)malloc(len + 1, M_DEVBUF, M_NOWAIT);
+	if (buf == NULL)
+		return (-1);
+
+	if (len != 0)
+		getpropstringA(node, name, *buf);
+	(*buf)[len] = '\0';
+	return (0);
+}
+
+bus_space_tag_t
+fhc_alloc_bus_tag(struct fhc_softc *sc)
+{
+	struct sparc_bus_space_tag *bt;
+
+	bt = malloc(sizeof(*bt), M_DEVBUF, M_NOWAIT);
+	if (bt == NULL)
+		panic("fhc: couldn't alloc bus tag");
+
+	bzero(bt, sizeof(*bt));
+	snprintf(bt->name, sizeof(bt->name), "%s", sc->sc_dv.dv_xname);
+	bt->cookie = sc;
+	bt->parent = sc->sc_bt;
+	bt->asi = bt->parent->asi;
+	bt->sasi = bt->parent->sasi;
+	bt->sparc_bus_map = _fhc_bus_map;
+	/* XXX bt->sparc_bus_mmap = fhc_bus_mmap; */
+	/* XXX bt->sparc_intr_establish = upa_intr_establish; */
+	return (bt);
+}
+
+int
+_fhc_bus_map(bus_space_tag_t t, bus_space_tag_t t0, bus_addr_t addr,
+    bus_size_t size, int flags, bus_space_handle_t *hp)
+{
+	struct fhc_softc *sc = t->cookie;
+	int64_t slot = BUS_ADDR_IOSPACE(addr);
+	int64_t offset = BUS_ADDR_PADDR(addr);
+	int i;
+
+	if (t->parent == NULL || t->parent->sparc_bus_map == NULL) {
+		printf("\n_fhc_bus_map: invalid parent");
+		return (EINVAL);
+	}
+
+	if (flags & BUS_SPACE_MAP_PROMADDRESS)
+		return ((*t->parent->sparc_bus_map)(t, t0, addr,
+		    size, flags, hp));
+
+	for (i = 0; i < sc->sc_nrange; i++) {
+		bus_addr_t paddr;
+
+		if (sc->sc_range[i].cspace != slot)
+			continue;
+
+		paddr = offset - sc->sc_range[i].coffset;
+		paddr += sc->sc_range[i].poffset;
+		paddr |= ((bus_addr_t)sc->sc_range[i].pspace << 32); 
+
+		printf("[fhc %llx]", (unsigned long long)paddr);
+		return ((*t->parent->sparc_bus_map)(t, t0, paddr,
+		    size, flags, hp));
+	}
+
+	return (EINVAL);
+}