clk: mediatek: add support for gate clock to reference topckgen clock

Add support for gate clock get_rate to reference topckgen clock for
infracfg-ao implementation.

In infracfg-ao implementation topckgen is on second level of parent with
infracfg in the middle.
To correctly detect this, check the driver of the dev parent and use the
second level parent if it's not mtk_clk_topckgen.

Due to all the dependency, parent tree must be filled before a gate is
used, hence is safe to assume it will be there.

Signed-off-by: Christian Marangi <ansuelsmth@gmail.com>

diff --git a/drivers/clk/mediatek/clk-mtk.c b/drivers/clk/mediatek/clk-mtk.c
index 341e1ecd1776eeeece133f5f73d4a4d5c506b95e..011615ab917e1d45b1d3361e4d770e5c720642dd 100644 (file)
--- a/drivers/clk/mediatek/clk-mtk.c
+++ b/drivers/clk/mediatek/clk-mtk.c
@@ -652,20 +652,33 @@ static int mtk_clk_infrasys_disable(struct clk *clk)
 static ulong mtk_clk_gate_get_rate(struct clk *clk)
 {
        struct mtk_cg_priv *priv = dev_get_priv(clk->dev);
+       struct udevice *parent = priv->parent;
        const struct mtk_gate *gate;
 
        if (clk->id < priv->tree->gates_offs)
                return -EINVAL;
 
        gate = &priv->gates[clk->id - priv->tree->gates_offs];
+       /*
+        * With requesting a TOPCKGEN parent, make sure the dev parent
+        * is actually topckgen. This might not be the case for an
+        * infracfg-ao implementation where:
+        * parent = infracfg
+        * parent->parent = topckgen
+        */
+       if (gate->flags & CLK_PARENT_TOPCKGEN &&
+           parent->driver != DM_DRIVER_GET(mtk_clk_topckgen)) {
+               priv = dev_get_priv(parent);
+               parent = priv->parent;
        /*
         * Assume xtal_rate to be declared if some gates have
         * XTAL as parent
         */
-       if (gate->flags & CLK_PARENT_XTAL)
+       } else if (gate->flags & CLK_PARENT_XTAL) {
                return priv->tree->xtal_rate;
+       }
 
-       return mtk_clk_find_parent_rate(clk, gate->parent, priv->parent);
+       return mtk_clk_find_parent_rate(clk, gate->parent, parent);
 }
 
 const struct clk_ops mtk_clk_apmixedsys_ops = {