// SPDX-License-Identifier: MIT

#include <linux/export.h>
#include <linux/module.h>

#include <drm/display/drm_hdmi_helper.h>
#include <drm/display/drm_scdc_helper.h>

#include <drm/drm_atomic.h>
#include <drm/drm_atomic_helper.h>
#include <drm/drm_connector.h>
#include <drm/drm_crtc.h>
#include <drm/drm_edid.h>
#include <drm/drm_modes.h>
#include <drm/drm_modeset_lock.h>
#include <drm/drm_print.h>
#include <drm/drm_property.h>

#define DRM_HDMI_SCDC_SOURCE_VERSION	1
#define DRM_HDMI_SCDC_POLL_DELAY_MS	1000

static inline bool is_eotf_supported(u8 output_eotf, u8 sink_eotf)
{
	return sink_eotf & BIT(output_eotf);
}

/**
 * drm_hdmi_infoframe_set_hdr_metadata() - fill an HDMI DRM infoframe with
 *                                         HDR metadata from userspace
 * @frame: HDMI DRM infoframe
 * @conn_state: Connector state containing HDR metadata
 *
 * Return: 0 on success or a negative error code on failure.
 */
int drm_hdmi_infoframe_set_hdr_metadata(struct hdmi_drm_infoframe *frame,
					const struct drm_connector_state *conn_state)
{
	struct drm_connector *connector;
	struct hdr_output_metadata *hdr_metadata;
	int err;

	if (!frame || !conn_state)
		return -EINVAL;

	connector = conn_state->connector;

	if (!conn_state->hdr_output_metadata)
		return -EINVAL;

	hdr_metadata = conn_state->hdr_output_metadata->data;

	if (!hdr_metadata || !connector)
		return -EINVAL;

	/* Sink EOTF is Bit map while infoframe is absolute values */
	if (!is_eotf_supported(hdr_metadata->hdmi_metadata_type1.eotf,
			       connector->display_info.hdr_sink_metadata.hdmi_type1.eotf))
		DRM_DEBUG_KMS("Unknown EOTF %d\n", hdr_metadata->hdmi_metadata_type1.eotf);

	err = hdmi_drm_infoframe_init(frame);
	if (err < 0)
		return err;

	frame->eotf = hdr_metadata->hdmi_metadata_type1.eotf;
	frame->metadata_type = hdr_metadata->hdmi_metadata_type1.metadata_type;

	BUILD_BUG_ON(sizeof(frame->display_primaries) !=
		     sizeof(hdr_metadata->hdmi_metadata_type1.display_primaries));
	BUILD_BUG_ON(sizeof(frame->white_point) !=
		     sizeof(hdr_metadata->hdmi_metadata_type1.white_point));

	memcpy(&frame->display_primaries,
	       &hdr_metadata->hdmi_metadata_type1.display_primaries,
	       sizeof(frame->display_primaries));

	memcpy(&frame->white_point,
	       &hdr_metadata->hdmi_metadata_type1.white_point,
	       sizeof(frame->white_point));

	frame->max_display_mastering_luminance =
		hdr_metadata->hdmi_metadata_type1.max_display_mastering_luminance;
	frame->min_display_mastering_luminance =
		hdr_metadata->hdmi_metadata_type1.min_display_mastering_luminance;
	frame->max_fall = hdr_metadata->hdmi_metadata_type1.max_fall;
	frame->max_cll = hdr_metadata->hdmi_metadata_type1.max_cll;

	return 0;
}
EXPORT_SYMBOL(drm_hdmi_infoframe_set_hdr_metadata);

/* HDMI Colorspace Spec Definitions */
#define FULL_COLORIMETRY_MASK		0x1FF
#define NORMAL_COLORIMETRY_MASK		0x3
#define EXTENDED_COLORIMETRY_MASK	0x7
#define EXTENDED_ACE_COLORIMETRY_MASK	0xF

#define C(x) ((x) << 0)
#define EC(x) ((x) << 2)
#define ACE(x) ((x) << 5)

#define HDMI_COLORIMETRY_NO_DATA		0x0
#define HDMI_COLORIMETRY_SMPTE_170M_YCC		(C(1) | EC(0) | ACE(0))
#define HDMI_COLORIMETRY_BT709_YCC		(C(2) | EC(0) | ACE(0))
#define HDMI_COLORIMETRY_XVYCC_601		(C(3) | EC(0) | ACE(0))
#define HDMI_COLORIMETRY_XVYCC_709		(C(3) | EC(1) | ACE(0))
#define HDMI_COLORIMETRY_SYCC_601		(C(3) | EC(2) | ACE(0))
#define HDMI_COLORIMETRY_OPYCC_601		(C(3) | EC(3) | ACE(0))
#define HDMI_COLORIMETRY_OPRGB			(C(3) | EC(4) | ACE(0))
#define HDMI_COLORIMETRY_BT2020_CYCC		(C(3) | EC(5) | ACE(0))
#define HDMI_COLORIMETRY_BT2020_RGB		(C(3) | EC(6) | ACE(0))
#define HDMI_COLORIMETRY_BT2020_YCC		(C(3) | EC(6) | ACE(0))
#define HDMI_COLORIMETRY_DCI_P3_RGB_D65		(C(3) | EC(7) | ACE(0))
#define HDMI_COLORIMETRY_DCI_P3_RGB_THEATER	(C(3) | EC(7) | ACE(1))

static const u32 hdmi_colorimetry_val[] = {
	[DRM_MODE_COLORIMETRY_NO_DATA] = HDMI_COLORIMETRY_NO_DATA,
	[DRM_MODE_COLORIMETRY_SMPTE_170M_YCC] = HDMI_COLORIMETRY_SMPTE_170M_YCC,
	[DRM_MODE_COLORIMETRY_BT709_YCC] = HDMI_COLORIMETRY_BT709_YCC,
	[DRM_MODE_COLORIMETRY_XVYCC_601] = HDMI_COLORIMETRY_XVYCC_601,
	[DRM_MODE_COLORIMETRY_XVYCC_709] = HDMI_COLORIMETRY_XVYCC_709,
	[DRM_MODE_COLORIMETRY_SYCC_601] = HDMI_COLORIMETRY_SYCC_601,
	[DRM_MODE_COLORIMETRY_OPYCC_601] = HDMI_COLORIMETRY_OPYCC_601,
	[DRM_MODE_COLORIMETRY_OPRGB] = HDMI_COLORIMETRY_OPRGB,
	[DRM_MODE_COLORIMETRY_BT2020_CYCC] = HDMI_COLORIMETRY_BT2020_CYCC,
	[DRM_MODE_COLORIMETRY_BT2020_RGB] = HDMI_COLORIMETRY_BT2020_RGB,
	[DRM_MODE_COLORIMETRY_BT2020_YCC] = HDMI_COLORIMETRY_BT2020_YCC,
};

#undef C
#undef EC
#undef ACE

/**
 * drm_hdmi_avi_infoframe_colorimetry() - fill the HDMI AVI infoframe
 *                                       colorimetry information
 * @frame: HDMI AVI infoframe
 * @conn_state: connector state
 */
void drm_hdmi_avi_infoframe_colorimetry(struct hdmi_avi_infoframe *frame,
					const struct drm_connector_state *conn_state)
{
	u32 colorimetry_val;
	u32 colorimetry_index = conn_state->colorspace & FULL_COLORIMETRY_MASK;

	if (colorimetry_index >= ARRAY_SIZE(hdmi_colorimetry_val))
		colorimetry_val = HDMI_COLORIMETRY_NO_DATA;
	else
		colorimetry_val = hdmi_colorimetry_val[colorimetry_index];

	frame->colorimetry = colorimetry_val & NORMAL_COLORIMETRY_MASK;
	/*
	 * ToDo: Extend it for ACE formats as well. Modify the infoframe
	 * structure and extend it in drivers/video/hdmi
	 */
	frame->extended_colorimetry = (colorimetry_val >> 2) &
					EXTENDED_COLORIMETRY_MASK;
}
EXPORT_SYMBOL(drm_hdmi_avi_infoframe_colorimetry);

/**
 * drm_hdmi_avi_infoframe_bars() - fill the HDMI AVI infoframe
 *                                 bar information
 * @frame: HDMI AVI infoframe
 * @conn_state: connector state
 */
void drm_hdmi_avi_infoframe_bars(struct hdmi_avi_infoframe *frame,
				 const struct drm_connector_state *conn_state)
{
	frame->right_bar = conn_state->tv.margins.right;
	frame->left_bar = conn_state->tv.margins.left;
	frame->top_bar = conn_state->tv.margins.top;
	frame->bottom_bar = conn_state->tv.margins.bottom;
}
EXPORT_SYMBOL(drm_hdmi_avi_infoframe_bars);

/**
 * drm_hdmi_avi_infoframe_content_type() - fill the HDMI AVI infoframe
 *                                         content type information, based
 *                                         on correspondent DRM property.
 * @frame: HDMI AVI infoframe
 * @conn_state: DRM display connector state
 *
 */
void drm_hdmi_avi_infoframe_content_type(struct hdmi_avi_infoframe *frame,
					 const struct drm_connector_state *conn_state)
{
	switch (conn_state->content_type) {
	case DRM_MODE_CONTENT_TYPE_GRAPHICS:
		frame->content_type = HDMI_CONTENT_TYPE_GRAPHICS;
		break;
	case DRM_MODE_CONTENT_TYPE_CINEMA:
		frame->content_type = HDMI_CONTENT_TYPE_CINEMA;
		break;
	case DRM_MODE_CONTENT_TYPE_GAME:
		frame->content_type = HDMI_CONTENT_TYPE_GAME;
		break;
	case DRM_MODE_CONTENT_TYPE_PHOTO:
		frame->content_type = HDMI_CONTENT_TYPE_PHOTO;
		break;
	default:
		/* Graphics is the default(0) */
		frame->content_type = HDMI_CONTENT_TYPE_GRAPHICS;
	}

	frame->itc = conn_state->content_type != DRM_MODE_CONTENT_TYPE_NO_DATA;
}
EXPORT_SYMBOL(drm_hdmi_avi_infoframe_content_type);

/**
 * drm_hdmi_compute_mode_clock() - Computes the TMDS Character Rate
 * @mode: Display mode to compute the clock for
 * @bpc: Bits per character
 * @fmt: Output Pixel Format used
 *
 * Returns the TMDS Character Rate for a given mode, bpc count and output format.
 *
 * RETURNS:
 * The TMDS Character Rate, in Hertz, or 0 on error.
 */
unsigned long long
drm_hdmi_compute_mode_clock(const struct drm_display_mode *mode,
			    unsigned int bpc,
			    enum drm_output_color_format fmt)
{
	unsigned long long clock = mode->clock * 1000ULL;
	unsigned int vic = drm_match_cea_mode(mode);

	/*
	 * CTA-861-G Spec, section 5.4 - Color Coding and Quantization
	 * mandates that VIC 1 always uses 8 bpc.
	 */
	if (vic == 1 && bpc != 8)
		return 0;

	if (fmt == DRM_OUTPUT_COLOR_FORMAT_YCBCR422) {
		/*
		 * HDMI 1.0 Spec, section 6.5 - Pixel Encoding states that
		 * YUV422 sends 24 bits over three channels, with Cb and Cr
		 * components being sent on odd and even pixels, respectively.
		 *
		 * If fewer than 12 bpc are sent, data are left justified.
		 */
		if (bpc > 12)
			return 0;

		/*
		 * HDMI 1.0 Spec, section 6.5 - Pixel Encoding
		 * specifies that YUV422 sends two 12-bits components over
		 * three TMDS channels per pixel clock, which is equivalent to
		 * three 8-bits components over three channels used by RGB as
		 * far as the clock rate goes.
		 */
		bpc = 8;
	}

	/*
	 * HDMI 2.0 Spec, Section 7.1 - YCbCr 4:2:0 Pixel Encoding
	 * specifies that YUV420 encoding is carried at a TMDS Character Rate
	 * equal to half the pixel clock rate.
	 */
	if (fmt == DRM_OUTPUT_COLOR_FORMAT_YCBCR420)
		clock = clock / 2;

	if (mode->flags & DRM_MODE_FLAG_DBLCLK)
		clock = clock * 2;

	return DIV_ROUND_CLOSEST_ULL(clock * bpc, 8);
}
EXPORT_SYMBOL(drm_hdmi_compute_mode_clock);

struct drm_hdmi_acr_n_cts_entry {
	unsigned int n;
	unsigned int cts;
};

struct drm_hdmi_acr_data {
	unsigned long tmds_clock_khz;
	struct drm_hdmi_acr_n_cts_entry n_cts_32k,
					n_cts_44k1,
					n_cts_48k;
};

static const struct drm_hdmi_acr_data hdmi_acr_n_cts[] = {
	{
		/* "Other" entry */
		.n_cts_32k =  { .n = 4096, },
		.n_cts_44k1 = { .n = 6272, },
		.n_cts_48k =  { .n = 6144, },
	}, {
		.tmds_clock_khz = 25175,
		.n_cts_32k =  { .n = 4576,  .cts = 28125, },
		.n_cts_44k1 = { .n = 7007,  .cts = 31250, },
		.n_cts_48k =  { .n = 6864,  .cts = 28125, },
	}, {
		.tmds_clock_khz = 25200,
		.n_cts_32k =  { .n = 4096,  .cts = 25200, },
		.n_cts_44k1 = { .n = 6272,  .cts = 28000, },
		.n_cts_48k =  { .n = 6144,  .cts = 25200, },
	}, {
		.tmds_clock_khz = 27000,
		.n_cts_32k =  { .n = 4096,  .cts = 27000, },
		.n_cts_44k1 = { .n = 6272,  .cts = 30000, },
		.n_cts_48k =  { .n = 6144,  .cts = 27000, },
	}, {
		.tmds_clock_khz = 27027,
		.n_cts_32k =  { .n = 4096,  .cts = 27027, },
		.n_cts_44k1 = { .n = 6272,  .cts = 30030, },
		.n_cts_48k =  { .n = 6144,  .cts = 27027, },
	}, {
		.tmds_clock_khz = 54000,
		.n_cts_32k =  { .n = 4096,  .cts = 54000, },
		.n_cts_44k1 = { .n = 6272,  .cts = 60000, },
		.n_cts_48k =  { .n = 6144,  .cts = 54000, },
	}, {
		.tmds_clock_khz = 54054,
		.n_cts_32k =  { .n = 4096,  .cts = 54054, },
		.n_cts_44k1 = { .n = 6272,  .cts = 60060, },
		.n_cts_48k =  { .n = 6144,  .cts = 54054, },
	}, {
		.tmds_clock_khz = 74176,
		.n_cts_32k =  { .n = 11648, .cts = 210937, }, /* and 210938 */
		.n_cts_44k1 = { .n = 17836, .cts = 234375, },
		.n_cts_48k =  { .n = 11648, .cts = 140625, },
	}, {
		.tmds_clock_khz = 74250,
		.n_cts_32k =  { .n = 4096,  .cts = 74250, },
		.n_cts_44k1 = { .n = 6272,  .cts = 82500, },
		.n_cts_48k =  { .n = 6144,  .cts = 74250, },
	}, {
		.tmds_clock_khz = 148352,
		.n_cts_32k =  { .n = 11648, .cts = 421875, },
		.n_cts_44k1 = { .n = 8918,  .cts = 234375, },
		.n_cts_48k =  { .n = 5824,  .cts = 140625, },
	}, {
		.tmds_clock_khz = 148500,
		.n_cts_32k =  { .n = 4096,  .cts = 148500, },
		.n_cts_44k1 = { .n = 6272,  .cts = 165000, },
		.n_cts_48k =  { .n = 6144,  .cts = 148500, },
	}, {
		.tmds_clock_khz = 296703,
		.n_cts_32k =  { .n = 5824,  .cts = 421875, },
		.n_cts_44k1 = { .n = 4459,  .cts = 234375, },
		.n_cts_48k =  { .n = 5824,  .cts = 281250, },
	}, {
		.tmds_clock_khz = 297000,
		.n_cts_32k =  { .n = 3072,  .cts = 222750, },
		.n_cts_44k1 = { .n = 4704,  .cts = 247500, },
		.n_cts_48k =  { .n = 5120,  .cts = 247500, },
	}, {
		.tmds_clock_khz = 593407,
		.n_cts_32k =  { .n = 5824,  .cts = 843750, },
		.n_cts_44k1 = { .n = 8918,  .cts = 937500, },
		.n_cts_48k =  { .n = 5824,  .cts = 562500, },
	}, {
		.tmds_clock_khz = 594000,
		.n_cts_32k =  { .n = 3072,  .cts = 445500, },
		.n_cts_44k1 = { .n = 9408,  .cts = 990000, },
		.n_cts_48k =  { .n = 6144,  .cts = 594000, },
	},
};

static int drm_hdmi_acr_find_tmds_entry(unsigned long tmds_clock_khz)
{
	int i;

	/* skip the "other" entry */
	for (i = 1; i < ARRAY_SIZE(hdmi_acr_n_cts); i++) {
		if (hdmi_acr_n_cts[i].tmds_clock_khz == tmds_clock_khz)
			return i;
	}

	return 0;
}

/**
 * drm_hdmi_acr_get_n_cts() - get N and CTS values for Audio Clock Regeneration
 *
 * @tmds_char_rate: TMDS clock (char rate) as used by the HDMI connector
 * @sample_rate: audio sample rate
 * @out_n: a pointer to write the N value
 * @out_cts: a pointer to write the CTS value
 *
 * Get the N and CTS values (either by calculating them or by returning data
 * from the tables. This follows the HDMI 1.4b Section 7.2 "Audio Sample Clock
 * Capture and Regeneration".
 *
 * Note, @sample_rate corresponds to the Fs value, see sections 7.2.4 - 7.2.6
 * on how to select Fs for non-L-PCM formats.
 */
void
drm_hdmi_acr_get_n_cts(unsigned long long tmds_char_rate,
		       unsigned int sample_rate,
		       unsigned int *out_n,
		       unsigned int *out_cts)
{
	/* be a bit more tolerant, especially for the 1.001 entries */
	unsigned long tmds_clock_khz = DIV_ROUND_CLOSEST_ULL(tmds_char_rate, 1000);
	const struct drm_hdmi_acr_n_cts_entry *entry;
	unsigned int n, cts, mult;
	int tmds_idx;

	tmds_idx = drm_hdmi_acr_find_tmds_entry(tmds_clock_khz);

	/*
	 * Don't change the order, 192 kHz is divisible by 48k and 32k, but it
	 * should use 48k entry.
	 */
	if (sample_rate % 48000 == 0) {
		entry = &hdmi_acr_n_cts[tmds_idx].n_cts_48k;
		mult = sample_rate / 48000;
	} else if (sample_rate % 44100 == 0) {
		entry = &hdmi_acr_n_cts[tmds_idx].n_cts_44k1;
		mult = sample_rate / 44100;
	} else if (sample_rate % 32000 == 0) {
		entry = &hdmi_acr_n_cts[tmds_idx].n_cts_32k;
		mult = sample_rate / 32000;
	} else {
		entry = NULL;
	}

	if (entry) {
		n = entry->n * mult;
		cts = entry->cts;
	} else {
		/* Recommended optimal value, HDMI 1.4b, Section 7.2.1 */
		n = 128 * sample_rate / 1000;
		cts = 0;
	}

	if (!cts)
		cts = DIV_ROUND_CLOSEST_ULL(tmds_char_rate * n,
					    128 * sample_rate);

	*out_n = n;
	*out_cts = cts;
}
EXPORT_SYMBOL(drm_hdmi_acr_get_n_cts);

/**
 * drm_hdmi_mode_needs_scrambling() - Check if an HDMI mode requires scrambling
 * @mode: Display mode to check
 * @bpc: Bits per color component
 * @fmt: Output pixel format
 *
 * Computes the TMDS character rate for the given mode, bits per component and
 * output format, and checks whether it exceeds the HDMI 1.3 maximum TMDS
 * character rate of 340 MHz.
 *
 * Returns:
 * true if the mode requires scrambling, false otherwise.
 */
bool drm_hdmi_mode_needs_scrambling(const struct drm_display_mode *mode,
				    unsigned int bpc,
				    enum drm_output_color_format fmt)
{
	unsigned long long tmds_char_rate;

	tmds_char_rate = drm_hdmi_compute_mode_clock(mode, bpc, fmt);

	return tmds_char_rate > HDMI_1_3_TMDS_CHAR_RATE_MAX_HZ;
}
EXPORT_SYMBOL(drm_hdmi_mode_needs_scrambling);

static bool drm_scdc_sink_supports_scrambling(struct drm_connector *connector)
{
	const struct drm_display_info *info = &connector->display_info;

	return info->is_hdmi &&
	       info->hdmi.scdc.supported &&
	       info->hdmi.scdc.scrambling.supported;
}

static void drm_connector_hdmi_reset_sink_scrambling(struct drm_connector *connector)
{
	struct drm_device *dev = connector->dev;
	u8 config;
	int ret;

	if (!connector->ddc || !drm_scdc_sink_supports_scrambling(connector))
		return;

	ret = drm_scdc_readb(connector->ddc, SCDC_TMDS_CONFIG, &config);
	if (ret) {
		drm_dbg_kms(dev, "Failed to read TMDS config: %d\n", ret);
		return;
	}

	if (config & SCDC_SCRAMBLING_ENABLE)
		drm_scdc_set_scrambling(connector, false);

	if (config & SCDC_TMDS_BIT_CLOCK_RATIO_BY_40)
		drm_scdc_set_high_tmds_clock_ratio(connector, false);
}

static int drm_connector_hdmi_try_scrambling_setup(struct drm_connector *connector)
{
	bool done;

	done = drm_scdc_set_high_tmds_clock_ratio(connector, true);
	if (!done)
		return -EIO;

	done = drm_scdc_set_scrambling(connector, true);
	if (!done)
		return -EIO;

	if (READ_ONCE(connector->hdmi.scrambler_enabled))
		schedule_delayed_work(&connector->hdmi.scdc_work,
				      msecs_to_jiffies(DRM_HDMI_SCDC_POLL_DELAY_MS));

	return 0;
}

static void drm_connector_hdmi_scdc_work(struct work_struct *work)
{
	struct drm_connector *connector;
	struct drm_connector_hdmi *hdmi;

	hdmi = container_of(to_delayed_work(work), struct drm_connector_hdmi,
			    scdc_work);
	connector = container_of(hdmi, struct drm_connector, hdmi);

	/*
	 * The connector, and hence this work item, may outlive the source
	 * driver, e.g. when userspace keeps a DRM file descriptor open past
	 * unbind. Never poke the DDC bus after the connector got unregistered,
	 * as the underlying I2C adapter may already be gone.
	 */
	if (drm_connector_is_unregistered(connector))
		return;

	if (READ_ONCE(connector->hdmi.scrambler_enabled) &&
	    !drm_scdc_get_scrambling_status(connector))
		drm_connector_hdmi_try_scrambling_setup(connector);
}

/**
 * drm_connector_hdmi_enable_scrambling() - enable scrambling and monitor SCDC status
 * @connector: connector
 * @conn_state: connector state
 *
 * Enables scrambling and high TMDS clock ratio on both source and sink sides.
 * Additionally, use a delayed work item to monitor the scrambling status on
 * the sink side and retry the operation, as some displays refuse to set the
 * scrambling bit right away.
 *
 * When @conn_state doesn't require scrambling, the sink-side SCDC status is
 * reset instead, so that a sink left scrambling by a state the driver did not
 * control, e.g. set up by the firmware before boot, doesn't end up out of sync
 * with the source.
 *
 * The work item is cancelled by drm_connector_hdmi_disable_scrambling(), hence
 * source drivers must ensure the display pipeline is shut down on unbind, e.g.
 * via drm_atomic_helper_shutdown(). Otherwise the work may outlive the driver's
 * devres-managed resources, since the connector itself is only cleaned up when
 * the last reference to the DRM device is dropped.
 *
 * Returns:
 * Zero if scrambling is set successfully, an error code otherwise.
 */
int drm_connector_hdmi_enable_scrambling(struct drm_connector *connector,
					 const struct drm_connector_state *conn_state)
{
	struct drm_connector_hdmi *hdmi = &connector->hdmi;
	struct drm_device *dev = connector->dev;
	int ret;

	if (!conn_state)
		return -EINVAL;

	if (!conn_state->hdmi.scrambler_needed) {
		/*
		 * Resync the sink here, where it is known to be connected
		 * and its capabilities have been parsed.
		 */
		drm_connector_hdmi_reset_sink_scrambling(connector);
		return 0;
	}

	if (!drm_connector_hdmi_scrambler_supported(connector)) {
		drm_dbg_kms(dev, "Source doesn't support scrambling.\n");
		return -EINVAL;
	}

	if (!drm_scdc_sink_supports_scrambling(connector)) {
		drm_dbg_kms(dev, "Sink doesn't support scrambling.\n");
		return -EINVAL;
	}

	if (!connector->ddc)
		return -EINVAL;

	/*
	 * Advertise our SCDC source version. This is purely informational and
	 * does not gate scrambling, so failures are non-fatal.
	 */
	drm_scdc_set_source_version(connector, DRM_HDMI_SCDC_SOURCE_VERSION);

	drm_dbg_kms(dev, "Enabling scrambling\n");

	if (!hdmi->scdc_work_initialized) {
		INIT_DELAYED_WORK(&hdmi->scdc_work,
				  drm_connector_hdmi_scdc_work);
		hdmi->scdc_work_initialized = true;
	}

	WRITE_ONCE(hdmi->scrambler_enabled, true);

	ret = drm_connector_hdmi_try_scrambling_setup(connector);
	if (!ret)
		ret = hdmi->funcs->scrambler_enable(connector);

	if (ret) {
		WRITE_ONCE(hdmi->scrambler_enabled, false);
		cancel_delayed_work_sync(&hdmi->scdc_work);

		drm_connector_hdmi_reset_sink_scrambling(connector);
	}

	return ret;
}
EXPORT_SYMBOL(drm_connector_hdmi_enable_scrambling);

/**
 * drm_connector_hdmi_disable_scrambling() - disable scrambling and SCDC monitoring
 * @connector: connector
 *
 * Disables scrambling and high TMDS clock ratio on both source and sink sides.
 * Also cancels the SCDC status monitoring work item, if it is still pending.
 *
 * Returns:
 * Zero if scrambling is reset successfully, an error code otherwise.
 */
int drm_connector_hdmi_disable_scrambling(struct drm_connector *connector)
{
	struct drm_connector_hdmi *hdmi = &connector->hdmi;
	struct drm_device *dev = connector->dev;

	if (!READ_ONCE(hdmi->scrambler_enabled))
		return 0;

	drm_dbg_kms(dev, "Disabling scrambling\n");

	WRITE_ONCE(hdmi->scrambler_enabled, false);

	/*
	 * A driver may force scrambler_enabled at init to trigger a disable
	 * at boot (e.g. vc4), bypassing the enable path that sets up the work
	 * item. Only cancel it once it has actually been initialized.
	 */
	if (hdmi->scdc_work_initialized)
		cancel_delayed_work_sync(&hdmi->scdc_work);

	drm_connector_hdmi_reset_sink_scrambling(connector);

	return hdmi->funcs->scrambler_disable(connector);
}
EXPORT_SYMBOL(drm_connector_hdmi_disable_scrambling);

/**
 * drm_connector_hdmi_sync_scdc() - resync the sink-side SCDC upon reconnect
 * @connector: connector
 * @plugged: connector plugged status event
 * @ctx: initialized lock acquisition context
 *
 * When receiving hotplug disconnect/reconnect event, while the display is
 * still active (CRTC enabled), the SCDC status on the sink side is reset
 * and must be explicitly restored.
 *
 * The typical solution for this is to trigger an empty modeset in
 * drm_connector_helper_funcs.detect_ctx(), which is what this helper does
 * by triggering a CRTC reset on reconnection.
 *
 * When making use of the HDMI connector framework, this is automatically
 * triggered via drm_atomic_helper_connector_hdmi_hotplug().
 *
 * Returns:
 * Zero on success, an error code otherwise, including -EDEADLK.
 */
int drm_connector_hdmi_sync_scdc(struct drm_connector *connector, bool plugged,
				 struct drm_modeset_acquire_ctx *ctx)
{
	struct drm_connector_state *conn_state;
	struct drm_device *dev;
	struct drm_crtc *crtc;
	u8 config;
	int ret;

	if (!connector || !plugged || !ctx)
		return 0;

	dev = connector->dev;

	/*
	 * This is normally part of .detect_ctx() call path, which already holds
	 * connection_mutex through @ctx.  However, re-acquiring it with the
	 * same context is a no-op and makes the helper safe under any caller.
	 */
	ret = drm_modeset_lock(&connector->dev->mode_config.connection_mutex, ctx);
	if (ret)
		return ret;

	/* TODO: Also handle HDMI 2.1 FRL link training */

	conn_state = connector->state;
	if (!conn_state)
		return 0;

	/*
	 * Rely on the committed connector state rather than on the current
	 * scrambler status: a source driver may force scrambler_enabled at
	 * init to get a disable at boot (e.g. vc4), and that value would
	 * remain stale until the first disable actually happens, leading to
	 * a spurious CRTC reset whenever the active mode needs no scrambling.
	 */
	if (!drm_connector_hdmi_scrambler_supported(connector) ||
	    !conn_state->hdmi.scrambler_needed)
		return 0;

	crtc = conn_state->crtc;
	if (!crtc)
		return 0;

	ret = drm_modeset_lock(&crtc->mutex, ctx);
	if (ret)
		return ret;

	if (!crtc->state || !crtc->state->active)
		return 0;

	if (!connector->ddc || !drm_scdc_sink_supports_scrambling(connector))
		return 0;

	if (conn_state->commit &&
	    !try_wait_for_completion(&conn_state->commit->hw_done))
		return 0;

	ret = drm_scdc_readb(connector->ddc, SCDC_TMDS_CONFIG, &config);
	if (ret) {
		drm_dbg_kms(dev, "Failed to read TMDS config: %d\n", ret);
		return ret;
	}

	if (config & SCDC_SCRAMBLING_ENABLE)
		return 0;

	/*
	 * HDMI 2.0 requires that one should not send scrambled data prior
	 * to configuring the sink scrambling, and that TMDS clock/data
	 * transmission should be suspended when changing the TMDS clock rate
	 * in the sink.  So let's just do a full modeset here, even though some
	 * sinks would be perfectly happy if were to just reconfigure the SCDC
	 * settings on the fly.
	 *
	 * The disable/re-enable cycle triggered by the reset should call
	 * drm_connector_hdmi_enable_scrambling() during re-enable, thus
	 * properly configuring the sink before data transmission resumes.
	 */
	drm_dbg_kms(dev, "Resetting CRTC to restore SCDC status\n");

	ret = drm_atomic_helper_reset_crtc(crtc, ctx);
	if (ret && ret != -EDEADLK)
		drm_dbg_kms(dev, "Failed to reset CRTC: %d\n", ret);

	return ret;
}
EXPORT_SYMBOL