11ccea77eSThomas Gleixner // SPDX-License-Identifier: GPL-2.0-or-later 2bbbe775eSNeil Armstrong /* 3bbbe775eSNeil Armstrong * Copyright (C) 2016 BayLibre, SAS 4bbbe775eSNeil Armstrong * Author: Neil Armstrong <narmstrong@baylibre.com> 5bbbe775eSNeil Armstrong * Copyright (C) 2014 Endless Mobile 6bbbe775eSNeil Armstrong * 7bbbe775eSNeil Armstrong * Written by: 8bbbe775eSNeil Armstrong * Jasper St. Pierre <jstpierre@mecheye.net> 9bbbe775eSNeil Armstrong */ 10bbbe775eSNeil Armstrong 11a41e82e6SNeil Armstrong #include <linux/component.h> 1266620f48SSam Ravnborg #include <linux/module.h> 13bbbe775eSNeil Armstrong #include <linux/of_graph.h> 148976eeeeSNeil Armstrong #include <linux/sys_soc.h> 1566620f48SSam Ravnborg #include <linux/platform_device.h> 1666620f48SSam Ravnborg #include <linux/soc/amlogic/meson-canvas.h> 17bbbe775eSNeil Armstrong 186848c291SThomas Zimmermann #include <drm/drm_aperture.h> 19bbbe775eSNeil Armstrong #include <drm/drm_atomic_helper.h> 2066620f48SSam Ravnborg #include <drm/drm_drv.h> 21fcd70cd3SDaniel Vetter #include <drm/drm_fb_helper.h> 22bbbe775eSNeil Armstrong #include <drm/drm_gem_cma_helper.h> 2324ef8157SNoralf Trønnes #include <drm/drm_gem_framebuffer_helper.h> 2466620f48SSam Ravnborg #include <drm/drm_modeset_helper_vtables.h> 25fcd70cd3SDaniel Vetter #include <drm/drm_probe_helper.h> 2666620f48SSam Ravnborg #include <drm/drm_vblank.h> 27bbbe775eSNeil Armstrong 28bbbe775eSNeil Armstrong #include "meson_crtc.h" 2966620f48SSam Ravnborg #include "meson_drv.h" 3066620f48SSam Ravnborg #include "meson_overlay.h" 3166620f48SSam Ravnborg #include "meson_plane.h" 32d1b5e41eSNeil Armstrong #include "meson_osd_afbcd.h" 33bbbe775eSNeil Armstrong #include "meson_registers.h" 3466620f48SSam Ravnborg #include "meson_venc_cvbs.h" 3566620f48SSam Ravnborg #include "meson_viu.h" 3666620f48SSam Ravnborg #include "meson_vpp.h" 37d1b5e41eSNeil Armstrong #include "meson_rdma.h" 38bbbe775eSNeil Armstrong 39bbbe775eSNeil Armstrong #define DRIVER_NAME "meson" 40bbbe775eSNeil Armstrong #define DRIVER_DESC "Amlogic Meson DRM driver" 41bbbe775eSNeil Armstrong 422021d5b7SNeil Armstrong /** 432021d5b7SNeil Armstrong * DOC: Video Processing Unit 44bbbe775eSNeil Armstrong * 45bbbe775eSNeil Armstrong * VPU Handles the Global Video Processing, it includes management of the 46bbbe775eSNeil Armstrong * clocks gates, blocks reset lines and power domains. 47bbbe775eSNeil Armstrong * 48bbbe775eSNeil Armstrong * What is missing : 492021d5b7SNeil Armstrong * 50bbbe775eSNeil Armstrong * - Full reset of entire video processing HW blocks 51bbbe775eSNeil Armstrong * - Scaling and setup of the VPU clock 52bbbe775eSNeil Armstrong * - Bus clock gates 53bbbe775eSNeil Armstrong * - Powering up video processing HW blocks 54bbbe775eSNeil Armstrong * - Powering Up HDMI controller and PHY 55bbbe775eSNeil Armstrong */ 56bbbe775eSNeil Armstrong 57bbbe775eSNeil Armstrong static const struct drm_mode_config_funcs meson_mode_config_funcs = { 58bbbe775eSNeil Armstrong .atomic_check = drm_atomic_helper_check, 59bbbe775eSNeil Armstrong .atomic_commit = drm_atomic_helper_commit, 6024ef8157SNoralf Trønnes .fb_create = drm_gem_fb_create, 61bbbe775eSNeil Armstrong }; 62bbbe775eSNeil Armstrong 63ce0210c1SNeil Armstrong static const struct drm_mode_config_helper_funcs meson_mode_config_helpers = { 64ce0210c1SNeil Armstrong .atomic_commit_tail = drm_atomic_helper_commit_tail_rpm, 65ce0210c1SNeil Armstrong }; 66ce0210c1SNeil Armstrong 67bbbe775eSNeil Armstrong static irqreturn_t meson_irq(int irq, void *arg) 68bbbe775eSNeil Armstrong { 69bbbe775eSNeil Armstrong struct drm_device *dev = arg; 70bbbe775eSNeil Armstrong struct meson_drm *priv = dev->dev_private; 71bbbe775eSNeil Armstrong 72bbbe775eSNeil Armstrong (void)readl_relaxed(priv->io_base + _REG(VENC_INTFLAG)); 73bbbe775eSNeil Armstrong 74bbbe775eSNeil Armstrong meson_crtc_irq(priv); 75bbbe775eSNeil Armstrong 76bbbe775eSNeil Armstrong return IRQ_HANDLED; 77bbbe775eSNeil Armstrong } 78bbbe775eSNeil Armstrong 79852ce728SNeil Armstrong static int meson_dumb_create(struct drm_file *file, struct drm_device *dev, 80852ce728SNeil Armstrong struct drm_mode_create_dumb *args) 81852ce728SNeil Armstrong { 82852ce728SNeil Armstrong /* 83852ce728SNeil Armstrong * We need 64bytes aligned stride, and PAGE aligned size 84852ce728SNeil Armstrong */ 85852ce728SNeil Armstrong args->pitch = ALIGN(DIV_ROUND_UP(args->width * args->bpp, 8), SZ_64); 86852ce728SNeil Armstrong args->size = PAGE_ALIGN(args->pitch * args->height); 87852ce728SNeil Armstrong 88852ce728SNeil Armstrong return drm_gem_cma_dumb_create_internal(file, dev, args); 89852ce728SNeil Armstrong } 90852ce728SNeil Armstrong 91d55f7e5dSDaniel Vetter DEFINE_DRM_GEM_CMA_FOPS(fops); 92bbbe775eSNeil Armstrong 9370a59dd8SDaniel Vetter static const struct drm_driver meson_driver = { 940424fdafSDaniel Vetter .driver_features = DRIVER_GEM | DRIVER_MODESET | DRIVER_ATOMIC, 95bbbe775eSNeil Armstrong 96b54d830cSThomas Zimmermann /* CMA Ops */ 97b54d830cSThomas Zimmermann DRM_GEM_CMA_DRIVER_OPS_WITH_DUMB_CREATE(meson_dumb_create), 98bbbe775eSNeil Armstrong 99bbbe775eSNeil Armstrong /* Misc */ 100bbbe775eSNeil Armstrong .fops = &fops, 101bbbe775eSNeil Armstrong .name = DRIVER_NAME, 102bbbe775eSNeil Armstrong .desc = DRIVER_DESC, 103bbbe775eSNeil Armstrong .date = "20161109", 104bbbe775eSNeil Armstrong .major = 1, 105bbbe775eSNeil Armstrong .minor = 0, 106bbbe775eSNeil Armstrong }; 107bbbe775eSNeil Armstrong 108bbbe775eSNeil Armstrong static bool meson_vpu_has_available_connectors(struct device *dev) 109bbbe775eSNeil Armstrong { 110bbbe775eSNeil Armstrong struct device_node *ep, *remote; 111bbbe775eSNeil Armstrong 112bbbe775eSNeil Armstrong /* Parses each endpoint and check if remote exists */ 113bbbe775eSNeil Armstrong for_each_endpoint_of_node(dev->of_node, ep) { 114bbbe775eSNeil Armstrong /* If the endpoint node exists, consider it enabled */ 115bbbe775eSNeil Armstrong remote = of_graph_get_remote_port(ep); 116bbbe775eSNeil Armstrong if (remote) 117bbbe775eSNeil Armstrong return true; 118bbbe775eSNeil Armstrong } 119bbbe775eSNeil Armstrong 120bbbe775eSNeil Armstrong return false; 121bbbe775eSNeil Armstrong } 122bbbe775eSNeil Armstrong 123bbbe775eSNeil Armstrong static struct regmap_config meson_regmap_config = { 124bbbe775eSNeil Armstrong .reg_bits = 32, 125bbbe775eSNeil Armstrong .val_bits = 32, 126bbbe775eSNeil Armstrong .reg_stride = 4, 127bbbe775eSNeil Armstrong .max_register = 0x1000, 128bbbe775eSNeil Armstrong }; 129bbbe775eSNeil Armstrong 13009762525SNeil Armstrong static void meson_vpu_init(struct meson_drm *priv) 13109762525SNeil Armstrong { 132bfb86819SJulien Masson u32 value; 133bfb86819SJulien Masson 134bfb86819SJulien Masson /* 135bfb86819SJulien Masson * Slave dc0 and dc5 connected to master port 1. 136bfb86819SJulien Masson * By default other slaves are connected to master port 0. 137bfb86819SJulien Masson */ 138bfb86819SJulien Masson value = VPU_RDARB_SLAVE_TO_MASTER_PORT(0, 1) | 139bfb86819SJulien Masson VPU_RDARB_SLAVE_TO_MASTER_PORT(5, 1); 140bfb86819SJulien Masson writel_relaxed(value, priv->io_base + _REG(VPU_RDARB_MODE_L1C1)); 141bfb86819SJulien Masson 142bfb86819SJulien Masson /* Slave dc0 connected to master port 1 */ 143bfb86819SJulien Masson value = VPU_RDARB_SLAVE_TO_MASTER_PORT(0, 1); 144bfb86819SJulien Masson writel_relaxed(value, priv->io_base + _REG(VPU_RDARB_MODE_L1C2)); 145bfb86819SJulien Masson 146bfb86819SJulien Masson /* Slave dc4 and dc7 connected to master port 1 */ 147bfb86819SJulien Masson value = VPU_RDARB_SLAVE_TO_MASTER_PORT(4, 1) | 148bfb86819SJulien Masson VPU_RDARB_SLAVE_TO_MASTER_PORT(7, 1); 149bfb86819SJulien Masson writel_relaxed(value, priv->io_base + _REG(VPU_RDARB_MODE_L2C1)); 150bfb86819SJulien Masson 151bfb86819SJulien Masson /* Slave dc1 connected to master port 1 */ 152bfb86819SJulien Masson value = VPU_RDARB_SLAVE_TO_MASTER_PORT(1, 1); 153bfb86819SJulien Masson writel_relaxed(value, priv->io_base + _REG(VPU_WRARB_MODE_L2C1)); 15409762525SNeil Armstrong } 15509762525SNeil Armstrong 1568976eeeeSNeil Armstrong struct meson_drm_soc_attr { 1578976eeeeSNeil Armstrong struct meson_drm_soc_limits limits; 1588976eeeeSNeil Armstrong const struct soc_device_attribute *attrs; 1598976eeeeSNeil Armstrong }; 1608976eeeeSNeil Armstrong 1618976eeeeSNeil Armstrong static const struct meson_drm_soc_attr meson_drm_soc_attrs[] = { 1628976eeeeSNeil Armstrong /* S805X/S805Y HDMI PLL won't lock for HDMI PHY freq > 1,65GHz */ 1638976eeeeSNeil Armstrong { 1648976eeeeSNeil Armstrong .limits = { 1658976eeeeSNeil Armstrong .max_hdmi_phy_freq = 1650000, 1668976eeeeSNeil Armstrong }, 1678976eeeeSNeil Armstrong .attrs = (const struct soc_device_attribute []) { 1688976eeeeSNeil Armstrong { .soc_id = "GXL (S805*)", }, 1698976eeeeSNeil Armstrong { /* sentinel */ }, 1708976eeeeSNeil Armstrong } 1718976eeeeSNeil Armstrong }, 1728976eeeeSNeil Armstrong }; 1738976eeeeSNeil Armstrong 1748604889fSNeil Armstrong static int meson_drv_bind_master(struct device *dev, bool has_components) 175bbbe775eSNeil Armstrong { 176a41e82e6SNeil Armstrong struct platform_device *pdev = to_platform_device(dev); 177d1b5e41eSNeil Armstrong const struct meson_drm_match_data *match; 178bbbe775eSNeil Armstrong struct meson_drm *priv; 179bbbe775eSNeil Armstrong struct drm_device *drm; 180bbbe775eSNeil Armstrong struct resource *res; 181bbbe775eSNeil Armstrong void __iomem *regs; 1828976eeeeSNeil Armstrong int ret, i; 183bbbe775eSNeil Armstrong 184bbbe775eSNeil Armstrong /* Checks if an output connector is available */ 185bbbe775eSNeil Armstrong if (!meson_vpu_has_available_connectors(dev)) { 186bbbe775eSNeil Armstrong dev_err(dev, "No output connector available\n"); 187bbbe775eSNeil Armstrong return -ENODEV; 188bbbe775eSNeil Armstrong } 189bbbe775eSNeil Armstrong 190d1b5e41eSNeil Armstrong match = of_device_get_match_data(dev); 191d1b5e41eSNeil Armstrong if (!match) 192d1b5e41eSNeil Armstrong return -ENODEV; 193d1b5e41eSNeil Armstrong 194bbbe775eSNeil Armstrong drm = drm_dev_alloc(&meson_driver, dev); 195bbbe775eSNeil Armstrong if (IS_ERR(drm)) 196bbbe775eSNeil Armstrong return PTR_ERR(drm); 197bbbe775eSNeil Armstrong 198bbbe775eSNeil Armstrong priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL); 199bbbe775eSNeil Armstrong if (!priv) { 200bbbe775eSNeil Armstrong ret = -ENOMEM; 201bbbe775eSNeil Armstrong goto free_drm; 202bbbe775eSNeil Armstrong } 203bbbe775eSNeil Armstrong drm->dev_private = priv; 204bbbe775eSNeil Armstrong priv->drm = drm; 205bbbe775eSNeil Armstrong priv->dev = dev; 206d1b5e41eSNeil Armstrong priv->compat = match->compat; 207d1b5e41eSNeil Armstrong priv->afbcd.ops = match->afbcd_ops; 208528a25d0SJulien Masson 209*d4cb82aaSCai Huoqing regs = devm_platform_ioremap_resource_byname(pdev, "vpu"); 2102c18107bSChristophe JAILLET if (IS_ERR(regs)) { 2112c18107bSChristophe JAILLET ret = PTR_ERR(regs); 2122c18107bSChristophe JAILLET goto free_drm; 2132c18107bSChristophe JAILLET } 214bbbe775eSNeil Armstrong 215bbbe775eSNeil Armstrong priv->io_base = regs; 216bbbe775eSNeil Armstrong 217bbbe775eSNeil Armstrong res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "hhi"); 21801a9e949SChristophe JAILLET if (!res) { 21901a9e949SChristophe JAILLET ret = -EINVAL; 22001a9e949SChristophe JAILLET goto free_drm; 22101a9e949SChristophe JAILLET } 222bbbe775eSNeil Armstrong /* Simply ioremap since it may be a shared register zone */ 223bbbe775eSNeil Armstrong regs = devm_ioremap(dev, res->start, resource_size(res)); 2242c18107bSChristophe JAILLET if (!regs) { 2252c18107bSChristophe JAILLET ret = -EADDRNOTAVAIL; 2262c18107bSChristophe JAILLET goto free_drm; 2272c18107bSChristophe JAILLET } 228bbbe775eSNeil Armstrong 229bbbe775eSNeil Armstrong priv->hhi = devm_regmap_init_mmio(dev, regs, 230bbbe775eSNeil Armstrong &meson_regmap_config); 231bbbe775eSNeil Armstrong if (IS_ERR(priv->hhi)) { 232bbbe775eSNeil Armstrong dev_err(&pdev->dev, "Couldn't create the HHI regmap\n"); 2332c18107bSChristophe JAILLET ret = PTR_ERR(priv->hhi); 2342c18107bSChristophe JAILLET goto free_drm; 235bbbe775eSNeil Armstrong } 236bbbe775eSNeil Armstrong 23766cae477SMaxime Jourdan priv->canvas = meson_canvas_get(dev); 2382bf6b5b0SMaxime Jourdan if (IS_ERR(priv->canvas)) { 2392bf6b5b0SMaxime Jourdan ret = PTR_ERR(priv->canvas); 2402bf6b5b0SMaxime Jourdan goto free_drm; 2412bf6b5b0SMaxime Jourdan } 2422bf6b5b0SMaxime Jourdan 24366cae477SMaxime Jourdan ret = meson_canvas_alloc(priv->canvas, &priv->canvas_id_osd1); 24466cae477SMaxime Jourdan if (ret) 24566cae477SMaxime Jourdan goto free_drm; 246f9a23481SNeil Armstrong ret = meson_canvas_alloc(priv->canvas, &priv->canvas_id_vd1_0); 247f9a23481SNeil Armstrong if (ret) { 248f9a23481SNeil Armstrong meson_canvas_free(priv->canvas, priv->canvas_id_osd1); 249f9a23481SNeil Armstrong goto free_drm; 250f9a23481SNeil Armstrong } 251f9a23481SNeil Armstrong ret = meson_canvas_alloc(priv->canvas, &priv->canvas_id_vd1_1); 252f9a23481SNeil Armstrong if (ret) { 253f9a23481SNeil Armstrong meson_canvas_free(priv->canvas, priv->canvas_id_osd1); 254f9a23481SNeil Armstrong meson_canvas_free(priv->canvas, priv->canvas_id_vd1_0); 255f9a23481SNeil Armstrong goto free_drm; 256f9a23481SNeil Armstrong } 257f9a23481SNeil Armstrong ret = meson_canvas_alloc(priv->canvas, &priv->canvas_id_vd1_2); 258f9a23481SNeil Armstrong if (ret) { 259f9a23481SNeil Armstrong meson_canvas_free(priv->canvas, priv->canvas_id_osd1); 260f9a23481SNeil Armstrong meson_canvas_free(priv->canvas, priv->canvas_id_vd1_0); 261f9a23481SNeil Armstrong meson_canvas_free(priv->canvas, priv->canvas_id_vd1_1); 262f9a23481SNeil Armstrong goto free_drm; 263f9a23481SNeil Armstrong } 264bbbe775eSNeil Armstrong 265bbbe775eSNeil Armstrong priv->vsync_irq = platform_get_irq(pdev, 0); 266bbbe775eSNeil Armstrong 267e770f6bfSChristophe JAILLET ret = drm_vblank_init(drm, 1); 268e770f6bfSChristophe JAILLET if (ret) 269e770f6bfSChristophe JAILLET goto free_drm; 270e770f6bfSChristophe JAILLET 2718976eeeeSNeil Armstrong /* Assign limits per soc revision/package */ 2728976eeeeSNeil Armstrong for (i = 0 ; i < ARRAY_SIZE(meson_drm_soc_attrs) ; ++i) { 2738976eeeeSNeil Armstrong if (soc_device_match(meson_drm_soc_attrs[i].attrs)) { 2748976eeeeSNeil Armstrong priv->limits = &meson_drm_soc_attrs[i].limits; 2758976eeeeSNeil Armstrong break; 2768976eeeeSNeil Armstrong } 2778976eeeeSNeil Armstrong } 2788976eeeeSNeil Armstrong 2796848c291SThomas Zimmermann /* 2806848c291SThomas Zimmermann * Remove early framebuffers (ie. simplefb). The framebuffer can be 2816848c291SThomas Zimmermann * located anywhere in RAM 2826848c291SThomas Zimmermann */ 28397c9bfe3SThomas Zimmermann ret = drm_aperture_remove_framebuffers(false, &meson_driver); 2846848c291SThomas Zimmermann if (ret) 2856848c291SThomas Zimmermann goto free_drm; 286e3de0aa6SMaxime Jourdan 287bd9ff7b5SDaniel Vetter ret = drmm_mode_config_init(drm); 288bd9ff7b5SDaniel Vetter if (ret) 289bd9ff7b5SDaniel Vetter goto free_drm; 290a41e82e6SNeil Armstrong drm->mode_config.max_width = 3840; 291a41e82e6SNeil Armstrong drm->mode_config.max_height = 2160; 292a41e82e6SNeil Armstrong drm->mode_config.funcs = &meson_mode_config_funcs; 293ce0210c1SNeil Armstrong drm->mode_config.helper_private = &meson_mode_config_helpers; 294a41e82e6SNeil Armstrong 295a41e82e6SNeil Armstrong /* Hardware Initialization */ 296a41e82e6SNeil Armstrong 29709762525SNeil Armstrong meson_vpu_init(priv); 298a41e82e6SNeil Armstrong meson_venc_init(priv); 299a41e82e6SNeil Armstrong meson_vpp_init(priv); 300a41e82e6SNeil Armstrong meson_viu_init(priv); 301d1b5e41eSNeil Armstrong if (priv->afbcd.ops) { 302d1b5e41eSNeil Armstrong ret = priv->afbcd.ops->init(priv); 303d1b5e41eSNeil Armstrong if (ret) 304d1b5e41eSNeil Armstrong return ret; 305d1b5e41eSNeil Armstrong } 306bbbe775eSNeil Armstrong 307bbbe775eSNeil Armstrong /* Encoder Initialization */ 308bbbe775eSNeil Armstrong 309bbbe775eSNeil Armstrong ret = meson_venc_cvbs_create(priv); 310bbbe775eSNeil Armstrong if (ret) 311bbbe775eSNeil Armstrong goto free_drm; 312bbbe775eSNeil Armstrong 3138604889fSNeil Armstrong if (has_components) { 314a41e82e6SNeil Armstrong ret = component_bind_all(drm->dev, drm); 315a41e82e6SNeil Armstrong if (ret) { 316a41e82e6SNeil Armstrong dev_err(drm->dev, "Couldn't bind all components\n"); 317a41e82e6SNeil Armstrong goto free_drm; 318a41e82e6SNeil Armstrong } 3198604889fSNeil Armstrong } 320bbbe775eSNeil Armstrong 321bbbe775eSNeil Armstrong ret = meson_plane_create(priv); 322bbbe775eSNeil Armstrong if (ret) 323bbbe775eSNeil Armstrong goto free_drm; 324bbbe775eSNeil Armstrong 325f9a23481SNeil Armstrong ret = meson_overlay_create(priv); 326f9a23481SNeil Armstrong if (ret) 327f9a23481SNeil Armstrong goto free_drm; 328f9a23481SNeil Armstrong 329bbbe775eSNeil Armstrong ret = meson_crtc_create(priv); 330bbbe775eSNeil Armstrong if (ret) 331bbbe775eSNeil Armstrong goto free_drm; 332bbbe775eSNeil Armstrong 33365a96965SThomas Zimmermann ret = request_irq(priv->vsync_irq, meson_irq, 0, drm->driver->name, drm); 334bbbe775eSNeil Armstrong if (ret) 335bbbe775eSNeil Armstrong goto free_drm; 336bbbe775eSNeil Armstrong 337bbbe775eSNeil Armstrong drm_mode_config_reset(drm); 338bbbe775eSNeil Armstrong 339bbbe775eSNeil Armstrong drm_kms_helper_poll_init(drm); 340bbbe775eSNeil Armstrong 341bbbe775eSNeil Armstrong platform_set_drvdata(pdev, priv); 342bbbe775eSNeil Armstrong 343bbbe775eSNeil Armstrong ret = drm_dev_register(drm, 0); 344bbbe775eSNeil Armstrong if (ret) 3452d8f9289SJean-Philippe Brucker goto uninstall_irq; 346bbbe775eSNeil Armstrong 347efbb9df9SNoralf Trønnes drm_fbdev_generic_setup(drm, 32); 348efbb9df9SNoralf Trønnes 349bbbe775eSNeil Armstrong return 0; 350bbbe775eSNeil Armstrong 3512d8f9289SJean-Philippe Brucker uninstall_irq: 35265a96965SThomas Zimmermann free_irq(priv->vsync_irq, drm); 353bbbe775eSNeil Armstrong free_drm: 354dcacf651SChristophe JAILLET drm_dev_put(drm); 355bbbe775eSNeil Armstrong 356bbbe775eSNeil Armstrong return ret; 357bbbe775eSNeil Armstrong } 358bbbe775eSNeil Armstrong 3598604889fSNeil Armstrong static int meson_drv_bind(struct device *dev) 3608604889fSNeil Armstrong { 3618604889fSNeil Armstrong return meson_drv_bind_master(dev, true); 3628604889fSNeil Armstrong } 3638604889fSNeil Armstrong 364a41e82e6SNeil Armstrong static void meson_drv_unbind(struct device *dev) 365bbbe775eSNeil Armstrong { 366776e7867SJean-Philippe Brucker struct meson_drm *priv = dev_get_drvdata(dev); 367776e7867SJean-Philippe Brucker struct drm_device *drm = priv->drm; 36866cae477SMaxime Jourdan 369f9a23481SNeil Armstrong if (priv->canvas) { 37066cae477SMaxime Jourdan meson_canvas_free(priv->canvas, priv->canvas_id_osd1); 371f9a23481SNeil Armstrong meson_canvas_free(priv->canvas, priv->canvas_id_vd1_0); 372f9a23481SNeil Armstrong meson_canvas_free(priv->canvas, priv->canvas_id_vd1_1); 373f9a23481SNeil Armstrong meson_canvas_free(priv->canvas, priv->canvas_id_vd1_2); 374f9a23481SNeil Armstrong } 375bbbe775eSNeil Armstrong 376bbbe775eSNeil Armstrong drm_dev_unregister(drm); 377bbbe775eSNeil Armstrong drm_kms_helper_poll_fini(drm); 378e78ad18bSMarc Zyngier drm_atomic_helper_shutdown(drm); 379e78ad18bSMarc Zyngier component_unbind_all(dev, drm); 38065a96965SThomas Zimmermann free_irq(priv->vsync_irq, drm); 381dcacf651SChristophe JAILLET drm_dev_put(drm); 382fa62ee25SMarc Zyngier 383fa62ee25SMarc Zyngier if (priv->afbcd.ops) { 384fa62ee25SMarc Zyngier priv->afbcd.ops->reset(priv); 385fa62ee25SMarc Zyngier meson_rdma_free(priv); 386fa62ee25SMarc Zyngier } 387bbbe775eSNeil Armstrong } 388bbbe775eSNeil Armstrong 389a41e82e6SNeil Armstrong static const struct component_master_ops meson_drv_master_ops = { 390a41e82e6SNeil Armstrong .bind = meson_drv_bind, 391a41e82e6SNeil Armstrong .unbind = meson_drv_unbind, 392a41e82e6SNeil Armstrong }; 393a41e82e6SNeil Armstrong 394cf3d4e53SNeil Armstrong static int __maybe_unused meson_drv_pm_suspend(struct device *dev) 395cf3d4e53SNeil Armstrong { 396cf3d4e53SNeil Armstrong struct meson_drm *priv = dev_get_drvdata(dev); 397cf3d4e53SNeil Armstrong 398cf3d4e53SNeil Armstrong if (!priv) 399cf3d4e53SNeil Armstrong return 0; 400cf3d4e53SNeil Armstrong 401cf3d4e53SNeil Armstrong return drm_mode_config_helper_suspend(priv->drm); 402cf3d4e53SNeil Armstrong } 403cf3d4e53SNeil Armstrong 404cf3d4e53SNeil Armstrong static int __maybe_unused meson_drv_pm_resume(struct device *dev) 405cf3d4e53SNeil Armstrong { 406cf3d4e53SNeil Armstrong struct meson_drm *priv = dev_get_drvdata(dev); 407cf3d4e53SNeil Armstrong 408cf3d4e53SNeil Armstrong if (!priv) 409cf3d4e53SNeil Armstrong return 0; 410cf3d4e53SNeil Armstrong 411cf3d4e53SNeil Armstrong meson_vpu_init(priv); 412cf3d4e53SNeil Armstrong meson_venc_init(priv); 413cf3d4e53SNeil Armstrong meson_vpp_init(priv); 414cf3d4e53SNeil Armstrong meson_viu_init(priv); 415d1b5e41eSNeil Armstrong if (priv->afbcd.ops) 416d1b5e41eSNeil Armstrong priv->afbcd.ops->init(priv); 417cf3d4e53SNeil Armstrong 418c54a8f1fSBernard Zhao return drm_mode_config_helper_resume(priv->drm); 419cf3d4e53SNeil Armstrong } 420cf3d4e53SNeil Armstrong 421a41e82e6SNeil Armstrong static int compare_of(struct device *dev, void *data) 422a41e82e6SNeil Armstrong { 4234bf99144SRob Herring DRM_DEBUG_DRIVER("Comparing of node %pOF with %pOF\n", 4244bf99144SRob Herring dev->of_node, data); 425a41e82e6SNeil Armstrong 426a41e82e6SNeil Armstrong return dev->of_node == data; 427a41e82e6SNeil Armstrong } 428a41e82e6SNeil Armstrong 429a41e82e6SNeil Armstrong /* Possible connectors nodes to ignore */ 430a41e82e6SNeil Armstrong static const struct of_device_id connectors_match[] = { 431a41e82e6SNeil Armstrong { .compatible = "composite-video-connector" }, 432a41e82e6SNeil Armstrong { .compatible = "svideo-connector" }, 433a41e82e6SNeil Armstrong { .compatible = "hdmi-connector" }, 434a41e82e6SNeil Armstrong { .compatible = "dvi-connector" }, 435a41e82e6SNeil Armstrong {} 436a41e82e6SNeil Armstrong }; 437a41e82e6SNeil Armstrong 438a41e82e6SNeil Armstrong static int meson_probe_remote(struct platform_device *pdev, 439a41e82e6SNeil Armstrong struct component_match **match, 440a41e82e6SNeil Armstrong struct device_node *parent, 441a41e82e6SNeil Armstrong struct device_node *remote) 442a41e82e6SNeil Armstrong { 443a41e82e6SNeil Armstrong struct device_node *ep, *remote_node; 444a41e82e6SNeil Armstrong int count = 1; 445a41e82e6SNeil Armstrong 446a41e82e6SNeil Armstrong /* If node is a connector, return and do not add to match table */ 447a41e82e6SNeil Armstrong if (of_match_node(connectors_match, remote)) 448a41e82e6SNeil Armstrong return 1; 449a41e82e6SNeil Armstrong 450a41e82e6SNeil Armstrong component_match_add(&pdev->dev, match, compare_of, remote); 451a41e82e6SNeil Armstrong 452a41e82e6SNeil Armstrong for_each_endpoint_of_node(remote, ep) { 453a41e82e6SNeil Armstrong remote_node = of_graph_get_remote_port_parent(ep); 454a41e82e6SNeil Armstrong if (!remote_node || 455a41e82e6SNeil Armstrong remote_node == parent || /* Ignore parent endpoint */ 456f672b93eSJulia Lawall !of_device_is_available(remote_node)) { 457f672b93eSJulia Lawall of_node_put(remote_node); 458a41e82e6SNeil Armstrong continue; 459f672b93eSJulia Lawall } 460a41e82e6SNeil Armstrong 461a41e82e6SNeil Armstrong count += meson_probe_remote(pdev, match, remote, remote_node); 462a41e82e6SNeil Armstrong 463a41e82e6SNeil Armstrong of_node_put(remote_node); 464a41e82e6SNeil Armstrong } 465a41e82e6SNeil Armstrong 466a41e82e6SNeil Armstrong return count; 467a41e82e6SNeil Armstrong } 468a41e82e6SNeil Armstrong 469fa0c16caSArtem Lapkin static void meson_drv_shutdown(struct platform_device *pdev) 470fa0c16caSArtem Lapkin { 471fa0c16caSArtem Lapkin struct meson_drm *priv = dev_get_drvdata(&pdev->dev); 472fa0c16caSArtem Lapkin 4737cfc4ea7SNeil Armstrong if (!priv) 4747cfc4ea7SNeil Armstrong return; 4757cfc4ea7SNeil Armstrong 4767cfc4ea7SNeil Armstrong drm_kms_helper_poll_fini(priv->drm); 4777cfc4ea7SNeil Armstrong drm_atomic_helper_shutdown(priv->drm); 478fa0c16caSArtem Lapkin } 479fa0c16caSArtem Lapkin 480a41e82e6SNeil Armstrong static int meson_drv_probe(struct platform_device *pdev) 481a41e82e6SNeil Armstrong { 482a41e82e6SNeil Armstrong struct component_match *match = NULL; 483a41e82e6SNeil Armstrong struct device_node *np = pdev->dev.of_node; 484a41e82e6SNeil Armstrong struct device_node *ep, *remote; 485a41e82e6SNeil Armstrong int count = 0; 486a41e82e6SNeil Armstrong 487a41e82e6SNeil Armstrong for_each_endpoint_of_node(np, ep) { 488a41e82e6SNeil Armstrong remote = of_graph_get_remote_port_parent(ep); 489f672b93eSJulia Lawall if (!remote || !of_device_is_available(remote)) { 490f672b93eSJulia Lawall of_node_put(remote); 491a41e82e6SNeil Armstrong continue; 492f672b93eSJulia Lawall } 493a41e82e6SNeil Armstrong 494a41e82e6SNeil Armstrong count += meson_probe_remote(pdev, &match, np, remote); 495f672b93eSJulia Lawall of_node_put(remote); 496a41e82e6SNeil Armstrong } 497a41e82e6SNeil Armstrong 4988604889fSNeil Armstrong if (count && !match) 4998604889fSNeil Armstrong return meson_drv_bind_master(&pdev->dev, false); 5008604889fSNeil Armstrong 501a41e82e6SNeil Armstrong /* If some endpoints were found, initialize the nodes */ 502a41e82e6SNeil Armstrong if (count) { 503a41e82e6SNeil Armstrong dev_info(&pdev->dev, "Queued %d outputs on vpu\n", count); 504a41e82e6SNeil Armstrong 505a41e82e6SNeil Armstrong return component_master_add_with_match(&pdev->dev, 506a41e82e6SNeil Armstrong &meson_drv_master_ops, 507a41e82e6SNeil Armstrong match); 508a41e82e6SNeil Armstrong } 509a41e82e6SNeil Armstrong 510a41e82e6SNeil Armstrong /* If no output endpoints were available, simply bail out */ 511a41e82e6SNeil Armstrong return 0; 512a41e82e6SNeil Armstrong }; 513a41e82e6SNeil Armstrong 514d1b5e41eSNeil Armstrong static struct meson_drm_match_data meson_drm_gxbb_data = { 515d1b5e41eSNeil Armstrong .compat = VPU_COMPATIBLE_GXBB, 516d1b5e41eSNeil Armstrong }; 517d1b5e41eSNeil Armstrong 518d1b5e41eSNeil Armstrong static struct meson_drm_match_data meson_drm_gxl_data = { 519d1b5e41eSNeil Armstrong .compat = VPU_COMPATIBLE_GXL, 520d1b5e41eSNeil Armstrong }; 521d1b5e41eSNeil Armstrong 522d1b5e41eSNeil Armstrong static struct meson_drm_match_data meson_drm_gxm_data = { 523d1b5e41eSNeil Armstrong .compat = VPU_COMPATIBLE_GXM, 524d1b5e41eSNeil Armstrong .afbcd_ops = &meson_afbcd_gxm_ops, 525d1b5e41eSNeil Armstrong }; 526d1b5e41eSNeil Armstrong 527d1b5e41eSNeil Armstrong static struct meson_drm_match_data meson_drm_g12a_data = { 528d1b5e41eSNeil Armstrong .compat = VPU_COMPATIBLE_G12A, 529d1b5e41eSNeil Armstrong .afbcd_ops = &meson_afbcd_g12a_ops, 530d1b5e41eSNeil Armstrong }; 531d1b5e41eSNeil Armstrong 532bbbe775eSNeil Armstrong static const struct of_device_id dt_match[] = { 533528a25d0SJulien Masson { .compatible = "amlogic,meson-gxbb-vpu", 534d1b5e41eSNeil Armstrong .data = (void *)&meson_drm_gxbb_data }, 535528a25d0SJulien Masson { .compatible = "amlogic,meson-gxl-vpu", 536d1b5e41eSNeil Armstrong .data = (void *)&meson_drm_gxl_data }, 537528a25d0SJulien Masson { .compatible = "amlogic,meson-gxm-vpu", 538d1b5e41eSNeil Armstrong .data = (void *)&meson_drm_gxm_data }, 539528a25d0SJulien Masson { .compatible = "amlogic,meson-g12a-vpu", 540d1b5e41eSNeil Armstrong .data = (void *)&meson_drm_g12a_data }, 541bbbe775eSNeil Armstrong {} 542bbbe775eSNeil Armstrong }; 543bbbe775eSNeil Armstrong MODULE_DEVICE_TABLE(of, dt_match); 544bbbe775eSNeil Armstrong 545cf3d4e53SNeil Armstrong static const struct dev_pm_ops meson_drv_pm_ops = { 546cf3d4e53SNeil Armstrong SET_SYSTEM_SLEEP_PM_OPS(meson_drv_pm_suspend, meson_drv_pm_resume) 547cf3d4e53SNeil Armstrong }; 548cf3d4e53SNeil Armstrong 549bbbe775eSNeil Armstrong static struct platform_driver meson_drm_platform_driver = { 550bbbe775eSNeil Armstrong .probe = meson_drv_probe, 551fa0c16caSArtem Lapkin .shutdown = meson_drv_shutdown, 552bbbe775eSNeil Armstrong .driver = { 5538aaacbc0SNeil Armstrong .name = "meson-drm", 554bbbe775eSNeil Armstrong .of_match_table = dt_match, 555cf3d4e53SNeil Armstrong .pm = &meson_drv_pm_ops, 556bbbe775eSNeil Armstrong }, 557bbbe775eSNeil Armstrong }; 558bbbe775eSNeil Armstrong 559bbbe775eSNeil Armstrong module_platform_driver(meson_drm_platform_driver); 560bbbe775eSNeil Armstrong 561bbbe775eSNeil Armstrong MODULE_AUTHOR("Jasper St. Pierre <jstpierre@mecheye.net>"); 562bbbe775eSNeil Armstrong MODULE_AUTHOR("Neil Armstrong <narmstrong@baylibre.com>"); 563bbbe775eSNeil Armstrong MODULE_DESCRIPTION(DRIVER_DESC); 564bbbe775eSNeil Armstrong MODULE_LICENSE("GPL"); 565