[deliverable/linux.git] / drivers / gpu / drm / rockchip / rockchip_drm_drv.c

/*
 * Copyright (C) Fuzhou Rockchip Electronics Co.Ltd
 * Author:Mark Yao <mark.yao@rock-chips.com>
 *
 * based on exynos_drm_drv.c
 *
 * This software is licensed under the terms of the GNU General Public
 * License version 2, as published by the Free Software Foundation, and
 * may be copied, distributed, and modified under those terms.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 */

#include <asm/dma-iommu.h>

#include <drm/drmP.h>
#include <drm/drm_crtc_helper.h>
#include <drm/drm_fb_helper.h>
#include <linux/dma-mapping.h>
#include <linux/pm_runtime.h>
#include <linux/module.h>
#include <linux/of_graph.h>
#include <linux/component.h>

#include "rockchip_drm_drv.h"
#include "rockchip_drm_fb.h"
#include "rockchip_drm_fbdev.h"
#include "rockchip_drm_gem.h"

#define DRIVER_NAME	"rockchip"
#define DRIVER_DESC	"RockChip Soc DRM"
#define DRIVER_DATE	"20140818"
#define DRIVER_MAJOR	1
#define DRIVER_MINOR	0

/*
 * Attach a (component) device to the shared drm dma mapping from master drm
 * device.  This is used by the VOPs to map GEM buffers to a common DMA
 * mapping.
 */
int rockchip_drm_dma_attach_device(struct drm_device *drm_dev,
				   struct device *dev)
{
	struct dma_iommu_mapping *mapping = drm_dev->dev->archdata.mapping;
	int ret;

	ret = dma_set_coherent_mask(dev, DMA_BIT_MASK(32));
	if (ret)
		return ret;

	dma_set_max_seg_size(dev, DMA_BIT_MASK(32));

	return arm_iommu_attach_device(dev, mapping);
}

void rockchip_drm_dma_detach_device(struct drm_device *drm_dev,
				    struct device *dev)
{
	arm_iommu_detach_device(dev);
}

int rockchip_register_crtc_funcs(struct drm_crtc *crtc,
				 const struct rockchip_crtc_funcs *crtc_funcs)
{
	int pipe = drm_crtc_index(crtc);
	struct rockchip_drm_private *priv = crtc->dev->dev_private;

	if (pipe > ROCKCHIP_MAX_CRTC)
		return -EINVAL;

	priv->crtc_funcs[pipe] = crtc_funcs;

	return 0;
}

void rockchip_unregister_crtc_funcs(struct drm_crtc *crtc)
{
	int pipe = drm_crtc_index(crtc);
	struct rockchip_drm_private *priv = crtc->dev->dev_private;

	if (pipe > ROCKCHIP_MAX_CRTC)
		return;

	priv->crtc_funcs[pipe] = NULL;
}

static struct drm_crtc *rockchip_crtc_from_pipe(struct drm_device *drm,
						int pipe)
{
	struct drm_crtc *crtc;
	int i = 0;

	list_for_each_entry(crtc, &drm->mode_config.crtc_list, head)
		if (i++ == pipe)
			return crtc;

	return NULL;
}

static int rockchip_drm_crtc_enable_vblank(struct drm_device *dev,
					   unsigned int pipe)
{
	struct rockchip_drm_private *priv = dev->dev_private;
	struct drm_crtc *crtc = rockchip_crtc_from_pipe(dev, pipe);

	if (crtc && priv->crtc_funcs[pipe] &&
	    priv->crtc_funcs[pipe]->enable_vblank)
		return priv->crtc_funcs[pipe]->enable_vblank(crtc);

	return 0;
}

static void rockchip_drm_crtc_disable_vblank(struct drm_device *dev,
					     unsigned int pipe)
{
	struct rockchip_drm_private *priv = dev->dev_private;
	struct drm_crtc *crtc = rockchip_crtc_from_pipe(dev, pipe);

	if (crtc && priv->crtc_funcs[pipe] &&
	    priv->crtc_funcs[pipe]->enable_vblank)
		priv->crtc_funcs[pipe]->disable_vblank(crtc);
}

static int rockchip_drm_load(struct drm_device *drm_dev, unsigned long flags)
{
	struct rockchip_drm_private *private;
	struct dma_iommu_mapping *mapping;
	struct device *dev = drm_dev->dev;
	struct drm_connector *connector;
	int ret;

	private = devm_kzalloc(drm_dev->dev, sizeof(*private), GFP_KERNEL);
	if (!private)
		return -ENOMEM;

	mutex_init(&private->commit.lock);
	INIT_WORK(&private->commit.work, rockchip_drm_atomic_work);

	drm_dev->dev_private = private;

	drm_mode_config_init(drm_dev);

	rockchip_drm_mode_config_init(drm_dev);

	dev->dma_parms = devm_kzalloc(dev, sizeof(*dev->dma_parms),
				      GFP_KERNEL);
	if (!dev->dma_parms) {
		ret = -ENOMEM;
		goto err_config_cleanup;
	}

	/* TODO(djkurtz): fetch the mapping start/size from somewhere */
	mapping = arm_iommu_create_mapping(&platform_bus_type, 0x00000000,
					   SZ_2G);
	if (IS_ERR(mapping)) {
		ret = PTR_ERR(mapping);
		goto err_config_cleanup;
	}

	ret = dma_set_mask_and_coherent(dev, DMA_BIT_MASK(32));
	if (ret)
		goto err_release_mapping;

	dma_set_max_seg_size(dev, DMA_BIT_MASK(32));

	ret = arm_iommu_attach_device(dev, mapping);
	if (ret)
		goto err_release_mapping;

	/* Try to bind all sub drivers. */
	ret = component_bind_all(dev, drm_dev);
	if (ret)
		goto err_detach_device;

	/*
	 * All components are now added, we can publish the connector sysfs
	 * entries to userspace.  This will generate hotplug events and so
	 * userspace will expect to be able to access DRM at this point.
	 */
	list_for_each_entry(connector, &drm_dev->mode_config.connector_list,
			head) {
		ret = drm_connector_register(connector);
		if (ret) {
			dev_err(drm_dev->dev,
				"[CONNECTOR:%d:%s] drm_connector_register failed: %d\n",
				connector->base.id,
				connector->name, ret);
			goto err_unbind;
		}
	}

	/* init kms poll for handling hpd */
	drm_kms_helper_poll_init(drm_dev);

	/*
	 * enable drm irq mode.
	 * - with irq_enabled = true, we can use the vblank feature.
	 */
	drm_dev->irq_enabled = true;

	ret = drm_vblank_init(drm_dev, ROCKCHIP_MAX_CRTC);
	if (ret)
		goto err_kms_helper_poll_fini;

	/*
	 * with vblank_disable_allowed = true, vblank interrupt will be disabled
	 * by drm timer once a current process gives up ownership of
	 * vblank event.(after drm_vblank_put function is called)
	 */
	drm_dev->vblank_disable_allowed = true;

	drm_mode_config_reset(drm_dev);

	ret = rockchip_drm_fbdev_init(drm_dev);
	if (ret)
		goto err_vblank_cleanup;

	return 0;
err_vblank_cleanup:
	drm_vblank_cleanup(drm_dev);
err_kms_helper_poll_fini:
	drm_kms_helper_poll_fini(drm_dev);
err_unbind:
	component_unbind_all(dev, drm_dev);
err_detach_device:
	arm_iommu_detach_device(dev);
err_release_mapping:
	arm_iommu_release_mapping(dev->archdata.mapping);
err_config_cleanup:
	drm_mode_config_cleanup(drm_dev);
	drm_dev->dev_private = NULL;
	return ret;
}

static int rockchip_drm_unload(struct drm_device *drm_dev)
{
	struct device *dev = drm_dev->dev;

	rockchip_drm_fbdev_fini(drm_dev);
	drm_vblank_cleanup(drm_dev);
	drm_kms_helper_poll_fini(drm_dev);
	component_unbind_all(dev, drm_dev);
	arm_iommu_detach_device(dev);
	arm_iommu_release_mapping(dev->archdata.mapping);
	drm_mode_config_cleanup(drm_dev);
	drm_dev->dev_private = NULL;

	return 0;
}

static void rockchip_drm_crtc_cancel_pending_vblank(struct drm_crtc *crtc,
						    struct drm_file *file_priv)
{
	struct rockchip_drm_private *priv = crtc->dev->dev_private;
	int pipe = drm_crtc_index(crtc);

	if (pipe < ROCKCHIP_MAX_CRTC &&
	    priv->crtc_funcs[pipe] &&
	    priv->crtc_funcs[pipe]->cancel_pending_vblank)
		priv->crtc_funcs[pipe]->cancel_pending_vblank(crtc, file_priv);
}

static void rockchip_drm_preclose(struct drm_device *dev,
				  struct drm_file *file_priv)
{
	struct drm_crtc *crtc;

	list_for_each_entry(crtc, &dev->mode_config.crtc_list, head)
		rockchip_drm_crtc_cancel_pending_vblank(crtc, file_priv);
}

void rockchip_drm_lastclose(struct drm_device *dev)
{
	struct rockchip_drm_private *priv = dev->dev_private;

	drm_fb_helper_restore_fbdev_mode_unlocked(&priv->fbdev_helper);
}

static const struct file_operations rockchip_drm_driver_fops = {
	.owner = THIS_MODULE,
	.open = drm_open,
	.mmap = rockchip_gem_mmap,
	.poll = drm_poll,
	.read = drm_read,
	.unlocked_ioctl = drm_ioctl,
#ifdef CONFIG_COMPAT
	.compat_ioctl = drm_compat_ioctl,
#endif
	.release = drm_release,
};

const struct vm_operations_struct rockchip_drm_vm_ops = {
	.open = drm_gem_vm_open,
	.close = drm_gem_vm_close,
};

static struct drm_driver rockchip_drm_driver = {
	.driver_features	= DRIVER_MODESET | DRIVER_GEM |
				  DRIVER_PRIME | DRIVER_ATOMIC,
	.load			= rockchip_drm_load,
	.unload			= rockchip_drm_unload,
	.preclose		= rockchip_drm_preclose,
	.lastclose		= rockchip_drm_lastclose,
	.get_vblank_counter	= drm_vblank_no_hw_counter,
	.enable_vblank		= rockchip_drm_crtc_enable_vblank,
	.disable_vblank		= rockchip_drm_crtc_disable_vblank,
	.gem_vm_ops		= &rockchip_drm_vm_ops,
	.gem_free_object	= rockchip_gem_free_object,
	.dumb_create		= rockchip_gem_dumb_create,
	.dumb_map_offset	= rockchip_gem_dumb_map_offset,
	.dumb_destroy		= drm_gem_dumb_destroy,
	.prime_handle_to_fd	= drm_gem_prime_handle_to_fd,
	.prime_fd_to_handle	= drm_gem_prime_fd_to_handle,
	.gem_prime_import	= drm_gem_prime_import,
	.gem_prime_export	= drm_gem_prime_export,
	.gem_prime_get_sg_table	= rockchip_gem_prime_get_sg_table,
	.gem_prime_vmap		= rockchip_gem_prime_vmap,
	.gem_prime_vunmap	= rockchip_gem_prime_vunmap,
	.gem_prime_mmap		= rockchip_gem_mmap_buf,
	.fops			= &rockchip_drm_driver_fops,
	.name	= DRIVER_NAME,
	.desc	= DRIVER_DESC,
	.date	= DRIVER_DATE,
	.major	= DRIVER_MAJOR,
	.minor	= DRIVER_MINOR,
};

#ifdef CONFIG_PM_SLEEP
static int rockchip_drm_sys_suspend(struct device *dev)
{
	struct drm_device *drm = dev_get_drvdata(dev);
	struct drm_connector *connector;

	if (!drm)
		return 0;

	drm_modeset_lock_all(drm);
	list_for_each_entry(connector, &drm->mode_config.connector_list, head) {
		int old_dpms = connector->dpms;

		if (connector->funcs->dpms)
			connector->funcs->dpms(connector, DRM_MODE_DPMS_OFF);

		/* Set the old mode back to the connector for resume */
		connector->dpms = old_dpms;
	}
	drm_modeset_unlock_all(drm);

	return 0;
}

static int rockchip_drm_sys_resume(struct device *dev)
{
	struct drm_device *drm = dev_get_drvdata(dev);
	struct drm_connector *connector;
	enum drm_connector_status status;
	bool changed = false;

	if (!drm)
		return 0;

	drm_modeset_lock_all(drm);
	list_for_each_entry(connector, &drm->mode_config.connector_list, head) {
		int desired_mode = connector->dpms;

		/*
		 * at suspend time, we save dpms to connector->dpms,
		 * restore the old_dpms, and at current time, the connector
		 * dpms status must be DRM_MODE_DPMS_OFF.
		 */
		connector->dpms = DRM_MODE_DPMS_OFF;

		/*
		 * If the connector has been disconnected during suspend,
		 * disconnect it from the encoder and leave it off. We'll notify
		 * userspace at the end.
		 */
		if (desired_mode == DRM_MODE_DPMS_ON) {
			status = connector->funcs->detect(connector, true);
			if (status == connector_status_disconnected) {
				connector->encoder = NULL;
				connector->status = status;
				changed = true;
				continue;
			}
		}
		if (connector->funcs->dpms)
			connector->funcs->dpms(connector, desired_mode);
	}
	drm_modeset_unlock_all(drm);

	drm_helper_resume_force_mode(drm);

	if (changed)
		drm_kms_helper_hotplug_event(drm);

	return 0;
}
#endif

static const struct dev_pm_ops rockchip_drm_pm_ops = {
	SET_SYSTEM_SLEEP_PM_OPS(rockchip_drm_sys_suspend,
				rockchip_drm_sys_resume)
};

static int compare_of(struct device *dev, void *data)
{
	struct device_node *np = data;

	return dev->of_node == np;
}

static void rockchip_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 rockchip_drm_bind(struct device *dev)
{
	struct drm_device *drm;
	int ret;

	drm = drm_dev_alloc(&rockchip_drm_driver, dev);
	if (!drm)
		return -ENOMEM;

	ret = drm_dev_register(drm, 0);
	if (ret)
		goto err_free;

	dev_set_drvdata(dev, drm);

	return 0;

err_free:
	drm_dev_unref(drm);
	return ret;
}

static void rockchip_drm_unbind(struct device *dev)
{
	struct drm_device *drm = dev_get_drvdata(dev);

	drm_dev_unregister(drm);
	drm_dev_unref(drm);
	dev_set_drvdata(dev, NULL);
}

static const struct component_master_ops rockchip_drm_ops = {
	.bind = rockchip_drm_bind,
	.unbind = rockchip_drm_unbind,
};

static int rockchip_drm_platform_probe(struct platform_device *pdev)
{
	struct device *dev = &pdev->dev;
	struct component_match *match = NULL;
	struct device_node *np = dev->of_node;
	struct device_node *port;
	int i;

	if (!np)
		return -ENODEV;
	/*
	 * Bind the crtc ports first, so that
	 * drm_of_find_possible_crtcs called from encoder .bind callbacks
	 * works as expected.
	 */
	for (i = 0;; i++) {
		port = of_parse_phandle(np, "ports", i);
		if (!port)
			break;

		if (!of_device_is_available(port->parent)) {
			of_node_put(port);
			continue;
		}

		component_match_add(dev, &match, compare_of, port->parent);
		of_node_put(port);
	}

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

	if (!match) {
		dev_err(dev, "No available vop found for display-subsystem.\n");
		return -ENODEV;
	}
	/*
	 * For each bound crtc, bind the encoders attached to its
	 * remote endpoint.
	 */
	for (i = 0;; i++) {
		port = of_parse_phandle(np, "ports", i);
		if (!port)
			break;

		if (!of_device_is_available(port->parent)) {
			of_node_put(port);
			continue;
		}

		rockchip_add_endpoints(dev, &match, port);
		of_node_put(port);
	}

	return component_master_add_with_match(dev, &rockchip_drm_ops, match);
}

static int rockchip_drm_platform_remove(struct platform_device *pdev)
{
	component_master_del(&pdev->dev, &rockchip_drm_ops);

	return 0;
}

static const struct of_device_id rockchip_drm_dt_ids[] = {
	{ .compatible = "rockchip,display-subsystem", },
	{ /* sentinel */ },
};
MODULE_DEVICE_TABLE(of, rockchip_drm_dt_ids);

static struct platform_driver rockchip_drm_platform_driver = {
	.probe = rockchip_drm_platform_probe,
	.remove = rockchip_drm_platform_remove,
	.driver = {
		.name = "rockchip-drm",
		.of_match_table = rockchip_drm_dt_ids,
		.pm = &rockchip_drm_pm_ops,
	},
};

module_platform_driver(rockchip_drm_platform_driver);

MODULE_AUTHOR("Mark Yao <mark.yao@rock-chips.com>");
MODULE_DESCRIPTION("ROCKCHIP DRM Driver");
MODULE_LICENSE("GPL v2");
Commit	Line	Data
2048e328 MY	1	/*
	2	* Copyright (C) Fuzhou Rockchip Electronics Co.Ltd
	3	* Author:Mark Yao <mark.yao@rock-chips.com>
	4	*
	5	* based on exynos_drm_drv.c
	6	*
	7	* This software is licensed under the terms of the GNU General Public
	8	* License version 2, as published by the Free Software Foundation, and
	9	* may be copied, distributed, and modified under those terms.
	10	*
	11	* This program is distributed in the hope that it will be useful,
	12	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	13	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	14	* GNU General Public License for more details.
	15	*/
	16
	17	#include <asm/dma-iommu.h>
	18
	19	#include <drm/drmP.h>
	20	#include <drm/drm_crtc_helper.h>
	21	#include <drm/drm_fb_helper.h>
	22	#include <linux/dma-mapping.h>
	23	#include <linux/pm_runtime.h>
00fe6148	24	#include <linux/module.h>
2048e328 MY	25	#include <linux/of_graph.h>
	26	#include <linux/component.h>
	27
	28	#include "rockchip_drm_drv.h"
	29	#include "rockchip_drm_fb.h"
	30	#include "rockchip_drm_fbdev.h"
	31	#include "rockchip_drm_gem.h"
	32
	33	#define DRIVER_NAME "rockchip"
	34	#define DRIVER_DESC "RockChip Soc DRM"
	35	#define DRIVER_DATE "20140818"
	36	#define DRIVER_MAJOR 1
	37	#define DRIVER_MINOR 0
	38
	39	/*
	40	* Attach a (component) device to the shared drm dma mapping from master drm
	41	* device. This is used by the VOPs to map GEM buffers to a common DMA
	42	* mapping.
	43	*/
	44	int rockchip_drm_dma_attach_device(struct drm_device *drm_dev,
	45	struct device *dev)
	46	{
	47	struct dma_iommu_mapping *mapping = drm_dev->dev->archdata.mapping;
	48	int ret;
	49
	50	ret = dma_set_coherent_mask(dev, DMA_BIT_MASK(32));
	51	if (ret)
	52	return ret;
	53
	54	dma_set_max_seg_size(dev, DMA_BIT_MASK(32));
	55
	56	return arm_iommu_attach_device(dev, mapping);
	57	}
2048e328 MY	58
	59	void rockchip_drm_dma_detach_device(struct drm_device *drm_dev,
	60	struct device *dev)
	61	{
	62	arm_iommu_detach_device(dev);
	63	}
2048e328	64
b5f7b755 MY	65	int rockchip_register_crtc_funcs(struct drm_crtc *crtc,
b5f7b755 MY	66	const struct rockchip_crtc_funcs *crtc_funcs)
2048e328	67	{
b5f7b755 MY	68	int pipe = drm_crtc_index(crtc);
b5f7b755 MY	69	struct rockchip_drm_private *priv = crtc->dev->dev_private;
2048e328 MY	70
	71	if (pipe > ROCKCHIP_MAX_CRTC)
	72	return -EINVAL;
	73
	74	priv->crtc_funcs[pipe] = crtc_funcs;
	75
	76	return 0;
	77	}
2048e328	78
b5f7b755	79	void rockchip_unregister_crtc_funcs(struct drm_crtc *crtc)
2048e328	80	{
b5f7b755 MY	81	int pipe = drm_crtc_index(crtc);
b5f7b755 MY	82	struct rockchip_drm_private *priv = crtc->dev->dev_private;
2048e328 MY	83
	84	if (pipe > ROCKCHIP_MAX_CRTC)
	85	return;
	86
	87	priv->crtc_funcs[pipe] = NULL;
	88	}
2048e328 MY	89
	90	static struct drm_crtc rockchip_crtc_from_pipe(struct drm_device drm,
	91	int pipe)
	92	{
	93	struct drm_crtc *crtc;
	94	int i = 0;
	95
	96	list_for_each_entry(crtc, &drm->mode_config.crtc_list, head)
	97	if (i++ == pipe)
	98	return crtc;
	99
	100	return NULL;
	101	}
	102
88e72717 TR	103	static int rockchip_drm_crtc_enable_vblank(struct drm_device *dev,
88e72717 TR	104	unsigned int pipe)
2048e328 MY	105	{
	106	struct rockchip_drm_private *priv = dev->dev_private;
	107	struct drm_crtc *crtc = rockchip_crtc_from_pipe(dev, pipe);
	108
	109	if (crtc && priv->crtc_funcs[pipe] &&
	110	priv->crtc_funcs[pipe]->enable_vblank)
	111	return priv->crtc_funcs[pipe]->enable_vblank(crtc);
	112
	113	return 0;
	114	}
	115
88e72717 TR	116	static void rockchip_drm_crtc_disable_vblank(struct drm_device *dev,
88e72717 TR	117	unsigned int pipe)
2048e328 MY	118	{
	119	struct rockchip_drm_private *priv = dev->dev_private;
	120	struct drm_crtc *crtc = rockchip_crtc_from_pipe(dev, pipe);
	121
	122	if (crtc && priv->crtc_funcs[pipe] &&
	123	priv->crtc_funcs[pipe]->enable_vblank)
	124	priv->crtc_funcs[pipe]->disable_vblank(crtc);
	125	}
	126
	127	static int rockchip_drm_load(struct drm_device *drm_dev, unsigned long flags)
	128	{
	129	struct rockchip_drm_private *private;
	130	struct dma_iommu_mapping *mapping;
	131	struct device *dev = drm_dev->dev;
d3007dab	132	struct drm_connector *connector;
2048e328 MY	133	int ret;
	134
	135	private = devm_kzalloc(drm_dev->dev, sizeof(*private), GFP_KERNEL);
	136	if (!private)
	137	return -ENOMEM;
	138
f32fad51 MY	139	mutex_init(&private->commit.lock);
	140	INIT_WORK(&private->commit.work, rockchip_drm_atomic_work);
	141
2048e328 MY	142	drm_dev->dev_private = private;
	143
	144	drm_mode_config_init(drm_dev);
	145
	146	rockchip_drm_mode_config_init(drm_dev);
	147
	148	dev->dma_parms = devm_kzalloc(dev, sizeof(*dev->dma_parms),
	149	GFP_KERNEL);
	150	if (!dev->dma_parms) {
	151	ret = -ENOMEM;
	152	goto err_config_cleanup;
	153	}
	154
	155	/* TODO(djkurtz): fetch the mapping start/size from somewhere */
	156	mapping = arm_iommu_create_mapping(&platform_bus_type, 0x00000000,
	157	SZ_2G);
	158	if (IS_ERR(mapping)) {
	159	ret = PTR_ERR(mapping);
	160	goto err_config_cleanup;
	161	}
	162
	163	ret = dma_set_mask_and_coherent(dev, DMA_BIT_MASK(32));
	164	if (ret)
	165	goto err_release_mapping;
	166
	167	dma_set_max_seg_size(dev, DMA_BIT_MASK(32));
	168
	169	ret = arm_iommu_attach_device(dev, mapping);
	170	if (ret)
	171	goto err_release_mapping;
	172
	173	/* Try to bind all sub drivers. */
	174	ret = component_bind_all(dev, drm_dev);
	175	if (ret)
	176	goto err_detach_device;
	177
d3007dab DK	178	/*
	179	* All components are now added, we can publish the connector sysfs
	180	* entries to userspace. This will generate hotplug events and so
	181	* userspace will expect to be able to access DRM at this point.
	182	*/
	183	list_for_each_entry(connector, &drm_dev->mode_config.connector_list,
	184	head) {
	185	ret = drm_connector_register(connector);
	186	if (ret) {
	187	dev_err(drm_dev->dev,
	188	"[CONNECTOR:%d:%s] drm_connector_register failed: %d\n",
	189	connector->base.id,
	190	connector->name, ret);
	191	goto err_unbind;
	192	}
	193	}
	194
2048e328 MY	195	/* init kms poll for handling hpd */
	196	drm_kms_helper_poll_init(drm_dev);
	197
	198	/*
	199	* enable drm irq mode.
	200	* - with irq_enabled = true, we can use the vblank feature.
	201	*/
	202	drm_dev->irq_enabled = true;
	203
	204	ret = drm_vblank_init(drm_dev, ROCKCHIP_MAX_CRTC);
	205	if (ret)
	206	goto err_kms_helper_poll_fini;
	207
	208	/*
	209	* with vblank_disable_allowed = true, vblank interrupt will be disabled
	210	* by drm timer once a current process gives up ownership of
	211	* vblank event.(after drm_vblank_put function is called)
	212	*/
	213	drm_dev->vblank_disable_allowed = true;
	214
63ebb9fa MY	215	drm_mode_config_reset(drm_dev);
63ebb9fa MY	216
2048e328 MY	217	ret = rockchip_drm_fbdev_init(drm_dev);
	218	if (ret)
	219	goto err_vblank_cleanup;
	220
	221	return 0;
	222	err_vblank_cleanup:
	223	drm_vblank_cleanup(drm_dev);
	224	err_kms_helper_poll_fini:
	225	drm_kms_helper_poll_fini(drm_dev);
d3007dab	226	err_unbind:
2048e328 MY	227	component_unbind_all(dev, drm_dev);
	228	err_detach_device:
	229	arm_iommu_detach_device(dev);
	230	err_release_mapping:
	231	arm_iommu_release_mapping(dev->archdata.mapping);
	232	err_config_cleanup:
	233	drm_mode_config_cleanup(drm_dev);
	234	drm_dev->dev_private = NULL;
	235	return ret;
	236	}
	237
	238	static int rockchip_drm_unload(struct drm_device *drm_dev)
	239	{
	240	struct device *dev = drm_dev->dev;
	241
	242	rockchip_drm_fbdev_fini(drm_dev);
	243	drm_vblank_cleanup(drm_dev);
	244	drm_kms_helper_poll_fini(drm_dev);
	245	component_unbind_all(dev, drm_dev);
	246	arm_iommu_detach_device(dev);
	247	arm_iommu_release_mapping(dev->archdata.mapping);
	248	drm_mode_config_cleanup(drm_dev);
	249	drm_dev->dev_private = NULL;
	250
	251	return 0;
	252	}
	253
f135046e JK	254	static void rockchip_drm_crtc_cancel_pending_vblank(struct drm_crtc *crtc,
	255	struct drm_file *file_priv)
	256	{
	257	struct rockchip_drm_private *priv = crtc->dev->dev_private;
	258	int pipe = drm_crtc_index(crtc);
	259
	260	if (pipe < ROCKCHIP_MAX_CRTC &&
	261	priv->crtc_funcs[pipe] &&
	262	priv->crtc_funcs[pipe]->cancel_pending_vblank)
	263	priv->crtc_funcs[pipe]->cancel_pending_vblank(crtc, file_priv);
	264	}
	265
	266	static void rockchip_drm_preclose(struct drm_device *dev,
	267	struct drm_file *file_priv)
	268	{
	269	struct drm_crtc *crtc;
	270
	271	list_for_each_entry(crtc, &dev->mode_config.crtc_list, head)
	272	rockchip_drm_crtc_cancel_pending_vblank(crtc, file_priv);
	273	}
	274
2048e328 MY	275	void rockchip_drm_lastclose(struct drm_device *dev)
	276	{
	277	struct rockchip_drm_private *priv = dev->dev_private;
	278
	279	drm_fb_helper_restore_fbdev_mode_unlocked(&priv->fbdev_helper);
	280	}
	281
	282	static const struct file_operations rockchip_drm_driver_fops = {
	283	.owner = THIS_MODULE,
	284	.open = drm_open,
	285	.mmap = rockchip_gem_mmap,
	286	.poll = drm_poll,
	287	.read = drm_read,
	288	.unlocked_ioctl = drm_ioctl,
	289	#ifdef CONFIG_COMPAT
	290	.compat_ioctl = drm_compat_ioctl,
	291	#endif
	292	.release = drm_release,
	293	};
	294
	295	const struct vm_operations_struct rockchip_drm_vm_ops = {
	296	.open = drm_gem_vm_open,
	297	.close = drm_gem_vm_close,
	298	};
	299
	300	static struct drm_driver rockchip_drm_driver = {
63ebb9fa MY	301	.driver_features = DRIVER_MODESET \| DRIVER_GEM \|
63ebb9fa MY	302	DRIVER_PRIME \| DRIVER_ATOMIC,
2048e328 MY	303	.load = rockchip_drm_load,
2048e328 MY	304	.unload = rockchip_drm_unload,
f135046e	305	.preclose = rockchip_drm_preclose,
2048e328	306	.lastclose = rockchip_drm_lastclose,
b44f8408	307	.get_vblank_counter = drm_vblank_no_hw_counter,
2048e328 MY	308	.enable_vblank = rockchip_drm_crtc_enable_vblank,
	309	.disable_vblank = rockchip_drm_crtc_disable_vblank,
	310	.gem_vm_ops = &rockchip_drm_vm_ops,
	311	.gem_free_object = rockchip_gem_free_object,
	312	.dumb_create = rockchip_gem_dumb_create,
	313	.dumb_map_offset = rockchip_gem_dumb_map_offset,
	314	.dumb_destroy = drm_gem_dumb_destroy,
	315	.prime_handle_to_fd = drm_gem_prime_handle_to_fd,
	316	.prime_fd_to_handle = drm_gem_prime_fd_to_handle,
	317	.gem_prime_import = drm_gem_prime_import,
	318	.gem_prime_export = drm_gem_prime_export,
	319	.gem_prime_get_sg_table = rockchip_gem_prime_get_sg_table,
	320	.gem_prime_vmap = rockchip_gem_prime_vmap,
	321	.gem_prime_vunmap = rockchip_gem_prime_vunmap,
	322	.gem_prime_mmap = rockchip_gem_mmap_buf,
	323	.fops = &rockchip_drm_driver_fops,
	324	.name = DRIVER_NAME,
	325	.desc = DRIVER_DESC,
	326	.date = DRIVER_DATE,
	327	.major = DRIVER_MAJOR,
	328	.minor = DRIVER_MINOR,
	329	};
	330
	331	#ifdef CONFIG_PM_SLEEP
	332	static int rockchip_drm_sys_suspend(struct device *dev)
	333	{
	334	struct drm_device *drm = dev_get_drvdata(dev);
	335	struct drm_connector *connector;
	336
	337	if (!drm)
	338	return 0;
	339
	340	drm_modeset_lock_all(drm);
	341	list_for_each_entry(connector, &drm->mode_config.connector_list, head) {
	342	int old_dpms = connector->dpms;
	343
	344	if (connector->funcs->dpms)
	345	connector->funcs->dpms(connector, DRM_MODE_DPMS_OFF);
	346
	347	/* Set the old mode back to the connector for resume */
	348	connector->dpms = old_dpms;
	349	}
	350	drm_modeset_unlock_all(drm);
	351
	352	return 0;
	353	}
	354
	355	static int rockchip_drm_sys_resume(struct device *dev)
	356	{
	357	struct drm_device *drm = dev_get_drvdata(dev);
	358	struct drm_connector *connector;
	359	enum drm_connector_status status;
	360	bool changed = false;
	361
	362	if (!drm)
	363	return 0;
	364
	365	drm_modeset_lock_all(drm);
	366	list_for_each_entry(connector, &drm->mode_config.connector_list, head) {
	367	int desired_mode = connector->dpms;
	368
	369	/*
	370	* at suspend time, we save dpms to connector->dpms,
	371	* restore the old_dpms, and at current time, the connector
372	* dpms status must be DRM_MODE_DPMS_OFF.
373	*/
374	connector->dpms = DRM_MODE_DPMS_OFF;
375
376	/*
377	* If the connector has been disconnected during suspend,
378	* disconnect it from the encoder and leave it off. We'll notify
379	* userspace at the end.
380	*/
381	if (desired_mode == DRM_MODE_DPMS_ON) {
382	status = connector->funcs->detect(connector, true);
383	if (status == connector_status_disconnected) {
384	connector->encoder = NULL;
385	connector->status = status;
386	changed = true;
387	continue;
388	}
389	}
390	if (connector->funcs->dpms)
391	connector->funcs->dpms(connector, desired_mode);
392	}
393	drm_modeset_unlock_all(drm);
394
395	drm_helper_resume_force_mode(drm);
396
397	if (changed)
398	drm_kms_helper_hotplug_event(drm);
399
400	return 0;
401	}
402	#endif
403
404	static const struct dev_pm_ops rockchip_drm_pm_ops = {
405	SET_SYSTEM_SLEEP_PM_OPS(rockchip_drm_sys_suspend,
406	rockchip_drm_sys_resume)
407	};
408
2048e328 MY	409	static int compare_of(struct device dev, void data)
	410	{
	411	struct device_node *np = data;
	412
	413	return dev->of_node == np;
	414	}
	415
5bad7d29 MY	416	static void rockchip_add_endpoints(struct device *dev,
	417	struct component_match **match,
	418	struct device_node *port)
	419	{
	420	struct device_node ep, remote;
	421
	422	for_each_child_of_node(port, ep) {
	423	remote = of_graph_get_remote_port_parent(ep);
	424	if (!remote \|\| !of_device_is_available(remote)) {
	425	of_node_put(remote);
	426	continue;
	427	} else if (!of_device_is_available(remote->parent)) {
	428	dev_warn(dev, "parent device of %s is not available\n",
	429	remote->full_name);
	430	of_node_put(remote);
	431	continue;
	432	}
	433
	434	component_match_add(dev, match, compare_of, remote);
	435	of_node_put(remote);
	436	}
	437	}
	438
2048e328 MY	439	static int rockchip_drm_bind(struct device *dev)
	440	{
	441	struct drm_device *drm;
	442	int ret;
	443
	444	drm = drm_dev_alloc(&rockchip_drm_driver, dev);
	445	if (!drm)
	446	return -ENOMEM;
	447
2048e328 MY	448	ret = drm_dev_register(drm, 0);
	449	if (ret)
	450	goto err_free;
	451
	452	dev_set_drvdata(dev, drm);
	453
	454	return 0;
	455
	456	err_free:
	457	drm_dev_unref(drm);
	458	return ret;
	459	}
	460
	461	static void rockchip_drm_unbind(struct device *dev)
	462	{
	463	struct drm_device *drm = dev_get_drvdata(dev);
	464
	465	drm_dev_unregister(drm);
	466	drm_dev_unref(drm);
	467	dev_set_drvdata(dev, NULL);
	468	}
	469
	470	static const struct component_master_ops rockchip_drm_ops = {
	471	.bind = rockchip_drm_bind,
	472	.unbind = rockchip_drm_unbind,
	473	};
	474
	475	static int rockchip_drm_platform_probe(struct platform_device *pdev)
	476	{
5bad7d29 MY	477	struct device *dev = &pdev->dev;
	478	struct component_match *match = NULL;
	479	struct device_node *np = dev->of_node;
	480	struct device_node *port;
	481	int i;
2048e328	482
5bad7d29	483	if (!np)
2048e328	484	return -ENODEV;
5bad7d29 MY	485	/*
	486	* Bind the crtc ports first, so that
	487	* drm_of_find_possible_crtcs called from encoder .bind callbacks
	488	* works as expected.
	489	*/
	490	for (i = 0;; i++) {
	491	port = of_parse_phandle(np, "ports", i);
	492	if (!port)
	493	break;
	494
	495	if (!of_device_is_available(port->parent)) {
	496	of_node_put(port);
	497	continue;
	498	}
2048e328	499
5bad7d29 MY	500	component_match_add(dev, &match, compare_of, port->parent);
	501	of_node_put(port);
	502	}
	503
	504	if (i == 0) {
	505	dev_err(dev, "missing 'ports' property\n");
	506	return -ENODEV;
	507	}
	508
	509	if (!match) {
	510	dev_err(dev, "No available vop found for display-subsystem.\n");
	511	return -ENODEV;
	512	}
	513	/*
	514	* For each bound crtc, bind the encoders attached to its
	515	* remote endpoint.
	516	*/
	517	for (i = 0;; i++) {
	518	port = of_parse_phandle(np, "ports", i);
	519	if (!port)
	520	break;
	521
	522	if (!of_device_is_available(port->parent)) {
	523	of_node_put(port);
	524	continue;
	525	}
	526
	527	rockchip_add_endpoints(dev, &match, port);
	528	of_node_put(port);
	529	}
	530
	531	return component_master_add_with_match(dev, &rockchip_drm_ops, match);
2048e328 MY	532	}
	533
	534	static int rockchip_drm_platform_remove(struct platform_device *pdev)
	535	{
	536	component_master_del(&pdev->dev, &rockchip_drm_ops);
	537
	538	return 0;
	539	}
	540
	541	static const struct of_device_id rockchip_drm_dt_ids[] = {
	542	{ .compatible = "rockchip,display-subsystem", },
	543	{ /* sentinel */ },
	544	};
	545	MODULE_DEVICE_TABLE(of, rockchip_drm_dt_ids);
	546
	547	static struct platform_driver rockchip_drm_platform_driver = {
	548	.probe = rockchip_drm_platform_probe,
	549	.remove = rockchip_drm_platform_remove,
	550	.driver = {
2048e328 MY	551	.name = "rockchip-drm",
	552	.of_match_table = rockchip_drm_dt_ids,
	553	.pm = &rockchip_drm_pm_ops,
	554	},
	555	};
	556
	557	module_platform_driver(rockchip_drm_platform_driver);
	558
	559	MODULE_AUTHOR("Mark Yao <mark.yao@rock-chips.com>");
	560	MODULE_DESCRIPTION("ROCKCHIP DRM Driver");
	561	MODULE_LICENSE("GPL v2");