tridentfb.c 38 KB

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