tridentfb.c 35 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512
  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. debug("enter\n");
  729. /* check color depth */
  730. if (bpp == 24)
  731. bpp = var->bits_per_pixel = 32;
  732. /* check whether resolution fits on panel and in memory */
  733. if (par->flatpanel && nativex && var->xres > nativex)
  734. return -EINVAL;
  735. if (var->xres * var->yres_virtual * bpp / 8 > info->fix.smem_len)
  736. return -EINVAL;
  737. switch (bpp) {
  738. case 8:
  739. var->red.offset = 0;
  740. var->green.offset = 0;
  741. var->blue.offset = 0;
  742. var->red.length = 6;
  743. var->green.length = 6;
  744. var->blue.length = 6;
  745. break;
  746. case 16:
  747. var->red.offset = 11;
  748. var->green.offset = 5;
  749. var->blue.offset = 0;
  750. var->red.length = 5;
  751. var->green.length = 6;
  752. var->blue.length = 5;
  753. break;
  754. case 32:
  755. var->red.offset = 16;
  756. var->green.offset = 8;
  757. var->blue.offset = 0;
  758. var->red.length = 8;
  759. var->green.length = 8;
  760. var->blue.length = 8;
  761. break;
  762. default:
  763. return -EINVAL;
  764. }
  765. debug("exit\n");
  766. return 0;
  767. }
  768. /* Pan the display */
  769. static int tridentfb_pan_display(struct fb_var_screeninfo *var,
  770. struct fb_info *info)
  771. {
  772. struct tridentfb_par *par = info->par;
  773. unsigned int offset;
  774. debug("enter\n");
  775. offset = (var->xoffset + (var->yoffset * var->xres))
  776. * var->bits_per_pixel / 32;
  777. info->var.xoffset = var->xoffset;
  778. info->var.yoffset = var->yoffset;
  779. set_screen_start(par, offset);
  780. debug("exit\n");
  781. return 0;
  782. }
  783. static void shadowmode_on(struct tridentfb_par *par)
  784. {
  785. write3CE(par, CyberControl, read3CE(par, CyberControl) | 0x81);
  786. }
  787. static void shadowmode_off(struct tridentfb_par *par)
  788. {
  789. write3CE(par, CyberControl, read3CE(par, CyberControl) & 0x7E);
  790. }
  791. /* Set the hardware to the requested video mode */
  792. static int tridentfb_set_par(struct fb_info *info)
  793. {
  794. struct tridentfb_par *par = (struct tridentfb_par *)(info->par);
  795. u32 htotal, hdispend, hsyncstart, hsyncend, hblankstart, hblankend;
  796. u32 vtotal, vdispend, vsyncstart, vsyncend, vblankstart, vblankend;
  797. struct fb_var_screeninfo *var = &info->var;
  798. int bpp = var->bits_per_pixel;
  799. unsigned char tmp;
  800. unsigned long vclk;
  801. debug("enter\n");
  802. hdispend = var->xres / 8 - 1;
  803. hsyncstart = (var->xres + var->right_margin) / 8 - 1;
  804. hsyncend = (var->xres + var->right_margin + var->hsync_len) / 8 - 1;
  805. htotal = (var->xres + var->left_margin + var->right_margin +
  806. var->hsync_len) / 8 - 5;
  807. hblankstart = hdispend + 1;
  808. hblankend = htotal + 3;
  809. vdispend = var->yres - 1;
  810. vsyncstart = var->yres + var->lower_margin;
  811. vsyncend = vsyncstart + var->vsync_len;
  812. vtotal = var->upper_margin + vsyncend - 2;
  813. vblankstart = vdispend + 1;
  814. vblankend = vtotal;
  815. crtc_unlock(par);
  816. write3CE(par, CyberControl, 8);
  817. if (par->flatpanel && var->xres < nativex) {
  818. /*
  819. * on flat panels with native size larger
  820. * than requested resolution decide whether
  821. * we stretch or center
  822. */
  823. t_outb(par, 0xEB, VGA_MIS_W);
  824. shadowmode_on(par);
  825. if (center)
  826. screen_center(par);
  827. else if (stretch)
  828. screen_stretch(par);
  829. } else {
  830. t_outb(par, 0x2B, VGA_MIS_W);
  831. write3CE(par, CyberControl, 8);
  832. }
  833. /* vertical timing values */
  834. write3X4(par, VGA_CRTC_V_TOTAL, vtotal & 0xFF);
  835. write3X4(par, VGA_CRTC_V_DISP_END, vdispend & 0xFF);
  836. write3X4(par, VGA_CRTC_V_SYNC_START, vsyncstart & 0xFF);
  837. write3X4(par, VGA_CRTC_V_SYNC_END, (vsyncend & 0x0F));
  838. write3X4(par, VGA_CRTC_V_BLANK_START, vblankstart & 0xFF);
  839. write3X4(par, VGA_CRTC_V_BLANK_END, vblankend & 0xFF);
  840. /* horizontal timing values */
  841. write3X4(par, VGA_CRTC_H_TOTAL, htotal & 0xFF);
  842. write3X4(par, VGA_CRTC_H_DISP, hdispend & 0xFF);
  843. write3X4(par, VGA_CRTC_H_SYNC_START, hsyncstart & 0xFF);
  844. write3X4(par, VGA_CRTC_H_SYNC_END,
  845. (hsyncend & 0x1F) | ((hblankend & 0x20) << 2));
  846. write3X4(par, VGA_CRTC_H_BLANK_START, hblankstart & 0xFF);
  847. write3X4(par, VGA_CRTC_H_BLANK_END, hblankend & 0x1F);
  848. /* higher bits of vertical timing values */
  849. tmp = 0x10;
  850. if (vtotal & 0x100) tmp |= 0x01;
  851. if (vdispend & 0x100) tmp |= 0x02;
  852. if (vsyncstart & 0x100) tmp |= 0x04;
  853. if (vblankstart & 0x100) tmp |= 0x08;
  854. if (vtotal & 0x200) tmp |= 0x20;
  855. if (vdispend & 0x200) tmp |= 0x40;
  856. if (vsyncstart & 0x200) tmp |= 0x80;
  857. write3X4(par, VGA_CRTC_OVERFLOW, tmp);
  858. tmp = read3X4(par, CRTHiOrd) & 0x07;
  859. tmp |= 0x08; /* line compare bit 10 */
  860. if (vtotal & 0x400) tmp |= 0x80;
  861. if (vblankstart & 0x400) tmp |= 0x40;
  862. if (vsyncstart & 0x400) tmp |= 0x20;
  863. if (vdispend & 0x400) tmp |= 0x10;
  864. write3X4(par, CRTHiOrd, tmp);
  865. tmp = (htotal >> 8) & 0x01;
  866. tmp |= (hdispend >> 7) & 0x02;
  867. tmp |= (hsyncstart >> 5) & 0x08;
  868. tmp |= (hblankstart >> 4) & 0x10;
  869. write3X4(par, HorizOverflow, tmp);
  870. tmp = 0x40;
  871. if (vblankstart & 0x200) tmp |= 0x20;
  872. //FIXME if (info->var.vmode & FB_VMODE_DOUBLE) tmp |= 0x80; /* double scan for 200 line modes */
  873. write3X4(par, VGA_CRTC_MAX_SCAN, tmp);
  874. write3X4(par, VGA_CRTC_LINE_COMPARE, 0xFF);
  875. write3X4(par, VGA_CRTC_PRESET_ROW, 0);
  876. write3X4(par, VGA_CRTC_MODE, 0xC3);
  877. write3X4(par, LinearAddReg, 0x20); /* enable linear addressing */
  878. tmp = (info->var.vmode & FB_VMODE_INTERLACED) ? 0x84 : 0x80;
  879. /* enable access extended memory */
  880. write3X4(par, CRTCModuleTest, tmp);
  881. /* enable GE for text acceleration */
  882. write3X4(par, GraphEngReg, 0x80);
  883. #ifdef CONFIG_FB_TRIDENT_ACCEL
  884. par->init_accel(par, info->var.xres, bpp);
  885. #endif
  886. switch (bpp) {
  887. case 8:
  888. tmp = 0x00;
  889. break;
  890. case 16:
  891. tmp = 0x05;
  892. break;
  893. case 24:
  894. tmp = 0x29;
  895. break;
  896. case 32:
  897. tmp = 0x09;
  898. break;
  899. }
  900. write3X4(par, PixelBusReg, tmp);
  901. tmp = read3X4(par, DRAMControl);
  902. if (!is_oldprotect(par->chip_id))
  903. tmp |= 0x10;
  904. if (iscyber(par->chip_id))
  905. tmp |= 0x20;
  906. write3X4(par, DRAMControl, tmp); /* both IO, linear enable */
  907. write3X4(par, InterfaceSel, read3X4(par, InterfaceSel) | 0x40);
  908. if (!is_xp(par->chip_id))
  909. write3X4(par, Performance, read3X4(par, Performance) | 0x10);
  910. /* MMIO & PCI read and write burst enable */
  911. if (par->chip_id != TGUI9440)
  912. write3X4(par, PCIReg, read3X4(par, PCIReg) | 0x06);
  913. /* convert from picoseconds to kHz */
  914. vclk = PICOS2KHZ(info->var.pixclock);
  915. if (bpp == 32)
  916. vclk *= 2;
  917. set_vclk(par, vclk);
  918. vga_mm_wseq(par->io_virt, 0, 3);
  919. vga_mm_wseq(par->io_virt, 1, 1); /* set char clock 8 dots wide */
  920. /* enable 4 maps because needed in chain4 mode */
  921. vga_mm_wseq(par->io_virt, 2, 0x0F);
  922. vga_mm_wseq(par->io_virt, 3, 0);
  923. vga_mm_wseq(par->io_virt, 4, 0x0E); /* memory mode enable bitmaps ?? */
  924. /* divide clock by 2 if 32bpp chain4 mode display and CPU path */
  925. write3CE(par, MiscExtFunc, (bpp == 32) ? 0x1A : 0x12);
  926. write3CE(par, 0x5, 0x40); /* no CGA compat, allow 256 col */
  927. write3CE(par, 0x6, 0x05); /* graphics mode */
  928. write3CE(par, 0x7, 0x0F); /* planes? */
  929. if (par->chip_id == CYBERBLADEXPAi1) {
  930. /* This fixes snow-effect in 32 bpp */
  931. write3X4(par, VGA_CRTC_H_SYNC_START, 0x84);
  932. }
  933. /* graphics mode and support 256 color modes */
  934. writeAttr(par, 0x10, 0x41);
  935. writeAttr(par, 0x12, 0x0F); /* planes */
  936. writeAttr(par, 0x13, 0); /* horizontal pel panning */
  937. /* colors */
  938. for (tmp = 0; tmp < 0x10; tmp++)
  939. writeAttr(par, tmp, tmp);
  940. fb_readb(par->io_virt + VGA_IS1_RC); /* flip-flop to index */
  941. t_outb(par, 0x20, VGA_ATT_W); /* enable attr */
  942. switch (bpp) {
  943. case 8:
  944. tmp = 0;
  945. break;
  946. case 15:
  947. tmp = 0x10;
  948. break;
  949. case 16:
  950. tmp = 0x30;
  951. break;
  952. case 24:
  953. case 32:
  954. tmp = 0xD0;
  955. break;
  956. }
  957. t_inb(par, VGA_PEL_IW);
  958. t_inb(par, VGA_PEL_MSK);
  959. t_inb(par, VGA_PEL_MSK);
  960. t_inb(par, VGA_PEL_MSK);
  961. t_inb(par, VGA_PEL_MSK);
  962. t_outb(par, tmp, VGA_PEL_MSK);
  963. t_inb(par, VGA_PEL_IW);
  964. if (par->flatpanel)
  965. set_number_of_lines(par, info->var.yres);
  966. set_lwidth(par, info->var.xres * bpp / (4 * 16));
  967. info->fix.visual = (bpp == 8) ? FB_VISUAL_PSEUDOCOLOR : FB_VISUAL_TRUECOLOR;
  968. info->fix.line_length = info->var.xres * (bpp >> 3);
  969. info->cmap.len = (bpp == 8) ? 256 : 16;
  970. debug("exit\n");
  971. return 0;
  972. }
  973. /* Set one color register */
  974. static int tridentfb_setcolreg(unsigned regno, unsigned red, unsigned green,
  975. unsigned blue, unsigned transp,
  976. struct fb_info *info)
  977. {
  978. int bpp = info->var.bits_per_pixel;
  979. struct tridentfb_par *par = info->par;
  980. if (regno >= info->cmap.len)
  981. return 1;
  982. if (bpp == 8) {
  983. t_outb(par, 0xFF, VGA_PEL_MSK);
  984. t_outb(par, regno, VGA_PEL_IW);
  985. t_outb(par, red >> 10, VGA_PEL_D);
  986. t_outb(par, green >> 10, VGA_PEL_D);
  987. t_outb(par, blue >> 10, VGA_PEL_D);
  988. } else if (regno < 16) {
  989. if (bpp == 16) { /* RGB 565 */
  990. u32 col;
  991. col = (red & 0xF800) | ((green & 0xFC00) >> 5) |
  992. ((blue & 0xF800) >> 11);
  993. col |= col << 16;
  994. ((u32 *)(info->pseudo_palette))[regno] = col;
  995. } else if (bpp == 32) /* ARGB 8888 */
  996. ((u32*)info->pseudo_palette)[regno] =
  997. ((transp & 0xFF00) << 16) |
  998. ((red & 0xFF00) << 8) |
  999. ((green & 0xFF00)) |
  1000. ((blue & 0xFF00) >> 8);
  1001. }
  1002. /* debug("exit\n"); */
  1003. return 0;
  1004. }
  1005. /* Try blanking the screen.For flat panels it does nothing */
  1006. static int tridentfb_blank(int blank_mode, struct fb_info *info)
  1007. {
  1008. unsigned char PMCont, DPMSCont;
  1009. struct tridentfb_par *par = info->par;
  1010. debug("enter\n");
  1011. if (par->flatpanel)
  1012. return 0;
  1013. t_outb(par, 0x04, 0x83C8); /* Read DPMS Control */
  1014. PMCont = t_inb(par, 0x83C6) & 0xFC;
  1015. DPMSCont = read3CE(par, PowerStatus) & 0xFC;
  1016. switch (blank_mode) {
  1017. case FB_BLANK_UNBLANK:
  1018. /* Screen: On, HSync: On, VSync: On */
  1019. case FB_BLANK_NORMAL:
  1020. /* Screen: Off, HSync: On, VSync: On */
  1021. PMCont |= 0x03;
  1022. DPMSCont |= 0x00;
  1023. break;
  1024. case FB_BLANK_HSYNC_SUSPEND:
  1025. /* Screen: Off, HSync: Off, VSync: On */
  1026. PMCont |= 0x02;
  1027. DPMSCont |= 0x01;
  1028. break;
  1029. case FB_BLANK_VSYNC_SUSPEND:
  1030. /* Screen: Off, HSync: On, VSync: Off */
  1031. PMCont |= 0x02;
  1032. DPMSCont |= 0x02;
  1033. break;
  1034. case FB_BLANK_POWERDOWN:
  1035. /* Screen: Off, HSync: Off, VSync: Off */
  1036. PMCont |= 0x00;
  1037. DPMSCont |= 0x03;
  1038. break;
  1039. }
  1040. write3CE(par, PowerStatus, DPMSCont);
  1041. t_outb(par, 4, 0x83C8);
  1042. t_outb(par, PMCont, 0x83C6);
  1043. debug("exit\n");
  1044. /* let fbcon do a softblank for us */
  1045. return (blank_mode == FB_BLANK_NORMAL) ? 1 : 0;
  1046. }
  1047. static struct fb_ops tridentfb_ops = {
  1048. .owner = THIS_MODULE,
  1049. .fb_setcolreg = tridentfb_setcolreg,
  1050. .fb_pan_display = tridentfb_pan_display,
  1051. .fb_blank = tridentfb_blank,
  1052. .fb_check_var = tridentfb_check_var,
  1053. .fb_set_par = tridentfb_set_par,
  1054. .fb_fillrect = tridentfb_fillrect,
  1055. .fb_copyarea = tridentfb_copyarea,
  1056. .fb_imageblit = cfb_imageblit,
  1057. };
  1058. static int __devinit trident_pci_probe(struct pci_dev *dev,
  1059. const struct pci_device_id *id)
  1060. {
  1061. int err;
  1062. unsigned char revision;
  1063. struct fb_info *info;
  1064. struct tridentfb_par *default_par;
  1065. int defaultaccel;
  1066. int chip3D;
  1067. int chip_id;
  1068. err = pci_enable_device(dev);
  1069. if (err)
  1070. return err;
  1071. info = framebuffer_alloc(sizeof(struct tridentfb_par), &dev->dev);
  1072. if (!info)
  1073. return -ENOMEM;
  1074. default_par = info->par;
  1075. chip_id = id->device;
  1076. if (chip_id == CYBERBLADEi1)
  1077. output("*** Please do use cyblafb, Cyberblade/i1 support "
  1078. "will soon be removed from tridentfb!\n");
  1079. /* If PCI id is 0x9660 then further detect chip type */
  1080. if (chip_id == TGUI9660) {
  1081. revision = vga_io_rseq(RevisionID);
  1082. switch (revision) {
  1083. case 0x21:
  1084. chip_id = PROVIDIA9685;
  1085. break;
  1086. case 0x22:
  1087. case 0x23:
  1088. chip_id = CYBER9397;
  1089. break;
  1090. case 0x2A:
  1091. chip_id = CYBER9397DVD;
  1092. break;
  1093. case 0x30:
  1094. case 0x33:
  1095. case 0x34:
  1096. case 0x35:
  1097. case 0x38:
  1098. case 0x3A:
  1099. case 0xB3:
  1100. chip_id = CYBER9385;
  1101. break;
  1102. case 0x40 ... 0x43:
  1103. chip_id = CYBER9382;
  1104. break;
  1105. case 0x4A:
  1106. chip_id = CYBER9388;
  1107. break;
  1108. default:
  1109. break;
  1110. }
  1111. }
  1112. chip3D = is3Dchip(chip_id);
  1113. if (is_xp(chip_id)) {
  1114. default_par->init_accel = xp_init_accel;
  1115. default_par->wait_engine = xp_wait_engine;
  1116. default_par->fill_rect = xp_fill_rect;
  1117. default_par->copy_rect = xp_copy_rect;
  1118. } else if (is_blade(chip_id)) {
  1119. default_par->init_accel = blade_init_accel;
  1120. default_par->wait_engine = blade_wait_engine;
  1121. default_par->fill_rect = blade_fill_rect;
  1122. default_par->copy_rect = blade_copy_rect;
  1123. } else {
  1124. default_par->init_accel = image_init_accel;
  1125. default_par->wait_engine = image_wait_engine;
  1126. default_par->fill_rect = image_fill_rect;
  1127. default_par->copy_rect = image_copy_rect;
  1128. }
  1129. default_par->chip_id = chip_id;
  1130. /* acceleration is on by default for 3D chips */
  1131. defaultaccel = chip3D && !noaccel;
  1132. /* setup MMIO region */
  1133. tridentfb_fix.mmio_start = pci_resource_start(dev, 1);
  1134. tridentfb_fix.mmio_len = chip3D ? 0x20000 : 0x10000;
  1135. if (!request_mem_region(tridentfb_fix.mmio_start, tridentfb_fix.mmio_len, "tridentfb")) {
  1136. debug("request_region failed!\n");
  1137. framebuffer_release(info);
  1138. return -1;
  1139. }
  1140. default_par->io_virt = ioremap_nocache(tridentfb_fix.mmio_start,
  1141. tridentfb_fix.mmio_len);
  1142. if (!default_par->io_virt) {
  1143. debug("ioremap failed\n");
  1144. err = -1;
  1145. goto out_unmap1;
  1146. }
  1147. /* setup framebuffer memory */
  1148. tridentfb_fix.smem_start = pci_resource_start(dev, 0);
  1149. tridentfb_fix.smem_len = get_memsize(default_par);
  1150. if (!request_mem_region(tridentfb_fix.smem_start, tridentfb_fix.smem_len, "tridentfb")) {
  1151. debug("request_mem_region failed!\n");
  1152. disable_mmio(info->par);
  1153. err = -1;
  1154. goto out_unmap1;
  1155. }
  1156. enable_mmio();
  1157. info->screen_base = ioremap_nocache(tridentfb_fix.smem_start,
  1158. tridentfb_fix.smem_len);
  1159. if (!info->screen_base) {
  1160. debug("ioremap failed\n");
  1161. err = -1;
  1162. goto out_unmap2;
  1163. }
  1164. output("%s board found\n", pci_name(dev));
  1165. default_par->flatpanel = is_flatpanel(default_par);
  1166. if (default_par->flatpanel)
  1167. nativex = get_nativex(default_par);
  1168. info->fix = tridentfb_fix;
  1169. info->fbops = &tridentfb_ops;
  1170. info->pseudo_palette = default_par->pseudo_pal;
  1171. info->flags = FBINFO_DEFAULT | FBINFO_HWACCEL_YPAN;
  1172. #ifdef CONFIG_FB_TRIDENT_ACCEL
  1173. info->flags |= FBINFO_HWACCEL_COPYAREA | FBINFO_HWACCEL_FILLRECT;
  1174. #endif
  1175. if (!fb_find_mode(&info->var, info,
  1176. mode_option, NULL, 0, NULL, bpp)) {
  1177. err = -EINVAL;
  1178. goto out_unmap2;
  1179. }
  1180. err = fb_alloc_cmap(&info->cmap, 256, 0);
  1181. if (err < 0)
  1182. goto out_unmap2;
  1183. if (defaultaccel && default_par->init_accel)
  1184. info->var.accel_flags |= FB_ACCELF_TEXT;
  1185. else
  1186. info->var.accel_flags &= ~FB_ACCELF_TEXT;
  1187. info->var.activate |= FB_ACTIVATE_NOW;
  1188. info->device = &dev->dev;
  1189. if (register_framebuffer(info) < 0) {
  1190. printk(KERN_ERR "tridentfb: could not register Trident framebuffer\n");
  1191. fb_dealloc_cmap(&info->cmap);
  1192. err = -EINVAL;
  1193. goto out_unmap2;
  1194. }
  1195. output("fb%d: %s frame buffer device %dx%d-%dbpp\n",
  1196. info->node, info->fix.id, info->var.xres,
  1197. info->var.yres, info->var.bits_per_pixel);
  1198. pci_set_drvdata(dev, info);
  1199. return 0;
  1200. out_unmap2:
  1201. if (info->screen_base)
  1202. iounmap(info->screen_base);
  1203. release_mem_region(tridentfb_fix.smem_start, tridentfb_fix.smem_len);
  1204. disable_mmio(info->par);
  1205. out_unmap1:
  1206. if (default_par->io_virt)
  1207. iounmap(default_par->io_virt);
  1208. release_mem_region(tridentfb_fix.mmio_start, tridentfb_fix.mmio_len);
  1209. framebuffer_release(info);
  1210. return err;
  1211. }
  1212. static void __devexit trident_pci_remove(struct pci_dev *dev)
  1213. {
  1214. struct fb_info *info = pci_get_drvdata(dev);
  1215. struct tridentfb_par *par = info->par;
  1216. unregister_framebuffer(info);
  1217. iounmap(par->io_virt);
  1218. iounmap(info->screen_base);
  1219. release_mem_region(tridentfb_fix.smem_start, tridentfb_fix.smem_len);
  1220. release_mem_region(tridentfb_fix.mmio_start, tridentfb_fix.mmio_len);
  1221. pci_set_drvdata(dev, NULL);
  1222. framebuffer_release(info);
  1223. }
  1224. /* List of boards that we are trying to support */
  1225. static struct pci_device_id trident_devices[] = {
  1226. {PCI_VENDOR_ID_TRIDENT, BLADE3D, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
  1227. {PCI_VENDOR_ID_TRIDENT, CYBERBLADEi7, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
  1228. {PCI_VENDOR_ID_TRIDENT, CYBERBLADEi7D, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
  1229. {PCI_VENDOR_ID_TRIDENT, CYBERBLADEi1, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
  1230. {PCI_VENDOR_ID_TRIDENT, CYBERBLADEi1D, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
  1231. {PCI_VENDOR_ID_TRIDENT, CYBERBLADEAi1, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
  1232. {PCI_VENDOR_ID_TRIDENT, CYBERBLADEAi1D, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
  1233. {PCI_VENDOR_ID_TRIDENT, CYBERBLADEE4, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
  1234. {PCI_VENDOR_ID_TRIDENT, TGUI9440, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
  1235. {PCI_VENDOR_ID_TRIDENT, TGUI9660, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
  1236. {PCI_VENDOR_ID_TRIDENT, IMAGE975, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
  1237. {PCI_VENDOR_ID_TRIDENT, IMAGE985, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
  1238. {PCI_VENDOR_ID_TRIDENT, CYBER9320, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
  1239. {PCI_VENDOR_ID_TRIDENT, CYBER9388, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
  1240. {PCI_VENDOR_ID_TRIDENT, CYBER9520, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
  1241. {PCI_VENDOR_ID_TRIDENT, CYBER9525DVD, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
  1242. {PCI_VENDOR_ID_TRIDENT, CYBER9397, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
  1243. {PCI_VENDOR_ID_TRIDENT, CYBER9397DVD, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
  1244. {PCI_VENDOR_ID_TRIDENT, CYBERBLADEXPAi1, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
  1245. {PCI_VENDOR_ID_TRIDENT, CYBERBLADEXPm8, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
  1246. {PCI_VENDOR_ID_TRIDENT, CYBERBLADEXPm16, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
  1247. {0,}
  1248. };
  1249. MODULE_DEVICE_TABLE(pci, trident_devices);
  1250. static struct pci_driver tridentfb_pci_driver = {
  1251. .name = "tridentfb",
  1252. .id_table = trident_devices,
  1253. .probe = trident_pci_probe,
  1254. .remove = __devexit_p(trident_pci_remove)
  1255. };
  1256. /*
  1257. * Parse user specified options (`video=trident:')
  1258. * example:
  1259. * video=trident:800x600,bpp=16,noaccel
  1260. */
  1261. #ifndef MODULE
  1262. static int __init tridentfb_setup(char *options)
  1263. {
  1264. char *opt;
  1265. if (!options || !*options)
  1266. return 0;
  1267. while ((opt = strsep(&options, ",")) != NULL) {
  1268. if (!*opt)
  1269. continue;
  1270. if (!strncmp(opt, "noaccel", 7))
  1271. noaccel = 1;
  1272. else if (!strncmp(opt, "fp", 2))
  1273. fp = 1;
  1274. else if (!strncmp(opt, "crt", 3))
  1275. fp = 0;
  1276. else if (!strncmp(opt, "bpp=", 4))
  1277. bpp = simple_strtoul(opt + 4, NULL, 0);
  1278. else if (!strncmp(opt, "center", 6))
  1279. center = 1;
  1280. else if (!strncmp(opt, "stretch", 7))
  1281. stretch = 1;
  1282. else if (!strncmp(opt, "memsize=", 8))
  1283. memsize = simple_strtoul(opt + 8, NULL, 0);
  1284. else if (!strncmp(opt, "memdiff=", 8))
  1285. memdiff = simple_strtoul(opt + 8, NULL, 0);
  1286. else if (!strncmp(opt, "nativex=", 8))
  1287. nativex = simple_strtoul(opt + 8, NULL, 0);
  1288. else
  1289. mode_option = opt;
  1290. }
  1291. return 0;
  1292. }
  1293. #endif
  1294. static int __init tridentfb_init(void)
  1295. {
  1296. #ifndef MODULE
  1297. char *option = NULL;
  1298. if (fb_get_options("tridentfb", &option))
  1299. return -ENODEV;
  1300. tridentfb_setup(option);
  1301. #endif
  1302. output("Trident framebuffer %s initializing\n", VERSION);
  1303. return pci_register_driver(&tridentfb_pci_driver);
  1304. }
  1305. static void __exit tridentfb_exit(void)
  1306. {
  1307. pci_unregister_driver(&tridentfb_pci_driver);
  1308. }
  1309. module_init(tridentfb_init);
  1310. module_exit(tridentfb_exit);
  1311. MODULE_AUTHOR("Jani Monoses <jani@iv.ro>");
  1312. MODULE_DESCRIPTION("Framebuffer driver for Trident cards");
  1313. MODULE_LICENSE("GPL");