2 * Copyright © 2016 Intel Corporation
4 * Permission is hereby granted, free of charge, to any person obtaining a
5 * copy of this software and associated documentation files (the "Software"),
6 * to deal in the Software without restriction, including without limitation
7 * the rights to use, copy, modify, merge, publish, distribute, sublicense,
8 * and/or sell copies of the Software, and to permit persons to whom the
9 * Software is furnished to do so, subject to the following conditions:
11 * The above copyright notice and this permission notice (including the next
12 * paragraph) shall be included in all copies or substantial portions of the
15 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
16 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
17 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
18 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
19 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
20 * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER
21 * DEALINGS IN THE SOFTWARE.
25 #include <drm/drm_edid.h>
26 #include <drm/drm_atomic_helper.h>
27 #include <drm/drm_dp_dual_mode_helper.h>
28 #include "intel_drv.h"
30 static struct intel_dp
*lspcon_to_intel_dp(struct intel_lspcon
*lspcon
)
32 struct intel_digital_port
*dig_port
=
33 container_of(lspcon
, struct intel_digital_port
, lspcon
);
38 static const char *lspcon_mode_name(enum drm_lspcon_mode mode
)
41 case DRM_LSPCON_MODE_PCON
:
43 case DRM_LSPCON_MODE_LS
:
45 case DRM_LSPCON_MODE_INVALID
:
53 static enum drm_lspcon_mode
lspcon_get_current_mode(struct intel_lspcon
*lspcon
)
55 enum drm_lspcon_mode current_mode
;
56 struct i2c_adapter
*adapter
= &lspcon_to_intel_dp(lspcon
)->aux
.ddc
;
58 if (drm_lspcon_get_mode(adapter
, ¤t_mode
)) {
59 DRM_DEBUG_KMS("Error reading LSPCON mode\n");
60 return DRM_LSPCON_MODE_INVALID
;
65 static enum drm_lspcon_mode
lspcon_wait_mode(struct intel_lspcon
*lspcon
,
66 enum drm_lspcon_mode mode
)
68 enum drm_lspcon_mode current_mode
;
70 current_mode
= lspcon_get_current_mode(lspcon
);
71 if (current_mode
== mode
)
74 DRM_DEBUG_KMS("Waiting for LSPCON mode %s to settle\n",
75 lspcon_mode_name(mode
));
77 wait_for((current_mode
= lspcon_get_current_mode(lspcon
)) == mode
, 100);
78 if (current_mode
!= mode
)
79 DRM_ERROR("LSPCON mode hasn't settled\n");
82 DRM_DEBUG_KMS("Current LSPCON mode %s\n",
83 lspcon_mode_name(current_mode
));
88 static int lspcon_change_mode(struct intel_lspcon
*lspcon
,
89 enum drm_lspcon_mode mode
)
92 enum drm_lspcon_mode current_mode
;
93 struct i2c_adapter
*adapter
= &lspcon_to_intel_dp(lspcon
)->aux
.ddc
;
95 err
= drm_lspcon_get_mode(adapter
, ¤t_mode
);
97 DRM_ERROR("Error reading LSPCON mode\n");
101 if (current_mode
== mode
) {
102 DRM_DEBUG_KMS("Current mode = desired LSPCON mode\n");
106 err
= drm_lspcon_set_mode(adapter
, mode
);
108 DRM_ERROR("LSPCON mode change failed\n");
113 DRM_DEBUG_KMS("LSPCON mode changed done\n");
117 static bool lspcon_wake_native_aux_ch(struct intel_lspcon
*lspcon
)
121 if (drm_dp_dpcd_readb(&lspcon_to_intel_dp(lspcon
)->aux
, DP_DPCD_REV
,
123 DRM_DEBUG_KMS("Native AUX CH down\n");
127 DRM_DEBUG_KMS("Native AUX CH up, DPCD version: %d.%d\n",
128 rev
>> 4, rev
& 0xf);
133 static bool lspcon_probe(struct intel_lspcon
*lspcon
)
136 enum drm_dp_dual_mode_type adaptor_type
;
137 struct i2c_adapter
*adapter
= &lspcon_to_intel_dp(lspcon
)->aux
.ddc
;
138 enum drm_lspcon_mode expected_mode
;
140 expected_mode
= lspcon_wake_native_aux_ch(lspcon
) ?
141 DRM_LSPCON_MODE_PCON
: DRM_LSPCON_MODE_LS
;
143 /* Lets probe the adaptor and check its type */
144 for (retry
= 0; retry
< 6; retry
++) {
146 usleep_range(500, 1000);
148 adaptor_type
= drm_dp_dual_mode_detect(adapter
);
149 if (adaptor_type
== DRM_DP_DUAL_MODE_LSPCON
)
153 if (adaptor_type
!= DRM_DP_DUAL_MODE_LSPCON
) {
154 DRM_DEBUG_KMS("No LSPCON detected, found %s\n",
155 drm_dp_get_dual_mode_type_name(adaptor_type
));
159 /* Yay ... got a LSPCON device */
160 DRM_DEBUG_KMS("LSPCON detected\n");
161 lspcon
->mode
= lspcon_wait_mode(lspcon
, expected_mode
);
162 lspcon
->active
= true;
166 static void lspcon_resume_in_pcon_wa(struct intel_lspcon
*lspcon
)
168 struct intel_dp
*intel_dp
= lspcon_to_intel_dp(lspcon
);
169 struct intel_digital_port
*dig_port
= dp_to_dig_port(intel_dp
);
170 struct drm_i915_private
*dev_priv
= to_i915(dig_port
->base
.base
.dev
);
171 unsigned long start
= jiffies
;
174 if (intel_digital_port_connected(dev_priv
, dig_port
)) {
175 DRM_DEBUG_KMS("LSPCON recovering in PCON mode after %lu ms\n",
176 jiffies_to_msecs(jiffies
- start
));
180 if (time_after(jiffies
, start
+ msecs_to_jiffies(1000)))
183 usleep_range(10000, 15000);
186 DRM_DEBUG_KMS("LSPCON DP descriptor mismatch after resume\n");
189 void lspcon_resume(struct intel_lspcon
*lspcon
)
191 enum drm_lspcon_mode expected_mode
;
193 if (lspcon_wake_native_aux_ch(lspcon
)) {
194 expected_mode
= DRM_LSPCON_MODE_PCON
;
195 lspcon_resume_in_pcon_wa(lspcon
);
197 expected_mode
= DRM_LSPCON_MODE_LS
;
200 if (lspcon_wait_mode(lspcon
, expected_mode
) == DRM_LSPCON_MODE_PCON
)
203 if (lspcon_change_mode(lspcon
, DRM_LSPCON_MODE_PCON
))
204 DRM_ERROR("LSPCON resume failed\n");
206 DRM_DEBUG_KMS("LSPCON resume success\n");
209 void lspcon_wait_pcon_mode(struct intel_lspcon
*lspcon
)
211 lspcon_wait_mode(lspcon
, DRM_LSPCON_MODE_PCON
);
214 bool lspcon_init(struct intel_digital_port
*intel_dig_port
)
216 struct intel_dp
*dp
= &intel_dig_port
->dp
;
217 struct intel_lspcon
*lspcon
= &intel_dig_port
->lspcon
;
218 struct drm_device
*dev
= intel_dig_port
->base
.base
.dev
;
219 struct drm_i915_private
*dev_priv
= to_i915(dev
);
221 if (!HAS_LSPCON(dev_priv
)) {
222 DRM_ERROR("LSPCON is not supported on this platform\n");
226 lspcon
->active
= false;
227 lspcon
->mode
= DRM_LSPCON_MODE_INVALID
;
229 if (!lspcon_probe(lspcon
)) {
230 DRM_ERROR("Failed to probe lspcon\n");
235 * In the SW state machine, lets Put LSPCON in PCON mode only.
236 * In this way, it will work with both HDMI 1.4 sinks as well as HDMI
239 if (lspcon
->active
&& lspcon
->mode
!= DRM_LSPCON_MODE_PCON
) {
240 if (lspcon_change_mode(lspcon
, DRM_LSPCON_MODE_PCON
) < 0) {
241 DRM_ERROR("LSPCON mode change to PCON failed\n");
246 if (!intel_dp_read_dpcd(dp
)) {
247 DRM_ERROR("LSPCON DPCD read failed\n");
251 drm_dp_read_desc(&dp
->aux
, &dp
->desc
, drm_dp_is_branch(dp
->dpcd
));
253 DRM_DEBUG_KMS("Success: LSPCON init\n");