?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
x86/speculation/mds: Fix documentation typo
[linux/fpc-iii.git] / drivers / staging / sm750fb / sm750.c
blob67207b0554cd4c868a095d8b8ab7cfeb51cb9233
1 #include <linux/kernel.h>
2 #include <linux/module.h>
3 #include <linux/errno.h>
4 #include <linux/string.h>
5 #include <linux/mm.h>
6 #include <linux/slab.h>
7 #include <linux/delay.h>
8 #include <linux/fb.h>
9 #include <linux/ioport.h>
10 #include <linux/init.h>
11 #include <linux/pci.h>
12 #include <linux/mm_types.h>
13 #include <linux/vmalloc.h>
14 #include <linux/pagemap.h>
15 #include <linux/screen_info.h>
16 #include <linux/console.h>
17 #include <asm/fb.h>
18 #include "sm750.h"
19 #include "sm750_accel.h"
20 #include "sm750_cursor.h"
21
22 /*
23 * #ifdef __BIG_ENDIAN
24 * ssize_t lynxfb_ops_write(struct fb_info *info, const char __user *buf,
25 * size_t count, loff_t *ppos);
26 * ssize_t lynxfb_ops_read(struct fb_info *info, char __user *buf,
27 * size_t count, loff_t *ppos);
28 * #endif
29 */
30
31 /* common var for all device */
32 static int g_hwcursor = 1;
33 static int g_noaccel;
34 static int g_nomtrr;
35 static const char *g_fbmode[] = {NULL, NULL};
36 static const char *g_def_fbmode = "1024x768-32@60";
37 static char *g_settings;
38 static int g_dualview;
39 static char *g_option;
40
41 static const struct fb_videomode lynx750_ext[] = {
42 /* 1024x600-60 VESA [1.71:1] */
43 {NULL, 60, 1024, 600, 20423, 144, 40, 18, 1, 104, 3,
44 FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
45 FB_VMODE_NONINTERLACED},
46
47 /* 1024x600-70 VESA */
48 {NULL, 70, 1024, 600, 17211, 152, 48, 21, 1, 104, 3,
49 FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
50 FB_VMODE_NONINTERLACED},
51
52 /* 1024x600-75 VESA */
53 {NULL, 75, 1024, 600, 15822, 160, 56, 23, 1, 104, 3,
54 FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
55 FB_VMODE_NONINTERLACED},
56
57 /* 1024x600-85 VESA */
58 {NULL, 85, 1024, 600, 13730, 168, 56, 26, 1, 112, 3,
59 FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
60 FB_VMODE_NONINTERLACED},
61
62 /* 720x480 */
63 {NULL, 60, 720, 480, 37427, 88, 16, 13, 1, 72, 3,
64 FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
65 FB_VMODE_NONINTERLACED},
66
67 /* 1280x720 [1.78:1] */
68 {NULL, 60, 1280, 720, 13426, 162, 86, 22, 1, 136, 3,
69 FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
70 FB_VMODE_NONINTERLACED},
71
72 /* 1280x768@60 */
73 {NULL, 60, 1280, 768, 12579, 192, 64, 20, 3, 128, 7,
74 FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
75 FB_VMODE_NONINTERLACED},
76
77 /* 1360 x 768 [1.77083:1] */
78 {NULL, 60, 1360, 768, 11804, 208, 64, 23, 1, 144, 3,
79 FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
80 FB_VMODE_NONINTERLACED},
81
82 /* 1368 x 768 [1.78:1] */
83 {NULL, 60, 1368, 768, 11647, 216, 72, 23, 1, 144, 3,
84 FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
85 FB_VMODE_NONINTERLACED},
86
87 /* 1440 x 900 [16:10] */
88 {NULL, 60, 1440, 900, 9392, 232, 80, 28, 1, 152, 3,
89 FB_SYNC_VERT_HIGH_ACT,
90 FB_VMODE_NONINTERLACED},
91
92 /* 1440x960 [15:10] */
93 {NULL, 60, 1440, 960, 8733, 240, 88, 30, 1, 152, 3,
94 FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
95 FB_VMODE_NONINTERLACED},
96
97 /* 1920x1080 [16:9] */
98 {NULL, 60, 1920, 1080, 6734, 148, 88, 41, 1, 44, 3,
99 FB_SYNC_VERT_HIGH_ACT,
100 FB_VMODE_NONINTERLACED},
101 };
102
103 /* no hardware cursor supported under version 2.6.10, kernel bug */
104 static int lynxfb_ops_cursor(struct fb_info *info, struct fb_cursor *fbcursor)
105 {
106 struct lynxfb_par *par;
107 struct lynxfb_crtc *crtc;
108 struct lynx_cursor *cursor;
109
110 par = info->par;
111 crtc = &par->crtc;
112 cursor = &crtc->cursor;
113
114 if (fbcursor->image.width > cursor->maxW ||
115 fbcursor->image.height > cursor->maxH ||
116 fbcursor->image.depth > 1) {
117 return -ENXIO;
118 }
119
120 sm750_hw_cursor_disable(cursor);
121 if (fbcursor->set & FB_CUR_SETSIZE)
122 sm750_hw_cursor_setSize(cursor,
123 fbcursor->image.width,
124 fbcursor->image.height);
125
126 if (fbcursor->set & FB_CUR_SETPOS)
127 sm750_hw_cursor_setPos(cursor,
128 fbcursor->image.dx - info->var.xoffset,
129 fbcursor->image.dy - info->var.yoffset);
130
131 if (fbcursor->set & FB_CUR_SETCMAP) {
132 /* get the 16bit color of kernel means */
133 u16 fg, bg;
134
135 fg = ((info->cmap.red[fbcursor->image.fg_color] & 0xf800)) |
136 ((info->cmap.green[fbcursor->image.fg_color] & 0xfc00) >> 5) |
137 ((info->cmap.blue[fbcursor->image.fg_color] & 0xf800) >> 11);
138
139 bg = ((info->cmap.red[fbcursor->image.bg_color] & 0xf800)) |
140 ((info->cmap.green[fbcursor->image.bg_color] & 0xfc00) >> 5) |
141 ((info->cmap.blue[fbcursor->image.bg_color] & 0xf800) >> 11);
142
143 sm750_hw_cursor_setColor(cursor, fg, bg);
144 }
145
146 if (fbcursor->set & (FB_CUR_SETSHAPE | FB_CUR_SETIMAGE)) {
147 sm750_hw_cursor_setData(cursor,
148 fbcursor->rop,
149 fbcursor->image.data,
150 fbcursor->mask);
151 }
152
153 if (fbcursor->enable)
154 sm750_hw_cursor_enable(cursor);
155
156 return 0;
157 }
158
159 static void lynxfb_ops_fillrect(struct fb_info *info,
160 const struct fb_fillrect *region)
161 {
162 struct lynxfb_par *par;
163 struct sm750_dev *sm750_dev;
164 unsigned int base, pitch, Bpp, rop;
165 u32 color;
166
167 if (info->state != FBINFO_STATE_RUNNING)
168 return;
169
170 par = info->par;
171 sm750_dev = par->dev;
172
173 /*
174 * each time 2d function begin to work,below three variable always need
175 * be set, seems we can put them together in some place
176 */
177 base = par->crtc.oScreen;
178 pitch = info->fix.line_length;
179 Bpp = info->var.bits_per_pixel >> 3;
180
181 color = (Bpp == 1) ? region->color :
182 ((u32 *)info->pseudo_palette)[region->color];
183 rop = (region->rop != ROP_COPY) ? HW_ROP2_XOR : HW_ROP2_COPY;
184
185 /*
186 * If not use spin_lock, system will die if user load driver
187 * and immediately unload driver frequently (dual)
188 * since they fb_count could change during the lifetime of
189 * this lock, we are holding it for all cases.
190 */
191 spin_lock(&sm750_dev->slock);
192
193 sm750_dev->accel.de_fillrect(&sm750_dev->accel,
194 base, pitch, Bpp,
195 region->dx, region->dy,
196 region->width, region->height,
197 color, rop);
198 spin_unlock(&sm750_dev->slock);
199 }
200
201 static void lynxfb_ops_copyarea(struct fb_info *info,
202 const struct fb_copyarea *region)
203 {
204 struct lynxfb_par *par;
205 struct sm750_dev *sm750_dev;
206 unsigned int base, pitch, Bpp;
207
208 par = info->par;
209 sm750_dev = par->dev;
210
211 /*
212 * each time 2d function begin to work,below three variable always need
213 * be set, seems we can put them together in some place
214 */
215 base = par->crtc.oScreen;
216 pitch = info->fix.line_length;
217 Bpp = info->var.bits_per_pixel >> 3;
218
219 /*
220 * If not use spin_lock, system will die if user load driver
221 * and immediately unload driver frequently (dual)
222 * since they fb_count could change during the lifetime of
223 * this lock, we are holding it for all cases.
224 */
225 spin_lock(&sm750_dev->slock);
226
227 sm750_dev->accel.de_copyarea(&sm750_dev->accel,
228 base, pitch, region->sx, region->sy,
229 base, pitch, Bpp, region->dx, region->dy,
230 region->width, region->height,
231 HW_ROP2_COPY);
232 spin_unlock(&sm750_dev->slock);
233 }
234
235 static void lynxfb_ops_imageblit(struct fb_info *info,
236 const struct fb_image *image)
237 {
238 unsigned int base, pitch, Bpp;
239 unsigned int fgcol, bgcol;
240 struct lynxfb_par *par;
241 struct sm750_dev *sm750_dev;
242
243 par = info->par;
244 sm750_dev = par->dev;
245 /*
246 * each time 2d function begin to work,below three variable always need
247 * be set, seems we can put them together in some place
248 */
249 base = par->crtc.oScreen;
250 pitch = info->fix.line_length;
251 Bpp = info->var.bits_per_pixel >> 3;
252
253 /* TODO: Implement hardware acceleration for image->depth > 1 */
254 if (image->depth != 1) {
255 cfb_imageblit(info, image);
256 return;
257 }
258
259 if (info->fix.visual == FB_VISUAL_TRUECOLOR ||
260 info->fix.visual == FB_VISUAL_DIRECTCOLOR) {
261 fgcol = ((u32 *)info->pseudo_palette)[image->fg_color];
262 bgcol = ((u32 *)info->pseudo_palette)[image->bg_color];
263 } else {
264 fgcol = image->fg_color;
265 bgcol = image->bg_color;
266 }
267
268 /*
269 * If not use spin_lock, system will die if user load driver
270 * and immediately unload driver frequently (dual)
271 * since they fb_count could change during the lifetime of
272 * this lock, we are holding it for all cases.
273 */
274 spin_lock(&sm750_dev->slock);
275
276 sm750_dev->accel.de_imageblit(&sm750_dev->accel,
277 image->data, image->width >> 3, 0,
278 base, pitch, Bpp,
279 image->dx, image->dy,
280 image->width, image->height,
281 fgcol, bgcol, HW_ROP2_COPY);
282 spin_unlock(&sm750_dev->slock);
283 }
284
285 static int lynxfb_ops_pan_display(struct fb_var_screeninfo *var,
286 struct fb_info *info)
287 {
288 struct lynxfb_par *par;
289 struct lynxfb_crtc *crtc;
290
291 if (!info)
292 return -EINVAL;
293
294 par = info->par;
295 crtc = &par->crtc;
296 return hw_sm750_pan_display(crtc, var, info);
297 }
298
299 static int lynxfb_ops_set_par(struct fb_info *info)
300 {
301 struct lynxfb_par *par;
302 struct lynxfb_crtc *crtc;
303 struct lynxfb_output *output;
304 struct fb_var_screeninfo *var;
305 struct fb_fix_screeninfo *fix;
306 int ret;
307 unsigned int line_length;
308
309 if (!info)
310 return -EINVAL;
311
312 ret = 0;
313 par = info->par;
314 crtc = &par->crtc;
315 output = &par->output;
316 var = &info->var;
317 fix = &info->fix;
318
319 /* fix structure is not so FIX ... */
320 line_length = var->xres_virtual * var->bits_per_pixel / 8;
321 line_length = ALIGN(line_length, crtc->line_pad);
322 fix->line_length = line_length;
323 pr_info("fix->line_length = %d\n", fix->line_length);
324
325 /*
326 * var->red,green,blue,transp are need to be set by driver
327 * and these data should be set before setcolreg routine
328 */
329
330 switch (var->bits_per_pixel) {
331 case 8:
332 fix->visual = FB_VISUAL_PSEUDOCOLOR;
333 var->red.offset = 0;
334 var->red.length = 8;
335 var->green.offset = 0;
336 var->green.length = 8;
337 var->blue.offset = 0;
338 var->blue.length = 8;
339 var->transp.length = 0;
340 var->transp.offset = 0;
341 break;
342 case 16:
343 var->red.offset = 11;
344 var->red.length = 5;
345 var->green.offset = 5;
346 var->green.length = 6;
347 var->blue.offset = 0;
348 var->blue.length = 5;
349 var->transp.length = 0;
350 var->transp.offset = 0;
351 fix->visual = FB_VISUAL_TRUECOLOR;
352 break;
353 case 24:
354 case 32:
355 var->red.offset = 16;
356 var->red.length = 8;
357 var->green.offset = 8;
358 var->green.length = 8;
359 var->blue.offset = 0;
360 var->blue.length = 8;
361 fix->visual = FB_VISUAL_TRUECOLOR;
362 break;
363 default:
364 ret = -EINVAL;
365 break;
366 }
367 var->height = var->width = -1;
368 var->accel_flags = 0;/*FB_ACCELF_TEXT;*/
369
370 if (ret) {
371 pr_err("pixel bpp format not satisfied\n.");
372 return ret;
373 }
374 ret = hw_sm750_crtc_setMode(crtc, var, fix);
375 if (!ret)
376 ret = hw_sm750_output_setMode(output, var, fix);
377 return ret;
378 }
379
380 static inline unsigned int chan_to_field(unsigned int chan,
381 struct fb_bitfield *bf)
382 {
383 chan &= 0xffff;
384 chan >>= 16 - bf->length;
385 return chan << bf->offset;
386 }
387
388 #ifdef CONFIG_PM
389 static int lynxfb_suspend(struct pci_dev *pdev, pm_message_t mesg)
390 {
391 struct fb_info *info;
392 struct sm750_dev *sm750_dev;
393 int ret;
394
395 if (mesg.event == pdev->dev.power.power_state.event)
396 return 0;
397
398 ret = 0;
399 sm750_dev = pci_get_drvdata(pdev);
400 switch (mesg.event) {
401 case PM_EVENT_FREEZE:
402 case PM_EVENT_PRETHAW:
403 pdev->dev.power.power_state = mesg;
404 return 0;
405 }
406
407 console_lock();
408 if (mesg.event & PM_EVENT_SLEEP) {
409 info = sm750_dev->fbinfo[0];
410 if (info)
411 /* 1 means do suspend */
412 fb_set_suspend(info, 1);
413 info = sm750_dev->fbinfo[1];
414 if (info)
415 /* 1 means do suspend */
416 fb_set_suspend(info, 1);
417
418 ret = pci_save_state(pdev);
419 if (ret) {
420 dev_err(&pdev->dev,
421 "error:%d occurred in pci_save_state\n", ret);
422 goto lynxfb_suspend_err;
423 }
424
425 ret = pci_set_power_state(pdev, pci_choose_state(pdev, mesg));
426 if (ret) {
427 dev_err(&pdev->dev,
428 "error:%d occurred in pci_set_power_state\n",
429 ret);
430 goto lynxfb_suspend_err;
431 }
432 }
433
434 pdev->dev.power.power_state = mesg;
435
436 lynxfb_suspend_err:
437 console_unlock();
438 return ret;
439 }
440
441 static int lynxfb_resume(struct pci_dev *pdev)
442 {
443 struct fb_info *info;
444 struct sm750_dev *sm750_dev;
445
446 struct lynxfb_par *par;
447 struct lynxfb_crtc *crtc;
448 struct lynx_cursor *cursor;
449
450 int ret;
451
452 ret = 0;
453 sm750_dev = pci_get_drvdata(pdev);
454
455 console_lock();
456
457 ret = pci_set_power_state(pdev, PCI_D0);
458 if (ret) {
459 dev_err(&pdev->dev,
460 "error:%d occurred in pci_set_power_state\n", ret);
461 goto lynxfb_resume_err;
462 }
463
464 if (pdev->dev.power.power_state.event != PM_EVENT_FREEZE) {
465 pci_restore_state(pdev);
466 ret = pci_enable_device(pdev);
467 if (ret) {
468 dev_err(&pdev->dev,
469 "error:%d occurred in pci_enable_device\n",
470 ret);
471 goto lynxfb_resume_err;
472 }
473 pci_set_master(pdev);
474 }
475
476 hw_sm750_inithw(sm750_dev, pdev);
477
478 info = sm750_dev->fbinfo[0];
479
480 if (info) {
481 par = info->par;
482 crtc = &par->crtc;
483 cursor = &crtc->cursor;
484 memset_io(cursor->vstart, 0x0, cursor->size);
485 memset_io(crtc->vScreen, 0x0, crtc->vidmem_size);
486 lynxfb_ops_set_par(info);
487 fb_set_suspend(info, 0);
488 }
489
490 info = sm750_dev->fbinfo[1];
491
492 if (info) {
493 par = info->par;
494 crtc = &par->crtc;
495 cursor = &crtc->cursor;
496 memset_io(cursor->vstart, 0x0, cursor->size);
497 memset_io(crtc->vScreen, 0x0, crtc->vidmem_size);
498 lynxfb_ops_set_par(info);
499 fb_set_suspend(info, 0);
500 }
501
502 pdev->dev.power.power_state.event = PM_EVENT_RESUME;
503
504 lynxfb_resume_err:
505 console_unlock();
506 return ret;
507 }
508 #endif
509
510 static int lynxfb_ops_check_var(struct fb_var_screeninfo *var,
511 struct fb_info *info)
512 {
513 struct lynxfb_par *par;
514 struct lynxfb_crtc *crtc;
515 struct lynxfb_output *output;
516 resource_size_t request;
517
518 par = info->par;
519 crtc = &par->crtc;
520 output = &par->output;
521
522 pr_debug("check var:%dx%d-%d\n",
523 var->xres,
524 var->yres,
525 var->bits_per_pixel);
526
527 switch (var->bits_per_pixel) {
528 case 8:
529 info->fix.visual = FB_VISUAL_PSEUDOCOLOR;
530 var->red.offset = 0;
531 var->red.length = 8;
532 var->green.offset = 0;
533 var->green.length = 8;
534 var->blue.offset = 0;
535 var->blue.length = 8;
536 var->transp.length = 0;
537 var->transp.offset = 0;
538 break;
539 case 16:
540 var->red.offset = 11;
541 var->red.length = 5;
542 var->green.offset = 5;
543 var->green.length = 6;
544 var->blue.offset = 0;
545 var->blue.length = 5;
546 var->transp.length = 0;
547 var->transp.offset = 0;
548 info->fix.visual = FB_VISUAL_TRUECOLOR;
549 break;
550 case 24:
551 case 32:
552 var->red.offset = 16;
553 var->red.length = 8;
554 var->green.offset = 8;
555 var->green.length = 8;
556 var->blue.offset = 0;
557 var->blue.length = 8;
558 info->fix.visual = FB_VISUAL_TRUECOLOR;
559 break;
560 default:
561 pr_err("bpp %d not supported\n", var->bits_per_pixel);
562 return -EINVAL;
563 }
564 var->height = var->width = -1;
565 var->accel_flags = 0;/* FB_ACCELF_TEXT; */
566
567 /* check if current fb's video memory big enought to hold the onscreen*/
568 request = var->xres_virtual * (var->bits_per_pixel >> 3);
569 /* defaulty crtc->channel go with par->index */
570
571 request = ALIGN(request, crtc->line_pad);
572 request = request * var->yres_virtual;
573 if (crtc->vidmem_size < request) {
574 pr_err("not enough video memory for mode\n");
575 return -ENOMEM;
576 }
577
578 return hw_sm750_crtc_checkMode(crtc, var);
579 }
580
581 static int lynxfb_ops_setcolreg(unsigned int regno,
582 unsigned int red,
583 unsigned int green,
584 unsigned int blue,
585 unsigned int transp,
586 struct fb_info *info)
587 {
588 struct lynxfb_par *par;
589 struct lynxfb_crtc *crtc;
590 struct fb_var_screeninfo *var;
591 int ret;
592
593 par = info->par;
594 crtc = &par->crtc;
595 var = &info->var;
596 ret = 0;
597
598 if (regno > 256) {
599 pr_err("regno = %d\n", regno);
600 return -EINVAL;
601 }
602
603 if (info->var.grayscale)
604 red = green = blue = (red * 77 + green * 151 + blue * 28) >> 8;
605
606 if (var->bits_per_pixel == 8 &&
607 info->fix.visual == FB_VISUAL_PSEUDOCOLOR) {
608 red >>= 8;
609 green >>= 8;
610 blue >>= 8;
611 ret = hw_sm750_setColReg(crtc, regno, red, green, blue);
612 goto exit;
613 }
614
615 if (info->fix.visual == FB_VISUAL_TRUECOLOR && regno < 256) {
616 u32 val;
617
618 if (var->bits_per_pixel == 16 ||
619 var->bits_per_pixel == 32 ||
620 var->bits_per_pixel == 24) {
621 val = chan_to_field(red, &var->red);
622 val |= chan_to_field(green, &var->green);
623 val |= chan_to_field(blue, &var->blue);
624 par->pseudo_palette[regno] = val;
625 goto exit;
626 }
627 }
628
629 ret = -EINVAL;
630
631 exit:
632 return ret;
633 }
634
635 static int lynxfb_ops_blank(int blank, struct fb_info *info)
636 {
637 struct lynxfb_par *par;
638 struct lynxfb_output *output;
639
640 pr_debug("blank = %d.\n", blank);
641 par = info->par;
642 output = &par->output;
643 return output->proc_setBLANK(output, blank);
644 }
645
646 static int sm750fb_set_drv(struct lynxfb_par *par)
647 {
648 int ret;
649 struct sm750_dev *sm750_dev;
650 struct lynxfb_output *output;
651 struct lynxfb_crtc *crtc;
652
653 ret = 0;
654
655 sm750_dev = par->dev;
656 output = &par->output;
657 crtc = &par->crtc;
658
659 crtc->vidmem_size = sm750_dev->vidmem_size;
660 if (sm750_dev->fb_count > 1)
661 crtc->vidmem_size >>= 1;
662
663 /* setup crtc and output member */
664 sm750_dev->hwCursor = g_hwcursor;
665
666 crtc->line_pad = 16;
667 crtc->xpanstep = 8;
668 crtc->ypanstep = 1;
669 crtc->ywrapstep = 0;
670
671 output->proc_setBLANK = (sm750_dev->revid == SM750LE_REVISION_ID) ?
672 hw_sm750le_setBLANK : hw_sm750_setBLANK;
673 /* chip specific phase */
674 sm750_dev->accel.de_wait = (sm750_dev->revid == SM750LE_REVISION_ID) ?
675 hw_sm750le_deWait : hw_sm750_deWait;
676 switch (sm750_dev->dataflow) {
677 case sm750_simul_pri:
678 output->paths = sm750_pnc;
679 crtc->channel = sm750_primary;
680 crtc->oScreen = 0;
681 crtc->vScreen = sm750_dev->pvMem;
682 pr_info("use simul primary mode\n");
683 break;
684 case sm750_simul_sec:
685 output->paths = sm750_pnc;
686 crtc->channel = sm750_secondary;
687 crtc->oScreen = 0;
688 crtc->vScreen = sm750_dev->pvMem;
689 break;
690 case sm750_dual_normal:
691 if (par->index == 0) {
692 output->paths = sm750_panel;
693 crtc->channel = sm750_primary;
694 crtc->oScreen = 0;
695 crtc->vScreen = sm750_dev->pvMem;
696 } else {
697 output->paths = sm750_crt;
698 crtc->channel = sm750_secondary;
699 /* not consider of padding stuffs for oScreen,need fix */
700 crtc->oScreen = (sm750_dev->vidmem_size >> 1);
701 crtc->vScreen = sm750_dev->pvMem + crtc->oScreen;
702 }
703 break;
704 case sm750_dual_swap:
705 if (par->index == 0) {
706 output->paths = sm750_panel;
707 crtc->channel = sm750_secondary;
708 crtc->oScreen = 0;
709 crtc->vScreen = sm750_dev->pvMem;
710 } else {
711 output->paths = sm750_crt;
712 crtc->channel = sm750_primary;
713 /* not consider of padding stuffs for oScreen,need fix */
714 crtc->oScreen = (sm750_dev->vidmem_size >> 1);
715 crtc->vScreen = sm750_dev->pvMem + crtc->oScreen;
716 }
717 break;
718 default:
719 ret = -EINVAL;
720 }
721
722 return ret;
723 }
724
725 static struct fb_ops lynxfb_ops = {
726 .owner = THIS_MODULE,
727 .fb_check_var = lynxfb_ops_check_var,
728 .fb_set_par = lynxfb_ops_set_par,
729 .fb_setcolreg = lynxfb_ops_setcolreg,
730 .fb_blank = lynxfb_ops_blank,
731 .fb_fillrect = cfb_fillrect,
732 .fb_imageblit = cfb_imageblit,
733 .fb_copyarea = cfb_copyarea,
734 /* cursor */
735 .fb_cursor = lynxfb_ops_cursor,
736 };
737
738 static int lynxfb_set_fbinfo(struct fb_info *info, int index)
739 {
740 int i;
741 struct lynxfb_par *par;
742 struct sm750_dev *sm750_dev;
743 struct lynxfb_crtc *crtc;
744 struct lynxfb_output *output;
745 struct fb_var_screeninfo *var;
746 struct fb_fix_screeninfo *fix;
747
748 const struct fb_videomode *pdb[] = {
749 lynx750_ext, NULL, vesa_modes,
750 };
751 int cdb[] = {ARRAY_SIZE(lynx750_ext), 0, VESA_MODEDB_SIZE};
752 static const char *mdb_desc[] = {
753 "driver prepared modes",
754 "kernel prepared default modedb",
755 "kernel HELPERS prepared vesa_modes",
756 };
757
758 static const char *fixId[2] = {
759 "sm750_fb1", "sm750_fb2",
760 };
761
762 int ret, line_length;
763
764 ret = 0;
765 par = (struct lynxfb_par *)info->par;
766 sm750_dev = par->dev;
767 crtc = &par->crtc;
768 output = &par->output;
769 var = &info->var;
770 fix = &info->fix;
771
772 /* set index */
773 par->index = index;
774 output->channel = &crtc->channel;
775 sm750fb_set_drv(par);
776 lynxfb_ops.fb_pan_display = lynxfb_ops_pan_display;
777
778 /*
779 * set current cursor variable and proc pointer,
780 * must be set after crtc member initialized
781 */
782 crtc->cursor.offset = crtc->oScreen + crtc->vidmem_size - 1024;
783 crtc->cursor.mmio = sm750_dev->pvReg +
784 0x800f0 + (int)crtc->channel * 0x140;
785
786 pr_info("crtc->cursor.mmio = %p\n", crtc->cursor.mmio);
787 crtc->cursor.maxH = crtc->cursor.maxW = 64;
788 crtc->cursor.size = crtc->cursor.maxH * crtc->cursor.maxW * 2 / 8;
789 crtc->cursor.vstart = sm750_dev->pvMem + crtc->cursor.offset;
790
791 memset_io(crtc->cursor.vstart, 0, crtc->cursor.size);
792 if (!g_hwcursor) {
793 lynxfb_ops.fb_cursor = NULL;
794 sm750_hw_cursor_disable(&crtc->cursor);
795 }
796
797 /* set info->fbops, must be set before fb_find_mode */
798 if (!sm750_dev->accel_off) {
799 /* use 2d acceleration */
800 lynxfb_ops.fb_fillrect = lynxfb_ops_fillrect;
801 lynxfb_ops.fb_copyarea = lynxfb_ops_copyarea;
802 lynxfb_ops.fb_imageblit = lynxfb_ops_imageblit;
803 }
804 info->fbops = &lynxfb_ops;
805
806 if (!g_fbmode[index]) {
807 g_fbmode[index] = g_def_fbmode;
808 if (index)
809 g_fbmode[index] = g_fbmode[0];
810 }
811
812 for (i = 0; i < 3; i++) {
813 ret = fb_find_mode(var, info, g_fbmode[index],
814 pdb[i], cdb[i], NULL, 8);
815
816 if (ret == 1) {
817 pr_info("success! use specified mode:%s in %s\n",
818 g_fbmode[index],
819 mdb_desc[i]);
820 break;
821 } else if (ret == 2) {
822 pr_warn("use specified mode:%s in %s,with an ignored refresh rate\n",
823 g_fbmode[index],
824 mdb_desc[i]);
825 break;
826 } else if (ret == 3) {
827 pr_warn("wanna use default mode\n");
828 /*break;*/
829 } else if (ret == 4) {
830 pr_warn("fall back to any valid mode\n");
831 } else {
832 pr_warn("ret = %d,fb_find_mode failed,with %s\n",
833 ret,
834 mdb_desc[i]);
835 }
836 }
837
838 /* some member of info->var had been set by fb_find_mode */
839
840 pr_info("Member of info->var is :\n"
841 "xres=%d\n"
842 "yres=%d\n"
843 "xres_virtual=%d\n"
844 "yres_virtual=%d\n"
845 "xoffset=%d\n"
846 "yoffset=%d\n"
847 "bits_per_pixel=%d\n"
848 " ...\n",
849 var->xres,
850 var->yres,
851 var->xres_virtual,
852 var->yres_virtual,
853 var->xoffset,
854 var->yoffset,
855 var->bits_per_pixel);
856
857 /* set par */
858 par->info = info;
859
860 /* set info */
861 line_length = ALIGN((var->xres_virtual * var->bits_per_pixel / 8),
862 crtc->line_pad);
863
864 info->pseudo_palette = &par->pseudo_palette[0];
865 info->screen_base = crtc->vScreen;
866 pr_debug("screen_base vaddr = %p\n", info->screen_base);
867 info->screen_size = line_length * var->yres_virtual;
868 info->flags = FBINFO_FLAG_DEFAULT | 0;
869
870 /* set info->fix */
871 fix->type = FB_TYPE_PACKED_PIXELS;
872 fix->type_aux = 0;
873 fix->xpanstep = crtc->xpanstep;
874 fix->ypanstep = crtc->ypanstep;
875 fix->ywrapstep = crtc->ywrapstep;
876 fix->accel = FB_ACCEL_SMI;
877
878 strlcpy(fix->id, fixId[index], sizeof(fix->id));
879
880 fix->smem_start = crtc->oScreen + sm750_dev->vidmem_start;
881 pr_info("fix->smem_start = %lx\n", fix->smem_start);
882 /*
883 * according to mmap experiment from user space application,
884 * fix->mmio_len should not larger than virtual size
885 * (xres_virtual x yres_virtual x ByPP)
886 * Below line maybe buggy when user mmap fb dev node and write
887 * data into the bound over virtual size
888 */
889 fix->smem_len = crtc->vidmem_size;
890 pr_info("fix->smem_len = %x\n", fix->smem_len);
891 info->screen_size = fix->smem_len;
892 fix->line_length = line_length;
893 fix->mmio_start = sm750_dev->vidreg_start;
894 pr_info("fix->mmio_start = %lx\n", fix->mmio_start);
895 fix->mmio_len = sm750_dev->vidreg_size;
896 pr_info("fix->mmio_len = %x\n", fix->mmio_len);
897 switch (var->bits_per_pixel) {
898 case 8:
899 fix->visual = FB_VISUAL_PSEUDOCOLOR;
900 break;
901 case 16:
902 case 32:
903 fix->visual = FB_VISUAL_TRUECOLOR;
904 break;
905 }
906
907 /* set var */
908 var->activate = FB_ACTIVATE_NOW;
909 var->accel_flags = 0;
910 var->vmode = FB_VMODE_NONINTERLACED;
911
912 pr_debug("#1 show info->cmap :\nstart=%d,len=%d,red=%p,green=%p,blue=%p,transp=%p\n",
913 info->cmap.start, info->cmap.len,
914 info->cmap.red, info->cmap.green, info->cmap.blue,
915 info->cmap.transp);
916
917 ret = fb_alloc_cmap(&info->cmap, 256, 0);
918 if (ret < 0) {
919 pr_err("Could not allocate memory for cmap.\n");
920 goto exit;
921 }
922
923 pr_debug("#2 show info->cmap :\nstart=%d,len=%d,red=%p,green=%p,blue=%p,transp=%p\n",
924 info->cmap.start, info->cmap.len,
925 info->cmap.red, info->cmap.green, info->cmap.blue,
926 info->cmap.transp);
927
928 exit:
929 lynxfb_ops_check_var(var, info);
930 return ret;
931 }
932
933 /* chip specific g_option configuration routine */
934 static void sm750fb_setup(struct sm750_dev *sm750_dev, char *src)
935 {
936 char *opt;
937 int swap;
938
939 swap = 0;
940
941 sm750_dev->initParm.chip_clk = 0;
942 sm750_dev->initParm.mem_clk = 0;
943 sm750_dev->initParm.master_clk = 0;
944 sm750_dev->initParm.powerMode = 0;
945 sm750_dev->initParm.setAllEngOff = 0;
946 sm750_dev->initParm.resetMemory = 1;
947
948 /* defaultly turn g_hwcursor on for both view */
949 g_hwcursor = 3;
950
951 if (!src || !*src) {
952 dev_warn(&sm750_dev->pdev->dev, "no specific g_option.\n");
953 goto NO_PARAM;
954 }
955
956 while ((opt = strsep(&src, ":")) != NULL && *opt != 0) {
957 dev_info(&sm750_dev->pdev->dev, "opt=%s\n", opt);
958 dev_info(&sm750_dev->pdev->dev, "src=%s\n", src);
959
960 if (!strncmp(opt, "swap", strlen("swap"))) {
961 swap = 1;
962 } else if (!strncmp(opt, "nocrt", strlen("nocrt"))) {
963 sm750_dev->nocrt = 1;
964 } else if (!strncmp(opt, "36bit", strlen("36bit"))) {
965 sm750_dev->pnltype = sm750_doubleTFT;
966 } else if (!strncmp(opt, "18bit", strlen("18bit"))) {
967 sm750_dev->pnltype = sm750_dualTFT;
968 } else if (!strncmp(opt, "24bit", strlen("24bit"))) {
969 sm750_dev->pnltype = sm750_24TFT;
970 } else if (!strncmp(opt, "nohwc0", strlen("nohwc0"))) {
971 g_hwcursor &= ~0x1;
972 } else if (!strncmp(opt, "nohwc1", strlen("nohwc1"))) {
973 g_hwcursor &= ~0x2;
974 } else if (!strncmp(opt, "nohwc", strlen("nohwc"))) {
975 g_hwcursor = 0;
976 } else {
977 if (!g_fbmode[0]) {
978 g_fbmode[0] = opt;
979 dev_info(&sm750_dev->pdev->dev,
980 "find fbmode0 : %s\n", g_fbmode[0]);
981 } else if (!g_fbmode[1]) {
982 g_fbmode[1] = opt;
983 dev_info(&sm750_dev->pdev->dev,
984 "find fbmode1 : %s\n", g_fbmode[1]);
985 } else {
986 dev_warn(&sm750_dev->pdev->dev, "How many view you wann set?\n");
987 }
988 }
989 }
990
991 NO_PARAM:
992 if (sm750_dev->revid != SM750LE_REVISION_ID) {
993 if (sm750_dev->fb_count > 1) {
994 if (swap)
995 sm750_dev->dataflow = sm750_dual_swap;
996 else
997 sm750_dev->dataflow = sm750_dual_normal;
998 } else {
999 if (swap)
1000 sm750_dev->dataflow = sm750_simul_sec;
1001 else
1002 sm750_dev->dataflow = sm750_simul_pri;
1003 }
1004 } else {
1005 /* SM750LE only have one crt channel */
1006 sm750_dev->dataflow = sm750_simul_sec;
1007 /* sm750le do not have complex attributes */
1008 sm750_dev->nocrt = 0;
1009 }
1010 }
1011
1012 static void sm750fb_frambuffer_release(struct sm750_dev *sm750_dev)
1013 {
1014 struct fb_info *fb_info;
1015
1016 while (sm750_dev->fb_count) {
1017 fb_info = sm750_dev->fbinfo[sm750_dev->fb_count - 1];
1018 unregister_framebuffer(fb_info);
1019 framebuffer_release(fb_info);
1020 sm750_dev->fb_count--;
1021 }
1022 }
1023
1024 static int sm750fb_frambuffer_alloc(struct sm750_dev *sm750_dev, int fbidx)
1025 {
1026 struct fb_info *fb_info;
1027 struct lynxfb_par *par;
1028 int err;
1029
1030 fb_info = framebuffer_alloc(sizeof(struct lynxfb_par),
1031 &sm750_dev->pdev->dev);
1032 if (!fb_info)
1033 return -ENOMEM;
1034
1035 sm750_dev->fbinfo[fbidx] = fb_info;
1036 par = fb_info->par;
1037 par->dev = sm750_dev;
1038
1039 err = lynxfb_set_fbinfo(fb_info, fbidx);
1040 if (err)
1041 goto release_fb;
1042
1043 err = register_framebuffer(fb_info);
1044 if (err < 0)
1045 goto release_fb;
1046
1047 sm750_dev->fb_count++;
1048
1049 return 0;
1050
1051 release_fb:
1052 framebuffer_release(fb_info);
1053 return err;
1054 }
1055
1056 static int lynxfb_kick_out_firmware_fb(struct pci_dev *pdev)
1057 {
1058 struct apertures_struct *ap;
1059 bool primary = false;
1060
1061 ap = alloc_apertures(1);
1062 if (!ap)
1063 return -ENOMEM;
1064
1065 ap->ranges[0].base = pci_resource_start(pdev, 0);
1066 ap->ranges[0].size = pci_resource_len(pdev, 0);
1067 #ifdef CONFIG_X86
1068 primary = pdev->resource[PCI_ROM_RESOURCE].flags &
1069 IORESOURCE_ROM_SHADOW;
1070 #endif
1071 remove_conflicting_framebuffers(ap, "sm750_fb1", primary);
1072 kfree(ap);
1073 return 0;
1074 }
1075
1076 static int lynxfb_pci_probe(struct pci_dev *pdev,
1077 const struct pci_device_id *ent)
1078 {
1079 struct sm750_dev *sm750_dev = NULL;
1080 int max_fb;
1081 int fbidx;
1082 int err;
1083
1084 err = lynxfb_kick_out_firmware_fb(pdev);
1085 if (err)
1086 return err;
1087
1088 /* enable device */
1089 err = pcim_enable_device(pdev);
1090 if (err)
1091 return err;
1092
1093 err = -ENOMEM;
1094 sm750_dev = devm_kzalloc(&pdev->dev, sizeof(*sm750_dev), GFP_KERNEL);
1095 if (!sm750_dev)
1096 return err;
1097
1098 sm750_dev->fbinfo[0] = sm750_dev->fbinfo[1] = NULL;
1099 sm750_dev->devid = pdev->device;
1100 sm750_dev->revid = pdev->revision;
1101 sm750_dev->pdev = pdev;
1102 sm750_dev->mtrr_off = g_nomtrr;
1103 sm750_dev->mtrr.vram = 0;
1104 sm750_dev->accel_off = g_noaccel;
1105 spin_lock_init(&sm750_dev->slock);
1106
1107 if (!sm750_dev->accel_off) {
1108 /*
1109 * hook deInit and 2d routines, notes that below hw_xxx
1110 * routine can work on most of lynx chips
1111 * if some chip need specific function,
1112 * please hook it in smXXX_set_drv routine
1113 */
1114 sm750_dev->accel.de_init = sm750_hw_de_init;
1115 sm750_dev->accel.de_fillrect = sm750_hw_fillrect;
1116 sm750_dev->accel.de_copyarea = sm750_hw_copyarea;
1117 sm750_dev->accel.de_imageblit = sm750_hw_imageblit;
1118 }
1119
1120 /* call chip specific setup routine */
1121 sm750fb_setup(sm750_dev, g_settings);
1122
1123 /* call chip specific mmap routine */
1124 err = hw_sm750_map(sm750_dev, pdev);
1125 if (err)
1126 return err;
1127
1128 if (!sm750_dev->mtrr_off)
1129 sm750_dev->mtrr.vram = arch_phys_wc_add(sm750_dev->vidmem_start,
1130 sm750_dev->vidmem_size);
1131
1132 memset_io(sm750_dev->pvMem, 0, sm750_dev->vidmem_size);
1133
1134 pci_set_drvdata(pdev, sm750_dev);
1135
1136 /* call chipInit routine */
1137 hw_sm750_inithw(sm750_dev, pdev);
1138
1139 /* allocate frame buffer info structures according to g_dualview */
1140 max_fb = g_dualview ? 2 : 1;
1141 for (fbidx = 0; fbidx < max_fb; fbidx++) {
1142 err = sm750fb_frambuffer_alloc(sm750_dev, fbidx);
1143 if (err)
1144 goto release_fb;
1145 }
1146
1147 return 0;
1148
1149 release_fb:
1150 sm750fb_frambuffer_release(sm750_dev);
1151 return err;
1152 }
1153
1154 static void lynxfb_pci_remove(struct pci_dev *pdev)
1155 {
1156 struct sm750_dev *sm750_dev;
1157
1158 sm750_dev = pci_get_drvdata(pdev);
1159
1160 sm750fb_frambuffer_release(sm750_dev);
1161 arch_phys_wc_del(sm750_dev->mtrr.vram);
1162
1163 iounmap(sm750_dev->pvReg);
1164 iounmap(sm750_dev->pvMem);
1165 kfree(g_settings);
1166 }
1167
1168 static int __init lynxfb_setup(char *options)
1169 {
1170 int len;
1171 char *opt, *tmp;
1172
1173 if (!options || !*options) {
1174 pr_warn("no options.\n");
1175 return 0;
1176 }
1177
1178 pr_info("options:%s\n", options);
1179
1180 len = strlen(options) + 1;
1181 g_settings = kzalloc(len, GFP_KERNEL);
1182 if (!g_settings)
1183 return -ENOMEM;
1184
1185 tmp = g_settings;
1186
1187 /*
1188 * Notes:
1189 * char * strsep(char **s,const char * ct);
1190 * @s: the string to be searched
1191 * @ct :the characters to search for
1192 *
1193 * strsep() updates @options to pointer after the first found token
1194 * it also returns the pointer ahead the token.
1195 */
1196 while ((opt = strsep(&options, ":")) != NULL) {
1197 /* options that mean for any lynx chips are configured here */
1198 if (!strncmp(opt, "noaccel", strlen("noaccel"))) {
1199 g_noaccel = 1;
1200 } else if (!strncmp(opt, "nomtrr", strlen("nomtrr"))) {
1201 g_nomtrr = 1;
1202 } else if (!strncmp(opt, "dual", strlen("dual"))) {
1203 g_dualview = 1;
1204 } else {
1205 strcat(tmp, opt);
1206 tmp += strlen(opt);
1207 if (options)
1208 *tmp++ = ':';
1209 else
1210 *tmp++ = 0;
1211 }
1212 }
1213
1214 /* misc g_settings are transport to chip specific routines */
1215 pr_info("parameter left for chip specific analysis:%s\n", g_settings);
1216 return 0;
1217 }
1218
1219 static const struct pci_device_id smi_pci_table[] = {
1220 { PCI_DEVICE(0x126f, 0x0750), },
1221 {0,}
1222 };
1223
1224 MODULE_DEVICE_TABLE(pci, smi_pci_table);
1225
1226 static struct pci_driver lynxfb_driver = {
1227 .name = "sm750fb",
1228 .id_table = smi_pci_table,
1229 .probe = lynxfb_pci_probe,
1230 .remove = lynxfb_pci_remove,
1231 #ifdef CONFIG_PM
1232 .suspend = lynxfb_suspend,
1233 .resume = lynxfb_resume,
1234 #endif
1235 };
1236
1237 static int __init lynxfb_init(void)
1238 {
1239 char *option;
1240
1241 #ifdef MODULE
1242 option = g_option;
1243 #else
1244 if (fb_get_options("sm750fb", &option))
1245 return -ENODEV;
1246 #endif
1247
1248 lynxfb_setup(option);
1249 return pci_register_driver(&lynxfb_driver);
1250 }
1251 module_init(lynxfb_init);
1252
1253 static void __exit lynxfb_exit(void)
1254 {
1255 pci_unregister_driver(&lynxfb_driver);
1256 }
1257 module_exit(lynxfb_exit);
1258
1259 module_param(g_option, charp, 0444);
1260
1261 MODULE_PARM_DESC(g_option,
1262 "\n\t\tCommon options:\n"
1263 "\t\tnoaccel:disable 2d capabilities\n"
1264 "\t\tnomtrr:disable MTRR attribute for video memory\n"
1265 "\t\tdualview:dual frame buffer feature enabled\n"
1266 "\t\tnohwc:disable hardware cursor\n"
1267 "\t\tUsual example:\n"
1268 "\t\tinsmod ./sm750fb.ko g_option=\"noaccel,nohwc,1280x1024-8@60\"\n"
1269 );
1270
1271 MODULE_AUTHOR("monk liu <monk.liu@siliconmotion.com>");
1272 MODULE_AUTHOR("Sudip Mukherjee <sudip@vectorindia.org>");
1273 MODULE_DESCRIPTION("Frame buffer driver for SM750 chipset");
1274 MODULE_LICENSE("Dual BSD/GPL");
Linux with added FPC-III support