2 * linux/arch/arm/mach-integrator/impd1.c
4 * Copyright (C) 2003 Deep Blue Solutions Ltd, All Rights Reserved.
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License version 2 as
8 * published by the Free Software Foundation.
10 * This file provides the core support for the IM-PD1 module.
12 * Module / boot parameters.
13 * lmid=n impd1.lmid=n - set the logic module position in stack to 'n'
15 #include <linux/module.h>
16 #include <linux/moduleparam.h>
17 #include <linux/init.h>
18 #include <linux/device.h>
19 #include <linux/errno.h>
21 #include <linux/amba/bus.h>
22 #include <linux/amba/clcd.h>
24 #include <linux/slab.h>
25 #include <linux/clkdev.h>
27 #include <asm/hardware/icst.h>
29 #include <mach/impd1.h>
30 #include <asm/sizes.h>
34 module_param_named(lmid
, module_id
, int, 0444);
35 MODULE_PARM_DESC(lmid
, "logic module stack position");
40 struct clk_lookup
*clks
[3];
43 static const struct icst_params impd1_vco_params
= {
44 .ref
= 24000000, /* 24 MHz */
45 .vco_max
= ICST525_VCO_MAX_3V
,
46 .vco_min
= ICST525_VCO_MIN
,
51 .s2div
= icst525_s2div
,
52 .idx2s
= icst525_idx2s
,
55 static void impd1_setvco(struct clk
*clk
, struct icst_vco vco
)
57 struct impd1_module
*impd1
= clk
->data
;
58 u32 val
= vco
.v
| (vco
.r
<< 9) | (vco
.s
<< 16);
60 writel(0xa05f, impd1
->base
+ IMPD1_LOCK
);
61 writel(val
, clk
->vcoreg
);
62 writel(0, impd1
->base
+ IMPD1_LOCK
);
66 vco
.r
= (val
>> 9) & 0x7f;
67 vco
.s
= (val
>> 16) & 7;
69 pr_debug("IM-PD1: VCO%d clock is %ld Hz\n",
70 vconr
, icst525_hz(&impd1_vco_params
, vco
));
74 static const struct clk_ops impd1_clk_ops
= {
75 .round
= icst_clk_round
,
77 .setvco
= impd1_setvco
,
80 void impd1_tweak_control(struct device
*dev
, u32 mask
, u32 val
)
82 struct impd1_module
*impd1
= dev_get_drvdata(dev
);
86 cur
= readl(impd1
->base
+ IMPD1_CTRL
) & ~mask
;
87 writel(cur
| val
, impd1
->base
+ IMPD1_CTRL
);
90 EXPORT_SYMBOL(impd1_tweak_control
);
95 #define PANEL PROSPECTOR
103 #define PANELTYPE vga
104 static struct clcd_panel vga
= {
118 .vmode
= FB_VMODE_NONINTERLACED
,
122 .tim2
= TIM2_BCD
| TIM2_IPC
,
123 .cntl
= CNTL_LCDTFT
| CNTL_LCDVCOMP(1),
124 .connector
= IMPD1_CTRL_DISP_VGA
,
130 #define PANELTYPE svga
131 static struct clcd_panel svga
= {
145 .vmode
= FB_VMODE_NONINTERLACED
,
150 .cntl
= CNTL_LCDTFT
| CNTL_LCDVCOMP(1),
151 .connector
= IMPD1_CTRL_DISP_VGA
,
156 #elif PANEL == PROSPECTOR
157 #define PANELTYPE prospector
158 static struct clcd_panel prospector
= {
160 .name
= "PROSPECTOR",
171 .sync
= FB_SYNC_HOR_HIGH_ACT
| FB_SYNC_VERT_HIGH_ACT
,
172 .vmode
= FB_VMODE_NONINTERLACED
,
177 .cntl
= CNTL_LCDTFT
| CNTL_LCDVCOMP(1),
179 .connector
= IMPD1_CTRL_DISP_LCD
,
184 #elif PANEL == LTM10C209
185 #define PANELTYPE ltm10c209
189 static struct clcd_panel ltm10c209
= {
202 .sync
= FB_SYNC_HOR_HIGH_ACT
| FB_SYNC_VERT_HIGH_ACT
,
203 .vmode
= FB_VMODE_NONINTERLACED
,
208 .cntl
= CNTL_LCDTFT
| CNTL_LCDVCOMP(1),
210 .connector
= IMPD1_CTRL_DISP_LCD
,
217 * Disable all display connectors on the interface module.
219 static void impd1fb_clcd_disable(struct clcd_fb
*fb
)
221 impd1_tweak_control(fb
->dev
->dev
.parent
, IMPD1_CTRL_DISP_MASK
, 0);
225 * Enable the relevant connector on the interface module.
227 static void impd1fb_clcd_enable(struct clcd_fb
*fb
)
229 impd1_tweak_control(fb
->dev
->dev
.parent
, IMPD1_CTRL_DISP_MASK
,
230 fb
->panel
->connector
| IMPD1_CTRL_DISP_ENABLE
);
233 static int impd1fb_clcd_setup(struct clcd_fb
*fb
)
235 unsigned long framebase
= fb
->dev
->res
.start
+ 0x01000000;
236 unsigned long framesize
= SZ_1M
;
239 fb
->panel
= &PANELTYPE
;
241 if (!request_mem_region(framebase
, framesize
, "clcd framebuffer")) {
242 printk(KERN_ERR
"IM-PD1: unable to reserve framebuffer\n");
246 fb
->fb
.screen_base
= ioremap(framebase
, framesize
);
247 if (!fb
->fb
.screen_base
) {
248 printk(KERN_ERR
"IM-PD1: unable to map framebuffer\n");
253 fb
->fb
.fix
.smem_start
= framebase
;
254 fb
->fb
.fix
.smem_len
= framesize
;
259 release_mem_region(framebase
, framesize
);
263 static int impd1fb_clcd_mmap(struct clcd_fb
*fb
, struct vm_area_struct
*vma
)
265 unsigned long start
, size
;
267 start
= vma
->vm_pgoff
+ (fb
->fb
.fix
.smem_start
>> PAGE_SHIFT
);
268 size
= vma
->vm_end
- vma
->vm_start
;
270 return remap_pfn_range(vma
, vma
->vm_start
, start
, size
,
274 static void impd1fb_clcd_remove(struct clcd_fb
*fb
)
276 iounmap(fb
->fb
.screen_base
);
277 release_mem_region(fb
->fb
.fix
.smem_start
, fb
->fb
.fix
.smem_len
);
280 static struct clcd_board impd1_clcd_data
= {
282 .check
= clcdfb_check
,
283 .decode
= clcdfb_decode
,
284 .disable
= impd1fb_clcd_disable
,
285 .enable
= impd1fb_clcd_enable
,
286 .setup
= impd1fb_clcd_setup
,
287 .mmap
= impd1fb_clcd_mmap
,
288 .remove
= impd1fb_clcd_remove
,
291 struct impd1_device
{
292 unsigned long offset
;
298 static struct impd1_device impd1_devs
[] = {
300 .offset
= 0x03000000,
303 .offset
= 0x00100000,
307 .offset
= 0x00200000,
311 .offset
= 0x00300000,
315 .offset
= 0x00400000,
319 .offset
= 0x00500000,
323 .offset
= 0x00600000,
327 .offset
= 0x00700000,
331 .offset
= 0x00800000,
335 .offset
= 0x01000000,
338 .platform_data
= &impd1_clcd_data
,
342 static struct clk fixed_14745600
= {
346 static int impd1_probe(struct lm_device
*dev
)
348 struct impd1_module
*impd1
;
351 if (dev
->id
!= module_id
)
354 if (!request_mem_region(dev
->resource
.start
, SZ_4K
, "LM registers"))
357 impd1
= kzalloc(sizeof(struct impd1_module
), GFP_KERNEL
);
363 impd1
->base
= ioremap(dev
->resource
.start
, SZ_4K
);
369 lm_set_drvdata(dev
, impd1
);
371 printk("IM-PD1 found at 0x%08lx\n",
372 (unsigned long)dev
->resource
.start
);
374 for (i
= 0; i
< ARRAY_SIZE(impd1
->vcos
); i
++) {
375 impd1
->vcos
[i
].ops
= &impd1_clk_ops
,
376 impd1
->vcos
[i
].owner
= THIS_MODULE
,
377 impd1
->vcos
[i
].params
= &impd1_vco_params
,
378 impd1
->vcos
[i
].data
= impd1
;
380 impd1
->vcos
[0].vcoreg
= impd1
->base
+ IMPD1_OSC1
;
381 impd1
->vcos
[1].vcoreg
= impd1
->base
+ IMPD1_OSC2
;
383 impd1
->clks
[0] = clkdev_alloc(&impd1
->vcos
[0], NULL
, "lm%x:01000",
385 impd1
->clks
[1] = clkdev_alloc(&fixed_14745600
, NULL
, "lm%x:00100",
387 impd1
->clks
[2] = clkdev_alloc(&fixed_14745600
, NULL
, "lm%x:00200",
389 for (i
= 0; i
< ARRAY_SIZE(impd1
->clks
); i
++)
390 clkdev_add(impd1
->clks
[i
]);
392 for (i
= 0; i
< ARRAY_SIZE(impd1_devs
); i
++) {
393 struct impd1_device
*idev
= impd1_devs
+ i
;
394 struct amba_device
*d
;
395 unsigned long pc_base
;
397 pc_base
= dev
->resource
.start
+ idev
->offset
;
399 d
= kzalloc(sizeof(struct amba_device
), GFP_KERNEL
);
403 dev_set_name(&d
->dev
, "lm%x:%5.5lx", dev
->id
, idev
->offset
>> 12);
404 d
->dev
.parent
= &dev
->dev
;
405 d
->res
.start
= dev
->resource
.start
+ idev
->offset
;
406 d
->res
.end
= d
->res
.start
+ SZ_4K
- 1;
407 d
->res
.flags
= IORESOURCE_MEM
;
408 d
->irq
[0] = dev
->irq
;
409 d
->irq
[1] = dev
->irq
;
410 d
->periphid
= idev
->id
;
411 d
->dev
.platform_data
= idev
->platform_data
;
413 ret
= amba_device_register(d
, &dev
->resource
);
415 dev_err(&d
->dev
, "unable to register device: %d\n", ret
);
423 if (impd1
&& impd1
->base
)
424 iounmap(impd1
->base
);
427 release_mem_region(dev
->resource
.start
, SZ_4K
);
431 static int impd1_remove_one(struct device
*dev
, void *data
)
433 device_unregister(dev
);
437 static void impd1_remove(struct lm_device
*dev
)
439 struct impd1_module
*impd1
= lm_get_drvdata(dev
);
442 device_for_each_child(&dev
->dev
, NULL
, impd1_remove_one
);
444 for (i
= 0; i
< ARRAY_SIZE(impd1
->clks
); i
++)
445 clkdev_drop(impd1
->clks
[i
]);
447 lm_set_drvdata(dev
, NULL
);
449 iounmap(impd1
->base
);
451 release_mem_region(dev
->resource
.start
, SZ_4K
);
454 static struct lm_driver impd1_driver
= {
458 .probe
= impd1_probe
,
459 .remove
= impd1_remove
,
462 static int __init
impd1_init(void)
464 return lm_driver_register(&impd1_driver
);
467 static void __exit
impd1_exit(void)
469 lm_driver_unregister(&impd1_driver
);
472 module_init(impd1_init
);
473 module_exit(impd1_exit
);
475 MODULE_LICENSE("GPL");
476 MODULE_DESCRIPTION("Integrator/IM-PD1 logic module core driver");
477 MODULE_AUTHOR("Deep Blue Solutions Ltd");