clk: meson-g12a: Add PCIE PLL support

The G12A PCIE PLL clock was introduced in Linux 5.2-rc1, and is needed
for USB to operate, add basic support for it and associated gates.

Signed-off-by: Neil Armstrong <narmstrong@baylibre.com>

diff --git a/drivers/clk/meson/g12a.c b/drivers/clk/meson/g12a.c
index fedc9eb7dd864465a431040c00b335379feb6079..112326e553f0b347211614371e4640f63d2f4759 100644 (file)
--- a/drivers/clk/meson/g12a.c
+++ b/drivers/clk/meson/g12a.c
@@ -22,6 +22,8 @@ struct meson_clk {
        struct regmap *map;
 };
 
+static ulong meson_clk_set_rate_by_id(struct clk *clk, unsigned long id,
+                                     ulong rate, ulong current_rate);
 static ulong meson_clk_get_rate_by_id(struct clk *clk, unsigned long id);
 
 #define NUM_CLKS 178
@@ -36,6 +38,8 @@ static struct meson_gate gates[NUM_CLKS] = {
        MESON_GATE(CLKID_SD_EMMC_C, HHI_GCLK_MPEG0, 26),
        MESON_GATE(CLKID_ETH, HHI_GCLK_MPEG1, 3),
        MESON_GATE(CLKID_UART1, HHI_GCLK_MPEG1, 16),
+       MESON_GATE(CLKID_USB, HHI_GCLK_MPEG1, 25),
+       MESON_GATE(CLKID_USB1_DDR_BRIDGE, HHI_GCLK_MPEG2, 8),
 
        /* Peripheral Gates */
        MESON_GATE(CLKID_SD_EMMC_B_CLK0, HHI_SD_EMMC_CLK_CNTL, 23),
@@ -231,6 +235,36 @@ static ulong meson_pll_get_rate(struct clk *clk, unsigned long id)
        return ((parent_rate_mhz * m / n) >> od) * 1000000;
 }
 
+static struct parm meson_pcie_pll_parm[3] = {
+       {HHI_PCIE_PLL_CNTL0, 0, 8}, /* pm */
+       {HHI_PCIE_PLL_CNTL0, 10, 5}, /* pn */
+       {HHI_PCIE_PLL_CNTL0, 16, 5}, /* pod */
+};
+
+static ulong meson_pcie_pll_get_rate(struct clk *clk)
+{
+       struct meson_clk *priv = dev_get_priv(clk->dev);
+       struct parm *pm, *pn, *pod;
+       unsigned long parent_rate_mhz = XTAL_RATE / 1000000;
+       u16 n, m, od;
+       uint reg;
+
+       pm = &meson_pcie_pll_parm[0];
+       pn = &meson_pcie_pll_parm[1];
+       pod = &meson_pcie_pll_parm[2];
+
+       regmap_read(priv->map, pn->reg_off, &reg);
+       n = PARM_GET(pn->width, pn->shift, reg);
+
+       regmap_read(priv->map, pm->reg_off, &reg);
+       m = PARM_GET(pm->width, pm->shift, reg);
+
+       regmap_read(priv->map, pod->reg_off, &reg);
+       od = PARM_GET(pod->width, pod->shift, reg);
+
+       return ((parent_rate_mhz * m / n) / 2 / od / 2) * 1000000;
+}
+
 static ulong meson_clk_get_rate_by_id(struct clk *clk, unsigned long id)
 {
        ulong rate;
@@ -263,6 +297,9 @@ static ulong meson_clk_get_rate_by_id(struct clk *clk, unsigned long id)
        case CLKID_CLK81:
                rate = meson_clk81_get_rate(clk);
                break;
+       case CLKID_PCIE_PLL:
+               rate = meson_pcie_pll_get_rate(clk);
+               break;
        default:
                if (gates[id].reg != 0) {
                        /* a clock gate */
@@ -281,6 +318,71 @@ static ulong meson_clk_get_rate(struct clk *clk)
        return meson_clk_get_rate_by_id(clk, clk->id);
 }
 
+static ulong meson_pcie_pll_set_rate(struct clk *clk, ulong rate)
+{
+       struct meson_clk *priv = dev_get_priv(clk->dev);
+
+       regmap_write(priv->map, HHI_PCIE_PLL_CNTL0, 0x20090496);
+       regmap_write(priv->map, HHI_PCIE_PLL_CNTL0, 0x30090496);
+       regmap_write(priv->map, HHI_PCIE_PLL_CNTL1, 0x00000000);
+       regmap_write(priv->map, HHI_PCIE_PLL_CNTL2, 0x00001100);
+       regmap_write(priv->map, HHI_PCIE_PLL_CNTL3, 0x10058e00);
+       regmap_write(priv->map, HHI_PCIE_PLL_CNTL4, 0x000100c0);
+       regmap_write(priv->map, HHI_PCIE_PLL_CNTL5, 0x68000048);
+       regmap_write(priv->map, HHI_PCIE_PLL_CNTL5, 0x68000068);
+       udelay(20);
+       regmap_write(priv->map, HHI_PCIE_PLL_CNTL4, 0x008100c0);
+       udelay(10);
+       regmap_write(priv->map, HHI_PCIE_PLL_CNTL0, 0x34090496);
+       regmap_write(priv->map, HHI_PCIE_PLL_CNTL0, 0x14090496);
+       udelay(10);
+       regmap_write(priv->map, HHI_PCIE_PLL_CNTL2, 0x00001000);
+       regmap_update_bits(priv->map, HHI_PCIE_PLL_CNTL0,
+                               0x1f << 16, 9 << 16);
+
+       return 100000000;
+}
+
+static ulong meson_clk_set_rate_by_id(struct clk *clk, unsigned long id,
+                                     ulong rate, ulong current_rate)
+{
+       if (current_rate == rate)
+               return 0;
+
+       switch (id) {
+       /* Fixed clocks */
+       case CLKID_PCIE_PLL:
+               return meson_pcie_pll_set_rate(clk, rate);
+
+       default:
+               return -ENOENT;
+       }
+
+       return -EINVAL;
+}
+
+
+static ulong meson_clk_set_rate(struct clk *clk, ulong rate)
+{
+       ulong current_rate = meson_clk_get_rate_by_id(clk, clk->id);
+       int ret;
+
+       if (IS_ERR_VALUE(current_rate))
+               return current_rate;
+
+       debug("%s: setting rate of %ld from %ld to %ld\n",
+             __func__, clk->id, current_rate, rate);
+
+       ret = meson_clk_set_rate_by_id(clk, clk->id, rate, current_rate);
+       if (IS_ERR_VALUE(ret))
+               return ret;
+
+       debug("clock %lu has new rate %lu\n", clk->id,
+             meson_clk_get_rate_by_id(clk, clk->id));
+
+       return 0;
+}
+
 static int meson_clk_probe(struct udevice *dev)
 {
        struct meson_clk *priv = dev_get_priv(dev);
@@ -298,6 +400,7 @@ static struct clk_ops meson_clk_ops = {
        .disable        = meson_clk_disable,
        .enable         = meson_clk_enable,
        .get_rate       = meson_clk_get_rate,
+       .set_rate       = meson_clk_set_rate,
 };
 
 static const struct udevice_id meson_clk_ids[] = {