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

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

嵌入式Linux

开发平台：

Unix_Linux

matroxfb_misc.c：源码内容
  1. /*
  2.  *
  3.  * Hardware accelerated Matrox Millennium I, II, Mystique, G100, G200 and G400
  4.  *
  5.  * (c) 1998,1999,2000 Petr Vandrovec <vandrove@vc.cvut.cz>
  6.  *
  7.  * Version: 1.54 2001/09/09
  8.  *
  9.  * MTRR stuff: 1998 Tom Rini <trini@kernel.crashing.org>
  10.  *
  11.  * Contributors: "menion?" <menion@mindless.com>
  12.  *                     Betatesting, fixes, ideas
  13.  *
  14.  *               "Kurt Garloff" <garloff@suse.de>
  15.  *                     Betatesting, fixes, ideas, videomodes, videomodes timmings
  16.  *
  17.  *               "Tom Rini" <trini@kernel.crashing.org>
  18.  *                     MTRR stuff, PPC cleanups, betatesting, fixes, ideas
  19.  *
  20.  *               "Bibek Sahu" <scorpio@dodds.net>
  21.  *                     Access device through readb|w|l and write b|w|l
  22.  *                     Extensive debugging stuff
  23.  *
  24.  *               "Daniel Haun" <haund@usa.net>
  25.  *                     Testing, hardware cursor fixes
  26.  *
  27.  *               "Scott Wood" <sawst46+@pitt.edu>
  28.  *                     Fixes
  29.  *
  30.  *               "Gerd Knorr" <kraxel@goldbach.isdn.cs.tu-berlin.de>
  31.  *                     Betatesting
  32.  *
  33.  *               "Kelly French" <targon@hazmat.com>
  34.  *               "Fernando Herrera" <fherrera@eurielec.etsit.upm.es>
  35.  *                     Betatesting, bug reporting
  36.  *
  37.  *               "Pablo Bianucci" <pbian@pccp.com.ar>
  38.  *                     Fixes, ideas, betatesting
  39.  *
  40.  *               "Inaky Perez Gonzalez" <inaky@peloncho.fis.ucm.es>
  41.  *                     Fixes, enhandcements, ideas, betatesting
  42.  *
  43.  *               "Ryuichi Oikawa" <roikawa@rr.iiij4u.or.jp>
  44.  *                     PPC betatesting, PPC support, backward compatibility
  45.  *
  46.  *               "Paul Womar" <Paul@pwomar.demon.co.uk>
  47.  *               "Owen Waller" <O.Waller@ee.qub.ac.uk>
  48.  *                     PPC betatesting
  49.  *
  50.  *               "Thomas Pornin" <pornin@bolet.ens.fr>
  51.  *                     Alpha betatesting
  52.  *
  53.  *               "Pieter van Leuven" <pvl@iae.nl>
  54.  *               "Ulf Jaenicke-Roessler" <ujr@physik.phy.tu-dresden.de>
  55.  *                     G100 testing
  56.  *
  57.  *               "H. Peter Arvin" <hpa@transmeta.com>
  58.  *                     Ideas
  59.  *
  60.  *               "Cort Dougan" <cort@cs.nmt.edu>
  61.  *                     CHRP fixes and PReP cleanup
  62.  *
  63.  *               "Mark Vojkovich" <mvojkovi@ucsd.edu>
  64.  *                     G400 support
  65.  *
  66.  *               "David C. Hansen" <haveblue@us.ibm.com>
  67.  *                     Fixes
  68.  *
  69.  * (following author is not in any relation with this code, but his code
  70.  *  is included in this driver)
  71.  *
  72.  * Based on framebuffer driver for VBE 2.0 compliant graphic boards
  73.  *     (c) 1998 Gerd Knorr <kraxel@cs.tu-berlin.de>
  74.  *
  75.  * (following author is not in any relation with this code, but his ideas
  76.  *  were used when writting this driver)
  77.  *
  78.  *  FreeVBE/AF (Matrox), "Shawn Hargreaves" <shawn@talula.demon.co.uk>
  79.  *
  80.  */
  82. /* make checkconfig does not check includes for this... */
  83. #include <linux/config.h>
  85. #include "matroxfb_misc.h"
  86. #include <linux/interrupt.h>
  87. #include <linux/matroxfb.h>
  89. void matroxfb_createcursorshape(WPMINFO struct display* p, int vmode) {
  90. unsigned int h;
  91. unsigned int cu, cd;
  93. h = fontheight(p);
  95. if (vmode & FB_VMODE_DOUBLE)
  96. h *= 2;
  97. cd = h;
  98. if (cd >= 10)
  99. cd--;
  100. switch (ACCESS_FBINFO(cursor.type) = (p->conp->vc_cursor_type & CUR_HWMASK)) {
  101. case CUR_NONE:
  102. cu = cd;
  103. break;
  104. case CUR_UNDERLINE:
  105. cu = cd - 2;
  106. break;
  107. case CUR_LOWER_THIRD:
  108. cu = (h * 2) / 3;
  109. break;
  110. case CUR_LOWER_HALF:
  111. cu = h / 2;
  112. break;
  113. case CUR_TWO_THIRDS:
  114. cu = h / 3;
  115. break;
  116. case CUR_BLOCK:
  117. default:
  118. cu = 0;
  119. cd = h;
  120. break;
  121. }
  122. ACCESS_FBINFO(cursor.w) = fontwidth(p);
  123. ACCESS_FBINFO(cursor.u) = cu;
  124. ACCESS_FBINFO(cursor.d) = cd;
  125. }
  127. void matroxfb_DAC_out(CPMINFO int reg, int val) {
  128. DBG_REG("outDAC");
  129. mga_outb(M_RAMDAC_BASE+M_X_INDEX, reg);
  130. mga_outb(M_RAMDAC_BASE+M_X_DATAREG, val);
  131. }
  133. int matroxfb_DAC_in(CPMINFO int reg) {
  134. DBG_REG("inDAC");
  135. mga_outb(M_RAMDAC_BASE+M_X_INDEX, reg);
  136. return mga_inb(M_RAMDAC_BASE+M_X_DATAREG);
  137. }
  139. void matroxfb_var2my(struct fb_var_screeninfo* var, struct my_timming* mt) {
  140. unsigned int pixclock = var->pixclock;
  142. DBG("var2my")
  144. if (!pixclock) pixclock = 10000; /* 10ns = 100MHz */
  145. mt->pixclock = 1000000000 / pixclock;
  146. if (mt->pixclock < 1) mt->pixclock = 1;
  147. mt->dblscan = var->vmode & FB_VMODE_DOUBLE;
  148. mt->interlaced = var->vmode & FB_VMODE_INTERLACED;
  149. mt->HDisplay = var->xres;
  150. mt->HSyncStart = mt->HDisplay + var->right_margin;
  151. mt->HSyncEnd = mt->HSyncStart + var->hsync_len;
  152. mt->HTotal = mt->HSyncEnd + var->left_margin;
  153. mt->VDisplay = var->yres;
  154. mt->VSyncStart = mt->VDisplay + var->lower_margin;
  155. mt->VSyncEnd = mt->VSyncStart + var->vsync_len;
  156. mt->VTotal = mt->VSyncEnd + var->upper_margin;
  157. mt->sync = var->sync;
  158. }
  160. int matroxfb_PLL_calcclock(const struct matrox_pll_features* pll, unsigned int freq, unsigned int fmax,
  161. unsigned int* in, unsigned int* feed, unsigned int* post) {
  162. unsigned int bestdiff = ~0;
  163. unsigned int bestvco = 0;
  164. unsigned int fxtal = pll->ref_freq;
  165. unsigned int fwant;
  166. unsigned int p;
  168. DBG("PLL_calcclock")
  170. fwant = freq;
  172. #ifdef DEBUG
  173. printk(KERN_ERR "post_shift_max: %dn", pll->post_shift_max);
  174. printk(KERN_ERR "ref_freq: %dn", pll->ref_freq);
  175. printk(KERN_ERR "freq: %dn", freq);
  176. printk(KERN_ERR "vco_freq_min: %dn", pll->vco_freq_min);
  177. printk(KERN_ERR "in_div_min: %dn", pll->in_div_min);
  178. printk(KERN_ERR "in_div_max: %dn", pll->in_div_max);
  179. printk(KERN_ERR "feed_div_min: %dn", pll->feed_div_min);
  180. printk(KERN_ERR "feed_div_max: %dn", pll->feed_div_max);
  181. printk(KERN_ERR "fmax: %dn", fmax);
  182. #endif
  183. for (p = 1; p <= pll->post_shift_max; p++) {
  184. if (fwant * 2 > fmax)
  185. break;
  186. fwant *= 2;
  187. }
  188. if (fwant < pll->vco_freq_min) fwant = pll->vco_freq_min;
  189. if (fwant > fmax) fwant = fmax;
  190. for (; p-- > 0; fwant >>= 1, bestdiff >>= 1) {
  191. unsigned int m;
  193. if (fwant < pll->vco_freq_min) break;
  194. for (m = pll->in_div_min; m <= pll->in_div_max; m++) {
  195. unsigned int diff, fvco;
  196. unsigned int n;
  198. n = (fwant * (m + 1) + (fxtal >> 1)) / fxtal - 1;
  199. if (n > pll->feed_div_max)
  200. break;
  201. if (n < pll->feed_div_min)
  202. n = pll->feed_div_min;
  203. fvco = (fxtal * (n + 1)) / (m + 1);
  204. if (fvco < fwant)
  205. diff = fwant - fvco;
  206. else
  207. diff = fvco - fwant;
  208. if (diff < bestdiff) {
  209. bestdiff = diff;
  210. *post = p;
  211. *in = m;
  212. *feed = n;
  213. bestvco = fvco;
  214. }
  215. }
  216. }
  217. dprintk(KERN_ERR "clk: %02X %02X %02X %d %d %dn", *in, *feed, *post, fxtal, bestvco, fwant);
  218. return bestvco;
  219. }
  221. int matroxfb_vgaHWinit(CPMINFO struct matrox_hw_state* hw, struct my_timming* m, struct display* p) {
  222. unsigned int hd, hs, he, hbe, ht;
  223. unsigned int vd, vs, ve, vt;
  224. unsigned int wd;
  225. unsigned int divider;
  226. int i;
  227. int text = p->type == FB_TYPE_TEXT;
  228. int fwidth;
  230. if (text) {
  231. fwidth = fontwidth(p);
  232. if (!fwidth) fwidth = 8;
  233. } else
  234. fwidth = 8;
  236. DBG("vgaHWinit")
  238. hw->SEQ[0] = 0x00;
  239. if (fwidth == 9)
  240. hw->SEQ[1] = 0x00;
  241. else
  242. hw->SEQ[1] = 0x01; /* or 0x09 */
  243. hw->SEQ[2] = 0x0F; /* bitplanes */
  244. hw->SEQ[3] = 0x00;
  245. if (text)
  246. hw->SEQ[4] = 0x02;
  247. else
  248. hw->SEQ[4] = 0x0E;
  249. /* CRTC 0..7, 9, 16..19, 21, 22 are reprogrammed by Matrox Millennium code... Hope that by MGA1064 too */
  250. if (m->dblscan) {
  251. m->VTotal <<= 1;
  252. m->VDisplay <<= 1;
  253. m->VSyncStart <<= 1;
  254. m->VSyncEnd <<= 1;
  255. }
  256. if (m->interlaced) {
  257. m->VTotal >>= 1;
  258. m->VDisplay >>= 1;
  259. m->VSyncStart >>= 1;
  260. m->VSyncEnd >>= 1;
  261. }
  263. /* GCTL is ignored when not using 0xA0000 aperture */
  264. hw->GCTL[0] = 0x00;
  265. hw->GCTL[1] = 0x00;
  266. hw->GCTL[2] = 0x00;
  267. hw->GCTL[3] = 0x00;
  268. hw->GCTL[4] = 0x00;
  269. if (text) {
  270. hw->GCTL[5] = 0x10;
  271. hw->GCTL[6] = 0x02;
  272. } else {
  273. hw->GCTL[5] = 0x40;
  274. hw->GCTL[6] = 0x05;
  275. }
  276. hw->GCTL[7] = 0x0F;
  277. hw->GCTL[8] = 0xFF;
  279. /* Whole ATTR is ignored in PowerGraphics mode */
  280. for (i = 0; i < 16; i++)
  281. hw->ATTR[i] = i;
  282. if (text) {
  283. hw->ATTR[16] = 0x04;
  284. } else {
  285. hw->ATTR[16] = 0x41;
  286. }
  287. hw->ATTR[17] = 0xFF;
  288. hw->ATTR[18] = 0x0F;
  289. if (fwidth == 9)
  290. hw->ATTR[19] = 0x08;
  291. else
  292. hw->ATTR[19] = 0x00;
  293. hw->ATTR[20] = 0x00;
  295. if (text) {
  296. hd = m->HDisplay / fwidth;
  297. hs = m->HSyncStart / fwidth;
  298. he = m->HSyncEnd / fwidth;
  299. ht = m->HTotal / fwidth;
  300. divider = 8;
  301. } else {
  302. hd = m->HDisplay >> 3;
  303. hs = m->HSyncStart >> 3;
  304. he = m->HSyncEnd >> 3;
  305. ht = m->HTotal >> 3;
  306. /* standard timmings are in 8pixels, but for interleaved we cannot */
  307. /* do it for 4bpp (because of (4bpp >> 1(interleaved))/4 == 0) */
  308. /* using 16 or more pixels per unit can save us */
  309. divider = ACCESS_FBINFO(curr.final_bppShift);
  310. }
  311. while (divider & 3) {
  312. hd >>= 1;
  313. hs >>= 1;
  314. he >>= 1;
  315. ht >>= 1;
  316. divider <<= 1;
  317. }
  318. divider = divider / 4;
  319. /* divider can be from 1 to 8 */
  320. while (divider > 8) {
  321. hd <<= 1;
  322. hs <<= 1;
  323. he <<= 1;
  324. ht <<= 1;
  325. divider >>= 1;
  326. }
  327. hd = hd - 1;
  328. hs = hs - 1;
  329. he = he - 1;
  330. ht = ht - 1;
  331. vd = m->VDisplay - 1;
  332. vs = m->VSyncStart - 1;
  333. ve = m->VSyncEnd - 1;
  334. vt = m->VTotal - 2;
  335. /* G200 cannot work with (ht & 7) == 6 */
  336. if (((ht & 0x07) == 0x06) || ((ht & 0x0F) == 0x04))
  337. ht++;
  338. if (text) {
  339. hbe = ht - 1;
  340. wd = p->var.xres_virtual / (fwidth * 2);
  341. } else {
  342. hbe = ht;
  343. wd = p->var.xres_virtual * ACCESS_FBINFO(curr.final_bppShift) / 64;
  344. }
  346. hw->CRTCEXT[0] = 0;
  347. hw->CRTCEXT[5] = 0;
  348. if (m->interlaced) {
  349. hw->CRTCEXT[0] = 0x80;
  350. hw->CRTCEXT[5] = (hs + he - ht) >> 1;
  351. if (!m->dblscan)
  352. wd <<= 1;
  353. vt &= ~1;
  354. }
  355. hw->CRTCEXT[0] |=  (wd & 0x300) >> 4;
  356. hw->CRTCEXT[1] = (((ht - 4) & 0x100) >> 8) |
  357.   ((hd      & 0x100) >> 7) | /* blanking */
  358.   ((hs      & 0x100) >> 6) | /* sync start */
  359.    (hbe     & 0x040);  /* end hor. blanking */
  360. if (ACCESS_FBINFO(output.ph) & MATROXFB_OUTPUT_CONN_SECONDARY)
  361. hw->CRTCEXT[1] |= 0x88; /* enable horizontal and vertical vidrst */
  362. hw->CRTCEXT[2] =  ((vt & 0xC00) >> 10) |
  363.   ((vd & 0x400) >>  8) | /* disp end */
  364.   ((vd & 0xC00) >>  7) | /* vblanking start */
  365.   ((vs & 0xC00) >>  5);
  366. if (text)
  367. hw->CRTCEXT[3] = 0x00;
  368. else
  369. hw->CRTCEXT[3] = (divider - 1) | 0x80;
  370. hw->CRTCEXT[4] = 0;
  372. hw->CRTC[0] = ht-4;
  373. hw->CRTC[1] = hd;
  374. hw->CRTC[2] = hd;
  375. hw->CRTC[3] = (hbe & 0x1F) | 0x80;
  376. hw->CRTC[4] = hs;
  377. hw->CRTC[5] = ((hbe & 0x20) << 2) | (he & 0x1F);
  378. if (text)
  379. hw->CRTC[5] |= 0x60; /* delay sync for 3 clocks (to same picture position on MGA and VGA) */
  380. hw->CRTC[6] = vt & 0xFF;
  381. hw->CRTC[7] = ((vt & 0x100) >> 8) |
  382.       ((vd & 0x100) >> 7) |
  383.       ((vs & 0x100) >> 6) |
  384.       ((vd & 0x100) >> 5) |
  385.       0x10                |
  386.       ((vt & 0x200) >> 4) |
  387.       ((vd & 0x200) >> 3) |
  388.       ((vs & 0x200) >> 2);
  389. hw->CRTC[8] = 0x00;
  390. hw->CRTC[9] = ((vd & 0x200) >> 4) | 0x40;
  391. if (text)
  392. hw->CRTC[9] |= fontheight(p) - 1;
  393. if (m->dblscan && !m->interlaced)
  394. hw->CRTC[9] |= 0x80;
  395. for (i = 10; i < 16; i++)
  396. hw->CRTC[i] = 0x00;
  397. hw->CRTC[16] = vs /* & 0xFF */;
  398. hw->CRTC[17] = (ve & 0x0F) | 0x20;
  399. hw->CRTC[18] = vd /* & 0xFF */;
  400. hw->CRTC[19] = wd /* & 0xFF */;
  401. hw->CRTC[20] = 0x00;
  402. hw->CRTC[21] = vd /* & 0xFF */;
  403. hw->CRTC[22] = (vt + 1) /* & 0xFF */;
  404. if (text) {
  405. if (ACCESS_FBINFO(devflags.textmode) == 1)
  406. hw->CRTC[23] = 0xC3;
  407. else
  408. hw->CRTC[23] = 0xA3;
  409. if (ACCESS_FBINFO(devflags.textmode) == 4)
  410. hw->CRTC[20] = 0x5F;
  411. else
  412. hw->CRTC[20] = 0x1F;
  413. } else
  414. hw->CRTC[23] = 0xC3;
  415. hw->CRTC[24] = 0xFF;
  416. return 0;
  417. };
  419. void matroxfb_vgaHWrestore(WPMINFO struct matrox_hw_state* hw, struct matrox_hw_state* oldhw) {
  420. int i;
  421. CRITFLAGS
  423. DBG("vgaHWrestore")
  425. dprintk(KERN_INFO "MiscOutReg: %02Xn", hw->MiscOutReg);
  426. dprintk(KERN_INFO "SEQ regs:   ");
  427. for (i = 0; i < 5; i++)
  428. dprintk("%02X:", hw->SEQ[i]);
  429. dprintk("n");
  430. dprintk(KERN_INFO "GDC regs:   ");
  431. for (i = 0; i < 9; i++)
  432. dprintk("%02X:", hw->GCTL[i]);
  433. dprintk("n");
  434. dprintk(KERN_INFO "CRTC regs: ");
  435. for (i = 0; i < 25; i++)
  436. dprintk("%02X:", hw->CRTC[i]);
  437. dprintk("n");
  438. dprintk(KERN_INFO "ATTR regs: ");
  439. for (i = 0; i < 21; i++)
  440. dprintk("%02X:", hw->ATTR[i]);
  441. dprintk("n");
  443. CRITBEGIN
  445. mga_inb(M_ATTR_RESET);
  446. mga_outb(M_ATTR_INDEX, 0);
  447. mga_outb(M_MISC_REG, hw->MiscOutReg);
  448. for (i = 1; i < 5; i++)
  449. mga_setr(M_SEQ_INDEX, i, hw->SEQ[i]);
  450. mga_setr(M_CRTC_INDEX, 17, hw->CRTC[17] & 0x7F);
  451. for (i = 0; i < 25; i++)
  452. mga_setr(M_CRTC_INDEX, i, hw->CRTC[i]);
  453. for (i = 0; i < 9; i++)
  454. mga_setr(M_GRAPHICS_INDEX, i, hw->GCTL[i]);
  455. for (i = 0; i < 21; i++) {
  456. mga_inb(M_ATTR_RESET);
  457. mga_outb(M_ATTR_INDEX, i);
  458. mga_outb(M_ATTR_INDEX, hw->ATTR[i]);
  459. }
  460. mga_outb(M_PALETTE_MASK, 0xFF);
  461. mga_outb(M_DAC_REG, 0x00);
  462. for (i = 0; i < 768; i++)
  463. mga_outb(M_DAC_VAL, hw->DACpal[i]);
  464. mga_inb(M_ATTR_RESET);
  465. mga_outb(M_ATTR_INDEX, 0x20);
  467. CRITEND
  468. }
  470. void matroxfb_fastfont_init(struct matrox_fb_info* minfo){
  471. unsigned int size;
  473. size = ACCESS_FBINFO(fastfont.size);
  474. ACCESS_FBINFO(fastfont.size) = 0;
  475. if (size) {
  476. unsigned int end = ACCESS_FBINFO(video.len_usable);
  478. if (size < end) {
  479. unsigned int start;
  481. start = (end - size) & PAGE_MASK;
  482. if (start >= 0x00100000) {
  483. ACCESS_FBINFO(video.len_usable) = start;
  484. ACCESS_FBINFO(fastfont.mgabase) = start * 8;
  485. ACCESS_FBINFO(fastfont.vbase) = ACCESS_FBINFO(video.vbase);
  486. vaddr_add(&ACCESS_FBINFO(fastfont.vbase), start);
  487. ACCESS_FBINFO(fastfont.size) = end - start;
  488. }
  489. }
  490. }
  491. }
  493. #ifndef FNTCHARCNT
  494. #define FNTCHARCNT(fd) (((int *)(fd))[-3])
  495. #endif
  497. int matrox_text_loadfont(WPMINFO struct display* p) {
  498. unsigned int fsize;
  499. unsigned int width;
  500. vaddr_t dst;
  501. unsigned int i;
  502. u_int8_t* font;
  503. CRITFLAGS
  505. if (!p || !p->fontdata)
  506. return 0;
  507. width = fontwidth(p);
  508. fsize = p->userfont?FNTCHARCNT(p->fontdata):256;
  510. dst = ACCESS_FBINFO(video.vbase);
  511. i = 2;
  512. font = (u_int8_t*)p->fontdata;
  514. CRITBEGIN
  516. mga_setr(M_SEQ_INDEX, 0x02, 0x04);
  517. while (fsize--) {
  518. int l;
  520. for (l = 0; l < fontheight(p); l++) {
  521. mga_writeb(dst, i, *font++);
  522. if (fontwidth(p) > 8) font++;
  523. i += ACCESS_FBINFO(devflags.vgastep);
  524. }
  525. i += (32 - fontheight(p)) * ACCESS_FBINFO(devflags.vgastep);
  526. }
  527. mga_setr(M_SEQ_INDEX, 0x02, 0x03);
  529. CRITEND
  531. return 1;
  532. }
  534. int matroxfb_fastfont_tryset(WPMINFO struct display* p) {
  535. unsigned int fsize;
  536. unsigned int width;
  537. CRITFLAGS
  539. if (!p || !p->fontdata)
  540. return 0;
  541. width = fontwidth(p);
  542. if (width > 32)
  543. return 0;
  544. fsize = (p->userfont?FNTCHARCNT(p->fontdata):256) * fontheight(p);
  545. if (((fsize * width + 31) / 32) * 4 > ACCESS_FBINFO(fastfont.size))
  546. return 0;
  548. CRITBEGIN
  550. mga_outl(M_OPMODE, M_OPMODE_8BPP);
  551. if (width <= 8) {
  552. if (width == 8)
  553. mga_memcpy_toio(ACCESS_FBINFO(fastfont.vbase), 0, p->fontdata, fsize);
  554. else {
  555. vaddr_t dst;
  556. unsigned int i;
  557. u_int8_t* font;
  558. u_int32_t mask, valid, reg;
  560. dst = ACCESS_FBINFO(fastfont.vbase);
  561. font = (u_int8_t*)p->fontdata;
  562. mask = ~0 << (8 - width);
  563. valid = 0;
  564. reg = 0;
  565. i = 0;
  566. while (fsize--) {
  567. reg |= (*font++ & mask) << (8 - valid);
  568. valid += width;
  569. if (valid >= 8) {
  570. mga_writeb(dst, i++, reg >> 8);
  571. reg = reg << 8;
  572. valid -= 8;
  573. }
  574. }
  575. if (valid)
  576. mga_writeb(dst, i, reg >> 8);
  577. }
  578. } else if (width <= 16) {
  579. if (width == 16)
  580. mga_memcpy_toio(ACCESS_FBINFO(fastfont.vbase), 0, p->fontdata, fsize*2);
  581. else {
  582. vaddr_t dst;
  583. u_int16_t* font;
  584. u_int32_t mask, valid, reg;
  585. unsigned int i;
  587. dst = ACCESS_FBINFO(fastfont.vbase);
  588. font = (u_int16_t*)p->fontdata;
  589. mask = ~0 << (16 - width);
  590. valid = 0;
  591. reg = 0;
  592. i = 0;
  593. while (fsize--) {
  594. reg |= (ntohs(*font++) & mask) << (16 - valid);
  595. valid += width;
  596. if (valid >= 16) {
  597. mga_writew(dst, i, htons(reg >> 16));
  598. i += 2;
  599. reg = reg << 16;
  600. valid -= 16;
  601. }
  602. }
  603. if (valid)
  604. mga_writew(dst, i, htons(reg >> 16));
  605. }
  606. } else {
  607. if (width == 32)
  608. mga_memcpy_toio(ACCESS_FBINFO(fastfont.vbase), 0, p->fontdata, fsize*4);
  609. else {
  610. vaddr_t dst;
  611. u_int32_t* font;
  612. u_int32_t mask, valid, reg;
  613. unsigned int i;
  615. dst = ACCESS_FBINFO(fastfont.vbase);
  616. font = (u_int32_t*)p->fontdata;
  617. mask = ~0 << (32 - width);
  618. valid = 0;
  619. reg = 0;
  620. i = 0;
  621. while (fsize--) {
  622. reg |= (ntohl(*font) & mask) >> valid;
  623. valid += width;
  624. if (valid >= 32) {
  625. mga_writel(dst, i, htonl(reg));
  626. i += 4;
  627. valid -= 32;
  628. if (valid)
  629. reg = (ntohl(*font) & mask) << (width - valid);
  630. else
  631. reg = 0;
  632. }
  633. font++;
  634. }
  635. if (valid)
  636. mga_writel(dst, i, htonl(reg));
  637. }
  638. }
  639. mga_outl(M_OPMODE, ACCESS_FBINFO(accel.m_opmode));
  641. CRITEND
  643. return 1;
  644. }
  646. EXPORT_SYMBOL(matroxfb_DAC_in);
  647. EXPORT_SYMBOL(matroxfb_DAC_out);
  648. EXPORT_SYMBOL(matroxfb_var2my);
  649. EXPORT_SYMBOL(matroxfb_PLL_calcclock);
  650. #ifndef CONFIG_FB_MATROX_MULTIHEAD
  651. struct matrox_fb_info matroxfb_global_mxinfo;
  652. EXPORT_SYMBOL(matroxfb_global_mxinfo);
  653. #endif
  654. EXPORT_SYMBOL(matrox_text_loadfont); /* for matroxfb_accel */
  655. EXPORT_SYMBOL(matroxfb_createcursorshape); /* accel, DAC1064, Ti3026 */
  656. EXPORT_SYMBOL(matroxfb_fastfont_tryset); /* accel */
  657. EXPORT_SYMBOL(matroxfb_fastfont_init); /* DAC1064, Ti3026 */
  658. EXPORT_SYMBOL(matroxfb_vgaHWinit); /* DAC1064, Ti3026 */
  659. EXPORT_SYMBOL(matroxfb_vgaHWrestore); /* DAC1064, Ti3026 */
  661. MODULE_AUTHOR("(c) 1999-2001 Petr Vandrovec <vandrove@vc.cvut.cz>");
  662. MODULE_DESCRIPTION("Miscellaneous support for Matrox video cards");
  663. MODULE_LICENSE("GPL");