[mirror_ubuntu-eoan-kernel.git] / drivers / gpu / drm / armada / armada_drv.c

// SPDX-License-Identifier: GPL-2.0-only
/*
 * Copyright (C) 2012 Russell King
 */
#include <linux/clk.h>
#include <linux/component.h>
#include <linux/module.h>
#include <linux/of_graph.h>
#include <drm/drm_atomic_helper.h>
#include <drm/drm_probe_helper.h>
#include <drm/drm_fb_helper.h>
#include <drm/drm_of.h>
#include "armada_crtc.h"
#include "armada_drm.h"
#include "armada_gem.h"
#include "armada_fb.h"
#include "armada_hw.h"
#include <drm/armada_drm.h>
#include "armada_ioctlP.h"

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

DEFINE_DRM_GEM_FOPS(armada_drm_fops);

static struct drm_driver armada_drm_driver = {
	.lastclose		= drm_fb_helper_lastclose,
	.gem_free_object_unlocked = 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,
	.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 | DRIVER_ATOMIC,
	.ioctls			= armada_ioctls,
	.fops			= &armada_drm_fops,
};

static const struct drm_mode_config_funcs armada_drm_mode_config_funcs = {
	.fb_create		= armada_fb_create,
	.output_poll_changed	= drm_fb_helper_output_poll_changed,
	.atomic_check		= drm_atomic_helper_check,
	.atomic_commit		= drm_atomic_helper_commit,
};

static int armada_drm_bind(struct device *dev)
{
	struct armada_private *priv;
	struct resource *mem = NULL;
	int ret, n;

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

		/* Resources above 64K are graphics memory */
		if (resource_size(r) > SZ_64K)
			mem = r;
		else
			return -EINVAL;
	}

	if (!mem)
		return -ENXIO;

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

	priv = kzalloc(sizeof(*priv), GFP_KERNEL);
	if (!priv)
		return -ENOMEM;

	/*
	 * The drm_device structure must be at the start of
	 * armada_private for drm_dev_put() to work correctly.
	 */
	BUILD_BUG_ON(offsetof(struct armada_private, drm) != 0);

	ret = drm_dev_init(&priv->drm, &armada_drm_driver, dev);
	if (ret) {
		dev_err(dev, "[" DRM_NAME ":%s] drm_dev_init failed: %d\n",
			__func__, ret);
		kfree(priv);
		return ret;
	}

	/* Remove early framebuffers */
	ret = drm_fb_helper_remove_conflicting_framebuffers(NULL,
							    "armada-drm-fb",
							    false);
	if (ret) {
		dev_err(dev, "[" DRM_NAME ":%s] can't kick out simple-fb: %d\n",
			__func__, ret);
		kfree(priv);
		return ret;
	}

	priv->drm.dev_private = priv;

	dev_set_drvdata(dev, &priv->drm);

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

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

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

	ret = component_bind_all(dev, &priv->drm);
	if (ret)
		goto err_kms;

	ret = drm_vblank_init(&priv->drm, priv->drm.mode_config.num_crtc);
	if (ret)
		goto err_comp;

	priv->drm.irq_enabled = true;

	drm_mode_config_reset(&priv->drm);

	ret = armada_fbdev_init(&priv->drm);
	if (ret)
		goto err_comp;

	drm_kms_helper_poll_init(&priv->drm);

	ret = drm_dev_register(&priv->drm, 0);
	if (ret)
		goto err_poll;

#ifdef CONFIG_DEBUG_FS
	armada_drm_debugfs_init(priv->drm.primary);
#endif

	return 0;

 err_poll:
	drm_kms_helper_poll_fini(&priv->drm);
	armada_fbdev_fini(&priv->drm);
 err_comp:
	component_unbind_all(dev, &priv->drm);
 err_kms:
	drm_mode_config_cleanup(&priv->drm);
	drm_mm_takedown(&priv->linear);
	drm_dev_put(&priv->drm);
	return ret;
}

static void armada_drm_unbind(struct device *dev)
{
	struct drm_device *drm = dev_get_drvdata(dev);
	struct armada_private *priv = drm->dev_private;

	drm_kms_helper_poll_fini(&priv->drm);
	armada_fbdev_fini(&priv->drm);

	drm_dev_unregister(&priv->drm);

	drm_atomic_helper_shutdown(&priv->drm);

	component_unbind_all(dev, &priv->drm);

	drm_mode_config_cleanup(&priv->drm);
	drm_mm_takedown(&priv->linear);

	drm_dev_put(&priv->drm);
}

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 *dev_node)
{
	struct device_node *ep, *remote;

	for_each_endpoint_of_node(dev_node, ep) {
		remote = of_graph_get_remote_port_parent(ep);
		if (remote && of_device_is_available(remote))
			drm_of_component_match_add(dev, match, compare_of,
						   remote);
		of_node_put(remote);
	}
}

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)
{
	struct component_match *match = NULL;
	struct device *dev = &pdev->dev;
	int ret;

	ret = drm_of_component_probe(dev, compare_dev_name, &armada_master_ops);
	if (ret != -EINVAL)
		return ret;

	if (dev->platform_data) {
		char **devices = dev->platform_data;
		struct device *d;
		int i;

		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)
				armada_add_endpoints(dev, &match, d->of_node);
			put_device(d);
		}
	}

	return component_master_add_with_match(&pdev->dev, &armada_master_ops,
					       match);
}

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

static const struct platform_device_id armada_drm_platform_ids[] = {
	{
		.name		= "armada-drm",
	}, {
		.name		= "armada-510-drm",
	},
	{ },
};
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",
	},
	.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
d2912cb1	1	// SPDX-License-Identifier: GPL-2.0-only
96f60e37 RK	2	/*
96f60e37 RK	3	* Copyright (C) 2012 Russell King
96f60e37 RK	4	*/
96f60e37 RK	5	#include <linux/clk.h>
0101fd00	6	#include <linux/component.h>
96f60e37	7	#include <linux/module.h>
0101fd00	8	#include <linux/of_graph.h>
6bd02908	9	#include <drm/drm_atomic_helper.h>
fcd70cd3	10	#include <drm/drm_probe_helper.h>
df139288	11	#include <drm/drm_fb_helper.h>
7fc7e86d	12	#include <drm/drm_of.h>
96f60e37 RK	13	#include "armada_crtc.h"
	14	#include "armada_drm.h"
	15	#include "armada_gem.h"
3382a6b9	16	#include "armada_fb.h"
96f60e37 RK	17	#include "armada_hw.h"
	18	#include <drm/armada_drm.h>
	19	#include "armada_ioctlP.h"
	20
96f60e37	21	static struct drm_ioctl_desc armada_ioctls[] = {
f8c47144 DV	22	DRM_IOCTL_DEF_DRV(ARMADA_GEM_CREATE, armada_gem_create_ioctl,0),
	23	DRM_IOCTL_DEF_DRV(ARMADA_GEM_MMAP, armada_gem_mmap_ioctl, 0),
	24	DRM_IOCTL_DEF_DRV(ARMADA_GEM_PWRITE, armada_gem_pwrite_ioctl, 0),
96f60e37 RK	25	};
96f60e37 RK	26
f42e1819	27	DEFINE_DRM_GEM_FOPS(armada_drm_fops);
96f60e37 RK	28
96f60e37 RK	29	static struct drm_driver armada_drm_driver = {
df139288	30	.lastclose = drm_fb_helper_lastclose,
87adc638	31	.gem_free_object_unlocked = armada_gem_free_object,
96f60e37 RK	32	.prime_handle_to_fd = drm_gem_prime_handle_to_fd,
	33	.prime_fd_to_handle = drm_gem_prime_fd_to_handle,
	34	.gem_prime_export = armada_gem_prime_export,
	35	.gem_prime_import = armada_gem_prime_import,
	36	.dumb_create = armada_gem_dumb_create,
96f60e37 RK	37	.gem_vm_ops = &armada_gem_vm_ops,
	38	.major = 1,
	39	.minor = 0,
	40	.name = "armada-drm",
	41	.desc = "Armada SoC DRM",
	42	.date = "20120730",
	43	.driver_features = DRIVER_GEM \| DRIVER_MODESET \|
6bd02908	44	DRIVER_PRIME \| DRIVER_ATOMIC,
96f60e37 RK	45	.ioctls = armada_ioctls,
	46	.fops = &armada_drm_fops,
	47	};
	48
3382a6b9 RK	49	static const struct drm_mode_config_funcs armada_drm_mode_config_funcs = {
	50	.fb_create = armada_fb_create,
	51	.output_poll_changed = drm_fb_helper_output_poll_changed,
6bd02908 RK	52	.atomic_check = drm_atomic_helper_check,
6bd02908 RK	53	.atomic_commit = drm_atomic_helper_commit,
3382a6b9 RK	54	};
3382a6b9 RK	55
0101fd00 RK	56	static int armada_drm_bind(struct device *dev)
0101fd00 RK	57	{
917a3cbe RK	58	struct armada_private *priv;
	59	struct resource *mem = NULL;
	60	int ret, n;
	61
	62	for (n = 0; ; n++) {
	63	struct resource *r = platform_get_resource(to_platform_device(dev),
	64	IORESOURCE_MEM, n);
	65	if (!r)
	66	break;
	67
	68	/* Resources above 64K are graphics memory */
	69	if (resource_size(r) > SZ_64K)
	70	mem = r;
	71	else
	72	return -EINVAL;
	73	}
	74
	75	if (!mem)
	76	return -ENXIO;
	77
	78	if (!devm_request_mem_region(dev, mem->start, resource_size(mem),
	79	"armada-drm"))
	80	return -EBUSY;
	81
	82	priv = kzalloc(sizeof(*priv), GFP_KERNEL);
	83	if (!priv)
	84	return -ENOMEM;
	85
	86	/*
	87	* The drm_device structure must be at the start of
830aadce	88	* armada_private for drm_dev_put() to work correctly.
917a3cbe RK	89	*/
	90	BUILD_BUG_ON(offsetof(struct armada_private, drm) != 0);
	91
	92	ret = drm_dev_init(&priv->drm, &armada_drm_driver, dev);
	93	if (ret) {
	94	dev_err(dev, "[" DRM_NAME ":%s] drm_dev_init failed: %d\n",
	95	__func__, ret);
	96	kfree(priv);
	97	return ret;
	98	}
	99
f54a5990 LR	100	/* Remove early framebuffers */
	101	ret = drm_fb_helper_remove_conflicting_framebuffers(NULL,
	102	"armada-drm-fb",
	103	false);
	104	if (ret) {
	105	dev_err(dev, "[" DRM_NAME ":%s] can't kick out simple-fb: %d\n",
	106	__func__, ret);
	107	kfree(priv);
	108	return ret;
	109	}
	110
917a3cbe RK	111	priv->drm.dev_private = priv;
917a3cbe RK	112
76adb460	113	dev_set_drvdata(dev, &priv->drm);
917a3cbe	114
917a3cbe RK	115	/* Mode setting support */
	116	drm_mode_config_init(&priv->drm);
	117	priv->drm.mode_config.min_width = 320;
	118	priv->drm.mode_config.min_height = 200;
	119
	120	/*
	121	* With vscale enabled, the maximum width is 1920 due to the
	122	* 1920 by 3 lines RAM
	123	*/
	124	priv->drm.mode_config.max_width = 1920;
	125	priv->drm.mode_config.max_height = 2048;
	126
	127	priv->drm.mode_config.preferred_depth = 24;
	128	priv->drm.mode_config.funcs = &armada_drm_mode_config_funcs;
	129	drm_mm_init(&priv->linear, mem->start, resource_size(mem));
	130	mutex_init(&priv->linear_lock);
	131
	132	ret = component_bind_all(dev, &priv->drm);
	133	if (ret)
	134	goto err_kms;
	135
	136	ret = drm_vblank_init(&priv->drm, priv->drm.mode_config.num_crtc);
	137	if (ret)
	138	goto err_comp;
	139
	140	priv->drm.irq_enabled = true;
	141
80c63aee RK	142	drm_mode_config_reset(&priv->drm);
80c63aee RK	143
917a3cbe RK	144	ret = armada_fbdev_init(&priv->drm);
	145	if (ret)
	146	goto err_comp;
	147
	148	drm_kms_helper_poll_init(&priv->drm);
	149
	150	ret = drm_dev_register(&priv->drm, 0);
	151	if (ret)
	152	goto err_poll;
	153
	154	#ifdef CONFIG_DEBUG_FS
	155	armada_drm_debugfs_init(priv->drm.primary);
	156	#endif
	157
917a3cbe RK	158	return 0;
	159
	160	err_poll:
	161	drm_kms_helper_poll_fini(&priv->drm);
	162	armada_fbdev_fini(&priv->drm);
	163	err_comp:
	164	component_unbind_all(dev, &priv->drm);
	165	err_kms:
	166	drm_mode_config_cleanup(&priv->drm);
	167	drm_mm_takedown(&priv->linear);
830aadce	168	drm_dev_put(&priv->drm);
917a3cbe	169	return ret;
0101fd00 RK	170	}
	171
	172	static void armada_drm_unbind(struct device *dev)
	173	{
917a3cbe RK	174	struct drm_device *drm = dev_get_drvdata(dev);
	175	struct armada_private *priv = drm->dev_private;
	176
	177	drm_kms_helper_poll_fini(&priv->drm);
	178	armada_fbdev_fini(&priv->drm);
	179
917a3cbe RK	180	drm_dev_unregister(&priv->drm);
917a3cbe RK	181
0ab17499 RK	182	drm_atomic_helper_shutdown(&priv->drm);
0ab17499 RK	183
917a3cbe RK	184	component_unbind_all(dev, &priv->drm);
	185
	186	drm_mode_config_cleanup(&priv->drm);
	187	drm_mm_takedown(&priv->linear);
917a3cbe	188
830aadce	189	drm_dev_put(&priv->drm);
0101fd00 RK	190	}
	191
	192	static int compare_of(struct device dev, void data)
	193	{
	194	return dev->of_node == data;
	195	}
	196
	197	static int compare_dev_name(struct device dev, void data)
	198	{
	199	const char *name = data;
	200	return !strcmp(dev_name(dev), name);
	201	}
	202
	203	static void armada_add_endpoints(struct device *dev,
989b9a7d	204	struct component_match *match, struct device_node dev_node)
0101fd00 RK	205	{
	206	struct device_node ep, remote;
	207
989b9a7d	208	for_each_endpoint_of_node(dev_node, ep) {
0101fd00	209	remote = of_graph_get_remote_port_parent(ep);
837567c1 RK	210	if (remote && of_device_is_available(remote))
	211	drm_of_component_match_add(dev, match, compare_of,
	212	remote);
0101fd00 RK	213	of_node_put(remote);
	214	}
	215	}
	216
7fc7e86d LD	217	static const struct component_master_ops armada_master_ops = {
	218	.bind = armada_drm_bind,
	219	.unbind = armada_drm_unbind,
	220	};
0101fd00	221
7fc7e86d LD	222	static int armada_drm_probe(struct platform_device *pdev)
	223	{
	224	struct component_match *match = NULL;
	225	struct device *dev = &pdev->dev;
	226	int ret;
0101fd00	227
7fc7e86d LD	228	ret = drm_of_component_probe(dev, compare_dev_name, &armada_master_ops);
	229	if (ret != -EINVAL)
	230	return ret;
0101fd00	231
7fc7e86d	232	if (dev->platform_data) {
0101fd00 RK	233	char **devices = dev->platform_data;
0101fd00 RK	234	struct device *d;
7fc7e86d	235	int i;
0101fd00 RK	236
0101fd00 RK	237	for (i = 0; devices[i]; i++)
7fc7e86d	238	component_match_add(dev, &match, compare_dev_name,
0101fd00 RK	239	devices[i]);
	240
	241	if (i == 0) {
	242	dev_err(dev, "missing 'ports' property\n");
	243	return -ENODEV;
	244	}
	245
	246	for (i = 0; devices[i]; i++) {
	247	d = bus_find_device_by_name(&platform_bus_type, NULL,
7fc7e86d	248	devices[i]);
989b9a7d RK	249	if (d && d->of_node)
989b9a7d RK	250	armada_add_endpoints(dev, &match, d->of_node);
0101fd00 RK	251	put_device(d);
	252	}
	253	}
	254
0fb2970b RK	255	return component_master_add_with_match(&pdev->dev, &armada_master_ops,
0fb2970b RK	256	match);
96f60e37 RK	257	}
	258
	259	static int armada_drm_remove(struct platform_device *pdev)
	260	{
0fb2970b	261	component_master_del(&pdev->dev, &armada_master_ops);
96f60e37 RK	262	return 0;
	263	}
	264
	265	static const struct platform_device_id armada_drm_platform_ids[] = {
	266	{
	267	.name = "armada-drm",
96f60e37 RK	268	}, {
96f60e37 RK	269	.name = "armada-510-drm",
96f60e37 RK	270	},
	271	{ },
	272	};
	273	MODULE_DEVICE_TABLE(platform, armada_drm_platform_ids);
	274
	275	static struct platform_driver armada_drm_platform_driver = {
	276	.probe = armada_drm_probe,
	277	.remove = armada_drm_remove,
	278	.driver = {
	279	.name = "armada-drm",
96f60e37 RK	280	},
	281	.id_table = armada_drm_platform_ids,
	282	};
	283
	284	static int __init armada_drm_init(void)
	285	{
d8c96083 RK	286	int ret;
d8c96083 RK	287
f95aeb17	288	armada_drm_driver.num_ioctls = ARRAY_SIZE(armada_ioctls);
d8c96083 RK	289
	290	ret = platform_driver_register(&armada_lcd_platform_driver);
	291	if (ret)
	292	return ret;
	293	ret = platform_driver_register(&armada_drm_platform_driver);
	294	if (ret)
	295	platform_driver_unregister(&armada_lcd_platform_driver);
	296	return ret;
96f60e37 RK	297	}
	298	module_init(armada_drm_init);
	299
	300	static void __exit armada_drm_exit(void)
	301	{
	302	platform_driver_unregister(&armada_drm_platform_driver);
d8c96083	303	platform_driver_unregister(&armada_lcd_platform_driver);
96f60e37 RK	304	}
	305	module_exit(armada_drm_exit);
	306
	307	MODULE_AUTHOR("Russell King <rmk+kernel@arm.linux.org.uk>");
	308	MODULE_DESCRIPTION("Armada DRM Driver");
	309	MODULE_LICENSE("GPL");
	310	MODULE_ALIAS("platform:armada-drm");