1 // SPDX-License-Identifier: GPL-2.0
2 #include <linux/kernel.h>
3 #include <linux/module.h>
4 #include <linux/errno.h>
5 #include <linux/string.h>
7 #include <linux/slab.h>
8 #include <linux/delay.h>
10 #include <linux/ioport.h>
11 #include <linux/init.h>
12 #include <linux/pci.h>
13 #include <linux/mm_types.h>
14 #include <linux/vmalloc.h>
15 #include <linux/pagemap.h>
16 #include <linux/screen_info.h>
17 #include <linux/console.h>
20 #include "sm750_accel.h"
21 #include "sm750_cursor.h"
25 * ssize_t lynxfb_ops_write(struct fb_info *info, const char __user *buf,
26 * size_t count, loff_t *ppos);
27 * ssize_t lynxfb_ops_read(struct fb_info *info, char __user *buf,
28 * size_t count, loff_t *ppos);
32 /* common var for all device */
33 static int g_hwcursor = 1;
36 static const char *g_fbmode[] = {NULL, NULL};
37 static const char *g_def_fbmode = "1024x768-32@60";
38 static char *g_settings;
39 static int g_dualview;
40 static char *g_option;
42 static const struct fb_videomode lynx750_ext[] = {
43 /* 1024x600-60 VESA [1.71:1] */
44 {NULL, 60, 1024, 600, 20423, 144, 40, 18, 1, 104, 3,
45 FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
46 FB_VMODE_NONINTERLACED},
48 /* 1024x600-70 VESA */
49 {NULL, 70, 1024, 600, 17211, 152, 48, 21, 1, 104, 3,
50 FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
51 FB_VMODE_NONINTERLACED},
53 /* 1024x600-75 VESA */
54 {NULL, 75, 1024, 600, 15822, 160, 56, 23, 1, 104, 3,
55 FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
56 FB_VMODE_NONINTERLACED},
58 /* 1024x600-85 VESA */
59 {NULL, 85, 1024, 600, 13730, 168, 56, 26, 1, 112, 3,
60 FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
61 FB_VMODE_NONINTERLACED},
64 {NULL, 60, 720, 480, 37427, 88, 16, 13, 1, 72, 3,
65 FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
66 FB_VMODE_NONINTERLACED},
68 /* 1280x720 [1.78:1] */
69 {NULL, 60, 1280, 720, 13426, 162, 86, 22, 1, 136, 3,
70 FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
71 FB_VMODE_NONINTERLACED},
74 {NULL, 60, 1280, 768, 12579, 192, 64, 20, 3, 128, 7,
75 FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
76 FB_VMODE_NONINTERLACED},
78 /* 1360 x 768 [1.77083:1] */
79 {NULL, 60, 1360, 768, 11804, 208, 64, 23, 1, 144, 3,
80 FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
81 FB_VMODE_NONINTERLACED},
83 /* 1368 x 768 [1.78:1] */
84 {NULL, 60, 1368, 768, 11647, 216, 72, 23, 1, 144, 3,
85 FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
86 FB_VMODE_NONINTERLACED},
88 /* 1440 x 900 [16:10] */
89 {NULL, 60, 1440, 900, 9392, 232, 80, 28, 1, 152, 3,
90 FB_SYNC_VERT_HIGH_ACT,
91 FB_VMODE_NONINTERLACED},
93 /* 1440x960 [15:10] */
94 {NULL, 60, 1440, 960, 8733, 240, 88, 30, 1, 152, 3,
95 FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
96 FB_VMODE_NONINTERLACED},
98 /* 1920x1080 [16:9] */
99 {NULL, 60, 1920, 1080, 6734, 148, 88, 41, 1, 44, 3,
100 FB_SYNC_VERT_HIGH_ACT,
101 FB_VMODE_NONINTERLACED},
104 /* no hardware cursor supported under version 2.6.10, kernel bug */
105 static int lynxfb_ops_cursor(struct fb_info *info, struct fb_cursor *fbcursor)
107 struct lynxfb_par *par;
108 struct lynxfb_crtc *crtc;
109 struct lynx_cursor *cursor;
113 cursor = &crtc->cursor;
115 if (fbcursor->image.width > cursor->maxW ||
116 fbcursor->image.height > cursor->maxH ||
117 fbcursor->image.depth > 1) {
121 sm750_hw_cursor_disable(cursor);
122 if (fbcursor->set & FB_CUR_SETSIZE)
123 sm750_hw_cursor_setSize(cursor,
124 fbcursor->image.width,
125 fbcursor->image.height);
127 if (fbcursor->set & FB_CUR_SETPOS)
128 sm750_hw_cursor_setPos(cursor,
129 fbcursor->image.dx - info->var.xoffset,
130 fbcursor->image.dy - info->var.yoffset);
132 if (fbcursor->set & FB_CUR_SETCMAP) {
133 /* get the 16bit color of kernel means */
136 fg = ((info->cmap.red[fbcursor->image.fg_color] & 0xf800)) |
137 ((info->cmap.green[fbcursor->image.fg_color] & 0xfc00) >> 5) |
138 ((info->cmap.blue[fbcursor->image.fg_color] & 0xf800) >> 11);
140 bg = ((info->cmap.red[fbcursor->image.bg_color] & 0xf800)) |
141 ((info->cmap.green[fbcursor->image.bg_color] & 0xfc00) >> 5) |
142 ((info->cmap.blue[fbcursor->image.bg_color] & 0xf800) >> 11);
144 sm750_hw_cursor_setColor(cursor, fg, bg);
147 if (fbcursor->set & (FB_CUR_SETSHAPE | FB_CUR_SETIMAGE)) {
148 sm750_hw_cursor_setData(cursor,
150 fbcursor->image.data,
154 if (fbcursor->enable)
155 sm750_hw_cursor_enable(cursor);
160 static void lynxfb_ops_fillrect(struct fb_info *info,
161 const struct fb_fillrect *region)
163 struct lynxfb_par *par;
164 struct sm750_dev *sm750_dev;
165 unsigned int base, pitch, Bpp, rop;
168 if (info->state != FBINFO_STATE_RUNNING)
172 sm750_dev = par->dev;
175 * each time 2d function begin to work,below three variable always need
176 * be set, seems we can put them together in some place
178 base = par->crtc.oScreen;
179 pitch = info->fix.line_length;
180 Bpp = info->var.bits_per_pixel >> 3;
182 color = (Bpp == 1) ? region->color :
183 ((u32 *)info->pseudo_palette)[region->color];
184 rop = (region->rop != ROP_COPY) ? HW_ROP2_XOR : HW_ROP2_COPY;
187 * If not use spin_lock, system will die if user load driver
188 * and immediately unload driver frequently (dual)
189 * since they fb_count could change during the lifetime of
190 * this lock, we are holding it for all cases.
192 spin_lock(&sm750_dev->slock);
194 sm750_dev->accel.de_fillrect(&sm750_dev->accel,
196 region->dx, region->dy,
197 region->width, region->height,
199 spin_unlock(&sm750_dev->slock);
202 static void lynxfb_ops_copyarea(struct fb_info *info,
203 const struct fb_copyarea *region)
205 struct lynxfb_par *par;
206 struct sm750_dev *sm750_dev;
207 unsigned int base, pitch, Bpp;
210 sm750_dev = par->dev;
213 * each time 2d function begin to work,below three variable always need
214 * be set, seems we can put them together in some place
216 base = par->crtc.oScreen;
217 pitch = info->fix.line_length;
218 Bpp = info->var.bits_per_pixel >> 3;
221 * If not use spin_lock, system will die if user load driver
222 * and immediately unload driver frequently (dual)
223 * since they fb_count could change during the lifetime of
224 * this lock, we are holding it for all cases.
226 spin_lock(&sm750_dev->slock);
228 sm750_dev->accel.de_copyarea(&sm750_dev->accel,
229 base, pitch, region->sx, region->sy,
230 base, pitch, Bpp, region->dx, region->dy,
231 region->width, region->height,
233 spin_unlock(&sm750_dev->slock);
236 static void lynxfb_ops_imageblit(struct fb_info *info,
237 const struct fb_image *image)
239 unsigned int base, pitch, Bpp;
240 unsigned int fgcol, bgcol;
241 struct lynxfb_par *par;
242 struct sm750_dev *sm750_dev;
245 sm750_dev = par->dev;
247 * each time 2d function begin to work,below three variable always need
248 * be set, seems we can put them together in some place
250 base = par->crtc.oScreen;
251 pitch = info->fix.line_length;
252 Bpp = info->var.bits_per_pixel >> 3;
254 /* TODO: Implement hardware acceleration for image->depth > 1 */
255 if (image->depth != 1) {
256 cfb_imageblit(info, image);
260 if (info->fix.visual == FB_VISUAL_TRUECOLOR ||
261 info->fix.visual == FB_VISUAL_DIRECTCOLOR) {
262 fgcol = ((u32 *)info->pseudo_palette)[image->fg_color];
263 bgcol = ((u32 *)info->pseudo_palette)[image->bg_color];
265 fgcol = image->fg_color;
266 bgcol = image->bg_color;
270 * If not use spin_lock, system will die if user load driver
271 * and immediately unload driver frequently (dual)
272 * since they fb_count could change during the lifetime of
273 * this lock, we are holding it for all cases.
275 spin_lock(&sm750_dev->slock);
277 sm750_dev->accel.de_imageblit(&sm750_dev->accel,
278 image->data, image->width >> 3, 0,
280 image->dx, image->dy,
281 image->width, image->height,
282 fgcol, bgcol, HW_ROP2_COPY);
283 spin_unlock(&sm750_dev->slock);
286 static int lynxfb_ops_pan_display(struct fb_var_screeninfo *var,
287 struct fb_info *info)
289 struct lynxfb_par *par;
290 struct lynxfb_crtc *crtc;
297 return hw_sm750_pan_display(crtc, var, info);
300 static inline void lynxfb_set_visual_mode(struct fb_info *info)
302 switch (info->var.bits_per_pixel) {
304 info->fix.visual = FB_VISUAL_PSEUDOCOLOR;
309 info->fix.visual = FB_VISUAL_TRUECOLOR;
316 static inline int lynxfb_set_color_offsets(struct fb_info *info)
318 lynxfb_set_visual_mode(info);
320 switch (info->var.bits_per_pixel) {
322 info->var.red.offset = 0;
323 info->var.red.length = 8;
324 info->var.green.offset = 0;
325 info->var.green.length = 8;
326 info->var.blue.offset = 0;
327 info->var.blue.length = 8;
328 info->var.transp.length = 0;
329 info->var.transp.offset = 0;
332 info->var.red.offset = 11;
333 info->var.red.length = 5;
334 info->var.green.offset = 5;
335 info->var.green.length = 6;
336 info->var.blue.offset = 0;
337 info->var.blue.length = 5;
338 info->var.transp.length = 0;
339 info->var.transp.offset = 0;
343 info->var.red.offset = 16;
344 info->var.red.length = 8;
345 info->var.green.offset = 8;
346 info->var.green.length = 8;
347 info->var.blue.offset = 0;
348 info->var.blue.length = 8;
356 static int lynxfb_ops_set_par(struct fb_info *info)
358 struct lynxfb_par *par;
359 struct lynxfb_crtc *crtc;
360 struct lynxfb_output *output;
361 struct fb_var_screeninfo *var;
362 struct fb_fix_screeninfo *fix;
364 unsigned int line_length;
372 output = &par->output;
376 /* fix structure is not so FIX ... */
377 line_length = var->xres_virtual * var->bits_per_pixel / 8;
378 line_length = ALIGN(line_length, crtc->line_pad);
379 fix->line_length = line_length;
380 pr_info("fix->line_length = %d\n", fix->line_length);
383 * var->red,green,blue,transp are need to be set by driver
384 * and these data should be set before setcolreg routine
387 ret = lynxfb_set_color_offsets(info);
389 var->height = var->width = -1;
390 var->accel_flags = 0;/*FB_ACCELF_TEXT;*/
393 pr_err("bpp %d not supported\n", var->bits_per_pixel);
396 ret = hw_sm750_crtc_setMode(crtc, var, fix);
398 ret = hw_sm750_output_setMode(output, var, fix);
402 static inline unsigned int chan_to_field(unsigned int chan,
403 struct fb_bitfield *bf)
406 chan >>= 16 - bf->length;
407 return chan << bf->offset;
410 static int __maybe_unused lynxfb_suspend(struct device *dev)
412 struct fb_info *info;
413 struct sm750_dev *sm750_dev;
415 sm750_dev = dev_get_drvdata(dev);
418 info = sm750_dev->fbinfo[0];
420 /* 1 means do suspend */
421 fb_set_suspend(info, 1);
422 info = sm750_dev->fbinfo[1];
424 /* 1 means do suspend */
425 fb_set_suspend(info, 1);
431 static int __maybe_unused lynxfb_resume(struct device *dev)
433 struct pci_dev *pdev = to_pci_dev(dev);
434 struct fb_info *info;
435 struct sm750_dev *sm750_dev;
437 struct lynxfb_par *par;
438 struct lynxfb_crtc *crtc;
439 struct lynx_cursor *cursor;
441 sm750_dev = pci_get_drvdata(pdev);
445 hw_sm750_inithw(sm750_dev, pdev);
447 info = sm750_dev->fbinfo[0];
452 cursor = &crtc->cursor;
453 memset_io(cursor->vstart, 0x0, cursor->size);
454 memset_io(crtc->vScreen, 0x0, crtc->vidmem_size);
455 lynxfb_ops_set_par(info);
456 fb_set_suspend(info, 0);
459 info = sm750_dev->fbinfo[1];
464 cursor = &crtc->cursor;
465 memset_io(cursor->vstart, 0x0, cursor->size);
466 memset_io(crtc->vScreen, 0x0, crtc->vidmem_size);
467 lynxfb_ops_set_par(info);
468 fb_set_suspend(info, 0);
471 pdev->dev.power.power_state.event = PM_EVENT_RESUME;
477 static int lynxfb_ops_check_var(struct fb_var_screeninfo *var,
478 struct fb_info *info)
481 struct lynxfb_par *par;
482 struct lynxfb_crtc *crtc;
483 resource_size_t request;
489 pr_debug("check var:%dx%d-%d\n",
492 var->bits_per_pixel);
494 ret = lynxfb_set_color_offsets(info);
497 pr_err("bpp %d not supported\n", var->bits_per_pixel);
501 var->height = var->width = -1;
502 var->accel_flags = 0;/* FB_ACCELF_TEXT; */
504 /* check if current fb's video memory big enough to hold the onscreen*/
505 request = var->xres_virtual * (var->bits_per_pixel >> 3);
506 /* defaulty crtc->channel go with par->index */
508 request = ALIGN(request, crtc->line_pad);
509 request = request * var->yres_virtual;
510 if (crtc->vidmem_size < request) {
511 pr_err("not enough video memory for mode\n");
515 return hw_sm750_crtc_checkMode(crtc, var);
518 static int lynxfb_ops_setcolreg(unsigned int regno,
523 struct fb_info *info)
525 struct lynxfb_par *par;
526 struct lynxfb_crtc *crtc;
527 struct fb_var_screeninfo *var;
536 pr_err("regno = %d\n", regno);
540 if (info->var.grayscale)
541 red = green = blue = (red * 77 + green * 151 + blue * 28) >> 8;
543 if (var->bits_per_pixel == 8 &&
544 info->fix.visual == FB_VISUAL_PSEUDOCOLOR) {
548 ret = hw_sm750_setColReg(crtc, regno, red, green, blue);
552 if (info->fix.visual == FB_VISUAL_TRUECOLOR && regno < 256) {
555 if (var->bits_per_pixel == 16 ||
556 var->bits_per_pixel == 32 ||
557 var->bits_per_pixel == 24) {
558 val = chan_to_field(red, &var->red);
559 val |= chan_to_field(green, &var->green);
560 val |= chan_to_field(blue, &var->blue);
561 par->pseudo_palette[regno] = val;
572 static int lynxfb_ops_blank(int blank, struct fb_info *info)
574 struct lynxfb_par *par;
575 struct lynxfb_output *output;
577 pr_debug("blank = %d.\n", blank);
579 output = &par->output;
580 return output->proc_setBLANK(output, blank);
583 static int sm750fb_set_drv(struct lynxfb_par *par)
586 struct sm750_dev *sm750_dev;
587 struct lynxfb_output *output;
588 struct lynxfb_crtc *crtc;
592 sm750_dev = par->dev;
593 output = &par->output;
596 crtc->vidmem_size = sm750_dev->vidmem_size;
597 if (sm750_dev->fb_count > 1)
598 crtc->vidmem_size >>= 1;
600 /* setup crtc and output member */
601 sm750_dev->hwCursor = g_hwcursor;
608 output->proc_setBLANK = (sm750_dev->revid == SM750LE_REVISION_ID) ?
609 hw_sm750le_setBLANK : hw_sm750_setBLANK;
610 /* chip specific phase */
611 sm750_dev->accel.de_wait = (sm750_dev->revid == SM750LE_REVISION_ID) ?
612 hw_sm750le_deWait : hw_sm750_deWait;
613 switch (sm750_dev->dataflow) {
614 case sm750_simul_pri:
615 output->paths = sm750_pnc;
616 crtc->channel = sm750_primary;
618 crtc->vScreen = sm750_dev->pvMem;
619 pr_info("use simul primary mode\n");
621 case sm750_simul_sec:
622 output->paths = sm750_pnc;
623 crtc->channel = sm750_secondary;
625 crtc->vScreen = sm750_dev->pvMem;
627 case sm750_dual_normal:
628 if (par->index == 0) {
629 output->paths = sm750_panel;
630 crtc->channel = sm750_primary;
632 crtc->vScreen = sm750_dev->pvMem;
634 output->paths = sm750_crt;
635 crtc->channel = sm750_secondary;
636 /* not consider of padding stuffs for oScreen,need fix */
637 crtc->oScreen = sm750_dev->vidmem_size >> 1;
638 crtc->vScreen = sm750_dev->pvMem + crtc->oScreen;
641 case sm750_dual_swap:
642 if (par->index == 0) {
643 output->paths = sm750_panel;
644 crtc->channel = sm750_secondary;
646 crtc->vScreen = sm750_dev->pvMem;
648 output->paths = sm750_crt;
649 crtc->channel = sm750_primary;
650 /* not consider of padding stuffs for oScreen,
653 crtc->oScreen = sm750_dev->vidmem_size >> 1;
654 crtc->vScreen = sm750_dev->pvMem + crtc->oScreen;
664 static struct fb_ops lynxfb_ops = {
665 .owner = THIS_MODULE,
666 .fb_check_var = lynxfb_ops_check_var,
667 .fb_set_par = lynxfb_ops_set_par,
668 .fb_setcolreg = lynxfb_ops_setcolreg,
669 .fb_blank = lynxfb_ops_blank,
670 .fb_fillrect = cfb_fillrect,
671 .fb_imageblit = cfb_imageblit,
672 .fb_copyarea = cfb_copyarea,
674 .fb_cursor = lynxfb_ops_cursor,
677 static int lynxfb_set_fbinfo(struct fb_info *info, int index)
680 struct lynxfb_par *par;
681 struct sm750_dev *sm750_dev;
682 struct lynxfb_crtc *crtc;
683 struct lynxfb_output *output;
684 struct fb_var_screeninfo *var;
685 struct fb_fix_screeninfo *fix;
687 const struct fb_videomode *pdb[] = {
688 lynx750_ext, NULL, vesa_modes,
690 int cdb[] = {ARRAY_SIZE(lynx750_ext), 0, VESA_MODEDB_SIZE};
691 static const char * const mdb_desc[] = {
692 "driver prepared modes",
693 "kernel prepared default modedb",
694 "kernel HELPERS prepared vesa_modes",
697 static const char *fixId[2] = {
698 "sm750_fb1", "sm750_fb2",
701 int ret, line_length;
704 par = (struct lynxfb_par *)info->par;
705 sm750_dev = par->dev;
707 output = &par->output;
713 output->channel = &crtc->channel;
714 sm750fb_set_drv(par);
715 lynxfb_ops.fb_pan_display = lynxfb_ops_pan_display;
718 * set current cursor variable and proc pointer,
719 * must be set after crtc member initialized
721 crtc->cursor.offset = crtc->oScreen + crtc->vidmem_size - 1024;
722 crtc->cursor.mmio = sm750_dev->pvReg +
723 0x800f0 + (int)crtc->channel * 0x140;
725 pr_info("crtc->cursor.mmio = %p\n", crtc->cursor.mmio);
726 crtc->cursor.maxH = crtc->cursor.maxW = 64;
727 crtc->cursor.size = crtc->cursor.maxH * crtc->cursor.maxW * 2 / 8;
728 crtc->cursor.vstart = sm750_dev->pvMem + crtc->cursor.offset;
730 memset_io(crtc->cursor.vstart, 0, crtc->cursor.size);
732 lynxfb_ops.fb_cursor = NULL;
733 sm750_hw_cursor_disable(&crtc->cursor);
736 /* set info->fbops, must be set before fb_find_mode */
737 if (!sm750_dev->accel_off) {
738 /* use 2d acceleration */
739 lynxfb_ops.fb_fillrect = lynxfb_ops_fillrect;
740 lynxfb_ops.fb_copyarea = lynxfb_ops_copyarea;
741 lynxfb_ops.fb_imageblit = lynxfb_ops_imageblit;
743 info->fbops = &lynxfb_ops;
745 if (!g_fbmode[index]) {
746 g_fbmode[index] = g_def_fbmode;
748 g_fbmode[index] = g_fbmode[0];
751 for (i = 0; i < 3; i++) {
752 ret = fb_find_mode(var, info, g_fbmode[index],
753 pdb[i], cdb[i], NULL, 8);
756 pr_info("success! use specified mode:%s in %s\n",
760 } else if (ret == 2) {
761 pr_warn("use specified mode:%s in %s,with an ignored refresh rate\n",
765 } else if (ret == 3) {
766 pr_warn("wanna use default mode\n");
768 } else if (ret == 4) {
769 pr_warn("fall back to any valid mode\n");
771 pr_warn("ret = %d,fb_find_mode failed,with %s\n",
777 /* some member of info->var had been set by fb_find_mode */
779 pr_info("Member of info->var is :\n"
786 "bits_per_pixel=%d\n"
794 var->bits_per_pixel);
800 line_length = ALIGN((var->xres_virtual * var->bits_per_pixel / 8),
803 info->pseudo_palette = &par->pseudo_palette[0];
804 info->screen_base = crtc->vScreen;
805 pr_debug("screen_base vaddr = %p\n", info->screen_base);
806 info->screen_size = line_length * var->yres_virtual;
807 info->flags = FBINFO_FLAG_DEFAULT | 0;
810 fix->type = FB_TYPE_PACKED_PIXELS;
812 fix->xpanstep = crtc->xpanstep;
813 fix->ypanstep = crtc->ypanstep;
814 fix->ywrapstep = crtc->ywrapstep;
815 fix->accel = FB_ACCEL_SMI;
817 strlcpy(fix->id, fixId[index], sizeof(fix->id));
819 fix->smem_start = crtc->oScreen + sm750_dev->vidmem_start;
820 pr_info("fix->smem_start = %lx\n", fix->smem_start);
822 * according to mmap experiment from user space application,
823 * fix->mmio_len should not larger than virtual size
824 * (xres_virtual x yres_virtual x ByPP)
825 * Below line maybe buggy when user mmap fb dev node and write
826 * data into the bound over virtual size
828 fix->smem_len = crtc->vidmem_size;
829 pr_info("fix->smem_len = %x\n", fix->smem_len);
830 info->screen_size = fix->smem_len;
831 fix->line_length = line_length;
832 fix->mmio_start = sm750_dev->vidreg_start;
833 pr_info("fix->mmio_start = %lx\n", fix->mmio_start);
834 fix->mmio_len = sm750_dev->vidreg_size;
835 pr_info("fix->mmio_len = %x\n", fix->mmio_len);
837 lynxfb_set_visual_mode(info);
840 var->activate = FB_ACTIVATE_NOW;
841 var->accel_flags = 0;
842 var->vmode = FB_VMODE_NONINTERLACED;
844 pr_debug("#1 show info->cmap :\nstart=%d,len=%d,red=%p,green=%p,blue=%p,transp=%p\n",
845 info->cmap.start, info->cmap.len,
846 info->cmap.red, info->cmap.green, info->cmap.blue,
849 ret = fb_alloc_cmap(&info->cmap, 256, 0);
851 pr_err("Could not allocate memory for cmap.\n");
855 pr_debug("#2 show info->cmap :\nstart=%d,len=%d,red=%p,green=%p,blue=%p,transp=%p\n",
856 info->cmap.start, info->cmap.len,
857 info->cmap.red, info->cmap.green, info->cmap.blue,
861 lynxfb_ops_check_var(var, info);
865 /* chip specific g_option configuration routine */
866 static void sm750fb_setup(struct sm750_dev *sm750_dev, char *src)
873 sm750_dev->initParm.chip_clk = 0;
874 sm750_dev->initParm.mem_clk = 0;
875 sm750_dev->initParm.master_clk = 0;
876 sm750_dev->initParm.powerMode = 0;
877 sm750_dev->initParm.setAllEngOff = 0;
878 sm750_dev->initParm.resetMemory = 1;
880 /* defaultly turn g_hwcursor on for both view */
884 dev_warn(&sm750_dev->pdev->dev, "no specific g_option.\n");
888 while ((opt = strsep(&src, ":")) != NULL && *opt != 0) {
889 dev_info(&sm750_dev->pdev->dev, "opt=%s\n", opt);
890 dev_info(&sm750_dev->pdev->dev, "src=%s\n", src);
892 if (!strncmp(opt, "swap", strlen("swap"))) {
894 } else if (!strncmp(opt, "nocrt", strlen("nocrt"))) {
895 sm750_dev->nocrt = 1;
896 } else if (!strncmp(opt, "36bit", strlen("36bit"))) {
897 sm750_dev->pnltype = sm750_doubleTFT;
898 } else if (!strncmp(opt, "18bit", strlen("18bit"))) {
899 sm750_dev->pnltype = sm750_dualTFT;
900 } else if (!strncmp(opt, "24bit", strlen("24bit"))) {
901 sm750_dev->pnltype = sm750_24TFT;
902 } else if (!strncmp(opt, "nohwc0", strlen("nohwc0"))) {
904 } else if (!strncmp(opt, "nohwc1", strlen("nohwc1"))) {
906 } else if (!strncmp(opt, "nohwc", strlen("nohwc"))) {
911 dev_info(&sm750_dev->pdev->dev,
912 "find fbmode0 : %s\n", g_fbmode[0]);
913 } else if (!g_fbmode[1]) {
915 dev_info(&sm750_dev->pdev->dev,
916 "find fbmode1 : %s\n", g_fbmode[1]);
918 dev_warn(&sm750_dev->pdev->dev, "How many view you wann set?\n");
924 if (sm750_dev->revid != SM750LE_REVISION_ID) {
925 if (sm750_dev->fb_count > 1) {
927 sm750_dev->dataflow = sm750_dual_swap;
929 sm750_dev->dataflow = sm750_dual_normal;
932 sm750_dev->dataflow = sm750_simul_sec;
934 sm750_dev->dataflow = sm750_simul_pri;
937 /* SM750LE only have one crt channel */
938 sm750_dev->dataflow = sm750_simul_sec;
939 /* sm750le do not have complex attributes */
940 sm750_dev->nocrt = 0;
944 static void sm750fb_framebuffer_release(struct sm750_dev *sm750_dev)
946 struct fb_info *fb_info;
948 while (sm750_dev->fb_count) {
949 fb_info = sm750_dev->fbinfo[sm750_dev->fb_count - 1];
950 unregister_framebuffer(fb_info);
951 framebuffer_release(fb_info);
952 sm750_dev->fb_count--;
956 static int sm750fb_framebuffer_alloc(struct sm750_dev *sm750_dev, int fbidx)
958 struct fb_info *fb_info;
959 struct lynxfb_par *par;
962 fb_info = framebuffer_alloc(sizeof(struct lynxfb_par),
963 &sm750_dev->pdev->dev);
967 sm750_dev->fbinfo[fbidx] = fb_info;
969 par->dev = sm750_dev;
971 err = lynxfb_set_fbinfo(fb_info, fbidx);
975 err = register_framebuffer(fb_info);
979 sm750_dev->fb_count++;
984 framebuffer_release(fb_info);
988 static int lynxfb_kick_out_firmware_fb(struct pci_dev *pdev)
990 struct apertures_struct *ap;
991 bool primary = false;
993 ap = alloc_apertures(1);
997 ap->ranges[0].base = pci_resource_start(pdev, 0);
998 ap->ranges[0].size = pci_resource_len(pdev, 0);
1000 primary = pdev->resource[PCI_ROM_RESOURCE].flags &
1001 IORESOURCE_ROM_SHADOW;
1003 remove_conflicting_framebuffers(ap, "sm750_fb1", primary);
1008 static int lynxfb_pci_probe(struct pci_dev *pdev,
1009 const struct pci_device_id *ent)
1011 struct sm750_dev *sm750_dev = NULL;
1016 err = lynxfb_kick_out_firmware_fb(pdev);
1021 err = pcim_enable_device(pdev);
1026 sm750_dev = devm_kzalloc(&pdev->dev, sizeof(*sm750_dev), GFP_KERNEL);
1030 sm750_dev->fbinfo[0] = sm750_dev->fbinfo[1] = NULL;
1031 sm750_dev->devid = pdev->device;
1032 sm750_dev->revid = pdev->revision;
1033 sm750_dev->pdev = pdev;
1034 sm750_dev->mtrr_off = g_nomtrr;
1035 sm750_dev->mtrr.vram = 0;
1036 sm750_dev->accel_off = g_noaccel;
1037 spin_lock_init(&sm750_dev->slock);
1039 if (!sm750_dev->accel_off) {
1041 * hook deInit and 2d routines, notes that below hw_xxx
1042 * routine can work on most of lynx chips
1043 * if some chip need specific function,
1044 * please hook it in smXXX_set_drv routine
1046 sm750_dev->accel.de_init = sm750_hw_de_init;
1047 sm750_dev->accel.de_fillrect = sm750_hw_fillrect;
1048 sm750_dev->accel.de_copyarea = sm750_hw_copyarea;
1049 sm750_dev->accel.de_imageblit = sm750_hw_imageblit;
1052 /* call chip specific setup routine */
1053 sm750fb_setup(sm750_dev, g_settings);
1055 /* call chip specific mmap routine */
1056 err = hw_sm750_map(sm750_dev, pdev);
1060 if (!sm750_dev->mtrr_off)
1061 sm750_dev->mtrr.vram = arch_phys_wc_add(sm750_dev->vidmem_start,
1062 sm750_dev->vidmem_size);
1064 memset_io(sm750_dev->pvMem, 0, sm750_dev->vidmem_size);
1066 pci_set_drvdata(pdev, sm750_dev);
1068 /* call chipInit routine */
1069 hw_sm750_inithw(sm750_dev, pdev);
1071 /* allocate frame buffer info structures according to g_dualview */
1072 max_fb = g_dualview ? 2 : 1;
1073 for (fbidx = 0; fbidx < max_fb; fbidx++) {
1074 err = sm750fb_framebuffer_alloc(sm750_dev, fbidx);
1082 sm750fb_framebuffer_release(sm750_dev);
1086 static void lynxfb_pci_remove(struct pci_dev *pdev)
1088 struct sm750_dev *sm750_dev;
1090 sm750_dev = pci_get_drvdata(pdev);
1092 sm750fb_framebuffer_release(sm750_dev);
1093 arch_phys_wc_del(sm750_dev->mtrr.vram);
1095 iounmap(sm750_dev->pvReg);
1096 iounmap(sm750_dev->pvMem);
1100 static int __init lynxfb_setup(char *options)
1105 if (!options || !*options) {
1106 pr_warn("no options.\n");
1110 pr_info("options:%s\n", options);
1112 len = strlen(options) + 1;
1113 g_settings = kzalloc(len, GFP_KERNEL);
1121 * char * strsep(char **s,const char * ct);
1122 * @s: the string to be searched
1123 * @ct :the characters to search for
1125 * strsep() updates @options to pointer after the first found token
1126 * it also returns the pointer ahead the token.
1128 while ((opt = strsep(&options, ":")) != NULL) {
1129 /* options that mean for any lynx chips are configured here */
1130 if (!strncmp(opt, "noaccel", strlen("noaccel"))) {
1132 } else if (!strncmp(opt, "nomtrr", strlen("nomtrr"))) {
1134 } else if (!strncmp(opt, "dual", strlen("dual"))) {
1146 /* misc g_settings are transport to chip specific routines */
1147 pr_info("parameter left for chip specific analysis:%s\n", g_settings);
1151 static const struct pci_device_id smi_pci_table[] = {
1152 { PCI_DEVICE(0x126f, 0x0750), },
1156 MODULE_DEVICE_TABLE(pci, smi_pci_table);
1158 static SIMPLE_DEV_PM_OPS(lynxfb_pm_ops, lynxfb_suspend, lynxfb_resume);
1160 static struct pci_driver lynxfb_driver = {
1162 .id_table = smi_pci_table,
1163 .probe = lynxfb_pci_probe,
1164 .remove = lynxfb_pci_remove,
1165 .driver.pm = &lynxfb_pm_ops,
1168 static int __init lynxfb_init(void)
1175 if (fb_get_options("sm750fb", &option))
1179 lynxfb_setup(option);
1180 return pci_register_driver(&lynxfb_driver);
1182 module_init(lynxfb_init);
1184 static void __exit lynxfb_exit(void)
1186 pci_unregister_driver(&lynxfb_driver);
1188 module_exit(lynxfb_exit);
1190 module_param(g_option, charp, 0444);
1192 MODULE_PARM_DESC(g_option,
1193 "\n\t\tCommon options:\n"
1194 "\t\tnoaccel:disable 2d capabilities\n"
1195 "\t\tnomtrr:disable MTRR attribute for video memory\n"
1196 "\t\tdualview:dual frame buffer feature enabled\n"
1197 "\t\tnohwc:disable hardware cursor\n"
1198 "\t\tUsual example:\n"
1199 "\t\tinsmod ./sm750fb.ko g_option=\"noaccel,nohwc,1280x1024-8@60\"\n"
1202 MODULE_AUTHOR("monk liu <monk.liu@siliconmotion.com>");
1203 MODULE_AUTHOR("Sudip Mukherjee <sudip@vectorindia.org>");
1204 MODULE_DESCRIPTION("Frame buffer driver for SM750 chipset");
1205 MODULE_LICENSE("Dual BSD/GPL");