s3c-fb: fix section mismatch
[linux-2.6.git] / drivers / video / s3c-fb.c
1 /* linux/drivers/video/s3c-fb.c
2  *
3  * Copyright 2008 Openmoko Inc.
4  * Copyright 2008-2010 Simtec Electronics
5  *      Ben Dooks <ben@simtec.co.uk>
6  *      http://armlinux.simtec.co.uk/
7  *
8  * Samsung SoC Framebuffer driver
9  *
10  * This program is free software; you can redistribute it and/or modify
11  * it under the terms of the GNU General Public License version 2 as
12  * published by the Free Software FoundatIon.
13 */
14
15 #include <linux/kernel.h>
16 #include <linux/module.h>
17 #include <linux/platform_device.h>
18 #include <linux/dma-mapping.h>
19 #include <linux/slab.h>
20 #include <linux/init.h>
21 #include <linux/clk.h>
22 #include <linux/fb.h>
23 #include <linux/io.h>
24 #include <linux/uaccess.h>
25 #include <linux/interrupt.h>
26
27 #include <mach/map.h>
28 #include <plat/regs-fb-v4.h>
29 #include <plat/fb.h>
30
31 /* This driver will export a number of framebuffer interfaces depending
32  * on the configuration passed in via the platform data. Each fb instance
33  * maps to a hardware window. Currently there is no support for runtime
34  * setting of the alpha-blending functions that each window has, so only
35  * window 0 is actually useful.
36  *
37  * Window 0 is treated specially, it is used for the basis of the LCD
38  * output timings and as the control for the output power-down state.
39 */
40
41 /* note, the previous use of <mach/regs-fb.h> to get platform specific data
42  * has been replaced by using the platform device name to pick the correct
43  * configuration data for the system.
44 */
45
46 #ifdef CONFIG_FB_S3C_DEBUG_REGWRITE
47 #undef writel
48 #define writel(v, r) do { \
49         printk(KERN_DEBUG "%s: %08x => %p\n", __func__, (unsigned int)v, r); \
50         __raw_writel(v, r); } while(0)
51 #endif /* FB_S3C_DEBUG_REGWRITE */
52
53 /* irq_flags bits */
54 #define S3C_FB_VSYNC_IRQ_EN     0
55
56 #define VSYNC_TIMEOUT_MSEC 50
57
58 struct s3c_fb;
59
60 #define VALID_BPP(x) (1 << ((x) - 1))
61
62 #define OSD_BASE(win, variant) ((variant).osd + ((win) * (variant).osd_stride))
63 #define VIDOSD_A(win, variant) (OSD_BASE(win, variant) + 0x00)
64 #define VIDOSD_B(win, variant) (OSD_BASE(win, variant) + 0x04)
65 #define VIDOSD_C(win, variant) (OSD_BASE(win, variant) + 0x08)
66 #define VIDOSD_D(win, variant) (OSD_BASE(win, variant) + 0x0C)
67
68 /**
69  * struct s3c_fb_variant - fb variant information
70  * @is_2443: Set if S3C2443/S3C2416 style hardware.
71  * @nr_windows: The number of windows.
72  * @vidtcon: The base for the VIDTCONx registers
73  * @wincon: The base for the WINxCON registers.
74  * @winmap: The base for the WINxMAP registers.
75  * @keycon: The abse for the WxKEYCON registers.
76  * @buf_start: Offset of buffer start registers.
77  * @buf_size: Offset of buffer size registers.
78  * @buf_end: Offset of buffer end registers.
79  * @osd: The base for the OSD registers.
80  * @palette: Address of palette memory, or 0 if none.
81  * @has_prtcon: Set if has PRTCON register.
82  * @has_shadowcon: Set if has SHADOWCON register.
83  */
84 struct s3c_fb_variant {
85         unsigned int    is_2443:1;
86         unsigned short  nr_windows;
87         unsigned short  vidtcon;
88         unsigned short  wincon;
89         unsigned short  winmap;
90         unsigned short  keycon;
91         unsigned short  buf_start;
92         unsigned short  buf_end;
93         unsigned short  buf_size;
94         unsigned short  osd;
95         unsigned short  osd_stride;
96         unsigned short  palette[S3C_FB_MAX_WIN];
97
98         unsigned int    has_prtcon:1;
99         unsigned int    has_shadowcon:1;
100 };
101
102 /**
103  * struct s3c_fb_win_variant
104  * @has_osd_c: Set if has OSD C register.
105  * @has_osd_d: Set if has OSD D register.
106  * @has_osd_alpha: Set if can change alpha transparency for a window.
107  * @palette_sz: Size of palette in entries.
108  * @palette_16bpp: Set if palette is 16bits wide.
109  * @osd_size_off: If != 0, supports setting up OSD for a window; the appropriate
110  *                register is located at the given offset from OSD_BASE.
111  * @valid_bpp: 1 bit per BPP setting to show valid bits-per-pixel.
112  *
113  * valid_bpp bit x is set if (x+1)BPP is supported.
114  */
115 struct s3c_fb_win_variant {
116         unsigned int    has_osd_c:1;
117         unsigned int    has_osd_d:1;
118         unsigned int    has_osd_alpha:1;
119         unsigned int    palette_16bpp:1;
120         unsigned short  osd_size_off;
121         unsigned short  palette_sz;
122         u32             valid_bpp;
123 };
124
125 /**
126  * struct s3c_fb_driverdata - per-device type driver data for init time.
127  * @variant: The variant information for this driver.
128  * @win: The window information for each window.
129  */
130 struct s3c_fb_driverdata {
131         struct s3c_fb_variant   variant;
132         struct s3c_fb_win_variant *win[S3C_FB_MAX_WIN];
133 };
134
135 /**
136  * struct s3c_fb_palette - palette information
137  * @r: Red bitfield.
138  * @g: Green bitfield.
139  * @b: Blue bitfield.
140  * @a: Alpha bitfield.
141  */
142 struct s3c_fb_palette {
143         struct fb_bitfield      r;
144         struct fb_bitfield      g;
145         struct fb_bitfield      b;
146         struct fb_bitfield      a;
147 };
148
149 /**
150  * struct s3c_fb_win - per window private data for each framebuffer.
151  * @windata: The platform data supplied for the window configuration.
152  * @parent: The hardware that this window is part of.
153  * @fbinfo: Pointer pack to the framebuffer info for this window.
154  * @varint: The variant information for this window.
155  * @palette_buffer: Buffer/cache to hold palette entries.
156  * @pseudo_palette: For use in TRUECOLOUR modes for entries 0..15/
157  * @index: The window number of this window.
158  * @palette: The bitfields for changing r/g/b into a hardware palette entry.
159  */
160 struct s3c_fb_win {
161         struct s3c_fb_pd_win    *windata;
162         struct s3c_fb           *parent;
163         struct fb_info          *fbinfo;
164         struct s3c_fb_palette    palette;
165         struct s3c_fb_win_variant variant;
166
167         u32                     *palette_buffer;
168         u32                      pseudo_palette[16];
169         unsigned int             index;
170 };
171
172 /**
173  * struct s3c_fb_vsync - vsync information
174  * @wait:       a queue for processes waiting for vsync
175  * @count:      vsync interrupt count
176  */
177 struct s3c_fb_vsync {
178         wait_queue_head_t       wait;
179         unsigned int            count;
180 };
181
182 /**
183  * struct s3c_fb - overall hardware state of the hardware
184  * @dev: The device that we bound to, for printing, etc.
185  * @regs_res: The resource we claimed for the IO registers.
186  * @bus_clk: The clk (hclk) feeding our interface and possibly pixclk.
187  * @regs: The mapped hardware registers.
188  * @variant: Variant information for this hardware.
189  * @enabled: A bitmask of enabled hardware windows.
190  * @pdata: The platform configuration data passed with the device.
191  * @windows: The hardware windows that have been claimed.
192  * @irq_no: IRQ line number
193  * @irq_flags: irq flags
194  * @vsync_info: VSYNC-related information (count, queues...)
195  */
196 struct s3c_fb {
197         struct device           *dev;
198         struct resource         *regs_res;
199         struct clk              *bus_clk;
200         void __iomem            *regs;
201         struct s3c_fb_variant    variant;
202
203         unsigned char            enabled;
204
205         struct s3c_fb_platdata  *pdata;
206         struct s3c_fb_win       *windows[S3C_FB_MAX_WIN];
207
208         int                      irq_no;
209         unsigned long            irq_flags;
210         struct s3c_fb_vsync      vsync_info;
211 };
212
213 /**
214  * s3c_fb_validate_win_bpp - validate the bits-per-pixel for this mode.
215  * @win: The device window.
216  * @bpp: The bit depth.
217  */
218 static bool s3c_fb_validate_win_bpp(struct s3c_fb_win *win, unsigned int bpp)
219 {
220         return win->variant.valid_bpp & VALID_BPP(bpp);
221 }
222
223 /**
224  * s3c_fb_check_var() - framebuffer layer request to verify a given mode.
225  * @var: The screen information to verify.
226  * @info: The framebuffer device.
227  *
228  * Framebuffer layer call to verify the given information and allow us to
229  * update various information depending on the hardware capabilities.
230  */
231 static int s3c_fb_check_var(struct fb_var_screeninfo *var,
232                             struct fb_info *info)
233 {
234         struct s3c_fb_win *win = info->par;
235         struct s3c_fb_pd_win *windata = win->windata;
236         struct s3c_fb *sfb = win->parent;
237
238         dev_dbg(sfb->dev, "checking parameters\n");
239
240         var->xres_virtual = max((unsigned int)windata->virtual_x, var->xres);
241         var->yres_virtual = max((unsigned int)windata->virtual_y, var->yres);
242
243         if (!s3c_fb_validate_win_bpp(win, var->bits_per_pixel)) {
244                 dev_dbg(sfb->dev, "win %d: unsupported bpp %d\n",
245                         win->index, var->bits_per_pixel);
246                 return -EINVAL;
247         }
248
249         /* always ensure these are zero, for drop through cases below */
250         var->transp.offset = 0;
251         var->transp.length = 0;
252
253         switch (var->bits_per_pixel) {
254         case 1:
255         case 2:
256         case 4:
257         case 8:
258                 if (sfb->variant.palette[win->index] != 0) {
259                         /* non palletised, A:1,R:2,G:3,B:2 mode */
260                         var->red.offset         = 4;
261                         var->green.offset       = 2;
262                         var->blue.offset        = 0;
263                         var->red.length         = 5;
264                         var->green.length       = 3;
265                         var->blue.length        = 2;
266                         var->transp.offset      = 7;
267                         var->transp.length      = 1;
268                 } else {
269                         var->red.offset = 0;
270                         var->red.length = var->bits_per_pixel;
271                         var->green      = var->red;
272                         var->blue       = var->red;
273                 }
274                 break;
275
276         case 19:
277                 /* 666 with one bit alpha/transparency */
278                 var->transp.offset      = 18;
279                 var->transp.length      = 1;
280         case 18:
281                 var->bits_per_pixel     = 32;
282
283                 /* 666 format */
284                 var->red.offset         = 12;
285                 var->green.offset       = 6;
286                 var->blue.offset        = 0;
287                 var->red.length         = 6;
288                 var->green.length       = 6;
289                 var->blue.length        = 6;
290                 break;
291
292         case 16:
293                 /* 16 bpp, 565 format */
294                 var->red.offset         = 11;
295                 var->green.offset       = 5;
296                 var->blue.offset        = 0;
297                 var->red.length         = 5;
298                 var->green.length       = 6;
299                 var->blue.length        = 5;
300                 break;
301
302         case 28:
303         case 25:
304                 var->transp.length      = var->bits_per_pixel - 24;
305                 var->transp.offset      = 24;
306                 /* drop through */
307         case 24:
308                 /* our 24bpp is unpacked, so 32bpp */
309                 var->bits_per_pixel     = 32;
310         case 32:
311                 var->red.offset         = 16;
312                 var->red.length         = 8;
313                 var->green.offset       = 8;
314                 var->green.length       = 8;
315                 var->blue.offset        = 0;
316                 var->blue.length        = 8;
317                 break;
318
319         default:
320                 dev_err(sfb->dev, "invalid bpp\n");
321         }
322
323         dev_dbg(sfb->dev, "%s: verified parameters\n", __func__);
324         return 0;
325 }
326
327 /**
328  * s3c_fb_calc_pixclk() - calculate the divider to create the pixel clock.
329  * @sfb: The hardware state.
330  * @pixclock: The pixel clock wanted, in picoseconds.
331  *
332  * Given the specified pixel clock, work out the necessary divider to get
333  * close to the output frequency.
334  */
335 static int s3c_fb_calc_pixclk(struct s3c_fb *sfb, unsigned int pixclk)
336 {
337         unsigned long clk = clk_get_rate(sfb->bus_clk);
338         unsigned long long tmp;
339         unsigned int result;
340
341         tmp = (unsigned long long)clk;
342         tmp *= pixclk;
343
344         do_div(tmp, 1000000000UL);
345         result = (unsigned int)tmp / 1000;
346
347         dev_dbg(sfb->dev, "pixclk=%u, clk=%lu, div=%d (%lu)\n",
348                 pixclk, clk, result, clk / result);
349
350         return result;
351 }
352
353 /**
354  * s3c_fb_align_word() - align pixel count to word boundary
355  * @bpp: The number of bits per pixel
356  * @pix: The value to be aligned.
357  *
358  * Align the given pixel count so that it will start on an 32bit word
359  * boundary.
360  */
361 static int s3c_fb_align_word(unsigned int bpp, unsigned int pix)
362 {
363         int pix_per_word;
364
365         if (bpp > 16)
366                 return pix;
367
368         pix_per_word = (8 * 32) / bpp;
369         return ALIGN(pix, pix_per_word);
370 }
371
372 /**
373  * vidosd_set_size() - set OSD size for a window
374  *
375  * @win: the window to set OSD size for
376  * @size: OSD size register value
377  */
378 static void vidosd_set_size(struct s3c_fb_win *win, u32 size)
379 {
380         struct s3c_fb *sfb = win->parent;
381
382         /* OSD can be set up if osd_size_off != 0 for this window */
383         if (win->variant.osd_size_off)
384                 writel(size, sfb->regs + OSD_BASE(win->index, sfb->variant)
385                                 + win->variant.osd_size_off);
386 }
387
388 /**
389  * vidosd_set_alpha() - set alpha transparency for a window
390  *
391  * @win: the window to set OSD size for
392  * @alpha: alpha register value
393  */
394 static void vidosd_set_alpha(struct s3c_fb_win *win, u32 alpha)
395 {
396         struct s3c_fb *sfb = win->parent;
397
398         if (win->variant.has_osd_alpha)
399                 writel(alpha, sfb->regs + VIDOSD_C(win->index, sfb->variant));
400 }
401
402 /**
403  * shadow_protect_win() - disable updating values from shadow registers at vsync
404  *
405  * @win: window to protect registers for
406  * @protect: 1 to protect (disable updates)
407  */
408 static void shadow_protect_win(struct s3c_fb_win *win, bool protect)
409 {
410         struct s3c_fb *sfb = win->parent;
411         u32 reg;
412
413         if (protect) {
414                 if (sfb->variant.has_prtcon) {
415                         writel(PRTCON_PROTECT, sfb->regs + PRTCON);
416                 } else if (sfb->variant.has_shadowcon) {
417                         reg = readl(sfb->regs + SHADOWCON);
418                         writel(reg | SHADOWCON_WINx_PROTECT(win->index),
419                                 sfb->regs + SHADOWCON);
420                 }
421         } else {
422                 if (sfb->variant.has_prtcon) {
423                         writel(0, sfb->regs + PRTCON);
424                 } else if (sfb->variant.has_shadowcon) {
425                         reg = readl(sfb->regs + SHADOWCON);
426                         writel(reg & ~SHADOWCON_WINx_PROTECT(win->index),
427                                 sfb->regs + SHADOWCON);
428                 }
429         }
430 }
431
432 /**
433  * s3c_fb_set_par() - framebuffer request to set new framebuffer state.
434  * @info: The framebuffer to change.
435  *
436  * Framebuffer layer request to set a new mode for the specified framebuffer
437  */
438 static int s3c_fb_set_par(struct fb_info *info)
439 {
440         struct fb_var_screeninfo *var = &info->var;
441         struct s3c_fb_win *win = info->par;
442         struct s3c_fb *sfb = win->parent;
443         void __iomem *regs = sfb->regs;
444         void __iomem *buf = regs;
445         int win_no = win->index;
446         u32 alpha = 0;
447         u32 data;
448         u32 pagewidth;
449         int clkdiv;
450
451         dev_dbg(sfb->dev, "setting framebuffer parameters\n");
452
453         shadow_protect_win(win, 1);
454
455         switch (var->bits_per_pixel) {
456         case 32:
457         case 24:
458         case 16:
459         case 12:
460                 info->fix.visual = FB_VISUAL_TRUECOLOR;
461                 break;
462         case 8:
463                 if (win->variant.palette_sz >= 256)
464                         info->fix.visual = FB_VISUAL_PSEUDOCOLOR;
465                 else
466                         info->fix.visual = FB_VISUAL_TRUECOLOR;
467                 break;
468         case 1:
469                 info->fix.visual = FB_VISUAL_MONO01;
470                 break;
471         default:
472                 info->fix.visual = FB_VISUAL_PSEUDOCOLOR;
473                 break;
474         }
475
476         info->fix.line_length = (var->xres_virtual * var->bits_per_pixel) / 8;
477
478         info->fix.xpanstep = info->var.xres_virtual > info->var.xres ? 1 : 0;
479         info->fix.ypanstep = info->var.yres_virtual > info->var.yres ? 1 : 0;
480
481         /* disable the window whilst we update it */
482         writel(0, regs + WINCON(win_no));
483
484         /* use platform specified window as the basis for the lcd timings */
485
486         if (win_no == sfb->pdata->default_win) {
487                 clkdiv = s3c_fb_calc_pixclk(sfb, var->pixclock);
488
489                 data = sfb->pdata->vidcon0;
490                 data &= ~(VIDCON0_CLKVAL_F_MASK | VIDCON0_CLKDIR);
491
492                 if (clkdiv > 1)
493                         data |= VIDCON0_CLKVAL_F(clkdiv-1) | VIDCON0_CLKDIR;
494                 else
495                         data &= ~VIDCON0_CLKDIR;        /* 1:1 clock */
496
497                 /* write the timing data to the panel */
498
499                 if (sfb->variant.is_2443)
500                         data |= (1 << 5);
501
502                 data |= VIDCON0_ENVID | VIDCON0_ENVID_F;
503                 writel(data, regs + VIDCON0);
504
505                 data = VIDTCON0_VBPD(var->upper_margin - 1) |
506                        VIDTCON0_VFPD(var->lower_margin - 1) |
507                        VIDTCON0_VSPW(var->vsync_len - 1);
508
509                 writel(data, regs + sfb->variant.vidtcon);
510
511                 data = VIDTCON1_HBPD(var->left_margin - 1) |
512                        VIDTCON1_HFPD(var->right_margin - 1) |
513                        VIDTCON1_HSPW(var->hsync_len - 1);
514
515                 /* VIDTCON1 */
516                 writel(data, regs + sfb->variant.vidtcon + 4);
517
518                 data = VIDTCON2_LINEVAL(var->yres - 1) |
519                        VIDTCON2_HOZVAL(var->xres - 1);
520                 writel(data, regs +sfb->variant.vidtcon + 8 );
521         }
522
523         /* write the buffer address */
524
525         /* start and end registers stride is 8 */
526         buf = regs + win_no * 8;
527
528         writel(info->fix.smem_start, buf + sfb->variant.buf_start);
529
530         data = info->fix.smem_start + info->fix.line_length * var->yres;
531         writel(data, buf + sfb->variant.buf_end);
532
533         pagewidth = (var->xres * var->bits_per_pixel) >> 3;
534         data = VIDW_BUF_SIZE_OFFSET(info->fix.line_length - pagewidth) |
535                VIDW_BUF_SIZE_PAGEWIDTH(pagewidth);
536         writel(data, regs + sfb->variant.buf_size + (win_no * 4));
537
538         /* write 'OSD' registers to control position of framebuffer */
539
540         data = VIDOSDxA_TOPLEFT_X(0) | VIDOSDxA_TOPLEFT_Y(0);
541         writel(data, regs + VIDOSD_A(win_no, sfb->variant));
542
543         data = VIDOSDxB_BOTRIGHT_X(s3c_fb_align_word(var->bits_per_pixel,
544                                                      var->xres - 1)) |
545                VIDOSDxB_BOTRIGHT_Y(var->yres - 1);
546
547         writel(data, regs + VIDOSD_B(win_no, sfb->variant));
548
549         data = var->xres * var->yres;
550
551         alpha = VIDISD14C_ALPHA1_R(0xf) |
552                 VIDISD14C_ALPHA1_G(0xf) |
553                 VIDISD14C_ALPHA1_B(0xf);
554
555         vidosd_set_alpha(win, alpha);
556         vidosd_set_size(win, data);
557
558         data = WINCONx_ENWIN;
559
560         /* note, since we have to round up the bits-per-pixel, we end up
561          * relying on the bitfield information for r/g/b/a to work out
562          * exactly which mode of operation is intended. */
563
564         switch (var->bits_per_pixel) {
565         case 1:
566                 data |= WINCON0_BPPMODE_1BPP;
567                 data |= WINCONx_BITSWP;
568                 data |= WINCONx_BURSTLEN_4WORD;
569                 break;
570         case 2:
571                 data |= WINCON0_BPPMODE_2BPP;
572                 data |= WINCONx_BITSWP;
573                 data |= WINCONx_BURSTLEN_8WORD;
574                 break;
575         case 4:
576                 data |= WINCON0_BPPMODE_4BPP;
577                 data |= WINCONx_BITSWP;
578                 data |= WINCONx_BURSTLEN_8WORD;
579                 break;
580         case 8:
581                 if (var->transp.length != 0)
582                         data |= WINCON1_BPPMODE_8BPP_1232;
583                 else
584                         data |= WINCON0_BPPMODE_8BPP_PALETTE;
585                 data |= WINCONx_BURSTLEN_8WORD;
586                 data |= WINCONx_BYTSWP;
587                 break;
588         case 16:
589                 if (var->transp.length != 0)
590                         data |= WINCON1_BPPMODE_16BPP_A1555;
591                 else
592                         data |= WINCON0_BPPMODE_16BPP_565;
593                 data |= WINCONx_HAWSWP;
594                 data |= WINCONx_BURSTLEN_16WORD;
595                 break;
596         case 24:
597         case 32:
598                 if (var->red.length == 6) {
599                         if (var->transp.length != 0)
600                                 data |= WINCON1_BPPMODE_19BPP_A1666;
601                         else
602                                 data |= WINCON1_BPPMODE_18BPP_666;
603                 } else if (var->transp.length == 1)
604                         data |= WINCON1_BPPMODE_25BPP_A1888
605                                 | WINCON1_BLD_PIX;
606                 else if (var->transp.length == 4)
607                         data |= WINCON1_BPPMODE_28BPP_A4888
608                                 | WINCON1_BLD_PIX | WINCON1_ALPHA_SEL;
609                 else
610                         data |= WINCON0_BPPMODE_24BPP_888;
611
612                 data |= WINCONx_WSWP;
613                 data |= WINCONx_BURSTLEN_16WORD;
614                 break;
615         }
616
617         /* Enable the colour keying for the window below this one */
618         if (win_no > 0) {
619                 u32 keycon0_data = 0, keycon1_data = 0;
620                 void __iomem *keycon = regs + sfb->variant.keycon;
621
622                 keycon0_data = ~(WxKEYCON0_KEYBL_EN |
623                                 WxKEYCON0_KEYEN_F |
624                                 WxKEYCON0_DIRCON) | WxKEYCON0_COMPKEY(0);
625
626                 keycon1_data = WxKEYCON1_COLVAL(0xffffff);
627
628                 keycon += (win_no - 1) * 8;
629
630                 writel(keycon0_data, keycon + WKEYCON0);
631                 writel(keycon1_data, keycon + WKEYCON1);
632         }
633
634         writel(data, regs + sfb->variant.wincon + (win_no * 4));
635         writel(0x0, regs + sfb->variant.winmap + (win_no * 4));
636
637         shadow_protect_win(win, 0);
638
639         return 0;
640 }
641
642 /**
643  * s3c_fb_update_palette() - set or schedule a palette update.
644  * @sfb: The hardware information.
645  * @win: The window being updated.
646  * @reg: The palette index being changed.
647  * @value: The computed palette value.
648  *
649  * Change the value of a palette register, either by directly writing to
650  * the palette (this requires the palette RAM to be disconnected from the
651  * hardware whilst this is in progress) or schedule the update for later.
652  *
653  * At the moment, since we have no VSYNC interrupt support, we simply set
654  * the palette entry directly.
655  */
656 static void s3c_fb_update_palette(struct s3c_fb *sfb,
657                                   struct s3c_fb_win *win,
658                                   unsigned int reg,
659                                   u32 value)
660 {
661         void __iomem *palreg;
662         u32 palcon;
663
664         palreg = sfb->regs + sfb->variant.palette[win->index];
665
666         dev_dbg(sfb->dev, "%s: win %d, reg %d (%p): %08x\n",
667                 __func__, win->index, reg, palreg, value);
668
669         win->palette_buffer[reg] = value;
670
671         palcon = readl(sfb->regs + WPALCON);
672         writel(palcon | WPALCON_PAL_UPDATE, sfb->regs + WPALCON);
673
674         if (win->variant.palette_16bpp)
675                 writew(value, palreg + (reg * 2));
676         else
677                 writel(value, palreg + (reg * 4));
678
679         writel(palcon, sfb->regs + WPALCON);
680 }
681
682 static inline unsigned int chan_to_field(unsigned int chan,
683                                          struct fb_bitfield *bf)
684 {
685         chan &= 0xffff;
686         chan >>= 16 - bf->length;
687         return chan << bf->offset;
688 }
689
690 /**
691  * s3c_fb_setcolreg() - framebuffer layer request to change palette.
692  * @regno: The palette index to change.
693  * @red: The red field for the palette data.
694  * @green: The green field for the palette data.
695  * @blue: The blue field for the palette data.
696  * @trans: The transparency (alpha) field for the palette data.
697  * @info: The framebuffer being changed.
698  */
699 static int s3c_fb_setcolreg(unsigned regno,
700                             unsigned red, unsigned green, unsigned blue,
701                             unsigned transp, struct fb_info *info)
702 {
703         struct s3c_fb_win *win = info->par;
704         struct s3c_fb *sfb = win->parent;
705         unsigned int val;
706
707         dev_dbg(sfb->dev, "%s: win %d: %d => rgb=%d/%d/%d\n",
708                 __func__, win->index, regno, red, green, blue);
709
710         switch (info->fix.visual) {
711         case FB_VISUAL_TRUECOLOR:
712                 /* true-colour, use pseudo-palette */
713
714                 if (regno < 16) {
715                         u32 *pal = info->pseudo_palette;
716
717                         val  = chan_to_field(red,   &info->var.red);
718                         val |= chan_to_field(green, &info->var.green);
719                         val |= chan_to_field(blue,  &info->var.blue);
720
721                         pal[regno] = val;
722                 }
723                 break;
724
725         case FB_VISUAL_PSEUDOCOLOR:
726                 if (regno < win->variant.palette_sz) {
727                         val  = chan_to_field(red, &win->palette.r);
728                         val |= chan_to_field(green, &win->palette.g);
729                         val |= chan_to_field(blue, &win->palette.b);
730
731                         s3c_fb_update_palette(sfb, win, regno, val);
732                 }
733
734                 break;
735
736         default:
737                 return 1;       /* unknown type */
738         }
739
740         return 0;
741 }
742
743 /**
744  * s3c_fb_enable() - Set the state of the main LCD output
745  * @sfb: The main framebuffer state.
746  * @enable: The state to set.
747  */
748 static void s3c_fb_enable(struct s3c_fb *sfb, int enable)
749 {
750         u32 vidcon0 = readl(sfb->regs + VIDCON0);
751
752         if (enable)
753                 vidcon0 |= VIDCON0_ENVID | VIDCON0_ENVID_F;
754         else {
755                 /* see the note in the framebuffer datasheet about
756                  * why you cannot take both of these bits down at the
757                  * same time. */
758
759                 if (!(vidcon0 & VIDCON0_ENVID))
760                         return;
761
762                 vidcon0 |= VIDCON0_ENVID;
763                 vidcon0 &= ~VIDCON0_ENVID_F;
764         }
765
766         writel(vidcon0, sfb->regs + VIDCON0);
767 }
768
769 /**
770  * s3c_fb_blank() - blank or unblank the given window
771  * @blank_mode: The blank state from FB_BLANK_*
772  * @info: The framebuffer to blank.
773  *
774  * Framebuffer layer request to change the power state.
775  */
776 static int s3c_fb_blank(int blank_mode, struct fb_info *info)
777 {
778         struct s3c_fb_win *win = info->par;
779         struct s3c_fb *sfb = win->parent;
780         unsigned int index = win->index;
781         u32 wincon;
782
783         dev_dbg(sfb->dev, "blank mode %d\n", blank_mode);
784
785         wincon = readl(sfb->regs + sfb->variant.wincon + (index * 4));
786
787         switch (blank_mode) {
788         case FB_BLANK_POWERDOWN:
789                 wincon &= ~WINCONx_ENWIN;
790                 sfb->enabled &= ~(1 << index);
791                 /* fall through to FB_BLANK_NORMAL */
792
793         case FB_BLANK_NORMAL:
794                 /* disable the DMA and display 0x0 (black) */
795                 writel(WINxMAP_MAP | WINxMAP_MAP_COLOUR(0x0),
796                        sfb->regs + sfb->variant.winmap + (index * 4));
797                 break;
798
799         case FB_BLANK_UNBLANK:
800                 writel(0x0, sfb->regs + sfb->variant.winmap + (index * 4));
801                 wincon |= WINCONx_ENWIN;
802                 sfb->enabled |= (1 << index);
803                 break;
804
805         case FB_BLANK_VSYNC_SUSPEND:
806         case FB_BLANK_HSYNC_SUSPEND:
807         default:
808                 return 1;
809         }
810
811         writel(wincon, sfb->regs + sfb->variant.wincon + (index * 4));
812
813         /* Check the enabled state to see if we need to be running the
814          * main LCD interface, as if there are no active windows then
815          * it is highly likely that we also do not need to output
816          * anything.
817          */
818
819         /* We could do something like the following code, but the current
820          * system of using framebuffer events means that we cannot make
821          * the distinction between just window 0 being inactive and all
822          * the windows being down.
823          *
824          * s3c_fb_enable(sfb, sfb->enabled ? 1 : 0);
825         */
826
827         /* we're stuck with this until we can do something about overriding
828          * the power control using the blanking event for a single fb.
829          */
830         if (index == sfb->pdata->default_win)
831                 s3c_fb_enable(sfb, blank_mode != FB_BLANK_POWERDOWN ? 1 : 0);
832
833         return 0;
834 }
835
836 /**
837  * s3c_fb_pan_display() - Pan the display.
838  *
839  * Note that the offsets can be written to the device at any time, as their
840  * values are latched at each vsync automatically. This also means that only
841  * the last call to this function will have any effect on next vsync, but
842  * there is no need to sleep waiting for it to prevent tearing.
843  *
844  * @var: The screen information to verify.
845  * @info: The framebuffer device.
846  */
847 static int s3c_fb_pan_display(struct fb_var_screeninfo *var,
848                               struct fb_info *info)
849 {
850         struct s3c_fb_win *win  = info->par;
851         struct s3c_fb *sfb      = win->parent;
852         void __iomem *buf       = sfb->regs + win->index * 8;
853         unsigned int start_boff, end_boff;
854
855         /* Offset in bytes to the start of the displayed area */
856         start_boff = var->yoffset * info->fix.line_length;
857         /* X offset depends on the current bpp */
858         if (info->var.bits_per_pixel >= 8) {
859                 start_boff += var->xoffset * (info->var.bits_per_pixel >> 3);
860         } else {
861                 switch (info->var.bits_per_pixel) {
862                 case 4:
863                         start_boff += var->xoffset >> 1;
864                         break;
865                 case 2:
866                         start_boff += var->xoffset >> 2;
867                         break;
868                 case 1:
869                         start_boff += var->xoffset >> 3;
870                         break;
871                 default:
872                         dev_err(sfb->dev, "invalid bpp\n");
873                         return -EINVAL;
874                 }
875         }
876         /* Offset in bytes to the end of the displayed area */
877         end_boff = start_boff + var->yres * info->fix.line_length;
878
879         /* Temporarily turn off per-vsync update from shadow registers until
880          * both start and end addresses are updated to prevent corruption */
881         shadow_protect_win(win, 1);
882
883         writel(info->fix.smem_start + start_boff, buf + sfb->variant.buf_start);
884         writel(info->fix.smem_start + end_boff, buf + sfb->variant.buf_end);
885
886         shadow_protect_win(win, 0);
887
888         return 0;
889 }
890
891 /**
892  * s3c_fb_enable_irq() - enable framebuffer interrupts
893  * @sfb: main hardware state
894  */
895 static void s3c_fb_enable_irq(struct s3c_fb *sfb)
896 {
897         void __iomem *regs = sfb->regs;
898         u32 irq_ctrl_reg;
899
900         if (!test_and_set_bit(S3C_FB_VSYNC_IRQ_EN, &sfb->irq_flags)) {
901                 /* IRQ disabled, enable it */
902                 irq_ctrl_reg = readl(regs + VIDINTCON0);
903
904                 irq_ctrl_reg |= VIDINTCON0_INT_ENABLE;
905                 irq_ctrl_reg |= VIDINTCON0_INT_FRAME;
906
907                 irq_ctrl_reg &= ~VIDINTCON0_FRAMESEL0_MASK;
908                 irq_ctrl_reg |= VIDINTCON0_FRAMESEL0_VSYNC;
909                 irq_ctrl_reg &= ~VIDINTCON0_FRAMESEL1_MASK;
910                 irq_ctrl_reg |= VIDINTCON0_FRAMESEL1_NONE;
911
912                 writel(irq_ctrl_reg, regs + VIDINTCON0);
913         }
914 }
915
916 /**
917  * s3c_fb_disable_irq() - disable framebuffer interrupts
918  * @sfb: main hardware state
919  */
920 static void s3c_fb_disable_irq(struct s3c_fb *sfb)
921 {
922         void __iomem *regs = sfb->regs;
923         u32 irq_ctrl_reg;
924
925         if (test_and_clear_bit(S3C_FB_VSYNC_IRQ_EN, &sfb->irq_flags)) {
926                 /* IRQ enabled, disable it */
927                 irq_ctrl_reg = readl(regs + VIDINTCON0);
928
929                 irq_ctrl_reg &= ~VIDINTCON0_INT_FRAME;
930                 irq_ctrl_reg &= ~VIDINTCON0_INT_ENABLE;
931
932                 writel(irq_ctrl_reg, regs + VIDINTCON0);
933         }
934 }
935
936 static irqreturn_t s3c_fb_irq(int irq, void *dev_id)
937 {
938         struct s3c_fb *sfb = dev_id;
939         void __iomem  *regs = sfb->regs;
940         u32 irq_sts_reg;
941
942         irq_sts_reg = readl(regs + VIDINTCON1);
943
944         if (irq_sts_reg & VIDINTCON1_INT_FRAME) {
945
946                 /* VSYNC interrupt, accept it */
947                 writel(VIDINTCON1_INT_FRAME, regs + VIDINTCON1);
948
949                 sfb->vsync_info.count++;
950                 wake_up_interruptible(&sfb->vsync_info.wait);
951         }
952
953         /* We only support waiting for VSYNC for now, so it's safe
954          * to always disable irqs here.
955          */
956         s3c_fb_disable_irq(sfb);
957
958         return IRQ_HANDLED;
959 }
960
961 /**
962  * s3c_fb_wait_for_vsync() - sleep until next VSYNC interrupt or timeout
963  * @sfb: main hardware state
964  * @crtc: head index.
965  */
966 static int s3c_fb_wait_for_vsync(struct s3c_fb *sfb, u32 crtc)
967 {
968         unsigned long count;
969         int ret;
970
971         if (crtc != 0)
972                 return -ENODEV;
973
974         count = sfb->vsync_info.count;
975         s3c_fb_enable_irq(sfb);
976         ret = wait_event_interruptible_timeout(sfb->vsync_info.wait,
977                                        count != sfb->vsync_info.count,
978                                        msecs_to_jiffies(VSYNC_TIMEOUT_MSEC));
979         if (ret == 0)
980                 return -ETIMEDOUT;
981
982         return 0;
983 }
984
985 static int s3c_fb_ioctl(struct fb_info *info, unsigned int cmd,
986                         unsigned long arg)
987 {
988         struct s3c_fb_win *win = info->par;
989         struct s3c_fb *sfb = win->parent;
990         int ret;
991         u32 crtc;
992
993         switch (cmd) {
994         case FBIO_WAITFORVSYNC:
995                 if (get_user(crtc, (u32 __user *)arg)) {
996                         ret = -EFAULT;
997                         break;
998                 }
999
1000                 ret = s3c_fb_wait_for_vsync(sfb, crtc);
1001                 break;
1002         default:
1003                 ret = -ENOTTY;
1004         }
1005
1006         return ret;
1007 }
1008
1009 static struct fb_ops s3c_fb_ops = {
1010         .owner          = THIS_MODULE,
1011         .fb_check_var   = s3c_fb_check_var,
1012         .fb_set_par     = s3c_fb_set_par,
1013         .fb_blank       = s3c_fb_blank,
1014         .fb_setcolreg   = s3c_fb_setcolreg,
1015         .fb_fillrect    = cfb_fillrect,
1016         .fb_copyarea    = cfb_copyarea,
1017         .fb_imageblit   = cfb_imageblit,
1018         .fb_pan_display = s3c_fb_pan_display,
1019         .fb_ioctl       = s3c_fb_ioctl,
1020 };
1021
1022 /**
1023  * s3c_fb_alloc_memory() - allocate display memory for framebuffer window
1024  * @sfb: The base resources for the hardware.
1025  * @win: The window to initialise memory for.
1026  *
1027  * Allocate memory for the given framebuffer.
1028  */
1029 static int __devinit s3c_fb_alloc_memory(struct s3c_fb *sfb,
1030                                          struct s3c_fb_win *win)
1031 {
1032         struct s3c_fb_pd_win *windata = win->windata;
1033         unsigned int real_size, virt_size, size;
1034         struct fb_info *fbi = win->fbinfo;
1035         dma_addr_t map_dma;
1036
1037         dev_dbg(sfb->dev, "allocating memory for display\n");
1038
1039         real_size = windata->win_mode.xres * windata->win_mode.yres;
1040         virt_size = windata->virtual_x * windata->virtual_y;
1041
1042         dev_dbg(sfb->dev, "real_size=%u (%u.%u), virt_size=%u (%u.%u)\n",
1043                 real_size, windata->win_mode.xres, windata->win_mode.yres,
1044                 virt_size, windata->virtual_x, windata->virtual_y);
1045
1046         size = (real_size > virt_size) ? real_size : virt_size;
1047         size *= (windata->max_bpp > 16) ? 32 : windata->max_bpp;
1048         size /= 8;
1049
1050         fbi->fix.smem_len = size;
1051         size = PAGE_ALIGN(size);
1052
1053         dev_dbg(sfb->dev, "want %u bytes for window\n", size);
1054
1055         fbi->screen_base = dma_alloc_writecombine(sfb->dev, size,
1056                                                   &map_dma, GFP_KERNEL);
1057         if (!fbi->screen_base)
1058                 return -ENOMEM;
1059
1060         dev_dbg(sfb->dev, "mapped %x to %p\n",
1061                 (unsigned int)map_dma, fbi->screen_base);
1062
1063         memset(fbi->screen_base, 0x0, size);
1064         fbi->fix.smem_start = map_dma;
1065
1066         return 0;
1067 }
1068
1069 /**
1070  * s3c_fb_free_memory() - free the display memory for the given window
1071  * @sfb: The base resources for the hardware.
1072  * @win: The window to free the display memory for.
1073  *
1074  * Free the display memory allocated by s3c_fb_alloc_memory().
1075  */
1076 static void s3c_fb_free_memory(struct s3c_fb *sfb, struct s3c_fb_win *win)
1077 {
1078         struct fb_info *fbi = win->fbinfo;
1079
1080         if (fbi->screen_base)
1081                 dma_free_writecombine(sfb->dev, PAGE_ALIGN(fbi->fix.smem_len),
1082                               fbi->screen_base, fbi->fix.smem_start);
1083 }
1084
1085 /**
1086  * s3c_fb_release_win() - release resources for a framebuffer window.
1087  * @win: The window to cleanup the resources for.
1088  *
1089  * Release the resources that where claimed for the hardware window,
1090  * such as the framebuffer instance and any memory claimed for it.
1091  */
1092 static void s3c_fb_release_win(struct s3c_fb *sfb, struct s3c_fb_win *win)
1093 {
1094         if (win->fbinfo) {
1095                 unregister_framebuffer(win->fbinfo);
1096                 if (win->fbinfo->cmap.len)
1097                         fb_dealloc_cmap(&win->fbinfo->cmap);
1098                 s3c_fb_free_memory(sfb, win);
1099                 framebuffer_release(win->fbinfo);
1100         }
1101 }
1102
1103 /**
1104  * s3c_fb_probe_win() - register an hardware window
1105  * @sfb: The base resources for the hardware
1106  * @variant: The variant information for this window.
1107  * @res: Pointer to where to place the resultant window.
1108  *
1109  * Allocate and do the basic initialisation for one of the hardware's graphics
1110  * windows.
1111  */
1112 static int __devinit s3c_fb_probe_win(struct s3c_fb *sfb, unsigned int win_no,
1113                                       struct s3c_fb_win_variant *variant,
1114                                       struct s3c_fb_win **res)
1115 {
1116         struct fb_var_screeninfo *var;
1117         struct fb_videomode *initmode;
1118         struct s3c_fb_pd_win *windata;
1119         struct s3c_fb_win *win;
1120         struct fb_info *fbinfo;
1121         int palette_size;
1122         int ret;
1123
1124         dev_dbg(sfb->dev, "probing window %d, variant %p\n", win_no, variant);
1125
1126         init_waitqueue_head(&sfb->vsync_info.wait);
1127
1128         palette_size = variant->palette_sz * 4;
1129
1130         fbinfo = framebuffer_alloc(sizeof(struct s3c_fb_win) +
1131                                    palette_size * sizeof(u32), sfb->dev);
1132         if (!fbinfo) {
1133                 dev_err(sfb->dev, "failed to allocate framebuffer\n");
1134                 return -ENOENT;
1135         }
1136
1137         windata = sfb->pdata->win[win_no];
1138         initmode = &windata->win_mode;
1139
1140         WARN_ON(windata->max_bpp == 0);
1141         WARN_ON(windata->win_mode.xres == 0);
1142         WARN_ON(windata->win_mode.yres == 0);
1143
1144         win = fbinfo->par;
1145         *res = win;
1146         var = &fbinfo->var;
1147         win->variant = *variant;
1148         win->fbinfo = fbinfo;
1149         win->parent = sfb;
1150         win->windata = windata;
1151         win->index = win_no;
1152         win->palette_buffer = (u32 *)(win + 1);
1153
1154         ret = s3c_fb_alloc_memory(sfb, win);
1155         if (ret) {
1156                 dev_err(sfb->dev, "failed to allocate display memory\n");
1157                 return ret;
1158         }
1159
1160         /* setup the r/b/g positions for the window's palette */
1161         if (win->variant.palette_16bpp) {
1162                 /* Set RGB 5:6:5 as default */
1163                 win->palette.r.offset = 11;
1164                 win->palette.r.length = 5;
1165                 win->palette.g.offset = 5;
1166                 win->palette.g.length = 6;
1167                 win->palette.b.offset = 0;
1168                 win->palette.b.length = 5;
1169
1170         } else {
1171                 /* Set 8bpp or 8bpp and 1bit alpha */
1172                 win->palette.r.offset = 16;
1173                 win->palette.r.length = 8;
1174                 win->palette.g.offset = 8;
1175                 win->palette.g.length = 8;
1176                 win->palette.b.offset = 0;
1177                 win->palette.b.length = 8;
1178         }
1179
1180         /* setup the initial video mode from the window */
1181         fb_videomode_to_var(&fbinfo->var, initmode);
1182
1183         fbinfo->fix.type        = FB_TYPE_PACKED_PIXELS;
1184         fbinfo->fix.accel       = FB_ACCEL_NONE;
1185         fbinfo->var.activate    = FB_ACTIVATE_NOW;
1186         fbinfo->var.vmode       = FB_VMODE_NONINTERLACED;
1187         fbinfo->var.bits_per_pixel = windata->default_bpp;
1188         fbinfo->fbops           = &s3c_fb_ops;
1189         fbinfo->flags           = FBINFO_FLAG_DEFAULT;
1190         fbinfo->pseudo_palette  = &win->pseudo_palette;
1191
1192         /* prepare to actually start the framebuffer */
1193
1194         ret = s3c_fb_check_var(&fbinfo->var, fbinfo);
1195         if (ret < 0) {
1196                 dev_err(sfb->dev, "check_var failed on initial video params\n");
1197                 return ret;
1198         }
1199
1200         /* create initial colour map */
1201
1202         ret = fb_alloc_cmap(&fbinfo->cmap, win->variant.palette_sz, 1);
1203         if (ret == 0)
1204                 fb_set_cmap(&fbinfo->cmap, fbinfo);
1205         else
1206                 dev_err(sfb->dev, "failed to allocate fb cmap\n");
1207
1208         s3c_fb_set_par(fbinfo);
1209
1210         dev_dbg(sfb->dev, "about to register framebuffer\n");
1211
1212         /* run the check_var and set_par on our configuration. */
1213
1214         ret = register_framebuffer(fbinfo);
1215         if (ret < 0) {
1216                 dev_err(sfb->dev, "failed to register framebuffer\n");
1217                 return ret;
1218         }
1219
1220         dev_info(sfb->dev, "window %d: fb %s\n", win_no, fbinfo->fix.id);
1221
1222         return 0;
1223 }
1224
1225 /**
1226  * s3c_fb_clear_win() - clear hardware window registers.
1227  * @sfb: The base resources for the hardware.
1228  * @win: The window to process.
1229  *
1230  * Reset the specific window registers to a known state.
1231  */
1232 static void s3c_fb_clear_win(struct s3c_fb *sfb, int win)
1233 {
1234         void __iomem *regs = sfb->regs;
1235         u32 reg;
1236
1237         writel(0, regs + sfb->variant.wincon + (win * 4));
1238         writel(0, regs + VIDOSD_A(win, sfb->variant));
1239         writel(0, regs + VIDOSD_B(win, sfb->variant));
1240         writel(0, regs + VIDOSD_C(win, sfb->variant));
1241         reg = readl(regs + SHADOWCON);
1242         writel(reg & ~SHADOWCON_WINx_PROTECT(win), regs + SHADOWCON);
1243 }
1244
1245 static int __devinit s3c_fb_probe(struct platform_device *pdev)
1246 {
1247         struct s3c_fb_driverdata *fbdrv;
1248         struct device *dev = &pdev->dev;
1249         struct s3c_fb_platdata *pd;
1250         struct s3c_fb *sfb;
1251         struct resource *res;
1252         int win;
1253         int ret = 0;
1254
1255         fbdrv = (struct s3c_fb_driverdata *)platform_get_device_id(pdev)->driver_data;
1256
1257         if (fbdrv->variant.nr_windows > S3C_FB_MAX_WIN) {
1258                 dev_err(dev, "too many windows, cannot attach\n");
1259                 return -EINVAL;
1260         }
1261
1262         pd = pdev->dev.platform_data;
1263         if (!pd) {
1264                 dev_err(dev, "no platform data specified\n");
1265                 return -EINVAL;
1266         }
1267
1268         sfb = kzalloc(sizeof(struct s3c_fb), GFP_KERNEL);
1269         if (!sfb) {
1270                 dev_err(dev, "no memory for framebuffers\n");
1271                 return -ENOMEM;
1272         }
1273
1274         dev_dbg(dev, "allocate new framebuffer %p\n", sfb);
1275
1276         sfb->dev = dev;
1277         sfb->pdata = pd;
1278         sfb->variant = fbdrv->variant;
1279
1280         sfb->bus_clk = clk_get(dev, "lcd");
1281         if (IS_ERR(sfb->bus_clk)) {
1282                 dev_err(dev, "failed to get bus clock\n");
1283                 goto err_sfb;
1284         }
1285
1286         clk_enable(sfb->bus_clk);
1287
1288         res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
1289         if (!res) {
1290                 dev_err(dev, "failed to find registers\n");
1291                 ret = -ENOENT;
1292                 goto err_clk;
1293         }
1294
1295         sfb->regs_res = request_mem_region(res->start, resource_size(res),
1296                                            dev_name(dev));
1297         if (!sfb->regs_res) {
1298                 dev_err(dev, "failed to claim register region\n");
1299                 ret = -ENOENT;
1300                 goto err_clk;
1301         }
1302
1303         sfb->regs = ioremap(res->start, resource_size(res));
1304         if (!sfb->regs) {
1305                 dev_err(dev, "failed to map registers\n");
1306                 ret = -ENXIO;
1307                 goto err_req_region;
1308         }
1309
1310         res = platform_get_resource(pdev, IORESOURCE_IRQ, 0);
1311         if (!res) {
1312                 dev_err(dev, "failed to acquire irq resource\n");
1313                 ret = -ENOENT;
1314                 goto err_ioremap;
1315         }
1316         sfb->irq_no = res->start;
1317         ret = request_irq(sfb->irq_no, s3c_fb_irq,
1318                           0, "s3c_fb", sfb);
1319         if (ret) {
1320                 dev_err(dev, "irq request failed\n");
1321                 goto err_ioremap;
1322         }
1323
1324         dev_dbg(dev, "got resources (regs %p), probing windows\n", sfb->regs);
1325
1326         /* setup gpio and output polarity controls */
1327
1328         pd->setup_gpio();
1329
1330         writel(pd->vidcon1, sfb->regs + VIDCON1);
1331
1332         /* zero all windows before we do anything */
1333
1334         for (win = 0; win < fbdrv->variant.nr_windows; win++)
1335                 s3c_fb_clear_win(sfb, win);
1336
1337         /* initialise colour key controls */
1338         for (win = 0; win < (fbdrv->variant.nr_windows - 1); win++) {
1339                 void __iomem *regs = sfb->regs + sfb->variant.keycon;
1340
1341                 regs += (win * 8);
1342                 writel(0xffffff, regs + WKEYCON0);
1343                 writel(0xffffff, regs + WKEYCON1);
1344         }
1345
1346         /* we have the register setup, start allocating framebuffers */
1347
1348         for (win = 0; win < fbdrv->variant.nr_windows; win++) {
1349                 if (!pd->win[win])
1350                         continue;
1351
1352                 ret = s3c_fb_probe_win(sfb, win, fbdrv->win[win],
1353                                        &sfb->windows[win]);
1354                 if (ret < 0) {
1355                         dev_err(dev, "failed to create window %d\n", win);
1356                         for (; win >= 0; win--)
1357                                 s3c_fb_release_win(sfb, sfb->windows[win]);
1358                         goto err_irq;
1359                 }
1360         }
1361
1362         platform_set_drvdata(pdev, sfb);
1363
1364         return 0;
1365
1366 err_irq:
1367         free_irq(sfb->irq_no, sfb);
1368
1369 err_ioremap:
1370         iounmap(sfb->regs);
1371
1372 err_req_region:
1373         release_resource(sfb->regs_res);
1374         kfree(sfb->regs_res);
1375
1376 err_clk:
1377         clk_disable(sfb->bus_clk);
1378         clk_put(sfb->bus_clk);
1379
1380 err_sfb:
1381         kfree(sfb);
1382         return ret;
1383 }
1384
1385 /**
1386  * s3c_fb_remove() - Cleanup on module finalisation
1387  * @pdev: The platform device we are bound to.
1388  *
1389  * Shutdown and then release all the resources that the driver allocated
1390  * on initialisation.
1391  */
1392 static int __devexit s3c_fb_remove(struct platform_device *pdev)
1393 {
1394         struct s3c_fb *sfb = platform_get_drvdata(pdev);
1395         int win;
1396
1397         for (win = 0; win < S3C_FB_MAX_WIN; win++)
1398                 if (sfb->windows[win])
1399                         s3c_fb_release_win(sfb, sfb->windows[win]);
1400
1401         free_irq(sfb->irq_no, sfb);
1402
1403         iounmap(sfb->regs);
1404
1405         clk_disable(sfb->bus_clk);
1406         clk_put(sfb->bus_clk);
1407
1408         release_resource(sfb->regs_res);
1409         kfree(sfb->regs_res);
1410
1411         kfree(sfb);
1412
1413         return 0;
1414 }
1415
1416 #ifdef CONFIG_PM
1417 static int s3c_fb_suspend(struct platform_device *pdev, pm_message_t state)
1418 {
1419         struct s3c_fb *sfb = platform_get_drvdata(pdev);
1420         struct s3c_fb_win *win;
1421         int win_no;
1422
1423         for (win_no = S3C_FB_MAX_WIN - 1; win_no >= 0; win_no--) {
1424                 win = sfb->windows[win_no];
1425                 if (!win)
1426                         continue;
1427
1428                 /* use the blank function to push into power-down */
1429                 s3c_fb_blank(FB_BLANK_POWERDOWN, win->fbinfo);
1430         }
1431
1432         clk_disable(sfb->bus_clk);
1433         return 0;
1434 }
1435
1436 static int s3c_fb_resume(struct platform_device *pdev)
1437 {
1438         struct s3c_fb *sfb = platform_get_drvdata(pdev);
1439         struct s3c_fb_platdata *pd = sfb->pdata;
1440         struct s3c_fb_win *win;
1441         int win_no;
1442
1443         clk_enable(sfb->bus_clk);
1444
1445         /* setup registers */
1446         writel(pd->vidcon1, sfb->regs + VIDCON1);
1447
1448         /* zero all windows before we do anything */
1449         for (win_no = 0; win_no < sfb->variant.nr_windows; win_no++)
1450                 s3c_fb_clear_win(sfb, win_no);
1451
1452         for (win_no = 0; win_no < sfb->variant.nr_windows - 1; win_no++) {
1453                 void __iomem *regs = sfb->regs + sfb->variant.keycon;
1454
1455                 regs += (win_no * 8);
1456                 writel(0xffffff, regs + WKEYCON0);
1457                 writel(0xffffff, regs + WKEYCON1);
1458         }
1459
1460         /* restore framebuffers */
1461         for (win_no = 0; win_no < S3C_FB_MAX_WIN; win_no++) {
1462                 win = sfb->windows[win_no];
1463                 if (!win)
1464                         continue;
1465
1466                 dev_dbg(&pdev->dev, "resuming window %d\n", win_no);
1467                 s3c_fb_set_par(win->fbinfo);
1468         }
1469
1470         return 0;
1471 }
1472 #else
1473 #define s3c_fb_suspend NULL
1474 #define s3c_fb_resume  NULL
1475 #endif
1476
1477
1478 #define VALID_BPP124 (VALID_BPP(1) | VALID_BPP(2) | VALID_BPP(4))
1479 #define VALID_BPP1248 (VALID_BPP124 | VALID_BPP(8))
1480
1481 static struct s3c_fb_win_variant s3c_fb_data_64xx_wins[] = {
1482         [0] = {
1483                 .has_osd_c      = 1,
1484                 .osd_size_off   = 0x8,
1485                 .palette_sz     = 256,
1486                 .valid_bpp      = VALID_BPP1248 | VALID_BPP(16) | VALID_BPP(24),
1487         },
1488         [1] = {
1489                 .has_osd_c      = 1,
1490                 .has_osd_d      = 1,
1491                 .osd_size_off   = 0x12,
1492                 .has_osd_alpha  = 1,
1493                 .palette_sz     = 256,
1494                 .valid_bpp      = (VALID_BPP1248 | VALID_BPP(16) |
1495                                    VALID_BPP(18) | VALID_BPP(19) |
1496                                    VALID_BPP(24) | VALID_BPP(25)),
1497         },
1498         [2] = {
1499                 .has_osd_c      = 1,
1500                 .has_osd_d      = 1,
1501                 .osd_size_off   = 0x12,
1502                 .has_osd_alpha  = 1,
1503                 .palette_sz     = 16,
1504                 .palette_16bpp  = 1,
1505                 .valid_bpp      = (VALID_BPP1248 | VALID_BPP(16) |
1506                                    VALID_BPP(18) | VALID_BPP(19) |
1507                                    VALID_BPP(24) | VALID_BPP(25)),
1508         },
1509         [3] = {
1510                 .has_osd_c      = 1,
1511                 .has_osd_alpha  = 1,
1512                 .palette_sz     = 16,
1513                 .palette_16bpp  = 1,
1514                 .valid_bpp      = (VALID_BPP124  | VALID_BPP(16) |
1515                                    VALID_BPP(18) | VALID_BPP(19) |
1516                                    VALID_BPP(24) | VALID_BPP(25)),
1517         },
1518         [4] = {
1519                 .has_osd_c      = 1,
1520                 .has_osd_alpha  = 1,
1521                 .palette_sz     = 4,
1522                 .palette_16bpp  = 1,
1523                 .valid_bpp      = (VALID_BPP(1) | VALID_BPP(2) |
1524                                    VALID_BPP(16) | VALID_BPP(18) |
1525                                    VALID_BPP(24) | VALID_BPP(25)),
1526         },
1527 };
1528
1529 static struct s3c_fb_driverdata s3c_fb_data_64xx = {
1530         .variant = {
1531                 .nr_windows     = 5,
1532                 .vidtcon        = VIDTCON0,
1533                 .wincon         = WINCON(0),
1534                 .winmap         = WINxMAP(0),
1535                 .keycon         = WKEYCON,
1536                 .osd            = VIDOSD_BASE,
1537                 .osd_stride     = 16,
1538                 .buf_start      = VIDW_BUF_START(0),
1539                 .buf_size       = VIDW_BUF_SIZE(0),
1540                 .buf_end        = VIDW_BUF_END(0),
1541
1542                 .palette = {
1543                         [0] = 0x400,
1544                         [1] = 0x800,
1545                         [2] = 0x300,
1546                         [3] = 0x320,
1547                         [4] = 0x340,
1548                 },
1549
1550                 .has_prtcon     = 1,
1551         },
1552         .win[0] = &s3c_fb_data_64xx_wins[0],
1553         .win[1] = &s3c_fb_data_64xx_wins[1],
1554         .win[2] = &s3c_fb_data_64xx_wins[2],
1555         .win[3] = &s3c_fb_data_64xx_wins[3],
1556         .win[4] = &s3c_fb_data_64xx_wins[4],
1557 };
1558
1559 static struct s3c_fb_driverdata s3c_fb_data_s5pc100 = {
1560         .variant = {
1561                 .nr_windows     = 5,
1562                 .vidtcon        = VIDTCON0,
1563                 .wincon         = WINCON(0),
1564                 .winmap         = WINxMAP(0),
1565                 .keycon         = WKEYCON,
1566                 .osd            = VIDOSD_BASE,
1567                 .osd_stride     = 16,
1568                 .buf_start      = VIDW_BUF_START(0),
1569                 .buf_size       = VIDW_BUF_SIZE(0),
1570                 .buf_end        = VIDW_BUF_END(0),
1571
1572                 .palette = {
1573                         [0] = 0x2400,
1574                         [1] = 0x2800,
1575                         [2] = 0x2c00,
1576                         [3] = 0x3000,
1577                         [4] = 0x3400,
1578                 },
1579
1580                 .has_prtcon     = 1,
1581         },
1582         .win[0] = &s3c_fb_data_64xx_wins[0],
1583         .win[1] = &s3c_fb_data_64xx_wins[1],
1584         .win[2] = &s3c_fb_data_64xx_wins[2],
1585         .win[3] = &s3c_fb_data_64xx_wins[3],
1586         .win[4] = &s3c_fb_data_64xx_wins[4],
1587 };
1588
1589 static struct s3c_fb_driverdata s3c_fb_data_s5pv210 = {
1590         .variant = {
1591                 .nr_windows     = 5,
1592                 .vidtcon        = VIDTCON0,
1593                 .wincon         = WINCON(0),
1594                 .winmap         = WINxMAP(0),
1595                 .keycon         = WKEYCON,
1596                 .osd            = VIDOSD_BASE,
1597                 .osd_stride     = 16,
1598                 .buf_start      = VIDW_BUF_START(0),
1599                 .buf_size       = VIDW_BUF_SIZE(0),
1600                 .buf_end        = VIDW_BUF_END(0),
1601
1602                 .palette = {
1603                         [0] = 0x2400,
1604                         [1] = 0x2800,
1605                         [2] = 0x2c00,
1606                         [3] = 0x3000,
1607                         [4] = 0x3400,
1608                 },
1609
1610                 .has_shadowcon  = 1,
1611         },
1612         .win[0] = &s3c_fb_data_64xx_wins[0],
1613         .win[1] = &s3c_fb_data_64xx_wins[1],
1614         .win[2] = &s3c_fb_data_64xx_wins[2],
1615         .win[3] = &s3c_fb_data_64xx_wins[3],
1616         .win[4] = &s3c_fb_data_64xx_wins[4],
1617 };
1618
1619 /* S3C2443/S3C2416 style hardware */
1620 static struct s3c_fb_driverdata s3c_fb_data_s3c2443 = {
1621         .variant = {
1622                 .nr_windows     = 2,
1623                 .is_2443        = 1,
1624
1625                 .vidtcon        = 0x08,
1626                 .wincon         = 0x14,
1627                 .winmap         = 0xd0,
1628                 .keycon         = 0xb0,
1629                 .osd            = 0x28,
1630                 .osd_stride     = 12,
1631                 .buf_start      = 0x64,
1632                 .buf_size       = 0x94,
1633                 .buf_end        = 0x7c,
1634
1635                 .palette = {
1636                         [0] = 0x400,
1637                         [1] = 0x800,
1638                 },
1639         },
1640         .win[0] = &(struct s3c_fb_win_variant) {
1641                 .palette_sz     = 256,
1642                 .valid_bpp      = VALID_BPP1248 | VALID_BPP(16) | VALID_BPP(24),
1643         },
1644         .win[1] = &(struct s3c_fb_win_variant) {
1645                 .has_osd_c      = 1,
1646                 .has_osd_alpha  = 1,
1647                 .palette_sz     = 256,
1648                 .valid_bpp      = (VALID_BPP1248 | VALID_BPP(16) |
1649                                    VALID_BPP(18) | VALID_BPP(19) |
1650                                    VALID_BPP(24) | VALID_BPP(25) |
1651                                    VALID_BPP(28)),
1652         },
1653 };
1654
1655 static struct platform_device_id s3c_fb_driver_ids[] = {
1656         {
1657                 .name           = "s3c-fb",
1658                 .driver_data    = (unsigned long)&s3c_fb_data_64xx,
1659         }, {
1660                 .name           = "s5pc100-fb",
1661                 .driver_data    = (unsigned long)&s3c_fb_data_s5pc100,
1662         }, {
1663                 .name           = "s5pv210-fb",
1664                 .driver_data    = (unsigned long)&s3c_fb_data_s5pv210,
1665         }, {
1666                 .name           = "s3c2443-fb",
1667                 .driver_data    = (unsigned long)&s3c_fb_data_s3c2443,
1668         },
1669         {},
1670 };
1671 MODULE_DEVICE_TABLE(platform, s3c_fb_driver_ids);
1672
1673 static struct platform_driver s3c_fb_driver = {
1674         .probe          = s3c_fb_probe,
1675         .remove         = __devexit_p(s3c_fb_remove),
1676         .suspend        = s3c_fb_suspend,
1677         .resume         = s3c_fb_resume,
1678         .id_table       = s3c_fb_driver_ids,
1679         .driver         = {
1680                 .name   = "s3c-fb",
1681                 .owner  = THIS_MODULE,
1682         },
1683 };
1684
1685 static int __init s3c_fb_init(void)
1686 {
1687         return platform_driver_register(&s3c_fb_driver);
1688 }
1689
1690 static void __exit s3c_fb_cleanup(void)
1691 {
1692         platform_driver_unregister(&s3c_fb_driver);
1693 }
1694
1695 module_init(s3c_fb_init);
1696 module_exit(s3c_fb_cleanup);
1697
1698 MODULE_AUTHOR("Ben Dooks <ben@simtec.co.uk>");
1699 MODULE_DESCRIPTION("Samsung S3C SoC Framebuffer driver");
1700 MODULE_LICENSE("GPL");
1701 MODULE_ALIAS("platform:s3c-fb");