Add a reset signal API alongside the clock API.

2 files changed, 150 insertions, 2 deletions

diff --git a/sys/dev/ofw/ofw_clock.c b/sys/dev/ofw/ofw_clock.c
index a0ec43a2406..ef86d876bed 100644
--- a/sys/dev/ofw/ofw_clock.c
+++ b/sys/dev/ofw/ofw_clock.c
@@ -1,4 +1,4 @@
-/*	$OpenBSD: ofw_clock.c,v 1.2 2016/08/22 11:23:54 kettenis Exp $	*/
+/*	$OpenBSD: ofw_clock.c,v 1.3 2016/08/22 18:16:58 kettenis Exp $	*/
 /*
  * Copyright (c) 2016 Mark Kettenis
  *
@@ -22,6 +22,10 @@
 #include <dev/ofw/openfirm.h>
 #include <dev/ofw/ofw_clock.h>
 
+/*
+ * Clock functionality.
+ */
+
 LIST_HEAD(, clock_device) clock_devices =
 	LIST_HEAD_INITIALIZER(clock_devices);
 
@@ -234,3 +238,132 @@ clock_disable(int node, const char *name)
 {
 	clock_do_enable(node, name, 0);
 }
+
+/*
+ * Reset functionality.
+ */
+
+LIST_HEAD(, reset_device) reset_devices =
+	LIST_HEAD_INITIALIZER(reset_devices);
+
+void
+reset_register(struct reset_device *rd)
+{
+	rd->rd_cells = OF_getpropint(rd->rd_node, "#reset-cells", 0);
+	rd->rd_phandle = OF_getpropint(rd->rd_node, "phandle", 0);
+	if (rd->rd_phandle == 0)
+		return;
+
+	LIST_INSERT_HEAD(&reset_devices, rd, rd_list);
+}
+
+void
+reset_assert_cells(uint32_t *cells, int assert)
+{
+	struct reset_device *rd;
+	uint32_t phandle = cells[0];
+
+	LIST_FOREACH(rd, &reset_devices, rd_list) {
+		if (rd->rd_phandle == phandle)
+			break;
+	}
+
+	rd->rd_reset(rd->rd_cookie, &cells[1], assert);
+}
+
+uint32_t *
+reset_next_reset(uint32_t *cells)
+{
+	uint32_t phandle = cells[0];
+	int node, ncells;
+
+	node = OF_getnodebyphandle(phandle);
+	if (node == 0)
+		return NULL;
+
+	ncells = OF_getpropint(node, "#reset-cells", 0);
+	return cells + ncells + 1;
+}
+
+int
+reset_index(int node, const char *reset)
+{
+	char *names;
+	char *name;
+	char *end;
+	int idx = 0;
+	int len;
+
+	if (reset == NULL)
+		return 0;
+
+	len = OF_getproplen(node, "reset-names");
+	if (len <= 0)
+		return -1;
+
+	names = malloc(len, M_TEMP, M_WAITOK);
+	OF_getprop(node, "reset-names", names, len);
+	end = names + len;
+	name = names;
+	while (name < end) {
+		if (strcmp(name, reset) == 0) {
+			free(names, M_TEMP, len);
+			return idx;
+		}
+		name += strlen(name) + 1;
+		idx++;
+	}
+	free(names, M_TEMP, len);
+	return -1;
+}
+
+void
+reset_do_assert_idx(int node, int idx, int assert)
+{
+	uint32_t *resets;
+	uint32_t *reset;
+	int len;
+
+	len = OF_getproplen(node, "resets");
+	if (len <= 0)
+		return;
+
+	resets = malloc(len, M_TEMP, M_WAITOK);
+	OF_getpropintarray(node, "resets", resets, len);
+
+	reset = resets;
+	while (reset && resets < resets + (len / sizeof(uint32_t))) {
+		if (idx <= 0)
+			reset_assert_cells(reset, assert);
+		if (idx == 0)
+			break;
+		reset = reset_next_reset(reset);
+		idx--;
+	}
+
+	free(resets, M_TEMP, len);
+}
+
+void
+reset_do_assert(int node, const char *name, int assert)
+{
+	int idx;
+
+	idx = reset_index(node, name);
+	if (idx == -1)
+		return;
+
+	reset_do_assert_idx(node, idx, assert);
+}
+
+void
+reset_assert(int node, const char *name)
+{
+	reset_do_assert(node, name, 1);
+}
+
+void
+reset_deassert(int node, const char *name)
+{
+	reset_do_assert(node, name, 0);
+}
diff --git a/sys/dev/ofw/ofw_clock.h b/sys/dev/ofw/ofw_clock.h
index d67f959ba41..fdeff05d554 100644
--- a/sys/dev/ofw/ofw_clock.h
+++ b/sys/dev/ofw/ofw_clock.h
@@ -1,4 +1,4 @@
-/*	$OpenBSD: ofw_clock.h,v 1.2 2016/08/22 11:23:54 kettenis Exp $	*/
+/*	$OpenBSD: ofw_clock.h,v 1.3 2016/08/22 18:16:58 kettenis Exp $	*/
 /*
  * Copyright (c) 2016 Mark Kettenis
  *
@@ -50,4 +50,19 @@ clock_disable_all(int node)
 	clock_disable_idx(node, -1);
 }
 
+struct reset_device {
+	int	rd_node;
+	void	*rd_cookie;
+	void	(*rd_reset)(void *, uint32_t *, int);
+
+	LIST_ENTRY(reset_device) rd_list;
+	uint32_t rd_phandle;
+	uint32_t rd_cells;
+};
+
+void	reset_register(struct reset_device *);
+
+void	reset_assert(int, const char *);
+void	reset_deassert(int, const char *);
+
 #endif /* _DEV_OFW_CLOCK_H_ */