[deliverable/linux.git] / drivers / gpu / drm / armada / armada_drv.c

/*
 * Copyright (C) 2012 Russell King
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License version 2 as
 * published by the Free Software Foundation.
 */
#include <linux/clk.h>
#include <linux/component.h>
#include <linux/module.h>
#include <linux/of_graph.h>
#include <drm/drmP.h>
#include <drm/drm_crtc_helper.h>
#include "armada_crtc.h"
#include "armada_drm.h"
#include "armada_gem.h"
#include "armada_hw.h"
#include <drm/armada_drm.h>
#include "armada_ioctlP.h"

#ifdef CONFIG_DRM_ARMADA_TDA1998X
#include <drm/i2c/tda998x.h>
#include "armada_slave.h"

static struct tda998x_encoder_params params = {
	/* With 0x24, there is no translation between vp_out and int_vp
	FB	LCD out	Pins	VIP	Int Vp
	R:23:16	R:7:0	VPC7:0	7:0	7:0[R]
	G:15:8	G:15:8	VPB7:0	23:16	23:16[G]
	B:7:0	B:23:16	VPA7:0	15:8	15:8[B]
	*/
	.swap_a = 2,
	.swap_b = 3,
	.swap_c = 4,
	.swap_d = 5,
	.swap_e = 0,
	.swap_f = 1,
	.audio_cfg = BIT(2),
	.audio_frame[1] = 1,
	.audio_format = AFMT_SPDIF,
	.audio_sample_rate = 44100,
};

static const struct armada_drm_slave_config tda19988_config = {
	.i2c_adapter_id = 0,
	.crtcs = 1 << 0, /* Only LCD0 at the moment */
	.polled = DRM_CONNECTOR_POLL_CONNECT | DRM_CONNECTOR_POLL_DISCONNECT,
	.interlace_allowed = true,
	.info = {
		.type = "tda998x",
		.addr = 0x70,
		.platform_data = &params,
	},
};
#endif

static bool is_componentized(struct device *dev)
{
	return dev->of_node || dev->platform_data;
}

static void armada_drm_unref_work(struct work_struct *work)
{
	struct armada_private *priv =
		container_of(work, struct armada_private, fb_unref_work);
	struct drm_framebuffer *fb;

	while (kfifo_get(&priv->fb_unref, &fb))
		drm_framebuffer_unreference(fb);
}

/* Must be called with dev->event_lock held */
void __armada_drm_queue_unref_work(struct drm_device *dev,
	struct drm_framebuffer *fb)
{
	struct armada_private *priv = dev->dev_private;

	WARN_ON(!kfifo_put(&priv->fb_unref, fb));
	schedule_work(&priv->fb_unref_work);
}

void armada_drm_queue_unref_work(struct drm_device *dev,
	struct drm_framebuffer *fb)
{
	unsigned long flags;

	spin_lock_irqsave(&dev->event_lock, flags);
	__armada_drm_queue_unref_work(dev, fb);
	spin_unlock_irqrestore(&dev->event_lock, flags);
}

static int armada_drm_load(struct drm_device *dev, unsigned long flags)
{
	const struct platform_device_id *id;
	const struct armada_variant *variant;
	struct armada_private *priv;
	struct resource *res[ARRAY_SIZE(priv->dcrtc)];
	struct resource *mem = NULL;
	int ret, n, i;

	memset(res, 0, sizeof(res));

	for (n = i = 0; ; n++) {
		struct resource *r = platform_get_resource(dev->platformdev,
							   IORESOURCE_MEM, n);
		if (!r)
			break;

		/* Resources above 64K are graphics memory */
		if (resource_size(r) > SZ_64K)
			mem = r;
		else if (i < ARRAY_SIZE(priv->dcrtc))
			res[i++] = r;
		else
			return -EINVAL;
	}

	if (!mem)
		return -ENXIO;

	if (!devm_request_mem_region(dev->dev, mem->start,
			resource_size(mem), "armada-drm"))
		return -EBUSY;

	priv = devm_kzalloc(dev->dev, sizeof(*priv), GFP_KERNEL);
	if (!priv) {
		DRM_ERROR("failed to allocate private\n");
		return -ENOMEM;
	}

	platform_set_drvdata(dev->platformdev, dev);
	dev->dev_private = priv;

	/* Get the implementation specific driver data. */
	id = platform_get_device_id(dev->platformdev);
	if (!id)
		return -ENXIO;

	variant = (const struct armada_variant *)id->driver_data;

	INIT_WORK(&priv->fb_unref_work, armada_drm_unref_work);
	INIT_KFIFO(priv->fb_unref);

	/* Mode setting support */
	drm_mode_config_init(dev);
	dev->mode_config.min_width = 320;
	dev->mode_config.min_height = 200;

	/*
	 * With vscale enabled, the maximum width is 1920 due to the
	 * 1920 by 3 lines RAM
	 */
	dev->mode_config.max_width = 1920;
	dev->mode_config.max_height = 2048;

	dev->mode_config.preferred_depth = 24;
	dev->mode_config.funcs = &armada_drm_mode_config_funcs;
	drm_mm_init(&priv->linear, mem->start, resource_size(mem));

	/* Create all LCD controllers */
	for (n = 0; n < ARRAY_SIZE(priv->dcrtc); n++) {
		int irq;

		if (!res[n])
			break;

		irq = platform_get_irq(dev->platformdev, n);
		if (irq < 0)
			goto err_kms;

		ret = armada_drm_crtc_create(dev, dev->dev, res[n], irq,
					     variant, NULL);
		if (ret)
			goto err_kms;
	}

	if (is_componentized(dev->dev)) {
		ret = component_bind_all(dev->dev, dev);
		if (ret)
			goto err_kms;
	} else {
#ifdef CONFIG_DRM_ARMADA_TDA1998X
		ret = armada_drm_connector_slave_create(dev, &tda19988_config);
		if (ret)
			goto err_kms;
#endif
	}

	ret = drm_vblank_init(dev, dev->mode_config.num_crtc);
	if (ret)
		goto err_comp;

	dev->vblank_disable_allowed = 1;

	ret = armada_fbdev_init(dev);
	if (ret)
		goto err_comp;

	drm_kms_helper_poll_init(dev);

	return 0;

 err_comp:
	if (is_componentized(dev->dev))
		component_unbind_all(dev->dev, dev);
 err_kms:
	drm_mode_config_cleanup(dev);
	drm_mm_takedown(&priv->linear);
	flush_work(&priv->fb_unref_work);

	return ret;
}

static int armada_drm_unload(struct drm_device *dev)
{
	struct armada_private *priv = dev->dev_private;

	drm_kms_helper_poll_fini(dev);
	armada_fbdev_fini(dev);

	if (is_componentized(dev->dev))
		component_unbind_all(dev->dev, dev);

	drm_mode_config_cleanup(dev);
	drm_mm_takedown(&priv->linear);
	flush_work(&priv->fb_unref_work);
	dev->dev_private = NULL;

	return 0;
}

void armada_drm_vbl_event_add(struct armada_crtc *dcrtc,
	struct armada_vbl_event *evt)
{
	unsigned long flags;

	spin_lock_irqsave(&dcrtc->irq_lock, flags);
	if (list_empty(&evt->node)) {
		list_add_tail(&evt->node, &dcrtc->vbl_list);

		drm_vblank_get(dcrtc->crtc.dev, dcrtc->num);
	}
	spin_unlock_irqrestore(&dcrtc->irq_lock, flags);
}

void armada_drm_vbl_event_remove(struct armada_crtc *dcrtc,
	struct armada_vbl_event *evt)
{
	if (!list_empty(&evt->node)) {
		list_del_init(&evt->node);
		drm_vblank_put(dcrtc->crtc.dev, dcrtc->num);
	}
}

void armada_drm_vbl_event_remove_unlocked(struct armada_crtc *dcrtc,
	struct armada_vbl_event *evt)
{
	unsigned long flags;

	spin_lock_irqsave(&dcrtc->irq_lock, flags);
	armada_drm_vbl_event_remove(dcrtc, evt);
	spin_unlock_irqrestore(&dcrtc->irq_lock, flags);
}

/* These are called under the vbl_lock. */
static int armada_drm_enable_vblank(struct drm_device *dev, int crtc)
{
	struct armada_private *priv = dev->dev_private;
	armada_drm_crtc_enable_irq(priv->dcrtc[crtc], VSYNC_IRQ_ENA);
	return 0;
}

static void armada_drm_disable_vblank(struct drm_device *dev, int crtc)
{
	struct armada_private *priv = dev->dev_private;
	armada_drm_crtc_disable_irq(priv->dcrtc[crtc], VSYNC_IRQ_ENA);
}

static struct drm_ioctl_desc armada_ioctls[] = {
	DRM_IOCTL_DEF_DRV(ARMADA_GEM_CREATE, armada_gem_create_ioctl,
		DRM_UNLOCKED),
	DRM_IOCTL_DEF_DRV(ARMADA_GEM_MMAP, armada_gem_mmap_ioctl,
		DRM_UNLOCKED),
	DRM_IOCTL_DEF_DRV(ARMADA_GEM_PWRITE, armada_gem_pwrite_ioctl,
		DRM_UNLOCKED),
};

static void armada_drm_lastclose(struct drm_device *dev)
{
	armada_fbdev_lastclose(dev);
}

static const struct file_operations armada_drm_fops = {
	.owner			= THIS_MODULE,
	.llseek			= no_llseek,
	.read			= drm_read,
	.poll			= drm_poll,
	.unlocked_ioctl		= drm_ioctl,
	.mmap			= drm_gem_mmap,
	.open			= drm_open,
	.release		= drm_release,
};

static struct drm_driver armada_drm_driver = {
	.load			= armada_drm_load,
	.open			= NULL,
	.preclose		= NULL,
	.postclose		= NULL,
	.lastclose		= armada_drm_lastclose,
	.unload			= armada_drm_unload,
	.get_vblank_counter	= drm_vblank_count,
	.enable_vblank		= armada_drm_enable_vblank,
	.disable_vblank		= armada_drm_disable_vblank,
#ifdef CONFIG_DEBUG_FS
	.debugfs_init		= armada_drm_debugfs_init,
	.debugfs_cleanup	= armada_drm_debugfs_cleanup,
#endif
	.gem_free_object	= armada_gem_free_object,
	.prime_handle_to_fd	= drm_gem_prime_handle_to_fd,
	.prime_fd_to_handle	= drm_gem_prime_fd_to_handle,
	.gem_prime_export	= armada_gem_prime_export,
	.gem_prime_import	= armada_gem_prime_import,
	.dumb_create		= armada_gem_dumb_create,
	.dumb_map_offset	= armada_gem_dumb_map_offset,
	.dumb_destroy		= armada_gem_dumb_destroy,
	.gem_vm_ops		= &armada_gem_vm_ops,
	.major			= 1,
	.minor			= 0,
	.name			= "armada-drm",
	.desc			= "Armada SoC DRM",
	.date			= "20120730",
	.driver_features	= DRIVER_GEM | DRIVER_MODESET |
				  DRIVER_PRIME,
	.ioctls			= armada_ioctls,
	.fops			= &armada_drm_fops,
};

static int armada_drm_bind(struct device *dev)
{
	return drm_platform_init(&armada_drm_driver, to_platform_device(dev));
}

static void armada_drm_unbind(struct device *dev)
{
	drm_put_dev(dev_get_drvdata(dev));
}

static int compare_of(struct device *dev, void *data)
{
	return dev->of_node == data;
}

static int compare_dev_name(struct device *dev, void *data)
{
	const char *name = data;
	return !strcmp(dev_name(dev), name);
}

static void armada_add_endpoints(struct device *dev,
	struct component_match **match, struct device_node *port)
{
	struct device_node *ep, *remote;

	for_each_child_of_node(port, ep) {
		remote = of_graph_get_remote_port_parent(ep);
		if (!remote || !of_device_is_available(remote)) {
			of_node_put(remote);
			continue;
		} else if (!of_device_is_available(remote->parent)) {
			dev_warn(dev, "parent device of %s is not available\n",
				 remote->full_name);
			of_node_put(remote);
			continue;
		}

		component_match_add(dev, match, compare_of, remote);
		of_node_put(remote);
	}
}

static int armada_drm_find_components(struct device *dev,
	struct component_match **match)
{
	struct device_node *port;
	int i;

	if (dev->of_node) {
		struct device_node *np = dev->of_node;

		for (i = 0; ; i++) {
			port = of_parse_phandle(np, "ports", i);
			if (!port)
				break;

			component_match_add(dev, match, compare_of, port);
			of_node_put(port);
		}

		if (i == 0) {
			dev_err(dev, "missing 'ports' property\n");
			return -ENODEV;
		}

		for (i = 0; ; i++) {
			port = of_parse_phandle(np, "ports", i);
			if (!port)
				break;

			armada_add_endpoints(dev, match, port);
			of_node_put(port);
		}
	} else if (dev->platform_data) {
		char **devices = dev->platform_data;
		struct device *d;

		for (i = 0; devices[i]; i++)
			component_match_add(dev, match, compare_dev_name,
					    devices[i]);

		if (i == 0) {
			dev_err(dev, "missing 'ports' property\n");
			return -ENODEV;
		}

		for (i = 0; devices[i]; i++) {
			d = bus_find_device_by_name(&platform_bus_type, NULL,
					devices[i]);
			if (d && d->of_node) {
				for_each_child_of_node(d->of_node, port)
					armada_add_endpoints(dev, match, port);
			}
			put_device(d);
		}
	}

	return 0;
}

static const struct component_master_ops armada_master_ops = {
	.bind = armada_drm_bind,
	.unbind = armada_drm_unbind,
};

static int armada_drm_probe(struct platform_device *pdev)
{
	if (is_componentized(&pdev->dev)) {
		struct component_match *match = NULL;
		int ret;

		ret = armada_drm_find_components(&pdev->dev, &match);
		if (ret < 0)
			return ret;

		return component_master_add_with_match(&pdev->dev,
				&armada_master_ops, match);
	} else {
		return drm_platform_init(&armada_drm_driver, pdev);
	}
}

static int armada_drm_remove(struct platform_device *pdev)
{
	if (is_componentized(&pdev->dev))
		component_master_del(&pdev->dev, &armada_master_ops);
	else
		drm_put_dev(platform_get_drvdata(pdev));
	return 0;
}

static const struct platform_device_id armada_drm_platform_ids[] = {
	{
		.name		= "armada-drm",
		.driver_data	= (unsigned long)&armada510_ops,
	}, {
		.name		= "armada-510-drm",
		.driver_data	= (unsigned long)&armada510_ops,
	},
	{ },
};
MODULE_DEVICE_TABLE(platform, armada_drm_platform_ids);

static struct platform_driver armada_drm_platform_driver = {
	.probe	= armada_drm_probe,
	.remove	= armada_drm_remove,
	.driver	= {
		.name	= "armada-drm",
		.owner	= THIS_MODULE,
	},
	.id_table = armada_drm_platform_ids,
};

static int __init armada_drm_init(void)
{
	int ret;

	armada_drm_driver.num_ioctls = ARRAY_SIZE(armada_ioctls);

	ret = platform_driver_register(&armada_lcd_platform_driver);
	if (ret)
		return ret;
	ret = platform_driver_register(&armada_drm_platform_driver);
	if (ret)
		platform_driver_unregister(&armada_lcd_platform_driver);
	return ret;
}
module_init(armada_drm_init);

static void __exit armada_drm_exit(void)
{
	platform_driver_unregister(&armada_drm_platform_driver);
	platform_driver_unregister(&armada_lcd_platform_driver);
}
module_exit(armada_drm_exit);

MODULE_AUTHOR("Russell King <rmk+kernel@arm.linux.org.uk>");
MODULE_DESCRIPTION("Armada DRM Driver");
MODULE_LICENSE("GPL");
MODULE_ALIAS("platform:armada-drm");
Commit	Line	Data
96f60e37 RK	1	/*
	2	* Copyright (C) 2012 Russell King
	3	*
	4	* This program is free software; you can redistribute it and/or modify
	5	* it under the terms of the GNU General Public License version 2 as
	6	* published by the Free Software Foundation.
	7	*/
	8	#include <linux/clk.h>
0101fd00	9	#include <linux/component.h>
96f60e37	10	#include <linux/module.h>
0101fd00	11	#include <linux/of_graph.h>
96f60e37 RK	12	#include <drm/drmP.h>
	13	#include <drm/drm_crtc_helper.h>
	14	#include "armada_crtc.h"
	15	#include "armada_drm.h"
	16	#include "armada_gem.h"
	17	#include "armada_hw.h"
	18	#include <drm/armada_drm.h>
	19	#include "armada_ioctlP.h"
	20
585b691e RK	21	#ifdef CONFIG_DRM_ARMADA_TDA1998X
	22	#include <drm/i2c/tda998x.h>
	23	#include "armada_slave.h"
	24
	25	static struct tda998x_encoder_params params = {
	26	/* With 0x24, there is no translation between vp_out and int_vp
	27	FB LCD out Pins VIP Int Vp
	28	R:23:16 R:7:0 VPC7:0 7:0 7:0[R]
	29	G:15:8 G:15:8 VPB7:0 23:16 23:16[G]
	30	B:7:0 B:23:16 VPA7:0 15:8 15:8[B]
	31	*/
	32	.swap_a = 2,
	33	.swap_b = 3,
	34	.swap_c = 4,
	35	.swap_d = 5,
	36	.swap_e = 0,
	37	.swap_f = 1,
	38	.audio_cfg = BIT(2),
	39	.audio_frame[1] = 1,
	40	.audio_format = AFMT_SPDIF,
	41	.audio_sample_rate = 44100,
	42	};
	43
	44	static const struct armada_drm_slave_config tda19988_config = {
	45	.i2c_adapter_id = 0,
	46	.crtcs = 1 << 0, /* Only LCD0 at the moment */
	47	.polled = DRM_CONNECTOR_POLL_CONNECT \| DRM_CONNECTOR_POLL_DISCONNECT,
	48	.interlace_allowed = true,
	49	.info = {
	50	.type = "tda998x",
	51	.addr = 0x70,
	52	.platform_data = &params,
	53	},
	54	};
	55	#endif
	56
0101fd00 RK	57	static bool is_componentized(struct device *dev)
	58	{
	59	return dev->of_node \|\| dev->platform_data;
	60	}
	61
96f60e37 RK	62	static void armada_drm_unref_work(struct work_struct *work)
	63	{
	64	struct armada_private *priv =
	65	container_of(work, struct armada_private, fb_unref_work);
	66	struct drm_framebuffer *fb;
	67
	68	while (kfifo_get(&priv->fb_unref, &fb))
	69	drm_framebuffer_unreference(fb);
	70	}
	71
	72	/* Must be called with dev->event_lock held */
	73	void __armada_drm_queue_unref_work(struct drm_device *dev,
	74	struct drm_framebuffer *fb)
	75	{
	76	struct armada_private *priv = dev->dev_private;
	77
d13c46c6	78	WARN_ON(!kfifo_put(&priv->fb_unref, fb));
96f60e37 RK	79	schedule_work(&priv->fb_unref_work);
	80	}
	81
	82	void armada_drm_queue_unref_work(struct drm_device *dev,
	83	struct drm_framebuffer *fb)
	84	{
	85	unsigned long flags;
	86
	87	spin_lock_irqsave(&dev->event_lock, flags);
	88	__armada_drm_queue_unref_work(dev, fb);
	89	spin_unlock_irqrestore(&dev->event_lock, flags);
	90	}
	91
	92	static int armada_drm_load(struct drm_device *dev, unsigned long flags)
	93	{
	94	const struct platform_device_id *id;
42e62ba7	95	const struct armada_variant *variant;
96f60e37 RK	96	struct armada_private *priv;
	97	struct resource *res[ARRAY_SIZE(priv->dcrtc)];
	98	struct resource *mem = NULL;
	99	int ret, n, i;
	100
	101	memset(res, 0, sizeof(res));
	102
	103	for (n = i = 0; ; n++) {
	104	struct resource *r = platform_get_resource(dev->platformdev,
	105	IORESOURCE_MEM, n);
	106	if (!r)
	107	break;
	108
	109	/* Resources above 64K are graphics memory */
	110	if (resource_size(r) > SZ_64K)
	111	mem = r;
	112	else if (i < ARRAY_SIZE(priv->dcrtc))
	113	res[i++] = r;
	114	else
	115	return -EINVAL;
	116	}
	117
d8c96083	118	if (!mem)
96f60e37 RK	119	return -ENXIO;
	120
	121	if (!devm_request_mem_region(dev->dev, mem->start,
	122	resource_size(mem), "armada-drm"))
	123	return -EBUSY;
	124
	125	priv = devm_kzalloc(dev->dev, sizeof(*priv), GFP_KERNEL);
	126	if (!priv) {
	127	DRM_ERROR("failed to allocate private\n");
	128	return -ENOMEM;
	129	}
	130
50fb3c3b	131	platform_set_drvdata(dev->platformdev, dev);
96f60e37 RK	132	dev->dev_private = priv;
	133
	134	/* Get the implementation specific driver data. */
	135	id = platform_get_device_id(dev->platformdev);
	136	if (!id)
	137	return -ENXIO;
	138
42e62ba7	139	variant = (const struct armada_variant *)id->driver_data;
96f60e37	140
96f60e37 RK	141	INIT_WORK(&priv->fb_unref_work, armada_drm_unref_work);
	142	INIT_KFIFO(priv->fb_unref);
	143
	144	/* Mode setting support */
	145	drm_mode_config_init(dev);
	146	dev->mode_config.min_width = 320;
	147	dev->mode_config.min_height = 200;
	148
	149	/*
	150	* With vscale enabled, the maximum width is 1920 due to the
	151	* 1920 by 3 lines RAM
	152	*/
	153	dev->mode_config.max_width = 1920;
	154	dev->mode_config.max_height = 2048;
	155
	156	dev->mode_config.preferred_depth = 24;
	157	dev->mode_config.funcs = &armada_drm_mode_config_funcs;
	158	drm_mm_init(&priv->linear, mem->start, resource_size(mem));
	159
	160	/* Create all LCD controllers */
	161	for (n = 0; n < ARRAY_SIZE(priv->dcrtc); n++) {
e5d9ddfb RK	162	int irq;
e5d9ddfb RK	163
96f60e37 RK	164	if (!res[n])
	165	break;
	166
e5d9ddfb RK	167	irq = platform_get_irq(dev->platformdev, n);
	168	if (irq < 0)
	169	goto err_kms;
	170
d8c96083	171	ret = armada_drm_crtc_create(dev, dev->dev, res[n], irq,
9611cb93	172	variant, NULL);
96f60e37 RK	173	if (ret)
	174	goto err_kms;
	175	}
	176
0101fd00 RK	177	if (is_componentized(dev->dev)) {
	178	ret = component_bind_all(dev->dev, dev);
	179	if (ret)
	180	goto err_kms;
	181	} else {
585b691e	182	#ifdef CONFIG_DRM_ARMADA_TDA1998X
0101fd00 RK	183	ret = armada_drm_connector_slave_create(dev, &tda19988_config);
	184	if (ret)
	185	goto err_kms;
585b691e	186	#endif
0101fd00	187	}
585b691e	188
d0165407	189	ret = drm_vblank_init(dev, dev->mode_config.num_crtc);
96f60e37	190	if (ret)
0101fd00	191	goto err_comp;
96f60e37	192
96f60e37 RK	193	dev->vblank_disable_allowed = 1;
	194
	195	ret = armada_fbdev_init(dev);
	196	if (ret)
0101fd00	197	goto err_comp;
96f60e37 RK	198
	199	drm_kms_helper_poll_init(dev);
	200
	201	return 0;
	202
0101fd00 RK	203	err_comp:
	204	if (is_componentized(dev->dev))
	205	component_unbind_all(dev->dev, dev);
96f60e37 RK	206	err_kms:
	207	drm_mode_config_cleanup(dev);
	208	drm_mm_takedown(&priv->linear);
	209	flush_work(&priv->fb_unref_work);
	210
	211	return ret;
	212	}
	213
	214	static int armada_drm_unload(struct drm_device *dev)
	215	{
	216	struct armada_private *priv = dev->dev_private;
	217
	218	drm_kms_helper_poll_fini(dev);
	219	armada_fbdev_fini(dev);
0101fd00 RK	220
	221	if (is_componentized(dev->dev))
	222	component_unbind_all(dev->dev, dev);
	223
96f60e37 RK	224	drm_mode_config_cleanup(dev);
	225	drm_mm_takedown(&priv->linear);
	226	flush_work(&priv->fb_unref_work);
	227	dev->dev_private = NULL;
	228
	229	return 0;
	230	}
	231
	232	void armada_drm_vbl_event_add(struct armada_crtc *dcrtc,
	233	struct armada_vbl_event *evt)
	234	{
	235	unsigned long flags;
	236
	237	spin_lock_irqsave(&dcrtc->irq_lock, flags);
	238	if (list_empty(&evt->node)) {
	239	list_add_tail(&evt->node, &dcrtc->vbl_list);
	240
	241	drm_vblank_get(dcrtc->crtc.dev, dcrtc->num);
	242	}
	243	spin_unlock_irqrestore(&dcrtc->irq_lock, flags);
	244	}
	245
	246	void armada_drm_vbl_event_remove(struct armada_crtc *dcrtc,
	247	struct armada_vbl_event *evt)
	248	{
	249	if (!list_empty(&evt->node)) {
	250	list_del_init(&evt->node);
	251	drm_vblank_put(dcrtc->crtc.dev, dcrtc->num);
	252	}
	253	}
	254
	255	void armada_drm_vbl_event_remove_unlocked(struct armada_crtc *dcrtc,
	256	struct armada_vbl_event *evt)
	257	{
	258	unsigned long flags;
	259
	260	spin_lock_irqsave(&dcrtc->irq_lock, flags);
	261	armada_drm_vbl_event_remove(dcrtc, evt);
	262	spin_unlock_irqrestore(&dcrtc->irq_lock, flags);
	263	}
	264
	265	/* These are called under the vbl_lock. */
	266	static int armada_drm_enable_vblank(struct drm_device *dev, int crtc)
	267	{
	268	struct armada_private *priv = dev->dev_private;
	269	armada_drm_crtc_enable_irq(priv->dcrtc[crtc], VSYNC_IRQ_ENA);
	270	return 0;
	271	}
	272
	273	static void armada_drm_disable_vblank(struct drm_device *dev, int crtc)
	274	{
	275	struct armada_private *priv = dev->dev_private;
	276	armada_drm_crtc_disable_irq(priv->dcrtc[crtc], VSYNC_IRQ_ENA);
	277	}
	278
96f60e37 RK	279	static struct drm_ioctl_desc armada_ioctls[] = {
	280	DRM_IOCTL_DEF_DRV(ARMADA_GEM_CREATE, armada_gem_create_ioctl,
	281	DRM_UNLOCKED),
	282	DRM_IOCTL_DEF_DRV(ARMADA_GEM_MMAP, armada_gem_mmap_ioctl,
	283	DRM_UNLOCKED),
	284	DRM_IOCTL_DEF_DRV(ARMADA_GEM_PWRITE, armada_gem_pwrite_ioctl,
	285	DRM_UNLOCKED),
	286	};
	287
2f5ae490 RK	288	static void armada_drm_lastclose(struct drm_device *dev)
	289	{
	290	armada_fbdev_lastclose(dev);
	291	}
	292
96f60e37 RK	293	static const struct file_operations armada_drm_fops = {
	294	.owner = THIS_MODULE,
	295	.llseek = no_llseek,
	296	.read = drm_read,
	297	.poll = drm_poll,
	298	.unlocked_ioctl = drm_ioctl,
	299	.mmap = drm_gem_mmap,
	300	.open = drm_open,
	301	.release = drm_release,
	302	};
	303
	304	static struct drm_driver armada_drm_driver = {
	305	.load = armada_drm_load,
	306	.open = NULL,
	307	.preclose = NULL,
	308	.postclose = NULL,
2f5ae490	309	.lastclose = armada_drm_lastclose,
96f60e37 RK	310	.unload = armada_drm_unload,
	311	.get_vblank_counter = drm_vblank_count,
	312	.enable_vblank = armada_drm_enable_vblank,
	313	.disable_vblank = armada_drm_disable_vblank,
96f60e37 RK	314	#ifdef CONFIG_DEBUG_FS
	315	.debugfs_init = armada_drm_debugfs_init,
	316	.debugfs_cleanup = armada_drm_debugfs_cleanup,
	317	#endif
96f60e37 RK	318	.gem_free_object = armada_gem_free_object,
	319	.prime_handle_to_fd = drm_gem_prime_handle_to_fd,
	320	.prime_fd_to_handle = drm_gem_prime_fd_to_handle,
	321	.gem_prime_export = armada_gem_prime_export,
	322	.gem_prime_import = armada_gem_prime_import,
	323	.dumb_create = armada_gem_dumb_create,
	324	.dumb_map_offset = armada_gem_dumb_map_offset,
	325	.dumb_destroy = armada_gem_dumb_destroy,
	326	.gem_vm_ops = &armada_gem_vm_ops,
	327	.major = 1,
	328	.minor = 0,
	329	.name = "armada-drm",
	330	.desc = "Armada SoC DRM",
	331	.date = "20120730",
	332	.driver_features = DRIVER_GEM \| DRIVER_MODESET \|
e5d9ddfb	333	DRIVER_PRIME,
96f60e37 RK	334	.ioctls = armada_ioctls,
	335	.fops = &armada_drm_fops,
	336	};
	337
0101fd00 RK	338	static int armada_drm_bind(struct device *dev)
	339	{
	340	return drm_platform_init(&armada_drm_driver, to_platform_device(dev));
	341	}
	342
	343	static void armada_drm_unbind(struct device *dev)
	344	{
	345	drm_put_dev(dev_get_drvdata(dev));
	346	}
	347
	348	static int compare_of(struct device dev, void data)
	349	{
	350	return dev->of_node == data;
	351	}
	352
	353	static int compare_dev_name(struct device dev, void data)
	354	{
	355	const char *name = data;
	356	return !strcmp(dev_name(dev), name);
	357	}
	358
	359	static void armada_add_endpoints(struct device *dev,
	360	struct component_match *match, struct device_node port)
	361	{
	362	struct device_node ep, remote;
	363
	364	for_each_child_of_node(port, ep) {
	365	remote = of_graph_get_remote_port_parent(ep);
	366	if (!remote \|\| !of_device_is_available(remote)) {
	367	of_node_put(remote);
	368	continue;
	369	} else if (!of_device_is_available(remote->parent)) {
	370	dev_warn(dev, "parent device of %s is not available\n",
	371	remote->full_name);
	372	of_node_put(remote);
	373	continue;
	374	}
	375
	376	component_match_add(dev, match, compare_of, remote);
	377	of_node_put(remote);
	378	}
	379	}
	380
	381	static int armada_drm_find_components(struct device *dev,
	382	struct component_match **match)
	383	{
	384	struct device_node *port;
	385	int i;
	386
	387	if (dev->of_node) {
	388	struct device_node *np = dev->of_node;
	389
	390	for (i = 0; ; i++) {
	391	port = of_parse_phandle(np, "ports", i);
	392	if (!port)
	393	break;
	394
	395	component_match_add(dev, match, compare_of, port);
	396	of_node_put(port);
	397	}
	398
	399	if (i == 0) {
	400	dev_err(dev, "missing 'ports' property\n");
	401	return -ENODEV;
402	}
403
404	for (i = 0; ; i++) {
405	port = of_parse_phandle(np, "ports", i);
406	if (!port)
407	break;
408
409	armada_add_endpoints(dev, match, port);
410	of_node_put(port);
411	}
412	} else if (dev->platform_data) {
413	char **devices = dev->platform_data;
414	struct device *d;
415
416	for (i = 0; devices[i]; i++)
417	component_match_add(dev, match, compare_dev_name,
418	devices[i]);
419
420	if (i == 0) {
421	dev_err(dev, "missing 'ports' property\n");
422	return -ENODEV;
423	}
424
425	for (i = 0; devices[i]; i++) {
426	d = bus_find_device_by_name(&platform_bus_type, NULL,
427	devices[i]);
428	if (d && d->of_node) {
429	for_each_child_of_node(d->of_node, port)
430	armada_add_endpoints(dev, match, port);
431	}
432	put_device(d);
433	}
434	}
435
436	return 0;
437	}
438
439	static const struct component_master_ops armada_master_ops = {
440	.bind = armada_drm_bind,
441	.unbind = armada_drm_unbind,
442	};
443
96f60e37 RK	444	static int armada_drm_probe(struct platform_device *pdev)
96f60e37 RK	445	{
0101fd00 RK	446	if (is_componentized(&pdev->dev)) {
	447	struct component_match *match = NULL;
	448	int ret;
	449
	450	ret = armada_drm_find_components(&pdev->dev, &match);
	451	if (ret < 0)
	452	return ret;
	453
	454	return component_master_add_with_match(&pdev->dev,
	455	&armada_master_ops, match);
	456	} else {
	457	return drm_platform_init(&armada_drm_driver, pdev);
	458	}
96f60e37 RK	459	}
	460
	461	static int armada_drm_remove(struct platform_device *pdev)
	462	{
0101fd00 RK	463	if (is_componentized(&pdev->dev))
	464	component_master_del(&pdev->dev, &armada_master_ops);
	465	else
	466	drm_put_dev(platform_get_drvdata(pdev));
96f60e37 RK	467	return 0;
	468	}
	469
	470	static const struct platform_device_id armada_drm_platform_ids[] = {
	471	{
	472	.name = "armada-drm",
	473	.driver_data = (unsigned long)&armada510_ops,
	474	}, {
	475	.name = "armada-510-drm",
	476	.driver_data = (unsigned long)&armada510_ops,
	477	},
	478	{ },
	479	};
	480	MODULE_DEVICE_TABLE(platform, armada_drm_platform_ids);
	481
	482	static struct platform_driver armada_drm_platform_driver = {
	483	.probe = armada_drm_probe,
	484	.remove = armada_drm_remove,
	485	.driver = {
	486	.name = "armada-drm",
	487	.owner = THIS_MODULE,
	488	},
	489	.id_table = armada_drm_platform_ids,
	490	};
	491
	492	static int __init armada_drm_init(void)
	493	{
d8c96083 RK	494	int ret;
d8c96083 RK	495
f95aeb17	496	armada_drm_driver.num_ioctls = ARRAY_SIZE(armada_ioctls);
d8c96083 RK	497
	498	ret = platform_driver_register(&armada_lcd_platform_driver);
	499	if (ret)
	500	return ret;
	501	ret = platform_driver_register(&armada_drm_platform_driver);
	502	if (ret)
	503	platform_driver_unregister(&armada_lcd_platform_driver);
	504	return ret;
96f60e37 RK	505	}
	506	module_init(armada_drm_init);
	507
	508	static void __exit armada_drm_exit(void)
	509	{
	510	platform_driver_unregister(&armada_drm_platform_driver);
d8c96083	511	platform_driver_unregister(&armada_lcd_platform_driver);
96f60e37 RK	512	}
	513	module_exit(armada_drm_exit);
	514
	515	MODULE_AUTHOR("Russell King <rmk+kernel@arm.linux.org.uk>");
	516	MODULE_DESCRIPTION("Armada DRM Driver");
	517	MODULE_LICENSE("GPL");
	518	MODULE_ALIAS("platform:armada-drm");