1 /*
2 * linux/drivers/video/nvidia/nvidia.c - nVidia fb driver
3 *
4 * Copyright 2004 Antonino Daplas <adaplas@pol.net>
5 *
6 * This file is subject to the terms and conditions of the GNU General Public
7 * License. See the file COPYING in the main directory of this archive
8 * for more details.
9 *
10 */
11
12 #include <linux/module.h>
13 #include <linux/kernel.h>
14 #include <linux/errno.h>
15 #include <linux/string.h>
16 #include <linux/mm.h>
17 #include <linux/slab.h>
18 #include <linux/delay.h>
19 #include <linux/fb.h>
20 #include <linux/init.h>
21 #include <linux/pci.h>
22 #include <linux/console.h>
23 #include <linux/backlight.h>
24 #ifdef CONFIG_MTRR
25 #include <asm/mtrr.h>
26 #endif
27 #ifdef CONFIG_BOOTX_TEXT
28 #include <asm/btext.h>
29 #endif
30
31 #include "nv_local.h"
32 #include "nv_type.h"
33 #include "nv_proto.h"
34 #include "nv_dma.h"
35
36 #ifdef CONFIG_FB_NVIDIA_DEBUG
37 #define NVTRACE printk
38 #else
39 #define NVTRACE if (0) printk
40 #endif
41
42 #define NVTRACE_ENTER(...) NVTRACE("%s START\n", __func__)
43 #define NVTRACE_LEAVE(...) NVTRACE("%s END\n", __func__)
44
45 #ifdef CONFIG_FB_NVIDIA_DEBUG
46 #define assert(expr) \
47 if (!(expr)) { \
48 printk( "Assertion failed! %s,%s,%s,line=%d\n",\
49 #expr,__FILE__,__func__,__LINE__); \
50 BUG(); \
51 }
52 #else
53 #define assert(expr)
54 #endif
55
56 #define PFX "nvidiafb: "
57
58 /* HW cursor parameters */
59 #define MAX_CURS 32
60
61 static struct pci_device_id nvidiafb_pci_tbl[] = {
62 {PCI_VENDOR_ID_NVIDIA, PCI_ANY_ID, PCI_ANY_ID, PCI_ANY_ID,
63 PCI_BASE_CLASS_DISPLAY << 16, 0xff0000, 0},
64 { 0, }
65 };
66 MODULE_DEVICE_TABLE(pci, nvidiafb_pci_tbl);
67
68 /* command line data, set in nvidiafb_setup() */
69 static int flatpanel = -1; /* Autodetect later */
70 static int fpdither = -1;
71 static int forceCRTC = -1;
72 static int hwcur = 0;
73 static int noaccel = 0;
74 static int noscale = 0;
75 static int paneltweak = 0;
76 static int vram = 0;
77 static int bpp = 8;
78 static int reverse_i2c;
79 #ifdef CONFIG_MTRR
80 static bool nomtrr = false;
81 #endif
82 #ifdef CONFIG_PMAC_BACKLIGHT
83 static int backlight = 1;
84 #else
85 static int backlight = 0;
86 #endif
87
88 static char *mode_option = NULL;
89
90 static struct fb_fix_screeninfo nvidiafb_fix = {
91 .type = FB_TYPE_PACKED_PIXELS,
92 .xpanstep = 8,
93 .ypanstep = 1,
94 };
95
96 static struct fb_var_screeninfo nvidiafb_default_var = {
97 .xres = 640,
98 .yres = 480,
99 .xres_virtual = 640,
100 .yres_virtual = 480,
101 .bits_per_pixel = 8,
102 .red = {0, 8, 0},
103 .green = {0, 8, 0},
104 .blue = {0, 8, 0},
105 .transp = {0, 0, 0},
106 .activate = FB_ACTIVATE_NOW,
107 .height = -1,
108 .width = -1,
109 .pixclock = 39721,
110 .left_margin = 40,
111 .right_margin = 24,
112 .upper_margin = 32,
113 .lower_margin = 11,
114 .hsync_len = 96,
115 .vsync_len = 2,
116 .vmode = FB_VMODE_NONINTERLACED
117 };
118
nvidiafb_load_cursor_image(struct nvidia_par * par,u8 * data8,u16 bg,u16 fg,u32 w,u32 h)119 static void nvidiafb_load_cursor_image(struct nvidia_par *par, u8 * data8,
120 u16 bg, u16 fg, u32 w, u32 h)
121 {
122 u32 *data = (u32 *) data8;
123 int i, j, k = 0;
124 u32 b, tmp;
125
126 w = (w + 1) & ~1;
127
128 for (i = 0; i < h; i++) {
129 b = *data++;
130 reverse_order(&b);
131
132 for (j = 0; j < w / 2; j++) {
133 tmp = 0;
134 #if defined (__BIG_ENDIAN)
135 tmp = (b & (1 << 31)) ? fg << 16 : bg << 16;
136 b <<= 1;
137 tmp |= (b & (1 << 31)) ? fg : bg;
138 b <<= 1;
139 #else
140 tmp = (b & 1) ? fg : bg;
141 b >>= 1;
142 tmp |= (b & 1) ? fg << 16 : bg << 16;
143 b >>= 1;
144 #endif
145 NV_WR32(&par->CURSOR[k++], 0, tmp);
146 }
147 k += (MAX_CURS - w) / 2;
148 }
149 }
150
nvidia_write_clut(struct nvidia_par * par,u8 regnum,u8 red,u8 green,u8 blue)151 static void nvidia_write_clut(struct nvidia_par *par,
152 u8 regnum, u8 red, u8 green, u8 blue)
153 {
154 NVWriteDacMask(par, 0xff);
155 NVWriteDacWriteAddr(par, regnum);
156 NVWriteDacData(par, red);
157 NVWriteDacData(par, green);
158 NVWriteDacData(par, blue);
159 }
160
nvidia_read_clut(struct nvidia_par * par,u8 regnum,u8 * red,u8 * green,u8 * blue)161 static void nvidia_read_clut(struct nvidia_par *par,
162 u8 regnum, u8 * red, u8 * green, u8 * blue)
163 {
164 NVWriteDacMask(par, 0xff);
165 NVWriteDacReadAddr(par, regnum);
166 *red = NVReadDacData(par);
167 *green = NVReadDacData(par);
168 *blue = NVReadDacData(par);
169 }
170
nvidia_panel_tweak(struct nvidia_par * par,struct _riva_hw_state * state)171 static int nvidia_panel_tweak(struct nvidia_par *par,
172 struct _riva_hw_state *state)
173 {
174 int tweak = 0;
175
176 if (par->paneltweak) {
177 tweak = par->paneltweak;
178 } else {
179 /* begin flat panel hacks */
180 /* This is unfortunate, but some chips need this register
181 tweaked or else you get artifacts where adjacent pixels are
182 swapped. There are no hard rules for what to set here so all
183 we can do is experiment and apply hacks. */
184
185 if(((par->Chipset & 0xffff) == 0x0328) && (state->bpp == 32)) {
186 /* At least one NV34 laptop needs this workaround. */
187 tweak = -1;
188 }
189
190 if((par->Chipset & 0xfff0) == 0x0310) {
191 tweak = 1;
192 }
193 /* end flat panel hacks */
194 }
195
196 return tweak;
197 }
198
nvidia_screen_off(struct nvidia_par * par,int on)199 static void nvidia_screen_off(struct nvidia_par *par, int on)
200 {
201 unsigned char tmp;
202
203 if (on) {
204 /*
205 * Turn off screen and disable sequencer.
206 */
207 tmp = NVReadSeq(par, 0x01);
208
209 NVWriteSeq(par, 0x00, 0x01); /* Synchronous Reset */
210 NVWriteSeq(par, 0x01, tmp | 0x20); /* disable the display */
211 } else {
212 /*
213 * Reenable sequencer, then turn on screen.
214 */
215
216 tmp = NVReadSeq(par, 0x01);
217
218 NVWriteSeq(par, 0x01, tmp & ~0x20); /* reenable display */
219 NVWriteSeq(par, 0x00, 0x03); /* End Reset */
220 }
221 }
222
nvidia_save_vga(struct nvidia_par * par,struct _riva_hw_state * state)223 static void nvidia_save_vga(struct nvidia_par *par,
224 struct _riva_hw_state *state)
225 {
226 int i;
227
228 NVTRACE_ENTER();
229 NVLockUnlock(par, 0);
230
231 NVUnloadStateExt(par, state);
232
233 state->misc_output = NVReadMiscOut(par);
234
235 for (i = 0; i < NUM_CRT_REGS; i++)
236 state->crtc[i] = NVReadCrtc(par, i);
237
238 for (i = 0; i < NUM_ATC_REGS; i++)
239 state->attr[i] = NVReadAttr(par, i);
240
241 for (i = 0; i < NUM_GRC_REGS; i++)
242 state->gra[i] = NVReadGr(par, i);
243
244 for (i = 0; i < NUM_SEQ_REGS; i++)
245 state->seq[i] = NVReadSeq(par, i);
246 NVTRACE_LEAVE();
247 }
248
249 #undef DUMP_REG
250
nvidia_write_regs(struct nvidia_par * par,struct _riva_hw_state * state)251 static void nvidia_write_regs(struct nvidia_par *par,
252 struct _riva_hw_state *state)
253 {
254 int i;
255
256 NVTRACE_ENTER();
257
258 NVLoadStateExt(par, state);
259
260 NVWriteMiscOut(par, state->misc_output);
261
262 for (i = 1; i < NUM_SEQ_REGS; i++) {
263 #ifdef DUMP_REG
264 printk(" SEQ[%02x] = %08x\n", i, state->seq[i]);
265 #endif
266 NVWriteSeq(par, i, state->seq[i]);
267 }
268
269 /* Ensure CRTC registers 0-7 are unlocked by clearing bit 7 of CRTC[17] */
270 NVWriteCrtc(par, 0x11, state->crtc[0x11] & ~0x80);
271
272 for (i = 0; i < NUM_CRT_REGS; i++) {
273 switch (i) {
274 case 0x19:
275 case 0x20 ... 0x40:
276 break;
277 default:
278 #ifdef DUMP_REG
279 printk("CRTC[%02x] = %08x\n", i, state->crtc[i]);
280 #endif
281 NVWriteCrtc(par, i, state->crtc[i]);
282 }
283 }
284
285 for (i = 0; i < NUM_GRC_REGS; i++) {
286 #ifdef DUMP_REG
287 printk(" GRA[%02x] = %08x\n", i, state->gra[i]);
288 #endif
289 NVWriteGr(par, i, state->gra[i]);
290 }
291
292 for (i = 0; i < NUM_ATC_REGS; i++) {
293 #ifdef DUMP_REG
294 printk("ATTR[%02x] = %08x\n", i, state->attr[i]);
295 #endif
296 NVWriteAttr(par, i, state->attr[i]);
297 }
298
299 NVTRACE_LEAVE();
300 }
301
nvidia_calc_regs(struct fb_info * info)302 static int nvidia_calc_regs(struct fb_info *info)
303 {
304 struct nvidia_par *par = info->par;
305 struct _riva_hw_state *state = &par->ModeReg;
306 int i, depth = fb_get_color_depth(&info->var, &info->fix);
307 int h_display = info->var.xres / 8 - 1;
308 int h_start = (info->var.xres + info->var.right_margin) / 8 - 1;
309 int h_end = (info->var.xres + info->var.right_margin +
310 info->var.hsync_len) / 8 - 1;
311 int h_total = (info->var.xres + info->var.right_margin +
312 info->var.hsync_len + info->var.left_margin) / 8 - 5;
313 int h_blank_s = h_display;
314 int h_blank_e = h_total + 4;
315 int v_display = info->var.yres - 1;
316 int v_start = info->var.yres + info->var.lower_margin - 1;
317 int v_end = (info->var.yres + info->var.lower_margin +
318 info->var.vsync_len) - 1;
319 int v_total = (info->var.yres + info->var.lower_margin +
320 info->var.vsync_len + info->var.upper_margin) - 2;
321 int v_blank_s = v_display;
322 int v_blank_e = v_total + 1;
323
324 /*
325 * Set all CRTC values.
326 */
327
328 if (info->var.vmode & FB_VMODE_INTERLACED)
329 v_total |= 1;
330
331 if (par->FlatPanel == 1) {
332 v_start = v_total - 3;
333 v_end = v_total - 2;
334 v_blank_s = v_start;
335 h_start = h_total - 5;
336 h_end = h_total - 2;
337 h_blank_e = h_total + 4;
338 }
339
340 state->crtc[0x0] = Set8Bits(h_total);
341 state->crtc[0x1] = Set8Bits(h_display);
342 state->crtc[0x2] = Set8Bits(h_blank_s);
343 state->crtc[0x3] = SetBitField(h_blank_e, 4: 0, 4:0)
344 | SetBit(7);
345 state->crtc[0x4] = Set8Bits(h_start);
346 state->crtc[0x5] = SetBitField(h_blank_e, 5: 5, 7:7)
347 | SetBitField(h_end, 4: 0, 4:0);
348 state->crtc[0x6] = SetBitField(v_total, 7: 0, 7:0);
349 state->crtc[0x7] = SetBitField(v_total, 8: 8, 0:0)
350 | SetBitField(v_display, 8: 8, 1:1)
351 | SetBitField(v_start, 8: 8, 2:2)
352 | SetBitField(v_blank_s, 8: 8, 3:3)
353 | SetBit(4)
354 | SetBitField(v_total, 9: 9, 5:5)
355 | SetBitField(v_display, 9: 9, 6:6)
356 | SetBitField(v_start, 9: 9, 7:7);
357 state->crtc[0x9] = SetBitField(v_blank_s, 9: 9, 5:5)
358 | SetBit(6)
359 | ((info->var.vmode & FB_VMODE_DOUBLE) ? 0x80 : 0x00);
360 state->crtc[0x10] = Set8Bits(v_start);
361 state->crtc[0x11] = SetBitField(v_end, 3: 0, 3:0) | SetBit(5);
362 state->crtc[0x12] = Set8Bits(v_display);
363 state->crtc[0x13] = ((info->var.xres_virtual / 8) *
364 (info->var.bits_per_pixel / 8));
365 state->crtc[0x15] = Set8Bits(v_blank_s);
366 state->crtc[0x16] = Set8Bits(v_blank_e);
367
368 state->attr[0x10] = 0x01;
369
370 if (par->Television)
371 state->attr[0x11] = 0x00;
372
373 state->screen = SetBitField(h_blank_e, 6: 6, 4:4)
374 | SetBitField(v_blank_s, 10: 10, 3:3)
375 | SetBitField(v_start, 10: 10, 2:2)
376 | SetBitField(v_display, 10: 10, 1:1)
377 | SetBitField(v_total, 10: 10, 0:0);
378
379 state->horiz = SetBitField(h_total, 8: 8, 0:0)
380 | SetBitField(h_display, 8: 8, 1:1)
381 | SetBitField(h_blank_s, 8: 8, 2:2)
382 | SetBitField(h_start, 8: 8, 3:3);
383
384 state->extra = SetBitField(v_total, 11: 11, 0:0)
385 | SetBitField(v_display, 11: 11, 2:2)
386 | SetBitField(v_start, 11: 11, 4:4)
387 | SetBitField(v_blank_s, 11: 11, 6:6);
388
389 if (info->var.vmode & FB_VMODE_INTERLACED) {
390 h_total = (h_total >> 1) & ~1;
391 state->interlace = Set8Bits(h_total);
392 state->horiz |= SetBitField(h_total, 8: 8, 4:4);
393 } else {
394 state->interlace = 0xff; /* interlace off */
395 }
396
397 /*
398 * Calculate the extended registers.
399 */
400
401 if (depth < 24)
402 i = depth;
403 else
404 i = 32;
405
406 if (par->Architecture >= NV_ARCH_10)
407 par->CURSOR = (volatile u32 __iomem *)(info->screen_base +
408 par->CursorStart);
409
410 if (info->var.sync & FB_SYNC_HOR_HIGH_ACT)
411 state->misc_output &= ~0x40;
412 else
413 state->misc_output |= 0x40;
414 if (info->var.sync & FB_SYNC_VERT_HIGH_ACT)
415 state->misc_output &= ~0x80;
416 else
417 state->misc_output |= 0x80;
418
419 NVCalcStateExt(par, state, i, info->var.xres_virtual,
420 info->var.xres, info->var.yres_virtual,
421 1000000000 / info->var.pixclock, info->var.vmode);
422
423 state->scale = NV_RD32(par->PRAMDAC, 0x00000848) & 0xfff000ff;
424 if (par->FlatPanel == 1) {
425 state->pixel |= (1 << 7);
426
427 if (!par->fpScaler || (par->fpWidth <= info->var.xres)
428 || (par->fpHeight <= info->var.yres)) {
429 state->scale |= (1 << 8);
430 }
431
432 if (!par->crtcSync_read) {
433 state->crtcSync = NV_RD32(par->PRAMDAC, 0x0828);
434 par->crtcSync_read = 1;
435 }
436
437 par->PanelTweak = nvidia_panel_tweak(par, state);
438 }
439
440 state->vpll = state->pll;
441 state->vpll2 = state->pll;
442 state->vpllB = state->pllB;
443 state->vpll2B = state->pllB;
444
445 VGA_WR08(par->PCIO, 0x03D4, 0x1C);
446 state->fifo = VGA_RD08(par->PCIO, 0x03D5) & ~(1<<5);
447
448 if (par->CRTCnumber) {
449 state->head = NV_RD32(par->PCRTC0, 0x00000860) & ~0x00001000;
450 state->head2 = NV_RD32(par->PCRTC0, 0x00002860) | 0x00001000;
451 state->crtcOwner = 3;
452 state->pllsel |= 0x20000800;
453 state->vpll = NV_RD32(par->PRAMDAC0, 0x00000508);
454 if (par->twoStagePLL)
455 state->vpllB = NV_RD32(par->PRAMDAC0, 0x00000578);
456 } else if (par->twoHeads) {
457 state->head = NV_RD32(par->PCRTC0, 0x00000860) | 0x00001000;
458 state->head2 = NV_RD32(par->PCRTC0, 0x00002860) & ~0x00001000;
459 state->crtcOwner = 0;
460 state->vpll2 = NV_RD32(par->PRAMDAC0, 0x0520);
461 if (par->twoStagePLL)
462 state->vpll2B = NV_RD32(par->PRAMDAC0, 0x057C);
463 }
464
465 state->cursorConfig = 0x00000100;
466
467 if (info->var.vmode & FB_VMODE_DOUBLE)
468 state->cursorConfig |= (1 << 4);
469
470 if (par->alphaCursor) {
471 if ((par->Chipset & 0x0ff0) != 0x0110)
472 state->cursorConfig |= 0x04011000;
473 else
474 state->cursorConfig |= 0x14011000;
475 state->general |= (1 << 29);
476 } else
477 state->cursorConfig |= 0x02000000;
478
479 if (par->twoHeads) {
480 if ((par->Chipset & 0x0ff0) == 0x0110) {
481 state->dither = NV_RD32(par->PRAMDAC, 0x0528) &
482 ~0x00010000;
483 if (par->FPDither)
484 state->dither |= 0x00010000;
485 } else {
486 state->dither = NV_RD32(par->PRAMDAC, 0x083C) & ~1;
487 if (par->FPDither)
488 state->dither |= 1;
489 }
490 }
491
492 state->timingH = 0;
493 state->timingV = 0;
494 state->displayV = info->var.xres;
495
496 return 0;
497 }
498
nvidia_init_vga(struct fb_info * info)499 static void nvidia_init_vga(struct fb_info *info)
500 {
501 struct nvidia_par *par = info->par;
502 struct _riva_hw_state *state = &par->ModeReg;
503 int i;
504
505 for (i = 0; i < 0x10; i++)
506 state->attr[i] = i;
507 state->attr[0x10] = 0x41;
508 state->attr[0x11] = 0xff;
509 state->attr[0x12] = 0x0f;
510 state->attr[0x13] = 0x00;
511 state->attr[0x14] = 0x00;
512
513 memset(state->crtc, 0x00, NUM_CRT_REGS);
514 state->crtc[0x0a] = 0x20;
515 state->crtc[0x17] = 0xe3;
516 state->crtc[0x18] = 0xff;
517 state->crtc[0x28] = 0x40;
518
519 memset(state->gra, 0x00, NUM_GRC_REGS);
520 state->gra[0x05] = 0x40;
521 state->gra[0x06] = 0x05;
522 state->gra[0x07] = 0x0f;
523 state->gra[0x08] = 0xff;
524
525 state->seq[0x00] = 0x03;
526 state->seq[0x01] = 0x01;
527 state->seq[0x02] = 0x0f;
528 state->seq[0x03] = 0x00;
529 state->seq[0x04] = 0x0e;
530
531 state->misc_output = 0xeb;
532 }
533
nvidiafb_cursor(struct fb_info * info,struct fb_cursor * cursor)534 static int nvidiafb_cursor(struct fb_info *info, struct fb_cursor *cursor)
535 {
536 struct nvidia_par *par = info->par;
537 u8 data[MAX_CURS * MAX_CURS / 8];
538 int i, set = cursor->set;
539 u16 fg, bg;
540
541 if (cursor->image.width > MAX_CURS || cursor->image.height > MAX_CURS)
542 return -ENXIO;
543
544 NVShowHideCursor(par, 0);
545
546 if (par->cursor_reset) {
547 set = FB_CUR_SETALL;
548 par->cursor_reset = 0;
549 }
550
551 if (set & FB_CUR_SETSIZE)
552 memset_io(par->CURSOR, 0, MAX_CURS * MAX_CURS * 2);
553
554 if (set & FB_CUR_SETPOS) {
555 u32 xx, yy, temp;
556
557 yy = cursor->image.dy - info->var.yoffset;
558 xx = cursor->image.dx - info->var.xoffset;
559 temp = xx & 0xFFFF;
560 temp |= yy << 16;
561
562 NV_WR32(par->PRAMDAC, 0x0000300, temp);
563 }
564
565 if (set & (FB_CUR_SETSHAPE | FB_CUR_SETCMAP | FB_CUR_SETIMAGE)) {
566 u32 bg_idx = cursor->image.bg_color;
567 u32 fg_idx = cursor->image.fg_color;
568 u32 s_pitch = (cursor->image.width + 7) >> 3;
569 u32 d_pitch = MAX_CURS / 8;
570 u8 *dat = (u8 *) cursor->image.data;
571 u8 *msk = (u8 *) cursor->mask;
572 u8 *src;
573
574 src = kmalloc(s_pitch * cursor->image.height, GFP_ATOMIC);
575
576 if (src) {
577 switch (cursor->rop) {
578 case ROP_XOR:
579 for (i = 0; i < s_pitch * cursor->image.height; i++)
580 src[i] = dat[i] ^ msk[i];
581 break;
582 case ROP_COPY:
583 default:
584 for (i = 0; i < s_pitch * cursor->image.height; i++)
585 src[i] = dat[i] & msk[i];
586 break;
587 }
588
589 fb_pad_aligned_buffer(data, d_pitch, src, s_pitch,
590 cursor->image.height);
591
592 bg = ((info->cmap.red[bg_idx] & 0xf8) << 7) |
593 ((info->cmap.green[bg_idx] & 0xf8) << 2) |
594 ((info->cmap.blue[bg_idx] & 0xf8) >> 3) | 1 << 15;
595
596 fg = ((info->cmap.red[fg_idx] & 0xf8) << 7) |
597 ((info->cmap.green[fg_idx] & 0xf8) << 2) |
598 ((info->cmap.blue[fg_idx] & 0xf8) >> 3) | 1 << 15;
599
600 NVLockUnlock(par, 0);
601
602 nvidiafb_load_cursor_image(par, data, bg, fg,
603 cursor->image.width,
604 cursor->image.height);
605 kfree(src);
606 }
607 }
608
609 if (cursor->enable)
610 NVShowHideCursor(par, 1);
611
612 return 0;
613 }
614
nvidiafb_set_par(struct fb_info * info)615 static int nvidiafb_set_par(struct fb_info *info)
616 {
617 struct nvidia_par *par = info->par;
618
619 NVTRACE_ENTER();
620
621 NVLockUnlock(par, 1);
622 if (!par->FlatPanel || !par->twoHeads)
623 par->FPDither = 0;
624
625 if (par->FPDither < 0) {
626 if ((par->Chipset & 0x0ff0) == 0x0110)
627 par->FPDither = !!(NV_RD32(par->PRAMDAC, 0x0528)
628 & 0x00010000);
629 else
630 par->FPDither = !!(NV_RD32(par->PRAMDAC, 0x083C) & 1);
631 printk(KERN_INFO PFX "Flat panel dithering %s\n",
632 par->FPDither ? "enabled" : "disabled");
633 }
634
635 info->fix.visual = (info->var.bits_per_pixel == 8) ?
636 FB_VISUAL_PSEUDOCOLOR : FB_VISUAL_DIRECTCOLOR;
637
638 nvidia_init_vga(info);
639 nvidia_calc_regs(info);
640
641 NVLockUnlock(par, 0);
642 if (par->twoHeads) {
643 VGA_WR08(par->PCIO, 0x03D4, 0x44);
644 VGA_WR08(par->PCIO, 0x03D5, par->ModeReg.crtcOwner);
645 NVLockUnlock(par, 0);
646 }
647
648 nvidia_screen_off(par, 1);
649
650 nvidia_write_regs(par, &par->ModeReg);
651 NVSetStartAddress(par, 0);
652
653 #if defined (__BIG_ENDIAN)
654 /* turn on LFB swapping */
655 {
656 unsigned char tmp;
657
658 VGA_WR08(par->PCIO, 0x3d4, 0x46);
659 tmp = VGA_RD08(par->PCIO, 0x3d5);
660 tmp |= (1 << 7);
661 VGA_WR08(par->PCIO, 0x3d5, tmp);
662 }
663 #endif
664
665 info->fix.line_length = (info->var.xres_virtual *
666 info->var.bits_per_pixel) >> 3;
667 if (info->var.accel_flags) {
668 info->fbops->fb_imageblit = nvidiafb_imageblit;
669 info->fbops->fb_fillrect = nvidiafb_fillrect;
670 info->fbops->fb_copyarea = nvidiafb_copyarea;
671 info->fbops->fb_sync = nvidiafb_sync;
672 info->pixmap.scan_align = 4;
673 info->flags &= ~FBINFO_HWACCEL_DISABLED;
674 info->flags |= FBINFO_READS_FAST;
675 NVResetGraphics(info);
676 } else {
677 info->fbops->fb_imageblit = cfb_imageblit;
678 info->fbops->fb_fillrect = cfb_fillrect;
679 info->fbops->fb_copyarea = cfb_copyarea;
680 info->fbops->fb_sync = NULL;
681 info->pixmap.scan_align = 1;
682 info->flags |= FBINFO_HWACCEL_DISABLED;
683 info->flags &= ~FBINFO_READS_FAST;
684 }
685
686 par->cursor_reset = 1;
687
688 nvidia_screen_off(par, 0);
689
690 #ifdef CONFIG_BOOTX_TEXT
691 /* Update debug text engine */
692 btext_update_display(info->fix.smem_start,
693 info->var.xres, info->var.yres,
694 info->var.bits_per_pixel, info->fix.line_length);
695 #endif
696
697 NVLockUnlock(par, 0);
698 NVTRACE_LEAVE();
699 return 0;
700 }
701
nvidiafb_setcolreg(unsigned regno,unsigned red,unsigned green,unsigned blue,unsigned transp,struct fb_info * info)702 static int nvidiafb_setcolreg(unsigned regno, unsigned red, unsigned green,
703 unsigned blue, unsigned transp,
704 struct fb_info *info)
705 {
706 struct nvidia_par *par = info->par;
707 int i;
708
709 NVTRACE_ENTER();
710 if (regno >= (1 << info->var.green.length))
711 return -EINVAL;
712
713 if (info->var.grayscale) {
714 /* gray = 0.30*R + 0.59*G + 0.11*B */
715 red = green = blue = (red * 77 + green * 151 + blue * 28) >> 8;
716 }
717
718 if (regno < 16 && info->fix.visual == FB_VISUAL_DIRECTCOLOR) {
719 ((u32 *) info->pseudo_palette)[regno] =
720 (regno << info->var.red.offset) |
721 (regno << info->var.green.offset) |
722 (regno << info->var.blue.offset);
723 }
724
725 switch (info->var.bits_per_pixel) {
726 case 8:
727 /* "transparent" stuff is completely ignored. */
728 nvidia_write_clut(par, regno, red >> 8, green >> 8, blue >> 8);
729 break;
730 case 16:
731 if (info->var.green.length == 5) {
732 for (i = 0; i < 8; i++) {
733 nvidia_write_clut(par, regno * 8 + i, red >> 8,
734 green >> 8, blue >> 8);
735 }
736 } else {
737 u8 r, g, b;
738
739 if (regno < 32) {
740 for (i = 0; i < 8; i++) {
741 nvidia_write_clut(par, regno * 8 + i,
742 red >> 8, green >> 8,
743 blue >> 8);
744 }
745 }
746
747 nvidia_read_clut(par, regno * 4, &r, &g, &b);
748
749 for (i = 0; i < 4; i++)
750 nvidia_write_clut(par, regno * 4 + i, r,
751 green >> 8, b);
752 }
753 break;
754 case 32:
755 nvidia_write_clut(par, regno, red >> 8, green >> 8, blue >> 8);
756 break;
757 default:
758 /* do nothing */
759 break;
760 }
761
762 NVTRACE_LEAVE();
763 return 0;
764 }
765
nvidiafb_check_var(struct fb_var_screeninfo * var,struct fb_info * info)766 static int nvidiafb_check_var(struct fb_var_screeninfo *var,
767 struct fb_info *info)
768 {
769 struct nvidia_par *par = info->par;
770 int memlen, vramlen, mode_valid = 0;
771 int pitch, err = 0;
772
773 NVTRACE_ENTER();
774
775 var->transp.offset = 0;
776 var->transp.length = 0;
777
778 var->xres &= ~7;
779
780 if (var->bits_per_pixel <= 8)
781 var->bits_per_pixel = 8;
782 else if (var->bits_per_pixel <= 16)
783 var->bits_per_pixel = 16;
784 else
785 var->bits_per_pixel = 32;
786
787 switch (var->bits_per_pixel) {
788 case 8:
789 var->red.offset = 0;
790 var->red.length = 8;
791 var->green.offset = 0;
792 var->green.length = 8;
793 var->blue.offset = 0;
794 var->blue.length = 8;
795 var->transp.offset = 0;
796 var->transp.length = 0;
797 break;
798 case 16:
799 var->green.length = (var->green.length < 6) ? 5 : 6;
800 var->red.length = 5;
801 var->blue.length = 5;
802 var->transp.length = 6 - var->green.length;
803 var->blue.offset = 0;
804 var->green.offset = 5;
805 var->red.offset = 5 + var->green.length;
806 var->transp.offset = (5 + var->red.offset) & 15;
807 break;
808 case 32: /* RGBA 8888 */
809 var->red.offset = 16;
810 var->red.length = 8;
811 var->green.offset = 8;
812 var->green.length = 8;
813 var->blue.offset = 0;
814 var->blue.length = 8;
815 var->transp.length = 8;
816 var->transp.offset = 24;
817 break;
818 }
819
820 var->red.msb_right = 0;
821 var->green.msb_right = 0;
822 var->blue.msb_right = 0;
823 var->transp.msb_right = 0;
824
825 if (!info->monspecs.hfmax || !info->monspecs.vfmax ||
826 !info->monspecs.dclkmax || !fb_validate_mode(var, info))
827 mode_valid = 1;
828
829 /* calculate modeline if supported by monitor */
830 if (!mode_valid && info->monspecs.gtf) {
831 if (!fb_get_mode(FB_MAXTIMINGS, 0, var, info))
832 mode_valid = 1;
833 }
834
835 if (!mode_valid) {
836 const struct fb_videomode *mode;
837
838 mode = fb_find_best_mode(var, &info->modelist);
839 if (mode) {
840 fb_videomode_to_var(var, mode);
841 mode_valid = 1;
842 }
843 }
844
845 if (!mode_valid && info->monspecs.modedb_len)
846 return -EINVAL;
847
848 /*
849 * If we're on a flat panel, check if the mode is outside of the
850 * panel dimensions. If so, cap it and try for the next best mode
851 * before bailing out.
852 */
853 if (par->fpWidth && par->fpHeight && (par->fpWidth < var->xres ||
854 par->fpHeight < var->yres)) {
855 const struct fb_videomode *mode;
856
857 var->xres = par->fpWidth;
858 var->yres = par->fpHeight;
859
860 mode = fb_find_best_mode(var, &info->modelist);
861 if (!mode) {
862 printk(KERN_ERR PFX "mode out of range of flat "
863 "panel dimensions\n");
864 return -EINVAL;
865 }
866
867 fb_videomode_to_var(var, mode);
868 }
869
870 if (var->yres_virtual < var->yres)
871 var->yres_virtual = var->yres;
872
873 if (var->xres_virtual < var->xres)
874 var->xres_virtual = var->xres;
875
876 var->xres_virtual = (var->xres_virtual + 63) & ~63;
877
878 vramlen = info->screen_size;
879 pitch = ((var->xres_virtual * var->bits_per_pixel) + 7) / 8;
880 memlen = pitch * var->yres_virtual;
881
882 if (memlen > vramlen) {
883 var->yres_virtual = vramlen / pitch;
884
885 if (var->yres_virtual < var->yres) {
886 var->yres_virtual = var->yres;
887 var->xres_virtual = vramlen / var->yres_virtual;
888 var->xres_virtual /= var->bits_per_pixel / 8;
889 var->xres_virtual &= ~63;
890 pitch = (var->xres_virtual *
891 var->bits_per_pixel + 7) / 8;
892 memlen = pitch * var->yres;
893
894 if (var->xres_virtual < var->xres) {
895 printk("nvidiafb: required video memory, "
896 "%d bytes, for %dx%d-%d (virtual) "
897 "is out of range\n",
898 memlen, var->xres_virtual,
899 var->yres_virtual, var->bits_per_pixel);
900 err = -ENOMEM;
901 }
902 }
903 }
904
905 if (var->accel_flags) {
906 if (var->yres_virtual > 0x7fff)
907 var->yres_virtual = 0x7fff;
908 if (var->xres_virtual > 0x7fff)
909 var->xres_virtual = 0x7fff;
910 }
911
912 var->xres_virtual &= ~63;
913
914 NVTRACE_LEAVE();
915
916 return err;
917 }
918
nvidiafb_pan_display(struct fb_var_screeninfo * var,struct fb_info * info)919 static int nvidiafb_pan_display(struct fb_var_screeninfo *var,
920 struct fb_info *info)
921 {
922 struct nvidia_par *par = info->par;
923 u32 total;
924
925 total = var->yoffset * info->fix.line_length + var->xoffset;
926
927 NVSetStartAddress(par, total);
928
929 return 0;
930 }
931
nvidiafb_blank(int blank,struct fb_info * info)932 static int nvidiafb_blank(int blank, struct fb_info *info)
933 {
934 struct nvidia_par *par = info->par;
935 unsigned char tmp, vesa;
936
937 tmp = NVReadSeq(par, 0x01) & ~0x20; /* screen on/off */
938 vesa = NVReadCrtc(par, 0x1a) & ~0xc0; /* sync on/off */
939
940 NVTRACE_ENTER();
941
942 if (blank)
943 tmp |= 0x20;
944
945 switch (blank) {
946 case FB_BLANK_UNBLANK:
947 case FB_BLANK_NORMAL:
948 break;
949 case FB_BLANK_VSYNC_SUSPEND:
950 vesa |= 0x80;
951 break;
952 case FB_BLANK_HSYNC_SUSPEND:
953 vesa |= 0x40;
954 break;
955 case FB_BLANK_POWERDOWN:
956 vesa |= 0xc0;
957 break;
958 }
959
960 NVWriteSeq(par, 0x01, tmp);
961 NVWriteCrtc(par, 0x1a, vesa);
962
963 NVTRACE_LEAVE();
964
965 return 0;
966 }
967
968 /*
969 * Because the VGA registers are not mapped linearly in its MMIO space,
970 * restrict VGA register saving and restore to x86 only, where legacy VGA IO
971 * access is legal. Consequently, we must also check if the device is the
972 * primary display.
973 */
974 #ifdef CONFIG_X86
save_vga_x86(struct nvidia_par * par)975 static void save_vga_x86(struct nvidia_par *par)
976 {
977 struct resource *res= &par->pci_dev->resource[PCI_ROM_RESOURCE];
978
979 if (res && res->flags & IORESOURCE_ROM_SHADOW) {
980 memset(&par->vgastate, 0, sizeof(par->vgastate));
981 par->vgastate.flags = VGA_SAVE_MODE | VGA_SAVE_FONTS |
982 VGA_SAVE_CMAP;
983 save_vga(&par->vgastate);
984 }
985 }
986
restore_vga_x86(struct nvidia_par * par)987 static void restore_vga_x86(struct nvidia_par *par)
988 {
989 struct resource *res= &par->pci_dev->resource[PCI_ROM_RESOURCE];
990
991 if (res && res->flags & IORESOURCE_ROM_SHADOW)
992 restore_vga(&par->vgastate);
993 }
994 #else
995 #define save_vga_x86(x) do {} while (0)
996 #define restore_vga_x86(x) do {} while (0)
997 #endif /* X86 */
998
nvidiafb_open(struct fb_info * info,int user)999 static int nvidiafb_open(struct fb_info *info, int user)
1000 {
1001 struct nvidia_par *par = info->par;
1002
1003 if (!par->open_count) {
1004 save_vga_x86(par);
1005 nvidia_save_vga(par, &par->initial_state);
1006 }
1007
1008 par->open_count++;
1009 return 0;
1010 }
1011
nvidiafb_release(struct fb_info * info,int user)1012 static int nvidiafb_release(struct fb_info *info, int user)
1013 {
1014 struct nvidia_par *par = info->par;
1015 int err = 0;
1016
1017 if (!par->open_count) {
1018 err = -EINVAL;
1019 goto done;
1020 }
1021
1022 if (par->open_count == 1) {
1023 nvidia_write_regs(par, &par->initial_state);
1024 restore_vga_x86(par);
1025 }
1026
1027 par->open_count--;
1028 done:
1029 return err;
1030 }
1031
1032 static struct fb_ops nvidia_fb_ops = {
1033 .owner = THIS_MODULE,
1034 .fb_open = nvidiafb_open,
1035 .fb_release = nvidiafb_release,
1036 .fb_check_var = nvidiafb_check_var,
1037 .fb_set_par = nvidiafb_set_par,
1038 .fb_setcolreg = nvidiafb_setcolreg,
1039 .fb_pan_display = nvidiafb_pan_display,
1040 .fb_blank = nvidiafb_blank,
1041 .fb_fillrect = nvidiafb_fillrect,
1042 .fb_copyarea = nvidiafb_copyarea,
1043 .fb_imageblit = nvidiafb_imageblit,
1044 .fb_cursor = nvidiafb_cursor,
1045 .fb_sync = nvidiafb_sync,
1046 };
1047
1048 #ifdef CONFIG_PM
nvidiafb_suspend(struct pci_dev * dev,pm_message_t mesg)1049 static int nvidiafb_suspend(struct pci_dev *dev, pm_message_t mesg)
1050 {
1051 struct fb_info *info = pci_get_drvdata(dev);
1052 struct nvidia_par *par = info->par;
1053
1054 if (mesg.event == PM_EVENT_PRETHAW)
1055 mesg.event = PM_EVENT_FREEZE;
1056 console_lock();
1057 par->pm_state = mesg.event;
1058
1059 if (mesg.event & PM_EVENT_SLEEP) {
1060 fb_set_suspend(info, 1);
1061 nvidiafb_blank(FB_BLANK_POWERDOWN, info);
1062 nvidia_write_regs(par, &par->SavedReg);
1063 pci_save_state(dev);
1064 pci_disable_device(dev);
1065 pci_set_power_state(dev, pci_choose_state(dev, mesg));
1066 }
1067 dev->dev.power.power_state = mesg;
1068
1069 console_unlock();
1070 return 0;
1071 }
1072
nvidiafb_resume(struct pci_dev * dev)1073 static int nvidiafb_resume(struct pci_dev *dev)
1074 {
1075 struct fb_info *info = pci_get_drvdata(dev);
1076 struct nvidia_par *par = info->par;
1077
1078 console_lock();
1079 pci_set_power_state(dev, PCI_D0);
1080
1081 if (par->pm_state != PM_EVENT_FREEZE) {
1082 pci_restore_state(dev);
1083
1084 if (pci_enable_device(dev))
1085 goto fail;
1086
1087 pci_set_master(dev);
1088 }
1089
1090 par->pm_state = PM_EVENT_ON;
1091 nvidiafb_set_par(info);
1092 fb_set_suspend (info, 0);
1093 nvidiafb_blank(FB_BLANK_UNBLANK, info);
1094
1095 fail:
1096 console_unlock();
1097 return 0;
1098 }
1099 #else
1100 #define nvidiafb_suspend NULL
1101 #define nvidiafb_resume NULL
1102 #endif
1103
nvidia_set_fbinfo(struct fb_info * info)1104 static int nvidia_set_fbinfo(struct fb_info *info)
1105 {
1106 struct fb_monspecs *specs = &info->monspecs;
1107 struct fb_videomode modedb;
1108 struct nvidia_par *par = info->par;
1109 int lpitch;
1110
1111 NVTRACE_ENTER();
1112 info->flags = FBINFO_DEFAULT
1113 | FBINFO_HWACCEL_IMAGEBLIT
1114 | FBINFO_HWACCEL_FILLRECT
1115 | FBINFO_HWACCEL_COPYAREA
1116 | FBINFO_HWACCEL_YPAN;
1117
1118 fb_videomode_to_modelist(info->monspecs.modedb,
1119 info->monspecs.modedb_len, &info->modelist);
1120 fb_var_to_videomode(&modedb, &nvidiafb_default_var);
1121
1122 switch (bpp) {
1123 case 0 ... 8:
1124 bpp = 8;
1125 break;
1126 case 9 ... 16:
1127 bpp = 16;
1128 break;
1129 default:
1130 bpp = 32;
1131 break;
1132 }
1133
1134 if (specs->modedb != NULL) {
1135 const struct fb_videomode *mode;
1136
1137 mode = fb_find_best_display(specs, &info->modelist);
1138 fb_videomode_to_var(&nvidiafb_default_var, mode);
1139 nvidiafb_default_var.bits_per_pixel = bpp;
1140 } else if (par->fpWidth && par->fpHeight) {
1141 char buf[16];
1142
1143 memset(buf, 0, 16);
1144 snprintf(buf, 15, "%dx%dMR", par->fpWidth, par->fpHeight);
1145 fb_find_mode(&nvidiafb_default_var, info, buf, specs->modedb,
1146 specs->modedb_len, &modedb, bpp);
1147 }
1148
1149 if (mode_option)
1150 fb_find_mode(&nvidiafb_default_var, info, mode_option,
1151 specs->modedb, specs->modedb_len, &modedb, bpp);
1152
1153 info->var = nvidiafb_default_var;
1154 info->fix.visual = (info->var.bits_per_pixel == 8) ?
1155 FB_VISUAL_PSEUDOCOLOR : FB_VISUAL_DIRECTCOLOR;
1156 info->pseudo_palette = par->pseudo_palette;
1157 fb_alloc_cmap(&info->cmap, 256, 0);
1158 fb_destroy_modedb(info->monspecs.modedb);
1159 info->monspecs.modedb = NULL;
1160
1161 /* maximize virtual vertical length */
1162 lpitch = info->var.xres_virtual *
1163 ((info->var.bits_per_pixel + 7) >> 3);
1164 info->var.yres_virtual = info->screen_size / lpitch;
1165
1166 info->pixmap.scan_align = 4;
1167 info->pixmap.buf_align = 4;
1168 info->pixmap.access_align = 32;
1169 info->pixmap.size = 8 * 1024;
1170 info->pixmap.flags = FB_PIXMAP_SYSTEM;
1171
1172 if (!hwcur)
1173 info->fbops->fb_cursor = NULL;
1174
1175 info->var.accel_flags = (!noaccel);
1176
1177 switch (par->Architecture) {
1178 case NV_ARCH_04:
1179 info->fix.accel = FB_ACCEL_NV4;
1180 break;
1181 case NV_ARCH_10:
1182 info->fix.accel = FB_ACCEL_NV_10;
1183 break;
1184 case NV_ARCH_20:
1185 info->fix.accel = FB_ACCEL_NV_20;
1186 break;
1187 case NV_ARCH_30:
1188 info->fix.accel = FB_ACCEL_NV_30;
1189 break;
1190 case NV_ARCH_40:
1191 info->fix.accel = FB_ACCEL_NV_40;
1192 break;
1193 }
1194
1195 NVTRACE_LEAVE();
1196
1197 return nvidiafb_check_var(&info->var, info);
1198 }
1199
nvidia_get_chipset(struct fb_info * info)1200 static u32 nvidia_get_chipset(struct fb_info *info)
1201 {
1202 struct nvidia_par *par = info->par;
1203 u32 id = (par->pci_dev->vendor << 16) | par->pci_dev->device;
1204
1205 printk(KERN_INFO PFX "Device ID: %x \n", id);
1206
1207 if ((id & 0xfff0) == 0x00f0 ||
1208 (id & 0xfff0) == 0x02e0) {
1209 /* pci-e */
1210 id = NV_RD32(par->REGS, 0x1800);
1211
1212 if ((id & 0x0000ffff) == 0x000010DE)
1213 id = 0x10DE0000 | (id >> 16);
1214 else if ((id & 0xffff0000) == 0xDE100000) /* wrong endian */
1215 id = 0x10DE0000 | ((id << 8) & 0x0000ff00) |
1216 ((id >> 8) & 0x000000ff);
1217 printk(KERN_INFO PFX "Subsystem ID: %x \n", id);
1218 }
1219
1220 return id;
1221 }
1222
nvidia_get_arch(struct fb_info * info)1223 static u32 nvidia_get_arch(struct fb_info *info)
1224 {
1225 struct nvidia_par *par = info->par;
1226 u32 arch = 0;
1227
1228 switch (par->Chipset & 0x0ff0) {
1229 case 0x0100: /* GeForce 256 */
1230 case 0x0110: /* GeForce2 MX */
1231 case 0x0150: /* GeForce2 */
1232 case 0x0170: /* GeForce4 MX */
1233 case 0x0180: /* GeForce4 MX (8x AGP) */
1234 case 0x01A0: /* nForce */
1235 case 0x01F0: /* nForce2 */
1236 arch = NV_ARCH_10;
1237 break;
1238 case 0x0200: /* GeForce3 */
1239 case 0x0250: /* GeForce4 Ti */
1240 case 0x0280: /* GeForce4 Ti (8x AGP) */
1241 arch = NV_ARCH_20;
1242 break;
1243 case 0x0300: /* GeForceFX 5800 */
1244 case 0x0310: /* GeForceFX 5600 */
1245 case 0x0320: /* GeForceFX 5200 */
1246 case 0x0330: /* GeForceFX 5900 */
1247 case 0x0340: /* GeForceFX 5700 */
1248 arch = NV_ARCH_30;
1249 break;
1250 case 0x0040: /* GeForce 6800 */
1251 case 0x00C0: /* GeForce 6800 */
1252 case 0x0120: /* GeForce 6800 */
1253 case 0x0140: /* GeForce 6600 */
1254 case 0x0160: /* GeForce 6200 */
1255 case 0x01D0: /* GeForce 7200, 7300, 7400 */
1256 case 0x0090: /* GeForce 7800 */
1257 case 0x0210: /* GeForce 6800 */
1258 case 0x0220: /* GeForce 6200 */
1259 case 0x0240: /* GeForce 6100 */
1260 case 0x0290: /* GeForce 7900 */
1261 case 0x0390: /* GeForce 7600 */
1262 case 0x03D0:
1263 arch = NV_ARCH_40;
1264 break;
1265 case 0x0020: /* TNT, TNT2 */
1266 arch = NV_ARCH_04;
1267 break;
1268 default: /* unknown architecture */
1269 break;
1270 }
1271
1272 return arch;
1273 }
1274
nvidiafb_probe(struct pci_dev * pd,const struct pci_device_id * ent)1275 static int nvidiafb_probe(struct pci_dev *pd, const struct pci_device_id *ent)
1276 {
1277 struct nvidia_par *par;
1278 struct fb_info *info;
1279 unsigned short cmd;
1280
1281
1282 NVTRACE_ENTER();
1283 assert(pd != NULL);
1284
1285 info = framebuffer_alloc(sizeof(struct nvidia_par), &pd->dev);
1286
1287 if (!info)
1288 goto err_out;
1289
1290 par = info->par;
1291 par->pci_dev = pd;
1292 info->pixmap.addr = kzalloc(8 * 1024, GFP_KERNEL);
1293
1294 if (info->pixmap.addr == NULL)
1295 goto err_out_kfree;
1296
1297 if (pci_enable_device(pd)) {
1298 printk(KERN_ERR PFX "cannot enable PCI device\n");
1299 goto err_out_enable;
1300 }
1301
1302 if (pci_request_regions(pd, "nvidiafb")) {
1303 printk(KERN_ERR PFX "cannot request PCI regions\n");
1304 goto err_out_enable;
1305 }
1306
1307 par->FlatPanel = flatpanel;
1308 if (flatpanel == 1)
1309 printk(KERN_INFO PFX "flatpanel support enabled\n");
1310 par->FPDither = fpdither;
1311
1312 par->CRTCnumber = forceCRTC;
1313 par->FpScale = (!noscale);
1314 par->paneltweak = paneltweak;
1315 par->reverse_i2c = reverse_i2c;
1316
1317 /* enable IO and mem if not already done */
1318 pci_read_config_word(pd, PCI_COMMAND, &cmd);
1319 cmd |= (PCI_COMMAND_IO | PCI_COMMAND_MEMORY);
1320 pci_write_config_word(pd, PCI_COMMAND, cmd);
1321
1322 nvidiafb_fix.mmio_start = pci_resource_start(pd, 0);
1323 nvidiafb_fix.smem_start = pci_resource_start(pd, 1);
1324 nvidiafb_fix.mmio_len = pci_resource_len(pd, 0);
1325
1326 par->REGS = ioremap(nvidiafb_fix.mmio_start, nvidiafb_fix.mmio_len);
1327
1328 if (!par->REGS) {
1329 printk(KERN_ERR PFX "cannot ioremap MMIO base\n");
1330 goto err_out_free_base0;
1331 }
1332
1333 par->Chipset = nvidia_get_chipset(info);
1334 par->Architecture = nvidia_get_arch(info);
1335
1336 if (par->Architecture == 0) {
1337 printk(KERN_ERR PFX "unknown NV_ARCH\n");
1338 goto err_out_arch;
1339 }
1340
1341 sprintf(nvidiafb_fix.id, "NV%x", (pd->device & 0x0ff0) >> 4);
1342
1343 if (NVCommonSetup(info))
1344 goto err_out_arch;
1345
1346 par->FbAddress = nvidiafb_fix.smem_start;
1347 par->FbMapSize = par->RamAmountKBytes * 1024;
1348 if (vram && vram * 1024 * 1024 < par->FbMapSize)
1349 par->FbMapSize = vram * 1024 * 1024;
1350
1351 /* Limit amount of vram to 64 MB */
1352 if (par->FbMapSize > 64 * 1024 * 1024)
1353 par->FbMapSize = 64 * 1024 * 1024;
1354
1355 if(par->Architecture >= NV_ARCH_40)
1356 par->FbUsableSize = par->FbMapSize - (560 * 1024);
1357 else
1358 par->FbUsableSize = par->FbMapSize - (128 * 1024);
1359 par->ScratchBufferSize = (par->Architecture < NV_ARCH_10) ? 8 * 1024 :
1360 16 * 1024;
1361 par->ScratchBufferStart = par->FbUsableSize - par->ScratchBufferSize;
1362 par->CursorStart = par->FbUsableSize + (32 * 1024);
1363
1364 info->screen_base = ioremap(nvidiafb_fix.smem_start, par->FbMapSize);
1365 info->screen_size = par->FbUsableSize;
1366 nvidiafb_fix.smem_len = par->RamAmountKBytes * 1024;
1367
1368 if (!info->screen_base) {
1369 printk(KERN_ERR PFX "cannot ioremap FB base\n");
1370 goto err_out_free_base1;
1371 }
1372
1373 par->FbStart = info->screen_base;
1374
1375 #ifdef CONFIG_MTRR
1376 if (!nomtrr) {
1377 par->mtrr.vram = mtrr_add(nvidiafb_fix.smem_start,
1378 par->RamAmountKBytes * 1024,
1379 MTRR_TYPE_WRCOMB, 1);
1380 if (par->mtrr.vram < 0) {
1381 printk(KERN_ERR PFX "unable to setup MTRR\n");
1382 } else {
1383 par->mtrr.vram_valid = 1;
1384 /* let there be speed */
1385 printk(KERN_INFO PFX "MTRR set to ON\n");
1386 }
1387 }
1388 #endif /* CONFIG_MTRR */
1389
1390 info->fbops = &nvidia_fb_ops;
1391 info->fix = nvidiafb_fix;
1392
1393 if (nvidia_set_fbinfo(info) < 0) {
1394 printk(KERN_ERR PFX "error setting initial video mode\n");
1395 goto err_out_iounmap_fb;
1396 }
1397
1398 nvidia_save_vga(par, &par->SavedReg);
1399
1400 pci_set_drvdata(pd, info);
1401
1402 if (backlight)
1403 nvidia_bl_init(par);
1404
1405 if (register_framebuffer(info) < 0) {
1406 printk(KERN_ERR PFX "error registering nVidia framebuffer\n");
1407 goto err_out_iounmap_fb;
1408 }
1409
1410
1411 printk(KERN_INFO PFX
1412 "PCI nVidia %s framebuffer (%dMB @ 0x%lX)\n",
1413 info->fix.id,
1414 par->FbMapSize / (1024 * 1024), info->fix.smem_start);
1415
1416 NVTRACE_LEAVE();
1417 return 0;
1418
1419 err_out_iounmap_fb:
1420 iounmap(info->screen_base);
1421 err_out_free_base1:
1422 fb_destroy_modedb(info->monspecs.modedb);
1423 nvidia_delete_i2c_busses(par);
1424 err_out_arch:
1425 iounmap(par->REGS);
1426 err_out_free_base0:
1427 pci_release_regions(pd);
1428 err_out_enable:
1429 kfree(info->pixmap.addr);
1430 err_out_kfree:
1431 framebuffer_release(info);
1432 err_out:
1433 return -ENODEV;
1434 }
1435
nvidiafb_remove(struct pci_dev * pd)1436 static void nvidiafb_remove(struct pci_dev *pd)
1437 {
1438 struct fb_info *info = pci_get_drvdata(pd);
1439 struct nvidia_par *par = info->par;
1440
1441 NVTRACE_ENTER();
1442
1443 unregister_framebuffer(info);
1444
1445 nvidia_bl_exit(par);
1446
1447 #ifdef CONFIG_MTRR
1448 if (par->mtrr.vram_valid)
1449 mtrr_del(par->mtrr.vram, info->fix.smem_start,
1450 info->fix.smem_len);
1451 #endif /* CONFIG_MTRR */
1452
1453 iounmap(info->screen_base);
1454 fb_destroy_modedb(info->monspecs.modedb);
1455 nvidia_delete_i2c_busses(par);
1456 iounmap(par->REGS);
1457 pci_release_regions(pd);
1458 kfree(info->pixmap.addr);
1459 framebuffer_release(info);
1460 NVTRACE_LEAVE();
1461 }
1462
1463 /* ------------------------------------------------------------------------- *
1464 *
1465 * initialization
1466 *
1467 * ------------------------------------------------------------------------- */
1468
1469 #ifndef MODULE
nvidiafb_setup(char * options)1470 static int nvidiafb_setup(char *options)
1471 {
1472 char *this_opt;
1473
1474 NVTRACE_ENTER();
1475 if (!options || !*options)
1476 return 0;
1477
1478 while ((this_opt = strsep(&options, ",")) != NULL) {
1479 if (!strncmp(this_opt, "forceCRTC", 9)) {
1480 char *p;
1481
1482 p = this_opt + 9;
1483 if (!*p || !*(++p))
1484 continue;
1485 forceCRTC = *p - '0';
1486 if (forceCRTC < 0 || forceCRTC > 1)
1487 forceCRTC = -1;
1488 } else if (!strncmp(this_opt, "flatpanel", 9)) {
1489 flatpanel = 1;
1490 } else if (!strncmp(this_opt, "hwcur", 5)) {
1491 hwcur = 1;
1492 } else if (!strncmp(this_opt, "noaccel", 6)) {
1493 noaccel = 1;
1494 } else if (!strncmp(this_opt, "noscale", 7)) {
1495 noscale = 1;
1496 } else if (!strncmp(this_opt, "reverse_i2c", 11)) {
1497 reverse_i2c = 1;
1498 } else if (!strncmp(this_opt, "paneltweak:", 11)) {
1499 paneltweak = simple_strtoul(this_opt+11, NULL, 0);
1500 } else if (!strncmp(this_opt, "vram:", 5)) {
1501 vram = simple_strtoul(this_opt+5, NULL, 0);
1502 } else if (!strncmp(this_opt, "backlight:", 10)) {
1503 backlight = simple_strtoul(this_opt+10, NULL, 0);
1504 #ifdef CONFIG_MTRR
1505 } else if (!strncmp(this_opt, "nomtrr", 6)) {
1506 nomtrr = true;
1507 #endif
1508 } else if (!strncmp(this_opt, "fpdither:", 9)) {
1509 fpdither = simple_strtol(this_opt+9, NULL, 0);
1510 } else if (!strncmp(this_opt, "bpp:", 4)) {
1511 bpp = simple_strtoul(this_opt+4, NULL, 0);
1512 } else
1513 mode_option = this_opt;
1514 }
1515 NVTRACE_LEAVE();
1516 return 0;
1517 }
1518 #endif /* !MODULE */
1519
1520 static struct pci_driver nvidiafb_driver = {
1521 .name = "nvidiafb",
1522 .id_table = nvidiafb_pci_tbl,
1523 .probe = nvidiafb_probe,
1524 .suspend = nvidiafb_suspend,
1525 .resume = nvidiafb_resume,
1526 .remove = nvidiafb_remove,
1527 };
1528
1529 /* ------------------------------------------------------------------------- *
1530 *
1531 * modularization
1532 *
1533 * ------------------------------------------------------------------------- */
1534
nvidiafb_init(void)1535 static int nvidiafb_init(void)
1536 {
1537 #ifndef MODULE
1538 char *option = NULL;
1539
1540 if (fb_get_options("nvidiafb", &option))
1541 return -ENODEV;
1542 nvidiafb_setup(option);
1543 #endif
1544 return pci_register_driver(&nvidiafb_driver);
1545 }
1546
1547 module_init(nvidiafb_init);
1548
nvidiafb_exit(void)1549 static void __exit nvidiafb_exit(void)
1550 {
1551 pci_unregister_driver(&nvidiafb_driver);
1552 }
1553
1554 module_exit(nvidiafb_exit);
1555
1556 module_param(flatpanel, int, 0);
1557 MODULE_PARM_DESC(flatpanel,
1558 "Enables experimental flat panel support for some chipsets. "
1559 "(0=disabled, 1=enabled, -1=autodetect) (default=-1)");
1560 module_param(fpdither, int, 0);
1561 MODULE_PARM_DESC(fpdither,
1562 "Enables dithering of flat panel for 6 bits panels. "
1563 "(0=disabled, 1=enabled, -1=autodetect) (default=-1)");
1564 module_param(hwcur, int, 0);
1565 MODULE_PARM_DESC(hwcur,
1566 "Enables hardware cursor implementation. (0 or 1=enabled) "
1567 "(default=0)");
1568 module_param(noaccel, int, 0);
1569 MODULE_PARM_DESC(noaccel,
1570 "Disables hardware acceleration. (0 or 1=disable) "
1571 "(default=0)");
1572 module_param(noscale, int, 0);
1573 MODULE_PARM_DESC(noscale,
1574 "Disables screen scaleing. (0 or 1=disable) "
1575 "(default=0, do scaling)");
1576 module_param(paneltweak, int, 0);
1577 MODULE_PARM_DESC(paneltweak,
1578 "Tweak display settings for flatpanels. "
1579 "(default=0, no tweaks)");
1580 module_param(forceCRTC, int, 0);
1581 MODULE_PARM_DESC(forceCRTC,
1582 "Forces usage of a particular CRTC in case autodetection "
1583 "fails. (0 or 1) (default=autodetect)");
1584 module_param(vram, int, 0);
1585 MODULE_PARM_DESC(vram,
1586 "amount of framebuffer memory to remap in MiB"
1587 "(default=0 - remap entire memory)");
1588 module_param(mode_option, charp, 0);
1589 MODULE_PARM_DESC(mode_option, "Specify initial video mode");
1590 module_param(bpp, int, 0);
1591 MODULE_PARM_DESC(bpp, "pixel width in bits"
1592 "(default=8)");
1593 module_param(reverse_i2c, int, 0);
1594 MODULE_PARM_DESC(reverse_i2c, "reverse port assignment of the i2c bus");
1595 #ifdef CONFIG_MTRR
1596 module_param(nomtrr, bool, false);
1597 MODULE_PARM_DESC(nomtrr, "Disables MTRR support (0 or 1=disabled) "
1598 "(default=0)");
1599 #endif
1600
1601 MODULE_AUTHOR("Antonino Daplas");
1602 MODULE_DESCRIPTION("Framebuffer driver for nVidia graphics chipset");
1603 MODULE_LICENSE("GPL");
1604