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

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

嵌入式Linux

开发平台：

Unix_Linux

sis_main.c：源码内容
  1. /*
  2.  * SiS 300/630/540/315H/315 frame buffer device For Kernal 2.4.x
  3.  *
  4.  * This driver is partly based on the VBE 2.0 compliant graphic 
  5.  * boards framebuffer driver, which is 
  6.  * 
  7.  * (c) 1998 Gerd Knorr <kraxel@goldbach.in-berlin.de>
  8.  *
  9.  */
  11. //#undef SISFBDEBUG
  13. #include <linux/config.h>
  14. #include <linux/module.h>
  15. #include <linux/kernel.h>
  16. #include <linux/errno.h>
  17. #include <linux/string.h>
  18. #include <linux/mm.h>
  19. #include <linux/tty.h>
  20. #include <linux/slab.h>
  21. #include <linux/delay.h>
  22. #include <linux/fb.h>
  23. #include <linux/console.h>
  24. #include <linux/selection.h>
  25. #include <linux/ioport.h>
  26. #include <linux/init.h>
  27. #include <linux/pci.h>
  28. #include <linux/vt_kern.h>
  29. #include <linux/capability.h>
  30. #include <linux/fs.h>
  31. #include <linux/agp_backend.h>
  32. #include <linux/types.h>
  33. #include <linux/sisfb.h>
  35. #include <asm/io.h>
  36. #include <asm/mtrr.h>
  38. #include <video/fbcon.h>
  39. #include <video/fbcon-cfb8.h>
  40. #include <video/fbcon-cfb16.h>
  41. #include <video/fbcon-cfb24.h>
  42. #include <video/fbcon-cfb32.h>
  44. #include "osdef.h"
  45. #include "vgatypes.h"
  46. #include "sis_main.h"
  48. /* -------------------- Macro definitions ---------------------------- */
  50. #ifdef SISFBDEBUG
  51. #define DPRINTK(fmt, args...) printk(KERN_DEBUG "%s: " fmt, __FUNCTION__ , ## args)
  52. #else
  53. #define DPRINTK(fmt, args...)
  54. #endif
  56. #define vgawb(reg,data) 
  57.            (outb(data, ivideo.vga_base+reg))
  58. #define vgaww(reg,data) 
  59.            (outw(data, ivideo.vga_base+reg))
  60. #define vgawl(reg,data) 
  61.            (outl(data, ivideo.vga_base+reg))
  62. #define vgarb(reg)      
  63.            (inb(ivideo.vga_base+reg))
  65. /* --------------- Hardware Access Routines -------------------------- */
  67. void sisfb_set_reg1 (u16 port, u16 index, u16 data)
  68. {
  69. outb ((u8) (index & 0xff), port);
  70. port++;
  71. outb ((u8) (data & 0xff), port);
  72. }
  74. void sisfb_set_reg3 (u16 port, u16 data)
  75. {
  76. outb ((u8) (data & 0xff), port);
  77. }
  79. void sisfb_set_reg4 (u16 port, unsigned long data)
  80. {
  81. outl ((u32) (data & 0xffffffff), port);
  82. }
  84. u8 sisfb_get_reg1 (u16 port, u16 index)
  85. {
  86. u8 data;
  88. outb ((u8) (index & 0xff), port);
  89. port += 1;
  90. data = inb (port);
  91. return (data);
  92. }
  94. u8 sisfb_get_reg2 (u16 port)
  95. {
  96. u8 data;
  98. data = inb (port);
  100. return (data);
  101. }
  103. u32 sisfb_get_reg3 (u16 port)
  104. {
  105. u32 data;
  107. data = inl (port);
  108. return (data);
  109. }
  111. /* --------------- Interface to BIOS code ---------------------------- */
  113. BOOLEAN sisfb_query_VGA_config_space (PSIS_HW_DEVICE_INFO psishw_ext,
  114.       unsigned long offset, unsigned long set,
  115.       unsigned long *value)
  116. {
  117. static struct pci_dev *pdev = NULL;
  118. static unsigned char init = 0, valid_pdev = 0;
  120. if (!set)
  121. DPRINTK ("Get VGA offset 0x%lxn", offset);
  122. else
  123. DPRINTK ("Set offset 0x%lx to 0x%lxn", offset, *value);
  125. if (!init) {
  126. init = TRUE;
  127. pci_for_each_dev (pdev) {
  128. DPRINTK ("Current: 0x%x, target: 0x%xn", pdev->device,
  129.  ivideo.chip_id);
  130. if ((pdev->vendor == PCI_VENDOR_ID_SI)
  131.     && (pdev->device == ivideo.chip_id)) {
  132. valid_pdev = TRUE;
  133. break;
  134. }
  135. }
  136. }
  138. if (!valid_pdev) {
  139. printk (KERN_DEBUG "Can't find SiS %d VGA device.n",
  140. ivideo.chip_id);
  141. return FALSE;
  142. }
  144. if (set == 0)
  145. pci_read_config_dword (pdev, offset, (u32 *) value);
  146. else
  147. pci_write_config_dword (pdev, offset, (u32) (*value));
  149. return TRUE;
  150. }
  152. BOOLEAN sisfb_query_north_bridge_space (PSIS_HW_DEVICE_INFO psishw_ext,
  153. unsigned long offset, unsigned long set,
  154. unsigned long *value)
  155. {
  156. static struct pci_dev *pdev = NULL;
  157. static unsigned char init = 0, valid_pdev = 0;
  158. u16 nbridge_id = 0;
  160. if (!init) {
  161. init = TRUE;
  162. switch (ivideo.chip) {
  163. case SIS_540:
  164. nbridge_id = PCI_DEVICE_ID_SI_540;
  165. break;
  166. case SIS_630:
  167. nbridge_id = PCI_DEVICE_ID_SI_630;
  168. break;
  169. case SIS_730:
  170. nbridge_id = PCI_DEVICE_ID_SI_730;
  171. break;
  172. case SIS_550:
  173. nbridge_id = PCI_DEVICE_ID_SI_550;
  174. break;
  175. default:
  176. nbridge_id = 0;
  177. break;
  178. }
  180. pci_for_each_dev (pdev) {
  181. DPRINTK ("Current: 0x%x, target: 0x%xn", pdev->device,
  182.  ivideo.chip_id);
  183. if ((pdev->vendor == PCI_VENDOR_ID_SI)
  184.     && (pdev->device == nbridge_id)) {
  185. valid_pdev = TRUE;
  186. break;
  187. }
  188. }
  189. }
  191. if (!valid_pdev) {
  192. printk (KERN_DEBUG "Can't find SiS %d North Bridge device.n",
  193. nbridge_id);
  194. return FALSE;
  195. }
  197. if (set == 0)
  198. pci_read_config_dword (pdev, offset, (u32 *) value);
  199. else
  200. pci_write_config_dword (pdev, offset, (u32) (*value));
  202. return TRUE;
  203. }
  205. /* -------------------- Export functions ----------------------------- */
  207. static void sis_get_glyph (SIS_GLYINFO * gly)
  208. {
  209. struct display *p = &fb_display[currcon];
  210. u16 c;
  211. u8 *cdat;
  212. int widthb;
  213. u8 *gbuf = gly->gmask;
  214. int size;
  216. gly->fontheight = fontheight (p);
  217. gly->fontwidth = fontwidth (p);
  218. widthb = (fontwidth (p) + 7) / 8;
  220. c = gly->ch & p->charmask;
  221. if (fontwidth (p) <= 8)
  222. cdat = p->fontdata + c * fontheight (p);
  223. else
  224. cdat = p->fontdata + (c * fontheight (p) << 1);
  226. size = fontheight (p) * widthb;
  227. memcpy (gbuf, cdat, size);
  228. gly->ngmask = size;
  229. }
  231. void sis_dispinfo (struct ap_data *rec)
  232. {
  233. rec->minfo.bpp = ivideo.video_bpp;
  234. rec->minfo.xres = ivideo.video_width;
  235. rec->minfo.yres = ivideo.video_height;
  236. rec->minfo.v_xres = ivideo.video_vwidth;
  237. rec->minfo.v_yres = ivideo.video_vheight;
  238. rec->minfo.org_x = ivideo.org_x;
  239. rec->minfo.org_y = ivideo.org_y;
  240. rec->minfo.vrate = ivideo.refresh_rate;
  241. rec->iobase = ivideo.vga_base - 0x30;
  242. rec->mem_size = ivideo.video_size;
  243. rec->disp_state = ivideo.disp_state;
  244. rec->version = (VER_MAJOR << 24) | (VER_MINOR << 16) | VER_LEVEL;
  245. rec->hasVB = ivideo.hasVB;
  246. rec->TV_type = ivideo.TV_type;
  247. rec->TV_plug = ivideo.TV_plug;
  248. rec->chip = ivideo.chip;
  249. }
  251. /* ------------------ Internal Routines ------------------------------ */
  253. static void sisfb_search_mode (const char *name)
  254. {
  255. int i = 0;
  257. if (name == NULL)
  258. return;
  260. while (sisbios_mode[i].mode_no != 0) {
  261. if (!strcmp (name, sisbios_mode[i].name)) {
  262. sisfb_mode_idx = i;
  263. break;
  264. }
  265. i++;
  266. }
  268. if (sisfb_mode_idx < 0)
  269. DPRINTK ("Invalid user mode : %sn", name);
  270. }
  272. static void sisfb_validate_mode (void)
  273. {
  274. switch (ivideo.disp_state & DISPTYPE_DISP2) {
  275. case DISPTYPE_LCD:
  276. // Eden Chen
  277. switch (sishw_ext.ulCRT2LCDType) {
  278. case LCD_1024x768:
  279. if (sisbios_mode[sisfb_mode_idx].xres > 1024)
  280. sisfb_mode_idx = -1;
  281. break;
  282. case LCD_1280x1024:
  283. case LCD_1280x960:
  284. if (sisbios_mode[sisfb_mode_idx].xres > 1280)
  285. sisfb_mode_idx = -1;
  286. break;
  287. case LCD_2048x1536:
  288. if (sisbios_mode[sisfb_mode_idx].xres > 2048)
  289. sisfb_mode_idx = -1;
  290. break;
  291. case LCD_1920x1440:
  292. if (sisbios_mode[sisfb_mode_idx].xres > 1920)
  293. sisfb_mode_idx = -1;
  294. break;
  295. case LCD_1600x1200:
  296. if (sisbios_mode[sisfb_mode_idx].xres > 1600)
  297. sisfb_mode_idx = -1;
  298. break;
  299. case LCD_800x600:
  300. if (sisbios_mode[sisfb_mode_idx].xres > 800)
  301. sisfb_mode_idx = -1;
  302. break;
  303. case LCD_640x480:
  304. if (sisbios_mode[sisfb_mode_idx].xres > 640)
  305. sisfb_mode_idx = -1;
  306. break;
  307. default:
  308. sisfb_mode_idx = -1;
  309. }
  310. // ~Eden Chen
  312. if (sisbios_mode[sisfb_mode_idx].xres == 720)
  313. sisfb_mode_idx = -1;
  314. break;
  315. case DISPTYPE_TV:
  316. switch (sisbios_mode[sisfb_mode_idx].xres) {
  317. case 800:
  318. case 640:
  319. break;
  320. case 720:
  321. if (ivideo.TV_type == TVMODE_NTSC) {
  322. if (sisbios_mode[sisfb_mode_idx].yres != 480)
  323. sisfb_mode_idx = -1;
  324. } else if (ivideo.TV_type == TVMODE_PAL) {
  325. if (sisbios_mode[sisfb_mode_idx].yres != 576)
  326. sisfb_mode_idx = -1;
  327. }
  328. break;
  329. /*karl */
  330. case 1024:
  331. if (ivideo.TV_type == TVMODE_NTSC) {
  332. if (sisbios_mode[sisfb_mode_idx].bpp == 32)
  333. sisfb_mode_idx -= 1;
  334. }
  335. break;
  336. default:
  337. sisfb_mode_idx = -1;
  338. }
  339. break;
  340. }
  341. }
  343. static u8 sisfb_search_refresh_rate (unsigned int rate)
  344. {
  345. u16 xres, yres;
  346. int i = 0;
  348. xres = sisbios_mode[sisfb_mode_idx].xres;
  349. yres = sisbios_mode[sisfb_mode_idx].yres;
  351. sisfb_rate_idx = 0;
  352. while ((sisfb_vrate[i].idx != 0) && (sisfb_vrate[i].xres <= xres)) {
  353. if ((sisfb_vrate[i].xres == xres)
  354.     && (sisfb_vrate[i].yres == yres)) {
  355. if (sisfb_vrate[i].refresh == rate) {
  356. sisfb_rate_idx = sisfb_vrate[i].idx;
  357. break;
  358. } else if (sisfb_vrate[i].refresh > rate) {
  359. if ((sisfb_vrate[i].refresh - rate) <= 2) {
  360. DPRINTK
  361.     ("Adjust rate from %d up to %dn",
  362.      rate, sisfb_vrate[i].refresh);
  363. sisfb_rate_idx = sisfb_vrate[i].idx;
  364. ivideo.refresh_rate =
  365.     sisfb_vrate[i].refresh;
  366. } else if (((rate - sisfb_vrate[i - 1].refresh) <=  2) 
  367.      && (sisfb_vrate[i].idx != 1)) {
  368. DPRINTK("Adjust rate from %d down to %dn",
  369.      rate, sisfb_vrate[i - 1].refresh);
  370. sisfb_rate_idx = sisfb_vrate[i - 1].idx;
  371. ivideo.refresh_rate = sisfb_vrate[i - 1].refresh;
  372. }
  373. break;
  374. }
  375. }
  376. i++;
  377. }
  379. if (sisfb_rate_idx > 0) {
  380. return sisfb_rate_idx;
  381. } else {
  382. DPRINTK ("Unsupported rate %d for %dx%d moden", rate, xres,
  383.  yres);
  384. return 0;
  385. }
  387. }
  389. static int sis_getcolreg (unsigned regno, unsigned *red, unsigned *green, unsigned *blue,
  390.        unsigned *transp, struct fb_info *fb_info)
  391. {
  392. if (regno >= video_cmap_len)
  393. return 1;
  395. *red = palette[regno].red;
  396. *green = palette[regno].green;
  397. *blue = palette[regno].blue;
  398. *transp = 0;
  399. return 0;
  400. }
  402. static int sis_setcolreg (unsigned regno, unsigned red, unsigned green, unsigned blue,
  403.        unsigned transp, struct fb_info *fb_info)
  404. {
  406. if (regno >= video_cmap_len)
  407. return 1;
  409. palette[regno].red = red;
  410. palette[regno].green = green;
  411. palette[regno].blue = blue;
  413. switch (ivideo.video_bpp) {
  414. #ifdef FBCON_HAS_CFB8
  415. case 8:
  416. vgawb (DAC_ADR, regno);
  417. vgawb (DAC_DATA, red >> 10);
  418. vgawb (DAC_DATA, green >> 10);
  419. vgawb (DAC_DATA, blue >> 10);
  420. if (ivideo.disp_state & DISPTYPE_DISP2) {
  421. vgawb (DAC2_ADR, regno);
  422. vgawb (DAC2_DATA, red >> 8);
  423. vgawb (DAC2_DATA, green >> 8);
  424. vgawb (DAC2_DATA, blue >> 8);
  425. }
  427. break;
  428. #endif
  429. #ifdef FBCON_HAS_CFB16
  430. case 15:
  431. case 16:
  432. fbcon_cmap.cfb16[regno] =
  433.     ((red & 0xf800)) |
  434.     ((green & 0xfc00) >> 5) | ((blue & 0xf800) >> 11);
  435. break;
  436. #endif
  437. #ifdef FBCON_HAS_CFB24
  438. case 24:
  439. red >>= 8;
  440. green >>= 8;
  441. blue >>= 8;
  442. fbcon_cmap.cfb24[regno] = (red << 16) | (green << 8) | (blue);
  443. break;
  444. #endif
  445. #ifdef FBCON_HAS_CFB32
  446. case 32:
  447. red >>= 8;
  448. green >>= 8;
  449. blue >>= 8;
  450. fbcon_cmap.cfb32[regno] = (red << 16) | (green << 8) | (blue);
  451. break;
  452. #endif
  453. }
  454. return 0;
  455. }
  457. static int sisfb_do_set_var (struct fb_var_screeninfo *var, int isactive,
  458.   struct fb_info *info)
  459. {
  460. unsigned int htotal =
  461.     var->left_margin + var->xres + var->right_margin + var->hsync_len;
  462. unsigned int vtotal =
  463.     var->upper_margin + var->yres + var->lower_margin + var->vsync_len;
  464. double drate = 0, hrate = 0;
  465. int found_mode = 0;
  466. int old_mode;
  468. if ((var->vmode & FB_VMODE_MASK) == FB_VMODE_NONINTERLACED)
  469. vtotal <<= 1;
  470. else if ((var->vmode & FB_VMODE_MASK) == FB_VMODE_DOUBLE)
  471. vtotal <<= 2;
  472. else if ((var->vmode & FB_VMODE_MASK) == FB_VMODE_INTERLACED)
  473. var->yres <<= 1;
  475. if (!htotal || !vtotal) {
  476. DPRINTK ("Invalid 'var' Information!n");
  477. return -EINVAL;
  478. }
  480. drate = 1E12 / var->pixclock;
  481. hrate = drate / htotal;
  482. ivideo.refresh_rate = (unsigned int) (hrate / vtotal * 2 + 0.5);
  484. DPRINTK ("Chagne mode to %dx%dx%d-%dMHzn",
  485.  var->xres, var->yres, var->bits_per_pixel,
  486.  ivideo.refresh_rate);
  488. old_mode = sisfb_mode_idx;
  489. sisfb_mode_idx = 0;
  491. while ((sisbios_mode[sisfb_mode_idx].mode_no != 0)
  492.        && (sisbios_mode[sisfb_mode_idx].xres <= var->xres)) {
  493. if ((sisbios_mode[sisfb_mode_idx].xres == var->xres)
  494.     && (sisbios_mode[sisfb_mode_idx].yres == var->yres)
  495.     && (sisbios_mode[sisfb_mode_idx].bpp ==
  496. var->bits_per_pixel)) {
  497. sisfb_mode_no = sisbios_mode[sisfb_mode_idx].mode_no;
  498. found_mode = 1;
  499. break;
  500. }
  501. sisfb_mode_idx++;
  502. }
  504. if (found_mode)
  505. sisfb_validate_mode ();
  506. else
  507. sisfb_mode_idx = -1;
  509. if (sisfb_mode_idx < 0) {
  510. DPRINTK ("sisfb does not support mode %dx%d-%dn", var->xres,
  511.  var->yres, var->bits_per_pixel);
  512. sisfb_mode_idx = old_mode;
  513. return -EINVAL;
  514. }
  516. if (sisfb_search_refresh_rate (ivideo.refresh_rate) == 0) {
  517. sisfb_rate_idx = sisbios_mode[sisfb_mode_idx].rate_idx;
  518. ivideo.refresh_rate = 60;
  519. }
  521. if (((var->activate & FB_ACTIVATE_MASK) == FB_ACTIVATE_NOW) && isactive) {
  522. sisfb_pre_setmode ();
  524. // Eden Chen
  525. /*
  526. #ifdef CONFIG_FB_SIS_300
  527. if (SiSSetMode(&sishw_ext, sisfb_mode_no)) {
  528. DPRINTK("set mode[0x%x]: failedn", sisfb_mode_no);
  529. return -1;
  530. }
  531. #endif
  533. #ifdef CONFIG_FB_SIS_315
  534. if (SiSSetMode310(&sishw_ext, sisfb_mode_no)) {
  535. DPRINTK("set mode[0x%x]: failedn", sisfb_mode_no);
  536. return -1;
  537. }
  539. #endif
  540. */
  541. if (SiSSetMode (&sishw_ext, sisfb_mode_no) == 0) {
  542. DPRINTK ("set mode[0x%x]: failedn", sisfb_mode_no);
  543. return -1;
  544. }
  546. vgawb (SEQ_ADR, IND_SIS_PASSWORD);
  547. vgawb (SEQ_DATA, SIS_PASSWORD);
  548. // ~Eden Chen
  549. sisfb_post_setmode ();
  551. DPRINTK ("Set New Mode : %dx%dx%d-%d n",
  552.  sisbios_mode[sisfb_mode_idx].xres,
  553.  sisbios_mode[sisfb_mode_idx].yres,
  554.  sisbios_mode[sisfb_mode_idx].bpp, ivideo.refresh_rate);
  556. ivideo.video_bpp = sisbios_mode[sisfb_mode_idx].bpp;
  557. ivideo.video_vwidth = ivideo.video_width =
  558.     sisbios_mode[sisfb_mode_idx].xres;
  559. ivideo.video_vheight = ivideo.video_height =
  560.     sisbios_mode[sisfb_mode_idx].yres;
  561. ivideo.org_x = ivideo.org_y = 0;
  562. video_linelength = ivideo.video_width * (ivideo.video_bpp >> 3);
  564. }
  565. return 0;
  566. }
  568. static void sisfb_set_disp (int con, struct fb_var_screeninfo *var)
  569. {
  570. struct fb_fix_screeninfo fix;
  571. struct display *display;
  572. struct display_switch *sw;
  573. u32 flags;
  575. if (con >= 0)
  576. display = &fb_display[con];
  577. else
  578. display = &disp;
  580. sisfb_get_fix (&fix, con, 0);
  582. display->screen_base = ivideo.video_vbase;
  583. display->visual = fix.visual;
  584. display->type = fix.type;
  585. display->type_aux = fix.type_aux;
  586. display->ypanstep = fix.ypanstep;
  587. display->ywrapstep = fix.ywrapstep;
  588. display->line_length = fix.line_length;
  589. display->next_line = fix.line_length;
  590. display->can_soft_blank = 0;
  591. display->inverse = sisfb_inverse;
  592. display->var = *var;
  594. save_flags (flags);
  595. switch (ivideo.video_bpp) {
  596. #ifdef FBCON_HAS_CFB8
  597. case 8:
  598. sw = &fbcon_cfb8;
  599. break;
  600. #endif
  601. #ifdef FBCON_HAS_CFB16
  602. case 15:
  603. case 16:
  604. sw = &fbcon_cfb16;
  605. display->dispsw_data = fbcon_cmap.cfb16;
  606. break;
  607. #endif
  608. #ifdef FBCON_HAS_CFB24
  609. case 24:
  610. sw = &fbcon_cfb24;
  611. display->dispsw_data = fbcon_cmap.cfb24;
  612. break;
  613. #endif
  614. #ifdef FBCON_HAS_CFB32
  615. case 32:
  616. sw = &fbcon_cfb32;
  617. display->dispsw_data = fbcon_cmap.cfb32;
  618. break;
  619. #endif
  620. default:
  621. sw = &fbcon_dummy;
  622. return;
  623. }
  624. memcpy (&sisfb_sw, sw, sizeof (*sw));
  625. display->dispsw = &sisfb_sw;
  626. restore_flags (flags);
  628. display->scrollmode = SCROLL_YREDRAW;
  629. sisfb_sw.bmove = fbcon_redraw_bmove;
  630. }
  632. static void sisfb_do_install_cmap (int con, struct fb_info *info)
  633. {
  634. if (con != currcon)
  635. return;
  637. if (fb_display[con].cmap.len)
  638. fb_set_cmap (&fb_display[con].cmap, 1, sis_setcolreg, info);
  639. else
  640. fb_set_cmap (fb_default_cmap (video_cmap_len), 1,
  641.      sis_setcolreg, info);
  642. }
  644. /* --------------- Chip-dependent Routines --------------------------- */
  646. #ifdef CONFIG_FB_SIS_300 /* for SiS 300/630/540/730 */
  647. static int sisfb_get_dram_size_300 (void)
  648. {
  649. struct pci_dev *pdev = NULL;
  650. int pdev_valid = 0;
  651. u8 pci_data, reg;
  652. u16 nbridge_id;
  654. switch (ivideo.chip) {
  655. case SIS_540:
  656. nbridge_id = PCI_DEVICE_ID_SI_540;
  657. break;
  658. case SIS_630:
  659. nbridge_id = PCI_DEVICE_ID_SI_630;
  660. break;
  661. case SIS_730:
  662. nbridge_id = PCI_DEVICE_ID_SI_730;
  663. break;
  664. default:
  665. nbridge_id = 0;
  666. break;
  667. }
  669. if (nbridge_id == 0) {
  670. vgawb (SEQ_ADR, IND_SIS_DRAM_SIZE);
  671. ivideo.video_size =
  672.     ((unsigned
  673.       int) ((vgarb (SEQ_DATA) & SIS_DRAM_SIZE_MASK) + 1) << 20);
  674. } else {
  675. pci_for_each_dev (pdev) {
  676. if ((pdev->vendor == PCI_VENDOR_ID_SI)
  677.     && (pdev->device == nbridge_id)) {
  678. //&& (pdev->device == PCI_DEVICE_ID_SI_630)) {
  679. pci_read_config_byte (pdev, IND_BRI_DRAM_STATUS,
  680.       &pci_data);
  681. pci_data = (pci_data & BRI_DRAM_SIZE_MASK) >> 4;
  682. ivideo.video_size =
  683.     (unsigned int) (1 << (pci_data + 21));
  684. pdev_valid = 1;
  686. reg = SIS_DATA_BUS_64 << 6;
  687. vgawb (SEQ_ADR, IND_SIS_DRAM_SIZE);
  688. switch (pci_data) {
  689. case BRI_DRAM_SIZE_2MB:
  690. reg |= SIS_DRAM_SIZE_2MB;
  691. break;
  692. case BRI_DRAM_SIZE_4MB:
  693. reg |= SIS_DRAM_SIZE_4MB;
  694. break;
  695. case BRI_DRAM_SIZE_8MB:
  696. reg |= SIS_DRAM_SIZE_8MB;
  697. break;
  698. case BRI_DRAM_SIZE_16MB:
  699. reg |= SIS_DRAM_SIZE_16MB;
  700. break;
  701. case BRI_DRAM_SIZE_32MB:
  702. reg |= SIS_DRAM_SIZE_32MB;
  703. break;
  704. case BRI_DRAM_SIZE_64MB:
  705. reg |= SIS_DRAM_SIZE_64MB;
  706. break;
  707. }
  708. vgawb (SEQ_DATA, reg);
  709. break;
  710. }
  711. }
  713. if (!pdev_valid)
  714. return -1;
  715. }
  717. return 0;
  718. }
  720. static void sisfb_detect_VB_connect_300(void)
  721. {
  722. u8 sr16, sr17, cr32, temp;
  724. vgawb (SEQ_ADR, IND_SIS_SCRATCH_REG_17);
  725. sr17 = vgarb (SEQ_DATA);
  726. vgawb (CRTC_ADR, IND_SIS_SCRATCH_REG_CR32);
  727. cr32 = vgarb (CRTC_DATA);
  729. ivideo.TV_plug = ivideo.TV_type = 0;
  730. if ((sr17 & 0x0F) && (ivideo.chip != SIS_300)) {
  731. if ((sr17 & 0x01) && !sisfb_crt1off)
  732. sisfb_crt1off = 0;
  733. else {
  734. if (sr17 & 0x0E)
  735. sisfb_crt1off = 1;
  736. else
  737. sisfb_crt1off = 0;
  738. }
  740. if (sr17 & 0x08)
  741. ivideo.disp_state = DISPTYPE_CRT2;
  742. else if (sr17 & 0x02)
  743. ivideo.disp_state = DISPTYPE_LCD;
  744. else if (sr17 & 0x04) {
  745. ivideo.disp_state = DISPTYPE_TV;
  746. if (sr17 & 0x20)
  747. ivideo.TV_plug = TVPLUG_SVIDEO;
  748. else if (sr17 & 0x10)
  749. ivideo.TV_plug = TVPLUG_COMPOSITE;
  751. vgawb (SEQ_ADR, IND_SIS_SCRATCH_REG_16);
  752. sr16 = vgarb (SEQ_DATA);
  753. if (sr16 & 0x20)
  754. ivideo.TV_type = TVMODE_PAL;
  755. else
  756. ivideo.TV_type = TVMODE_NTSC;
  757. } else
  758. ivideo.disp_state = 0;
  759. } else {
  760. if ((cr32 & SIS_CRT1) && !sisfb_crt1off)
  761. sisfb_crt1off = 0;
  762. else {
  763. if (cr32 & 0x5F)
  764. sisfb_crt1off = 1;
  765. else
  766. sisfb_crt1off = 0;
  767. }
  769. if (cr32 & SIS_VB_CRT2)
  770. ivideo.disp_state = DISPTYPE_CRT2;
  771. else if (cr32 & SIS_VB_LCD)
  772. ivideo.disp_state = DISPTYPE_LCD;
  773. else if (cr32 & SIS_VB_TV) {
  774. ivideo.disp_state = DISPTYPE_TV;
  775. if (cr32 & SIS_VB_HIVISION) {
  776. ivideo.TV_type = TVMODE_HIVISION;
  777. ivideo.TV_plug = TVPLUG_SVIDEO;
  778. } else if (cr32 & SIS_VB_SVIDEO)
  779. ivideo.TV_plug = TVPLUG_SVIDEO;
  780. else if (cr32 & SIS_VB_COMPOSITE)
  781. ivideo.TV_plug = TVPLUG_COMPOSITE;
  782. else if (cr32 & SIS_VB_SCART)
  783. ivideo.TV_plug = TVPLUG_SCART;
  785. if (ivideo.TV_type == 0) {
  786. // Eden Chen
  787. //temp = *((u8 *)(sishw_ext.VirtualRomBase+0x52));
  788. //if (temp&0x40) {
  789. //      temp=*((u8 *)(sishw_ext.VirtualRomBase+0x53));
  790. //} else {
  791. vgawb (SEQ_ADR, IND_SIS_POWER_ON_TRAP);
  792. temp = vgarb (SEQ_DATA);
  793. //}
  794. // ~Eden Chen
  795. if (temp & 0x01)
  796. ivideo.TV_type = TVMODE_PAL;
  797. else
  798. ivideo.TV_type = TVMODE_NTSC;
  799. }
  800. } else
  801. ivideo.disp_state = 0;
  802. }
  803. }
  805. static void sisfb_get_VB_type_300 (void)
  806. {
  807. u8 reg;
  809. if (ivideo.chip != SIS_300) {
  810. if (!sisfb_has_VB_300 ()) {
  811. vgawb (CRTC_ADR, IND_SIS_SCRATCH_REG_CR37);
  812. reg = vgarb (CRTC_DATA);
  814. switch ((reg & SIS_EXTERNAL_CHIP_MASK) >> 1) {
  815. case SIS_EXTERNAL_CHIP_SIS301:
  816. ivideo.hasVB = HASVB_301;
  817. break;
  818. case SIS_EXTERNAL_CHIP_LVDS:
  819. ivideo.hasVB = HASVB_LVDS;
  820. break;
  821. case SIS_EXTERNAL_CHIP_TRUMPION:
  822. ivideo.hasVB = HASVB_TRUMPION;
  823. break;
  824. case SIS_EXTERNAL_CHIP_LVDS_CHRONTEL:
  825. ivideo.hasVB = HASVB_LVDS_CHRONTEL;
  826. break;
  827. case SIS_EXTERNAL_CHIP_CHRONTEL:
  828. ivideo.hasVB = HASVB_CHRONTEL;
  829. break;
  830. default:
  831. break;
  832. }
  833. }
  834. } else {
  835. sisfb_has_VB_300 ();
  836. }
  838. //sishw_ext.hasVB = ivideo.hasVB;
  839. }
  841. static int sisfb_has_VB_300 (void)
  842. {
  843. // Eden Chen
  844. //u8 sr38, sr39, vb_chipid;
  845. u8 vb_chipid;
  847. //vgawb(SEQ_ADR, IND_SIS_POWER_ON_TRAP);
  848. //sr38 = vgarb(SEQ_DATA);
  849. //vgawb(SEQ_ADR, IND_SIS_POWER_ON_TRAP2);
  850. //sr39 = vgarb(SEQ_DATA);
  851. vgawb (VB_PART4_ADR, 0x0);
  852. vb_chipid = vgarb (VB_PART4_DATA);
  854. switch (vb_chipid) {
  855. case 0x01:
  856. ivideo.hasVB = HASVB_301;
  857. break;
  858. case 0x02:
  859. ivideo.hasVB = HASVB_302;
  860. break;
  861. case 0x03:
  862. ivideo.hasVB = HASVB_303;
  863. break;
  864. default:
  865. ivideo.hasVB = HASVB_NONE;
  866. return FALSE;
  867. }
  868. return TRUE;
  869. }
  871. #endif /* CONFIG_FB_SIS_300 */
  873. #ifdef CONFIG_FB_SIS_315 /* for SiS 315H/315 */
  874. static int sisfb_get_dram_size_315 (void)
  875. {
  876. #ifdef LINUXBIOS
  877. struct pci_dev *pdev = NULL;
  878. int pdev_valid = 0;
  879. u8 pci_data;
  880. #endif
  881. u8 reg = 0;
  883. if (ivideo.chip == SIS_550) {
  884. #ifdef LINUXBIOS
  885. pci_for_each_dev (pdev) {
  886. if ((pdev->vendor == PCI_VENDOR_ID_SI)
  887.     && (pdev->device == PCI_DEVICE_ID_SI_550)) {
  888. pci_read_config_byte (pdev, IND_BRI_DRAM_STATUS,
  889.       &pci_data);
  890. pci_data = (pci_data & BRI_DRAM_SIZE_MASK) >> 4;
  891. ivideo.video_size =
  892.     (unsigned int) (1 << (pci_data + 21));
  893. pdev_valid = 1;
  895. vgawb (SEQ_ADR, IND_SIS_DRAM_SIZE);
  896. reg = vgarb (SEQ_DATA) & 0xC0;
  898. switch (pci_data) {
  899. //case BRI_DRAM_SIZE_2MB:
  900. //      reg |= (SIS315_DRAM_SIZE_2MB << 4); break;
  901. case BRI_DRAM_SIZE_4MB:
  902. reg |= SIS550_DRAM_SIZE_4MB;
  903. break;
  904. case BRI_DRAM_SIZE_8MB:
  905. reg |= SIS550_DRAM_SIZE_8MB;
  906. break;
  907. case BRI_DRAM_SIZE_16MB:
  908. reg |= SIS550_DRAM_SIZE_16MB;
  909. break;
  910. case BRI_DRAM_SIZE_32MB:
  911. reg |= SIS550_DRAM_SIZE_32MB;
  912. break;
  913. case BRI_DRAM_SIZE_64MB:
  914. reg |= SIS550_DRAM_SIZE_64MB;
  915. break;
  916. /* case BRI_DRAM_SIZE_128MB:
  917.    reg |= (SIS315_DRAM_SIZE_128MB << 4); break; */
  918. }
  920. /* TODO : set Dual channel and bus width bits here */
  922. vgawb (SEQ_DATA, reg);
  923. break;
  924. }
  925. }
  927. if (!pdev_valid)
  928. return -1;
  929. #else
  930. vgawb (SEQ_ADR, IND_SIS_DRAM_SIZE);
  931. reg = vgarb (SEQ_DATA);
  932. switch (reg & SIS550_DRAM_SIZE_MASK) {
  933. case SIS550_DRAM_SIZE_4MB:
  934. ivideo.video_size = 0x400000;
  935. break;
  936. case SIS550_DRAM_SIZE_8MB:
  937. ivideo.video_size = 0x800000;
  938. break;
  939. case SIS550_DRAM_SIZE_16MB:
  940. ivideo.video_size = 0x1000000;
  941. break;
  942. case SIS550_DRAM_SIZE_24MB:
  943. ivideo.video_size = 0x1800000;
  944. break;
  945. case SIS550_DRAM_SIZE_32MB:
  946. ivideo.video_size = 0x2000000;
  947. break;
  948. case SIS550_DRAM_SIZE_64MB:
  949. ivideo.video_size = 0x4000000;
  950. break;
  951. case SIS550_DRAM_SIZE_96MB:
  952. ivideo.video_size = 0x6000000;
  953. break;
  954. case SIS550_DRAM_SIZE_128MB:
  955. ivideo.video_size = 0x8000000;
  956. break;
  957. case SIS550_DRAM_SIZE_256MB:
  958. ivideo.video_size = 0x10000000;
  959. break;
  960. default:
  961. return -1;
  962. }
  963. #endif
  964. return 0;
  965. } else {
  966. vgawb (SEQ_ADR, IND_SIS_DRAM_SIZE);
  967. reg = vgarb (SEQ_DATA);
  968. switch ((reg & SIS315_DRAM_SIZE_MASK) >> 4) {
  969. case SIS315_DRAM_SIZE_2MB:
  970. ivideo.video_size = 0x200000;
  971. break;
  972. case SIS315_DRAM_SIZE_4MB:
  973. ivideo.video_size = 0x400000;
  974. break;
  975. case SIS315_DRAM_SIZE_8MB:
  976. ivideo.video_size = 0x800000;
  977. break;
  978. case SIS315_DRAM_SIZE_16MB:
  979. ivideo.video_size = 0x1000000;
  980. break;
  981. case SIS315_DRAM_SIZE_32MB:
  982. ivideo.video_size = 0x2000000;
  983. break;
  984. case SIS315_DRAM_SIZE_64MB:
  985. ivideo.video_size = 0x4000000;
  986. break;
  987. case SIS315_DRAM_SIZE_128MB:
  988. ivideo.video_size = 0x8000000;
  989. break;
  990. default:
  991. return -1;
  992. }
  993. }
  995. reg &= SIS315_DUAL_CHANNEL_MASK;
  996. reg >>= 2;
  997. switch (reg) {
  998. case SIS315_SINGLE_CHANNEL_2_RANK:
  999. ivideo.video_size <<= 1;
  1000. break;
  1001. case SIS315_DUAL_CHANNEL_1_RANK:
  1002. ivideo.video_size <<= 1;
  1003. break;
  1004. }
  1006. return 0;
  1007. }
  1009. static void sisfb_detect_VB_connect_315 (void)
  1010. {
  1011. u8 cr32, temp;
  1013. vgawb (CRTC_ADR, IND_SIS_SCRATCH_REG_CR32);
  1014. cr32 = vgarb (CRTC_DATA);
  1016. ivideo.TV_plug = ivideo.TV_type = 0;
  1017. if ((cr32 & SIS_CRT1) && !sisfb_crt1off)
  1018. sisfb_crt1off = 0;
  1019. else {
  1020. if (cr32 & 0x5F)
  1021. sisfb_crt1off = 1;
  1022. else
  1023. sisfb_crt1off = 0;
  1024. }
  1026. if (cr32 & SIS_VB_CRT2)
  1027. ivideo.disp_state = DISPTYPE_CRT2;
  1028. else if (cr32 & SIS_VB_LCD)
  1029. ivideo.disp_state = DISPTYPE_LCD;
  1030. else if (cr32 & SIS_VB_TV) {
  1031. ivideo.disp_state = DISPTYPE_TV;
  1033. if (cr32 & SIS_VB_HIVISION) {
  1034. ivideo.TV_type = TVMODE_HIVISION;
  1035. ivideo.TV_plug = TVPLUG_SVIDEO;
  1036. } else if (cr32 & SIS_VB_SVIDEO)
  1037. ivideo.TV_plug = TVPLUG_SVIDEO;
  1038. else if (cr32 & SIS_VB_COMPOSITE)
  1039. ivideo.TV_plug = TVPLUG_COMPOSITE;
  1040. else if (cr32 & SIS_VB_SCART)
  1041. ivideo.TV_plug = TVPLUG_SCART;
  1043. if (ivideo.TV_type == 0) {
  1044. vgawb (SEQ_ADR, IND_SIS_POWER_ON_TRAP);
  1045. temp = vgarb (SEQ_DATA);
  1047. if (temp & 0x01)
  1048. ivideo.TV_type = TVMODE_PAL;
  1049. else
  1050. ivideo.TV_type = TVMODE_NTSC;
  1051. }
  1052. } else
  1053. ivideo.disp_state = 0;
  1054. }
  1056. static void sisfb_get_VB_type_315 (void)
  1057. {
  1058. u8 vb_chipid;
  1060. vgawb (VB_PART4_ADR, 0x0);
  1061. vb_chipid = vgarb (VB_PART4_DATA);
  1063. switch (vb_chipid) {
  1064. case 0x01:
  1065. ivideo.hasVB = HASVB_301;
  1066. break;
  1067. case 0x02:
  1068. ivideo.hasVB = HASVB_302;
  1069. break;
  1070. case 0x03:
  1071. ivideo.hasVB = HASVB_303;
  1072. break;
  1073. default:
  1074. ivideo.hasVB = HASVB_NONE;
  1075. }
  1076. // Eden Chen
  1077. //sishw_ext.hasVB = ivideo.hasVB;
  1078. // ~Eden Chen
  1079. }
  1080. #endif /* CONFIG_FB_SIS_315 */
  1082. /* --------------------- Heap Routines ------------------------------- */
  1084. static int sisfb_heap_init (void)
  1085. {
  1086. SIS_OH *poh;
  1087. u8 temp = 0;
  1088. #ifdef CONFIG_FB_SIS_315
  1089. int agp_enabled = 1;
  1090. u32 agp_size;
  1091. unsigned long *cmdq_baseport = 0;
  1092. unsigned long *read_port = 0;
  1093. unsigned long *write_port = 0;
  1094. SIS_CMDTYPE cmd_type;
  1095. #ifndef AGPOFF
  1096. agp_kern_info *agp_info;
  1097. agp_memory *agp;
  1098. u32 agp_phys;
  1099. #endif
  1100. #endif
  1101. /*karl:10/01/2001 */
  1102. if (!sisfb_mem) {
  1104. if (ivideo.video_size > 0x800000)
  1105. sisfb_heap_start =
  1106.     (unsigned long) ivideo.video_vbase + 0x800000;
  1107. else
  1108. sisfb_heap_start =
  1109.     (unsigned long) ivideo.video_vbase + 0x400000;
  1110. } else
  1111. sisfb_heap_start =
  1112.     (unsigned long) (ivideo.video_vbase + sisfb_mem * 0x100000);
  1114. sisfb_heap_end = (unsigned long) ivideo.video_vbase + ivideo.video_size;
  1115. sisfb_heap_size = sisfb_heap_end - sisfb_heap_start;
  1117. #ifdef CONFIG_FB_SIS_315
  1119. cmdq_baseport =
  1120.     (unsigned long *) (ivideo.mmio_vbase + MMIO_QUEUE_PHYBASE);
  1121. write_port =
  1122.     (unsigned long *) (ivideo.mmio_vbase + MMIO_QUEUE_WRITEPORT);
  1123. read_port = (unsigned long *) (ivideo.mmio_vbase + MMIO_QUEUE_READPORT);
  1125. DPRINTK ("AGP base: 0x%p, read: 0x%p, write: 0x%pn", cmdq_baseport,
  1126.  read_port, write_port);
  1128. agp_size = COMMAND_QUEUE_AREA_SIZE;
  1130. #ifndef AGPOFF
  1132. agp_info = vmalloc (sizeof (agp_kern_info));
  1133. memset ((void *) agp_info, 0x00, sizeof (agp_kern_info));
  1134. agp_copy_info (agp_info);
  1136. agp_backend_acquire ();
  1138. agp =
  1139.     agp_allocate_memory (COMMAND_QUEUE_AREA_SIZE / PAGE_SIZE,
  1140.  AGP_NORMAL_MEMORY);
  1141. if (agp == NULL) {
  1142. DPRINTK ("Allocate AGP buffer failed.n");
  1143. agp_enabled = 0;
  1144. } else {
  1145. if (agp_bind_memory (agp, agp->pg_start) != 0) {
  1146. DPRINTK ("AGP : can not bind memoryn");
  1147. agp_enabled = 0;
  1148. } else {
  1149. agp_enable (0);
  1150. }
  1151. }
  1153. #else
  1154. agp_enabled = 0;
  1155. #endif
  1156. if (agp_enabled)
  1157. cmd_type = AGP_CMD_QUEUE;
  1158. else if (sisfb_heap_size >= COMMAND_QUEUE_AREA_SIZE)
  1159. cmd_type = VM_CMD_QUEUE;
  1160. else
  1161. cmd_type = MMIO_CMD;
  1163. switch (agp_size) {
  1164. case 0x80000:
  1165. temp = SIS_CMD_QUEUE_SIZE_512k;
  1166. break;
  1167. case 0x100000:
  1168. temp = SIS_CMD_QUEUE_SIZE_1M;
  1169. break;
  1170. case 0x200000:
  1171. temp = SIS_CMD_QUEUE_SIZE_2M;
  1172. break;
  1173. case 0x400000:
  1174. temp = SIS_CMD_QUEUE_SIZE_4M;
  1175. break;
  1176. }
  1178. switch (cmd_type) {
  1179. case AGP_CMD_QUEUE:
  1180. #ifndef AGPOFF
  1181. DPRINTK ("AGP buffer base:0x%lx, offset:0x%x, size is %dKn",
  1182.  agp_info->aper_base, agp->physical, agp_size / 1024);
  1184. agp_phys = agp_info->aper_base + agp->physical;
  1186. vgawb (CRTC_ADR, IND_SIS_AGP_IO_PAD);
  1187. vgawb (CRTC_DATA, 0);
  1188. vgawb (CRTC_DATA, SIS_AGP_2X);
  1190. vgawb (SEQ_ADR, IND_SIS_CMDQUEUE_THRESHOLD);
  1191. vgawb (SEQ_DATA, COMMAND_QUEUE_THRESHOLD);
  1193. vgawb (SEQ_ADR, IND_SIS_CMDQUEUE_SET);
  1194. vgawb (SEQ_DATA, SIS_CMD_QUEUE_RESET);
  1196. *write_port = *read_port;
  1198. temp |= SIS_AGP_CMDQUEUE_ENABLE;
  1199. vgawb (SEQ_ADR, IND_SIS_CMDQUEUE_SET);
  1200. vgawb (SEQ_DATA, temp);
  1202. *cmdq_baseport = agp_phys;
  1204. sisfb_caps |= AGP_CMD_QUEUE_CAP;
  1205. #endif
  1206. break;
  1208. case VM_CMD_QUEUE:
  1209. sisfb_heap_end -= COMMAND_QUEUE_AREA_SIZE;
  1210. sisfb_heap_size -= COMMAND_QUEUE_AREA_SIZE;
  1212. vgawb (SEQ_ADR, IND_SIS_CMDQUEUE_THRESHOLD);
  1213. vgawb (SEQ_DATA, COMMAND_QUEUE_THRESHOLD);
  1215. vgawb (SEQ_ADR, IND_SIS_CMDQUEUE_SET);
  1216. vgawb (SEQ_DATA, SIS_CMD_QUEUE_RESET);
  1218. *write_port = *read_port;
  1220. temp |= SIS_VRAM_CMDQUEUE_ENABLE;
  1221. vgawb (SEQ_ADR, IND_SIS_CMDQUEUE_SET);
  1222. vgawb (SEQ_DATA, temp);
  1224. *cmdq_baseport = ivideo.video_size - COMMAND_QUEUE_AREA_SIZE;
  1226. sisfb_caps |= VM_CMD_QUEUE_CAP;
  1228. DPRINTK ("VM Cmd Queue offset = 0x%lx, size is %dKn",
  1229.  *cmdq_baseport, COMMAND_QUEUE_AREA_SIZE / 1024);
  1230. break;
  1231. default:
  1232. vgawb (SEQ_ADR, IND_SIS_CMDQUEUE_SET);
  1233. vgawb (SEQ_DATA, SIS_MMIO_CMD_ENABLE);
  1234. break;
  1235. }
  1237. #endif
  1239. #ifdef CONFIG_FB_SIS_300
  1240. if (sisfb_heap_size >= TURBO_QUEUE_AREA_SIZE) {
  1241. unsigned int tqueue_pos;
  1242. u8 tq_state;
  1244. tqueue_pos =
  1245.     (ivideo.video_size - TURBO_QUEUE_AREA_SIZE) / (64 * 1024);
  1246. temp = (u8) (tqueue_pos & 0xff);
  1247. vgawb (SEQ_ADR, IND_SIS_TURBOQUEUE_SET);
  1248. tq_state = vgarb (SEQ_DATA);
  1249. tq_state |= 0xf0;
  1250. tq_state &= 0xfc;
  1251. tq_state |= (u8) (tqueue_pos >> 8);
  1252. vgawb (SEQ_DATA, tq_state);
  1253. vgawb (SEQ_ADR, IND_SIS_TURBOQUEUE_ADR);
  1254. vgawb (SEQ_DATA, temp);
  1256. sisfb_caps |= TURBO_QUEUE_CAP;
  1258. sisfb_heap_end -= TURBO_QUEUE_AREA_SIZE;
  1259. sisfb_heap_size -= TURBO_QUEUE_AREA_SIZE;
  1260. DPRINTK ("Turbo Queue: start at 0x%lx, size is %dKn",
  1261.  sisfb_heap_end, TURBO_QUEUE_AREA_SIZE / 1024);
  1262. }
  1263. #endif
  1265. if (sisfb_heap_size >= HW_CURSOR_AREA_SIZE) {
  1266. sisfb_heap_end -= HW_CURSOR_AREA_SIZE;
  1267. sisfb_heap_size -= HW_CURSOR_AREA_SIZE;
  1268. sisfb_hwcursor_vbase = sisfb_heap_end;
  1270. sisfb_caps |= HW_CURSOR_CAP;
  1272. DPRINTK ("Hardware Cursor: start at 0x%lx, size is %dKn",
  1273.  sisfb_heap_end, HW_CURSOR_AREA_SIZE / 1024);
  1274. }
  1276. sisfb_heap.poha_chain = NULL;
  1277. sisfb_heap.poh_freelist = NULL;
  1279. poh = sisfb_poh_new_node ();
  1281. if (poh == NULL)
  1282. return 1;
  1284. poh->poh_next = &sisfb_heap.oh_free;
  1285. poh->poh_prev = &sisfb_heap.oh_free;
  1286. poh->size = sisfb_heap_end - sisfb_heap_start + 1;
  1287. poh->offset = sisfb_heap_start - (unsigned long) ivideo.video_vbase;
  1289. DPRINTK ("sisfb:Heap start:0x%p, end:0x%p, len=%dkn",
  1290.  (char *) sisfb_heap_start, (char *) sisfb_heap_end,
  1291.  (unsigned int) poh->size / 1024);
  1293. DPRINTK ("sisfb:First Node offset:0x%x, size:%dkn",
  1294.  (unsigned int) poh->offset, (unsigned int) poh->size / 1024);
  1296. sisfb_heap.oh_free.poh_next = poh;
  1297. sisfb_heap.oh_free.poh_prev = poh;
  1298. sisfb_heap.oh_free.size = 0;
  1299. sisfb_heap.max_freesize = poh->size;
  1301. sisfb_heap.oh_used.poh_next = &sisfb_heap.oh_used;
  1302. sisfb_heap.oh_used.poh_prev = &sisfb_heap.oh_used;
  1303. sisfb_heap.oh_used.size = SENTINEL;
  1305. return 0;
  1306. }
  1308. static SIS_OH *sisfb_poh_new_node (void)
  1309. {
  1310. int i;
  1311. unsigned long cOhs;
  1312. SIS_OHALLOC *poha;
  1313. SIS_OH *poh;
  1315. if (sisfb_heap.poh_freelist == NULL) {
  1316. poha = kmalloc (OH_ALLOC_SIZE, GFP_KERNEL);
  1318. poha->poha_next = sisfb_heap.poha_chain;
  1319. sisfb_heap.poha_chain = poha;
  1321. cOhs =
  1322.     (OH_ALLOC_SIZE -
  1323.      sizeof (SIS_OHALLOC)) / sizeof (SIS_OH) + 1;
  1325. poh = &poha->aoh[0];
  1326. for (i = cOhs - 1; i != 0; i--) {
  1327. poh->poh_next = poh + 1;
  1328. poh = poh + 1;
  1329. }
  1331. poh->poh_next = NULL;
  1332. sisfb_heap.poh_freelist = &poha->aoh[0];
  1333. }
  1335. poh = sisfb_heap.poh_freelist;
  1336. sisfb_heap.poh_freelist = poh->poh_next;
  1338. return (poh);
  1339. }
  1341. static SIS_OH *sisfb_poh_allocate (unsigned long size)
  1342. {
  1343. SIS_OH *pohThis;
  1344. SIS_OH *pohRoot;
  1345. int bAllocated = 0;
  1347. if (size > sisfb_heap.max_freesize) {
  1348. DPRINTK ("sisfb: Can't allocate %dk size on offscreenn",
  1349.  (unsigned int) size / 1024);
  1350. return (NULL);
  1351. }
  1353. pohThis = sisfb_heap.oh_free.poh_next;
  1355. while (pohThis != &sisfb_heap.oh_free) {
  1356. if (size <= pohThis->size) {
  1357. bAllocated = 1;
  1358. break;
  1359. }
  1360. pohThis = pohThis->poh_next;
  1361. }
  1363. if (!bAllocated) {
  1364. DPRINTK ("sisfb: Can't allocate %dk size on offscreenn",
  1365.  (unsigned int) size / 1024);
  1366. return (NULL);
  1367. }
  1369. if (size == pohThis->size) {
  1370. pohRoot = pohThis;
  1371. sisfb_delete_node (pohThis);
  1372. } else {
  1373. pohRoot = sisfb_poh_new_node ();
  1375. if (pohRoot == NULL) {
  1376. return (NULL);
  1377. }
  1379. pohRoot->offset = pohThis->offset;
  1380. pohRoot->size = size;
  1382. pohThis->offset += size;
  1383. pohThis->size -= size;
  1384. }
  1386. sisfb_heap.max_freesize -= size;
  1388. pohThis = &sisfb_heap.oh_used;
  1389. sisfb_insert_node (pohThis, pohRoot);
  1391. return (pohRoot);
  1392. }
  1394. static void sisfb_delete_node (SIS_OH * poh)
  1395. {
  1396. SIS_OH *poh_prev;
  1397. SIS_OH *poh_next;
  1399. poh_prev = poh->poh_prev;
  1400. poh_next = poh->poh_next;
  1402. poh_prev->poh_next = poh_next;
  1403. poh_next->poh_prev = poh_prev;
  1405. return;
  1406. }
  1408. static void sisfb_insert_node (SIS_OH * pohList, SIS_OH * poh)
  1409. {
  1410. SIS_OH *pohTemp;
  1412. pohTemp = pohList->poh_next;
  1414. pohList->poh_next = poh;
  1415. pohTemp->poh_prev = poh;
  1417. poh->poh_prev = pohList;
  1418. poh->poh_next = pohTemp;
  1419. }
  1421. static SIS_OH *sisfb_poh_free (unsigned long base)
  1422. {
  1424. SIS_OH *pohThis;
  1425. SIS_OH *poh_freed;
  1426. SIS_OH *poh_prev;
  1427. SIS_OH *poh_next;
  1428. unsigned long ulUpper;
  1429. unsigned long ulLower;
  1430. int foundNode = 0;
  1432. poh_freed = sisfb_heap.oh_used.poh_next;
  1434. while (poh_freed != &sisfb_heap.oh_used) {
  1435. if (poh_freed->offset == base) {
  1436. foundNode = 1;
  1437. break;
  1438. }
  1440. poh_freed = poh_freed->poh_next;
  1441. }
  1443. if (!foundNode)
  1444. return (NULL);
  1446. sisfb_heap.max_freesize += poh_freed->size;
  1448. poh_prev = poh_next = NULL;
  1449. ulUpper = poh_freed->offset + poh_freed->size;
  1450. ulLower = poh_freed->offset;
  1452. pohThis = sisfb_heap.oh_free.poh_next;
  1454. while (pohThis != &sisfb_heap.oh_free) {
  1455. if (pohThis->offset == ulUpper) {
  1456. poh_next = pohThis;
  1457. } else if ((pohThis->offset + pohThis->size) == ulLower) {
  1458. poh_prev = pohThis;
  1459. }
  1460. pohThis = pohThis->poh_next;
  1461. }
  1463. sisfb_delete_node (poh_freed);
  1465. if (poh_prev && poh_next) {
  1466. poh_prev->size += (poh_freed->size + poh_next->size);
  1467. sisfb_delete_node (poh_next);
  1468. sisfb_free_node (poh_freed);
  1469. sisfb_free_node (poh_next);
  1470. return (poh_prev);
  1471. }
  1473. if (poh_prev) {
  1474. poh_prev->size += poh_freed->size;
  1475. sisfb_free_node (poh_freed);
  1476. return (poh_prev);
  1477. }
  1479. if (poh_next) {
  1480. poh_next->size += poh_freed->size;
  1481. poh_next->offset = poh_freed->offset;
  1482. sisfb_free_node (poh_freed);
  1483. return (poh_next);
  1484. }
  1486. sisfb_insert_node (&sisfb_heap.oh_free, poh_freed);
  1488. return (poh_freed);
  1489. }
  1491. static void sisfb_free_node (SIS_OH * poh)
  1492. {
  1493. if (poh == NULL) {
  1494. return;
  1495. }
  1497. poh->poh_next = sisfb_heap.poh_freelist;
  1498. sisfb_heap.poh_freelist = poh;
  1500. return;
  1501. }
  1503. void sis_malloc (struct sis_memreq *req)
  1504. {
  1505. SIS_OH *poh;
  1507. poh = sisfb_poh_allocate (req->size);
  1509. if (poh == NULL) {
  1510. req->offset = 0;
  1511. req->size = 0;
  1512. DPRINTK ("sisfb: VMEM Allocation Failedn");
  1513. } else {
  1514. DPRINTK ("sisfb: VMEM Allocation Successed : 0x%pn",
  1515.  (char *) (poh->offset +
  1516.    (unsigned long) ivideo.video_vbase));
  1518. req->offset = poh->offset;
  1519. req->size = poh->size;
  1520. }
  1522. }
  1524. void sis_free (unsigned long base)
  1525. {
  1526. SIS_OH *poh;
  1528. poh = sisfb_poh_free (base);
  1530. if (poh == NULL) {
  1531. DPRINTK ("sisfb: sisfb_poh_free() failed at base 0x%xn",
  1532.  (unsigned int) base);
  1533. }
  1534. }
  1536. /* ------------------ SetMode Routines ------------------------------- */
  1538. static void sisfb_pre_setmode (void)
  1539. {
  1540. u8 cr30 = 0, cr31 = 0;
  1542. vgawb (CRTC_ADR, 0x31);
  1543. cr31 = vgarb (CRTC_DATA) & ~0x60;
  1545. switch (ivideo.disp_state & DISPTYPE_DISP2) {
  1546. case DISPTYPE_CRT2:
  1547. cr30 = (SIS_VB_OUTPUT_CRT2 | SIS_SIMULTANEOUS_VIEW_ENABLE);
  1548. cr31 |= SIS_DRIVER_MODE;
  1549. break;
  1550. case DISPTYPE_LCD:
  1551. cr30 = (SIS_VB_OUTPUT_LCD | SIS_SIMULTANEOUS_VIEW_ENABLE);
  1552. cr31 |= SIS_DRIVER_MODE;
  1553. break;
  1554. case DISPTYPE_TV:
  1555. if (ivideo.TV_type == TVMODE_HIVISION)
  1556. cr30 =
  1557.     (SIS_VB_OUTPUT_HIVISION |
  1558.      SIS_SIMULTANEOUS_VIEW_ENABLE);
  1559. else if (ivideo.TV_plug == TVPLUG_SVIDEO)
  1560. cr30 =
  1561.     (SIS_VB_OUTPUT_SVIDEO |
  1562.      SIS_SIMULTANEOUS_VIEW_ENABLE);
  1563. else if (ivideo.TV_plug == TVPLUG_COMPOSITE)
  1564. cr30 =
  1565.     (SIS_VB_OUTPUT_COMPOSITE |
  1566.      SIS_SIMULTANEOUS_VIEW_ENABLE);
  1567. else if (ivideo.TV_plug == TVPLUG_SCART)
  1568. cr30 =
  1569.     (SIS_VB_OUTPUT_SCART |
  1570.      SIS_SIMULTANEOUS_VIEW_ENABLE);
  1571. cr31 |= SIS_DRIVER_MODE;
  1573. /*karl */
  1574. if (sisfb_tvmode == 1)
  1575. cr31 |= 0x1;
  1576. if (sisfb_tvmode == 2)
  1577. cr31 &= ~0x1;
  1579. break;
  1580. default:
  1581. cr30 = 0x00;
  1582. cr31 |= (SIS_DRIVER_MODE | SIS_VB_OUTPUT_DISABLE);
  1583. }
  1585. vgawb (CRTC_ADR, IND_SIS_SCRATCH_REG_CR30);
  1586. vgawb (CRTC_DATA, cr30);
  1587. vgawb (CRTC_ADR, IND_SIS_SCRATCH_REG_CR31);
  1588. vgawb (CRTC_DATA, cr31);
  1589. vgawb (CRTC_ADR, IND_SIS_SCRATCH_REG_CR33);
  1590. vgawb (CRTC_DATA, sisfb_rate_idx & 0x0F);
  1591. }
  1593. static void sisfb_post_setmode (void)
  1594. {
  1595. u8 reg;
  1597. vgawb (CRTC_ADR, 0x17);
  1598. reg = vgarb (CRTC_DATA);
  1600. if ((ivideo.hasVB == HASVB_LVDS)
  1601.     || (ivideo.hasVB == HASVB_LVDS_CHRONTEL)) if (ivideo.video_bpp == 8)
  1602. sisfb_crt1off = 0;
  1604. if (sisfb_crt1off)
  1605. reg &= ~0x80;
  1606. else
  1607. reg |= 0x80;
  1608. vgawb (CRTC_DATA, reg);
  1610. vgawb (SEQ_ADR, IND_SIS_RAMDAC_CONTROL);
  1611. reg = vgarb (SEQ_DATA);
  1612. reg &= ~0x04;
  1613. vgawb (SEQ_DATA, reg);
  1615. if ((ivideo.disp_state & DISPTYPE_TV) && (ivideo.hasVB == HASVB_301)) {
  1616. /*karl */
  1617. vgawb (VB_PART4_ADR, 0x01);
  1618. reg = vgarb (VB_PART4_DATA);
  1620. if ((reg != 0xB1) && (reg != 0xB0)) { /*301B Revision ID */
  1621. // Eden Chen
  1622. switch (ivideo.video_width) {
  1623. case 320:
  1624. filter_tb =
  1625.     (ivideo.TV_type == TVMODE_NTSC) ? 4 : 12;
  1626. break;
  1627. case 640:
  1628. filter_tb =
  1629.     (ivideo.TV_type == TVMODE_NTSC) ? 5 : 13;
  1630. break;
  1631. case 720:
  1632. filter_tb =
  1633.     (ivideo.TV_type == TVMODE_NTSC) ? 6 : 14;
  1634. break;
  1635. case 800:
  1636. filter_tb =
  1637.     (ivideo.TV_type == TVMODE_NTSC) ? 7 : 15;
  1638. break;
  1639. default:
  1640. filter = -1;
  1641. break;
  1642. }
  1643. // ~Eden Chen
  1645. // Eden Chen
  1646. //vgawb(VB_PART1_ADR,  0x24);
  1647. vgawb (VB_PART1_ADR, IND_SIS_CRT2_WRITE_ENABLE);
  1648. // ~Eden Chen
  1649. vgawb (VB_PART1_DATA, 0x1);
  1651. // Eden Chen for Debug
  1652. // ~Eden Chen
  1654. if (ivideo.TV_type == TVMODE_NTSC) {
  1655. vgawb (VB_PART2_ADR, 0x3A);
  1656. reg = vgarb (VB_PART2_DATA);
  1657. reg &= 0x1F;
  1658. vgawb (VB_PART2_DATA, reg);
  1660. if (ivideo.TV_plug == TVPLUG_SVIDEO) {
  1661. vgawb (VB_PART2_ADR, 0x30);
  1662. reg = vgarb (VB_PART2_DATA);
  1663. reg &= 0xDF;
  1664. vgawb (VB_PART2_DATA, reg);
  1665. } else if (ivideo.TV_plug == TVPLUG_COMPOSITE) {
  1666. vgawb (VB_PART2_ADR, 0x30);
  1667. reg = vgarb (VB_PART2_DATA);
  1668. reg |= 0x20;
  1669. vgawb (VB_PART2_DATA, reg);
  1671. switch (ivideo.video_width) {
  1672. case 640:
  1673. vgawb (VB_PART2_ADR, 0x35);
  1674. vgawb (VB_PART2_DATA, 0xEB);
  1675. vgawb (VB_PART2_ADR, 0x36);
  1676. vgawb (VB_PART2_DATA, 0x04);
  1677. vgawb (VB_PART2_ADR, 0x37);
  1678. vgawb (VB_PART2_DATA, 0x25);
  1679. vgawb (VB_PART2_ADR, 0x38);
  1680. vgawb (VB_PART2_DATA, 0x18);
  1681. break;
  1682. case 720:
  1683. vgawb (VB_PART2_ADR, 0x35);
  1684. vgawb (VB_PART2_DATA, 0xEE);
  1685. vgawb (VB_PART2_ADR, 0x36);
  1686. vgawb (VB_PART2_DATA, 0x0C);
  1687. vgawb (VB_PART2_ADR, 0x37);
  1688. vgawb (VB_PART2_DATA, 0x22);
  1689. vgawb (VB_PART2_ADR, 0x38);
  1690. vgawb (VB_PART2_DATA, 0x08);
  1691. break;
  1692. case 800:
  1693. vgawb (VB_PART2_ADR, 0x35);
  1694. vgawb (VB_PART2_DATA, 0xEB);
  1695. vgawb (VB_PART2_ADR, 0x36);
  1696. vgawb (VB_PART2_DATA, 0x15);
  1697. vgawb (VB_PART2_ADR, 0x37);
  1698. vgawb (VB_PART2_DATA, 0x25);
  1699. vgawb (VB_PART2_ADR, 0x38);
  1700. vgawb (VB_PART2_DATA, 0xF6);
  1701. break;
  1702. }
  1703. }
  1704. } else if (ivideo.TV_type == TVMODE_PAL) {
  1705. vgawb (VB_PART2_ADR, 0x3A);
  1706. reg = vgarb (VB_PART2_DATA);
  1707. reg &= 0x1F;
  1708. vgawb (VB_PART2_DATA, reg);
  1710. if (ivideo.TV_plug == TVPLUG_SVIDEO) {
  1711. vgawb (VB_PART2_ADR, 0x30);
  1712. reg = vgarb (VB_PART2_DATA);
  1713. reg &= 0xDF;
  1714. vgawb (VB_PART2_DATA, reg);
  1715. } else if (ivideo.TV_plug == TVPLUG_COMPOSITE) {
  1716. vgawb (VB_PART2_ADR, 0x30);
  1717. reg = vgarb (VB_PART2_DATA);
  1718. reg |= 0x20;
  1719. vgawb (VB_PART2_DATA, reg);
  1721. switch (ivideo.video_width) {
  1722. case 640:
  1723. vgawb (VB_PART2_ADR, 0x35);
  1724. vgawb (VB_PART2_DATA, 0xF1);
  1725. vgawb (VB_PART2_ADR, 0x36);
  1726. vgawb (VB_PART2_DATA, 0xF7);
  1727. vgawb (VB_PART2_ADR, 0x37);
  1728. vgawb (VB_PART2_DATA, 0x1F);
  1729. vgawb (VB_PART2_ADR, 0x38);
  1730. vgawb (VB_PART2_DATA, 0x32);
  1731. break;
  1732. case 720:
  1733. vgawb (VB_PART2_ADR, 0x35);
  1734. vgawb (VB_PART2_DATA, 0xF3);
  1735. vgawb (VB_PART2_ADR, 0x36);
  1736. vgawb (VB_PART2_DATA, 0x00);
  1737. vgawb (VB_PART2_ADR, 0x37);
  1738. vgawb (VB_PART2_DATA, 0x1D);
  1739. vgawb (VB_PART2_ADR, 0x38);
  1740. vgawb (VB_PART2_DATA, 0x20);
  1741. break;
  1742. case 800:
  1743. vgawb (VB_PART2_ADR, 0x35);
  1744. vgawb (VB_PART2_DATA, 0xFC);
  1745. vgawb (VB_PART2_ADR, 0x36);
  1746. vgawb (VB_PART2_DATA, 0xFB);
  1747. vgawb (VB_PART2_ADR, 0x37);
  1748. vgawb (VB_PART2_DATA, 0x14);
  1749. vgawb (VB_PART2_ADR, 0x38);
  1750. vgawb (VB_PART2_DATA, 0x2A);
  1751. break;
  1752. }
  1753. }
  1754. }
  1755. // Eden 
  1756. if ((filter >= 0) && (filter <= 7)) {
  1757. DPRINTK
  1758.     ("FilterTable[%d]-%d: %02x %02x %02x %02xn",
  1759.      filter_tb, filter,
  1760.      sis_TV_filter[filter_tb].filter[filter][0],
  1761.      sis_TV_filter[filter_tb].filter[filter][1],
  1762.      sis_TV_filter[filter_tb].filter[filter][2],
  1763.      sis_TV_filter[filter_tb].filter[filter][3]
  1764.     );
  1765. vgawb (VB_PART2_ADR, 0x35);
  1766. vgawb (VB_PART2_DATA,
  1767.        sis_TV_filter[filter_tb].
  1768.        filter[filter][0]);
  1769. vgawb (VB_PART2_ADR, 0x36);
  1770. vgawb (VB_PART2_DATA,
  1771.        sis_TV_filter[filter_tb].
  1772.        filter[filter][1]);
  1773. vgawb (VB_PART2_ADR, 0x37);
  1774. vgawb (VB_PART2_DATA,
  1775.        sis_TV_filter[filter_tb].
  1776.        filter[filter][2]);
  1777. vgawb (VB_PART2_ADR, 0x38);
  1778. vgawb (VB_PART2_DATA,
  1779.        sis_TV_filter[filter_tb].
  1780.        filter[filter][3]);
  1781. }
  1782. // ~Eden 
  1783. }
  1784. }
  1786. }
  1788. static void sisfb_crtc_to_var (struct fb_var_screeninfo *var)
  1789. {
  1790. u16 VRE, VBE, VRS, VBS, VDE, VT;
  1791. u16 HRE, HBE, HRS, HBS, HDE, HT;
  1792. u8 sr_data, cr_data, cr_data2, cr_data3, mr_data;
  1793. int A, B, C, D, E, F, temp;
  1794. double hrate, drate;
  1796. vgawb (SEQ_ADR, IND_SIS_COLOR_MODE);
  1797. sr_data = vgarb (SEQ_DATA);
  1799. if (sr_data & SIS_INTERLACED_MODE)
  1800. var->vmode = FB_VMODE_INTERLACED;
  1801. else
  1802. var->vmode = FB_VMODE_NONINTERLACED;
  1804. switch ((sr_data & 0x1C) >> 2) {
  1805. case SIS_8BPP_COLOR_MODE:
  1806. var->bits_per_pixel = 8;
  1807. break;
  1808. case SIS_16BPP_COLOR_MODE:
  1809. var->bits_per_pixel = 16;
  1810. break;
  1811. case SIS_32BPP_COLOR_MODE:
  1812. var->bits_per_pixel = 32;
  1813. break;
  1814. }
  1816. switch (var->bits_per_pixel) {
  1817. case 8:
  1818. var->red.length = 6;
  1819. var->green.length = 6;
  1820. var->blue.length = 6;
  1821. video_cmap_len = 256;
  1822. break;
  1823. case 16:
  1824. var->red.offset = 11;
  1825. var->red.length = 5;
  1826. var->green.offset = 5;
  1827. var->green.length = 6;
  1828. var->blue.offset = 0;
  1829. var->blue.length = 5;
  1830. var->transp.offset = 0;
  1831. var->transp.length = 0;
  1832. video_cmap_len = 16;
  1834. break;
  1835. case 24:
  1836. var->red.offset = 16;
  1837. var->red.length = 8;
  1838. var->green.offset = 8;
  1839. var->green.length = 8;
  1840. var->blue.offset = 0;
  1841. var->blue.length = 8;
  1842. var->transp.offset = 0;
  1843. var->transp.length = 0;
  1844. video_cmap_len = 16;
  1845. break;
  1846. case 32:
  1847. var->red.offset = 16;
  1848. var->red.length = 8;
  1849. var->green.offset = 8;
  1850. var->green.length = 8;
  1851. var->blue.offset = 0;
  1852. var->blue.length = 8;
  1853. var->transp.offset = 24;
  1854. var->transp.length = 8;
  1855. video_cmap_len = 16;
  1856. break;
  1857. }
  1859. vgawb (SEQ_ADR, 0xA);
  1860. sr_data = vgarb (SEQ_DATA);
  1862. vgawb (CRTC_ADR, 0x6);
  1863. cr_data = vgarb (CRTC_DATA);
  1864. vgawb (CRTC_ADR, 0x7);
  1865. cr_data2 = vgarb (CRTC_DATA);
  1866. VT =
  1867.     (cr_data & 0xFF) | ((u16) (cr_data2 & 0x01) << 8) |
  1868.     ((u16) (cr_data2 & 0x20) << 4) | ((u16) (sr_data & 0x01) << 10);
  1869. A = VT + 2;
  1871. vgawb (CRTC_ADR, 0x12);
  1872. cr_data = vgarb (CRTC_DATA);
  1873. VDE =
  1874.     (cr_data & 0xff) | ((u16) (cr_data2 & 0x02) << 7) |
  1875.     ((u16) (cr_data2 & 0x40) << 3) | ((u16) (sr_data & 0x02) << 9);
  1876. E = VDE + 1;
  1878. vgawb (CRTC_ADR, 0x10);
  1879. cr_data = vgarb (CRTC_DATA);
  1880. VRS =
  1881.     (cr_data & 0xff) | ((u16) (cr_data2 & 0x04) << 6) |
  1882.     ((u16) (cr_data2 & 0x80) << 2) | ((u16) (sr_data & 0x08) << 7);
  1883. F = VRS + 1 - E;
  1885. vgawb (CRTC_ADR, 0x15);
  1886. cr_data = vgarb (CRTC_DATA);
  1887. vgawb (CRTC_ADR, 0x9);
  1888. cr_data3 = vgarb (CRTC_DATA);
  1889. VBS = (cr_data & 0xff) | ((u16) (cr_data2 & 0x08) << 5) |
  1890.     ((u16) (cr_data3 & 0x20) << 4) | ((u16) (sr_data & 0x04) << 8);
  1892. vgawb (CRTC_ADR, 0x16);
  1893. cr_data = vgarb (CRTC_DATA);
  1894. VBE = (cr_data & 0xff) | ((u16) (sr_data & 0x10) << 4);
  1895. temp = VBE - ((E - 1) & 511);
  1896. B = (temp > 0) ? temp : (temp + 512);
  1898. vgawb (CRTC_ADR, 0x11);
  1899. cr_data = vgarb (CRTC_DATA);
  1900. VRE = (cr_data & 0x0f) | ((sr_data & 0x20) >> 1);
  1901. temp = VRE - ((E + F - 1) & 31);
  1902. C = (temp > 0) ? temp : (temp + 32);
  1904. D = B - F - C;
  1906. var->yres = var->yres_virtual = E;
  1907. var->upper_margin = D;
  1908. var->lower_margin = F;
  1909. var->vsync_len = C;
  1911. vgawb (SEQ_ADR, 0xb);
  1912. sr_data = vgarb (SEQ_DATA);
  1914. vgawb (CRTC_ADR, 0x0);
  1915. cr_data = vgarb (CRTC_DATA);
  1916. HT = (cr_data & 0xff) | ((u16) (sr_data & 0x03) << 8);
  1917. A = HT + 5;
  1919. vgawb (CRTC_ADR, 0x1);
  1920. cr_data = vgarb (CRTC_DATA);
  1921. HDE = (cr_data & 0xff) | ((u16) (sr_data & 0x0C) << 6);
  1922. E = HDE + 1;
  1924. vgawb (CRTC_ADR, 0x4);
  1925. cr_data = vgarb (CRTC_DATA);
  1926. HRS = (cr_data & 0xff) | ((u16) (sr_data & 0xC0) << 2);
  1927. F = HRS - E - 3;
  1929. vgawb (CRTC_ADR, 0x2);
  1930. cr_data = vgarb (CRTC_DATA);
  1931. HBS = (cr_data & 0xff) | ((u16) (sr_data & 0x30) << 4);
  1933. vgawb (SEQ_ADR, 0xc);
  1934. sr_data = vgarb (SEQ_DATA);
  1935. vgawb (CRTC_ADR, 0x3);
  1936. cr_data = vgarb (CRTC_DATA);
  1937. vgawb (CRTC_ADR, 0x5);
  1938. cr_data2 = vgarb (CRTC_DATA);
  1939. HBE =
  1940.     (cr_data & 0x1f) | ((u16) (cr_data2 & 0x80) >> 2) |
  1941.     ((u16) (sr_data & 0x03) << 6);
  1942. HRE = (cr_data2 & 0x1f) | ((sr_data & 0x04) << 3);
  1944. temp = HBE - ((E - 1) & 255);
  1945. B = (temp > 0) ? temp : (temp + 256);
  1947. temp = HRE - ((E + F + 3) & 63);
  1948. C = (temp > 0) ? temp : (temp + 64);
  1950. D = B - F - C;
  1952. var->xres = var->xres_virtual = E * 8;
  1953. var->left_margin = D * 8;
  1954. var->right_margin = F * 8;
  1955. var->hsync_len = C * 8;
  1957. var->activate = FB_ACTIVATE_NOW;
  1959. var->sync = 0;
  1961. mr_data = vgarb (0x1C);
  1962. if (mr_data & 0x80)
  1963. var->sync &= ~FB_SYNC_VERT_HIGH_ACT;
  1964. else
  1965. var->sync |= FB_SYNC_VERT_HIGH_ACT;
  1967. if (mr_data & 0x40)
  1968. var->sync &= ~FB_SYNC_HOR_HIGH_ACT;
  1969. else
  1970. var->sync |= FB_SYNC_HOR_HIGH_ACT;
  1972. VT += 2;
  1973. VT <<= 1;
  1974. HT = (HT + 5) * 8;
  1976. hrate = (double) ivideo.refresh_rate * (double) VT / 2;
  1977. drate = hrate * HT;
  1978. var->pixclock = (u32) (1E12 / drate);
  1979. }
  1981. /* ------------------ Public Routines -------------------------------- */
  1983. static int sisfb_get_fix (struct fb_fix_screeninfo *fix, int con, struct fb_info *info)
  1984. {
  1985. memset (fix, 0, sizeof (struct fb_fix_screeninfo));
  1986. strcpy (fix->id, fb_info.modename);
  1988. fix->smem_start = ivideo.video_base;
  1990. /*karl:10/01/2001 */
  1991. if (!sisfb_mem) {
  1992. if (ivideo.video_size > 0x800000)
  1993. fix->smem_len = 0x800000;
  1994. else
  1995. fix->smem_len = 0x400000;
  1996. } else
  1997. fix->smem_len = sisfb_mem * 0x100000;
  1999. fix->type = video_type;
  2000. fix->type_aux = 0;
  2001. if (ivideo.video_bpp == 8)
  2002. fix->visual = FB_VISUAL_PSEUDOCOLOR;
  2003. else
  2004. fix->visual = FB_VISUAL_TRUECOLOR;
  2005. fix->xpanstep = 0;
  2006. fix->ypanstep = 0;
  2007. fix->ywrapstep = 0;
  2008. fix->line_length = video_linelength;
  2009. fix->mmio_start = ivideo.mmio_base;
  2010. fix->mmio_len = sisfb_mmio_size;
  2011. fix->accel = FB_ACCEL_SIS_GLAMOUR;
  2012. fix->reserved[0] = ivideo.video_size & 0xFFFF;
  2013. fix->reserved[1] = (ivideo.video_size >> 16) & 0xFFFF;
  2014. fix->reserved[2] = sisfb_caps;
  2016. return 0;
  2018. }
  2020. static int sisfb_get_var (struct fb_var_screeninfo *var, int con, struct fb_info *info)
  2021. {
  2022. if (con == -1)
  2023. memcpy (var, &default_var, sizeof (struct fb_var_screeninfo));
  2024. else
  2025. *var = fb_display[con].var;
  2027. return 0;
  2028. }
  2030. static int sisfb_set_var (struct fb_var_screeninfo *var, int con, struct fb_info *info)
  2031. {
  2032. int err;
  2033. unsigned int cols, rows;
  2035. fb_display[con].var.activate = FB_ACTIVATE_NOW;
  2037. if (sisfb_do_set_var (var, con == currcon, info)) {
  2038. sisfb_crtc_to_var (var);
  2039. return -EINVAL;
  2040. }
  2042. sisfb_crtc_to_var (var);
  2044. sisfb_set_disp (con, var);
  2046. if (info->changevar)
  2047. (*info->changevar) (con);
  2049. if ((err = fb_alloc_cmap (&fb_display[con].cmap, 0, 0)))
  2050. return err;
  2052. sisfb_do_install_cmap (con, info);
  2054. cols = sisbios_mode[sisfb_mode_idx].cols;
  2055. rows = sisbios_mode[sisfb_mode_idx].rows;
  2056. vc_resize_con (rows, cols, fb_display[con].conp->vc_num);
  2058. return 0;
  2060. }
  2062. static int sisfb_get_cmap (struct fb_cmap *cmap, int kspc, int con, struct fb_info *info)
  2063. {
  2064. if (con == currcon)
  2065. return fb_get_cmap (cmap, kspc, sis_getcolreg, info);
  2066. else if (fb_display[con].cmap.len)
  2067. fb_copy_cmap (&fb_display[con].cmap, cmap, kspc ? 0 : 2);
  2068. else
  2069. fb_copy_cmap (fb_default_cmap (video_cmap_len), cmap,
  2070.       kspc ? 0 : 2);
  2072. return 0;
  2073. }
  2075. static int sisfb_set_cmap (struct fb_cmap *cmap, int kspc, int con, struct fb_info *info)
  2076. {
  2077. int err;
  2079. if (!fb_display[con].cmap.len) {
  2080. err = fb_alloc_cmap (&fb_display[con].cmap, video_cmap_len, 0);
  2081. if (err)
  2082. return err;
  2083. }
  2084. if (con == currcon)
  2085. return fb_set_cmap (cmap, kspc, sis_setcolreg, info);
  2086. else
  2087. fb_copy_cmap (cmap, &fb_display[con].cmap, kspc ? 0 : 1);
  2088. return 0;
  2089. }
  2091. static int sisfb_ioctl (struct inode *inode, struct file *file,
  2092.      unsigned int cmd, unsigned long arg, int con, struct fb_info *info)
  2093. {
  2094. switch (cmd) {
  2095. case FBIO_ALLOC:
  2096. if (!capable (CAP_SYS_RAWIO))
  2097. return -EPERM;
  2098. sis_malloc ((struct sis_memreq *) arg);
  2099. break;
  2100. case FBIO_FREE:
  2101. if (!capable (CAP_SYS_RAWIO))
  2102. return -EPERM;
  2103. sis_free (*(unsigned long *) arg);
  2104. break;
  2105. case FBIOGET_GLYPH:
  2106. sis_get_glyph ((SIS_GLYINFO *) arg);
  2107. break;
  2108. case FBIOGET_HWCINFO:
  2109. {
  2110. unsigned long *hwc_offset = (unsigned long *) arg;
  2112. if (sisfb_caps & HW_CURSOR_CAP)
  2113. *hwc_offset = sisfb_hwcursor_vbase -
  2114.     (unsigned long) ivideo.video_vbase;
  2115. else
  2116. *hwc_offset = 0;
  2118. break;
  2119. }
  2120. case FBIOPUT_MODEINFO:
  2121. {
  2122. struct mode_info *x = (struct mode_info *) arg;
  2124. ivideo.video_bpp = x->bpp;
  2125. ivideo.video_width = x->xres;
  2126. ivideo.video_height = x->yres;
  2127. ivideo.video_vwidth = x->v_xres;
  2128. ivideo.video_vheight = x->v_yres;
  2129. ivideo.org_x = x->org_x;
  2130. ivideo.org_y = x->org_y;
  2131. ivideo.refresh_rate = x->vrate;
  2133. break;
  2134. }
  2135. case FBIOGET_DISPINFO:
  2136. sis_dispinfo ((struct ap_data *) arg);
  2137. break;
  2138. default:
  2139. return -EINVAL;
  2140. }
  2141. return 0;
  2143. }
  2145. static int sisfb_mmap (struct fb_info *info, struct file *file, struct vm_area_struct *vma)
  2146. {
  2147. struct fb_var_screeninfo var;
  2148. unsigned long start;
  2149. unsigned long off;
  2150. u32 len;
  2152. if (vma->vm_pgoff > (~0UL >> PAGE_SHIFT))
  2153. return -EINVAL;
  2154. off = vma->vm_pgoff << PAGE_SHIFT;
  2156. start = (unsigned long) ivideo.video_base;
  2157. len = PAGE_ALIGN ((start & ~PAGE_MASK) + ivideo.video_size);
  2159. if (off >= len) {
  2160. off -= len;
  2161. sisfb_get_var (&var, currcon, info);
  2162. if (var.accel_flags)
  2163. return -EINVAL;
  2164. start = (unsigned long) ivideo.mmio_base;
  2165. len = PAGE_ALIGN ((start & ~PAGE_MASK) + sisfb_mmio_size);
  2166. }
  2168. start &= PAGE_MASK;
  2169. if ((vma->vm_end - vma->vm_start + off) > len)
  2170. return -EINVAL;
  2171. off += start;
  2172. vma->vm_pgoff = off >> PAGE_SHIFT;
  2174. #if defined(__i386__)
  2175. if (boot_cpu_data.x86 > 3)
  2176. pgprot_val (vma->vm_page_prot) |= _PAGE_PCD;
  2177. #endif
  2178. if (io_remap_page_range(vma->vm_start, off, vma->vm_end - vma->vm_start, vma->vm_page_prot)) 
  2179. return -EAGAIN;
  2180. return 0;
  2182. }
  2184. static struct fb_ops sisfb_ops = {
  2185. owner:THIS_MODULE,
  2186. fb_get_fix:sisfb_get_fix,
  2187. fb_get_var:sisfb_get_var,
  2188. fb_set_var:sisfb_set_var,
  2189. fb_get_cmap:sisfb_get_cmap,
  2190. fb_set_cmap:sisfb_set_cmap,
  2191. fb_ioctl:sisfb_ioctl,
  2192. fb_mmap:sisfb_mmap,
  2193. };
  2195. /* ------------ Interface to the low level console driver -------------*/
  2197. static int sisfb_update_var (int con, struct fb_info *info)
  2198. {
  2199. return 0;
  2200. }
  2202. static int sisfb_switch (int con, struct fb_info *info)
  2203. {
  2204. int cols, rows;
  2206. if (fb_display[currcon].cmap.len)
  2207. fb_get_cmap (&fb_display[currcon].cmap, 1, sis_getcolreg, info);
  2209. fb_display[con].var.activate = FB_ACTIVATE_NOW;
  2211. if (!memcmp(&fb_display[con].var, &fb_display[currcon].var, sizeof (struct fb_var_screeninfo))) {
  2212. currcon = con;
  2213. return 1;
  2214. }
  2216. currcon = con;
  2218. sisfb_do_set_var (&fb_display[con].var, 1, info);
  2220. sisfb_set_disp (con, &fb_display[con].var);
  2222. sisfb_do_install_cmap (con, info);
  2224. cols = sisbios_mode[sisfb_mode_idx].cols;
  2225. rows = sisbios_mode[sisfb_mode_idx].rows;
  2226. vc_resize_con (rows, cols, fb_display[con].conp->vc_num);
  2228. sisfb_update_var (con, info);
  2230. return 1;
  2232. }
  2234. static void sisfb_blank (int blank, struct fb_info *info)
  2235. {
  2236. u8 reg;
  2238. vgawb (CRTC_ADR, 0x17);
  2239. reg = vgarb (CRTC_DATA);
  2241. if (blank > 0)
  2242. reg &= 0x7f;
  2243. else
  2244. reg |= 0x80;
  2246. vgawb (CRTC_ADR, 0x17);
  2247. vgawb (CRTC_DATA, reg);
  2248. }
  2250. int sisfb_setup (char *options)
  2251. {
  2252. char *this_opt;
  2254. fb_info.fontname[0] = '';
  2255. ivideo.refresh_rate = 0;
  2257. if (!options || !*options)
  2258. return 0;
  2260. for (this_opt = strtok (options, ","); this_opt;
  2261.      this_opt = strtok (NULL, ",")) {
  2262. if (!*this_opt)
  2263. continue;
  2265. if (!strcmp (this_opt, "inverse")) {
  2266. sisfb_inverse = 1;
  2267. fb_invert_cmaps ();
  2268. } else if (!strncmp (this_opt, "font:", 5)) {
  2269. strcpy (fb_info.fontname, this_opt + 5);
  2270. } else if (!strncmp (this_opt, "mode:", 5)) {
  2271. sisfb_search_mode (this_opt + 5);
  2272. } else if (!strncmp (this_opt, "vrate:", 6)) {
  2273. ivideo.refresh_rate =
  2274.     simple_strtoul (this_opt + 6, NULL, 0);
  2275. } else if (!strncmp (this_opt, "off", 3)) {
  2276. sisfb_off = 1;
  2277. } else if (!strncmp (this_opt, "crt1off", 7)) {
  2278. sisfb_crt1off = 1;
  2279. } else if (!strncmp (this_opt, "filter:", 7)) {
  2280. filter = (int) simple_strtoul (this_opt + 7, NULL, 0);
  2281. }
  2282. /*karl */
  2283. else if (!strncmp (this_opt, "tvmode:", 7)) {
  2284. if (!strncmp (this_opt + 7, "pal", 3))
  2285. sisfb_tvmode = 1;
  2286. if (!strncmp (this_opt + 7, "ntsc", 4))
  2287. sisfb_tvmode = 2;
  2288. }
  2289. /*karl:10/01/2001 */
  2290. else if (!strncmp (this_opt, "mem:", 4)) {
  2292. sisfb_mem = simple_strtoul (this_opt + 4, NULL, 0);
  2294. } else
  2295. DPRINTK ("invalid parameter %sn", this_opt);
  2296. }
  2297. return 0;
  2298. }
  2300. int __init sisfb_init (void)
  2301. {
  2302. struct pci_dev *pdev = NULL;
  2303. struct board *b;
  2304. int pdev_valid = 0;
  2305. //unsigned long rom_vbase;
  2306. u32 reg32;
  2307. u16 reg16;
  2308. u8 reg;
  2309. int nRes;
  2311. outb (0x77, 0x80);
  2313. if (sisfb_off)
  2314. return -ENXIO;
  2316. pci_for_each_dev (pdev)
  2317. {
  2318. for (b = sisdev_list; b->vendor; b++) {
  2319. if ((b->vendor == pdev->vendor)
  2320.     && (b->device == pdev->device)) {
  2321. pdev_valid = 1;
  2322. strcpy (fb_info.modename, b->name);
  2323. ivideo.chip_id = pdev->device;
  2324. pci_read_config_byte (pdev, PCI_REVISION_ID,
  2325.       &ivideo.revision_id);
  2326. pci_read_config_word (pdev, PCI_COMMAND, &reg16);
  2327. // Eden Chen
  2328. //sishw_ext.uRevisionID = ivideo.revision_id;
  2329. sishw_ext.jChipRevision = ivideo.revision_id;
  2330. // ~Eden Chen
  2331. sisvga_enabled = reg16 & 0x1;
  2332. break;
  2333. }
  2334. }
  2336. if (pdev_valid)
  2337. break;
  2338. }
  2340. if (!pdev_valid)
  2341. return -1;
  2343. // Eden Chen
  2344. switch (ivideo.chip_id) {
  2345. case PCI_DEVICE_ID_SI_300:
  2346. ivideo.chip = SIS_300;
  2347. sisvga_engine = SIS_300_VGA;
  2348. break;
  2349. case PCI_DEVICE_ID_SI_630_VGA:
  2350. {
  2351. sisfb_set_reg4 (0xCF8, 0x80000000);
  2352. reg32 = sisfb_get_reg3 (0xCFC);
  2353. if (reg32 == 0x07301039) {
  2354. ivideo.chip = SIS_730;
  2355. strcpy (fb_info.modename, "SIS 730");
  2356. } else
  2357. ivideo.chip = SIS_630;
  2359. sisvga_engine = SIS_300_VGA;
  2360. break;
  2361. }
  2362. case PCI_DEVICE_ID_SI_540_VGA:
  2363. ivideo.chip = SIS_540;
  2364. sisvga_engine = SIS_300_VGA;
  2365. break;
  2366. case PCI_DEVICE_ID_SI_315H:
  2367. ivideo.chip = SIS_315H;
  2368. sisvga_engine = SIS_315_VGA;
  2369. break;
  2370. case PCI_DEVICE_ID_SI_315:
  2371. ivideo.chip = SIS_315;
  2372. sisvga_engine = SIS_315_VGA;
  2373. break;
  2374. case PCI_DEVICE_ID_SI_315PRO:
  2375. ivideo.chip = SIS_315PRO;
  2376. sisvga_engine = SIS_315_VGA;
  2377. break;
  2378. case PCI_DEVICE_ID_SI_550_VGA:
  2379. ivideo.chip = SIS_550;
  2380. sisvga_engine = SIS_315_VGA;
  2381. break;
  2382. }
  2384. // Eden Chen
  2385. //sishw_ext.jChipID = ivideo.chip;
  2386. sishw_ext.jChipType = ivideo.chip;
  2387. // for Debug
  2388. if ((sishw_ext.jChipType == SIS_315PRO)
  2389.     || (sishw_ext.jChipType == SIS_315))
  2390. sishw_ext.jChipType = SIS_315H;
  2391. // ~Eden Chen
  2393. DPRINTK ("%s is used as %s device(VGA Engine %d).n",
  2394.  fb_info.modename, sisvga_enabled ? "primary" : "secondary",
  2395.  sisvga_engine);
  2397. ivideo.video_base = pci_resource_start (pdev, 0);
  2398. ivideo.mmio_base = pci_resource_start (pdev, 1);
  2399. // Eden Chen
  2400. //sishw_ext.IOAddress = (unsigned short) ivideo.vga_base 
  2401. //      = pci_resource_start(pdev, 2) + 0x30;
  2402. sishw_ext.ulIOAddress = (unsigned short) ivideo.vga_base = pci_resource_start (pdev, 2) + 0x30;
  2403. // ~Eden Chen
  2405. sisfb_mmio_size = pci_resource_len (pdev, 1);
  2407. if (!sisvga_enabled)
  2408. if (pci_enable_device (pdev))
  2409. return -EIO;
  2411. vgawb (SEQ_ADR, IND_SIS_PASSWORD);
  2412. vgawb (SEQ_DATA, SIS_PASSWORD);
  2414. #ifdef LINUXBIOS
  2415. #ifdef CONFIG_FB_SIS_300
  2416. if (sisvga_engine == SIS_300_VGA)
  2417. {
  2418. vgawb (SEQ_ADR, 0x28);
  2419. vgawb (SEQ_DATA, 0x37);
  2421. vgawb (SEQ_ADR, 0x29);
  2422. vgawb (SEQ_DATA, 0x61);
  2424. vgawb (SEQ_ADR, IND_SIS_SCRATCH_REG_1A);
  2425. reg = vgarb (SEQ_DATA);
  2426. reg |= SIS_SCRATCH_REG_1A_MASK;
  2427. vgawb (SEQ_DATA, reg);
  2428. }
  2429. #endif
  2430. #ifdef CONFIG_FB_SIS_315
  2431. if (ivideo.chip == SIS_550) {
  2432. vgawb (SEQ_ADR, 0x28);
  2433. vgawb (SEQ_DATA, 0x5A);
  2435. vgawb (SEQ_ADR, 0x29);
  2436. vgawb (SEQ_DATA, 0x64);
  2438. vgawb (CRTC_ADR, 0x3A);
  2439. vgawb (CRTC_DATA, 0x00);
  2440. }
  2441. #endif
  2442. #endif
  2444. if (sisvga_engine == SIS_315_VGA) {
  2445. switch (ivideo.chip) {
  2446. case SIS_315H:
  2447. case SIS_315:
  2448. sishw_ext.bIntegratedMMEnabled = TRUE;
  2449. break;
  2450. case SIS_550:
  2451. // Eden Chen
  2452. //vgawb(SEQ_ADR, IND_SIS_SCRATCH_REG_1A);
  2453. //reg = vgarb(SEQ_DATA);
  2454. //if (reg & SIS_SCRATCH_REG_1A_MASK)
  2455. //      sishw_ext.bIntegratedMMEnabled = TRUE;
  2456. //else
  2457. //      sishw_ext.bIntegratedMMEnabled = FALSE;
  2458. //for Debug
  2459. sishw_ext.bIntegratedMMEnabled = TRUE;
  2460. // ~Eden Chen
  2461. break;
  2462. default:
  2463. break;
  2464. }
  2465. } else if (sisvga_engine == SIS_300_VGA) {
  2466. if (ivideo.chip == SIS_300) {
  2467. sishw_ext.bIntegratedMMEnabled = TRUE;
  2468. } else {
  2469. vgawb (SEQ_ADR, IND_SIS_SCRATCH_REG_1A);
  2470. reg = vgarb (SEQ_DATA);
  2471. if (reg & SIS_SCRATCH_REG_1A_MASK)
  2472. sishw_ext.bIntegratedMMEnabled = TRUE;
  2473. else
  2474. sishw_ext.bIntegratedMMEnabled = FALSE;
  2475. }
  2476. }
  2477. // Eden Chen
  2478. sishw_ext.pDevice = NULL;
  2479. sishw_ext.pjVirtualRomBase = NULL;
  2480. sishw_ext.pjCustomizedROMImage = NULL;
  2481. sishw_ext.bSkipDramSizing = 0;
  2482. sishw_ext.pQueryVGAConfigSpace = &sisfb_query_VGA_config_space;
  2483. sishw_ext.pQueryNorthBridgeSpace = &sisfb_query_north_bridge_space;
  2484. strcpy (sishw_ext.szVBIOSVer, "0.84");
  2486. sishw_ext.pSR = vmalloc (sizeof (SIS_DSReg) * SR_BUFFER_SIZE);
  2487. if (sishw_ext.pSR == NULL)
  2488. printk (KERN_DEBUG "Allocated SRReg space fail.n");
  2489. sishw_ext.pSR[0].jIdx = sishw_ext.pSR[0].jVal = 0xFF;
  2491. sishw_ext.pCR = vmalloc (sizeof (SIS_DSReg) * CR_BUFFER_SIZE);
  2492. if (sishw_ext.pCR == NULL)
  2493. printk (KERN_DEBUG "Allocated CRReg space fail.n");
  2494. sishw_ext.pCR[0].jIdx = sishw_ext.pCR[0].jVal = 0xFF;
  2495. // ~Eden Chen
  2497. #ifdef CONFIG_FB_SIS_300
  2498. if (sisvga_engine == SIS_300_VGA) {
  2499. if (!sisvga_enabled) {
  2500. // Eden Chen
  2501. sishw_ext.pjVideoMemoryAddress = ioremap (ivideo.video_base, 0x2000000);
  2502. //SiSInit300(&sishw_ext);
  2503. SiSInit (&sishw_ext);
  2504. vgawb (SEQ_ADR, IND_SIS_PASSWORD);
  2505. vgawb (SEQ_DATA, SIS_PASSWORD);
  2506. // ~Eden Chen
  2507. }
  2508. #ifdef LINUXBIOS
  2509. else {
  2510. // Eden Chen
  2511. sishw_ext.pjVideoMemoryAddress
  2512.     = ioremap (ivideo.video_base, 0x2000000);
  2513. //SiSInit300(&sishw_ext);
  2514. SiSInit (&sishw_ext);
  2515. vgawb (SEQ_ADR, IND_SIS_PASSWORD);
  2516. vgawb (SEQ_DATA, SIS_PASSWORD);
  2517. // ~Eden Chen
  2518. }
  2519. vgawb (SEQ_ADR, 0x7);
  2520. reg = vgarb (SEQ_DATA);
  2521. reg |= 0x10;
  2522. vgawb (SEQ_DATA, reg);
  2523. #endif
  2524. sisfb_get_dram_size_300 ();
  2525. }
  2526. #endif
  2528. #ifdef CONFIG_FB_SIS_315
  2529. if (sisvga_engine == SIS_315_VGA) {
  2530. if (!sisvga_enabled) {
  2531. /* Mapping Max FB Size for 315 Init */
  2532. // Eden Chen
  2533. //sishw_ext.VirtualVideoMemoryAddress 
  2534. sishw_ext.pjVideoMemoryAddress = ioremap (ivideo.video_base, 0x8000000);
  2535. //SiSInit310(&sishw_ext);
  2536. SiSInit (&sishw_ext);
  2538. vgawb (SEQ_ADR, IND_SIS_PASSWORD);
  2539. vgawb (SEQ_DATA, SIS_PASSWORD);
  2541. sishw_ext.bSkipDramSizing = TRUE;
  2542. vgawb (SEQ_ADR, 0x13);
  2543. sishw_ext.pSR[0].jIdx = 0x13;
  2544. sishw_ext.pSR[0].jVal = vgarb (SEQ_DATA);
  2545. vgawb (SEQ_ADR, 0x14);
  2546. sishw_ext.pSR[1].jIdx = 0x14;
  2547. sishw_ext.pSR[1].jVal = vgarb (SEQ_DATA);
  2548. sishw_ext.pSR[2].jIdx = 0xFF;
  2549. sishw_ext.pSR[2].jVal = 0xFF;
  2550. // Eden Chen
  2551. }
  2552. #ifdef LINUXBIOS
  2553. else {
  2554. sishw_ext.pjVideoMemoryAddress = ioremap (ivideo.video_base, 0x8000000);
  2555. SiSInit (&sishw_ext);
  2556. vgawb (SEQ_ADR, IND_SIS_PASSWORD);
  2557. vgawb (SEQ_DATA, SIS_PASSWORD);
  2559. sishw_ext.bSkipDramSizing = TRUE;
  2560. vgawb (SEQ_ADR, 0x13);
  2561. sishw_ext.pSR[0].jIdx = 0x13;
  2562. sishw_ext.pSR[0].jVal = vgarb (SEQ_DATA);
  2563. vgawb (SEQ_ADR, 0x14);
  2564. sishw_ext.pSR[1].jIdx = 0x14;
  2565. sishw_ext.pSR[1].jVal = vgarb (SEQ_DATA);
  2566. sishw_ext.pSR[2].jIdx = 0xFF;
  2567. sishw_ext.pSR[2].jVal = 0xFF;
  2568. }
  2569. #endif
  2570. sisfb_get_dram_size_315 ();
  2571. }
  2572. #endif
  2573. //Eden Chen 
  2574. vgawb (SEQ_ADR, IND_SIS_PCI_ADDRESS_SET);
  2575. reg = vgarb (SEQ_DATA);
  2576. reg |= SIS_PCI_ADDR_ENABLE;
  2577. reg |= SIS_MEM_MAP_IO_ENABLE;
  2578. vgawb (SEQ_DATA, reg);
  2580. vgawb (SEQ_ADR, IND_SIS_MODULE_ENABLE);
  2581. reg = vgarb (SEQ_DATA);
  2582. reg |= SIS_ENABLE_2D;
  2583. vgawb (SEQ_DATA, reg);
  2584. //~Eden Chen
  2586. // Eden Chen
  2587. sishw_ext.ulVideoMemorySize = ivideo.video_size;
  2588. // ~Eden Chen
  2589. if (!request_mem_region (ivideo.video_base, ivideo.video_size, "sisfb FB")) {
  2590. printk (KERN_ERR "sisfb: cannot reserve frame buffer memoryn");
  2591. return -ENODEV;
  2592. }
  2594. if (!request_mem_region (ivideo.mmio_base, sisfb_mmio_size, "sisfb MMIO")) {
  2595. printk (KERN_ERR "sisfb: cannot reserve MMIO regionn");
  2596. release_mem_region (ivideo.video_base, ivideo.video_size);
  2597. return -ENODEV;
  2598. }
  2599. // Eden Chen
  2600. //sishw_ext.VirtualVideoMemoryAddress = ivideo.video_vbase 
  2601. sishw_ext.pjVideoMemoryAddress = ivideo.video_vbase = ioremap (ivideo.video_base, ivideo.video_size);
  2602. // Eden Chen
  2603. ivideo.mmio_vbase = ioremap (ivideo.mmio_base, sisfb_mmio_size);
  2605. printk (KERN_INFO
  2606. "sisfb: framebuffer at 0x%lx, mapped to 0x%p, size %dkn",
  2607. ivideo.video_base, ivideo.video_vbase, ivideo.video_size / 1024);
  2609. printk (KERN_INFO
  2610. "sisfb: MMIO at 0x%lx, mapped to 0x%p, size %ldkn",
  2611. ivideo.mmio_base, ivideo.mmio_vbase, sisfb_mmio_size / 1024);
  2613. #ifdef CONFIG_FB_SIS_300
  2614. if (sisvga_engine == SIS_300_VGA) {
  2615. sisfb_get_VB_type_300 ();
  2616. if (ivideo.hasVB != HASVB_NONE) {
  2617. sisfb_detect_VB_connect_300 ();
  2618. }
  2619. }
  2620. #endif
  2622. #ifdef CONFIG_FB_SIS_315
  2623. if (sisvga_engine == SIS_315_VGA) {
  2624. sisfb_get_VB_type_315 ();
  2625. if (ivideo.hasVB != HASVB_NONE) {
  2626. sisfb_detect_VB_connect_315 ();
  2627. }
  2628. }
  2629. #endif
  2631. // Eden Chen
  2632. sishw_ext.ujVBChipID = VB_CHIP_UNKNOWN;
  2633. sishw_ext.usExternalChip = 0;
  2635. switch (ivideo.hasVB) {
  2636. case HASVB_301:
  2637. /*karl */
  2638. vgawb (VB_PART4_ADR, 0x01);
  2639. reg = vgarb (VB_PART4_DATA);
  2640. if ((reg != 0xB1) && (reg != 0xB0))
  2641. sishw_ext.ujVBChipID = VB_CHIP_301;
  2642. else
  2643. sishw_ext.ujVBChipID = VB_CHIP_301B;
  2644. break;
  2645. case HASVB_302:
  2646. sishw_ext.ujVBChipID = VB_CHIP_302;
  2647. break;
  2648. case HASVB_303:
  2649. sishw_ext.ujVBChipID = VB_CHIP_303;
  2650. break;
  2651. case HASVB_LVDS:
  2652. sishw_ext.usExternalChip = 0x1;
  2653. break;
  2654. case HASVB_TRUMPION:
  2655. sishw_ext.usExternalChip = 0x2;
  2656. break;
  2657. case HASVB_CHRONTEL:
  2658. sishw_ext.usExternalChip = 0x4;
  2659. break;
  2660. case HASVB_LVDS_CHRONTEL:
  2661. sishw_ext.usExternalChip = 0x5;
  2662. break;
  2663. default:
  2664. break;
  2665. }
  2667. // ~Eden Chen
  2669. if (ivideo.disp_state & DISPTYPE_DISP2) {
  2670. if (sisfb_crt1off)
  2671. ivideo.disp_state |= DISPMODE_SINGLE;
  2672. else
  2673. ivideo.disp_state |= (DISPMODE_MIRROR | DISPTYPE_CRT1);
  2674. } else
  2675. ivideo.disp_state = DISPMODE_SINGLE | DISPTYPE_CRT1;
  2677. if (ivideo.disp_state & DISPTYPE_LCD) {
  2678. vgawb (CRTC_ADR, IND_SIS_LCD_PANEL);
  2679. reg = vgarb (CRTC_DATA);
  2680. // Eden Chen
  2681. switch (reg) {
  2682. case SIS_LCD_PANEL_800X600:
  2683. sishw_ext.ulCRT2LCDType = LCD_800x600;
  2684. break;
  2685. case SIS_LCD_PANEL_1024X768:
  2686. sishw_ext.ulCRT2LCDType = LCD_1024x768;
  2687. break;
  2688. case SIS_LCD_PANEL_1280X1024:
  2689. sishw_ext.ulCRT2LCDType = LCD_1280x1024;
  2690. break;
  2691. case SIS_LCD_PANEL_640X480:
  2692. sishw_ext.ulCRT2LCDType = LCD_640x480;
  2693. break;
  2694. case SIS_LCD_PANEL_1280X960:
  2695. sishw_ext.ulCRT2LCDType = LCD_1280x960;
  2696. break;
  2697. default:
  2698. sishw_ext.ulCRT2LCDType = LCD_1024x768;
  2699. break;
  2700. }
  2701. // ~Eden Chen
  2702. }
  2704. if (sisfb_mode_idx >= 0)
  2705. sisfb_validate_mode ();
  2707. if (sisfb_mode_idx < 0) {
  2708. switch (ivideo.disp_state & DISPTYPE_DISP2) {
  2709. case DISPTYPE_LCD:
  2710. sisfb_mode_idx = DEFAULT_LCDMODE;
  2711. break;
  2712. case DISPTYPE_TV:
  2713. sisfb_mode_idx = DEFAULT_TVMODE;
  2714. break;
  2715. default:
  2716. sisfb_mode_idx = DEFAULT_MODE;
  2717. break;
  2718. }
  2719. }
  2721. sisfb_mode_no = sisbios_mode[sisfb_mode_idx].mode_no;
  2723. if (ivideo.refresh_rate != 0)
  2724. sisfb_search_refresh_rate (ivideo.refresh_rate);
  2726. if (sisfb_rate_idx == 0) {
  2727. sisfb_rate_idx = sisbios_mode[sisfb_mode_idx].rate_idx;
  2728. ivideo.refresh_rate = 60;
  2729. }
  2731. ivideo.video_bpp = sisbios_mode[sisfb_mode_idx].bpp;
  2732. ivideo.video_vwidth = ivideo.video_width = sisbios_mode[sisfb_mode_idx].xres;
  2733. ivideo.video_vheight = ivideo.video_height = sisbios_mode[sisfb_mode_idx].yres;
  2734. ivideo.org_x = ivideo.org_y = 0;
  2735. video_linelength = ivideo.video_width * (ivideo.video_bpp >> 3);
  2737. printk (KERN_INFO "sisfb: mode is %dx%dx%d, linelength=%dn",
  2738. ivideo.video_width, ivideo.video_height, ivideo.video_bpp,
  2739. video_linelength);
  2741. // Eden Chen
  2742. // Check interface correction  For Debug
  2743. DPRINTK ("VM Adr=0x%pn", sishw_ext.pjVideoMemoryAddress);
  2744. DPRINTK ("VM Size=%ldKn", sishw_ext.ulVideoMemorySize / 1024);
  2745. DPRINTK ("IO Adr=0x%lxn", sishw_ext.ulIOAddress);
  2746. DPRINTK ("Chip=%dn", sishw_ext.jChipType);
  2747. DPRINTK ("ChipRevision=%dn", sishw_ext.jChipRevision);
  2748. DPRINTK ("VBChip=%dn", sishw_ext.ujVBChipID);
  2749. DPRINTK ("ExtVB=%dn", sishw_ext.usExternalChip);
  2750. DPRINTK ("LCD=%ldn", sishw_ext.ulCRT2LCDType);
  2751. DPRINTK ("bIntegratedMMEnabled=%dn", sishw_ext.bIntegratedMMEnabled);
  2752. // ~Eden Chen
  2754. sisfb_pre_setmode ();
  2756. if (SiSSetMode (&sishw_ext, sisfb_mode_no) == 0) {
  2757. DPRINTK ("set mode[0x%x]: failedn", sisfb_mode_no);
  2758. return -1;
  2759. }
  2760. vgawb (SEQ_ADR, IND_SIS_PASSWORD);
  2761. vgawb (SEQ_DATA, SIS_PASSWORD);
  2762. // Eden Chen
  2764. sisfb_post_setmode ();
  2766. sisfb_crtc_to_var (&default_var);
  2768. fb_info.changevar = NULL;
  2769. fb_info.node = -1;
  2770. fb_info.fbops = &sisfb_ops;
  2771. fb_info.disp = &disp;
  2772. fb_info.switch_con = &sisfb_switch;
  2773. fb_info.updatevar = &sisfb_update_var;
  2774. fb_info.blank = &sisfb_blank;
  2775. fb_info.flags = FBINFO_FLAG_DEFAULT;
  2777. sisfb_set_disp (-1, &default_var);
  2779. if (sisfb_heap_init ()) {
  2780. DPRINTK ("sisfb: Failed to enable offscreen heapn");
  2781. }
  2783. /*H.C. */
  2784. nRes =  mtrr_add ((unsigned int) ivideo.video_base, (unsigned int) ivideo.video_size,  MTRR_TYPE_WRCOMB, 1);
  2785. vc_resize_con (1, 1, 0);
  2787. if (register_framebuffer (&fb_info) < 0)
  2788. return -EINVAL;
  2790. printk (KERN_INFO "fb%d: %s frame buffer device, Version %d.%d.%02dn",
  2791. GET_FB_IDX (fb_info.node), fb_info.modename, VER_MAJOR, VER_MINOR,
  2792. VER_LEVEL);
  2794. return 0;
  2795. }
  2797. #ifdef MODULE
  2799. static char *mode = NULL;
  2800. static unsigned int rate = 0;
  2801. static unsigned int crt1 = 1;
  2803. MODULE_PARM (mode, "s");
  2804. MODULE_PARM (rate, "i");
  2805. MODULE_PARM (crt1, "i");
  2806. MODULE_PARM (filter, "i");
  2808. int init_module (void)
  2809. {
  2810. if (mode)
  2811. sisfb_search_mode (mode);
  2813. ivideo.refresh_rate = rate;
  2815. if (crt1 == 0)
  2816. sisfb_crt1off = 1;
  2817. else
  2818. sisfb_crt1off = 0;
  2820. sisfb_init ();
  2822. return 0;
  2823. }
  2825. void cleanup_module (void)
  2826. {
  2827. unregister_framebuffer (&fb_info);
  2828. }
  2829. #endif
  2831. EXPORT_SYMBOL (sis_malloc);
  2832. EXPORT_SYMBOL (sis_free);
  2833. EXPORT_SYMBOL (sis_dispinfo);
  2835. EXPORT_SYMBOL (ivideo);