fbmon.c 37 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499
  1. /*
  2. * linux/drivers/video/fbmon.c
  3. *
  4. * Copyright (C) 2002 James Simmons <jsimmons@users.sf.net>
  5. *
  6. * Credits:
  7. *
  8. * The EDID Parser is a conglomeration from the following sources:
  9. *
  10. * 1. SciTech SNAP Graphics Architecture
  11. * Copyright (C) 1991-2002 SciTech Software, Inc. All rights reserved.
  12. *
  13. * 2. XFree86 4.3.0, interpret_edid.c
  14. * Copyright 1998 by Egbert Eich <Egbert.Eich@Physik.TU-Darmstadt.DE>
  15. *
  16. * 3. John Fremlin <vii@users.sourceforge.net> and
  17. * Ani Joshi <ajoshi@unixbox.com>
  18. *
  19. * Generalized Timing Formula is derived from:
  20. *
  21. * GTF Spreadsheet by Andy Morrish (1/5/97)
  22. * available at http://www.vesa.org
  23. *
  24. * This file is subject to the terms and conditions of the GNU General Public
  25. * License. See the file COPYING in the main directory of this archive
  26. * for more details.
  27. *
  28. */
  29. #include <linux/fb.h>
  30. #include <linux/module.h>
  31. #include <linux/pci.h>
  32. #include <linux/slab.h>
  33. #include <video/edid.h>
  34. #ifdef CONFIG_PPC_OF
  35. #include <asm/prom.h>
  36. #include <asm/pci-bridge.h>
  37. #endif
  38. #include "edid.h"
  39. /*
  40. * EDID parser
  41. */
  42. #undef DEBUG /* define this for verbose EDID parsing output */
  43. #ifdef DEBUG
  44. #define DPRINTK(fmt, args...) printk(fmt,## args)
  45. #else
  46. #define DPRINTK(fmt, args...)
  47. #endif
  48. #define FBMON_FIX_HEADER 1
  49. #define FBMON_FIX_INPUT 2
  50. #define FBMON_FIX_TIMINGS 3
  51. #ifdef CONFIG_FB_MODE_HELPERS
  52. struct broken_edid {
  53. u8 manufacturer[4];
  54. u32 model;
  55. u32 fix;
  56. };
  57. static const struct broken_edid brokendb[] = {
  58. /* DEC FR-PCXAV-YZ */
  59. {
  60. .manufacturer = "DEC",
  61. .model = 0x073a,
  62. .fix = FBMON_FIX_HEADER,
  63. },
  64. /* ViewSonic PF775a */
  65. {
  66. .manufacturer = "VSC",
  67. .model = 0x5a44,
  68. .fix = FBMON_FIX_INPUT,
  69. },
  70. /* Sharp UXGA? */
  71. {
  72. .manufacturer = "SHP",
  73. .model = 0x138e,
  74. .fix = FBMON_FIX_TIMINGS,
  75. },
  76. };
  77. static const unsigned char edid_v1_header[] = { 0x00, 0xff, 0xff, 0xff,
  78. 0xff, 0xff, 0xff, 0x00
  79. };
  80. static void copy_string(unsigned char *c, unsigned char *s)
  81. {
  82. int i;
  83. c = c + 5;
  84. for (i = 0; (i < 13 && *c != 0x0A); i++)
  85. *(s++) = *(c++);
  86. *s = 0;
  87. while (i-- && (*--s == 0x20)) *s = 0;
  88. }
  89. static int edid_is_serial_block(unsigned char *block)
  90. {
  91. if ((block[0] == 0x00) && (block[1] == 0x00) &&
  92. (block[2] == 0x00) && (block[3] == 0xff) &&
  93. (block[4] == 0x00))
  94. return 1;
  95. else
  96. return 0;
  97. }
  98. static int edid_is_ascii_block(unsigned char *block)
  99. {
  100. if ((block[0] == 0x00) && (block[1] == 0x00) &&
  101. (block[2] == 0x00) && (block[3] == 0xfe) &&
  102. (block[4] == 0x00))
  103. return 1;
  104. else
  105. return 0;
  106. }
  107. static int edid_is_limits_block(unsigned char *block)
  108. {
  109. if ((block[0] == 0x00) && (block[1] == 0x00) &&
  110. (block[2] == 0x00) && (block[3] == 0xfd) &&
  111. (block[4] == 0x00))
  112. return 1;
  113. else
  114. return 0;
  115. }
  116. static int edid_is_monitor_block(unsigned char *block)
  117. {
  118. if ((block[0] == 0x00) && (block[1] == 0x00) &&
  119. (block[2] == 0x00) && (block[3] == 0xfc) &&
  120. (block[4] == 0x00))
  121. return 1;
  122. else
  123. return 0;
  124. }
  125. static int edid_is_timing_block(unsigned char *block)
  126. {
  127. if ((block[0] != 0x00) || (block[1] != 0x00) ||
  128. (block[2] != 0x00) || (block[4] != 0x00))
  129. return 1;
  130. else
  131. return 0;
  132. }
  133. static int check_edid(unsigned char *edid)
  134. {
  135. unsigned char *block = edid + ID_MANUFACTURER_NAME, manufacturer[4];
  136. unsigned char *b;
  137. u32 model;
  138. int i, fix = 0, ret = 0;
  139. manufacturer[0] = ((block[0] & 0x7c) >> 2) + '@';
  140. manufacturer[1] = ((block[0] & 0x03) << 3) +
  141. ((block[1] & 0xe0) >> 5) + '@';
  142. manufacturer[2] = (block[1] & 0x1f) + '@';
  143. manufacturer[3] = 0;
  144. model = block[2] + (block[3] << 8);
  145. for (i = 0; i < ARRAY_SIZE(brokendb); i++) {
  146. if (!strncmp(manufacturer, brokendb[i].manufacturer, 4) &&
  147. brokendb[i].model == model) {
  148. fix = brokendb[i].fix;
  149. break;
  150. }
  151. }
  152. switch (fix) {
  153. case FBMON_FIX_HEADER:
  154. for (i = 0; i < 8; i++) {
  155. if (edid[i] != edid_v1_header[i]) {
  156. ret = fix;
  157. break;
  158. }
  159. }
  160. break;
  161. case FBMON_FIX_INPUT:
  162. b = edid + EDID_STRUCT_DISPLAY;
  163. /* Only if display is GTF capable will
  164. the input type be reset to analog */
  165. if (b[4] & 0x01 && b[0] & 0x80)
  166. ret = fix;
  167. break;
  168. case FBMON_FIX_TIMINGS:
  169. b = edid + DETAILED_TIMING_DESCRIPTIONS_START;
  170. ret = fix;
  171. for (i = 0; i < 4; i++) {
  172. if (edid_is_limits_block(b)) {
  173. ret = 0;
  174. break;
  175. }
  176. b += DETAILED_TIMING_DESCRIPTION_SIZE;
  177. }
  178. break;
  179. }
  180. if (ret)
  181. printk("fbmon: The EDID Block of "
  182. "Manufacturer: %s Model: 0x%x is known to "
  183. "be broken,\n", manufacturer, model);
  184. return ret;
  185. }
  186. static void fix_edid(unsigned char *edid, int fix)
  187. {
  188. int i;
  189. unsigned char *b, csum = 0;
  190. switch (fix) {
  191. case FBMON_FIX_HEADER:
  192. printk("fbmon: trying a header reconstruct\n");
  193. memcpy(edid, edid_v1_header, 8);
  194. break;
  195. case FBMON_FIX_INPUT:
  196. printk("fbmon: trying to fix input type\n");
  197. b = edid + EDID_STRUCT_DISPLAY;
  198. b[0] &= ~0x80;
  199. edid[127] += 0x80;
  200. break;
  201. case FBMON_FIX_TIMINGS:
  202. printk("fbmon: trying to fix monitor timings\n");
  203. b = edid + DETAILED_TIMING_DESCRIPTIONS_START;
  204. for (i = 0; i < 4; i++) {
  205. if (!(edid_is_serial_block(b) ||
  206. edid_is_ascii_block(b) ||
  207. edid_is_monitor_block(b) ||
  208. edid_is_timing_block(b))) {
  209. b[0] = 0x00;
  210. b[1] = 0x00;
  211. b[2] = 0x00;
  212. b[3] = 0xfd;
  213. b[4] = 0x00;
  214. b[5] = 60; /* vfmin */
  215. b[6] = 60; /* vfmax */
  216. b[7] = 30; /* hfmin */
  217. b[8] = 75; /* hfmax */
  218. b[9] = 17; /* pixclock - 170 MHz*/
  219. b[10] = 0; /* GTF */
  220. break;
  221. }
  222. b += DETAILED_TIMING_DESCRIPTION_SIZE;
  223. }
  224. for (i = 0; i < EDID_LENGTH - 1; i++)
  225. csum += edid[i];
  226. edid[127] = 256 - csum;
  227. break;
  228. }
  229. }
  230. static int edid_checksum(unsigned char *edid)
  231. {
  232. unsigned char csum = 0, all_null = 0;
  233. int i, err = 0, fix = check_edid(edid);
  234. if (fix)
  235. fix_edid(edid, fix);
  236. for (i = 0; i < EDID_LENGTH; i++) {
  237. csum += edid[i];
  238. all_null |= edid[i];
  239. }
  240. if (csum == 0x00 && all_null) {
  241. /* checksum passed, everything's good */
  242. err = 1;
  243. }
  244. return err;
  245. }
  246. static int edid_check_header(unsigned char *edid)
  247. {
  248. int i, err = 1, fix = check_edid(edid);
  249. if (fix)
  250. fix_edid(edid, fix);
  251. for (i = 0; i < 8; i++) {
  252. if (edid[i] != edid_v1_header[i])
  253. err = 0;
  254. }
  255. return err;
  256. }
  257. static void parse_vendor_block(unsigned char *block, struct fb_monspecs *specs)
  258. {
  259. specs->manufacturer[0] = ((block[0] & 0x7c) >> 2) + '@';
  260. specs->manufacturer[1] = ((block[0] & 0x03) << 3) +
  261. ((block[1] & 0xe0) >> 5) + '@';
  262. specs->manufacturer[2] = (block[1] & 0x1f) + '@';
  263. specs->manufacturer[3] = 0;
  264. specs->model = block[2] + (block[3] << 8);
  265. specs->serial = block[4] + (block[5] << 8) +
  266. (block[6] << 16) + (block[7] << 24);
  267. specs->year = block[9] + 1990;
  268. specs->week = block[8];
  269. DPRINTK(" Manufacturer: %s\n", specs->manufacturer);
  270. DPRINTK(" Model: %x\n", specs->model);
  271. DPRINTK(" Serial#: %u\n", specs->serial);
  272. DPRINTK(" Year: %u Week %u\n", specs->year, specs->week);
  273. }
  274. static void get_dpms_capabilities(unsigned char flags,
  275. struct fb_monspecs *specs)
  276. {
  277. specs->dpms = 0;
  278. if (flags & DPMS_ACTIVE_OFF)
  279. specs->dpms |= FB_DPMS_ACTIVE_OFF;
  280. if (flags & DPMS_SUSPEND)
  281. specs->dpms |= FB_DPMS_SUSPEND;
  282. if (flags & DPMS_STANDBY)
  283. specs->dpms |= FB_DPMS_STANDBY;
  284. DPRINTK(" DPMS: Active %s, Suspend %s, Standby %s\n",
  285. (flags & DPMS_ACTIVE_OFF) ? "yes" : "no",
  286. (flags & DPMS_SUSPEND) ? "yes" : "no",
  287. (flags & DPMS_STANDBY) ? "yes" : "no");
  288. }
  289. static void get_chroma(unsigned char *block, struct fb_monspecs *specs)
  290. {
  291. int tmp;
  292. DPRINTK(" Chroma\n");
  293. /* Chromaticity data */
  294. tmp = ((block[5] & (3 << 6)) >> 6) | (block[0x7] << 2);
  295. tmp *= 1000;
  296. tmp += 512;
  297. specs->chroma.redx = tmp/1024;
  298. DPRINTK(" RedX: 0.%03d ", specs->chroma.redx);
  299. tmp = ((block[5] & (3 << 4)) >> 4) | (block[0x8] << 2);
  300. tmp *= 1000;
  301. tmp += 512;
  302. specs->chroma.redy = tmp/1024;
  303. DPRINTK("RedY: 0.%03d\n", specs->chroma.redy);
  304. tmp = ((block[5] & (3 << 2)) >> 2) | (block[0x9] << 2);
  305. tmp *= 1000;
  306. tmp += 512;
  307. specs->chroma.greenx = tmp/1024;
  308. DPRINTK(" GreenX: 0.%03d ", specs->chroma.greenx);
  309. tmp = (block[5] & 3) | (block[0xa] << 2);
  310. tmp *= 1000;
  311. tmp += 512;
  312. specs->chroma.greeny = tmp/1024;
  313. DPRINTK("GreenY: 0.%03d\n", specs->chroma.greeny);
  314. tmp = ((block[6] & (3 << 6)) >> 6) | (block[0xb] << 2);
  315. tmp *= 1000;
  316. tmp += 512;
  317. specs->chroma.bluex = tmp/1024;
  318. DPRINTK(" BlueX: 0.%03d ", specs->chroma.bluex);
  319. tmp = ((block[6] & (3 << 4)) >> 4) | (block[0xc] << 2);
  320. tmp *= 1000;
  321. tmp += 512;
  322. specs->chroma.bluey = tmp/1024;
  323. DPRINTK("BlueY: 0.%03d\n", specs->chroma.bluey);
  324. tmp = ((block[6] & (3 << 2)) >> 2) | (block[0xd] << 2);
  325. tmp *= 1000;
  326. tmp += 512;
  327. specs->chroma.whitex = tmp/1024;
  328. DPRINTK(" WhiteX: 0.%03d ", specs->chroma.whitex);
  329. tmp = (block[6] & 3) | (block[0xe] << 2);
  330. tmp *= 1000;
  331. tmp += 512;
  332. specs->chroma.whitey = tmp/1024;
  333. DPRINTK("WhiteY: 0.%03d\n", specs->chroma.whitey);
  334. }
  335. static void calc_mode_timings(int xres, int yres, int refresh,
  336. struct fb_videomode *mode)
  337. {
  338. struct fb_var_screeninfo *var;
  339. var = kzalloc(sizeof(struct fb_var_screeninfo), GFP_KERNEL);
  340. if (var) {
  341. var->xres = xres;
  342. var->yres = yres;
  343. fb_get_mode(FB_VSYNCTIMINGS | FB_IGNOREMON,
  344. refresh, var, NULL);
  345. mode->xres = xres;
  346. mode->yres = yres;
  347. mode->pixclock = var->pixclock;
  348. mode->refresh = refresh;
  349. mode->left_margin = var->left_margin;
  350. mode->right_margin = var->right_margin;
  351. mode->upper_margin = var->upper_margin;
  352. mode->lower_margin = var->lower_margin;
  353. mode->hsync_len = var->hsync_len;
  354. mode->vsync_len = var->vsync_len;
  355. mode->vmode = 0;
  356. mode->sync = 0;
  357. kfree(var);
  358. }
  359. }
  360. static int get_est_timing(unsigned char *block, struct fb_videomode *mode)
  361. {
  362. int num = 0;
  363. unsigned char c;
  364. c = block[0];
  365. if (c&0x80) {
  366. calc_mode_timings(720, 400, 70, &mode[num]);
  367. mode[num++].flag = FB_MODE_IS_CALCULATED;
  368. DPRINTK(" 720x400@70Hz\n");
  369. }
  370. if (c&0x40) {
  371. calc_mode_timings(720, 400, 88, &mode[num]);
  372. mode[num++].flag = FB_MODE_IS_CALCULATED;
  373. DPRINTK(" 720x400@88Hz\n");
  374. }
  375. if (c&0x20) {
  376. mode[num++] = vesa_modes[3];
  377. DPRINTK(" 640x480@60Hz\n");
  378. }
  379. if (c&0x10) {
  380. calc_mode_timings(640, 480, 67, &mode[num]);
  381. mode[num++].flag = FB_MODE_IS_CALCULATED;
  382. DPRINTK(" 640x480@67Hz\n");
  383. }
  384. if (c&0x08) {
  385. mode[num++] = vesa_modes[4];
  386. DPRINTK(" 640x480@72Hz\n");
  387. }
  388. if (c&0x04) {
  389. mode[num++] = vesa_modes[5];
  390. DPRINTK(" 640x480@75Hz\n");
  391. }
  392. if (c&0x02) {
  393. mode[num++] = vesa_modes[7];
  394. DPRINTK(" 800x600@56Hz\n");
  395. }
  396. if (c&0x01) {
  397. mode[num++] = vesa_modes[8];
  398. DPRINTK(" 800x600@60Hz\n");
  399. }
  400. c = block[1];
  401. if (c&0x80) {
  402. mode[num++] = vesa_modes[9];
  403. DPRINTK(" 800x600@72Hz\n");
  404. }
  405. if (c&0x40) {
  406. mode[num++] = vesa_modes[10];
  407. DPRINTK(" 800x600@75Hz\n");
  408. }
  409. if (c&0x20) {
  410. calc_mode_timings(832, 624, 75, &mode[num]);
  411. mode[num++].flag = FB_MODE_IS_CALCULATED;
  412. DPRINTK(" 832x624@75Hz\n");
  413. }
  414. if (c&0x10) {
  415. mode[num++] = vesa_modes[12];
  416. DPRINTK(" 1024x768@87Hz Interlaced\n");
  417. }
  418. if (c&0x08) {
  419. mode[num++] = vesa_modes[13];
  420. DPRINTK(" 1024x768@60Hz\n");
  421. }
  422. if (c&0x04) {
  423. mode[num++] = vesa_modes[14];
  424. DPRINTK(" 1024x768@70Hz\n");
  425. }
  426. if (c&0x02) {
  427. mode[num++] = vesa_modes[15];
  428. DPRINTK(" 1024x768@75Hz\n");
  429. }
  430. if (c&0x01) {
  431. mode[num++] = vesa_modes[21];
  432. DPRINTK(" 1280x1024@75Hz\n");
  433. }
  434. c = block[2];
  435. if (c&0x80) {
  436. mode[num++] = vesa_modes[17];
  437. DPRINTK(" 1152x870@75Hz\n");
  438. }
  439. DPRINTK(" Manufacturer's mask: %x\n",c&0x7F);
  440. return num;
  441. }
  442. static int get_std_timing(unsigned char *block, struct fb_videomode *mode,
  443. int ver, int rev)
  444. {
  445. int xres, yres = 0, refresh, ratio, i;
  446. xres = (block[0] + 31) * 8;
  447. if (xres <= 256)
  448. return 0;
  449. ratio = (block[1] & 0xc0) >> 6;
  450. switch (ratio) {
  451. case 0:
  452. /* in EDID 1.3 the meaning of 0 changed to 16:10 (prior 1:1) */
  453. if (ver < 1 || (ver == 1 && rev < 3))
  454. yres = xres;
  455. else
  456. yres = (xres * 10)/16;
  457. break;
  458. case 1:
  459. yres = (xres * 3)/4;
  460. break;
  461. case 2:
  462. yres = (xres * 4)/5;
  463. break;
  464. case 3:
  465. yres = (xres * 9)/16;
  466. break;
  467. }
  468. refresh = (block[1] & 0x3f) + 60;
  469. DPRINTK(" %dx%d@%dHz\n", xres, yres, refresh);
  470. for (i = 0; i < VESA_MODEDB_SIZE; i++) {
  471. if (vesa_modes[i].xres == xres &&
  472. vesa_modes[i].yres == yres &&
  473. vesa_modes[i].refresh == refresh) {
  474. *mode = vesa_modes[i];
  475. mode->flag |= FB_MODE_IS_STANDARD;
  476. return 1;
  477. }
  478. }
  479. calc_mode_timings(xres, yres, refresh, mode);
  480. return 1;
  481. }
  482. static int get_dst_timing(unsigned char *block,
  483. struct fb_videomode *mode, int ver, int rev)
  484. {
  485. int j, num = 0;
  486. for (j = 0; j < 6; j++, block += STD_TIMING_DESCRIPTION_SIZE)
  487. num += get_std_timing(block, &mode[num], ver, rev);
  488. return num;
  489. }
  490. static void get_detailed_timing(unsigned char *block,
  491. struct fb_videomode *mode)
  492. {
  493. mode->xres = H_ACTIVE;
  494. mode->yres = V_ACTIVE;
  495. mode->pixclock = PIXEL_CLOCK;
  496. mode->pixclock /= 1000;
  497. mode->pixclock = KHZ2PICOS(mode->pixclock);
  498. mode->right_margin = H_SYNC_OFFSET;
  499. mode->left_margin = (H_ACTIVE + H_BLANKING) -
  500. (H_ACTIVE + H_SYNC_OFFSET + H_SYNC_WIDTH);
  501. mode->upper_margin = V_BLANKING - V_SYNC_OFFSET -
  502. V_SYNC_WIDTH;
  503. mode->lower_margin = V_SYNC_OFFSET;
  504. mode->hsync_len = H_SYNC_WIDTH;
  505. mode->vsync_len = V_SYNC_WIDTH;
  506. if (HSYNC_POSITIVE)
  507. mode->sync |= FB_SYNC_HOR_HIGH_ACT;
  508. if (VSYNC_POSITIVE)
  509. mode->sync |= FB_SYNC_VERT_HIGH_ACT;
  510. mode->refresh = PIXEL_CLOCK/((H_ACTIVE + H_BLANKING) *
  511. (V_ACTIVE + V_BLANKING));
  512. if (INTERLACED) {
  513. mode->yres *= 2;
  514. mode->upper_margin *= 2;
  515. mode->lower_margin *= 2;
  516. mode->vsync_len *= 2;
  517. mode->vmode |= FB_VMODE_INTERLACED;
  518. }
  519. mode->flag = FB_MODE_IS_DETAILED;
  520. DPRINTK(" %d MHz ", PIXEL_CLOCK/1000000);
  521. DPRINTK("%d %d %d %d ", H_ACTIVE, H_ACTIVE + H_SYNC_OFFSET,
  522. H_ACTIVE + H_SYNC_OFFSET + H_SYNC_WIDTH, H_ACTIVE + H_BLANKING);
  523. DPRINTK("%d %d %d %d ", V_ACTIVE, V_ACTIVE + V_SYNC_OFFSET,
  524. V_ACTIVE + V_SYNC_OFFSET + V_SYNC_WIDTH, V_ACTIVE + V_BLANKING);
  525. DPRINTK("%sHSync %sVSync\n\n", (HSYNC_POSITIVE) ? "+" : "-",
  526. (VSYNC_POSITIVE) ? "+" : "-");
  527. }
  528. /**
  529. * fb_create_modedb - create video mode database
  530. * @edid: EDID data
  531. * @dbsize: database size
  532. *
  533. * RETURNS: struct fb_videomode, @dbsize contains length of database
  534. *
  535. * DESCRIPTION:
  536. * This function builds a mode database using the contents of the EDID
  537. * data
  538. */
  539. static struct fb_videomode *fb_create_modedb(unsigned char *edid, int *dbsize)
  540. {
  541. struct fb_videomode *mode, *m;
  542. unsigned char *block;
  543. int num = 0, i, first = 1;
  544. int ver, rev;
  545. ver = edid[EDID_STRUCT_VERSION];
  546. rev = edid[EDID_STRUCT_REVISION];
  547. mode = kzalloc(50 * sizeof(struct fb_videomode), GFP_KERNEL);
  548. if (mode == NULL)
  549. return NULL;
  550. if (edid == NULL || !edid_checksum(edid) ||
  551. !edid_check_header(edid)) {
  552. kfree(mode);
  553. return NULL;
  554. }
  555. *dbsize = 0;
  556. DPRINTK(" Detailed Timings\n");
  557. block = edid + DETAILED_TIMING_DESCRIPTIONS_START;
  558. for (i = 0; i < 4; i++, block+= DETAILED_TIMING_DESCRIPTION_SIZE) {
  559. if (!(block[0] == 0x00 && block[1] == 0x00)) {
  560. get_detailed_timing(block, &mode[num]);
  561. if (first) {
  562. mode[num].flag |= FB_MODE_IS_FIRST;
  563. first = 0;
  564. }
  565. num++;
  566. }
  567. }
  568. DPRINTK(" Supported VESA Modes\n");
  569. block = edid + ESTABLISHED_TIMING_1;
  570. num += get_est_timing(block, &mode[num]);
  571. DPRINTK(" Standard Timings\n");
  572. block = edid + STD_TIMING_DESCRIPTIONS_START;
  573. for (i = 0; i < STD_TIMING; i++, block += STD_TIMING_DESCRIPTION_SIZE)
  574. num += get_std_timing(block, &mode[num], ver, rev);
  575. block = edid + DETAILED_TIMING_DESCRIPTIONS_START;
  576. for (i = 0; i < 4; i++, block+= DETAILED_TIMING_DESCRIPTION_SIZE) {
  577. if (block[0] == 0x00 && block[1] == 0x00 && block[3] == 0xfa)
  578. num += get_dst_timing(block + 5, &mode[num], ver, rev);
  579. }
  580. /* Yikes, EDID data is totally useless */
  581. if (!num) {
  582. kfree(mode);
  583. return NULL;
  584. }
  585. *dbsize = num;
  586. m = kmalloc(num * sizeof(struct fb_videomode), GFP_KERNEL);
  587. if (!m)
  588. return mode;
  589. memmove(m, mode, num * sizeof(struct fb_videomode));
  590. kfree(mode);
  591. return m;
  592. }
  593. /**
  594. * fb_destroy_modedb - destroys mode database
  595. * @modedb: mode database to destroy
  596. *
  597. * DESCRIPTION:
  598. * Destroy mode database created by fb_create_modedb
  599. */
  600. void fb_destroy_modedb(struct fb_videomode *modedb)
  601. {
  602. kfree(modedb);
  603. }
  604. static int fb_get_monitor_limits(unsigned char *edid, struct fb_monspecs *specs)
  605. {
  606. int i, retval = 1;
  607. unsigned char *block;
  608. block = edid + DETAILED_TIMING_DESCRIPTIONS_START;
  609. DPRINTK(" Monitor Operating Limits: ");
  610. for (i = 0; i < 4; i++, block += DETAILED_TIMING_DESCRIPTION_SIZE) {
  611. if (edid_is_limits_block(block)) {
  612. specs->hfmin = H_MIN_RATE * 1000;
  613. specs->hfmax = H_MAX_RATE * 1000;
  614. specs->vfmin = V_MIN_RATE;
  615. specs->vfmax = V_MAX_RATE;
  616. specs->dclkmax = MAX_PIXEL_CLOCK * 1000000;
  617. specs->gtf = (GTF_SUPPORT) ? 1 : 0;
  618. retval = 0;
  619. DPRINTK("From EDID\n");
  620. break;
  621. }
  622. }
  623. /* estimate monitor limits based on modes supported */
  624. if (retval) {
  625. struct fb_videomode *modes, *mode;
  626. int num_modes, hz, hscan, pixclock;
  627. int vtotal, htotal;
  628. modes = fb_create_modedb(edid, &num_modes);
  629. if (!modes) {
  630. DPRINTK("None Available\n");
  631. return 1;
  632. }
  633. retval = 0;
  634. for (i = 0; i < num_modes; i++) {
  635. mode = &modes[i];
  636. pixclock = PICOS2KHZ(modes[i].pixclock) * 1000;
  637. htotal = mode->xres + mode->right_margin + mode->hsync_len
  638. + mode->left_margin;
  639. vtotal = mode->yres + mode->lower_margin + mode->vsync_len
  640. + mode->upper_margin;
  641. if (mode->vmode & FB_VMODE_INTERLACED)
  642. vtotal /= 2;
  643. if (mode->vmode & FB_VMODE_DOUBLE)
  644. vtotal *= 2;
  645. hscan = (pixclock + htotal / 2) / htotal;
  646. hscan = (hscan + 500) / 1000 * 1000;
  647. hz = (hscan + vtotal / 2) / vtotal;
  648. if (specs->dclkmax == 0 || specs->dclkmax < pixclock)
  649. specs->dclkmax = pixclock;
  650. if (specs->dclkmin == 0 || specs->dclkmin > pixclock)
  651. specs->dclkmin = pixclock;
  652. if (specs->hfmax == 0 || specs->hfmax < hscan)
  653. specs->hfmax = hscan;
  654. if (specs->hfmin == 0 || specs->hfmin > hscan)
  655. specs->hfmin = hscan;
  656. if (specs->vfmax == 0 || specs->vfmax < hz)
  657. specs->vfmax = hz;
  658. if (specs->vfmin == 0 || specs->vfmin > hz)
  659. specs->vfmin = hz;
  660. }
  661. DPRINTK("Extrapolated\n");
  662. fb_destroy_modedb(modes);
  663. }
  664. DPRINTK(" H: %d-%dKHz V: %d-%dHz DCLK: %dMHz\n",
  665. specs->hfmin/1000, specs->hfmax/1000, specs->vfmin,
  666. specs->vfmax, specs->dclkmax/1000000);
  667. return retval;
  668. }
  669. static void get_monspecs(unsigned char *edid, struct fb_monspecs *specs)
  670. {
  671. unsigned char c, *block;
  672. block = edid + EDID_STRUCT_DISPLAY;
  673. fb_get_monitor_limits(edid, specs);
  674. c = block[0] & 0x80;
  675. specs->input = 0;
  676. if (c) {
  677. specs->input |= FB_DISP_DDI;
  678. DPRINTK(" Digital Display Input");
  679. } else {
  680. DPRINTK(" Analog Display Input: Input Voltage - ");
  681. switch ((block[0] & 0x60) >> 5) {
  682. case 0:
  683. DPRINTK("0.700V/0.300V");
  684. specs->input |= FB_DISP_ANA_700_300;
  685. break;
  686. case 1:
  687. DPRINTK("0.714V/0.286V");
  688. specs->input |= FB_DISP_ANA_714_286;
  689. break;
  690. case 2:
  691. DPRINTK("1.000V/0.400V");
  692. specs->input |= FB_DISP_ANA_1000_400;
  693. break;
  694. case 3:
  695. DPRINTK("0.700V/0.000V");
  696. specs->input |= FB_DISP_ANA_700_000;
  697. break;
  698. }
  699. }
  700. DPRINTK("\n Sync: ");
  701. c = block[0] & 0x10;
  702. if (c)
  703. DPRINTK(" Configurable signal level\n");
  704. c = block[0] & 0x0f;
  705. specs->signal = 0;
  706. if (c & 0x10) {
  707. DPRINTK("Blank to Blank ");
  708. specs->signal |= FB_SIGNAL_BLANK_BLANK;
  709. }
  710. if (c & 0x08) {
  711. DPRINTK("Separate ");
  712. specs->signal |= FB_SIGNAL_SEPARATE;
  713. }
  714. if (c & 0x04) {
  715. DPRINTK("Composite ");
  716. specs->signal |= FB_SIGNAL_COMPOSITE;
  717. }
  718. if (c & 0x02) {
  719. DPRINTK("Sync on Green ");
  720. specs->signal |= FB_SIGNAL_SYNC_ON_GREEN;
  721. }
  722. if (c & 0x01) {
  723. DPRINTK("Serration on ");
  724. specs->signal |= FB_SIGNAL_SERRATION_ON;
  725. }
  726. DPRINTK("\n");
  727. specs->max_x = block[1];
  728. specs->max_y = block[2];
  729. DPRINTK(" Max H-size in cm: ");
  730. if (specs->max_x)
  731. DPRINTK("%d\n", specs->max_x);
  732. else
  733. DPRINTK("variable\n");
  734. DPRINTK(" Max V-size in cm: ");
  735. if (specs->max_y)
  736. DPRINTK("%d\n", specs->max_y);
  737. else
  738. DPRINTK("variable\n");
  739. c = block[3];
  740. specs->gamma = c+100;
  741. DPRINTK(" Gamma: ");
  742. DPRINTK("%d.%d\n", specs->gamma/100, specs->gamma % 100);
  743. get_dpms_capabilities(block[4], specs);
  744. switch ((block[4] & 0x18) >> 3) {
  745. case 0:
  746. DPRINTK(" Monochrome/Grayscale\n");
  747. specs->input |= FB_DISP_MONO;
  748. break;
  749. case 1:
  750. DPRINTK(" RGB Color Display\n");
  751. specs->input |= FB_DISP_RGB;
  752. break;
  753. case 2:
  754. DPRINTK(" Non-RGB Multicolor Display\n");
  755. specs->input |= FB_DISP_MULTI;
  756. break;
  757. default:
  758. DPRINTK(" Unknown\n");
  759. specs->input |= FB_DISP_UNKNOWN;
  760. break;
  761. }
  762. get_chroma(block, specs);
  763. specs->misc = 0;
  764. c = block[4] & 0x7;
  765. if (c & 0x04) {
  766. DPRINTK(" Default color format is primary\n");
  767. specs->misc |= FB_MISC_PRIM_COLOR;
  768. }
  769. if (c & 0x02) {
  770. DPRINTK(" First DETAILED Timing is preferred\n");
  771. specs->misc |= FB_MISC_1ST_DETAIL;
  772. }
  773. if (c & 0x01) {
  774. printk(" Display is GTF capable\n");
  775. specs->gtf = 1;
  776. }
  777. }
  778. int fb_parse_edid(unsigned char *edid, struct fb_var_screeninfo *var)
  779. {
  780. int i;
  781. unsigned char *block;
  782. if (edid == NULL || var == NULL)
  783. return 1;
  784. if (!(edid_checksum(edid)))
  785. return 1;
  786. if (!(edid_check_header(edid)))
  787. return 1;
  788. block = edid + DETAILED_TIMING_DESCRIPTIONS_START;
  789. for (i = 0; i < 4; i++, block += DETAILED_TIMING_DESCRIPTION_SIZE) {
  790. if (edid_is_timing_block(block)) {
  791. var->xres = var->xres_virtual = H_ACTIVE;
  792. var->yres = var->yres_virtual = V_ACTIVE;
  793. var->height = var->width = 0;
  794. var->right_margin = H_SYNC_OFFSET;
  795. var->left_margin = (H_ACTIVE + H_BLANKING) -
  796. (H_ACTIVE + H_SYNC_OFFSET + H_SYNC_WIDTH);
  797. var->upper_margin = V_BLANKING - V_SYNC_OFFSET -
  798. V_SYNC_WIDTH;
  799. var->lower_margin = V_SYNC_OFFSET;
  800. var->hsync_len = H_SYNC_WIDTH;
  801. var->vsync_len = V_SYNC_WIDTH;
  802. var->pixclock = PIXEL_CLOCK;
  803. var->pixclock /= 1000;
  804. var->pixclock = KHZ2PICOS(var->pixclock);
  805. if (HSYNC_POSITIVE)
  806. var->sync |= FB_SYNC_HOR_HIGH_ACT;
  807. if (VSYNC_POSITIVE)
  808. var->sync |= FB_SYNC_VERT_HIGH_ACT;
  809. return 0;
  810. }
  811. }
  812. return 1;
  813. }
  814. void fb_edid_to_monspecs(unsigned char *edid, struct fb_monspecs *specs)
  815. {
  816. unsigned char *block;
  817. int i, found = 0;
  818. if (edid == NULL)
  819. return;
  820. if (!(edid_checksum(edid)))
  821. return;
  822. if (!(edid_check_header(edid)))
  823. return;
  824. memset(specs, 0, sizeof(struct fb_monspecs));
  825. specs->version = edid[EDID_STRUCT_VERSION];
  826. specs->revision = edid[EDID_STRUCT_REVISION];
  827. DPRINTK("========================================\n");
  828. DPRINTK("Display Information (EDID)\n");
  829. DPRINTK("========================================\n");
  830. DPRINTK(" EDID Version %d.%d\n", (int) specs->version,
  831. (int) specs->revision);
  832. parse_vendor_block(edid + ID_MANUFACTURER_NAME, specs);
  833. block = edid + DETAILED_TIMING_DESCRIPTIONS_START;
  834. for (i = 0; i < 4; i++, block += DETAILED_TIMING_DESCRIPTION_SIZE) {
  835. if (edid_is_serial_block(block)) {
  836. copy_string(block, specs->serial_no);
  837. DPRINTK(" Serial Number: %s\n", specs->serial_no);
  838. } else if (edid_is_ascii_block(block)) {
  839. copy_string(block, specs->ascii);
  840. DPRINTK(" ASCII Block: %s\n", specs->ascii);
  841. } else if (edid_is_monitor_block(block)) {
  842. copy_string(block, specs->monitor);
  843. DPRINTK(" Monitor Name: %s\n", specs->monitor);
  844. }
  845. }
  846. DPRINTK(" Display Characteristics:\n");
  847. get_monspecs(edid, specs);
  848. specs->modedb = fb_create_modedb(edid, &specs->modedb_len);
  849. /*
  850. * Workaround for buggy EDIDs that sets that the first
  851. * detailed timing is preferred but has not detailed
  852. * timing specified
  853. */
  854. for (i = 0; i < specs->modedb_len; i++) {
  855. if (specs->modedb[i].flag & FB_MODE_IS_DETAILED) {
  856. found = 1;
  857. break;
  858. }
  859. }
  860. if (!found)
  861. specs->misc &= ~FB_MISC_1ST_DETAIL;
  862. DPRINTK("========================================\n");
  863. }
  864. /**
  865. * fb_edid_add_monspecs() - add monitor video modes from E-EDID data
  866. * @edid: 128 byte array with an E-EDID block
  867. * @spacs: monitor specs to be extended
  868. */
  869. void fb_edid_add_monspecs(unsigned char *edid, struct fb_monspecs *specs)
  870. {
  871. unsigned char *block;
  872. struct fb_videomode *m;
  873. int num = 0, i;
  874. u8 svd[64], edt[(128 - 4) / DETAILED_TIMING_DESCRIPTION_SIZE];
  875. u8 pos = 4, svd_n = 0;
  876. if (!edid)
  877. return;
  878. if (!edid_checksum(edid))
  879. return;
  880. if (edid[0] != 0x2 ||
  881. edid[2] < 4 || edid[2] > 128 - DETAILED_TIMING_DESCRIPTION_SIZE)
  882. return;
  883. DPRINTK(" Short Video Descriptors\n");
  884. while (pos < edid[2]) {
  885. u8 len = edid[pos] & 0x1f, type = (edid[pos] >> 5) & 7;
  886. pr_debug("Data block %u of %u bytes\n", type, len);
  887. if (type == 2)
  888. for (i = pos; i < pos + len; i++) {
  889. u8 idx = edid[pos + i] & 0x7f;
  890. svd[svd_n++] = idx;
  891. pr_debug("N%sative mode #%d\n",
  892. edid[pos + i] & 0x80 ? "" : "on-n", idx);
  893. }
  894. pos += len + 1;
  895. }
  896. block = edid + edid[2];
  897. DPRINTK(" Extended Detailed Timings\n");
  898. for (i = 0; i < (128 - edid[2]) / DETAILED_TIMING_DESCRIPTION_SIZE;
  899. i++, block += DETAILED_TIMING_DESCRIPTION_SIZE)
  900. if (PIXEL_CLOCK)
  901. edt[num++] = block - edid;
  902. /* Yikes, EDID data is totally useless */
  903. if (!(num + svd_n))
  904. return;
  905. m = kzalloc((specs->modedb_len + num + svd_n) *
  906. sizeof(struct fb_videomode), GFP_KERNEL);
  907. if (!m)
  908. return;
  909. memcpy(m, specs->modedb, specs->modedb_len * sizeof(struct fb_videomode));
  910. for (i = specs->modedb_len; i < specs->modedb_len + num; i++) {
  911. get_detailed_timing(edid + edt[i - specs->modedb_len], &m[i]);
  912. if (i == specs->modedb_len)
  913. m[i].flag |= FB_MODE_IS_FIRST;
  914. pr_debug("Adding %ux%u@%u\n", m[i].xres, m[i].yres, m[i].refresh);
  915. }
  916. for (i = specs->modedb_len + num; i < specs->modedb_len + num + svd_n; i++) {
  917. int idx = svd[i - specs->modedb_len - num];
  918. if (!idx || idx > 63) {
  919. pr_warning("Reserved SVD code %d\n", idx);
  920. } else if (idx > ARRAY_SIZE(cea_modes) || !cea_modes[idx].xres) {
  921. pr_warning("Unimplemented SVD code %d\n", idx);
  922. } else {
  923. memcpy(&m[i], cea_modes + idx, sizeof(m[i]));
  924. pr_debug("Adding SVD #%d: %ux%u@%u\n", idx,
  925. m[i].xres, m[i].yres, m[i].refresh);
  926. }
  927. }
  928. kfree(specs->modedb);
  929. specs->modedb = m;
  930. specs->modedb_len = specs->modedb_len + num + svd_n;
  931. }
  932. /*
  933. * VESA Generalized Timing Formula (GTF)
  934. */
  935. #define FLYBACK 550
  936. #define V_FRONTPORCH 1
  937. #define H_OFFSET 40
  938. #define H_SCALEFACTOR 20
  939. #define H_BLANKSCALE 128
  940. #define H_GRADIENT 600
  941. #define C_VAL 30
  942. #define M_VAL 300
  943. struct __fb_timings {
  944. u32 dclk;
  945. u32 hfreq;
  946. u32 vfreq;
  947. u32 hactive;
  948. u32 vactive;
  949. u32 hblank;
  950. u32 vblank;
  951. u32 htotal;
  952. u32 vtotal;
  953. };
  954. /**
  955. * fb_get_vblank - get vertical blank time
  956. * @hfreq: horizontal freq
  957. *
  958. * DESCRIPTION:
  959. * vblank = right_margin + vsync_len + left_margin
  960. *
  961. * given: right_margin = 1 (V_FRONTPORCH)
  962. * vsync_len = 3
  963. * flyback = 550
  964. *
  965. * flyback * hfreq
  966. * left_margin = --------------- - vsync_len
  967. * 1000000
  968. */
  969. static u32 fb_get_vblank(u32 hfreq)
  970. {
  971. u32 vblank;
  972. vblank = (hfreq * FLYBACK)/1000;
  973. vblank = (vblank + 500)/1000;
  974. return (vblank + V_FRONTPORCH);
  975. }
  976. /**
  977. * fb_get_hblank_by_freq - get horizontal blank time given hfreq
  978. * @hfreq: horizontal freq
  979. * @xres: horizontal resolution in pixels
  980. *
  981. * DESCRIPTION:
  982. *
  983. * xres * duty_cycle
  984. * hblank = ------------------
  985. * 100 - duty_cycle
  986. *
  987. * duty cycle = percent of htotal assigned to inactive display
  988. * duty cycle = C - (M/Hfreq)
  989. *
  990. * where: C = ((offset - scale factor) * blank_scale)
  991. * -------------------------------------- + scale factor
  992. * 256
  993. * M = blank_scale * gradient
  994. *
  995. */
  996. static u32 fb_get_hblank_by_hfreq(u32 hfreq, u32 xres)
  997. {
  998. u32 c_val, m_val, duty_cycle, hblank;
  999. c_val = (((H_OFFSET - H_SCALEFACTOR) * H_BLANKSCALE)/256 +
  1000. H_SCALEFACTOR) * 1000;
  1001. m_val = (H_BLANKSCALE * H_GRADIENT)/256;
  1002. m_val = (m_val * 1000000)/hfreq;
  1003. duty_cycle = c_val - m_val;
  1004. hblank = (xres * duty_cycle)/(100000 - duty_cycle);
  1005. return (hblank);
  1006. }
  1007. /**
  1008. * fb_get_hblank_by_dclk - get horizontal blank time given pixelclock
  1009. * @dclk: pixelclock in Hz
  1010. * @xres: horizontal resolution in pixels
  1011. *
  1012. * DESCRIPTION:
  1013. *
  1014. * xres * duty_cycle
  1015. * hblank = ------------------
  1016. * 100 - duty_cycle
  1017. *
  1018. * duty cycle = percent of htotal assigned to inactive display
  1019. * duty cycle = C - (M * h_period)
  1020. *
  1021. * where: h_period = SQRT(100 - C + (0.4 * xres * M)/dclk) + C - 100
  1022. * -----------------------------------------------
  1023. * 2 * M
  1024. * M = 300;
  1025. * C = 30;
  1026. */
  1027. static u32 fb_get_hblank_by_dclk(u32 dclk, u32 xres)
  1028. {
  1029. u32 duty_cycle, h_period, hblank;
  1030. dclk /= 1000;
  1031. h_period = 100 - C_VAL;
  1032. h_period *= h_period;
  1033. h_period += (M_VAL * xres * 2 * 1000)/(5 * dclk);
  1034. h_period *= 10000;
  1035. h_period = int_sqrt(h_period);
  1036. h_period -= (100 - C_VAL) * 100;
  1037. h_period *= 1000;
  1038. h_period /= 2 * M_VAL;
  1039. duty_cycle = C_VAL * 1000 - (M_VAL * h_period)/100;
  1040. hblank = (xres * duty_cycle)/(100000 - duty_cycle) + 8;
  1041. hblank &= ~15;
  1042. return (hblank);
  1043. }
  1044. /**
  1045. * fb_get_hfreq - estimate hsync
  1046. * @vfreq: vertical refresh rate
  1047. * @yres: vertical resolution
  1048. *
  1049. * DESCRIPTION:
  1050. *
  1051. * (yres + front_port) * vfreq * 1000000
  1052. * hfreq = -------------------------------------
  1053. * (1000000 - (vfreq * FLYBACK)
  1054. *
  1055. */
  1056. static u32 fb_get_hfreq(u32 vfreq, u32 yres)
  1057. {
  1058. u32 divisor, hfreq;
  1059. divisor = (1000000 - (vfreq * FLYBACK))/1000;
  1060. hfreq = (yres + V_FRONTPORCH) * vfreq * 1000;
  1061. return (hfreq/divisor);
  1062. }
  1063. static void fb_timings_vfreq(struct __fb_timings *timings)
  1064. {
  1065. timings->hfreq = fb_get_hfreq(timings->vfreq, timings->vactive);
  1066. timings->vblank = fb_get_vblank(timings->hfreq);
  1067. timings->vtotal = timings->vactive + timings->vblank;
  1068. timings->hblank = fb_get_hblank_by_hfreq(timings->hfreq,
  1069. timings->hactive);
  1070. timings->htotal = timings->hactive + timings->hblank;
  1071. timings->dclk = timings->htotal * timings->hfreq;
  1072. }
  1073. static void fb_timings_hfreq(struct __fb_timings *timings)
  1074. {
  1075. timings->vblank = fb_get_vblank(timings->hfreq);
  1076. timings->vtotal = timings->vactive + timings->vblank;
  1077. timings->vfreq = timings->hfreq/timings->vtotal;
  1078. timings->hblank = fb_get_hblank_by_hfreq(timings->hfreq,
  1079. timings->hactive);
  1080. timings->htotal = timings->hactive + timings->hblank;
  1081. timings->dclk = timings->htotal * timings->hfreq;
  1082. }
  1083. static void fb_timings_dclk(struct __fb_timings *timings)
  1084. {
  1085. timings->hblank = fb_get_hblank_by_dclk(timings->dclk,
  1086. timings->hactive);
  1087. timings->htotal = timings->hactive + timings->hblank;
  1088. timings->hfreq = timings->dclk/timings->htotal;
  1089. timings->vblank = fb_get_vblank(timings->hfreq);
  1090. timings->vtotal = timings->vactive + timings->vblank;
  1091. timings->vfreq = timings->hfreq/timings->vtotal;
  1092. }
  1093. /*
  1094. * fb_get_mode - calculates video mode using VESA GTF
  1095. * @flags: if: 0 - maximize vertical refresh rate
  1096. * 1 - vrefresh-driven calculation;
  1097. * 2 - hscan-driven calculation;
  1098. * 3 - pixelclock-driven calculation;
  1099. * @val: depending on @flags, ignored, vrefresh, hsync or pixelclock
  1100. * @var: pointer to fb_var_screeninfo
  1101. * @info: pointer to fb_info
  1102. *
  1103. * DESCRIPTION:
  1104. * Calculates video mode based on monitor specs using VESA GTF.
  1105. * The GTF is best for VESA GTF compliant monitors but is
  1106. * specifically formulated to work for older monitors as well.
  1107. *
  1108. * If @flag==0, the function will attempt to maximize the
  1109. * refresh rate. Otherwise, it will calculate timings based on
  1110. * the flag and accompanying value.
  1111. *
  1112. * If FB_IGNOREMON bit is set in @flags, monitor specs will be
  1113. * ignored and @var will be filled with the calculated timings.
  1114. *
  1115. * All calculations are based on the VESA GTF Spreadsheet
  1116. * available at VESA's public ftp (http://www.vesa.org).
  1117. *
  1118. * NOTES:
  1119. * The timings generated by the GTF will be different from VESA
  1120. * DMT. It might be a good idea to keep a table of standard
  1121. * VESA modes as well. The GTF may also not work for some displays,
  1122. * such as, and especially, analog TV.
  1123. *
  1124. * REQUIRES:
  1125. * A valid info->monspecs, otherwise 'safe numbers' will be used.
  1126. */
  1127. int fb_get_mode(int flags, u32 val, struct fb_var_screeninfo *var, struct fb_info *info)
  1128. {
  1129. struct __fb_timings *timings;
  1130. u32 interlace = 1, dscan = 1;
  1131. u32 hfmin, hfmax, vfmin, vfmax, dclkmin, dclkmax, err = 0;
  1132. timings = kzalloc(sizeof(struct __fb_timings), GFP_KERNEL);
  1133. if (!timings)
  1134. return -ENOMEM;
  1135. /*
  1136. * If monspecs are invalid, use values that are enough
  1137. * for 640x480@60
  1138. */
  1139. if (!info || !info->monspecs.hfmax || !info->monspecs.vfmax ||
  1140. !info->monspecs.dclkmax ||
  1141. info->monspecs.hfmax < info->monspecs.hfmin ||
  1142. info->monspecs.vfmax < info->monspecs.vfmin ||
  1143. info->monspecs.dclkmax < info->monspecs.dclkmin) {
  1144. hfmin = 29000; hfmax = 30000;
  1145. vfmin = 60; vfmax = 60;
  1146. dclkmin = 0; dclkmax = 25000000;
  1147. } else {
  1148. hfmin = info->monspecs.hfmin;
  1149. hfmax = info->monspecs.hfmax;
  1150. vfmin = info->monspecs.vfmin;
  1151. vfmax = info->monspecs.vfmax;
  1152. dclkmin = info->monspecs.dclkmin;
  1153. dclkmax = info->monspecs.dclkmax;
  1154. }
  1155. timings->hactive = var->xres;
  1156. timings->vactive = var->yres;
  1157. if (var->vmode & FB_VMODE_INTERLACED) {
  1158. timings->vactive /= 2;
  1159. interlace = 2;
  1160. }
  1161. if (var->vmode & FB_VMODE_DOUBLE) {
  1162. timings->vactive *= 2;
  1163. dscan = 2;
  1164. }
  1165. switch (flags & ~FB_IGNOREMON) {
  1166. case FB_MAXTIMINGS: /* maximize refresh rate */
  1167. timings->hfreq = hfmax;
  1168. fb_timings_hfreq(timings);
  1169. if (timings->vfreq > vfmax) {
  1170. timings->vfreq = vfmax;
  1171. fb_timings_vfreq(timings);
  1172. }
  1173. if (timings->dclk > dclkmax) {
  1174. timings->dclk = dclkmax;
  1175. fb_timings_dclk(timings);
  1176. }
  1177. break;
  1178. case FB_VSYNCTIMINGS: /* vrefresh driven */
  1179. timings->vfreq = val;
  1180. fb_timings_vfreq(timings);
  1181. break;
  1182. case FB_HSYNCTIMINGS: /* hsync driven */
  1183. timings->hfreq = val;
  1184. fb_timings_hfreq(timings);
  1185. break;
  1186. case FB_DCLKTIMINGS: /* pixelclock driven */
  1187. timings->dclk = PICOS2KHZ(val) * 1000;
  1188. fb_timings_dclk(timings);
  1189. break;
  1190. default:
  1191. err = -EINVAL;
  1192. }
  1193. if (err || (!(flags & FB_IGNOREMON) &&
  1194. (timings->vfreq < vfmin || timings->vfreq > vfmax ||
  1195. timings->hfreq < hfmin || timings->hfreq > hfmax ||
  1196. timings->dclk < dclkmin || timings->dclk > dclkmax))) {
  1197. err = -EINVAL;
  1198. } else {
  1199. var->pixclock = KHZ2PICOS(timings->dclk/1000);
  1200. var->hsync_len = (timings->htotal * 8)/100;
  1201. var->right_margin = (timings->hblank/2) - var->hsync_len;
  1202. var->left_margin = timings->hblank - var->right_margin -
  1203. var->hsync_len;
  1204. var->vsync_len = (3 * interlace)/dscan;
  1205. var->lower_margin = (1 * interlace)/dscan;
  1206. var->upper_margin = (timings->vblank * interlace)/dscan -
  1207. (var->vsync_len + var->lower_margin);
  1208. }
  1209. kfree(timings);
  1210. return err;
  1211. }
  1212. #else
  1213. int fb_parse_edid(unsigned char *edid, struct fb_var_screeninfo *var)
  1214. {
  1215. return 1;
  1216. }
  1217. void fb_edid_to_monspecs(unsigned char *edid, struct fb_monspecs *specs)
  1218. {
  1219. specs = NULL;
  1220. }
  1221. void fb_edid_add_monspecs(unsigned char *edid, struct fb_monspecs *specs)
  1222. {
  1223. }
  1224. void fb_destroy_modedb(struct fb_videomode *modedb)
  1225. {
  1226. }
  1227. int fb_get_mode(int flags, u32 val, struct fb_var_screeninfo *var,
  1228. struct fb_info *info)
  1229. {
  1230. return -EINVAL;
  1231. }
  1232. #endif /* CONFIG_FB_MODE_HELPERS */
  1233. /*
  1234. * fb_validate_mode - validates var against monitor capabilities
  1235. * @var: pointer to fb_var_screeninfo
  1236. * @info: pointer to fb_info
  1237. *
  1238. * DESCRIPTION:
  1239. * Validates video mode against monitor capabilities specified in
  1240. * info->monspecs.
  1241. *
  1242. * REQUIRES:
  1243. * A valid info->monspecs.
  1244. */
  1245. int fb_validate_mode(const struct fb_var_screeninfo *var, struct fb_info *info)
  1246. {
  1247. u32 hfreq, vfreq, htotal, vtotal, pixclock;
  1248. u32 hfmin, hfmax, vfmin, vfmax, dclkmin, dclkmax;
  1249. /*
  1250. * If monspecs are invalid, use values that are enough
  1251. * for 640x480@60
  1252. */
  1253. if (!info->monspecs.hfmax || !info->monspecs.vfmax ||
  1254. !info->monspecs.dclkmax ||
  1255. info->monspecs.hfmax < info->monspecs.hfmin ||
  1256. info->monspecs.vfmax < info->monspecs.vfmin ||
  1257. info->monspecs.dclkmax < info->monspecs.dclkmin) {
  1258. hfmin = 29000; hfmax = 30000;
  1259. vfmin = 60; vfmax = 60;
  1260. dclkmin = 0; dclkmax = 25000000;
  1261. } else {
  1262. hfmin = info->monspecs.hfmin;
  1263. hfmax = info->monspecs.hfmax;
  1264. vfmin = info->monspecs.vfmin;
  1265. vfmax = info->monspecs.vfmax;
  1266. dclkmin = info->monspecs.dclkmin;
  1267. dclkmax = info->monspecs.dclkmax;
  1268. }
  1269. if (!var->pixclock)
  1270. return -EINVAL;
  1271. pixclock = PICOS2KHZ(var->pixclock) * 1000;
  1272. htotal = var->xres + var->right_margin + var->hsync_len +
  1273. var->left_margin;
  1274. vtotal = var->yres + var->lower_margin + var->vsync_len +
  1275. var->upper_margin;
  1276. if (var->vmode & FB_VMODE_INTERLACED)
  1277. vtotal /= 2;
  1278. if (var->vmode & FB_VMODE_DOUBLE)
  1279. vtotal *= 2;
  1280. hfreq = pixclock/htotal;
  1281. hfreq = (hfreq + 500) / 1000 * 1000;
  1282. vfreq = hfreq/vtotal;
  1283. return (vfreq < vfmin || vfreq > vfmax ||
  1284. hfreq < hfmin || hfreq > hfmax ||
  1285. pixclock < dclkmin || pixclock > dclkmax) ?
  1286. -EINVAL : 0;
  1287. }
  1288. #if defined(CONFIG_FIRMWARE_EDID) && defined(CONFIG_X86)
  1289. /*
  1290. * We need to ensure that the EDID block is only returned for
  1291. * the primary graphics adapter.
  1292. */
  1293. const unsigned char *fb_firmware_edid(struct device *device)
  1294. {
  1295. struct pci_dev *dev = NULL;
  1296. struct resource *res = NULL;
  1297. unsigned char *edid = NULL;
  1298. if (device)
  1299. dev = to_pci_dev(device);
  1300. if (dev)
  1301. res = &dev->resource[PCI_ROM_RESOURCE];
  1302. if (res && res->flags & IORESOURCE_ROM_SHADOW)
  1303. edid = edid_info.dummy;
  1304. return edid;
  1305. }
  1306. #else
  1307. const unsigned char *fb_firmware_edid(struct device *device)
  1308. {
  1309. return NULL;
  1310. }
  1311. #endif
  1312. EXPORT_SYMBOL(fb_firmware_edid);
  1313. EXPORT_SYMBOL(fb_parse_edid);
  1314. EXPORT_SYMBOL(fb_edid_to_monspecs);
  1315. EXPORT_SYMBOL(fb_edid_add_monspecs);
  1316. EXPORT_SYMBOL(fb_get_mode);
  1317. EXPORT_SYMBOL(fb_validate_mode);
  1318. EXPORT_SYMBOL(fb_destroy_modedb);