Module Name: src
Committed By: palle
Date: Fri Jun 17 21:59:06 UTC 2016
Added Files:
src/sys/arch/sparc64/dev: vbus.c vbusvar.h vrtc.c
Log Message:
sun4v: vbus and vrtc drivers - from OpenBSD
To generate a diff of this commit:
cvs rdiff -u -r0 -r1.1 src/sys/arch/sparc64/dev/vbus.c \
src/sys/arch/sparc64/dev/vbusvar.h src/sys/arch/sparc64/dev/vrtc.c
Please note that diffs are not public domain; they are subject to the
copyright notices on the relevant files.
Added files:
Index: src/sys/arch/sparc64/dev/vbus.c
diff -u /dev/null src/sys/arch/sparc64/dev/vbus.c:1.1
--- /dev/null Fri Jun 17 21:59:06 2016
+++ src/sys/arch/sparc64/dev/vbus.c Fri Jun 17 21:59:06 2016
@@ -0,0 +1,273 @@
+/* $NetBSD: vbus.c,v 1.1 2016/06/17 21:59:06 palle Exp $ */
+/* $OpenBSD: vbus.c,v 1.8 2015/09/27 11:29:20 kettenis Exp $ */
+/*
+ * Copyright (c) 2008 Mark Kettenis
+ *
+ * Permission to use, copy, modify, and distribute this software for any
+ * purpose with or without fee is hereby granted, provided that the above
+ * copyright notice and this permission notice appear in all copies.
+ *
+ * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
+ * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
+ * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
+ * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
+ * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
+ * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
+ * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
+ */
+
+#include <sys/param.h>
+#include <sys/device.h>
+#include <sys/malloc.h>
+#include <sys/systm.h>
+
+#include <machine/autoconf.h>
+#include <machine/hypervisor.h>
+#include <machine/openfirm.h>
+
+#include <sparc64/dev/vbusvar.h>
+
+#include <sparc64/dev/iommureg.h>
+
+#include <dev/clock_subr.h>
+extern todr_chip_handle_t todr_handle;
+
+#ifdef DEBUG
+#define VBUS_INTR 0x01
+int vbus_debug = 0x00|VBUS_INTR;
+#define DPRINTF(l, s) do { if (vbus_debug & l) printf s; } while (0)
+#else
+#define DPRINTF(l, s)
+#endif
+
+struct vbus_softc {
+ device_t sc_dv;
+ bus_space_tag_t sc_bustag;
+ bus_dma_tag_t sc_dmatag;
+};
+int vbus_cmp_cells(int *, int *, int *, int);
+int vbus_match(device_t, cfdata_t, void *);
+void vbus_attach(device_t, device_t, void *);
+int vbus_print(void *, const char *);
+
+CFATTACH_DECL_NEW(vbus, sizeof(struct vbus_softc),
+ vbus_match, vbus_attach, NULL, NULL);
+
+void *vbus_intr_establish(bus_space_tag_t, int, int,
+ int (*)(void *), void *, void (*)(void));
+void vbus_intr_ack(struct intrhand *);
+bus_space_tag_t vbus_alloc_bus_tag(struct vbus_softc *, bus_space_tag_t);
+
+int
+vbus_match(device_t parent, cfdata_t match, void *aux)
+{
+ struct mainbus_attach_args *ma = aux;
+
+ if (strcmp(ma->ma_name, "virtual-devices") == 0)
+ return (1);
+
+ return (0);
+}
+
+void
+vbus_attach(device_t parent, device_t self, void *aux)
+{
+ struct vbus_softc *sc = (struct vbus_softc *)self;
+ struct mainbus_attach_args *ma = aux;
+ int node;
+
+ sc->sc_bustag = vbus_alloc_bus_tag(sc, ma->ma_bustag);
+ sc->sc_dmatag = ma->ma_dmatag;
+ printf("\n");
+
+ for (node = OF_child(ma->ma_node); node; node = OF_peer(node)) {
+ struct vbus_attach_args va;
+ char buf[32];
+
+ bzero(&va, sizeof(va));
+ va.va_node = node;
+ if (OF_getprop(node, "name", buf, sizeof(buf)) <= 0)
+ continue;
+ va.va_name = buf;
+ va.va_bustag = sc->sc_bustag;
+ va.va_dmatag = sc->sc_dmatag;
+ prom_getprop(node, "reg", sizeof(*va.va_reg),
+ &va.va_nreg, (void **)&va.va_reg);
+ prom_getprop(node, "interrupts", sizeof(*va.va_intr),
+ &va.va_nintr, (void **)&va.va_intr);
+ config_found(self, &va, vbus_print);
+ }
+
+ struct vbus_attach_args va;
+ bzero(&va, sizeof(va));
+ va.va_name = "rtc";
+ config_found(self, &va, vbus_print);
+
+}
+
+int
+vbus_print(void *aux, const char *name)
+{
+ struct vbus_attach_args *va = aux;
+
+ if (name)
+ printf("\"%s\" at %s", va->va_name, name);
+ return (UNCONF);
+}
+
+/*
+ * Compare a sequence of cells with a mask, return 1 if they match and
+ * 0 if they don't.
+ */
+int
+vbus_cmp_cells(int *cell1, int *cell2, int *mask, int ncells)
+{
+ int i;
+
+ for (i = 0; i < ncells; i++) {
+ if (((cell1[i] ^ cell2[i]) & mask[i]) != 0)
+ return (0);
+ }
+ return (1);
+}
+
+int
+vbus_intr_map(int node, int ino, uint64_t *sysino)
+{
+ int *imap = NULL, nimap;
+ int *reg = NULL, nreg;
+ int *imap_mask;
+ int parent;
+ int address_cells, interrupt_cells;
+ uint64_t devhandle;
+ uint64_t devino;
+ int len;
+ int err;
+
+ DPRINTF(VBUS_INTR, ("vbus_intr_map(): ino 0x%x\n", ino));
+
+ parent = OF_parent(node);
+
+ address_cells = prom_getpropint(parent, "#address-cells", 2);
+ interrupt_cells = prom_getpropint(parent, "#interrupt-cells", 1);
+ KASSERT(interrupt_cells == 1);
+
+ len = OF_getproplen(parent, "interrupt-map-mask");
+ if (len < (address_cells + interrupt_cells) * sizeof(int))
+ return (-1);
+ imap_mask = malloc(len, M_DEVBUF, M_NOWAIT);
+ if (imap_mask == NULL)
+ return (-1);
+ if (OF_getprop(parent, "interrupt-map-mask", imap_mask, len) != len)
+ return (-1);
+
+ if (prom_getprop(parent, "interrupt-map", sizeof(int), &nimap, (void **)&imap))
+ panic("vbus: can't get interrupt-map");
+
+ if (prom_getprop(node, "reg", sizeof(*reg), &nreg, (void **)®))
+ panic("vbus: can't get reg");
+ if (nreg < address_cells)
+ return (-1);
+
+ while (nimap >= address_cells + interrupt_cells + 2) {
+ if (vbus_cmp_cells(imap, reg, imap_mask, address_cells) &&
+ vbus_cmp_cells(&imap[address_cells], &ino,
+ &imap_mask[address_cells], interrupt_cells)) {
+ node = imap[address_cells + interrupt_cells];
+ devino = imap[address_cells + interrupt_cells + 1];
+
+ free(reg, M_DEVBUF);
+ reg = NULL;
+
+ if (prom_getprop(node, "reg", sizeof(*reg), &nreg, (void **)®))
+ panic("vbus: can't get reg");
+
+ devhandle = reg[0] & 0x0fffffff;
+
+ err = hv_intr_devino_to_sysino(devhandle, devino, sysino);
+ if (err != H_EOK)
+ return (-1);
+
+ KASSERT(*sysino == INTVEC(*sysino));
+ return (0);
+ }
+ imap += address_cells + interrupt_cells + 2;
+ nimap -= address_cells + interrupt_cells + 2;
+ }
+
+ return (-1);
+}
+
+void *
+vbus_intr_establish(bus_space_tag_t t, int ihandle, int level,
+ int (*handler)(void *), void *arg, void (*fastvec)(void) /* ignored */)
+{
+ uint64_t sysino = INTVEC(ihandle);
+ struct intrhand *ih;
+ int ino;
+ int err;
+
+ DPRINTF(VBUS_INTR, ("vbus_intr_establish()\n"));
+
+ ino = INTINO(ihandle);
+
+ ih = intrhand_alloc();
+
+ ih->ih_ivec = ihandle;
+ ih->ih_fun = handler;
+ ih->ih_arg = arg;
+ ih->ih_pil = level;
+ ih->ih_number = ino;
+ ih->ih_pending = 0;
+
+ intr_establish(ih->ih_pil, level != IPL_VM, ih);
+ ih->ih_ack = vbus_intr_ack;
+
+ err = hv_intr_settarget(sysino, cpus->ci_cpuid);
+ if (err != H_EOK) {
+ printf("hv_intr_settarget(%lu, %u) failed - err = %d\n",
+ (long unsigned int)sysino, cpus->ci_cpuid, err);
+ return (NULL);
+ }
+
+ /* Clear pending interrupts. */
+ err = hv_intr_setstate(sysino, INTR_IDLE);
+ if (err != H_EOK) {
+ printf("hv_intr_setstate(%lu, INTR_IDLE) failed - err = %d\n",
+ (long unsigned int)sysino, err);
+ return (NULL);
+ }
+
+ err = hv_intr_setenabled(sysino, INTR_ENABLED);
+ if (err != H_EOK) {
+ printf("hv_intr_setenabled(%lu) failed - err = %d\n",
+ (long unsigned int)sysino, err);
+ return (NULL);
+ }
+
+ return (ih);
+}
+
+void
+vbus_intr_ack(struct intrhand *ih)
+{
+ DPRINTF(VBUS_INTR, ("vbus_intr_ack()\n"));
+ hv_intr_setstate(ih->ih_number, INTR_IDLE);
+}
+
+bus_space_tag_t
+vbus_alloc_bus_tag(struct vbus_softc *sc, bus_space_tag_t parent)
+{
+ struct sparc_bus_space_tag *bt;
+
+ bt = malloc(sizeof(*bt), M_DEVBUF, M_NOWAIT | M_ZERO);
+ if (bt == NULL)
+ panic("could not allocate vbus bus tag");
+
+ bt->cookie = sc;
+ bt->parent = parent;
+ bt->sparc_bus_map = parent->sparc_bus_map;
+ bt->sparc_intr_establish = vbus_intr_establish;
+
+ return (bt);
+}
Index: src/sys/arch/sparc64/dev/vbusvar.h
diff -u /dev/null src/sys/arch/sparc64/dev/vbusvar.h:1.1
--- /dev/null Fri Jun 17 21:59:06 2016
+++ src/sys/arch/sparc64/dev/vbusvar.h Fri Jun 17 21:59:06 2016
@@ -0,0 +1,38 @@
+/* $NetBSD: vbusvar.h,v 1.1 2016/06/17 21:59:06 palle Exp $ */
+/* $OpenBSD: vbusvar.h,v 1.3 2008/12/30 21:23:33 kettenis Exp $ */
+/*
+ * Copyright (c) 2008 Mark Kettenis
+ *
+ * Permission to use, copy, modify, and distribute this software for any
+ * purpose with or without fee is hereby granted, provided that the above
+ * copyright notice and this permission notice appear in all copies.
+ *
+ * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
+ * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
+ * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
+ * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
+ * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
+ * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
+ * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
+ */
+
+#ifndef _SPARC64_DEV_VBUSVAR_H_
+#define _SPARC64_DEV_VBUSVAR_H_
+
+struct vbus_attach_args {
+ const char *va_name;
+ int va_node;
+
+ bus_space_tag_t va_bustag;
+ bus_dma_tag_t va_dmatag;
+
+ u_int32_t *va_reg;
+ u_int32_t *va_intr;
+
+ int va_nreg;
+ int va_nintr;
+};
+
+int vbus_intr_map(int, int, uint64_t *);
+
+#endif
Index: src/sys/arch/sparc64/dev/vrtc.c
diff -u /dev/null src/sys/arch/sparc64/dev/vrtc.c:1.1
--- /dev/null Fri Jun 17 21:59:06 2016
+++ src/sys/arch/sparc64/dev/vrtc.c Fri Jun 17 21:59:06 2016
@@ -0,0 +1,94 @@
+/* $NetBSD: vrtc.c,v 1.1 2016/06/17 21:59:06 palle Exp $ */
+/* $OpenBSD: vrtc.c,v 1.1 2008/03/08 19:19:43 kettenis Exp $ */
+/*
+ * Copyright (c) 2008 Mark Kettenis
+ *
+ * Permission to use, copy, modify, and distribute this software for any
+ * purpose with or without fee is hereby granted, provided that the above
+ * copyright notice and this permission notice appear in all copies.
+ *
+ * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
+ * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
+ * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
+ * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
+ * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
+ * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
+ * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
+ */
+
+#include <sys/param.h>
+#include <sys/device.h>
+#include <sys/malloc.h>
+#include <sys/systm.h>
+
+#include <machine/autoconf.h>
+#include <machine/hypervisor.h>
+#include <machine/openfirm.h>
+
+#include <dev/clock_subr.h>
+#include <sparc64/dev/vbusvar.h>
+
+extern todr_chip_handle_t todr_handle;
+
+int vrtc_match(device_t, cfdata_t, void *);
+void vrtc_attach(device_t, device_t, void *);
+
+CFATTACH_DECL_NEW(vrtc, sizeof(device_t),
+ vrtc_match, vrtc_attach, NULL, NULL);
+
+int vrtc_gettime(todr_chip_handle_t, struct timeval *);
+int vrtc_settime(todr_chip_handle_t, struct timeval *);
+
+int
+vrtc_match(device_t parent, cfdata_t match, void *aux)
+{
+ struct vbus_attach_args *va = aux;
+
+ if (strcmp(va->va_name, "rtc") == 0)
+ return (1);
+
+ return (0);
+}
+
+void
+vrtc_attach(device_t parent, device_t self, void *aux)
+{
+ todr_chip_handle_t handle;
+
+ printf("\n");
+
+ handle = malloc(sizeof(struct todr_chip_handle), M_DEVBUF,M_NOWAIT);
+ if (handle == NULL)
+ panic("couldn't allocate todr_handle");
+
+ handle->cookie = self;
+ handle->todr_gettime = vrtc_gettime;
+ handle->todr_settime = vrtc_settime;
+
+ handle->bus_cookie = NULL;
+ handle->todr_setwen = NULL;
+
+ todr_attach(handle);
+}
+
+int
+vrtc_gettime(todr_chip_handle_t handle, struct timeval *tv)
+{
+ u_int64_t tod;
+
+ if (hv_tod_get(&tod) != H_EOK)
+ return (1);
+
+ tv->tv_sec = tod;
+ tv->tv_usec = 0;
+ return (0);
+}
+
+int
+vrtc_settime(todr_chip_handle_t handle, struct timeval *tv)
+{
+ if (hv_tod_set(tv->tv_sec) != H_EOK)
+ return (1);
+
+ return (0);
+}
