1// SPDX-License-Identifier: GPL-2.0-only
  2/*
  3 * Copyright (c) 2014-2015, The Linux Foundation. All rights reserved.
  4 */
  5
  6#include "drm/drm_edid.h"
  7#include "msm_kms.h"
  8#include "edp.h"
  9
 10struct edp_connector {
 11	struct drm_connector base;
 12	struct msm_edp *edp;
 13};
 14#define to_edp_connector(x) container_of(x, struct edp_connector, base)
 15
 16static enum drm_connector_status edp_connector_detect(
 17		struct drm_connector *connector, bool force)
 18{
 19	struct edp_connector *edp_connector = to_edp_connector(connector);
 20	struct msm_edp *edp = edp_connector->edp;
 21
 22	DBG("");
 23	return msm_edp_ctrl_panel_connected(edp->ctrl) ?
 24		connector_status_connected : connector_status_disconnected;
 25}
 26
 27static void edp_connector_destroy(struct drm_connector *connector)
 28{
 29	struct edp_connector *edp_connector = to_edp_connector(connector);
 30
 31	DBG("");
 32
 33	drm_connector_cleanup(connector);
 34
 35	kfree(edp_connector);
 36}
 37
 38static int edp_connector_get_modes(struct drm_connector *connector)
 39{
 40	struct edp_connector *edp_connector = to_edp_connector(connector);
 41	struct msm_edp *edp = edp_connector->edp;
 42
 43	struct edid *drm_edid = NULL;
 44	int ret = 0;
 45
 46	DBG("");
 47	ret = msm_edp_ctrl_get_panel_info(edp->ctrl, connector, &drm_edid);
 48	if (ret)
 49		return ret;
 50
 51	drm_connector_update_edid_property(connector, drm_edid);
 52	if (drm_edid)
 53		ret = drm_add_edid_modes(connector, drm_edid);
 54
 55	return ret;
 56}
 57
 58static int edp_connector_mode_valid(struct drm_connector *connector,
 59				 struct drm_display_mode *mode)
 60{
 61	struct edp_connector *edp_connector = to_edp_connector(connector);
 62	struct msm_edp *edp = edp_connector->edp;
 63	struct msm_drm_private *priv = connector->dev->dev_private;
 64	struct msm_kms *kms = priv->kms;
 65	long actual, requested;
 66
 67	requested = 1000 * mode->clock;
 68	actual = kms->funcs->round_pixclk(kms,
 69			requested, edp_connector->edp->encoder);
 70
 71	DBG("requested=%ld, actual=%ld", requested, actual);
 72	if (actual != requested)
 73		return MODE_CLOCK_RANGE;
 74
 75	if (!msm_edp_ctrl_pixel_clock_valid(
 76		edp->ctrl, mode->clock, NULL, NULL))
 77		return MODE_CLOCK_RANGE;
 78
 79	/* Invalidate all modes if color format is not supported */
 80	if (connector->display_info.bpc > 8)
 81		return MODE_BAD;
 82
 83	return MODE_OK;
 84}
 85
 86static const struct drm_connector_funcs edp_connector_funcs = {
 87	.detect = edp_connector_detect,
 88	.fill_modes = drm_helper_probe_single_connector_modes,
 89	.destroy = edp_connector_destroy,
 90	.reset = drm_atomic_helper_connector_reset,
 91	.atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state,
 92	.atomic_destroy_state = drm_atomic_helper_connector_destroy_state,
 93};
 94
 95static const struct drm_connector_helper_funcs edp_connector_helper_funcs = {
 96	.get_modes = edp_connector_get_modes,
 97	.mode_valid = edp_connector_mode_valid,
 98};
 99
100/* initialize connector */
101struct drm_connector *msm_edp_connector_init(struct msm_edp *edp)
102{
103	struct drm_connector *connector = NULL;
104	struct edp_connector *edp_connector;
105	int ret;
106
107	edp_connector = kzalloc(sizeof(*edp_connector), GFP_KERNEL);
108	if (!edp_connector)
109		return ERR_PTR(-ENOMEM);
110
111	edp_connector->edp = edp;
112
113	connector = &edp_connector->base;
114
115	ret = drm_connector_init(edp->dev, connector, &edp_connector_funcs,
116			DRM_MODE_CONNECTOR_eDP);
117	if (ret)
118		return ERR_PTR(ret);
119
120	drm_connector_helper_add(connector, &edp_connector_helper_funcs);
121
122	/* We don't support HPD, so only poll status until connected. */
123	connector->polled = DRM_CONNECTOR_POLL_CONNECT;
124
125	/* Display driver doesn't support interlace now. */
126	connector->interlace_allowed = false;
127	connector->doublescan_allowed = false;
128
129	drm_connector_attach_encoder(connector, edp->encoder);
130
131	return connector;
132}