tridentfb.c 35 KB

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