162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only
262306a36Sopenharmony_ci/*
362306a36Sopenharmony_ci * Copyright (C) 2011 Texas Instruments Incorporated - https://www.ti.com/
462306a36Sopenharmony_ci * Author: Rob Clark <rob@ti.com>
562306a36Sopenharmony_ci */
662306a36Sopenharmony_ci
762306a36Sopenharmony_ci#include <linux/list.h>
862306a36Sopenharmony_ci
962306a36Sopenharmony_ci#include <drm/drm_bridge.h>
1062306a36Sopenharmony_ci#include <drm/drm_crtc.h>
1162306a36Sopenharmony_ci#include <drm/drm_modeset_helper_vtables.h>
1262306a36Sopenharmony_ci#include <drm/drm_edid.h>
1362306a36Sopenharmony_ci
1462306a36Sopenharmony_ci#include "omap_drv.h"
1562306a36Sopenharmony_ci
1662306a36Sopenharmony_ci/*
1762306a36Sopenharmony_ci * encoder funcs
1862306a36Sopenharmony_ci */
1962306a36Sopenharmony_ci
2062306a36Sopenharmony_ci#define to_omap_encoder(x) container_of(x, struct omap_encoder, base)
2162306a36Sopenharmony_ci
2262306a36Sopenharmony_ci/* The encoder and connector both map to same dssdev.. the encoder
2362306a36Sopenharmony_ci * handles the 'active' parts, ie. anything the modifies the state
2462306a36Sopenharmony_ci * of the hw, and the connector handles the 'read-only' parts, like
2562306a36Sopenharmony_ci * detecting connection and reading edid.
2662306a36Sopenharmony_ci */
2762306a36Sopenharmony_cistruct omap_encoder {
2862306a36Sopenharmony_ci	struct drm_encoder base;
2962306a36Sopenharmony_ci	struct omap_dss_device *output;
3062306a36Sopenharmony_ci};
3162306a36Sopenharmony_ci
3262306a36Sopenharmony_cistatic void omap_encoder_destroy(struct drm_encoder *encoder)
3362306a36Sopenharmony_ci{
3462306a36Sopenharmony_ci	struct omap_encoder *omap_encoder = to_omap_encoder(encoder);
3562306a36Sopenharmony_ci
3662306a36Sopenharmony_ci	drm_encoder_cleanup(encoder);
3762306a36Sopenharmony_ci	kfree(omap_encoder);
3862306a36Sopenharmony_ci}
3962306a36Sopenharmony_ci
4062306a36Sopenharmony_cistatic const struct drm_encoder_funcs omap_encoder_funcs = {
4162306a36Sopenharmony_ci	.destroy = omap_encoder_destroy,
4262306a36Sopenharmony_ci};
4362306a36Sopenharmony_ci
4462306a36Sopenharmony_cistatic void omap_encoder_update_videomode_flags(struct videomode *vm,
4562306a36Sopenharmony_ci						u32 bus_flags)
4662306a36Sopenharmony_ci{
4762306a36Sopenharmony_ci	if (!(vm->flags & (DISPLAY_FLAGS_DE_LOW |
4862306a36Sopenharmony_ci			   DISPLAY_FLAGS_DE_HIGH))) {
4962306a36Sopenharmony_ci		if (bus_flags & DRM_BUS_FLAG_DE_LOW)
5062306a36Sopenharmony_ci			vm->flags |= DISPLAY_FLAGS_DE_LOW;
5162306a36Sopenharmony_ci		else if (bus_flags & DRM_BUS_FLAG_DE_HIGH)
5262306a36Sopenharmony_ci			vm->flags |= DISPLAY_FLAGS_DE_HIGH;
5362306a36Sopenharmony_ci	}
5462306a36Sopenharmony_ci
5562306a36Sopenharmony_ci	if (!(vm->flags & (DISPLAY_FLAGS_PIXDATA_POSEDGE |
5662306a36Sopenharmony_ci			   DISPLAY_FLAGS_PIXDATA_NEGEDGE))) {
5762306a36Sopenharmony_ci		if (bus_flags & DRM_BUS_FLAG_PIXDATA_DRIVE_POSEDGE)
5862306a36Sopenharmony_ci			vm->flags |= DISPLAY_FLAGS_PIXDATA_POSEDGE;
5962306a36Sopenharmony_ci		else if (bus_flags & DRM_BUS_FLAG_PIXDATA_DRIVE_NEGEDGE)
6062306a36Sopenharmony_ci			vm->flags |= DISPLAY_FLAGS_PIXDATA_NEGEDGE;
6162306a36Sopenharmony_ci	}
6262306a36Sopenharmony_ci
6362306a36Sopenharmony_ci	if (!(vm->flags & (DISPLAY_FLAGS_SYNC_POSEDGE |
6462306a36Sopenharmony_ci			   DISPLAY_FLAGS_SYNC_NEGEDGE))) {
6562306a36Sopenharmony_ci		if (bus_flags & DRM_BUS_FLAG_SYNC_DRIVE_POSEDGE)
6662306a36Sopenharmony_ci			vm->flags |= DISPLAY_FLAGS_SYNC_POSEDGE;
6762306a36Sopenharmony_ci		else if (bus_flags & DRM_BUS_FLAG_SYNC_DRIVE_NEGEDGE)
6862306a36Sopenharmony_ci			vm->flags |= DISPLAY_FLAGS_SYNC_NEGEDGE;
6962306a36Sopenharmony_ci	}
7062306a36Sopenharmony_ci}
7162306a36Sopenharmony_ci
7262306a36Sopenharmony_cistatic void omap_encoder_mode_set(struct drm_encoder *encoder,
7362306a36Sopenharmony_ci				  struct drm_display_mode *mode,
7462306a36Sopenharmony_ci				  struct drm_display_mode *adjusted_mode)
7562306a36Sopenharmony_ci{
7662306a36Sopenharmony_ci	struct omap_encoder *omap_encoder = to_omap_encoder(encoder);
7762306a36Sopenharmony_ci	struct omap_dss_device *output = omap_encoder->output;
7862306a36Sopenharmony_ci	struct drm_device *dev = encoder->dev;
7962306a36Sopenharmony_ci	struct drm_connector *connector;
8062306a36Sopenharmony_ci	struct drm_bridge *bridge;
8162306a36Sopenharmony_ci	struct videomode vm = { 0 };
8262306a36Sopenharmony_ci	u32 bus_flags;
8362306a36Sopenharmony_ci
8462306a36Sopenharmony_ci	list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
8562306a36Sopenharmony_ci		if (connector->encoder == encoder)
8662306a36Sopenharmony_ci			break;
8762306a36Sopenharmony_ci	}
8862306a36Sopenharmony_ci
8962306a36Sopenharmony_ci	drm_display_mode_to_videomode(adjusted_mode, &vm);
9062306a36Sopenharmony_ci
9162306a36Sopenharmony_ci	/*
9262306a36Sopenharmony_ci	 * HACK: This fixes the vm flags.
9362306a36Sopenharmony_ci	 * struct drm_display_mode does not contain the VSYNC/HSYNC/DE flags and
9462306a36Sopenharmony_ci	 * they get lost when converting back and forth between struct
9562306a36Sopenharmony_ci	 * drm_display_mode and struct videomode. The hack below goes and
9662306a36Sopenharmony_ci	 * fetches the missing flags.
9762306a36Sopenharmony_ci	 *
9862306a36Sopenharmony_ci	 * A better solution is to use DRM's bus-flags through the whole driver.
9962306a36Sopenharmony_ci	 */
10062306a36Sopenharmony_ci	for (bridge = output->bridge; bridge;
10162306a36Sopenharmony_ci	     bridge = drm_bridge_get_next_bridge(bridge)) {
10262306a36Sopenharmony_ci		if (!bridge->timings)
10362306a36Sopenharmony_ci			continue;
10462306a36Sopenharmony_ci
10562306a36Sopenharmony_ci		bus_flags = bridge->timings->input_bus_flags;
10662306a36Sopenharmony_ci		omap_encoder_update_videomode_flags(&vm, bus_flags);
10762306a36Sopenharmony_ci	}
10862306a36Sopenharmony_ci
10962306a36Sopenharmony_ci	bus_flags = connector->display_info.bus_flags;
11062306a36Sopenharmony_ci	omap_encoder_update_videomode_flags(&vm, bus_flags);
11162306a36Sopenharmony_ci
11262306a36Sopenharmony_ci	/* Set timings for all devices in the display pipeline. */
11362306a36Sopenharmony_ci	dss_mgr_set_timings(output, &vm);
11462306a36Sopenharmony_ci}
11562306a36Sopenharmony_ci
11662306a36Sopenharmony_cistatic const struct drm_encoder_helper_funcs omap_encoder_helper_funcs = {
11762306a36Sopenharmony_ci	.mode_set = omap_encoder_mode_set,
11862306a36Sopenharmony_ci};
11962306a36Sopenharmony_ci
12062306a36Sopenharmony_ci/* initialize encoder */
12162306a36Sopenharmony_cistruct drm_encoder *omap_encoder_init(struct drm_device *dev,
12262306a36Sopenharmony_ci				      struct omap_dss_device *output)
12362306a36Sopenharmony_ci{
12462306a36Sopenharmony_ci	struct drm_encoder *encoder = NULL;
12562306a36Sopenharmony_ci	struct omap_encoder *omap_encoder;
12662306a36Sopenharmony_ci
12762306a36Sopenharmony_ci	omap_encoder = kzalloc(sizeof(*omap_encoder), GFP_KERNEL);
12862306a36Sopenharmony_ci	if (!omap_encoder)
12962306a36Sopenharmony_ci		goto fail;
13062306a36Sopenharmony_ci
13162306a36Sopenharmony_ci	omap_encoder->output = output;
13262306a36Sopenharmony_ci
13362306a36Sopenharmony_ci	encoder = &omap_encoder->base;
13462306a36Sopenharmony_ci
13562306a36Sopenharmony_ci	drm_encoder_init(dev, encoder, &omap_encoder_funcs,
13662306a36Sopenharmony_ci			 DRM_MODE_ENCODER_TMDS, NULL);
13762306a36Sopenharmony_ci	drm_encoder_helper_add(encoder, &omap_encoder_helper_funcs);
13862306a36Sopenharmony_ci
13962306a36Sopenharmony_ci	return encoder;
14062306a36Sopenharmony_ci
14162306a36Sopenharmony_cifail:
14262306a36Sopenharmony_ci	if (encoder)
14362306a36Sopenharmony_ci		omap_encoder_destroy(encoder);
14462306a36Sopenharmony_ci
14562306a36Sopenharmony_ci	return NULL;
14662306a36Sopenharmony_ci}
147