Quelle  k210-sysctl.c   Sprache: C

// SPDX-License-Identifier: GPL-2.0-or-later
/*
 * Copyright (c) 2019 Christoph Hellwig.
 * Copyright (c) 2019 Western Digital Corporation or its affiliates.
 */
#include <linux/io.h>
#include <linux/platform_device.h>
#include <linux/of_platform.h>
#include <linux/clk.h>
#include <asm/soc.h>

#include <soc/canaan/k210-sysctl.h>

static int k210_sysctl_probe(struct platform_device *pdev)
{
 struct device *dev = &pdev->dev;
 struct clk *pclk;
 int ret;

 dev_info(dev, "K210 system controller\n");

 /* Get power bus clock */
 pclk = devm_clk_get(dev, NULL);
 if (IS_ERR(pclk))
  return dev_err_probe(dev, PTR_ERR(pclk),
         "Get bus clock failed\n");

 ret = clk_prepare_enable(pclk);
 if (ret) {
  dev_err(dev, "Enable bus clock failed\n");
  return ret;
 }

 /* Populate children */
 ret = devm_of_platform_populate(dev);
 if (ret)
  dev_err(dev, "Populate platform failed %d\n", ret);

 return ret;
}

static const struct of_device_id k210_sysctl_of_match[] = {
 { .compatible = "canaan,k210-sysctl", },
 { /* sentinel */ },
};

static struct platform_driver k210_sysctl_driver = {
 .driver = {
  .name  = "k210-sysctl",
  .of_match_table = k210_sysctl_of_match,
 },
 .probe   = k210_sysctl_probe,
};
builtin_platform_driver(k210_sysctl_driver);

/*
 * System controller registers base address and size.
 */
#define K210_SYSCTL_BASE_ADDR 0x50440000ULL
#define K210_SYSCTL_BASE_SIZE 0x1000

/*
 * This needs to be called very early during initialization, given that
 * PLL1 needs to be enabled to be able to use all SRAM.
 */
static void __init k210_soc_early_init(const void *fdt)
{
 void __iomem *sysctl_base;

 sysctl_base = ioremap(K210_SYSCTL_BASE_ADDR, K210_SYSCTL_BASE_SIZE);
 if (!sysctl_base)
  panic("k210-sysctl: ioremap failed");

 k210_clk_early_init(sysctl_base);

 iounmap(sysctl_base);
}
SOC_EARLY_INIT_DECLARE(k210_soc, "canaan,kendryte-k210", k210_soc_early_init);