Branch data Line data Source code
1 : : /*
2 : : * This program is free software; you can redistribute it and/or modify
3 : : * it under the terms of the GNU General Public License version 2 as
4 : : * published by the Free Software Foundation.
5 : : *
6 : : * This program is distributed in the hope that it will be useful,
7 : : * but WITHOUT ANY WARRANTY; without even the implied warranty of
8 : : * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
9 : : * GNU General Public License for more details.
10 : : *
11 : : * Copyright (C) 2013 ARM Limited
12 : : */
13 : :
14 : : #include <linux/amba/sp810.h>
15 : : #include <linux/clkdev.h>
16 : : #include <linux/clk-provider.h>
17 : : #include <linux/err.h>
18 : : #include <linux/of.h>
19 : : #include <linux/of_address.h>
20 : :
21 : : #define to_clk_sp810_timerclken(_hw) \
22 : : container_of(_hw, struct clk_sp810_timerclken, hw)
23 : :
24 : : struct clk_sp810;
25 : :
26 : : struct clk_sp810_timerclken {
27 : : struct clk_hw hw;
28 : : struct clk *clk;
29 : : struct clk_sp810 *sp810;
30 : : int channel;
31 : : };
32 : :
33 : : struct clk_sp810 {
34 : : struct device_node *node;
35 : : int refclk_index, timclk_index;
36 : : void __iomem *base;
37 : : spinlock_t lock;
38 : : struct clk_sp810_timerclken timerclken[4];
39 : : struct clk *refclk;
40 : : struct clk *timclk;
41 : : };
42 : :
43 : 0 : static u8 clk_sp810_timerclken_get_parent(struct clk_hw *hw)
44 : : {
45 : : struct clk_sp810_timerclken *timerclken = to_clk_sp810_timerclken(hw);
46 : 0 : u32 val = readl(timerclken->sp810->base + SCCTRL);
47 : :
48 : 0 : return !!(val & (1 << SCCTRL_TIMERENnSEL_SHIFT(timerclken->channel)));
49 : : }
50 : :
51 : 0 : static int clk_sp810_timerclken_set_parent(struct clk_hw *hw, u8 index)
52 : : {
53 : : struct clk_sp810_timerclken *timerclken = to_clk_sp810_timerclken(hw);
54 : 0 : struct clk_sp810 *sp810 = timerclken->sp810;
55 : 0 : u32 val, shift = SCCTRL_TIMERENnSEL_SHIFT(timerclken->channel);
56 : : unsigned long flags = 0;
57 : :
58 [ # # ][ # # ]: 0 : if (WARN_ON(index > 1))
59 : : return -EINVAL;
60 : :
61 : 0 : spin_lock_irqsave(&sp810->lock, flags);
62 : :
63 : 0 : val = readl(sp810->base + SCCTRL);
64 : 0 : val &= ~(1 << shift);
65 : 0 : val |= index << shift;
66 : 0 : writel(val, sp810->base + SCCTRL);
67 : :
68 : : spin_unlock_irqrestore(&sp810->lock, flags);
69 : :
70 : 0 : return 0;
71 : : }
72 : :
73 : : /*
74 : : * FIXME - setting the parent every time .prepare is invoked is inefficient.
75 : : * This is better handled by a dedicated clock tree configuration mechanism at
76 : : * init-time. Revisit this later when such a mechanism exists
77 : : */
78 : 0 : static int clk_sp810_timerclken_prepare(struct clk_hw *hw)
79 : : {
80 : : struct clk_sp810_timerclken *timerclken = to_clk_sp810_timerclken(hw);
81 : 0 : struct clk_sp810 *sp810 = timerclken->sp810;
82 : 0 : struct clk *old_parent = __clk_get_parent(hw->clk);
83 : : struct clk *new_parent;
84 : :
85 [ # # ]: 0 : if (!sp810->refclk)
86 : 0 : sp810->refclk = of_clk_get(sp810->node, sp810->refclk_index);
87 : :
88 [ # # ]: 0 : if (!sp810->timclk)
89 : 0 : sp810->timclk = of_clk_get(sp810->node, sp810->timclk_index);
90 : :
91 [ # # ][ # # ]: 0 : if (WARN_ON(IS_ERR(sp810->refclk) || IS_ERR(sp810->timclk)))
[ # # ][ # # ]
92 : : return -ENOENT;
93 : :
94 : : /* Select fastest parent */
95 [ # # ]: 0 : if (clk_get_rate(sp810->refclk) > clk_get_rate(sp810->timclk))
96 : 0 : new_parent = sp810->refclk;
97 : : else
98 : 0 : new_parent = sp810->timclk;
99 : :
100 : : /* Switch the parent if necessary */
101 [ # # ]: 0 : if (old_parent != new_parent) {
102 : 0 : clk_prepare(new_parent);
103 : 0 : clk_set_parent(hw->clk, new_parent);
104 : 0 : clk_unprepare(old_parent);
105 : : }
106 : :
107 : : return 0;
108 : : }
109 : :
110 : 0 : static void clk_sp810_timerclken_unprepare(struct clk_hw *hw)
111 : : {
112 : : struct clk_sp810_timerclken *timerclken = to_clk_sp810_timerclken(hw);
113 : 0 : struct clk_sp810 *sp810 = timerclken->sp810;
114 : :
115 : 0 : clk_put(sp810->timclk);
116 : 0 : clk_put(sp810->refclk);
117 : 0 : }
118 : :
119 : : static const struct clk_ops clk_sp810_timerclken_ops = {
120 : : .prepare = clk_sp810_timerclken_prepare,
121 : : .unprepare = clk_sp810_timerclken_unprepare,
122 : : .get_parent = clk_sp810_timerclken_get_parent,
123 : : .set_parent = clk_sp810_timerclken_set_parent,
124 : : };
125 : :
126 : 0 : struct clk *clk_sp810_timerclken_of_get(struct of_phandle_args *clkspec,
127 : : void *data)
128 : : {
129 : : struct clk_sp810 *sp810 = data;
130 : :
131 [ # # ][ # # ]: 0 : if (WARN_ON(clkspec->args_count != 1 || clkspec->args[0] >
[ # # ][ # # ]
132 : : ARRAY_SIZE(sp810->timerclken)))
133 : : return NULL;
134 : :
135 : 0 : return sp810->timerclken[clkspec->args[0]].clk;
136 : : }
137 : :
138 : 0 : void __init clk_sp810_of_setup(struct device_node *node)
139 : : {
140 : : struct clk_sp810 *sp810 = kzalloc(sizeof(*sp810), GFP_KERNEL);
141 : : const char *parent_names[2];
142 : : char name[12];
143 : : struct clk_init_data init;
144 : : int i;
145 : :
146 [ # # ]: 0 : if (!sp810) {
147 : 0 : pr_err("Failed to allocate memory for SP810!\n");
148 : 0 : return;
149 : : }
150 : :
151 : 0 : sp810->refclk_index = of_property_match_string(node, "clock-names",
152 : : "refclk");
153 : 0 : parent_names[0] = of_clk_get_parent_name(node, sp810->refclk_index);
154 : :
155 : 0 : sp810->timclk_index = of_property_match_string(node, "clock-names",
156 : : "timclk");
157 : 0 : parent_names[1] = of_clk_get_parent_name(node, sp810->timclk_index);
158 : :
159 [ # # ][ # # ]: 0 : if (parent_names[0] <= 0 || parent_names[1] <= 0) {
160 : 0 : pr_warn("Failed to obtain parent clocks for SP810!\n");
161 : 0 : return;
162 : : }
163 : :
164 : 0 : sp810->node = node;
165 : 0 : sp810->base = of_iomap(node, 0);
166 : 0 : spin_lock_init(&sp810->lock);
167 : :
168 : 0 : init.name = name;
169 : 0 : init.ops = &clk_sp810_timerclken_ops;
170 : 0 : init.flags = CLK_IS_BASIC;
171 : 0 : init.parent_names = parent_names;
172 : 0 : init.num_parents = ARRAY_SIZE(parent_names);
173 : :
174 [ # # ]: 0 : for (i = 0; i < ARRAY_SIZE(sp810->timerclken); i++) {
175 : 0 : snprintf(name, ARRAY_SIZE(name), "timerclken%d", i);
176 : :
177 : 0 : sp810->timerclken[i].sp810 = sp810;
178 : 0 : sp810->timerclken[i].channel = i;
179 : 0 : sp810->timerclken[i].hw.init = &init;
180 : :
181 : 0 : sp810->timerclken[i].clk = clk_register(NULL,
182 : : &sp810->timerclken[i].hw);
183 [ # # ]: 0 : WARN_ON(IS_ERR(sp810->timerclken[i].clk));
184 : : }
185 : :
186 : 0 : of_clk_add_provider(node, clk_sp810_timerclken_of_get, sp810);
187 : : }
188 : : CLK_OF_DECLARE(sp810, "arm,sp810", clk_sp810_of_setup);
|
