[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 (!res[0] || !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, res[n], irq, variant);
		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)
{
	armada_drm_driver.num_ioctls = ARRAY_SIZE(armada_ioctls);
	return platform_driver_register(&armada_drm_platform_driver);
}
module_init(armada_drm_init);

static void __exit armada_drm_exit(void)
{
	platform_driver_unregister(&armada_drm_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
	118	if (!res[0] \|\| !mem)
	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
42e62ba7	171	ret = armada_drm_crtc_create(dev, res[n], irq, variant);
96f60e37 RK	172	if (ret)
	173	goto err_kms;
	174	}
	175
0101fd00 RK	176	if (is_componentized(dev->dev)) {
	177	ret = component_bind_all(dev->dev, dev);
	178	if (ret)
	179	goto err_kms;
	180	} else {
585b691e	181	#ifdef CONFIG_DRM_ARMADA_TDA1998X
0101fd00 RK	182	ret = armada_drm_connector_slave_create(dev, &tda19988_config);
	183	if (ret)
	184	goto err_kms;
585b691e	185	#endif
0101fd00	186	}
585b691e	187
d0165407	188	ret = drm_vblank_init(dev, dev->mode_config.num_crtc);
96f60e37	189	if (ret)
0101fd00	190	goto err_comp;
96f60e37	191
96f60e37 RK	192	dev->vblank_disable_allowed = 1;
	193
	194	ret = armada_fbdev_init(dev);
	195	if (ret)
0101fd00	196	goto err_comp;
96f60e37 RK	197
	198	drm_kms_helper_poll_init(dev);
	199
	200	return 0;
	201
0101fd00 RK	202	err_comp:
	203	if (is_componentized(dev->dev))
	204	component_unbind_all(dev->dev, dev);
96f60e37 RK	205	err_kms:
	206	drm_mode_config_cleanup(dev);
	207	drm_mm_takedown(&priv->linear);
	208	flush_work(&priv->fb_unref_work);
	209
	210	return ret;
	211	}
	212
	213	static int armada_drm_unload(struct drm_device *dev)
	214	{
	215	struct armada_private *priv = dev->dev_private;
	216
	217	drm_kms_helper_poll_fini(dev);
	218	armada_fbdev_fini(dev);
0101fd00 RK	219
	220	if (is_componentized(dev->dev))
	221	component_unbind_all(dev->dev, dev);
	222
96f60e37 RK	223	drm_mode_config_cleanup(dev);
	224	drm_mm_takedown(&priv->linear);
	225	flush_work(&priv->fb_unref_work);
	226	dev->dev_private = NULL;
	227
	228	return 0;
	229	}
	230
	231	void armada_drm_vbl_event_add(struct armada_crtc *dcrtc,
	232	struct armada_vbl_event *evt)
	233	{
	234	unsigned long flags;
	235
	236	spin_lock_irqsave(&dcrtc->irq_lock, flags);
	237	if (list_empty(&evt->node)) {
	238	list_add_tail(&evt->node, &dcrtc->vbl_list);
	239
	240	drm_vblank_get(dcrtc->crtc.dev, dcrtc->num);
	241	}
	242	spin_unlock_irqrestore(&dcrtc->irq_lock, flags);
	243	}
	244
	245	void armada_drm_vbl_event_remove(struct armada_crtc *dcrtc,
	246	struct armada_vbl_event *evt)
	247	{
	248	if (!list_empty(&evt->node)) {
	249	list_del_init(&evt->node);
	250	drm_vblank_put(dcrtc->crtc.dev, dcrtc->num);
	251	}
	252	}
	253
	254	void armada_drm_vbl_event_remove_unlocked(struct armada_crtc *dcrtc,
	255	struct armada_vbl_event *evt)
	256	{
	257	unsigned long flags;
	258
	259	spin_lock_irqsave(&dcrtc->irq_lock, flags);
	260	armada_drm_vbl_event_remove(dcrtc, evt);
	261	spin_unlock_irqrestore(&dcrtc->irq_lock, flags);
	262	}
	263
	264	/* These are called under the vbl_lock. */
	265	static int armada_drm_enable_vblank(struct drm_device *dev, int crtc)
	266	{
	267	struct armada_private *priv = dev->dev_private;
	268	armada_drm_crtc_enable_irq(priv->dcrtc[crtc], VSYNC_IRQ_ENA);
	269	return 0;
	270	}
	271
	272	static void armada_drm_disable_vblank(struct drm_device *dev, int crtc)
	273	{
	274	struct armada_private *priv = dev->dev_private;
	275	armada_drm_crtc_disable_irq(priv->dcrtc[crtc], VSYNC_IRQ_ENA);
	276	}
	277
96f60e37 RK	278	static struct drm_ioctl_desc armada_ioctls[] = {
	279	DRM_IOCTL_DEF_DRV(ARMADA_GEM_CREATE, armada_gem_create_ioctl,
	280	DRM_UNLOCKED),
	281	DRM_IOCTL_DEF_DRV(ARMADA_GEM_MMAP, armada_gem_mmap_ioctl,
	282	DRM_UNLOCKED),
	283	DRM_IOCTL_DEF_DRV(ARMADA_GEM_PWRITE, armada_gem_pwrite_ioctl,
	284	DRM_UNLOCKED),
	285	};
	286
2f5ae490 RK	287	static void armada_drm_lastclose(struct drm_device *dev)
	288	{
	289	armada_fbdev_lastclose(dev);
	290	}
	291
96f60e37 RK	292	static const struct file_operations armada_drm_fops = {
	293	.owner = THIS_MODULE,
	294	.llseek = no_llseek,
	295	.read = drm_read,
	296	.poll = drm_poll,
	297	.unlocked_ioctl = drm_ioctl,
	298	.mmap = drm_gem_mmap,
	299	.open = drm_open,
	300	.release = drm_release,
	301	};
	302
	303	static struct drm_driver armada_drm_driver = {
	304	.load = armada_drm_load,
	305	.open = NULL,
	306	.preclose = NULL,
	307	.postclose = NULL,
2f5ae490	308	.lastclose = armada_drm_lastclose,
96f60e37 RK	309	.unload = armada_drm_unload,
	310	.get_vblank_counter = drm_vblank_count,
	311	.enable_vblank = armada_drm_enable_vblank,
	312	.disable_vblank = armada_drm_disable_vblank,
96f60e37 RK	313	#ifdef CONFIG_DEBUG_FS
	314	.debugfs_init = armada_drm_debugfs_init,
	315	.debugfs_cleanup = armada_drm_debugfs_cleanup,
	316	#endif
96f60e37 RK	317	.gem_free_object = armada_gem_free_object,
	318	.prime_handle_to_fd = drm_gem_prime_handle_to_fd,
	319	.prime_fd_to_handle = drm_gem_prime_fd_to_handle,
	320	.gem_prime_export = armada_gem_prime_export,
	321	.gem_prime_import = armada_gem_prime_import,
	322	.dumb_create = armada_gem_dumb_create,
	323	.dumb_map_offset = armada_gem_dumb_map_offset,
	324	.dumb_destroy = armada_gem_dumb_destroy,
	325	.gem_vm_ops = &armada_gem_vm_ops,
	326	.major = 1,
	327	.minor = 0,
	328	.name = "armada-drm",
	329	.desc = "Armada SoC DRM",
	330	.date = "20120730",
	331	.driver_features = DRIVER_GEM \| DRIVER_MODESET \|
e5d9ddfb	332	DRIVER_PRIME,
96f60e37 RK	333	.ioctls = armada_ioctls,
	334	.fops = &armada_drm_fops,
	335	};
	336
0101fd00 RK	337	static int armada_drm_bind(struct device *dev)
	338	{
	339	return drm_platform_init(&armada_drm_driver, to_platform_device(dev));
	340	}
	341
	342	static void armada_drm_unbind(struct device *dev)
	343	{
	344	drm_put_dev(dev_get_drvdata(dev));
	345	}
	346
	347	static int compare_of(struct device dev, void data)
	348	{
	349	return dev->of_node == data;
	350	}
	351
	352	static int compare_dev_name(struct device dev, void data)
	353	{
	354	const char *name = data;
	355	return !strcmp(dev_name(dev), name);
	356	}
	357
	358	static void armada_add_endpoints(struct device *dev,
	359	struct component_match *match, struct device_node port)
	360	{
	361	struct device_node ep, remote;
	362
	363	for_each_child_of_node(port, ep) {
	364	remote = of_graph_get_remote_port_parent(ep);
	365	if (!remote \|\| !of_device_is_available(remote)) {
	366	of_node_put(remote);
	367	continue;
	368	} else if (!of_device_is_available(remote->parent)) {
	369	dev_warn(dev, "parent device of %s is not available\n",
	370	remote->full_name);
	371	of_node_put(remote);
	372	continue;
	373	}
	374
	375	component_match_add(dev, match, compare_of, remote);
	376	of_node_put(remote);
	377	}
	378	}
	379
	380	static int armada_drm_find_components(struct device *dev,
	381	struct component_match **match)
	382	{
	383	struct device_node *port;
	384	int i;
	385
	386	if (dev->of_node) {
	387	struct device_node *np = dev->of_node;
	388
	389	for (i = 0; ; i++) {
	390	port = of_parse_phandle(np, "ports", i);
	391	if (!port)
	392	break;
	393
	394	component_match_add(dev, match, compare_of, port);
	395	of_node_put(port);
	396	}
	397
	398	if (i == 0) {
	399	dev_err(dev, "missing 'ports' property\n");
	400	return -ENODEV;
401	}
402
403	for (i = 0; ; i++) {
404	port = of_parse_phandle(np, "ports", i);
405	if (!port)
406	break;
407
408	armada_add_endpoints(dev, match, port);
409	of_node_put(port);
410	}
411	} else if (dev->platform_data) {
412	char **devices = dev->platform_data;
413	struct device *d;
414
415	for (i = 0; devices[i]; i++)
416	component_match_add(dev, match, compare_dev_name,
417	devices[i]);
418
419	if (i == 0) {
420	dev_err(dev, "missing 'ports' property\n");
421	return -ENODEV;
422	}
423
424	for (i = 0; devices[i]; i++) {
425	d = bus_find_device_by_name(&platform_bus_type, NULL,
426	devices[i]);
427	if (d && d->of_node) {
428	for_each_child_of_node(d->of_node, port)
429	armada_add_endpoints(dev, match, port);
430	}
431	put_device(d);
432	}
433	}
434
435	return 0;
436	}
437
438	static const struct component_master_ops armada_master_ops = {
439	.bind = armada_drm_bind,
440	.unbind = armada_drm_unbind,
441	};
442
96f60e37 RK	443	static int armada_drm_probe(struct platform_device *pdev)
96f60e37 RK	444	{
0101fd00 RK	445	if (is_componentized(&pdev->dev)) {
	446	struct component_match *match = NULL;
	447	int ret;
	448
	449	ret = armada_drm_find_components(&pdev->dev, &match);
	450	if (ret < 0)
	451	return ret;
	452
	453	return component_master_add_with_match(&pdev->dev,
	454	&armada_master_ops, match);
	455	} else {
	456	return drm_platform_init(&armada_drm_driver, pdev);
	457	}
96f60e37 RK	458	}
	459
	460	static int armada_drm_remove(struct platform_device *pdev)
	461	{
0101fd00 RK	462	if (is_componentized(&pdev->dev))
	463	component_master_del(&pdev->dev, &armada_master_ops);
	464	else
	465	drm_put_dev(platform_get_drvdata(pdev));
96f60e37 RK	466	return 0;
	467	}
	468
	469	static const struct platform_device_id armada_drm_platform_ids[] = {
	470	{
	471	.name = "armada-drm",
	472	.driver_data = (unsigned long)&armada510_ops,
	473	}, {
	474	.name = "armada-510-drm",
	475	.driver_data = (unsigned long)&armada510_ops,
	476	},
	477	{ },
	478	};
	479	MODULE_DEVICE_TABLE(platform, armada_drm_platform_ids);
	480
	481	static struct platform_driver armada_drm_platform_driver = {
	482	.probe = armada_drm_probe,
	483	.remove = armada_drm_remove,
	484	.driver = {
	485	.name = "armada-drm",
	486	.owner = THIS_MODULE,
	487	},
	488	.id_table = armada_drm_platform_ids,
	489	};
	490
	491	static int __init armada_drm_init(void)
	492	{
f95aeb17	493	armada_drm_driver.num_ioctls = ARRAY_SIZE(armada_ioctls);
96f60e37 RK	494	return platform_driver_register(&armada_drm_platform_driver);
	495	}
	496	module_init(armada_drm_init);
	497
	498	static void __exit armada_drm_exit(void)
	499	{
	500	platform_driver_unregister(&armada_drm_platform_driver);
	501	}
	502	module_exit(armada_drm_exit);
	503
	504	MODULE_AUTHOR("Russell King <rmk+kernel@arm.linux.org.uk>");
	505	MODULE_DESCRIPTION("Armada DRM Driver");
	506	MODULE_LICENSE("GPL");
	507	MODULE_ALIAS("platform:armada-drm");