drivers/amlogic/clk/txl/txl_ao.c

/*
 * drivers/amlogic/clk/txl/txl_ao.c
 *
 * Copyright (C) 2018 Amlogic, Inc. All rights reserved.
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2 of the License, or
 * (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful, but WITHOUT
 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
 * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
 * more details.
 *
 */

#include <linux/clk.h>
#include <linux/clk-provider.h>
#include <linux/of_address.h>
#include <linux/platform_device.h>
#include <linux/init.h>
#include <linux/slab.h>
#include <dt-bindings/clock/amlogic,txl-clkc.h>

#include "../clkc.h"
#include "txl.h"

static struct clk_mux aoclk81 = {
	.reg = (void *)AO_RTI_PWR_CNTL_REG0,
	.mask = 0x1,
	.shift = 8,
	.flags = CLK_MUX_READ_ONLY,
	.lock = &clk_lock,
	.hw.init = &(struct clk_init_data){
		.name = "aoclk81",
		.ops = &clk_mux_ops,
		.parent_names = (const char *[]){ "clk81", "ao_slow_clk" },
		.num_parents = 2,
		.flags = (CLK_SET_RATE_NO_REPARENT),
	},
};

/* sar_adc_clk */
static struct clk_mux txl_saradc_mux = {
	.reg = (void *)AO_SAR_CLK,
	.mask = 0x3,
	.shift = 9,
	.lock = &clk_lock,
	.hw.init = &(struct clk_init_data){
		.name = "txl_saradc_mux",
		.ops = &clk_mux_ops,
		.parent_names = (const char *[]){ "xtal", "aoclk81"},
		.num_parents = 2,
		.flags = (CLK_GET_RATE_NOCACHE),
	},
};

static struct clk_divider txl_saradc_div = {
	.reg = (void *)AO_SAR_CLK,
	.shift = 0,
	.width = 8,
	.lock = &clk_lock,
	.hw.init = &(struct clk_init_data){
		.name = "txl_saradc_div",
		.ops = &clk_divider_ops,
		.parent_names = (const char *[]){ "txl_saradc_mux" },
		.num_parents = 1,
		.flags = (CLK_DIVIDER_ROUND_CLOSEST),
	},
};

static struct clk_gate txl_saradc_gate = {
	.reg = (void *)AO_SAR_CLK,
	.bit_idx = 8,
	.lock = &clk_lock,
	.hw.init = &(struct clk_init_data){
		.name = "txl_saradc_gate",
		.ops = &clk_gate_ops,
		.parent_names = (const char *[]){ "txl_saradc_div" },
		.num_parents = 1,
		.flags = (CLK_SET_RATE_PARENT | CLK_IGNORE_UNUSED),
	},
};

/* Array of all clocks provided by this provider */

static struct clk_hw *txl_ao_clk_hws[] = {
	[CLKID_AO_CLK81 - CLKID_AO_CLK81]
		= &aoclk81.hw,
	[CLKID_SARADC_MUX - CLKID_AO_CLK81]
		= &txl_saradc_mux.hw,
	[CLKID_SARADC_DIV - CLKID_AO_CLK81]
		= &txl_saradc_div.hw,
	[CLKID_SARADC_GATE - CLKID_AO_CLK81]
		= &txl_saradc_gate.hw,
};

static int txl_aoclkc_probe(struct platform_device *pdev)
{
	void __iomem *aoclk_base;
	int clkid;
	struct device *dev = &pdev->dev;

	/*  Generic clocks and PLLs */
	aoclk_base = of_iomap(dev->of_node, 0);
	if (!aoclk_base) {
		pr_err("%s: Unable to map clk base\n", __func__);
		return -ENXIO;
	}
	/* Populate the base address for ao clk */
	aoclk81.reg = aoclk_base + (unsigned long)aoclk81.reg;
	txl_saradc_mux.reg = aoclk_base + (unsigned long)txl_saradc_mux.reg;
	txl_saradc_div.reg = aoclk_base + (unsigned long)txl_saradc_div.reg;
	txl_saradc_gate.reg = aoclk_base + (unsigned long)txl_saradc_gate.reg;

	for (clkid = CLKID_AO_BASE; clkid < NR_CLKS; clkid++) {
		if (txl_ao_clk_hws[clkid-CLKID_AO_BASE]) {
			clks[clkid] = clk_register(NULL,
			txl_ao_clk_hws[clkid-CLKID_AO_BASE]);
			WARN_ON(IS_ERR(clks[clkid]));
		}
	}

	return 0;
}

static const struct of_device_id txl_aoclkc_match_table[] = {
	{ .compatible = "amlogic,txl-aoclkc" },
	{ }
};

static struct platform_driver txl_aoclk_driver = {
	.probe		= txl_aoclkc_probe,
	.driver		= {
		.name	= "txl-aoclkc",
		.of_match_table = txl_aoclkc_match_table,
	},
};

builtin_platform_driver(txl_aoclk_driver);