| /* |
| * 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 <drm/drm_gem_cma_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 <linux/console.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 |
| |
| static bool is_support_iommu = true; |
| static struct drm_driver rockchip_drm_driver; |
| |
| /* |
| * 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; |
| |
| if (!is_support_iommu) |
| return 0; |
| |
| 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) |
| { |
| if (!is_support_iommu) |
| return; |
| |
| 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_bind(struct device *dev) |
| { |
| struct drm_device *drm_dev; |
| struct rockchip_drm_private *private; |
| struct dma_iommu_mapping *mapping = NULL; |
| int ret; |
| |
| drm_dev = drm_dev_alloc(&rockchip_drm_driver, dev); |
| if (!drm_dev) |
| return -ENOMEM; |
| |
| dev_set_drvdata(dev, drm_dev); |
| |
| private = devm_kzalloc(drm_dev->dev, sizeof(*private), GFP_KERNEL); |
| if (!private) { |
| ret = -ENOMEM; |
| goto err_free; |
| } |
| |
| 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; |
| } |
| |
| if (is_support_iommu) { |
| /* 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; |
| |
| /* 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; |
| |
| drm_mode_config_reset(drm_dev); |
| |
| ret = rockchip_drm_fbdev_init(drm_dev); |
| if (ret) |
| goto err_vblank_cleanup; |
| |
| ret = drm_dev_register(drm_dev, 0); |
| if (ret) |
| goto err_fbdev_fini; |
| |
| if (is_support_iommu) |
| arm_iommu_release_mapping(mapping); |
| return 0; |
| err_fbdev_fini: |
| rockchip_drm_fbdev_fini(drm_dev); |
| err_vblank_cleanup: |
| drm_vblank_cleanup(drm_dev); |
| err_kms_helper_poll_fini: |
| drm_kms_helper_poll_fini(drm_dev); |
| component_unbind_all(dev, drm_dev); |
| err_detach_device: |
| if (is_support_iommu) |
| arm_iommu_detach_device(dev); |
| err_release_mapping: |
| if (is_support_iommu) |
| arm_iommu_release_mapping(mapping); |
| err_config_cleanup: |
| drm_mode_config_cleanup(drm_dev); |
| drm_dev->dev_private = NULL; |
| err_free: |
| drm_dev_unref(drm_dev); |
| return ret; |
| } |
| |
| static void rockchip_drm_unbind(struct device *dev) |
| { |
| struct drm_device *drm_dev = dev_get_drvdata(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); |
| if (is_support_iommu) |
| arm_iommu_detach_device(dev); |
| drm_mode_config_cleanup(drm_dev); |
| drm_dev->dev_private = NULL; |
| drm_dev_unregister(drm_dev); |
| drm_dev_unref(drm_dev); |
| dev_set_drvdata(dev, NULL); |
| } |
| |
| 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, |
| }; |
| |
| static struct drm_driver rockchip_drm_driver = { |
| .driver_features = DRIVER_MODESET | DRIVER_GEM | |
| DRIVER_PRIME | DRIVER_ATOMIC, |
| .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 = &drm_gem_cma_vm_ops, |
| .gem_free_object_unlocked = 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 |
| void rockchip_drm_fb_suspend(struct drm_device *drm) |
| { |
| struct rockchip_drm_private *priv = drm->dev_private; |
| |
| console_lock(); |
| drm_fb_helper_set_suspend(&priv->fbdev_helper, 1); |
| console_unlock(); |
| } |
| |
| void rockchip_drm_fb_resume(struct drm_device *drm) |
| { |
| struct rockchip_drm_private *priv = drm->dev_private; |
| |
| console_lock(); |
| drm_fb_helper_set_suspend(&priv->fbdev_helper, 0); |
| console_unlock(); |
| } |
| |
| static int rockchip_drm_sys_suspend(struct device *dev) |
| { |
| struct drm_device *drm = dev_get_drvdata(dev); |
| struct rockchip_drm_private *priv = drm->dev_private; |
| |
| drm_kms_helper_poll_disable(drm); |
| rockchip_drm_fb_suspend(drm); |
| |
| priv->state = drm_atomic_helper_suspend(drm); |
| if (IS_ERR(priv->state)) { |
| rockchip_drm_fb_resume(drm); |
| drm_kms_helper_poll_enable(drm); |
| return PTR_ERR(priv->state); |
| } |
| |
| return 0; |
| } |
| |
| static int rockchip_drm_sys_resume(struct device *dev) |
| { |
| struct drm_device *drm = dev_get_drvdata(dev); |
| struct rockchip_drm_private *priv = drm->dev_private; |
| |
| drm_atomic_helper_resume(drm, priv->state); |
| rockchip_drm_fb_resume(drm); |
| drm_kms_helper_poll_enable(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 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++) { |
| struct device_node *iommu; |
| |
| port = of_parse_phandle(np, "ports", i); |
| if (!port) |
| break; |
| |
| if (!of_device_is_available(port->parent)) { |
| of_node_put(port); |
| continue; |
| } |
| |
| iommu = of_parse_phandle(port->parent, "iommus", 0); |
| if (!iommu || !of_device_is_available(iommu->parent)) { |
| dev_dbg(dev, "no iommu attached for %s, using non-iommu buffers\n", |
| port->parent->full_name); |
| /* |
| * if there is a crtc not support iommu, force set all |
| * crtc use non-iommu buffer. |
| */ |
| is_support_iommu = false; |
| } |
| |
| of_node_put(iommu); |
| 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"); |