2 * Copyright (C) 2009, Lars-Peter Clausen <lars@metafoo.de>
3 * JZ4720/JZ4740 SoC LCD framebuffer driver
5 * This program is free software; you can redistribute it and/or modify it
6 * under the terms of the GNU General Public License as published by the
7 * Free Software Foundation; either version 2 of the License, or (at your
8 * option) any later version.
10 * You should have received a copy of the GNU General Public License along
11 * with this program; if not, write to the Free Software Foundation, Inc.,
12 * 675 Mass Ave, Cambridge, MA 02139, USA.
16 #include <linux/types.h>
17 #include <linux/platform_device.h>
19 #include <linux/module.h>
20 #include <linux/dma-mapping.h>
21 #include <linux/jz4740_fb.h>
23 #include <linux/delay.h>
24 #include <linux/clk.h>
26 #include <asm/mach-jz4740/gpio.h>
28 #define JZ_REG_LCD_CFG 0x00
29 #define JZ_REG_LCD_VSYNC 0x04
30 #define JZ_REG_LCD_HSYNC 0x08
31 #define JZ_REG_LCD_VAT 0x0C
32 #define JZ_REG_LCD_DAH 0x10
33 #define JZ_REG_LCD_DAV 0x14
34 #define JZ_REG_LCD_PS 0x18
35 #define JZ_REG_LCD_CLS 0x1C
36 #define JZ_REG_LCD_SPL 0x20
37 #define JZ_REG_LCD_REV 0x24
38 #define JZ_REG_LCD_CTRL 0x30
39 #define JZ_REG_LCD_STATE 0x34
40 #define JZ_REG_LCD_IID 0x38
41 #define JZ_REG_LCD_DA0 0x40
42 #define JZ_REG_LCD_SA0 0x44
43 #define JZ_REG_LCD_FID0 0x48
44 #define JZ_REG_LCD_CMD0 0x4C
45 #define JZ_REG_LCD_DA1 0x50
46 #define JZ_REG_LCD_SA1 0x54
47 #define JZ_REG_LCD_FID1 0x58
48 #define JZ_REG_LCD_CMD1 0x5C
50 #define JZ_LCD_CFG_SLCD BIT(31)
51 #define JZ_LCD_CFG_PSM BIT(23)
52 #define JZ_LCD_CFG_CLSM BIT(22)
53 #define JZ_LCD_CFG_SPLM BIT(21)
54 #define JZ_LCD_CFG_REVM BIT(20)
55 #define JZ_LCD_CFG_HSYNCM BIT(19)
56 #define JZ_LCD_CFG_PCLKM BIT(18)
57 #define JZ_LCD_CFG_INV BIT(17)
58 #define JZ_LCD_CFG_SYNC_DIR BIT(16)
59 #define JZ_LCD_CFG_PSP BIT(15)
60 #define JZ_LCD_CFG_CLSP BIT(14)
61 #define JZ_LCD_CFG_SPLP BIT(13)
62 #define JZ_LCD_CFG_REVP BIT(12)
63 #define JZ_LCD_CFG_HSYNCP BIT(11)
64 #define JZ_LCD_CFG_PCLKP BIT(10)
65 #define JZ_LCD_CFG_DEP BIT(9)
66 #define JZ_LCD_CFG_VSYNCP BIT(8)
67 #define JZ_LCD_CFG_18_BIT BIT(7)
68 #define JZ_LCD_CFG_PDW BIT(5) | BIT(4)
69 #define JZ_LCD_CFG_MODE_MASK 0xf
71 #define JZ_LCD_CTRL_BURST_4 (0x0 << 28)
72 #define JZ_LCD_CTRL_BURST_8 (0x1 << 28)
73 #define JZ_LCD_CTRL_BURST_16 (0x2 << 28)
74 #define JZ_LCD_CTRL_RGB555 BIT(27)
75 #define JZ_LCD_CTRL_OFUP BIT(26)
76 #define JZ_LCD_CTRL_FRC_GRAYSCALE_16 (0x0 << 24)
77 #define JZ_LCD_CTRL_FRC_GRAYSCALE_4 (0x1 << 24)
78 #define JZ_LCD_CTRL_FRC_GRAYSCALE_2 (0x2 << 24)
79 #define JZ_LCD_CTRL_PDD_MASK (0xff << 16)
80 #define JZ_LCD_CTRL_EOF_IRQ BIT(13)
81 #define JZ_LCD_CTRL_SOF_IRQ BIT(12)
82 #define JZ_LCD_CTRL_OFU_IRQ BIT(11)
83 #define JZ_LCD_CTRL_IFU0_IRQ BIT(10)
84 #define JZ_LCD_CTRL_IFU1_IRQ BIT(9)
85 #define JZ_LCD_CTRL_DD_IRQ BIT(8)
86 #define JZ_LCD_CTRL_QDD_IRQ BIT(7)
87 #define JZ_LCD_CTRL_REVERSE_ENDIAN BIT(6)
88 #define JZ_LCD_CTRL_LSB_FISRT BIT(5)
89 #define JZ_LCD_CTRL_DISABLE BIT(4)
90 #define JZ_LCD_CTRL_ENABLE BIT(3)
91 #define JZ_LCD_CTRL_BPP_1 0x0
92 #define JZ_LCD_CTRL_BPP_2 0x1
93 #define JZ_LCD_CTRL_BPP_4 0x2
94 #define JZ_LCD_CTRL_BPP_8 0x3
95 #define JZ_LCD_CTRL_BPP_15_16 0x4
96 #define JZ_LCD_CTRL_BPP_18_24 0x5
98 #define JZ_LCD_CMD_SOF_IRQ BIT(15)
99 #define JZ_LCD_CMD_EOF_IRQ BIT(16)
100 #define JZ_LCD_CMD_ENABLE_PAL BIT(12)
102 #define JZ_LCD_SYNC_MASK 0x3ff
104 #define JZ_LCD_STATE_DISABLED BIT(0)
106 struct jzfb_framedesc
{
111 } __attribute__((packed
));
115 struct platform_device
*pdev
;
117 struct resource
*mem
;
118 struct jz4740_fb_platform_data
*pdata
;
122 dma_addr_t devmem_phys
;
125 dma_addr_t vidmem_phys
;
126 struct jzfb_framedesc
*framedesc
;
131 uint32_t pseudo_palette
[16];
132 unsigned is_enabled
:1;
135 static struct fb_fix_screeninfo jzfb_fix __devinitdata
= {
137 .type
= FB_TYPE_PACKED_PIXELS
,
138 .visual
= FB_VISUAL_TRUECOLOR
,
142 .accel
= FB_ACCEL_NONE
,
145 const static struct jz_gpio_bulk_request jz_lcd_pins
[] = {
146 JZ_GPIO_BULK_PIN(LCD_PCLK
),
147 JZ_GPIO_BULK_PIN(LCD_HSYNC
),
148 JZ_GPIO_BULK_PIN(LCD_VSYNC
),
149 JZ_GPIO_BULK_PIN(LCD_DATA0
),
150 JZ_GPIO_BULK_PIN(LCD_DATA1
),
151 JZ_GPIO_BULK_PIN(LCD_DATA2
),
152 JZ_GPIO_BULK_PIN(LCD_DATA3
),
153 JZ_GPIO_BULK_PIN(LCD_DATA4
),
154 JZ_GPIO_BULK_PIN(LCD_DATA5
),
155 JZ_GPIO_BULK_PIN(LCD_DATA6
),
156 JZ_GPIO_BULK_PIN(LCD_DATA7
),
160 int jzfb_setcolreg(unsigned regno
, unsigned red
, unsigned green
, unsigned blue
,
161 unsigned transp
, struct fb_info
*fb
)
163 ((uint32_t*)fb
->pseudo_palette
)[regno
] = red
<< 16 | green
<< 8 | blue
;
167 static int jzfb_get_controller_bpp(struct jzfb
*jzfb
)
169 switch(jzfb
->pdata
->bpp
) {
174 return jzfb
->pdata
->bpp
;
178 static int jzfb_check_var(struct fb_var_screeninfo
*var
, struct fb_info
*fb
)
180 struct jzfb
* jzfb
= fb
->par
;
181 struct fb_videomode
*mode
= jzfb
->pdata
->modes
;
184 if (fb
->var
.bits_per_pixel
!= jzfb_get_controller_bpp(jzfb
) &&
185 fb
->var
.bits_per_pixel
!= jzfb
->pdata
->bpp
)
188 for (i
= 0; i
< jzfb
->pdata
->num_modes
; ++i
, ++mode
) {
189 if (mode
->xres
== fb
->var
.xres
&& mode
->yres
== fb
->var
.yres
)
193 if (i
== jzfb
->pdata
->num_modes
)
196 fb_videomode_to_var(&fb
->var
, fb
->mode
);
198 switch (jzfb
->pdata
->bpp
) {
202 var
->red
.offset
= 10;
204 var
->green
.offset
= 6;
205 var
->green
.length
= 5;
206 var
->blue
.offset
= 0;
207 var
->blue
.length
= 5;
210 var
->red
.offset
= 11;
212 var
->green
.offset
= 6;
213 var
->green
.length
= 6;
214 var
->blue
.offset
= 0;
215 var
->blue
.length
= 5;
218 var
->red
.offset
= 16;
220 var
->green
.offset
= 8;
221 var
->green
.length
= 6;
222 var
->blue
.offset
= 0;
223 var
->blue
.length
= 6;
224 fb
->var
.bits_per_pixel
= 32;
228 var
->transp
.offset
= 24;
229 var
->transp
.length
= 8;
230 var
->red
.offset
= 16;
232 var
->green
.offset
= 8;
233 var
->green
.length
= 8;
234 var
->blue
.offset
= 0;
235 var
->blue
.length
= 8;
236 fb
->var
.bits_per_pixel
= 32;
245 static int jzfb_set_par(struct fb_info
*info
)
247 struct jzfb
* jzfb
= info
->par
;
248 struct fb_var_screeninfo
*var
= &info
->var
;
254 hds
= var
->hsync_len
+ var
->left_margin
;
255 hde
= hds
+ var
->xres
;
256 ht
= hde
+ var
->right_margin
;
258 vds
= var
->vsync_len
+ var
->upper_margin
;
259 vde
= vds
+ var
->yres
;
260 vt
= vde
+ var
->lower_margin
;
262 writel(var
->hsync_len
, jzfb
->base
+ JZ_REG_LCD_HSYNC
);
263 writel(var
->vsync_len
, jzfb
->base
+ JZ_REG_LCD_VSYNC
);
265 writel((ht
<< 16) | vt
, jzfb
->base
+ JZ_REG_LCD_VAT
);
267 writel((hds
<< 16) | hde
, jzfb
->base
+ JZ_REG_LCD_DAH
);
268 writel((vds
<< 16) | vde
, jzfb
->base
+ JZ_REG_LCD_DAV
);
270 ctrl
= JZ_LCD_CTRL_OFUP
| JZ_LCD_CTRL_BURST_16
;
271 ctrl
|= JZ_LCD_CTRL_ENABLE
;
273 switch (jzfb
->pdata
->bpp
) {
275 ctrl
|= JZ_LCD_CTRL_BPP_1
;
278 ctrl
|= JZ_LCD_CTRL_BPP_2
;
281 ctrl
|= JZ_LCD_CTRL_BPP_4
;
284 ctrl
|= JZ_LCD_CTRL_BPP_8
;
287 ctrl
|= JZ_LCD_CTRL_RGB555
; /* Falltrough */
289 ctrl
|= JZ_LCD_CTRL_BPP_15_16
;
294 ctrl
|= JZ_LCD_CTRL_BPP_18_24
;
299 writel(ctrl
, jzfb
->base
+ JZ_REG_LCD_CTRL
);
304 static int jzfb_blank(int blank_mode
, struct fb_info
*info
)
306 struct jzfb
* jzfb
= info
->par
;
309 switch (blank_mode
) {
310 case FB_BLANK_UNBLANK
:
311 if (jzfb
->is_enabled
)
314 jz_gpio_bulk_resume(jz_lcd_pins
, ARRAY_SIZE(jz_lcd_pins
));
315 clk_enable(jzfb
->lpclk
);
317 writel(0, jzfb
->base
+ JZ_REG_LCD_STATE
);
319 writel(jzfb
->framedesc
->next
, jzfb
->base
+ JZ_REG_LCD_DA0
);
321 ctrl
= readl(jzfb
->base
+ JZ_REG_LCD_CTRL
);
322 ctrl
|= JZ_LCD_CTRL_ENABLE
;
323 ctrl
&= ~JZ_LCD_CTRL_DISABLE
;
324 writel(ctrl
, jzfb
->base
+ JZ_REG_LCD_CTRL
);
326 jzfb
->is_enabled
= 1;
329 if (!jzfb
->is_enabled
)
332 ctrl
= readl(jzfb
->base
+ JZ_REG_LCD_CTRL
);
333 ctrl
|= JZ_LCD_CTRL_DISABLE
;
334 writel(ctrl
, jzfb
->base
+ JZ_REG_LCD_CTRL
);
336 ctrl
= readl(jzfb
->base
+ JZ_REG_LCD_STATE
);
337 } while (!(ctrl
& JZ_LCD_STATE_DISABLED
));
339 clk_disable(jzfb
->lpclk
);
340 jz_gpio_bulk_suspend(jz_lcd_pins
, ARRAY_SIZE(jz_lcd_pins
));
341 jzfb
->is_enabled
= 0;
349 static int jzfb_alloc_vidmem(struct jzfb
*jzfb
)
352 int max_videosize
= 0;
353 struct fb_videomode
*mode
= jzfb
->pdata
->modes
;
354 struct jzfb_framedesc
*framedesc
;
358 for (i
= 0; i
< jzfb
->pdata
->num_modes
; ++mode
, ++i
) {
359 if (max_videosize
< mode
->xres
* mode
->yres
)
360 max_videosize
= mode
->xres
* mode
->yres
;
363 max_videosize
*= jzfb_get_controller_bpp(jzfb
) >> 3;
365 devmem_size
= max_videosize
+ sizeof(struct jzfb_framedesc
);
367 jzfb
->devmem_size
= devmem_size
;
368 jzfb
->devmem
= dma_alloc_coherent(&jzfb
->pdev
->dev
,
369 PAGE_ALIGN(devmem_size
),
370 &jzfb
->devmem_phys
, GFP_KERNEL
);
376 for (page
= jzfb
->vidmem
;
377 page
< jzfb
->vidmem
+ PAGE_ALIGN(jzfb
->vidmem_size
);
379 SetPageReserved(virt_to_page(page
));
383 framedesc
= jzfb
->devmem
+ max_videosize
;
384 jzfb
->vidmem
= jzfb
->devmem
;
385 jzfb
->vidmem_phys
= jzfb
->devmem_phys
;
387 framedesc
->next
= jzfb
->devmem_phys
+ max_videosize
;
388 framedesc
->addr
= jzfb
->devmem_phys
;
391 framedesc
->cmd
|= max_videosize
/ 4;
393 jzfb
->framedesc
= framedesc
;
399 static void jzfb_free_devmem(struct jzfb
*jzfb
)
401 dma_free_coherent(&jzfb
->pdev
->dev
, jzfb
->devmem_size
, jzfb
->devmem
,
405 static struct fb_ops jzfb_ops
= {
406 .owner
= THIS_MODULE
,
407 .fb_check_var
= jzfb_check_var
,
408 .fb_set_par
= jzfb_set_par
,
409 .fb_blank
= jzfb_blank
,
410 .fb_fillrect
= sys_fillrect
,
411 .fb_copyarea
= sys_copyarea
,
412 .fb_imageblit
= sys_imageblit
,
413 .fb_setcolreg
= jzfb_setcolreg
,
416 static int __devinit
jzfb_probe(struct platform_device
*pdev
)
421 struct jz4740_fb_platform_data
*pdata
= pdev
->dev
.platform_data
;
422 struct resource
*mem
;
425 dev_err(&pdev
->dev
, "Missing platform data\n");
429 mem
= platform_get_resource(pdev
, IORESOURCE_MEM
, 0);
432 dev_err(&pdev
->dev
, "Failed to get register memory resource\n");
436 mem
= request_mem_region(mem
->start
, resource_size(mem
), pdev
->name
);
439 dev_err(&pdev
->dev
, "Failed to request register memory region\n");
444 fb
= framebuffer_alloc(sizeof(struct jzfb
), &pdev
->dev
);
447 dev_err(&pdev
->dev
, "Failed to allocate framebuffer device\n");
449 goto err_release_mem_region
;
452 fb
->fbops
= &jzfb_ops
;
453 fb
->flags
= FBINFO_DEFAULT
;
460 jzfb
->ldclk
= clk_get(&pdev
->dev
, "lcd");
461 jzfb
->lpclk
= clk_get(&pdev
->dev
, "lcd_pclk");
463 jzfb
->is_enabled
= 1;
465 if (IS_ERR(jzfb
->ldclk
)) {
466 ret
= PTR_ERR(jzfb
->ldclk
);
467 dev_err(&pdev
->dev
, "Faild to get device clock: %d\n", ret
);
468 goto err_framebuffer_release
;
471 if (IS_ERR(jzfb
->lpclk
)) {
472 ret
= PTR_ERR(jzfb
->ldclk
);
473 dev_err(&pdev
->dev
, "Faild to get pixel clock: %d\n", ret
);
474 goto err_framebuffer_release
;
478 jzfb
->base
= ioremap(mem
->start
, resource_size(mem
));
481 dev_err(&pdev
->dev
, "Failed to ioremap register memory region\n");
483 goto err_framebuffer_release
;
486 platform_set_drvdata(pdev
, jzfb
);
488 fb_videomode_to_modelist(pdata
->modes
, pdata
->num_modes
,
490 fb
->mode
= pdata
->modes
;
492 fb_videomode_to_var(&fb
->var
, fb
->mode
);
493 fb
->var
.bits_per_pixel
= pdata
->bpp
;
494 jzfb_check_var(&fb
->var
, fb
);
496 ret
= jzfb_alloc_vidmem(jzfb
);
498 dev_err(&pdev
->dev
, "Failed to allocate video memory\n");
503 fb
->fix
.line_length
= fb
->var
.bits_per_pixel
* fb
->var
.xres
/ 8;
504 fb
->fix
.mmio_start
= mem
->start
;
505 fb
->fix
.mmio_len
= resource_size(mem
);
506 fb
->fix
.smem_start
= jzfb
->vidmem_phys
;
507 fb
->fix
.smem_len
= fb
->fix
.line_length
* fb
->var
.yres
;
508 fb
->screen_base
= jzfb
->vidmem
;
509 fb
->pseudo_palette
= jzfb
->pseudo_palette
;
511 fb_alloc_cmap(&fb
->cmap
, 256, 0);
513 clk_enable(jzfb
->ldclk
);
516 writel(jzfb
->framedesc
->next
, jzfb
->base
+ JZ_REG_LCD_DA0
);
518 jz_gpio_bulk_request(jz_lcd_pins
, ARRAY_SIZE(jz_lcd_pins
));
520 ret
= register_framebuffer(fb
);
522 dev_err(&pdev
->dev
, "Failed to register framebuffer: %d\n", ret
);
523 goto err_free_devmem
;
528 jzfb_free_devmem(jzfb
);
531 err_framebuffer_release
:
532 framebuffer_release(fb
);
533 err_release_mem_region
:
534 release_mem_region(mem
->start
, resource_size(mem
));
538 static int __devexit
jzfb_remove(struct platform_device
*pdev
)
540 struct jzfb
*jzfb
= platform_get_drvdata(pdev
);
542 jz_gpio_bulk_free(jz_lcd_pins
, ARRAY_SIZE(jz_lcd_pins
));
544 release_mem_region(jzfb
->mem
->start
, resource_size(jzfb
->mem
));
545 jzfb_free_devmem(jzfb
);
546 platform_set_drvdata(pdev
, NULL
);
547 framebuffer_release(jzfb
->fb
);
553 static int jzfb_suspend(struct device
*dev
)
555 struct jzfb
*jzfb
= dev_get_drvdata(dev
);
556 clk_disable(jzfb
->ldclk
);
561 static int jzfb_resume(struct device
*dev
)
563 struct jzfb
*jzfb
= dev_get_drvdata(dev
);
564 clk_enable(jzfb
->ldclk
);
569 static const struct dev_pm_ops jzfb_pm_ops
= {
570 .suspend
= jzfb_suspend
,
571 .resume
= jzfb_resume
,
572 .poweroff
= jzfb_suspend
,
573 .restore
= jzfb_resume
,
576 #define JZFB_PM_OPS (&jzfb_pm_ops)
579 #define JZFB_PM_OPS NULL
582 static struct platform_driver jzfb_driver
= {
584 .remove
= __devexit_p(jzfb_remove
),
592 int __init
jzfb_init(void)
594 return platform_driver_register(&jzfb_driver
);
596 module_init(jzfb_init
);
598 void __exit
jzfb_exit(void)
600 platform_driver_unregister(&jzfb_driver
);
602 module_exit(jzfb_exit
);
604 MODULE_LICENSE("GPL");
605 MODULE_AUTHOR("Lars-Peter Clausen <lars@metafoo.de>");
606 MODULE_DESCRIPTION("JZ4720/JZ4740 SoC LCD framebuffer driver");
607 MODULE_ALIAS("platform:jz4740-fb");
608 MODULE_ALIAS("platform:jz4720-fb");