GNU Linux-libre 4.4.292-gnu1
[releases.git] / drivers / clk / imx / clk-cpu.c
1 /*
2  * Copyright (c) 2014 Lucas Stach <l.stach@pengutronix.de>, Pengutronix
3  *
4  * This program is free software; you can redistribute it and/or modify
5  * it under the terms of the GNU General Public License version 2 as
6  * published by the Free Software Foundation.
7  *
8  * http://www.opensource.org/licenses/gpl-license.html
9  * http://www.gnu.org/copyleft/gpl.html
10  */
11
12 #include <linux/clk.h>
13 #include <linux/clk-provider.h>
14 #include <linux/slab.h>
15 #include "clk.h"
16
17 struct clk_cpu {
18         struct clk_hw   hw;
19         struct clk      *div;
20         struct clk      *mux;
21         struct clk      *pll;
22         struct clk      *step;
23 };
24
25 static inline struct clk_cpu *to_clk_cpu(struct clk_hw *hw)
26 {
27         return container_of(hw, struct clk_cpu, hw);
28 }
29
30 static unsigned long clk_cpu_recalc_rate(struct clk_hw *hw,
31                                          unsigned long parent_rate)
32 {
33         struct clk_cpu *cpu = to_clk_cpu(hw);
34
35         return clk_get_rate(cpu->div);
36 }
37
38 static long clk_cpu_round_rate(struct clk_hw *hw, unsigned long rate,
39                                unsigned long *prate)
40 {
41         struct clk_cpu *cpu = to_clk_cpu(hw);
42
43         return clk_round_rate(cpu->pll, rate);
44 }
45
46 static int clk_cpu_set_rate(struct clk_hw *hw, unsigned long rate,
47                             unsigned long parent_rate)
48 {
49         struct clk_cpu *cpu = to_clk_cpu(hw);
50         int ret;
51
52         /* switch to PLL bypass clock */
53         ret = clk_set_parent(cpu->mux, cpu->step);
54         if (ret)
55                 return ret;
56
57         /* reprogram PLL */
58         ret = clk_set_rate(cpu->pll, rate);
59         if (ret) {
60                 clk_set_parent(cpu->mux, cpu->pll);
61                 return ret;
62         }
63         /* switch back to PLL clock */
64         clk_set_parent(cpu->mux, cpu->pll);
65
66         /* Ensure the divider is what we expect */
67         clk_set_rate(cpu->div, rate);
68
69         return 0;
70 }
71
72 static const struct clk_ops clk_cpu_ops = {
73         .recalc_rate    = clk_cpu_recalc_rate,
74         .round_rate     = clk_cpu_round_rate,
75         .set_rate       = clk_cpu_set_rate,
76 };
77
78 struct clk *imx_clk_cpu(const char *name, const char *parent_name,
79                 struct clk *div, struct clk *mux, struct clk *pll,
80                 struct clk *step)
81 {
82         struct clk_cpu *cpu;
83         struct clk *clk;
84         struct clk_init_data init;
85
86         cpu = kzalloc(sizeof(*cpu), GFP_KERNEL);
87         if (!cpu)
88                 return ERR_PTR(-ENOMEM);
89
90         cpu->div = div;
91         cpu->mux = mux;
92         cpu->pll = pll;
93         cpu->step = step;
94
95         init.name = name;
96         init.ops = &clk_cpu_ops;
97         init.flags = 0;
98         init.parent_names = &parent_name;
99         init.num_parents = 1;
100
101         cpu->hw.init = &init;
102
103         clk = clk_register(NULL, &cpu->hw);
104         if (IS_ERR(clk))
105                 kfree(cpu);
106
107         return clk;
108 }