diff options
author | Linus Torvalds <torvalds@linux-foundation.org> | 2012-10-01 21:28:06 -0400 |
---|---|---|
committer | Linus Torvalds <torvalds@linux-foundation.org> | 2012-10-01 21:28:06 -0400 |
commit | 2a2bf85f05e42b12ea6bfe821e2d19221cf93555 (patch) | |
tree | 11abcdaef6e4f8307574056998d306d21558b6ed /drivers | |
parent | 11801e9de26992d37cb869cc74f389b6a7677e0e (diff) | |
parent | 99261fbad0a16f105b262d7525801697588ba526 (diff) |
Merge tag 'dt' of git://git.kernel.org/pub/scm/linux/kernel/git/arm/arm-soc
Pull ARM soc device tree updates from Olof Johansson:
"Device tree conversion and enablement branch. Mostly a bunch of new
bindings and setup for various platforms, but the Via/Winchip VT8500
platform is also converted over from being 100% legacy to now use
device tree for probing. More of that will come for 3.8."
Trivial conflicts due to removal of vt8500 files, and one documentation
file that was added with slightly different contents both here and in
the USb tree.
* tag 'dt' of git://git.kernel.org/pub/scm/linux/kernel/git/arm/arm-soc: (212 commits)
arm: vt8500: Fixup for missing gpio.h
ARM: LPC32xx: LED fix in PHY3250 DTS file
ARM: dt: mmp-dma: add binding file
arm: vt8500: Update arch-vt8500 to devicetree support.
arm: vt8500: gpio: Devicetree support for arch-vt8500
arm: vt8500: doc: Add device tree bindings for arch-vt8500 devices
arm: vt8500: clk: Add Common Clock Framework support
video: vt8500: Add devicetree support for vt8500-fb and wm8505-fb
serial: vt8500: Add devicetree support for vt8500-serial
rtc: vt8500: Add devicetree support for vt8500-rtc
arm: vt8500: Add device tree files for VIA/Wondermedia SoC's
ARM: tegra: Add Avionic Design Tamonten Evaluation Carrier support
ARM: tegra: Add Avionic Design Medcom-Wide support
ARM: tegra: Add Avionic Design Plutux support
ARM: tegra: Add Avionic Design Tamonten support
ARM: tegra: dts: Add pwm label
ARM: ux500: Fix SSP register address format
ARM: ux500: Apply tc3589x's GPIO/IRQ properties to HREF's DT
ARM: ux500: Remove redundant #gpio-cell properties from Snowball DT
ARM: ux500: Add all encompassing sound node to the HREF Device Tree
...
Diffstat (limited to 'drivers')
-rw-r--r-- | drivers/clk/Makefile | 1 | ||||
-rw-r--r-- | drivers/clk/clk-vt8500.c | 510 | ||||
-rw-r--r-- | drivers/clk/mxs/clk-imx23.c | 55 | ||||
-rw-r--r-- | drivers/clk/mxs/clk-imx28.c | 113 | ||||
-rw-r--r-- | drivers/gpio/Kconfig | 6 | ||||
-rw-r--r-- | drivers/gpio/Makefile | 1 | ||||
-rw-r--r-- | drivers/gpio/gpio-pxa.c | 77 | ||||
-rw-r--r-- | drivers/gpio/gpio-samsung.c | 63 | ||||
-rw-r--r-- | drivers/gpio/gpio-twl4030.c | 77 | ||||
-rw-r--r-- | drivers/gpio/gpio-vt8500.c | 316 | ||||
-rw-r--r-- | drivers/mtd/nand/pxa3xx_nand.c | 87 | ||||
-rw-r--r-- | drivers/pinctrl/pinctrl-sirf.c | 58 | ||||
-rw-r--r-- | drivers/rtc/rtc-ab8500.c | 6 | ||||
-rw-r--r-- | drivers/rtc/rtc-pxa.c | 11 | ||||
-rw-r--r-- | drivers/rtc/rtc-vt8500.c | 9 | ||||
-rw-r--r-- | drivers/tty/serial/vt8500_serial.c | 58 | ||||
-rw-r--r-- | drivers/video/Kconfig | 6 | ||||
-rw-r--r-- | drivers/video/vt8500lcdfb.c | 79 | ||||
-rw-r--r-- | drivers/video/wm8505fb.c | 97 | ||||
-rw-r--r-- | drivers/video/wmt_ge_rops.c | 9 |
20 files changed, 1354 insertions, 285 deletions
diff --git a/drivers/clk/Makefile b/drivers/clk/Makefile index 2b861625bdae..71a25b91de00 100644 --- a/drivers/clk/Makefile +++ b/drivers/clk/Makefile | |||
@@ -18,6 +18,7 @@ obj-$(CONFIG_ARCH_MMP) += mmp/ | |||
18 | endif | 18 | endif |
19 | obj-$(CONFIG_MACH_LOONGSON1) += clk-ls1x.o | 19 | obj-$(CONFIG_MACH_LOONGSON1) += clk-ls1x.o |
20 | obj-$(CONFIG_ARCH_U8500) += ux500/ | 20 | obj-$(CONFIG_ARCH_U8500) += ux500/ |
21 | obj-$(CONFIG_ARCH_VT8500) += clk-vt8500.o | ||
21 | 22 | ||
22 | # Chip specific | 23 | # Chip specific |
23 | obj-$(CONFIG_COMMON_CLK_WM831X) += clk-wm831x.o | 24 | obj-$(CONFIG_COMMON_CLK_WM831X) += clk-wm831x.o |
diff --git a/drivers/clk/clk-vt8500.c b/drivers/clk/clk-vt8500.c new file mode 100644 index 000000000000..a885600f5270 --- /dev/null +++ b/drivers/clk/clk-vt8500.c | |||
@@ -0,0 +1,510 @@ | |||
1 | /* | ||
2 | * Clock implementation for VIA/Wondermedia SoC's | ||
3 | * Copyright (C) 2012 Tony Prisk <linux@prisktech.co.nz> | ||
4 | * | ||
5 | * This software is licensed under the terms of the GNU General Public | ||
6 | * License version 2, as published by the Free Software Foundation, and | ||
7 | * may be copied, distributed, and modified under those terms. | ||
8 | * | ||
9 | * This program is distributed in the hope that it will be useful, | ||
10 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
11 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | ||
12 | * GNU General Public License for more details. | ||
13 | * | ||
14 | */ | ||
15 | |||
16 | #include <linux/io.h> | ||
17 | #include <linux/of.h> | ||
18 | #include <linux/slab.h> | ||
19 | #include <linux/bitops.h> | ||
20 | #include <linux/clkdev.h> | ||
21 | #include <linux/clk-provider.h> | ||
22 | |||
23 | /* All clocks share the same lock as none can be changed concurrently */ | ||
24 | static DEFINE_SPINLOCK(_lock); | ||
25 | |||
26 | struct clk_device { | ||
27 | struct clk_hw hw; | ||
28 | void __iomem *div_reg; | ||
29 | unsigned int div_mask; | ||
30 | void __iomem *en_reg; | ||
31 | int en_bit; | ||
32 | spinlock_t *lock; | ||
33 | }; | ||
34 | |||
35 | /* | ||
36 | * Add new PLL_TYPE_x definitions here as required. Use the first known model | ||
37 | * to support the new type as the name. | ||
38 | * Add case statements to vtwm_pll_recalc_rate(), vtwm_pll_round_round() and | ||
39 | * vtwm_pll_set_rate() to handle the new PLL_TYPE_x | ||
40 | */ | ||
41 | |||
42 | #define PLL_TYPE_VT8500 0 | ||
43 | #define PLL_TYPE_WM8650 1 | ||
44 | |||
45 | struct clk_pll { | ||
46 | struct clk_hw hw; | ||
47 | void __iomem *reg; | ||
48 | spinlock_t *lock; | ||
49 | int type; | ||
50 | }; | ||
51 | |||
52 | static void __iomem *pmc_base; | ||
53 | |||
54 | #define to_clk_device(_hw) container_of(_hw, struct clk_device, hw) | ||
55 | |||
56 | #define VT8500_PMC_BUSY_MASK 0x18 | ||
57 | |||
58 | static void vt8500_pmc_wait_busy(void) | ||
59 | { | ||
60 | while (readl(pmc_base) & VT8500_PMC_BUSY_MASK) | ||
61 | cpu_relax(); | ||
62 | } | ||
63 | |||
64 | static int vt8500_dclk_enable(struct clk_hw *hw) | ||
65 | { | ||
66 | struct clk_device *cdev = to_clk_device(hw); | ||
67 | u32 en_val; | ||
68 | unsigned long flags = 0; | ||
69 | |||
70 | spin_lock_irqsave(cdev->lock, flags); | ||
71 | |||
72 | en_val = readl(cdev->en_reg); | ||
73 | en_val |= BIT(cdev->en_bit); | ||
74 | writel(en_val, cdev->en_reg); | ||
75 | |||
76 | spin_unlock_irqrestore(cdev->lock, flags); | ||
77 | return 0; | ||
78 | } | ||
79 | |||
80 | static void vt8500_dclk_disable(struct clk_hw *hw) | ||
81 | { | ||
82 | struct clk_device *cdev = to_clk_device(hw); | ||
83 | u32 en_val; | ||
84 | unsigned long flags = 0; | ||
85 | |||
86 | spin_lock_irqsave(cdev->lock, flags); | ||
87 | |||
88 | en_val = readl(cdev->en_reg); | ||
89 | en_val &= ~BIT(cdev->en_bit); | ||
90 | writel(en_val, cdev->en_reg); | ||
91 | |||
92 | spin_unlock_irqrestore(cdev->lock, flags); | ||
93 | } | ||
94 | |||
95 | static int vt8500_dclk_is_enabled(struct clk_hw *hw) | ||
96 | { | ||
97 | struct clk_device *cdev = to_clk_device(hw); | ||
98 | u32 en_val = (readl(cdev->en_reg) & BIT(cdev->en_bit)); | ||
99 | |||
100 | return en_val ? 1 : 0; | ||
101 | } | ||
102 | |||
103 | static unsigned long vt8500_dclk_recalc_rate(struct clk_hw *hw, | ||
104 | unsigned long parent_rate) | ||
105 | { | ||
106 | struct clk_device *cdev = to_clk_device(hw); | ||
107 | u32 div = readl(cdev->div_reg) & cdev->div_mask; | ||
108 | |||
109 | /* Special case for SDMMC devices */ | ||
110 | if ((cdev->div_mask == 0x3F) && (div & BIT(5))) | ||
111 | div = 64 * (div & 0x1f); | ||
112 | |||
113 | /* div == 0 is actually the highest divisor */ | ||
114 | if (div == 0) | ||
115 | div = (cdev->div_mask + 1); | ||
116 | |||
117 | return parent_rate / div; | ||
118 | } | ||
119 | |||
120 | static long vt8500_dclk_round_rate(struct clk_hw *hw, unsigned long rate, | ||
121 | unsigned long *prate) | ||
122 | { | ||
123 | u32 divisor = *prate / rate; | ||
124 | |||
125 | return *prate / divisor; | ||
126 | } | ||
127 | |||
128 | static int vt8500_dclk_set_rate(struct clk_hw *hw, unsigned long rate, | ||
129 | unsigned long parent_rate) | ||
130 | { | ||
131 | struct clk_device *cdev = to_clk_device(hw); | ||
132 | u32 divisor = parent_rate / rate; | ||
133 | unsigned long flags = 0; | ||
134 | |||
135 | if (divisor == cdev->div_mask + 1) | ||
136 | divisor = 0; | ||
137 | |||
138 | if (divisor > cdev->div_mask) { | ||
139 | pr_err("%s: invalid divisor for clock\n", __func__); | ||
140 | return -EINVAL; | ||
141 | } | ||
142 | |||
143 | spin_lock_irqsave(cdev->lock, flags); | ||
144 | |||
145 | vt8500_pmc_wait_busy(); | ||
146 | writel(divisor, cdev->div_reg); | ||
147 | vt8500_pmc_wait_busy(); | ||
148 | |||
149 | spin_lock_irqsave(cdev->lock, flags); | ||
150 | |||
151 | return 0; | ||
152 | } | ||
153 | |||
154 | |||
155 | static const struct clk_ops vt8500_gated_clk_ops = { | ||
156 | .enable = vt8500_dclk_enable, | ||
157 | .disable = vt8500_dclk_disable, | ||
158 | .is_enabled = vt8500_dclk_is_enabled, | ||
159 | }; | ||
160 | |||
161 | static const struct clk_ops vt8500_divisor_clk_ops = { | ||
162 | .round_rate = vt8500_dclk_round_rate, | ||
163 | .set_rate = vt8500_dclk_set_rate, | ||
164 | .recalc_rate = vt8500_dclk_recalc_rate, | ||
165 | }; | ||
166 | |||
167 | static const struct clk_ops vt8500_gated_divisor_clk_ops = { | ||
168 | .enable = vt8500_dclk_enable, | ||
169 | .disable = vt8500_dclk_disable, | ||
170 | .is_enabled = vt8500_dclk_is_enabled, | ||
171 | .round_rate = vt8500_dclk_round_rate, | ||
172 | .set_rate = vt8500_dclk_set_rate, | ||
173 | .recalc_rate = vt8500_dclk_recalc_rate, | ||
174 | }; | ||
175 | |||
176 | #define CLK_INIT_GATED BIT(0) | ||
177 | #define CLK_INIT_DIVISOR BIT(1) | ||
178 | #define CLK_INIT_GATED_DIVISOR (CLK_INIT_DIVISOR | CLK_INIT_GATED) | ||
179 | |||
180 | static __init void vtwm_device_clk_init(struct device_node *node) | ||
181 | { | ||
182 | u32 en_reg, div_reg; | ||
183 | struct clk *clk; | ||
184 | struct clk_device *dev_clk; | ||
185 | const char *clk_name = node->name; | ||
186 | const char *parent_name; | ||
187 | struct clk_init_data init; | ||
188 | int rc; | ||
189 | int clk_init_flags = 0; | ||
190 | |||
191 | dev_clk = kzalloc(sizeof(*dev_clk), GFP_KERNEL); | ||
192 | if (WARN_ON(!dev_clk)) | ||
193 | return; | ||
194 | |||
195 | dev_clk->lock = &_lock; | ||
196 | |||
197 | rc = of_property_read_u32(node, "enable-reg", &en_reg); | ||
198 | if (!rc) { | ||
199 | dev_clk->en_reg = pmc_base + en_reg; | ||
200 | rc = of_property_read_u32(node, "enable-bit", &dev_clk->en_bit); | ||
201 | if (rc) { | ||
202 | pr_err("%s: enable-bit property required for gated clock\n", | ||
203 | __func__); | ||
204 | return; | ||
205 | } | ||
206 | clk_init_flags |= CLK_INIT_GATED; | ||
207 | } | ||
208 | |||
209 | rc = of_property_read_u32(node, "divisor-reg", &div_reg); | ||
210 | if (!rc) { | ||
211 | dev_clk->div_reg = pmc_base + div_reg; | ||
212 | /* | ||
213 | * use 0x1f as the default mask since it covers | ||
214 | * almost all the clocks and reduces dts properties | ||
215 | */ | ||
216 | dev_clk->div_mask = 0x1f; | ||
217 | |||
218 | of_property_read_u32(node, "divisor-mask", &dev_clk->div_mask); | ||
219 | clk_init_flags |= CLK_INIT_DIVISOR; | ||
220 | } | ||
221 | |||
222 | of_property_read_string(node, "clock-output-names", &clk_name); | ||
223 | |||
224 | switch (clk_init_flags) { | ||
225 | case CLK_INIT_GATED: | ||
226 | init.ops = &vt8500_gated_clk_ops; | ||
227 | break; | ||
228 | case CLK_INIT_DIVISOR: | ||
229 | init.ops = &vt8500_divisor_clk_ops; | ||
230 | break; | ||
231 | case CLK_INIT_GATED_DIVISOR: | ||
232 | init.ops = &vt8500_gated_divisor_clk_ops; | ||
233 | break; | ||
234 | default: | ||
235 | pr_err("%s: Invalid clock description in device tree\n", | ||
236 | __func__); | ||
237 | kfree(dev_clk); | ||
238 | return; | ||
239 | } | ||
240 | |||
241 | init.name = clk_name; | ||
242 | init.flags = 0; | ||
243 | parent_name = of_clk_get_parent_name(node, 0); | ||
244 | init.parent_names = &parent_name; | ||
245 | init.num_parents = 1; | ||
246 | |||
247 | dev_clk->hw.init = &init; | ||
248 | |||
249 | clk = clk_register(NULL, &dev_clk->hw); | ||
250 | if (WARN_ON(IS_ERR(clk))) { | ||
251 | kfree(dev_clk); | ||
252 | return; | ||
253 | } | ||
254 | rc = of_clk_add_provider(node, of_clk_src_simple_get, clk); | ||
255 | clk_register_clkdev(clk, clk_name, NULL); | ||
256 | } | ||
257 | |||
258 | |||
259 | /* PLL clock related functions */ | ||
260 | |||
261 | #define to_clk_pll(_hw) container_of(_hw, struct clk_pll, hw) | ||
262 | |||
263 | /* Helper macros for PLL_VT8500 */ | ||
264 | #define VT8500_PLL_MUL(x) ((x & 0x1F) << 1) | ||
265 | #define VT8500_PLL_DIV(x) ((x & 0x100) ? 1 : 2) | ||
266 | |||
267 | #define VT8500_BITS_TO_FREQ(r, m, d) \ | ||
268 | ((r / d) * m) | ||
269 | |||
270 | #define VT8500_BITS_TO_VAL(m, d) \ | ||
271 | ((d == 2 ? 0 : 0x100) | ((m >> 1) & 0x1F)) | ||
272 | |||
273 | /* Helper macros for PLL_WM8650 */ | ||
274 | #define WM8650_PLL_MUL(x) (x & 0x3FF) | ||
275 | #define WM8650_PLL_DIV(x) (((x >> 10) & 7) * (1 << ((x >> 13) & 3))) | ||
276 | |||
277 | #define WM8650_BITS_TO_FREQ(r, m, d1, d2) \ | ||
278 | (r * m / (d1 * (1 << d2))) | ||
279 | |||
280 | #define WM8650_BITS_TO_VAL(m, d1, d2) \ | ||
281 | ((d2 << 13) | (d1 << 10) | (m & 0x3FF)) | ||
282 | |||
283 | |||
284 | static void vt8500_find_pll_bits(unsigned long rate, unsigned long parent_rate, | ||
285 | u32 *multiplier, u32 *prediv) | ||
286 | { | ||
287 | unsigned long tclk; | ||
288 | |||
289 | /* sanity check */ | ||
290 | if ((rate < parent_rate * 4) || (rate > parent_rate * 62)) { | ||
291 | pr_err("%s: requested rate out of range\n", __func__); | ||
292 | *multiplier = 0; | ||
293 | *prediv = 1; | ||
294 | return; | ||
295 | } | ||
296 | if (rate <= parent_rate * 31) | ||
297 | /* use the prediv to double the resolution */ | ||
298 | *prediv = 2; | ||
299 | else | ||
300 | *prediv = 1; | ||
301 | |||
302 | *multiplier = rate / (parent_rate / *prediv); | ||
303 | tclk = (parent_rate / *prediv) * *multiplier; | ||
304 | |||
305 | if (tclk != rate) | ||
306 | pr_warn("%s: requested rate %lu, found rate %lu\n", __func__, | ||
307 | rate, tclk); | ||
308 | } | ||
309 | |||
310 | static void wm8650_find_pll_bits(unsigned long rate, unsigned long parent_rate, | ||
311 | u32 *multiplier, u32 *divisor1, u32 *divisor2) | ||
312 | { | ||
313 | u32 mul, div1, div2; | ||
314 | u32 best_mul, best_div1, best_div2; | ||
315 | unsigned long tclk, rate_err, best_err; | ||
316 | |||
317 | best_err = (unsigned long)-1; | ||
318 | |||
319 | /* Find the closest match (lower or equal to requested) */ | ||
320 | for (div1 = 5; div1 >= 3; div1--) | ||
321 | for (div2 = 3; div2 >= 0; div2--) | ||
322 | for (mul = 3; mul <= 1023; mul++) { | ||
323 | tclk = parent_rate * mul / (div1 * (1 << div2)); | ||
324 | if (tclk > rate) | ||
325 | continue; | ||
326 | /* error will always be +ve */ | ||
327 | rate_err = rate - tclk; | ||
328 | if (rate_err == 0) { | ||
329 | *multiplier = mul; | ||
330 | *divisor1 = div1; | ||
331 | *divisor2 = div2; | ||
332 | return; | ||
333 | } | ||
334 | |||
335 | if (rate_err < best_err) { | ||
336 | best_err = rate_err; | ||
337 | best_mul = mul; | ||
338 | best_div1 = div1; | ||
339 | best_div2 = div2; | ||
340 | } | ||
341 | } | ||
342 | |||
343 | /* if we got here, it wasn't an exact match */ | ||
344 | pr_warn("%s: requested rate %lu, found rate %lu\n", __func__, rate, | ||
345 | rate - best_err); | ||
346 | *multiplier = mul; | ||
347 | *divisor1 = div1; | ||
348 | *divisor2 = div2; | ||
349 | } | ||
350 | |||
351 | static int vtwm_pll_set_rate(struct clk_hw *hw, unsigned long rate, | ||
352 | unsigned long parent_rate) | ||
353 | { | ||
354 | struct clk_pll *pll = to_clk_pll(hw); | ||
355 | u32 mul, div1, div2; | ||
356 | u32 pll_val; | ||
357 | unsigned long flags = 0; | ||
358 | |||
359 | /* sanity check */ | ||
360 | |||
361 | switch (pll->type) { | ||
362 | case PLL_TYPE_VT8500: | ||
363 | vt8500_find_pll_bits(rate, parent_rate, &mul, &div1); | ||
364 | pll_val = VT8500_BITS_TO_VAL(mul, div1); | ||
365 | break; | ||
366 | case PLL_TYPE_WM8650: | ||
367 | wm8650_find_pll_bits(rate, parent_rate, &mul, &div1, &div2); | ||
368 | pll_val = WM8650_BITS_TO_VAL(mul, div1, div2); | ||
369 | break; | ||
370 | default: | ||
371 | pr_err("%s: invalid pll type\n", __func__); | ||
372 | return 0; | ||
373 | } | ||
374 | |||
375 | spin_lock_irqsave(pll->lock, flags); | ||
376 | |||
377 | vt8500_pmc_wait_busy(); | ||
378 | writel(pll_val, pll->reg); | ||
379 | vt8500_pmc_wait_busy(); | ||
380 | |||
381 | spin_unlock_irqrestore(pll->lock, flags); | ||
382 | |||
383 | return 0; | ||
384 | } | ||
385 | |||
386 | static long vtwm_pll_round_rate(struct clk_hw *hw, unsigned long rate, | ||
387 | unsigned long *prate) | ||
388 | { | ||
389 | struct clk_pll *pll = to_clk_pll(hw); | ||
390 | u32 mul, div1, div2; | ||
391 | long round_rate; | ||
392 | |||
393 | switch (pll->type) { | ||
394 | case PLL_TYPE_VT8500: | ||
395 | vt8500_find_pll_bits(rate, *prate, &mul, &div1); | ||
396 | round_rate = VT8500_BITS_TO_FREQ(*prate, mul, div1); | ||
397 | break; | ||
398 | case PLL_TYPE_WM8650: | ||
399 | wm8650_find_pll_bits(rate, *prate, &mul, &div1, &div2); | ||
400 | round_rate = WM8650_BITS_TO_FREQ(*prate, mul, div1, div2); | ||
401 | break; | ||
402 | default: | ||
403 | round_rate = 0; | ||
404 | } | ||
405 | |||
406 | return round_rate; | ||
407 | } | ||
408 | |||
409 | static unsigned long vtwm_pll_recalc_rate(struct clk_hw *hw, | ||
410 | unsigned long parent_rate) | ||
411 | { | ||
412 | struct clk_pll *pll = to_clk_pll(hw); | ||
413 | u32 pll_val = readl(pll->reg); | ||
414 | unsigned long pll_freq; | ||
415 | |||
416 | switch (pll->type) { | ||
417 | case PLL_TYPE_VT8500: | ||
418 | pll_freq = parent_rate * VT8500_PLL_MUL(pll_val); | ||
419 | pll_freq /= VT8500_PLL_DIV(pll_val); | ||
420 | break; | ||
421 | case PLL_TYPE_WM8650: | ||
422 | pll_freq = parent_rate * WM8650_PLL_MUL(pll_val); | ||
423 | pll_freq /= WM8650_PLL_DIV(pll_val); | ||
424 | break; | ||
425 | default: | ||
426 | pll_freq = 0; | ||
427 | } | ||
428 | |||
429 | return pll_freq; | ||
430 | } | ||
431 | |||
432 | const struct clk_ops vtwm_pll_ops = { | ||
433 | .round_rate = vtwm_pll_round_rate, | ||
434 | .set_rate = vtwm_pll_set_rate, | ||
435 | .recalc_rate = vtwm_pll_recalc_rate, | ||
436 | }; | ||
437 | |||
438 | static __init void vtwm_pll_clk_init(struct device_node *node, int pll_type) | ||
439 | { | ||
440 | u32 reg; | ||
441 | struct clk *clk; | ||
442 | struct clk_pll *pll_clk; | ||
443 | const char *clk_name = node->name; | ||
444 | const char *parent_name; | ||
445 | struct clk_init_data init; | ||
446 | int rc; | ||
447 | |||
448 | rc = of_property_read_u32(node, "reg", ®); | ||
449 | if (WARN_ON(rc)) | ||
450 | return; | ||
451 | |||
452 | pll_clk = kzalloc(sizeof(*pll_clk), GFP_KERNEL); | ||
453 | if (WARN_ON(!pll_clk)) | ||
454 | return; | ||
455 | |||
456 | pll_clk->reg = pmc_base + reg; | ||
457 | pll_clk->lock = &_lock; | ||
458 | pll_clk->type = pll_type; | ||
459 | |||
460 | of_property_read_string(node, "clock-output-names", &clk_name); | ||
461 | |||
462 | init.name = clk_name; | ||
463 | init.ops = &vtwm_pll_ops; | ||
464 | init.flags = 0; | ||
465 | parent_name = of_clk_get_parent_name(node, 0); | ||
466 | init.parent_names = &parent_name; | ||
467 | init.num_parents = 1; | ||
468 | |||
469 | pll_clk->hw.init = &init; | ||
470 | |||
471 | clk = clk_register(NULL, &pll_clk->hw); | ||
472 | if (WARN_ON(IS_ERR(clk))) { | ||
473 | kfree(pll_clk); | ||
474 | return; | ||
475 | } | ||
476 | rc = of_clk_add_provider(node, of_clk_src_simple_get, clk); | ||
477 | clk_register_clkdev(clk, clk_name, NULL); | ||
478 | } | ||
479 | |||
480 | |||
481 | /* Wrappers for initialization functions */ | ||
482 | |||
483 | static void __init vt8500_pll_init(struct device_node *node) | ||
484 | { | ||
485 | vtwm_pll_clk_init(node, PLL_TYPE_VT8500); | ||
486 | } | ||
487 | |||
488 | static void __init wm8650_pll_init(struct device_node *node) | ||
489 | { | ||
490 | vtwm_pll_clk_init(node, PLL_TYPE_WM8650); | ||
491 | } | ||
492 | |||
493 | static const __initconst struct of_device_id clk_match[] = { | ||
494 | { .compatible = "fixed-clock", .data = of_fixed_clk_setup, }, | ||
495 | { .compatible = "via,vt8500-pll-clock", .data = vt8500_pll_init, }, | ||
496 | { .compatible = "wm,wm8650-pll-clock", .data = wm8650_pll_init, }, | ||
497 | { .compatible = "via,vt8500-device-clock", | ||
498 | .data = vtwm_device_clk_init, }, | ||
499 | { /* sentinel */ } | ||
500 | }; | ||
501 | |||
502 | void __init vtwm_clk_init(void __iomem *base) | ||
503 | { | ||
504 | if (!base) | ||
505 | return; | ||
506 | |||
507 | pmc_base = base; | ||
508 | |||
509 | of_clk_init(clk_match); | ||
510 | } | ||
diff --git a/drivers/clk/mxs/clk-imx23.c b/drivers/clk/mxs/clk-imx23.c index 844043ad0fe4..9f6d15546cbe 100644 --- a/drivers/clk/mxs/clk-imx23.c +++ b/drivers/clk/mxs/clk-imx23.c | |||
@@ -14,6 +14,7 @@ | |||
14 | #include <linux/err.h> | 14 | #include <linux/err.h> |
15 | #include <linux/init.h> | 15 | #include <linux/init.h> |
16 | #include <linux/io.h> | 16 | #include <linux/io.h> |
17 | #include <linux/of.h> | ||
17 | #include <mach/common.h> | 18 | #include <mach/common.h> |
18 | #include <mach/mx23.h> | 19 | #include <mach/mx23.h> |
19 | #include "clk.h" | 20 | #include "clk.h" |
@@ -71,44 +72,6 @@ static void __init clk_misc_init(void) | |||
71 | __mxs_setl(30 << BP_FRAC_IOFRAC, FRAC); | 72 | __mxs_setl(30 << BP_FRAC_IOFRAC, FRAC); |
72 | } | 73 | } |
73 | 74 | ||
74 | static struct clk_lookup uart_lookups[] = { | ||
75 | { .dev_id = "duart", }, | ||
76 | { .dev_id = "mxs-auart.0", }, | ||
77 | { .dev_id = "mxs-auart.1", }, | ||
78 | { .dev_id = "8006c000.serial", }, | ||
79 | { .dev_id = "8006e000.serial", }, | ||
80 | { .dev_id = "80070000.serial", }, | ||
81 | }; | ||
82 | |||
83 | static struct clk_lookup hbus_lookups[] = { | ||
84 | { .dev_id = "imx23-dma-apbh", }, | ||
85 | { .dev_id = "80004000.dma-apbh", }, | ||
86 | }; | ||
87 | |||
88 | static struct clk_lookup xbus_lookups[] = { | ||
89 | { .dev_id = "duart", .con_id = "apb_pclk"}, | ||
90 | { .dev_id = "80070000.serial", .con_id = "apb_pclk"}, | ||
91 | { .dev_id = "imx23-dma-apbx", }, | ||
92 | { .dev_id = "80024000.dma-apbx", }, | ||
93 | }; | ||
94 | |||
95 | static struct clk_lookup ssp_lookups[] = { | ||
96 | { .dev_id = "imx23-mmc.0", }, | ||
97 | { .dev_id = "imx23-mmc.1", }, | ||
98 | { .dev_id = "80010000.ssp", }, | ||
99 | { .dev_id = "80034000.ssp", }, | ||
100 | }; | ||
101 | |||
102 | static struct clk_lookup lcdif_lookups[] = { | ||
103 | { .dev_id = "imx23-fb", }, | ||
104 | { .dev_id = "80030000.lcdif", }, | ||
105 | }; | ||
106 | |||
107 | static struct clk_lookup gpmi_lookups[] = { | ||
108 | { .dev_id = "imx23-gpmi-nand", }, | ||
109 | { .dev_id = "8000c000.gpmi-nand", }, | ||
110 | }; | ||
111 | |||
112 | static const char *sel_pll[] __initconst = { "pll", "ref_xtal", }; | 75 | static const char *sel_pll[] __initconst = { "pll", "ref_xtal", }; |
113 | static const char *sel_cpu[] __initconst = { "ref_cpu", "ref_xtal", }; | 76 | static const char *sel_cpu[] __initconst = { "ref_cpu", "ref_xtal", }; |
114 | static const char *sel_pix[] __initconst = { "ref_pix", "ref_xtal", }; | 77 | static const char *sel_pix[] __initconst = { "ref_pix", "ref_xtal", }; |
@@ -127,6 +90,7 @@ enum imx23_clk { | |||
127 | }; | 90 | }; |
128 | 91 | ||
129 | static struct clk *clks[clk_max]; | 92 | static struct clk *clks[clk_max]; |
93 | static struct clk_onecell_data clk_data; | ||
130 | 94 | ||
131 | static enum imx23_clk clks_init_on[] __initdata = { | 95 | static enum imx23_clk clks_init_on[] __initdata = { |
132 | cpu, hbus, xbus, emi, uart, | 96 | cpu, hbus, xbus, emi, uart, |
@@ -134,6 +98,7 @@ static enum imx23_clk clks_init_on[] __initdata = { | |||
134 | 98 | ||
135 | int __init mx23_clocks_init(void) | 99 | int __init mx23_clocks_init(void) |
136 | { | 100 | { |
101 | struct device_node *np; | ||
137 | int i; | 102 | int i; |
138 | 103 | ||
139 | clk_misc_init(); | 104 | clk_misc_init(); |
@@ -188,14 +153,14 @@ int __init mx23_clocks_init(void) | |||
188 | return PTR_ERR(clks[i]); | 153 | return PTR_ERR(clks[i]); |
189 | } | 154 | } |
190 | 155 | ||
156 | np = of_find_compatible_node(NULL, NULL, "fsl,imx23-clkctrl"); | ||
157 | if (np) { | ||
158 | clk_data.clks = clks; | ||
159 | clk_data.clk_num = ARRAY_SIZE(clks); | ||
160 | of_clk_add_provider(np, of_clk_src_onecell_get, &clk_data); | ||
161 | } | ||
162 | |||
191 | clk_register_clkdev(clks[clk32k], NULL, "timrot"); | 163 | clk_register_clkdev(clks[clk32k], NULL, "timrot"); |
192 | clk_register_clkdev(clks[pwm], NULL, "80064000.pwm"); | ||
193 | clk_register_clkdevs(clks[hbus], hbus_lookups, ARRAY_SIZE(hbus_lookups)); | ||
194 | clk_register_clkdevs(clks[xbus], xbus_lookups, ARRAY_SIZE(xbus_lookups)); | ||
195 | clk_register_clkdevs(clks[uart], uart_lookups, ARRAY_SIZE(uart_lookups)); | ||
196 | clk_register_clkdevs(clks[ssp], ssp_lookups, ARRAY_SIZE(ssp_lookups)); | ||
197 | clk_register_clkdevs(clks[gpmi], gpmi_lookups, ARRAY_SIZE(gpmi_lookups)); | ||
198 | clk_register_clkdevs(clks[lcdif], lcdif_lookups, ARRAY_SIZE(lcdif_lookups)); | ||
199 | 164 | ||
200 | for (i = 0; i < ARRAY_SIZE(clks_init_on); i++) | 165 | for (i = 0; i < ARRAY_SIZE(clks_init_on); i++) |
201 | clk_prepare_enable(clks[clks_init_on[i]]); | 166 | clk_prepare_enable(clks[clks_init_on[i]]); |
diff --git a/drivers/clk/mxs/clk-imx28.c b/drivers/clk/mxs/clk-imx28.c index e3aab67b3eb7..613e76f3758e 100644 --- a/drivers/clk/mxs/clk-imx28.c +++ b/drivers/clk/mxs/clk-imx28.c | |||
@@ -14,6 +14,7 @@ | |||
14 | #include <linux/err.h> | 14 | #include <linux/err.h> |
15 | #include <linux/init.h> | 15 | #include <linux/init.h> |
16 | #include <linux/io.h> | 16 | #include <linux/io.h> |
17 | #include <linux/of.h> | ||
17 | #include <mach/common.h> | 18 | #include <mach/common.h> |
18 | #include <mach/mx28.h> | 19 | #include <mach/mx28.h> |
19 | #include "clk.h" | 20 | #include "clk.h" |
@@ -120,90 +121,6 @@ static void __init clk_misc_init(void) | |||
120 | writel_relaxed(val, FRAC0); | 121 | writel_relaxed(val, FRAC0); |
121 | } | 122 | } |
122 | 123 | ||
123 | static struct clk_lookup uart_lookups[] = { | ||
124 | { .dev_id = "duart", }, | ||
125 | { .dev_id = "mxs-auart.0", }, | ||
126 | { .dev_id = "mxs-auart.1", }, | ||
127 | { .dev_id = "mxs-auart.2", }, | ||
128 | { .dev_id = "mxs-auart.3", }, | ||
129 | { .dev_id = "mxs-auart.4", }, | ||
130 | { .dev_id = "8006a000.serial", }, | ||
131 | { .dev_id = "8006c000.serial", }, | ||
132 | { .dev_id = "8006e000.serial", }, | ||
133 | { .dev_id = "80070000.serial", }, | ||
134 | { .dev_id = "80072000.serial", }, | ||
135 | { .dev_id = "80074000.serial", }, | ||
136 | }; | ||
137 | |||
138 | static struct clk_lookup hbus_lookups[] = { | ||
139 | { .dev_id = "imx28-dma-apbh", }, | ||
140 | { .dev_id = "80004000.dma-apbh", }, | ||
141 | }; | ||
142 | |||
143 | static struct clk_lookup xbus_lookups[] = { | ||
144 | { .dev_id = "duart", .con_id = "apb_pclk"}, | ||
145 | { .dev_id = "80074000.serial", .con_id = "apb_pclk"}, | ||
146 | { .dev_id = "imx28-dma-apbx", }, | ||
147 | { .dev_id = "80024000.dma-apbx", }, | ||
148 | }; | ||
149 | |||
150 | static struct clk_lookup ssp0_lookups[] = { | ||
151 | { .dev_id = "imx28-mmc.0", }, | ||
152 | { .dev_id = "80010000.ssp", }, | ||
153 | }; | ||
154 | |||
155 | static struct clk_lookup ssp1_lookups[] = { | ||
156 | { .dev_id = "imx28-mmc.1", }, | ||
157 | { .dev_id = "80012000.ssp", }, | ||
158 | }; | ||
159 | |||
160 | static struct clk_lookup ssp2_lookups[] = { | ||
161 | { .dev_id = "imx28-mmc.2", }, | ||
162 | { .dev_id = "80014000.ssp", }, | ||
163 | }; | ||
164 | |||
165 | static struct clk_lookup ssp3_lookups[] = { | ||
166 | { .dev_id = "imx28-mmc.3", }, | ||
167 | { .dev_id = "80016000.ssp", }, | ||
168 | }; | ||
169 | |||
170 | static struct clk_lookup lcdif_lookups[] = { | ||
171 | { .dev_id = "imx28-fb", }, | ||
172 | { .dev_id = "80030000.lcdif", }, | ||
173 | }; | ||
174 | |||
175 | static struct clk_lookup gpmi_lookups[] = { | ||
176 | { .dev_id = "imx28-gpmi-nand", }, | ||
177 | { .dev_id = "8000c000.gpmi-nand", }, | ||
178 | }; | ||
179 | |||
180 | static struct clk_lookup fec_lookups[] = { | ||
181 | { .dev_id = "imx28-fec.0", }, | ||
182 | { .dev_id = "imx28-fec.1", }, | ||
183 | { .dev_id = "800f0000.ethernet", }, | ||
184 | { .dev_id = "800f4000.ethernet", }, | ||
185 | }; | ||
186 | |||
187 | static struct clk_lookup can0_lookups[] = { | ||
188 | { .dev_id = "flexcan.0", }, | ||
189 | { .dev_id = "80032000.can", }, | ||
190 | }; | ||
191 | |||
192 | static struct clk_lookup can1_lookups[] = { | ||
193 | { .dev_id = "flexcan.1", }, | ||
194 | { .dev_id = "80034000.can", }, | ||
195 | }; | ||
196 | |||
197 | static struct clk_lookup saif0_lookups[] = { | ||
198 | { .dev_id = "mxs-saif.0", }, | ||
199 | { .dev_id = "80042000.saif", }, | ||
200 | }; | ||
201 | |||
202 | static struct clk_lookup saif1_lookups[] = { | ||
203 | { .dev_id = "mxs-saif.1", }, | ||
204 | { .dev_id = "80046000.saif", }, | ||
205 | }; | ||
206 | |||
207 | static const char *sel_cpu[] __initconst = { "ref_cpu", "ref_xtal", }; | 124 | static const char *sel_cpu[] __initconst = { "ref_cpu", "ref_xtal", }; |
208 | static const char *sel_io0[] __initconst = { "ref_io0", "ref_xtal", }; | 125 | static const char *sel_io0[] __initconst = { "ref_io0", "ref_xtal", }; |
209 | static const char *sel_io1[] __initconst = { "ref_io1", "ref_xtal", }; | 126 | static const char *sel_io1[] __initconst = { "ref_io1", "ref_xtal", }; |
@@ -228,6 +145,7 @@ enum imx28_clk { | |||
228 | }; | 145 | }; |
229 | 146 | ||
230 | static struct clk *clks[clk_max]; | 147 | static struct clk *clks[clk_max]; |
148 | static struct clk_onecell_data clk_data; | ||
231 | 149 | ||
232 | static enum imx28_clk clks_init_on[] __initdata = { | 150 | static enum imx28_clk clks_init_on[] __initdata = { |
233 | cpu, hbus, xbus, emi, uart, | 151 | cpu, hbus, xbus, emi, uart, |
@@ -235,6 +153,7 @@ static enum imx28_clk clks_init_on[] __initdata = { | |||
235 | 153 | ||
236 | int __init mx28_clocks_init(void) | 154 | int __init mx28_clocks_init(void) |
237 | { | 155 | { |
156 | struct device_node *np; | ||
238 | int i; | 157 | int i; |
239 | 158 | ||
240 | clk_misc_init(); | 159 | clk_misc_init(); |
@@ -312,27 +231,15 @@ int __init mx28_clocks_init(void) | |||
312 | return PTR_ERR(clks[i]); | 231 | return PTR_ERR(clks[i]); |
313 | } | 232 | } |
314 | 233 | ||
234 | np = of_find_compatible_node(NULL, NULL, "fsl,imx28-clkctrl"); | ||
235 | if (np) { | ||
236 | clk_data.clks = clks; | ||
237 | clk_data.clk_num = ARRAY_SIZE(clks); | ||
238 | of_clk_add_provider(np, of_clk_src_onecell_get, &clk_data); | ||
239 | } | ||
240 | |||
315 | clk_register_clkdev(clks[clk32k], NULL, "timrot"); | 241 | clk_register_clkdev(clks[clk32k], NULL, "timrot"); |
316 | clk_register_clkdev(clks[enet_out], NULL, "enet_out"); | 242 | clk_register_clkdev(clks[enet_out], NULL, "enet_out"); |
317 | clk_register_clkdev(clks[pwm], NULL, "80064000.pwm"); | ||
318 | clk_register_clkdevs(clks[hbus], hbus_lookups, ARRAY_SIZE(hbus_lookups)); | ||
319 | clk_register_clkdevs(clks[xbus], xbus_lookups, ARRAY_SIZE(xbus_lookups)); | ||
320 | clk_register_clkdevs(clks[uart], uart_lookups, ARRAY_SIZE(uart_lookups)); | ||
321 | clk_register_clkdevs(clks[ssp0], ssp0_lookups, ARRAY_SIZE(ssp0_lookups)); | ||
322 | clk_register_clkdevs(clks[ssp1], ssp1_lookups, ARRAY_SIZE(ssp1_lookups)); | ||
323 | clk_register_clkdevs(clks[ssp2], ssp2_lookups, ARRAY_SIZE(ssp2_lookups)); | ||
324 | clk_register_clkdevs(clks[ssp3], ssp3_lookups, ARRAY_SIZE(ssp3_lookups)); | ||
325 | clk_register_clkdevs(clks[gpmi], gpmi_lookups, ARRAY_SIZE(gpmi_lookups)); | ||
326 | clk_register_clkdevs(clks[saif0], saif0_lookups, ARRAY_SIZE(saif0_lookups)); | ||
327 | clk_register_clkdevs(clks[saif1], saif1_lookups, ARRAY_SIZE(saif1_lookups)); | ||
328 | clk_register_clkdevs(clks[lcdif], lcdif_lookups, ARRAY_SIZE(lcdif_lookups)); | ||
329 | clk_register_clkdevs(clks[fec], fec_lookups, ARRAY_SIZE(fec_lookups)); | ||
330 | clk_register_clkdevs(clks[can0], can0_lookups, ARRAY_SIZE(can0_lookups)); | ||
331 | clk_register_clkdevs(clks[can1], can1_lookups, ARRAY_SIZE(can1_lookups)); | ||
332 | clk_register_clkdev(clks[usb0_pwr], NULL, "8007c000.usbphy"); | ||
333 | clk_register_clkdev(clks[usb1_pwr], NULL, "8007e000.usbphy"); | ||
334 | clk_register_clkdev(clks[usb0], NULL, "80080000.usb"); | ||
335 | clk_register_clkdev(clks[usb1], NULL, "80090000.usb"); | ||
336 | 243 | ||
337 | for (i = 0; i < ARRAY_SIZE(clks_init_on); i++) | 244 | for (i = 0; i < ARRAY_SIZE(clks_init_on); i++) |
338 | clk_prepare_enable(clks[clks_init_on[i]]); | 245 | clk_prepare_enable(clks[clks_init_on[i]]); |
diff --git a/drivers/gpio/Kconfig b/drivers/gpio/Kconfig index ba7926f5c099..a00b828b1643 100644 --- a/drivers/gpio/Kconfig +++ b/drivers/gpio/Kconfig | |||
@@ -183,6 +183,12 @@ config GPIO_STA2X11 | |||
183 | Say yes here to support the STA2x11/ConneXt GPIO device. | 183 | Say yes here to support the STA2x11/ConneXt GPIO device. |
184 | The GPIO module has 128 GPIO pins with alternate functions. | 184 | The GPIO module has 128 GPIO pins with alternate functions. |
185 | 185 | ||
186 | config GPIO_VT8500 | ||
187 | bool "VIA/Wondermedia SoC GPIO Support" | ||
188 | depends on ARCH_VT8500 | ||
189 | help | ||
190 | Say yes here to support the VT8500/WM8505/WM8650 GPIO controller. | ||
191 | |||
186 | config GPIO_XILINX | 192 | config GPIO_XILINX |
187 | bool "Xilinx GPIO support" | 193 | bool "Xilinx GPIO support" |
188 | depends on PPC_OF || MICROBLAZE | 194 | depends on PPC_OF || MICROBLAZE |
diff --git a/drivers/gpio/Makefile b/drivers/gpio/Makefile index 153caceeb053..a288142ad998 100644 --- a/drivers/gpio/Makefile +++ b/drivers/gpio/Makefile | |||
@@ -69,6 +69,7 @@ obj-$(CONFIG_GPIO_TPS65912) += gpio-tps65912.o | |||
69 | obj-$(CONFIG_GPIO_TWL4030) += gpio-twl4030.o | 69 | obj-$(CONFIG_GPIO_TWL4030) += gpio-twl4030.o |
70 | obj-$(CONFIG_GPIO_UCB1400) += gpio-ucb1400.o | 70 | obj-$(CONFIG_GPIO_UCB1400) += gpio-ucb1400.o |
71 | obj-$(CONFIG_GPIO_VR41XX) += gpio-vr41xx.o | 71 | obj-$(CONFIG_GPIO_VR41XX) += gpio-vr41xx.o |
72 | obj-$(CONFIG_GPIO_VT8500) += gpio-vt8500.o | ||
72 | obj-$(CONFIG_GPIO_VX855) += gpio-vx855.o | 73 | obj-$(CONFIG_GPIO_VX855) += gpio-vx855.o |
73 | obj-$(CONFIG_GPIO_WM831X) += gpio-wm831x.o | 74 | obj-$(CONFIG_GPIO_WM831X) += gpio-wm831x.o |
74 | obj-$(CONFIG_GPIO_WM8350) += gpio-wm8350.o | 75 | obj-$(CONFIG_GPIO_WM8350) += gpio-wm8350.o |
diff --git a/drivers/gpio/gpio-pxa.c b/drivers/gpio/gpio-pxa.c index 9cac88a65f78..9528779ca463 100644 --- a/drivers/gpio/gpio-pxa.c +++ b/drivers/gpio/gpio-pxa.c | |||
@@ -26,6 +26,8 @@ | |||
26 | #include <linux/syscore_ops.h> | 26 | #include <linux/syscore_ops.h> |
27 | #include <linux/slab.h> | 27 | #include <linux/slab.h> |
28 | 28 | ||
29 | #include <asm/mach/irq.h> | ||
30 | |||
29 | #include <mach/irqs.h> | 31 | #include <mach/irqs.h> |
30 | 32 | ||
31 | /* | 33 | /* |
@@ -59,6 +61,7 @@ | |||
59 | #define BANK_OFF(n) (((n) < 3) ? (n) << 2 : 0x100 + (((n) - 3) << 2)) | 61 | #define BANK_OFF(n) (((n) < 3) ? (n) << 2 : 0x100 + (((n) - 3) << 2)) |
60 | 62 | ||
61 | int pxa_last_gpio; | 63 | int pxa_last_gpio; |
64 | static int irq_base; | ||
62 | 65 | ||
63 | #ifdef CONFIG_OF | 66 | #ifdef CONFIG_OF |
64 | static struct irq_domain *domain; | 67 | static struct irq_domain *domain; |
@@ -167,63 +170,14 @@ static inline int __gpio_is_occupied(unsigned gpio) | |||
167 | return ret; | 170 | return ret; |
168 | } | 171 | } |
169 | 172 | ||
170 | #ifdef CONFIG_ARCH_PXA | ||
171 | static inline int __pxa_gpio_to_irq(int gpio) | ||
172 | { | ||
173 | if (gpio_is_pxa_type(gpio_type)) | ||
174 | return PXA_GPIO_TO_IRQ(gpio); | ||
175 | return -1; | ||
176 | } | ||
177 | |||
178 | static inline int __pxa_irq_to_gpio(int irq) | ||
179 | { | ||
180 | if (gpio_is_pxa_type(gpio_type)) | ||
181 | return irq - PXA_GPIO_TO_IRQ(0); | ||
182 | return -1; | ||
183 | } | ||
184 | #else | ||
185 | static inline int __pxa_gpio_to_irq(int gpio) { return -1; } | ||
186 | static inline int __pxa_irq_to_gpio(int irq) { return -1; } | ||
187 | #endif | ||
188 | |||
189 | #ifdef CONFIG_ARCH_MMP | ||
190 | static inline int __mmp_gpio_to_irq(int gpio) | ||
191 | { | ||
192 | if (gpio_is_mmp_type(gpio_type)) | ||
193 | return MMP_GPIO_TO_IRQ(gpio); | ||
194 | return -1; | ||
195 | } | ||
196 | |||
197 | static inline int __mmp_irq_to_gpio(int irq) | ||
198 | { | ||
199 | if (gpio_is_mmp_type(gpio_type)) | ||
200 | return irq - MMP_GPIO_TO_IRQ(0); | ||
201 | return -1; | ||
202 | } | ||
203 | #else | ||
204 | static inline int __mmp_gpio_to_irq(int gpio) { return -1; } | ||
205 | static inline int __mmp_irq_to_gpio(int irq) { return -1; } | ||
206 | #endif | ||
207 | |||
208 | static int pxa_gpio_to_irq(struct gpio_chip *chip, unsigned offset) | 173 | static int pxa_gpio_to_irq(struct gpio_chip *chip, unsigned offset) |
209 | { | 174 | { |
210 | int gpio, ret; | 175 | return chip->base + offset + irq_base; |
211 | |||
212 | gpio = chip->base + offset; | ||
213 | ret = __pxa_gpio_to_irq(gpio); | ||
214 | if (ret >= 0) | ||
215 | return ret; | ||
216 | return __mmp_gpio_to_irq(gpio); | ||
217 | } | 176 | } |
218 | 177 | ||
219 | int pxa_irq_to_gpio(int irq) | 178 | int pxa_irq_to_gpio(int irq) |
220 | { | 179 | { |
221 | int ret; | 180 | return irq - irq_base; |
222 | |||
223 | ret = __pxa_irq_to_gpio(irq); | ||
224 | if (ret >= 0) | ||
225 | return ret; | ||
226 | return __mmp_irq_to_gpio(irq); | ||
227 | } | 181 | } |
228 | 182 | ||
229 | static int pxa_gpio_direction_input(struct gpio_chip *chip, unsigned offset) | 183 | static int pxa_gpio_direction_input(struct gpio_chip *chip, unsigned offset) |
@@ -403,6 +357,9 @@ static void pxa_gpio_demux_handler(unsigned int irq, struct irq_desc *desc) | |||
403 | struct pxa_gpio_chip *c; | 357 | struct pxa_gpio_chip *c; |
404 | int loop, gpio, gpio_base, n; | 358 | int loop, gpio, gpio_base, n; |
405 | unsigned long gedr; | 359 | unsigned long gedr; |
360 | struct irq_chip *chip = irq_desc_get_chip(desc); | ||
361 | |||
362 | chained_irq_enter(chip, desc); | ||
406 | 363 | ||
407 | do { | 364 | do { |
408 | loop = 0; | 365 | loop = 0; |
@@ -422,6 +379,8 @@ static void pxa_gpio_demux_handler(unsigned int irq, struct irq_desc *desc) | |||
422 | } | 379 | } |
423 | } | 380 | } |
424 | } while (loop); | 381 | } while (loop); |
382 | |||
383 | chained_irq_exit(chip, desc); | ||
425 | } | 384 | } |
426 | 385 | ||
427 | static void pxa_ack_muxed_gpio(struct irq_data *d) | 386 | static void pxa_ack_muxed_gpio(struct irq_data *d) |
@@ -535,7 +494,7 @@ const struct irq_domain_ops pxa_irq_domain_ops = { | |||
535 | 494 | ||
536 | static int __devinit pxa_gpio_probe_dt(struct platform_device *pdev) | 495 | static int __devinit pxa_gpio_probe_dt(struct platform_device *pdev) |
537 | { | 496 | { |
538 | int ret, nr_banks, nr_gpios, irq_base; | 497 | int ret, nr_banks, nr_gpios; |
539 | struct device_node *prev, *next, *np = pdev->dev.of_node; | 498 | struct device_node *prev, *next, *np = pdev->dev.of_node; |
540 | const struct of_device_id *of_id = | 499 | const struct of_device_id *of_id = |
541 | of_match_device(pxa_gpio_dt_ids, &pdev->dev); | 500 | of_match_device(pxa_gpio_dt_ids, &pdev->dev); |
@@ -590,10 +549,20 @@ static int __devinit pxa_gpio_probe(struct platform_device *pdev) | |||
590 | int irq0 = 0, irq1 = 0, irq_mux, gpio_offset = 0; | 549 | int irq0 = 0, irq1 = 0, irq_mux, gpio_offset = 0; |
591 | 550 | ||
592 | ret = pxa_gpio_probe_dt(pdev); | 551 | ret = pxa_gpio_probe_dt(pdev); |
593 | if (ret < 0) | 552 | if (ret < 0) { |
594 | pxa_last_gpio = pxa_gpio_nums(); | 553 | pxa_last_gpio = pxa_gpio_nums(); |
595 | else | 554 | #ifdef CONFIG_ARCH_PXA |
555 | if (gpio_is_pxa_type(gpio_type)) | ||
556 | irq_base = PXA_GPIO_TO_IRQ(0); | ||
557 | #endif | ||
558 | #ifdef CONFIG_ARCH_MMP | ||
559 | if (gpio_is_mmp_type(gpio_type)) | ||
560 | irq_base = MMP_GPIO_TO_IRQ(0); | ||
561 | #endif | ||
562 | } else { | ||
596 | use_of = 1; | 563 | use_of = 1; |
564 | } | ||
565 | |||
597 | if (!pxa_last_gpio) | 566 | if (!pxa_last_gpio) |
598 | return -EINVAL; | 567 | return -EINVAL; |
599 | 568 | ||
diff --git a/drivers/gpio/gpio-samsung.c b/drivers/gpio/gpio-samsung.c index 1c169324e357..8af4b06e80f7 100644 --- a/drivers/gpio/gpio-samsung.c +++ b/drivers/gpio/gpio-samsung.c | |||
@@ -938,6 +938,67 @@ static void __init samsung_gpiolib_add(struct samsung_gpio_chip *chip) | |||
938 | s3c_gpiolib_track(chip); | 938 | s3c_gpiolib_track(chip); |
939 | } | 939 | } |
940 | 940 | ||
941 | #if defined(CONFIG_PLAT_S3C24XX) && defined(CONFIG_OF) | ||
942 | static int s3c24xx_gpio_xlate(struct gpio_chip *gc, | ||
943 | const struct of_phandle_args *gpiospec, u32 *flags) | ||
944 | { | ||
945 | unsigned int pin; | ||
946 | |||
947 | if (WARN_ON(gc->of_gpio_n_cells < 3)) | ||
948 | return -EINVAL; | ||
949 | |||
950 | if (WARN_ON(gpiospec->args_count < gc->of_gpio_n_cells)) | ||
951 | return -EINVAL; | ||
952 | |||
953 | if (gpiospec->args[0] > gc->ngpio) | ||
954 | return -EINVAL; | ||
955 | |||
956 | pin = gc->base + gpiospec->args[0]; | ||
957 | |||
958 | if (s3c_gpio_cfgpin(pin, S3C_GPIO_SFN(gpiospec->args[1]))) | ||
959 | pr_warn("gpio_xlate: failed to set pin function\n"); | ||
960 | if (s3c_gpio_setpull(pin, gpiospec->args[2] & 0xffff)) | ||
961 | pr_warn("gpio_xlate: failed to set pin pull up/down\n"); | ||
962 | |||
963 | if (flags) | ||
964 | *flags = gpiospec->args[2] >> 16; | ||
965 | |||
966 | return gpiospec->args[0]; | ||
967 | } | ||
968 | |||
969 | static const struct of_device_id s3c24xx_gpio_dt_match[] __initdata = { | ||
970 | { .compatible = "samsung,s3c24xx-gpio", }, | ||
971 | {} | ||
972 | }; | ||
973 | |||
974 | static __init void s3c24xx_gpiolib_attach_ofnode(struct samsung_gpio_chip *chip, | ||
975 | u64 base, u64 offset) | ||
976 | { | ||
977 | struct gpio_chip *gc = &chip->chip; | ||
978 | u64 address; | ||
979 | |||
980 | if (!of_have_populated_dt()) | ||
981 | return; | ||
982 | |||
983 | address = chip->base ? base + ((u32)chip->base & 0xfff) : base + offset; | ||
984 | gc->of_node = of_find_matching_node_by_address(NULL, | ||
985 | s3c24xx_gpio_dt_match, address); | ||
986 | if (!gc->of_node) { | ||
987 | pr_info("gpio: device tree node not found for gpio controller" | ||
988 | " with base address %08llx\n", address); | ||
989 | return; | ||
990 | } | ||
991 | gc->of_gpio_n_cells = 3; | ||
992 | gc->of_xlate = s3c24xx_gpio_xlate; | ||
993 | } | ||
994 | #else | ||
995 | static __init void s3c24xx_gpiolib_attach_ofnode(struct samsung_gpio_chip *chip, | ||
996 | u64 base, u64 offset) | ||
997 | { | ||
998 | return; | ||
999 | } | ||
1000 | #endif /* defined(CONFIG_PLAT_S3C24XX) && defined(CONFIG_OF) */ | ||
1001 | |||
941 | static void __init s3c24xx_gpiolib_add_chips(struct samsung_gpio_chip *chip, | 1002 | static void __init s3c24xx_gpiolib_add_chips(struct samsung_gpio_chip *chip, |
942 | int nr_chips, void __iomem *base) | 1003 | int nr_chips, void __iomem *base) |
943 | { | 1004 | { |
@@ -962,6 +1023,8 @@ static void __init s3c24xx_gpiolib_add_chips(struct samsung_gpio_chip *chip, | |||
962 | gc->direction_output = samsung_gpiolib_2bit_output; | 1023 | gc->direction_output = samsung_gpiolib_2bit_output; |
963 | 1024 | ||
964 | samsung_gpiolib_add(chip); | 1025 | samsung_gpiolib_add(chip); |
1026 | |||
1027 | s3c24xx_gpiolib_attach_ofnode(chip, S3C24XX_PA_GPIO, i * 0x10); | ||
965 | } | 1028 | } |
966 | } | 1029 | } |
967 | 1030 | ||
diff --git a/drivers/gpio/gpio-twl4030.c b/drivers/gpio/gpio-twl4030.c index f030880bc9bb..c5f8ca233e1f 100644 --- a/drivers/gpio/gpio-twl4030.c +++ b/drivers/gpio/gpio-twl4030.c | |||
@@ -396,6 +396,29 @@ static int __devinit gpio_twl4030_debounce(u32 debounce, u8 mmc_cd) | |||
396 | 396 | ||
397 | static int gpio_twl4030_remove(struct platform_device *pdev); | 397 | static int gpio_twl4030_remove(struct platform_device *pdev); |
398 | 398 | ||
399 | static struct twl4030_gpio_platform_data *of_gpio_twl4030(struct device *dev) | ||
400 | { | ||
401 | struct twl4030_gpio_platform_data *omap_twl_info; | ||
402 | |||
403 | omap_twl_info = devm_kzalloc(dev, sizeof(*omap_twl_info), GFP_KERNEL); | ||
404 | if (!omap_twl_info) | ||
405 | return NULL; | ||
406 | |||
407 | omap_twl_info->use_leds = of_property_read_bool(dev->of_node, | ||
408 | "ti,use-leds"); | ||
409 | |||
410 | of_property_read_u32(dev->of_node, "ti,debounce", | ||
411 | &omap_twl_info->debounce); | ||
412 | of_property_read_u32(dev->of_node, "ti,mmc-cd", | ||
413 | (u32 *)&omap_twl_info->mmc_cd); | ||
414 | of_property_read_u32(dev->of_node, "ti,pullups", | ||
415 | &omap_twl_info->pullups); | ||
416 | of_property_read_u32(dev->of_node, "ti,pulldowns", | ||
417 | &omap_twl_info->pulldowns); | ||
418 | |||
419 | return omap_twl_info; | ||
420 | } | ||
421 | |||
399 | static int __devinit gpio_twl4030_probe(struct platform_device *pdev) | 422 | static int __devinit gpio_twl4030_probe(struct platform_device *pdev) |
400 | { | 423 | { |
401 | struct twl4030_gpio_platform_data *pdata = pdev->dev.platform_data; | 424 | struct twl4030_gpio_platform_data *pdata = pdev->dev.platform_data; |
@@ -428,33 +451,37 @@ no_irqs: | |||
428 | twl_gpiochip.ngpio = TWL4030_GPIO_MAX; | 451 | twl_gpiochip.ngpio = TWL4030_GPIO_MAX; |
429 | twl_gpiochip.dev = &pdev->dev; | 452 | twl_gpiochip.dev = &pdev->dev; |
430 | 453 | ||
431 | if (pdata) { | 454 | if (node) |
432 | /* | 455 | pdata = of_gpio_twl4030(&pdev->dev); |
433 | * NOTE: boards may waste power if they don't set pullups | 456 | |
434 | * and pulldowns correctly ... default for non-ULPI pins is | 457 | if (pdata == NULL) { |
435 | * pulldown, and some other pins may have external pullups | 458 | dev_err(&pdev->dev, "Platform data is missing\n"); |
436 | * or pulldowns. Careful! | 459 | return -ENXIO; |
437 | */ | ||
438 | ret = gpio_twl4030_pulls(pdata->pullups, pdata->pulldowns); | ||
439 | if (ret) | ||
440 | dev_dbg(&pdev->dev, "pullups %.05x %.05x --> %d\n", | ||
441 | pdata->pullups, pdata->pulldowns, | ||
442 | ret); | ||
443 | |||
444 | ret = gpio_twl4030_debounce(pdata->debounce, pdata->mmc_cd); | ||
445 | if (ret) | ||
446 | dev_dbg(&pdev->dev, "debounce %.03x %.01x --> %d\n", | ||
447 | pdata->debounce, pdata->mmc_cd, | ||
448 | ret); | ||
449 | |||
450 | /* | ||
451 | * NOTE: we assume VIBRA_CTL.VIBRA_EN, in MODULE_AUDIO_VOICE, | ||
452 | * is (still) clear if use_leds is set. | ||
453 | */ | ||
454 | if (pdata->use_leds) | ||
455 | twl_gpiochip.ngpio += 2; | ||
456 | } | 460 | } |
457 | 461 | ||
462 | /* | ||
463 | * NOTE: boards may waste power if they don't set pullups | ||
464 | * and pulldowns correctly ... default for non-ULPI pins is | ||
465 | * pulldown, and some other pins may have external pullups | ||
466 | * or pulldowns. Careful! | ||
467 | */ | ||
468 | ret = gpio_twl4030_pulls(pdata->pullups, pdata->pulldowns); | ||
469 | if (ret) | ||
470 | dev_dbg(&pdev->dev, "pullups %.05x %.05x --> %d\n", | ||
471 | pdata->pullups, pdata->pulldowns, ret); | ||
472 | |||
473 | ret = gpio_twl4030_debounce(pdata->debounce, pdata->mmc_cd); | ||
474 | if (ret) | ||
475 | dev_dbg(&pdev->dev, "debounce %.03x %.01x --> %d\n", | ||
476 | pdata->debounce, pdata->mmc_cd, ret); | ||
477 | |||
478 | /* | ||
479 | * NOTE: we assume VIBRA_CTL.VIBRA_EN, in MODULE_AUDIO_VOICE, | ||
480 | * is (still) clear if use_leds is set. | ||
481 | */ | ||
482 | if (pdata->use_leds) | ||
483 | twl_gpiochip.ngpio += 2; | ||
484 | |||
458 | ret = gpiochip_add(&twl_gpiochip); | 485 | ret = gpiochip_add(&twl_gpiochip); |
459 | if (ret < 0) { | 486 | if (ret < 0) { |
460 | dev_err(&pdev->dev, "could not register gpiochip, %d\n", ret); | 487 | dev_err(&pdev->dev, "could not register gpiochip, %d\n", ret); |
diff --git a/drivers/gpio/gpio-vt8500.c b/drivers/gpio/gpio-vt8500.c new file mode 100644 index 000000000000..bcd8e4aa7c7d --- /dev/null +++ b/drivers/gpio/gpio-vt8500.c | |||
@@ -0,0 +1,316 @@ | |||
1 | /* drivers/gpio/gpio-vt8500.c | ||
2 | * | ||
3 | * Copyright (C) 2012 Tony Prisk <linux@prisktech.co.nz> | ||
4 | * Based on arch/arm/mach-vt8500/gpio.c: | ||
5 | * - Copyright (C) 2010 Alexey Charkov <alchark@gmail.com> | ||
6 | * | ||
7 | * This software is licensed under the terms of the GNU General Public | ||
8 | * License version 2, as published by the Free Software Foundation, and | ||
9 | * may be copied, distributed, and modified under those terms. | ||
10 | * | ||
11 | * This program is distributed in the hope that it will be useful, | ||
12 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
13 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | ||
14 | * GNU General Public License for more details. | ||
15 | * | ||
16 | */ | ||
17 | |||
18 | #include <linux/module.h> | ||
19 | #include <linux/err.h> | ||
20 | #include <linux/io.h> | ||
21 | #include <linux/gpio.h> | ||
22 | #include <linux/platform_device.h> | ||
23 | #include <linux/bitops.h> | ||
24 | #include <linux/of.h> | ||
25 | #include <linux/of_address.h> | ||
26 | #include <linux/of_irq.h> | ||
27 | #include <linux/of_device.h> | ||
28 | |||
29 | /* | ||
30 | We handle GPIOs by bank, each bank containing up to 32 GPIOs covered | ||
31 | by one set of registers (although not all may be valid). | ||
32 | |||
33 | Because different SoC's have different register offsets, we pass the | ||
34 | register offsets as data in vt8500_gpio_dt_ids[]. | ||
35 | |||
36 | A value of NO_REG is used to indicate that this register is not | ||
37 | supported. Only used for ->en at the moment. | ||
38 | */ | ||
39 | |||
40 | #define NO_REG 0xFFFF | ||
41 | |||
42 | /* | ||
43 | * struct vt8500_gpio_bank_regoffsets | ||
44 | * @en: offset to enable register of the bank | ||
45 | * @dir: offset to direction register of the bank | ||
46 | * @data_out: offset to the data out register of the bank | ||
47 | * @data_in: offset to the data in register of the bank | ||
48 | * @ngpio: highest valid pin in this bank | ||
49 | */ | ||
50 | |||
51 | struct vt8500_gpio_bank_regoffsets { | ||
52 | unsigned int en; | ||
53 | unsigned int dir; | ||
54 | unsigned int data_out; | ||
55 | unsigned int data_in; | ||
56 | unsigned char ngpio; | ||
57 | }; | ||
58 | |||
59 | struct vt8500_gpio_data { | ||
60 | unsigned int num_banks; | ||
61 | struct vt8500_gpio_bank_regoffsets banks[]; | ||
62 | }; | ||
63 | |||
64 | #define VT8500_BANK(__en, __dir, __out, __in, __ngpio) \ | ||
65 | { \ | ||
66 | .en = __en, \ | ||
67 | .dir = __dir, \ | ||
68 | .data_out = __out, \ | ||
69 | .data_in = __in, \ | ||
70 | .ngpio = __ngpio, \ | ||
71 | } | ||
72 | |||
73 | static struct vt8500_gpio_data vt8500_data = { | ||
74 | .num_banks = 7, | ||
75 | .banks = { | ||
76 | VT8500_BANK(0x00, 0x20, 0x40, 0x60, 26), | ||
77 | VT8500_BANK(0x04, 0x24, 0x44, 0x64, 28), | ||
78 | VT8500_BANK(0x08, 0x28, 0x48, 0x68, 31), | ||
79 | VT8500_BANK(0x0C, 0x2C, 0x4C, 0x6C, 19), | ||
80 | VT8500_BANK(0x10, 0x30, 0x50, 0x70, 19), | ||
81 | VT8500_BANK(0x14, 0x34, 0x54, 0x74, 23), | ||
82 | VT8500_BANK(NO_REG, 0x3C, 0x5C, 0x7C, 9), | ||
83 | }, | ||
84 | }; | ||
85 | |||
86 | static struct vt8500_gpio_data wm8505_data = { | ||
87 | .num_banks = 10, | ||
88 | .banks = { | ||
89 | VT8500_BANK(0x40, 0x68, 0x90, 0xB8, 8), | ||
90 | VT8500_BANK(0x44, 0x6C, 0x94, 0xBC, 32), | ||
91 | VT8500_BANK(0x48, 0x70, 0x98, 0xC0, 6), | ||
92 | VT8500_BANK(0x4C, 0x74, 0x9C, 0xC4, 16), | ||
93 | VT8500_BANK(0x50, 0x78, 0xA0, 0xC8, 25), | ||
94 | VT8500_BANK(0x54, 0x7C, 0xA4, 0xCC, 5), | ||
95 | VT8500_BANK(0x58, 0x80, 0xA8, 0xD0, 5), | ||
96 | VT8500_BANK(0x5C, 0x84, 0xAC, 0xD4, 12), | ||
97 | VT8500_BANK(0x60, 0x88, 0xB0, 0xD8, 16), | ||
98 | VT8500_BANK(0x64, 0x8C, 0xB4, 0xDC, 22), | ||
99 | }, | ||
100 | }; | ||
101 | |||
102 | /* | ||
103 | * No information about which bits are valid so we just make | ||
104 | * them all available until its figured out. | ||
105 | */ | ||
106 | static struct vt8500_gpio_data wm8650_data = { | ||
107 | .num_banks = 9, | ||
108 | .banks = { | ||
109 | VT8500_BANK(0x40, 0x80, 0xC0, 0x00, 32), | ||
110 | VT8500_BANK(0x44, 0x84, 0xC4, 0x04, 32), | ||
111 | VT8500_BANK(0x48, 0x88, 0xC8, 0x08, 32), | ||
112 | VT8500_BANK(0x4C, 0x8C, 0xCC, 0x0C, 32), | ||
113 | VT8500_BANK(0x50, 0x90, 0xD0, 0x10, 32), | ||
114 | VT8500_BANK(0x54, 0x94, 0xD4, 0x14, 32), | ||
115 | VT8500_BANK(0x58, 0x98, 0xD8, 0x18, 32), | ||
116 | VT8500_BANK(0x5C, 0x9C, 0xDC, 0x1C, 32), | ||
117 | VT8500_BANK(0x7C, 0xBC, 0xFC, 0x3C, 32), | ||
118 | }, | ||
119 | }; | ||
120 | |||
121 | struct vt8500_gpio_chip { | ||
122 | struct gpio_chip chip; | ||
123 | |||
124 | const struct vt8500_gpio_bank_regoffsets *regs; | ||
125 | void __iomem *base; | ||
126 | }; | ||
127 | |||
128 | |||
129 | #define to_vt8500(__chip) container_of(__chip, struct vt8500_gpio_chip, chip) | ||
130 | |||
131 | static int vt8500_gpio_request(struct gpio_chip *chip, unsigned offset) | ||
132 | { | ||
133 | u32 val; | ||
134 | struct vt8500_gpio_chip *vt8500_chip = to_vt8500(chip); | ||
135 | |||
136 | if (vt8500_chip->regs->en == NO_REG) | ||
137 | return 0; | ||
138 | |||
139 | val = readl_relaxed(vt8500_chip->base + vt8500_chip->regs->en); | ||
140 | val |= BIT(offset); | ||
141 | writel_relaxed(val, vt8500_chip->base + vt8500_chip->regs->en); | ||
142 | |||
143 | return 0; | ||
144 | } | ||
145 | |||
146 | static void vt8500_gpio_free(struct gpio_chip *chip, unsigned offset) | ||
147 | { | ||
148 | struct vt8500_gpio_chip *vt8500_chip = to_vt8500(chip); | ||
149 | u32 val; | ||
150 | |||
151 | if (vt8500_chip->regs->en == NO_REG) | ||
152 | return; | ||
153 | |||
154 | val = readl_relaxed(vt8500_chip->base + vt8500_chip->regs->en); | ||
155 | val &= ~BIT(offset); | ||
156 | writel_relaxed(val, vt8500_chip->base + vt8500_chip->regs->en); | ||
157 | } | ||
158 | |||
159 | static int vt8500_gpio_direction_input(struct gpio_chip *chip, unsigned offset) | ||
160 | { | ||
161 | struct vt8500_gpio_chip *vt8500_chip = to_vt8500(chip); | ||
162 | |||
163 | u32 val = readl_relaxed(vt8500_chip->base + vt8500_chip->regs->dir); | ||
164 | val &= ~BIT(offset); | ||
165 | writel_relaxed(val, vt8500_chip->base + vt8500_chip->regs->dir); | ||
166 | |||
167 | return 0; | ||
168 | } | ||
169 | |||
170 | static int vt8500_gpio_direction_output(struct gpio_chip *chip, unsigned offset, | ||
171 | int value) | ||
172 | { | ||
173 | struct vt8500_gpio_chip *vt8500_chip = to_vt8500(chip); | ||
174 | |||
175 | u32 val = readl_relaxed(vt8500_chip->base + vt8500_chip->regs->dir); | ||
176 | val |= BIT(offset); | ||
177 | writel_relaxed(val, vt8500_chip->base + vt8500_chip->regs->dir); | ||
178 | |||
179 | if (value) { | ||
180 | val = readl_relaxed(vt8500_chip->base + | ||
181 | vt8500_chip->regs->data_out); | ||
182 | val |= BIT(offset); | ||
183 | writel_relaxed(val, vt8500_chip->base + | ||
184 | vt8500_chip->regs->data_out); | ||
185 | } | ||
186 | return 0; | ||
187 | } | ||
188 | |||
189 | static int vt8500_gpio_get_value(struct gpio_chip *chip, unsigned offset) | ||
190 | { | ||
191 | struct vt8500_gpio_chip *vt8500_chip = to_vt8500(chip); | ||
192 | |||
193 | return (readl_relaxed(vt8500_chip->base + vt8500_chip->regs->data_in) >> | ||
194 | offset) & 1; | ||
195 | } | ||
196 | |||
197 | static void vt8500_gpio_set_value(struct gpio_chip *chip, unsigned offset, | ||
198 | int value) | ||
199 | { | ||
200 | struct vt8500_gpio_chip *vt8500_chip = to_vt8500(chip); | ||
201 | |||
202 | u32 val = readl_relaxed(vt8500_chip->base + | ||
203 | vt8500_chip->regs->data_out); | ||
204 | if (value) | ||
205 | val |= BIT(offset); | ||
206 | else | ||
207 | val &= ~BIT(offset); | ||
208 | |||
209 | writel_relaxed(val, vt8500_chip->base + vt8500_chip->regs->data_out); | ||
210 | } | ||
211 | |||
212 | static int vt8500_of_xlate(struct gpio_chip *gc, | ||
213 | const struct of_phandle_args *gpiospec, u32 *flags) | ||
214 | { | ||
215 | /* bank if specificed in gpiospec->args[0] */ | ||
216 | if (flags) | ||
217 | *flags = gpiospec->args[2]; | ||
218 | |||
219 | return gpiospec->args[1]; | ||
220 | } | ||
221 | |||
222 | static int vt8500_add_chips(struct platform_device *pdev, void __iomem *base, | ||
223 | const struct vt8500_gpio_data *data) | ||
224 | { | ||
225 | struct vt8500_gpio_chip *vtchip; | ||
226 | struct gpio_chip *chip; | ||
227 | int i; | ||
228 | int pin_cnt = 0; | ||
229 | |||
230 | vtchip = devm_kzalloc(&pdev->dev, | ||
231 | sizeof(struct vt8500_gpio_chip) * data->num_banks, | ||
232 | GFP_KERNEL); | ||
233 | if (!vtchip) { | ||
234 | pr_err("%s: failed to allocate chip memory\n", __func__); | ||
235 | return -ENOMEM; | ||
236 | } | ||
237 | |||
238 | for (i = 0; i < data->num_banks; i++) { | ||
239 | vtchip[i].base = base; | ||
240 | vtchip[i].regs = &data->banks[i]; | ||
241 | |||
242 | chip = &vtchip[i].chip; | ||
243 | |||
244 | chip->of_xlate = vt8500_of_xlate; | ||
245 | chip->of_gpio_n_cells = 3; | ||
246 | chip->of_node = pdev->dev.of_node; | ||
247 | |||
248 | chip->request = vt8500_gpio_request; | ||
249 | chip->free = vt8500_gpio_free; | ||
250 | chip->direction_input = vt8500_gpio_direction_input; | ||
251 | chip->direction_output = vt8500_gpio_direction_output; | ||
252 | chip->get = vt8500_gpio_get_value; | ||
253 | chip->set = vt8500_gpio_set_value; | ||
254 | chip->can_sleep = 0; | ||
255 | chip->base = pin_cnt; | ||
256 | chip->ngpio = data->banks[i].ngpio; | ||
257 | |||
258 | pin_cnt += data->banks[i].ngpio; | ||
259 | |||
260 | gpiochip_add(chip); | ||
261 | } | ||
262 | return 0; | ||
263 | } | ||
264 | |||
265 | static struct of_device_id vt8500_gpio_dt_ids[] = { | ||
266 | { .compatible = "via,vt8500-gpio", .data = &vt8500_data, }, | ||
267 | { .compatible = "wm,wm8505-gpio", .data = &wm8505_data, }, | ||
268 | { .compatible = "wm,wm8650-gpio", .data = &wm8650_data, }, | ||
269 | { /* Sentinel */ }, | ||
270 | }; | ||
271 | |||
272 | static int __devinit vt8500_gpio_probe(struct platform_device *pdev) | ||
273 | { | ||
274 | void __iomem *gpio_base; | ||
275 | struct device_node *np; | ||
276 | const struct of_device_id *of_id = | ||
277 | of_match_device(vt8500_gpio_dt_ids, &pdev->dev); | ||
278 | |||
279 | if (!of_id) { | ||
280 | dev_err(&pdev->dev, "Failed to find gpio controller\n"); | ||
281 | return -ENODEV; | ||
282 | } | ||
283 | |||
284 | np = pdev->dev.of_node; | ||
285 | if (!np) { | ||
286 | dev_err(&pdev->dev, "Missing GPIO description in devicetree\n"); | ||
287 | return -EFAULT; | ||
288 | } | ||
289 | |||
290 | gpio_base = of_iomap(np, 0); | ||
291 | if (!gpio_base) { | ||
292 | dev_err(&pdev->dev, "Unable to map GPIO registers\n"); | ||
293 | of_node_put(np); | ||
294 | return -ENOMEM; | ||
295 | } | ||
296 | |||
297 | vt8500_add_chips(pdev, gpio_base, of_id->data); | ||
298 | |||
299 | return 0; | ||
300 | } | ||
301 | |||
302 | static struct platform_driver vt8500_gpio_driver = { | ||
303 | .probe = vt8500_gpio_probe, | ||
304 | .driver = { | ||
305 | .name = "vt8500-gpio", | ||
306 | .owner = THIS_MODULE, | ||
307 | .of_match_table = vt8500_gpio_dt_ids, | ||
308 | }, | ||
309 | }; | ||
310 | |||
311 | module_platform_driver(vt8500_gpio_driver); | ||
312 | |||
313 | MODULE_DESCRIPTION("VT8500 GPIO Driver"); | ||
314 | MODULE_AUTHOR("Tony Prisk <linux@prisktech.co.nz>"); | ||
315 | MODULE_LICENSE("GPL v2"); | ||
316 | MODULE_DEVICE_TABLE(of, vt8500_gpio_dt_ids); | ||
diff --git a/drivers/mtd/nand/pxa3xx_nand.c b/drivers/mtd/nand/pxa3xx_nand.c index 252aaefcacfa..d944d6ef7da8 100644 --- a/drivers/mtd/nand/pxa3xx_nand.c +++ b/drivers/mtd/nand/pxa3xx_nand.c | |||
@@ -22,6 +22,8 @@ | |||
22 | #include <linux/io.h> | 22 | #include <linux/io.h> |
23 | #include <linux/irq.h> | 23 | #include <linux/irq.h> |
24 | #include <linux/slab.h> | 24 | #include <linux/slab.h> |
25 | #include <linux/of.h> | ||
26 | #include <linux/of_device.h> | ||
25 | 27 | ||
26 | #include <mach/dma.h> | 28 | #include <mach/dma.h> |
27 | #include <plat/pxa3xx_nand.h> | 29 | #include <plat/pxa3xx_nand.h> |
@@ -1032,7 +1034,7 @@ static int alloc_nand_resource(struct platform_device *pdev) | |||
1032 | struct pxa3xx_nand_platform_data *pdata; | 1034 | struct pxa3xx_nand_platform_data *pdata; |
1033 | struct pxa3xx_nand_info *info; | 1035 | struct pxa3xx_nand_info *info; |
1034 | struct pxa3xx_nand_host *host; | 1036 | struct pxa3xx_nand_host *host; |
1035 | struct nand_chip *chip; | 1037 | struct nand_chip *chip = NULL; |
1036 | struct mtd_info *mtd; | 1038 | struct mtd_info *mtd; |
1037 | struct resource *r; | 1039 | struct resource *r; |
1038 | int ret, irq, cs; | 1040 | int ret, irq, cs; |
@@ -1081,21 +1083,31 @@ static int alloc_nand_resource(struct platform_device *pdev) | |||
1081 | } | 1083 | } |
1082 | clk_enable(info->clk); | 1084 | clk_enable(info->clk); |
1083 | 1085 | ||
1084 | r = platform_get_resource(pdev, IORESOURCE_DMA, 0); | 1086 | /* |
1085 | if (r == NULL) { | 1087 | * This is a dirty hack to make this driver work from devicetree |
1086 | dev_err(&pdev->dev, "no resource defined for data DMA\n"); | 1088 | * bindings. It can be removed once we have a prober DMA controller |
1087 | ret = -ENXIO; | 1089 | * framework for DT. |
1088 | goto fail_put_clk; | 1090 | */ |
1089 | } | 1091 | if (pdev->dev.of_node && cpu_is_pxa3xx()) { |
1090 | info->drcmr_dat = r->start; | 1092 | info->drcmr_dat = 97; |
1093 | info->drcmr_cmd = 99; | ||
1094 | } else { | ||
1095 | r = platform_get_resource(pdev, IORESOURCE_DMA, 0); | ||
1096 | if (r == NULL) { | ||
1097 | dev_err(&pdev->dev, "no resource defined for data DMA\n"); | ||
1098 | ret = -ENXIO; | ||
1099 | goto fail_put_clk; | ||
1100 | } | ||
1101 | info->drcmr_dat = r->start; | ||
1091 | 1102 | ||
1092 | r = platform_get_resource(pdev, IORESOURCE_DMA, 1); | 1103 | r = platform_get_resource(pdev, IORESOURCE_DMA, 1); |
1093 | if (r == NULL) { | 1104 | if (r == NULL) { |
1094 | dev_err(&pdev->dev, "no resource defined for command DMA\n"); | 1105 | dev_err(&pdev->dev, "no resource defined for command DMA\n"); |
1095 | ret = -ENXIO; | 1106 | ret = -ENXIO; |
1096 | goto fail_put_clk; | 1107 | goto fail_put_clk; |
1108 | } | ||
1109 | info->drcmr_cmd = r->start; | ||
1097 | } | 1110 | } |
1098 | info->drcmr_cmd = r->start; | ||
1099 | 1111 | ||
1100 | irq = platform_get_irq(pdev, 0); | 1112 | irq = platform_get_irq(pdev, 0); |
1101 | if (irq < 0) { | 1113 | if (irq < 0) { |
@@ -1200,12 +1212,55 @@ static int pxa3xx_nand_remove(struct platform_device *pdev) | |||
1200 | return 0; | 1212 | return 0; |
1201 | } | 1213 | } |
1202 | 1214 | ||
1215 | #ifdef CONFIG_OF | ||
1216 | static struct of_device_id pxa3xx_nand_dt_ids[] = { | ||
1217 | { .compatible = "marvell,pxa3xx-nand" }, | ||
1218 | {} | ||
1219 | }; | ||
1220 | MODULE_DEVICE_TABLE(of, i2c_pxa_dt_ids); | ||
1221 | |||
1222 | static int pxa3xx_nand_probe_dt(struct platform_device *pdev) | ||
1223 | { | ||
1224 | struct pxa3xx_nand_platform_data *pdata; | ||
1225 | struct device_node *np = pdev->dev.of_node; | ||
1226 | const struct of_device_id *of_id = | ||
1227 | of_match_device(pxa3xx_nand_dt_ids, &pdev->dev); | ||
1228 | |||
1229 | if (!of_id) | ||
1230 | return 0; | ||
1231 | |||
1232 | pdata = devm_kzalloc(&pdev->dev, sizeof(*pdata), GFP_KERNEL); | ||
1233 | if (!pdata) | ||
1234 | return -ENOMEM; | ||
1235 | |||
1236 | if (of_get_property(np, "marvell,nand-enable-arbiter", NULL)) | ||
1237 | pdata->enable_arbiter = 1; | ||
1238 | if (of_get_property(np, "marvell,nand-keep-config", NULL)) | ||
1239 | pdata->keep_config = 1; | ||
1240 | of_property_read_u32(np, "num-cs", &pdata->num_cs); | ||
1241 | |||
1242 | pdev->dev.platform_data = pdata; | ||
1243 | |||
1244 | return 0; | ||
1245 | } | ||
1246 | #else | ||
1247 | static inline int pxa3xx_nand_probe_dt(struct platform_device *pdev) | ||
1248 | { | ||
1249 | return 0; | ||
1250 | } | ||
1251 | #endif | ||
1252 | |||
1203 | static int pxa3xx_nand_probe(struct platform_device *pdev) | 1253 | static int pxa3xx_nand_probe(struct platform_device *pdev) |
1204 | { | 1254 | { |
1205 | struct pxa3xx_nand_platform_data *pdata; | 1255 | struct pxa3xx_nand_platform_data *pdata; |
1256 | struct mtd_part_parser_data ppdata = {}; | ||
1206 | struct pxa3xx_nand_info *info; | 1257 | struct pxa3xx_nand_info *info; |
1207 | int ret, cs, probe_success; | 1258 | int ret, cs, probe_success; |
1208 | 1259 | ||
1260 | ret = pxa3xx_nand_probe_dt(pdev); | ||
1261 | if (ret) | ||
1262 | return ret; | ||
1263 | |||
1209 | pdata = pdev->dev.platform_data; | 1264 | pdata = pdev->dev.platform_data; |
1210 | if (!pdata) { | 1265 | if (!pdata) { |
1211 | dev_err(&pdev->dev, "no platform data defined\n"); | 1266 | dev_err(&pdev->dev, "no platform data defined\n"); |
@@ -1229,8 +1284,9 @@ static int pxa3xx_nand_probe(struct platform_device *pdev) | |||
1229 | continue; | 1284 | continue; |
1230 | } | 1285 | } |
1231 | 1286 | ||
1287 | ppdata.of_node = pdev->dev.of_node; | ||
1232 | ret = mtd_device_parse_register(info->host[cs]->mtd, NULL, | 1288 | ret = mtd_device_parse_register(info->host[cs]->mtd, NULL, |
1233 | NULL, pdata->parts[cs], | 1289 | &ppdata, pdata->parts[cs], |
1234 | pdata->nr_parts[cs]); | 1290 | pdata->nr_parts[cs]); |
1235 | if (!ret) | 1291 | if (!ret) |
1236 | probe_success = 1; | 1292 | probe_success = 1; |
@@ -1306,6 +1362,7 @@ static int pxa3xx_nand_resume(struct platform_device *pdev) | |||
1306 | static struct platform_driver pxa3xx_nand_driver = { | 1362 | static struct platform_driver pxa3xx_nand_driver = { |
1307 | .driver = { | 1363 | .driver = { |
1308 | .name = "pxa3xx-nand", | 1364 | .name = "pxa3xx-nand", |
1365 | .of_match_table = of_match_ptr(pxa3xx_nand_dt_ids), | ||
1309 | }, | 1366 | }, |
1310 | .probe = pxa3xx_nand_probe, | 1367 | .probe = pxa3xx_nand_probe, |
1311 | .remove = pxa3xx_nand_remove, | 1368 | .remove = pxa3xx_nand_remove, |
diff --git a/drivers/pinctrl/pinctrl-sirf.c b/drivers/pinctrl/pinctrl-sirf.c index 7fca6ce5952b..304360cd213e 100644 --- a/drivers/pinctrl/pinctrl-sirf.c +++ b/drivers/pinctrl/pinctrl-sirf.c | |||
@@ -17,6 +17,7 @@ | |||
17 | #include <linux/pinctrl/pinctrl.h> | 17 | #include <linux/pinctrl/pinctrl.h> |
18 | #include <linux/pinctrl/pinmux.h> | 18 | #include <linux/pinctrl/pinmux.h> |
19 | #include <linux/pinctrl/consumer.h> | 19 | #include <linux/pinctrl/consumer.h> |
20 | #include <linux/pinctrl/machine.h> | ||
20 | #include <linux/of.h> | 21 | #include <linux/of.h> |
21 | #include <linux/of_address.h> | 22 | #include <linux/of_address.h> |
22 | #include <linux/of_device.h> | 23 | #include <linux/of_device.h> |
@@ -916,11 +917,66 @@ static void sirfsoc_pin_dbg_show(struct pinctrl_dev *pctldev, struct seq_file *s | |||
916 | seq_printf(s, " " DRIVER_NAME); | 917 | seq_printf(s, " " DRIVER_NAME); |
917 | } | 918 | } |
918 | 919 | ||
920 | static int sirfsoc_dt_node_to_map(struct pinctrl_dev *pctldev, | ||
921 | struct device_node *np_config, | ||
922 | struct pinctrl_map **map, unsigned *num_maps) | ||
923 | { | ||
924 | struct sirfsoc_pmx *spmx = pinctrl_dev_get_drvdata(pctldev); | ||
925 | struct device_node *np; | ||
926 | struct property *prop; | ||
927 | const char *function, *group; | ||
928 | int ret, index = 0, count = 0; | ||
929 | |||
930 | /* calculate number of maps required */ | ||
931 | for_each_child_of_node(np_config, np) { | ||
932 | ret = of_property_read_string(np, "sirf,function", &function); | ||
933 | if (ret < 0) | ||
934 | return ret; | ||
935 | |||
936 | ret = of_property_count_strings(np, "sirf,pins"); | ||
937 | if (ret < 0) | ||
938 | return ret; | ||
939 | |||
940 | count += ret; | ||
941 | } | ||
942 | |||
943 | if (!count) { | ||
944 | dev_err(spmx->dev, "No child nodes passed via DT\n"); | ||
945 | return -ENODEV; | ||
946 | } | ||
947 | |||
948 | *map = kzalloc(sizeof(**map) * count, GFP_KERNEL); | ||
949 | if (!*map) | ||
950 | return -ENOMEM; | ||
951 | |||
952 | for_each_child_of_node(np_config, np) { | ||
953 | of_property_read_string(np, "sirf,function", &function); | ||
954 | of_property_for_each_string(np, "sirf,pins", prop, group) { | ||
955 | (*map)[index].type = PIN_MAP_TYPE_MUX_GROUP; | ||
956 | (*map)[index].data.mux.group = group; | ||
957 | (*map)[index].data.mux.function = function; | ||
958 | index++; | ||
959 | } | ||
960 | } | ||
961 | |||
962 | *num_maps = count; | ||
963 | |||
964 | return 0; | ||
965 | } | ||
966 | |||
967 | static void sirfsoc_dt_free_map(struct pinctrl_dev *pctldev, | ||
968 | struct pinctrl_map *map, unsigned num_maps) | ||
969 | { | ||
970 | kfree(map); | ||
971 | } | ||
972 | |||
919 | static struct pinctrl_ops sirfsoc_pctrl_ops = { | 973 | static struct pinctrl_ops sirfsoc_pctrl_ops = { |
920 | .get_groups_count = sirfsoc_get_groups_count, | 974 | .get_groups_count = sirfsoc_get_groups_count, |
921 | .get_group_name = sirfsoc_get_group_name, | 975 | .get_group_name = sirfsoc_get_group_name, |
922 | .get_group_pins = sirfsoc_get_group_pins, | 976 | .get_group_pins = sirfsoc_get_group_pins, |
923 | .pin_dbg_show = sirfsoc_pin_dbg_show, | 977 | .pin_dbg_show = sirfsoc_pin_dbg_show, |
978 | .dt_node_to_map = sirfsoc_dt_node_to_map, | ||
979 | .dt_free_map = sirfsoc_dt_free_map, | ||
924 | }; | 980 | }; |
925 | 981 | ||
926 | struct sirfsoc_pmx_func { | 982 | struct sirfsoc_pmx_func { |
@@ -1221,7 +1277,7 @@ out_no_gpio_remap: | |||
1221 | } | 1277 | } |
1222 | 1278 | ||
1223 | static const struct of_device_id pinmux_ids[] __devinitconst = { | 1279 | static const struct of_device_id pinmux_ids[] __devinitconst = { |
1224 | { .compatible = "sirf,prima2-gpio-pinmux" }, | 1280 | { .compatible = "sirf,prima2-pinctrl" }, |
1225 | {} | 1281 | {} |
1226 | }; | 1282 | }; |
1227 | 1283 | ||
diff --git a/drivers/rtc/rtc-ab8500.c b/drivers/rtc/rtc-ab8500.c index bf3c2f669c3c..2e5970fe9eeb 100644 --- a/drivers/rtc/rtc-ab8500.c +++ b/drivers/rtc/rtc-ab8500.c | |||
@@ -462,16 +462,10 @@ static int __devexit ab8500_rtc_remove(struct platform_device *pdev) | |||
462 | return 0; | 462 | return 0; |
463 | } | 463 | } |
464 | 464 | ||
465 | static const struct of_device_id ab8500_rtc_match[] = { | ||
466 | { .compatible = "stericsson,ab8500-rtc", }, | ||
467 | {} | ||
468 | }; | ||
469 | |||
470 | static struct platform_driver ab8500_rtc_driver = { | 465 | static struct platform_driver ab8500_rtc_driver = { |
471 | .driver = { | 466 | .driver = { |
472 | .name = "ab8500-rtc", | 467 | .name = "ab8500-rtc", |
473 | .owner = THIS_MODULE, | 468 | .owner = THIS_MODULE, |
474 | .of_match_table = ab8500_rtc_match, | ||
475 | }, | 469 | }, |
476 | .probe = ab8500_rtc_probe, | 470 | .probe = ab8500_rtc_probe, |
477 | .remove = __devexit_p(ab8500_rtc_remove), | 471 | .remove = __devexit_p(ab8500_rtc_remove), |
diff --git a/drivers/rtc/rtc-pxa.c b/drivers/rtc/rtc-pxa.c index 0075c8fd93d8..f771b2ee4b18 100644 --- a/drivers/rtc/rtc-pxa.c +++ b/drivers/rtc/rtc-pxa.c | |||
@@ -27,6 +27,8 @@ | |||
27 | #include <linux/interrupt.h> | 27 | #include <linux/interrupt.h> |
28 | #include <linux/io.h> | 28 | #include <linux/io.h> |
29 | #include <linux/slab.h> | 29 | #include <linux/slab.h> |
30 | #include <linux/of.h> | ||
31 | #include <linux/of_device.h> | ||
30 | 32 | ||
31 | #include <mach/hardware.h> | 33 | #include <mach/hardware.h> |
32 | 34 | ||
@@ -396,6 +398,14 @@ static int __exit pxa_rtc_remove(struct platform_device *pdev) | |||
396 | return 0; | 398 | return 0; |
397 | } | 399 | } |
398 | 400 | ||
401 | #ifdef CONFIG_OF | ||
402 | static struct of_device_id pxa_rtc_dt_ids[] = { | ||
403 | { .compatible = "marvell,pxa-rtc" }, | ||
404 | {} | ||
405 | }; | ||
406 | MODULE_DEVICE_TABLE(of, pxa_rtc_dt_ids); | ||
407 | #endif | ||
408 | |||
399 | #ifdef CONFIG_PM | 409 | #ifdef CONFIG_PM |
400 | static int pxa_rtc_suspend(struct device *dev) | 410 | static int pxa_rtc_suspend(struct device *dev) |
401 | { | 411 | { |
@@ -425,6 +435,7 @@ static struct platform_driver pxa_rtc_driver = { | |||
425 | .remove = __exit_p(pxa_rtc_remove), | 435 | .remove = __exit_p(pxa_rtc_remove), |
426 | .driver = { | 436 | .driver = { |
427 | .name = "pxa-rtc", | 437 | .name = "pxa-rtc", |
438 | .of_match_table = of_match_ptr(pxa_rtc_dt_ids), | ||
428 | #ifdef CONFIG_PM | 439 | #ifdef CONFIG_PM |
429 | .pm = &pxa_rtc_pm_ops, | 440 | .pm = &pxa_rtc_pm_ops, |
430 | #endif | 441 | #endif |
diff --git a/drivers/rtc/rtc-vt8500.c b/drivers/rtc/rtc-vt8500.c index 9e94fb147c26..07bf19364a74 100644 --- a/drivers/rtc/rtc-vt8500.c +++ b/drivers/rtc/rtc-vt8500.c | |||
@@ -23,6 +23,7 @@ | |||
23 | #include <linux/bcd.h> | 23 | #include <linux/bcd.h> |
24 | #include <linux/platform_device.h> | 24 | #include <linux/platform_device.h> |
25 | #include <linux/slab.h> | 25 | #include <linux/slab.h> |
26 | #include <linux/of.h> | ||
26 | 27 | ||
27 | /* | 28 | /* |
28 | * Register definitions | 29 | * Register definitions |
@@ -302,12 +303,18 @@ static int __devexit vt8500_rtc_remove(struct platform_device *pdev) | |||
302 | return 0; | 303 | return 0; |
303 | } | 304 | } |
304 | 305 | ||
306 | static const struct of_device_id wmt_dt_ids[] = { | ||
307 | { .compatible = "via,vt8500-rtc", }, | ||
308 | {} | ||
309 | }; | ||
310 | |||
305 | static struct platform_driver vt8500_rtc_driver = { | 311 | static struct platform_driver vt8500_rtc_driver = { |
306 | .probe = vt8500_rtc_probe, | 312 | .probe = vt8500_rtc_probe, |
307 | .remove = __devexit_p(vt8500_rtc_remove), | 313 | .remove = __devexit_p(vt8500_rtc_remove), |
308 | .driver = { | 314 | .driver = { |
309 | .name = "vt8500-rtc", | 315 | .name = "vt8500-rtc", |
310 | .owner = THIS_MODULE, | 316 | .owner = THIS_MODULE, |
317 | .of_match_table = of_match_ptr(wmt_dt_ids), | ||
311 | }, | 318 | }, |
312 | }; | 319 | }; |
313 | 320 | ||
@@ -315,5 +322,5 @@ module_platform_driver(vt8500_rtc_driver); | |||
315 | 322 | ||
316 | MODULE_AUTHOR("Alexey Charkov <alchark@gmail.com>"); | 323 | MODULE_AUTHOR("Alexey Charkov <alchark@gmail.com>"); |
317 | MODULE_DESCRIPTION("VIA VT8500 SoC Realtime Clock Driver (RTC)"); | 324 | MODULE_DESCRIPTION("VIA VT8500 SoC Realtime Clock Driver (RTC)"); |
318 | MODULE_LICENSE("GPL"); | 325 | MODULE_LICENSE("GPL v2"); |
319 | MODULE_ALIAS("platform:vt8500-rtc"); | 326 | MODULE_ALIAS("platform:vt8500-rtc"); |
diff --git a/drivers/tty/serial/vt8500_serial.c b/drivers/tty/serial/vt8500_serial.c index 2be006fb3da0..205d4cf4a063 100644 --- a/drivers/tty/serial/vt8500_serial.c +++ b/drivers/tty/serial/vt8500_serial.c | |||
@@ -34,6 +34,7 @@ | |||
34 | #include <linux/slab.h> | 34 | #include <linux/slab.h> |
35 | #include <linux/clk.h> | 35 | #include <linux/clk.h> |
36 | #include <linux/platform_device.h> | 36 | #include <linux/platform_device.h> |
37 | #include <linux/of.h> | ||
37 | 38 | ||
38 | /* | 39 | /* |
39 | * UART Register offsets | 40 | * UART Register offsets |
@@ -76,6 +77,8 @@ | |||
76 | #define RX_FIFO_INTS (RXFAF | RXFF | RXOVER | PER | FER | RXTOUT) | 77 | #define RX_FIFO_INTS (RXFAF | RXFF | RXOVER | PER | FER | RXTOUT) |
77 | #define TX_FIFO_INTS (TXFAE | TXFE | TXUDR) | 78 | #define TX_FIFO_INTS (TXFAE | TXFE | TXUDR) |
78 | 79 | ||
80 | #define VT8500_MAX_PORTS 6 | ||
81 | |||
79 | struct vt8500_port { | 82 | struct vt8500_port { |
80 | struct uart_port uart; | 83 | struct uart_port uart; |
81 | char name[16]; | 84 | char name[16]; |
@@ -83,6 +86,13 @@ struct vt8500_port { | |||
83 | unsigned int ier; | 86 | unsigned int ier; |
84 | }; | 87 | }; |
85 | 88 | ||
89 | /* | ||
90 | * we use this variable to keep track of which ports | ||
91 | * have been allocated as we can't use pdev->id in | ||
92 | * devicetree | ||
93 | */ | ||
94 | static unsigned long vt8500_ports_in_use; | ||
95 | |||
86 | static inline void vt8500_write(struct uart_port *port, unsigned int val, | 96 | static inline void vt8500_write(struct uart_port *port, unsigned int val, |
87 | unsigned int off) | 97 | unsigned int off) |
88 | { | 98 | { |
@@ -431,7 +441,7 @@ static int vt8500_verify_port(struct uart_port *port, | |||
431 | return 0; | 441 | return 0; |
432 | } | 442 | } |
433 | 443 | ||
434 | static struct vt8500_port *vt8500_uart_ports[4]; | 444 | static struct vt8500_port *vt8500_uart_ports[VT8500_MAX_PORTS]; |
435 | static struct uart_driver vt8500_uart_driver; | 445 | static struct uart_driver vt8500_uart_driver; |
436 | 446 | ||
437 | #ifdef CONFIG_SERIAL_VT8500_CONSOLE | 447 | #ifdef CONFIG_SERIAL_VT8500_CONSOLE |
@@ -548,7 +558,9 @@ static int __devinit vt8500_serial_probe(struct platform_device *pdev) | |||
548 | { | 558 | { |
549 | struct vt8500_port *vt8500_port; | 559 | struct vt8500_port *vt8500_port; |
550 | struct resource *mmres, *irqres; | 560 | struct resource *mmres, *irqres; |
561 | struct device_node *np = pdev->dev.of_node; | ||
551 | int ret; | 562 | int ret; |
563 | int port; | ||
552 | 564 | ||
553 | mmres = platform_get_resource(pdev, IORESOURCE_MEM, 0); | 565 | mmres = platform_get_resource(pdev, IORESOURCE_MEM, 0); |
554 | irqres = platform_get_resource(pdev, IORESOURCE_IRQ, 0); | 566 | irqres = platform_get_resource(pdev, IORESOURCE_IRQ, 0); |
@@ -559,16 +571,46 @@ static int __devinit vt8500_serial_probe(struct platform_device *pdev) | |||
559 | if (!vt8500_port) | 571 | if (!vt8500_port) |
560 | return -ENOMEM; | 572 | return -ENOMEM; |
561 | 573 | ||
574 | if (np) | ||
575 | port = of_alias_get_id(np, "serial"); | ||
576 | if (port > VT8500_MAX_PORTS) | ||
577 | port = -1; | ||
578 | else | ||
579 | port = -1; | ||
580 | |||
581 | if (port < 0) { | ||
582 | /* calculate the port id */ | ||
583 | port = find_first_zero_bit(&vt8500_ports_in_use, | ||
584 | sizeof(vt8500_ports_in_use)); | ||
585 | } | ||
586 | |||
587 | if (port > VT8500_MAX_PORTS) | ||
588 | return -ENODEV; | ||
589 | |||
590 | /* reserve the port id */ | ||
591 | if (test_and_set_bit(port, &vt8500_ports_in_use)) { | ||
592 | /* port already in use - shouldn't really happen */ | ||
593 | return -EBUSY; | ||
594 | } | ||
595 | |||
562 | vt8500_port->uart.type = PORT_VT8500; | 596 | vt8500_port->uart.type = PORT_VT8500; |
563 | vt8500_port->uart.iotype = UPIO_MEM; | 597 | vt8500_port->uart.iotype = UPIO_MEM; |
564 | vt8500_port->uart.mapbase = mmres->start; | 598 | vt8500_port->uart.mapbase = mmres->start; |
565 | vt8500_port->uart.irq = irqres->start; | 599 | vt8500_port->uart.irq = irqres->start; |
566 | vt8500_port->uart.fifosize = 16; | 600 | vt8500_port->uart.fifosize = 16; |
567 | vt8500_port->uart.ops = &vt8500_uart_pops; | 601 | vt8500_port->uart.ops = &vt8500_uart_pops; |
568 | vt8500_port->uart.line = pdev->id; | 602 | vt8500_port->uart.line = port; |
569 | vt8500_port->uart.dev = &pdev->dev; | 603 | vt8500_port->uart.dev = &pdev->dev; |
570 | vt8500_port->uart.flags = UPF_IOREMAP | UPF_BOOT_AUTOCONF; | 604 | vt8500_port->uart.flags = UPF_IOREMAP | UPF_BOOT_AUTOCONF; |
571 | vt8500_port->uart.uartclk = 24000000; | 605 | |
606 | vt8500_port->clk = of_clk_get(pdev->dev.of_node, 0); | ||
607 | if (vt8500_port->clk) { | ||
608 | vt8500_port->uart.uartclk = clk_get_rate(vt8500_port->clk); | ||
609 | } else { | ||
610 | /* use the default of 24Mhz if not specified and warn */ | ||
611 | pr_warn("%s: serial clock source not specified\n", __func__); | ||
612 | vt8500_port->uart.uartclk = 24000000; | ||
613 | } | ||
572 | 614 | ||
573 | snprintf(vt8500_port->name, sizeof(vt8500_port->name), | 615 | snprintf(vt8500_port->name, sizeof(vt8500_port->name), |
574 | "VT8500 UART%d", pdev->id); | 616 | "VT8500 UART%d", pdev->id); |
@@ -579,7 +621,7 @@ static int __devinit vt8500_serial_probe(struct platform_device *pdev) | |||
579 | goto err; | 621 | goto err; |
580 | } | 622 | } |
581 | 623 | ||
582 | vt8500_uart_ports[pdev->id] = vt8500_port; | 624 | vt8500_uart_ports[port] = vt8500_port; |
583 | 625 | ||
584 | uart_add_one_port(&vt8500_uart_driver, &vt8500_port->uart); | 626 | uart_add_one_port(&vt8500_uart_driver, &vt8500_port->uart); |
585 | 627 | ||
@@ -603,12 +645,18 @@ static int __devexit vt8500_serial_remove(struct platform_device *pdev) | |||
603 | return 0; | 645 | return 0; |
604 | } | 646 | } |
605 | 647 | ||
648 | static const struct of_device_id wmt_dt_ids[] = { | ||
649 | { .compatible = "via,vt8500-uart", }, | ||
650 | {} | ||
651 | }; | ||
652 | |||
606 | static struct platform_driver vt8500_platform_driver = { | 653 | static struct platform_driver vt8500_platform_driver = { |
607 | .probe = vt8500_serial_probe, | 654 | .probe = vt8500_serial_probe, |
608 | .remove = __devexit_p(vt8500_serial_remove), | 655 | .remove = __devexit_p(vt8500_serial_remove), |
609 | .driver = { | 656 | .driver = { |
610 | .name = "vt8500_serial", | 657 | .name = "vt8500_serial", |
611 | .owner = THIS_MODULE, | 658 | .owner = THIS_MODULE, |
659 | .of_match_table = of_match_ptr(wmt_dt_ids), | ||
612 | }, | 660 | }, |
613 | }; | 661 | }; |
614 | 662 | ||
@@ -642,4 +690,4 @@ module_exit(vt8500_serial_exit); | |||
642 | 690 | ||
643 | MODULE_AUTHOR("Alexey Charkov <alchark@gmail.com>"); | 691 | MODULE_AUTHOR("Alexey Charkov <alchark@gmail.com>"); |
644 | MODULE_DESCRIPTION("Driver for vt8500 serial device"); | 692 | MODULE_DESCRIPTION("Driver for vt8500 serial device"); |
645 | MODULE_LICENSE("GPL"); | 693 | MODULE_LICENSE("GPL v2"); |
diff --git a/drivers/video/Kconfig b/drivers/video/Kconfig index 0217f7415ef5..b66d951b8e32 100644 --- a/drivers/video/Kconfig +++ b/drivers/video/Kconfig | |||
@@ -1788,7 +1788,7 @@ config FB_AU1200 | |||
1788 | 1788 | ||
1789 | config FB_VT8500 | 1789 | config FB_VT8500 |
1790 | bool "VT8500 LCD Driver" | 1790 | bool "VT8500 LCD Driver" |
1791 | depends on (FB = y) && ARM && ARCH_VT8500 && VTWM_VERSION_VT8500 | 1791 | depends on (FB = y) && ARM && ARCH_VT8500 |
1792 | select FB_WMT_GE_ROPS | 1792 | select FB_WMT_GE_ROPS |
1793 | select FB_SYS_IMAGEBLIT | 1793 | select FB_SYS_IMAGEBLIT |
1794 | help | 1794 | help |
@@ -1797,11 +1797,11 @@ config FB_VT8500 | |||
1797 | 1797 | ||
1798 | config FB_WM8505 | 1798 | config FB_WM8505 |
1799 | bool "WM8505 frame buffer support" | 1799 | bool "WM8505 frame buffer support" |
1800 | depends on (FB = y) && ARM && ARCH_VT8500 && VTWM_VERSION_WM8505 | 1800 | depends on (FB = y) && ARM && ARCH_VT8500 |
1801 | select FB_WMT_GE_ROPS | 1801 | select FB_WMT_GE_ROPS |
1802 | select FB_SYS_IMAGEBLIT | 1802 | select FB_SYS_IMAGEBLIT |
1803 | help | 1803 | help |
1804 | This is the framebuffer driver for WonderMedia WM8505 | 1804 | This is the framebuffer driver for WonderMedia WM8505/WM8650 |
1805 | integrated LCD controller. | 1805 | integrated LCD controller. |
1806 | 1806 | ||
1807 | source "drivers/video/geode/Kconfig" | 1807 | source "drivers/video/geode/Kconfig" |
diff --git a/drivers/video/vt8500lcdfb.c b/drivers/video/vt8500lcdfb.c index 2a5fe6ede845..d24595cd0c9b 100644 --- a/drivers/video/vt8500lcdfb.c +++ b/drivers/video/vt8500lcdfb.c | |||
@@ -35,6 +35,13 @@ | |||
35 | #include "vt8500lcdfb.h" | 35 | #include "vt8500lcdfb.h" |
36 | #include "wmt_ge_rops.h" | 36 | #include "wmt_ge_rops.h" |
37 | 37 | ||
38 | #ifdef CONFIG_OF | ||
39 | #include <linux/of.h> | ||
40 | #include <linux/of_fdt.h> | ||
41 | #include <linux/memblock.h> | ||
42 | #endif | ||
43 | |||
44 | |||
38 | #define to_vt8500lcd_info(__info) container_of(__info, \ | 45 | #define to_vt8500lcd_info(__info) container_of(__info, \ |
39 | struct vt8500lcd_info, fb) | 46 | struct vt8500lcd_info, fb) |
40 | 47 | ||
@@ -270,15 +277,21 @@ static int __devinit vt8500lcd_probe(struct platform_device *pdev) | |||
270 | { | 277 | { |
271 | struct vt8500lcd_info *fbi; | 278 | struct vt8500lcd_info *fbi; |
272 | struct resource *res; | 279 | struct resource *res; |
273 | struct vt8500fb_platform_data *pdata = pdev->dev.platform_data; | ||
274 | void *addr; | 280 | void *addr; |
275 | int irq, ret; | 281 | int irq, ret; |
276 | 282 | ||
283 | struct fb_videomode of_mode; | ||
284 | struct device_node *np; | ||
285 | u32 bpp; | ||
286 | dma_addr_t fb_mem_phys; | ||
287 | unsigned long fb_mem_len; | ||
288 | void *fb_mem_virt; | ||
289 | |||
277 | ret = -ENOMEM; | 290 | ret = -ENOMEM; |
278 | fbi = NULL; | 291 | fbi = NULL; |
279 | 292 | ||
280 | fbi = kzalloc(sizeof(struct vt8500lcd_info) + sizeof(u32) * 16, | 293 | fbi = devm_kzalloc(&pdev->dev, sizeof(struct vt8500lcd_info) |
281 | GFP_KERNEL); | 294 | + sizeof(u32) * 16, GFP_KERNEL); |
282 | if (!fbi) { | 295 | if (!fbi) { |
283 | dev_err(&pdev->dev, "Failed to initialize framebuffer device\n"); | 296 | dev_err(&pdev->dev, "Failed to initialize framebuffer device\n"); |
284 | ret = -ENOMEM; | 297 | ret = -ENOMEM; |
@@ -333,9 +346,45 @@ static int __devinit vt8500lcd_probe(struct platform_device *pdev) | |||
333 | goto failed_free_res; | 346 | goto failed_free_res; |
334 | } | 347 | } |
335 | 348 | ||
336 | fbi->fb.fix.smem_start = pdata->video_mem_phys; | 349 | np = of_parse_phandle(pdev->dev.of_node, "default-mode", 0); |
337 | fbi->fb.fix.smem_len = pdata->video_mem_len; | 350 | if (!np) { |
338 | fbi->fb.screen_base = pdata->video_mem_virt; | 351 | pr_err("%s: No display description in Device Tree\n", __func__); |
352 | ret = -EINVAL; | ||
353 | goto failed_free_res; | ||
354 | } | ||
355 | |||
356 | /* | ||
357 | * This code is copied from Sascha Hauer's of_videomode helper | ||
358 | * and can be replaced with a call to the helper once mainlined | ||
359 | */ | ||
360 | ret = 0; | ||
361 | ret |= of_property_read_u32(np, "hactive", &of_mode.xres); | ||
362 | ret |= of_property_read_u32(np, "vactive", &of_mode.yres); | ||
363 | ret |= of_property_read_u32(np, "hback-porch", &of_mode.left_margin); | ||
364 | ret |= of_property_read_u32(np, "hfront-porch", &of_mode.right_margin); | ||
365 | ret |= of_property_read_u32(np, "hsync-len", &of_mode.hsync_len); | ||
366 | ret |= of_property_read_u32(np, "vback-porch", &of_mode.upper_margin); | ||
367 | ret |= of_property_read_u32(np, "vfront-porch", &of_mode.lower_margin); | ||
368 | ret |= of_property_read_u32(np, "vsync-len", &of_mode.vsync_len); | ||
369 | ret |= of_property_read_u32(np, "bpp", &bpp); | ||
370 | if (ret) { | ||
371 | pr_err("%s: Unable to read display properties\n", __func__); | ||
372 | goto failed_free_res; | ||
373 | } | ||
374 | of_mode.vmode = FB_VMODE_NONINTERLACED; | ||
375 | |||
376 | /* try allocating the framebuffer */ | ||
377 | fb_mem_len = of_mode.xres * of_mode.yres * 2 * (bpp / 8); | ||
378 | fb_mem_virt = dma_alloc_coherent(&pdev->dev, fb_mem_len, &fb_mem_phys, | ||
379 | GFP_KERNEL); | ||
380 | if (!fb_mem_virt) { | ||
381 | pr_err("%s: Failed to allocate framebuffer\n", __func__); | ||
382 | return -ENOMEM; | ||
383 | }; | ||
384 | |||
385 | fbi->fb.fix.smem_start = fb_mem_phys; | ||
386 | fbi->fb.fix.smem_len = fb_mem_len; | ||
387 | fbi->fb.screen_base = fb_mem_virt; | ||
339 | 388 | ||
340 | fbi->palette_size = PAGE_ALIGN(512); | 389 | fbi->palette_size = PAGE_ALIGN(512); |
341 | fbi->palette_cpu = dma_alloc_coherent(&pdev->dev, | 390 | fbi->palette_cpu = dma_alloc_coherent(&pdev->dev, |
@@ -370,10 +419,11 @@ static int __devinit vt8500lcd_probe(struct platform_device *pdev) | |||
370 | goto failed_free_irq; | 419 | goto failed_free_irq; |
371 | } | 420 | } |
372 | 421 | ||
373 | fb_videomode_to_var(&fbi->fb.var, &pdata->mode); | 422 | fb_videomode_to_var(&fbi->fb.var, &of_mode); |
374 | fbi->fb.var.bits_per_pixel = pdata->bpp; | 423 | |
375 | fbi->fb.var.xres_virtual = pdata->xres_virtual; | 424 | fbi->fb.var.xres_virtual = of_mode.xres; |
376 | fbi->fb.var.yres_virtual = pdata->yres_virtual; | 425 | fbi->fb.var.yres_virtual = of_mode.yres * 2; |
426 | fbi->fb.var.bits_per_pixel = bpp; | ||
377 | 427 | ||
378 | ret = vt8500lcd_set_par(&fbi->fb); | 428 | ret = vt8500lcd_set_par(&fbi->fb); |
379 | if (ret) { | 429 | if (ret) { |
@@ -448,12 +498,18 @@ static int __devexit vt8500lcd_remove(struct platform_device *pdev) | |||
448 | return 0; | 498 | return 0; |
449 | } | 499 | } |
450 | 500 | ||
501 | static const struct of_device_id via_dt_ids[] = { | ||
502 | { .compatible = "via,vt8500-fb", }, | ||
503 | {} | ||
504 | }; | ||
505 | |||
451 | static struct platform_driver vt8500lcd_driver = { | 506 | static struct platform_driver vt8500lcd_driver = { |
452 | .probe = vt8500lcd_probe, | 507 | .probe = vt8500lcd_probe, |
453 | .remove = __devexit_p(vt8500lcd_remove), | 508 | .remove = __devexit_p(vt8500lcd_remove), |
454 | .driver = { | 509 | .driver = { |
455 | .owner = THIS_MODULE, | 510 | .owner = THIS_MODULE, |
456 | .name = "vt8500-lcd", | 511 | .name = "vt8500-lcd", |
512 | .of_match_table = of_match_ptr(via_dt_ids), | ||
457 | }, | 513 | }, |
458 | }; | 514 | }; |
459 | 515 | ||
@@ -461,4 +517,5 @@ module_platform_driver(vt8500lcd_driver); | |||
461 | 517 | ||
462 | MODULE_AUTHOR("Alexey Charkov <alchark@gmail.com>"); | 518 | MODULE_AUTHOR("Alexey Charkov <alchark@gmail.com>"); |
463 | MODULE_DESCRIPTION("LCD controller driver for VIA VT8500"); | 519 | MODULE_DESCRIPTION("LCD controller driver for VIA VT8500"); |
464 | MODULE_LICENSE("GPL"); | 520 | MODULE_LICENSE("GPL v2"); |
521 | MODULE_DEVICE_TABLE(of, via_dt_ids); | ||
diff --git a/drivers/video/wm8505fb.c b/drivers/video/wm8505fb.c index c8703bd61b74..ec4742442103 100644 --- a/drivers/video/wm8505fb.c +++ b/drivers/video/wm8505fb.c | |||
@@ -28,6 +28,9 @@ | |||
28 | #include <linux/dma-mapping.h> | 28 | #include <linux/dma-mapping.h> |
29 | #include <linux/platform_device.h> | 29 | #include <linux/platform_device.h> |
30 | #include <linux/wait.h> | 30 | #include <linux/wait.h> |
31 | #include <linux/of.h> | ||
32 | #include <linux/of_fdt.h> | ||
33 | #include <linux/memblock.h> | ||
31 | 34 | ||
32 | #include <mach/vt8500fb.h> | 35 | #include <mach/vt8500fb.h> |
33 | 36 | ||
@@ -59,8 +62,12 @@ static int wm8505fb_init_hw(struct fb_info *info) | |||
59 | writel(fbi->fb.fix.smem_start, fbi->regbase + WMT_GOVR_FBADDR); | 62 | writel(fbi->fb.fix.smem_start, fbi->regbase + WMT_GOVR_FBADDR); |
60 | writel(fbi->fb.fix.smem_start, fbi->regbase + WMT_GOVR_FBADDR1); | 63 | writel(fbi->fb.fix.smem_start, fbi->regbase + WMT_GOVR_FBADDR1); |
61 | 64 | ||
62 | /* Set in-memory picture format to RGB 32bpp */ | 65 | /* |
63 | writel(0x1c, fbi->regbase + WMT_GOVR_COLORSPACE); | 66 | * Set in-memory picture format to RGB |
67 | * 0x31C sets the correct color mode (RGB565) for WM8650 | ||
68 | * Bit 8+9 (0x300) are ignored on WM8505 as reserved | ||
69 | */ | ||
70 | writel(0x31c, fbi->regbase + WMT_GOVR_COLORSPACE); | ||
64 | writel(1, fbi->regbase + WMT_GOVR_COLORSPACE1); | 71 | writel(1, fbi->regbase + WMT_GOVR_COLORSPACE1); |
65 | 72 | ||
66 | /* Virtual buffer size */ | 73 | /* Virtual buffer size */ |
@@ -127,6 +134,18 @@ static int wm8505fb_set_par(struct fb_info *info) | |||
127 | info->var.blue.msb_right = 0; | 134 | info->var.blue.msb_right = 0; |
128 | info->fix.visual = FB_VISUAL_TRUECOLOR; | 135 | info->fix.visual = FB_VISUAL_TRUECOLOR; |
129 | info->fix.line_length = info->var.xres_virtual << 2; | 136 | info->fix.line_length = info->var.xres_virtual << 2; |
137 | } else if (info->var.bits_per_pixel == 16) { | ||
138 | info->var.red.offset = 11; | ||
139 | info->var.red.length = 5; | ||
140 | info->var.red.msb_right = 0; | ||
141 | info->var.green.offset = 5; | ||
142 | info->var.green.length = 6; | ||
143 | info->var.green.msb_right = 0; | ||
144 | info->var.blue.offset = 0; | ||
145 | info->var.blue.length = 5; | ||
146 | info->var.blue.msb_right = 0; | ||
147 | info->fix.visual = FB_VISUAL_TRUECOLOR; | ||
148 | info->fix.line_length = info->var.xres_virtual << 1; | ||
130 | } | 149 | } |
131 | 150 | ||
132 | wm8505fb_set_timing(info); | 151 | wm8505fb_set_timing(info); |
@@ -246,16 +265,20 @@ static int __devinit wm8505fb_probe(struct platform_device *pdev) | |||
246 | struct wm8505fb_info *fbi; | 265 | struct wm8505fb_info *fbi; |
247 | struct resource *res; | 266 | struct resource *res; |
248 | void *addr; | 267 | void *addr; |
249 | struct vt8500fb_platform_data *pdata; | ||
250 | int ret; | 268 | int ret; |
251 | 269 | ||
252 | pdata = pdev->dev.platform_data; | 270 | struct fb_videomode of_mode; |
271 | struct device_node *np; | ||
272 | u32 bpp; | ||
273 | dma_addr_t fb_mem_phys; | ||
274 | unsigned long fb_mem_len; | ||
275 | void *fb_mem_virt; | ||
253 | 276 | ||
254 | ret = -ENOMEM; | 277 | ret = -ENOMEM; |
255 | fbi = NULL; | 278 | fbi = NULL; |
256 | 279 | ||
257 | fbi = kzalloc(sizeof(struct wm8505fb_info) + sizeof(u32) * 16, | 280 | fbi = devm_kzalloc(&pdev->dev, sizeof(struct wm8505fb_info) + |
258 | GFP_KERNEL); | 281 | sizeof(u32) * 16, GFP_KERNEL); |
259 | if (!fbi) { | 282 | if (!fbi) { |
260 | dev_err(&pdev->dev, "Failed to initialize framebuffer device\n"); | 283 | dev_err(&pdev->dev, "Failed to initialize framebuffer device\n"); |
261 | ret = -ENOMEM; | 284 | ret = -ENOMEM; |
@@ -305,21 +328,58 @@ static int __devinit wm8505fb_probe(struct platform_device *pdev) | |||
305 | goto failed_free_res; | 328 | goto failed_free_res; |
306 | } | 329 | } |
307 | 330 | ||
308 | fb_videomode_to_var(&fbi->fb.var, &pdata->mode); | 331 | np = of_parse_phandle(pdev->dev.of_node, "default-mode", 0); |
332 | if (!np) { | ||
333 | pr_err("%s: No display description in Device Tree\n", __func__); | ||
334 | ret = -EINVAL; | ||
335 | goto failed_free_res; | ||
336 | } | ||
337 | |||
338 | /* | ||
339 | * This code is copied from Sascha Hauer's of_videomode helper | ||
340 | * and can be replaced with a call to the helper once mainlined | ||
341 | */ | ||
342 | ret = 0; | ||
343 | ret |= of_property_read_u32(np, "hactive", &of_mode.xres); | ||
344 | ret |= of_property_read_u32(np, "vactive", &of_mode.yres); | ||
345 | ret |= of_property_read_u32(np, "hback-porch", &of_mode.left_margin); | ||
346 | ret |= of_property_read_u32(np, "hfront-porch", &of_mode.right_margin); | ||
347 | ret |= of_property_read_u32(np, "hsync-len", &of_mode.hsync_len); | ||
348 | ret |= of_property_read_u32(np, "vback-porch", &of_mode.upper_margin); | ||
349 | ret |= of_property_read_u32(np, "vfront-porch", &of_mode.lower_margin); | ||
350 | ret |= of_property_read_u32(np, "vsync-len", &of_mode.vsync_len); | ||
351 | ret |= of_property_read_u32(np, "bpp", &bpp); | ||
352 | if (ret) { | ||
353 | pr_err("%s: Unable to read display properties\n", __func__); | ||
354 | goto failed_free_res; | ||
355 | } | ||
356 | |||
357 | of_mode.vmode = FB_VMODE_NONINTERLACED; | ||
358 | fb_videomode_to_var(&fbi->fb.var, &of_mode); | ||
309 | 359 | ||
310 | fbi->fb.var.nonstd = 0; | 360 | fbi->fb.var.nonstd = 0; |
311 | fbi->fb.var.activate = FB_ACTIVATE_NOW; | 361 | fbi->fb.var.activate = FB_ACTIVATE_NOW; |
312 | 362 | ||
313 | fbi->fb.var.height = -1; | 363 | fbi->fb.var.height = -1; |
314 | fbi->fb.var.width = -1; | 364 | fbi->fb.var.width = -1; |
315 | fbi->fb.var.xres_virtual = pdata->xres_virtual; | ||
316 | fbi->fb.var.yres_virtual = pdata->yres_virtual; | ||
317 | fbi->fb.var.bits_per_pixel = pdata->bpp; | ||
318 | 365 | ||
319 | fbi->fb.fix.smem_start = pdata->video_mem_phys; | 366 | /* try allocating the framebuffer */ |
320 | fbi->fb.fix.smem_len = pdata->video_mem_len; | 367 | fb_mem_len = of_mode.xres * of_mode.yres * 2 * (bpp / 8); |
321 | fbi->fb.screen_base = pdata->video_mem_virt; | 368 | fb_mem_virt = dma_alloc_coherent(&pdev->dev, fb_mem_len, &fb_mem_phys, |
322 | fbi->fb.screen_size = pdata->video_mem_len; | 369 | GFP_KERNEL); |
370 | if (!fb_mem_virt) { | ||
371 | pr_err("%s: Failed to allocate framebuffer\n", __func__); | ||
372 | return -ENOMEM; | ||
373 | }; | ||
374 | |||
375 | fbi->fb.var.xres_virtual = of_mode.xres; | ||
376 | fbi->fb.var.yres_virtual = of_mode.yres * 2; | ||
377 | fbi->fb.var.bits_per_pixel = bpp; | ||
378 | |||
379 | fbi->fb.fix.smem_start = fb_mem_phys; | ||
380 | fbi->fb.fix.smem_len = fb_mem_len; | ||
381 | fbi->fb.screen_base = fb_mem_virt; | ||
382 | fbi->fb.screen_size = fb_mem_len; | ||
323 | 383 | ||
324 | if (fb_alloc_cmap(&fbi->fb.cmap, 256, 0) < 0) { | 384 | if (fb_alloc_cmap(&fbi->fb.cmap, 256, 0) < 0) { |
325 | dev_err(&pdev->dev, "Failed to allocate color map\n"); | 385 | dev_err(&pdev->dev, "Failed to allocate color map\n"); |
@@ -395,12 +455,18 @@ static int __devexit wm8505fb_remove(struct platform_device *pdev) | |||
395 | return 0; | 455 | return 0; |
396 | } | 456 | } |
397 | 457 | ||
458 | static const struct of_device_id wmt_dt_ids[] = { | ||
459 | { .compatible = "wm,wm8505-fb", }, | ||
460 | {} | ||
461 | }; | ||
462 | |||
398 | static struct platform_driver wm8505fb_driver = { | 463 | static struct platform_driver wm8505fb_driver = { |
399 | .probe = wm8505fb_probe, | 464 | .probe = wm8505fb_probe, |
400 | .remove = __devexit_p(wm8505fb_remove), | 465 | .remove = __devexit_p(wm8505fb_remove), |
401 | .driver = { | 466 | .driver = { |
402 | .owner = THIS_MODULE, | 467 | .owner = THIS_MODULE, |
403 | .name = DRIVER_NAME, | 468 | .name = DRIVER_NAME, |
469 | .of_match_table = of_match_ptr(wmt_dt_ids), | ||
404 | }, | 470 | }, |
405 | }; | 471 | }; |
406 | 472 | ||
@@ -408,4 +474,5 @@ module_platform_driver(wm8505fb_driver); | |||
408 | 474 | ||
409 | MODULE_AUTHOR("Ed Spiridonov <edo.rus@gmail.com>"); | 475 | MODULE_AUTHOR("Ed Spiridonov <edo.rus@gmail.com>"); |
410 | MODULE_DESCRIPTION("Framebuffer driver for WMT WM8505"); | 476 | MODULE_DESCRIPTION("Framebuffer driver for WMT WM8505"); |
411 | MODULE_LICENSE("GPL"); | 477 | MODULE_LICENSE("GPL v2"); |
478 | MODULE_DEVICE_TABLE(of, wmt_dt_ids); | ||
diff --git a/drivers/video/wmt_ge_rops.c b/drivers/video/wmt_ge_rops.c index 55be3865015b..ba025b4c7d09 100644 --- a/drivers/video/wmt_ge_rops.c +++ b/drivers/video/wmt_ge_rops.c | |||
@@ -158,12 +158,18 @@ static int __devexit wmt_ge_rops_remove(struct platform_device *pdev) | |||
158 | return 0; | 158 | return 0; |
159 | } | 159 | } |
160 | 160 | ||
161 | static const struct of_device_id wmt_dt_ids[] = { | ||
162 | { .compatible = "wm,prizm-ge-rops", }, | ||
163 | { /* sentinel */ } | ||
164 | }; | ||
165 | |||
161 | static struct platform_driver wmt_ge_rops_driver = { | 166 | static struct platform_driver wmt_ge_rops_driver = { |
162 | .probe = wmt_ge_rops_probe, | 167 | .probe = wmt_ge_rops_probe, |
163 | .remove = __devexit_p(wmt_ge_rops_remove), | 168 | .remove = __devexit_p(wmt_ge_rops_remove), |
164 | .driver = { | 169 | .driver = { |
165 | .owner = THIS_MODULE, | 170 | .owner = THIS_MODULE, |
166 | .name = "wmt_ge_rops", | 171 | .name = "wmt_ge_rops", |
172 | .of_match_table = of_match_ptr(wmt_dt_ids), | ||
167 | }, | 173 | }, |
168 | }; | 174 | }; |
169 | 175 | ||
@@ -172,4 +178,5 @@ module_platform_driver(wmt_ge_rops_driver); | |||
172 | MODULE_AUTHOR("Alexey Charkov <alchark@gmail.com"); | 178 | MODULE_AUTHOR("Alexey Charkov <alchark@gmail.com"); |
173 | MODULE_DESCRIPTION("Accelerators for raster operations using " | 179 | MODULE_DESCRIPTION("Accelerators for raster operations using " |
174 | "WonderMedia Graphics Engine"); | 180 | "WonderMedia Graphics Engine"); |
175 | MODULE_LICENSE("GPL"); | 181 | MODULE_LICENSE("GPL v2"); |
182 | MODULE_DEVICE_TABLE(of, wmt_dt_ids); | ||