| /* |
| * Copyright (c) 2016-2017, The Linux Foundation. All rights reserved. |
| * Copyright (C) 2013 Red Hat |
| * Author: Rob Clark <robdclark@gmail.com> |
| * |
| * This program is free software; you can redistribute it and/or modify it |
| * under the terms of the GNU General Public License version 2 as published by |
| * the Free Software Foundation. |
| * |
| * 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. |
| * |
| * You should have received a copy of the GNU General Public License along with |
| * this program. If not, see <http://www.gnu.org/licenses/>. |
| */ |
| /* |
| * Copyright (c) 2016 Intel Corporation |
| * |
| * Permission to use, copy, modify, distribute, and sell this software and its |
| * documentation for any purpose is hereby granted without fee, provided that |
| * the above copyright notice appear in all copies and that both that copyright |
| * notice and this permission notice appear in supporting documentation, and |
| * that the name of the copyright holders not be used in advertising or |
| * publicity pertaining to distribution of the software without specific, |
| * written prior permission. The copyright holders make no representations |
| * about the suitability of this software for any purpose. It is provided "as |
| * is" without express or implied warranty. |
| * |
| * THE COPYRIGHT HOLDERS DISCLAIM ALL WARRANTIES WITH REGARD TO THIS SOFTWARE, |
| * INCLUDING ALL IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS, IN NO |
| * EVENT SHALL THE COPYRIGHT HOLDERS BE LIABLE FOR ANY SPECIAL, INDIRECT OR |
| * CONSEQUENTIAL DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, |
| * DATA OR PROFITS, WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER |
| * TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR PERFORMANCE |
| * OF THIS SOFTWARE. |
| */ |
| |
| #include <linux/of_address.h> |
| #include <linux/kthread.h> |
| #include "msm_drv.h" |
| #include "msm_debugfs.h" |
| #include "msm_fence.h" |
| #include "msm_gpu.h" |
| #include "msm_kms.h" |
| #include "sde_wb.h" |
| #include "dsi_display.h" |
| |
| /* |
| * MSM driver version: |
| * - 1.0.0 - initial interface |
| * - 1.1.0 - adds madvise, and support for submits with > 4 cmd buffers |
| * - 1.2.0 - adds explicit fence support for submit ioctl |
| */ |
| #define MSM_VERSION_MAJOR 1 |
| #define MSM_VERSION_MINOR 2 |
| #define MSM_VERSION_PATCHLEVEL 0 |
| |
| #define TEARDOWN_DEADLOCK_RETRY_MAX 5 |
| |
| static void msm_drm_helper_hotplug_event(struct drm_device *dev) |
| { |
| struct drm_connector *connector; |
| char *event_string; |
| char const *connector_name; |
| char *envp[2]; |
| |
| if (!dev) { |
| DRM_ERROR("hotplug_event failed, invalid input\n"); |
| return; |
| } |
| |
| if (!dev->mode_config.poll_enabled) |
| return; |
| |
| event_string = kzalloc(SZ_4K, GFP_KERNEL); |
| if (!event_string) { |
| DRM_ERROR("failed to allocate event string\n"); |
| return; |
| } |
| |
| mutex_lock(&dev->mode_config.mutex); |
| drm_for_each_connector(connector, dev) { |
| /* Only handle HPD capable connectors. */ |
| if (!(connector->polled & DRM_CONNECTOR_POLL_HPD)) |
| continue; |
| |
| connector->status = connector->funcs->detect(connector, false); |
| |
| if (connector->name) |
| connector_name = connector->name; |
| else |
| connector_name = "unknown"; |
| |
| snprintf(event_string, SZ_4K, "name=%s status=%s\n", |
| connector_name, |
| drm_get_connector_status_name(connector->status)); |
| DRM_DEBUG("generating hotplug event [%s]\n", event_string); |
| envp[0] = event_string; |
| envp[1] = NULL; |
| kobject_uevent_env(&dev->primary->kdev->kobj, KOBJ_CHANGE, |
| envp); |
| } |
| mutex_unlock(&dev->mode_config.mutex); |
| kfree(event_string); |
| } |
| |
| static void msm_fb_output_poll_changed(struct drm_device *dev) |
| { |
| struct msm_drm_private *priv = NULL; |
| |
| if (!dev) { |
| DRM_ERROR("output_poll_changed failed, invalid input\n"); |
| return; |
| } |
| |
| priv = dev->dev_private; |
| |
| if (priv->fbdev) |
| drm_fb_helper_hotplug_event(priv->fbdev); |
| else |
| msm_drm_helper_hotplug_event(dev); |
| } |
| |
| int msm_atomic_check(struct drm_device *dev, |
| struct drm_atomic_state *state) |
| { |
| if (msm_is_suspend_blocked(dev)) { |
| DRM_DEBUG("rejecting commit during suspend\n"); |
| return -EBUSY; |
| } |
| return drm_atomic_helper_check(dev, state); |
| } |
| |
| static const struct drm_mode_config_funcs mode_config_funcs = { |
| .fb_create = msm_framebuffer_create, |
| .output_poll_changed = msm_fb_output_poll_changed, |
| .atomic_check = msm_atomic_check, |
| .atomic_commit = msm_atomic_commit, |
| }; |
| |
| int msm_register_mmu(struct drm_device *dev, struct msm_mmu *mmu) |
| { |
| struct msm_drm_private *priv = dev->dev_private; |
| int idx = priv->num_mmus++; |
| |
| if (WARN_ON(idx >= ARRAY_SIZE(priv->mmus))) |
| return -EINVAL; |
| |
| priv->mmus[idx] = mmu; |
| |
| return idx; |
| } |
| |
| void msm_unregister_mmu(struct drm_device *dev, struct msm_mmu *mmu) |
| { |
| struct msm_drm_private *priv = dev->dev_private; |
| int idx; |
| |
| if (priv->num_mmus <= 0) { |
| dev_err(dev->dev, "invalid num mmus %d\n", priv->num_mmus); |
| return; |
| } |
| |
| idx = priv->num_mmus - 1; |
| |
| /* only support reverse-order deallocation */ |
| if (priv->mmus[idx] != mmu) { |
| dev_err(dev->dev, "unexpected mmu at idx %d\n", idx); |
| return; |
| } |
| |
| --priv->num_mmus; |
| priv->mmus[idx] = 0; |
| } |
| |
| |
| #ifdef CONFIG_DRM_MSM_REGISTER_LOGGING |
| static bool reglog = false; |
| MODULE_PARM_DESC(reglog, "Enable register read/write logging"); |
| module_param(reglog, bool, 0600); |
| #else |
| #define reglog 0 |
| #endif |
| |
| #ifdef CONFIG_DRM_FBDEV_EMULATION |
| static bool fbdev = true; |
| MODULE_PARM_DESC(fbdev, "Enable fbdev compat layer"); |
| module_param(fbdev, bool, 0600); |
| #endif |
| |
| static char *vram = "16m"; |
| MODULE_PARM_DESC(vram, "Configure VRAM size (for devices without IOMMU/GPUMMU)"); |
| module_param(vram, charp, 0); |
| |
| /* |
| * Util/helpers: |
| */ |
| |
| void __iomem *msm_ioremap(struct platform_device *pdev, const char *name, |
| const char *dbgname) |
| { |
| struct resource *res; |
| unsigned long size; |
| void __iomem *ptr; |
| |
| if (name) |
| res = platform_get_resource_byname(pdev, IORESOURCE_MEM, name); |
| else |
| res = platform_get_resource(pdev, IORESOURCE_MEM, 0); |
| |
| if (!res) { |
| dev_err(&pdev->dev, "failed to get memory resource: %s\n", name); |
| return ERR_PTR(-EINVAL); |
| } |
| |
| size = resource_size(res); |
| |
| ptr = devm_ioremap_nocache(&pdev->dev, res->start, size); |
| if (!ptr) { |
| dev_err(&pdev->dev, "failed to ioremap: %s\n", name); |
| return ERR_PTR(-ENOMEM); |
| } |
| |
| if (reglog) |
| printk(KERN_DEBUG "IO:region %s %p %08lx\n", dbgname, ptr, size); |
| |
| return ptr; |
| } |
| |
| void msm_iounmap(struct platform_device *pdev, void __iomem *addr) |
| { |
| devm_iounmap(&pdev->dev, addr); |
| } |
| |
| void msm_writel(u32 data, void __iomem *addr) |
| { |
| if (reglog) |
| printk(KERN_DEBUG "IO:W %p %08x\n", addr, data); |
| writel(data, addr); |
| } |
| |
| u32 msm_readl(const void __iomem *addr) |
| { |
| u32 val = readl(addr); |
| |
| if (reglog) |
| printk(KERN_ERR "IO:R %p %08x\n", addr, val); |
| return val; |
| } |
| |
| struct vblank_event { |
| struct list_head node; |
| int crtc_id; |
| bool enable; |
| }; |
| |
| static void vblank_ctrl_worker(struct kthread_work *work) |
| { |
| struct msm_vblank_ctrl *vbl_ctrl = container_of(work, |
| struct msm_vblank_ctrl, work); |
| struct msm_drm_private *priv = container_of(vbl_ctrl, |
| struct msm_drm_private, vblank_ctrl); |
| struct msm_kms *kms = priv->kms; |
| struct vblank_event *vbl_ev, *tmp; |
| unsigned long flags; |
| |
| spin_lock_irqsave(&vbl_ctrl->lock, flags); |
| list_for_each_entry_safe(vbl_ev, tmp, &vbl_ctrl->event_list, node) { |
| list_del(&vbl_ev->node); |
| spin_unlock_irqrestore(&vbl_ctrl->lock, flags); |
| |
| if (vbl_ev->enable) |
| kms->funcs->enable_vblank(kms, |
| priv->crtcs[vbl_ev->crtc_id]); |
| else |
| kms->funcs->disable_vblank(kms, |
| priv->crtcs[vbl_ev->crtc_id]); |
| |
| kfree(vbl_ev); |
| |
| spin_lock_irqsave(&vbl_ctrl->lock, flags); |
| } |
| |
| spin_unlock_irqrestore(&vbl_ctrl->lock, flags); |
| } |
| |
| static int vblank_ctrl_queue_work(struct msm_drm_private *priv, |
| int crtc_id, bool enable) |
| { |
| struct msm_vblank_ctrl *vbl_ctrl = &priv->vblank_ctrl; |
| struct vblank_event *vbl_ev; |
| unsigned long flags; |
| |
| vbl_ev = kzalloc(sizeof(*vbl_ev), GFP_ATOMIC); |
| if (!vbl_ev) |
| return -ENOMEM; |
| |
| vbl_ev->crtc_id = crtc_id; |
| vbl_ev->enable = enable; |
| |
| spin_lock_irqsave(&vbl_ctrl->lock, flags); |
| list_add_tail(&vbl_ev->node, &vbl_ctrl->event_list); |
| spin_unlock_irqrestore(&vbl_ctrl->lock, flags); |
| |
| kthread_queue_work(&priv->disp_thread[crtc_id].worker, &vbl_ctrl->work); |
| |
| return 0; |
| } |
| |
| static int msm_drm_uninit(struct device *dev) |
| { |
| struct platform_device *pdev = to_platform_device(dev); |
| struct drm_device *ddev = platform_get_drvdata(pdev); |
| struct msm_drm_private *priv = ddev->dev_private; |
| struct msm_kms *kms = priv->kms; |
| struct msm_gpu *gpu = priv->gpu; |
| struct msm_vblank_ctrl *vbl_ctrl = &priv->vblank_ctrl; |
| struct vblank_event *vbl_ev, *tmp; |
| int i; |
| |
| /* We must cancel and cleanup any pending vblank enable/disable |
| * work before drm_irq_uninstall() to avoid work re-enabling an |
| * irq after uninstall has disabled it. |
| */ |
| kthread_flush_work(&vbl_ctrl->work); |
| list_for_each_entry_safe(vbl_ev, tmp, &vbl_ctrl->event_list, node) { |
| list_del(&vbl_ev->node); |
| kfree(vbl_ev); |
| } |
| |
| /* clean up display commit worker threads */ |
| for (i = 0; i < priv->num_crtcs; i++) { |
| if (priv->disp_thread[i].thread) { |
| kthread_flush_worker(&priv->disp_thread[i].worker); |
| kthread_stop(priv->disp_thread[i].thread); |
| priv->disp_thread[i].thread = NULL; |
| } |
| } |
| |
| msm_gem_shrinker_cleanup(ddev); |
| |
| drm_kms_helper_poll_fini(ddev); |
| |
| drm_mode_config_cleanup(ddev); |
| drm_vblank_cleanup(ddev); |
| |
| if (priv->registered) { |
| drm_dev_unregister(ddev); |
| priv->registered = false; |
| } |
| |
| #ifdef CONFIG_DRM_FBDEV_EMULATION |
| if (fbdev && priv->fbdev) |
| msm_fbdev_free(ddev); |
| #endif |
| drm_mode_config_cleanup(ddev); |
| |
| pm_runtime_get_sync(dev); |
| drm_irq_uninstall(ddev); |
| pm_runtime_put_sync(dev); |
| |
| flush_workqueue(priv->wq); |
| destroy_workqueue(priv->wq); |
| |
| if (kms && kms->funcs) |
| kms->funcs->destroy(kms); |
| |
| if (gpu) { |
| mutex_lock(&ddev->struct_mutex); |
| gpu->funcs->pm_suspend(gpu); |
| mutex_unlock(&ddev->struct_mutex); |
| gpu->funcs->destroy(gpu); |
| } |
| |
| if (priv->vram.paddr) { |
| unsigned long attrs = DMA_ATTR_NO_KERNEL_MAPPING; |
| |
| drm_mm_takedown(&priv->vram.mm); |
| dma_free_attrs(dev, priv->vram.size, NULL, |
| priv->vram.paddr, attrs); |
| } |
| |
| sde_dbg_destroy(); |
| debugfs_remove_recursive(priv->debug_root); |
| |
| component_unbind_all(dev, ddev); |
| sde_power_client_destroy(&priv->phandle, priv->pclient); |
| sde_power_resource_deinit(pdev, &priv->phandle); |
| |
| msm_mdss_destroy(ddev); |
| |
| ddev->dev_private = NULL; |
| kfree(priv); |
| |
| drm_dev_unref(ddev); |
| |
| return 0; |
| } |
| |
| #define KMS_MDP4 4 |
| #define KMS_MDP5 5 |
| #define KMS_SDE 3 |
| |
| static int get_mdp_ver(struct platform_device *pdev) |
| { |
| #ifdef CONFIG_OF |
| static const struct of_device_id match_types[] = { { |
| .compatible = "qcom,mdss_mdp", |
| .data = (void *)KMS_MDP5, |
| }, |
| { |
| .compatible = "qcom,sde-kms", |
| .data = (void *)KMS_SDE, |
| }, |
| {} }; |
| struct device *dev = &pdev->dev; |
| const struct of_device_id *match; |
| |
| match = of_match_node(match_types, dev->of_node); |
| if (match) |
| return (int)(unsigned long)match->data; |
| #endif |
| return KMS_MDP4; |
| } |
| |
| static int msm_init_vram(struct drm_device *dev) |
| { |
| struct msm_drm_private *priv = dev->dev_private; |
| struct device_node *node; |
| unsigned long size = 0; |
| int ret = 0; |
| |
| /* In the device-tree world, we could have a 'memory-region' |
| * phandle, which gives us a link to our "vram". Allocating |
| * is all nicely abstracted behind the dma api, but we need |
| * to know the entire size to allocate it all in one go. There |
| * are two cases: |
| * 1) device with no IOMMU, in which case we need exclusive |
| * access to a VRAM carveout big enough for all gpu |
| * buffers |
| * 2) device with IOMMU, but where the bootloader puts up |
| * a splash screen. In this case, the VRAM carveout |
| * need only be large enough for fbdev fb. But we need |
| * exclusive access to the buffer to avoid the kernel |
| * using those pages for other purposes (which appears |
| * as corruption on screen before we have a chance to |
| * load and do initial modeset) |
| */ |
| |
| node = of_parse_phandle(dev->dev->of_node, "memory-region", 0); |
| if (node) { |
| struct resource r; |
| |
| ret = of_address_to_resource(node, 0, &r); |
| |
| of_node_put(node); |
| if (ret) |
| return ret; |
| size = r.end - r.start; |
| DRM_INFO("using VRAM carveout: %lx@%pa\n", size, &r.start); |
| |
| /* if we have no IOMMU, then we need to use carveout allocator. |
| * Grab the entire CMA chunk carved out in early startup in |
| * mach-msm: |
| */ |
| } else if (!iommu_present(&platform_bus_type)) { |
| DRM_INFO("using %s VRAM carveout\n", vram); |
| size = memparse(vram, NULL); |
| } |
| |
| if (size) { |
| unsigned long attrs = 0; |
| void *p; |
| |
| priv->vram.size = size; |
| |
| drm_mm_init(&priv->vram.mm, 0, (size >> PAGE_SHIFT) - 1); |
| |
| attrs |= DMA_ATTR_NO_KERNEL_MAPPING; |
| attrs |= DMA_ATTR_WRITE_COMBINE; |
| |
| /* note that for no-kernel-mapping, the vaddr returned |
| * is bogus, but non-null if allocation succeeded: |
| */ |
| p = dma_alloc_attrs(dev->dev, size, |
| &priv->vram.paddr, GFP_KERNEL, attrs); |
| if (!p) { |
| dev_err(dev->dev, "failed to allocate VRAM\n"); |
| priv->vram.paddr = 0; |
| return -ENOMEM; |
| } |
| |
| dev_info(dev->dev, "VRAM: %08x->%08x\n", |
| (uint32_t)priv->vram.paddr, |
| (uint32_t)(priv->vram.paddr + size)); |
| } |
| |
| return ret; |
| } |
| |
| #ifdef CONFIG_OF |
| static int msm_component_bind_all(struct device *dev, |
| struct drm_device *drm_dev) |
| { |
| int ret; |
| |
| ret = component_bind_all(dev, drm_dev); |
| if (ret) |
| DRM_ERROR("component_bind_all failed: %d\n", ret); |
| |
| return ret; |
| } |
| #else |
| static int msm_component_bind_all(struct device *dev, |
| struct drm_device *drm_dev) |
| { |
| return 0; |
| } |
| #endif |
| |
| static int msm_power_enable_wrapper(void *handle, void *client, bool enable) |
| { |
| return sde_power_resource_enable(handle, client, enable); |
| } |
| |
| static int msm_drm_init(struct device *dev, struct drm_driver *drv) |
| { |
| struct platform_device *pdev = to_platform_device(dev); |
| struct drm_device *ddev; |
| struct msm_drm_private *priv; |
| struct msm_kms *kms; |
| struct sde_dbg_power_ctrl dbg_power_ctrl = { 0 }; |
| int ret, i; |
| |
| ddev = drm_dev_alloc(drv, dev); |
| if (!ddev) { |
| dev_err(dev, "failed to allocate drm_device\n"); |
| return -ENOMEM; |
| } |
| |
| drm_mode_config_init(ddev); |
| platform_set_drvdata(pdev, ddev); |
| ddev->platformdev = pdev; |
| |
| priv = kzalloc(sizeof(*priv), GFP_KERNEL); |
| if (!priv) { |
| ret = -ENOMEM; |
| goto priv_alloc_fail; |
| } |
| |
| ddev->dev_private = priv; |
| priv->dev = ddev; |
| |
| ret = msm_mdss_init(ddev); |
| if (ret) |
| goto mdss_init_fail; |
| |
| priv->wq = alloc_ordered_workqueue("msm_drm", 0); |
| init_waitqueue_head(&priv->pending_crtcs_event); |
| |
| INIT_LIST_HEAD(&priv->client_event_list); |
| INIT_LIST_HEAD(&priv->inactive_list); |
| INIT_LIST_HEAD(&priv->vblank_ctrl.event_list); |
| kthread_init_work(&priv->vblank_ctrl.work, vblank_ctrl_worker); |
| spin_lock_init(&priv->vblank_ctrl.lock); |
| |
| ret = sde_power_resource_init(pdev, &priv->phandle); |
| if (ret) { |
| pr_err("sde power resource init failed\n"); |
| goto power_init_fail; |
| } |
| |
| priv->pclient = sde_power_client_create(&priv->phandle, "sde"); |
| if (IS_ERR_OR_NULL(priv->pclient)) { |
| pr_err("sde power client create failed\n"); |
| ret = -EINVAL; |
| goto power_client_fail; |
| } |
| |
| /* Bind all our sub-components: */ |
| ret = msm_component_bind_all(dev, ddev); |
| if (ret) |
| goto bind_fail; |
| |
| ret = msm_init_vram(ddev); |
| if (ret) |
| goto fail; |
| |
| dbg_power_ctrl.handle = &priv->phandle; |
| dbg_power_ctrl.client = priv->pclient; |
| dbg_power_ctrl.enable_fn = msm_power_enable_wrapper; |
| ret = sde_dbg_init(&pdev->dev, &dbg_power_ctrl); |
| if (ret) { |
| dev_err(dev, "failed to init sde dbg: %d\n", ret); |
| goto fail; |
| } |
| |
| switch (get_mdp_ver(pdev)) { |
| case KMS_MDP4: |
| kms = mdp4_kms_init(ddev); |
| break; |
| case KMS_MDP5: |
| kms = mdp5_kms_init(ddev); |
| break; |
| case KMS_SDE: |
| kms = sde_kms_init(ddev); |
| break; |
| default: |
| kms = ERR_PTR(-ENODEV); |
| break; |
| } |
| |
| if (IS_ERR(kms)) { |
| /* |
| * NOTE: once we have GPU support, having no kms should not |
| * be considered fatal.. ideally we would still support gpu |
| * and (for example) use dmabuf/prime to share buffers with |
| * imx drm driver on iMX5 |
| */ |
| priv->kms = NULL; |
| dev_err(dev, "failed to load kms\n"); |
| ret = PTR_ERR(kms); |
| goto fail; |
| } |
| priv->kms = kms; |
| pm_runtime_enable(dev); |
| |
| if (kms) { |
| ret = kms->funcs->hw_init(kms); |
| if (ret) { |
| dev_err(dev, "kms hw init failed: %d\n", ret); |
| goto fail; |
| } |
| } |
| ddev->mode_config.funcs = &mode_config_funcs; |
| |
| for (i = 0; i < priv->num_crtcs; i++) { |
| priv->disp_thread[i].crtc_id = priv->crtcs[i]->base.id; |
| kthread_init_worker(&priv->disp_thread[i].worker); |
| priv->disp_thread[i].dev = ddev; |
| priv->disp_thread[i].thread = |
| kthread_run(kthread_worker_fn, |
| &priv->disp_thread[i].worker, |
| "crtc_commit:%d", |
| priv->disp_thread[i].crtc_id); |
| |
| if (IS_ERR(priv->disp_thread[i].thread)) { |
| dev_err(dev, "failed to create kthread\n"); |
| priv->disp_thread[i].thread = NULL; |
| /* clean up previously created threads if any */ |
| for (i -= 1; i >= 0; i--) { |
| kthread_stop(priv->disp_thread[i].thread); |
| priv->disp_thread[i].thread = NULL; |
| } |
| goto fail; |
| } |
| } |
| |
| ret = drm_vblank_init(ddev, priv->num_crtcs); |
| if (ret < 0) { |
| dev_err(dev, "failed to initialize vblank\n"); |
| goto fail; |
| } |
| |
| if (kms) { |
| pm_runtime_get_sync(dev); |
| ret = drm_irq_install(ddev, platform_get_irq(pdev, 0)); |
| pm_runtime_put_sync(dev); |
| if (ret < 0) { |
| dev_err(dev, "failed to install IRQ handler\n"); |
| goto fail; |
| } |
| } |
| |
| ret = drm_dev_register(ddev, 0); |
| if (ret) |
| goto fail; |
| priv->registered = true; |
| |
| drm_mode_config_reset(ddev); |
| |
| #ifdef CONFIG_DRM_FBDEV_EMULATION |
| if (fbdev) |
| priv->fbdev = msm_fbdev_init(ddev); |
| #endif |
| |
| ret = msm_debugfs_late_init(ddev); |
| if (ret) |
| goto fail; |
| |
| priv->debug_root = debugfs_create_dir("debug", |
| ddev->primary->debugfs_root); |
| if (IS_ERR_OR_NULL(priv->debug_root)) { |
| pr_err("debugfs_root create_dir fail, error %ld\n", |
| PTR_ERR(priv->debug_root)); |
| priv->debug_root = NULL; |
| goto fail; |
| } |
| |
| ret = sde_dbg_debugfs_register(priv->debug_root); |
| if (ret) { |
| dev_err(dev, "failed to reg sde dbg debugfs: %d\n", ret); |
| goto fail; |
| } |
| |
| /* perform subdriver post initialization */ |
| if (kms && kms->funcs && kms->funcs->postinit) { |
| ret = kms->funcs->postinit(kms); |
| if (ret) { |
| pr_err("kms post init failed: %d\n", ret); |
| goto fail; |
| } |
| } |
| |
| drm_kms_helper_poll_init(ddev); |
| |
| return 0; |
| |
| fail: |
| msm_drm_uninit(dev); |
| return ret; |
| bind_fail: |
| sde_power_client_destroy(&priv->phandle, priv->pclient); |
| power_client_fail: |
| sde_power_resource_deinit(pdev, &priv->phandle); |
| power_init_fail: |
| msm_mdss_destroy(ddev); |
| mdss_init_fail: |
| kfree(priv); |
| priv_alloc_fail: |
| drm_dev_unref(ddev); |
| return ret; |
| } |
| |
| /* |
| * DRM operations: |
| */ |
| |
| #ifdef CONFIG_QCOM_KGSL |
| static void load_gpu(struct drm_device *dev) |
| { |
| } |
| #else |
| static void load_gpu(struct drm_device *dev) |
| { |
| static DEFINE_MUTEX(init_lock); |
| struct msm_drm_private *priv = dev->dev_private; |
| |
| mutex_lock(&init_lock); |
| |
| if (!priv->gpu) |
| priv->gpu = adreno_load_gpu(dev); |
| |
| mutex_unlock(&init_lock); |
| } |
| #endif |
| |
| static int msm_open(struct drm_device *dev, struct drm_file *file) |
| { |
| struct msm_file_private *ctx; |
| |
| /* For now, load gpu on open.. to avoid the requirement of having |
| * firmware in the initrd. |
| */ |
| load_gpu(dev); |
| |
| ctx = kzalloc(sizeof(*ctx), GFP_KERNEL); |
| if (!ctx) |
| return -ENOMEM; |
| |
| file->driver_priv = ctx; |
| |
| if (dev && dev->dev_private) { |
| struct msm_drm_private *priv = dev->dev_private; |
| struct msm_kms *kms; |
| |
| kms = priv->kms; |
| if (kms && kms->funcs && kms->funcs->postopen) |
| kms->funcs->postopen(kms, file); |
| } |
| return 0; |
| } |
| |
| static void msm_preclose(struct drm_device *dev, struct drm_file *file) |
| { |
| struct msm_drm_private *priv = dev->dev_private; |
| struct msm_kms *kms = priv->kms; |
| |
| if (kms && kms->funcs && kms->funcs->preclose) |
| kms->funcs->preclose(kms, file); |
| } |
| |
| static void msm_postclose(struct drm_device *dev, struct drm_file *file) |
| { |
| struct msm_drm_private *priv = dev->dev_private; |
| struct msm_file_private *ctx = file->driver_priv; |
| struct msm_kms *kms = priv->kms; |
| |
| if (kms && kms->funcs && kms->funcs->postclose) |
| kms->funcs->postclose(kms, file); |
| |
| mutex_lock(&dev->struct_mutex); |
| if (ctx == priv->lastctx) |
| priv->lastctx = NULL; |
| mutex_unlock(&dev->struct_mutex); |
| |
| kfree(ctx); |
| } |
| |
| static int msm_disable_all_modes_commit( |
| struct drm_device *dev, |
| struct drm_atomic_state *state) |
| { |
| struct drm_plane *plane; |
| struct drm_crtc *crtc; |
| unsigned int plane_mask; |
| int ret; |
| |
| plane_mask = 0; |
| drm_for_each_plane(plane, dev) { |
| struct drm_plane_state *plane_state; |
| |
| plane_state = drm_atomic_get_plane_state(state, plane); |
| if (IS_ERR(plane_state)) { |
| ret = PTR_ERR(plane_state); |
| goto fail; |
| } |
| |
| plane_state->rotation = 0; |
| |
| plane->old_fb = plane->fb; |
| plane_mask |= 1 << drm_plane_index(plane); |
| |
| /* disable non-primary: */ |
| if (plane->type == DRM_PLANE_TYPE_PRIMARY) |
| continue; |
| |
| DRM_DEBUG("disabling plane %d\n", plane->base.id); |
| |
| ret = __drm_atomic_helper_disable_plane(plane, plane_state); |
| if (ret != 0) |
| DRM_ERROR("error %d disabling plane %d\n", ret, |
| plane->base.id); |
| } |
| |
| drm_for_each_crtc(crtc, dev) { |
| struct drm_mode_set mode_set; |
| |
| memset(&mode_set, 0, sizeof(struct drm_mode_set)); |
| mode_set.crtc = crtc; |
| |
| DRM_DEBUG("disabling crtc %d\n", crtc->base.id); |
| |
| ret = __drm_atomic_helper_set_config(&mode_set, state); |
| if (ret != 0) |
| DRM_ERROR("error %d disabling crtc %d\n", ret, |
| crtc->base.id); |
| } |
| |
| DRM_DEBUG("committing disables\n"); |
| ret = drm_atomic_commit(state); |
| |
| fail: |
| drm_atomic_clean_old_fb(dev, plane_mask, ret); |
| DRM_DEBUG("disables result %d\n", ret); |
| return ret; |
| } |
| |
| /** |
| * msm_clear_all_modes - disables all planes and crtcs via an atomic commit |
| * based on restore_fbdev_mode_atomic in drm_fb_helper.c |
| * @dev: device pointer |
| * @Return: 0 on success, otherwise -error |
| */ |
| static int msm_disable_all_modes(struct drm_device *dev) |
| { |
| struct drm_atomic_state *state; |
| int ret, i; |
| |
| state = drm_atomic_state_alloc(dev); |
| if (!state) |
| return -ENOMEM; |
| |
| state->acquire_ctx = dev->mode_config.acquire_ctx; |
| |
| for (i = 0; i < TEARDOWN_DEADLOCK_RETRY_MAX; i++) { |
| ret = msm_disable_all_modes_commit(dev, state); |
| if (ret != -EDEADLK) |
| break; |
| drm_atomic_state_clear(state); |
| drm_atomic_legacy_backoff(state); |
| } |
| |
| /* on successful atomic commit state ownership transfers to framework */ |
| if (ret != 0) |
| drm_atomic_state_free(state); |
| |
| return ret; |
| } |
| |
| static void msm_lastclose(struct drm_device *dev) |
| { |
| struct msm_drm_private *priv = dev->dev_private; |
| struct msm_kms *kms = priv->kms; |
| int i; |
| |
| /* |
| * clean up vblank disable immediately as this is the last close. |
| */ |
| for (i = 0; i < dev->num_crtcs; i++) { |
| struct drm_vblank_crtc *vblank = &dev->vblank[i]; |
| struct timer_list *disable_timer = &vblank->disable_timer; |
| |
| if (del_timer_sync(disable_timer)) |
| disable_timer->function(disable_timer->data); |
| } |
| |
| /* wait for pending vblank requests to be executed by worker thread */ |
| flush_workqueue(priv->wq); |
| |
| if (priv->fbdev) { |
| drm_fb_helper_restore_fbdev_mode_unlocked(priv->fbdev); |
| } else { |
| drm_modeset_lock_all(dev); |
| msm_disable_all_modes(dev); |
| drm_modeset_unlock_all(dev); |
| if (kms && kms->funcs && kms->funcs->lastclose) |
| kms->funcs->lastclose(kms); |
| } |
| } |
| |
| static irqreturn_t msm_irq(int irq, void *arg) |
| { |
| struct drm_device *dev = arg; |
| struct msm_drm_private *priv = dev->dev_private; |
| struct msm_kms *kms = priv->kms; |
| |
| BUG_ON(!kms); |
| return kms->funcs->irq(kms); |
| } |
| |
| static void msm_irq_preinstall(struct drm_device *dev) |
| { |
| struct msm_drm_private *priv = dev->dev_private; |
| struct msm_kms *kms = priv->kms; |
| |
| BUG_ON(!kms); |
| kms->funcs->irq_preinstall(kms); |
| } |
| |
| static int msm_irq_postinstall(struct drm_device *dev) |
| { |
| struct msm_drm_private *priv = dev->dev_private; |
| struct msm_kms *kms = priv->kms; |
| |
| BUG_ON(!kms); |
| return kms->funcs->irq_postinstall(kms); |
| } |
| |
| static void msm_irq_uninstall(struct drm_device *dev) |
| { |
| struct msm_drm_private *priv = dev->dev_private; |
| struct msm_kms *kms = priv->kms; |
| |
| BUG_ON(!kms); |
| kms->funcs->irq_uninstall(kms); |
| } |
| |
| static int msm_enable_vblank(struct drm_device *dev, unsigned int pipe) |
| { |
| struct msm_drm_private *priv = dev->dev_private; |
| struct msm_kms *kms = priv->kms; |
| |
| if (!kms) |
| return -ENXIO; |
| DBG("dev=%p, crtc=%u", dev, pipe); |
| return vblank_ctrl_queue_work(priv, pipe, true); |
| } |
| |
| static void msm_disable_vblank(struct drm_device *dev, unsigned int pipe) |
| { |
| struct msm_drm_private *priv = dev->dev_private; |
| struct msm_kms *kms = priv->kms; |
| |
| if (!kms) |
| return; |
| DBG("dev=%p, crtc=%u", dev, pipe); |
| vblank_ctrl_queue_work(priv, pipe, false); |
| } |
| |
| /* |
| * DRM ioctls: |
| */ |
| |
| static int msm_ioctl_get_param(struct drm_device *dev, void *data, |
| struct drm_file *file) |
| { |
| struct msm_drm_private *priv = dev->dev_private; |
| struct drm_msm_param *args = data; |
| struct msm_gpu *gpu; |
| |
| /* for now, we just have 3d pipe.. eventually this would need to |
| * be more clever to dispatch to appropriate gpu module: |
| */ |
| if (args->pipe != MSM_PIPE_3D0) |
| return -EINVAL; |
| |
| gpu = priv->gpu; |
| |
| if (!gpu) |
| return -ENXIO; |
| |
| return gpu->funcs->get_param(gpu, args->param, &args->value); |
| } |
| |
| static int msm_ioctl_gem_new(struct drm_device *dev, void *data, |
| struct drm_file *file) |
| { |
| struct drm_msm_gem_new *args = data; |
| |
| if (args->flags & ~MSM_BO_FLAGS) { |
| DRM_ERROR("invalid flags: %08x\n", args->flags); |
| return -EINVAL; |
| } |
| |
| return msm_gem_new_handle(dev, file, args->size, |
| args->flags, &args->handle); |
| } |
| |
| static inline ktime_t to_ktime(struct drm_msm_timespec timeout) |
| { |
| return ktime_set(timeout.tv_sec, timeout.tv_nsec); |
| } |
| |
| static int msm_ioctl_gem_cpu_prep(struct drm_device *dev, void *data, |
| struct drm_file *file) |
| { |
| struct drm_msm_gem_cpu_prep *args = data; |
| struct drm_gem_object *obj; |
| ktime_t timeout = to_ktime(args->timeout); |
| int ret; |
| |
| if (args->op & ~MSM_PREP_FLAGS) { |
| DRM_ERROR("invalid op: %08x\n", args->op); |
| return -EINVAL; |
| } |
| |
| obj = drm_gem_object_lookup(file, args->handle); |
| if (!obj) |
| return -ENOENT; |
| |
| ret = msm_gem_cpu_prep(obj, args->op, &timeout); |
| |
| drm_gem_object_unreference_unlocked(obj); |
| |
| return ret; |
| } |
| |
| static int msm_ioctl_gem_cpu_fini(struct drm_device *dev, void *data, |
| struct drm_file *file) |
| { |
| struct drm_msm_gem_cpu_fini *args = data; |
| struct drm_gem_object *obj; |
| int ret; |
| |
| obj = drm_gem_object_lookup(file, args->handle); |
| if (!obj) |
| return -ENOENT; |
| |
| ret = msm_gem_cpu_fini(obj); |
| |
| drm_gem_object_unreference_unlocked(obj); |
| |
| return ret; |
| } |
| |
| static int msm_ioctl_gem_info(struct drm_device *dev, void *data, |
| struct drm_file *file) |
| { |
| struct drm_msm_gem_info *args = data; |
| struct drm_gem_object *obj; |
| int ret = 0; |
| |
| if (args->pad) |
| return -EINVAL; |
| |
| obj = drm_gem_object_lookup(file, args->handle); |
| if (!obj) |
| return -ENOENT; |
| |
| args->offset = msm_gem_mmap_offset(obj); |
| |
| drm_gem_object_unreference_unlocked(obj); |
| |
| return ret; |
| } |
| |
| static int msm_ioctl_wait_fence(struct drm_device *dev, void *data, |
| struct drm_file *file) |
| { |
| struct msm_drm_private *priv = dev->dev_private; |
| struct drm_msm_wait_fence *args = data; |
| ktime_t timeout = to_ktime(args->timeout); |
| |
| if (args->pad) { |
| DRM_ERROR("invalid pad: %08x\n", args->pad); |
| return -EINVAL; |
| } |
| |
| if (!priv->gpu) |
| return 0; |
| |
| return msm_wait_fence(priv->gpu->fctx, args->fence, &timeout, true); |
| } |
| |
| static int msm_ioctl_gem_madvise(struct drm_device *dev, void *data, |
| struct drm_file *file) |
| { |
| struct drm_msm_gem_madvise *args = data; |
| struct drm_gem_object *obj; |
| int ret; |
| |
| switch (args->madv) { |
| case MSM_MADV_DONTNEED: |
| case MSM_MADV_WILLNEED: |
| break; |
| default: |
| return -EINVAL; |
| } |
| |
| ret = mutex_lock_interruptible(&dev->struct_mutex); |
| if (ret) |
| return ret; |
| |
| obj = drm_gem_object_lookup(file, args->handle); |
| if (!obj) { |
| ret = -ENOENT; |
| goto unlock; |
| } |
| |
| ret = msm_gem_madvise(obj, args->madv); |
| if (ret >= 0) { |
| args->retained = ret; |
| ret = 0; |
| } |
| |
| drm_gem_object_unreference(obj); |
| |
| unlock: |
| mutex_unlock(&dev->struct_mutex); |
| return ret; |
| } |
| |
| static int msm_drm_object_supports_event(struct drm_device *dev, |
| struct drm_msm_event_req *req) |
| { |
| int ret = -EINVAL; |
| struct drm_mode_object *arg_obj; |
| |
| arg_obj = drm_mode_object_find(dev, req->object_id, req->object_type); |
| if (!arg_obj) |
| return -ENOENT; |
| |
| switch (arg_obj->type) { |
| case DRM_MODE_OBJECT_CRTC: |
| case DRM_MODE_OBJECT_CONNECTOR: |
| ret = 0; |
| break; |
| default: |
| ret = -EOPNOTSUPP; |
| break; |
| } |
| |
| return ret; |
| } |
| |
| static int msm_register_event(struct drm_device *dev, |
| struct drm_msm_event_req *req, struct drm_file *file, bool en) |
| { |
| int ret = -EINVAL; |
| struct msm_drm_private *priv = dev->dev_private; |
| struct msm_kms *kms = priv->kms; |
| struct drm_mode_object *arg_obj; |
| |
| arg_obj = drm_mode_object_find(dev, req->object_id, req->object_type); |
| if (!arg_obj) |
| return -ENOENT; |
| |
| ret = kms->funcs->register_events(kms, arg_obj, req->event, en); |
| return ret; |
| } |
| |
| static int msm_event_client_count(struct drm_device *dev, |
| struct drm_msm_event_req *req_event, bool locked) |
| { |
| struct msm_drm_private *priv = dev->dev_private; |
| unsigned long flag = 0; |
| struct msm_drm_event *node; |
| int count = 0; |
| |
| if (!locked) |
| spin_lock_irqsave(&dev->event_lock, flag); |
| list_for_each_entry(node, &priv->client_event_list, base.link) { |
| if (node->event.type == req_event->event && |
| node->info.object_id == req_event->object_id) |
| count++; |
| } |
| if (!locked) |
| spin_unlock_irqrestore(&dev->event_lock, flag); |
| |
| return count; |
| } |
| |
| static int msm_ioctl_register_event(struct drm_device *dev, void *data, |
| struct drm_file *file) |
| { |
| struct msm_drm_private *priv = dev->dev_private; |
| struct drm_msm_event_req *req_event = data; |
| struct msm_drm_event *client, *node; |
| unsigned long flag = 0; |
| bool dup_request = false; |
| int ret = 0, count = 0; |
| |
| ret = msm_drm_object_supports_event(dev, req_event); |
| if (ret) { |
| DRM_ERROR("unsupported event %x object %x object id %d\n", |
| req_event->event, req_event->object_type, |
| req_event->object_id); |
| return ret; |
| } |
| |
| spin_lock_irqsave(&dev->event_lock, flag); |
| list_for_each_entry(node, &priv->client_event_list, base.link) { |
| if (node->base.file_priv != file) |
| continue; |
| if (node->event.type == req_event->event && |
| node->info.object_id == req_event->object_id) { |
| DRM_DEBUG("duplicate request for event %x obj id %d\n", |
| node->event.type, node->info.object_id); |
| dup_request = true; |
| break; |
| } |
| } |
| spin_unlock_irqrestore(&dev->event_lock, flag); |
| |
| if (dup_request) |
| return -EALREADY; |
| |
| client = kzalloc(sizeof(*client), GFP_KERNEL); |
| if (!client) |
| return -ENOMEM; |
| |
| client->base.file_priv = file; |
| client->base.pid = current->pid; |
| client->base.event = &client->event; |
| client->event.type = req_event->event; |
| memcpy(&client->info, req_event, sizeof(client->info)); |
| |
| /* Get the count of clients that have registered for event. |
| * Event should be enabled for first client, for subsequent enable |
| * calls add to client list and return. |
| */ |
| count = msm_event_client_count(dev, req_event, false); |
| /* Add current client to list */ |
| spin_lock_irqsave(&dev->event_lock, flag); |
| list_add_tail(&client->base.link, &priv->client_event_list); |
| spin_unlock_irqrestore(&dev->event_lock, flag); |
| |
| if (count) |
| return 0; |
| |
| ret = msm_register_event(dev, req_event, file, true); |
| if (ret) { |
| DRM_ERROR("failed to enable event %x object %x object id %d\n", |
| req_event->event, req_event->object_type, |
| req_event->object_id); |
| spin_lock_irqsave(&dev->event_lock, flag); |
| list_del(&client->base.link); |
| spin_unlock_irqrestore(&dev->event_lock, flag); |
| kfree(client); |
| } |
| return ret; |
| } |
| |
| static int msm_ioctl_deregister_event(struct drm_device *dev, void *data, |
| struct drm_file *file) |
| { |
| struct msm_drm_private *priv = dev->dev_private; |
| struct drm_msm_event_req *req_event = data; |
| struct msm_drm_event *client = NULL, *node, *temp; |
| unsigned long flag = 0; |
| int count = 0; |
| bool found = false; |
| int ret = 0; |
| |
| ret = msm_drm_object_supports_event(dev, req_event); |
| if (ret) { |
| DRM_ERROR("unsupported event %x object %x object id %d\n", |
| req_event->event, req_event->object_type, |
| req_event->object_id); |
| return ret; |
| } |
| |
| spin_lock_irqsave(&dev->event_lock, flag); |
| list_for_each_entry_safe(node, temp, &priv->client_event_list, |
| base.link) { |
| if (node->event.type == req_event->event && |
| node->info.object_id == req_event->object_id && |
| node->base.file_priv == file) { |
| client = node; |
| list_del(&client->base.link); |
| found = true; |
| kfree(client); |
| break; |
| } |
| } |
| spin_unlock_irqrestore(&dev->event_lock, flag); |
| |
| if (!found) |
| return -ENOENT; |
| |
| count = msm_event_client_count(dev, req_event, false); |
| if (!count) |
| ret = msm_register_event(dev, req_event, file, false); |
| |
| return ret; |
| } |
| |
| void msm_mode_object_event_nofity(struct drm_mode_object *obj, |
| struct drm_device *dev, struct drm_event *event, u8 *payload) |
| { |
| struct msm_drm_private *priv = NULL; |
| unsigned long flags; |
| struct msm_drm_event *notify, *node; |
| int len = 0, ret; |
| |
| if (!obj || !event || !event->length || !payload) { |
| DRM_ERROR("err param obj %pK event %pK len %d payload %pK\n", |
| obj, event, ((event) ? (event->length) : -1), |
| payload); |
| return; |
| } |
| priv = (dev) ? dev->dev_private : NULL; |
| if (!dev || !priv) { |
| DRM_ERROR("invalid dev %pK priv %pK\n", dev, priv); |
| return; |
| } |
| |
| spin_lock_irqsave(&dev->event_lock, flags); |
| list_for_each_entry(node, &priv->client_event_list, base.link) { |
| if (node->event.type != event->type || |
| obj->id != node->info.object_id) |
| continue; |
| len = event->length + sizeof(struct drm_msm_event_resp); |
| if (node->base.file_priv->event_space < len) { |
| DRM_ERROR("Insufficient space to notify\n"); |
| continue; |
| } |
| notify = kzalloc(len, GFP_ATOMIC); |
| if (!notify) |
| continue; |
| notify->base.file_priv = node->base.file_priv; |
| notify->base.event = ¬ify->event; |
| notify->base.pid = node->base.pid; |
| notify->event.type = node->event.type; |
| notify->event.length = len; |
| memcpy(¬ify->info, &node->info, sizeof(notify->info)); |
| memcpy(notify->data, payload, event->length); |
| ret = drm_event_reserve_init_locked(dev, node->base.file_priv, |
| ¬ify->base, ¬ify->event); |
| if (ret) { |
| kfree(notify); |
| continue; |
| } |
| drm_send_event_locked(dev, ¬ify->base); |
| } |
| spin_unlock_irqrestore(&dev->event_lock, flags); |
| } |
| |
| static int msm_release(struct inode *inode, struct file *filp) |
| { |
| struct drm_file *file_priv = filp->private_data; |
| struct drm_minor *minor = file_priv->minor; |
| struct drm_device *dev = minor->dev; |
| struct msm_drm_private *priv = dev->dev_private; |
| struct msm_drm_event *node, *temp; |
| u32 count; |
| unsigned long flags; |
| |
| spin_lock_irqsave(&dev->event_lock, flags); |
| list_for_each_entry_safe(node, temp, &priv->client_event_list, |
| base.link) { |
| if (node->base.file_priv != file_priv) |
| continue; |
| list_del(&node->base.link); |
| spin_unlock_irqrestore(&dev->event_lock, flags); |
| count = msm_event_client_count(dev, &node->info, true); |
| if (!count) |
| msm_register_event(dev, &node->info, file_priv, false); |
| kfree(node); |
| spin_lock_irqsave(&dev->event_lock, flags); |
| } |
| spin_unlock_irqrestore(&dev->event_lock, flags); |
| |
| return drm_release(inode, filp); |
| } |
| |
| /** |
| * msm_drv_framebuffer_remove - remove and unreference a framebuffer object |
| * @fb: framebuffer to remove |
| */ |
| void msm_drv_framebuffer_remove(struct drm_framebuffer *fb) |
| { |
| struct drm_device *dev; |
| |
| if (!fb) |
| return; |
| |
| dev = fb->dev; |
| |
| WARN_ON(!list_empty(&fb->filp_head)); |
| |
| drm_framebuffer_unreference(fb); |
| } |
| |
| struct msm_drv_rmfb2_work { |
| struct work_struct work; |
| struct list_head fbs; |
| }; |
| |
| static void msm_drv_rmfb2_work_fn(struct work_struct *w) |
| { |
| struct msm_drv_rmfb2_work *arg = container_of(w, typeof(*arg), work); |
| |
| while (!list_empty(&arg->fbs)) { |
| struct drm_framebuffer *fb = |
| list_first_entry(&arg->fbs, typeof(*fb), filp_head); |
| |
| list_del_init(&fb->filp_head); |
| msm_drv_framebuffer_remove(fb); |
| } |
| } |
| |
| /** |
| * msm_ioctl_rmfb2 - remove an FB from the configuration |
| * @dev: drm device for the ioctl |
| * @data: data pointer for the ioctl |
| * @file_priv: drm file for the ioctl call |
| * |
| * Remove the FB specified by the user. |
| * |
| * Called by the user via ioctl. |
| * |
| * Returns: |
| * Zero on success, negative errno on failure. |
| */ |
| int msm_ioctl_rmfb2(struct drm_device *dev, void *data, |
| struct drm_file *file_priv) |
| { |
| struct drm_framebuffer *fb = NULL; |
| struct drm_framebuffer *fbl = NULL; |
| uint32_t *id = data; |
| int found = 0; |
| |
| if (!drm_core_check_feature(dev, DRIVER_MODESET)) |
| return -EINVAL; |
| |
| fb = drm_framebuffer_lookup(dev, *id); |
| if (!fb) |
| return -ENOENT; |
| |
| /* drop extra ref from traversing drm_framebuffer_lookup */ |
| drm_framebuffer_unreference(fb); |
| |
| mutex_lock(&file_priv->fbs_lock); |
| list_for_each_entry(fbl, &file_priv->fbs, filp_head) |
| if (fb == fbl) |
| found = 1; |
| if (!found) { |
| mutex_unlock(&file_priv->fbs_lock); |
| return -ENOENT; |
| } |
| |
| list_del_init(&fb->filp_head); |
| mutex_unlock(&file_priv->fbs_lock); |
| |
| /* |
| * we now own the reference that was stored in the fbs list |
| * |
| * drm_framebuffer_remove may fail with -EINTR on pending signals, |
| * so run this in a separate stack as there's no way to correctly |
| * handle this after the fb is already removed from the lookup table. |
| */ |
| if (drm_framebuffer_read_refcount(fb) > 1) { |
| struct msm_drv_rmfb2_work arg; |
| |
| INIT_WORK_ONSTACK(&arg.work, msm_drv_rmfb2_work_fn); |
| INIT_LIST_HEAD(&arg.fbs); |
| list_add_tail(&fb->filp_head, &arg.fbs); |
| |
| schedule_work(&arg.work); |
| flush_work(&arg.work); |
| destroy_work_on_stack(&arg.work); |
| } else |
| drm_framebuffer_unreference(fb); |
| |
| return 0; |
| } |
| EXPORT_SYMBOL(msm_ioctl_rmfb2); |
| |
| static const struct drm_ioctl_desc msm_ioctls[] = { |
| DRM_IOCTL_DEF_DRV(MSM_GET_PARAM, msm_ioctl_get_param, DRM_AUTH|DRM_RENDER_ALLOW), |
| DRM_IOCTL_DEF_DRV(MSM_GEM_NEW, msm_ioctl_gem_new, DRM_AUTH|DRM_RENDER_ALLOW), |
| DRM_IOCTL_DEF_DRV(MSM_GEM_INFO, msm_ioctl_gem_info, DRM_AUTH|DRM_RENDER_ALLOW), |
| DRM_IOCTL_DEF_DRV(MSM_GEM_CPU_PREP, msm_ioctl_gem_cpu_prep, DRM_AUTH|DRM_RENDER_ALLOW), |
| DRM_IOCTL_DEF_DRV(MSM_GEM_CPU_FINI, msm_ioctl_gem_cpu_fini, DRM_AUTH|DRM_RENDER_ALLOW), |
| DRM_IOCTL_DEF_DRV(MSM_GEM_SUBMIT, msm_ioctl_gem_submit, DRM_AUTH|DRM_RENDER_ALLOW), |
| DRM_IOCTL_DEF_DRV(MSM_WAIT_FENCE, msm_ioctl_wait_fence, DRM_AUTH|DRM_RENDER_ALLOW), |
| DRM_IOCTL_DEF_DRV(MSM_GEM_MADVISE, msm_ioctl_gem_madvise, DRM_AUTH|DRM_RENDER_ALLOW), |
| DRM_IOCTL_DEF_DRV(SDE_WB_CONFIG, sde_wb_config, DRM_UNLOCKED|DRM_AUTH), |
| DRM_IOCTL_DEF_DRV(MSM_REGISTER_EVENT, msm_ioctl_register_event, |
| DRM_UNLOCKED|DRM_CONTROL_ALLOW), |
| DRM_IOCTL_DEF_DRV(MSM_DEREGISTER_EVENT, msm_ioctl_deregister_event, |
| DRM_UNLOCKED|DRM_CONTROL_ALLOW), |
| DRM_IOCTL_DEF_DRV(MSM_RMFB2, msm_ioctl_rmfb2, |
| DRM_CONTROL_ALLOW|DRM_UNLOCKED), |
| }; |
| |
| static const struct vm_operations_struct vm_ops = { |
| .fault = msm_gem_fault, |
| .open = drm_gem_vm_open, |
| .close = drm_gem_vm_close, |
| }; |
| |
| static const struct file_operations fops = { |
| .owner = THIS_MODULE, |
| .open = drm_open, |
| .release = msm_release, |
| .unlocked_ioctl = drm_ioctl, |
| #ifdef CONFIG_COMPAT |
| .compat_ioctl = drm_compat_ioctl, |
| #endif |
| .poll = drm_poll, |
| .read = drm_read, |
| .llseek = no_llseek, |
| .mmap = msm_gem_mmap, |
| }; |
| |
| static struct drm_driver msm_driver = { |
| .driver_features = DRIVER_HAVE_IRQ | |
| DRIVER_GEM | |
| DRIVER_PRIME | |
| DRIVER_RENDER | |
| DRIVER_ATOMIC | |
| DRIVER_MODESET, |
| .open = msm_open, |
| .preclose = msm_preclose, |
| .postclose = msm_postclose, |
| .lastclose = msm_lastclose, |
| .irq_handler = msm_irq, |
| .irq_preinstall = msm_irq_preinstall, |
| .irq_postinstall = msm_irq_postinstall, |
| .irq_uninstall = msm_irq_uninstall, |
| .get_vblank_counter = drm_vblank_no_hw_counter, |
| .enable_vblank = msm_enable_vblank, |
| .disable_vblank = msm_disable_vblank, |
| .gem_free_object = msm_gem_free_object, |
| .gem_vm_ops = &vm_ops, |
| .dumb_create = msm_gem_dumb_create, |
| .dumb_map_offset = msm_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_export = drm_gem_prime_export, |
| .gem_prime_import = drm_gem_prime_import, |
| .gem_prime_pin = msm_gem_prime_pin, |
| .gem_prime_unpin = msm_gem_prime_unpin, |
| .gem_prime_get_sg_table = msm_gem_prime_get_sg_table, |
| .gem_prime_import_sg_table = msm_gem_prime_import_sg_table, |
| .gem_prime_vmap = msm_gem_prime_vmap, |
| .gem_prime_vunmap = msm_gem_prime_vunmap, |
| .gem_prime_mmap = msm_gem_prime_mmap, |
| #ifdef CONFIG_DEBUG_FS |
| .debugfs_init = msm_debugfs_init, |
| .debugfs_cleanup = msm_debugfs_cleanup, |
| #endif |
| .ioctls = msm_ioctls, |
| .num_ioctls = ARRAY_SIZE(msm_ioctls), |
| .fops = &fops, |
| .name = "msm_drm", |
| .desc = "MSM Snapdragon DRM", |
| .date = "20130625", |
| .major = MSM_VERSION_MAJOR, |
| .minor = MSM_VERSION_MINOR, |
| .patchlevel = MSM_VERSION_PATCHLEVEL, |
| }; |
| |
| #ifdef CONFIG_PM_SLEEP |
| static int msm_pm_suspend(struct device *dev) |
| { |
| struct drm_device *ddev; |
| struct drm_modeset_acquire_ctx ctx; |
| struct drm_connector *conn; |
| struct drm_atomic_state *state; |
| struct drm_crtc_state *crtc_state; |
| struct msm_drm_private *priv; |
| int ret = 0; |
| |
| if (!dev) |
| return -EINVAL; |
| |
| ddev = dev_get_drvdata(dev); |
| if (!ddev || !ddev->dev_private) |
| return -EINVAL; |
| |
| priv = ddev->dev_private; |
| SDE_EVT32(0); |
| |
| /* acquire modeset lock(s) */ |
| drm_modeset_acquire_init(&ctx, 0); |
| |
| retry: |
| ret = drm_modeset_lock_all_ctx(ddev, &ctx); |
| if (ret) |
| goto unlock; |
| |
| /* save current state for resume */ |
| if (priv->suspend_state) |
| drm_atomic_state_free(priv->suspend_state); |
| priv->suspend_state = drm_atomic_helper_duplicate_state(ddev, &ctx); |
| if (IS_ERR_OR_NULL(priv->suspend_state)) { |
| DRM_ERROR("failed to back up suspend state\n"); |
| priv->suspend_state = NULL; |
| goto unlock; |
| } |
| |
| /* create atomic state to disable all CRTCs */ |
| state = drm_atomic_state_alloc(ddev); |
| if (IS_ERR_OR_NULL(state)) { |
| DRM_ERROR("failed to allocate crtc disable state\n"); |
| goto unlock; |
| } |
| |
| state->acquire_ctx = &ctx; |
| drm_for_each_connector(conn, ddev) { |
| |
| if (!conn->state || !conn->state->crtc || |
| conn->dpms != DRM_MODE_DPMS_ON) |
| continue; |
| |
| /* force CRTC to be inactive */ |
| crtc_state = drm_atomic_get_crtc_state(state, |
| conn->state->crtc); |
| if (IS_ERR_OR_NULL(crtc_state)) { |
| DRM_ERROR("failed to get crtc %d state\n", |
| conn->state->crtc->base.id); |
| drm_atomic_state_free(state); |
| goto unlock; |
| } |
| crtc_state->active = false; |
| } |
| |
| /* commit the "disable all" state */ |
| ret = drm_atomic_commit(state); |
| if (ret < 0) { |
| DRM_ERROR("failed to disable crtcs, %d\n", ret); |
| drm_atomic_state_free(state); |
| } else { |
| priv->suspend_block = true; |
| } |
| |
| unlock: |
| if (ret == -EDEADLK) { |
| drm_modeset_backoff(&ctx); |
| goto retry; |
| } |
| drm_modeset_drop_locks(&ctx); |
| drm_modeset_acquire_fini(&ctx); |
| |
| /* disable hot-plug polling */ |
| drm_kms_helper_poll_disable(ddev); |
| |
| return 0; |
| } |
| |
| static int msm_pm_resume(struct device *dev) |
| { |
| struct drm_device *ddev; |
| struct msm_drm_private *priv; |
| int ret; |
| |
| if (!dev) |
| return -EINVAL; |
| |
| ddev = dev_get_drvdata(dev); |
| if (!ddev || !ddev->dev_private) |
| return -EINVAL; |
| |
| priv = ddev->dev_private; |
| |
| SDE_EVT32(priv->suspend_state != NULL); |
| |
| drm_mode_config_reset(ddev); |
| |
| drm_modeset_lock_all(ddev); |
| |
| priv->suspend_block = false; |
| |
| if (priv->suspend_state) { |
| priv->suspend_state->acquire_ctx = |
| ddev->mode_config.acquire_ctx; |
| ret = drm_atomic_commit(priv->suspend_state); |
| if (ret < 0) { |
| DRM_ERROR("failed to restore state, %d\n", ret); |
| drm_atomic_state_free(priv->suspend_state); |
| } |
| priv->suspend_state = NULL; |
| } |
| drm_modeset_unlock_all(ddev); |
| |
| /* enable hot-plug polling */ |
| drm_kms_helper_poll_enable(ddev); |
| |
| return 0; |
| } |
| #endif |
| |
| static const struct dev_pm_ops msm_pm_ops = { |
| SET_SYSTEM_SLEEP_PM_OPS(msm_pm_suspend, msm_pm_resume) |
| }; |
| |
| /* |
| * Componentized driver support: |
| */ |
| |
| /* |
| * NOTE: duplication of the same code as exynos or imx (or probably any other). |
| * so probably some room for some helpers |
| */ |
| static int compare_of(struct device *dev, void *data) |
| { |
| return dev->of_node == data; |
| } |
| |
| /* |
| * Identify what components need to be added by parsing what remote-endpoints |
| * our MDP output ports are connected to. In the case of LVDS on MDP4, there |
| * is no external component that we need to add since LVDS is within MDP4 |
| * itself. |
| */ |
| static int add_components_mdp(struct device *mdp_dev, |
| struct component_match **matchptr) |
| { |
| struct device_node *np = mdp_dev->of_node; |
| struct device_node *ep_node; |
| struct device *master_dev; |
| |
| /* |
| * on MDP4 based platforms, the MDP platform device is the component |
| * master that adds other display interface components to itself. |
| * |
| * on MDP5 based platforms, the MDSS platform device is the component |
| * master that adds MDP5 and other display interface components to |
| * itself. |
| */ |
| if (of_device_is_compatible(np, "qcom,mdp4")) |
| master_dev = mdp_dev; |
| else |
| master_dev = mdp_dev->parent; |
| |
| for_each_endpoint_of_node(np, ep_node) { |
| struct device_node *intf; |
| struct of_endpoint ep; |
| int ret; |
| |
| ret = of_graph_parse_endpoint(ep_node, &ep); |
| if (ret) { |
| dev_err(mdp_dev, "unable to parse port endpoint\n"); |
| of_node_put(ep_node); |
| return ret; |
| } |
| |
| /* |
| * The LCDC/LVDS port on MDP4 is a speacial case where the |
| * remote-endpoint isn't a component that we need to add |
| */ |
| if (of_device_is_compatible(np, "qcom,mdp4") && |
| ep.port == 0) { |
| of_node_put(ep_node); |
| continue; |
| } |
| |
| /* |
| * It's okay if some of the ports don't have a remote endpoint |
| * specified. It just means that the port isn't connected to |
| * any external interface. |
| */ |
| intf = of_graph_get_remote_port_parent(ep_node); |
| if (!intf) { |
| of_node_put(ep_node); |
| continue; |
| } |
| |
| component_match_add(master_dev, matchptr, compare_of, intf); |
| |
| of_node_put(intf); |
| of_node_put(ep_node); |
| } |
| |
| return 0; |
| } |
| |
| static int compare_name_mdp(struct device *dev, void *data) |
| { |
| return (strnstr(dev_name(dev), "mdp", strlen("mdp")) != NULL); |
| } |
| |
| static int add_display_components(struct device *dev, |
| struct component_match **matchptr) |
| { |
| struct device *mdp_dev = NULL; |
| struct device_node *node; |
| const char *name; |
| int ret; |
| |
| if (of_device_is_compatible(dev->of_node, "qcom,sde-kms")) { |
| struct device_node *np = dev->of_node; |
| unsigned int i; |
| |
| for (i = 0; i < MAX_DSI_ACTIVE_DISPLAY; i++) { |
| node = dsi_display_get_boot_display(i); |
| |
| if (node != NULL) { |
| name = of_get_property(node, "label", NULL); |
| component_match_add(dev, matchptr, compare_of, |
| node); |
| pr_debug("Added component = %s\n", name); |
| } |
| } |
| |
| for (i = 0; ; i++) { |
| node = of_parse_phandle(np, "connectors", i); |
| if (!node) |
| break; |
| |
| component_match_add(dev, matchptr, compare_of, node); |
| } |
| return 0; |
| } |
| |
| /* |
| * MDP5 based devices don't have a flat hierarchy. There is a top level |
| * parent: MDSS, and children: MDP5, DSI, HDMI, eDP etc. Populate the |
| * children devices, find the MDP5 node, and then add the interfaces |
| * to our components list. |
| */ |
| if (of_device_is_compatible(dev->of_node, "qcom,mdss")) { |
| ret = of_platform_populate(dev->of_node, NULL, NULL, dev); |
| if (ret) { |
| dev_err(dev, "failed to populate children devices\n"); |
| return ret; |
| } |
| |
| mdp_dev = device_find_child(dev, NULL, compare_name_mdp); |
| if (!mdp_dev) { |
| dev_err(dev, "failed to find MDSS MDP node\n"); |
| of_platform_depopulate(dev); |
| return -ENODEV; |
| } |
| |
| put_device(mdp_dev); |
| |
| /* add the MDP component itself */ |
| component_match_add(dev, matchptr, compare_of, |
| mdp_dev->of_node); |
| } else { |
| /* MDP4 */ |
| mdp_dev = dev; |
| } |
| |
| ret = add_components_mdp(mdp_dev, matchptr); |
| if (ret) |
| of_platform_depopulate(dev); |
| |
| return ret; |
| } |
| |
| /* |
| * We don't know what's the best binding to link the gpu with the drm device. |
| * Fow now, we just hunt for all the possible gpus that we support, and add them |
| * as components. |
| */ |
| static const struct of_device_id msm_gpu_match[] = { |
| { .compatible = "qcom,adreno-3xx" }, |
| { .compatible = "qcom,kgsl-3d0" }, |
| { }, |
| }; |
| |
| #ifdef CONFIG_QCOM_KGSL |
| static int add_gpu_components(struct device *dev, |
| struct component_match **matchptr) |
| { |
| return 0; |
| } |
| #else |
| static int add_gpu_components(struct device *dev, |
| struct component_match **matchptr) |
| { |
| struct device_node *np; |
| |
| np = of_find_matching_node(NULL, msm_gpu_match); |
| if (!np) |
| return 0; |
| |
| component_match_add(dev, matchptr, compare_of, np); |
| |
| of_node_put(np); |
| |
| return 0; |
| } |
| #endif |
| |
| static int msm_drm_bind(struct device *dev) |
| { |
| return msm_drm_init(dev, &msm_driver); |
| } |
| |
| static void msm_drm_unbind(struct device *dev) |
| { |
| msm_drm_uninit(dev); |
| } |
| |
| static const struct component_master_ops msm_drm_ops = { |
| .bind = msm_drm_bind, |
| .unbind = msm_drm_unbind, |
| }; |
| |
| /* |
| * Platform driver: |
| */ |
| |
| static int msm_pdev_probe(struct platform_device *pdev) |
| { |
| int ret; |
| struct component_match *match = NULL; |
| |
| ret = add_display_components(&pdev->dev, &match); |
| if (ret) |
| return ret; |
| |
| ret = add_gpu_components(&pdev->dev, &match); |
| if (ret) |
| return ret; |
| |
| pdev->dev.coherent_dma_mask = DMA_BIT_MASK(32); |
| return component_master_add_with_match(&pdev->dev, &msm_drm_ops, match); |
| } |
| |
| static int msm_pdev_remove(struct platform_device *pdev) |
| { |
| component_master_del(&pdev->dev, &msm_drm_ops); |
| of_platform_depopulate(&pdev->dev); |
| |
| msm_drm_unbind(&pdev->dev); |
| return 0; |
| } |
| |
| static const struct of_device_id dt_match[] = { |
| { .compatible = "qcom,mdp4", .data = (void *)4 }, /* MDP4 */ |
| { .compatible = "qcom,mdss", .data = (void *)5 }, /* MDP5 MDSS */ |
| { .compatible = "qcom,sde-kms", .data = (void *)3 }, /* sde */ |
| {} |
| }; |
| MODULE_DEVICE_TABLE(of, dt_match); |
| |
| static struct platform_driver msm_platform_driver = { |
| .probe = msm_pdev_probe, |
| .remove = msm_pdev_remove, |
| .driver = { |
| .name = "msm_drm", |
| .of_match_table = dt_match, |
| .pm = &msm_pm_ops, |
| }, |
| }; |
| |
| #ifdef CONFIG_QCOM_KGSL |
| void __init adreno_register(void) |
| { |
| } |
| |
| void __exit adreno_unregister(void) |
| { |
| } |
| #endif |
| |
| static int __init msm_drm_register(void) |
| { |
| DBG("init"); |
| msm_dsi_register(); |
| msm_edp_register(); |
| msm_hdmi_register(); |
| adreno_register(); |
| return platform_driver_register(&msm_platform_driver); |
| } |
| |
| static void __exit msm_drm_unregister(void) |
| { |
| DBG("fini"); |
| platform_driver_unregister(&msm_platform_driver); |
| msm_hdmi_unregister(); |
| adreno_unregister(); |
| msm_edp_unregister(); |
| msm_dsi_unregister(); |
| } |
| |
| module_init(msm_drm_register); |
| module_exit(msm_drm_unregister); |
| |
| MODULE_AUTHOR("Rob Clark <robdclark@gmail.com"); |
| MODULE_DESCRIPTION("MSM DRM Driver"); |
| MODULE_LICENSE("GPL"); |