1e67f6037SNeil Armstrong // SPDX-License-Identifier: GPL-2.0-or-later
2e67f6037SNeil Armstrong /*
3e67f6037SNeil Armstrong * Copyright (C) 2016 BayLibre, SAS
4e67f6037SNeil Armstrong * Author: Neil Armstrong <narmstrong@baylibre.com>
5e67f6037SNeil Armstrong * Copyright (C) 2015 Amlogic, Inc. All rights reserved.
6e67f6037SNeil Armstrong */
7e67f6037SNeil Armstrong
8e67f6037SNeil Armstrong #include <linux/clk.h>
9e67f6037SNeil Armstrong #include <linux/component.h>
10e67f6037SNeil Armstrong #include <linux/kernel.h>
11e67f6037SNeil Armstrong #include <linux/module.h>
12722d4f06SRob Herring #include <linux/of.h>
13e67f6037SNeil Armstrong #include <linux/of_graph.h>
14722d4f06SRob Herring #include <linux/of_platform.h>
15722d4f06SRob Herring #include <linux/platform_device.h>
16e67f6037SNeil Armstrong #include <linux/regulator/consumer.h>
17e67f6037SNeil Armstrong #include <linux/reset.h>
18e67f6037SNeil Armstrong
190af5e0b4SNeil Armstrong #include <media/cec-notifier.h>
200af5e0b4SNeil Armstrong
21e67f6037SNeil Armstrong #include <drm/drm_atomic_helper.h>
22e67f6037SNeil Armstrong #include <drm/drm_bridge.h>
230af5e0b4SNeil Armstrong #include <drm/drm_bridge_connector.h>
24e67f6037SNeil Armstrong #include <drm/drm_device.h>
25e67f6037SNeil Armstrong #include <drm/drm_edid.h>
26e67f6037SNeil Armstrong #include <drm/drm_probe_helper.h>
27e67f6037SNeil Armstrong #include <drm/drm_simple_kms_helper.h>
28e67f6037SNeil Armstrong
29e67f6037SNeil Armstrong #include <linux/media-bus-format.h>
30e67f6037SNeil Armstrong #include <linux/videodev2.h>
31e67f6037SNeil Armstrong
32e67f6037SNeil Armstrong #include "meson_drv.h"
33e67f6037SNeil Armstrong #include "meson_registers.h"
34e67f6037SNeil Armstrong #include "meson_vclk.h"
35e67f6037SNeil Armstrong #include "meson_venc.h"
36e67f6037SNeil Armstrong #include "meson_encoder_hdmi.h"
37e67f6037SNeil Armstrong
38e67f6037SNeil Armstrong struct meson_encoder_hdmi {
39e67f6037SNeil Armstrong struct drm_encoder encoder;
40e67f6037SNeil Armstrong struct drm_bridge bridge;
41e67f6037SNeil Armstrong struct drm_bridge *next_bridge;
420af5e0b4SNeil Armstrong struct drm_connector *connector;
43e67f6037SNeil Armstrong struct meson_drm *priv;
44e67f6037SNeil Armstrong unsigned long output_bus_fmt;
450af5e0b4SNeil Armstrong struct cec_notifier *cec_notifier;
46e67f6037SNeil Armstrong };
47e67f6037SNeil Armstrong
48e67f6037SNeil Armstrong #define bridge_to_meson_encoder_hdmi(x) \
49e67f6037SNeil Armstrong container_of(x, struct meson_encoder_hdmi, bridge)
50e67f6037SNeil Armstrong
meson_encoder_hdmi_attach(struct drm_bridge * bridge,enum drm_bridge_attach_flags flags)51e67f6037SNeil Armstrong static int meson_encoder_hdmi_attach(struct drm_bridge *bridge,
52e67f6037SNeil Armstrong enum drm_bridge_attach_flags flags)
53e67f6037SNeil Armstrong {
54e67f6037SNeil Armstrong struct meson_encoder_hdmi *encoder_hdmi = bridge_to_meson_encoder_hdmi(bridge);
55e67f6037SNeil Armstrong
56e67f6037SNeil Armstrong return drm_bridge_attach(bridge->encoder, encoder_hdmi->next_bridge,
57e67f6037SNeil Armstrong &encoder_hdmi->bridge, flags);
58e67f6037SNeil Armstrong }
59e67f6037SNeil Armstrong
meson_encoder_hdmi_detach(struct drm_bridge * bridge)600af5e0b4SNeil Armstrong static void meson_encoder_hdmi_detach(struct drm_bridge *bridge)
610af5e0b4SNeil Armstrong {
620af5e0b4SNeil Armstrong struct meson_encoder_hdmi *encoder_hdmi = bridge_to_meson_encoder_hdmi(bridge);
630af5e0b4SNeil Armstrong
640af5e0b4SNeil Armstrong cec_notifier_conn_unregister(encoder_hdmi->cec_notifier);
650af5e0b4SNeil Armstrong encoder_hdmi->cec_notifier = NULL;
660af5e0b4SNeil Armstrong }
670af5e0b4SNeil Armstrong
meson_encoder_hdmi_set_vclk(struct meson_encoder_hdmi * encoder_hdmi,const struct drm_display_mode * mode)68e67f6037SNeil Armstrong static void meson_encoder_hdmi_set_vclk(struct meson_encoder_hdmi *encoder_hdmi,
69e67f6037SNeil Armstrong const struct drm_display_mode *mode)
70e67f6037SNeil Armstrong {
71e67f6037SNeil Armstrong struct meson_drm *priv = encoder_hdmi->priv;
72e67f6037SNeil Armstrong int vic = drm_match_cea_mode(mode);
73e67f6037SNeil Armstrong unsigned int phy_freq;
74e67f6037SNeil Armstrong unsigned int vclk_freq;
75e67f6037SNeil Armstrong unsigned int venc_freq;
76e67f6037SNeil Armstrong unsigned int hdmi_freq;
77e67f6037SNeil Armstrong
78e67f6037SNeil Armstrong vclk_freq = mode->clock;
79e67f6037SNeil Armstrong
80e67f6037SNeil Armstrong /* For 420, pixel clock is half unlike venc clock */
81e67f6037SNeil Armstrong if (encoder_hdmi->output_bus_fmt == MEDIA_BUS_FMT_UYYVYY8_0_5X24)
82e67f6037SNeil Armstrong vclk_freq /= 2;
83e67f6037SNeil Armstrong
84e67f6037SNeil Armstrong /* TMDS clock is pixel_clock * 10 */
85e67f6037SNeil Armstrong phy_freq = vclk_freq * 10;
86e67f6037SNeil Armstrong
87e67f6037SNeil Armstrong if (!vic) {
88e67f6037SNeil Armstrong meson_vclk_setup(priv, MESON_VCLK_TARGET_DMT, phy_freq,
89e67f6037SNeil Armstrong vclk_freq, vclk_freq, vclk_freq, false);
90e67f6037SNeil Armstrong return;
91e67f6037SNeil Armstrong }
92e67f6037SNeil Armstrong
93e67f6037SNeil Armstrong /* 480i/576i needs global pixel doubling */
94e67f6037SNeil Armstrong if (mode->flags & DRM_MODE_FLAG_DBLCLK)
95e67f6037SNeil Armstrong vclk_freq *= 2;
96e67f6037SNeil Armstrong
97e67f6037SNeil Armstrong venc_freq = vclk_freq;
98e67f6037SNeil Armstrong hdmi_freq = vclk_freq;
99e67f6037SNeil Armstrong
100e67f6037SNeil Armstrong /* VENC double pixels for 1080i, 720p and YUV420 modes */
101e67f6037SNeil Armstrong if (meson_venc_hdmi_venc_repeat(vic) ||
102e67f6037SNeil Armstrong encoder_hdmi->output_bus_fmt == MEDIA_BUS_FMT_UYYVYY8_0_5X24)
103e67f6037SNeil Armstrong venc_freq *= 2;
104e67f6037SNeil Armstrong
105e67f6037SNeil Armstrong vclk_freq = max(venc_freq, hdmi_freq);
106e67f6037SNeil Armstrong
107e67f6037SNeil Armstrong if (mode->flags & DRM_MODE_FLAG_DBLCLK)
108e67f6037SNeil Armstrong venc_freq /= 2;
109e67f6037SNeil Armstrong
110e67f6037SNeil Armstrong dev_dbg(priv->dev, "vclk:%d phy=%d venc=%d hdmi=%d enci=%d\n",
111e67f6037SNeil Armstrong phy_freq, vclk_freq, venc_freq, hdmi_freq,
112e67f6037SNeil Armstrong priv->venc.hdmi_use_enci);
113e67f6037SNeil Armstrong
114e67f6037SNeil Armstrong meson_vclk_setup(priv, MESON_VCLK_TARGET_HDMI, phy_freq, vclk_freq,
115e67f6037SNeil Armstrong venc_freq, hdmi_freq, priv->venc.hdmi_use_enci);
116e67f6037SNeil Armstrong }
117e67f6037SNeil Armstrong
meson_encoder_hdmi_mode_valid(struct drm_bridge * bridge,const struct drm_display_info * display_info,const struct drm_display_mode * mode)118e67f6037SNeil Armstrong static enum drm_mode_status meson_encoder_hdmi_mode_valid(struct drm_bridge *bridge,
119e67f6037SNeil Armstrong const struct drm_display_info *display_info,
120e67f6037SNeil Armstrong const struct drm_display_mode *mode)
121e67f6037SNeil Armstrong {
122e67f6037SNeil Armstrong struct meson_encoder_hdmi *encoder_hdmi = bridge_to_meson_encoder_hdmi(bridge);
123e67f6037SNeil Armstrong struct meson_drm *priv = encoder_hdmi->priv;
124e67f6037SNeil Armstrong bool is_hdmi2_sink = display_info->hdmi.scdc.supported;
125e67f6037SNeil Armstrong unsigned int phy_freq;
126e67f6037SNeil Armstrong unsigned int vclk_freq;
127e67f6037SNeil Armstrong unsigned int venc_freq;
128e67f6037SNeil Armstrong unsigned int hdmi_freq;
129e67f6037SNeil Armstrong int vic = drm_match_cea_mode(mode);
130e67f6037SNeil Armstrong enum drm_mode_status status;
131e67f6037SNeil Armstrong
132e67f6037SNeil Armstrong dev_dbg(priv->dev, "Modeline " DRM_MODE_FMT "\n", DRM_MODE_ARG(mode));
133e67f6037SNeil Armstrong
134e67f6037SNeil Armstrong /* If sink does not support 540MHz, reject the non-420 HDMI2 modes */
135e67f6037SNeil Armstrong if (display_info->max_tmds_clock &&
136e67f6037SNeil Armstrong mode->clock > display_info->max_tmds_clock &&
137e67f6037SNeil Armstrong !drm_mode_is_420_only(display_info, mode) &&
138e67f6037SNeil Armstrong !drm_mode_is_420_also(display_info, mode))
139e67f6037SNeil Armstrong return MODE_BAD;
140e67f6037SNeil Armstrong
141e67f6037SNeil Armstrong /* Check against non-VIC supported modes */
142e67f6037SNeil Armstrong if (!vic) {
143e67f6037SNeil Armstrong status = meson_venc_hdmi_supported_mode(mode);
144e67f6037SNeil Armstrong if (status != MODE_OK)
145e67f6037SNeil Armstrong return status;
146e67f6037SNeil Armstrong
147e67f6037SNeil Armstrong return meson_vclk_dmt_supported_freq(priv, mode->clock);
148e67f6037SNeil Armstrong /* Check against supported VIC modes */
149e67f6037SNeil Armstrong } else if (!meson_venc_hdmi_supported_vic(vic))
150e67f6037SNeil Armstrong return MODE_BAD;
151e67f6037SNeil Armstrong
152e67f6037SNeil Armstrong vclk_freq = mode->clock;
153e67f6037SNeil Armstrong
154e67f6037SNeil Armstrong /* For 420, pixel clock is half unlike venc clock */
155e67f6037SNeil Armstrong if (drm_mode_is_420_only(display_info, mode) ||
156e67f6037SNeil Armstrong (!is_hdmi2_sink &&
157e67f6037SNeil Armstrong drm_mode_is_420_also(display_info, mode)))
158e67f6037SNeil Armstrong vclk_freq /= 2;
159e67f6037SNeil Armstrong
160e67f6037SNeil Armstrong /* TMDS clock is pixel_clock * 10 */
161e67f6037SNeil Armstrong phy_freq = vclk_freq * 10;
162e67f6037SNeil Armstrong
163e67f6037SNeil Armstrong /* 480i/576i needs global pixel doubling */
164e67f6037SNeil Armstrong if (mode->flags & DRM_MODE_FLAG_DBLCLK)
165e67f6037SNeil Armstrong vclk_freq *= 2;
166e67f6037SNeil Armstrong
167e67f6037SNeil Armstrong venc_freq = vclk_freq;
168e67f6037SNeil Armstrong hdmi_freq = vclk_freq;
169e67f6037SNeil Armstrong
170e67f6037SNeil Armstrong /* VENC double pixels for 1080i, 720p and YUV420 modes */
171e67f6037SNeil Armstrong if (meson_venc_hdmi_venc_repeat(vic) ||
172e67f6037SNeil Armstrong drm_mode_is_420_only(display_info, mode) ||
173e67f6037SNeil Armstrong (!is_hdmi2_sink &&
174e67f6037SNeil Armstrong drm_mode_is_420_also(display_info, mode)))
175e67f6037SNeil Armstrong venc_freq *= 2;
176e67f6037SNeil Armstrong
177e67f6037SNeil Armstrong vclk_freq = max(venc_freq, hdmi_freq);
178e67f6037SNeil Armstrong
179e67f6037SNeil Armstrong if (mode->flags & DRM_MODE_FLAG_DBLCLK)
180e67f6037SNeil Armstrong venc_freq /= 2;
181e67f6037SNeil Armstrong
182e67f6037SNeil Armstrong dev_dbg(priv->dev, "%s: vclk:%d phy=%d venc=%d hdmi=%d\n",
183e67f6037SNeil Armstrong __func__, phy_freq, vclk_freq, venc_freq, hdmi_freq);
184e67f6037SNeil Armstrong
185e67f6037SNeil Armstrong return meson_vclk_vic_supported_freq(priv, phy_freq, vclk_freq);
186e67f6037SNeil Armstrong }
187e67f6037SNeil Armstrong
meson_encoder_hdmi_atomic_enable(struct drm_bridge * bridge,struct drm_bridge_state * bridge_state)188e67f6037SNeil Armstrong static void meson_encoder_hdmi_atomic_enable(struct drm_bridge *bridge,
189e67f6037SNeil Armstrong struct drm_bridge_state *bridge_state)
190e67f6037SNeil Armstrong {
191e67f6037SNeil Armstrong struct meson_encoder_hdmi *encoder_hdmi = bridge_to_meson_encoder_hdmi(bridge);
192e67f6037SNeil Armstrong struct drm_atomic_state *state = bridge_state->base.state;
193e67f6037SNeil Armstrong unsigned int ycrcb_map = VPU_HDMI_OUTPUT_CBYCR;
194e67f6037SNeil Armstrong struct meson_drm *priv = encoder_hdmi->priv;
195e67f6037SNeil Armstrong struct drm_connector_state *conn_state;
196e67f6037SNeil Armstrong const struct drm_display_mode *mode;
197e67f6037SNeil Armstrong struct drm_crtc_state *crtc_state;
198e67f6037SNeil Armstrong struct drm_connector *connector;
199e67f6037SNeil Armstrong bool yuv420_mode = false;
200e67f6037SNeil Armstrong int vic;
201e67f6037SNeil Armstrong
202e67f6037SNeil Armstrong connector = drm_atomic_get_new_connector_for_encoder(state, bridge->encoder);
203e67f6037SNeil Armstrong if (WARN_ON(!connector))
204e67f6037SNeil Armstrong return;
205e67f6037SNeil Armstrong
206e67f6037SNeil Armstrong conn_state = drm_atomic_get_new_connector_state(state, connector);
207e67f6037SNeil Armstrong if (WARN_ON(!conn_state))
208e67f6037SNeil Armstrong return;
209e67f6037SNeil Armstrong
210e67f6037SNeil Armstrong crtc_state = drm_atomic_get_new_crtc_state(state, conn_state->crtc);
211e67f6037SNeil Armstrong if (WARN_ON(!crtc_state))
212e67f6037SNeil Armstrong return;
213e67f6037SNeil Armstrong
214e67f6037SNeil Armstrong mode = &crtc_state->adjusted_mode;
215e67f6037SNeil Armstrong
216e67f6037SNeil Armstrong vic = drm_match_cea_mode(mode);
217e67f6037SNeil Armstrong
218e67f6037SNeil Armstrong dev_dbg(priv->dev, "\"%s\" vic %d\n", mode->name, vic);
219e67f6037SNeil Armstrong
220e67f6037SNeil Armstrong if (encoder_hdmi->output_bus_fmt == MEDIA_BUS_FMT_UYYVYY8_0_5X24) {
221e67f6037SNeil Armstrong ycrcb_map = VPU_HDMI_OUTPUT_CRYCB;
222e67f6037SNeil Armstrong yuv420_mode = true;
223c193a003SDongjin Kim } else if (encoder_hdmi->output_bus_fmt == MEDIA_BUS_FMT_UYVY8_1X16)
224c193a003SDongjin Kim ycrcb_map = VPU_HDMI_OUTPUT_CRYCB;
225e67f6037SNeil Armstrong
226e67f6037SNeil Armstrong /* VENC + VENC-DVI Mode setup */
227e67f6037SNeil Armstrong meson_venc_hdmi_mode_set(priv, vic, ycrcb_map, yuv420_mode, mode);
228e67f6037SNeil Armstrong
229e67f6037SNeil Armstrong /* VCLK Set clock */
230e67f6037SNeil Armstrong meson_encoder_hdmi_set_vclk(encoder_hdmi, mode);
231e67f6037SNeil Armstrong
232e67f6037SNeil Armstrong if (encoder_hdmi->output_bus_fmt == MEDIA_BUS_FMT_UYYVYY8_0_5X24)
233e67f6037SNeil Armstrong /* Setup YUV420 to HDMI-TX, no 10bit diphering */
234e67f6037SNeil Armstrong writel_relaxed(2 | (2 << 2),
235e67f6037SNeil Armstrong priv->io_base + _REG(VPU_HDMI_FMT_CTRL));
236c193a003SDongjin Kim else if (encoder_hdmi->output_bus_fmt == MEDIA_BUS_FMT_UYVY8_1X16)
237c193a003SDongjin Kim /* Setup YUV422 to HDMI-TX, no 10bit diphering */
238c193a003SDongjin Kim writel_relaxed(1 | (2 << 2),
239c193a003SDongjin Kim priv->io_base + _REG(VPU_HDMI_FMT_CTRL));
240e67f6037SNeil Armstrong else
241e67f6037SNeil Armstrong /* Setup YUV444 to HDMI-TX, no 10bit diphering */
242e67f6037SNeil Armstrong writel_relaxed(0, priv->io_base + _REG(VPU_HDMI_FMT_CTRL));
243e67f6037SNeil Armstrong
244e67f6037SNeil Armstrong dev_dbg(priv->dev, "%s\n", priv->venc.hdmi_use_enci ? "VENCI" : "VENCP");
245e67f6037SNeil Armstrong
246e67f6037SNeil Armstrong if (priv->venc.hdmi_use_enci)
247e67f6037SNeil Armstrong writel_relaxed(1, priv->io_base + _REG(ENCI_VIDEO_EN));
248e67f6037SNeil Armstrong else
249e67f6037SNeil Armstrong writel_relaxed(1, priv->io_base + _REG(ENCP_VIDEO_EN));
250e67f6037SNeil Armstrong }
251e67f6037SNeil Armstrong
meson_encoder_hdmi_atomic_disable(struct drm_bridge * bridge,struct drm_bridge_state * bridge_state)252e67f6037SNeil Armstrong static void meson_encoder_hdmi_atomic_disable(struct drm_bridge *bridge,
253e67f6037SNeil Armstrong struct drm_bridge_state *bridge_state)
254e67f6037SNeil Armstrong {
255e67f6037SNeil Armstrong struct meson_encoder_hdmi *encoder_hdmi = bridge_to_meson_encoder_hdmi(bridge);
256e67f6037SNeil Armstrong struct meson_drm *priv = encoder_hdmi->priv;
257e67f6037SNeil Armstrong
258e67f6037SNeil Armstrong writel_bits_relaxed(0x3, 0,
259e67f6037SNeil Armstrong priv->io_base + _REG(VPU_HDMI_SETTING));
260e67f6037SNeil Armstrong
261e67f6037SNeil Armstrong writel_relaxed(0, priv->io_base + _REG(ENCI_VIDEO_EN));
262e67f6037SNeil Armstrong writel_relaxed(0, priv->io_base + _REG(ENCP_VIDEO_EN));
263e67f6037SNeil Armstrong }
264e67f6037SNeil Armstrong
265e67f6037SNeil Armstrong static const u32 meson_encoder_hdmi_out_bus_fmts[] = {
266e67f6037SNeil Armstrong MEDIA_BUS_FMT_YUV8_1X24,
267c193a003SDongjin Kim MEDIA_BUS_FMT_UYVY8_1X16,
268e67f6037SNeil Armstrong MEDIA_BUS_FMT_UYYVYY8_0_5X24,
269e67f6037SNeil Armstrong };
270e67f6037SNeil Armstrong
271e67f6037SNeil Armstrong static u32 *
meson_encoder_hdmi_get_inp_bus_fmts(struct drm_bridge * bridge,struct drm_bridge_state * bridge_state,struct drm_crtc_state * crtc_state,struct drm_connector_state * conn_state,u32 output_fmt,unsigned int * num_input_fmts)272e67f6037SNeil Armstrong meson_encoder_hdmi_get_inp_bus_fmts(struct drm_bridge *bridge,
273e67f6037SNeil Armstrong struct drm_bridge_state *bridge_state,
274e67f6037SNeil Armstrong struct drm_crtc_state *crtc_state,
275e67f6037SNeil Armstrong struct drm_connector_state *conn_state,
276e67f6037SNeil Armstrong u32 output_fmt,
277e67f6037SNeil Armstrong unsigned int *num_input_fmts)
278e67f6037SNeil Armstrong {
279e67f6037SNeil Armstrong u32 *input_fmts = NULL;
280e67f6037SNeil Armstrong int i;
281e67f6037SNeil Armstrong
282e67f6037SNeil Armstrong *num_input_fmts = 0;
283e67f6037SNeil Armstrong
284e67f6037SNeil Armstrong for (i = 0 ; i < ARRAY_SIZE(meson_encoder_hdmi_out_bus_fmts) ; ++i) {
285e67f6037SNeil Armstrong if (output_fmt == meson_encoder_hdmi_out_bus_fmts[i]) {
286e67f6037SNeil Armstrong *num_input_fmts = 1;
287e67f6037SNeil Armstrong input_fmts = kcalloc(*num_input_fmts,
288e67f6037SNeil Armstrong sizeof(*input_fmts),
289e67f6037SNeil Armstrong GFP_KERNEL);
290e67f6037SNeil Armstrong if (!input_fmts)
291e67f6037SNeil Armstrong return NULL;
292e67f6037SNeil Armstrong
293e67f6037SNeil Armstrong input_fmts[0] = output_fmt;
294e67f6037SNeil Armstrong
295e67f6037SNeil Armstrong break;
296e67f6037SNeil Armstrong }
297e67f6037SNeil Armstrong }
298e67f6037SNeil Armstrong
299e67f6037SNeil Armstrong return input_fmts;
300e67f6037SNeil Armstrong }
301e67f6037SNeil Armstrong
meson_encoder_hdmi_atomic_check(struct drm_bridge * bridge,struct drm_bridge_state * bridge_state,struct drm_crtc_state * crtc_state,struct drm_connector_state * conn_state)302e67f6037SNeil Armstrong static int meson_encoder_hdmi_atomic_check(struct drm_bridge *bridge,
303e67f6037SNeil Armstrong struct drm_bridge_state *bridge_state,
304e67f6037SNeil Armstrong struct drm_crtc_state *crtc_state,
305e67f6037SNeil Armstrong struct drm_connector_state *conn_state)
306e67f6037SNeil Armstrong {
307e67f6037SNeil Armstrong struct meson_encoder_hdmi *encoder_hdmi = bridge_to_meson_encoder_hdmi(bridge);
308e67f6037SNeil Armstrong struct drm_connector_state *old_conn_state =
309e67f6037SNeil Armstrong drm_atomic_get_old_connector_state(conn_state->state, conn_state->connector);
310e67f6037SNeil Armstrong struct meson_drm *priv = encoder_hdmi->priv;
311e67f6037SNeil Armstrong
312e67f6037SNeil Armstrong encoder_hdmi->output_bus_fmt = bridge_state->output_bus_cfg.format;
313e67f6037SNeil Armstrong
314e67f6037SNeil Armstrong dev_dbg(priv->dev, "output_bus_fmt %lx\n", encoder_hdmi->output_bus_fmt);
315e67f6037SNeil Armstrong
316e67f6037SNeil Armstrong if (!drm_connector_atomic_hdr_metadata_equal(old_conn_state, conn_state))
317e67f6037SNeil Armstrong crtc_state->mode_changed = true;
318e67f6037SNeil Armstrong
319e67f6037SNeil Armstrong return 0;
320e67f6037SNeil Armstrong }
321e67f6037SNeil Armstrong
meson_encoder_hdmi_hpd_notify(struct drm_bridge * bridge,enum drm_connector_status status)3220af5e0b4SNeil Armstrong static void meson_encoder_hdmi_hpd_notify(struct drm_bridge *bridge,
3230af5e0b4SNeil Armstrong enum drm_connector_status status)
3240af5e0b4SNeil Armstrong {
3250af5e0b4SNeil Armstrong struct meson_encoder_hdmi *encoder_hdmi = bridge_to_meson_encoder_hdmi(bridge);
3260af5e0b4SNeil Armstrong struct edid *edid;
3270af5e0b4SNeil Armstrong
3280af5e0b4SNeil Armstrong if (!encoder_hdmi->cec_notifier)
3290af5e0b4SNeil Armstrong return;
3300af5e0b4SNeil Armstrong
3310af5e0b4SNeil Armstrong if (status == connector_status_connected) {
3320af5e0b4SNeil Armstrong edid = drm_bridge_get_edid(encoder_hdmi->next_bridge, encoder_hdmi->connector);
3330af5e0b4SNeil Armstrong if (!edid)
3340af5e0b4SNeil Armstrong return;
3350af5e0b4SNeil Armstrong
3360af5e0b4SNeil Armstrong cec_notifier_set_phys_addr_from_edid(encoder_hdmi->cec_notifier, edid);
337*099f0af9SJani Nikula
338*099f0af9SJani Nikula kfree(edid);
3390af5e0b4SNeil Armstrong } else
3400af5e0b4SNeil Armstrong cec_notifier_phys_addr_invalidate(encoder_hdmi->cec_notifier);
3410af5e0b4SNeil Armstrong }
3420af5e0b4SNeil Armstrong
343e67f6037SNeil Armstrong static const struct drm_bridge_funcs meson_encoder_hdmi_bridge_funcs = {
344e67f6037SNeil Armstrong .attach = meson_encoder_hdmi_attach,
3450af5e0b4SNeil Armstrong .detach = meson_encoder_hdmi_detach,
346e67f6037SNeil Armstrong .mode_valid = meson_encoder_hdmi_mode_valid,
3470af5e0b4SNeil Armstrong .hpd_notify = meson_encoder_hdmi_hpd_notify,
348e67f6037SNeil Armstrong .atomic_enable = meson_encoder_hdmi_atomic_enable,
349e67f6037SNeil Armstrong .atomic_disable = meson_encoder_hdmi_atomic_disable,
350e67f6037SNeil Armstrong .atomic_get_input_bus_fmts = meson_encoder_hdmi_get_inp_bus_fmts,
351e67f6037SNeil Armstrong .atomic_check = meson_encoder_hdmi_atomic_check,
352e67f6037SNeil Armstrong .atomic_duplicate_state = drm_atomic_helper_bridge_duplicate_state,
353e67f6037SNeil Armstrong .atomic_destroy_state = drm_atomic_helper_bridge_destroy_state,
354e67f6037SNeil Armstrong .atomic_reset = drm_atomic_helper_bridge_reset,
355e67f6037SNeil Armstrong };
356e67f6037SNeil Armstrong
meson_encoder_hdmi_init(struct meson_drm * priv)357e67f6037SNeil Armstrong int meson_encoder_hdmi_init(struct meson_drm *priv)
358e67f6037SNeil Armstrong {
359e67f6037SNeil Armstrong struct meson_encoder_hdmi *meson_encoder_hdmi;
3600af5e0b4SNeil Armstrong struct platform_device *pdev;
361e67f6037SNeil Armstrong struct device_node *remote;
362e67f6037SNeil Armstrong int ret;
363e67f6037SNeil Armstrong
364e67f6037SNeil Armstrong meson_encoder_hdmi = devm_kzalloc(priv->dev, sizeof(*meson_encoder_hdmi), GFP_KERNEL);
365e67f6037SNeil Armstrong if (!meson_encoder_hdmi)
366e67f6037SNeil Armstrong return -ENOMEM;
367e67f6037SNeil Armstrong
368e67f6037SNeil Armstrong /* HDMI Transceiver Bridge */
369e67f6037SNeil Armstrong remote = of_graph_get_remote_node(priv->dev->of_node, 1, 0);
370e67f6037SNeil Armstrong if (!remote) {
371e67f6037SNeil Armstrong dev_err(priv->dev, "HDMI transceiver device is disabled");
372e67f6037SNeil Armstrong return 0;
373e67f6037SNeil Armstrong }
374e67f6037SNeil Armstrong
375e67f6037SNeil Armstrong meson_encoder_hdmi->next_bridge = of_drm_find_bridge(remote);
376e67f6037SNeil Armstrong if (!meson_encoder_hdmi->next_bridge) {
377e67f6037SNeil Armstrong dev_err(priv->dev, "Failed to find HDMI transceiver bridge\n");
378d82a5a4aSMiaoqian Lin ret = -EPROBE_DEFER;
379d82a5a4aSMiaoqian Lin goto err_put_node;
380e67f6037SNeil Armstrong }
381e67f6037SNeil Armstrong
382e67f6037SNeil Armstrong /* HDMI Encoder Bridge */
383e67f6037SNeil Armstrong meson_encoder_hdmi->bridge.funcs = &meson_encoder_hdmi_bridge_funcs;
384e67f6037SNeil Armstrong meson_encoder_hdmi->bridge.of_node = priv->dev->of_node;
385e67f6037SNeil Armstrong meson_encoder_hdmi->bridge.type = DRM_MODE_CONNECTOR_HDMIA;
3860af5e0b4SNeil Armstrong meson_encoder_hdmi->bridge.interlace_allowed = true;
387e67f6037SNeil Armstrong
388e67f6037SNeil Armstrong drm_bridge_add(&meson_encoder_hdmi->bridge);
389e67f6037SNeil Armstrong
390e67f6037SNeil Armstrong meson_encoder_hdmi->priv = priv;
391e67f6037SNeil Armstrong
392e67f6037SNeil Armstrong /* Encoder */
393e67f6037SNeil Armstrong ret = drm_simple_encoder_init(priv->drm, &meson_encoder_hdmi->encoder,
394e67f6037SNeil Armstrong DRM_MODE_ENCODER_TMDS);
395e67f6037SNeil Armstrong if (ret) {
396e67f6037SNeil Armstrong dev_err(priv->dev, "Failed to init HDMI encoder: %d\n", ret);
397d82a5a4aSMiaoqian Lin goto err_put_node;
398e67f6037SNeil Armstrong }
399e67f6037SNeil Armstrong
400e67f6037SNeil Armstrong meson_encoder_hdmi->encoder.possible_crtcs = BIT(0);
401e67f6037SNeil Armstrong
402e67f6037SNeil Armstrong /* Attach HDMI Encoder Bridge to Encoder */
4030af5e0b4SNeil Armstrong ret = drm_bridge_attach(&meson_encoder_hdmi->encoder, &meson_encoder_hdmi->bridge, NULL,
4040af5e0b4SNeil Armstrong DRM_BRIDGE_ATTACH_NO_CONNECTOR);
405e67f6037SNeil Armstrong if (ret) {
406e67f6037SNeil Armstrong dev_err(priv->dev, "Failed to attach bridge: %d\n", ret);
407d82a5a4aSMiaoqian Lin goto err_put_node;
408e67f6037SNeil Armstrong }
409e67f6037SNeil Armstrong
4100af5e0b4SNeil Armstrong /* Initialize & attach Bridge Connector */
4110af5e0b4SNeil Armstrong meson_encoder_hdmi->connector = drm_bridge_connector_init(priv->drm,
4120af5e0b4SNeil Armstrong &meson_encoder_hdmi->encoder);
4130af5e0b4SNeil Armstrong if (IS_ERR(meson_encoder_hdmi->connector)) {
4140af5e0b4SNeil Armstrong dev_err(priv->dev, "Unable to create HDMI bridge connector\n");
415d82a5a4aSMiaoqian Lin ret = PTR_ERR(meson_encoder_hdmi->connector);
416d82a5a4aSMiaoqian Lin goto err_put_node;
4170af5e0b4SNeil Armstrong }
4180af5e0b4SNeil Armstrong drm_connector_attach_encoder(meson_encoder_hdmi->connector,
4190af5e0b4SNeil Armstrong &meson_encoder_hdmi->encoder);
4200af5e0b4SNeil Armstrong
421e67f6037SNeil Armstrong /*
422e67f6037SNeil Armstrong * We should have now in place:
4230af5e0b4SNeil Armstrong * encoder->[hdmi encoder bridge]->[dw-hdmi bridge]->[display connector bridge]->[display connector]
424e67f6037SNeil Armstrong */
425e67f6037SNeil Armstrong
4260af5e0b4SNeil Armstrong /*
4270af5e0b4SNeil Armstrong * drm_connector_attach_max_bpc_property() requires the
4280af5e0b4SNeil Armstrong * connector to have a state.
4290af5e0b4SNeil Armstrong */
4300af5e0b4SNeil Armstrong drm_atomic_helper_connector_reset(meson_encoder_hdmi->connector);
4310af5e0b4SNeil Armstrong
4320af5e0b4SNeil Armstrong if (meson_vpu_is_compatible(priv, VPU_COMPATIBLE_GXL) ||
4330af5e0b4SNeil Armstrong meson_vpu_is_compatible(priv, VPU_COMPATIBLE_GXM) ||
4340af5e0b4SNeil Armstrong meson_vpu_is_compatible(priv, VPU_COMPATIBLE_G12A))
4350af5e0b4SNeil Armstrong drm_connector_attach_hdr_output_metadata_property(meson_encoder_hdmi->connector);
4360af5e0b4SNeil Armstrong
4370af5e0b4SNeil Armstrong drm_connector_attach_max_bpc_property(meson_encoder_hdmi->connector, 8, 8);
4380af5e0b4SNeil Armstrong
4390af5e0b4SNeil Armstrong /* Handle this here until handled by drm_bridge_connector_init() */
4400af5e0b4SNeil Armstrong meson_encoder_hdmi->connector->ycbcr_420_allowed = true;
4410af5e0b4SNeil Armstrong
4420af5e0b4SNeil Armstrong pdev = of_find_device_by_node(remote);
443d82a5a4aSMiaoqian Lin of_node_put(remote);
4440af5e0b4SNeil Armstrong if (pdev) {
4450af5e0b4SNeil Armstrong struct cec_connector_info conn_info;
4460af5e0b4SNeil Armstrong struct cec_notifier *notifier;
4470af5e0b4SNeil Armstrong
4480af5e0b4SNeil Armstrong cec_fill_conn_info_from_drm(&conn_info, meson_encoder_hdmi->connector);
4490af5e0b4SNeil Armstrong
4500af5e0b4SNeil Armstrong notifier = cec_notifier_conn_register(&pdev->dev, NULL, &conn_info);
45173810768SMiaoqian Lin if (!notifier) {
45273810768SMiaoqian Lin put_device(&pdev->dev);
4530af5e0b4SNeil Armstrong return -ENOMEM;
45473810768SMiaoqian Lin }
4550af5e0b4SNeil Armstrong
4560af5e0b4SNeil Armstrong meson_encoder_hdmi->cec_notifier = notifier;
4570af5e0b4SNeil Armstrong }
4580af5e0b4SNeil Armstrong
45909847723SAdrián Larumbe priv->encoders[MESON_ENC_HDMI] = meson_encoder_hdmi;
46009847723SAdrián Larumbe
461e67f6037SNeil Armstrong dev_dbg(priv->dev, "HDMI encoder initialized\n");
462e67f6037SNeil Armstrong
463e67f6037SNeil Armstrong return 0;
464d82a5a4aSMiaoqian Lin
465d82a5a4aSMiaoqian Lin err_put_node:
466d82a5a4aSMiaoqian Lin of_node_put(remote);
467d82a5a4aSMiaoqian Lin return ret;
468e67f6037SNeil Armstrong }
46909847723SAdrián Larumbe
meson_encoder_hdmi_remove(struct meson_drm * priv)47009847723SAdrián Larumbe void meson_encoder_hdmi_remove(struct meson_drm *priv)
47109847723SAdrián Larumbe {
47209847723SAdrián Larumbe struct meson_encoder_hdmi *meson_encoder_hdmi;
47309847723SAdrián Larumbe
47409847723SAdrián Larumbe if (priv->encoders[MESON_ENC_HDMI]) {
47509847723SAdrián Larumbe meson_encoder_hdmi = priv->encoders[MESON_ENC_HDMI];
47609847723SAdrián Larumbe drm_bridge_remove(&meson_encoder_hdmi->bridge);
47709847723SAdrián Larumbe }
47809847723SAdrián Larumbe }
479