Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /* |
2 | * BRIEF MODULE DESCRIPTION | |
3 | * Au1100 LCD Driver. | |
4 | * | |
3b495f2b PP |
5 | * Rewritten for 2.6 by Embedded Alley Solutions |
6 | * <source@embeddedalley.com>, based on submissions by | |
7 | * Karl Lessard <klessard@sunrisetelecom.com> | |
8 | * <c.pellegrin@exadron.com> | |
9 | * | |
f77f50ca | 10 | * PM support added by Rodolfo Giometti <giometti@linux.it> |
ca27ac4c | 11 | * Cursor enable/disable by Rodolfo Giometti <giometti@linux.it> |
f77f50ca | 12 | * |
1da177e4 LT |
13 | * Copyright 2002 MontaVista Software |
14 | * Author: MontaVista Software, Inc. | |
15 | * ppopov@mvista.com or source@mvista.com | |
16 | * | |
17 | * Copyright 2002 Alchemy Semiconductor | |
18 | * Author: Alchemy Semiconductor | |
19 | * | |
20 | * Based on: | |
21 | * linux/drivers/video/skeletonfb.c -- Skeleton for a frame buffer device | |
22 | * Created 28 Dec 1997 by Geert Uytterhoeven | |
23 | * | |
24 | * This program is free software; you can redistribute it and/or modify it | |
25 | * under the terms of the GNU General Public License as published by the | |
26 | * Free Software Foundation; either version 2 of the License, or (at your | |
27 | * option) any later version. | |
28 | * | |
29 | * THIS SOFTWARE IS PROVIDED ``AS IS'' AND ANY EXPRESS OR IMPLIED | |
30 | * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF | |
31 | * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN | |
32 | * NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, | |
33 | * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT | |
34 | * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF | |
35 | * USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON | |
36 | * ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT | |
37 | * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF | |
38 | * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. | |
39 | * | |
40 | * You should have received a copy of the GNU General Public License along | |
41 | * with this program; if not, write to the Free Software Foundation, Inc., | |
42 | * 675 Mass Ave, Cambridge, MA 02139, USA. | |
43 | */ | |
1da177e4 LT |
44 | #include <linux/module.h> |
45 | #include <linux/kernel.h> | |
46 | #include <linux/errno.h> | |
47 | #include <linux/string.h> | |
48 | #include <linux/mm.h> | |
1da177e4 LT |
49 | #include <linux/fb.h> |
50 | #include <linux/init.h> | |
3b495f2b PP |
51 | #include <linux/interrupt.h> |
52 | #include <linux/ctype.h> | |
53 | #include <linux/dma-mapping.h> | |
cacfc8cf | 54 | #include <linux/platform_device.h> |
5a0e3ad6 | 55 | #include <linux/slab.h> |
1da177e4 | 56 | |
3b495f2b | 57 | #include <asm/mach-au1x00/au1000.h> |
1da177e4 | 58 | |
3b495f2b PP |
59 | #define DEBUG 0 |
60 | ||
61 | #include "au1100fb.h" | |
1da177e4 | 62 | |
3b495f2b PP |
63 | #define DRIVER_NAME "au1100fb" |
64 | #define DRIVER_DESC "LCD controller driver for AU1100 processors" | |
1da177e4 | 65 | |
3b495f2b PP |
66 | #define to_au1100fb_device(_info) \ |
67 | (_info ? container_of(_info, struct au1100fb_device, info) : NULL); | |
1da177e4 | 68 | |
3b495f2b PP |
69 | /* Bitfields format supported by the controller. Note that the order of formats |
70 | * SHOULD be the same as in the LCD_CONTROL_SBPPF field, so we can retrieve the | |
71 | * right pixel format by doing rgb_bitfields[LCD_CONTROL_SBPPF_XXX >> LCD_CONTROL_SBPPF] | |
72 | */ | |
73 | struct fb_bitfield rgb_bitfields[][4] = | |
74 | { | |
75 | /* Red, Green, Blue, Transp */ | |
76 | { { 10, 6, 0 }, { 5, 5, 0 }, { 0, 5, 0 }, { 0, 0, 0 } }, | |
77 | { { 11, 5, 0 }, { 5, 6, 0 }, { 0, 5, 0 }, { 0, 0, 0 } }, | |
78 | { { 11, 5, 0 }, { 6, 5, 0 }, { 0, 6, 0 }, { 0, 0, 0 } }, | |
79 | { { 10, 5, 0 }, { 5, 5, 0 }, { 0, 5, 0 }, { 15, 1, 0 } }, | |
80 | { { 11, 5, 0 }, { 6, 5, 0 }, { 1, 5, 0 }, { 0, 1, 0 } }, | |
81 | ||
82 | /* The last is used to describe 12bpp format */ | |
83 | { { 8, 4, 0 }, { 4, 4, 0 }, { 0, 4, 0 }, { 0, 0, 0 } }, | |
1da177e4 LT |
84 | }; |
85 | ||
362992b1 | 86 | static struct fb_fix_screeninfo au1100fb_fix __devinitdata = { |
3b495f2b PP |
87 | .id = "AU1100 FB", |
88 | .xpanstep = 1, | |
89 | .ypanstep = 1, | |
90 | .type = FB_TYPE_PACKED_PIXELS, | |
91 | .accel = FB_ACCEL_NONE, | |
1da177e4 LT |
92 | }; |
93 | ||
362992b1 | 94 | static struct fb_var_screeninfo au1100fb_var __devinitdata = { |
3b495f2b PP |
95 | .activate = FB_ACTIVATE_NOW, |
96 | .height = -1, | |
97 | .width = -1, | |
98 | .vmode = FB_VMODE_NONINTERLACED, | |
1da177e4 LT |
99 | }; |
100 | ||
8e92f21b YY |
101 | /* fb_blank |
102 | * Blank the screen. Depending on the mode, the screen will be | |
103 | * activated with the backlight color, or desactivated | |
104 | */ | |
105 | static int au1100fb_fb_blank(int blank_mode, struct fb_info *fbi) | |
106 | { | |
107 | struct au1100fb_device *fbdev = to_au1100fb_device(fbi); | |
108 | ||
109 | print_dbg("fb_blank %d %p", blank_mode, fbi); | |
110 | ||
111 | switch (blank_mode) { | |
112 | ||
113 | case VESA_NO_BLANKING: | |
114 | /* Turn on panel */ | |
115 | fbdev->regs->lcd_control |= LCD_CONTROL_GO; | |
116 | #ifdef CONFIG_MIPS_PB1100 | |
d121c3f3 | 117 | if (fbdev->panel_idx == 1) { |
8e92f21b YY |
118 | au_writew(au_readw(PB1100_G_CONTROL) |
119 | | (PB1100_G_CONTROL_BL | PB1100_G_CONTROL_VDD), | |
120 | PB1100_G_CONTROL); | |
121 | } | |
122 | #endif | |
123 | au_sync(); | |
124 | break; | |
125 | ||
126 | case VESA_VSYNC_SUSPEND: | |
127 | case VESA_HSYNC_SUSPEND: | |
128 | case VESA_POWERDOWN: | |
129 | /* Turn off panel */ | |
130 | fbdev->regs->lcd_control &= ~LCD_CONTROL_GO; | |
131 | #ifdef CONFIG_MIPS_PB1100 | |
d121c3f3 | 132 | if (fbdev->panel_idx == 1) { |
8e92f21b YY |
133 | au_writew(au_readw(PB1100_G_CONTROL) |
134 | & ~(PB1100_G_CONTROL_BL | PB1100_G_CONTROL_VDD), | |
135 | PB1100_G_CONTROL); | |
136 | } | |
137 | #endif | |
138 | au_sync(); | |
139 | break; | |
140 | default: | |
141 | break; | |
142 | ||
143 | } | |
144 | return 0; | |
145 | } | |
146 | ||
3b495f2b PP |
147 | /* |
148 | * Set hardware with var settings. This will enable the controller with a specific | |
149 | * mode, normally validated with the fb_check_var method | |
1da177e4 | 150 | */ |
3b495f2b | 151 | int au1100fb_setmode(struct au1100fb_device *fbdev) |
1da177e4 | 152 | { |
3b495f2b PP |
153 | struct fb_info *info = &fbdev->info; |
154 | u32 words; | |
155 | int index; | |
1da177e4 | 156 | |
3b495f2b PP |
157 | if (!fbdev) |
158 | return -EINVAL; | |
159 | ||
160 | /* Update var-dependent FB info */ | |
161 | if (panel_is_active(fbdev->panel) || panel_is_color(fbdev->panel)) { | |
162 | if (info->var.bits_per_pixel <= 8) { | |
163 | /* palettized */ | |
164 | info->var.red.offset = 0; | |
165 | info->var.red.length = info->var.bits_per_pixel; | |
166 | info->var.red.msb_right = 0; | |
167 | ||
168 | info->var.green.offset = 0; | |
169 | info->var.green.length = info->var.bits_per_pixel; | |
170 | info->var.green.msb_right = 0; | |
171 | ||
172 | info->var.blue.offset = 0; | |
173 | info->var.blue.length = info->var.bits_per_pixel; | |
174 | info->var.blue.msb_right = 0; | |
175 | ||
176 | info->var.transp.offset = 0; | |
177 | info->var.transp.length = 0; | |
178 | info->var.transp.msb_right = 0; | |
179 | ||
180 | info->fix.visual = FB_VISUAL_PSEUDOCOLOR; | |
181 | info->fix.line_length = info->var.xres_virtual / | |
182 | (8/info->var.bits_per_pixel); | |
183 | } else { | |
184 | /* non-palettized */ | |
185 | index = (fbdev->panel->control_base & LCD_CONTROL_SBPPF_MASK) >> LCD_CONTROL_SBPPF_BIT; | |
186 | info->var.red = rgb_bitfields[index][0]; | |
187 | info->var.green = rgb_bitfields[index][1]; | |
188 | info->var.blue = rgb_bitfields[index][2]; | |
189 | info->var.transp = rgb_bitfields[index][3]; | |
190 | ||
191 | info->fix.visual = FB_VISUAL_TRUECOLOR; | |
192 | info->fix.line_length = info->var.xres_virtual << 1; /* depth=16 */ | |
bb39e419 | 193 | } |
3b495f2b PP |
194 | } else { |
195 | /* mono */ | |
196 | info->fix.visual = FB_VISUAL_MONO10; | |
197 | info->fix.line_length = info->var.xres_virtual / 8; | |
1da177e4 LT |
198 | } |
199 | ||
3b495f2b | 200 | info->screen_size = info->fix.line_length * info->var.yres_virtual; |
fd2d5430 RG |
201 | info->var.rotate = ((fbdev->panel->control_base&LCD_CONTROL_SM_MASK) \ |
202 | >> LCD_CONTROL_SM_BIT) * 90; | |
1da177e4 | 203 | |
3b495f2b | 204 | /* Determine BPP mode and format */ |
fd2d5430 | 205 | fbdev->regs->lcd_control = fbdev->panel->control_base; |
3b495f2b | 206 | fbdev->regs->lcd_horztiming = fbdev->panel->horztiming; |
3b495f2b | 207 | fbdev->regs->lcd_verttiming = fbdev->panel->verttiming; |
3b495f2b | 208 | fbdev->regs->lcd_clkcontrol = fbdev->panel->clkcontrol_base; |
bb39e419 RG |
209 | fbdev->regs->lcd_intenable = 0; |
210 | fbdev->regs->lcd_intstatus = 0; | |
3b495f2b PP |
211 | fbdev->regs->lcd_dmaaddr0 = LCD_DMA_SA_N(fbdev->fb_phys); |
212 | ||
213 | if (panel_is_dual(fbdev->panel)) { | |
214 | /* Second panel display seconf half of screen if possible, | |
215 | * otherwise display the same as the first panel */ | |
216 | if (info->var.yres_virtual >= (info->var.yres << 1)) { | |
217 | fbdev->regs->lcd_dmaaddr1 = LCD_DMA_SA_N(fbdev->fb_phys + | |
218 | (info->fix.line_length * | |
219 | (info->var.yres_virtual >> 1))); | |
220 | } else { | |
221 | fbdev->regs->lcd_dmaaddr1 = LCD_DMA_SA_N(fbdev->fb_phys); | |
222 | } | |
1da177e4 | 223 | } |
1da177e4 | 224 | |
3b495f2b PP |
225 | words = info->fix.line_length / sizeof(u32); |
226 | if (!info->var.rotate || (info->var.rotate == 180)) { | |
227 | words *= info->var.yres_virtual; | |
228 | if (info->var.rotate /* 180 */) { | |
229 | words -= (words % 8); /* should be divisable by 8 */ | |
230 | } | |
231 | } | |
232 | fbdev->regs->lcd_words = LCD_WRD_WRDS_N(words); | |
1da177e4 | 233 | |
3b495f2b PP |
234 | fbdev->regs->lcd_pwmdiv = 0; |
235 | fbdev->regs->lcd_pwmhi = 0; | |
1da177e4 | 236 | |
3b495f2b PP |
237 | /* Resume controller */ |
238 | fbdev->regs->lcd_control |= LCD_CONTROL_GO; | |
bb39e419 RG |
239 | mdelay(10); |
240 | au1100fb_fb_blank(VESA_NO_BLANKING, info); | |
1da177e4 | 241 | |
3b495f2b | 242 | return 0; |
1da177e4 LT |
243 | } |
244 | ||
3b495f2b PP |
245 | /* fb_setcolreg |
246 | * Set color in LCD palette. | |
247 | */ | |
248 | int au1100fb_fb_setcolreg(unsigned regno, unsigned red, unsigned green, unsigned blue, unsigned transp, struct fb_info *fbi) | |
1da177e4 | 249 | { |
c05b7f3d RG |
250 | struct au1100fb_device *fbdev; |
251 | u32 *palette; | |
3b495f2b | 252 | u32 value; |
1da177e4 | 253 | |
c05b7f3d RG |
254 | fbdev = to_au1100fb_device(fbi); |
255 | palette = fbdev->regs->lcd_pallettebase; | |
256 | ||
3b495f2b PP |
257 | if (regno > (AU1100_LCD_NBR_PALETTE_ENTRIES - 1)) |
258 | return -EINVAL; | |
1da177e4 | 259 | |
3b495f2b PP |
260 | if (fbi->var.grayscale) { |
261 | /* Convert color to grayscale */ | |
262 | red = green = blue = | |
263 | (19595 * red + 38470 * green + 7471 * blue) >> 16; | |
264 | } | |
1da177e4 | 265 | |
3b495f2b PP |
266 | if (fbi->fix.visual == FB_VISUAL_TRUECOLOR) { |
267 | /* Place color in the pseudopalette */ | |
268 | if (regno > 16) | |
269 | return -EINVAL; | |
1da177e4 | 270 | |
3b495f2b PP |
271 | palette = (u32*)fbi->pseudo_palette; |
272 | ||
273 | red >>= (16 - fbi->var.red.length); | |
274 | green >>= (16 - fbi->var.green.length); | |
275 | blue >>= (16 - fbi->var.blue.length); | |
276 | ||
277 | value = (red << fbi->var.red.offset) | | |
278 | (green << fbi->var.green.offset)| | |
279 | (blue << fbi->var.blue.offset); | |
280 | value &= 0xFFFF; | |
281 | ||
282 | } else if (panel_is_active(fbdev->panel)) { | |
283 | /* COLOR TFT PALLETTIZED (use RGB 565) */ | |
284 | value = (red & 0xF800)|((green >> 5) & 0x07E0)|((blue >> 11) & 0x001F); | |
285 | value &= 0xFFFF; | |
286 | ||
287 | } else if (panel_is_color(fbdev->panel)) { | |
288 | /* COLOR STN MODE */ | |
289 | value = (((panel_swap_rgb(fbdev->panel) ? blue : red) >> 12) & 0x000F) | | |
290 | ((green >> 8) & 0x00F0) | | |
291 | (((panel_swap_rgb(fbdev->panel) ? red : blue) >> 4) & 0x0F00); | |
292 | value &= 0xFFF; | |
293 | } else { | |
294 | /* MONOCHROME MODE */ | |
295 | value = (green >> 12) & 0x000F; | |
296 | value &= 0xF; | |
1da177e4 LT |
297 | } |
298 | ||
3b495f2b PP |
299 | palette[regno] = value; |
300 | ||
1da177e4 LT |
301 | return 0; |
302 | } | |
303 | ||
3b495f2b PP |
304 | /* fb_pan_display |
305 | * Pan display in x and/or y as specified | |
306 | */ | |
307 | int au1100fb_fb_pan_display(struct fb_var_screeninfo *var, struct fb_info *fbi) | |
1da177e4 | 308 | { |
c05b7f3d | 309 | struct au1100fb_device *fbdev; |
3b495f2b PP |
310 | int dy; |
311 | ||
c05b7f3d RG |
312 | fbdev = to_au1100fb_device(fbi); |
313 | ||
3b495f2b PP |
314 | print_dbg("fb_pan_display %p %p", var, fbi); |
315 | ||
316 | if (!var || !fbdev) { | |
317 | return -EINVAL; | |
318 | } | |
319 | ||
320 | if (var->xoffset - fbi->var.xoffset) { | |
321 | /* No support for X panning for now! */ | |
322 | return -EINVAL; | |
323 | } | |
324 | ||
325 | print_dbg("fb_pan_display 2 %p %p", var, fbi); | |
326 | dy = var->yoffset - fbi->var.yoffset; | |
327 | if (dy) { | |
328 | ||
329 | u32 dmaaddr; | |
330 | ||
331 | print_dbg("Panning screen of %d lines", dy); | |
332 | ||
333 | dmaaddr = fbdev->regs->lcd_dmaaddr0; | |
334 | dmaaddr += (fbi->fix.line_length * dy); | |
335 | ||
336 | /* TODO: Wait for current frame to finished */ | |
337 | fbdev->regs->lcd_dmaaddr0 = LCD_DMA_SA_N(dmaaddr); | |
338 | ||
339 | if (panel_is_dual(fbdev->panel)) { | |
340 | dmaaddr = fbdev->regs->lcd_dmaaddr1; | |
341 | dmaaddr += (fbi->fix.line_length * dy); | |
342 | fbdev->regs->lcd_dmaaddr0 = LCD_DMA_SA_N(dmaaddr); | |
343 | } | |
344 | } | |
345 | print_dbg("fb_pan_display 3 %p %p", var, fbi); | |
346 | ||
347 | return 0; | |
348 | } | |
349 | ||
350 | /* fb_rotate | |
351 | * Rotate the display of this angle. This doesn't seems to be used by the core, | |
352 | * but as our hardware supports it, so why not implementing it... | |
353 | */ | |
354 | void au1100fb_fb_rotate(struct fb_info *fbi, int angle) | |
355 | { | |
356 | struct au1100fb_device *fbdev = to_au1100fb_device(fbi); | |
357 | ||
358 | print_dbg("fb_rotate %p %d", fbi, angle); | |
359 | ||
360 | if (fbdev && (angle > 0) && !(angle % 90)) { | |
361 | ||
362 | fbdev->regs->lcd_control &= ~LCD_CONTROL_GO; | |
363 | ||
364 | fbdev->regs->lcd_control &= ~(LCD_CONTROL_SM_MASK); | |
365 | fbdev->regs->lcd_control |= ((angle/90) << LCD_CONTROL_SM_BIT); | |
366 | ||
367 | fbdev->regs->lcd_control |= LCD_CONTROL_GO; | |
1da177e4 LT |
368 | } |
369 | } | |
370 | ||
3b495f2b PP |
371 | /* fb_mmap |
372 | * Map video memory in user space. We don't use the generic fb_mmap method mainly | |
373 | * to allow the use of the TLB streaming flag (CCA=6) | |
374 | */ | |
216d526c | 375 | int au1100fb_fb_mmap(struct fb_info *fbi, struct vm_area_struct *vma) |
1da177e4 | 376 | { |
c05b7f3d | 377 | struct au1100fb_device *fbdev; |
1da177e4 LT |
378 | unsigned int len; |
379 | unsigned long start=0, off; | |
1da177e4 | 380 | |
c05b7f3d RG |
381 | fbdev = to_au1100fb_device(fbi); |
382 | ||
1da177e4 LT |
383 | if (vma->vm_pgoff > (~0UL >> PAGE_SHIFT)) { |
384 | return -EINVAL; | |
385 | } | |
386 | ||
3b495f2b PP |
387 | start = fbdev->fb_phys & PAGE_MASK; |
388 | len = PAGE_ALIGN((start & ~PAGE_MASK) + fbdev->fb_len); | |
1da177e4 LT |
389 | |
390 | off = vma->vm_pgoff << PAGE_SHIFT; | |
391 | ||
392 | if ((vma->vm_end - vma->vm_start + off) > len) { | |
393 | return -EINVAL; | |
394 | } | |
395 | ||
396 | off += start; | |
397 | vma->vm_pgoff = off >> PAGE_SHIFT; | |
398 | ||
3b495f2b | 399 | vma->vm_page_prot = pgprot_noncached(vma->vm_page_prot); |
1da177e4 LT |
400 | pgprot_val(vma->vm_page_prot) |= (6 << 9); //CCA=6 |
401 | ||
1da177e4 LT |
402 | vma->vm_flags |= VM_IO; |
403 | ||
cacfc8cf | 404 | if (io_remap_pfn_range(vma, vma->vm_start, off >> PAGE_SHIFT, |
1da177e4 LT |
405 | vma->vm_end - vma->vm_start, |
406 | vma->vm_page_prot)) { | |
407 | return -EAGAIN; | |
408 | } | |
409 | ||
1da177e4 LT |
410 | return 0; |
411 | } | |
412 | ||
3b495f2b | 413 | static struct fb_ops au1100fb_ops = |
1da177e4 | 414 | { |
3b495f2b PP |
415 | .owner = THIS_MODULE, |
416 | .fb_setcolreg = au1100fb_fb_setcolreg, | |
417 | .fb_blank = au1100fb_fb_blank, | |
418 | .fb_pan_display = au1100fb_fb_pan_display, | |
419 | .fb_fillrect = cfb_fillrect, | |
420 | .fb_copyarea = cfb_copyarea, | |
421 | .fb_imageblit = cfb_imageblit, | |
422 | .fb_rotate = au1100fb_fb_rotate, | |
423 | .fb_mmap = au1100fb_fb_mmap, | |
424 | }; | |
1da177e4 | 425 | |
1da177e4 | 426 | |
3b495f2b | 427 | /*-------------------------------------------------------------------------*/ |
1da177e4 | 428 | |
d121c3f3 ML |
429 | static int au1100fb_setup(struct au1100fb_device *fbdev) |
430 | { | |
431 | char *this_opt, *options; | |
432 | int num_panels = ARRAY_SIZE(known_lcd_panels); | |
433 | ||
434 | if (num_panels <= 0) { | |
435 | print_err("No LCD panels supported by driver!"); | |
436 | return -ENODEV; | |
437 | } | |
438 | ||
439 | if (fb_get_options(DRIVER_NAME, &options)) | |
440 | return -ENODEV; | |
441 | if (!options) | |
442 | return -ENODEV; | |
443 | ||
444 | while ((this_opt = strsep(&options, ",")) != NULL) { | |
445 | /* Panel option */ | |
446 | if (!strncmp(this_opt, "panel:", 6)) { | |
447 | int i; | |
448 | this_opt += 6; | |
449 | for (i = 0; i < num_panels; i++) { | |
450 | if (!strncmp(this_opt, known_lcd_panels[i].name, | |
451 | strlen(this_opt))) { | |
452 | fbdev->panel = &known_lcd_panels[i]; | |
453 | fbdev->panel_idx = i; | |
454 | break; | |
455 | } | |
456 | } | |
457 | if (i >= num_panels) { | |
458 | print_warn("Panel '%s' not supported!", this_opt); | |
459 | return -ENODEV; | |
460 | } | |
461 | } | |
462 | /* Unsupported option */ | |
463 | else | |
464 | print_warn("Unsupported option \"%s\"", this_opt); | |
465 | } | |
466 | ||
467 | print_info("Panel=%s", fbdev->panel->name); | |
468 | ||
469 | return 0; | |
470 | } | |
1da177e4 | 471 | |
362992b1 | 472 | static int __devinit au1100fb_drv_probe(struct platform_device *dev) |
1da177e4 | 473 | { |
3b495f2b PP |
474 | struct au1100fb_device *fbdev = NULL; |
475 | struct resource *regs_res; | |
476 | unsigned long page; | |
477 | u32 sys_clksrc; | |
478 | ||
3b495f2b | 479 | /* Allocate new device private */ |
1c16697b JL |
480 | fbdev = devm_kzalloc(&dev->dev, sizeof(struct au1100fb_device), |
481 | GFP_KERNEL); | |
d121c3f3 | 482 | if (!fbdev) { |
3b495f2b PP |
483 | print_err("fail to allocate device private record"); |
484 | return -ENOMEM; | |
1da177e4 LT |
485 | } |
486 | ||
d121c3f3 ML |
487 | if (au1100fb_setup(fbdev)) |
488 | goto failed; | |
1da177e4 | 489 | |
7a192ec3 | 490 | platform_set_drvdata(dev, (void *)fbdev); |
1da177e4 | 491 | |
3b495f2b | 492 | /* Allocate region for our registers and map them */ |
d121c3f3 ML |
493 | regs_res = platform_get_resource(dev, IORESOURCE_MEM, 0); |
494 | if (!regs_res) { | |
3b495f2b PP |
495 | print_err("fail to retrieve registers resource"); |
496 | return -EFAULT; | |
497 | } | |
1da177e4 | 498 | |
3b495f2b | 499 | au1100fb_fix.mmio_start = regs_res->start; |
28f65c11 | 500 | au1100fb_fix.mmio_len = resource_size(regs_res); |
1da177e4 | 501 | |
1c16697b JL |
502 | if (!devm_request_mem_region(au1100fb_fix.mmio_start, |
503 | au1100fb_fix.mmio_len, | |
504 | DRIVER_NAME)) { | |
c05b7f3d | 505 | print_err("fail to lock memory region at 0x%08lx", |
3b495f2b PP |
506 | au1100fb_fix.mmio_start); |
507 | return -EBUSY; | |
508 | } | |
1da177e4 | 509 | |
3b495f2b | 510 | fbdev->regs = (struct au1100fb_regs*)KSEG1ADDR(au1100fb_fix.mmio_start); |
1da177e4 | 511 | |
3b495f2b PP |
512 | print_dbg("Register memory map at %p", fbdev->regs); |
513 | print_dbg("phys=0x%08x, size=%d", fbdev->regs_phys, fbdev->regs_len); | |
1da177e4 | 514 | |
3b495f2b PP |
515 | /* Allocate the framebuffer to the maximum screen size * nbr of video buffers */ |
516 | fbdev->fb_len = fbdev->panel->xres * fbdev->panel->yres * | |
517 | (fbdev->panel->bpp >> 3) * AU1100FB_NBR_VIDEO_BUFFERS; | |
518 | ||
1c16697b JL |
519 | fbdev->fb_mem = dmam_alloc_coherent(&dev->dev, &dev->dev, |
520 | PAGE_ALIGN(fbdev->fb_len), | |
521 | &fbdev->fb_phys, GFP_KERNEL); | |
3b495f2b PP |
522 | if (!fbdev->fb_mem) { |
523 | print_err("fail to allocate frambuffer (size: %dK))", | |
524 | fbdev->fb_len / 1024); | |
1da177e4 LT |
525 | return -ENOMEM; |
526 | } | |
3b495f2b PP |
527 | |
528 | au1100fb_fix.smem_start = fbdev->fb_phys; | |
529 | au1100fb_fix.smem_len = fbdev->fb_len; | |
1da177e4 LT |
530 | |
531 | /* | |
532 | * Set page reserved so that mmap will work. This is necessary | |
533 | * since we'll be remapping normal memory. | |
534 | */ | |
3b495f2b PP |
535 | for (page = (unsigned long)fbdev->fb_mem; |
536 | page < PAGE_ALIGN((unsigned long)fbdev->fb_mem + fbdev->fb_len); | |
1da177e4 | 537 | page += PAGE_SIZE) { |
3b495f2b | 538 | #if CONFIG_DMA_NONCOHERENT |
d121c3f3 | 539 | SetPageReserved(virt_to_page(CAC_ADDR((void *)page))); |
3b495f2b | 540 | #else |
1da177e4 | 541 | SetPageReserved(virt_to_page(page)); |
3b495f2b | 542 | #endif |
1da177e4 LT |
543 | } |
544 | ||
3b495f2b PP |
545 | print_dbg("Framebuffer memory map at %p", fbdev->fb_mem); |
546 | print_dbg("phys=0x%08x, size=%dK", fbdev->fb_phys, fbdev->fb_len / 1024); | |
547 | ||
548 | /* Setup LCD clock to AUX (48 MHz) */ | |
549 | sys_clksrc = au_readl(SYS_CLKSRC) & ~(SYS_CS_ML_MASK | SYS_CS_DL | SYS_CS_CL); | |
550 | au_writel((sys_clksrc | (1 << SYS_CS_ML_BIT)), SYS_CLKSRC); | |
551 | ||
552 | /* load the panel info into the var struct */ | |
553 | au1100fb_var.bits_per_pixel = fbdev->panel->bpp; | |
554 | au1100fb_var.xres = fbdev->panel->xres; | |
555 | au1100fb_var.xres_virtual = au1100fb_var.xres; | |
556 | au1100fb_var.yres = fbdev->panel->yres; | |
557 | au1100fb_var.yres_virtual = au1100fb_var.yres; | |
558 | ||
559 | fbdev->info.screen_base = fbdev->fb_mem; | |
560 | fbdev->info.fbops = &au1100fb_ops; | |
561 | fbdev->info.fix = au1100fb_fix; | |
562 | ||
1c16697b JL |
563 | fbdev->info.pseudo_palette = |
564 | devm_kzalloc(&dev->dev, sizeof(u32) * 16, GFP_KERNEL); | |
565 | if (!fbdev->info.pseudo_palette) | |
3b495f2b | 566 | return -ENOMEM; |
3b495f2b PP |
567 | |
568 | if (fb_alloc_cmap(&fbdev->info.cmap, AU1100_LCD_NBR_PALETTE_ENTRIES, 0) < 0) { | |
569 | print_err("Fail to allocate colormap (%d entries)", | |
570 | AU1100_LCD_NBR_PALETTE_ENTRIES); | |
3b495f2b PP |
571 | return -EFAULT; |
572 | } | |
573 | ||
574 | fbdev->info.var = au1100fb_var; | |
575 | ||
576 | /* Set h/w registers */ | |
577 | au1100fb_setmode(fbdev); | |
578 | ||
579 | /* Register new framebuffer */ | |
580 | if (register_framebuffer(&fbdev->info) < 0) { | |
581 | print_err("cannot register new framebuffer"); | |
582 | goto failed; | |
583 | } | |
584 | ||
585 | return 0; | |
586 | ||
587 | failed: | |
3b495f2b | 588 | if (fbdev->fb_mem) { |
d121c3f3 ML |
589 | dma_free_noncoherent(&dev->dev, fbdev->fb_len, fbdev->fb_mem, |
590 | fbdev->fb_phys); | |
3b495f2b PP |
591 | } |
592 | if (fbdev->info.cmap.len != 0) { | |
593 | fb_dealloc_cmap(&fbdev->info.cmap); | |
594 | } | |
7a192ec3 | 595 | platform_set_drvdata(dev, NULL); |
1da177e4 | 596 | |
1c16697b | 597 | return -ENODEV; |
1da177e4 LT |
598 | } |
599 | ||
7a192ec3 | 600 | int au1100fb_drv_remove(struct platform_device *dev) |
3b495f2b PP |
601 | { |
602 | struct au1100fb_device *fbdev = NULL; | |
603 | ||
604 | if (!dev) | |
605 | return -ENODEV; | |
606 | ||
7a192ec3 | 607 | fbdev = (struct au1100fb_device *) platform_get_drvdata(dev); |
3b495f2b PP |
608 | |
609 | #if !defined(CONFIG_FRAMEBUFFER_CONSOLE) && defined(CONFIG_LOGO) | |
610 | au1100fb_fb_blank(VESA_POWERDOWN, &fbdev->info); | |
611 | #endif | |
612 | fbdev->regs->lcd_control &= ~LCD_CONTROL_GO; | |
1da177e4 | 613 | |
3b495f2b PP |
614 | /* Clean up all probe data */ |
615 | unregister_framebuffer(&fbdev->info); | |
616 | ||
3b495f2b | 617 | fb_dealloc_cmap(&fbdev->info.cmap); |
3b495f2b PP |
618 | |
619 | return 0; | |
620 | } | |
621 | ||
f77f50ca RG |
622 | #ifdef CONFIG_PM |
623 | static u32 sys_clksrc; | |
624 | static struct au1100fb_regs fbregs; | |
625 | ||
7a192ec3 | 626 | int au1100fb_drv_suspend(struct platform_device *dev, pm_message_t state) |
3b495f2b | 627 | { |
7a192ec3 | 628 | struct au1100fb_device *fbdev = platform_get_drvdata(dev); |
f77f50ca RG |
629 | |
630 | if (!fbdev) | |
631 | return 0; | |
632 | ||
633 | /* Save the clock source state */ | |
634 | sys_clksrc = au_readl(SYS_CLKSRC); | |
635 | ||
636 | /* Blank the LCD */ | |
637 | au1100fb_fb_blank(VESA_POWERDOWN, &fbdev->info); | |
638 | ||
639 | /* Stop LCD clocking */ | |
640 | au_writel(sys_clksrc & ~SYS_CS_ML_MASK, SYS_CLKSRC); | |
641 | ||
642 | memcpy(&fbregs, fbdev->regs, sizeof(struct au1100fb_regs)); | |
643 | ||
3b495f2b PP |
644 | return 0; |
645 | } | |
646 | ||
7a192ec3 | 647 | int au1100fb_drv_resume(struct platform_device *dev) |
1da177e4 | 648 | { |
7a192ec3 | 649 | struct au1100fb_device *fbdev = platform_get_drvdata(dev); |
f77f50ca RG |
650 | |
651 | if (!fbdev) | |
652 | return 0; | |
653 | ||
654 | memcpy(fbdev->regs, &fbregs, sizeof(struct au1100fb_regs)); | |
655 | ||
656 | /* Restart LCD clocking */ | |
657 | au_writel(sys_clksrc, SYS_CLKSRC); | |
658 | ||
659 | /* Unblank the LCD */ | |
660 | au1100fb_fb_blank(VESA_NO_BLANKING, &fbdev->info); | |
661 | ||
3b495f2b | 662 | return 0; |
1da177e4 | 663 | } |
f77f50ca RG |
664 | #else |
665 | #define au1100fb_drv_suspend NULL | |
666 | #define au1100fb_drv_resume NULL | |
667 | #endif | |
1da177e4 | 668 | |
7a192ec3 ML |
669 | static struct platform_driver au1100fb_driver = { |
670 | .driver = { | |
671 | .name = "au1100-lcd", | |
672 | .owner = THIS_MODULE, | |
673 | }, | |
3b495f2b PP |
674 | .probe = au1100fb_drv_probe, |
675 | .remove = au1100fb_drv_remove, | |
676 | .suspend = au1100fb_drv_suspend, | |
677 | .resume = au1100fb_drv_resume, | |
678 | }; | |
679 | ||
d121c3f3 | 680 | static int __init au1100fb_load(void) |
1da177e4 | 681 | { |
7a192ec3 | 682 | return platform_driver_register(&au1100fb_driver); |
1da177e4 LT |
683 | } |
684 | ||
d121c3f3 | 685 | static void __exit au1100fb_unload(void) |
1da177e4 | 686 | { |
7a192ec3 | 687 | platform_driver_unregister(&au1100fb_driver); |
1da177e4 LT |
688 | } |
689 | ||
d121c3f3 ML |
690 | module_init(au1100fb_load); |
691 | module_exit(au1100fb_unload); | |
3b495f2b PP |
692 | |
693 | MODULE_DESCRIPTION(DRIVER_DESC); | |
694 | MODULE_LICENSE("GPL"); |