1 /*
2 * Copyright 2009 Red Hat Inc.
3 *
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:
10 *
11 * The above copyright notice and this permission notice shall be included in
12 * all copies or substantial portions of the Software.
13 *
14 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
15 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
16 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
17 * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR
18 * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
19 * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
20 * OTHER DEALINGS IN THE SOFTWARE.
21 *
22 * Authors: Ben Skeggs
23 */
24
25 #include <drm/display/drm_dp_helper.h>
26
27 #include "nouveau_drv.h"
28 #include "nouveau_connector.h"
29 #include "nouveau_encoder.h"
30 #include "nouveau_crtc.h"
31
32 #include <nvif/if0011.h>
33
34 MODULE_PARM_DESC(mst, "Enable DisplayPort multi-stream (default: enabled)");
35 static int nouveau_mst = 1;
36 module_param_named(mst, nouveau_mst, int, 0400);
37
38 static bool
nouveau_dp_has_sink_count(struct drm_connector * connector,struct nouveau_encoder * outp)39 nouveau_dp_has_sink_count(struct drm_connector *connector,
40 struct nouveau_encoder *outp)
41 {
42 return drm_dp_read_sink_count_cap(connector, outp->dp.dpcd, &outp->dp.desc);
43 }
44
45 static enum drm_connector_status
nouveau_dp_probe_dpcd(struct nouveau_connector * nv_connector,struct nouveau_encoder * outp)46 nouveau_dp_probe_dpcd(struct nouveau_connector *nv_connector,
47 struct nouveau_encoder *outp)
48 {
49 struct drm_connector *connector = &nv_connector->base;
50 struct drm_dp_aux *aux = &nv_connector->aux;
51 struct nv50_mstm *mstm = NULL;
52 enum drm_connector_status status = connector_status_disconnected;
53 int ret;
54 u8 *dpcd = outp->dp.dpcd;
55
56 ret = drm_dp_read_dpcd_caps(aux, dpcd);
57 if (ret < 0)
58 goto out;
59
60 ret = drm_dp_read_desc(aux, &outp->dp.desc, drm_dp_is_branch(dpcd));
61 if (ret < 0)
62 goto out;
63
64 if (nouveau_mst) {
65 mstm = outp->dp.mstm;
66 if (mstm)
67 mstm->can_mst = drm_dp_read_mst_cap(aux, dpcd);
68 }
69
70 if (nouveau_dp_has_sink_count(connector, outp)) {
71 ret = drm_dp_read_sink_count(aux);
72 if (ret < 0)
73 goto out;
74
75 outp->dp.sink_count = ret;
76
77 /*
78 * Dongle connected, but no display. Don't bother reading
79 * downstream port info
80 */
81 if (!outp->dp.sink_count)
82 return connector_status_disconnected;
83 }
84
85 ret = drm_dp_read_downstream_info(aux, dpcd,
86 outp->dp.downstream_ports);
87 if (ret < 0)
88 goto out;
89
90 status = connector_status_connected;
91 out:
92 if (status != connector_status_connected) {
93 /* Clear any cached info */
94 outp->dp.sink_count = 0;
95 }
96 return status;
97 }
98
99 int
nouveau_dp_detect(struct nouveau_connector * nv_connector,struct nouveau_encoder * nv_encoder)100 nouveau_dp_detect(struct nouveau_connector *nv_connector,
101 struct nouveau_encoder *nv_encoder)
102 {
103 struct drm_device *dev = nv_encoder->base.base.dev;
104 struct nouveau_drm *drm = nouveau_drm(dev);
105 struct drm_connector *connector = &nv_connector->base;
106 struct nv50_mstm *mstm = nv_encoder->dp.mstm;
107 enum drm_connector_status status;
108 u8 *dpcd = nv_encoder->dp.dpcd;
109 int ret = NOUVEAU_DP_NONE, hpd;
110
111 /* eDP ports don't support hotplugging - so there's no point in probing eDP ports unless we
112 * haven't probed them once before.
113 */
114 if (connector->connector_type == DRM_MODE_CONNECTOR_eDP) {
115 if (connector->status == connector_status_connected)
116 return NOUVEAU_DP_SST;
117 else if (connector->status == connector_status_disconnected)
118 return NOUVEAU_DP_NONE;
119 }
120
121 mutex_lock(&nv_encoder->dp.hpd_irq_lock);
122 if (mstm) {
123 /* If we're not ready to handle MST state changes yet, just
124 * report the last status of the connector. We'll reprobe it
125 * once we've resumed.
126 */
127 if (mstm->suspended) {
128 if (mstm->is_mst)
129 ret = NOUVEAU_DP_MST;
130 else if (connector->status ==
131 connector_status_connected)
132 ret = NOUVEAU_DP_SST;
133
134 goto out;
135 }
136 }
137
138 /* Check status of HPD pin before attempting an AUX transaction that
139 * would result in a number of (futile) retries on a connector which
140 * has no display plugged.
141 *
142 * TODO: look into checking this before probing I2C to detect DVI/HDMI
143 */
144 hpd = nvif_conn_hpd_status(&nv_connector->conn);
145 if (hpd == NVIF_CONN_HPD_STATUS_NOT_PRESENT) {
146 nvif_outp_dp_aux_pwr(&nv_encoder->outp, false);
147 goto out;
148 }
149 nvif_outp_dp_aux_pwr(&nv_encoder->outp, true);
150
151 status = nouveau_dp_probe_dpcd(nv_connector, nv_encoder);
152 if (status == connector_status_disconnected) {
153 nvif_outp_dp_aux_pwr(&nv_encoder->outp, false);
154 goto out;
155 }
156
157 /* If we're in MST mode, we're done here */
158 if (mstm && mstm->can_mst && mstm->is_mst) {
159 ret = NOUVEAU_DP_MST;
160 goto out;
161 }
162
163 nv_encoder->dp.link_bw = 27000 * dpcd[DP_MAX_LINK_RATE];
164 nv_encoder->dp.link_nr =
165 dpcd[DP_MAX_LANE_COUNT] & DP_MAX_LANE_COUNT_MASK;
166
167 if (connector->connector_type == DRM_MODE_CONNECTOR_eDP && dpcd[DP_DPCD_REV] >= 0x13) {
168 struct drm_dp_aux *aux = &nv_connector->aux;
169 int ret, i;
170 u8 sink_rates[16];
171
172 ret = drm_dp_dpcd_read(aux, DP_SUPPORTED_LINK_RATES, sink_rates, sizeof(sink_rates));
173 if (ret == sizeof(sink_rates)) {
174 for (i = 0; i < ARRAY_SIZE(sink_rates); i += 2) {
175 int val = ((sink_rates[i + 1] << 8) | sink_rates[i]) * 200 / 10;
176 if (val && (i == 0 || val > nv_encoder->dp.link_bw))
177 nv_encoder->dp.link_bw = val;
178 }
179 }
180 }
181
182 NV_DEBUG(drm, "display: %dx%d dpcd 0x%02x\n",
183 nv_encoder->dp.link_nr, nv_encoder->dp.link_bw,
184 dpcd[DP_DPCD_REV]);
185 NV_DEBUG(drm, "encoder: %dx%d\n",
186 nv_encoder->dcb->dpconf.link_nr,
187 nv_encoder->dcb->dpconf.link_bw);
188
189 if (nv_encoder->dcb->dpconf.link_nr < nv_encoder->dp.link_nr)
190 nv_encoder->dp.link_nr = nv_encoder->dcb->dpconf.link_nr;
191 if (nv_encoder->dcb->dpconf.link_bw < nv_encoder->dp.link_bw)
192 nv_encoder->dp.link_bw = nv_encoder->dcb->dpconf.link_bw;
193
194 NV_DEBUG(drm, "maximum: %dx%d\n",
195 nv_encoder->dp.link_nr, nv_encoder->dp.link_bw);
196
197 if (mstm && mstm->can_mst) {
198 ret = nv50_mstm_detect(nv_encoder);
199 if (ret == 1) {
200 ret = NOUVEAU_DP_MST;
201 goto out;
202 } else if (ret != 0) {
203 nvif_outp_dp_aux_pwr(&nv_encoder->outp, false);
204 goto out;
205 }
206 }
207 ret = NOUVEAU_DP_SST;
208
209 out:
210 if (mstm && !mstm->suspended && ret != NOUVEAU_DP_MST)
211 nv50_mstm_remove(mstm);
212
213 mutex_unlock(&nv_encoder->dp.hpd_irq_lock);
214 return ret;
215 }
216
217 bool
nouveau_dp_link_check(struct nouveau_connector * nv_connector)218 nouveau_dp_link_check(struct nouveau_connector *nv_connector)
219 {
220 struct nouveau_encoder *nv_encoder = find_encoder(&nv_connector->base, DCB_OUTPUT_DP);
221
222 if (!nv_encoder || nv_encoder->outp.or.id < 0)
223 return true;
224
225 return nvif_outp_dp_retrain(&nv_encoder->outp) == 0;
226 }
227
228 void
nouveau_dp_irq(struct work_struct * work)229 nouveau_dp_irq(struct work_struct *work)
230 {
231 struct nouveau_connector *nv_connector =
232 container_of(work, typeof(*nv_connector), irq_work);
233 struct drm_connector *connector = &nv_connector->base;
234 struct nouveau_encoder *outp = find_encoder(connector, DCB_OUTPUT_DP);
235 struct nouveau_drm *drm = nouveau_drm(outp->base.base.dev);
236 struct nv50_mstm *mstm;
237 u64 hpd = 0;
238 int ret;
239
240 if (!outp)
241 return;
242
243 mstm = outp->dp.mstm;
244 NV_DEBUG(drm, "service %s\n", connector->name);
245
246 mutex_lock(&outp->dp.hpd_irq_lock);
247
248 if (mstm && mstm->is_mst) {
249 if (!nv50_mstm_service(drm, nv_connector, mstm))
250 hpd |= NVIF_CONN_EVENT_V0_UNPLUG;
251 } else {
252 drm_dp_cec_irq(&nv_connector->aux);
253
254 if (nouveau_dp_has_sink_count(connector, outp)) {
255 ret = drm_dp_read_sink_count(&nv_connector->aux);
256 if (ret != outp->dp.sink_count)
257 hpd |= NVIF_CONN_EVENT_V0_PLUG;
258 if (ret >= 0)
259 outp->dp.sink_count = ret;
260 }
261 }
262
263 mutex_unlock(&outp->dp.hpd_irq_lock);
264
265 nouveau_connector_hpd(nv_connector, NVIF_CONN_EVENT_V0_IRQ | hpd);
266 }
267
268 /* TODO:
269 * - Validate against the DP caps advertised by the GPU (we don't check these
270 * yet)
271 */
272 enum drm_mode_status
nv50_dp_mode_valid(struct nouveau_encoder * outp,const struct drm_display_mode * mode,unsigned * out_clock)273 nv50_dp_mode_valid(struct nouveau_encoder *outp,
274 const struct drm_display_mode *mode,
275 unsigned *out_clock)
276 {
277 const unsigned int min_clock = 25000;
278 unsigned int max_rate, mode_rate, ds_max_dotclock, clock = mode->clock;
279 /* Check with the minmum bpc always, so we can advertise better modes.
280 * In particlar not doing this causes modes to be dropped on HDR
281 * displays as we might check with a bpc of 16 even.
282 */
283 const u8 bpp = 6 * 3;
284
285 if (mode->flags & DRM_MODE_FLAG_INTERLACE && !outp->caps.dp_interlace)
286 return MODE_NO_INTERLACE;
287
288 if ((mode->flags & DRM_MODE_FLAG_3D_MASK) == DRM_MODE_FLAG_3D_FRAME_PACKING)
289 clock *= 2;
290
291 max_rate = outp->dp.link_nr * outp->dp.link_bw;
292 mode_rate = DIV_ROUND_UP(clock * bpp, 8);
293 if (mode_rate > max_rate)
294 return MODE_CLOCK_HIGH;
295
296 ds_max_dotclock = drm_dp_downstream_max_dotclock(outp->dp.dpcd, outp->dp.downstream_ports);
297 if (ds_max_dotclock && clock > ds_max_dotclock)
298 return MODE_CLOCK_HIGH;
299
300 if (clock < min_clock)
301 return MODE_CLOCK_LOW;
302
303 if (out_clock)
304 *out_clock = clock;
305
306 return MODE_OK;
307 }
308