[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;
}

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,
	.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)
};

/*
 * @node: device tree node containing encoder input ports
 * @encoder: drm_encoder
 */
int rockchip_drm_encoder_get_mux_id(struct device_node *node,
				    struct drm_encoder *encoder)
{
	struct device_node *ep;
	struct drm_crtc *crtc = encoder->crtc;
	struct of_endpoint endpoint;
	struct device_node *port;
	int ret;

	if (!node || !crtc)
		return -EINVAL;

	for_each_endpoint_of_node(node, ep) {
		port = of_graph_get_remote_port(ep);
		of_node_put(port);
		if (port == crtc->port) {
			ret = of_graph_parse_endpoint(ep, &endpoint);
			of_node_put(ep);
			return ret ?: endpoint.id;
		}
	}

	return -EINVAL;
}
EXPORT_SYMBOL_GPL(rockchip_drm_encoder_get_mux_id);

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
	254	void rockchip_drm_lastclose(struct drm_device *dev)
	255	{
	256	struct rockchip_drm_private *priv = dev->dev_private;
	257
	258	drm_fb_helper_restore_fbdev_mode_unlocked(&priv->fbdev_helper);
	259	}
	260
	261	static const struct file_operations rockchip_drm_driver_fops = {
	262	.owner = THIS_MODULE,
	263	.open = drm_open,
	264	.mmap = rockchip_gem_mmap,
	265	.poll = drm_poll,
	266	.read = drm_read,
	267	.unlocked_ioctl = drm_ioctl,
	268	#ifdef CONFIG_COMPAT
	269	.compat_ioctl = drm_compat_ioctl,
	270	#endif
	271	.release = drm_release,
	272	};
	273
	274	const struct vm_operations_struct rockchip_drm_vm_ops = {
	275	.open = drm_gem_vm_open,
	276	.close = drm_gem_vm_close,
	277	};
	278
	279	static struct drm_driver rockchip_drm_driver = {
63ebb9fa MY	280	.driver_features = DRIVER_MODESET \| DRIVER_GEM \|
63ebb9fa MY	281	DRIVER_PRIME \| DRIVER_ATOMIC,
2048e328 MY	282	.load = rockchip_drm_load,
	283	.unload = rockchip_drm_unload,
	284	.lastclose = rockchip_drm_lastclose,
b44f8408	285	.get_vblank_counter = drm_vblank_no_hw_counter,
2048e328 MY	286	.enable_vblank = rockchip_drm_crtc_enable_vblank,
	287	.disable_vblank = rockchip_drm_crtc_disable_vblank,
	288	.gem_vm_ops = &rockchip_drm_vm_ops,
	289	.gem_free_object = rockchip_gem_free_object,
	290	.dumb_create = rockchip_gem_dumb_create,
	291	.dumb_map_offset = rockchip_gem_dumb_map_offset,
	292	.dumb_destroy = drm_gem_dumb_destroy,
	293	.prime_handle_to_fd = drm_gem_prime_handle_to_fd,
	294	.prime_fd_to_handle = drm_gem_prime_fd_to_handle,
	295	.gem_prime_import = drm_gem_prime_import,
	296	.gem_prime_export = drm_gem_prime_export,
	297	.gem_prime_get_sg_table = rockchip_gem_prime_get_sg_table,
	298	.gem_prime_vmap = rockchip_gem_prime_vmap,
	299	.gem_prime_vunmap = rockchip_gem_prime_vunmap,
	300	.gem_prime_mmap = rockchip_gem_mmap_buf,
	301	.fops = &rockchip_drm_driver_fops,
	302	.name = DRIVER_NAME,
	303	.desc = DRIVER_DESC,
	304	.date = DRIVER_DATE,
	305	.major = DRIVER_MAJOR,
	306	.minor = DRIVER_MINOR,
	307	};
	308
	309	#ifdef CONFIG_PM_SLEEP
	310	static int rockchip_drm_sys_suspend(struct device *dev)
	311	{
	312	struct drm_device *drm = dev_get_drvdata(dev);
	313	struct drm_connector *connector;
	314
	315	if (!drm)
	316	return 0;
	317
	318	drm_modeset_lock_all(drm);
	319	list_for_each_entry(connector, &drm->mode_config.connector_list, head) {
	320	int old_dpms = connector->dpms;
	321
	322	if (connector->funcs->dpms)
	323	connector->funcs->dpms(connector, DRM_MODE_DPMS_OFF);
	324
	325	/* Set the old mode back to the connector for resume */
	326	connector->dpms = old_dpms;
	327	}
	328	drm_modeset_unlock_all(drm);
	329
	330	return 0;
	331	}
	332
	333	static int rockchip_drm_sys_resume(struct device *dev)
	334	{
	335	struct drm_device *drm = dev_get_drvdata(dev);
	336	struct drm_connector *connector;
	337	enum drm_connector_status status;
	338	bool changed = false;
	339
	340	if (!drm)
	341	return 0;
	342
	343	drm_modeset_lock_all(drm);
	344	list_for_each_entry(connector, &drm->mode_config.connector_list, head) {
	345	int desired_mode = connector->dpms;
	346
	347	/*
	348	* at suspend time, we save dpms to connector->dpms,
	349	* restore the old_dpms, and at current time, the connector
350	* dpms status must be DRM_MODE_DPMS_OFF.
351	*/
352	connector->dpms = DRM_MODE_DPMS_OFF;
353
354	/*
355	* If the connector has been disconnected during suspend,
356	* disconnect it from the encoder and leave it off. We'll notify
357	* userspace at the end.
358	*/
359	if (desired_mode == DRM_MODE_DPMS_ON) {
360	status = connector->funcs->detect(connector, true);
361	if (status == connector_status_disconnected) {
362	connector->encoder = NULL;
363	connector->status = status;
364	changed = true;
365	continue;
366	}
367	}
368	if (connector->funcs->dpms)
369	connector->funcs->dpms(connector, desired_mode);
370	}
371	drm_modeset_unlock_all(drm);
372
373	drm_helper_resume_force_mode(drm);
374
375	if (changed)
376	drm_kms_helper_hotplug_event(drm);
377
378	return 0;
379	}
380	#endif
381
382	static const struct dev_pm_ops rockchip_drm_pm_ops = {
383	SET_SYSTEM_SLEEP_PM_OPS(rockchip_drm_sys_suspend,
384	rockchip_drm_sys_resume)
385	};
386
387	/*
388	* @node: device tree node containing encoder input ports
389	* @encoder: drm_encoder
390	*/
391	int rockchip_drm_encoder_get_mux_id(struct device_node *node,
392	struct drm_encoder *encoder)
393	{
ecaa4902	394	struct device_node *ep;
2048e328 MY	395	struct drm_crtc *crtc = encoder->crtc;
	396	struct of_endpoint endpoint;
	397	struct device_node *port;
	398	int ret;
	399
	400	if (!node \|\| !crtc)
	401	return -EINVAL;
	402
ecaa4902	403	for_each_endpoint_of_node(node, ep) {
2048e328 MY	404	port = of_graph_get_remote_port(ep);
	405	of_node_put(port);
	406	if (port == crtc->port) {
	407	ret = of_graph_parse_endpoint(ep, &endpoint);
ecaa4902	408	of_node_put(ep);
2048e328 MY	409	return ret ?: endpoint.id;
2048e328 MY	410	}
ecaa4902	411	}
2048e328 MY	412
	413	return -EINVAL;
	414	}
f66a1627	415	EXPORT_SYMBOL_GPL(rockchip_drm_encoder_get_mux_id);
2048e328 MY	416
	417	static int compare_of(struct device dev, void data)
	418	{
	419	struct device_node *np = data;
	420
	421	return dev->of_node == np;
	422	}
	423
5bad7d29 MY	424	static void rockchip_add_endpoints(struct device *dev,
	425	struct component_match **match,
	426	struct device_node *port)
	427	{
	428	struct device_node ep, remote;
	429
	430	for_each_child_of_node(port, ep) {
	431	remote = of_graph_get_remote_port_parent(ep);
	432	if (!remote \|\| !of_device_is_available(remote)) {
	433	of_node_put(remote);
	434	continue;
	435	} else if (!of_device_is_available(remote->parent)) {
	436	dev_warn(dev, "parent device of %s is not available\n",
	437	remote->full_name);
	438	of_node_put(remote);
	439	continue;
	440	}
	441
	442	component_match_add(dev, match, compare_of, remote);
	443	of_node_put(remote);
	444	}
	445	}
	446
2048e328 MY	447	static int rockchip_drm_bind(struct device *dev)
	448	{
	449	struct drm_device *drm;
	450	int ret;
	451
	452	drm = drm_dev_alloc(&rockchip_drm_driver, dev);
	453	if (!drm)
	454	return -ENOMEM;
	455
2048e328 MY	456	ret = drm_dev_register(drm, 0);
	457	if (ret)
	458	goto err_free;
	459
	460	dev_set_drvdata(dev, drm);
	461
	462	return 0;
	463
	464	err_free:
	465	drm_dev_unref(drm);
	466	return ret;
	467	}
	468
	469	static void rockchip_drm_unbind(struct device *dev)
	470	{
	471	struct drm_device *drm = dev_get_drvdata(dev);
	472
	473	drm_dev_unregister(drm);
	474	drm_dev_unref(drm);
	475	dev_set_drvdata(dev, NULL);
	476	}
	477
	478	static const struct component_master_ops rockchip_drm_ops = {
	479	.bind = rockchip_drm_bind,
	480	.unbind = rockchip_drm_unbind,
	481	};
	482
	483	static int rockchip_drm_platform_probe(struct platform_device *pdev)
	484	{
5bad7d29 MY	485	struct device *dev = &pdev->dev;
	486	struct component_match *match = NULL;
	487	struct device_node *np = dev->of_node;
	488	struct device_node *port;
	489	int i;
2048e328	490
5bad7d29	491	if (!np)
2048e328	492	return -ENODEV;
5bad7d29 MY	493	/*
	494	* Bind the crtc ports first, so that
	495	* drm_of_find_possible_crtcs called from encoder .bind callbacks
	496	* works as expected.
	497	*/
	498	for (i = 0;; i++) {
	499	port = of_parse_phandle(np, "ports", i);
	500	if (!port)
	501	break;
	502
	503	if (!of_device_is_available(port->parent)) {
	504	of_node_put(port);
	505	continue;
	506	}
2048e328	507
5bad7d29 MY	508	component_match_add(dev, &match, compare_of, port->parent);
	509	of_node_put(port);
	510	}
	511
	512	if (i == 0) {
	513	dev_err(dev, "missing 'ports' property\n");
	514	return -ENODEV;
	515	}
	516
	517	if (!match) {
	518	dev_err(dev, "No available vop found for display-subsystem.\n");
	519	return -ENODEV;
	520	}
	521	/*
	522	* For each bound crtc, bind the encoders attached to its
	523	* remote endpoint.
	524	*/
	525	for (i = 0;; i++) {
	526	port = of_parse_phandle(np, "ports", i);
	527	if (!port)
	528	break;
	529
	530	if (!of_device_is_available(port->parent)) {
	531	of_node_put(port);
	532	continue;
	533	}
	534
	535	rockchip_add_endpoints(dev, &match, port);
	536	of_node_put(port);
	537	}
	538
	539	return component_master_add_with_match(dev, &rockchip_drm_ops, match);
2048e328 MY	540	}
	541
	542	static int rockchip_drm_platform_remove(struct platform_device *pdev)
	543	{
	544	component_master_del(&pdev->dev, &rockchip_drm_ops);
	545
	546	return 0;
	547	}
	548
	549	static const struct of_device_id rockchip_drm_dt_ids[] = {
	550	{ .compatible = "rockchip,display-subsystem", },
	551	{ /* sentinel */ },
	552	};
	553	MODULE_DEVICE_TABLE(of, rockchip_drm_dt_ids);
	554
	555	static struct platform_driver rockchip_drm_platform_driver = {
	556	.probe = rockchip_drm_platform_probe,
	557	.remove = rockchip_drm_platform_remove,
	558	.driver = {
2048e328 MY	559	.name = "rockchip-drm",
	560	.of_match_table = rockchip_drm_dt_ids,
	561	.pm = &rockchip_drm_pm_ops,
	562	},
	563	};
	564
	565	module_platform_driver(rockchip_drm_platform_driver);
	566
	567	MODULE_AUTHOR("Mark Yao <mark.yao@rock-chips.com>");
	568	MODULE_DESCRIPTION("ROCKCHIP DRM Driver");
	569	MODULE_LICENSE("GPL v2");