forked from Minki/linux
ff01df28e5
Since we have a folder of our own, we can actually make use of it by splitting the huge clock file into several sub drivers. The main oscillator is pretty easy to deal with, since it's pretty much isolated. Signed-off-by: Maxime Ripard <maxime.ripard@free-electrons.com> Acked-by: Mike Turquette <mturquette@linaro.org> Signed-off-by: Emilio López <emilio@elopez.com.ar>
74 lines
1.9 KiB
C
74 lines
1.9 KiB
C
/*
|
|
* Copyright 2013 Emilio López
|
|
*
|
|
* Emilio López <emilio@elopez.com.ar>
|
|
*
|
|
* 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-provider.h>
|
|
#include <linux/clkdev.h>
|
|
#include <linux/of.h>
|
|
#include <linux/of_address.h>
|
|
|
|
#define SUNXI_OSC24M_GATE 0
|
|
|
|
static DEFINE_SPINLOCK(hosc_lock);
|
|
|
|
static void __init sun4i_osc_clk_setup(struct device_node *node)
|
|
{
|
|
struct clk *clk;
|
|
struct clk_fixed_rate *fixed;
|
|
struct clk_gate *gate;
|
|
const char *clk_name = node->name;
|
|
u32 rate;
|
|
|
|
if (of_property_read_u32(node, "clock-frequency", &rate))
|
|
return;
|
|
|
|
/* allocate fixed-rate and gate clock structs */
|
|
fixed = kzalloc(sizeof(struct clk_fixed_rate), GFP_KERNEL);
|
|
if (!fixed)
|
|
return;
|
|
gate = kzalloc(sizeof(struct clk_gate), GFP_KERNEL);
|
|
if (!gate)
|
|
goto err_free_fixed;
|
|
|
|
of_property_read_string(node, "clock-output-names", &clk_name);
|
|
|
|
/* set up gate and fixed rate properties */
|
|
gate->reg = of_iomap(node, 0);
|
|
gate->bit_idx = SUNXI_OSC24M_GATE;
|
|
gate->lock = &hosc_lock;
|
|
fixed->fixed_rate = rate;
|
|
|
|
clk = clk_register_composite(NULL, clk_name,
|
|
NULL, 0,
|
|
NULL, NULL,
|
|
&fixed->hw, &clk_fixed_rate_ops,
|
|
&gate->hw, &clk_gate_ops,
|
|
CLK_IS_ROOT);
|
|
|
|
if (IS_ERR(clk))
|
|
goto err_free_gate;
|
|
|
|
of_clk_add_provider(node, of_clk_src_simple_get, clk);
|
|
clk_register_clkdev(clk, clk_name, NULL);
|
|
|
|
return;
|
|
|
|
err_free_gate:
|
|
kfree(gate);
|
|
err_free_fixed:
|
|
kfree(fixed);
|
|
}
|
|
CLK_OF_DECLARE(sun4i_osc, "allwinner,sun4i-a10-osc-clk", sun4i_osc_clk_setup);
|