aboutsummaryrefslogtreecommitdiffstats
diff options
context:
space:
mode:
authorKrzysztof Helt <krzysztof.h1@wp.pl>2007-10-16 04:28:54 -0400
committerLinus Torvalds <torvalds@woody.linux-foundation.org>2007-10-16 12:43:16 -0400
commitb0831941d59a80896c9b2a63a13ea063e31054a5 (patch)
treea0c3da9269700dc1c7dc620c004a6acbe379b493
parent1d677a6dfaac1d1cf51a7f58847077240985faf2 (diff)
s3c2410fb: code cleanup
This patch cleans up the driver a bit. It contains coding style fixes (pointed by Lindent and checkpatch), white space clean ups and few minor code improvements. Signed-off-by: Krzysztof Helt <krzysztof.h1@wp.pl> Signed-off-by: Antonino Daplas <adaplas@gmail.com> Signed-off-by: Andrew Morton <akpm@linux-foundation.org> Signed-off-by: Linus Torvalds <torvalds@linux-foundation.org>
-rw-r--r--drivers/video/s3c2410fb.c357
1 files changed, 172 insertions, 185 deletions
diff --git a/drivers/video/s3c2410fb.c b/drivers/video/s3c2410fb.c
index 8a4c6470d799..f10310178e3e 100644
--- a/drivers/video/s3c2410fb.c
+++ b/drivers/video/s3c2410fb.c
@@ -31,8 +31,8 @@
31 * - add pixel clock divisor control 31 * - add pixel clock divisor control
32 * 32 *
33 * 2004-11-11: Arnaud Patard <arnaud.patard@rtp-net.org> 33 * 2004-11-11: Arnaud Patard <arnaud.patard@rtp-net.org>
34 * - Removed the use of currcon as it no more exist 34 * - Removed the use of currcon as it no more exist
35 * - Added LCD power sysfs interface 35 * - Added LCD power sysfs interface
36 * 36 *
37 * 2004-11-03: Ben Dooks <ben-linux@fluff.org> 37 * 2004-11-03: Ben Dooks <ben-linux@fluff.org>
38 * - minor cleanups 38 * - minor cleanups
@@ -49,12 +49,12 @@
49 * - Suppress command line options 49 * - Suppress command line options
50 * 50 *
51 * 2004-09-15: Arnaud Patard <arnaud.patard@rtp-net.org> 51 * 2004-09-15: Arnaud Patard <arnaud.patard@rtp-net.org>
52 * - code cleanup 52 * - code cleanup
53 * 53 *
54 * 2004-09-07: Arnaud Patard <arnaud.patard@rtp-net.org> 54 * 2004-09-07: Arnaud Patard <arnaud.patard@rtp-net.org>
55 * - Renamed from h1940fb.c to s3c2410fb.c 55 * - Renamed from h1940fb.c to s3c2410fb.c
56 * - Add support for different devices 56 * - Add support for different devices
57 * - Backlight support 57 * - Backlight support
58 * 58 *
59 * 2004-09-05: Herbert Pötzl <herbert@13thfloor.at> 59 * 2004-09-05: Herbert Pötzl <herbert@13thfloor.at>
60 * - added clock (de-)allocation code 60 * - added clock (de-)allocation code
@@ -102,14 +102,13 @@
102 102
103#include "s3c2410fb.h" 103#include "s3c2410fb.h"
104 104
105
106static struct s3c2410fb_mach_info *mach_info; 105static struct s3c2410fb_mach_info *mach_info;
107 106
108/* Debugging stuff */ 107/* Debugging stuff */
109#ifdef CONFIG_FB_S3C2410_DEBUG 108#ifdef CONFIG_FB_S3C2410_DEBUG
110static int debug = 1; 109static int debug = 1;
111#else 110#else
112static int debug = 0; 111static int debug = 0;
113#endif 112#endif
114 113
115#define dprintk(msg...) if (debug) { printk(KERN_DEBUG "s3c2410fb: " msg); } 114#define dprintk(msg...) if (debug) { printk(KERN_DEBUG "s3c2410fb: " msg); }
@@ -119,19 +118,20 @@ static int debug = 0;
119/* s3c2410fb_set_lcdaddr 118/* s3c2410fb_set_lcdaddr
120 * 119 *
121 * initialise lcd controller address pointers 120 * initialise lcd controller address pointers
122*/ 121 */
123
124static void s3c2410fb_set_lcdaddr(struct s3c2410fb_info *fbi) 122static void s3c2410fb_set_lcdaddr(struct s3c2410fb_info *fbi)
125{ 123{
126 struct fb_var_screeninfo *var = &fbi->fb->var; 124 struct fb_var_screeninfo *var = &fbi->fb->var;
127 unsigned long saddr1, saddr2, saddr3; 125 unsigned long saddr1, saddr2, saddr3;
126 int line_length = var->xres * var->bits_per_pixel;
128 127
129 saddr1 = fbi->fb->fix.smem_start >> 1; 128 saddr1 = fbi->fb->fix.smem_start >> 1;
130 saddr2 = fbi->fb->fix.smem_start; 129 saddr2 = fbi->fb->fix.smem_start;
131 saddr2 += (var->xres * var->yres * var->bits_per_pixel)/8; 130 saddr2 += (line_length * var->yres) / 8;
132 saddr2>>= 1; 131 saddr2 >>= 1;
133 132
134 saddr3 = S3C2410_OFFSIZE(0) | S3C2410_PAGEWIDTH((var->xres * var->bits_per_pixel / 16) & 0x3ff); 133 saddr3 = S3C2410_OFFSIZE(0) |
134 S3C2410_PAGEWIDTH((line_length / 16) & 0x3ff);
135 135
136 dprintk("LCDSADDR1 = 0x%08lx\n", saddr1); 136 dprintk("LCDSADDR1 = 0x%08lx\n", saddr1);
137 dprintk("LCDSADDR2 = 0x%08lx\n", saddr2); 137 dprintk("LCDSADDR2 = 0x%08lx\n", saddr2);
@@ -145,8 +145,7 @@ static void s3c2410fb_set_lcdaddr(struct s3c2410fb_info *fbi)
145/* s3c2410fb_calc_pixclk() 145/* s3c2410fb_calc_pixclk()
146 * 146 *
147 * calculate divisor for clk->pixclk 147 * calculate divisor for clk->pixclk
148*/ 148 */
149
150static unsigned int s3c2410fb_calc_pixclk(struct s3c2410fb_info *fbi, 149static unsigned int s3c2410fb_calc_pixclk(struct s3c2410fb_info *fbi,
151 unsigned long pixclk) 150 unsigned long pixclk)
152{ 151{
@@ -159,8 +158,8 @@ static unsigned int s3c2410fb_calc_pixclk(struct s3c2410fb_info *fbi,
159 */ 158 */
160 159
161 div = (unsigned long long)clk * pixclk; 160 div = (unsigned long long)clk * pixclk;
162 do_div(div,1000000UL); 161 do_div(div, 1000000UL);
163 do_div(div,1000000UL); 162 do_div(div, 1000000UL);
164 163
165 dprintk("pixclk %ld, divisor is %ld\n", pixclk, (long)div); 164 dprintk("pixclk %ld, divisor is %ld\n", pixclk, (long)div);
166 return div; 165 return div;
@@ -198,93 +197,84 @@ static int s3c2410fb_check_var(struct fb_var_screeninfo *var,
198 else if (var->bits_per_pixel < fbi->mach_info->bpp.min) 197 else if (var->bits_per_pixel < fbi->mach_info->bpp.min)
199 var->bits_per_pixel = fbi->mach_info->bpp.min; 198 var->bits_per_pixel = fbi->mach_info->bpp.min;
200 199
200 var->transp.offset = 0;
201 var->transp.length = 0;
201 /* set r/g/b positions */ 202 /* set r/g/b positions */
202 switch (var->bits_per_pixel) { 203 switch (var->bits_per_pixel) {
203 case 1: 204 case 1:
204 case 2: 205 case 2:
205 case 4: 206 case 4:
206 var->red.offset = 0; 207 var->red.offset = 0;
207 var->red.length = var->bits_per_pixel; 208 var->red.length = var->bits_per_pixel;
208 var->green = var->red; 209 var->green = var->red;
209 var->blue = var->red; 210 var->blue = var->red;
210 var->transp.offset = 0; 211 break;
211 var->transp.length = 0; 212 case 8:
212 break; 213 if (fbi->mach_info->type != S3C2410_LCDCON1_TFT) {
213 case 8: 214 /* 8 bpp 332 */
214 if ( fbi->mach_info->type != S3C2410_LCDCON1_TFT ) { 215 var->red.length = 3;
215 /* 8 bpp 332 */ 216 var->red.offset = 5;
216 var->red.length = 3; 217 var->green.length = 3;
217 var->red.offset = 5; 218 var->green.offset = 2;
218 var->green.length = 3; 219 var->blue.length = 2;
219 var->green.offset = 2;
220 var->blue.length = 2;
221 var->blue.offset = 0;
222 var->transp.length = 0;
223 } else {
224 var->red.offset = 0;
225 var->red.length = var->bits_per_pixel;
226 var->green = var->red;
227 var->blue = var->red;
228 var->transp.offset = 0;
229 var->transp.length = 0;
230 }
231 break;
232 case 12:
233 /* 12 bpp 444 */
234 var->red.length = 4;
235 var->red.offset = 8;
236 var->green.length = 4;
237 var->green.offset = 4;
238 var->blue.length = 4;
239 var->blue.offset = 0; 220 var->blue.offset = 0;
240 var->transp.length = 0; 221 } else {
241 break; 222 var->red.offset = 0;
242
243 default:
244 case 16:
245 if (fbi->regs.lcdcon5 & S3C2410_LCDCON5_FRM565 ) {
246 /* 16 bpp, 565 format */
247 var->red.offset = 11;
248 var->green.offset = 5;
249 var->blue.offset = 0;
250 var->red.length = 5;
251 var->green.length = 6;
252 var->blue.length = 5;
253 var->transp.length = 0;
254 } else {
255 /* 16 bpp, 5551 format */
256 var->red.offset = 11;
257 var->green.offset = 6;
258 var->blue.offset = 1;
259 var->red.length = 5;
260 var->green.length = 5;
261 var->blue.length = 5;
262 var->transp.length = 0;
263 }
264 break;
265 case 24:
266 /* 24 bpp 888 */
267 var->red.length = 8; 223 var->red.length = 8;
268 var->red.offset = 16; 224 var->green = var->red;
269 var->green.length = 8; 225 var->blue = var->red;
270 var->green.offset = 8; 226 }
271 var->blue.length = 8; 227 break;
228 case 12:
229 /* 12 bpp 444 */
230 var->red.length = 4;
231 var->red.offset = 8;
232 var->green.length = 4;
233 var->green.offset = 4;
234 var->blue.length = 4;
235 var->blue.offset = 0;
236 break;
237
238 default:
239 case 16:
240 if (fbi->regs.lcdcon5 & S3C2410_LCDCON5_FRM565) {
241 /* 16 bpp, 565 format */
242 var->red.offset = 11;
243 var->green.offset = 5;
272 var->blue.offset = 0; 244 var->blue.offset = 0;
273 var->transp.length = 0; 245 var->red.length = 5;
274 break; 246 var->green.length = 6;
247 var->blue.length = 5;
248 } else {
249 /* 16 bpp, 5551 format */
250 var->red.offset = 11;
251 var->green.offset = 6;
252 var->blue.offset = 1;
253 var->red.length = 5;
254 var->green.length = 5;
255 var->blue.length = 5;
256 }
257 break;
258 case 24:
259 /* 24 bpp 888 */
260 var->red.length = 8;
261 var->red.offset = 16;
262 var->green.length = 8;
263 var->green.offset = 8;
264 var->blue.length = 8;
265 var->blue.offset = 0;
266 break;
275 267
276 268
277 } 269 }
278 return 0; 270 return 0;
279} 271}
280 272
281
282/* s3c2410fb_activate_var 273/* s3c2410fb_activate_var
283 * 274 *
284 * activate (set) the controller from the given framebuffer 275 * activate (set) the controller from the given framebuffer
285 * information 276 * information
286*/ 277 */
287
288static void s3c2410fb_activate_var(struct s3c2410fb_info *fbi, 278static void s3c2410fb_activate_var(struct s3c2410fb_info *fbi,
289 struct fb_var_screeninfo *var) 279 struct fb_var_screeninfo *var)
290{ 280{
@@ -319,7 +309,8 @@ static void s3c2410fb_activate_var(struct s3c2410fb_info *fbi,
319 309
320 default: 310 default:
321 /* invalid pixel depth */ 311 /* invalid pixel depth */
322 dev_err(fbi->dev, "invalid bpp %d\n", var->bits_per_pixel); 312 dev_err(fbi->dev, "invalid bpp %d\n",
313 var->bits_per_pixel);
323 } 314 }
324 else 315 else
325 switch (var->bits_per_pixel) { 316 switch (var->bits_per_pixel) {
@@ -341,19 +332,18 @@ static void s3c2410fb_activate_var(struct s3c2410fb_info *fbi,
341 332
342 default: 333 default:
343 /* invalid pixel depth */ 334 /* invalid pixel depth */
344 dev_err(fbi->dev, "invalid bpp %d\n", var->bits_per_pixel); 335 dev_err(fbi->dev, "invalid bpp %d\n",
336 var->bits_per_pixel);
345 } 337 }
346 338
347 /* check to see if we need to update sync/borders */ 339 /* check to see if we need to update sync/borders */
348 340
349 if (!fbi->mach_info->fixed_syncs) { 341 if (!fbi->mach_info->fixed_syncs) {
350 dprintk("setting vert: up=%d, low=%d, sync=%d\n", 342 dprintk("setting vert: up=%d, low=%d, sync=%d\n",
351 var->upper_margin, var->lower_margin, 343 var->upper_margin, var->lower_margin, var->vsync_len);
352 var->vsync_len);
353 344
354 dprintk("setting horz: lft=%d, rt=%d, sync=%d\n", 345 dprintk("setting horz: lft=%d, rt=%d, sync=%d\n",
355 var->left_margin, var->right_margin, 346 var->left_margin, var->right_margin, var->hsync_len);
356 var->hsync_len);
357 347
358 fbi->regs.lcdcon2 = 348 fbi->regs.lcdcon2 =
359 S3C2410_LCDCON2_VBPD(var->upper_margin - 1) | 349 S3C2410_LCDCON2_VBPD(var->upper_margin - 1) |
@@ -373,27 +363,24 @@ static void s3c2410fb_activate_var(struct s3c2410fb_info *fbi,
373 fbi->regs.lcdcon2 &= ~S3C2410_LCDCON2_LINEVAL(0x3ff); 363 fbi->regs.lcdcon2 &= ~S3C2410_LCDCON2_LINEVAL(0x3ff);
374 fbi->regs.lcdcon2 |= S3C2410_LCDCON2_LINEVAL(var->yres - 1); 364 fbi->regs.lcdcon2 |= S3C2410_LCDCON2_LINEVAL(var->yres - 1);
375 365
376 switch(fbi->mach_info->type) { 366 switch (fbi->mach_info->type) {
377 case S3C2410_LCDCON1_DSCAN4: 367 case S3C2410_LCDCON1_DSCAN4:
378 case S3C2410_LCDCON1_STN8: 368 case S3C2410_LCDCON1_STN8:
379 hs = var->xres / 8; 369 hs = var->xres / 8;
380 break; 370 break;
381 case S3C2410_LCDCON1_STN4: 371 case S3C2410_LCDCON1_STN4:
382 hs = var->xres / 4; 372 hs = var->xres / 4;
383 break; 373 break;
384 default: 374 default:
385 case S3C2410_LCDCON1_TFT: 375 case S3C2410_LCDCON1_TFT:
386 hs = var->xres; 376 hs = var->xres;
387 break; 377 break;
388
389 } 378 }
390 379
391 /* Special cases : STN color displays */ 380 /* Special cases : STN color displays */
392 if ( ((fbi->regs.lcdcon1 & S3C2410_LCDCON1_MODEMASK) == S3C2410_LCDCON1_STN8BPP) \ 381 if (((fbi->regs.lcdcon1 & S3C2410_LCDCON1_MODEMASK) == S3C2410_LCDCON1_STN8BPP) ||
393 || ((fbi->regs.lcdcon1 & S3C2410_LCDCON1_MODEMASK) == S3C2410_LCDCON1_STN12BPP) ) { 382 ((fbi->regs.lcdcon1 & S3C2410_LCDCON1_MODEMASK) == S3C2410_LCDCON1_STN12BPP))
394 hs = hs * 3; 383 hs = hs * 3;
395 }
396
397 384
398 fbi->regs.lcdcon3 &= ~S3C2410_LCDCON3_HOZVAL(0x7ff); 385 fbi->regs.lcdcon3 &= ~S3C2410_LCDCON3_HOZVAL(0x7ff);
399 fbi->regs.lcdcon3 |= S3C2410_LCDCON3_HOZVAL(hs - 1); 386 fbi->regs.lcdcon3 |= S3C2410_LCDCON3_HOZVAL(hs - 1);
@@ -402,11 +389,10 @@ static void s3c2410fb_activate_var(struct s3c2410fb_info *fbi,
402 int clkdiv = s3c2410fb_calc_pixclk(fbi, var->pixclock); 389 int clkdiv = s3c2410fb_calc_pixclk(fbi, var->pixclock);
403 390
404 if (fbi->mach_info->type == S3C2410_LCDCON1_TFT) { 391 if (fbi->mach_info->type == S3C2410_LCDCON1_TFT) {
405 clkdiv = (clkdiv / 2) -1; 392 clkdiv = (clkdiv / 2) - 1;
406 if (clkdiv < 0) 393 if (clkdiv < 0)
407 clkdiv = 0; 394 clkdiv = 0;
408 } 395 } else {
409 else {
410 clkdiv = (clkdiv / 2); 396 clkdiv = (clkdiv / 2);
411 if (clkdiv < 2) 397 if (clkdiv < 2)
412 clkdiv = 2; 398 clkdiv = 2;
@@ -437,9 +423,8 @@ static void s3c2410fb_activate_var(struct s3c2410fb_info *fbi,
437 writel(fbi->regs.lcdcon1, S3C2410_LCDCON1); 423 writel(fbi->regs.lcdcon1, S3C2410_LCDCON1);
438} 424}
439 425
440
441/* 426/*
442 * s3c2410fb_set_par - Optional function. Alters the hardware state. 427 * s3c2410fb_set_par - Alters the hardware state.
443 * @info: frame buffer structure that represents a single frame buffer 428 * @info: frame buffer structure that represents a single frame buffer
444 * 429 *
445 */ 430 */
@@ -448,20 +433,19 @@ static int s3c2410fb_set_par(struct fb_info *info)
448 struct s3c2410fb_info *fbi = info->par; 433 struct s3c2410fb_info *fbi = info->par;
449 struct fb_var_screeninfo *var = &info->var; 434 struct fb_var_screeninfo *var = &info->var;
450 435
451 switch (var->bits_per_pixel) 436 switch (var->bits_per_pixel) {
452 { 437 case 16:
453 case 16: 438 info->fix.visual = FB_VISUAL_TRUECOLOR;
454 fbi->fb->fix.visual = FB_VISUAL_TRUECOLOR; 439 break;
455 break; 440 case 1:
456 case 1: 441 info->fix.visual = FB_VISUAL_MONO01;
457 fbi->fb->fix.visual = FB_VISUAL_MONO01; 442 break;
458 break; 443 default:
459 default: 444 info->fix.visual = FB_VISUAL_PSEUDOCOLOR;
460 fbi->fb->fix.visual = FB_VISUAL_PSEUDOCOLOR; 445 break;
461 break;
462 } 446 }
463 447
464 fbi->fb->fix.line_length = (var->width*var->bits_per_pixel)/8; 448 info->fix.line_length = (var->width * var->bits_per_pixel) / 8;
465 449
466 /* activate this new configuration */ 450 /* activate this new configuration */
467 451
@@ -493,7 +477,8 @@ static void schedule_palette_update(struct s3c2410fb_info *fbi,
493} 477}
494 478
495/* from pxafb.c */ 479/* from pxafb.c */
496static inline unsigned int chan_to_field(unsigned int chan, struct fb_bitfield *bf) 480static inline unsigned int chan_to_field(unsigned int chan,
481 struct fb_bitfield *bf)
497{ 482{
498 chan &= 0xffff; 483 chan &= 0xffff;
499 chan >>= 16 - bf->length; 484 chan >>= 16 - bf->length;
@@ -507,18 +492,19 @@ static int s3c2410fb_setcolreg(unsigned regno,
507 struct s3c2410fb_info *fbi = info->par; 492 struct s3c2410fb_info *fbi = info->par;
508 unsigned int val; 493 unsigned int val;
509 494
510 /* dprintk("setcol: regno=%d, rgb=%d,%d,%d\n", regno, red, green, blue); */ 495 /* dprintk("setcol: regno=%d, rgb=%d,%d,%d\n",
496 regno, red, green, blue); */
511 497
512 switch (fbi->fb->fix.visual) { 498 switch (info->fix.visual) {
513 case FB_VISUAL_TRUECOLOR: 499 case FB_VISUAL_TRUECOLOR:
514 /* true-colour, use pseuo-palette */ 500 /* true-colour, use pseudo-palette */
515 501
516 if (regno < 16) { 502 if (regno < 16) {
517 u32 *pal = fbi->fb->pseudo_palette; 503 u32 *pal = info->pseudo_palette;
518 504
519 val = chan_to_field(red, &fbi->fb->var.red); 505 val = chan_to_field(red, &info->var.red);
520 val |= chan_to_field(green, &fbi->fb->var.green); 506 val |= chan_to_field(green, &info->var.green);
521 val |= chan_to_field(blue, &fbi->fb->var.blue); 507 val |= chan_to_field(blue, &info->var.blue);
522 508
523 pal[regno] = val; 509 pal[regno] = val;
524 } 510 }
@@ -539,14 +525,13 @@ static int s3c2410fb_setcolreg(unsigned regno,
539 break; 525 break;
540 526
541 default: 527 default:
542 return 1; /* unknown type */ 528 return 1; /* unknown type */
543 } 529 }
544 530
545 return 0; 531 return 0;
546} 532}
547 533
548 534/*
549/**
550 * s3c2410fb_blank 535 * s3c2410fb_blank
551 * @blank_mode: the blank mode we want. 536 * @blank_mode: the blank mode we want.
552 * @info: frame buffer structure that represents a single frame buffer 537 * @info: frame buffer structure that represents a single frame buffer
@@ -579,12 +564,14 @@ static int s3c2410fb_blank(int blank_mode, struct fb_info *info)
579 return 0; 564 return 0;
580} 565}
581 566
582static int s3c2410fb_debug_show(struct device *dev, struct device_attribute *attr, char *buf) 567static int s3c2410fb_debug_show(struct device *dev,
568 struct device_attribute *attr, char *buf)
583{ 569{
584 return snprintf(buf, PAGE_SIZE, "%s\n", debug ? "on" : "off"); 570 return snprintf(buf, PAGE_SIZE, "%s\n", debug ? "on" : "off");
585} 571}
586static int s3c2410fb_debug_store(struct device *dev, struct device_attribute *attr, 572static int s3c2410fb_debug_store(struct device *dev,
587 const char *buf, size_t len) 573 struct device_attribute *attr,
574 const char *buf, size_t len)
588{ 575{
589 if (mach_info == NULL) 576 if (mach_info == NULL)
590 return -EINVAL; 577 return -EINVAL;
@@ -607,10 +594,7 @@ static int s3c2410fb_debug_store(struct device *dev, struct device_attribute *at
607 return len; 594 return len;
608} 595}
609 596
610 597static DEVICE_ATTR(debug, 0666, s3c2410fb_debug_show, s3c2410fb_debug_store);
611static DEVICE_ATTR(debug, 0666,
612 s3c2410fb_debug_show,
613 s3c2410fb_debug_store);
614 598
615static struct fb_ops s3c2410fb_ops = { 599static struct fb_ops s3c2410fb_ops = {
616 .owner = THIS_MODULE, 600 .owner = THIS_MODULE,
@@ -623,7 +607,6 @@ static struct fb_ops s3c2410fb_ops = {
623 .fb_imageblit = cfb_imageblit, 607 .fb_imageblit = cfb_imageblit,
624}; 608};
625 609
626
627/* 610/*
628 * s3c2410fb_map_video_memory(): 611 * s3c2410fb_map_video_memory():
629 * Allocates the DRAM memory for the frame buffer. This buffer is 612 * Allocates the DRAM memory for the frame buffer. This buffer is
@@ -661,7 +644,8 @@ static int __init s3c2410fb_map_video_memory(struct s3c2410fb_info *fbi)
661 644
662static inline void s3c2410fb_unmap_video_memory(struct s3c2410fb_info *fbi) 645static inline void s3c2410fb_unmap_video_memory(struct s3c2410fb_info *fbi)
663{ 646{
664 dma_free_writecombine(fbi->dev,fbi->map_size,fbi->map_cpu, fbi->map_dma); 647 dma_free_writecombine(fbi->dev, fbi->map_size, fbi->map_cpu,
648 fbi->map_dma);
665} 649}
666 650
667static inline void modify_gpio(void __iomem *reg, 651static inline void modify_gpio(void __iomem *reg,
@@ -673,11 +657,9 @@ static inline void modify_gpio(void __iomem *reg,
673 writel(tmp | set, reg); 657 writel(tmp | set, reg);
674} 658}
675 659
676
677/* 660/*
678 * s3c2410fb_init_registers - Initialise all LCD-related registers 661 * s3c2410fb_init_registers - Initialise all LCD-related registers
679 */ 662 */
680
681static int s3c2410fb_init_registers(struct s3c2410fb_info *fbi) 663static int s3c2410fb_init_registers(struct s3c2410fb_info *fbi)
682{ 664{
683 unsigned long flags; 665 unsigned long flags;
@@ -702,7 +684,7 @@ static int s3c2410fb_init_registers(struct s3c2410fb_info *fbi)
702 writel(fbi->regs.lcdcon4, regs + S3C2410_LCDCON4); 684 writel(fbi->regs.lcdcon4, regs + S3C2410_LCDCON4);
703 writel(fbi->regs.lcdcon5, regs + S3C2410_LCDCON5); 685 writel(fbi->regs.lcdcon5, regs + S3C2410_LCDCON5);
704 686
705 s3c2410fb_set_lcdaddr(fbi); 687 s3c2410fb_set_lcdaddr(fbi);
706 688
707 dprintk("LPCSEL = 0x%08lx\n", mach_info->lpcsel); 689 dprintk("LPCSEL = 0x%08lx\n", mach_info->lpcsel);
708 writel(mach_info->lpcsel, regs + S3C2410_LPCSEL); 690 writel(mach_info->lpcsel, regs + S3C2410_LPCSEL);
@@ -721,13 +703,13 @@ static int s3c2410fb_init_registers(struct s3c2410fb_info *fbi)
721static void s3c2410fb_write_palette(struct s3c2410fb_info *fbi) 703static void s3c2410fb_write_palette(struct s3c2410fb_info *fbi)
722{ 704{
723 unsigned int i; 705 unsigned int i;
724 unsigned long ent;
725 void __iomem *regs = fbi->io; 706 void __iomem *regs = fbi->io;
726 707
727 fbi->palette_ready = 0; 708 fbi->palette_ready = 0;
728 709
729 for (i = 0; i < 256; i++) { 710 for (i = 0; i < 256; i++) {
730 if ((ent = fbi->palette_buffer[i]) == PALETTE_BUFF_CLEAR) 711 unsigned long ent = fbi->palette_buffer[i];
712 if (ent == PALETTE_BUFF_CLEAR)
731 continue; 713 continue;
732 714
733 writel(ent, regs + S3C2410_TFTPAL(i)); 715 writel(ent, regs + S3C2410_TFTPAL(i));
@@ -761,12 +743,12 @@ static irqreturn_t s3c2410fb_irq(int irq, void *dev_id)
761 return IRQ_HANDLED; 743 return IRQ_HANDLED;
762} 744}
763 745
764static char driver_name[]="s3c2410fb"; 746static char driver_name[] = "s3c2410fb";
765 747
766static int __init s3c2410fb_probe(struct platform_device *pdev) 748static int __init s3c2410fb_probe(struct platform_device *pdev)
767{ 749{
768 struct s3c2410fb_info *info; 750 struct s3c2410fb_info *info;
769 struct fb_info *fbinfo; 751 struct fb_info *fbinfo;
770 struct s3c2410fb_hw *mregs; 752 struct s3c2410fb_hw *mregs;
771 struct resource *res; 753 struct resource *res;
772 int ret; 754 int ret;
@@ -777,7 +759,8 @@ static int __init s3c2410fb_probe(struct platform_device *pdev)
777 759
778 mach_info = pdev->dev.platform_data; 760 mach_info = pdev->dev.platform_data;
779 if (mach_info == NULL) { 761 if (mach_info == NULL) {
780 dev_err(&pdev->dev,"no platform data for lcd, cannot attach\n"); 762 dev_err(&pdev->dev,
763 "no platform data for lcd, cannot attach\n");
781 return -EINVAL; 764 return -EINVAL;
782 } 765 }
783 766
@@ -790,9 +773,8 @@ static int __init s3c2410fb_probe(struct platform_device *pdev)
790 } 773 }
791 774
792 fbinfo = framebuffer_alloc(sizeof(struct s3c2410fb_info), &pdev->dev); 775 fbinfo = framebuffer_alloc(sizeof(struct s3c2410fb_info), &pdev->dev);
793 if (!fbinfo) { 776 if (!fbinfo)
794 return -ENOMEM; 777 return -ENOMEM;
795 }
796 778
797 info = fbinfo->par; 779 info = fbinfo->par;
798 info->fb = fbinfo; 780 info->fb = fbinfo;
@@ -800,12 +782,12 @@ static int __init s3c2410fb_probe(struct platform_device *pdev)
800 782
801 res = platform_get_resource(pdev, IORESOURCE_MEM, 0); 783 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
802 if (res == NULL) { 784 if (res == NULL) {
803 dev_err(&pdev->dev, "failed to get memory registersn"); 785 dev_err(&pdev->dev, "failed to get memory registers\n");
804 ret = -ENXIO; 786 ret = -ENXIO;
805 goto dealloc_fb; 787 goto dealloc_fb;
806 } 788 }
807 789
808 size = (res->end - res->start)+1; 790 size = (res->end - res->start) + 1;
809 info->mem = request_mem_region(res->start, size, pdev->name); 791 info->mem = request_mem_region(res->start, size, pdev->name);
810 if (info->mem == NULL) { 792 if (info->mem == NULL) {
811 dev_err(&pdev->dev, "failed to get memory region\n"); 793 dev_err(&pdev->dev, "failed to get memory region\n");
@@ -859,13 +841,19 @@ static int __init s3c2410fb_probe(struct platform_device *pdev)
859 fbinfo->var.yres_virtual = mach_info->yres.defval; 841 fbinfo->var.yres_virtual = mach_info->yres.defval;
860 fbinfo->var.bits_per_pixel = mach_info->bpp.defval; 842 fbinfo->var.bits_per_pixel = mach_info->bpp.defval;
861 843
862 fbinfo->var.upper_margin = S3C2410_LCDCON2_GET_VBPD(mregs->lcdcon2) + 1; 844 fbinfo->var.upper_margin =
863 fbinfo->var.lower_margin = S3C2410_LCDCON2_GET_VFPD(mregs->lcdcon2) + 1; 845 S3C2410_LCDCON2_GET_VBPD(mregs->lcdcon2) + 1;
864 fbinfo->var.vsync_len = S3C2410_LCDCON2_GET_VSPW(mregs->lcdcon2) + 1; 846 fbinfo->var.lower_margin =
847 S3C2410_LCDCON2_GET_VFPD(mregs->lcdcon2) + 1;
848 fbinfo->var.vsync_len =
849 S3C2410_LCDCON2_GET_VSPW(mregs->lcdcon2) + 1;
865 850
866 fbinfo->var.left_margin = S3C2410_LCDCON3_GET_HFPD(mregs->lcdcon3) + 1; 851 fbinfo->var.left_margin =
867 fbinfo->var.right_margin = S3C2410_LCDCON3_GET_HBPD(mregs->lcdcon3) + 1; 852 S3C2410_LCDCON3_GET_HFPD(mregs->lcdcon3) + 1;
868 fbinfo->var.hsync_len = S3C2410_LCDCON4_GET_HSPW(mregs->lcdcon4) + 1; 853 fbinfo->var.right_margin =
854 S3C2410_LCDCON3_GET_HBPD(mregs->lcdcon3) + 1;
855 fbinfo->var.hsync_len =
856 S3C2410_LCDCON4_GET_HSPW(mregs->lcdcon4) + 1;
869 857
870 fbinfo->var.red.offset = 11; 858 fbinfo->var.red.offset = 11;
871 fbinfo->var.green.offset = 5; 859 fbinfo->var.green.offset = 5;
@@ -875,7 +863,7 @@ static int __init s3c2410fb_probe(struct platform_device *pdev)
875 fbinfo->var.green.length = 6; 863 fbinfo->var.green.length = 6;
876 fbinfo->var.blue.length = 5; 864 fbinfo->var.blue.length = 5;
877 fbinfo->var.transp.length = 0; 865 fbinfo->var.transp.length = 0;
878 fbinfo->fix.smem_len = mach_info->xres.max * 866 fbinfo->fix.smem_len = mach_info->xres.max *
879 mach_info->yres.max * 867 mach_info->yres.max *
880 mach_info->bpp.max / 8; 868 mach_info->bpp.max / 8;
881 869
@@ -904,20 +892,21 @@ static int __init s3c2410fb_probe(struct platform_device *pdev)
904 /* Initialize video memory */ 892 /* Initialize video memory */
905 ret = s3c2410fb_map_video_memory(info); 893 ret = s3c2410fb_map_video_memory(info);
906 if (ret) { 894 if (ret) {
907 printk( KERN_ERR "Failed to allocate video RAM: %d\n", ret); 895 printk(KERN_ERR "Failed to allocate video RAM: %d\n", ret);
908 ret = -ENOMEM; 896 ret = -ENOMEM;
909 goto release_clock; 897 goto release_clock;
910 } 898 }
911 899
912 dprintk("got video memory\n"); 900 dprintk("got video memory\n");
913 901
914 ret = s3c2410fb_init_registers(info); 902 s3c2410fb_init_registers(info);
915 903
916 ret = s3c2410fb_check_var(&fbinfo->var, fbinfo); 904 s3c2410fb_check_var(&fbinfo->var, fbinfo);
917 905
918 ret = register_framebuffer(fbinfo); 906 ret = register_framebuffer(fbinfo);
919 if (ret < 0) { 907 if (ret < 0) {
920 printk(KERN_ERR "Failed to register framebuffer device: %d\n", ret); 908 printk(KERN_ERR "Failed to register framebuffer device: %d\n",
909 ret);
921 goto free_video_memory; 910 goto free_video_memory;
922 } 911 }
923 912
@@ -935,7 +924,7 @@ release_clock:
935 clk_disable(info->clk); 924 clk_disable(info->clk);
936 clk_put(info->clk); 925 clk_put(info->clk);
937release_irq: 926release_irq:
938 free_irq(irq,info); 927 free_irq(irq, info);
939release_regs: 928release_regs:
940 iounmap(info->io); 929 iounmap(info->io);
941release_mem: 930release_mem:
@@ -949,8 +938,7 @@ dealloc_fb:
949/* s3c2410fb_stop_lcd 938/* s3c2410fb_stop_lcd
950 * 939 *
951 * shutdown the lcd controller 940 * shutdown the lcd controller
952*/ 941 */
953
954static void s3c2410fb_stop_lcd(struct s3c2410fb_info *fbi) 942static void s3c2410fb_stop_lcd(struct s3c2410fb_info *fbi)
955{ 943{
956 unsigned long flags; 944 unsigned long flags;
@@ -968,7 +956,7 @@ static void s3c2410fb_stop_lcd(struct s3c2410fb_info *fbi)
968 */ 956 */
969static int s3c2410fb_remove(struct platform_device *pdev) 957static int s3c2410fb_remove(struct platform_device *pdev)
970{ 958{
971 struct fb_info *fbinfo = platform_get_drvdata(pdev); 959 struct fb_info *fbinfo = platform_get_drvdata(pdev);
972 struct s3c2410fb_info *info = fbinfo->par; 960 struct s3c2410fb_info *info = fbinfo->par;
973 int irq; 961 int irq;
974 962
@@ -977,14 +965,14 @@ static int s3c2410fb_remove(struct platform_device *pdev)
977 965
978 s3c2410fb_unmap_video_memory(info); 966 s3c2410fb_unmap_video_memory(info);
979 967
980 if (info->clk) { 968 if (info->clk) {
981 clk_disable(info->clk); 969 clk_disable(info->clk);
982 clk_put(info->clk); 970 clk_put(info->clk);
983 info->clk = NULL; 971 info->clk = NULL;
984 } 972 }
985 973
986 irq = platform_get_irq(pdev, 0); 974 irq = platform_get_irq(pdev, 0);
987 free_irq(irq,info); 975 free_irq(irq, info);
988 976
989 release_resource(info->mem); 977 release_resource(info->mem);
990 kfree(info->mem); 978 kfree(info->mem);
@@ -997,7 +985,6 @@ static int s3c2410fb_remove(struct platform_device *pdev)
997#ifdef CONFIG_PM 985#ifdef CONFIG_PM
998 986
999/* suspend and resume support for the lcd controller */ 987/* suspend and resume support for the lcd controller */
1000
1001static int s3c2410fb_suspend(struct platform_device *dev, pm_message_t state) 988static int s3c2410fb_suspend(struct platform_device *dev, pm_message_t state)
1002{ 989{
1003 struct fb_info *fbinfo = platform_get_drvdata(dev); 990 struct fb_info *fbinfo = platform_get_drvdata(dev);
@@ -1054,10 +1041,10 @@ static void __exit s3c2410fb_cleanup(void)
1054 platform_driver_unregister(&s3c2410fb_driver); 1041 platform_driver_unregister(&s3c2410fb_driver);
1055} 1042}
1056 1043
1057
1058module_init(s3c2410fb_init); 1044module_init(s3c2410fb_init);
1059module_exit(s3c2410fb_cleanup); 1045module_exit(s3c2410fb_cleanup);
1060 1046
1061MODULE_AUTHOR("Arnaud Patard <arnaud.patard@rtp-net.org>, Ben Dooks <ben-linux@fluff.org>"); 1047MODULE_AUTHOR("Arnaud Patard <arnaud.patard@rtp-net.org>, "
1048 "Ben Dooks <ben-linux@fluff.org>");
1062MODULE_DESCRIPTION("Framebuffer driver for the s3c2410"); 1049MODULE_DESCRIPTION("Framebuffer driver for the s3c2410");
1063MODULE_LICENSE("GPL"); 1050MODULE_LICENSE("GPL");