[mirror_ubuntu-artful-kernel.git] / drivers / gpu / drm / exynos / exynos_drm_vidi.c

/* exynos_drm_vidi.c
 *
 * Copyright (C) 2012 Samsung Electronics Co.Ltd
 * Authors:
 *	Inki Dae <inki.dae@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 <linux/kernel.h>
#include <linux/platform_device.h>
#include <linux/component.h>

#include <drm/exynos_drm.h>

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

#include "exynos_drm_drv.h"
#include "exynos_drm_crtc.h"
#include "exynos_drm_plane.h"
#include "exynos_drm_encoder.h"
#include "exynos_drm_vidi.h"

/* vidi has totally three virtual windows. */
#define WINDOWS_NR		3

#define ctx_from_connector(c)	container_of(c, struct vidi_context, \
					connector)

struct vidi_context {
	struct exynos_drm_display	display;
	struct platform_device		*pdev;
	struct drm_device		*drm_dev;
	struct exynos_drm_crtc		*crtc;
	struct drm_encoder		*encoder;
	struct drm_connector		connector;
	struct exynos_drm_plane		planes[WINDOWS_NR];
	struct edid			*raw_edid;
	unsigned int			clkdiv;
	unsigned int			default_win;
	unsigned long			irq_flags;
	unsigned int			connected;
	bool				vblank_on;
	bool				suspended;
	bool				direct_vblank;
	struct work_struct		work;
	struct mutex			lock;
	int				pipe;
};

static inline struct vidi_context *display_to_vidi(struct exynos_drm_display *d)
{
	return container_of(d, struct vidi_context, display);
}

static const char fake_edid_info[] = {
	0x00, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0x00, 0x4c, 0x2d, 0x05, 0x05,
	0x00, 0x00, 0x00, 0x00, 0x30, 0x12, 0x01, 0x03, 0x80, 0x10, 0x09, 0x78,
	0x0a, 0xee, 0x91, 0xa3, 0x54, 0x4c, 0x99, 0x26, 0x0f, 0x50, 0x54, 0xbd,
	0xee, 0x00, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01,
	0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x66, 0x21, 0x50, 0xb0, 0x51, 0x00,
	0x1b, 0x30, 0x40, 0x70, 0x36, 0x00, 0xa0, 0x5a, 0x00, 0x00, 0x00, 0x1e,
	0x01, 0x1d, 0x00, 0x72, 0x51, 0xd0, 0x1e, 0x20, 0x6e, 0x28, 0x55, 0x00,
	0xa0, 0x5a, 0x00, 0x00, 0x00, 0x1e, 0x00, 0x00, 0x00, 0xfd, 0x00, 0x18,
	0x4b, 0x1a, 0x44, 0x17, 0x00, 0x0a, 0x20, 0x20, 0x20, 0x20, 0x20, 0x20,
	0x00, 0x00, 0x00, 0xfc, 0x00, 0x53, 0x41, 0x4d, 0x53, 0x55, 0x4e, 0x47,
	0x0a, 0x20, 0x20, 0x20, 0x20, 0x20, 0x01, 0xbc, 0x02, 0x03, 0x1e, 0xf1,
	0x46, 0x84, 0x05, 0x03, 0x10, 0x20, 0x22, 0x23, 0x09, 0x07, 0x07, 0x83,
	0x01, 0x00, 0x00, 0xe2, 0x00, 0x0f, 0x67, 0x03, 0x0c, 0x00, 0x10, 0x00,
	0xb8, 0x2d, 0x01, 0x1d, 0x80, 0x18, 0x71, 0x1c, 0x16, 0x20, 0x58, 0x2c,
	0x25, 0x00, 0xa0, 0x5a, 0x00, 0x00, 0x00, 0x9e, 0x8c, 0x0a, 0xd0, 0x8a,
	0x20, 0xe0, 0x2d, 0x10, 0x10, 0x3e, 0x96, 0x00, 0xa0, 0x5a, 0x00, 0x00,
	0x00, 0x18, 0x02, 0x3a, 0x80, 0x18, 0x71, 0x38, 0x2d, 0x40, 0x58, 0x2c,
	0x45, 0x00, 0xa0, 0x5a, 0x00, 0x00, 0x00, 0x1e, 0x00, 0x00, 0x00, 0x00,
	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
	0x00, 0x00, 0x00, 0x06
};

static int vidi_enable_vblank(struct exynos_drm_crtc *crtc)
{
	struct vidi_context *ctx = crtc->ctx;

	if (ctx->suspended)
		return -EPERM;

	if (!test_and_set_bit(0, &ctx->irq_flags))
		ctx->vblank_on = true;

	ctx->direct_vblank = true;

	/*
	 * in case of page flip request, vidi_finish_pageflip function
	 * will not be called because direct_vblank is true and then
	 * that function will be called by crtc_ops->win_commit callback
	 */
	schedule_work(&ctx->work);

	return 0;
}

static void vidi_disable_vblank(struct exynos_drm_crtc *crtc)
{
	struct vidi_context *ctx = crtc->ctx;

	if (ctx->suspended)
		return;

	if (test_and_clear_bit(0, &ctx->irq_flags))
		ctx->vblank_on = false;
}

static void vidi_win_commit(struct exynos_drm_crtc *crtc, unsigned int win)
{
	struct vidi_context *ctx = crtc->ctx;
	struct exynos_drm_plane *plane;

	if (ctx->suspended)
		return;

	if (win < 0 || win >= WINDOWS_NR)
		return;

	plane = &ctx->planes[win];

	plane->enabled = true;

	DRM_DEBUG_KMS("dma_addr = %pad\n", plane->dma_addr);

	if (ctx->vblank_on)
		schedule_work(&ctx->work);
}

static void vidi_win_disable(struct exynos_drm_crtc *crtc, unsigned int win)
{
	struct vidi_context *ctx = crtc->ctx;
	struct exynos_drm_plane *plane;

	if (win < 0 || win >= WINDOWS_NR)
		return;

	plane = &ctx->planes[win];
	plane->enabled = false;

	/* TODO. */
}

static int vidi_power_on(struct vidi_context *ctx, bool enable)
{
	struct exynos_drm_plane *plane;
	int i;

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

	if (enable != false && enable != true)
		return -EINVAL;

	if (enable) {
		ctx->suspended = false;

		/* if vblank was enabled status, enable it again. */
		if (test_and_clear_bit(0, &ctx->irq_flags))
			vidi_enable_vblank(ctx->crtc);

		for (i = 0; i < WINDOWS_NR; i++) {
			plane = &ctx->planes[i];
			if (plane->enabled)
				vidi_win_commit(ctx->crtc, i);
		}
	} else {
		ctx->suspended = true;
	}

	return 0;
}

static void vidi_dpms(struct exynos_drm_crtc *crtc, int mode)
{
	struct vidi_context *ctx = crtc->ctx;

	DRM_DEBUG_KMS("%d\n", mode);

	mutex_lock(&ctx->lock);

	switch (mode) {
	case DRM_MODE_DPMS_ON:
		vidi_power_on(ctx, true);
		break;
	case DRM_MODE_DPMS_STANDBY:
	case DRM_MODE_DPMS_SUSPEND:
	case DRM_MODE_DPMS_OFF:
		vidi_power_on(ctx, false);
		break;
	default:
		DRM_DEBUG_KMS("unspecified mode %d\n", mode);
		break;
	}

	mutex_unlock(&ctx->lock);
}

static int vidi_ctx_initialize(struct vidi_context *ctx,
			struct drm_device *drm_dev)
{
	struct exynos_drm_private *priv = drm_dev->dev_private;

	ctx->drm_dev = drm_dev;
	ctx->pipe = priv->pipe++;

	return 0;
}

static struct exynos_drm_crtc_ops vidi_crtc_ops = {
	.dpms = vidi_dpms,
	.enable_vblank = vidi_enable_vblank,
	.disable_vblank = vidi_disable_vblank,
	.win_commit = vidi_win_commit,
	.win_disable = vidi_win_disable,
};

static void vidi_fake_vblank_handler(struct work_struct *work)
{
	struct vidi_context *ctx = container_of(work, struct vidi_context,
					work);

	if (ctx->pipe < 0)
		return;

	/* refresh rate is about 50Hz. */
	usleep_range(16000, 20000);

	mutex_lock(&ctx->lock);

	if (ctx->direct_vblank) {
		drm_handle_vblank(ctx->drm_dev, ctx->pipe);
		ctx->direct_vblank = false;
		mutex_unlock(&ctx->lock);
		return;
	}

	mutex_unlock(&ctx->lock);

	exynos_drm_crtc_finish_pageflip(ctx->drm_dev, ctx->pipe);
}

static int vidi_show_connection(struct device *dev,
				struct device_attribute *attr, char *buf)
{
	struct vidi_context *ctx = dev_get_drvdata(dev);
	int rc;

	mutex_lock(&ctx->lock);

	rc = sprintf(buf, "%d\n", ctx->connected);

	mutex_unlock(&ctx->lock);

	return rc;
}

static int vidi_store_connection(struct device *dev,
				struct device_attribute *attr,
				const char *buf, size_t len)
{
	struct vidi_context *ctx = dev_get_drvdata(dev);
	int ret;

	ret = kstrtoint(buf, 0, &ctx->connected);
	if (ret)
		return ret;

	if (ctx->connected > 1)
		return -EINVAL;

	/* use fake edid data for test. */
	if (!ctx->raw_edid)
		ctx->raw_edid = (struct edid *)fake_edid_info;

	/* if raw_edid isn't same as fake data then it can't be tested. */
	if (ctx->raw_edid != (struct edid *)fake_edid_info) {
		DRM_DEBUG_KMS("edid data is not fake data.\n");
		return -EINVAL;
	}

	DRM_DEBUG_KMS("requested connection.\n");

	drm_helper_hpd_irq_event(ctx->drm_dev);

	return len;
}

static DEVICE_ATTR(connection, 0644, vidi_show_connection,
			vidi_store_connection);

int vidi_connection_ioctl(struct drm_device *drm_dev, void *data,
				struct drm_file *file_priv)
{
	struct vidi_context *ctx = NULL;
	struct drm_encoder *encoder;
	struct exynos_drm_display *display;
	struct drm_exynos_vidi_connection *vidi = data;

	if (!vidi) {
		DRM_DEBUG_KMS("user data for vidi is null.\n");
		return -EINVAL;
	}

	if (vidi->connection > 1) {
		DRM_DEBUG_KMS("connection should be 0 or 1.\n");
		return -EINVAL;
	}

	list_for_each_entry(encoder, &drm_dev->mode_config.encoder_list,
								head) {
		display = exynos_drm_get_display(encoder);

		if (display->type == EXYNOS_DISPLAY_TYPE_VIDI) {
			ctx = display_to_vidi(display);
			break;
		}
	}

	if (!ctx) {
		DRM_DEBUG_KMS("not found virtual device type encoder.\n");
		return -EINVAL;
	}

	if (ctx->connected == vidi->connection) {
		DRM_DEBUG_KMS("same connection request.\n");
		return -EINVAL;
	}

	if (vidi->connection) {
		struct edid *raw_edid  = (struct edid *)(uint32_t)vidi->edid;
		if (!drm_edid_is_valid(raw_edid)) {
			DRM_DEBUG_KMS("edid data is invalid.\n");
			return -EINVAL;
		}
		ctx->raw_edid = drm_edid_duplicate(raw_edid);
		if (!ctx->raw_edid) {
			DRM_DEBUG_KMS("failed to allocate raw_edid.\n");
			return -ENOMEM;
		}
	} else {
		/*
		 * with connection = 0, free raw_edid
		 * only if raw edid data isn't same as fake data.
		 */
		if (ctx->raw_edid && ctx->raw_edid !=
				(struct edid *)fake_edid_info) {
			kfree(ctx->raw_edid);
			ctx->raw_edid = NULL;
		}
	}

	ctx->connected = vidi->connection;
	drm_helper_hpd_irq_event(ctx->drm_dev);

	return 0;
}

static enum drm_connector_status vidi_detect(struct drm_connector *connector,
			bool force)
{
	struct vidi_context *ctx = ctx_from_connector(connector);

	/*
	 * connection request would come from user side
	 * to do hotplug through specific ioctl.
	 */
	return ctx->connected ? connector_status_connected :
			connector_status_disconnected;
}

static void vidi_connector_destroy(struct drm_connector *connector)
{
}

static struct drm_connector_funcs vidi_connector_funcs = {
	.dpms = drm_helper_connector_dpms,
	.fill_modes = drm_helper_probe_single_connector_modes,
	.detect = vidi_detect,
	.destroy = vidi_connector_destroy,
};

static int vidi_get_modes(struct drm_connector *connector)
{
	struct vidi_context *ctx = ctx_from_connector(connector);
	struct edid *edid;
	int edid_len;

	/*
	 * the edid data comes from user side and it would be set
	 * to ctx->raw_edid through specific ioctl.
	 */
	if (!ctx->raw_edid) {
		DRM_DEBUG_KMS("raw_edid is null.\n");
		return -EFAULT;
	}

	edid_len = (1 + ctx->raw_edid->extensions) * EDID_LENGTH;
	edid = kmemdup(ctx->raw_edid, edid_len, GFP_KERNEL);
	if (!edid) {
		DRM_DEBUG_KMS("failed to allocate edid\n");
		return -ENOMEM;
	}

	drm_mode_connector_update_edid_property(connector, edid);

	return drm_add_edid_modes(connector, edid);
}

static struct drm_encoder *vidi_best_encoder(struct drm_connector *connector)
{
	struct vidi_context *ctx = ctx_from_connector(connector);

	return ctx->encoder;
}

static struct drm_connector_helper_funcs vidi_connector_helper_funcs = {
	.get_modes = vidi_get_modes,
	.best_encoder = vidi_best_encoder,
};

static int vidi_create_connector(struct exynos_drm_display *display,
				struct drm_encoder *encoder)
{
	struct vidi_context *ctx = display_to_vidi(display);
	struct drm_connector *connector = &ctx->connector;
	int ret;

	ctx->encoder = encoder;
	connector->polled = DRM_CONNECTOR_POLL_HPD;

	ret = drm_connector_init(ctx->drm_dev, connector,
			&vidi_connector_funcs, DRM_MODE_CONNECTOR_VIRTUAL);
	if (ret) {
		DRM_ERROR("Failed to initialize connector with drm\n");
		return ret;
	}

	drm_connector_helper_add(connector, &vidi_connector_helper_funcs);
	drm_connector_register(connector);
	drm_mode_connector_attach_encoder(connector, encoder);

	return 0;
}


static struct exynos_drm_display_ops vidi_display_ops = {
	.create_connector = vidi_create_connector,
};

static int vidi_bind(struct device *dev, struct device *master, void *data)
{
	struct vidi_context *ctx = dev_get_drvdata(dev);
	struct drm_device *drm_dev = data;
	struct exynos_drm_plane *exynos_plane;
	enum drm_plane_type type;
	unsigned int zpos;
	int ret;

	vidi_ctx_initialize(ctx, drm_dev);

	for (zpos = 0; zpos < WINDOWS_NR; zpos++) {
		type = (zpos == ctx->default_win) ? DRM_PLANE_TYPE_PRIMARY :
						DRM_PLANE_TYPE_OVERLAY;
		ret = exynos_plane_init(drm_dev, &ctx->planes[zpos],
					1 << ctx->pipe, type, zpos);
		if (ret)
			return ret;
	}

	exynos_plane = &ctx->planes[ctx->default_win];
	ctx->crtc = exynos_drm_crtc_create(drm_dev, &exynos_plane->base,
					   ctx->pipe, EXYNOS_DISPLAY_TYPE_VIDI,
					   &vidi_crtc_ops, ctx);
	if (IS_ERR(ctx->crtc)) {
		DRM_ERROR("failed to create crtc.\n");
		return PTR_ERR(ctx->crtc);
	}

	ret = exynos_drm_create_enc_conn(drm_dev, &ctx->display);
	if (ret) {
		ctx->crtc->base.funcs->destroy(&ctx->crtc->base);
		return ret;
	}

	return 0;
}


static void vidi_unbind(struct device *dev, struct device *master, void *data)
{
}

static const struct component_ops vidi_component_ops = {
	.bind	= vidi_bind,
	.unbind = vidi_unbind,
};

static int vidi_probe(struct platform_device *pdev)
{
	struct vidi_context *ctx;
	int ret;

	ctx = devm_kzalloc(&pdev->dev, sizeof(*ctx), GFP_KERNEL);
	if (!ctx)
		return -ENOMEM;

	ctx->display.type = EXYNOS_DISPLAY_TYPE_VIDI;
	ctx->display.ops = &vidi_display_ops;
	ctx->default_win = 0;
	ctx->pdev = pdev;

	ret = exynos_drm_component_add(&pdev->dev, EXYNOS_DEVICE_TYPE_CRTC,
					EXYNOS_DISPLAY_TYPE_VIDI);
	if (ret)
		return ret;

	ret = exynos_drm_component_add(&pdev->dev, EXYNOS_DEVICE_TYPE_CONNECTOR,
					ctx->display.type);
	if (ret)
		goto err_del_crtc_component;

	INIT_WORK(&ctx->work, vidi_fake_vblank_handler);

	mutex_init(&ctx->lock);

	platform_set_drvdata(pdev, ctx);

	ret = device_create_file(&pdev->dev, &dev_attr_connection);
	if (ret < 0) {
		DRM_ERROR("failed to create connection sysfs.\n");
		goto err_del_conn_component;
	}

	ret = component_add(&pdev->dev, &vidi_component_ops);
	if (ret)
		goto err_remove_file;

	return ret;

err_remove_file:
	device_remove_file(&pdev->dev, &dev_attr_connection);
err_del_conn_component:
	exynos_drm_component_del(&pdev->dev, EXYNOS_DEVICE_TYPE_CONNECTOR);
err_del_crtc_component:
	exynos_drm_component_del(&pdev->dev, EXYNOS_DEVICE_TYPE_CRTC);

	return ret;
}

static int vidi_remove(struct platform_device *pdev)
{
	struct vidi_context *ctx = platform_get_drvdata(pdev);

	if (ctx->raw_edid != (struct edid *)fake_edid_info) {
		kfree(ctx->raw_edid);
		ctx->raw_edid = NULL;

		return -EINVAL;
	}

	component_del(&pdev->dev, &vidi_component_ops);
	exynos_drm_component_del(&pdev->dev, EXYNOS_DEVICE_TYPE_CONNECTOR);
	exynos_drm_component_del(&pdev->dev, EXYNOS_DEVICE_TYPE_CRTC);

	return 0;
}

struct platform_driver vidi_driver = {
	.probe		= vidi_probe,
	.remove		= vidi_remove,
	.driver		= {
		.name	= "exynos-drm-vidi",
		.owner	= THIS_MODULE,
	},
};

int exynos_drm_probe_vidi(void)
{
	struct platform_device *pdev;
	int ret;

	pdev = platform_device_register_simple("exynos-drm-vidi", -1, NULL, 0);
	if (IS_ERR(pdev))
		return PTR_ERR(pdev);

	ret = platform_driver_register(&vidi_driver);
	if (ret) {
		platform_device_unregister(pdev);
		return ret;
	}

	return ret;
}

static int exynos_drm_remove_vidi_device(struct device *dev, void *data)
{
	platform_device_unregister(to_platform_device(dev));

	return 0;
}

void exynos_drm_remove_vidi(void)
{
	int ret = driver_for_each_device(&vidi_driver.driver, NULL, NULL,
					 exynos_drm_remove_vidi_device);
	/* silence compiler warning */
	(void)ret;

	platform_driver_unregister(&vidi_driver);
}
Commit	Line	Data
b73d1230 ID	1	/* exynos_drm_vidi.c
	2	*
	3	* Copyright (C) 2012 Samsung Electronics Co.Ltd
	4	* Authors:
	5	* Inki Dae <inki.dae@samsung.com>
	6	*
	7	* This program is free software; you can redistribute it and/or modify it
	8	* under the terms of the GNU General Public License as published by the
	9	* Free Software Foundation; either version 2 of the License, or (at your
	10	* option) any later version.
	11	*
	12	*/
760285e7	13	#include <drm/drmP.h>
b73d1230 ID	14
b73d1230 ID	15	#include <linux/kernel.h>
b73d1230	16	#include <linux/platform_device.h>
1d50aa9c	17	#include <linux/component.h>
b73d1230 ID	18
	19	#include <drm/exynos_drm.h>
	20
760285e7 DH	21	#include <drm/drm_edid.h>
760285e7 DH	22	#include <drm/drm_crtc_helper.h>
b73d1230 ID	23
	24	#include "exynos_drm_drv.h"
	25	#include "exynos_drm_crtc.h"
7ee14cdc	26	#include "exynos_drm_plane.h"
b73d1230	27	#include "exynos_drm_encoder.h"
e30655d0	28	#include "exynos_drm_vidi.h"
b73d1230 ID	29
	30	/* vidi has totally three virtual windows. */
	31	#define WINDOWS_NR 3
	32
ce6cb556 SP	33	#define ctx_from_connector(c) container_of(c, struct vidi_context, \
ce6cb556 SP	34	connector)
b73d1230	35
b73d1230	36	struct vidi_context {
7340426a	37	struct exynos_drm_display display;
1d50aa9c	38	struct platform_device *pdev;
080be03d	39	struct drm_device *drm_dev;
93bca243	40	struct exynos_drm_crtc *crtc;
ce6cb556 SP	41	struct drm_encoder *encoder;
ce6cb556 SP	42	struct drm_connector connector;
7ee14cdc	43	struct exynos_drm_plane planes[WINDOWS_NR];
b73d1230 ID	44	struct edid *raw_edid;
	45	unsigned int clkdiv;
	46	unsigned int default_win;
	47	unsigned long irq_flags;
	48	unsigned int connected;
	49	bool vblank_on;
	50	bool suspended;
291257cf	51	bool direct_vblank;
b73d1230 ID	52	struct work_struct work;
b73d1230 ID	53	struct mutex lock;
080be03d	54	int pipe;
b73d1230 ID	55	};
b73d1230 ID	56
2f26bd72 AH	57	static inline struct vidi_context display_to_vidi(struct exynos_drm_display d)
	58	{
	59	return container_of(d, struct vidi_context, display);
	60	}
	61
b73d1230 ID	62	static const char fake_edid_info[] = {
	63	0x00, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0x00, 0x4c, 0x2d, 0x05, 0x05,
	64	0x00, 0x00, 0x00, 0x00, 0x30, 0x12, 0x01, 0x03, 0x80, 0x10, 0x09, 0x78,
	65	0x0a, 0xee, 0x91, 0xa3, 0x54, 0x4c, 0x99, 0x26, 0x0f, 0x50, 0x54, 0xbd,
	66	0xee, 0x00, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01,
	67	0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x66, 0x21, 0x50, 0xb0, 0x51, 0x00,
	68	0x1b, 0x30, 0x40, 0x70, 0x36, 0x00, 0xa0, 0x5a, 0x00, 0x00, 0x00, 0x1e,
	69	0x01, 0x1d, 0x00, 0x72, 0x51, 0xd0, 0x1e, 0x20, 0x6e, 0x28, 0x55, 0x00,
	70	0xa0, 0x5a, 0x00, 0x00, 0x00, 0x1e, 0x00, 0x00, 0x00, 0xfd, 0x00, 0x18,
	71	0x4b, 0x1a, 0x44, 0x17, 0x00, 0x0a, 0x20, 0x20, 0x20, 0x20, 0x20, 0x20,
	72	0x00, 0x00, 0x00, 0xfc, 0x00, 0x53, 0x41, 0x4d, 0x53, 0x55, 0x4e, 0x47,
	73	0x0a, 0x20, 0x20, 0x20, 0x20, 0x20, 0x01, 0xbc, 0x02, 0x03, 0x1e, 0xf1,
	74	0x46, 0x84, 0x05, 0x03, 0x10, 0x20, 0x22, 0x23, 0x09, 0x07, 0x07, 0x83,
	75	0x01, 0x00, 0x00, 0xe2, 0x00, 0x0f, 0x67, 0x03, 0x0c, 0x00, 0x10, 0x00,
	76	0xb8, 0x2d, 0x01, 0x1d, 0x80, 0x18, 0x71, 0x1c, 0x16, 0x20, 0x58, 0x2c,
	77	0x25, 0x00, 0xa0, 0x5a, 0x00, 0x00, 0x00, 0x9e, 0x8c, 0x0a, 0xd0, 0x8a,
	78	0x20, 0xe0, 0x2d, 0x10, 0x10, 0x3e, 0x96, 0x00, 0xa0, 0x5a, 0x00, 0x00,
	79	0x00, 0x18, 0x02, 0x3a, 0x80, 0x18, 0x71, 0x38, 0x2d, 0x40, 0x58, 0x2c,
	80	0x45, 0x00, 0xa0, 0x5a, 0x00, 0x00, 0x00, 0x1e, 0x00, 0x00, 0x00, 0x00,
	81	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
	82	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
	83	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
	84	0x00, 0x00, 0x00, 0x06
	85	};
	86
93bca243	87	static int vidi_enable_vblank(struct exynos_drm_crtc *crtc)
b73d1230	88	{
93bca243	89	struct vidi_context *ctx = crtc->ctx;
b73d1230	90
b73d1230 ID	91	if (ctx->suspended)
	92	return -EPERM;
	93
	94	if (!test_and_set_bit(0, &ctx->irq_flags))
	95	ctx->vblank_on = true;
	96
291257cf ID	97	ctx->direct_vblank = true;
	98
	99	/*
	100	* in case of page flip request, vidi_finish_pageflip function
	101	* will not be called because direct_vblank is true and then
93bca243	102	* that function will be called by crtc_ops->win_commit callback
291257cf ID	103	*/
	104	schedule_work(&ctx->work);
	105
b73d1230 ID	106	return 0;
	107	}
	108
93bca243	109	static void vidi_disable_vblank(struct exynos_drm_crtc *crtc)
b73d1230	110	{
93bca243	111	struct vidi_context *ctx = crtc->ctx;
b73d1230	112
b73d1230 ID	113	if (ctx->suspended)
	114	return;
	115
	116	if (test_and_clear_bit(0, &ctx->irq_flags))
	117	ctx->vblank_on = false;
	118	}
	119
6e2a3b66	120	static void vidi_win_commit(struct exynos_drm_crtc *crtc, unsigned int win)
b73d1230	121	{
93bca243	122	struct vidi_context *ctx = crtc->ctx;
7ee14cdc	123	struct exynos_drm_plane *plane;
b73d1230	124
b73d1230 ID	125	if (ctx->suspended)
	126	return;
	127
a7f98d6a	128	if (win < 0 \|\| win >= WINDOWS_NR)
b73d1230 ID	129	return;
b73d1230 ID	130
7ee14cdc	131	plane = &ctx->planes[win];
b73d1230	132
7ee14cdc	133	plane->enabled = true;
b73d1230	134
7ee14cdc	135	DRM_DEBUG_KMS("dma_addr = %pad\n", plane->dma_addr);
b73d1230 ID	136
	137	if (ctx->vblank_on)
	138	schedule_work(&ctx->work);
	139	}
	140
6e2a3b66	141	static void vidi_win_disable(struct exynos_drm_crtc *crtc, unsigned int win)
b73d1230	142	{
93bca243	143	struct vidi_context *ctx = crtc->ctx;
7ee14cdc	144	struct exynos_drm_plane *plane;
b73d1230	145
a7f98d6a	146	if (win < 0 \|\| win >= WINDOWS_NR)
b73d1230 ID	147	return;
b73d1230 ID	148
7ee14cdc GP	149	plane = &ctx->planes[win];
7ee14cdc GP	150	plane->enabled = false;
b73d1230 ID	151
	152	/* TODO. */
	153	}
	154
92dc7a04	155	static int vidi_power_on(struct vidi_context *ctx, bool enable)
af65c804	156	{
7ee14cdc GP	157	struct exynos_drm_plane *plane;
	158	int i;
	159
af65c804 SP	160	DRM_DEBUG_KMS("%s\n", __FILE__);
	161
	162	if (enable != false && enable != true)
	163	return -EINVAL;
	164
	165	if (enable) {
	166	ctx->suspended = false;
	167
	168	/* if vblank was enabled status, enable it again. */
	169	if (test_and_clear_bit(0, &ctx->irq_flags))
92dc7a04	170	vidi_enable_vblank(ctx->crtc);
af65c804	171
7ee14cdc GP	172	for (i = 0; i < WINDOWS_NR; i++) {
	173	plane = &ctx->planes[i];
	174	if (plane->enabled)
	175	vidi_win_commit(ctx->crtc, i);
	176	}
af65c804 SP	177	} else {
	178	ctx->suspended = true;
	179	}
	180
	181	return 0;
	182	}
	183
93bca243	184	static void vidi_dpms(struct exynos_drm_crtc *crtc, int mode)
af65c804	185	{
93bca243	186	struct vidi_context *ctx = crtc->ctx;
af65c804 SP	187
	188	DRM_DEBUG_KMS("%d\n", mode);
	189
	190	mutex_lock(&ctx->lock);
	191
	192	switch (mode) {
	193	case DRM_MODE_DPMS_ON:
92dc7a04	194	vidi_power_on(ctx, true);
af65c804 SP	195	break;
	196	case DRM_MODE_DPMS_STANDBY:
	197	case DRM_MODE_DPMS_SUSPEND:
	198	case DRM_MODE_DPMS_OFF:
92dc7a04	199	vidi_power_on(ctx, false);
af65c804 SP	200	break;
	201	default:
	202	DRM_DEBUG_KMS("unspecified mode %d\n", mode);
	203	break;
	204	}
	205
	206	mutex_unlock(&ctx->lock);
	207	}
	208
93bca243	209	static int vidi_ctx_initialize(struct vidi_context *ctx,
f37cd5e8	210	struct drm_device *drm_dev)
080be03d	211	{
f37cd5e8	212	struct exynos_drm_private *priv = drm_dev->dev_private;
080be03d	213
eb88e422	214	ctx->drm_dev = drm_dev;
8a326edd	215	ctx->pipe = priv->pipe++;
080be03d	216
080be03d SP	217	return 0;
	218	}
	219
93bca243	220	static struct exynos_drm_crtc_ops vidi_crtc_ops = {
1c6244c3	221	.dpms = vidi_dpms,
1c6244c3 SP	222	.enable_vblank = vidi_enable_vblank,
1c6244c3 SP	223	.disable_vblank = vidi_disable_vblank,
1c6244c3 SP	224	.win_commit = vidi_win_commit,
1c6244c3 SP	225	.win_disable = vidi_win_disable,
b73d1230 ID	226	};
b73d1230 ID	227
b73d1230 ID	228	static void vidi_fake_vblank_handler(struct work_struct *work)
	229	{
	230	struct vidi_context *ctx = container_of(work, struct vidi_context,
	231	work);
b73d1230	232
080be03d	233	if (ctx->pipe < 0)
b73d1230 ID	234	return;
	235
	236	/* refresh rate is about 50Hz. */
	237	usleep_range(16000, 20000);
	238
291257cf ID	239	mutex_lock(&ctx->lock);
	240
	241	if (ctx->direct_vblank) {
080be03d	242	drm_handle_vblank(ctx->drm_dev, ctx->pipe);
291257cf ID	243	ctx->direct_vblank = false;
	244	mutex_unlock(&ctx->lock);
	245	return;
	246	}
	247
	248	mutex_unlock(&ctx->lock);
	249
080be03d	250	exynos_drm_crtc_finish_pageflip(ctx->drm_dev, ctx->pipe);
b73d1230 ID	251	}
b73d1230 ID	252
b73d1230 ID	253	static int vidi_show_connection(struct device *dev,
	254	struct device_attribute attr, char buf)
	255	{
f01833cd	256	struct vidi_context *ctx = dev_get_drvdata(dev);
b73d1230	257	int rc;
b73d1230 ID	258
	259	mutex_lock(&ctx->lock);
	260
	261	rc = sprintf(buf, "%d\n", ctx->connected);
	262
	263	mutex_unlock(&ctx->lock);
	264
	265	return rc;
	266	}
	267
	268	static int vidi_store_connection(struct device *dev,
	269	struct device_attribute *attr,
	270	const char *buf, size_t len)
	271	{
f01833cd	272	struct vidi_context *ctx = dev_get_drvdata(dev);
b73d1230 ID	273	int ret;
b73d1230 ID	274
b73d1230 ID	275	ret = kstrtoint(buf, 0, &ctx->connected);
	276	if (ret)
	277	return ret;
	278
	279	if (ctx->connected > 1)
	280	return -EINVAL;
	281
d07d39df ID	282	/* use fake edid data for test. */
	283	if (!ctx->raw_edid)
	284	ctx->raw_edid = (struct edid *)fake_edid_info;
	285
d7b8478a ID	286	/* if raw_edid isn't same as fake data then it can't be tested. */
	287	if (ctx->raw_edid != (struct edid *)fake_edid_info) {
	288	DRM_DEBUG_KMS("edid data is not fake data.\n");
	289	return -EINVAL;
	290	}
	291
b73d1230 ID	292	DRM_DEBUG_KMS("requested connection.\n");
b73d1230 ID	293
080be03d	294	drm_helper_hpd_irq_event(ctx->drm_dev);
b73d1230 ID	295
	296	return len;
	297	}
	298
	299	static DEVICE_ATTR(connection, 0644, vidi_show_connection,
	300	vidi_store_connection);
	301
	302	int vidi_connection_ioctl(struct drm_device drm_dev, void data,
	303	struct drm_file *file_priv)
	304	{
	305	struct vidi_context *ctx = NULL;
	306	struct drm_encoder *encoder;
080be03d	307	struct exynos_drm_display *display;
b73d1230 ID	308	struct drm_exynos_vidi_connection *vidi = data;
b73d1230 ID	309
b73d1230 ID	310	if (!vidi) {
	311	DRM_DEBUG_KMS("user data for vidi is null.\n");
	312	return -EINVAL;
	313	}
	314
b73d1230 ID	315	if (vidi->connection > 1) {
	316	DRM_DEBUG_KMS("connection should be 0 or 1.\n");
	317	return -EINVAL;
	318	}
	319
	320	list_for_each_entry(encoder, &drm_dev->mode_config.encoder_list,
	321	head) {
080be03d	322	display = exynos_drm_get_display(encoder);
b73d1230	323
080be03d	324	if (display->type == EXYNOS_DISPLAY_TYPE_VIDI) {
2f26bd72	325	ctx = display_to_vidi(display);
b73d1230 ID	326	break;
	327	}
	328	}
	329
	330	if (!ctx) {
	331	DRM_DEBUG_KMS("not found virtual device type encoder.\n");
	332	return -EINVAL;
	333	}
	334
	335	if (ctx->connected == vidi->connection) {
	336	DRM_DEBUG_KMS("same connection request.\n");
	337	return -EINVAL;
	338	}
	339
d3b62dbf	340	if (vidi->connection) {
e7808df1 SWK	341	struct edid raw_edid = (struct edid )(uint32_t)vidi->edid;
	342	if (!drm_edid_is_valid(raw_edid)) {
	343	DRM_DEBUG_KMS("edid data is invalid.\n");
d3b62dbf ID	344	return -EINVAL;
d3b62dbf ID	345	}
4ddc773b	346	ctx->raw_edid = drm_edid_duplicate(raw_edid);
d3b62dbf ID	347	if (!ctx->raw_edid) {
	348	DRM_DEBUG_KMS("failed to allocate raw_edid.\n");
	349	return -ENOMEM;
	350	}
d3b62dbf ID	351	} else {
	352	/*
	353	* with connection = 0, free raw_edid
	354	* only if raw edid data isn't same as fake data.
	355	*/
	356	if (ctx->raw_edid && ctx->raw_edid !=
	357	(struct edid *)fake_edid_info) {
	358	kfree(ctx->raw_edid);
	359	ctx->raw_edid = NULL;
	360	}
	361	}
b73d1230 ID	362
b73d1230 ID	363	ctx->connected = vidi->connection;
080be03d	364	drm_helper_hpd_irq_event(ctx->drm_dev);
b73d1230 ID	365
	366	return 0;
	367	}
	368
ce6cb556 SP	369	static enum drm_connector_status vidi_detect(struct drm_connector *connector,
	370	bool force)
	371	{
	372	struct vidi_context *ctx = ctx_from_connector(connector);
	373
	374	/*
	375	* connection request would come from user side
	376	* to do hotplug through specific ioctl.
	377	*/
	378	return ctx->connected ? connector_status_connected :
	379	connector_status_disconnected;
	380	}
	381
	382	static void vidi_connector_destroy(struct drm_connector *connector)
	383	{
	384	}
	385
	386	static struct drm_connector_funcs vidi_connector_funcs = {
	387	.dpms = drm_helper_connector_dpms,
	388	.fill_modes = drm_helper_probe_single_connector_modes,
	389	.detect = vidi_detect,
	390	.destroy = vidi_connector_destroy,
	391	};
	392
	393	static int vidi_get_modes(struct drm_connector *connector)
	394	{
	395	struct vidi_context *ctx = ctx_from_connector(connector);
	396	struct edid *edid;
	397	int edid_len;
	398
	399	/*
	400	* the edid data comes from user side and it would be set
	401	* to ctx->raw_edid through specific ioctl.
	402	*/
	403	if (!ctx->raw_edid) {
	404	DRM_DEBUG_KMS("raw_edid is null.\n");
	405	return -EFAULT;
	406	}
	407
	408	edid_len = (1 + ctx->raw_edid->extensions) * EDID_LENGTH;
	409	edid = kmemdup(ctx->raw_edid, edid_len, GFP_KERNEL);
	410	if (!edid) {
	411	DRM_DEBUG_KMS("failed to allocate edid\n");
	412	return -ENOMEM;
	413	}
	414
	415	drm_mode_connector_update_edid_property(connector, edid);
	416
	417	return drm_add_edid_modes(connector, edid);
	418	}
	419
ce6cb556 SP	420	static struct drm_encoder vidi_best_encoder(struct drm_connector connector)
	421	{
	422	struct vidi_context *ctx = ctx_from_connector(connector);
	423
	424	return ctx->encoder;
	425	}
	426
	427	static struct drm_connector_helper_funcs vidi_connector_helper_funcs = {
	428	.get_modes = vidi_get_modes,
ce6cb556 SP	429	.best_encoder = vidi_best_encoder,
	430	};
	431
	432	static int vidi_create_connector(struct exynos_drm_display *display,
	433	struct drm_encoder *encoder)
	434	{
2f26bd72	435	struct vidi_context *ctx = display_to_vidi(display);
ce6cb556 SP	436	struct drm_connector *connector = &ctx->connector;
	437	int ret;
	438
	439	ctx->encoder = encoder;
	440	connector->polled = DRM_CONNECTOR_POLL_HPD;
	441
	442	ret = drm_connector_init(ctx->drm_dev, connector,
	443	&vidi_connector_funcs, DRM_MODE_CONNECTOR_VIRTUAL);
	444	if (ret) {
	445	DRM_ERROR("Failed to initialize connector with drm\n");
	446	return ret;
	447	}
	448
	449	drm_connector_helper_add(connector, &vidi_connector_helper_funcs);
34ea3d38	450	drm_connector_register(connector);
ce6cb556 SP	451	drm_mode_connector_attach_encoder(connector, encoder);
	452
	453	return 0;
	454	}
	455
	456
	457	static struct exynos_drm_display_ops vidi_display_ops = {
	458	.create_connector = vidi_create_connector,
	459	};
	460
1d50aa9c	461	static int vidi_bind(struct device dev, struct device master, void *data)
f37cd5e8	462	{
f01833cd	463	struct vidi_context *ctx = dev_get_drvdata(dev);
1d50aa9c	464	struct drm_device *drm_dev = data;
7ee14cdc GP	465	struct exynos_drm_plane *exynos_plane;
7ee14cdc GP	466	enum drm_plane_type type;
6e2a3b66 GP	467	unsigned int zpos;
6e2a3b66 GP	468	int ret;
f37cd5e8	469
0f04cf8d JS	470	vidi_ctx_initialize(ctx, drm_dev);
0f04cf8d JS	471
7ee14cdc GP	472	for (zpos = 0; zpos < WINDOWS_NR; zpos++) {
	473	type = (zpos == ctx->default_win) ? DRM_PLANE_TYPE_PRIMARY :
	474	DRM_PLANE_TYPE_OVERLAY;
	475	ret = exynos_plane_init(drm_dev, &ctx->planes[zpos],
6e2a3b66	476	1 << ctx->pipe, type, zpos);
7ee14cdc GP	477	if (ret)
	478	return ret;
	479	}
	480
	481	exynos_plane = &ctx->planes[ctx->default_win];
	482	ctx->crtc = exynos_drm_crtc_create(drm_dev, &exynos_plane->base,
	483	ctx->pipe, EXYNOS_DISPLAY_TYPE_VIDI,
93bca243 GP	484	&vidi_crtc_ops, ctx);
93bca243 GP	485	if (IS_ERR(ctx->crtc)) {
f37cd5e8	486	DRM_ERROR("failed to create crtc.\n");
93bca243	487	return PTR_ERR(ctx->crtc);
f37cd5e8 ID	488	}
f37cd5e8 ID	489
7340426a	490	ret = exynos_drm_create_enc_conn(drm_dev, &ctx->display);
f37cd5e8	491	if (ret) {
93bca243	492	ctx->crtc->base.funcs->destroy(&ctx->crtc->base);
f37cd5e8 ID	493	return ret;
	494	}
	495
	496	return 0;
	497	}
	498
1d50aa9c ID	499
	500	static void vidi_unbind(struct device dev, struct device master, void *data)
	501	{
	502	}
	503
	504	static const struct component_ops vidi_component_ops = {
	505	.bind = vidi_bind,
	506	.unbind = vidi_unbind,
	507	};
	508
56550d94	509	static int vidi_probe(struct platform_device *pdev)
b73d1230	510	{
b73d1230	511	struct vidi_context *ctx;
b73d1230 ID	512	int ret;
b73d1230 ID	513
f37cd5e8	514	ctx = devm_kzalloc(&pdev->dev, sizeof(*ctx), GFP_KERNEL);
b73d1230 ID	515	if (!ctx)
	516	return -ENOMEM;
	517
7340426a AH	518	ctx->display.type = EXYNOS_DISPLAY_TYPE_VIDI;
7340426a AH	519	ctx->display.ops = &vidi_display_ops;
b73d1230	520	ctx->default_win = 0;
1d50aa9c ID	521	ctx->pdev = pdev;
	522
	523	ret = exynos_drm_component_add(&pdev->dev, EXYNOS_DEVICE_TYPE_CRTC,
5d1741ad	524	EXYNOS_DISPLAY_TYPE_VIDI);
1d50aa9c ID	525	if (ret)
	526	return ret;
	527
	528	ret = exynos_drm_component_add(&pdev->dev, EXYNOS_DEVICE_TYPE_CONNECTOR,
	529	ctx->display.type);
	530	if (ret)
	531	goto err_del_crtc_component;
b73d1230 ID	532
	533	INIT_WORK(&ctx->work, vidi_fake_vblank_handler);
	534
b73d1230 ID	535	mutex_init(&ctx->lock);
b73d1230 ID	536
f01833cd	537	platform_set_drvdata(pdev, ctx);
b73d1230	538
f37cd5e8 ID	539	ret = device_create_file(&pdev->dev, &dev_attr_connection);
f37cd5e8 ID	540	if (ret < 0) {
1d50aa9c ID	541	DRM_ERROR("failed to create connection sysfs.\n");
1d50aa9c ID	542	goto err_del_conn_component;
f37cd5e8	543	}
b73d1230	544
1d50aa9c ID	545	ret = component_add(&pdev->dev, &vidi_component_ops);
	546	if (ret)
	547	goto err_remove_file;
	548
	549	return ret;
	550
	551	err_remove_file:
	552	device_remove_file(&pdev->dev, &dev_attr_connection);
	553	err_del_conn_component:
	554	exynos_drm_component_del(&pdev->dev, EXYNOS_DEVICE_TYPE_CONNECTOR);
	555	err_del_crtc_component:
	556	exynos_drm_component_del(&pdev->dev, EXYNOS_DEVICE_TYPE_CRTC);
	557
	558	return ret;
b73d1230 ID	559	}
b73d1230 ID	560
56550d94	561	static int vidi_remove(struct platform_device *pdev)
b73d1230	562	{
f01833cd	563	struct vidi_context *ctx = platform_get_drvdata(pdev);
b73d1230	564
d3b62dbf ID	565	if (ctx->raw_edid != (struct edid *)fake_edid_info) {
	566	kfree(ctx->raw_edid);
	567	ctx->raw_edid = NULL;
f37cd5e8 ID	568
f37cd5e8 ID	569	return -EINVAL;
d3b62dbf ID	570	}
d3b62dbf ID	571
1d50aa9c ID	572	component_del(&pdev->dev, &vidi_component_ops);
	573	exynos_drm_component_del(&pdev->dev, EXYNOS_DEVICE_TYPE_CONNECTOR);
	574	exynos_drm_component_del(&pdev->dev, EXYNOS_DEVICE_TYPE_CRTC);
	575
b73d1230 ID	576	return 0;
	577	}
	578
b73d1230 ID	579	struct platform_driver vidi_driver = {
b73d1230 ID	580	.probe = vidi_probe,
56550d94	581	.remove = vidi_remove,
b73d1230 ID	582	.driver = {
	583	.name = "exynos-drm-vidi",
	584	.owner = THIS_MODULE,
b73d1230 ID	585	},
b73d1230 ID	586	};
f37cd5e8 ID	587
	588	int exynos_drm_probe_vidi(void)
	589	{
	590	struct platform_device *pdev;
	591	int ret;
	592
	593	pdev = platform_device_register_simple("exynos-drm-vidi", -1, NULL, 0);
	594	if (IS_ERR(pdev))
	595	return PTR_ERR(pdev);
	596
	597	ret = platform_driver_register(&vidi_driver);
	598	if (ret) {
	599	platform_device_unregister(pdev);
	600	return ret;
	601	}
	602
	603	return ret;
	604	}
	605
f01833cd AH	606	static int exynos_drm_remove_vidi_device(struct device dev, void data)
	607	{
	608	platform_device_unregister(to_platform_device(dev));
	609
	610	return 0;
	611	}
	612
f37cd5e8 ID	613	void exynos_drm_remove_vidi(void)
f37cd5e8 ID	614	{
f01833cd AH	615	int ret = driver_for_each_device(&vidi_driver.driver, NULL, NULL,
	616	exynos_drm_remove_vidi_device);
	617	/* silence compiler warning */
	618	(void)ret;
f37cd5e8 ID	619
f37cd5e8 ID	620	platform_driver_unregister(&vidi_driver);
f37cd5e8	621	}