开通博客赚积分
发布资源赚积分
分类

源码开发语言/平台
当前位置：首页 > 源码/资料 > 嵌入式/单片机编程 > 嵌入式Linux > 查看源码
fbdev.c
资源名称：SBC-2410X_kernel.tar.gz　[点击查看]
上传用户：lgb322
上传日期：2013-02-24
资源大小：30529k
文件大小：53k
源码类别：

嵌入式Linux

开发平台：

Unix_Linux

fbdev.c：源码内容
  1. /*
  2.  * linux/drivers/video/riva/fbdev.c - nVidia RIVA 128/TNT/TNT2 fb driver
  3.  *
  4.  * Maintained by Ani Joshi <ajoshi@shell.unixbox.com>
  5.  *
  6.  * Copyright 1999-2000 Jeff Garzik
  7.  *
  8.  * Contributors:
  9.  *
  10.  * Ani Joshi:  Lots of debugging and cleanup work, really helped
  11.  * get the driver going
  12.  *
  13.  * Ferenc Bakonyi:  Bug fixes, cleanup, modularization
  14.  *
  15.  * Jindrich Makovicka:  Accel code help, hw cursor, mtrr
  16.  *
  17.  * Initial template from skeletonfb.c, created 28 Dec 1997 by Geert Uytterhoeven
  18.  * Includes riva_hw.c from nVidia, see copyright below.
  19.  * KGI code provided the basis for state storage, init, and mode switching.
  20.  *
  21.  * This file is subject to the terms and conditions of the GNU General Public
  22.  * License.  See the file COPYING in the main directory of this archive
  23.  * for more details.
  24.  *
  25.  * Known bugs and issues:
  26.  * restoring text mode fails
  27.  * doublescan modes are broken
  28.  * option 'noaccel' has no effect
  29.  */
  31. #include <linux/config.h>
  32. #include <linux/module.h>
  33. #include <linux/kernel.h>
  34. #include <linux/errno.h>
  35. #include <linux/string.h>
  36. #include <linux/mm.h>
  37. #include <linux/selection.h>
  38. #include <linux/tty.h>
  39. #include <linux/slab.h>
  40. #include <linux/delay.h>
  41. #include <linux/fb.h>
  42. #include <linux/init.h>
  43. #include <linux/pci.h>
  44. #include <linux/console.h>
  45. #ifdef CONFIG_MTRR
  46. #include <asm/mtrr.h>
  47. #endif
  48. #include "rivafb.h"
  49. #include "nvreg.h"
  51. #ifndef CONFIG_PCI /* sanity check */
  52. #error This driver requires PCI support.
  53. #endif
  57. /* version number of this driver */
  58. #define RIVAFB_VERSION "0.9.2a"
  62. /* ------------------------------------------------------------------------- *
  63.  *
  64.  * various helpful macros and constants
  65.  *
  66.  * ------------------------------------------------------------------------- */
  68. #undef RIVAFBDEBUG
  69. #ifdef RIVAFBDEBUG
  70. #define DPRINTK(fmt, args...) printk(KERN_DEBUG "%s: " fmt, __FUNCTION__ , ## args)
  71. #else
  72. #define DPRINTK(fmt, args...)
  73. #endif
  75. #ifndef RIVA_NDEBUG
  76. #define assert(expr) 
  77. if(!(expr)) { 
  78. printk( "Assertion failed! %s,%s,%s,line=%dn",
  79. #expr,__FILE__,__FUNCTION__,__LINE__); 
  80. BUG(); 
  81. }
  82. #else
  83. #define assert(expr)
  84. #endif
  86. #define PFX "rivafb: "
  88. /* macro that allows you to set overflow bits */
  89. #define SetBitField(value,from,to) SetBF(to,GetBF(value,from))
  90. #define SetBit(n) (1<<(n))
  91. #define Set8Bits(value) ((value)&0xff)
  93. /* HW cursor parameters */
  94. #define DEFAULT_CURSOR_BLINK_RATE (40)
  95. #define CURSOR_HIDE_DELAY (20)
  96. #define CURSOR_SHOW_DELAY (3)
  98. #define CURSOR_COLOR 0x7fff
  99. #define TRANSPARENT_COLOR 0x0000
  100. #define MAX_CURS 32
  104. /* ------------------------------------------------------------------------- *
  105.  *
  106.  * prototypes
  107.  *
  108.  * ------------------------------------------------------------------------- */
  110. static void rivafb_blank(int blank, struct fb_info *info);
  112. extern void riva_setup_accel(struct rivafb_info *rinfo);
  113. extern inline void wait_for_idle(struct rivafb_info *rinfo);
  117. /* ------------------------------------------------------------------------- *
  118.  *
  119.  * card identification
  120.  *
  121.  * ------------------------------------------------------------------------- */
  123. enum riva_chips {
  124. CH_RIVA_128 = 0,
  125. CH_RIVA_TNT,
  126. CH_RIVA_TNT2,
  127. CH_RIVA_UTNT2, /* UTNT2 */
  128. CH_RIVA_VTNT2, /* VTNT2 */
  129. CH_RIVA_UVTNT2, /* VTNT2 */
  130. CH_RIVA_ITNT2, /* ITNT2 */
  131. CH_GEFORCE_SDR,
  132. CH_GEFORCE_DDR,
  133. CH_QUADRO,
  134. CH_GEFORCE2_MX,
  135. CH_QUADRO2_MXR,
  136. CH_GEFORCE2_GTS,
  137. CH_GEFORCE2_ULTRA,
  138. CH_QUADRO2_PRO,
  139. CH_GEFORCE2_GO,
  140.         CH_GEFORCE3,
  141.         CH_GEFORCE3_1,
  142.         CH_GEFORCE3_2,
  143.         CH_QUADRO_DDC
  144. };
  146. /* directly indexed by riva_chips enum, above */
  147. static struct riva_chip_info {
  148. const char *name;
  149. unsigned arch_rev;
  150. } riva_chip_info[] __devinitdata = {
  151. { "RIVA-128", NV_ARCH_03 },
  152. { "RIVA-TNT", NV_ARCH_04 },
  153. { "RIVA-TNT2", NV_ARCH_04 },
  154. { "RIVA-UTNT2", NV_ARCH_04 },
  155. { "RIVA-VTNT2", NV_ARCH_04 },
  156. { "RIVA-UVTNT2", NV_ARCH_04 },
  157. { "RIVA-ITNT2", NV_ARCH_04 },
  158. { "GeForce-SDR", NV_ARCH_10},
  159. { "GeForce-DDR", NV_ARCH_10},
  160. { "Quadro", NV_ARCH_10},
  161. { "GeForce2-MX", NV_ARCH_10},
  162. { "Quadro2-MXR", NV_ARCH_10},
  163. { "GeForce2-GTS", NV_ARCH_10},
  164. { "GeForce2-ULTRA", NV_ARCH_10},
  165. { "Quadro2-PRO", NV_ARCH_10},
  166.         { "GeForce2-Go", NV_ARCH_10},
  167.         { "GeForce3", NV_ARCH_20}, 
  168.         { "GeForce3 Ti 200", NV_ARCH_20},
  169.         { "GeForce3 Ti 500", NV_ARCH_20},
  170.         { "Quadro DDC", NV_ARCH_20}
  171. };
  173. static struct pci_device_id rivafb_pci_tbl[] __devinitdata = {
  174. { PCI_VENDOR_ID_NVIDIA_SGS, PCI_DEVICE_ID_NVIDIA_SGS_RIVA128,
  175.   PCI_ANY_ID, PCI_ANY_ID, 0, 0, CH_RIVA_128 },
  176. { PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_TNT,
  177.   PCI_ANY_ID, PCI_ANY_ID, 0, 0, CH_RIVA_TNT },
  178. { PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_TNT2,
  179.   PCI_ANY_ID, PCI_ANY_ID, 0, 0, CH_RIVA_TNT2 },
  180. { PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_UTNT2,
  181.   PCI_ANY_ID, PCI_ANY_ID, 0, 0, CH_RIVA_UTNT2 },
  182. { PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_VTNT2,
  183.   PCI_ANY_ID, PCI_ANY_ID, 0, 0, CH_RIVA_VTNT2 },
  184. { PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_UVTNT2,
  185.   PCI_ANY_ID, PCI_ANY_ID, 0, 0, CH_RIVA_VTNT2 },
  186. { PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_ITNT2,
  187.   PCI_ANY_ID, PCI_ANY_ID, 0, 0, CH_RIVA_ITNT2 },
  188. { PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_GEFORCE_SDR,
  189.   PCI_ANY_ID, PCI_ANY_ID, 0, 0, CH_GEFORCE_SDR },
  190. { PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_GEFORCE_DDR,
  191.   PCI_ANY_ID, PCI_ANY_ID, 0, 0, CH_GEFORCE_DDR },
  192. { PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_QUADRO,
  193.   PCI_ANY_ID, PCI_ANY_ID, 0, 0, CH_QUADRO },
  194. { PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_GEFORCE2_MX,
  195.   PCI_ANY_ID, PCI_ANY_ID, 0, 0, CH_GEFORCE2_MX },
  196. { PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_GEFORCE2_MX2,
  197.   PCI_ANY_ID, PCI_ANY_ID, 0, 0, CH_GEFORCE2_MX },
  198. { PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_QUADRO2_MXR,
  199.   PCI_ANY_ID, PCI_ANY_ID, 0, 0, CH_QUADRO2_MXR },
  200. { PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_GEFORCE2_GTS,
  201.   PCI_ANY_ID, PCI_ANY_ID, 0, 0, CH_GEFORCE2_GTS },
  202. { PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_GEFORCE2_GTS2,
  203.   PCI_ANY_ID, PCI_ANY_ID, 0, 0, CH_GEFORCE2_GTS },
  204. { PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_GEFORCE2_ULTRA,
  205.   PCI_ANY_ID, PCI_ANY_ID, 0, 0, CH_GEFORCE2_ULTRA },
  206. { PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_QUADRO2_PRO,
  207.   PCI_ANY_ID, PCI_ANY_ID, 0, 0, CH_QUADRO2_PRO },
  208.         { PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_GEFORCE2_GO,
  209.           PCI_ANY_ID, PCI_ANY_ID, 0, 0, CH_GEFORCE2_GO },
  210.         { PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_GEFORCE3,
  211.           PCI_ANY_ID, PCI_ANY_ID, 0, 0, CH_GEFORCE3 },
  212.         { PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_GEFORCE3_1,
  213.           PCI_ANY_ID, PCI_ANY_ID, 0, 0, CH_GEFORCE3_1 },
  214.         { PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_GEFORCE3_2,
  215.           PCI_ANY_ID, PCI_ANY_ID, 0, 0, CH_GEFORCE3_2 },
  216.         { PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_QUADRO_DDC,
  217.           PCI_ANY_ID, PCI_ANY_ID, 0, 0, CH_QUADRO_DDC },
  218. { 0, } /* terminate list */
  219. };
  220. MODULE_DEVICE_TABLE(pci, rivafb_pci_tbl);
  224. /* ------------------------------------------------------------------------- *
  225.  *
  226.  * framebuffer related structures
  227.  *
  228.  * ------------------------------------------------------------------------- */
  230. #ifdef FBCON_HAS_CFB8
  231. extern struct display_switch fbcon_riva8;
  232. #endif
  233. #ifdef FBCON_HAS_CFB16
  234. extern struct display_switch fbcon_riva16;
  235. #endif
  236. #ifdef FBCON_HAS_CFB32
  237. extern struct display_switch fbcon_riva32;
  238. #endif
  240. #if 0
  241. /* describes the state of a Riva board */
  242. struct rivafb_par {
  243. struct riva_regs state; /* state of hw board */
  244. __u32 visual; /* FB_VISUAL_xxx */
  245. unsigned depth; /* bpp of current mode */
  246. };
  247. #endif
  249. struct riva_cursor {
  250. int enable;
  251. int on;
  252. int vbl_cnt;
  253. int last_move_delay;
  254. int blink_rate;
  255. struct {
  256. u16 x, y;
  257. } pos, size;
  258. unsigned short image[MAX_CURS*MAX_CURS];
  259. struct timer_list *timer;
  260. };
  264. /* ------------------------------------------------------------------------- *
  265.  *
  266.  * global variables
  267.  *
  268.  * ------------------------------------------------------------------------- */
  270. struct rivafb_info *riva_boards = NULL;
  272. /* command line data, set in rivafb_setup() */
  273. static char fontname[40] __initdata = { 0 };
  274. static char noaccel __initdata = 0;
  275. static char nomove = 0;
  276. static char nohwcursor __initdata = 0;
  277. static char noblink = 0;
  278. #ifdef CONFIG_MTRR
  279. static char nomtrr __initdata = 0;
  280. #endif
  282. #ifndef MODULE
  283. static char *mode_option __initdata = NULL;
  284. #else
  285. static char *font = NULL;
  286. #endif
  288. static struct fb_var_screeninfo rivafb_default_var = {
  289. xres: 640,
  290. yres: 480,
  291. xres_virtual: 640,
  292. yres_virtual: 480,
  293. xoffset: 0,
  294. yoffset: 0,
  295. bits_per_pixel: 8,
  296. grayscale: 0,
  297. red: {0, 6, 0},
  298. green: {0, 6, 0},
  299. blue: {0, 6, 0},
  300. transp: {0, 0, 0},
  301. nonstd: 0,
  302. activate: 0,
  303. height: -1,
  304. width: -1,
  305. accel_flags: 0,
  306. pixclock: 39721,
  307. left_margin: 40,
  308. right_margin: 24,
  309. upper_margin: 32,
  310. lower_margin: 11,
  311. hsync_len: 96,
  312. vsync_len: 2,
  313. sync: 0,
  314. vmode: FB_VMODE_NONINTERLACED
  315. };
  317. /* from GGI */
  318. static const struct riva_regs reg_template = {
  319. {0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, /* ATTR */
  320.  0x08, 0x09, 0x0A, 0x0B, 0x0C, 0x0D, 0x0E, 0x0F,
  321.  0x41, 0x01, 0x0F, 0x00, 0x00},
  322. {0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* CRT  */
  323.  0x00, 0x00, 0x20, 0x00, 0x00, 0x00, 0x00, 0x00,
  324.  0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xE3, /* 0x10 */
  325.  0xFF, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
  326.  0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* 0x20 */
  327.  0x40, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
  328.  0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* 0x30 */
  329.  0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
  330.  0x00, /* 0x40 */
  331.  },
  332. {0x00, 0x00, 0x00, 0x00, 0x00, 0x40, 0x05, 0x0F, /* GRA  */
  333.  0xFF},
  334. {0x03, 0x01, 0x0F, 0x00, 0x0E}, /* SEQ  */
  335. 0xEB /* MISC */
  336. };
  340. /* ------------------------------------------------------------------------- *
  341.  *
  342.  * MMIO access macros
  343.  *
  344.  * ------------------------------------------------------------------------- */
  346. static inline void CRTCout(struct rivafb_info *rinfo, unsigned char index,
  347.    unsigned char val)
  348. {
  349. VGA_WR08(rinfo->riva.PCIO, 0x3d4, index);
  350. VGA_WR08(rinfo->riva.PCIO, 0x3d5, val);
  351. }
  353. static inline unsigned char CRTCin(struct rivafb_info *rinfo,
  354.    unsigned char index)
  355. {
  356. VGA_WR08(rinfo->riva.PCIO, 0x3d4, index);
  357. return (VGA_RD08(rinfo->riva.PCIO, 0x3d5));
  358. }
  360. static inline void GRAout(struct rivafb_info *rinfo, unsigned char index,
  361.   unsigned char val)
  362. {
  363. VGA_WR08(rinfo->riva.PVIO, 0x3ce, index);
  364. VGA_WR08(rinfo->riva.PVIO, 0x3cf, val);
  365. }
  367. static inline unsigned char GRAin(struct rivafb_info *rinfo,
  368.   unsigned char index)
  369. {
  370. VGA_WR08(rinfo->riva.PVIO, 0x3ce, index);
  371. return (VGA_RD08(rinfo->riva.PVIO, 0x3cf));
  372. }
  374. static inline void SEQout(struct rivafb_info *rinfo, unsigned char index,
  375.   unsigned char val)
  376. {
  377. VGA_WR08(rinfo->riva.PVIO, 0x3c4, index);
  378. VGA_WR08(rinfo->riva.PVIO, 0x3c5, val);
  379. }
  381. static inline unsigned char SEQin(struct rivafb_info *rinfo,
  382.   unsigned char index)
  383. {
  384. VGA_WR08(rinfo->riva.PVIO, 0x3c4, index);
  385. return (VGA_RD08(rinfo->riva.PVIO, 0x3c5));
  386. }
  388. static inline void ATTRout(struct rivafb_info *rinfo, unsigned char index,
  389.    unsigned char val)
  390. {
  391. VGA_WR08(rinfo->riva.PCIO, 0x3c0, index);
  392. VGA_WR08(rinfo->riva.PCIO, 0x3c0, val);
  393. }
  395. static inline unsigned char ATTRin(struct rivafb_info *rinfo,
  396.    unsigned char index)
  397. {
  398. VGA_WR08(rinfo->riva.PCIO, 0x3c0, index);
  399. return (VGA_RD08(rinfo->riva.PCIO, 0x3c1));
  400. }
  402. static inline void MISCout(struct rivafb_info *rinfo, unsigned char val)
  403. {
  404. VGA_WR08(rinfo->riva.PVIO, 0x3c2, val);
  405. }
  407. static inline unsigned char MISCin(struct rivafb_info *rinfo)
  408. {
  409. return (VGA_RD08(rinfo->riva.PVIO, 0x3cc));
  410. }
  414. /* ------------------------------------------------------------------------- *
  415.  *
  416.  * cursor stuff
  417.  *
  418.  * ------------------------------------------------------------------------- */
  420. /**
  421.  * riva_cursor_timer_handler - blink timer
  422.  * @dev_addr: pointer to rivafb_info object containing info for current riva board
  423.  *
  424.  * DESCRIPTION:
  425.  * Cursor blink timer.
  426.  */
  427. static void riva_cursor_timer_handler(unsigned long dev_addr)
  428. {
  429. struct rivafb_info *rinfo = (struct rivafb_info *)dev_addr;
  431. if (!rinfo->cursor) return;
  433. if (!rinfo->cursor->enable) goto out;
  435. if (rinfo->cursor->last_move_delay < 1000)
  436. rinfo->cursor->last_move_delay++;
  438. if (rinfo->cursor->vbl_cnt && --rinfo->cursor->vbl_cnt == 0) {
  439. rinfo->cursor->on ^= 1;
  440. if (rinfo->cursor->on)
  441. *(rinfo->riva.CURSORPOS) = (rinfo->cursor->pos.x & 0xFFFF)
  442.    | (rinfo->cursor->pos.y << 16);
  443. rinfo->riva.ShowHideCursor(&rinfo->riva, rinfo->cursor->on);
  444. if (!noblink)
  445. rinfo->cursor->vbl_cnt = rinfo->cursor->blink_rate;
  446. }
  447. out:
  448. rinfo->cursor->timer->expires = jiffies + (HZ / 100);
  449. add_timer(rinfo->cursor->timer);
  450. }
  452. /**
  453.  * rivafb_init_cursor - allocates cursor structure and starts blink timer
  454.  * @rinfo: pointer to rivafb_info object containing info for current riva board
  455.  *
  456.  * DESCRIPTION:
  457.  * Allocates cursor structure and starts blink timer.
  458.  *
  459.  * RETURNS:
  460.  * Pointer to allocated cursor structure.
  461.  *
  462.  * CALLED FROM:
  463.  * rivafb_init_one()
  464.  */
  465. static struct riva_cursor * __init rivafb_init_cursor(struct rivafb_info *rinfo)
  466. {
  467. struct riva_cursor *cursor;
  469. cursor = kmalloc(sizeof(struct riva_cursor), GFP_KERNEL);
  470. if (!cursor) return 0;
  471. memset(cursor, 0, sizeof(*cursor));
  473. cursor->timer = kmalloc(sizeof(*cursor->timer), GFP_KERNEL);
  474. if (!cursor->timer) {
  475. kfree(cursor);
  476. return 0;
  477. }
  478. memset(cursor->timer, 0, sizeof(*cursor->timer));
  480. cursor->blink_rate = DEFAULT_CURSOR_BLINK_RATE;
  482. init_timer(cursor->timer);
  483. cursor->timer->expires = jiffies + (HZ / 100);
  484. cursor->timer->data = (unsigned long)rinfo;
  485. cursor->timer->function = riva_cursor_timer_handler;
  486. add_timer(cursor->timer);
  488. return cursor;
  489. }
  491. /**
  492.  * rivafb_exit_cursor - stops blink timer and releases cursor structure
  493.  * @rinfo: pointer to rivafb_info object containing info for current riva board
  494.  *
  495.  * DESCRIPTION:
  496.  * Stops blink timer and releases cursor structure.
  497.  *
  498.  * CALLED FROM:
  499.  * rivafb_init_one()
  500.  * rivafb_remove_one()
  501.  */
  502. static void rivafb_exit_cursor(struct rivafb_info *rinfo)
  503. {
  504. struct riva_cursor *cursor = rinfo->cursor;
  506. if (cursor) {
  507. if (cursor->timer) {
  508. del_timer_sync(cursor->timer);
  509. kfree(cursor->timer);
  510. }
  511. kfree(cursor);
  512. rinfo->cursor = 0;
  513. }
  514. }
  516. /**
  517.  * rivafb_download_cursor - writes cursor shape into card registers
  518.  * @rinfo: pointer to rivafb_info object containing info for current riva board
  519.  *
  520.  * DESCRIPTION:
  521.  * Writes cursor shape into card registers.
  522.  *
  523.  * CALLED FROM:
  524.  * riva_load_video_mode()
  525.  */
  526. static void rivafb_download_cursor(struct rivafb_info *rinfo)
  527. {
  528. int i, save;
  529. int *image;
  531. if (!rinfo->cursor) return;
  533. image = (int *)rinfo->cursor->image;
  534. save = rinfo->riva.ShowHideCursor(&rinfo->riva, 0);
  535. for (i = 0; i < (MAX_CURS*MAX_CURS*2)/sizeof(int); i++)
  536. writel(image[i], rinfo->riva.CURSOR + i);
  538. rinfo->riva.ShowHideCursor(&rinfo->riva, save);
  539. }
  541. /**
  542.  * rivafb_create_cursor - sets rectangular cursor
  543.  * @rinfo: pointer to rivafb_info object containing info for current riva board
  544.  * @width: cursor width in pixels
  545.  * @height: cursor height in pixels
  546.  *
  547.  * DESCRIPTION:
  548.  * Sets rectangular cursor.
  549.  *
  550.  * CALLED FROM:
  551.  * rivafb_set_font()
  552.  * rivafb_set_var()
  553.  */
  554. static void rivafb_create_cursor(struct rivafb_info *rinfo, int width, int height)
  555. {
  556. struct riva_cursor *c = rinfo->cursor;
  557. int i, j, idx;
  559. if (c) {
  560. if (width <= 0 || height <= 0) {
  561. width = 8;
  562. height = 16;
  563. }
  564. if (width > MAX_CURS) width = MAX_CURS;
  565. if (height > MAX_CURS) height = MAX_CURS;
  567. c->size.x = width;
  568. c->size.y = height;
  570. idx = 0;
  572. for (i = 0; i < height; i++) {
  573. for (j = 0; j < width; j++,idx++)
  574. c->image[idx] = CURSOR_COLOR;
  575. for (j = width; j < MAX_CURS; j++,idx++)
  576. c->image[idx] = TRANSPARENT_COLOR;
  577. }
  578. for (i = height; i < MAX_CURS; i++)
  579. for (j = 0; j < MAX_CURS; j++,idx++)
  580. c->image[idx] = TRANSPARENT_COLOR;
  581. }
  582. }
  584. /**
  585.  * rivafb_set_font - change font size
  586.  * @p: pointer to display object
  587.  * @width: font width in pixels
  588.  * @height: font height in pixels
  589.  *
  590.  * DESCRIPTION:
  591.  * Callback function called if font settings changed.
  592.  *
  593.  * RETURNS:
  594.  * 1 (Always succeeds.)
  595.  */
  596. static int rivafb_set_font(struct display *p, int width, int height)
  597. {
  598. struct rivafb_info *fb = (struct rivafb_info *)(p->fb_info);
  600. rivafb_create_cursor(fb, width, height);
  601. return 1;
  602. }
  604. /**
  605.  * rivafb_cursor - cursor handler
  606.  * @p: pointer to display object
  607.  * @mode: cursor mode (see CM_*)
  608.  * @x: cursor x coordinate in characters
  609.  * @y: cursor y coordinate in characters
  610.  *
  611.  * DESCRIPTION:
  612.  * Cursor handler.
  613.  */
  614. static void rivafb_cursor(struct display *p, int mode, int x, int y)
  615. {
  616. struct rivafb_info *rinfo = (struct rivafb_info *)(p->fb_info);
  617. struct riva_cursor *c = rinfo->cursor;
  619. if (!c) return;
  621. x = x * fontwidth(p) - p->var.xoffset;
  622. y = y * fontheight(p) - p->var.yoffset;
  624. if (c->pos.x == x && c->pos.y == y && (mode == CM_ERASE) == !c->enable)
  625. return;
  627. c->enable = 0;
  628. if (c->on) rinfo->riva.ShowHideCursor(&rinfo->riva, 0);
  630. c->pos.x = x;
  631. c->pos.y = y;
  633. switch (mode) {
  634. case CM_ERASE:
  635. c->on = 0;
  636. break;
  637. case CM_DRAW:
  638. case CM_MOVE:
  639. if (c->last_move_delay <= 1) { /* rapid cursor movement */
  640. c->vbl_cnt = CURSOR_SHOW_DELAY;
  641. } else {
  642. *(rinfo->riva.CURSORPOS) = (x & 0xFFFF) | (y << 16);
  643. rinfo->riva.ShowHideCursor(&rinfo->riva, 1);
  644. if (!noblink) c->vbl_cnt = CURSOR_HIDE_DELAY;
  645. c->on = 1;
  646. }
  647. c->last_move_delay = 0;
  648. c->enable = 1;
  649. break;
  650. }
  651. }
  655. /* ------------------------------------------------------------------------- *
  656.  *
  657.  * general utility functions
  658.  *
  659.  * ------------------------------------------------------------------------- */
  661. /**
  662.  * riva_set_dispsw - sets dispsw
  663.  * @rinfo: pointer to internal driver struct for a given Riva card
  664.  * @disp: pointer to display object
  665.  *
  666.  * DESCRIPTION:
  667.  * Sets up console low level operations depending on the current? color depth
  668.  * of the display.
  669.  *
  670.  * CALLED FROM:
  671.  * rivafb_set_var()
  672.  * rivafb_switch()
  673.  * riva_init_disp()
  674.  */
  675. static void riva_set_dispsw(struct rivafb_info *rinfo, struct display *disp)
  676. {
  677. int accel = disp->var.accel_flags & FB_ACCELF_TEXT;
  679. DPRINTK("ENTERn");
  681. assert(rinfo != NULL);
  683. disp->dispsw_data = NULL;
  685. disp->screen_base = rinfo->fb_base;
  686. disp->type = FB_TYPE_PACKED_PIXELS;
  687. disp->type_aux = 0;
  688. disp->ypanstep = 1;
  689. disp->ywrapstep = 0;
  690. disp->can_soft_blank = 1;
  691. disp->inverse = 0;
  693. switch (disp->var.bits_per_pixel) {
  694. #ifdef FBCON_HAS_CFB8
  695. case 8:
  696. rinfo->dispsw = accel ? fbcon_riva8 : fbcon_cfb8;
  697. disp->dispsw = &rinfo->dispsw;
  698. disp->line_length = disp->var.xres_virtual;
  699. disp->visual = FB_VISUAL_PSEUDOCOLOR;
  700. break;
  701. #endif
  702. #ifdef FBCON_HAS_CFB16
  703. case 16:
  704. rinfo->dispsw = accel ? fbcon_riva16 : fbcon_cfb16;
  705. disp->dispsw_data = &rinfo->con_cmap.cfb16;
  706. disp->dispsw = &rinfo->dispsw;
  707. disp->line_length = disp->var.xres_virtual * 2;
  708. disp->visual = FB_VISUAL_DIRECTCOLOR;
  709. break;
  710. #endif
  711. #ifdef FBCON_HAS_CFB32
  712. case 32:
  713. rinfo->dispsw = accel ? fbcon_riva32 : fbcon_cfb32;
  714. disp->dispsw_data = rinfo->con_cmap.cfb32;
  715. disp->dispsw = &rinfo->dispsw;
  716. disp->line_length = disp->var.xres_virtual * 4;
  717. disp->visual = FB_VISUAL_DIRECTCOLOR;
  718. break;
  719. #endif
  720. default:
  721. DPRINTK("Setting fbcon_dummy renderern");
  722. rinfo->dispsw = fbcon_dummy;
  723. disp->dispsw = &rinfo->dispsw;
  724. }
  726. /* FIXME: verify that the above code sets dsp->* fields correctly */
  728. if (rinfo->cursor) {
  729. rinfo->dispsw.cursor = rivafb_cursor;
  730. rinfo->dispsw.set_font = rivafb_set_font;
  731. }
  733. DPRINTK("EXITn");
  734. }
  736. /**
  737.  * riva_wclut - set CLUT entry
  738.  * @chip: pointer to RIVA_HW_INST object
  739.  * @regnum: register number
  740.  * @red: red component
  741.  * @green: green component
  742.  * @blue: blue component
  743.  *
  744.  * DESCRIPTION:
  745.  * Sets color register @regnum.
  746.  *
  747.  * CALLED FROM:
  748.  * riva_setcolreg()
  749.  */
  750. static void riva_wclut(RIVA_HW_INST *chip,
  751.        unsigned char regnum, unsigned char red,
  752.        unsigned char green, unsigned char blue)
  753. {
  754. VGA_WR08(chip->PDIO, 0x3c8, regnum);
  755. VGA_WR08(chip->PDIO, 0x3c9, red);
  756. VGA_WR08(chip->PDIO, 0x3c9, green);
  757. VGA_WR08(chip->PDIO, 0x3c9, blue);
  758. }
  760. /**
  761.  * riva_save_state - saves current chip state
  762.  * @rinfo: pointer to rivafb_info object containing info for current riva board
  763.  * @regs: pointer to riva_regs object
  764.  *
  765.  * DESCRIPTION:
  766.  * Saves current chip state to @regs.
  767.  *
  768.  * CALLED FROM:
  769.  * rivafb_init_one()
  770.  */
  771. /* from GGI */
  772. static void riva_save_state(struct rivafb_info *rinfo, struct riva_regs *regs)
  773. {
  774. int i;
  776. rinfo->riva.LockUnlock(&rinfo->riva, 0);
  778. rinfo->riva.UnloadStateExt(&rinfo->riva, &regs->ext);
  780. regs->misc_output = MISCin(rinfo);
  782. for (i = 0; i < NUM_CRT_REGS; i++) {
  783. regs->crtc[i] = CRTCin(rinfo, i);
  784. }
  786. for (i = 0; i < NUM_ATC_REGS; i++) {
  787. regs->attr[i] = ATTRin(rinfo, i);
  788. }
  790. for (i = 0; i < NUM_GRC_REGS; i++) {
  791. regs->gra[i] = GRAin(rinfo, i);
  792. }
  794. for (i = 0; i < NUM_SEQ_REGS; i++) {
  795. regs->seq[i] = SEQin(rinfo, i);
  796. }
  797. }
  799. /**
  800.  * riva_load_state - loads current chip state
  801.  * @rinfo: pointer to rivafb_info object containing info for current riva board
  802.  * @regs: pointer to riva_regs object
  803.  *
  804.  * DESCRIPTION:
  805.  * Loads chip state from @regs.
  806.  *
  807.  * CALLED FROM:
  808.  * riva_load_video_mode()
  809.  * rivafb_init_one()
  810.  * rivafb_remove_one()
  811.  */
  812. /* from GGI */
  813. static void riva_load_state(struct rivafb_info *rinfo, struct riva_regs *regs)
  814. {
  815. int i;
  816. RIVA_HW_STATE *state = &regs->ext;
  818. CRTCout(rinfo, 0x11, 0x00);
  820. rinfo->riva.LockUnlock(&rinfo->riva, 0);
  822. rinfo->riva.LoadStateExt(&rinfo->riva, state);
  824. MISCout(rinfo, regs->misc_output);
  826. for (i = 0; i < NUM_CRT_REGS; i++) {
  827. switch (i) {
  828. case 0x19:
  829. case 0x20 ... 0x40:
  830. break;
  831. default:
  832. CRTCout(rinfo, i, regs->crtc[i]);
  833. }
  834. }
  836. for (i = 0; i < NUM_ATC_REGS; i++) {
  837. ATTRout(rinfo, i, regs->attr[i]);
  838. }
  840. for (i = 0; i < NUM_GRC_REGS; i++) {
  841. GRAout(rinfo, i, regs->gra[i]);
  842. }
  844. for (i = 0; i < NUM_SEQ_REGS; i++) {
  845. SEQout(rinfo, i, regs->seq[i]);
  846. }
  847. }
  849. /**
  850.  * riva_load_video_mode - calculate timings
  851.  * @rinfo: pointer to rivafb_info object containing info for current riva board
  852.  * @video_mode: video mode to set
  853.  *
  854.  * DESCRIPTION:
  855.  * Calculate some timings and then send em off to riva_load_state().
  856.  *
  857.  * CALLED FROM:
  858.  * rivafb_set_var()
  859.  */
  860. static void riva_load_video_mode(struct rivafb_info *rinfo,
  861.  struct fb_var_screeninfo *video_mode)
  862. {
  863. struct riva_regs newmode;
  864. int bpp, width, hDisplaySize, hDisplay, hStart,
  865.     hEnd, hTotal, height, vDisplay, vStart, vEnd, vTotal, dotClock;
  867. /* time to calculate */
  869. rivafb_blank(1, (struct fb_info *)rinfo);
  871. bpp = video_mode->bits_per_pixel;
  872. if (bpp == 16 && video_mode->green.length == 5)
  873. bpp = 15;
  874. width = video_mode->xres_virtual;
  875. hDisplaySize = video_mode->xres;
  876. hDisplay = (hDisplaySize / 8) - 1;
  877. hStart = (hDisplaySize + video_mode->right_margin) / 8 + 2;
  878. hEnd = (hDisplaySize + video_mode->right_margin +
  879. video_mode->hsync_len) / 8 - 1;
  880. hTotal = (hDisplaySize + video_mode->right_margin +
  881.   video_mode->hsync_len + video_mode->left_margin) / 8 - 1;
  882. height = video_mode->yres_virtual;
  883. vDisplay = video_mode->yres - 1;
  884. vStart = video_mode->yres + video_mode->lower_margin - 1;
  885. vEnd = video_mode->yres + video_mode->lower_margin +
  886.        video_mode->vsync_len - 1;
  887. vTotal = video_mode->yres + video_mode->lower_margin +
  888.  video_mode->vsync_len + video_mode->upper_margin + 2;
  889. dotClock = 1000000000 / video_mode->pixclock;
  891. memcpy(&newmode, &reg_template, sizeof(struct riva_regs));
  893. newmode.crtc[0x0] = Set8Bits (hTotal - 4);
  894. newmode.crtc[0x1] = Set8Bits (hDisplay);
  895. newmode.crtc[0x2] = Set8Bits (hDisplay);
  896. newmode.crtc[0x3] = SetBitField (hTotal, 4: 0, 4:0) | SetBit (7);
  897. newmode.crtc[0x4] = Set8Bits (hStart);
  898. newmode.crtc[0x5] = SetBitField (hTotal, 5: 5, 7:7)
  899. | SetBitField (hEnd, 4: 0, 4:0);
  900. newmode.crtc[0x6] = SetBitField (vTotal, 7: 0, 7:0);
  901. newmode.crtc[0x7] = SetBitField (vTotal, 8: 8, 0:0)
  902. | SetBitField (vDisplay, 8: 8, 1:1)
  903. | SetBitField (vStart, 8: 8, 2:2)
  904. | SetBitField (vDisplay, 8: 8, 3:3)
  905. | SetBit (4)
  906. | SetBitField (vTotal, 9: 9, 5:5)
  907. | SetBitField (vDisplay, 9: 9, 6:6)
  908. | SetBitField (vStart, 9: 9, 7:7);
  909. newmode.crtc[0x9] = SetBitField (vDisplay, 9: 9, 5:5)
  910. | SetBit (6);
  911. newmode.crtc[0x10] = Set8Bits (vStart);
  912. newmode.crtc[0x11] = SetBitField (vEnd, 3: 0, 3:0)
  913. | SetBit (5);
  914. newmode.crtc[0x12] = Set8Bits (vDisplay);
  915. newmode.crtc[0x13] = ((width / 8) * ((bpp + 1) / 8)) & 0xFF;
  916. newmode.crtc[0x15] = Set8Bits (vDisplay);
  917. newmode.crtc[0x16] = Set8Bits (vTotal + 1);
  919. newmode.ext.bpp = bpp;
  920. newmode.ext.width = width;
  921. newmode.ext.height = height;
  923. rinfo->riva.CalcStateExt(&rinfo->riva, &newmode.ext, bpp, width,
  924.   hDisplaySize, hDisplay, hStart, hEnd,
  925.   hTotal, height, vDisplay, vStart, vEnd,
  926.   vTotal, dotClock);
  928. rinfo->current_state = newmode;
  929. riva_load_state(rinfo, &rinfo->current_state);
  931. rinfo->riva.LockUnlock(&rinfo->riva, 0); /* important for HW cursor */
  932. rivafb_download_cursor(rinfo);
  933. }
  935. /**
  936.  * riva_board_list_add - maintains board list
  937.  * @board_list: root node of list of boards
  938.  * @new_node: new node to be added
  939.  *
  940.  * DESCRIPTION:
  941.  * Adds @new_node to the list referenced by @board_list.
  942.  *
  943.  * RETURNS:
  944.  * New root node
  945.  *
  946.  * CALLED FROM:
  947.  * rivafb_init_one()
  948.  */
  949. static struct rivafb_info *riva_board_list_add(struct rivafb_info *board_list,
  950.        struct rivafb_info *new_node)
  951. {
  952. struct rivafb_info *i_p = board_list;
  954. new_node->next = NULL;
  956. if (board_list == NULL)
  957. return new_node;
  959. while (i_p->next != NULL)
  960. i_p = i_p->next;
  961. i_p->next = new_node;
  963. return board_list;
  964. }
  966. /**
  967.  * riva_board_list_del - maintains board list
  968.  * @board_list: root node of list of boards
  969.  * @del_node: node to be removed
  970.  *
  971.  * DESCRIPTION:
  972.  * Removes @del_node from the list referenced by @board_list.
  973.  *
  974.  * RETURNS:
  975.  * New root node
  976.  *
  977.  * CALLED FROM:
  978.  * rivafb_remove_one()
  979.  */
  980. static struct rivafb_info *riva_board_list_del(struct rivafb_info *board_list,
  981.        struct rivafb_info *del_node)
  982. {
  983. struct rivafb_info *i_p = board_list;
  985. if (board_list == del_node)
  986. return del_node->next;
  988. while (i_p->next != del_node)
  989. i_p = i_p->next;
  990. i_p->next = del_node->next;
  992. return board_list;
  993. }
  995. /**
  996.  * rivafb_do_maximize - 
  997.  * @rinfo: pointer to rivafb_info object containing info for current riva board
  998.  * @var:
  999.  * @v:
  1000.  * @nom:
  1001.  * @den:
  1002.  *
  1003.  * DESCRIPTION:
  1004.  * .
  1005.  *
  1006.  * RETURNS:
  1007.  * -EINVAL on failure, 0 on success
  1008.  * 
  1009.  *
  1010.  * CALLED FROM:
  1011.  * rivafb_set_var()
  1012.  */
  1013. static int rivafb_do_maximize(struct rivafb_info *rinfo,
  1014.       struct fb_var_screeninfo *var,
  1015.       struct fb_var_screeninfo *v,
  1016.       int nom, int den)
  1017. {
  1018. static struct {
  1019. int xres, yres;
  1020. } modes[] = {
  1021. {1600, 1280},
  1022. {1280, 1024},
  1023. {1024, 768},
  1024. {800, 600},
  1025. {640, 480},
  1026. {-1, -1}
  1027. };
  1028. int i;
  1030. /* use highest possible virtual resolution */
  1031. if (v->xres_virtual == -1 && v->yres_virtual == -1) {
  1032. printk(KERN_WARNING PFX
  1033.        "using maximum available virtual resolutionn");
  1034. for (i = 0; modes[i].xres != -1; i++) {
  1035. if (modes[i].xres * nom / den * modes[i].yres <
  1036.     rinfo->ram_amount / 2)
  1037. break;
  1038. }
  1039. if (modes[i].xres == -1) {
  1040. printk(KERN_ERR PFX
  1041.        "could not find a virtual resolution that fits into video memory!!n");
  1042. DPRINTK("EXIT - EINVAL errorn");
  1043. return -EINVAL;
  1044. }
  1045. v->xres_virtual = modes[i].xres;
  1046. v->yres_virtual = modes[i].yres;
  1048. printk(KERN_INFO PFX
  1049.        "virtual resolution set to maximum of %dx%dn",
  1050.        v->xres_virtual, v->yres_virtual);
  1051. } else if (v->xres_virtual == -1) {
  1052. v->xres_virtual = (rinfo->ram_amount * den /
  1053. (nom * v->yres_virtual * 2)) & ~15;
  1054. printk(KERN_WARNING PFX
  1055.        "setting virtual X resolution to %dn", v->xres_virtual);
  1056. } else if (v->yres_virtual == -1) {
  1057. v->xres_virtual = (v->xres_virtual + 15) & ~15;
  1058. v->yres_virtual = rinfo->ram_amount * den /
  1059. (nom * v->xres_virtual * 2);
  1060. printk(KERN_WARNING PFX
  1061.        "setting virtual Y resolution to %dn", v->yres_virtual);
  1062. } else {
  1063. v->xres_virtual = (v->xres_virtual + 15) & ~15;
  1064. if (v->xres_virtual * nom / den * v->yres_virtual > rinfo->ram_amount) {
  1065. printk(KERN_ERR PFX
  1066.        "mode %dx%dx%d rejected...resolution too high to fit into video memory!n",
  1067.        var->xres, var->yres, var->bits_per_pixel);
  1068. DPRINTK("EXIT - EINVAL errorn");
  1069. return -EINVAL;
  1070. }
  1071. }
  1073. if (v->xres_virtual * nom / den >= 8192) {
  1074. printk(KERN_WARNING PFX
  1075.        "virtual X resolution (%d) is too high, lowering to %dn",
  1076.        v->xres_virtual, 8192 * den / nom - 16);
  1077. v->xres_virtual = 8192 * den / nom - 16;
  1078. }
  1080. if (v->xres_virtual < v->xres) {
  1081. printk(KERN_ERR PFX
  1082.        "virtual X resolution (%d) is smaller than realn", v->xres_virtual);
  1083. return -EINVAL;
  1084. }
  1086. if (v->yres_virtual < v->yres) {
  1087. printk(KERN_ERR PFX
  1088.        "virtual Y resolution (%d) is smaller than realn", v->yres_virtual);
  1089. return -EINVAL;
  1090. }
  1092. return 0;
  1093. }
  1097. /* ------------------------------------------------------------------------- *
  1098.  *
  1099.  * internal fb_ops helper functions
  1100.  *
  1101.  * ------------------------------------------------------------------------- */
  1103. /**
  1104.  * riva_get_cmap_len - query current color map length
  1105.  * @var: standard kernel fb changeable data
  1106.  *
  1107.  * DESCRIPTION:
  1108.  * Get current color map length.
  1109.  *
  1110.  * RETURNS:
  1111.  * Length of color map
  1112.  *
  1113.  * CALLED FROM:
  1114.  * riva_getcolreg()
  1115.  * riva_setcolreg()
  1116.  * rivafb_get_cmap()
  1117.  * rivafb_set_cmap()
  1118.  */
  1119. static int riva_get_cmap_len(const struct fb_var_screeninfo *var)
  1120. {
  1121. int rc = 16; /* reasonable default */
  1123. assert(var != NULL);
  1125. switch (var->bits_per_pixel) {
  1126. #ifdef FBCON_HAS_CFB8
  1127. case 8:
  1128. rc = 256; /* pseudocolor... 256 entries HW palette */
  1129. break;
  1130. #endif
  1131. #ifdef FBCON_HAS_CFB16
  1132. case 15:
  1133. rc = 15; /* fix for 15 bpp depths on Riva 128 based cards */
  1134. break;
  1135. case 16:
  1136. rc = 16; /* directcolor... 16 entries SW palette */
  1137. break; /* Mystique: truecolor, 16 entries SW palette, HW palette hardwired into 1:1 mapping */
  1138. #endif
  1139. #ifdef FBCON_HAS_CFB32
  1140. case 32:
  1141. rc = 16; /* directcolor... 16 entries SW palette */
  1142. break; /* Mystique: truecolor, 16 entries SW palette, HW palette hardwired into 1:1 mapping */
  1143. #endif
  1144. default:
  1145. /* should not occur */
  1146. break;
  1147. }
  1149. return rc;
  1150. }
  1152. /**
  1153.  * riva_getcolreg
  1154.  * @regno: register index
  1155.  * @red: red component
  1156.  * @green: green component
  1157.  * @blue: blue component
  1158.  * @transp: transparency
  1159.  * @info: pointer to rivafb_info object containing info for current riva board
  1160.  *
  1161.  * DESCRIPTION:
  1162.  * Read a single color register and split it into colors/transparent.
  1163.  * The return values must have a 16 bit magnitude.
  1164.  *
  1165.  * RETURNS:
  1166.  * Return != 0 for invalid regno.
  1167.  *
  1168.  * CALLED FROM:
  1169.  * rivafb_get_cmap()
  1170.  * rivafb_switch()
  1171.  * fbcmap.c:fb_get_cmap()
  1172.  * fbgen.c:fbgen_get_cmap()
  1173.  * fbgen.c:fbgen_switch()
  1174.  */
  1175. static int riva_getcolreg(unsigned regno, unsigned *red, unsigned *green,
  1176.   unsigned *blue, unsigned *transp,
  1177.   struct fb_info *info)
  1178. {
  1179. struct rivafb_info *rivainfo = (struct rivafb_info *)info;
  1181. if (regno >= riva_get_cmap_len(&rivainfo->currcon_display->var))
  1182. return 1;
  1184. *red = rivainfo->palette[regno].red;
  1185. *green = rivainfo->palette[regno].green;
  1186. *blue = rivainfo->palette[regno].blue;
  1187. *transp = 0;
  1189. return 0;
  1190. }
  1192. /**
  1193.  * riva_setcolreg
  1194.  * @regno: register index
  1195.  * @red: red component
  1196.  * @green: green component
  1197.  * @blue: blue component
  1198.  * @transp: transparency
  1199.  * @info: pointer to rivafb_info object containing info for current riva board
  1200.  *
  1201.  * DESCRIPTION:
  1202.  * Set a single color register. The values supplied have a 16 bit
  1203.  * magnitude.
  1204.  *
  1205.  * RETURNS:
  1206.  * Return != 0 for invalid regno.
  1207.  *
  1208.  * CALLED FROM:
  1209.  * rivafb_set_cmap()
  1210.  * fbcmap.c:fb_set_cmap()
  1211.  * fbgen.c:fbgen_get_cmap()
  1212.  * fbgen.c:fbgen_install_cmap()
  1213.  * fbgen.c:fbgen_set_var()
  1214.  * fbgen.c:fbgen_switch()
  1215.  * fbgen.c:fbgen_blank()
  1216.  * fbgen.c:fbgen_blank()
  1217.  */
  1218. static int riva_setcolreg(unsigned regno, unsigned red, unsigned green,
  1219.   unsigned blue, unsigned transp,
  1220.   struct fb_info *info)
  1221. {
  1222. struct rivafb_info *rivainfo = (struct rivafb_info *)info;
  1223. RIVA_HW_INST *chip = &rivainfo->riva;
  1224. struct display *p;
  1226. DPRINTK("ENTERn");
  1228. assert(rivainfo != NULL);
  1229. assert(rivainfo->currcon_display != NULL);
  1231. p = rivainfo->currcon_display;
  1233. if (regno >= riva_get_cmap_len(&p->var))
  1234. return -EINVAL;
  1236. rivainfo->palette[regno].red = red;
  1237. rivainfo->palette[regno].green = green;
  1238. rivainfo->palette[regno].blue = blue;
  1240. if (p->var.grayscale) {
  1241. /* gray = 0.30*R + 0.59*G + 0.11*B */
  1242. red = green = blue =
  1243.     (red * 77 + green * 151 + blue * 28) >> 8;
  1244. }
  1246. switch (p->var.bits_per_pixel) {
  1247. #ifdef FBCON_HAS_CFB8
  1248. case 8:
  1249. /* "transparent" stuff is completely ignored. */
  1250. riva_wclut(chip, regno, red >> 8, green >> 8, blue >> 8);
  1251. break;
  1252. #endif /* FBCON_HAS_CFB8 */
  1253. #ifdef FBCON_HAS_CFB16
  1254. case 16:
  1255. assert(regno < 16);
  1256. if (p->var.green.length == 5) {
  1257. /* 0rrrrrgg gggbbbbb */
  1258. rivainfo->con_cmap.cfb16[regno] =
  1259.     ((red & 0xf800) >> 1) |
  1260.     ((green & 0xf800) >> 6) | ((blue & 0xf800) >> 11);
  1261. } else {
  1262. /* rrrrrggg gggbbbbb */
  1263. rivainfo->con_cmap.cfb16[regno] =
  1264.     ((red & 0xf800) >> 0) |
  1265.     ((green & 0xf800) >> 5) | ((blue & 0xf800) >> 11);
  1266. }
  1267. break;
  1268. #endif /* FBCON_HAS_CFB16 */
  1269. #ifdef FBCON_HAS_CFB32
  1270. case 32:
  1271. assert(regno < 16);
  1272. rivainfo->con_cmap.cfb32[regno] =
  1273.     ((red & 0xff00) << 8) |
  1274.     ((green & 0xff00)) | ((blue & 0xff00) >> 8);
  1275. break;
  1276. #endif /* FBCON_HAS_CFB32 */
  1277. default:
  1278. /* do nothing */
  1279. break;
  1280. }
  1282. return 0;
  1283. }
  1287. /* ------------------------------------------------------------------------- *
  1288.  *
  1289.  * framebuffer operations
  1290.  *
  1291.  * ------------------------------------------------------------------------- */
  1293. static int rivafb_get_fix(struct fb_fix_screeninfo *fix, int con,
  1294.   struct fb_info *info)
  1295. {
  1296. struct rivafb_info *rivainfo = (struct rivafb_info *)info;
  1297. struct display *p;
  1299. DPRINTK("ENTERn");
  1301. assert(fix != NULL);
  1302. assert(info != NULL);
  1303. assert(rivainfo->drvr_name && rivainfo->drvr_name[0]);
  1304. assert(rivainfo->fb_base_phys > 0);
  1305. assert(rivainfo->ram_amount > 0);
  1307. p = (con < 0) ? rivainfo->info.disp : &fb_display[con];
  1309. memset(fix, 0, sizeof(struct fb_fix_screeninfo));
  1310. sprintf(fix->id, "nVidia %s", rivainfo->drvr_name);
  1312. fix->smem_start = rivainfo->fb_base_phys;
  1313. fix->smem_len = rivainfo->ram_amount;
  1315. fix->type = p->type;
  1316. fix->type_aux = p->type_aux;
  1317. fix->visual = p->visual;
  1319. fix->xpanstep = 1;
  1320. fix->ypanstep = 1;
  1321. fix->ywrapstep = 0; /* FIXME: no ywrap for now */
  1323. fix->line_length = p->line_length;
  1325. fix->mmio_start = rivainfo->ctrl_base_phys;
  1326. fix->mmio_len = rivainfo->base0_region_size;
  1327. fix->smem_start = rivainfo->fb_base_phys;
  1328. fix->smem_len = rivainfo->base1_region_size;
  1330. switch (rivainfo->riva.Architecture) {
  1331. case NV_ARCH_03:
  1332. fix->accel = FB_ACCEL_NV3;
  1333. break;
  1334. case NV_ARCH_04: /* riva_hw.c now doesn't distinguish between TNT & TNT2 */
  1335. fix->accel = FB_ACCEL_NV4;
  1336. break;
  1337. case NV_ARCH_10: /* FIXME: ID for GeForce */
  1338. case NV_ARCH_20:
  1339. fix->accel = FB_ACCEL_NV4;
  1340. break;
  1342. }
  1344. DPRINTK("EXIT, returning 0n");
  1346. return 0;
  1347. }
  1349. static int rivafb_get_var(struct fb_var_screeninfo *var, int con,
  1350.   struct fb_info *info)
  1351. {
  1352. struct rivafb_info *rivainfo = (struct rivafb_info *)info;
  1354. DPRINTK("ENTERn");
  1356. assert(info != NULL);
  1357. assert(var != NULL);
  1359. *var = (con < 0) ? rivainfo->disp.var : fb_display[con].var;
  1361. DPRINTK("EXIT, returning 0n");
  1363. return 0;
  1364. }
  1366. static int rivafb_set_var(struct fb_var_screeninfo *var, int con,
  1367.   struct fb_info *info)
  1368. {
  1369. struct rivafb_info *rivainfo = (struct rivafb_info *)info;
  1370. struct display *dsp;
  1371. struct fb_var_screeninfo v;
  1372. int nom, den; /* translating from pixels->bytes */
  1373. int accel;
  1374. unsigned chgvar = 0;
  1376. DPRINTK("ENTERn");
  1378. assert(info != NULL);
  1379. assert(var != NULL);
  1381. DPRINTK("Requested: %dx%dx%dn", var->xres, var->yres,
  1382. var->bits_per_pixel);
  1383. DPRINTK("  virtual: %dx%dn", var->xres_virtual,
  1384. var->yres_virtual);
  1385. DPRINTK("   offset: (%d,%d)n", var->xoffset, var->yoffset);
  1386. DPRINTK("grayscale: %dn", var->grayscale);
  1388. dsp = (con < 0) ? rivainfo->info.disp : &fb_display[con];
  1389. assert(dsp != NULL);
  1391. /* if var has changed, we should call changevar() later */
  1392. if (con >= 0) {
  1393. chgvar = ((dsp->var.xres != var->xres) ||
  1394.   (dsp->var.yres != var->yres) ||
  1395.   (dsp->var.xres_virtual != var->xres_virtual) ||
  1396.   (dsp->var.yres_virtual != var->yres_virtual) ||
  1397.   (dsp->var.accel_flags != var->accel_flags) ||
  1398.   (dsp->var.bits_per_pixel != var->bits_per_pixel)
  1399.   || memcmp(&dsp->var.red, &var->red,
  1400.     sizeof(var->red))
  1401.   || memcmp(&dsp->var.green, &var->green,
  1402.     sizeof(var->green))
  1403.   || memcmp(&dsp->var.blue, &var->blue,
  1404.     sizeof(var->blue)));
  1405. }
  1407. memcpy(&v, var, sizeof(v));
  1409. accel = v.accel_flags & FB_ACCELF_TEXT;
  1411. switch (v.bits_per_pixel) {
  1412. #ifdef FBCON_HAS_CFB8
  1413. case 1 ... 8:
  1414. v.bits_per_pixel = 8;
  1415. nom = 1;
  1416. den = 1;
  1417. v.red.offset = 0;
  1418. v.red.length = 8;
  1419. v.green.offset = 0;
  1420. v.green.length = 8;
  1421. v.blue.offset = 0;
  1422. v.blue.length = 8;
  1423. break;
  1424. #endif
  1425. #ifdef FBCON_HAS_CFB16
  1426. case 9 ... 15:
  1427. v.green.length = 5;
  1428. /* fall through */
  1429. case 16:
  1430. v.bits_per_pixel = 16;
  1431. nom = 2;
  1432. den = 1;
  1433. if (v.green.length == 5) {
  1434. /* 0rrrrrgg gggbbbbb */
  1435. v.red.offset = 10;
  1436. v.green.offset = 5;
  1437. v.blue.offset = 0;
  1438. v.red.length = 5;
  1439. v.green.length = 5;
  1440. v.blue.length = 5;
  1441. } else {
  1442. /* rrrrrggg gggbbbbb */
  1443. v.red.offset = 11;
  1444. v.green.offset = 5;
  1445. v.blue.offset = 0;
  1446. v.red.length = 5;
  1447. v.green.length = 6;
  1448. v.blue.length = 5;
  1449. }
  1450. break;
  1451. #endif
  1452. #ifdef FBCON_HAS_CFB32
  1453. case 17 ... 32:
  1454. v.bits_per_pixel = 32;
  1455. nom = 4;
  1456. den = 1;
  1457. v.red.offset = 16;
  1458. v.green.offset = 8;
  1459. v.blue.offset = 0;
  1460. v.red.length = 8;
  1461. v.green.length = 8;
  1462. v.blue.length = 8;
  1463. break;
  1464. #endif
  1465. default:
  1466. printk(KERN_ERR PFX
  1467.        "mode %dx%dx%d rejected...color depth not supported.n",
  1468.        var->xres, var->yres, var->bits_per_pixel);
  1469. DPRINTK("EXIT, returning -EINVALn");
  1470. return -EINVAL;
  1471. }
  1473. if (rivafb_do_maximize(rivainfo, var, &v, nom, den) < 0)
  1474. return -EINVAL;
  1476. if (v.xoffset < 0)
  1477. v.xoffset = 0;
  1478. if (v.yoffset < 0)
  1479. v.yoffset = 0;
  1481. /* truncate xoffset and yoffset to maximum if too high */
  1482. if (v.xoffset > v.xres_virtual - v.xres)
  1483. v.xoffset = v.xres_virtual - v.xres - 1;
  1485. if (v.yoffset > v.yres_virtual - v.yres)
  1486. v.yoffset = v.yres_virtual - v.yres - 1;
  1488. v.red.msb_right =
  1489.     v.green.msb_right =
  1490.     v.blue.msb_right =
  1491.     v.transp.offset = v.transp.length = v.transp.msb_right = 0;
  1493. switch (v.activate & FB_ACTIVATE_MASK) {
  1494. case FB_ACTIVATE_TEST:
  1495. DPRINTK("EXIT - FB_ACTIVATE_TESTn");
  1496. return 0;
  1497. case FB_ACTIVATE_NXTOPEN: /* ?? */
  1498. case FB_ACTIVATE_NOW:
  1499. break; /* continue */
  1500. default:
  1501. DPRINTK("EXIT - unknown activation typen");
  1502. return -EINVAL; /* unknown */
  1503. }
  1505. memcpy(&dsp->var, &v, sizeof(v));
  1506. if (chgvar) {
  1507. riva_set_dispsw(rivainfo, dsp);
  1509. if (accel) {
  1510. if (nomove)
  1511. dsp->scrollmode = SCROLL_YNOMOVE;
  1512. else
  1513. dsp->scrollmode = 0;
  1514. } else
  1515. dsp->scrollmode = SCROLL_YREDRAW;
  1517. if (info && info->changevar)
  1518. info->changevar(con);
  1519. }
  1521. rivafb_create_cursor(rivainfo, fontwidth(dsp), fontheight(dsp));
  1522. riva_load_video_mode(rivainfo, &v);
  1523. if (accel) riva_setup_accel(rivainfo);
  1525. DPRINTK("EXIT, returning 0n");
  1526. return 0;
  1527. }
  1529. static int rivafb_get_cmap(struct fb_cmap *cmap, int kspc, int con,
  1530.    struct fb_info *info)
  1531. {
  1532. struct rivafb_info *rivainfo = (struct rivafb_info *)info;
  1533. struct display *dsp;
  1535. DPRINTK("ENTERn");
  1537. assert(rivainfo != NULL);
  1538. assert(cmap != NULL);
  1540. dsp = (con < 0) ? rivainfo->info.disp : &fb_display[con];
  1542. if (con == rivainfo->currcon) { /* current console? */
  1543. int rc = fb_get_cmap(cmap, kspc, riva_getcolreg, info);
  1544. DPRINTK("EXIT - returning %dn", rc);
  1545. return rc;
  1546. } else if (dsp->cmap.len) /* non default colormap? */
  1547. fb_copy_cmap(&dsp->cmap, cmap, kspc ? 0 : 2);
  1548. else
  1549. fb_copy_cmap(fb_default_cmap
  1550.      (riva_get_cmap_len(&dsp->var)), cmap,
  1551.      kspc ? 0 : 2);
  1553. DPRINTK("EXIT, returning 0n");
  1555. return 0;
  1556. }
  1558. static int rivafb_set_cmap(struct fb_cmap *cmap, int kspc, int con,
  1559.    struct fb_info *info)
  1560. {
  1561. struct rivafb_info *rivainfo = (struct rivafb_info *)info;
  1562. struct display *dsp;
  1563. unsigned int cmap_len;
  1565. DPRINTK("ENTERn");
  1567. assert(rivainfo != NULL);
  1568. assert(cmap != NULL);
  1570. dsp = (con < 0) ? rivainfo->info.disp : &fb_display[con];
  1572. cmap_len = riva_get_cmap_len(&dsp->var);
  1573. if (dsp->cmap.len != cmap_len) {
  1574. int err = fb_alloc_cmap(&dsp->cmap, cmap_len, 0);
  1575. if (err) {
  1576. DPRINTK("EXIT - returning %dn", err);
  1577. return err;
  1578. }
  1579. }
  1580. if (con == rivainfo->currcon) { /* current console? */
  1581. int rc = fb_set_cmap(cmap, kspc, riva_setcolreg, info);
  1582. DPRINTK("EXIT - returning %dn", rc);
  1583. return rc;
  1584. } else
  1585. fb_copy_cmap(cmap, &dsp->cmap, kspc ? 0 : 1);
  1587. DPRINTK("EXIT, returning 0n");
  1589. return 0;
  1590. }
  1592. /**
  1593.  * rivafb_pan_display
  1594.  * @var: standard kernel fb changeable data
  1595.  * @con: TODO
  1596.  * @info: pointer to rivafb_info object containing info for current riva board
  1597.  *
  1598.  * DESCRIPTION:
  1599.  * Pan (or wrap, depending on the `vmode' field) the display using the
  1600.  * `xoffset' and `yoffset' fields of the `var' structure.
  1601.  * If the values don't fit, return -EINVAL.
  1602.  *
  1603.  * This call looks only at xoffset, yoffset and the FB_VMODE_YWRAP flag
  1604.  */
  1605. static int rivafb_pan_display(struct fb_var_screeninfo *var, int con,
  1606.       struct fb_info *info)
  1607. {
  1608. unsigned int base;
  1609. struct display *dsp;
  1610. struct rivafb_info *rivainfo = (struct rivafb_info *)info;
  1612. DPRINTK("ENTERn");
  1614. assert(rivainfo != NULL);
  1616. if (var->xoffset > (var->xres_virtual - var->xres))
  1617. return -EINVAL;
  1618. if (var->yoffset > (var->yres_virtual - var->yres))
  1619. return -EINVAL;
  1621. dsp = (con < 0) ? rivainfo->info.disp : &fb_display[con];
  1623. if (var->vmode & FB_VMODE_YWRAP) {
  1624. if (var->yoffset < 0
  1625.     || var->yoffset >= dsp->var.yres_virtual
  1626.     || var->xoffset) return -EINVAL;
  1627. } else {
  1628. if (var->xoffset + dsp->var.xres > dsp->var.xres_virtual ||
  1629.     var->yoffset + dsp->var.yres > dsp->var.yres_virtual)
  1630. return -EINVAL;
  1631. }
  1633. base = var->yoffset * dsp->line_length + var->xoffset;
  1635. if (con == rivainfo->currcon) {
  1636. rivainfo->riva.SetStartAddress(&rivainfo->riva, base);
  1637. }
  1639. dsp->var.xoffset = var->xoffset;
  1640. dsp->var.yoffset = var->yoffset;
  1642. if (var->vmode & FB_VMODE_YWRAP)
  1643. dsp->var.vmode |= FB_VMODE_YWRAP;
  1644. else
  1645. dsp->var.vmode &= ~FB_VMODE_YWRAP;
  1647. DPRINTK("EXIT, returning 0n");
  1649. return 0;
  1650. }
  1652. static int rivafb_ioctl(struct inode *inode, struct file *file, unsigned int cmd,
  1653. unsigned long arg, int con, struct fb_info *info)
  1654. {
  1655. struct rivafb_info *rivainfo = (struct rivafb_info *)info;
  1657. DPRINTK("ENTERn");
  1659. assert(rivainfo != NULL);
  1661. /* no rivafb-specific ioctls */
  1663. DPRINTK("EXIT, returning -EINVALn");
  1665. return -EINVAL;
  1666. }
  1668. static int rivafb_rasterimg(struct fb_info *info, int start)
  1669. {
  1670. struct rivafb_info *rinfo = (struct rivafb_info *)info;
  1672. wait_for_idle(rinfo);
  1674. return 0;
  1675. }
  1677. static int rivafb_switch(int con, struct fb_info *info)
  1678. {
  1679. struct rivafb_info *rivainfo = (struct rivafb_info *)info;
  1680. struct fb_cmap *cmap;
  1681. struct display *dsp;
  1683. DPRINTK("ENTERn");
  1685. assert(rivainfo != NULL);
  1687. dsp = (con < 0) ? rivainfo->info.disp : &fb_display[con];
  1689. if (rivainfo->currcon >= 0) {
  1690. /* Do we have to save the colormap? */
  1691. cmap = &(rivainfo->currcon_display->cmap);
  1692. DPRINTK("switch1: con = %d, cmap.len = %dn",
  1693.  rivainfo->currcon, cmap->len);
  1695. if (cmap->len) {
  1696. DPRINTK("switch1a: %p %p %p %pn", cmap->red,
  1697.  cmap->green, cmap->blue, cmap->transp);
  1698. fb_get_cmap(cmap, 1, riva_getcolreg, info);
  1699. }
  1700. }
  1701. rivainfo->currcon = con;
  1702. rivainfo->currcon_display = dsp;
  1704. rivafb_set_var(&dsp->var, con, info);
  1705. riva_set_dispsw(rivainfo, dsp);
  1707. DPRINTK("EXIT, returning 0n");
  1708. return 0;
  1709. }
  1711. static int rivafb_updatevar(int con, struct fb_info *info)
  1712. {
  1713. int rc;
  1715. DPRINTK("ENTERn");
  1717. rc = (con < 0) ? -EINVAL : rivafb_pan_display(&fb_display[con].var,
  1718.       con, info);
  1719. DPRINTK("EXIT, returning %dn", rc);
  1720. return rc;
  1721. }
  1723. static void rivafb_blank(int blank, struct fb_info *info)
  1724. {
  1725. unsigned char tmp, vesa;
  1726. struct rivafb_info *rinfo = (struct rivafb_info *)info;
  1728. DPRINTK("ENTERn");
  1730. assert(rinfo != NULL);
  1732. tmp = SEQin(rinfo, 0x01) & ~0x20; /* screen on/off */
  1733. vesa = CRTCin(rinfo, 0x1a) & ~0xc0; /* sync on/off */
  1735. if (blank) {
  1736. tmp |= 0x20;
  1737. switch (blank - 1) {
  1738. case VESA_NO_BLANKING:
  1739. break;
  1740. case VESA_VSYNC_SUSPEND:
  1741. vesa |= 0x80;
  1742. break;
  1743. case VESA_HSYNC_SUSPEND:
  1744. vesa |= 0x40;
  1745. break;
  1746. case VESA_POWERDOWN:
  1747. vesa |= 0xc0;
  1748. break;
  1749. }
  1750. }
  1752. SEQout(rinfo, 0x01, tmp);
  1753. CRTCout(rinfo, 0x1a, vesa);
  1755. DPRINTK("EXITn");
  1756. }
  1760. /* ------------------------------------------------------------------------- *
  1761.  *
  1762.  * initialization helper functions
  1763.  *
  1764.  * ------------------------------------------------------------------------- */
  1766. /* kernel interface */
  1767. static struct fb_ops riva_fb_ops = {
  1768. owner: THIS_MODULE,
  1769. fb_get_fix: rivafb_get_fix,
  1770. fb_get_var: rivafb_get_var,
  1771. fb_set_var: rivafb_set_var,
  1772. fb_get_cmap: rivafb_get_cmap,
  1773. fb_set_cmap: rivafb_set_cmap,
  1774. fb_pan_display: rivafb_pan_display,
  1775. fb_ioctl: rivafb_ioctl,
  1776. fb_rasterimg: rivafb_rasterimg,
  1777. };
  1779. static int __devinit riva_init_disp_var(struct rivafb_info *rinfo)
  1780. {
  1781. #ifndef MODULE
  1782. if (mode_option)
  1783. fb_find_mode(&rinfo->disp.var, &rinfo->info, mode_option,
  1784.      NULL, 0, NULL, 8);
  1785. #endif
  1786. return 0;
  1787. }
  1789. static int __devinit riva_init_disp(struct rivafb_info *rinfo)
  1790. {
  1791. struct fb_info *info;
  1792. struct display *disp;
  1794. DPRINTK("ENTERn");
  1796. assert(rinfo != NULL);
  1798. info = &rinfo->info;
  1799. disp = &rinfo->disp;
  1801. disp->var = rivafb_default_var;
  1803. if (noaccel)
  1804. disp->var.accel_flags &= ~FB_ACCELF_TEXT;
  1805. else
  1806. disp->var.accel_flags |= FB_ACCELF_TEXT;
  1808. info->disp = disp;
  1810. /* FIXME: assure that disp->cmap is completely filled out */
  1812. rinfo->currcon_display = disp;
  1814. if ((riva_init_disp_var(rinfo)) < 0) {
  1815. DPRINTK("EXIT, returning -1n");
  1816. return -1;
  1817. }
  1819. riva_set_dispsw(rinfo, disp);
  1821. DPRINTK("EXIT, returning 0n");
  1822. return 0;
  1824. }
  1826. static int __devinit riva_set_fbinfo(struct rivafb_info *rinfo)
  1827. {
  1828. struct fb_info *info;
  1830. assert(rinfo != NULL);
  1832. info = &rinfo->info;
  1834. strcpy(info->modename, rinfo->drvr_name);
  1835. info->node = -1;
  1836. info->flags = FBINFO_FLAG_DEFAULT;
  1837. info->fbops = &riva_fb_ops;
  1839. /* FIXME: set monspecs to what??? */
  1841. info->display_fg = NULL;
  1842. strncpy(info->fontname, fontname, sizeof(info->fontname));
  1843. info->fontname[sizeof(info->fontname) - 1] = 0;
  1845. info->changevar = NULL;
  1846. info->switch_con = rivafb_switch;
  1847. info->updatevar = rivafb_updatevar;
  1848. info->blank = rivafb_blank;
  1850. if (riva_init_disp(rinfo) < 0) /* must be done last */
  1851. return -1;
  1853. return 0;
  1854. }
  1858. /* ------------------------------------------------------------------------- *
  1859.  *
  1860.  * PCI bus
  1861.  *
  1862.  * ------------------------------------------------------------------------- */
  1864. static int __devinit rivafb_init_one(struct pci_dev *pd,
  1865.      const struct pci_device_id *ent)
  1866. {
  1867. struct rivafb_info *rinfo;
  1868. struct riva_chip_info *rci = &riva_chip_info[ent->driver_data];
  1870. assert(pd != NULL);
  1871. assert(rci != NULL);
  1873. rinfo = kmalloc(sizeof(struct rivafb_info), GFP_KERNEL);
  1874. if (!rinfo)
  1875. goto err_out;
  1877. memset(rinfo, 0, sizeof(struct rivafb_info));
  1879. rinfo->drvr_name = rci->name;
  1880. rinfo->riva.Architecture = rci->arch_rev;
  1882. rinfo->pd = pd;
  1883. rinfo->base0_region_size = pci_resource_len(pd, 0);
  1884. rinfo->base1_region_size = pci_resource_len(pd, 1);
  1886. assert(rinfo->base0_region_size >= 0x00800000); /* from GGI */
  1887. assert(rinfo->base1_region_size >= 0x01000000); /* from GGI */
  1889. rinfo->ctrl_base_phys = pci_resource_start(rinfo->pd, 0);
  1890. rinfo->fb_base_phys = pci_resource_start(rinfo->pd, 1);
  1892. if (!request_mem_region(rinfo->ctrl_base_phys,
  1893. rinfo->base0_region_size, "rivafb")) {
  1894. printk(KERN_ERR PFX "cannot reserve MMIO regionn");
  1895. goto err_out_kfree;
  1896. }
  1898. if (!request_mem_region(rinfo->fb_base_phys,
  1899. rinfo->base1_region_size, "rivafb")) {
  1900. printk(KERN_ERR PFX "cannot reserve FB regionn");
  1901. goto err_out_free_base0;
  1902. }
  1904. rinfo->ctrl_base = ioremap(rinfo->ctrl_base_phys,
  1905.    rinfo->base0_region_size);
  1906. if (!rinfo->ctrl_base) {
  1907. printk(KERN_ERR PFX "cannot ioremap MMIO basen");
  1908. goto err_out_free_base1;
  1909. }
  1911. rinfo->fb_base = ioremap(rinfo->fb_base_phys,
  1912.  rinfo->base1_region_size);
  1913. if (!rinfo->fb_base) {
  1914. printk(KERN_ERR PFX "cannot ioremap FB basen");
  1915. goto err_out_iounmap_ctrl;
  1916. }
  1918. #ifdef CONFIG_MTRR
  1919. if (!nomtrr) {
  1920. rinfo->mtrr.vram = mtrr_add(rinfo->fb_base_phys,
  1921.     rinfo->base1_region_size, MTRR_TYPE_WRCOMB, 1);
  1922. if (rinfo->mtrr.vram < 0) {
  1923. printk(KERN_ERR PFX "unable to setup MTRRn");
  1924. } else {
  1925. rinfo->mtrr.vram_valid = 1;
  1926. /* let there be speed */
  1927. printk(KERN_INFO PFX "RIVA MTRR set to ONn");
  1928. }
  1929. }
  1930. #endif /* CONFIG_MTRR */
  1932. rinfo->riva.EnableIRQ = 0;
  1933. rinfo->riva.PRAMDAC = (unsigned *)(rinfo->ctrl_base + 0x00680000);
  1934. rinfo->riva.PFB = (unsigned *)(rinfo->ctrl_base + 0x00100000);
  1935. rinfo->riva.PFIFO = (unsigned *)(rinfo->ctrl_base + 0x00002000);
  1936. rinfo->riva.PGRAPH = (unsigned *)(rinfo->ctrl_base + 0x00400000);
  1937. rinfo->riva.PEXTDEV = (unsigned *)(rinfo->ctrl_base + 0x00101000);
  1938. rinfo->riva.PTIMER = (unsigned *)(rinfo->ctrl_base + 0x00009000);
  1939. rinfo->riva.PMC = (unsigned *)(rinfo->ctrl_base + 0x00000000);
  1940. rinfo->riva.FIFO = (unsigned *)(rinfo->ctrl_base + 0x00800000);
  1942. rinfo->riva.PCIO = (U008 *)(rinfo->ctrl_base + 0x00601000);
  1943. rinfo->riva.PDIO = (U008 *)(rinfo->ctrl_base + 0x00681000);
  1944. rinfo->riva.PVIO = (U008 *)(rinfo->ctrl_base + 0x000C0000);
  1946. rinfo->riva.IO = (MISCin(rinfo) & 0x01) ? 0x3D0 : 0x3B0;
  1948. switch (rinfo->riva.Architecture) {
  1949. case NV_ARCH_03:
  1950. rinfo->riva.PRAMIN = (unsigned *)(rinfo->fb_base + 0x00C00000);
  1951. break;
  1952. case NV_ARCH_04:
  1953. case NV_ARCH_10:
  1954. case NV_ARCH_20:
  1955. rinfo->riva.PCRTC = (unsigned *)(rinfo->ctrl_base + 0x00600000);
  1956. rinfo->riva.PRAMIN = (unsigned *)(rinfo->ctrl_base + 0x00710000);
  1957. break;
  1958. }
  1960. RivaGetConfig(&rinfo->riva);
  1962. /* back to normal */
  1964. assert(rinfo->pd != NULL);
  1966. /* unlock io */
  1967. CRTCout(rinfo, 0x11, 0xFF); /* vgaHWunlock() + riva unlock (0x7F) */
  1968. rinfo->riva.LockUnlock(&rinfo->riva, 0);
  1970. riva_save_state(rinfo, &rinfo->initial_state);
  1972. rinfo->ram_amount = rinfo->riva.RamAmountKBytes * 1024;
  1973. rinfo->dclk_max = rinfo->riva.MaxVClockFreqKHz * 1000;
  1975. if (!nohwcursor) rinfo->cursor = rivafb_init_cursor(rinfo);
  1977. if (riva_set_fbinfo(rinfo) < 0) {
  1978. printk(KERN_ERR PFX "error setting initial video moden");
  1979. goto err_out_cursor;
  1980. }
  1982. if (register_framebuffer((struct fb_info *)rinfo) < 0) {
  1983. printk(KERN_ERR PFX
  1984. "error registering riva framebuffern");
  1985. goto err_out_load_state;
  1986. }
  1988. riva_boards = riva_board_list_add(riva_boards, rinfo);
  1990. pci_set_drvdata(pd, rinfo);
  1992. printk(KERN_INFO PFX
  1993. "PCI nVidia NV%d framebuffer ver %s (%s, %dMB @ 0x%lX)n",
  1994. rinfo->riva.Architecture,
  1995. RIVAFB_VERSION,
  1996. rinfo->drvr_name,
  1997. rinfo->ram_amount / (1024 * 1024),
  1998. rinfo->fb_base_phys);
  2000. return 0;
  2002. err_out_load_state:
  2003. riva_load_state(rinfo, &rinfo->initial_state);
  2004. err_out_cursor:
  2005. rivafb_exit_cursor(rinfo);
  2006. /* err_out_iounmap_fb: */
  2007. iounmap(rinfo->fb_base);
  2008. err_out_iounmap_ctrl:
  2009. iounmap(rinfo->ctrl_base);
  2010. err_out_free_base1:
  2011. release_mem_region(rinfo->fb_base_phys, rinfo->base1_region_size);
  2012. err_out_free_base0:
  2013. release_mem_region(rinfo->ctrl_base_phys, rinfo->base0_region_size);
  2014. err_out_kfree:
  2015. kfree(rinfo);
  2016. err_out:
  2017. return -ENODEV;
  2018. }
  2020. static void __devexit rivafb_remove_one(struct pci_dev *pd)
  2021. {
  2022. struct rivafb_info *board = pci_get_drvdata(pd);
  2024. if (!board)
  2025. return;
  2027. riva_boards = riva_board_list_del(riva_boards, board);
  2029. riva_load_state(board, &board->initial_state);
  2031. unregister_framebuffer((struct fb_info *)board);
  2033. rivafb_exit_cursor(board);
  2035. #ifdef CONFIG_MTRR
  2036. if (board->mtrr.vram_valid)
  2037. mtrr_del(board->mtrr.vram, board->fb_base_phys,
  2038.  board->base1_region_size);
  2039. #endif /* CONFIG_MTRR */
  2041. iounmap(board->ctrl_base);
  2042. iounmap(board->fb_base);
  2044. release_mem_region(board->ctrl_base_phys,
  2045.    board->base0_region_size);
  2046. release_mem_region(board->fb_base_phys,
  2047.    board->base1_region_size);
  2049. kfree(board);
  2051. pci_set_drvdata(pd, NULL);
  2052. }
  2056. /* ------------------------------------------------------------------------- *
  2057.  *
  2058.  * initialization
  2059.  *
  2060.  * ------------------------------------------------------------------------- */
  2062. #ifndef MODULE
  2063. int __init rivafb_setup(char *options)
  2064. {
  2065. char *this_opt;
  2067. if (!options || !*options)
  2068. return 0;
  2070. while ((this_opt = strsep(&options, ",")) != NULL) {
  2071. if (!*this_opt)
  2072. continue;
  2073. if (!strncmp(this_opt, "font:", 5)) {
  2074. char *p;
  2075. int i;
  2077. p = this_opt + 5;
  2078. for (i = 0; i < sizeof(fontname) - 1; i++)
  2079. if (!*p || *p == ' ' || *p == ',')
  2080. break;
  2081. memcpy(fontname, this_opt + 5, i);
  2082. fontname[i] = 0;
  2084. } else if (!strncmp(this_opt, "noblink", 7)) {
  2085. noblink = 1;
  2086. } else if (!strncmp(this_opt, "noaccel", 7)) {
  2087. noaccel = 1;
  2088. } else if (!strncmp(this_opt, "nomove", 6)) {
  2089. nomove = 1;
  2090. #ifdef CONFIG_MTRR
  2091. } else if (!strncmp(this_opt, "nomtrr", 6)) {
  2092. nomtrr = 1;
  2093. #endif
  2094. } else if (!strncmp(this_opt, "nohwcursor", 10)) {
  2095. nohwcursor = 1;
  2096. } else
  2097. mode_option = this_opt;
  2098. }
  2099. return 0;
  2100. }
  2101. #endif /* !MODULE */
  2103. static struct pci_driver rivafb_driver = {
  2104. name: "rivafb",
  2105. id_table: rivafb_pci_tbl,
  2106. probe: rivafb_init_one,
  2107. remove: __devexit_p(rivafb_remove_one),
  2108. };
  2112. /* ------------------------------------------------------------------------- *
  2113.  *
  2114.  * modularization
  2115.  *
  2116.  * ------------------------------------------------------------------------- */
  2118. int __init rivafb_init(void)
  2119. {
  2120. int err;
  2121. #ifdef MODULE
  2122. if (font) strncpy(fontname, font, sizeof(fontname)-1);
  2123. #endif
  2124. err = pci_module_init(&rivafb_driver);
  2125. if (err)
  2126. return err;
  2127. return 0;
  2128. }
  2131. #ifdef MODULE
  2132. static void __exit rivafb_exit(void)
  2133. {
  2134. pci_unregister_driver(&rivafb_driver);
  2135. }
  2137. module_init(rivafb_init);
  2138. module_exit(rivafb_exit);
  2140. MODULE_PARM(font, "s");
  2141. MODULE_PARM_DESC(font, "Specifies one of the compiled-in fonts (default=none)");
  2142. MODULE_PARM(noaccel, "i");
  2143. MODULE_PARM_DESC(noaccel, "Disables hardware acceleration (0 or 1=disabled) (default=0)");
  2144. MODULE_PARM(nomove, "i");
  2145. MODULE_PARM_DESC(nomove, "Enables YSCROLL_NOMOVE (0 or 1=enabled) (default=0)");
  2146. MODULE_PARM(nohwcursor, "i");
  2147. MODULE_PARM_DESC(nohwcursor, "Disables hardware cursor (0 or 1=disabled) (default=0)");
  2148. MODULE_PARM(noblink, "i");
  2149. MODULE_PARM_DESC(noblink, "Disables hardware cursor blinking (0 or 1=disabled) (default=0)");
  2150. #ifdef CONFIG_MTRR
  2151. MODULE_PARM(nomtrr, "i");
  2152. MODULE_PARM_DESC(nomtrr, "Disables MTRR support (0 or 1=disabled) (default=0)");
  2153. #endif
  2154. #endif /* MODULE */
  2156. MODULE_AUTHOR("Ani Joshi, maintainer");
  2157. MODULE_DESCRIPTION("Framebuffer driver for nVidia Riva 128, TNT, TNT2");
  2158. MODULE_LICENSE("GPL");