From: patrick <patrick@openbsd.org>
Date: Wed, 17 May 2023 23:30:58 +0000 (+0000)
Subject: Add qcmtx(4), a driver for the hardware spinlock on Qualcomm SoCs that
X-Git-Url: http://artulab.com/gitweb/?a=commitdiff_plain;h=5763838533a58e19b33aacbc442838580ac65c19;p=openbsd

Add qcmtx(4), a driver for the hardware spinlock on Qualcomm SoCs that
is used to synchronize access to the shared memory table between the
application cores we run on and the co-processors next to us.

ok kettenis@ drahn@
---

diff --git a/sys/arch/arm64/conf/GENERIC b/sys/arch/arm64/conf/GENERIC
index 17c38f6d1a1..ecdb0e82448 100644
--- a/sys/arch/arm64/conf/GENERIC
+++ b/sys/arch/arm64/conf/GENERIC
@@ -1,4 +1,4 @@
-# $OpenBSD: GENERIC,v 1.268 2023/05/17 23:18:59 patrick Exp $
+# $OpenBSD: GENERIC,v 1.269 2023/05/17 23:30:58 patrick Exp $
 #
 # GENERIC machine description file
 #
@@ -327,6 +327,7 @@ qciic*		at acpi?
 qciic*		at fdt?
 iic*		at qciic?
 qcipcc*		at fdt?
+qcmtx*		at fdt? early 1
 qcpdc*		at fdt?
 qcscm*		at fdt?
 qcspmi*		at fdt?
diff --git a/sys/arch/arm64/conf/RAMDISK b/sys/arch/arm64/conf/RAMDISK
index 97514600aa5..5fb4af166db 100644
--- a/sys/arch/arm64/conf/RAMDISK
+++ b/sys/arch/arm64/conf/RAMDISK
@@ -1,4 +1,4 @@
-# $OpenBSD: RAMDISK,v 1.201 2023/05/17 23:18:59 patrick Exp $
+# $OpenBSD: RAMDISK,v 1.202 2023/05/17 23:30:58 patrick Exp $
 
 machine		arm64
 maxusers	4
@@ -251,6 +251,7 @@ qciic*		at acpi?
 qciic*		at fdt?
 iic*		at qciic?
 qcipcc*		at fdt?
+qcmtx*		at fdt? early 1
 qcpdc*		at fdt?
 qcscm*		at fdt?
 qcspmi*		at fdt?
diff --git a/sys/dev/fdt/files.fdt b/sys/dev/fdt/files.fdt
index d336538fd61..a9bba15c39b 100644
--- a/sys/dev/fdt/files.fdt
+++ b/sys/dev/fdt/files.fdt
@@ -1,4 +1,4 @@
-#	$OpenBSD: files.fdt,v 1.188 2023/05/17 23:19:00 patrick Exp $
+#	$OpenBSD: files.fdt,v 1.189 2023/05/17 23:30:58 patrick Exp $
 #
 # Config file and device description for machine-independent FDT code.
 # Included by ports that need it.
@@ -681,6 +681,11 @@ device	qcipcc
 attach	qcipcc at fdt
 file	dev/fdt/qcipcc.c		qcipcc
 
+# Qualcomm Hardware Spinlock
+device	qcmtx
+attach	qcmtx at fdt
+file	dev/fdt/qcmtx.c			qcmtx
+
 # Qualcomm SCM
 device	qcscm
 attach	qcscm at fdt
diff --git a/sys/dev/fdt/qcmtx.c b/sys/dev/fdt/qcmtx.c
new file mode 100644
index 00000000000..ad8b628a7cb
--- /dev/null
+++ b/sys/dev/fdt/qcmtx.c
@@ -0,0 +1,117 @@
+/*	$OpenBSD: qcmtx.c,v 1.1 2023/05/17 23:30:58 patrick Exp $	*/
+/*
+ * Copyright (c) 2023 Patrick Wildt <patrick@blueri.se>
+ *
+ * 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/systm.h>
+#include <sys/device.h>
+#include <sys/malloc.h>
+
+#include <machine/bus.h>
+#include <machine/fdt.h>
+
+#include <dev/ofw/openfirm.h>
+#include <dev/ofw/ofw_misc.h>
+#include <dev/ofw/fdt.h>
+
+#define QCMTX_OFF(idx)		((idx) * 0x1000)
+#define QCMTX_NUM_LOCKS		32
+#define QCMTX_APPS_PROC_ID	1
+
+#define HREAD4(sc, reg)							\
+	(bus_space_read_4((sc)->sc_iot, (sc)->sc_ioh, (reg)))
+#define HWRITE4(sc, reg, val)						\
+	bus_space_write_4((sc)->sc_iot, (sc)->sc_ioh, (reg), (val))
+
+struct qcmtx_softc {
+	struct device		sc_dev;
+	bus_space_tag_t		sc_iot;
+	bus_space_handle_t	sc_ioh;
+	int			sc_node;
+
+	struct hwlock_device	sc_hd;
+};
+
+int	qcmtx_match(struct device *, void *, void *);
+void	qcmtx_attach(struct device *, struct device *, void *);
+
+int	qcmtx_lock(void *, uint32_t *, int);
+
+const struct cfattach qcmtx_ca = {
+	sizeof (struct qcmtx_softc), qcmtx_match, qcmtx_attach
+};
+
+struct cfdriver qcmtx_cd = {
+	NULL, "qcmtx", DV_DULL
+};
+
+int
+qcmtx_match(struct device *parent, void *match, void *aux)
+{
+	struct fdt_attach_args *faa = aux;
+
+	return OF_is_compatible(faa->fa_node, "qcom,tcsr-mutex");
+}
+
+void
+qcmtx_attach(struct device *parent, struct device *self, void *aux)
+{
+	struct qcmtx_softc *sc = (struct qcmtx_softc *)self;
+	struct fdt_attach_args *faa = aux;
+
+	if (faa->fa_nreg < 1) {
+		printf(": no registers\n");
+		return;
+	}
+
+	sc->sc_node = faa->fa_node;
+	sc->sc_iot = faa->fa_iot;
+	if (bus_space_map(sc->sc_iot, faa->fa_reg[0].addr,
+	    faa->fa_reg[0].size, 0, &sc->sc_ioh)) {
+		printf(": can't map registers\n");
+		return;
+	}
+
+	printf("\n");
+
+	sc->sc_hd.hd_node = faa->fa_node;
+	sc->sc_hd.hd_cookie = sc;
+	sc->sc_hd.hd_lock = qcmtx_lock;
+	hwlock_register(&sc->sc_hd);
+}
+
+int
+qcmtx_lock(void *cookie, uint32_t *cells, int lock)
+{
+	struct qcmtx_softc *sc = cookie;
+	int idx = cells[0];
+
+	if (idx >= QCMTX_NUM_LOCKS)
+		return ENXIO;
+
+	if (lock) {
+		HWRITE4(sc, QCMTX_OFF(idx), QCMTX_APPS_PROC_ID);
+		if (HREAD4(sc, QCMTX_OFF(idx)) !=
+		    QCMTX_APPS_PROC_ID)
+			return EAGAIN;
+		KASSERT(HREAD4(sc, QCMTX_OFF(idx)) == QCMTX_APPS_PROC_ID);
+	} else {
+		KASSERT(HREAD4(sc, QCMTX_OFF(idx)) == QCMTX_APPS_PROC_ID);
+		HWRITE4(sc, QCMTX_OFF(idx), 0);
+	}
+
+	return 0;
+}