linux-imx

// SPDX-License-Identifier: GPL-2.0

/*

 * Copyright (C) 2014 Samsung Electronics Co., Ltd.

 * Sylwester Nawrocki <s.nawrocki@samsung.com>

 */

​

#include <linux/clk.h>

#include <linux/clk-provider.h>

#include <linux/clk/clk-conf.h>

#include <linux/device.h>

#include <linux/of.h>

#include <linux/printk.h>

​

static int __set_clk_parents(struct device_node *node, bool clk_supplier)

{

    struct of_phandle_args clkspec;

    int index, rc, num_parents;

    struct clk *clk, *pclk;

​

    num_parents = of_count_phandle_with_args(node, "assigned-clock-parents",

                         "#clock-cells");

    if (num_parents == -EINVAL)

        pr_err("clk: invalid value of clock-parents property at %pOF\n",

               node);

​

    for (index = 0; index < num_parents; index++) {

        rc = of_parse_phandle_with_args(node, "assigned-clock-parents",

                    "#clock-cells", index, &clkspec);

        if (rc < 0) {

            /* skip empty (null) phandles */

            if (rc == -ENOENT)

                continue;

            else

                return rc;

        }

        if (clkspec.np == node && !clk_supplier)

            return 0;

        pclk = of_clk_get_from_provider(&clkspec);

        if (IS_ERR(pclk)) {

            if (PTR_ERR(pclk) != -EPROBE_DEFER)

                pr_warn("clk: couldn't get parent clock %d for %pOF\n",

                    index, node);

            return PTR_ERR(pclk);

        }

​

        rc = of_parse_phandle_with_args(node, "assigned-clocks",

                    "#clock-cells", index, &clkspec);

        if (rc < 0)

            goto err;

        if (clkspec.np == node && !clk_supplier) {

            rc = 0;

            goto err;

        }

        clk = of_clk_get_from_provider(&clkspec);

        if (IS_ERR(clk)) {

            if (PTR_ERR(clk) != -EPROBE_DEFER)

                pr_warn("clk: couldn't get assigned clock %d for %pOF\n",

                    index, node);

            rc = PTR_ERR(clk);

            goto err;

        }

​

        rc = clk_set_parent(clk, pclk);