Loading...
1// SPDX-License-Identifier: GPL-2.0-or-later
2/*
3 * Copyright (C) 2016 BayLibre, SAS
4 * Author: Neil Armstrong <narmstrong@baylibre.com>
5 * Copyright (C) 2015 Amlogic, Inc. All rights reserved.
6 */
7
8#include <linux/clk.h>
9#include <linux/component.h>
10#include <linux/kernel.h>
11#include <linux/module.h>
12#include <linux/of_device.h>
13#include <linux/of_graph.h>
14#include <linux/regulator/consumer.h>
15#include <linux/reset.h>
16
17#include <media/cec-notifier.h>
18
19#include <drm/drm_atomic_helper.h>
20#include <drm/drm_bridge.h>
21#include <drm/drm_bridge_connector.h>
22#include <drm/drm_device.h>
23#include <drm/drm_edid.h>
24#include <drm/drm_probe_helper.h>
25#include <drm/drm_simple_kms_helper.h>
26
27#include <linux/media-bus-format.h>
28#include <linux/videodev2.h>
29
30#include "meson_drv.h"
31#include "meson_registers.h"
32#include "meson_vclk.h"
33#include "meson_venc.h"
34#include "meson_encoder_hdmi.h"
35
36struct meson_encoder_hdmi {
37 struct drm_encoder encoder;
38 struct drm_bridge bridge;
39 struct drm_bridge *next_bridge;
40 struct drm_connector *connector;
41 struct meson_drm *priv;
42 unsigned long output_bus_fmt;
43 struct cec_notifier *cec_notifier;
44};
45
46#define bridge_to_meson_encoder_hdmi(x) \
47 container_of(x, struct meson_encoder_hdmi, bridge)
48
49static int meson_encoder_hdmi_attach(struct drm_bridge *bridge,
50 enum drm_bridge_attach_flags flags)
51{
52 struct meson_encoder_hdmi *encoder_hdmi = bridge_to_meson_encoder_hdmi(bridge);
53
54 return drm_bridge_attach(bridge->encoder, encoder_hdmi->next_bridge,
55 &encoder_hdmi->bridge, flags);
56}
57
58static void meson_encoder_hdmi_detach(struct drm_bridge *bridge)
59{
60 struct meson_encoder_hdmi *encoder_hdmi = bridge_to_meson_encoder_hdmi(bridge);
61
62 cec_notifier_conn_unregister(encoder_hdmi->cec_notifier);
63 encoder_hdmi->cec_notifier = NULL;
64}
65
66static void meson_encoder_hdmi_set_vclk(struct meson_encoder_hdmi *encoder_hdmi,
67 const struct drm_display_mode *mode)
68{
69 struct meson_drm *priv = encoder_hdmi->priv;
70 int vic = drm_match_cea_mode(mode);
71 unsigned int phy_freq;
72 unsigned int vclk_freq;
73 unsigned int venc_freq;
74 unsigned int hdmi_freq;
75
76 vclk_freq = mode->clock;
77
78 /* For 420, pixel clock is half unlike venc clock */
79 if (encoder_hdmi->output_bus_fmt == MEDIA_BUS_FMT_UYYVYY8_0_5X24)
80 vclk_freq /= 2;
81
82 /* TMDS clock is pixel_clock * 10 */
83 phy_freq = vclk_freq * 10;
84
85 if (!vic) {
86 meson_vclk_setup(priv, MESON_VCLK_TARGET_DMT, phy_freq,
87 vclk_freq, vclk_freq, vclk_freq, false);
88 return;
89 }
90
91 /* 480i/576i needs global pixel doubling */
92 if (mode->flags & DRM_MODE_FLAG_DBLCLK)
93 vclk_freq *= 2;
94
95 venc_freq = vclk_freq;
96 hdmi_freq = vclk_freq;
97
98 /* VENC double pixels for 1080i, 720p and YUV420 modes */
99 if (meson_venc_hdmi_venc_repeat(vic) ||
100 encoder_hdmi->output_bus_fmt == MEDIA_BUS_FMT_UYYVYY8_0_5X24)
101 venc_freq *= 2;
102
103 vclk_freq = max(venc_freq, hdmi_freq);
104
105 if (mode->flags & DRM_MODE_FLAG_DBLCLK)
106 venc_freq /= 2;
107
108 dev_dbg(priv->dev, "vclk:%d phy=%d venc=%d hdmi=%d enci=%d\n",
109 phy_freq, vclk_freq, venc_freq, hdmi_freq,
110 priv->venc.hdmi_use_enci);
111
112 meson_vclk_setup(priv, MESON_VCLK_TARGET_HDMI, phy_freq, vclk_freq,
113 venc_freq, hdmi_freq, priv->venc.hdmi_use_enci);
114}
115
116static enum drm_mode_status meson_encoder_hdmi_mode_valid(struct drm_bridge *bridge,
117 const struct drm_display_info *display_info,
118 const struct drm_display_mode *mode)
119{
120 struct meson_encoder_hdmi *encoder_hdmi = bridge_to_meson_encoder_hdmi(bridge);
121 struct meson_drm *priv = encoder_hdmi->priv;
122 bool is_hdmi2_sink = display_info->hdmi.scdc.supported;
123 unsigned int phy_freq;
124 unsigned int vclk_freq;
125 unsigned int venc_freq;
126 unsigned int hdmi_freq;
127 int vic = drm_match_cea_mode(mode);
128 enum drm_mode_status status;
129
130 dev_dbg(priv->dev, "Modeline " DRM_MODE_FMT "\n", DRM_MODE_ARG(mode));
131
132 /* If sink does not support 540MHz, reject the non-420 HDMI2 modes */
133 if (display_info->max_tmds_clock &&
134 mode->clock > display_info->max_tmds_clock &&
135 !drm_mode_is_420_only(display_info, mode) &&
136 !drm_mode_is_420_also(display_info, mode))
137 return MODE_BAD;
138
139 /* Check against non-VIC supported modes */
140 if (!vic) {
141 status = meson_venc_hdmi_supported_mode(mode);
142 if (status != MODE_OK)
143 return status;
144
145 return meson_vclk_dmt_supported_freq(priv, mode->clock);
146 /* Check against supported VIC modes */
147 } else if (!meson_venc_hdmi_supported_vic(vic))
148 return MODE_BAD;
149
150 vclk_freq = mode->clock;
151
152 /* For 420, pixel clock is half unlike venc clock */
153 if (drm_mode_is_420_only(display_info, mode) ||
154 (!is_hdmi2_sink &&
155 drm_mode_is_420_also(display_info, mode)))
156 vclk_freq /= 2;
157
158 /* TMDS clock is pixel_clock * 10 */
159 phy_freq = vclk_freq * 10;
160
161 /* 480i/576i needs global pixel doubling */
162 if (mode->flags & DRM_MODE_FLAG_DBLCLK)
163 vclk_freq *= 2;
164
165 venc_freq = vclk_freq;
166 hdmi_freq = vclk_freq;
167
168 /* VENC double pixels for 1080i, 720p and YUV420 modes */
169 if (meson_venc_hdmi_venc_repeat(vic) ||
170 drm_mode_is_420_only(display_info, mode) ||
171 (!is_hdmi2_sink &&
172 drm_mode_is_420_also(display_info, mode)))
173 venc_freq *= 2;
174
175 vclk_freq = max(venc_freq, hdmi_freq);
176
177 if (mode->flags & DRM_MODE_FLAG_DBLCLK)
178 venc_freq /= 2;
179
180 dev_dbg(priv->dev, "%s: vclk:%d phy=%d venc=%d hdmi=%d\n",
181 __func__, phy_freq, vclk_freq, venc_freq, hdmi_freq);
182
183 return meson_vclk_vic_supported_freq(priv, phy_freq, vclk_freq);
184}
185
186static void meson_encoder_hdmi_atomic_enable(struct drm_bridge *bridge,
187 struct drm_bridge_state *bridge_state)
188{
189 struct meson_encoder_hdmi *encoder_hdmi = bridge_to_meson_encoder_hdmi(bridge);
190 struct drm_atomic_state *state = bridge_state->base.state;
191 unsigned int ycrcb_map = VPU_HDMI_OUTPUT_CBYCR;
192 struct meson_drm *priv = encoder_hdmi->priv;
193 struct drm_connector_state *conn_state;
194 const struct drm_display_mode *mode;
195 struct drm_crtc_state *crtc_state;
196 struct drm_connector *connector;
197 bool yuv420_mode = false;
198 int vic;
199
200 connector = drm_atomic_get_new_connector_for_encoder(state, bridge->encoder);
201 if (WARN_ON(!connector))
202 return;
203
204 conn_state = drm_atomic_get_new_connector_state(state, connector);
205 if (WARN_ON(!conn_state))
206 return;
207
208 crtc_state = drm_atomic_get_new_crtc_state(state, conn_state->crtc);
209 if (WARN_ON(!crtc_state))
210 return;
211
212 mode = &crtc_state->adjusted_mode;
213
214 vic = drm_match_cea_mode(mode);
215
216 dev_dbg(priv->dev, "\"%s\" vic %d\n", mode->name, vic);
217
218 if (encoder_hdmi->output_bus_fmt == MEDIA_BUS_FMT_UYYVYY8_0_5X24) {
219 ycrcb_map = VPU_HDMI_OUTPUT_CRYCB;
220 yuv420_mode = true;
221 } else if (encoder_hdmi->output_bus_fmt == MEDIA_BUS_FMT_UYVY8_1X16)
222 ycrcb_map = VPU_HDMI_OUTPUT_CRYCB;
223
224 /* VENC + VENC-DVI Mode setup */
225 meson_venc_hdmi_mode_set(priv, vic, ycrcb_map, yuv420_mode, mode);
226
227 /* VCLK Set clock */
228 meson_encoder_hdmi_set_vclk(encoder_hdmi, mode);
229
230 if (encoder_hdmi->output_bus_fmt == MEDIA_BUS_FMT_UYYVYY8_0_5X24)
231 /* Setup YUV420 to HDMI-TX, no 10bit diphering */
232 writel_relaxed(2 | (2 << 2),
233 priv->io_base + _REG(VPU_HDMI_FMT_CTRL));
234 else if (encoder_hdmi->output_bus_fmt == MEDIA_BUS_FMT_UYVY8_1X16)
235 /* Setup YUV422 to HDMI-TX, no 10bit diphering */
236 writel_relaxed(1 | (2 << 2),
237 priv->io_base + _REG(VPU_HDMI_FMT_CTRL));
238 else
239 /* Setup YUV444 to HDMI-TX, no 10bit diphering */
240 writel_relaxed(0, priv->io_base + _REG(VPU_HDMI_FMT_CTRL));
241
242 dev_dbg(priv->dev, "%s\n", priv->venc.hdmi_use_enci ? "VENCI" : "VENCP");
243
244 if (priv->venc.hdmi_use_enci)
245 writel_relaxed(1, priv->io_base + _REG(ENCI_VIDEO_EN));
246 else
247 writel_relaxed(1, priv->io_base + _REG(ENCP_VIDEO_EN));
248}
249
250static void meson_encoder_hdmi_atomic_disable(struct drm_bridge *bridge,
251 struct drm_bridge_state *bridge_state)
252{
253 struct meson_encoder_hdmi *encoder_hdmi = bridge_to_meson_encoder_hdmi(bridge);
254 struct meson_drm *priv = encoder_hdmi->priv;
255
256 writel_bits_relaxed(0x3, 0,
257 priv->io_base + _REG(VPU_HDMI_SETTING));
258
259 writel_relaxed(0, priv->io_base + _REG(ENCI_VIDEO_EN));
260 writel_relaxed(0, priv->io_base + _REG(ENCP_VIDEO_EN));
261}
262
263static const u32 meson_encoder_hdmi_out_bus_fmts[] = {
264 MEDIA_BUS_FMT_YUV8_1X24,
265 MEDIA_BUS_FMT_UYVY8_1X16,
266 MEDIA_BUS_FMT_UYYVYY8_0_5X24,
267};
268
269static u32 *
270meson_encoder_hdmi_get_inp_bus_fmts(struct drm_bridge *bridge,
271 struct drm_bridge_state *bridge_state,
272 struct drm_crtc_state *crtc_state,
273 struct drm_connector_state *conn_state,
274 u32 output_fmt,
275 unsigned int *num_input_fmts)
276{
277 u32 *input_fmts = NULL;
278 int i;
279
280 *num_input_fmts = 0;
281
282 for (i = 0 ; i < ARRAY_SIZE(meson_encoder_hdmi_out_bus_fmts) ; ++i) {
283 if (output_fmt == meson_encoder_hdmi_out_bus_fmts[i]) {
284 *num_input_fmts = 1;
285 input_fmts = kcalloc(*num_input_fmts,
286 sizeof(*input_fmts),
287 GFP_KERNEL);
288 if (!input_fmts)
289 return NULL;
290
291 input_fmts[0] = output_fmt;
292
293 break;
294 }
295 }
296
297 return input_fmts;
298}
299
300static int meson_encoder_hdmi_atomic_check(struct drm_bridge *bridge,
301 struct drm_bridge_state *bridge_state,
302 struct drm_crtc_state *crtc_state,
303 struct drm_connector_state *conn_state)
304{
305 struct meson_encoder_hdmi *encoder_hdmi = bridge_to_meson_encoder_hdmi(bridge);
306 struct drm_connector_state *old_conn_state =
307 drm_atomic_get_old_connector_state(conn_state->state, conn_state->connector);
308 struct meson_drm *priv = encoder_hdmi->priv;
309
310 encoder_hdmi->output_bus_fmt = bridge_state->output_bus_cfg.format;
311
312 dev_dbg(priv->dev, "output_bus_fmt %lx\n", encoder_hdmi->output_bus_fmt);
313
314 if (!drm_connector_atomic_hdr_metadata_equal(old_conn_state, conn_state))
315 crtc_state->mode_changed = true;
316
317 return 0;
318}
319
320static void meson_encoder_hdmi_hpd_notify(struct drm_bridge *bridge,
321 enum drm_connector_status status)
322{
323 struct meson_encoder_hdmi *encoder_hdmi = bridge_to_meson_encoder_hdmi(bridge);
324 struct edid *edid;
325
326 if (!encoder_hdmi->cec_notifier)
327 return;
328
329 if (status == connector_status_connected) {
330 edid = drm_bridge_get_edid(encoder_hdmi->next_bridge, encoder_hdmi->connector);
331 if (!edid)
332 return;
333
334 cec_notifier_set_phys_addr_from_edid(encoder_hdmi->cec_notifier, edid);
335 } else
336 cec_notifier_phys_addr_invalidate(encoder_hdmi->cec_notifier);
337}
338
339static const struct drm_bridge_funcs meson_encoder_hdmi_bridge_funcs = {
340 .attach = meson_encoder_hdmi_attach,
341 .detach = meson_encoder_hdmi_detach,
342 .mode_valid = meson_encoder_hdmi_mode_valid,
343 .hpd_notify = meson_encoder_hdmi_hpd_notify,
344 .atomic_enable = meson_encoder_hdmi_atomic_enable,
345 .atomic_disable = meson_encoder_hdmi_atomic_disable,
346 .atomic_get_input_bus_fmts = meson_encoder_hdmi_get_inp_bus_fmts,
347 .atomic_check = meson_encoder_hdmi_atomic_check,
348 .atomic_duplicate_state = drm_atomic_helper_bridge_duplicate_state,
349 .atomic_destroy_state = drm_atomic_helper_bridge_destroy_state,
350 .atomic_reset = drm_atomic_helper_bridge_reset,
351};
352
353int meson_encoder_hdmi_init(struct meson_drm *priv)
354{
355 struct meson_encoder_hdmi *meson_encoder_hdmi;
356 struct platform_device *pdev;
357 struct device_node *remote;
358 int ret;
359
360 meson_encoder_hdmi = devm_kzalloc(priv->dev, sizeof(*meson_encoder_hdmi), GFP_KERNEL);
361 if (!meson_encoder_hdmi)
362 return -ENOMEM;
363
364 /* HDMI Transceiver Bridge */
365 remote = of_graph_get_remote_node(priv->dev->of_node, 1, 0);
366 if (!remote) {
367 dev_err(priv->dev, "HDMI transceiver device is disabled");
368 return 0;
369 }
370
371 meson_encoder_hdmi->next_bridge = of_drm_find_bridge(remote);
372 if (!meson_encoder_hdmi->next_bridge) {
373 dev_err(priv->dev, "Failed to find HDMI transceiver bridge\n");
374 ret = -EPROBE_DEFER;
375 goto err_put_node;
376 }
377
378 /* HDMI Encoder Bridge */
379 meson_encoder_hdmi->bridge.funcs = &meson_encoder_hdmi_bridge_funcs;
380 meson_encoder_hdmi->bridge.of_node = priv->dev->of_node;
381 meson_encoder_hdmi->bridge.type = DRM_MODE_CONNECTOR_HDMIA;
382 meson_encoder_hdmi->bridge.interlace_allowed = true;
383
384 drm_bridge_add(&meson_encoder_hdmi->bridge);
385
386 meson_encoder_hdmi->priv = priv;
387
388 /* Encoder */
389 ret = drm_simple_encoder_init(priv->drm, &meson_encoder_hdmi->encoder,
390 DRM_MODE_ENCODER_TMDS);
391 if (ret) {
392 dev_err(priv->dev, "Failed to init HDMI encoder: %d\n", ret);
393 goto err_put_node;
394 }
395
396 meson_encoder_hdmi->encoder.possible_crtcs = BIT(0);
397
398 /* Attach HDMI Encoder Bridge to Encoder */
399 ret = drm_bridge_attach(&meson_encoder_hdmi->encoder, &meson_encoder_hdmi->bridge, NULL,
400 DRM_BRIDGE_ATTACH_NO_CONNECTOR);
401 if (ret) {
402 dev_err(priv->dev, "Failed to attach bridge: %d\n", ret);
403 goto err_put_node;
404 }
405
406 /* Initialize & attach Bridge Connector */
407 meson_encoder_hdmi->connector = drm_bridge_connector_init(priv->drm,
408 &meson_encoder_hdmi->encoder);
409 if (IS_ERR(meson_encoder_hdmi->connector)) {
410 dev_err(priv->dev, "Unable to create HDMI bridge connector\n");
411 ret = PTR_ERR(meson_encoder_hdmi->connector);
412 goto err_put_node;
413 }
414 drm_connector_attach_encoder(meson_encoder_hdmi->connector,
415 &meson_encoder_hdmi->encoder);
416
417 /*
418 * We should have now in place:
419 * encoder->[hdmi encoder bridge]->[dw-hdmi bridge]->[display connector bridge]->[display connector]
420 */
421
422 /*
423 * drm_connector_attach_max_bpc_property() requires the
424 * connector to have a state.
425 */
426 drm_atomic_helper_connector_reset(meson_encoder_hdmi->connector);
427
428 if (meson_vpu_is_compatible(priv, VPU_COMPATIBLE_GXL) ||
429 meson_vpu_is_compatible(priv, VPU_COMPATIBLE_GXM) ||
430 meson_vpu_is_compatible(priv, VPU_COMPATIBLE_G12A))
431 drm_connector_attach_hdr_output_metadata_property(meson_encoder_hdmi->connector);
432
433 drm_connector_attach_max_bpc_property(meson_encoder_hdmi->connector, 8, 8);
434
435 /* Handle this here until handled by drm_bridge_connector_init() */
436 meson_encoder_hdmi->connector->ycbcr_420_allowed = true;
437
438 pdev = of_find_device_by_node(remote);
439 of_node_put(remote);
440 if (pdev) {
441 struct cec_connector_info conn_info;
442 struct cec_notifier *notifier;
443
444 cec_fill_conn_info_from_drm(&conn_info, meson_encoder_hdmi->connector);
445
446 notifier = cec_notifier_conn_register(&pdev->dev, NULL, &conn_info);
447 if (!notifier) {
448 put_device(&pdev->dev);
449 return -ENOMEM;
450 }
451
452 meson_encoder_hdmi->cec_notifier = notifier;
453 }
454
455 priv->encoders[MESON_ENC_HDMI] = meson_encoder_hdmi;
456
457 dev_dbg(priv->dev, "HDMI encoder initialized\n");
458
459 return 0;
460
461err_put_node:
462 of_node_put(remote);
463 return ret;
464}
465
466void meson_encoder_hdmi_remove(struct meson_drm *priv)
467{
468 struct meson_encoder_hdmi *meson_encoder_hdmi;
469
470 if (priv->encoders[MESON_ENC_HDMI]) {
471 meson_encoder_hdmi = priv->encoders[MESON_ENC_HDMI];
472 drm_bridge_remove(&meson_encoder_hdmi->bridge);
473 drm_bridge_remove(meson_encoder_hdmi->next_bridge);
474 }
475}
1// SPDX-License-Identifier: GPL-2.0-or-later
2/*
3 * Copyright (C) 2016 BayLibre, SAS
4 * Author: Neil Armstrong <narmstrong@baylibre.com>
5 * Copyright (C) 2015 Amlogic, Inc. All rights reserved.
6 */
7
8#include <linux/clk.h>
9#include <linux/component.h>
10#include <linux/kernel.h>
11#include <linux/module.h>
12#include <linux/of.h>
13#include <linux/of_graph.h>
14#include <linux/of_platform.h>
15#include <linux/platform_device.h>
16#include <linux/regulator/consumer.h>
17#include <linux/reset.h>
18
19#include <media/cec-notifier.h>
20
21#include <drm/drm_atomic_helper.h>
22#include <drm/drm_bridge.h>
23#include <drm/drm_bridge_connector.h>
24#include <drm/drm_device.h>
25#include <drm/drm_edid.h>
26#include <drm/drm_probe_helper.h>
27#include <drm/drm_simple_kms_helper.h>
28
29#include <linux/media-bus-format.h>
30#include <linux/videodev2.h>
31
32#include "meson_drv.h"
33#include "meson_registers.h"
34#include "meson_vclk.h"
35#include "meson_venc.h"
36#include "meson_encoder_hdmi.h"
37
38struct meson_encoder_hdmi {
39 struct drm_encoder encoder;
40 struct drm_bridge bridge;
41 struct drm_bridge *next_bridge;
42 struct drm_connector *connector;
43 struct meson_drm *priv;
44 unsigned long output_bus_fmt;
45 struct cec_notifier *cec_notifier;
46};
47
48#define bridge_to_meson_encoder_hdmi(x) \
49 container_of(x, struct meson_encoder_hdmi, bridge)
50
51static int meson_encoder_hdmi_attach(struct drm_bridge *bridge,
52 enum drm_bridge_attach_flags flags)
53{
54 struct meson_encoder_hdmi *encoder_hdmi = bridge_to_meson_encoder_hdmi(bridge);
55
56 return drm_bridge_attach(bridge->encoder, encoder_hdmi->next_bridge,
57 &encoder_hdmi->bridge, flags);
58}
59
60static void meson_encoder_hdmi_detach(struct drm_bridge *bridge)
61{
62 struct meson_encoder_hdmi *encoder_hdmi = bridge_to_meson_encoder_hdmi(bridge);
63
64 cec_notifier_conn_unregister(encoder_hdmi->cec_notifier);
65 encoder_hdmi->cec_notifier = NULL;
66}
67
68static void meson_encoder_hdmi_set_vclk(struct meson_encoder_hdmi *encoder_hdmi,
69 const struct drm_display_mode *mode)
70{
71 struct meson_drm *priv = encoder_hdmi->priv;
72 int vic = drm_match_cea_mode(mode);
73 unsigned int phy_freq;
74 unsigned int vclk_freq;
75 unsigned int venc_freq;
76 unsigned int hdmi_freq;
77
78 vclk_freq = mode->clock;
79
80 /* For 420, pixel clock is half unlike venc clock */
81 if (encoder_hdmi->output_bus_fmt == MEDIA_BUS_FMT_UYYVYY8_0_5X24)
82 vclk_freq /= 2;
83
84 /* TMDS clock is pixel_clock * 10 */
85 phy_freq = vclk_freq * 10;
86
87 if (!vic) {
88 meson_vclk_setup(priv, MESON_VCLK_TARGET_DMT, phy_freq,
89 vclk_freq, vclk_freq, vclk_freq, false);
90 return;
91 }
92
93 /* 480i/576i needs global pixel doubling */
94 if (mode->flags & DRM_MODE_FLAG_DBLCLK)
95 vclk_freq *= 2;
96
97 venc_freq = vclk_freq;
98 hdmi_freq = vclk_freq;
99
100 /* VENC double pixels for 1080i, 720p and YUV420 modes */
101 if (meson_venc_hdmi_venc_repeat(vic) ||
102 encoder_hdmi->output_bus_fmt == MEDIA_BUS_FMT_UYYVYY8_0_5X24)
103 venc_freq *= 2;
104
105 vclk_freq = max(venc_freq, hdmi_freq);
106
107 if (mode->flags & DRM_MODE_FLAG_DBLCLK)
108 venc_freq /= 2;
109
110 dev_dbg(priv->dev, "vclk:%d phy=%d venc=%d hdmi=%d enci=%d\n",
111 phy_freq, vclk_freq, venc_freq, hdmi_freq,
112 priv->venc.hdmi_use_enci);
113
114 meson_vclk_setup(priv, MESON_VCLK_TARGET_HDMI, phy_freq, vclk_freq,
115 venc_freq, hdmi_freq, priv->venc.hdmi_use_enci);
116}
117
118static enum drm_mode_status meson_encoder_hdmi_mode_valid(struct drm_bridge *bridge,
119 const struct drm_display_info *display_info,
120 const struct drm_display_mode *mode)
121{
122 struct meson_encoder_hdmi *encoder_hdmi = bridge_to_meson_encoder_hdmi(bridge);
123 struct meson_drm *priv = encoder_hdmi->priv;
124 bool is_hdmi2_sink = display_info->hdmi.scdc.supported;
125 unsigned int phy_freq;
126 unsigned int vclk_freq;
127 unsigned int venc_freq;
128 unsigned int hdmi_freq;
129 int vic = drm_match_cea_mode(mode);
130 enum drm_mode_status status;
131
132 dev_dbg(priv->dev, "Modeline " DRM_MODE_FMT "\n", DRM_MODE_ARG(mode));
133
134 /* If sink does not support 540MHz, reject the non-420 HDMI2 modes */
135 if (display_info->max_tmds_clock &&
136 mode->clock > display_info->max_tmds_clock &&
137 !drm_mode_is_420_only(display_info, mode) &&
138 !drm_mode_is_420_also(display_info, mode))
139 return MODE_BAD;
140
141 /* Check against non-VIC supported modes */
142 if (!vic) {
143 status = meson_venc_hdmi_supported_mode(mode);
144 if (status != MODE_OK)
145 return status;
146
147 return meson_vclk_dmt_supported_freq(priv, mode->clock);
148 /* Check against supported VIC modes */
149 } else if (!meson_venc_hdmi_supported_vic(vic))
150 return MODE_BAD;
151
152 vclk_freq = mode->clock;
153
154 /* For 420, pixel clock is half unlike venc clock */
155 if (drm_mode_is_420_only(display_info, mode) ||
156 (!is_hdmi2_sink &&
157 drm_mode_is_420_also(display_info, mode)))
158 vclk_freq /= 2;
159
160 /* TMDS clock is pixel_clock * 10 */
161 phy_freq = vclk_freq * 10;
162
163 /* 480i/576i needs global pixel doubling */
164 if (mode->flags & DRM_MODE_FLAG_DBLCLK)
165 vclk_freq *= 2;
166
167 venc_freq = vclk_freq;
168 hdmi_freq = vclk_freq;
169
170 /* VENC double pixels for 1080i, 720p and YUV420 modes */
171 if (meson_venc_hdmi_venc_repeat(vic) ||
172 drm_mode_is_420_only(display_info, mode) ||
173 (!is_hdmi2_sink &&
174 drm_mode_is_420_also(display_info, mode)))
175 venc_freq *= 2;
176
177 vclk_freq = max(venc_freq, hdmi_freq);
178
179 if (mode->flags & DRM_MODE_FLAG_DBLCLK)
180 venc_freq /= 2;
181
182 dev_dbg(priv->dev, "%s: vclk:%d phy=%d venc=%d hdmi=%d\n",
183 __func__, phy_freq, vclk_freq, venc_freq, hdmi_freq);
184
185 return meson_vclk_vic_supported_freq(priv, phy_freq, vclk_freq);
186}
187
188static void meson_encoder_hdmi_atomic_enable(struct drm_bridge *bridge,
189 struct drm_bridge_state *bridge_state)
190{
191 struct meson_encoder_hdmi *encoder_hdmi = bridge_to_meson_encoder_hdmi(bridge);
192 struct drm_atomic_state *state = bridge_state->base.state;
193 unsigned int ycrcb_map = VPU_HDMI_OUTPUT_CBYCR;
194 struct meson_drm *priv = encoder_hdmi->priv;
195 struct drm_connector_state *conn_state;
196 const struct drm_display_mode *mode;
197 struct drm_crtc_state *crtc_state;
198 struct drm_connector *connector;
199 bool yuv420_mode = false;
200 int vic;
201
202 connector = drm_atomic_get_new_connector_for_encoder(state, bridge->encoder);
203 if (WARN_ON(!connector))
204 return;
205
206 conn_state = drm_atomic_get_new_connector_state(state, connector);
207 if (WARN_ON(!conn_state))
208 return;
209
210 crtc_state = drm_atomic_get_new_crtc_state(state, conn_state->crtc);
211 if (WARN_ON(!crtc_state))
212 return;
213
214 mode = &crtc_state->adjusted_mode;
215
216 vic = drm_match_cea_mode(mode);
217
218 dev_dbg(priv->dev, "\"%s\" vic %d\n", mode->name, vic);
219
220 if (encoder_hdmi->output_bus_fmt == MEDIA_BUS_FMT_UYYVYY8_0_5X24) {
221 ycrcb_map = VPU_HDMI_OUTPUT_CRYCB;
222 yuv420_mode = true;
223 } else if (encoder_hdmi->output_bus_fmt == MEDIA_BUS_FMT_UYVY8_1X16)
224 ycrcb_map = VPU_HDMI_OUTPUT_CRYCB;
225
226 /* VENC + VENC-DVI Mode setup */
227 meson_venc_hdmi_mode_set(priv, vic, ycrcb_map, yuv420_mode, mode);
228
229 /* VCLK Set clock */
230 meson_encoder_hdmi_set_vclk(encoder_hdmi, mode);
231
232 if (encoder_hdmi->output_bus_fmt == MEDIA_BUS_FMT_UYYVYY8_0_5X24)
233 /* Setup YUV420 to HDMI-TX, no 10bit diphering */
234 writel_relaxed(2 | (2 << 2),
235 priv->io_base + _REG(VPU_HDMI_FMT_CTRL));
236 else if (encoder_hdmi->output_bus_fmt == MEDIA_BUS_FMT_UYVY8_1X16)
237 /* Setup YUV422 to HDMI-TX, no 10bit diphering */
238 writel_relaxed(1 | (2 << 2),
239 priv->io_base + _REG(VPU_HDMI_FMT_CTRL));
240 else
241 /* Setup YUV444 to HDMI-TX, no 10bit diphering */
242 writel_relaxed(0, priv->io_base + _REG(VPU_HDMI_FMT_CTRL));
243
244 dev_dbg(priv->dev, "%s\n", priv->venc.hdmi_use_enci ? "VENCI" : "VENCP");
245
246 if (priv->venc.hdmi_use_enci)
247 writel_relaxed(1, priv->io_base + _REG(ENCI_VIDEO_EN));
248 else
249 writel_relaxed(1, priv->io_base + _REG(ENCP_VIDEO_EN));
250}
251
252static void meson_encoder_hdmi_atomic_disable(struct drm_bridge *bridge,
253 struct drm_bridge_state *bridge_state)
254{
255 struct meson_encoder_hdmi *encoder_hdmi = bridge_to_meson_encoder_hdmi(bridge);
256 struct meson_drm *priv = encoder_hdmi->priv;
257
258 writel_bits_relaxed(0x3, 0,
259 priv->io_base + _REG(VPU_HDMI_SETTING));
260
261 writel_relaxed(0, priv->io_base + _REG(ENCI_VIDEO_EN));
262 writel_relaxed(0, priv->io_base + _REG(ENCP_VIDEO_EN));
263}
264
265static const u32 meson_encoder_hdmi_out_bus_fmts[] = {
266 MEDIA_BUS_FMT_YUV8_1X24,
267 MEDIA_BUS_FMT_UYVY8_1X16,
268 MEDIA_BUS_FMT_UYYVYY8_0_5X24,
269};
270
271static u32 *
272meson_encoder_hdmi_get_inp_bus_fmts(struct drm_bridge *bridge,
273 struct drm_bridge_state *bridge_state,
274 struct drm_crtc_state *crtc_state,
275 struct drm_connector_state *conn_state,
276 u32 output_fmt,
277 unsigned int *num_input_fmts)
278{
279 u32 *input_fmts = NULL;
280 int i;
281
282 *num_input_fmts = 0;
283
284 for (i = 0 ; i < ARRAY_SIZE(meson_encoder_hdmi_out_bus_fmts) ; ++i) {
285 if (output_fmt == meson_encoder_hdmi_out_bus_fmts[i]) {
286 *num_input_fmts = 1;
287 input_fmts = kcalloc(*num_input_fmts,
288 sizeof(*input_fmts),
289 GFP_KERNEL);
290 if (!input_fmts)
291 return NULL;
292
293 input_fmts[0] = output_fmt;
294
295 break;
296 }
297 }
298
299 return input_fmts;
300}
301
302static int meson_encoder_hdmi_atomic_check(struct drm_bridge *bridge,
303 struct drm_bridge_state *bridge_state,
304 struct drm_crtc_state *crtc_state,
305 struct drm_connector_state *conn_state)
306{
307 struct meson_encoder_hdmi *encoder_hdmi = bridge_to_meson_encoder_hdmi(bridge);
308 struct drm_connector_state *old_conn_state =
309 drm_atomic_get_old_connector_state(conn_state->state, conn_state->connector);
310 struct meson_drm *priv = encoder_hdmi->priv;
311
312 encoder_hdmi->output_bus_fmt = bridge_state->output_bus_cfg.format;
313
314 dev_dbg(priv->dev, "output_bus_fmt %lx\n", encoder_hdmi->output_bus_fmt);
315
316 if (!drm_connector_atomic_hdr_metadata_equal(old_conn_state, conn_state))
317 crtc_state->mode_changed = true;
318
319 return 0;
320}
321
322static void meson_encoder_hdmi_hpd_notify(struct drm_bridge *bridge,
323 enum drm_connector_status status)
324{
325 struct meson_encoder_hdmi *encoder_hdmi = bridge_to_meson_encoder_hdmi(bridge);
326
327 if (!encoder_hdmi->cec_notifier)
328 return;
329
330 if (status == connector_status_connected) {
331 const struct drm_edid *drm_edid;
332 const struct edid *edid;
333
334 drm_edid = drm_bridge_edid_read(encoder_hdmi->next_bridge,
335 encoder_hdmi->connector);
336 if (!drm_edid)
337 return;
338
339 /*
340 * FIXME: The CEC physical address should be set using
341 * cec_notifier_set_phys_addr(encoder_hdmi->cec_notifier,
342 * connector->display_info.source_physical_address) from a path
343 * that has read the EDID and called
344 * drm_edid_connector_update().
345 */
346 edid = drm_edid_raw(drm_edid);
347
348 cec_notifier_set_phys_addr_from_edid(encoder_hdmi->cec_notifier, edid);
349
350 drm_edid_free(drm_edid);
351 } else
352 cec_notifier_phys_addr_invalidate(encoder_hdmi->cec_notifier);
353}
354
355static const struct drm_bridge_funcs meson_encoder_hdmi_bridge_funcs = {
356 .attach = meson_encoder_hdmi_attach,
357 .detach = meson_encoder_hdmi_detach,
358 .mode_valid = meson_encoder_hdmi_mode_valid,
359 .hpd_notify = meson_encoder_hdmi_hpd_notify,
360 .atomic_enable = meson_encoder_hdmi_atomic_enable,
361 .atomic_disable = meson_encoder_hdmi_atomic_disable,
362 .atomic_get_input_bus_fmts = meson_encoder_hdmi_get_inp_bus_fmts,
363 .atomic_check = meson_encoder_hdmi_atomic_check,
364 .atomic_duplicate_state = drm_atomic_helper_bridge_duplicate_state,
365 .atomic_destroy_state = drm_atomic_helper_bridge_destroy_state,
366 .atomic_reset = drm_atomic_helper_bridge_reset,
367};
368
369int meson_encoder_hdmi_probe(struct meson_drm *priv)
370{
371 struct meson_encoder_hdmi *meson_encoder_hdmi;
372 struct platform_device *pdev;
373 struct device_node *remote;
374 int ret;
375
376 meson_encoder_hdmi = devm_kzalloc(priv->dev, sizeof(*meson_encoder_hdmi), GFP_KERNEL);
377 if (!meson_encoder_hdmi)
378 return -ENOMEM;
379
380 /* HDMI Transceiver Bridge */
381 remote = of_graph_get_remote_node(priv->dev->of_node, 1, 0);
382 if (!remote) {
383 dev_err(priv->dev, "HDMI transceiver device is disabled");
384 return 0;
385 }
386
387 meson_encoder_hdmi->next_bridge = of_drm_find_bridge(remote);
388 if (!meson_encoder_hdmi->next_bridge) {
389 ret = dev_err_probe(priv->dev, -EPROBE_DEFER,
390 "Failed to find HDMI transceiver bridge\n");
391 goto err_put_node;
392 }
393
394 /* HDMI Encoder Bridge */
395 meson_encoder_hdmi->bridge.funcs = &meson_encoder_hdmi_bridge_funcs;
396 meson_encoder_hdmi->bridge.of_node = priv->dev->of_node;
397 meson_encoder_hdmi->bridge.type = DRM_MODE_CONNECTOR_HDMIA;
398 meson_encoder_hdmi->bridge.interlace_allowed = true;
399
400 drm_bridge_add(&meson_encoder_hdmi->bridge);
401
402 meson_encoder_hdmi->priv = priv;
403
404 /* Encoder */
405 ret = drm_simple_encoder_init(priv->drm, &meson_encoder_hdmi->encoder,
406 DRM_MODE_ENCODER_TMDS);
407 if (ret) {
408 dev_err_probe(priv->dev, ret, "Failed to init HDMI encoder\n");
409 goto err_put_node;
410 }
411
412 meson_encoder_hdmi->encoder.possible_crtcs = BIT(0);
413
414 /* Attach HDMI Encoder Bridge to Encoder */
415 ret = drm_bridge_attach(&meson_encoder_hdmi->encoder, &meson_encoder_hdmi->bridge, NULL,
416 DRM_BRIDGE_ATTACH_NO_CONNECTOR);
417 if (ret) {
418 dev_err_probe(priv->dev, ret, "Failed to attach bridge\n");
419 goto err_put_node;
420 }
421
422 /* Initialize & attach Bridge Connector */
423 meson_encoder_hdmi->connector = drm_bridge_connector_init(priv->drm,
424 &meson_encoder_hdmi->encoder);
425 if (IS_ERR(meson_encoder_hdmi->connector)) {
426 ret = dev_err_probe(priv->dev,
427 PTR_ERR(meson_encoder_hdmi->connector),
428 "Unable to create HDMI bridge connector\n");
429 goto err_put_node;
430 }
431 drm_connector_attach_encoder(meson_encoder_hdmi->connector,
432 &meson_encoder_hdmi->encoder);
433
434 /*
435 * We should have now in place:
436 * encoder->[hdmi encoder bridge]->[dw-hdmi bridge]->[display connector bridge]->[display connector]
437 */
438
439 /*
440 * drm_connector_attach_max_bpc_property() requires the
441 * connector to have a state.
442 */
443 drm_atomic_helper_connector_reset(meson_encoder_hdmi->connector);
444
445 if (meson_vpu_is_compatible(priv, VPU_COMPATIBLE_GXL) ||
446 meson_vpu_is_compatible(priv, VPU_COMPATIBLE_GXM) ||
447 meson_vpu_is_compatible(priv, VPU_COMPATIBLE_G12A))
448 drm_connector_attach_hdr_output_metadata_property(meson_encoder_hdmi->connector);
449
450 drm_connector_attach_max_bpc_property(meson_encoder_hdmi->connector, 8, 8);
451
452 /* Handle this here until handled by drm_bridge_connector_init() */
453 meson_encoder_hdmi->connector->ycbcr_420_allowed = true;
454
455 pdev = of_find_device_by_node(remote);
456 of_node_put(remote);
457 if (pdev) {
458 struct cec_connector_info conn_info;
459 struct cec_notifier *notifier;
460
461 cec_fill_conn_info_from_drm(&conn_info, meson_encoder_hdmi->connector);
462
463 notifier = cec_notifier_conn_register(&pdev->dev, NULL, &conn_info);
464 if (!notifier) {
465 put_device(&pdev->dev);
466 return -ENOMEM;
467 }
468
469 meson_encoder_hdmi->cec_notifier = notifier;
470 }
471
472 priv->encoders[MESON_ENC_HDMI] = meson_encoder_hdmi;
473
474 dev_dbg(priv->dev, "HDMI encoder initialized\n");
475
476 return 0;
477
478err_put_node:
479 of_node_put(remote);
480 return ret;
481}
482
483void meson_encoder_hdmi_remove(struct meson_drm *priv)
484{
485 struct meson_encoder_hdmi *meson_encoder_hdmi;
486
487 if (priv->encoders[MESON_ENC_HDMI]) {
488 meson_encoder_hdmi = priv->encoders[MESON_ENC_HDMI];
489 drm_bridge_remove(&meson_encoder_hdmi->bridge);
490 }
491}