intel_hdmi.c 35 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261
  1. /*
  2. * Copyright 2006 Dave Airlie <airlied@linux.ie>
  3. * Copyright © 2006-2009 Intel Corporation
  4. *
  5. * Permission is hereby granted, free of charge, to any person obtaining a
  6. * copy of this software and associated documentation files (the "Software"),
  7. * to deal in the Software without restriction, including without limitation
  8. * the rights to use, copy, modify, merge, publish, distribute, sublicense,
  9. * and/or sell copies of the Software, and to permit persons to whom the
  10. * Software is furnished to do so, subject to the following conditions:
  11. *
  12. * The above copyright notice and this permission notice (including the next
  13. * paragraph) shall be included in all copies or substantial portions of the
  14. * Software.
  15. *
  16. * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  17. * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  18. * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
  19. * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
  20. * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
  21. * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER
  22. * DEALINGS IN THE SOFTWARE.
  23. *
  24. * Authors:
  25. * Eric Anholt <eric@anholt.net>
  26. * Jesse Barnes <jesse.barnes@intel.com>
  27. */
  28. #include <linux/i2c.h>
  29. #include <linux/slab.h>
  30. #include <linux/delay.h>
  31. #include <linux/hdmi.h>
  32. #include <drm/drmP.h>
  33. #include <drm/drm_crtc.h>
  34. #include <drm/drm_edid.h>
  35. #include "intel_drv.h"
  36. #include <drm/i915_drm.h>
  37. #include "i915_drv.h"
  38. static struct drm_device *intel_hdmi_to_dev(struct intel_hdmi *intel_hdmi)
  39. {
  40. return hdmi_to_dig_port(intel_hdmi)->base.base.dev;
  41. }
  42. static void
  43. assert_hdmi_port_disabled(struct intel_hdmi *intel_hdmi)
  44. {
  45. struct drm_device *dev = intel_hdmi_to_dev(intel_hdmi);
  46. struct drm_i915_private *dev_priv = dev->dev_private;
  47. uint32_t enabled_bits;
  48. enabled_bits = HAS_DDI(dev) ? DDI_BUF_CTL_ENABLE : SDVO_ENABLE;
  49. WARN(I915_READ(intel_hdmi->hdmi_reg) & enabled_bits,
  50. "HDMI port enabled, expecting disabled\n");
  51. }
  52. struct intel_hdmi *enc_to_intel_hdmi(struct drm_encoder *encoder)
  53. {
  54. struct intel_digital_port *intel_dig_port =
  55. container_of(encoder, struct intel_digital_port, base.base);
  56. return &intel_dig_port->hdmi;
  57. }
  58. static struct intel_hdmi *intel_attached_hdmi(struct drm_connector *connector)
  59. {
  60. return enc_to_intel_hdmi(&intel_attached_encoder(connector)->base);
  61. }
  62. void intel_dip_infoframe_csum(struct dip_infoframe *frame)
  63. {
  64. uint8_t *data = (uint8_t *)frame;
  65. uint8_t sum = 0;
  66. unsigned i;
  67. frame->checksum = 0;
  68. frame->ecc = 0;
  69. for (i = 0; i < frame->len + DIP_HEADER_SIZE; i++)
  70. sum += data[i];
  71. frame->checksum = 0x100 - sum;
  72. }
  73. static u32 g4x_infoframe_index(enum hdmi_infoframe_type type)
  74. {
  75. switch (type) {
  76. case HDMI_INFOFRAME_TYPE_AVI:
  77. return VIDEO_DIP_SELECT_AVI;
  78. case HDMI_INFOFRAME_TYPE_SPD:
  79. return VIDEO_DIP_SELECT_SPD;
  80. default:
  81. DRM_DEBUG_DRIVER("unknown info frame type %d\n", type);
  82. return 0;
  83. }
  84. }
  85. static u32 g4x_infoframe_enable(enum hdmi_infoframe_type type)
  86. {
  87. switch (type) {
  88. case HDMI_INFOFRAME_TYPE_AVI:
  89. return VIDEO_DIP_ENABLE_AVI;
  90. case HDMI_INFOFRAME_TYPE_SPD:
  91. return VIDEO_DIP_ENABLE_SPD;
  92. default:
  93. DRM_DEBUG_DRIVER("unknown info frame type %d\n", type);
  94. return 0;
  95. }
  96. }
  97. static u32 hsw_infoframe_enable(enum hdmi_infoframe_type type)
  98. {
  99. switch (type) {
  100. case HDMI_INFOFRAME_TYPE_AVI:
  101. return VIDEO_DIP_ENABLE_AVI_HSW;
  102. case HDMI_INFOFRAME_TYPE_SPD:
  103. return VIDEO_DIP_ENABLE_SPD_HSW;
  104. default:
  105. DRM_DEBUG_DRIVER("unknown info frame type %d\n", type);
  106. return 0;
  107. }
  108. }
  109. static u32 hsw_infoframe_data_reg(enum hdmi_infoframe_type type,
  110. enum transcoder cpu_transcoder)
  111. {
  112. switch (type) {
  113. case HDMI_INFOFRAME_TYPE_AVI:
  114. return HSW_TVIDEO_DIP_AVI_DATA(cpu_transcoder);
  115. case HDMI_INFOFRAME_TYPE_SPD:
  116. return HSW_TVIDEO_DIP_SPD_DATA(cpu_transcoder);
  117. default:
  118. DRM_DEBUG_DRIVER("unknown info frame type %d\n", type);
  119. return 0;
  120. }
  121. }
  122. static void g4x_write_infoframe(struct drm_encoder *encoder,
  123. enum hdmi_infoframe_type type,
  124. const uint8_t *frame, ssize_t len)
  125. {
  126. uint32_t *data = (uint32_t *)frame;
  127. struct drm_device *dev = encoder->dev;
  128. struct drm_i915_private *dev_priv = dev->dev_private;
  129. u32 val = I915_READ(VIDEO_DIP_CTL);
  130. int i;
  131. WARN(!(val & VIDEO_DIP_ENABLE), "Writing DIP with CTL reg disabled\n");
  132. val &= ~(VIDEO_DIP_SELECT_MASK | 0xf); /* clear DIP data offset */
  133. val |= g4x_infoframe_index(type);
  134. val &= ~g4x_infoframe_enable(type);
  135. I915_WRITE(VIDEO_DIP_CTL, val);
  136. mmiowb();
  137. for (i = 0; i < len; i += 4) {
  138. I915_WRITE(VIDEO_DIP_DATA, *data);
  139. data++;
  140. }
  141. /* Write every possible data byte to force correct ECC calculation. */
  142. for (; i < VIDEO_DIP_DATA_SIZE; i += 4)
  143. I915_WRITE(VIDEO_DIP_DATA, 0);
  144. mmiowb();
  145. val |= g4x_infoframe_enable(type);
  146. val &= ~VIDEO_DIP_FREQ_MASK;
  147. val |= VIDEO_DIP_FREQ_VSYNC;
  148. I915_WRITE(VIDEO_DIP_CTL, val);
  149. POSTING_READ(VIDEO_DIP_CTL);
  150. }
  151. static void ibx_write_infoframe(struct drm_encoder *encoder,
  152. enum hdmi_infoframe_type type,
  153. const uint8_t *frame, ssize_t len)
  154. {
  155. uint32_t *data = (uint32_t *)frame;
  156. struct drm_device *dev = encoder->dev;
  157. struct drm_i915_private *dev_priv = dev->dev_private;
  158. struct intel_crtc *intel_crtc = to_intel_crtc(encoder->crtc);
  159. int i, reg = TVIDEO_DIP_CTL(intel_crtc->pipe);
  160. u32 val = I915_READ(reg);
  161. WARN(!(val & VIDEO_DIP_ENABLE), "Writing DIP with CTL reg disabled\n");
  162. val &= ~(VIDEO_DIP_SELECT_MASK | 0xf); /* clear DIP data offset */
  163. val |= g4x_infoframe_index(type);
  164. val &= ~g4x_infoframe_enable(type);
  165. I915_WRITE(reg, val);
  166. mmiowb();
  167. for (i = 0; i < len; i += 4) {
  168. I915_WRITE(TVIDEO_DIP_DATA(intel_crtc->pipe), *data);
  169. data++;
  170. }
  171. /* Write every possible data byte to force correct ECC calculation. */
  172. for (; i < VIDEO_DIP_DATA_SIZE; i += 4)
  173. I915_WRITE(TVIDEO_DIP_DATA(intel_crtc->pipe), 0);
  174. mmiowb();
  175. val |= g4x_infoframe_enable(type);
  176. val &= ~VIDEO_DIP_FREQ_MASK;
  177. val |= VIDEO_DIP_FREQ_VSYNC;
  178. I915_WRITE(reg, val);
  179. POSTING_READ(reg);
  180. }
  181. static void cpt_write_infoframe(struct drm_encoder *encoder,
  182. enum hdmi_infoframe_type type,
  183. const uint8_t *frame, ssize_t len)
  184. {
  185. uint32_t *data = (uint32_t *)frame;
  186. struct drm_device *dev = encoder->dev;
  187. struct drm_i915_private *dev_priv = dev->dev_private;
  188. struct intel_crtc *intel_crtc = to_intel_crtc(encoder->crtc);
  189. int i, reg = TVIDEO_DIP_CTL(intel_crtc->pipe);
  190. u32 val = I915_READ(reg);
  191. WARN(!(val & VIDEO_DIP_ENABLE), "Writing DIP with CTL reg disabled\n");
  192. val &= ~(VIDEO_DIP_SELECT_MASK | 0xf); /* clear DIP data offset */
  193. val |= g4x_infoframe_index(type);
  194. /* The DIP control register spec says that we need to update the AVI
  195. * infoframe without clearing its enable bit */
  196. if (type != HDMI_INFOFRAME_TYPE_AVI)
  197. val &= ~g4x_infoframe_enable(type);
  198. I915_WRITE(reg, val);
  199. mmiowb();
  200. for (i = 0; i < len; i += 4) {
  201. I915_WRITE(TVIDEO_DIP_DATA(intel_crtc->pipe), *data);
  202. data++;
  203. }
  204. /* Write every possible data byte to force correct ECC calculation. */
  205. for (; i < VIDEO_DIP_DATA_SIZE; i += 4)
  206. I915_WRITE(TVIDEO_DIP_DATA(intel_crtc->pipe), 0);
  207. mmiowb();
  208. val |= g4x_infoframe_enable(type);
  209. val &= ~VIDEO_DIP_FREQ_MASK;
  210. val |= VIDEO_DIP_FREQ_VSYNC;
  211. I915_WRITE(reg, val);
  212. POSTING_READ(reg);
  213. }
  214. static void vlv_write_infoframe(struct drm_encoder *encoder,
  215. enum hdmi_infoframe_type type,
  216. const uint8_t *frame, ssize_t len)
  217. {
  218. uint32_t *data = (uint32_t *)frame;
  219. struct drm_device *dev = encoder->dev;
  220. struct drm_i915_private *dev_priv = dev->dev_private;
  221. struct intel_crtc *intel_crtc = to_intel_crtc(encoder->crtc);
  222. int i, reg = VLV_TVIDEO_DIP_CTL(intel_crtc->pipe);
  223. u32 val = I915_READ(reg);
  224. WARN(!(val & VIDEO_DIP_ENABLE), "Writing DIP with CTL reg disabled\n");
  225. val &= ~(VIDEO_DIP_SELECT_MASK | 0xf); /* clear DIP data offset */
  226. val |= g4x_infoframe_index(type);
  227. val &= ~g4x_infoframe_enable(type);
  228. I915_WRITE(reg, val);
  229. mmiowb();
  230. for (i = 0; i < len; i += 4) {
  231. I915_WRITE(VLV_TVIDEO_DIP_DATA(intel_crtc->pipe), *data);
  232. data++;
  233. }
  234. /* Write every possible data byte to force correct ECC calculation. */
  235. for (; i < VIDEO_DIP_DATA_SIZE; i += 4)
  236. I915_WRITE(VLV_TVIDEO_DIP_DATA(intel_crtc->pipe), 0);
  237. mmiowb();
  238. val |= g4x_infoframe_enable(type);
  239. val &= ~VIDEO_DIP_FREQ_MASK;
  240. val |= VIDEO_DIP_FREQ_VSYNC;
  241. I915_WRITE(reg, val);
  242. POSTING_READ(reg);
  243. }
  244. static void hsw_write_infoframe(struct drm_encoder *encoder,
  245. enum hdmi_infoframe_type type,
  246. const uint8_t *frame, ssize_t len)
  247. {
  248. uint32_t *data = (uint32_t *)frame;
  249. struct drm_device *dev = encoder->dev;
  250. struct drm_i915_private *dev_priv = dev->dev_private;
  251. struct intel_crtc *intel_crtc = to_intel_crtc(encoder->crtc);
  252. u32 ctl_reg = HSW_TVIDEO_DIP_CTL(intel_crtc->config.cpu_transcoder);
  253. u32 data_reg;
  254. int i;
  255. u32 val = I915_READ(ctl_reg);
  256. data_reg = hsw_infoframe_data_reg(type,
  257. intel_crtc->config.cpu_transcoder);
  258. if (data_reg == 0)
  259. return;
  260. val &= ~hsw_infoframe_enable(type);
  261. I915_WRITE(ctl_reg, val);
  262. mmiowb();
  263. for (i = 0; i < len; i += 4) {
  264. I915_WRITE(data_reg + i, *data);
  265. data++;
  266. }
  267. /* Write every possible data byte to force correct ECC calculation. */
  268. for (; i < VIDEO_DIP_DATA_SIZE; i += 4)
  269. I915_WRITE(data_reg + i, 0);
  270. mmiowb();
  271. val |= hsw_infoframe_enable(type);
  272. I915_WRITE(ctl_reg, val);
  273. POSTING_READ(ctl_reg);
  274. }
  275. static void intel_set_infoframe(struct drm_encoder *encoder,
  276. struct dip_infoframe *frame)
  277. {
  278. struct intel_hdmi *intel_hdmi = enc_to_intel_hdmi(encoder);
  279. intel_dip_infoframe_csum(frame);
  280. intel_hdmi->write_infoframe(encoder, frame->type, (uint8_t *)frame,
  281. DIP_HEADER_SIZE + frame->len);
  282. }
  283. static void intel_hdmi_set_avi_infoframe(struct drm_encoder *encoder,
  284. struct drm_display_mode *adjusted_mode)
  285. {
  286. struct intel_hdmi *intel_hdmi = enc_to_intel_hdmi(encoder);
  287. struct intel_crtc *intel_crtc = to_intel_crtc(encoder->crtc);
  288. struct dip_infoframe avi_if = {
  289. .type = DIP_TYPE_AVI,
  290. .ver = DIP_VERSION_AVI,
  291. .len = DIP_LEN_AVI,
  292. };
  293. if (adjusted_mode->flags & DRM_MODE_FLAG_DBLCLK)
  294. avi_if.body.avi.YQ_CN_PR |= DIP_AVI_PR_2;
  295. if (intel_hdmi->rgb_quant_range_selectable) {
  296. if (intel_crtc->config.limited_color_range)
  297. avi_if.body.avi.ITC_EC_Q_SC |= DIP_AVI_RGB_QUANT_RANGE_LIMITED;
  298. else
  299. avi_if.body.avi.ITC_EC_Q_SC |= DIP_AVI_RGB_QUANT_RANGE_FULL;
  300. }
  301. avi_if.body.avi.VIC = drm_match_cea_mode(adjusted_mode);
  302. intel_set_infoframe(encoder, &avi_if);
  303. }
  304. static void intel_hdmi_set_spd_infoframe(struct drm_encoder *encoder)
  305. {
  306. struct dip_infoframe spd_if;
  307. memset(&spd_if, 0, sizeof(spd_if));
  308. spd_if.type = DIP_TYPE_SPD;
  309. spd_if.ver = DIP_VERSION_SPD;
  310. spd_if.len = DIP_LEN_SPD;
  311. strcpy(spd_if.body.spd.vn, "Intel");
  312. strcpy(spd_if.body.spd.pd, "Integrated gfx");
  313. spd_if.body.spd.sdi = DIP_SPD_PC;
  314. intel_set_infoframe(encoder, &spd_if);
  315. }
  316. static void g4x_set_infoframes(struct drm_encoder *encoder,
  317. struct drm_display_mode *adjusted_mode)
  318. {
  319. struct drm_i915_private *dev_priv = encoder->dev->dev_private;
  320. struct intel_digital_port *intel_dig_port = enc_to_dig_port(encoder);
  321. struct intel_hdmi *intel_hdmi = &intel_dig_port->hdmi;
  322. u32 reg = VIDEO_DIP_CTL;
  323. u32 val = I915_READ(reg);
  324. u32 port;
  325. assert_hdmi_port_disabled(intel_hdmi);
  326. /* If the registers were not initialized yet, they might be zeroes,
  327. * which means we're selecting the AVI DIP and we're setting its
  328. * frequency to once. This seems to really confuse the HW and make
  329. * things stop working (the register spec says the AVI always needs to
  330. * be sent every VSync). So here we avoid writing to the register more
  331. * than we need and also explicitly select the AVI DIP and explicitly
  332. * set its frequency to every VSync. Avoiding to write it twice seems to
  333. * be enough to solve the problem, but being defensive shouldn't hurt us
  334. * either. */
  335. val |= VIDEO_DIP_SELECT_AVI | VIDEO_DIP_FREQ_VSYNC;
  336. if (!intel_hdmi->has_hdmi_sink) {
  337. if (!(val & VIDEO_DIP_ENABLE))
  338. return;
  339. val &= ~VIDEO_DIP_ENABLE;
  340. I915_WRITE(reg, val);
  341. POSTING_READ(reg);
  342. return;
  343. }
  344. switch (intel_dig_port->port) {
  345. case PORT_B:
  346. port = VIDEO_DIP_PORT_B;
  347. break;
  348. case PORT_C:
  349. port = VIDEO_DIP_PORT_C;
  350. break;
  351. default:
  352. BUG();
  353. return;
  354. }
  355. if (port != (val & VIDEO_DIP_PORT_MASK)) {
  356. if (val & VIDEO_DIP_ENABLE) {
  357. val &= ~VIDEO_DIP_ENABLE;
  358. I915_WRITE(reg, val);
  359. POSTING_READ(reg);
  360. }
  361. val &= ~VIDEO_DIP_PORT_MASK;
  362. val |= port;
  363. }
  364. val |= VIDEO_DIP_ENABLE;
  365. val &= ~VIDEO_DIP_ENABLE_VENDOR;
  366. I915_WRITE(reg, val);
  367. POSTING_READ(reg);
  368. intel_hdmi_set_avi_infoframe(encoder, adjusted_mode);
  369. intel_hdmi_set_spd_infoframe(encoder);
  370. }
  371. static void ibx_set_infoframes(struct drm_encoder *encoder,
  372. struct drm_display_mode *adjusted_mode)
  373. {
  374. struct drm_i915_private *dev_priv = encoder->dev->dev_private;
  375. struct intel_crtc *intel_crtc = to_intel_crtc(encoder->crtc);
  376. struct intel_digital_port *intel_dig_port = enc_to_dig_port(encoder);
  377. struct intel_hdmi *intel_hdmi = &intel_dig_port->hdmi;
  378. u32 reg = TVIDEO_DIP_CTL(intel_crtc->pipe);
  379. u32 val = I915_READ(reg);
  380. u32 port;
  381. assert_hdmi_port_disabled(intel_hdmi);
  382. /* See the big comment in g4x_set_infoframes() */
  383. val |= VIDEO_DIP_SELECT_AVI | VIDEO_DIP_FREQ_VSYNC;
  384. if (!intel_hdmi->has_hdmi_sink) {
  385. if (!(val & VIDEO_DIP_ENABLE))
  386. return;
  387. val &= ~VIDEO_DIP_ENABLE;
  388. I915_WRITE(reg, val);
  389. POSTING_READ(reg);
  390. return;
  391. }
  392. switch (intel_dig_port->port) {
  393. case PORT_B:
  394. port = VIDEO_DIP_PORT_B;
  395. break;
  396. case PORT_C:
  397. port = VIDEO_DIP_PORT_C;
  398. break;
  399. case PORT_D:
  400. port = VIDEO_DIP_PORT_D;
  401. break;
  402. default:
  403. BUG();
  404. return;
  405. }
  406. if (port != (val & VIDEO_DIP_PORT_MASK)) {
  407. if (val & VIDEO_DIP_ENABLE) {
  408. val &= ~VIDEO_DIP_ENABLE;
  409. I915_WRITE(reg, val);
  410. POSTING_READ(reg);
  411. }
  412. val &= ~VIDEO_DIP_PORT_MASK;
  413. val |= port;
  414. }
  415. val |= VIDEO_DIP_ENABLE;
  416. val &= ~(VIDEO_DIP_ENABLE_VENDOR | VIDEO_DIP_ENABLE_GAMUT |
  417. VIDEO_DIP_ENABLE_GCP);
  418. I915_WRITE(reg, val);
  419. POSTING_READ(reg);
  420. intel_hdmi_set_avi_infoframe(encoder, adjusted_mode);
  421. intel_hdmi_set_spd_infoframe(encoder);
  422. }
  423. static void cpt_set_infoframes(struct drm_encoder *encoder,
  424. struct drm_display_mode *adjusted_mode)
  425. {
  426. struct drm_i915_private *dev_priv = encoder->dev->dev_private;
  427. struct intel_crtc *intel_crtc = to_intel_crtc(encoder->crtc);
  428. struct intel_hdmi *intel_hdmi = enc_to_intel_hdmi(encoder);
  429. u32 reg = TVIDEO_DIP_CTL(intel_crtc->pipe);
  430. u32 val = I915_READ(reg);
  431. assert_hdmi_port_disabled(intel_hdmi);
  432. /* See the big comment in g4x_set_infoframes() */
  433. val |= VIDEO_DIP_SELECT_AVI | VIDEO_DIP_FREQ_VSYNC;
  434. if (!intel_hdmi->has_hdmi_sink) {
  435. if (!(val & VIDEO_DIP_ENABLE))
  436. return;
  437. val &= ~(VIDEO_DIP_ENABLE | VIDEO_DIP_ENABLE_AVI);
  438. I915_WRITE(reg, val);
  439. POSTING_READ(reg);
  440. return;
  441. }
  442. /* Set both together, unset both together: see the spec. */
  443. val |= VIDEO_DIP_ENABLE | VIDEO_DIP_ENABLE_AVI;
  444. val &= ~(VIDEO_DIP_ENABLE_VENDOR | VIDEO_DIP_ENABLE_GAMUT |
  445. VIDEO_DIP_ENABLE_GCP);
  446. I915_WRITE(reg, val);
  447. POSTING_READ(reg);
  448. intel_hdmi_set_avi_infoframe(encoder, adjusted_mode);
  449. intel_hdmi_set_spd_infoframe(encoder);
  450. }
  451. static void vlv_set_infoframes(struct drm_encoder *encoder,
  452. struct drm_display_mode *adjusted_mode)
  453. {
  454. struct drm_i915_private *dev_priv = encoder->dev->dev_private;
  455. struct intel_crtc *intel_crtc = to_intel_crtc(encoder->crtc);
  456. struct intel_hdmi *intel_hdmi = enc_to_intel_hdmi(encoder);
  457. u32 reg = VLV_TVIDEO_DIP_CTL(intel_crtc->pipe);
  458. u32 val = I915_READ(reg);
  459. assert_hdmi_port_disabled(intel_hdmi);
  460. /* See the big comment in g4x_set_infoframes() */
  461. val |= VIDEO_DIP_SELECT_AVI | VIDEO_DIP_FREQ_VSYNC;
  462. if (!intel_hdmi->has_hdmi_sink) {
  463. if (!(val & VIDEO_DIP_ENABLE))
  464. return;
  465. val &= ~VIDEO_DIP_ENABLE;
  466. I915_WRITE(reg, val);
  467. POSTING_READ(reg);
  468. return;
  469. }
  470. val |= VIDEO_DIP_ENABLE;
  471. val &= ~(VIDEO_DIP_ENABLE_VENDOR | VIDEO_DIP_ENABLE_GAMUT |
  472. VIDEO_DIP_ENABLE_GCP);
  473. I915_WRITE(reg, val);
  474. POSTING_READ(reg);
  475. intel_hdmi_set_avi_infoframe(encoder, adjusted_mode);
  476. intel_hdmi_set_spd_infoframe(encoder);
  477. }
  478. static void hsw_set_infoframes(struct drm_encoder *encoder,
  479. struct drm_display_mode *adjusted_mode)
  480. {
  481. struct drm_i915_private *dev_priv = encoder->dev->dev_private;
  482. struct intel_crtc *intel_crtc = to_intel_crtc(encoder->crtc);
  483. struct intel_hdmi *intel_hdmi = enc_to_intel_hdmi(encoder);
  484. u32 reg = HSW_TVIDEO_DIP_CTL(intel_crtc->config.cpu_transcoder);
  485. u32 val = I915_READ(reg);
  486. assert_hdmi_port_disabled(intel_hdmi);
  487. if (!intel_hdmi->has_hdmi_sink) {
  488. I915_WRITE(reg, 0);
  489. POSTING_READ(reg);
  490. return;
  491. }
  492. val &= ~(VIDEO_DIP_ENABLE_VSC_HSW | VIDEO_DIP_ENABLE_GCP_HSW |
  493. VIDEO_DIP_ENABLE_VS_HSW | VIDEO_DIP_ENABLE_GMP_HSW);
  494. I915_WRITE(reg, val);
  495. POSTING_READ(reg);
  496. intel_hdmi_set_avi_infoframe(encoder, adjusted_mode);
  497. intel_hdmi_set_spd_infoframe(encoder);
  498. }
  499. static void intel_hdmi_mode_set(struct intel_encoder *encoder)
  500. {
  501. struct drm_device *dev = encoder->base.dev;
  502. struct drm_i915_private *dev_priv = dev->dev_private;
  503. struct intel_crtc *crtc = to_intel_crtc(encoder->base.crtc);
  504. struct intel_hdmi *intel_hdmi = enc_to_intel_hdmi(&encoder->base);
  505. struct drm_display_mode *adjusted_mode = &crtc->config.adjusted_mode;
  506. u32 hdmi_val;
  507. hdmi_val = SDVO_ENCODING_HDMI;
  508. if (!HAS_PCH_SPLIT(dev))
  509. hdmi_val |= intel_hdmi->color_range;
  510. if (adjusted_mode->flags & DRM_MODE_FLAG_PVSYNC)
  511. hdmi_val |= SDVO_VSYNC_ACTIVE_HIGH;
  512. if (adjusted_mode->flags & DRM_MODE_FLAG_PHSYNC)
  513. hdmi_val |= SDVO_HSYNC_ACTIVE_HIGH;
  514. if (crtc->config.pipe_bpp > 24)
  515. hdmi_val |= HDMI_COLOR_FORMAT_12bpc;
  516. else
  517. hdmi_val |= SDVO_COLOR_FORMAT_8bpc;
  518. /* Required on CPT */
  519. if (intel_hdmi->has_hdmi_sink && HAS_PCH_CPT(dev))
  520. hdmi_val |= HDMI_MODE_SELECT_HDMI;
  521. if (intel_hdmi->has_audio) {
  522. DRM_DEBUG_DRIVER("Enabling HDMI audio on pipe %c\n",
  523. pipe_name(crtc->pipe));
  524. hdmi_val |= SDVO_AUDIO_ENABLE;
  525. hdmi_val |= HDMI_MODE_SELECT_HDMI;
  526. intel_write_eld(&encoder->base, adjusted_mode);
  527. }
  528. if (HAS_PCH_CPT(dev))
  529. hdmi_val |= SDVO_PIPE_SEL_CPT(crtc->pipe);
  530. else
  531. hdmi_val |= SDVO_PIPE_SEL(crtc->pipe);
  532. I915_WRITE(intel_hdmi->hdmi_reg, hdmi_val);
  533. POSTING_READ(intel_hdmi->hdmi_reg);
  534. intel_hdmi->set_infoframes(&encoder->base, adjusted_mode);
  535. }
  536. static bool intel_hdmi_get_hw_state(struct intel_encoder *encoder,
  537. enum pipe *pipe)
  538. {
  539. struct drm_device *dev = encoder->base.dev;
  540. struct drm_i915_private *dev_priv = dev->dev_private;
  541. struct intel_hdmi *intel_hdmi = enc_to_intel_hdmi(&encoder->base);
  542. u32 tmp;
  543. tmp = I915_READ(intel_hdmi->hdmi_reg);
  544. if (!(tmp & SDVO_ENABLE))
  545. return false;
  546. if (HAS_PCH_CPT(dev))
  547. *pipe = PORT_TO_PIPE_CPT(tmp);
  548. else
  549. *pipe = PORT_TO_PIPE(tmp);
  550. return true;
  551. }
  552. static void intel_hdmi_get_config(struct intel_encoder *encoder,
  553. struct intel_crtc_config *pipe_config)
  554. {
  555. struct intel_hdmi *intel_hdmi = enc_to_intel_hdmi(&encoder->base);
  556. struct drm_i915_private *dev_priv = encoder->base.dev->dev_private;
  557. u32 tmp, flags = 0;
  558. tmp = I915_READ(intel_hdmi->hdmi_reg);
  559. if (tmp & SDVO_HSYNC_ACTIVE_HIGH)
  560. flags |= DRM_MODE_FLAG_PHSYNC;
  561. else
  562. flags |= DRM_MODE_FLAG_NHSYNC;
  563. if (tmp & SDVO_VSYNC_ACTIVE_HIGH)
  564. flags |= DRM_MODE_FLAG_PVSYNC;
  565. else
  566. flags |= DRM_MODE_FLAG_NVSYNC;
  567. pipe_config->adjusted_mode.flags |= flags;
  568. }
  569. static void intel_enable_hdmi(struct intel_encoder *encoder)
  570. {
  571. struct drm_device *dev = encoder->base.dev;
  572. struct drm_i915_private *dev_priv = dev->dev_private;
  573. struct intel_crtc *intel_crtc = to_intel_crtc(encoder->base.crtc);
  574. struct intel_hdmi *intel_hdmi = enc_to_intel_hdmi(&encoder->base);
  575. u32 temp;
  576. u32 enable_bits = SDVO_ENABLE;
  577. if (intel_hdmi->has_audio)
  578. enable_bits |= SDVO_AUDIO_ENABLE;
  579. temp = I915_READ(intel_hdmi->hdmi_reg);
  580. /* HW workaround for IBX, we need to move the port to transcoder A
  581. * before disabling it, so restore the transcoder select bit here. */
  582. if (HAS_PCH_IBX(dev))
  583. enable_bits |= SDVO_PIPE_SEL(intel_crtc->pipe);
  584. /* HW workaround, need to toggle enable bit off and on for 12bpc, but
  585. * we do this anyway which shows more stable in testing.
  586. */
  587. if (HAS_PCH_SPLIT(dev)) {
  588. I915_WRITE(intel_hdmi->hdmi_reg, temp & ~SDVO_ENABLE);
  589. POSTING_READ(intel_hdmi->hdmi_reg);
  590. }
  591. temp |= enable_bits;
  592. I915_WRITE(intel_hdmi->hdmi_reg, temp);
  593. POSTING_READ(intel_hdmi->hdmi_reg);
  594. /* HW workaround, need to write this twice for issue that may result
  595. * in first write getting masked.
  596. */
  597. if (HAS_PCH_SPLIT(dev)) {
  598. I915_WRITE(intel_hdmi->hdmi_reg, temp);
  599. POSTING_READ(intel_hdmi->hdmi_reg);
  600. }
  601. }
  602. static void vlv_enable_hdmi(struct intel_encoder *encoder)
  603. {
  604. }
  605. static void intel_disable_hdmi(struct intel_encoder *encoder)
  606. {
  607. struct drm_device *dev = encoder->base.dev;
  608. struct drm_i915_private *dev_priv = dev->dev_private;
  609. struct intel_hdmi *intel_hdmi = enc_to_intel_hdmi(&encoder->base);
  610. u32 temp;
  611. u32 enable_bits = SDVO_ENABLE | SDVO_AUDIO_ENABLE;
  612. temp = I915_READ(intel_hdmi->hdmi_reg);
  613. /* HW workaround for IBX, we need to move the port to transcoder A
  614. * before disabling it. */
  615. if (HAS_PCH_IBX(dev)) {
  616. struct drm_crtc *crtc = encoder->base.crtc;
  617. int pipe = crtc ? to_intel_crtc(crtc)->pipe : -1;
  618. if (temp & SDVO_PIPE_B_SELECT) {
  619. temp &= ~SDVO_PIPE_B_SELECT;
  620. I915_WRITE(intel_hdmi->hdmi_reg, temp);
  621. POSTING_READ(intel_hdmi->hdmi_reg);
  622. /* Again we need to write this twice. */
  623. I915_WRITE(intel_hdmi->hdmi_reg, temp);
  624. POSTING_READ(intel_hdmi->hdmi_reg);
  625. /* Transcoder selection bits only update
  626. * effectively on vblank. */
  627. if (crtc)
  628. intel_wait_for_vblank(dev, pipe);
  629. else
  630. msleep(50);
  631. }
  632. }
  633. /* HW workaround, need to toggle enable bit off and on for 12bpc, but
  634. * we do this anyway which shows more stable in testing.
  635. */
  636. if (HAS_PCH_SPLIT(dev)) {
  637. I915_WRITE(intel_hdmi->hdmi_reg, temp & ~SDVO_ENABLE);
  638. POSTING_READ(intel_hdmi->hdmi_reg);
  639. }
  640. temp &= ~enable_bits;
  641. I915_WRITE(intel_hdmi->hdmi_reg, temp);
  642. POSTING_READ(intel_hdmi->hdmi_reg);
  643. /* HW workaround, need to write this twice for issue that may result
  644. * in first write getting masked.
  645. */
  646. if (HAS_PCH_SPLIT(dev)) {
  647. I915_WRITE(intel_hdmi->hdmi_reg, temp);
  648. POSTING_READ(intel_hdmi->hdmi_reg);
  649. }
  650. }
  651. static int intel_hdmi_mode_valid(struct drm_connector *connector,
  652. struct drm_display_mode *mode)
  653. {
  654. if (mode->clock > 165000)
  655. return MODE_CLOCK_HIGH;
  656. if (mode->clock < 20000)
  657. return MODE_CLOCK_LOW;
  658. if (mode->flags & DRM_MODE_FLAG_DBLSCAN)
  659. return MODE_NO_DBLESCAN;
  660. return MODE_OK;
  661. }
  662. bool intel_hdmi_compute_config(struct intel_encoder *encoder,
  663. struct intel_crtc_config *pipe_config)
  664. {
  665. struct intel_hdmi *intel_hdmi = enc_to_intel_hdmi(&encoder->base);
  666. struct drm_device *dev = encoder->base.dev;
  667. struct drm_display_mode *adjusted_mode = &pipe_config->adjusted_mode;
  668. int clock_12bpc = pipe_config->requested_mode.clock * 3 / 2;
  669. int desired_bpp;
  670. if (intel_hdmi->color_range_auto) {
  671. /* See CEA-861-E - 5.1 Default Encoding Parameters */
  672. if (intel_hdmi->has_hdmi_sink &&
  673. drm_match_cea_mode(adjusted_mode) > 1)
  674. intel_hdmi->color_range = HDMI_COLOR_RANGE_16_235;
  675. else
  676. intel_hdmi->color_range = 0;
  677. }
  678. if (intel_hdmi->color_range)
  679. pipe_config->limited_color_range = true;
  680. if (HAS_PCH_SPLIT(dev) && !HAS_DDI(dev))
  681. pipe_config->has_pch_encoder = true;
  682. /*
  683. * HDMI is either 12 or 8, so if the display lets 10bpc sneak
  684. * through, clamp it down. Note that g4x/vlv don't support 12bpc hdmi
  685. * outputs. We also need to check that the higher clock still fits
  686. * within limits.
  687. */
  688. if (pipe_config->pipe_bpp > 8*3 && clock_12bpc <= 225000
  689. && HAS_PCH_SPLIT(dev)) {
  690. DRM_DEBUG_KMS("picking bpc to 12 for HDMI output\n");
  691. desired_bpp = 12*3;
  692. /* Need to adjust the port link by 1.5x for 12bpc. */
  693. pipe_config->port_clock = clock_12bpc;
  694. } else {
  695. DRM_DEBUG_KMS("picking bpc to 8 for HDMI output\n");
  696. desired_bpp = 8*3;
  697. }
  698. if (!pipe_config->bw_constrained) {
  699. DRM_DEBUG_KMS("forcing pipe bpc to %i for HDMI\n", desired_bpp);
  700. pipe_config->pipe_bpp = desired_bpp;
  701. }
  702. if (adjusted_mode->clock > 225000) {
  703. DRM_DEBUG_KMS("too high HDMI clock, rejecting mode\n");
  704. return false;
  705. }
  706. return true;
  707. }
  708. static enum drm_connector_status
  709. intel_hdmi_detect(struct drm_connector *connector, bool force)
  710. {
  711. struct drm_device *dev = connector->dev;
  712. struct intel_hdmi *intel_hdmi = intel_attached_hdmi(connector);
  713. struct intel_digital_port *intel_dig_port =
  714. hdmi_to_dig_port(intel_hdmi);
  715. struct intel_encoder *intel_encoder = &intel_dig_port->base;
  716. struct drm_i915_private *dev_priv = dev->dev_private;
  717. struct edid *edid;
  718. enum drm_connector_status status = connector_status_disconnected;
  719. DRM_DEBUG_KMS("[CONNECTOR:%d:%s]\n",
  720. connector->base.id, drm_get_connector_name(connector));
  721. intel_hdmi->has_hdmi_sink = false;
  722. intel_hdmi->has_audio = false;
  723. intel_hdmi->rgb_quant_range_selectable = false;
  724. edid = drm_get_edid(connector,
  725. intel_gmbus_get_adapter(dev_priv,
  726. intel_hdmi->ddc_bus));
  727. if (edid) {
  728. if (edid->input & DRM_EDID_INPUT_DIGITAL) {
  729. status = connector_status_connected;
  730. if (intel_hdmi->force_audio != HDMI_AUDIO_OFF_DVI)
  731. intel_hdmi->has_hdmi_sink =
  732. drm_detect_hdmi_monitor(edid);
  733. intel_hdmi->has_audio = drm_detect_monitor_audio(edid);
  734. intel_hdmi->rgb_quant_range_selectable =
  735. drm_rgb_quant_range_selectable(edid);
  736. }
  737. kfree(edid);
  738. }
  739. if (status == connector_status_connected) {
  740. if (intel_hdmi->force_audio != HDMI_AUDIO_AUTO)
  741. intel_hdmi->has_audio =
  742. (intel_hdmi->force_audio == HDMI_AUDIO_ON);
  743. intel_encoder->type = INTEL_OUTPUT_HDMI;
  744. }
  745. return status;
  746. }
  747. static int intel_hdmi_get_modes(struct drm_connector *connector)
  748. {
  749. struct intel_hdmi *intel_hdmi = intel_attached_hdmi(connector);
  750. struct drm_i915_private *dev_priv = connector->dev->dev_private;
  751. /* We should parse the EDID data and find out if it's an HDMI sink so
  752. * we can send audio to it.
  753. */
  754. return intel_ddc_get_modes(connector,
  755. intel_gmbus_get_adapter(dev_priv,
  756. intel_hdmi->ddc_bus));
  757. }
  758. static bool
  759. intel_hdmi_detect_audio(struct drm_connector *connector)
  760. {
  761. struct intel_hdmi *intel_hdmi = intel_attached_hdmi(connector);
  762. struct drm_i915_private *dev_priv = connector->dev->dev_private;
  763. struct edid *edid;
  764. bool has_audio = false;
  765. edid = drm_get_edid(connector,
  766. intel_gmbus_get_adapter(dev_priv,
  767. intel_hdmi->ddc_bus));
  768. if (edid) {
  769. if (edid->input & DRM_EDID_INPUT_DIGITAL)
  770. has_audio = drm_detect_monitor_audio(edid);
  771. kfree(edid);
  772. }
  773. return has_audio;
  774. }
  775. static int
  776. intel_hdmi_set_property(struct drm_connector *connector,
  777. struct drm_property *property,
  778. uint64_t val)
  779. {
  780. struct intel_hdmi *intel_hdmi = intel_attached_hdmi(connector);
  781. struct intel_digital_port *intel_dig_port =
  782. hdmi_to_dig_port(intel_hdmi);
  783. struct drm_i915_private *dev_priv = connector->dev->dev_private;
  784. int ret;
  785. ret = drm_object_property_set_value(&connector->base, property, val);
  786. if (ret)
  787. return ret;
  788. if (property == dev_priv->force_audio_property) {
  789. enum hdmi_force_audio i = val;
  790. bool has_audio;
  791. if (i == intel_hdmi->force_audio)
  792. return 0;
  793. intel_hdmi->force_audio = i;
  794. if (i == HDMI_AUDIO_AUTO)
  795. has_audio = intel_hdmi_detect_audio(connector);
  796. else
  797. has_audio = (i == HDMI_AUDIO_ON);
  798. if (i == HDMI_AUDIO_OFF_DVI)
  799. intel_hdmi->has_hdmi_sink = 0;
  800. intel_hdmi->has_audio = has_audio;
  801. goto done;
  802. }
  803. if (property == dev_priv->broadcast_rgb_property) {
  804. bool old_auto = intel_hdmi->color_range_auto;
  805. uint32_t old_range = intel_hdmi->color_range;
  806. switch (val) {
  807. case INTEL_BROADCAST_RGB_AUTO:
  808. intel_hdmi->color_range_auto = true;
  809. break;
  810. case INTEL_BROADCAST_RGB_FULL:
  811. intel_hdmi->color_range_auto = false;
  812. intel_hdmi->color_range = 0;
  813. break;
  814. case INTEL_BROADCAST_RGB_LIMITED:
  815. intel_hdmi->color_range_auto = false;
  816. intel_hdmi->color_range = HDMI_COLOR_RANGE_16_235;
  817. break;
  818. default:
  819. return -EINVAL;
  820. }
  821. if (old_auto == intel_hdmi->color_range_auto &&
  822. old_range == intel_hdmi->color_range)
  823. return 0;
  824. goto done;
  825. }
  826. return -EINVAL;
  827. done:
  828. if (intel_dig_port->base.base.crtc)
  829. intel_crtc_restore_mode(intel_dig_port->base.base.crtc);
  830. return 0;
  831. }
  832. static void intel_hdmi_pre_enable(struct intel_encoder *encoder)
  833. {
  834. struct intel_digital_port *dport = enc_to_dig_port(&encoder->base);
  835. struct drm_device *dev = encoder->base.dev;
  836. struct drm_i915_private *dev_priv = dev->dev_private;
  837. struct intel_crtc *intel_crtc =
  838. to_intel_crtc(encoder->base.crtc);
  839. int port = vlv_dport_to_channel(dport);
  840. int pipe = intel_crtc->pipe;
  841. u32 val;
  842. if (!IS_VALLEYVIEW(dev))
  843. return;
  844. /* Enable clock channels for this port */
  845. mutex_lock(&dev_priv->dpio_lock);
  846. val = vlv_dpio_read(dev_priv, DPIO_DATA_LANE_A(port));
  847. val = 0;
  848. if (pipe)
  849. val |= (1<<21);
  850. else
  851. val &= ~(1<<21);
  852. val |= 0x001000c4;
  853. vlv_dpio_write(dev_priv, DPIO_DATA_CHANNEL(port), val);
  854. /* HDMI 1.0V-2dB */
  855. vlv_dpio_write(dev_priv, DPIO_TX_OCALINIT(port), 0);
  856. vlv_dpio_write(dev_priv, DPIO_TX_SWING_CTL4(port),
  857. 0x2b245f5f);
  858. vlv_dpio_write(dev_priv, DPIO_TX_SWING_CTL2(port),
  859. 0x5578b83a);
  860. vlv_dpio_write(dev_priv, DPIO_TX_SWING_CTL3(port),
  861. 0x0c782040);
  862. vlv_dpio_write(dev_priv, DPIO_TX3_SWING_CTL4(port),
  863. 0x2b247878);
  864. vlv_dpio_write(dev_priv, DPIO_PCS_STAGGER0(port), 0x00030000);
  865. vlv_dpio_write(dev_priv, DPIO_PCS_CTL_OVER1(port),
  866. 0x00002000);
  867. vlv_dpio_write(dev_priv, DPIO_TX_OCALINIT(port),
  868. DPIO_TX_OCALINIT_EN);
  869. /* Program lane clock */
  870. vlv_dpio_write(dev_priv, DPIO_PCS_CLOCKBUF0(port),
  871. 0x00760018);
  872. vlv_dpio_write(dev_priv, DPIO_PCS_CLOCKBUF8(port),
  873. 0x00400888);
  874. mutex_unlock(&dev_priv->dpio_lock);
  875. intel_enable_hdmi(encoder);
  876. vlv_wait_port_ready(dev_priv, port);
  877. }
  878. static void intel_hdmi_pre_pll_enable(struct intel_encoder *encoder)
  879. {
  880. struct intel_digital_port *dport = enc_to_dig_port(&encoder->base);
  881. struct drm_device *dev = encoder->base.dev;
  882. struct drm_i915_private *dev_priv = dev->dev_private;
  883. int port = vlv_dport_to_channel(dport);
  884. if (!IS_VALLEYVIEW(dev))
  885. return;
  886. /* Program Tx lane resets to default */
  887. mutex_lock(&dev_priv->dpio_lock);
  888. vlv_dpio_write(dev_priv, DPIO_PCS_TX(port),
  889. DPIO_PCS_TX_LANE2_RESET |
  890. DPIO_PCS_TX_LANE1_RESET);
  891. vlv_dpio_write(dev_priv, DPIO_PCS_CLK(port),
  892. DPIO_PCS_CLK_CRI_RXEB_EIOS_EN |
  893. DPIO_PCS_CLK_CRI_RXDIGFILTSG_EN |
  894. (1<<DPIO_PCS_CLK_DATAWIDTH_SHIFT) |
  895. DPIO_PCS_CLK_SOFT_RESET);
  896. /* Fix up inter-pair skew failure */
  897. vlv_dpio_write(dev_priv, DPIO_PCS_STAGGER1(port), 0x00750f00);
  898. vlv_dpio_write(dev_priv, DPIO_TX_CTL(port), 0x00001500);
  899. vlv_dpio_write(dev_priv, DPIO_TX_LANE(port), 0x40400000);
  900. vlv_dpio_write(dev_priv, DPIO_PCS_CTL_OVER1(port),
  901. 0x00002000);
  902. vlv_dpio_write(dev_priv, DPIO_TX_OCALINIT(port),
  903. DPIO_TX_OCALINIT_EN);
  904. mutex_unlock(&dev_priv->dpio_lock);
  905. }
  906. static void intel_hdmi_post_disable(struct intel_encoder *encoder)
  907. {
  908. struct intel_digital_port *dport = enc_to_dig_port(&encoder->base);
  909. struct drm_i915_private *dev_priv = encoder->base.dev->dev_private;
  910. int port = vlv_dport_to_channel(dport);
  911. /* Reset lanes to avoid HDMI flicker (VLV w/a) */
  912. mutex_lock(&dev_priv->dpio_lock);
  913. vlv_dpio_write(dev_priv, DPIO_PCS_TX(port), 0x00000000);
  914. vlv_dpio_write(dev_priv, DPIO_PCS_CLK(port), 0x00e00060);
  915. mutex_unlock(&dev_priv->dpio_lock);
  916. }
  917. static void intel_hdmi_destroy(struct drm_connector *connector)
  918. {
  919. drm_sysfs_connector_remove(connector);
  920. drm_connector_cleanup(connector);
  921. kfree(connector);
  922. }
  923. static const struct drm_connector_funcs intel_hdmi_connector_funcs = {
  924. .dpms = intel_connector_dpms,
  925. .detect = intel_hdmi_detect,
  926. .fill_modes = drm_helper_probe_single_connector_modes,
  927. .set_property = intel_hdmi_set_property,
  928. .destroy = intel_hdmi_destroy,
  929. };
  930. static const struct drm_connector_helper_funcs intel_hdmi_connector_helper_funcs = {
  931. .get_modes = intel_hdmi_get_modes,
  932. .mode_valid = intel_hdmi_mode_valid,
  933. .best_encoder = intel_best_encoder,
  934. };
  935. static const struct drm_encoder_funcs intel_hdmi_enc_funcs = {
  936. .destroy = intel_encoder_destroy,
  937. };
  938. static void
  939. intel_hdmi_add_properties(struct intel_hdmi *intel_hdmi, struct drm_connector *connector)
  940. {
  941. intel_attach_force_audio_property(connector);
  942. intel_attach_broadcast_rgb_property(connector);
  943. intel_hdmi->color_range_auto = true;
  944. }
  945. void intel_hdmi_init_connector(struct intel_digital_port *intel_dig_port,
  946. struct intel_connector *intel_connector)
  947. {
  948. struct drm_connector *connector = &intel_connector->base;
  949. struct intel_hdmi *intel_hdmi = &intel_dig_port->hdmi;
  950. struct intel_encoder *intel_encoder = &intel_dig_port->base;
  951. struct drm_device *dev = intel_encoder->base.dev;
  952. struct drm_i915_private *dev_priv = dev->dev_private;
  953. enum port port = intel_dig_port->port;
  954. drm_connector_init(dev, connector, &intel_hdmi_connector_funcs,
  955. DRM_MODE_CONNECTOR_HDMIA);
  956. drm_connector_helper_add(connector, &intel_hdmi_connector_helper_funcs);
  957. connector->interlace_allowed = 1;
  958. connector->doublescan_allowed = 0;
  959. switch (port) {
  960. case PORT_B:
  961. intel_hdmi->ddc_bus = GMBUS_PORT_DPB;
  962. intel_encoder->hpd_pin = HPD_PORT_B;
  963. break;
  964. case PORT_C:
  965. intel_hdmi->ddc_bus = GMBUS_PORT_DPC;
  966. intel_encoder->hpd_pin = HPD_PORT_C;
  967. break;
  968. case PORT_D:
  969. intel_hdmi->ddc_bus = GMBUS_PORT_DPD;
  970. intel_encoder->hpd_pin = HPD_PORT_D;
  971. break;
  972. case PORT_A:
  973. intel_encoder->hpd_pin = HPD_PORT_A;
  974. /* Internal port only for eDP. */
  975. default:
  976. BUG();
  977. }
  978. if (IS_VALLEYVIEW(dev)) {
  979. intel_hdmi->write_infoframe = vlv_write_infoframe;
  980. intel_hdmi->set_infoframes = vlv_set_infoframes;
  981. } else if (!HAS_PCH_SPLIT(dev)) {
  982. intel_hdmi->write_infoframe = g4x_write_infoframe;
  983. intel_hdmi->set_infoframes = g4x_set_infoframes;
  984. } else if (HAS_DDI(dev)) {
  985. intel_hdmi->write_infoframe = hsw_write_infoframe;
  986. intel_hdmi->set_infoframes = hsw_set_infoframes;
  987. } else if (HAS_PCH_IBX(dev)) {
  988. intel_hdmi->write_infoframe = ibx_write_infoframe;
  989. intel_hdmi->set_infoframes = ibx_set_infoframes;
  990. } else {
  991. intel_hdmi->write_infoframe = cpt_write_infoframe;
  992. intel_hdmi->set_infoframes = cpt_set_infoframes;
  993. }
  994. if (HAS_DDI(dev))
  995. intel_connector->get_hw_state = intel_ddi_connector_get_hw_state;
  996. else
  997. intel_connector->get_hw_state = intel_connector_get_hw_state;
  998. intel_hdmi_add_properties(intel_hdmi, connector);
  999. intel_connector_attach_encoder(intel_connector, intel_encoder);
  1000. drm_sysfs_connector_add(connector);
  1001. /* For G4X desktop chip, PEG_BAND_GAP_DATA 3:0 must first be written
  1002. * 0xd. Failure to do so will result in spurious interrupts being
  1003. * generated on the port when a cable is not attached.
  1004. */
  1005. if (IS_G4X(dev) && !IS_GM45(dev)) {
  1006. u32 temp = I915_READ(PEG_BAND_GAP_DATA);
  1007. I915_WRITE(PEG_BAND_GAP_DATA, (temp & ~0xf) | 0xd);
  1008. }
  1009. }
  1010. void intel_hdmi_init(struct drm_device *dev, int hdmi_reg, enum port port)
  1011. {
  1012. struct intel_digital_port *intel_dig_port;
  1013. struct intel_encoder *intel_encoder;
  1014. struct drm_encoder *encoder;
  1015. struct intel_connector *intel_connector;
  1016. intel_dig_port = kzalloc(sizeof(struct intel_digital_port), GFP_KERNEL);
  1017. if (!intel_dig_port)
  1018. return;
  1019. intel_connector = kzalloc(sizeof(struct intel_connector), GFP_KERNEL);
  1020. if (!intel_connector) {
  1021. kfree(intel_dig_port);
  1022. return;
  1023. }
  1024. intel_encoder = &intel_dig_port->base;
  1025. encoder = &intel_encoder->base;
  1026. drm_encoder_init(dev, &intel_encoder->base, &intel_hdmi_enc_funcs,
  1027. DRM_MODE_ENCODER_TMDS);
  1028. intel_encoder->compute_config = intel_hdmi_compute_config;
  1029. intel_encoder->mode_set = intel_hdmi_mode_set;
  1030. intel_encoder->disable = intel_disable_hdmi;
  1031. intel_encoder->get_hw_state = intel_hdmi_get_hw_state;
  1032. intel_encoder->get_config = intel_hdmi_get_config;
  1033. if (IS_VALLEYVIEW(dev)) {
  1034. intel_encoder->pre_pll_enable = intel_hdmi_pre_pll_enable;
  1035. intel_encoder->pre_enable = intel_hdmi_pre_enable;
  1036. intel_encoder->enable = vlv_enable_hdmi;
  1037. intel_encoder->post_disable = intel_hdmi_post_disable;
  1038. } else {
  1039. intel_encoder->enable = intel_enable_hdmi;
  1040. }
  1041. intel_encoder->type = INTEL_OUTPUT_HDMI;
  1042. intel_encoder->crtc_mask = (1 << 0) | (1 << 1) | (1 << 2);
  1043. intel_encoder->cloneable = false;
  1044. intel_dig_port->port = port;
  1045. intel_dig_port->hdmi.hdmi_reg = hdmi_reg;
  1046. intel_dig_port->dp.output_reg = 0;
  1047. intel_hdmi_init_connector(intel_dig_port, intel_connector);
  1048. }