tridentfb.c 36 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546
  1. /*
  2. * Frame buffer driver for Trident Blade and Image series
  3. *
  4. * Copyright 2001, 2002 - Jani Monoses <jani@iv.ro>
  5. *
  6. *
  7. * CREDITS:(in order of appearance)
  8. * skeletonfb.c by Geert Uytterhoeven and other fb code in drivers/video
  9. * Special thanks ;) to Mattia Crivellini <tia@mclink.it>
  10. * much inspired by the XFree86 4.x Trident driver sources
  11. * by Alan Hourihane the FreeVGA project
  12. * Francesco Salvestrini <salvestrini@users.sf.net> XP support,
  13. * code, suggestions
  14. * TODO:
  15. * timing value tweaking so it looks good on every monitor in every mode
  16. * TGUI acceleration
  17. */
  18. #include <linux/module.h>
  19. #include <linux/fb.h>
  20. #include <linux/init.h>
  21. #include <linux/pci.h>
  22. #include <linux/delay.h>
  23. #include <video/vga.h>
  24. #include <video/trident.h>
  25. #define VERSION "0.7.9-NEWAPI"
  26. struct tridentfb_par {
  27. void __iomem *io_virt; /* iospace virtual memory address */
  28. u32 pseudo_pal[16];
  29. int chip_id;
  30. int flatpanel;
  31. void (*init_accel) (struct tridentfb_par *, int, int);
  32. void (*wait_engine) (struct tridentfb_par *);
  33. void (*fill_rect)
  34. (struct tridentfb_par *par, u32, u32, u32, u32, u32, u32);
  35. void (*copy_rect)
  36. (struct tridentfb_par *par, u32, u32, u32, u32, u32, u32);
  37. };
  38. static unsigned char eng_oper; /* engine operation... */
  39. static struct fb_ops tridentfb_ops;
  40. static struct fb_fix_screeninfo tridentfb_fix = {
  41. .id = "Trident",
  42. .type = FB_TYPE_PACKED_PIXELS,
  43. .ypanstep = 1,
  44. .visual = FB_VISUAL_PSEUDOCOLOR,
  45. .accel = FB_ACCEL_NONE,
  46. };
  47. /* defaults which are normally overriden by user values */
  48. /* video mode */
  49. static char *mode_option __devinitdata = "640x480";
  50. static int bpp __devinitdata = 8;
  51. static int noaccel __devinitdata;
  52. static int center;
  53. static int stretch;
  54. static int fp __devinitdata;
  55. static int crt __devinitdata;
  56. static int memsize __devinitdata;
  57. static int memdiff __devinitdata;
  58. static int nativex;
  59. module_param(mode_option, charp, 0);
  60. MODULE_PARM_DESC(mode_option, "Initial video mode e.g. '648x480-8@60'");
  61. module_param_named(mode, mode_option, charp, 0);
  62. MODULE_PARM_DESC(mode, "Initial video mode e.g. '648x480-8@60' (deprecated)");
  63. module_param(bpp, int, 0);
  64. module_param(center, int, 0);
  65. module_param(stretch, int, 0);
  66. module_param(noaccel, int, 0);
  67. module_param(memsize, int, 0);
  68. module_param(memdiff, int, 0);
  69. module_param(nativex, int, 0);
  70. module_param(fp, int, 0);
  71. MODULE_PARM_DESC(fp, "Define if flatpanel is connected");
  72. module_param(crt, int, 0);
  73. MODULE_PARM_DESC(crt, "Define if CRT is connected");
  74. static int is_oldclock(int id)
  75. {
  76. return (id == TGUI9440) ||
  77. (id == TGUI9660) ||
  78. (id == CYBER9320);
  79. }
  80. static int is_oldprotect(int id)
  81. {
  82. return (id == TGUI9440) ||
  83. (id == TGUI9660) ||
  84. (id == PROVIDIA9685) ||
  85. (id == CYBER9320) ||
  86. (id == CYBER9382) ||
  87. (id == CYBER9385);
  88. }
  89. static int is_blade(int id)
  90. {
  91. return (id == BLADE3D) ||
  92. (id == CYBERBLADEE4) ||
  93. (id == CYBERBLADEi7) ||
  94. (id == CYBERBLADEi7D) ||
  95. (id == CYBERBLADEi1) ||
  96. (id == CYBERBLADEi1D) ||
  97. (id == CYBERBLADEAi1) ||
  98. (id == CYBERBLADEAi1D);
  99. }
  100. static int is_xp(int id)
  101. {
  102. return (id == CYBERBLADEXPAi1) ||
  103. (id == CYBERBLADEXPm8) ||
  104. (id == CYBERBLADEXPm16);
  105. }
  106. static int is3Dchip(int id)
  107. {
  108. return ((id == BLADE3D) || (id == CYBERBLADEE4) ||
  109. (id == CYBERBLADEi7) || (id == CYBERBLADEi7D) ||
  110. (id == CYBER9397) || (id == CYBER9397DVD) ||
  111. (id == CYBER9520) || (id == CYBER9525DVD) ||
  112. (id == IMAGE975) || (id == IMAGE985) ||
  113. (id == CYBERBLADEi1) || (id == CYBERBLADEi1D) ||
  114. (id == CYBERBLADEAi1) || (id == CYBERBLADEAi1D) ||
  115. (id == CYBERBLADEXPm8) || (id == CYBERBLADEXPm16) ||
  116. (id == CYBERBLADEXPAi1));
  117. }
  118. static int iscyber(int id)
  119. {
  120. switch (id) {
  121. case CYBER9388:
  122. case CYBER9382:
  123. case CYBER9385:
  124. case CYBER9397:
  125. case CYBER9397DVD:
  126. case CYBER9520:
  127. case CYBER9525DVD:
  128. case CYBERBLADEE4:
  129. case CYBERBLADEi7D:
  130. case CYBERBLADEi1:
  131. case CYBERBLADEi1D:
  132. case CYBERBLADEAi1:
  133. case CYBERBLADEAi1D:
  134. case CYBERBLADEXPAi1:
  135. return 1;
  136. case CYBER9320:
  137. case TGUI9660:
  138. case PROVIDIA9685:
  139. case IMAGE975:
  140. case IMAGE985:
  141. case BLADE3D:
  142. case CYBERBLADEi7: /* VIA MPV4 integrated version */
  143. default:
  144. /* case CYBERBLDAEXPm8: Strange */
  145. /* case CYBERBLDAEXPm16: Strange */
  146. return 0;
  147. }
  148. }
  149. static inline void t_outb(struct tridentfb_par *p, u8 val, u16 reg)
  150. {
  151. fb_writeb(val, p->io_virt + reg);
  152. }
  153. static inline u8 t_inb(struct tridentfb_par *p, u16 reg)
  154. {
  155. return fb_readb(p->io_virt + reg);
  156. }
  157. static inline void writemmr(struct tridentfb_par *par, u16 r, u32 v)
  158. {
  159. fb_writel(v, par->io_virt + r);
  160. }
  161. static inline u32 readmmr(struct tridentfb_par *par, u16 r)
  162. {
  163. return fb_readl(par->io_virt + r);
  164. }
  165. /*
  166. * Blade specific acceleration.
  167. */
  168. #define point(x, y) ((y) << 16 | (x))
  169. #define STA 0x2120
  170. #define CMD 0x2144
  171. #define ROP 0x2148
  172. #define CLR 0x2160
  173. #define SR1 0x2100
  174. #define SR2 0x2104
  175. #define DR1 0x2108
  176. #define DR2 0x210C
  177. #define ROP_S 0xCC
  178. static void blade_init_accel(struct tridentfb_par *par, int pitch, int bpp)
  179. {
  180. int v1 = (pitch >> 3) << 20;
  181. int tmp = 0, v2;
  182. switch (bpp) {
  183. case 8:
  184. tmp = 0;
  185. break;
  186. case 15:
  187. tmp = 5;
  188. break;
  189. case 16:
  190. tmp = 1;
  191. break;
  192. case 24:
  193. case 32:
  194. tmp = 2;
  195. break;
  196. }
  197. v2 = v1 | (tmp << 29);
  198. writemmr(par, 0x21C0, v2);
  199. writemmr(par, 0x21C4, v2);
  200. writemmr(par, 0x21B8, v2);
  201. writemmr(par, 0x21BC, v2);
  202. writemmr(par, 0x21D0, v1);
  203. writemmr(par, 0x21D4, v1);
  204. writemmr(par, 0x21C8, v1);
  205. writemmr(par, 0x21CC, v1);
  206. writemmr(par, 0x216C, 0);
  207. }
  208. static void blade_wait_engine(struct tridentfb_par *par)
  209. {
  210. while (readmmr(par, STA) & 0xFA800000) ;
  211. }
  212. static void blade_fill_rect(struct tridentfb_par *par,
  213. u32 x, u32 y, u32 w, u32 h, u32 c, u32 rop)
  214. {
  215. writemmr(par, CLR, c);
  216. writemmr(par, ROP, rop ? 0x66 : ROP_S);
  217. writemmr(par, CMD, 0x20000000 | 1 << 19 | 1 << 4 | 2 << 2);
  218. writemmr(par, DR1, point(x, y));
  219. writemmr(par, DR2, point(x + w - 1, y + h - 1));
  220. }
  221. static void blade_copy_rect(struct tridentfb_par *par,
  222. u32 x1, u32 y1, u32 x2, u32 y2, u32 w, u32 h)
  223. {
  224. u32 s1, s2, d1, d2;
  225. int direction = 2;
  226. s1 = point(x1, y1);
  227. s2 = point(x1 + w - 1, y1 + h - 1);
  228. d1 = point(x2, y2);
  229. d2 = point(x2 + w - 1, y2 + h - 1);
  230. if ((y1 > y2) || ((y1 == y2) && (x1 > x2)))
  231. direction = 0;
  232. writemmr(par, ROP, ROP_S);
  233. writemmr(par, CMD, 0xE0000000 | 1 << 19 | 1 << 4 | 1 << 2 | direction);
  234. writemmr(par, SR1, direction ? s2 : s1);
  235. writemmr(par, SR2, direction ? s1 : s2);
  236. writemmr(par, DR1, direction ? d2 : d1);
  237. writemmr(par, DR2, direction ? d1 : d2);
  238. }
  239. /*
  240. * BladeXP specific acceleration functions
  241. */
  242. #define ROP_P 0xF0
  243. #define masked_point(x, y) ((y & 0xffff)<<16|(x & 0xffff))
  244. static void xp_init_accel(struct tridentfb_par *par, int pitch, int bpp)
  245. {
  246. int tmp = 0, v1;
  247. unsigned char x = 0;
  248. switch (bpp) {
  249. case 8:
  250. x = 0;
  251. break;
  252. case 16:
  253. x = 1;
  254. break;
  255. case 24:
  256. x = 3;
  257. break;
  258. case 32:
  259. x = 2;
  260. break;
  261. }
  262. switch (pitch << (bpp >> 3)) {
  263. case 8192:
  264. case 512:
  265. x |= 0x00;
  266. break;
  267. case 1024:
  268. x |= 0x04;
  269. break;
  270. case 2048:
  271. x |= 0x08;
  272. break;
  273. case 4096:
  274. x |= 0x0C;
  275. break;
  276. }
  277. t_outb(par, x, 0x2125);
  278. eng_oper = x | 0x40;
  279. switch (bpp) {
  280. case 8:
  281. tmp = 18;
  282. break;
  283. case 15:
  284. case 16:
  285. tmp = 19;
  286. break;
  287. case 24:
  288. case 32:
  289. tmp = 20;
  290. break;
  291. }
  292. v1 = pitch << tmp;
  293. writemmr(par, 0x2154, v1);
  294. writemmr(par, 0x2150, v1);
  295. t_outb(par, 3, 0x2126);
  296. }
  297. static void xp_wait_engine(struct tridentfb_par *par)
  298. {
  299. int busy;
  300. int count, timeout;
  301. count = 0;
  302. timeout = 0;
  303. for (;;) {
  304. busy = t_inb(par, STA) & 0x80;
  305. if (busy != 0x80)
  306. return;
  307. count++;
  308. if (count == 10000000) {
  309. /* Timeout */
  310. count = 9990000;
  311. timeout++;
  312. if (timeout == 8) {
  313. /* Reset engine */
  314. t_outb(par, 0x00, 0x2120);
  315. return;
  316. }
  317. }
  318. }
  319. }
  320. static void xp_fill_rect(struct tridentfb_par *par,
  321. u32 x, u32 y, u32 w, u32 h, u32 c, u32 rop)
  322. {
  323. writemmr(par, 0x2127, ROP_P);
  324. writemmr(par, 0x2158, c);
  325. writemmr(par, 0x2128, 0x4000);
  326. writemmr(par, 0x2140, masked_point(h, w));
  327. writemmr(par, 0x2138, masked_point(y, x));
  328. t_outb(par, 0x01, 0x2124);
  329. t_outb(par, eng_oper, 0x2125);
  330. }
  331. static void xp_copy_rect(struct tridentfb_par *par,
  332. u32 x1, u32 y1, u32 x2, u32 y2, u32 w, u32 h)
  333. {
  334. int direction;
  335. u32 x1_tmp, x2_tmp, y1_tmp, y2_tmp;
  336. direction = 0x0004;
  337. if ((x1 < x2) && (y1 == y2)) {
  338. direction |= 0x0200;
  339. x1_tmp = x1 + w - 1;
  340. x2_tmp = x2 + w - 1;
  341. } else {
  342. x1_tmp = x1;
  343. x2_tmp = x2;
  344. }
  345. if (y1 < y2) {
  346. direction |= 0x0100;
  347. y1_tmp = y1 + h - 1;
  348. y2_tmp = y2 + h - 1;
  349. } else {
  350. y1_tmp = y1;
  351. y2_tmp = y2;
  352. }
  353. writemmr(par, 0x2128, direction);
  354. t_outb(par, ROP_S, 0x2127);
  355. writemmr(par, 0x213C, masked_point(y1_tmp, x1_tmp));
  356. writemmr(par, 0x2138, masked_point(y2_tmp, x2_tmp));
  357. writemmr(par, 0x2140, masked_point(h, w));
  358. t_outb(par, 0x01, 0x2124);
  359. }
  360. /*
  361. * Image specific acceleration functions
  362. */
  363. static void image_init_accel(struct tridentfb_par *par, int pitch, int bpp)
  364. {
  365. int tmp = 0;
  366. switch (bpp) {
  367. case 8:
  368. tmp = 0;
  369. break;
  370. case 15:
  371. tmp = 5;
  372. break;
  373. case 16:
  374. tmp = 1;
  375. break;
  376. case 24:
  377. case 32:
  378. tmp = 2;
  379. break;
  380. }
  381. writemmr(par, 0x2120, 0xF0000000);
  382. writemmr(par, 0x2120, 0x40000000 | tmp);
  383. writemmr(par, 0x2120, 0x80000000);
  384. writemmr(par, 0x2144, 0x00000000);
  385. writemmr(par, 0x2148, 0x00000000);
  386. writemmr(par, 0x2150, 0x00000000);
  387. writemmr(par, 0x2154, 0x00000000);
  388. writemmr(par, 0x2120, 0x60000000 | (pitch << 16) | pitch);
  389. writemmr(par, 0x216C, 0x00000000);
  390. writemmr(par, 0x2170, 0x00000000);
  391. writemmr(par, 0x217C, 0x00000000);
  392. writemmr(par, 0x2120, 0x10000000);
  393. writemmr(par, 0x2130, (2047 << 16) | 2047);
  394. }
  395. static void image_wait_engine(struct tridentfb_par *par)
  396. {
  397. while (readmmr(par, 0x2164) & 0xF0000000) ;
  398. }
  399. static void image_fill_rect(struct tridentfb_par *par,
  400. u32 x, u32 y, u32 w, u32 h, u32 c, u32 rop)
  401. {
  402. writemmr(par, 0x2120, 0x80000000);
  403. writemmr(par, 0x2120, 0x90000000 | ROP_S);
  404. writemmr(par, 0x2144, c);
  405. writemmr(par, DR1, point(x, y));
  406. writemmr(par, DR2, point(x + w - 1, y + h - 1));
  407. writemmr(par, 0x2124, 0x80000000 | 3 << 22 | 1 << 10 | 1 << 9);
  408. }
  409. static void image_copy_rect(struct tridentfb_par *par,
  410. u32 x1, u32 y1, u32 x2, u32 y2, u32 w, u32 h)
  411. {
  412. u32 s1, s2, d1, d2;
  413. int direction = 2;
  414. s1 = point(x1, y1);
  415. s2 = point(x1 + w - 1, y1 + h - 1);
  416. d1 = point(x2, y2);
  417. d2 = point(x2 + w - 1, y2 + h - 1);
  418. if ((y1 > y2) || ((y1 == y2) && (x1 > x2)))
  419. direction = 0;
  420. writemmr(par, 0x2120, 0x80000000);
  421. writemmr(par, 0x2120, 0x90000000 | ROP_S);
  422. writemmr(par, SR1, direction ? s2 : s1);
  423. writemmr(par, SR2, direction ? s1 : s2);
  424. writemmr(par, DR1, direction ? d2 : d1);
  425. writemmr(par, DR2, direction ? d1 : d2);
  426. writemmr(par, 0x2124,
  427. 0x80000000 | 1 << 22 | 1 << 10 | 1 << 7 | direction);
  428. }
  429. /*
  430. * Accel functions called by the upper layers
  431. */
  432. #ifdef CONFIG_FB_TRIDENT_ACCEL
  433. static void tridentfb_fillrect(struct fb_info *info,
  434. const struct fb_fillrect *fr)
  435. {
  436. struct tridentfb_par *par = info->par;
  437. int bpp = info->var.bits_per_pixel;
  438. int col = 0;
  439. switch (bpp) {
  440. default:
  441. case 8:
  442. col |= fr->color;
  443. col |= col << 8;
  444. col |= col << 16;
  445. break;
  446. case 16:
  447. col = ((u32 *)(info->pseudo_palette))[fr->color];
  448. break;
  449. case 32:
  450. col = ((u32 *)(info->pseudo_palette))[fr->color];
  451. break;
  452. }
  453. par->fill_rect(par, fr->dx, fr->dy, fr->width,
  454. fr->height, col, fr->rop);
  455. par->wait_engine(par);
  456. }
  457. static void tridentfb_copyarea(struct fb_info *info,
  458. const struct fb_copyarea *ca)
  459. {
  460. struct tridentfb_par *par = info->par;
  461. par->copy_rect(par, ca->sx, ca->sy, ca->dx, ca->dy,
  462. ca->width, ca->height);
  463. par->wait_engine(par);
  464. }
  465. #else /* !CONFIG_FB_TRIDENT_ACCEL */
  466. #define tridentfb_fillrect cfb_fillrect
  467. #define tridentfb_copyarea cfb_copyarea
  468. #endif /* CONFIG_FB_TRIDENT_ACCEL */
  469. /*
  470. * Hardware access functions
  471. */
  472. static inline unsigned char read3X4(struct tridentfb_par *par, int reg)
  473. {
  474. return vga_mm_rcrt(par->io_virt, reg);
  475. }
  476. static inline void write3X4(struct tridentfb_par *par, int reg,
  477. unsigned char val)
  478. {
  479. vga_mm_wcrt(par->io_virt, reg, val);
  480. }
  481. static inline unsigned char read3CE(struct tridentfb_par *par,
  482. unsigned char reg)
  483. {
  484. return vga_mm_rgfx(par->io_virt, reg);
  485. }
  486. static inline void writeAttr(struct tridentfb_par *par, int reg,
  487. unsigned char val)
  488. {
  489. fb_readb(par->io_virt + VGA_IS1_RC); /* flip-flop to index */
  490. vga_mm_wattr(par->io_virt, reg, val);
  491. }
  492. static inline void write3CE(struct tridentfb_par *par, int reg,
  493. unsigned char val)
  494. {
  495. vga_mm_wgfx(par->io_virt, reg, val);
  496. }
  497. static void enable_mmio(void)
  498. {
  499. /* Goto New Mode */
  500. vga_io_rseq(0x0B);
  501. /* Unprotect registers */
  502. vga_io_wseq(NewMode1, 0x80);
  503. /* Enable MMIO */
  504. outb(PCIReg, 0x3D4);
  505. outb(inb(0x3D5) | 0x01, 0x3D5);
  506. }
  507. static void disable_mmio(struct tridentfb_par *par)
  508. {
  509. /* Goto New Mode */
  510. vga_mm_rseq(par->io_virt, 0x0B);
  511. /* Unprotect registers */
  512. vga_mm_wseq(par->io_virt, NewMode1, 0x80);
  513. /* Disable MMIO */
  514. t_outb(par, PCIReg, 0x3D4);
  515. t_outb(par, t_inb(par, 0x3D5) & ~0x01, 0x3D5);
  516. }
  517. static void crtc_unlock(struct tridentfb_par *par)
  518. {
  519. write3X4(par, VGA_CRTC_V_SYNC_END,
  520. read3X4(par, VGA_CRTC_V_SYNC_END) & 0x7F);
  521. }
  522. /* Return flat panel's maximum x resolution */
  523. static int __devinit get_nativex(struct tridentfb_par *par)
  524. {
  525. int x, y, tmp;
  526. if (nativex)
  527. return nativex;
  528. tmp = (read3CE(par, VertStretch) >> 4) & 3;
  529. switch (tmp) {
  530. case 0:
  531. x = 1280; y = 1024;
  532. break;
  533. case 2:
  534. x = 1024; y = 768;
  535. break;
  536. case 3:
  537. x = 800; y = 600;
  538. break;
  539. case 4:
  540. x = 1400; y = 1050;
  541. break;
  542. case 1:
  543. default:
  544. x = 640; y = 480;
  545. break;
  546. }
  547. output("%dx%d flat panel found\n", x, y);
  548. return x;
  549. }
  550. /* Set pitch */
  551. static void set_lwidth(struct tridentfb_par *par, int width)
  552. {
  553. write3X4(par, VGA_CRTC_OFFSET, width & 0xFF);
  554. write3X4(par, AddColReg,
  555. (read3X4(par, AddColReg) & 0xCF) | ((width & 0x300) >> 4));
  556. }
  557. /* For resolutions smaller than FP resolution stretch */
  558. static void screen_stretch(struct tridentfb_par *par)
  559. {
  560. if (par->chip_id != CYBERBLADEXPAi1)
  561. write3CE(par, BiosReg, 0);
  562. else
  563. write3CE(par, BiosReg, 8);
  564. write3CE(par, VertStretch, (read3CE(par, VertStretch) & 0x7C) | 1);
  565. write3CE(par, HorStretch, (read3CE(par, HorStretch) & 0x7C) | 1);
  566. }
  567. /* For resolutions smaller than FP resolution center */
  568. static void screen_center(struct tridentfb_par *par)
  569. {
  570. write3CE(par, VertStretch, (read3CE(par, VertStretch) & 0x7C) | 0x80);
  571. write3CE(par, HorStretch, (read3CE(par, HorStretch) & 0x7C) | 0x80);
  572. }
  573. /* Address of first shown pixel in display memory */
  574. static void set_screen_start(struct tridentfb_par *par, int base)
  575. {
  576. u8 tmp;
  577. write3X4(par, VGA_CRTC_START_LO, base & 0xFF);
  578. write3X4(par, VGA_CRTC_START_HI, (base & 0xFF00) >> 8);
  579. tmp = read3X4(par, CRTCModuleTest) & 0xDF;
  580. write3X4(par, CRTCModuleTest, tmp | ((base & 0x10000) >> 11));
  581. tmp = read3X4(par, CRTHiOrd) & 0xF8;
  582. write3X4(par, CRTHiOrd, tmp | ((base & 0xE0000) >> 17));
  583. }
  584. /* Set dotclock frequency */
  585. static void set_vclk(struct tridentfb_par *par, unsigned long freq)
  586. {
  587. int m, n, k;
  588. unsigned long fi, d, di;
  589. unsigned char best_m = 0, best_n = 0, best_k = 0;
  590. unsigned char hi, lo;
  591. d = 20000;
  592. for (k = 1; k >= 0; k--)
  593. for (m = 0; m < 32; m++)
  594. for (n = 0; n < 122; n++) {
  595. fi = ((14318l * (n + 8)) / (m + 2)) >> k;
  596. if ((di = abs(fi - freq)) < d) {
  597. d = di;
  598. best_n = n;
  599. best_m = m;
  600. best_k = k;
  601. }
  602. if (fi > freq)
  603. break;
  604. }
  605. if (is_oldclock(par->chip_id)) {
  606. lo = best_n | (best_m << 7);
  607. hi = (best_m >> 1) | (best_k << 4);
  608. } else {
  609. lo = best_n;
  610. hi = best_m | (best_k << 6);
  611. }
  612. if (is3Dchip(par->chip_id)) {
  613. vga_mm_wseq(par->io_virt, ClockHigh, hi);
  614. vga_mm_wseq(par->io_virt, ClockLow, lo);
  615. } else {
  616. t_outb(par, lo, 0x43C8);
  617. t_outb(par, hi, 0x43C9);
  618. }
  619. debug("VCLK = %X %X\n", hi, lo);
  620. }
  621. /* Set number of lines for flat panels*/
  622. static void set_number_of_lines(struct tridentfb_par *par, int lines)
  623. {
  624. int tmp = read3CE(par, CyberEnhance) & 0x8F;
  625. if (lines > 1024)
  626. tmp |= 0x50;
  627. else if (lines > 768)
  628. tmp |= 0x30;
  629. else if (lines > 600)
  630. tmp |= 0x20;
  631. else if (lines > 480)
  632. tmp |= 0x10;
  633. write3CE(par, CyberEnhance, tmp);
  634. }
  635. /*
  636. * If we see that FP is active we assume we have one.
  637. * Otherwise we have a CRT display. User can override.
  638. */
  639. static int __devinit is_flatpanel(struct tridentfb_par *par)
  640. {
  641. if (fp)
  642. return 1;
  643. if (crt || !iscyber(par->chip_id))
  644. return 0;
  645. return (read3CE(par, FPConfig) & 0x10) ? 1 : 0;
  646. }
  647. /* Try detecting the video memory size */
  648. static unsigned int __devinit get_memsize(struct tridentfb_par *par)
  649. {
  650. unsigned char tmp, tmp2;
  651. unsigned int k;
  652. /* If memory size provided by user */
  653. if (memsize)
  654. k = memsize * Kb;
  655. else
  656. switch (par->chip_id) {
  657. case CYBER9525DVD:
  658. k = 2560 * Kb;
  659. break;
  660. default:
  661. tmp = read3X4(par, SPR) & 0x0F;
  662. switch (tmp) {
  663. case 0x01:
  664. k = 512 * Kb;
  665. break;
  666. case 0x02:
  667. k = 6 * Mb; /* XP */
  668. break;
  669. case 0x03:
  670. k = 1 * Mb;
  671. break;
  672. case 0x04:
  673. k = 8 * Mb;
  674. break;
  675. case 0x06:
  676. k = 10 * Mb; /* XP */
  677. break;
  678. case 0x07:
  679. k = 2 * Mb;
  680. break;
  681. case 0x08:
  682. k = 12 * Mb; /* XP */
  683. break;
  684. case 0x0A:
  685. k = 14 * Mb; /* XP */
  686. break;
  687. case 0x0C:
  688. k = 16 * Mb; /* XP */
  689. break;
  690. case 0x0E: /* XP */
  691. tmp2 = vga_mm_rseq(par->io_virt, 0xC1);
  692. switch (tmp2) {
  693. case 0x00:
  694. k = 20 * Mb;
  695. break;
  696. case 0x01:
  697. k = 24 * Mb;
  698. break;
  699. case 0x10:
  700. k = 28 * Mb;
  701. break;
  702. case 0x11:
  703. k = 32 * Mb;
  704. break;
  705. default:
  706. k = 1 * Mb;
  707. break;
  708. }
  709. break;
  710. case 0x0F:
  711. k = 4 * Mb;
  712. break;
  713. default:
  714. k = 1 * Mb;
  715. break;
  716. }
  717. }
  718. k -= memdiff * Kb;
  719. output("framebuffer size = %d Kb\n", k / Kb);
  720. return k;
  721. }
  722. /* See if we can handle the video mode described in var */
  723. static int tridentfb_check_var(struct fb_var_screeninfo *var,
  724. struct fb_info *info)
  725. {
  726. struct tridentfb_par *par = info->par;
  727. int bpp = var->bits_per_pixel;
  728. int ramdac = 230000; /* 230MHz for most 3D chips */
  729. debug("enter\n");
  730. /* check color depth */
  731. if (bpp == 24)
  732. bpp = var->bits_per_pixel = 32;
  733. /* check whether resolution fits on panel and in memory */
  734. if (par->flatpanel && nativex && var->xres > nativex)
  735. return -EINVAL;
  736. /* various resolution checks */
  737. var->xres = (var->xres + 7) & ~0x7;
  738. if (var->xres != var->xres_virtual)
  739. var->xres_virtual = var->xres;
  740. if (var->yres > var->yres_virtual)
  741. var->yres_virtual = var->yres;
  742. if (var->xres * var->yres_virtual * bpp / 8 > info->fix.smem_len)
  743. return -EINVAL;
  744. switch (bpp) {
  745. case 8:
  746. var->red.offset = 0;
  747. var->green.offset = 0;
  748. var->blue.offset = 0;
  749. var->red.length = 6;
  750. var->green.length = 6;
  751. var->blue.length = 6;
  752. break;
  753. case 16:
  754. var->red.offset = 11;
  755. var->green.offset = 5;
  756. var->blue.offset = 0;
  757. var->red.length = 5;
  758. var->green.length = 6;
  759. var->blue.length = 5;
  760. break;
  761. case 32:
  762. var->red.offset = 16;
  763. var->green.offset = 8;
  764. var->blue.offset = 0;
  765. var->red.length = 8;
  766. var->green.length = 8;
  767. var->blue.length = 8;
  768. break;
  769. default:
  770. return -EINVAL;
  771. }
  772. if (is_xp(par->chip_id))
  773. ramdac = 350000;
  774. switch (par->chip_id) {
  775. case TGUI9440:
  776. ramdac = 90000;
  777. break;
  778. case CYBER9320:
  779. case TGUI9660:
  780. ramdac = 135000;
  781. break;
  782. case PROVIDIA9685:
  783. case CYBER9388:
  784. case CYBER9382:
  785. case CYBER9385:
  786. ramdac = 170000;
  787. break;
  788. }
  789. /* The clock is doubled for 32 bpp */
  790. if (bpp == 32)
  791. ramdac /= 2;
  792. if (PICOS2KHZ(var->pixclock) > ramdac)
  793. return -EINVAL;
  794. debug("exit\n");
  795. return 0;
  796. }
  797. /* Pan the display */
  798. static int tridentfb_pan_display(struct fb_var_screeninfo *var,
  799. struct fb_info *info)
  800. {
  801. struct tridentfb_par *par = info->par;
  802. unsigned int offset;
  803. debug("enter\n");
  804. offset = (var->xoffset + (var->yoffset * var->xres))
  805. * var->bits_per_pixel / 32;
  806. info->var.xoffset = var->xoffset;
  807. info->var.yoffset = var->yoffset;
  808. set_screen_start(par, offset);
  809. debug("exit\n");
  810. return 0;
  811. }
  812. static void shadowmode_on(struct tridentfb_par *par)
  813. {
  814. write3CE(par, CyberControl, read3CE(par, CyberControl) | 0x81);
  815. }
  816. static void shadowmode_off(struct tridentfb_par *par)
  817. {
  818. write3CE(par, CyberControl, read3CE(par, CyberControl) & 0x7E);
  819. }
  820. /* Set the hardware to the requested video mode */
  821. static int tridentfb_set_par(struct fb_info *info)
  822. {
  823. struct tridentfb_par *par = (struct tridentfb_par *)(info->par);
  824. u32 htotal, hdispend, hsyncstart, hsyncend, hblankstart, hblankend;
  825. u32 vtotal, vdispend, vsyncstart, vsyncend, vblankstart, vblankend;
  826. struct fb_var_screeninfo *var = &info->var;
  827. int bpp = var->bits_per_pixel;
  828. unsigned char tmp;
  829. unsigned long vclk;
  830. debug("enter\n");
  831. hdispend = var->xres / 8 - 1;
  832. hsyncstart = (var->xres + var->right_margin) / 8 - 1;
  833. hsyncend = (var->xres + var->right_margin + var->hsync_len) / 8 - 1;
  834. htotal = (var->xres + var->left_margin + var->right_margin +
  835. var->hsync_len) / 8 - 5;
  836. hblankstart = hdispend + 1;
  837. hblankend = htotal + 3;
  838. vdispend = var->yres - 1;
  839. vsyncstart = var->yres + var->lower_margin;
  840. vsyncend = vsyncstart + var->vsync_len;
  841. vtotal = var->upper_margin + vsyncend - 2;
  842. vblankstart = vdispend + 1;
  843. vblankend = vtotal;
  844. crtc_unlock(par);
  845. write3CE(par, CyberControl, 8);
  846. if (par->flatpanel && var->xres < nativex) {
  847. /*
  848. * on flat panels with native size larger
  849. * than requested resolution decide whether
  850. * we stretch or center
  851. */
  852. t_outb(par, 0xEB, VGA_MIS_W);
  853. shadowmode_on(par);
  854. if (center)
  855. screen_center(par);
  856. else if (stretch)
  857. screen_stretch(par);
  858. } else {
  859. t_outb(par, 0x2B, VGA_MIS_W);
  860. write3CE(par, CyberControl, 8);
  861. }
  862. /* vertical timing values */
  863. write3X4(par, VGA_CRTC_V_TOTAL, vtotal & 0xFF);
  864. write3X4(par, VGA_CRTC_V_DISP_END, vdispend & 0xFF);
  865. write3X4(par, VGA_CRTC_V_SYNC_START, vsyncstart & 0xFF);
  866. write3X4(par, VGA_CRTC_V_SYNC_END, (vsyncend & 0x0F));
  867. write3X4(par, VGA_CRTC_V_BLANK_START, vblankstart & 0xFF);
  868. write3X4(par, VGA_CRTC_V_BLANK_END, vblankend & 0xFF);
  869. /* horizontal timing values */
  870. write3X4(par, VGA_CRTC_H_TOTAL, htotal & 0xFF);
  871. write3X4(par, VGA_CRTC_H_DISP, hdispend & 0xFF);
  872. write3X4(par, VGA_CRTC_H_SYNC_START, hsyncstart & 0xFF);
  873. write3X4(par, VGA_CRTC_H_SYNC_END,
  874. (hsyncend & 0x1F) | ((hblankend & 0x20) << 2));
  875. write3X4(par, VGA_CRTC_H_BLANK_START, hblankstart & 0xFF);
  876. write3X4(par, VGA_CRTC_H_BLANK_END, hblankend & 0x1F);
  877. /* higher bits of vertical timing values */
  878. tmp = 0x10;
  879. if (vtotal & 0x100) tmp |= 0x01;
  880. if (vdispend & 0x100) tmp |= 0x02;
  881. if (vsyncstart & 0x100) tmp |= 0x04;
  882. if (vblankstart & 0x100) tmp |= 0x08;
  883. if (vtotal & 0x200) tmp |= 0x20;
  884. if (vdispend & 0x200) tmp |= 0x40;
  885. if (vsyncstart & 0x200) tmp |= 0x80;
  886. write3X4(par, VGA_CRTC_OVERFLOW, tmp);
  887. tmp = read3X4(par, CRTHiOrd) & 0x07;
  888. tmp |= 0x08; /* line compare bit 10 */
  889. if (vtotal & 0x400) tmp |= 0x80;
  890. if (vblankstart & 0x400) tmp |= 0x40;
  891. if (vsyncstart & 0x400) tmp |= 0x20;
  892. if (vdispend & 0x400) tmp |= 0x10;
  893. write3X4(par, CRTHiOrd, tmp);
  894. tmp = (htotal >> 8) & 0x01;
  895. tmp |= (hdispend >> 7) & 0x02;
  896. tmp |= (hsyncstart >> 5) & 0x08;
  897. tmp |= (hblankstart >> 4) & 0x10;
  898. write3X4(par, HorizOverflow, tmp);
  899. tmp = 0x40;
  900. if (vblankstart & 0x200) tmp |= 0x20;
  901. //FIXME if (info->var.vmode & FB_VMODE_DOUBLE) tmp |= 0x80; /* double scan for 200 line modes */
  902. write3X4(par, VGA_CRTC_MAX_SCAN, tmp);
  903. write3X4(par, VGA_CRTC_LINE_COMPARE, 0xFF);
  904. write3X4(par, VGA_CRTC_PRESET_ROW, 0);
  905. write3X4(par, VGA_CRTC_MODE, 0xC3);
  906. write3X4(par, LinearAddReg, 0x20); /* enable linear addressing */
  907. tmp = (info->var.vmode & FB_VMODE_INTERLACED) ? 0x84 : 0x80;
  908. /* enable access extended memory */
  909. write3X4(par, CRTCModuleTest, tmp);
  910. /* enable GE for text acceleration */
  911. write3X4(par, GraphEngReg, 0x80);
  912. #ifdef CONFIG_FB_TRIDENT_ACCEL
  913. par->init_accel(par, info->var.xres, bpp);
  914. #endif
  915. switch (bpp) {
  916. case 8:
  917. tmp = 0x00;
  918. break;
  919. case 16:
  920. tmp = 0x05;
  921. break;
  922. case 24:
  923. tmp = 0x29;
  924. break;
  925. case 32:
  926. tmp = 0x09;
  927. break;
  928. }
  929. write3X4(par, PixelBusReg, tmp);
  930. tmp = read3X4(par, DRAMControl);
  931. if (!is_oldprotect(par->chip_id))
  932. tmp |= 0x10;
  933. if (iscyber(par->chip_id))
  934. tmp |= 0x20;
  935. write3X4(par, DRAMControl, tmp); /* both IO, linear enable */
  936. write3X4(par, InterfaceSel, read3X4(par, InterfaceSel) | 0x40);
  937. if (!is_xp(par->chip_id))
  938. write3X4(par, Performance, read3X4(par, Performance) | 0x10);
  939. /* MMIO & PCI read and write burst enable */
  940. if (par->chip_id != TGUI9440)
  941. write3X4(par, PCIReg, read3X4(par, PCIReg) | 0x06);
  942. /* convert from picoseconds to kHz */
  943. vclk = PICOS2KHZ(info->var.pixclock);
  944. if (bpp == 32)
  945. vclk *= 2;
  946. set_vclk(par, vclk);
  947. vga_mm_wseq(par->io_virt, 0, 3);
  948. vga_mm_wseq(par->io_virt, 1, 1); /* set char clock 8 dots wide */
  949. /* enable 4 maps because needed in chain4 mode */
  950. vga_mm_wseq(par->io_virt, 2, 0x0F);
  951. vga_mm_wseq(par->io_virt, 3, 0);
  952. vga_mm_wseq(par->io_virt, 4, 0x0E); /* memory mode enable bitmaps ?? */
  953. /* divide clock by 2 if 32bpp chain4 mode display and CPU path */
  954. write3CE(par, MiscExtFunc, (bpp == 32) ? 0x1A : 0x12);
  955. write3CE(par, 0x5, 0x40); /* no CGA compat, allow 256 col */
  956. write3CE(par, 0x6, 0x05); /* graphics mode */
  957. write3CE(par, 0x7, 0x0F); /* planes? */
  958. if (par->chip_id == CYBERBLADEXPAi1) {
  959. /* This fixes snow-effect in 32 bpp */
  960. write3X4(par, VGA_CRTC_H_SYNC_START, 0x84);
  961. }
  962. /* graphics mode and support 256 color modes */
  963. writeAttr(par, 0x10, 0x41);
  964. writeAttr(par, 0x12, 0x0F); /* planes */
  965. writeAttr(par, 0x13, 0); /* horizontal pel panning */
  966. /* colors */
  967. for (tmp = 0; tmp < 0x10; tmp++)
  968. writeAttr(par, tmp, tmp);
  969. fb_readb(par->io_virt + VGA_IS1_RC); /* flip-flop to index */
  970. t_outb(par, 0x20, VGA_ATT_W); /* enable attr */
  971. switch (bpp) {
  972. case 8:
  973. tmp = 0;
  974. break;
  975. case 15:
  976. tmp = 0x10;
  977. break;
  978. case 16:
  979. tmp = 0x30;
  980. break;
  981. case 24:
  982. case 32:
  983. tmp = 0xD0;
  984. break;
  985. }
  986. t_inb(par, VGA_PEL_IW);
  987. t_inb(par, VGA_PEL_MSK);
  988. t_inb(par, VGA_PEL_MSK);
  989. t_inb(par, VGA_PEL_MSK);
  990. t_inb(par, VGA_PEL_MSK);
  991. t_outb(par, tmp, VGA_PEL_MSK);
  992. t_inb(par, VGA_PEL_IW);
  993. if (par->flatpanel)
  994. set_number_of_lines(par, info->var.yres);
  995. set_lwidth(par, info->var.xres * bpp / (4 * 16));
  996. info->fix.visual = (bpp == 8) ? FB_VISUAL_PSEUDOCOLOR : FB_VISUAL_TRUECOLOR;
  997. info->fix.line_length = info->var.xres * (bpp >> 3);
  998. info->cmap.len = (bpp == 8) ? 256 : 16;
  999. debug("exit\n");
  1000. return 0;
  1001. }
  1002. /* Set one color register */
  1003. static int tridentfb_setcolreg(unsigned regno, unsigned red, unsigned green,
  1004. unsigned blue, unsigned transp,
  1005. struct fb_info *info)
  1006. {
  1007. int bpp = info->var.bits_per_pixel;
  1008. struct tridentfb_par *par = info->par;
  1009. if (regno >= info->cmap.len)
  1010. return 1;
  1011. if (bpp == 8) {
  1012. t_outb(par, 0xFF, VGA_PEL_MSK);
  1013. t_outb(par, regno, VGA_PEL_IW);
  1014. t_outb(par, red >> 10, VGA_PEL_D);
  1015. t_outb(par, green >> 10, VGA_PEL_D);
  1016. t_outb(par, blue >> 10, VGA_PEL_D);
  1017. } else if (regno < 16) {
  1018. if (bpp == 16) { /* RGB 565 */
  1019. u32 col;
  1020. col = (red & 0xF800) | ((green & 0xFC00) >> 5) |
  1021. ((blue & 0xF800) >> 11);
  1022. col |= col << 16;
  1023. ((u32 *)(info->pseudo_palette))[regno] = col;
  1024. } else if (bpp == 32) /* ARGB 8888 */
  1025. ((u32*)info->pseudo_palette)[regno] =
  1026. ((transp & 0xFF00) << 16) |
  1027. ((red & 0xFF00) << 8) |
  1028. ((green & 0xFF00)) |
  1029. ((blue & 0xFF00) >> 8);
  1030. }
  1031. /* debug("exit\n"); */
  1032. return 0;
  1033. }
  1034. /* Try blanking the screen.For flat panels it does nothing */
  1035. static int tridentfb_blank(int blank_mode, struct fb_info *info)
  1036. {
  1037. unsigned char PMCont, DPMSCont;
  1038. struct tridentfb_par *par = info->par;
  1039. debug("enter\n");
  1040. if (par->flatpanel)
  1041. return 0;
  1042. t_outb(par, 0x04, 0x83C8); /* Read DPMS Control */
  1043. PMCont = t_inb(par, 0x83C6) & 0xFC;
  1044. DPMSCont = read3CE(par, PowerStatus) & 0xFC;
  1045. switch (blank_mode) {
  1046. case FB_BLANK_UNBLANK:
  1047. /* Screen: On, HSync: On, VSync: On */
  1048. case FB_BLANK_NORMAL:
  1049. /* Screen: Off, HSync: On, VSync: On */
  1050. PMCont |= 0x03;
  1051. DPMSCont |= 0x00;
  1052. break;
  1053. case FB_BLANK_HSYNC_SUSPEND:
  1054. /* Screen: Off, HSync: Off, VSync: On */
  1055. PMCont |= 0x02;
  1056. DPMSCont |= 0x01;
  1057. break;
  1058. case FB_BLANK_VSYNC_SUSPEND:
  1059. /* Screen: Off, HSync: On, VSync: Off */
  1060. PMCont |= 0x02;
  1061. DPMSCont |= 0x02;
  1062. break;
  1063. case FB_BLANK_POWERDOWN:
  1064. /* Screen: Off, HSync: Off, VSync: Off */
  1065. PMCont |= 0x00;
  1066. DPMSCont |= 0x03;
  1067. break;
  1068. }
  1069. write3CE(par, PowerStatus, DPMSCont);
  1070. t_outb(par, 4, 0x83C8);
  1071. t_outb(par, PMCont, 0x83C6);
  1072. debug("exit\n");
  1073. /* let fbcon do a softblank for us */
  1074. return (blank_mode == FB_BLANK_NORMAL) ? 1 : 0;
  1075. }
  1076. static struct fb_ops tridentfb_ops = {
  1077. .owner = THIS_MODULE,
  1078. .fb_setcolreg = tridentfb_setcolreg,
  1079. .fb_pan_display = tridentfb_pan_display,
  1080. .fb_blank = tridentfb_blank,
  1081. .fb_check_var = tridentfb_check_var,
  1082. .fb_set_par = tridentfb_set_par,
  1083. .fb_fillrect = tridentfb_fillrect,
  1084. .fb_copyarea = tridentfb_copyarea,
  1085. .fb_imageblit = cfb_imageblit,
  1086. };
  1087. static int __devinit trident_pci_probe(struct pci_dev *dev,
  1088. const struct pci_device_id *id)
  1089. {
  1090. int err;
  1091. unsigned char revision;
  1092. struct fb_info *info;
  1093. struct tridentfb_par *default_par;
  1094. int defaultaccel;
  1095. int chip3D;
  1096. int chip_id;
  1097. err = pci_enable_device(dev);
  1098. if (err)
  1099. return err;
  1100. info = framebuffer_alloc(sizeof(struct tridentfb_par), &dev->dev);
  1101. if (!info)
  1102. return -ENOMEM;
  1103. default_par = info->par;
  1104. chip_id = id->device;
  1105. if (chip_id == CYBERBLADEi1)
  1106. output("*** Please do use cyblafb, Cyberblade/i1 support "
  1107. "will soon be removed from tridentfb!\n");
  1108. /* If PCI id is 0x9660 then further detect chip type */
  1109. if (chip_id == TGUI9660) {
  1110. revision = vga_io_rseq(RevisionID);
  1111. switch (revision) {
  1112. case 0x21:
  1113. chip_id = PROVIDIA9685;
  1114. break;
  1115. case 0x22:
  1116. case 0x23:
  1117. chip_id = CYBER9397;
  1118. break;
  1119. case 0x2A:
  1120. chip_id = CYBER9397DVD;
  1121. break;
  1122. case 0x30:
  1123. case 0x33:
  1124. case 0x34:
  1125. case 0x35:
  1126. case 0x38:
  1127. case 0x3A:
  1128. case 0xB3:
  1129. chip_id = CYBER9385;
  1130. break;
  1131. case 0x40 ... 0x43:
  1132. chip_id = CYBER9382;
  1133. break;
  1134. case 0x4A:
  1135. chip_id = CYBER9388;
  1136. break;
  1137. default:
  1138. break;
  1139. }
  1140. }
  1141. chip3D = is3Dchip(chip_id);
  1142. if (is_xp(chip_id)) {
  1143. default_par->init_accel = xp_init_accel;
  1144. default_par->wait_engine = xp_wait_engine;
  1145. default_par->fill_rect = xp_fill_rect;
  1146. default_par->copy_rect = xp_copy_rect;
  1147. } else if (is_blade(chip_id)) {
  1148. default_par->init_accel = blade_init_accel;
  1149. default_par->wait_engine = blade_wait_engine;
  1150. default_par->fill_rect = blade_fill_rect;
  1151. default_par->copy_rect = blade_copy_rect;
  1152. } else {
  1153. default_par->init_accel = image_init_accel;
  1154. default_par->wait_engine = image_wait_engine;
  1155. default_par->fill_rect = image_fill_rect;
  1156. default_par->copy_rect = image_copy_rect;
  1157. }
  1158. default_par->chip_id = chip_id;
  1159. /* acceleration is on by default for 3D chips */
  1160. defaultaccel = chip3D && !noaccel;
  1161. /* setup MMIO region */
  1162. tridentfb_fix.mmio_start = pci_resource_start(dev, 1);
  1163. tridentfb_fix.mmio_len = chip3D ? 0x20000 : 0x10000;
  1164. if (!request_mem_region(tridentfb_fix.mmio_start, tridentfb_fix.mmio_len, "tridentfb")) {
  1165. debug("request_region failed!\n");
  1166. framebuffer_release(info);
  1167. return -1;
  1168. }
  1169. default_par->io_virt = ioremap_nocache(tridentfb_fix.mmio_start,
  1170. tridentfb_fix.mmio_len);
  1171. if (!default_par->io_virt) {
  1172. debug("ioremap failed\n");
  1173. err = -1;
  1174. goto out_unmap1;
  1175. }
  1176. /* setup framebuffer memory */
  1177. tridentfb_fix.smem_start = pci_resource_start(dev, 0);
  1178. tridentfb_fix.smem_len = get_memsize(default_par);
  1179. if (!request_mem_region(tridentfb_fix.smem_start, tridentfb_fix.smem_len, "tridentfb")) {
  1180. debug("request_mem_region failed!\n");
  1181. disable_mmio(info->par);
  1182. err = -1;
  1183. goto out_unmap1;
  1184. }
  1185. enable_mmio();
  1186. info->screen_base = ioremap_nocache(tridentfb_fix.smem_start,
  1187. tridentfb_fix.smem_len);
  1188. if (!info->screen_base) {
  1189. debug("ioremap failed\n");
  1190. err = -1;
  1191. goto out_unmap2;
  1192. }
  1193. output("%s board found\n", pci_name(dev));
  1194. default_par->flatpanel = is_flatpanel(default_par);
  1195. if (default_par->flatpanel)
  1196. nativex = get_nativex(default_par);
  1197. info->fix = tridentfb_fix;
  1198. info->fbops = &tridentfb_ops;
  1199. info->pseudo_palette = default_par->pseudo_pal;
  1200. info->flags = FBINFO_DEFAULT | FBINFO_HWACCEL_YPAN;
  1201. #ifdef CONFIG_FB_TRIDENT_ACCEL
  1202. info->flags |= FBINFO_HWACCEL_COPYAREA | FBINFO_HWACCEL_FILLRECT;
  1203. #endif
  1204. if (!fb_find_mode(&info->var, info,
  1205. mode_option, NULL, 0, NULL, bpp)) {
  1206. err = -EINVAL;
  1207. goto out_unmap2;
  1208. }
  1209. err = fb_alloc_cmap(&info->cmap, 256, 0);
  1210. if (err < 0)
  1211. goto out_unmap2;
  1212. if (defaultaccel && default_par->init_accel)
  1213. info->var.accel_flags |= FB_ACCELF_TEXT;
  1214. else
  1215. info->var.accel_flags &= ~FB_ACCELF_TEXT;
  1216. info->var.activate |= FB_ACTIVATE_NOW;
  1217. info->device = &dev->dev;
  1218. if (register_framebuffer(info) < 0) {
  1219. printk(KERN_ERR "tridentfb: could not register Trident framebuffer\n");
  1220. fb_dealloc_cmap(&info->cmap);
  1221. err = -EINVAL;
  1222. goto out_unmap2;
  1223. }
  1224. output("fb%d: %s frame buffer device %dx%d-%dbpp\n",
  1225. info->node, info->fix.id, info->var.xres,
  1226. info->var.yres, info->var.bits_per_pixel);
  1227. pci_set_drvdata(dev, info);
  1228. return 0;
  1229. out_unmap2:
  1230. if (info->screen_base)
  1231. iounmap(info->screen_base);
  1232. release_mem_region(tridentfb_fix.smem_start, tridentfb_fix.smem_len);
  1233. disable_mmio(info->par);
  1234. out_unmap1:
  1235. if (default_par->io_virt)
  1236. iounmap(default_par->io_virt);
  1237. release_mem_region(tridentfb_fix.mmio_start, tridentfb_fix.mmio_len);
  1238. framebuffer_release(info);
  1239. return err;
  1240. }
  1241. static void __devexit trident_pci_remove(struct pci_dev *dev)
  1242. {
  1243. struct fb_info *info = pci_get_drvdata(dev);
  1244. struct tridentfb_par *par = info->par;
  1245. unregister_framebuffer(info);
  1246. iounmap(par->io_virt);
  1247. iounmap(info->screen_base);
  1248. release_mem_region(tridentfb_fix.smem_start, tridentfb_fix.smem_len);
  1249. release_mem_region(tridentfb_fix.mmio_start, tridentfb_fix.mmio_len);
  1250. pci_set_drvdata(dev, NULL);
  1251. framebuffer_release(info);
  1252. }
  1253. /* List of boards that we are trying to support */
  1254. static struct pci_device_id trident_devices[] = {
  1255. {PCI_VENDOR_ID_TRIDENT, BLADE3D, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
  1256. {PCI_VENDOR_ID_TRIDENT, CYBERBLADEi7, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
  1257. {PCI_VENDOR_ID_TRIDENT, CYBERBLADEi7D, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
  1258. {PCI_VENDOR_ID_TRIDENT, CYBERBLADEi1, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
  1259. {PCI_VENDOR_ID_TRIDENT, CYBERBLADEi1D, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
  1260. {PCI_VENDOR_ID_TRIDENT, CYBERBLADEAi1, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
  1261. {PCI_VENDOR_ID_TRIDENT, CYBERBLADEAi1D, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
  1262. {PCI_VENDOR_ID_TRIDENT, CYBERBLADEE4, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
  1263. {PCI_VENDOR_ID_TRIDENT, TGUI9440, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
  1264. {PCI_VENDOR_ID_TRIDENT, TGUI9660, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
  1265. {PCI_VENDOR_ID_TRIDENT, IMAGE975, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
  1266. {PCI_VENDOR_ID_TRIDENT, IMAGE985, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
  1267. {PCI_VENDOR_ID_TRIDENT, CYBER9320, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
  1268. {PCI_VENDOR_ID_TRIDENT, CYBER9388, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
  1269. {PCI_VENDOR_ID_TRIDENT, CYBER9520, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
  1270. {PCI_VENDOR_ID_TRIDENT, CYBER9525DVD, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
  1271. {PCI_VENDOR_ID_TRIDENT, CYBER9397, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
  1272. {PCI_VENDOR_ID_TRIDENT, CYBER9397DVD, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
  1273. {PCI_VENDOR_ID_TRIDENT, CYBERBLADEXPAi1, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
  1274. {PCI_VENDOR_ID_TRIDENT, CYBERBLADEXPm8, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
  1275. {PCI_VENDOR_ID_TRIDENT, CYBERBLADEXPm16, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
  1276. {0,}
  1277. };
  1278. MODULE_DEVICE_TABLE(pci, trident_devices);
  1279. static struct pci_driver tridentfb_pci_driver = {
  1280. .name = "tridentfb",
  1281. .id_table = trident_devices,
  1282. .probe = trident_pci_probe,
  1283. .remove = __devexit_p(trident_pci_remove)
  1284. };
  1285. /*
  1286. * Parse user specified options (`video=trident:')
  1287. * example:
  1288. * video=trident:800x600,bpp=16,noaccel
  1289. */
  1290. #ifndef MODULE
  1291. static int __init tridentfb_setup(char *options)
  1292. {
  1293. char *opt;
  1294. if (!options || !*options)
  1295. return 0;
  1296. while ((opt = strsep(&options, ",")) != NULL) {
  1297. if (!*opt)
  1298. continue;
  1299. if (!strncmp(opt, "noaccel", 7))
  1300. noaccel = 1;
  1301. else if (!strncmp(opt, "fp", 2))
  1302. fp = 1;
  1303. else if (!strncmp(opt, "crt", 3))
  1304. fp = 0;
  1305. else if (!strncmp(opt, "bpp=", 4))
  1306. bpp = simple_strtoul(opt + 4, NULL, 0);
  1307. else if (!strncmp(opt, "center", 6))
  1308. center = 1;
  1309. else if (!strncmp(opt, "stretch", 7))
  1310. stretch = 1;
  1311. else if (!strncmp(opt, "memsize=", 8))
  1312. memsize = simple_strtoul(opt + 8, NULL, 0);
  1313. else if (!strncmp(opt, "memdiff=", 8))
  1314. memdiff = simple_strtoul(opt + 8, NULL, 0);
  1315. else if (!strncmp(opt, "nativex=", 8))
  1316. nativex = simple_strtoul(opt + 8, NULL, 0);
  1317. else
  1318. mode_option = opt;
  1319. }
  1320. return 0;
  1321. }
  1322. #endif
  1323. static int __init tridentfb_init(void)
  1324. {
  1325. #ifndef MODULE
  1326. char *option = NULL;
  1327. if (fb_get_options("tridentfb", &option))
  1328. return -ENODEV;
  1329. tridentfb_setup(option);
  1330. #endif
  1331. output("Trident framebuffer %s initializing\n", VERSION);
  1332. return pci_register_driver(&tridentfb_pci_driver);
  1333. }
  1334. static void __exit tridentfb_exit(void)
  1335. {
  1336. pci_unregister_driver(&tridentfb_pci_driver);
  1337. }
  1338. module_init(tridentfb_init);
  1339. module_exit(tridentfb_exit);
  1340. MODULE_AUTHOR("Jani Monoses <jani@iv.ro>");
  1341. MODULE_DESCRIPTION("Framebuffer driver for Trident cards");
  1342. MODULE_LICENSE("GPL");