i810_dvt.c 11 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307
  1. /*-*- linux-c -*-
  2. * linux/drivers/video/i810_dvt.c -- Intel 810 Discrete Video Timings (Intel)
  3. *
  4. * Copyright (C) 2001 Antonino Daplas<adaplas@pol.net>
  5. * All Rights Reserved
  6. *
  7. *
  8. * This file is subject to the terms and conditions of the GNU General Public
  9. * License. See the file COPYING in the main directory of this archive for
  10. * more details.
  11. */
  12. #include <linux/kernel.h>
  13. #include "i810_regs.h"
  14. #include "i810.h"
  15. struct mode_registers std_modes[] = {
  16. /* 640x480 @ 60Hz */
  17. { 25000, 0x0013, 0x0003, 0x40, 0x5F, 0x4F, 0x50, 0x82, 0x51, 0x9D,
  18. 0x0B, 0x10, 0x40, 0xE9, 0x0B, 0xDF, 0x50, 0xE7, 0x04, 0x02,
  19. 0x01, 0x01, 0x01, 0x00, 0x01, 0x22002000, 0x22004000, 0x22006000,
  20. 0x22002000, 0x22004000, 0x22006000, 0xC0 },
  21. /* 640x480 @ 70Hz */
  22. { 28000, 0x0053, 0x0010, 0x40, 0x61, 0x4F, 0x4F, 0x85, 0x52, 0x9A,
  23. 0xF2, 0x10, 0x40, 0xE0, 0x03, 0xDF, 0x50, 0xDF, 0xF3, 0x01,
  24. 0x01, 0x01, 0x01, 0x00, 0x01, 0x22002000, 0x22004000, 0x22005000,
  25. 0x22002000, 0x22004000, 0x22005000, 0xC0 },
  26. /* 640x480 @ 72Hz */
  27. { 31000, 0x0013, 0x0002, 0x40, 0x63, 0x4F, 0x4F, 0x87, 0x52, 0x97,
  28. 0x06, 0x0F, 0x40, 0xE8, 0x0B, 0xDF, 0x50, 0xDF, 0x07, 0x02,
  29. 0x01, 0x01, 0x01, 0x00, 0x01, 0x22003000, 0x22005000, 0x22007000,
  30. 0x22003000, 0x22005000, 0x22007000, 0xC0 },
  31. /* 640x480 @ 75Hz */
  32. { 31000, 0x0013, 0x0002, 0x40, 0x64, 0x4F, 0x4F, 0x88, 0x51, 0x99,
  33. 0xF2, 0x10, 0x40, 0xE0, 0x03, 0xDF, 0x50, 0xDF, 0xF3, 0x01,
  34. 0x01, 0x01, 0x01, 0x00, 0x01, 0x22003000, 0x22005000, 0x22007000,
  35. 0x22003000, 0x22005000, 0x22007000, 0xC0 },
  36. /* 640x480 @ 85Hz */
  37. { 36000, 0x0010, 0x0001, 0x40, 0x63, 0x4F, 0x4F, 0x87, 0x56, 0x9D,
  38. 0xFB, 0x10, 0x40, 0xE0, 0x03, 0xDF, 0x50, 0xDF, 0xFC, 0x01,
  39. 0x01, 0x01, 0x01, 0x00, 0x01, 0x22003000, 0x22005000, 0x22107000,
  40. 0x22003000, 0x22005000, 0x22107000, 0xC0 },
  41. /* 800x600 @ 56Hz */
  42. { 36000, 0x0010, 0x0001, 0x40, 0x7B, 0x63, 0x63, 0x9F, 0x66, 0x8F,
  43. 0x6F, 0x10, 0x40, 0x58, 0x0A, 0x57, 0xC8, 0x57, 0x70, 0x02,
  44. 0x02, 0x02, 0x02, 0x00, 0x01, 0x22003000, 0x22005000, 0x22107000,
  45. 0x22003000, 0x22005000, 0x22107000, 0x00 },
  46. /* 800x600 @ 60Hz */
  47. { 40000, 0x0008, 0x0001, 0x30, 0x7F, 0x63, 0x63, 0x83, 0x68, 0x18,
  48. 0x72, 0x10, 0x40, 0x58, 0x0C, 0x57, 0xC8, 0x57, 0x73, 0x02,
  49. 0x02, 0x02, 0x02, 0x00, 0x00, 0x22003000, 0x22006000, 0x22108000,
  50. 0x22003000, 0x22006000, 0x22108000, 0x00 },
  51. /* 800x600 @ 70Hz */
  52. { 45000, 0x0054, 0x0015, 0x30, 0x7D, 0x63, 0x63, 0x81, 0x68, 0x12,
  53. 0x6f, 0x10, 0x40, 0x58, 0x0b, 0x57, 0x64, 0x57, 0x70, 0x02,
  54. 0x02, 0x02, 0x02, 0x00, 0x00, 0x22004000, 0x22007000, 0x2210A000,
  55. 0x22004000, 0x22007000, 0x2210A000, 0x00 },
  56. /* 800x600 @ 72Hz */
  57. { 50000, 0x0017, 0x0004, 0x30, 0x7D, 0x63, 0x63, 0x81, 0x6A, 0x19,
  58. 0x98, 0x10, 0x40, 0x7C, 0x02, 0x57, 0xC8, 0x57, 0x99, 0x02,
  59. 0x02, 0x02, 0x02, 0x00, 0x00, 0x22004000, 0x22007000, 0x2210A000,
  60. 0x22004000, 0x22007000, 0x2210A000, 0x00 },
  61. /* 800x600 @ 75Hz */
  62. { 49000, 0x001F, 0x0006, 0x30, 0x7F, 0x63, 0x63, 0x83, 0x65, 0x0F,
  63. 0x6F, 0x10, 0x40, 0x58, 0x0B, 0x57, 0xC8, 0x57, 0x70, 0x02,
  64. 0x02, 0x02, 0x02, 0x00, 0x00, 0x22004000, 0x22007000, 0x2210B000,
  65. 0x22004000, 0x22007000, 0x2210B000, 0x00 },
  66. /* 800x600 @ 85Hz */
  67. { 56000, 0x0049, 0x000E, 0x30, 0x7E, 0x63, 0x63, 0x82, 0x67, 0x0F,
  68. 0x75, 0x10, 0x40, 0x58, 0x0B, 0x57, 0xC8, 0x57, 0x76, 0x02,
  69. 0x02, 0x02, 0x02, 0x00, 0x00, 0x22004000, 0x22108000, 0x2210b000,
  70. 0x22004000, 0x22108000, 0x2210b000, 0x00 },
  71. /* 1024x768 @ 60Hz */
  72. { 65000, 0x003F, 0x000A, 0x30, 0xA3, 0x7F, 0x7F, 0x87, 0x83, 0x94,
  73. 0x24, 0x10, 0x40, 0x02, 0x08, 0xFF, 0x80, 0xFF, 0x25, 0x03,
  74. 0x02, 0x03, 0x02, 0x00, 0x00, 0x22005000, 0x22109000, 0x2220D000,
  75. 0x22005000, 0x22109000, 0x2220D000, 0xC0 },
  76. /* 1024x768 @ 70Hz */
  77. { 75000, 0x0017, 0x0002, 0x30, 0xA1, 0x7F, 0x7F, 0x85, 0x82, 0x93,
  78. 0x24, 0x10, 0x40, 0x02, 0x08, 0xFF, 0x80, 0xFF, 0x25, 0x03,
  79. 0x02, 0x03, 0x02, 0x00, 0x00, 0x22005000, 0x2210A000, 0x2220F000,
  80. 0x22005000, 0x2210A000, 0x2220F000, 0xC0 },
  81. /* 1024x768 @ 75Hz */
  82. { 78000, 0x0050, 0x0017, 0x20, 0x9F, 0x7F, 0x7F, 0x83, 0x81, 0x8D,
  83. 0x1E, 0x10, 0x40, 0x00, 0x03, 0xFF, 0x80, 0xFF, 0x1F, 0x03,
  84. 0x02, 0x03, 0x02, 0x00, 0x00, 0x22006000, 0x2210B000, 0x22210000,
  85. 0x22006000, 0x2210B000, 0x22210000, 0x00 },
  86. /* 1024x768 @ 85Hz */
  87. { 94000, 0x003D, 0x000E, 0x20, 0xA7, 0x7F, 0x7F, 0x8B, 0x85, 0x91,
  88. 0x26, 0x10, 0x40, 0x00, 0x03, 0xFF, 0x80, 0xFF, 0x27, 0x03,
  89. 0x02, 0x03, 0x02, 0x00, 0x00, 0x22007000, 0x2220E000, 0x22212000,
  90. 0x22007000, 0x2220E000, 0x22212000, 0x00 },
  91. /* 1152x864 @ 60Hz */
  92. { 80000, 0x0008, 0x0001, 0x20, 0xB3, 0x8F, 0x8F, 0x97, 0x93, 0x9f,
  93. 0x87, 0x10, 0x40, 0x60, 0x03, 0x5F, 0x90, 0x5f, 0x88, 0x03,
  94. 0x03, 0x03, 0x03, 0x00, 0x00, 0x2220C000, 0x22210000, 0x22415000,
  95. 0x2220C000, 0x22210000, 0x22415000, 0x00 },
  96. /* 1152x864 @ 70Hz */
  97. { 96000, 0x000a, 0x0001, 0x20, 0xbb, 0x8F, 0x8F, 0x9f, 0x98, 0x87,
  98. 0x82, 0x10, 0x40, 0x60, 0x03, 0x5F, 0x90, 0x5F, 0x83, 0x03,
  99. 0x03, 0x03, 0x03, 0x00, 0x00, 0x22107000, 0x22210000, 0x22415000,
  100. 0x22107000, 0x22210000, 0x22415000, 0x00 },
  101. /* 1152x864 @ 72Hz */
  102. { 99000, 0x001f, 0x0006, 0x20, 0xbb, 0x8F, 0x8F, 0x9f, 0x98, 0x87,
  103. 0x83, 0x10, 0x40, 0x60, 0x03, 0x5F, 0x90, 0x5F, 0x84, 0x03,
  104. 0x03, 0x03, 0x03, 0x00, 0x00, 0x22107000, 0x22210000, 0x22415000,
  105. 0x22107000, 0x22210000, 0x22415000, 0x00 },
  106. /* 1152x864 @ 75Hz */
  107. { 108000, 0x0010, 0x0002, 0x20, 0xC3, 0x8F, 0x8F, 0x87, 0x97, 0x07,
  108. 0x82, 0x10, 0x40, 0x60, 0x03, 0x5F, 0x90, 0x5F, 0x83, 0x03,
  109. 0x03, 0x03, 0x03, 0x00, 0x01, 0x22107000, 0x22210000, 0x22415000,
  110. 0x22107000, 0x22210000, 0x22415000, 0x00 },
  111. /* 1152x864 @ 85Hz */
  112. { 121000, 0x006D, 0x0014, 0x20, 0xc0, 0x8F, 0x8F, 0x84, 0x97, 0x07,
  113. 0x93, 0x10, 0x40, 0x60, 0x03, 0x5F, 0x90, 0x5F, 0x94, 0x03,
  114. 0x03, 0x03, 0x03, 0x00, 0x01, 0x2220C000, 0x22210000, 0x22415000,
  115. 0x2220C000, 0x22210000, 0x22415000, 0x0 },
  116. /* 1280x960 @ 60Hz */
  117. { 108000, 0x0010, 0x0002, 0x20, 0xDC, 0x9F, 0x9F, 0x80, 0xAB, 0x99,
  118. 0xE6, 0x10, 0x40, 0xC0, 0x03, 0xBF, 0xA0, 0xBF, 0xE7, 0x03,
  119. 0x03, 0x03, 0x03, 0x00, 0x01, 0x2210A000, 0x22210000, 0x22415000,
  120. 0x2210A000, 0x22210000, 0x22415000, 0x00 },
  121. /* 1280x960 @ 75Hz */
  122. { 129000, 0x0029, 0x0006, 0x20, 0xD3, 0x9F, 0x9F, 0x97, 0xaa, 0x1b,
  123. 0xE8, 0x10, 0x40, 0xC0, 0x03, 0xBF, 0xA0, 0xBF, 0xE9, 0x03,
  124. 0x03, 0x03, 0x03, 0x00, 0x01, 0x2210A000, 0x22210000, 0x2241B000,
  125. 0x2210A000, 0x22210000, 0x2241B000, 0x00 },
  126. /* 1280x960 @ 85Hz */
  127. { 148000, 0x0042, 0x0009, 0x20, 0xD3, 0x9F, 0x9F, 0x97, 0xA7, 0x1B,
  128. 0xF1, 0x10, 0x40, 0xC0, 0x03, 0xBF, 0xA0, 0xBF, 0xF2, 0x03,
  129. 0x03, 0x03, 0x03, 0x00, 0x01, 0x2210A000, 0x22220000, 0x2241D000,
  130. 0x2210A000, 0x22220000, 0x2241D000, 0x00 },
  131. /* 1600x1200 @ 60Hz */
  132. { 162000, 0x0019, 0x0006, 0x10, 0x09, 0xC7, 0xC7, 0x8D, 0xcf, 0x07,
  133. 0xE0, 0x10, 0x40, 0xB0, 0x03, 0xAF, 0xC8, 0xAF, 0xE1, 0x04,
  134. 0x04, 0x04, 0x04, 0x01, 0x00, 0x2210b000, 0x22416000, 0x44419000,
  135. 0x2210b000, 0x22416000, 0x44419000, 0x00 },
  136. /* 1600x1200 @ 65 Hz */
  137. { 175000, 0x005d, 0x0018, 0x10, 0x09, 0xC7, 0xC7, 0x8D, 0xcf, 0x07,
  138. 0xE0, 0x10, 0x40, 0xB0, 0x03, 0xAF, 0xC8, 0xAF, 0xE1, 0x04,
  139. 0x04, 0x04, 0x04, 0x01, 0x00, 0x2210c000, 0x22416000, 0x44419000,
  140. 0x2210c000, 0x22416000, 0x44419000, 0x00 },
  141. /* 1600x1200 @ 70 Hz */
  142. { 189000, 0x003D, 0x000e, 0x10, 0x09, 0xC7, 0xC7, 0x8d, 0xcf, 0x07,
  143. 0xE0, 0x10, 0x40, 0xb0, 0x03, 0xAF, 0xC8, 0xaf, 0xE1, 0x04,
  144. 0x04, 0x04, 0x04, 0x01, 0x00, 0x2220e000, 0x22416000, 0x44419000,
  145. 0x2220e000, 0x22416000, 0x44419000, 0x00 },
  146. /* 1600x1200 @ 72 Hz */
  147. { 195000, 0x003f, 0x000e, 0x10, 0x0b, 0xC7, 0xC7, 0x8f, 0xd5, 0x0b,
  148. 0xE1, 0x10, 0x40, 0xb0, 0x03, 0xAF, 0xC8, 0xaf, 0xe2, 0x04, 0x04,
  149. 0x04, 0x04, 0x01, 0x00, 0x2220e000, 0x22416000, 0x44419000,
  150. 0x2220e000, 0x22416000, 0x44419000, 0x00 },
  151. /* 1600x1200 @ 75 Hz */
  152. { 202000, 0x0024, 0x0007, 0x10, 0x09, 0xC7, 0xC7, 0x8d, 0xcf, 0x07,
  153. 0xE0, 0x10, 0x40, 0xb0, 0x03, 0xAF, 0xC8, 0xaf, 0xE1, 0x04, 0x04,
  154. 0x04, 0x04, 0x01, 0x00, 0x2220e000, 0x22416000, 0x44419000,
  155. 0x2220e000, 0x22416000, 0x44419000, 0x00 },
  156. /* 1600x1200 @ 85 Hz */
  157. { 229000, 0x0029, 0x0007, 0x10, 0x09, 0xC7, 0xC7, 0x8d, 0xcf, 0x07,
  158. 0xE0, 0x10, 0x40, 0xb0, 0x03, 0xAF, 0xC8, 0xaf, 0xE1, 0x04, 0x04,
  159. 0x04, 0x04, 0x01, 0x00, 0x22210000, 0x22416000, 0x0,
  160. 0x22210000, 0x22416000, 0x0, 0x00 },
  161. };
  162. void round_off_xres(u32 *xres)
  163. {
  164. if (*xres <= 640)
  165. *xres = 640;
  166. else if (*xres <= 800)
  167. *xres = 800;
  168. else if (*xres <= 1024)
  169. *xres = 1024;
  170. else if (*xres <= 1152)
  171. *xres = 1152;
  172. else if (*xres <= 1280)
  173. *xres = 1280;
  174. else
  175. *xres = 1600;
  176. }
  177. inline void round_off_yres(u32 *xres, u32 *yres)
  178. {
  179. *yres = (*xres * 3) >> 2;
  180. }
  181. void i810fb_encode_registers(const struct fb_var_screeninfo *var,
  182. struct i810fb_par *par, u32 xres, u32 yres)
  183. {
  184. u32 diff = 0, diff_best = 0xFFFFFFFF, i = 0, i_best = 0;
  185. u8 hfl;
  186. hfl = (u8) ((xres >> 3) - 1);
  187. for (i = 0; i < ARRAY_SIZE(std_modes); i++) {
  188. if (std_modes[i].cr01 == hfl) {
  189. if (std_modes[i].pixclock <= par->regs.pixclock)
  190. diff = par->regs.pixclock -
  191. std_modes[i].pixclock;
  192. if (diff < diff_best) {
  193. i_best = i;
  194. diff_best = diff;
  195. }
  196. }
  197. }
  198. par->regs = std_modes[i_best];
  199. /* overlay */
  200. par->ovract = ((xres + var->right_margin + var->hsync_len +
  201. var->left_margin - 32) | ((xres - 32) << 16));
  202. }
  203. void i810fb_fill_var_timings(struct fb_var_screeninfo *var)
  204. {
  205. struct i810fb_par par;
  206. u32 total, xres, yres;
  207. xres = var->xres;
  208. yres = var->yres;
  209. par.regs.pixclock = 1000000000/var->pixclock;
  210. i810fb_encode_registers(var, &par, xres, yres);
  211. total = ((par.regs.cr00 | (par.regs.cr35 & 1) << 8) + 3) << 3;
  212. var->pixclock = 1000000000/par.regs.pixclock;
  213. var->right_margin = (par.regs.cr04 << 3) - xres;
  214. var->hsync_len = ((par.regs.cr05 & 0x1F) -
  215. (par.regs.cr04 & 0x1F)) << 3;
  216. var->left_margin = (total - (xres + var->right_margin +
  217. var->hsync_len));
  218. var->sync = FB_SYNC_ON_GREEN;
  219. if (~(par.regs.msr & (1 << 6)))
  220. var->sync |= FB_SYNC_HOR_HIGH_ACT;
  221. if (~(par.regs.msr & (1 << 7)))
  222. var->sync |= FB_SYNC_VERT_HIGH_ACT;
  223. total = ((par.regs.cr06 | (par.regs.cr30 & 0x0F) << 8)) + 2;
  224. var->lower_margin = (par.regs.cr10 |
  225. (par.regs.cr32 & 0x0F) << 8) - yres;
  226. var->vsync_len = (par.regs.cr11 & 0x0F) - (var->lower_margin & 0x0F);
  227. var->upper_margin = total - (yres + var->lower_margin +
  228. var->vsync_len);
  229. }
  230. u32 i810_get_watermark(struct fb_var_screeninfo *var,
  231. struct i810fb_par *par)
  232. {
  233. struct mode_registers *params = &par->regs;
  234. u32 wmark = 0;
  235. if (par->mem_freq == 100) {
  236. switch (var->bits_per_pixel) {
  237. case 8:
  238. wmark = params->bpp8_100;
  239. break;
  240. case 16:
  241. wmark = params->bpp16_100;
  242. break;
  243. case 24:
  244. case 32:
  245. wmark = params->bpp24_100;
  246. }
  247. } else {
  248. switch (var->bits_per_pixel) {
  249. case 8:
  250. wmark = params->bpp8_133;
  251. break;
  252. case 16:
  253. wmark = params->bpp16_133;
  254. break;
  255. case 24:
  256. case 32:
  257. wmark = params->bpp24_133;
  258. }
  259. }
  260. return wmark;
  261. }