Page MenuHomeFreeBSD
Files F107293287

D31022.diff
No OneTemporary
Actions

D31022.diff
View Options

diff --git a/sys/riscv/sifive/sifive_prci.c b/sys/riscv/sifive/sifive_prci.c
--- a/sys/riscv/sifive/sifive_prci.c
+++ b/sys/riscv/sifive/sifive_prci.c
@@ -47,11 +47,14 @@
#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 @@
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 @@
#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 @@
#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 @@
.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 @@
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 @@
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_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 @@
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
};

File Metadata

Mime Type
text/plain
Expires
Mon, Jan 13, 2:49 AM (21 h, 8 m)
Storage Engine
blob
Storage Format
Raw Data
Storage Handle
15775403
Default Alt Text
D31022.diff (9 KB)

Event Timeline