2 * Copyright (C) 2008-2009 MontaVista Software Inc.
3 * Copyright (C) 2008-2009 Texas Instruments Inc
5 * Based on the LCD driver for TI Avalanche processors written by
6 * Ajay Singh and Shalom Hai.
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License as published by
10 * the Free Software Foundation; either version 2 of the License, or
11 * (at your option)any later version.
13 * This program is distributed in the hope that it will be useful,
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16 * GNU General Public License for more details.
18 * You should have received a copy of the GNU General Public License
19 * along with this program; if not, write to the Free Software
20 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
22 #include <linux/module.h>
23 #include <linux/kernel.h>
25 #include <linux/dma-mapping.h>
26 #include <linux/device.h>
27 #include <linux/platform_device.h>
28 #include <linux/uaccess.h>
29 #include <linux/interrupt.h>
30 #include <linux/clk.h>
31 #include <linux/cpufreq.h>
32 #include <video/da8xx-fb.h>
34 #define DRIVER_NAME "da8xx_lcdc"
36 /* LCD Status Register */
37 #define LCD_END_OF_FRAME0 BIT(8)
38 #define LCD_FIFO_UNDERFLOW BIT(5)
39 #define LCD_SYNC_LOST BIT(2)
41 /* LCD DMA Control Register */
42 #define LCD_DMA_BURST_SIZE(x) ((x) << 4)
43 #define LCD_DMA_BURST_1 0x0
44 #define LCD_DMA_BURST_2 0x1
45 #define LCD_DMA_BURST_4 0x2
46 #define LCD_DMA_BURST_8 0x3
47 #define LCD_DMA_BURST_16 0x4
48 #define LCD_END_OF_FRAME_INT_ENA BIT(2)
49 #define LCD_DUAL_FRAME_BUFFER_ENABLE BIT(0)
51 /* LCD Control Register */
52 #define LCD_CLK_DIVISOR(x) ((x) << 8)
53 #define LCD_RASTER_MODE 0x01
55 /* LCD Raster Control Register */
56 #define LCD_PALETTE_LOAD_MODE(x) ((x) << 20)
57 #define PALETTE_AND_DATA 0x00
58 #define PALETTE_ONLY 0x01
60 #define LCD_MONO_8BIT_MODE BIT(9)
61 #define LCD_RASTER_ORDER BIT(8)
62 #define LCD_TFT_MODE BIT(7)
63 #define LCD_UNDERFLOW_INT_ENA BIT(6)
64 #define LCD_MONOCHROME_MODE BIT(1)
65 #define LCD_RASTER_ENABLE BIT(0)
66 #define LCD_TFT_ALT_ENABLE BIT(23)
67 #define LCD_STN_565_ENABLE BIT(24)
69 /* LCD Raster Timing 2 Register */
70 #define LCD_AC_BIAS_TRANSITIONS_PER_INT(x) ((x) << 16)
71 #define LCD_AC_BIAS_FREQUENCY(x) ((x) << 8)
72 #define LCD_SYNC_CTRL BIT(25)
73 #define LCD_SYNC_EDGE BIT(24)
74 #define LCD_INVERT_PIXEL_CLOCK BIT(22)
75 #define LCD_INVERT_LINE_CLOCK BIT(21)
76 #define LCD_INVERT_FRAME_CLOCK BIT(20)
79 #define LCD_CTRL_REG 0x4
80 #define LCD_STAT_REG 0x8
81 #define LCD_RASTER_CTRL_REG 0x28
82 #define LCD_RASTER_TIMING_0_REG 0x2C
83 #define LCD_RASTER_TIMING_1_REG 0x30
84 #define LCD_RASTER_TIMING_2_REG 0x34
85 #define LCD_DMA_CTRL_REG 0x40
86 #define LCD_DMA_FRM_BUF_BASE_ADDR_0_REG 0x44
87 #define LCD_DMA_FRM_BUF_CEILING_ADDR_0_REG 0x48
89 #define WSI_TIMEOUT 50
90 #define PALETTE_SIZE 256
91 #define LEFT_MARGIN 64
92 #define RIGHT_MARGIN 64
93 #define UPPER_MARGIN 32
94 #define LOWER_MARGIN 32
96 static resource_size_t da8xx_fb_reg_base
;
97 static struct resource
*lcdc_regs
;
99 static inline unsigned int lcdc_read(unsigned int addr
)
101 return (unsigned int)__raw_readl(da8xx_fb_reg_base
+ (addr
));
104 static inline void lcdc_write(unsigned int val
, unsigned int addr
)
106 __raw_writel(val
, da8xx_fb_reg_base
+ (addr
));
109 struct da8xx_fb_par
{
110 resource_size_t p_palette_base
;
111 unsigned char *v_palette_base
;
112 struct clk
*lcdc_clk
;
114 unsigned short pseudo_palette
[16];
115 unsigned int databuf_sz
;
116 unsigned int palette_sz
;
117 unsigned int pxl_clk
;
119 #ifdef CONFIG_CPU_FREQ
120 struct notifier_block freq_transition
;
122 void (*panel_power_ctrl
)(int);
125 /* Variable Screen Information */
126 static struct fb_var_screeninfo da8xx_fb_var __devinitdata
= {
134 .pixclock
= 46666, /* 46us - AUO display */
136 .left_margin
= LEFT_MARGIN
,
137 .right_margin
= RIGHT_MARGIN
,
138 .upper_margin
= UPPER_MARGIN
,
139 .lower_margin
= LOWER_MARGIN
,
141 .vmode
= FB_VMODE_NONINTERLACED
144 static struct fb_fix_screeninfo da8xx_fb_fix __devinitdata
= {
145 .id
= "DA8xx FB Drv",
146 .type
= FB_TYPE_PACKED_PIXELS
,
148 .visual
= FB_VISUAL_PSEUDOCOLOR
,
152 .accel
= FB_ACCEL_NONE
156 const char name
[25]; /* Full name <vendor>_<model> */
157 unsigned short width
;
158 unsigned short height
;
159 int hfp
; /* Horizontal front porch */
160 int hbp
; /* Horizontal back porch */
161 int hsw
; /* Horizontal Sync Pulse Width */
162 int vfp
; /* Vertical front porch */
163 int vbp
; /* Vertical back porch */
164 int vsw
; /* Vertical Sync Pulse Width */
165 unsigned int pxl_clk
; /* Pixel clock */
166 unsigned char invert_pxl_clk
; /* Invert Pixel clock */
169 static struct da8xx_panel known_lcd_panels
[] = {
170 /* Sharp LCD035Q3DG01 */
172 .name
= "Sharp_LCD035Q3DG01",
184 /* Sharp LK043T1DG01 */
186 .name
= "Sharp_LK043T1DG01",
200 /* Enable the Raster Engine of the LCD Controller */
201 static inline void lcd_enable_raster(void)
205 reg
= lcdc_read(LCD_RASTER_CTRL_REG
);
206 if (!(reg
& LCD_RASTER_ENABLE
))
207 lcdc_write(reg
| LCD_RASTER_ENABLE
, LCD_RASTER_CTRL_REG
);
210 /* Disable the Raster Engine of the LCD Controller */
211 static inline void lcd_disable_raster(void)
215 reg
= lcdc_read(LCD_RASTER_CTRL_REG
);
216 if (reg
& LCD_RASTER_ENABLE
)
217 lcdc_write(reg
& ~LCD_RASTER_ENABLE
, LCD_RASTER_CTRL_REG
);
220 static void lcd_blit(int load_mode
, struct da8xx_fb_par
*par
)
222 u32 tmp
= par
->p_palette_base
+ par
->databuf_sz
- 4;
225 /* Update the databuf in the hw. */
226 lcdc_write(par
->p_palette_base
, LCD_DMA_FRM_BUF_BASE_ADDR_0_REG
);
227 lcdc_write(tmp
, LCD_DMA_FRM_BUF_CEILING_ADDR_0_REG
);
230 reg
= lcdc_read(LCD_RASTER_CTRL_REG
);
232 if (load_mode
== LOAD_DATA
)
233 reg
|= LCD_PALETTE_LOAD_MODE(PALETTE_AND_DATA
);
234 else if (load_mode
== LOAD_PALETTE
)
235 reg
|= LCD_PALETTE_LOAD_MODE(PALETTE_ONLY
);
237 lcdc_write(reg
, LCD_RASTER_CTRL_REG
);
240 /* Configure the Burst Size of DMA */
241 static int lcd_cfg_dma(int burst_size
)
245 reg
= lcdc_read(LCD_DMA_CTRL_REG
) & 0x00000001;
246 switch (burst_size
) {
248 reg
|= LCD_DMA_BURST_SIZE(LCD_DMA_BURST_1
);
251 reg
|= LCD_DMA_BURST_SIZE(LCD_DMA_BURST_2
);
254 reg
|= LCD_DMA_BURST_SIZE(LCD_DMA_BURST_4
);
257 reg
|= LCD_DMA_BURST_SIZE(LCD_DMA_BURST_8
);
260 reg
|= LCD_DMA_BURST_SIZE(LCD_DMA_BURST_16
);
265 lcdc_write(reg
, LCD_DMA_CTRL_REG
);
270 static void lcd_cfg_ac_bias(int period
, int transitions_per_int
)
274 /* Set the AC Bias Period and Number of Transisitons per Interrupt */
275 reg
= lcdc_read(LCD_RASTER_TIMING_2_REG
) & 0xFFF00000;
276 reg
|= LCD_AC_BIAS_FREQUENCY(period
) |
277 LCD_AC_BIAS_TRANSITIONS_PER_INT(transitions_per_int
);
278 lcdc_write(reg
, LCD_RASTER_TIMING_2_REG
);
281 static void lcd_cfg_horizontal_sync(int back_porch
, int pulse_width
,
286 reg
= lcdc_read(LCD_RASTER_TIMING_0_REG
) & 0xf;
287 reg
|= ((back_porch
& 0xff) << 24)
288 | ((front_porch
& 0xff) << 16)
289 | ((pulse_width
& 0x3f) << 10);
290 lcdc_write(reg
, LCD_RASTER_TIMING_0_REG
);
293 static void lcd_cfg_vertical_sync(int back_porch
, int pulse_width
,
298 reg
= lcdc_read(LCD_RASTER_TIMING_1_REG
) & 0x3ff;
299 reg
|= ((back_porch
& 0xff) << 24)
300 | ((front_porch
& 0xff) << 16)
301 | ((pulse_width
& 0x3f) << 10);
302 lcdc_write(reg
, LCD_RASTER_TIMING_1_REG
);
305 static int lcd_cfg_display(const struct lcd_ctrl_config
*cfg
)
309 reg
= lcdc_read(LCD_RASTER_CTRL_REG
) & ~(LCD_TFT_MODE
|
311 LCD_MONOCHROME_MODE
);
313 switch (cfg
->p_disp_panel
->panel_shade
) {
315 reg
|= LCD_MONOCHROME_MODE
;
316 if (cfg
->mono_8bit_mode
)
317 reg
|= LCD_MONO_8BIT_MODE
;
321 if (cfg
->tft_alt_mode
)
322 reg
|= LCD_TFT_ALT_ENABLE
;
326 if (cfg
->stn_565_mode
)
327 reg
|= LCD_STN_565_ENABLE
;
334 /* enable additional interrupts here */
335 reg
|= LCD_UNDERFLOW_INT_ENA
;
337 lcdc_write(reg
, LCD_RASTER_CTRL_REG
);
339 reg
= lcdc_read(LCD_RASTER_TIMING_2_REG
);
342 reg
|= LCD_SYNC_CTRL
;
344 reg
&= ~LCD_SYNC_CTRL
;
347 reg
|= LCD_SYNC_EDGE
;
349 reg
&= ~LCD_SYNC_EDGE
;
351 if (cfg
->invert_line_clock
)
352 reg
|= LCD_INVERT_LINE_CLOCK
;
354 reg
&= ~LCD_INVERT_LINE_CLOCK
;
356 if (cfg
->invert_frm_clock
)
357 reg
|= LCD_INVERT_FRAME_CLOCK
;
359 reg
&= ~LCD_INVERT_FRAME_CLOCK
;
361 lcdc_write(reg
, LCD_RASTER_TIMING_2_REG
);
366 static int lcd_cfg_frame_buffer(struct da8xx_fb_par
*par
, u32 width
, u32 height
,
367 u32 bpp
, u32 raster_order
)
371 /* Disable Dual Frame Buffer. */
372 reg
= lcdc_read(LCD_DMA_CTRL_REG
);
373 lcdc_write(reg
& ~LCD_DUAL_FRAME_BUFFER_ENABLE
,
375 /* Set the Panel Width */
376 /* Pixels per line = (PPL + 1)*16 */
377 /*0x3F in bits 4..9 gives max horisontal resolution = 1024 pixels*/
379 reg
= lcdc_read(LCD_RASTER_TIMING_0_REG
);
381 reg
|= ((width
>> 4) - 1) << 4;
382 lcdc_write(reg
, LCD_RASTER_TIMING_0_REG
);
384 /* Set the Panel Height */
385 reg
= lcdc_read(LCD_RASTER_TIMING_1_REG
);
386 reg
= ((height
- 1) & 0x3ff) | (reg
& 0xfffffc00);
387 lcdc_write(reg
, LCD_RASTER_TIMING_1_REG
);
389 /* Set the Raster Order of the Frame Buffer */
390 reg
= lcdc_read(LCD_RASTER_CTRL_REG
) & ~(1 << 8);
392 reg
|= LCD_RASTER_ORDER
;
393 lcdc_write(reg
, LCD_RASTER_CTRL_REG
);
400 par
->palette_sz
= 16 * 2;
404 par
->palette_sz
= 256 * 2;
411 bpl
= width
* bpp
/ 8;
412 par
->databuf_sz
= height
* bpl
+ par
->palette_sz
;
417 static int fb_setcolreg(unsigned regno
, unsigned red
, unsigned green
,
418 unsigned blue
, unsigned transp
,
419 struct fb_info
*info
)
421 struct da8xx_fb_par
*par
= info
->par
;
422 unsigned short *palette
= (unsigned short *)par
->v_palette_base
;
428 if (info
->fix
.visual
== FB_VISUAL_DIRECTCOLOR
)
431 if (info
->var
.bits_per_pixel
== 8) {
436 pal
= (red
& 0x0f00);
437 pal
|= (green
& 0x00f0);
438 pal
|= (blue
& 0x000f);
440 palette
[regno
] = pal
;
442 } else if ((info
->var
.bits_per_pixel
== 16) && regno
< 16) {
443 red
>>= (16 - info
->var
.red
.length
);
444 red
<<= info
->var
.red
.offset
;
446 green
>>= (16 - info
->var
.green
.length
);
447 green
<<= info
->var
.green
.offset
;
449 blue
>>= (16 - info
->var
.blue
.length
);
450 blue
<<= info
->var
.blue
.offset
;
452 par
->pseudo_palette
[regno
] = red
| green
| blue
;
460 static void lcd_reset(struct da8xx_fb_par
*par
)
462 /* Disable the Raster if previously Enabled */
463 lcd_disable_raster();
465 /* DMA has to be disabled */
466 lcdc_write(0, LCD_DMA_CTRL_REG
);
467 lcdc_write(0, LCD_RASTER_CTRL_REG
);
470 static void lcd_calc_clk_divider(struct da8xx_fb_par
*par
)
472 unsigned int lcd_clk
, div
;
474 lcd_clk
= clk_get_rate(par
->lcdc_clk
);
475 div
= lcd_clk
/ par
->pxl_clk
;
477 /* Configure the LCD clock divisor. */
478 lcdc_write(LCD_CLK_DIVISOR(div
) |
479 (LCD_RASTER_MODE
& 0x1), LCD_CTRL_REG
);
482 static int lcd_init(struct da8xx_fb_par
*par
, const struct lcd_ctrl_config
*cfg
,
483 struct da8xx_panel
*panel
)
490 /* Calculate the divider */
491 lcd_calc_clk_divider(par
);
493 if (panel
->invert_pxl_clk
)
494 lcdc_write((lcdc_read(LCD_RASTER_TIMING_2_REG
) |
495 LCD_INVERT_PIXEL_CLOCK
), LCD_RASTER_TIMING_2_REG
);
497 lcdc_write((lcdc_read(LCD_RASTER_TIMING_2_REG
) &
498 ~LCD_INVERT_PIXEL_CLOCK
), LCD_RASTER_TIMING_2_REG
);
500 /* Configure the DMA burst size. */
501 ret
= lcd_cfg_dma(cfg
->dma_burst_sz
);
505 /* Configure the AC bias properties. */
506 lcd_cfg_ac_bias(cfg
->ac_bias
, cfg
->ac_bias_intrpt
);
508 /* Configure the vertical and horizontal sync properties. */
509 lcd_cfg_vertical_sync(panel
->vbp
, panel
->vsw
, panel
->vfp
);
510 lcd_cfg_horizontal_sync(panel
->hbp
, panel
->hsw
, panel
->hfp
);
512 /* Configure for disply */
513 ret
= lcd_cfg_display(cfg
);
517 if (QVGA
!= cfg
->p_disp_panel
->panel_type
)
520 if (cfg
->bpp
<= cfg
->p_disp_panel
->max_bpp
&&
521 cfg
->bpp
>= cfg
->p_disp_panel
->min_bpp
)
524 bpp
= cfg
->p_disp_panel
->max_bpp
;
527 ret
= lcd_cfg_frame_buffer(par
, (unsigned int)panel
->width
,
528 (unsigned int)panel
->height
, bpp
,
534 lcdc_write((lcdc_read(LCD_RASTER_CTRL_REG
) & 0xfff00fff) |
535 (cfg
->fdd
<< 12), LCD_RASTER_CTRL_REG
);
540 static irqreturn_t
lcdc_irq_handler(int irq
, void *arg
)
542 u32 stat
= lcdc_read(LCD_STAT_REG
);
544 if ((stat
& LCD_SYNC_LOST
) && (stat
& LCD_FIFO_UNDERFLOW
)) {
545 lcd_disable_raster();
546 lcdc_write(stat
, LCD_STAT_REG
);
549 lcdc_write(stat
, LCD_STAT_REG
);
554 static int fb_check_var(struct fb_var_screeninfo
*var
,
555 struct fb_info
*info
)
559 switch (var
->bits_per_pixel
) {
564 var
->green
.offset
= 0;
565 var
->green
.length
= 8;
566 var
->blue
.offset
= 0;
567 var
->blue
.length
= 8;
568 var
->transp
.offset
= 0;
569 var
->transp
.length
= 0;
574 var
->green
.offset
= 0;
575 var
->green
.length
= 4;
576 var
->blue
.offset
= 0;
577 var
->blue
.length
= 4;
578 var
->transp
.offset
= 0;
579 var
->transp
.length
= 0;
581 case 16: /* RGB 565 */
582 var
->red
.offset
= 11;
584 var
->green
.offset
= 5;
585 var
->green
.length
= 6;
586 var
->blue
.offset
= 0;
587 var
->blue
.length
= 5;
588 var
->transp
.offset
= 0;
589 var
->transp
.length
= 0;
595 var
->red
.msb_right
= 0;
596 var
->green
.msb_right
= 0;
597 var
->blue
.msb_right
= 0;
598 var
->transp
.msb_right
= 0;
602 #ifdef CONFIG_CPU_FREQ
603 static int lcd_da8xx_cpufreq_transition(struct notifier_block
*nb
,
604 unsigned long val
, void *data
)
606 struct da8xx_fb_par
*par
;
608 par
= container_of(nb
, struct da8xx_fb_par
, freq_transition
);
609 if (val
== CPUFREQ_PRECHANGE
) {
610 lcd_disable_raster();
611 } else if (val
== CPUFREQ_POSTCHANGE
) {
612 lcd_calc_clk_divider(par
);
619 static inline int lcd_da8xx_cpufreq_register(struct da8xx_fb_par
*par
)
621 par
->freq_transition
.notifier_call
= lcd_da8xx_cpufreq_transition
;
623 return cpufreq_register_notifier(&par
->freq_transition
,
624 CPUFREQ_TRANSITION_NOTIFIER
);
627 static inline void lcd_da8xx_cpufreq_deregister(struct da8xx_fb_par
*par
)
629 cpufreq_unregister_notifier(&par
->freq_transition
,
630 CPUFREQ_TRANSITION_NOTIFIER
);
634 static int __devexit
fb_remove(struct platform_device
*dev
)
636 struct fb_info
*info
= dev_get_drvdata(&dev
->dev
);
639 struct da8xx_fb_par
*par
= info
->par
;
641 #ifdef CONFIG_CPU_FREQ
642 lcd_da8xx_cpufreq_deregister(par
);
644 if (par
->panel_power_ctrl
)
645 par
->panel_power_ctrl(0);
647 lcd_disable_raster();
648 lcdc_write(0, LCD_RASTER_CTRL_REG
);
651 lcdc_write(0, LCD_DMA_CTRL_REG
);
653 unregister_framebuffer(info
);
654 fb_dealloc_cmap(&info
->cmap
);
655 dma_free_coherent(NULL
, par
->databuf_sz
+ PAGE_SIZE
,
656 info
->screen_base
- PAGE_SIZE
,
657 info
->fix
.smem_start
);
658 free_irq(par
->irq
, par
);
659 clk_disable(par
->lcdc_clk
);
660 clk_put(par
->lcdc_clk
);
661 framebuffer_release(info
);
662 iounmap((void __iomem
*)da8xx_fb_reg_base
);
663 release_mem_region(lcdc_regs
->start
, resource_size(lcdc_regs
));
669 static int fb_ioctl(struct fb_info
*info
, unsigned int cmd
,
672 struct lcd_sync_arg sync_arg
;
675 case FBIOGET_CONTRAST
:
676 case FBIOPUT_CONTRAST
:
677 case FBIGET_BRIGHTNESS
:
678 case FBIPUT_BRIGHTNESS
:
683 if (copy_from_user(&sync_arg
, (char *)arg
,
684 sizeof(struct lcd_sync_arg
)))
686 lcd_cfg_horizontal_sync(sync_arg
.back_porch
,
687 sync_arg
.pulse_width
,
688 sync_arg
.front_porch
);
691 if (copy_from_user(&sync_arg
, (char *)arg
,
692 sizeof(struct lcd_sync_arg
)))
694 lcd_cfg_vertical_sync(sync_arg
.back_porch
,
695 sync_arg
.pulse_width
,
696 sync_arg
.front_porch
);
704 static struct fb_ops da8xx_fb_ops
= {
705 .owner
= THIS_MODULE
,
706 .fb_check_var
= fb_check_var
,
707 .fb_setcolreg
= fb_setcolreg
,
708 .fb_ioctl
= fb_ioctl
,
709 .fb_fillrect
= cfb_fillrect
,
710 .fb_copyarea
= cfb_copyarea
,
711 .fb_imageblit
= cfb_imageblit
,
714 static int __init
fb_probe(struct platform_device
*device
)
716 struct da8xx_lcdc_platform_data
*fb_pdata
=
717 device
->dev
.platform_data
;
718 struct lcd_ctrl_config
*lcd_cfg
;
719 struct da8xx_panel
*lcdc_info
;
720 struct fb_info
*da8xx_fb_info
;
721 struct clk
*fb_clk
= NULL
;
722 struct da8xx_fb_par
*par
;
726 if (fb_pdata
== NULL
) {
727 dev_err(&device
->dev
, "Can not get platform data\n");
731 lcdc_regs
= platform_get_resource(device
, IORESOURCE_MEM
, 0);
733 dev_err(&device
->dev
,
734 "Can not get memory resource for LCD controller\n");
738 len
= resource_size(lcdc_regs
);
740 lcdc_regs
= request_mem_region(lcdc_regs
->start
, len
, lcdc_regs
->name
);
744 da8xx_fb_reg_base
= (resource_size_t
)ioremap(lcdc_regs
->start
, len
);
745 if (!da8xx_fb_reg_base
) {
747 goto err_request_mem
;
750 fb_clk
= clk_get(&device
->dev
, NULL
);
751 if (IS_ERR(fb_clk
)) {
752 dev_err(&device
->dev
, "Can not get device clock\n");
756 ret
= clk_enable(fb_clk
);
760 for (i
= 0, lcdc_info
= known_lcd_panels
;
761 i
< ARRAY_SIZE(known_lcd_panels
);
763 if (strcmp(fb_pdata
->type
, lcdc_info
->name
) == 0)
767 if (i
== ARRAY_SIZE(known_lcd_panels
)) {
768 dev_err(&device
->dev
, "GLCD: No valid panel found\n");
770 goto err_clk_disable
;
772 dev_info(&device
->dev
, "GLCD: Found %s panel\n",
775 lcd_cfg
= (struct lcd_ctrl_config
*)fb_pdata
->controller_data
;
777 da8xx_fb_info
= framebuffer_alloc(sizeof(struct da8xx_fb_par
),
779 if (!da8xx_fb_info
) {
780 dev_dbg(&device
->dev
, "Memory allocation failed for fb_info\n");
782 goto err_clk_disable
;
785 par
= da8xx_fb_info
->par
;
786 par
->lcdc_clk
= fb_clk
;
787 par
->pxl_clk
= lcdc_info
->pxl_clk
;
788 if (fb_pdata
->panel_power_ctrl
) {
789 par
->panel_power_ctrl
= fb_pdata
->panel_power_ctrl
;
790 par
->panel_power_ctrl(1);
793 if (lcd_init(par
, lcd_cfg
, lcdc_info
) < 0) {
794 dev_err(&device
->dev
, "lcd_init failed\n");
799 /* allocate frame buffer */
800 da8xx_fb_info
->screen_base
= dma_alloc_coherent(NULL
,
801 par
->databuf_sz
+ PAGE_SIZE
,
803 &da8xx_fb_info
->fix
.smem_start
,
804 GFP_KERNEL
| GFP_DMA
);
806 if (!da8xx_fb_info
->screen_base
) {
807 dev_err(&device
->dev
,
808 "GLCD: kmalloc for frame buffer failed\n");
813 /* move palette base pointer by (PAGE_SIZE - palette_sz) bytes */
814 par
->v_palette_base
= da8xx_fb_info
->screen_base
+
815 (PAGE_SIZE
- par
->palette_sz
);
816 par
->p_palette_base
= da8xx_fb_info
->fix
.smem_start
+
817 (PAGE_SIZE
- par
->palette_sz
);
819 /* the rest of the frame buffer is pixel data */
820 da8xx_fb_info
->screen_base
= par
->v_palette_base
+ par
->palette_sz
;
821 da8xx_fb_fix
.smem_start
= par
->p_palette_base
+ par
->palette_sz
;
822 da8xx_fb_fix
.smem_len
= par
->databuf_sz
- par
->palette_sz
;
823 da8xx_fb_fix
.line_length
= (lcdc_info
->width
* lcd_cfg
->bpp
) / 8;
825 par
->irq
= platform_get_irq(device
, 0);
828 goto err_release_fb_mem
;
831 ret
= request_irq(par
->irq
, lcdc_irq_handler
, 0, DRIVER_NAME
, par
);
833 goto err_release_fb_mem
;
836 da8xx_fb_info
->var
.bits_per_pixel
= lcd_cfg
->bpp
;
838 da8xx_fb_var
.xres
= lcdc_info
->width
;
839 da8xx_fb_var
.xres_virtual
= lcdc_info
->width
;
841 da8xx_fb_var
.yres
= lcdc_info
->height
;
842 da8xx_fb_var
.yres_virtual
= lcdc_info
->height
;
844 da8xx_fb_var
.grayscale
=
845 lcd_cfg
->p_disp_panel
->panel_shade
== MONOCHROME
? 1 : 0;
846 da8xx_fb_var
.bits_per_pixel
= lcd_cfg
->bpp
;
848 da8xx_fb_var
.hsync_len
= lcdc_info
->hsw
;
849 da8xx_fb_var
.vsync_len
= lcdc_info
->vsw
;
851 /* Initialize fbinfo */
852 da8xx_fb_info
->flags
= FBINFO_FLAG_DEFAULT
;
853 da8xx_fb_info
->fix
= da8xx_fb_fix
;
854 da8xx_fb_info
->var
= da8xx_fb_var
;
855 da8xx_fb_info
->fbops
= &da8xx_fb_ops
;
856 da8xx_fb_info
->pseudo_palette
= par
->pseudo_palette
;
857 da8xx_fb_info
->fix
.visual
= (da8xx_fb_info
->var
.bits_per_pixel
<= 8) ?
858 FB_VISUAL_PSEUDOCOLOR
: FB_VISUAL_TRUECOLOR
;
860 ret
= fb_alloc_cmap(&da8xx_fb_info
->cmap
, PALETTE_SIZE
, 0);
864 /* First palette_sz byte of the frame buffer is the palette */
865 da8xx_fb_info
->cmap
.len
= par
->palette_sz
;
867 /* Flush the buffer to the screen. */
868 lcd_blit(LOAD_DATA
, par
);
870 /* initialize var_screeninfo */
871 da8xx_fb_var
.activate
= FB_ACTIVATE_FORCE
;
872 fb_set_var(da8xx_fb_info
, &da8xx_fb_var
);
874 dev_set_drvdata(&device
->dev
, da8xx_fb_info
);
875 /* Register the Frame Buffer */
876 if (register_framebuffer(da8xx_fb_info
) < 0) {
877 dev_err(&device
->dev
,
878 "GLCD: Frame Buffer Registration Failed!\n");
880 goto err_dealloc_cmap
;
883 #ifdef CONFIG_CPU_FREQ
884 ret
= lcd_da8xx_cpufreq_register(par
);
886 dev_err(&device
->dev
, "failed to register cpufreq\n");
891 /* enable raster engine */
896 #ifdef CONFIG_CPU_FREQ
898 unregister_framebuffer(da8xx_fb_info
);
902 fb_dealloc_cmap(&da8xx_fb_info
->cmap
);
905 free_irq(par
->irq
, par
);
908 dma_free_coherent(NULL
, par
->databuf_sz
+ PAGE_SIZE
,
909 da8xx_fb_info
->screen_base
- PAGE_SIZE
,
910 da8xx_fb_info
->fix
.smem_start
);
913 framebuffer_release(da8xx_fb_info
);
922 iounmap((void __iomem
*)da8xx_fb_reg_base
);
925 release_mem_region(lcdc_regs
->start
, len
);
931 static int fb_suspend(struct platform_device
*dev
, pm_message_t state
)
935 static int fb_resume(struct platform_device
*dev
)
940 #define fb_suspend NULL
941 #define fb_resume NULL
944 static struct platform_driver da8xx_fb_driver
= {
947 .suspend
= fb_suspend
,
951 .owner
= THIS_MODULE
,
955 static int __init
da8xx_fb_init(void)
957 return platform_driver_register(&da8xx_fb_driver
);
960 static void __exit
da8xx_fb_cleanup(void)
962 platform_driver_unregister(&da8xx_fb_driver
);
965 module_init(da8xx_fb_init
);
966 module_exit(da8xx_fb_cleanup
);
968 MODULE_DESCRIPTION("Framebuffer driver for TI da8xx/omap-l1xx");
969 MODULE_AUTHOR("Texas Instruments");
970 MODULE_LICENSE("GPL");