svgalib.c 19 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671
  1. /*
  2. * Common utility functions for VGA-based graphics cards.
  3. *
  4. * Copyright (c) 2006-2007 Ondrej Zajicek <santiago@crfreenet.org>
  5. *
  6. * This file is subject to the terms and conditions of the GNU General Public
  7. * License. See the file COPYING in the main directory of this archive for
  8. * more details.
  9. *
  10. * Some parts are based on David Boucher's viafb (http://davesdomain.org.uk/viafb/)
  11. */
  12. #include <linux/module.h>
  13. #include <linux/kernel.h>
  14. #include <linux/string.h>
  15. #include <linux/fb.h>
  16. #include <linux/svga.h>
  17. #include <asm/types.h>
  18. #include <asm/io.h>
  19. /* Write a CRT register value spread across multiple registers */
  20. void svga_wcrt_multi(const struct vga_regset *regset, u32 value) {
  21. u8 regval, bitval, bitnum;
  22. while (regset->regnum != VGA_REGSET_END_VAL) {
  23. regval = vga_rcrt(NULL, regset->regnum);
  24. bitnum = regset->lowbit;
  25. while (bitnum <= regset->highbit) {
  26. bitval = 1 << bitnum;
  27. regval = regval & ~bitval;
  28. if (value & 1) regval = regval | bitval;
  29. bitnum ++;
  30. value = value >> 1;
  31. }
  32. vga_wcrt(NULL, regset->regnum, regval);
  33. regset ++;
  34. }
  35. }
  36. /* Write a sequencer register value spread across multiple registers */
  37. void svga_wseq_multi(const struct vga_regset *regset, u32 value) {
  38. u8 regval, bitval, bitnum;
  39. while (regset->regnum != VGA_REGSET_END_VAL) {
  40. regval = vga_rseq(NULL, regset->regnum);
  41. bitnum = regset->lowbit;
  42. while (bitnum <= regset->highbit) {
  43. bitval = 1 << bitnum;
  44. regval = regval & ~bitval;
  45. if (value & 1) regval = regval | bitval;
  46. bitnum ++;
  47. value = value >> 1;
  48. }
  49. vga_wseq(NULL, regset->regnum, regval);
  50. regset ++;
  51. }
  52. }
  53. static unsigned int svga_regset_size(const struct vga_regset *regset)
  54. {
  55. u8 count = 0;
  56. while (regset->regnum != VGA_REGSET_END_VAL) {
  57. count += regset->highbit - regset->lowbit + 1;
  58. regset ++;
  59. }
  60. return 1 << count;
  61. }
  62. /* ------------------------------------------------------------------------- */
  63. /* Set graphics controller registers to sane values */
  64. void svga_set_default_gfx_regs(void)
  65. {
  66. /* All standard GFX registers (GR00 - GR08) */
  67. vga_wgfx(NULL, VGA_GFX_SR_VALUE, 0x00);
  68. vga_wgfx(NULL, VGA_GFX_SR_ENABLE, 0x00);
  69. vga_wgfx(NULL, VGA_GFX_COMPARE_VALUE, 0x00);
  70. vga_wgfx(NULL, VGA_GFX_DATA_ROTATE, 0x00);
  71. vga_wgfx(NULL, VGA_GFX_PLANE_READ, 0x00);
  72. vga_wgfx(NULL, VGA_GFX_MODE, 0x00);
  73. /* vga_wgfx(NULL, VGA_GFX_MODE, 0x20); */
  74. /* vga_wgfx(NULL, VGA_GFX_MODE, 0x40); */
  75. vga_wgfx(NULL, VGA_GFX_MISC, 0x05);
  76. /* vga_wgfx(NULL, VGA_GFX_MISC, 0x01); */
  77. vga_wgfx(NULL, VGA_GFX_COMPARE_MASK, 0x0F);
  78. vga_wgfx(NULL, VGA_GFX_BIT_MASK, 0xFF);
  79. }
  80. /* Set attribute controller registers to sane values */
  81. void svga_set_default_atc_regs(void)
  82. {
  83. u8 count;
  84. vga_r(NULL, 0x3DA);
  85. vga_w(NULL, VGA_ATT_W, 0x00);
  86. /* All standard ATC registers (AR00 - AR14) */
  87. for (count = 0; count <= 0xF; count ++)
  88. svga_wattr(count, count);
  89. svga_wattr(VGA_ATC_MODE, 0x01);
  90. /* svga_wattr(VGA_ATC_MODE, 0x41); */
  91. svga_wattr(VGA_ATC_OVERSCAN, 0x00);
  92. svga_wattr(VGA_ATC_PLANE_ENABLE, 0x0F);
  93. svga_wattr(VGA_ATC_PEL, 0x00);
  94. svga_wattr(VGA_ATC_COLOR_PAGE, 0x00);
  95. vga_r(NULL, 0x3DA);
  96. vga_w(NULL, VGA_ATT_W, 0x20);
  97. }
  98. /* Set sequencer registers to sane values */
  99. void svga_set_default_seq_regs(void)
  100. {
  101. /* Standard sequencer registers (SR01 - SR04), SR00 is not set */
  102. vga_wseq(NULL, VGA_SEQ_CLOCK_MODE, VGA_SR01_CHAR_CLK_8DOTS);
  103. vga_wseq(NULL, VGA_SEQ_PLANE_WRITE, VGA_SR02_ALL_PLANES);
  104. vga_wseq(NULL, VGA_SEQ_CHARACTER_MAP, 0x00);
  105. /* vga_wseq(NULL, VGA_SEQ_MEMORY_MODE, VGA_SR04_EXT_MEM | VGA_SR04_SEQ_MODE | VGA_SR04_CHN_4M); */
  106. vga_wseq(NULL, VGA_SEQ_MEMORY_MODE, VGA_SR04_EXT_MEM | VGA_SR04_SEQ_MODE);
  107. }
  108. /* Set CRTC registers to sane values */
  109. void svga_set_default_crt_regs(void)
  110. {
  111. /* Standard CRT registers CR03 CR08 CR09 CR14 CR17 */
  112. svga_wcrt_mask(0x03, 0x80, 0x80); /* Enable vertical retrace EVRA */
  113. vga_wcrt(NULL, VGA_CRTC_PRESET_ROW, 0);
  114. svga_wcrt_mask(VGA_CRTC_MAX_SCAN, 0, 0x1F);
  115. vga_wcrt(NULL, VGA_CRTC_UNDERLINE, 0);
  116. vga_wcrt(NULL, VGA_CRTC_MODE, 0xE3);
  117. }
  118. void svga_set_textmode_vga_regs(void)
  119. {
  120. /* svga_wseq_mask(0x1, 0x00, 0x01); */ /* Switch 8/9 pixel per char */
  121. vga_wseq(NULL, VGA_SEQ_MEMORY_MODE, VGA_SR04_EXT_MEM);
  122. vga_wseq(NULL, VGA_SEQ_PLANE_WRITE, 0x03);
  123. vga_wcrt(NULL, VGA_CRTC_MAX_SCAN, 0x0f); /* 0x4f */
  124. vga_wcrt(NULL, VGA_CRTC_UNDERLINE, 0x1f);
  125. svga_wcrt_mask(VGA_CRTC_MODE, 0x23, 0x7f);
  126. vga_wcrt(NULL, VGA_CRTC_CURSOR_START, 0x0d);
  127. vga_wcrt(NULL, VGA_CRTC_CURSOR_END, 0x0e);
  128. vga_wcrt(NULL, VGA_CRTC_CURSOR_HI, 0x00);
  129. vga_wcrt(NULL, VGA_CRTC_CURSOR_LO, 0x00);
  130. vga_wgfx(NULL, VGA_GFX_MODE, 0x10); /* Odd/even memory mode */
  131. vga_wgfx(NULL, VGA_GFX_MISC, 0x0E); /* Misc graphics register - text mode enable */
  132. vga_wgfx(NULL, VGA_GFX_COMPARE_MASK, 0x00);
  133. vga_r(NULL, 0x3DA);
  134. vga_w(NULL, VGA_ATT_W, 0x00);
  135. svga_wattr(0x10, 0x0C); /* Attribute Mode Control Register - text mode, blinking and line graphics */
  136. svga_wattr(0x13, 0x08); /* Horizontal Pixel Panning Register */
  137. vga_r(NULL, 0x3DA);
  138. vga_w(NULL, VGA_ATT_W, 0x20);
  139. }
  140. #if 0
  141. void svga_dump_var(struct fb_var_screeninfo *var, int node)
  142. {
  143. pr_debug("fb%d: var.vmode : 0x%X\n", node, var->vmode);
  144. pr_debug("fb%d: var.xres : %d\n", node, var->xres);
  145. pr_debug("fb%d: var.yres : %d\n", node, var->yres);
  146. pr_debug("fb%d: var.bits_per_pixel: %d\n", node, var->bits_per_pixel);
  147. pr_debug("fb%d: var.xres_virtual : %d\n", node, var->xres_virtual);
  148. pr_debug("fb%d: var.yres_virtual : %d\n", node, var->yres_virtual);
  149. pr_debug("fb%d: var.left_margin : %d\n", node, var->left_margin);
  150. pr_debug("fb%d: var.right_margin : %d\n", node, var->right_margin);
  151. pr_debug("fb%d: var.upper_margin : %d\n", node, var->upper_margin);
  152. pr_debug("fb%d: var.lower_margin : %d\n", node, var->lower_margin);
  153. pr_debug("fb%d: var.hsync_len : %d\n", node, var->hsync_len);
  154. pr_debug("fb%d: var.vsync_len : %d\n", node, var->vsync_len);
  155. pr_debug("fb%d: var.sync : 0x%X\n", node, var->sync);
  156. pr_debug("fb%d: var.pixclock : %d\n\n", node, var->pixclock);
  157. }
  158. #endif /* 0 */
  159. /* ------------------------------------------------------------------------- */
  160. void svga_settile(struct fb_info *info, struct fb_tilemap *map)
  161. {
  162. const u8 *font = map->data;
  163. u8 __iomem *fb = (u8 __iomem *)info->screen_base;
  164. int i, c;
  165. if ((map->width != 8) || (map->height != 16) ||
  166. (map->depth != 1) || (map->length != 256)) {
  167. printk(KERN_ERR "fb%d: unsupported font parameters: width %d, height %d, depth %d, length %d\n",
  168. info->node, map->width, map->height, map->depth, map->length);
  169. return;
  170. }
  171. fb += 2;
  172. for (c = 0; c < map->length; c++) {
  173. for (i = 0; i < map->height; i++) {
  174. fb_writeb(font[i], fb + i * 4);
  175. // fb[i * 4] = font[i];
  176. }
  177. fb += 128;
  178. font += map->height;
  179. }
  180. }
  181. /* Copy area in text (tileblit) mode */
  182. void svga_tilecopy(struct fb_info *info, struct fb_tilearea *area)
  183. {
  184. int dx, dy;
  185. /* colstride is halved in this function because u16 are used */
  186. int colstride = 1 << (info->fix.type_aux & FB_AUX_TEXT_SVGA_MASK);
  187. int rowstride = colstride * (info->var.xres_virtual / 8);
  188. u16 __iomem *fb = (u16 __iomem *) info->screen_base;
  189. u16 __iomem *src, *dst;
  190. if ((area->sy > area->dy) ||
  191. ((area->sy == area->dy) && (area->sx > area->dx))) {
  192. src = fb + area->sx * colstride + area->sy * rowstride;
  193. dst = fb + area->dx * colstride + area->dy * rowstride;
  194. } else {
  195. src = fb + (area->sx + area->width - 1) * colstride
  196. + (area->sy + area->height - 1) * rowstride;
  197. dst = fb + (area->dx + area->width - 1) * colstride
  198. + (area->dy + area->height - 1) * rowstride;
  199. colstride = -colstride;
  200. rowstride = -rowstride;
  201. }
  202. for (dy = 0; dy < area->height; dy++) {
  203. u16 __iomem *src2 = src;
  204. u16 __iomem *dst2 = dst;
  205. for (dx = 0; dx < area->width; dx++) {
  206. fb_writew(fb_readw(src2), dst2);
  207. // *dst2 = *src2;
  208. src2 += colstride;
  209. dst2 += colstride;
  210. }
  211. src += rowstride;
  212. dst += rowstride;
  213. }
  214. }
  215. /* Fill area in text (tileblit) mode */
  216. void svga_tilefill(struct fb_info *info, struct fb_tilerect *rect)
  217. {
  218. int dx, dy;
  219. int colstride = 2 << (info->fix.type_aux & FB_AUX_TEXT_SVGA_MASK);
  220. int rowstride = colstride * (info->var.xres_virtual / 8);
  221. int attr = (0x0F & rect->bg) << 4 | (0x0F & rect->fg);
  222. u8 __iomem *fb = (u8 __iomem *)info->screen_base;
  223. fb += rect->sx * colstride + rect->sy * rowstride;
  224. for (dy = 0; dy < rect->height; dy++) {
  225. u8 __iomem *fb2 = fb;
  226. for (dx = 0; dx < rect->width; dx++) {
  227. fb_writeb(rect->index, fb2);
  228. fb_writeb(attr, fb2 + 1);
  229. fb2 += colstride;
  230. }
  231. fb += rowstride;
  232. }
  233. }
  234. /* Write text in text (tileblit) mode */
  235. void svga_tileblit(struct fb_info *info, struct fb_tileblit *blit)
  236. {
  237. int dx, dy, i;
  238. int colstride = 2 << (info->fix.type_aux & FB_AUX_TEXT_SVGA_MASK);
  239. int rowstride = colstride * (info->var.xres_virtual / 8);
  240. int attr = (0x0F & blit->bg) << 4 | (0x0F & blit->fg);
  241. u8 __iomem *fb = (u8 __iomem *)info->screen_base;
  242. fb += blit->sx * colstride + blit->sy * rowstride;
  243. i=0;
  244. for (dy=0; dy < blit->height; dy ++) {
  245. u8 __iomem *fb2 = fb;
  246. for (dx = 0; dx < blit->width; dx ++) {
  247. fb_writeb(blit->indices[i], fb2);
  248. fb_writeb(attr, fb2 + 1);
  249. fb2 += colstride;
  250. i ++;
  251. if (i == blit->length) return;
  252. }
  253. fb += rowstride;
  254. }
  255. }
  256. /* Set cursor in text (tileblit) mode */
  257. void svga_tilecursor(struct fb_info *info, struct fb_tilecursor *cursor)
  258. {
  259. u8 cs = 0x0d;
  260. u8 ce = 0x0e;
  261. u16 pos = cursor->sx + (info->var.xoffset / 8)
  262. + (cursor->sy + (info->var.yoffset / 16))
  263. * (info->var.xres_virtual / 8);
  264. if (! cursor -> mode)
  265. return;
  266. svga_wcrt_mask(0x0A, 0x20, 0x20); /* disable cursor */
  267. if (cursor -> shape == FB_TILE_CURSOR_NONE)
  268. return;
  269. switch (cursor -> shape) {
  270. case FB_TILE_CURSOR_UNDERLINE:
  271. cs = 0x0d;
  272. break;
  273. case FB_TILE_CURSOR_LOWER_THIRD:
  274. cs = 0x09;
  275. break;
  276. case FB_TILE_CURSOR_LOWER_HALF:
  277. cs = 0x07;
  278. break;
  279. case FB_TILE_CURSOR_TWO_THIRDS:
  280. cs = 0x05;
  281. break;
  282. case FB_TILE_CURSOR_BLOCK:
  283. cs = 0x01;
  284. break;
  285. }
  286. /* set cursor position */
  287. vga_wcrt(NULL, 0x0E, pos >> 8);
  288. vga_wcrt(NULL, 0x0F, pos & 0xFF);
  289. vga_wcrt(NULL, 0x0B, ce); /* set cursor end */
  290. vga_wcrt(NULL, 0x0A, cs); /* set cursor start and enable it */
  291. }
  292. int svga_get_tilemax(struct fb_info *info)
  293. {
  294. return 256;
  295. }
  296. /* Get capabilities of accelerator based on the mode */
  297. void svga_get_caps(struct fb_info *info, struct fb_blit_caps *caps,
  298. struct fb_var_screeninfo *var)
  299. {
  300. if (var->bits_per_pixel == 0) {
  301. /* can only support 256 8x16 bitmap */
  302. caps->x = 1 << (8 - 1);
  303. caps->y = 1 << (16 - 1);
  304. caps->len = 256;
  305. } else {
  306. caps->x = (var->bits_per_pixel == 4) ? 1 << (8 - 1) : ~(u32)0;
  307. caps->y = ~(u32)0;
  308. caps->len = ~(u32)0;
  309. }
  310. }
  311. EXPORT_SYMBOL(svga_get_caps);
  312. /* ------------------------------------------------------------------------- */
  313. /*
  314. * Compute PLL settings (M, N, R)
  315. * F_VCO = (F_BASE * M) / N
  316. * F_OUT = F_VCO / (2^R)
  317. */
  318. static inline u32 abs_diff(u32 a, u32 b)
  319. {
  320. return (a > b) ? (a - b) : (b - a);
  321. }
  322. int svga_compute_pll(const struct svga_pll *pll, u32 f_wanted, u16 *m, u16 *n, u16 *r, int node)
  323. {
  324. u16 am, an, ar;
  325. u32 f_vco, f_current, delta_current, delta_best;
  326. pr_debug("fb%d: ideal frequency: %d kHz\n", node, (unsigned int) f_wanted);
  327. ar = pll->r_max;
  328. f_vco = f_wanted << ar;
  329. /* overflow check */
  330. if ((f_vco >> ar) != f_wanted)
  331. return -EINVAL;
  332. /* It is usually better to have greater VCO clock
  333. because of better frequency stability.
  334. So first try r_max, then r smaller. */
  335. while ((ar > pll->r_min) && (f_vco > pll->f_vco_max)) {
  336. ar--;
  337. f_vco = f_vco >> 1;
  338. }
  339. /* VCO bounds check */
  340. if ((f_vco < pll->f_vco_min) || (f_vco > pll->f_vco_max))
  341. return -EINVAL;
  342. delta_best = 0xFFFFFFFF;
  343. *m = 0;
  344. *n = 0;
  345. *r = ar;
  346. am = pll->m_min;
  347. an = pll->n_min;
  348. while ((am <= pll->m_max) && (an <= pll->n_max)) {
  349. f_current = (pll->f_base * am) / an;
  350. delta_current = abs_diff (f_current, f_vco);
  351. if (delta_current < delta_best) {
  352. delta_best = delta_current;
  353. *m = am;
  354. *n = an;
  355. }
  356. if (f_current <= f_vco) {
  357. am ++;
  358. } else {
  359. an ++;
  360. }
  361. }
  362. f_current = (pll->f_base * *m) / *n;
  363. pr_debug("fb%d: found frequency: %d kHz (VCO %d kHz)\n", node, (int) (f_current >> ar), (int) f_current);
  364. pr_debug("fb%d: m = %d n = %d r = %d\n", node, (unsigned int) *m, (unsigned int) *n, (unsigned int) *r);
  365. return 0;
  366. }
  367. /* ------------------------------------------------------------------------- */
  368. /* Check CRT timing values */
  369. int svga_check_timings(const struct svga_timing_regs *tm, struct fb_var_screeninfo *var, int node)
  370. {
  371. u32 value;
  372. var->xres = (var->xres+7)&~7;
  373. var->left_margin = (var->left_margin+7)&~7;
  374. var->right_margin = (var->right_margin+7)&~7;
  375. var->hsync_len = (var->hsync_len+7)&~7;
  376. /* Check horizontal total */
  377. value = var->xres + var->left_margin + var->right_margin + var->hsync_len;
  378. if (((value / 8) - 5) >= svga_regset_size (tm->h_total_regs))
  379. return -EINVAL;
  380. /* Check horizontal display and blank start */
  381. value = var->xres;
  382. if (((value / 8) - 1) >= svga_regset_size (tm->h_display_regs))
  383. return -EINVAL;
  384. if (((value / 8) - 1) >= svga_regset_size (tm->h_blank_start_regs))
  385. return -EINVAL;
  386. /* Check horizontal sync start */
  387. value = var->xres + var->right_margin;
  388. if (((value / 8) - 1) >= svga_regset_size (tm->h_sync_start_regs))
  389. return -EINVAL;
  390. /* Check horizontal blank end (or length) */
  391. value = var->left_margin + var->right_margin + var->hsync_len;
  392. if ((value == 0) || ((value / 8) >= svga_regset_size (tm->h_blank_end_regs)))
  393. return -EINVAL;
  394. /* Check horizontal sync end (or length) */
  395. value = var->hsync_len;
  396. if ((value == 0) || ((value / 8) >= svga_regset_size (tm->h_sync_end_regs)))
  397. return -EINVAL;
  398. /* Check vertical total */
  399. value = var->yres + var->upper_margin + var->lower_margin + var->vsync_len;
  400. if ((value - 1) >= svga_regset_size(tm->v_total_regs))
  401. return -EINVAL;
  402. /* Check vertical display and blank start */
  403. value = var->yres;
  404. if ((value - 1) >= svga_regset_size(tm->v_display_regs))
  405. return -EINVAL;
  406. if ((value - 1) >= svga_regset_size(tm->v_blank_start_regs))
  407. return -EINVAL;
  408. /* Check vertical sync start */
  409. value = var->yres + var->lower_margin;
  410. if ((value - 1) >= svga_regset_size(tm->v_sync_start_regs))
  411. return -EINVAL;
  412. /* Check vertical blank end (or length) */
  413. value = var->upper_margin + var->lower_margin + var->vsync_len;
  414. if ((value == 0) || (value >= svga_regset_size (tm->v_blank_end_regs)))
  415. return -EINVAL;
  416. /* Check vertical sync end (or length) */
  417. value = var->vsync_len;
  418. if ((value == 0) || (value >= svga_regset_size (tm->v_sync_end_regs)))
  419. return -EINVAL;
  420. return 0;
  421. }
  422. /* Set CRT timing registers */
  423. void svga_set_timings(const struct svga_timing_regs *tm, struct fb_var_screeninfo *var,
  424. u32 hmul, u32 hdiv, u32 vmul, u32 vdiv, u32 hborder, int node)
  425. {
  426. u8 regval;
  427. u32 value;
  428. value = var->xres + var->left_margin + var->right_margin + var->hsync_len;
  429. value = (value * hmul) / hdiv;
  430. pr_debug("fb%d: horizontal total : %d\n", node, value);
  431. svga_wcrt_multi(tm->h_total_regs, (value / 8) - 5);
  432. value = var->xres;
  433. value = (value * hmul) / hdiv;
  434. pr_debug("fb%d: horizontal display : %d\n", node, value);
  435. svga_wcrt_multi(tm->h_display_regs, (value / 8) - 1);
  436. value = var->xres;
  437. value = (value * hmul) / hdiv;
  438. pr_debug("fb%d: horizontal blank start: %d\n", node, value);
  439. svga_wcrt_multi(tm->h_blank_start_regs, (value / 8) - 1 + hborder);
  440. value = var->xres + var->left_margin + var->right_margin + var->hsync_len;
  441. value = (value * hmul) / hdiv;
  442. pr_debug("fb%d: horizontal blank end : %d\n", node, value);
  443. svga_wcrt_multi(tm->h_blank_end_regs, (value / 8) - 1 - hborder);
  444. value = var->xres + var->right_margin;
  445. value = (value * hmul) / hdiv;
  446. pr_debug("fb%d: horizontal sync start : %d\n", node, value);
  447. svga_wcrt_multi(tm->h_sync_start_regs, (value / 8));
  448. value = var->xres + var->right_margin + var->hsync_len;
  449. value = (value * hmul) / hdiv;
  450. pr_debug("fb%d: horizontal sync end : %d\n", node, value);
  451. svga_wcrt_multi(tm->h_sync_end_regs, (value / 8));
  452. value = var->yres + var->upper_margin + var->lower_margin + var->vsync_len;
  453. value = (value * vmul) / vdiv;
  454. pr_debug("fb%d: vertical total : %d\n", node, value);
  455. svga_wcrt_multi(tm->v_total_regs, value - 2);
  456. value = var->yres;
  457. value = (value * vmul) / vdiv;
  458. pr_debug("fb%d: vertical display : %d\n", node, value);
  459. svga_wcrt_multi(tm->v_display_regs, value - 1);
  460. value = var->yres;
  461. value = (value * vmul) / vdiv;
  462. pr_debug("fb%d: vertical blank start : %d\n", node, value);
  463. svga_wcrt_multi(tm->v_blank_start_regs, value);
  464. value = var->yres + var->upper_margin + var->lower_margin + var->vsync_len;
  465. value = (value * vmul) / vdiv;
  466. pr_debug("fb%d: vertical blank end : %d\n", node, value);
  467. svga_wcrt_multi(tm->v_blank_end_regs, value - 2);
  468. value = var->yres + var->lower_margin;
  469. value = (value * vmul) / vdiv;
  470. pr_debug("fb%d: vertical sync start : %d\n", node, value);
  471. svga_wcrt_multi(tm->v_sync_start_regs, value);
  472. value = var->yres + var->lower_margin + var->vsync_len;
  473. value = (value * vmul) / vdiv;
  474. pr_debug("fb%d: vertical sync end : %d\n", node, value);
  475. svga_wcrt_multi(tm->v_sync_end_regs, value);
  476. /* Set horizontal and vertical sync pulse polarity in misc register */
  477. regval = vga_r(NULL, VGA_MIS_R);
  478. if (var->sync & FB_SYNC_HOR_HIGH_ACT) {
  479. pr_debug("fb%d: positive horizontal sync\n", node);
  480. regval = regval & ~0x80;
  481. } else {
  482. pr_debug("fb%d: negative horizontal sync\n", node);
  483. regval = regval | 0x80;
  484. }
  485. if (var->sync & FB_SYNC_VERT_HIGH_ACT) {
  486. pr_debug("fb%d: positive vertical sync\n", node);
  487. regval = regval & ~0x40;
  488. } else {
  489. pr_debug("fb%d: negative vertical sync\n\n", node);
  490. regval = regval | 0x40;
  491. }
  492. vga_w(NULL, VGA_MIS_W, regval);
  493. }
  494. /* ------------------------------------------------------------------------- */
  495. static inline int match_format(const struct svga_fb_format *frm,
  496. struct fb_var_screeninfo *var)
  497. {
  498. int i = 0;
  499. int stored = -EINVAL;
  500. while (frm->bits_per_pixel != SVGA_FORMAT_END_VAL)
  501. {
  502. if ((var->bits_per_pixel == frm->bits_per_pixel) &&
  503. (var->red.length <= frm->red.length) &&
  504. (var->green.length <= frm->green.length) &&
  505. (var->blue.length <= frm->blue.length) &&
  506. (var->transp.length <= frm->transp.length) &&
  507. (var->nonstd == frm->nonstd))
  508. return i;
  509. if (var->bits_per_pixel == frm->bits_per_pixel)
  510. stored = i;
  511. i++;
  512. frm++;
  513. }
  514. return stored;
  515. }
  516. int svga_match_format(const struct svga_fb_format *frm,
  517. struct fb_var_screeninfo *var,
  518. struct fb_fix_screeninfo *fix)
  519. {
  520. int i = match_format(frm, var);
  521. if (i >= 0) {
  522. var->bits_per_pixel = frm[i].bits_per_pixel;
  523. var->red = frm[i].red;
  524. var->green = frm[i].green;
  525. var->blue = frm[i].blue;
  526. var->transp = frm[i].transp;
  527. var->nonstd = frm[i].nonstd;
  528. if (fix != NULL) {
  529. fix->type = frm[i].type;
  530. fix->type_aux = frm[i].type_aux;
  531. fix->visual = frm[i].visual;
  532. fix->xpanstep = frm[i].xpanstep;
  533. }
  534. }
  535. return i;
  536. }
  537. EXPORT_SYMBOL(svga_wcrt_multi);
  538. EXPORT_SYMBOL(svga_wseq_multi);
  539. EXPORT_SYMBOL(svga_set_default_gfx_regs);
  540. EXPORT_SYMBOL(svga_set_default_atc_regs);
  541. EXPORT_SYMBOL(svga_set_default_seq_regs);
  542. EXPORT_SYMBOL(svga_set_default_crt_regs);
  543. EXPORT_SYMBOL(svga_set_textmode_vga_regs);
  544. EXPORT_SYMBOL(svga_settile);
  545. EXPORT_SYMBOL(svga_tilecopy);
  546. EXPORT_SYMBOL(svga_tilefill);
  547. EXPORT_SYMBOL(svga_tileblit);
  548. EXPORT_SYMBOL(svga_tilecursor);
  549. EXPORT_SYMBOL(svga_get_tilemax);
  550. EXPORT_SYMBOL(svga_compute_pll);
  551. EXPORT_SYMBOL(svga_check_timings);
  552. EXPORT_SYMBOL(svga_set_timings);
  553. EXPORT_SYMBOL(svga_match_format);
  554. MODULE_AUTHOR("Ondrej Zajicek <santiago@crfreenet.org>");
  555. MODULE_DESCRIPTION("Common utility functions for VGA-based graphics cards");
  556. MODULE_LICENSE("GPL");