From bc4366cb1f2e21fe0e15a4c2cdfefa070e666799 Mon Sep 17 00:00:00 2001
From: kettenis <kettenis@openbsd.org>
Date: Fri, 10 Mar 2023 10:54:29 +0000
Subject: [PATCH] Implement setting the parent clock for RK356x.  This includes
 code for setting external parent clocks, which is needed to switch to the
 clock provided by the Ethernet PHY.

ok patrick@
---
 sys/dev/fdt/rkclock.c | 37 +++++++++++++++++++++++++++++++++++--
 1 file changed, 35 insertions(+), 2 deletions(-)

diff --git a/sys/dev/fdt/rkclock.c b/sys/dev/fdt/rkclock.c
index 9e6458acb19..28cbddf7a3a 100644
--- a/sys/dev/fdt/rkclock.c
+++ b/sys/dev/fdt/rkclock.c
@@ -1,4 +1,4 @@
-/*	$OpenBSD: rkclock.c,v 1.66 2023/02/26 12:39:07 kettenis Exp $	*/
+/*	$OpenBSD: rkclock.c,v 1.67 2023/03/10 10:54:29 kettenis Exp $	*/
 /*
  * Copyright (c) 2017, 2018 Mark Kettenis <kettenis@openbsd.org>
  *
@@ -299,6 +299,7 @@ void	rk3399_pmu_reset(void *, uint32_t *, int);
 void	rk3568_init(struct rkclock_softc *);
 uint32_t rk3568_get_frequency(void *, uint32_t *);
 int	rk3568_set_frequency(void *, uint32_t *, uint32_t);
+int	rk3568_set_parent(void *, uint32_t *, uint32_t *);
 void	rk3568_enable(void *, uint32_t *, int);
 void	rk3568_reset(void *, uint32_t *, int);
 
@@ -359,7 +360,7 @@ const struct rkclock_compat rkclock_compat[] = {
 	{
 		"rockchip,rk3568-cru", 1, rk3568_init,
 		rk3568_enable, rk3568_get_frequency,
-		rk3568_set_frequency, NULL,
+		rk3568_set_frequency, rk3568_set_parent,
 		rk3568_reset
 	},
 	{
@@ -3494,6 +3495,38 @@ rk3568_set_frequency(void *cookie, uint32_t *cells, uint32_t freq)
 	return rkclock_set_frequency(sc, idx, freq);
 }
 
+int
+rk3568_set_parent(void *cookie, uint32_t *cells, uint32_t *pcells)
+{
+	struct rkclock_softc *sc = cookie;
+	char buf[64] = {};
+	int len, node;
+
+	if (pcells[0] != sc->sc_phandle) {
+		node = OF_getnodebyphandle(pcells[0]);
+		if (node == 0)
+			return -1;
+		len = OF_getproplen(node, "clock-output-names");
+		if (len <= 0 || len > sizeof(buf))
+			return -1;
+		OF_getprop(node, "clock-output-names", buf, sizeof(buf));
+
+		if (strcmp(buf, "gmac0_clkin") == 0) {
+			return rkclock_set_parent(sc, cells[0],
+			    RK3568_GMAC0_CLKIN);
+		}
+		if (strcmp(buf, "gmac1_clkin") == 0) {
+			return rkclock_set_parent(sc, cells[0],
+			    RK3568_GMAC1_CLKIN);
+		}
+
+		printf("%s: 0x%08x 0x%08x\n", __func__, cells[0], pcells[0]);
+		return -1;
+	}
+
+	return rkclock_set_parent(sc, cells[0], pcells[1]);
+}
+
 void
 rk3568_enable(void *cookie, uint32_t *cells, int on)
 {
-- 
2.20.1