1
2
3
4
5
6
7
8
9#include <linux/clk-provider.h>
10#include <linux/clk.h>
11#include <linux/clkdev.h>
12#include <linux/err.h>
13#include <linux/io.h>
14#include <linux/platform_data/clk-integrator.h>
15
16#include "clk-icst.h"
17
18#define IMPD1_OSC1 0x00
19#define IMPD1_OSC2 0x04
20#define IMPD1_LOCK 0x08
21
22struct impd1_clk {
23 char *pclkname;
24 struct clk *pclk;
25 char *vco1name;
26 struct clk *vco1clk;
27 char *vco2name;
28 struct clk *vco2clk;
29 struct clk *mmciclk;
30 char *uartname;
31 struct clk *uartclk;
32 char *spiname;
33 struct clk *spiclk;
34 char *scname;
35 struct clk *scclk;
36 struct clk_lookup *clks[15];
37};
38
39
40static struct impd1_clk impd1_clks[4];
41
42
43
44
45
46static const struct icst_params impd1_vco1_params = {
47 .ref = 24000000,
48 .vco_max = ICST525_VCO_MAX_3V,
49 .vco_min = ICST525_VCO_MIN,
50 .vd_min = 12,
51 .vd_max = 519,
52 .rd_min = 3,
53 .rd_max = 120,
54 .s2div = icst525_s2div,
55 .idx2s = icst525_idx2s,
56};
57
58static const struct clk_icst_desc impd1_icst1_desc = {
59 .params = &impd1_vco1_params,
60 .vco_offset = IMPD1_OSC1,
61 .lock_offset = IMPD1_LOCK,
62};
63
64static const struct icst_params impd1_vco2_params = {
65 .ref = 24000000,
66 .vco_max = ICST525_VCO_MAX_3V,
67 .vco_min = ICST525_VCO_MIN,
68 .vd_min = 12,
69 .vd_max = 519,
70 .rd_min = 3,
71 .rd_max = 120,
72 .s2div = icst525_s2div,
73 .idx2s = icst525_idx2s,
74};
75
76static const struct clk_icst_desc impd1_icst2_desc = {
77 .params = &impd1_vco2_params,
78 .vco_offset = IMPD1_OSC2,
79 .lock_offset = IMPD1_LOCK,
80};
81
82
83
84
85
86
87void integrator_impd1_clk_init(void __iomem *base, unsigned int id)
88{
89 struct impd1_clk *imc;
90 struct clk *clk;
91 struct clk *pclk;
92 int i;
93
94 if (id > 3) {
95 pr_crit("no more than 4 LMs can be attached\n");
96 return;
97 }
98 imc = &impd1_clks[id];
99
100
101 imc->pclkname = kasprintf(GFP_KERNEL, "lm%x-pclk", id);
102 pclk = clk_register_fixed_rate(NULL, imc->pclkname, NULL,
103 CLK_IS_ROOT, 0);
104 imc->pclk = pclk;
105
106 imc->vco1name = kasprintf(GFP_KERNEL, "lm%x-vco1", id);
107 clk = icst_clk_register(NULL, &impd1_icst1_desc, imc->vco1name, NULL,
108 base);
109 imc->vco1clk = clk;
110 imc->clks[0] = clkdev_alloc(pclk, "apb_pclk", "lm%x:01000", id);
111 imc->clks[1] = clkdev_alloc(clk, NULL, "lm%x:01000", id);
112
113
114 imc->vco2name = kasprintf(GFP_KERNEL, "lm%x-vco2", id);
115 clk = icst_clk_register(NULL, &impd1_icst2_desc, imc->vco2name, NULL,
116 base);
117 imc->vco2clk = clk;
118
119
120 imc->clks[2] = clkdev_alloc(pclk, "apb_pclk", "lm%x:00700", id);
121 imc->clks[3] = clkdev_alloc(clk, NULL, "lm%x:00700", id);
122
123
124 imc->uartname = kasprintf(GFP_KERNEL, "lm%x-uartclk", id);
125 clk = clk_register_fixed_factor(NULL, imc->uartname, imc->vco2name,
126 CLK_IGNORE_UNUSED, 1, 4);
127 imc->uartclk = clk;
128 imc->clks[4] = clkdev_alloc(pclk, "apb_pclk", "lm%x:00100", id);
129 imc->clks[5] = clkdev_alloc(clk, NULL, "lm%x:00100", id);
130 imc->clks[6] = clkdev_alloc(pclk, "apb_pclk", "lm%x:00200", id);
131 imc->clks[7] = clkdev_alloc(clk, NULL, "lm%x:00200", id);
132
133
134 imc->spiname = kasprintf(GFP_KERNEL, "lm%x-spiclk", id);
135 clk = clk_register_fixed_factor(NULL, imc->spiname, imc->vco2name,
136 CLK_IGNORE_UNUSED, 1, 64);
137 imc->clks[8] = clkdev_alloc(pclk, "apb_pclk", "lm%x:00300", id);
138 imc->clks[9] = clkdev_alloc(clk, NULL, "lm%x:00300", id);
139
140
141 imc->clks[10] = clkdev_alloc(pclk, "apb_pclk", "lm%x:00400", id);
142 imc->clks[11] = clkdev_alloc(pclk, "apb_pclk", "lm%x:00500", id);
143 imc->clks[12] = clkdev_alloc(pclk, "apb_pclk", "lm%x:00800", id);
144
145
146 imc->scname = kasprintf(GFP_KERNEL, "lm%x-scclk", id);
147 clk = clk_register_fixed_factor(NULL, imc->scname, imc->vco2name,
148 CLK_IGNORE_UNUSED, 1, 4);
149 imc->scclk = clk;
150 imc->clks[13] = clkdev_alloc(pclk, "apb_pclk", "lm%x:00600", id);
151 imc->clks[14] = clkdev_alloc(clk, NULL, "lm%x:00600", id);
152
153 for (i = 0; i < ARRAY_SIZE(imc->clks); i++)
154 clkdev_add(imc->clks[i]);
155}
156EXPORT_SYMBOL_GPL(integrator_impd1_clk_init);
157
158void integrator_impd1_clk_exit(unsigned int id)
159{
160 int i;
161 struct impd1_clk *imc;
162
163 if (id > 3)
164 return;
165 imc = &impd1_clks[id];
166
167 for (i = 0; i < ARRAY_SIZE(imc->clks); i++)
168 clkdev_drop(imc->clks[i]);
169 clk_unregister(imc->spiclk);
170 clk_unregister(imc->uartclk);
171 clk_unregister(imc->vco2clk);
172 clk_unregister(imc->vco1clk);
173 clk_unregister(imc->pclk);
174 kfree(imc->scname);
175 kfree(imc->spiname);
176 kfree(imc->uartname);
177 kfree(imc->vco2name);
178 kfree(imc->vco1name);
179 kfree(imc->pclkname);
180}
181EXPORT_SYMBOL_GPL(integrator_impd1_clk_exit);
182