Skip site navigation (1)Skip section navigation (2)
Date:      Tue, 7 Sep 2021 12:09:47 GMT
From:      Jessica Clarke <jrtc27@FreeBSD.org>
To:        src-committers@FreeBSD.org, dev-commits-src-all@FreeBSD.org, dev-commits-src-branches@FreeBSD.org
Subject:   git: 7f59cce2d43d - stable/13 - sifive_prci: Add support for the FU740 PRCI
Message-ID:  <202109071209.187C9l9K087377@gitrepo.freebsd.org>

next in thread | raw e-mail | index | archive | help
The branch stable/13 has been updated by jrtc27:

URL: https://cgit.FreeBSD.org/src/commit/?id=7f59cce2d43d0eb55e7fae99ca8499f133e64341

commit 7f59cce2d43d0eb55e7fae99ca8499f133e64341
Author:     Jessica Clarke <jrtc27@FreeBSD.org>
AuthorDate: 2021-08-07 18:27:28 +0000
Commit:     Jessica Clarke <jrtc27@FreeBSD.org>
CommitDate: 2021-09-07 12:06:49 +0000

    sifive_prci: Add support for the FU740 PRCI
    
    Reviewed by:    mhorne
    MFC after:      1 week
    Differential Revision:  https://reviews.freebsd.org/D31022
    
    (cherry picked from commit 589d8a78a57b3ca1327bec3311281a38e4e49952)
---
 sys/riscv/sifive/sifive_prci.c | 292 ++++++++++++++++++++++++++++++++++++++++-
 1 file changed, 291 insertions(+), 1 deletion(-)

diff --git a/sys/riscv/sifive/sifive_prci.c b/sys/riscv/sifive/sifive_prci.c
index 7c0939c77251..21b9cd568f32 100644
--- a/sys/riscv/sifive/sifive_prci.c
+++ b/sys/riscv/sifive/sifive_prci.c
@@ -47,11 +47,14 @@ __FBSDID("$FreeBSD$");
 
 #include <dev/extres/clk/clk.h>
 #include <dev/extres/clk/clk_fixed.h>
+#include <dev/extres/clk/clk_gate.h>
 
 #include <dev/ofw/ofw_bus.h>
 #include <dev/ofw/ofw_bus_subr.h>
 #include <dev/ofw/openfirm.h>
 
+#include "clkdev_if.h"
+
 static struct resource_spec prci_spec[] = {
 	{ SYS_RES_MEMORY, 0, RF_ACTIVE },
 	RESOURCE_SPEC_END
@@ -73,6 +76,12 @@ struct prci_clk_pll_sc {
 	uint32_t		reg;
 };
 
+struct prci_clk_div_sc {
+	struct prci_softc	*parent_sc;
+	uint32_t		reg;
+	uint32_t		bias;
+};
+
 #define	PRCI_LOCK(sc)			mtx_lock(&(sc)->mtx)
 #define	PRCI_UNLOCK(sc)			mtx_unlock(&(sc)->mtx)
 #define	PRCI_ASSERT_LOCKED(sc)		mtx_assert(&(sc)->mtx, MA_OWNED);
@@ -87,6 +96,8 @@ struct prci_clk_pll_sc {
 
 #define	PRCI_READ(_sc, _reg)		\
     bus_space_read_4((_sc)->bst, (_sc)->bsh, (_reg))
+#define	PRCI_WRITE(_sc, _reg, _val)	\
+    bus_space_write_4((_sc)->bst, (_sc)->bsh, (_reg), (_val))
 
 struct prci_pll_def {
 	uint32_t	id;
@@ -103,8 +114,46 @@ struct prci_pll_def {
 
 #define PLL_END	PLL(0, NULL, 0)
 
+struct prci_div_def {
+	uint32_t	id;
+	const char	*name;
+	const char	*parent_name;
+	uint32_t	reg;
+	uint32_t	bias;
+};
+
+#define DIV(_id, _name, _parent_name, _base, _bias)		\
+{								\
+	.id = (_id),						\
+	.name = (_name),					\
+	.parent_name = (_parent_name),				\
+	.reg = (_base),						\
+	.bias = (_bias),					\
+}
+
+#define DIV_END	DIV(0, NULL, NULL, 0, 0)
+
+struct prci_gate_def {
+	uint32_t	id;
+	const char	*name;
+	const char	*parent_name;
+	uint32_t	reg;
+};
+
+#define GATE(_id, _name, _parent_name, _base)			\
+{								\
+	.id = (_id),						\
+	.name = (_name),					\
+	.parent_name = (_parent_name),				\
+	.reg = (_base),						\
+}
+
+#define GATE_END	GATE(0, NULL, NULL, 0)
+
 struct prci_config {
 	struct prci_pll_def	*pll_clks;
+	struct prci_div_def	*div_clks;
+	struct prci_gate_def	*gate_clks;
 	struct clk_fixed_def	*tlclk_def;
 };
 
@@ -144,10 +193,74 @@ struct prci_config fu540_prci_config = {
 	.tlclk_def = &fu540_tlclk_def,
 };
 
+/* FU740 clock numbers */
+#define	FU740_PRCI_CORECLK		0
+#define	FU740_PRCI_DDRCLK		1
+#define	FU740_PRCI_GEMGXLCLK		2
+#define	FU740_PRCI_DVFSCORECLK		3
+#define	FU740_PRCI_HFPCLK		4
+#define	FU740_PRCI_CLTXCLK		5
+#define	FU740_PRCI_TLCLK		6
+#define	FU740_PRCI_PCLK			7
+#define	FU740_PRCI_PCIEAUXCLK		8
+
+/* FU740 registers */
+#define	FU740_PRCI_COREPLL_CFG0		0x4
+#define	FU740_PRCI_DDRPLL_CFG0		0xC
+#define	FU740_PRCI_PCIEAUX_GATE		0x14
+#define	FU740_PRCI_GEMGXLPLL_CFG0	0x1C
+#define	FU740_PRCI_DVFSCOREPLL_CFG0	0x38
+#define	FU740_PRCI_HFPCLKPLL_CFG0	0x50
+#define	FU740_PRCI_CLTXPLL_CFG0		0x30
+#define	FU740_PRCI_HFPCLK_DIV		0x5C
+
+/* FU740 PLL clocks */
+static struct prci_pll_def fu740_pll_clks[] = {
+	PLL(FU740_PRCI_CORECLK, "coreclk", FU740_PRCI_COREPLL_CFG0),
+	PLL(FU740_PRCI_DDRCLK, "ddrclk", FU740_PRCI_DDRPLL_CFG0),
+	PLL(FU740_PRCI_GEMGXLCLK, "gemgxlclk", FU740_PRCI_GEMGXLPLL_CFG0),
+	PLL(FU740_PRCI_DVFSCORECLK, "dvfscoreclk", FU740_PRCI_DVFSCOREPLL_CFG0),
+	PLL(FU740_PRCI_HFPCLK, "hfpclk", FU740_PRCI_HFPCLKPLL_CFG0),
+	PLL(FU740_PRCI_CLTXCLK, "cltxclk", FU740_PRCI_CLTXPLL_CFG0),
+	PLL_END
+};
+
+/* FU740 divisor clocks */
+static struct prci_div_def fu740_div_clks[] = {
+	DIV(FU740_PRCI_PCLK, "pclk", "hfpclk", FU740_PRCI_HFPCLK_DIV, 2),
+	DIV_END
+};
+
+/* FU740 gated clocks */
+static struct prci_gate_def fu740_gate_clks[] = {
+	GATE(FU740_PRCI_PCIEAUXCLK, "pcieauxclk", "hfclk", FU740_PRCI_PCIEAUX_GATE),
+	GATE_END
+};
+
+/* FU740 fixed divisor clock TLCLK. */
+static struct clk_fixed_def fu740_tlclk_def = {
+	.clkdef.id = FU740_PRCI_TLCLK,
+	.clkdef.name = "tlclk",
+	.clkdef.parent_names = (const char *[]){"coreclk"},
+	.clkdef.parent_cnt = 1,
+	.clkdef.flags = CLK_NODE_STATIC_STRINGS,
+	.mult = 1,
+	.div = 2,
+};
+
+/* FU740 config */
+struct prci_config fu740_prci_config = {
+	.pll_clks = fu740_pll_clks,
+	.div_clks = fu740_div_clks,
+	.gate_clks = fu740_gate_clks,
+	.tlclk_def = &fu740_tlclk_def,
+};
+
 static struct ofw_compat_data compat_data[] = {
 	{ "sifive,aloeprci0",		(uintptr_t)&fu540_prci_config },
 	{ "sifive,ux00prci0",		(uintptr_t)&fu540_prci_config },
 	{ "sifive,fu540-c000-prci",	(uintptr_t)&fu540_prci_config },
+	{ "sifive,fu740-c000-prci",	(uintptr_t)&fu740_prci_config },
 	{ NULL,				0 },
 };
 
@@ -209,6 +322,60 @@ DEFINE_CLASS_1(prci_clk_pll_clknode, prci_clk_pll_clknode_class,
     prci_clk_pll_clknode_methods, sizeof(struct prci_clk_pll_sc),
     clknode_class);
 
+static int
+prci_clk_div_init(struct clknode *clk, device_t dev)
+{
+
+	clknode_init_parent_idx(clk, 0);
+
+	return (0);
+}
+
+static int
+prci_clk_div_recalc(struct clknode *clk, uint64_t *freq)
+{
+	struct prci_clk_div_sc *sc;
+	struct clknode *parent_clk;
+	uint32_t div;
+	uint64_t refclk;
+	int err;
+
+	KASSERT(freq != NULL, ("freq cannot be NULL"));
+
+	sc = clknode_get_softc(clk);
+
+	PRCI_LOCK(sc->parent_sc);
+
+	/* Get refclock frequency. */
+	parent_clk = clknode_get_parent(clk);
+	err = clknode_get_freq(parent_clk, &refclk);
+	if (err) {
+		device_printf(sc->parent_sc->dev,
+		    "Failed to get refclk frequency\n");
+		PRCI_UNLOCK(sc->parent_sc);
+		return (err);
+	}
+
+	/* Calculate the divisor output */
+	div = PRCI_READ(sc->parent_sc, sc->reg);
+
+	*freq = refclk / (div + sc->bias);
+
+	PRCI_UNLOCK(sc->parent_sc);
+
+	return (0);
+}
+
+static clknode_method_t prci_clk_div_clknode_methods[] = {
+	CLKNODEMETHOD(clknode_init,		prci_clk_div_init),
+	CLKNODEMETHOD(clknode_recalc_freq,	prci_clk_div_recalc),
+	CLKNODEMETHOD_END
+};
+
+DEFINE_CLASS_1(prci_clk_div_clknode, prci_clk_div_clknode_class,
+    prci_clk_div_clknode_methods, sizeof(struct prci_clk_div_sc),
+    clknode_class);
+
 static int
 prci_probe(device_t dev)
 {
@@ -243,16 +410,39 @@ prci_pll_register(struct prci_softc *parent_sc, struct clknode_init_def *clkdef,
 	clknode_register(parent_sc->clkdom, clk);
 }
 
+static void
+prci_div_register(struct prci_softc *parent_sc, struct clknode_init_def *clkdef,
+	uint32_t reg, uint32_t bias)
+{
+	struct clknode *clk;
+	struct prci_clk_div_sc *sc;
+
+	clk = clknode_create(parent_sc->clkdom, &prci_clk_div_clknode_class,
+	    clkdef);
+	if (clk == NULL)
+		panic("Failed to create clknode");
+
+	sc = clknode_get_softc(clk);
+	sc->parent_sc = parent_sc;
+	sc->reg = reg;
+	sc->bias = bias;
+
+	clknode_register(parent_sc->clkdom, clk);
+}
+
 static int
 prci_attach(device_t dev)
 {
-	struct clknode_init_def clkdef;
+	struct clknode_init_def clkdef, clkdef_div;
+	struct clk_gate_def clkdef_gate;
 	struct prci_softc *sc;
 	clk_t clk_parent;
 	phandle_t node;
 	int i, ncells, error;
 	struct prci_config *cfg;
 	struct prci_pll_def *pll_clk;
+	struct prci_div_def *div_clk;
+	struct prci_gate_def *gate_clk;
 
 	sc = device_get_softc(dev);
 	sc->dev = dev;
@@ -308,6 +498,41 @@ prci_attach(device_t dev)
 		prci_pll_register(sc, &clkdef, pll_clk->reg);
 	}
 
+	if (cfg->div_clks != NULL) {
+		bzero(&clkdef_div, sizeof(clkdef_div));
+		for (div_clk = cfg->div_clks; div_clk->name; div_clk++) {
+			clkdef_div.id = div_clk->id;
+			clkdef_div.name = div_clk->name;
+			clkdef_div.parent_names = &div_clk->parent_name;
+			clkdef_div.parent_cnt = 1;
+			prci_div_register(sc, &clkdef_div, div_clk->reg,
+			    div_clk->bias);
+		}
+	}
+
+	if (cfg->gate_clks != NULL) {
+		bzero(&clkdef_gate, sizeof(clkdef_gate));
+		for (gate_clk = cfg->gate_clks; gate_clk->name; gate_clk++) {
+			clkdef_gate.clkdef.id = gate_clk->id;
+			clkdef_gate.clkdef.name = gate_clk->name;
+			clkdef_gate.clkdef.parent_names = &gate_clk->parent_name;
+			clkdef_gate.clkdef.parent_cnt = 1;
+			clkdef_gate.offset = gate_clk->reg;
+			clkdef_gate.shift = 0;
+			clkdef_gate.mask = 1;
+			clkdef_gate.on_value = 1;
+			clkdef_gate.off_value = 0;
+			error = clknode_gate_register(sc->clkdom,
+			    &clkdef_gate);
+			if (error != 0) {
+				device_printf(dev,
+				    "Couldn't create gated clock %s: %d\n",
+				    gate_clk->name, error);
+				goto fail;
+			}
+		}
+	}
+
 	/*
 	 * Register the fixed clock "tlclk".
 	 *
@@ -333,10 +558,75 @@ fail:
 	return (error);
 }
 
+static int
+prci_write_4(device_t dev, bus_addr_t addr, uint32_t val)
+{
+	struct prci_softc *sc;
+
+	sc = device_get_softc(dev);
+
+	PRCI_WRITE(sc, addr, val);
+
+	return (0);
+}
+
+static int
+prci_read_4(device_t dev, bus_addr_t addr, uint32_t *val)
+{
+	struct prci_softc *sc;
+
+	sc = device_get_softc(dev);
+
+	*val = PRCI_READ(sc, addr);
+
+	return (0);
+}
+
+static int
+prci_modify_4(device_t dev, bus_addr_t addr, uint32_t clr, uint32_t set)
+{
+	struct prci_softc *sc;
+	uint32_t reg;
+
+	sc = device_get_softc(dev);
+
+	reg = PRCI_READ(sc, addr);
+	reg &= ~clr;
+	reg |= set;
+	PRCI_WRITE(sc, addr, reg);
+
+	return (0);
+}
+
+static void
+prci_device_lock(device_t dev)
+{
+	struct prci_softc *sc;
+
+	sc = device_get_softc(dev);
+	PRCI_LOCK(sc);
+}
+
+static void
+prci_device_unlock(device_t dev)
+{
+	struct prci_softc *sc;
+
+	sc = device_get_softc(dev);
+	PRCI_UNLOCK(sc);
+}
+
 static device_method_t prci_methods[] = {
 	DEVMETHOD(device_probe,		prci_probe),
 	DEVMETHOD(device_attach,	prci_attach),
 
+	/* clkdev interface */
+	DEVMETHOD(clkdev_write_4,	prci_write_4),
+	DEVMETHOD(clkdev_read_4,	prci_read_4),
+	DEVMETHOD(clkdev_modify_4,	prci_modify_4),
+	DEVMETHOD(clkdev_device_lock,	prci_device_lock),
+	DEVMETHOD(clkdev_device_unlock,	prci_device_unlock),
+
 	DEVMETHOD_END
 };
 



Want to link to this message? Use this URL: <https://mail-archive.FreeBSD.org/cgi/mid.cgi?202109071209.187C9l9K087377>