[deliverable/linux.git] / drivers / gpu / drm / exynos / exynos_drm_connector.c

/*
 * Copyright (c) 2011 Samsung Electronics Co., Ltd.
 * Authors:
 *	Inki Dae <inki.dae@samsung.com>
 *	Joonyoung Shim <jy0922.shim@samsung.com>
 *	Seung-Woo Kim <sw0312.kim@samsung.com>
 *
 * This program is free software; you can redistribute  it and/or modify it
 * under  the terms of  the GNU General  Public License as published by the
 * Free Software Foundation;  either version 2 of the  License, or (at your
 * option) any later version.
 */

#include <drm/drmP.h>
#include <drm/drm_crtc_helper.h>

#include <drm/exynos_drm.h>
#include "exynos_drm_drv.h"
#include "exynos_drm_encoder.h"
#include "exynos_drm_connector.h"

#define to_exynos_connector(x)	container_of(x, struct exynos_drm_connector,\
				drm_connector)

struct exynos_drm_connector {
	struct drm_connector	drm_connector;
	uint32_t		encoder_id;
	struct exynos_drm_manager *manager;
	uint32_t		dpms;
};

static int exynos_drm_connector_get_modes(struct drm_connector *connector)
{
	struct exynos_drm_connector *exynos_connector =
					to_exynos_connector(connector);
	struct exynos_drm_manager *manager = exynos_connector->manager;
	struct exynos_drm_display_ops *display_ops = manager->display_ops;
	struct edid *edid = NULL;
	unsigned int count = 0;
	int ret;

	if (!display_ops) {
		DRM_DEBUG_KMS("display_ops is null.\n");
		return 0;
	}

	/*
	 * if get_edid() exists then get_edid() callback of hdmi side
	 * is called to get edid data through i2c interface else
	 * get timing from the FIMD driver(display controller).
	 *
	 * P.S. in case of lcd panel, count is always 1 if success
	 * because lcd panel has only one mode.
	 */
	if (display_ops->get_edid) {
		edid = display_ops->get_edid(manager->dev, connector);
		if (IS_ERR_OR_NULL(edid)) {
			ret = PTR_ERR(edid);
			edid = NULL;
			DRM_ERROR("Panel operation get_edid failed %d\n", ret);
			goto out;
		}

		count = drm_add_edid_modes(connector, edid);
		if (!count) {
			DRM_ERROR("Add edid modes failed %d\n", count);
			goto out;
		}

		drm_mode_connector_update_edid_property(connector, edid);
	} else {
		struct exynos_drm_panel_info *panel;
		struct drm_display_mode *mode = drm_mode_create(connector->dev);
		if (!mode) {
			DRM_ERROR("failed to create a new display mode.\n");
			return 0;
		}

		if (display_ops->get_panel)
			panel = display_ops->get_panel(manager->dev);
		else {
			drm_mode_destroy(connector->dev, mode);
			return 0;
		}

		drm_display_mode_from_videomode(&panel->vm, mode);
		mode->width_mm = panel->width_mm;
		mode->height_mm = panel->height_mm;
		connector->display_info.width_mm = mode->width_mm;
		connector->display_info.height_mm = mode->height_mm;

		mode->type = DRM_MODE_TYPE_DRIVER | DRM_MODE_TYPE_PREFERRED;
		drm_mode_set_name(mode);
		drm_mode_probed_add(connector, mode);

		count = 1;
	}

out:
	kfree(edid);
	return count;
}

static int exynos_drm_connector_mode_valid(struct drm_connector *connector,
					    struct drm_display_mode *mode)
{
	struct exynos_drm_connector *exynos_connector =
					to_exynos_connector(connector);
	struct exynos_drm_manager *manager = exynos_connector->manager;
	struct exynos_drm_display_ops *display_ops = manager->display_ops;
	int ret = MODE_BAD;

	DRM_DEBUG_KMS("%s\n", __FILE__);

	if (display_ops && display_ops->check_mode)
		if (!display_ops->check_mode(manager->dev, mode))
			ret = MODE_OK;

	return ret;
}

struct drm_encoder *exynos_drm_best_encoder(struct drm_connector *connector)
{
	struct drm_device *dev = connector->dev;
	struct exynos_drm_connector *exynos_connector =
					to_exynos_connector(connector);
	struct drm_mode_object *obj;
	struct drm_encoder *encoder;

	obj = drm_mode_object_find(dev, exynos_connector->encoder_id,
				   DRM_MODE_OBJECT_ENCODER);
	if (!obj) {
		DRM_DEBUG_KMS("Unknown ENCODER ID %d\n",
				exynos_connector->encoder_id);
		return NULL;
	}

	encoder = obj_to_encoder(obj);

	return encoder;
}

static struct drm_connector_helper_funcs exynos_connector_helper_funcs = {
	.get_modes	= exynos_drm_connector_get_modes,
	.mode_valid	= exynos_drm_connector_mode_valid,
	.best_encoder	= exynos_drm_best_encoder,
};

void exynos_drm_display_power(struct drm_connector *connector, int mode)
{
	struct drm_encoder *encoder = exynos_drm_best_encoder(connector);
	struct exynos_drm_connector *exynos_connector;
	struct exynos_drm_manager *manager = exynos_drm_get_manager(encoder);
	struct exynos_drm_display_ops *display_ops = manager->display_ops;

	exynos_connector = to_exynos_connector(connector);

	if (exynos_connector->dpms == mode) {
		DRM_DEBUG_KMS("desired dpms mode is same as previous one.\n");
		return;
	}

	if (display_ops && display_ops->power_on)
		display_ops->power_on(manager->dev, mode);

	exynos_connector->dpms = mode;
}

static void exynos_drm_connector_dpms(struct drm_connector *connector,
					int mode)
{
	/*
	 * in case that drm_crtc_helper_set_mode() is called,
	 * encoder/crtc->funcs->dpms() will be just returned
	 * because they already were DRM_MODE_DPMS_ON so only
	 * exynos_drm_display_power() will be called.
	 */
	drm_helper_connector_dpms(connector, mode);

	exynos_drm_display_power(connector, mode);

}

static int exynos_drm_connector_fill_modes(struct drm_connector *connector,
				unsigned int max_width, unsigned int max_height)
{
	struct exynos_drm_connector *exynos_connector =
					to_exynos_connector(connector);
	struct exynos_drm_manager *manager = exynos_connector->manager;
	struct exynos_drm_manager_ops *ops = manager->ops;
	unsigned int width, height;

	width = max_width;
	height = max_height;

	/*
	 * if specific driver want to find desired_mode using maxmum
	 * resolution then get max width and height from that driver.
	 */
	if (ops && ops->get_max_resol)
		ops->get_max_resol(manager->dev, &width, &height);

	return drm_helper_probe_single_connector_modes(connector, width,
							height);
}

/* get detection status of display device. */
static enum drm_connector_status
exynos_drm_connector_detect(struct drm_connector *connector, bool force)
{
	struct exynos_drm_connector *exynos_connector =
					to_exynos_connector(connector);
	struct exynos_drm_manager *manager = exynos_connector->manager;
	struct exynos_drm_display_ops *display_ops =
					manager->display_ops;
	enum drm_connector_status status = connector_status_disconnected;

	if (display_ops && display_ops->is_connected) {
		if (display_ops->is_connected(manager->dev))
			status = connector_status_connected;
		else
			status = connector_status_disconnected;
	}

	return status;
}

static void exynos_drm_connector_destroy(struct drm_connector *connector)
{
	struct exynos_drm_connector *exynos_connector =
		to_exynos_connector(connector);

	drm_sysfs_connector_remove(connector);
	drm_connector_cleanup(connector);
	kfree(exynos_connector);
}

static struct drm_connector_funcs exynos_connector_funcs = {
	.dpms		= exynos_drm_connector_dpms,
	.fill_modes	= exynos_drm_connector_fill_modes,
	.detect		= exynos_drm_connector_detect,
	.destroy	= exynos_drm_connector_destroy,
};

struct drm_connector *exynos_drm_connector_create(struct drm_device *dev,
						   struct drm_encoder *encoder)
{
	struct exynos_drm_connector *exynos_connector;
	struct exynos_drm_manager *manager = exynos_drm_get_manager(encoder);
	struct drm_connector *connector;
	int type;
	int err;

	exynos_connector = kzalloc(sizeof(*exynos_connector), GFP_KERNEL);
	if (!exynos_connector)
		return NULL;

	connector = &exynos_connector->drm_connector;

	switch (manager->display_ops->type) {
	case EXYNOS_DISPLAY_TYPE_HDMI:
		type = DRM_MODE_CONNECTOR_HDMIA;
		connector->interlace_allowed = true;
		connector->polled = DRM_CONNECTOR_POLL_HPD;
		break;
	case EXYNOS_DISPLAY_TYPE_VIDI:
		type = DRM_MODE_CONNECTOR_VIRTUAL;
		connector->polled = DRM_CONNECTOR_POLL_HPD;
		break;
	default:
		type = DRM_MODE_CONNECTOR_Unknown;
		break;
	}

	drm_connector_init(dev, connector, &exynos_connector_funcs, type);
	drm_connector_helper_add(connector, &exynos_connector_helper_funcs);

	err = drm_sysfs_connector_add(connector);
	if (err)
		goto err_connector;

	exynos_connector->encoder_id = encoder->base.id;
	exynos_connector->manager = manager;
	exynos_connector->dpms = DRM_MODE_DPMS_OFF;
	connector->dpms = DRM_MODE_DPMS_OFF;
	connector->encoder = encoder;

	err = drm_mode_connector_attach_encoder(connector, encoder);
	if (err) {
		DRM_ERROR("failed to attach a connector to a encoder\n");
		goto err_sysfs;
	}

	DRM_DEBUG_KMS("connector has been created\n");

	return connector;

err_sysfs:
	drm_sysfs_connector_remove(connector);
err_connector:
	drm_connector_cleanup(connector);
	kfree(exynos_connector);
	return NULL;
}
Commit	Line	Data
1c248b7d ID	1	/*
	2	* Copyright (c) 2011 Samsung Electronics Co., Ltd.
	3	* Authors:
	4	* Inki Dae <inki.dae@samsung.com>
	5	* Joonyoung Shim <jy0922.shim@samsung.com>
	6	* Seung-Woo Kim <sw0312.kim@samsung.com>
	7	*
d81aecb5 ID	8	* This program is free software; you can redistribute it and/or modify it
	9	* under the terms of the GNU General Public License as published by the
	10	* Free Software Foundation; either version 2 of the License, or (at your
	11	* option) any later version.
1c248b7d ID	12	*/
1c248b7d ID	13
760285e7 DH	14	#include <drm/drmP.h>
760285e7 DH	15	#include <drm/drm_crtc_helper.h>
1c248b7d	16
607c50d4	17	#include <drm/exynos_drm.h>
1c248b7d ID	18	#include "exynos_drm_drv.h"
1c248b7d ID	19	#include "exynos_drm_encoder.h"
e30655d0	20	#include "exynos_drm_connector.h"
1c248b7d	21
1c248b7d ID	22	#define to_exynos_connector(x) container_of(x, struct exynos_drm_connector,\
	23	drm_connector)
	24
	25	struct exynos_drm_connector {
	26	struct drm_connector drm_connector;
adb6b159 ID	27	uint32_t encoder_id;
adb6b159 ID	28	struct exynos_drm_manager *manager;
50caf25c	29	uint32_t dpms;
1c248b7d ID	30	};
1c248b7d ID	31
1c248b7d ID	32	static int exynos_drm_connector_get_modes(struct drm_connector *connector)
1c248b7d ID	33	{
adb6b159 ID	34	struct exynos_drm_connector *exynos_connector =
	35	to_exynos_connector(connector);
	36	struct exynos_drm_manager *manager = exynos_connector->manager;
74ccc539	37	struct exynos_drm_display_ops *display_ops = manager->display_ops;
9c08e4ba RS	38	struct edid *edid = NULL;
	39	unsigned int count = 0;
	40	int ret;
1c248b7d	41
74ccc539 ID	42	if (!display_ops) {
74ccc539 ID	43	DRM_DEBUG_KMS("display_ops is null.\n");
1c248b7d ID	44	return 0;
	45	}
	46
	47	/*
	48	* if get_edid() exists then get_edid() callback of hdmi side
	49	* is called to get edid data through i2c interface else
	50	* get timing from the FIMD driver(display controller).
	51	*
	52	* P.S. in case of lcd panel, count is always 1 if success
	53	* because lcd panel has only one mode.
	54	*/
74ccc539	55	if (display_ops->get_edid) {
9c08e4ba RS	56	edid = display_ops->get_edid(manager->dev, connector);
	57	if (IS_ERR_OR_NULL(edid)) {
	58	ret = PTR_ERR(edid);
	59	edid = NULL;
	60	DRM_ERROR("Panel operation get_edid failed %d\n", ret);
	61	goto out;
1c248b7d ID	62	}
1c248b7d ID	63
9c08e4ba	64	count = drm_add_edid_modes(connector, edid);
81ed7039	65	if (!count) {
9c08e4ba RS	66	DRM_ERROR("Add edid modes failed %d\n", count);
9c08e4ba RS	67	goto out;
1c248b7d ID	68	}
	69
	70	drm_mode_connector_update_edid_property(connector, edid);
1c248b7d	71	} else {
607c50d4	72	struct exynos_drm_panel_info *panel;
53bd5556 SK	73	struct drm_display_mode *mode = drm_mode_create(connector->dev);
	74	if (!mode) {
	75	DRM_ERROR("failed to create a new display mode.\n");
	76	return 0;
	77	}
1c248b7d	78
607c50d4 ECK	79	if (display_ops->get_panel)
607c50d4 ECK	80	panel = display_ops->get_panel(manager->dev);
1c248b7d ID	81	else {
	82	drm_mode_destroy(connector->dev, mode);
	83	return 0;
	84	}
	85
111e6055 AH	86	drm_display_mode_from_videomode(&panel->vm, mode);
	87	mode->width_mm = panel->width_mm;
	88	mode->height_mm = panel->height_mm;
607c50d4 ECK	89	connector->display_info.width_mm = mode->width_mm;
607c50d4 ECK	90	connector->display_info.height_mm = mode->height_mm;
1c248b7d ID	91
	92	mode->type = DRM_MODE_TYPE_DRIVER \| DRM_MODE_TYPE_PREFERRED;
	93	drm_mode_set_name(mode);
	94	drm_mode_probed_add(connector, mode);
	95
	96	count = 1;
	97	}
	98
9c08e4ba RS	99	out:
9c08e4ba RS	100	kfree(edid);
1c248b7d ID	101	return count;
	102	}
	103
	104	static int exynos_drm_connector_mode_valid(struct drm_connector *connector,
	105	struct drm_display_mode *mode)
	106	{
adb6b159 ID	107	struct exynos_drm_connector *exynos_connector =
	108	to_exynos_connector(connector);
	109	struct exynos_drm_manager *manager = exynos_connector->manager;
74ccc539	110	struct exynos_drm_display_ops *display_ops = manager->display_ops;
1c248b7d ID	111	int ret = MODE_BAD;
	112
	113	DRM_DEBUG_KMS("%s\n", __FILE__);
	114
16844fb1 RS	115	if (display_ops && display_ops->check_mode)
16844fb1 RS	116	if (!display_ops->check_mode(manager->dev, mode))
1c248b7d ID	117	ret = MODE_OK;
	118
	119	return ret;
	120	}
	121
58f6aad7	122	struct drm_encoder exynos_drm_best_encoder(struct drm_connector connector)
1c248b7d	123	{
adb6b159 ID	124	struct drm_device *dev = connector->dev;
	125	struct exynos_drm_connector *exynos_connector =
	126	to_exynos_connector(connector);
	127	struct drm_mode_object *obj;
	128	struct drm_encoder *encoder;
	129
adb6b159 ID	130	obj = drm_mode_object_find(dev, exynos_connector->encoder_id,
	131	DRM_MODE_OBJECT_ENCODER);
	132	if (!obj) {
	133	DRM_DEBUG_KMS("Unknown ENCODER ID %d\n",
	134	exynos_connector->encoder_id);
	135	return NULL;
	136	}
	137
	138	encoder = obj_to_encoder(obj);
	139
	140	return encoder;
1c248b7d ID	141	}
	142
	143	static struct drm_connector_helper_funcs exynos_connector_helper_funcs = {
	144	.get_modes = exynos_drm_connector_get_modes,
	145	.mode_valid = exynos_drm_connector_mode_valid,
	146	.best_encoder = exynos_drm_best_encoder,
	147	};
	148
50caf25c ID	149	void exynos_drm_display_power(struct drm_connector *connector, int mode)
50caf25c ID	150	{
58f6aad7	151	struct drm_encoder *encoder = exynos_drm_best_encoder(connector);
50caf25c ID	152	struct exynos_drm_connector *exynos_connector;
	153	struct exynos_drm_manager *manager = exynos_drm_get_manager(encoder);
	154	struct exynos_drm_display_ops *display_ops = manager->display_ops;
	155
	156	exynos_connector = to_exynos_connector(connector);
	157
	158	if (exynos_connector->dpms == mode) {
	159	DRM_DEBUG_KMS("desired dpms mode is same as previous one.\n");
	160	return;
	161	}
	162
	163	if (display_ops && display_ops->power_on)
	164	display_ops->power_on(manager->dev, mode);
	165
	166	exynos_connector->dpms = mode;
	167	}
	168
	169	static void exynos_drm_connector_dpms(struct drm_connector *connector,
	170	int mode)
	171	{
50caf25c ID	172	/*
	173	* in case that drm_crtc_helper_set_mode() is called,
	174	* encoder/crtc->funcs->dpms() will be just returned
	175	* because they already were DRM_MODE_DPMS_ON so only
	176	* exynos_drm_display_power() will be called.
	177	*/
	178	drm_helper_connector_dpms(connector, mode);
	179
	180	exynos_drm_display_power(connector, mode);
	181
	182	}
	183
1de425b0 ID	184	static int exynos_drm_connector_fill_modes(struct drm_connector *connector,
	185	unsigned int max_width, unsigned int max_height)
	186	{
	187	struct exynos_drm_connector *exynos_connector =
	188	to_exynos_connector(connector);
	189	struct exynos_drm_manager *manager = exynos_connector->manager;
	190	struct exynos_drm_manager_ops *ops = manager->ops;
	191	unsigned int width, height;
	192
	193	width = max_width;
	194	height = max_height;
	195
	196	/*
	197	* if specific driver want to find desired_mode using maxmum
	198	* resolution then get max width and height from that driver.
	199	*/
	200	if (ops && ops->get_max_resol)
	201	ops->get_max_resol(manager->dev, &width, &height);
	202
	203	return drm_helper_probe_single_connector_modes(connector, width,
	204	height);
	205	}
	206
1c248b7d ID	207	/* get detection status of display device. */
	208	static enum drm_connector_status
	209	exynos_drm_connector_detect(struct drm_connector *connector, bool force)
	210	{
adb6b159 ID	211	struct exynos_drm_connector *exynos_connector =
	212	to_exynos_connector(connector);
	213	struct exynos_drm_manager *manager = exynos_connector->manager;
74ccc539 ID	214	struct exynos_drm_display_ops *display_ops =
74ccc539 ID	215	manager->display_ops;
1c248b7d ID	216	enum drm_connector_status status = connector_status_disconnected;
1c248b7d ID	217
74ccc539 ID	218	if (display_ops && display_ops->is_connected) {
74ccc539 ID	219	if (display_ops->is_connected(manager->dev))
1c248b7d ID	220	status = connector_status_connected;
	221	else
	222	status = connector_status_disconnected;
	223	}
	224
	225	return status;
	226	}
	227
	228	static void exynos_drm_connector_destroy(struct drm_connector *connector)
	229	{
	230	struct exynos_drm_connector *exynos_connector =
	231	to_exynos_connector(connector);
	232
1c248b7d ID	233	drm_sysfs_connector_remove(connector);
	234	drm_connector_cleanup(connector);
	235	kfree(exynos_connector);
	236	}
	237
	238	static struct drm_connector_funcs exynos_connector_funcs = {
50caf25c	239	.dpms = exynos_drm_connector_dpms,
1de425b0	240	.fill_modes = exynos_drm_connector_fill_modes,
1c248b7d ID	241	.detect = exynos_drm_connector_detect,
	242	.destroy = exynos_drm_connector_destroy,
	243	};
	244
	245	struct drm_connector exynos_drm_connector_create(struct drm_device dev,
	246	struct drm_encoder *encoder)
	247	{
	248	struct exynos_drm_connector *exynos_connector;
	249	struct exynos_drm_manager *manager = exynos_drm_get_manager(encoder);
	250	struct drm_connector *connector;
	251	int type;
	252	int err;
	253
1c248b7d	254	exynos_connector = kzalloc(sizeof(*exynos_connector), GFP_KERNEL);
38bb5253	255	if (!exynos_connector)
1c248b7d	256	return NULL;
1c248b7d ID	257
	258	connector = &exynos_connector->drm_connector;
	259
74ccc539	260	switch (manager->display_ops->type) {
1c248b7d ID	261	case EXYNOS_DISPLAY_TYPE_HDMI:
1c248b7d ID	262	type = DRM_MODE_CONNECTOR_HDMIA;
1b17b206 SWK	263	connector->interlace_allowed = true;
1b17b206 SWK	264	connector->polled = DRM_CONNECTOR_POLL_HPD;
1c248b7d	265	break;
b73d1230 ID	266	case EXYNOS_DISPLAY_TYPE_VIDI:
	267	type = DRM_MODE_CONNECTOR_VIRTUAL;
	268	connector->polled = DRM_CONNECTOR_POLL_HPD;
	269	break;
1c248b7d ID	270	default:
	271	type = DRM_MODE_CONNECTOR_Unknown;
	272	break;
	273	}
	274
	275	drm_connector_init(dev, connector, &exynos_connector_funcs, type);
	276	drm_connector_helper_add(connector, &exynos_connector_helper_funcs);
	277
	278	err = drm_sysfs_connector_add(connector);
	279	if (err)
	280	goto err_connector;
	281
adb6b159 ID	282	exynos_connector->encoder_id = encoder->base.id;
adb6b159 ID	283	exynos_connector->manager = manager;
50caf25c	284	exynos_connector->dpms = DRM_MODE_DPMS_OFF;
44c91697	285	connector->dpms = DRM_MODE_DPMS_OFF;
1c248b7d	286	connector->encoder = encoder;
adb6b159	287
1c248b7d ID	288	err = drm_mode_connector_attach_encoder(connector, encoder);
	289	if (err) {
	290	DRM_ERROR("failed to attach a connector to a encoder\n");
	291	goto err_sysfs;
	292	}
	293
	294	DRM_DEBUG_KMS("connector has been created\n");
	295
	296	return connector;
	297
	298	err_sysfs:
	299	drm_sysfs_connector_remove(connector);
	300	err_connector:
	301	drm_connector_cleanup(connector);
	302	kfree(exynos_connector);
	303	return NULL;
	304	}