Quelle  meson-eeclk.c   Sprache: C

// SPDX-License-Identifier: GPL-2.0
/*
 * Copyright (c) 2019 BayLibre, SAS.
 * Author: Jerome Brunet <jbrunet@baylibre.com>
 */

#include <linux/clk-provider.h>
#include <linux/of.h>
#include <linux/platform_device.h>
#include <linux/mfd/syscon.h>
#include <linux/regmap.h>
#include <linux/module.h>

#include "clk-regmap.h"
#include "meson-eeclk.h"

int meson_eeclkc_probe(struct platform_device *pdev)
{
 const struct meson_eeclkc_data *data;
 struct device *dev = &pdev->dev;
 struct device_node *np;
 struct regmap *map;
 int ret, i;

 data = of_device_get_match_data(dev);
 if (!data)
  return -EINVAL;

 /* Get the hhi system controller node */
 np = of_get_parent(dev->of_node);
 map = syscon_node_to_regmap(np);
 of_node_put(np);
 if (IS_ERR(map)) {
  dev_err(dev,
   "failed to get HHI regmap\n");
  return PTR_ERR(map);
 }

 if (data->init_count)
  regmap_multi_reg_write(map, data->init_regs, data->init_count);

 for (i = 0; i < data->hw_clks.num; i++) {
  /* array might be sparse */
  if (!data->hw_clks.hws[i])
   continue;

  ret = devm_clk_hw_register(dev, data->hw_clks.hws[i]);
  if (ret) {
   dev_err(dev, "Clock registration failed\n");
   return ret;
  }
 }

 return devm_of_clk_add_hw_provider(dev, meson_clk_hw_get, (void *)&data->hw_clks);
}
EXPORT_SYMBOL_NS_GPL(meson_eeclkc_probe, "CLK_MESON");

MODULE_DESCRIPTION("Amlogic Main Clock Controller Helpers");
MODULE_LICENSE("GPL");
MODULE_IMPORT_NS("CLK_MESON");