drivers/gpu/drm/kmb/kmb_drv.c

   1 // SPDX-License-Identifier: GPL-2.0-only
   2 /*
   3  * Copyright © 2018-2020 Intel Corporation
   4  */
   5
   6 #include <linux/clk.h>
   7 #include <linux/module.h>
   8 #include <linux/of_graph.h>
   9 #include <linux/of_platform.h>
  10 #include <linux/of_reserved_mem.h>
  11 #include <linux/mfd/syscon.h>
  12 #include <linux/platform_device.h>
  13 #include <linux/pm_runtime.h>
  14 #include <linux/regmap.h>
  15
  16 #include <drm/drm_atomic_helper.h>
  17 #include <drm/drm_drv.h>
  18 #include <drm/drm_fbdev_dma.h>
  19 #include <drm/drm_gem_dma_helper.h>
  20 #include <drm/drm_gem_framebuffer_helper.h>
  21 #include <drm/drm_module.h>
  22 #include <drm/drm_probe_helper.h>
  23 #include <drm/drm_vblank.h>
  24
  25 #include "kmb_drv.h"
  26 #include "kmb_dsi.h"
  27 #include "kmb_regs.h"
  28
  29 static int kmb_display_clk_enable(struct kmb_drm_private *kmb)
  30 {
  31         int ret = 0;
  32
  33         ret = clk_prepare_enable(kmb->kmb_clk.clk_lcd);
  34         if (ret) {
  35                 drm_err(&kmb->drm, "Failed to enable LCD clock: %d\n", ret);
  36                 return ret;
  37         }
  38         DRM_INFO("SUCCESS : enabled LCD clocks\n");
  39         return 0;
  40 }
  41
  42 static int kmb_initialize_clocks(struct kmb_drm_private *kmb, struct device *dev)
  43 {
  44         int ret = 0;
  45         struct regmap *msscam;
  46
  47         kmb->kmb_clk.clk_lcd = devm_clk_get(dev, "clk_lcd");
  48         if (IS_ERR(kmb->kmb_clk.clk_lcd)) {
  49                 drm_err(&kmb->drm, "clk_get() failed clk_lcd\n");
  50                 return PTR_ERR(kmb->kmb_clk.clk_lcd);
  51         }
  52
  53         kmb->kmb_clk.clk_pll0 = devm_clk_get(dev, "clk_pll0");
  54         if (IS_ERR(kmb->kmb_clk.clk_pll0)) {
  55                 drm_err(&kmb->drm, "clk_get() failed clk_pll0 ");
  56                 return PTR_ERR(kmb->kmb_clk.clk_pll0);
  57         }
  58         kmb->sys_clk_mhz = clk_get_rate(kmb->kmb_clk.clk_pll0) / 1000000;
  59         drm_info(&kmb->drm, "system clk = %d Mhz", kmb->sys_clk_mhz);
  60
  61         ret =  kmb_dsi_clk_init(kmb->kmb_dsi);
  62
  63         /* Set LCD clock to 200 Mhz */
  64         clk_set_rate(kmb->kmb_clk.clk_lcd, KMB_LCD_DEFAULT_CLK);
  65         if (clk_get_rate(kmb->kmb_clk.clk_lcd) != KMB_LCD_DEFAULT_CLK) {
  66                 drm_err(&kmb->drm, "failed to set to clk_lcd to %d\n",
  67                         KMB_LCD_DEFAULT_CLK);
  68                 return -1;
  69         }
  70         drm_dbg(&kmb->drm, "clk_lcd = %ld\n", clk_get_rate(kmb->kmb_clk.clk_lcd));
  71
  72         ret = kmb_display_clk_enable(kmb);
  73         if (ret)
  74                 return ret;
  75
  76         msscam = syscon_regmap_lookup_by_compatible("intel,keembay-msscam");
  77         if (IS_ERR(msscam)) {
  78                 drm_err(&kmb->drm, "failed to get msscam syscon");
  79                 return -1;
  80         }
  81
  82         /* Enable MSS_CAM_CLK_CTRL for MIPI TX and LCD */
  83         regmap_update_bits(msscam, MSS_CAM_CLK_CTRL, 0x1fff, 0x1fff);
  84         regmap_update_bits(msscam, MSS_CAM_RSTN_CTRL, 0xffffffff, 0xffffffff);
  85         return 0;
  86 }
  87
  88 static void kmb_display_clk_disable(struct kmb_drm_private *kmb)
  89 {
  90         clk_disable_unprepare(kmb->kmb_clk.clk_lcd);
  91 }
  92
  93 static void __iomem *kmb_map_mmio(struct drm_device *drm,
  94                                   struct platform_device *pdev,
  95                                   char *name)
  96 {
  97         struct resource *res;
  98         void __iomem *mem;
  99
 100         res = platform_get_resource_byname(pdev, IORESOURCE_MEM, name);
 101         if (!res) {
 102                 drm_err(drm, "failed to get resource for %s", name);
 103                 return ERR_PTR(-ENOMEM);
 104         }
 105         mem = devm_ioremap_resource(drm->dev, res);
 106         if (IS_ERR(mem))
 107                 drm_err(drm, "failed to ioremap %s registers", name);
 108         return mem;
 109 }
 110
 111 static int kmb_hw_init(struct drm_device *drm, unsigned long flags)
 112 {
 113         struct kmb_drm_private *kmb = to_kmb(drm);
 114         struct platform_device *pdev = to_platform_device(drm->dev);
 115         int irq_lcd;
 116         int ret = 0;
 117
 118         /* Map LCD MMIO registers */
 119         kmb->lcd_mmio = kmb_map_mmio(drm, pdev, "lcd");
 120         if (IS_ERR(kmb->lcd_mmio)) {
 121                 drm_err(&kmb->drm, "failed to map LCD registers\n");
 122                 return -ENOMEM;
 123         }
 124
 125         /* Map MIPI MMIO registers */
 126         ret = kmb_dsi_map_mmio(kmb->kmb_dsi);
 127         if (ret)
 128                 return ret;
 129
 130         /* Enable display clocks */
 131         kmb_initialize_clocks(kmb, &pdev->dev);
 132
 133         /* Register irqs here - section 17.3 in databook
 134          * lists LCD at 79 and 82 for MIPI under MSS CPU -
 135          * firmware has redirected 79 to A53 IRQ 33
 136          */
 137
 138         /* Allocate LCD interrupt resources */
 139         irq_lcd = platform_get_irq(pdev, 0);
 140         if (irq_lcd < 0) {
 141                 ret = irq_lcd;
 142                 drm_err(&kmb->drm, "irq_lcd not found");
 143                 goto setup_fail;
 144         }
 145
 146         /* Get the optional framebuffer memory resource */
 147         ret = of_reserved_mem_device_init(drm->dev);
 148         if (ret && ret != -ENODEV)
 149                 return ret;
 150
 151         spin_lock_init(&kmb->irq_lock);
 152
 153         kmb->irq_lcd = irq_lcd;
 154
 155         return 0;
 156
 157  setup_fail:
 158         of_reserved_mem_device_release(drm->dev);
 159
 160         return ret;
 161 }
 162
 163 static const struct drm_mode_config_funcs kmb_mode_config_funcs = {
 164         .fb_create = drm_gem_fb_create,
 165         .atomic_check = drm_atomic_helper_check,
 166         .atomic_commit = drm_atomic_helper_commit,
 167 };
 168
 169 static int kmb_setup_mode_config(struct drm_device *drm)
 170 {
 171         int ret;
 172         struct kmb_drm_private *kmb = to_kmb(drm);
 173
 174         ret = drmm_mode_config_init(drm);
 175         if (ret)
 176                 return ret;
 177         drm->mode_config.min_width = KMB_FB_MIN_WIDTH;
 178         drm->mode_config.min_height = KMB_FB_MIN_HEIGHT;
 179         drm->mode_config.max_width = KMB_FB_MAX_WIDTH;
 180         drm->mode_config.max_height = KMB_FB_MAX_HEIGHT;
 181         drm->mode_config.preferred_depth = 24;
 182         drm->mode_config.funcs = &kmb_mode_config_funcs;
 183
 184         ret = kmb_setup_crtc(drm);
 185         if (ret < 0) {
 186                 drm_err(drm, "failed to create crtc\n");
 187                 return ret;
 188         }
 189         ret = kmb_dsi_encoder_init(drm, kmb->kmb_dsi);
 190         /* Set the CRTC's port so that the encoder component can find it */
 191         kmb->crtc.port = of_graph_get_port_by_id(drm->dev->of_node, 0);
 192         ret = drm_vblank_init(drm, drm->mode_config.num_crtc);
 193         if (ret < 0) {
 194                 drm_err(drm, "failed to initialize vblank\n");
 195                 pm_runtime_disable(drm->dev);
 196                 return ret;
 197         }
 198
 199         drm_mode_config_reset(drm);
 200         return 0;
 201 }
 202
 203 static irqreturn_t handle_lcd_irq(struct drm_device *dev)
 204 {
 205         unsigned long status, val, val1;
 206         int plane_id, dma0_state, dma1_state;
 207         struct kmb_drm_private *kmb = to_kmb(dev);
 208         u32 ctrl = 0;
 209
 210         status = kmb_read_lcd(kmb, LCD_INT_STATUS);
 211
 212         spin_lock(&kmb->irq_lock);
 213         if (status & LCD_INT_EOF) {
 214                 kmb_write_lcd(kmb, LCD_INT_CLEAR, LCD_INT_EOF);
 215
 216                 /* When disabling/enabling LCD layers, the change takes effect
 217                  * immediately and does not wait for EOF (end of frame).
 218                  * When kmb_plane_atomic_disable is called, mark the plane as
 219                  * disabled but actually disable the plane when EOF irq is
 220                  * being handled.
 221                  */
 222                 for (plane_id = LAYER_0;
 223                                 plane_id < KMB_MAX_PLANES; plane_id++) {
 224                         if (kmb->plane_status[plane_id].disable) {
 225                                 kmb_clr_bitmask_lcd(kmb,
 226                                                     LCD_LAYERn_DMA_CFG
 227                                                     (plane_id),
 228                                                     LCD_DMA_LAYER_ENABLE);
 229
 230                                 kmb_clr_bitmask_lcd(kmb, LCD_CONTROL,
 231                                                     kmb->plane_status[plane_id].ctrl);
 232
 233                                 ctrl = kmb_read_lcd(kmb, LCD_CONTROL);
 234                                 if (!(ctrl & (LCD_CTRL_VL1_ENABLE |
 235                                     LCD_CTRL_VL2_ENABLE |
 236                                     LCD_CTRL_GL1_ENABLE |
 237                                     LCD_CTRL_GL2_ENABLE))) {
 238                                         /* If no LCD layers are using DMA,
 239                                          * then disable DMA pipelined AXI read
 240                                          * transactions.
 241                                          */
 242                                         kmb_clr_bitmask_lcd(kmb, LCD_CONTROL,
 243                                                             LCD_CTRL_PIPELINE_DMA);
 244                                 }
 245
 246                                 kmb->plane_status[plane_id].disable = false;
 247                         }
 248                 }
 249                 if (kmb->kmb_under_flow) {
 250                         /* DMA Recovery after underflow */
 251                         dma0_state = (kmb->layer_no == 0) ?
 252                             LCD_VIDEO0_DMA0_STATE : LCD_VIDEO1_DMA0_STATE;
 253                         dma1_state = (kmb->layer_no == 0) ?
 254                             LCD_VIDEO0_DMA1_STATE : LCD_VIDEO1_DMA1_STATE;
 255
 256                         do {
 257                                 kmb_write_lcd(kmb, LCD_FIFO_FLUSH, 1);
 258                                 val = kmb_read_lcd(kmb, dma0_state)
 259                                     & LCD_DMA_STATE_ACTIVE;
 260                                 val1 = kmb_read_lcd(kmb, dma1_state)
 261                                     & LCD_DMA_STATE_ACTIVE;
 262                         } while ((val || val1));
 263                         /* disable dma */
 264                         kmb_clr_bitmask_lcd(kmb,
 265                                             LCD_LAYERn_DMA_CFG(kmb->layer_no),
 266                                             LCD_DMA_LAYER_ENABLE);
 267                         kmb_write_lcd(kmb, LCD_FIFO_FLUSH, 1);
 268                         kmb->kmb_flush_done = 1;
 269                         kmb->kmb_under_flow = 0;
 270                 }
 271         }
 272
 273         if (status & LCD_INT_LINE_CMP) {
 274                 /* clear line compare interrupt */
 275                 kmb_write_lcd(kmb, LCD_INT_CLEAR, LCD_INT_LINE_CMP);
 276         }
 277
 278         if (status & LCD_INT_VERT_COMP) {
 279                 /* Read VSTATUS */
 280                 val = kmb_read_lcd(kmb, LCD_VSTATUS);
 281                 val = (val & LCD_VSTATUS_VERTICAL_STATUS_MASK);
 282                 switch (val) {
 283                 case LCD_VSTATUS_COMPARE_VSYNC:
 284                         /* Clear vertical compare interrupt */
 285                         kmb_write_lcd(kmb, LCD_INT_CLEAR, LCD_INT_VERT_COMP);
 286                         if (kmb->kmb_flush_done) {
 287                                 kmb_set_bitmask_lcd(kmb,
 288                                                     LCD_LAYERn_DMA_CFG
 289                                                     (kmb->layer_no),
 290                                                     LCD_DMA_LAYER_ENABLE);
 291                                 kmb->kmb_flush_done = 0;
 292                         }
 293                         drm_crtc_handle_vblank(&kmb->crtc);
 294                         break;
 295                 case LCD_VSTATUS_COMPARE_BACKPORCH:
 296                 case LCD_VSTATUS_COMPARE_ACTIVE:
 297                 case LCD_VSTATUS_COMPARE_FRONT_PORCH:
 298                         kmb_write_lcd(kmb, LCD_INT_CLEAR, LCD_INT_VERT_COMP);
 299                         break;
 300                 }
 301         }
 302         if (status & LCD_INT_DMA_ERR) {
 303                 val =
 304                     (status & LCD_INT_DMA_ERR &
 305                      kmb_read_lcd(kmb, LCD_INT_ENABLE));
 306                 /* LAYER0 - VL0 */
 307                 if (val & (LAYER0_DMA_FIFO_UNDERFLOW |
 308                            LAYER0_DMA_CB_FIFO_UNDERFLOW |
 309                            LAYER0_DMA_CR_FIFO_UNDERFLOW)) {
 310                         kmb->kmb_under_flow++;
 311                         drm_info(&kmb->drm,
 312                                  "!LAYER0:VL0 DMA UNDERFLOW val = 0x%lx,under_flow=%d",
 313                              val, kmb->kmb_under_flow);
 314                         /* disable underflow interrupt */
 315                         kmb_clr_bitmask_lcd(kmb, LCD_INT_ENABLE,
 316                                             LAYER0_DMA_FIFO_UNDERFLOW |
 317                                             LAYER0_DMA_CB_FIFO_UNDERFLOW |
 318                                             LAYER0_DMA_CR_FIFO_UNDERFLOW);
 319                         kmb_set_bitmask_lcd(kmb, LCD_INT_CLEAR,
 320                                             LAYER0_DMA_CB_FIFO_UNDERFLOW |
 321                                             LAYER0_DMA_FIFO_UNDERFLOW |
 322                                             LAYER0_DMA_CR_FIFO_UNDERFLOW);
 323                         /* disable auto restart mode */
 324                         kmb_clr_bitmask_lcd(kmb, LCD_LAYERn_DMA_CFG(0),
 325                                             LCD_DMA_LAYER_CONT_PING_PONG_UPDATE);
 326
 327                         kmb->layer_no = 0;
 328                 }
 329
 330                 if (val & LAYER0_DMA_FIFO_OVERFLOW)
 331                         drm_dbg(&kmb->drm,
 332                                 "LAYER0:VL0 DMA OVERFLOW val = 0x%lx", val);
 333                 if (val & LAYER0_DMA_CB_FIFO_OVERFLOW)
 334                         drm_dbg(&kmb->drm,
 335                                 "LAYER0:VL0 DMA CB OVERFLOW val = 0x%lx", val);
 336                 if (val & LAYER0_DMA_CR_FIFO_OVERFLOW)
 337                         drm_dbg(&kmb->drm,
 338                                 "LAYER0:VL0 DMA CR OVERFLOW val = 0x%lx", val);
 339
 340                 /* LAYER1 - VL1 */
 341                 if (val & (LAYER1_DMA_FIFO_UNDERFLOW |
 342                            LAYER1_DMA_CB_FIFO_UNDERFLOW |
 343                            LAYER1_DMA_CR_FIFO_UNDERFLOW)) {
 344                         kmb->kmb_under_flow++;
 345                         drm_info(&kmb->drm,
 346                                  "!LAYER1:VL1 DMA UNDERFLOW val = 0x%lx, under_flow=%d",
 347                              val, kmb->kmb_under_flow);
 348                         /* disable underflow interrupt */
 349                         kmb_clr_bitmask_lcd(kmb, LCD_INT_ENABLE,
 350                                             LAYER1_DMA_FIFO_UNDERFLOW |
 351                                             LAYER1_DMA_CB_FIFO_UNDERFLOW |
 352                                             LAYER1_DMA_CR_FIFO_UNDERFLOW);
 353                         kmb_set_bitmask_lcd(kmb, LCD_INT_CLEAR,
 354                                             LAYER1_DMA_CB_FIFO_UNDERFLOW |
 355                                             LAYER1_DMA_FIFO_UNDERFLOW |
 356                                             LAYER1_DMA_CR_FIFO_UNDERFLOW);
 357                         /* disable auto restart mode */
 358                         kmb_clr_bitmask_lcd(kmb, LCD_LAYERn_DMA_CFG(1),
 359                                             LCD_DMA_LAYER_CONT_PING_PONG_UPDATE);
 360                         kmb->layer_no = 1;
 361                 }
 362
 363                 /* LAYER1 - VL1 */
 364                 if (val & LAYER1_DMA_FIFO_OVERFLOW)
 365                         drm_dbg(&kmb->drm,
 366                                 "LAYER1:VL1 DMA OVERFLOW val = 0x%lx", val);
 367                 if (val & LAYER1_DMA_CB_FIFO_OVERFLOW)
 368                         drm_dbg(&kmb->drm,
 369                                 "LAYER1:VL1 DMA CB OVERFLOW val = 0x%lx", val);
 370                 if (val & LAYER1_DMA_CR_FIFO_OVERFLOW)
 371                         drm_dbg(&kmb->drm,
 372                                 "LAYER1:VL1 DMA CR OVERFLOW val = 0x%lx", val);
 373
 374                 /* LAYER2 - GL0 */
 375                 if (val & LAYER2_DMA_FIFO_UNDERFLOW)
 376                         drm_dbg(&kmb->drm,
 377                                 "LAYER2:GL0 DMA UNDERFLOW val = 0x%lx", val);
 378                 if (val & LAYER2_DMA_FIFO_OVERFLOW)
 379                         drm_dbg(&kmb->drm,
 380                                 "LAYER2:GL0 DMA OVERFLOW val = 0x%lx", val);
 381
 382                 /* LAYER3 - GL1 */
 383                 if (val & LAYER3_DMA_FIFO_UNDERFLOW)
 384                         drm_dbg(&kmb->drm,
 385                                 "LAYER3:GL1 DMA UNDERFLOW val = 0x%lx", val);
 386                 if (val & LAYER3_DMA_FIFO_OVERFLOW)
 387                         drm_dbg(&kmb->drm,
 388                                 "LAYER3:GL1 DMA OVERFLOW val = 0x%lx", val);
 389         }
 390
 391         spin_unlock(&kmb->irq_lock);
 392
 393         if (status & LCD_INT_LAYER) {
 394                 /* Clear layer interrupts */
 395                 kmb_write_lcd(kmb, LCD_INT_CLEAR, LCD_INT_LAYER);
 396         }
 397
 398         /* Clear all interrupts */
 399         kmb_set_bitmask_lcd(kmb, LCD_INT_CLEAR, 1);
 400         return IRQ_HANDLED;
 401 }
 402
 403 /* IRQ handler */
 404 static irqreturn_t kmb_isr(int irq, void *arg)
 405 {
 406         struct drm_device *dev = (struct drm_device *)arg;
 407
 408         handle_lcd_irq(dev);
 409         return IRQ_HANDLED;
 410 }
 411
 412 static void kmb_irq_reset(struct drm_device *drm)
 413 {
 414         kmb_write_lcd(to_kmb(drm), LCD_INT_CLEAR, 0xFFFF);
 415         kmb_write_lcd(to_kmb(drm), LCD_INT_ENABLE, 0);
 416 }
 417
 418 static int kmb_irq_install(struct drm_device *drm, unsigned int irq)
 419 {
 420         if (irq == IRQ_NOTCONNECTED)
 421                 return -ENOTCONN;
 422
 423         kmb_irq_reset(drm);
 424
 425         return request_irq(irq, kmb_isr, 0, drm->driver->name, drm);
 426 }
 427
 428 static void kmb_irq_uninstall(struct drm_device *drm)
 429 {
 430         struct kmb_drm_private *kmb = to_kmb(drm);
 431
 432         kmb_irq_reset(drm);
 433         free_irq(kmb->irq_lcd, drm);
 434 }
 435
 436 DEFINE_DRM_GEM_DMA_FOPS(fops);
 437
 438 static const struct drm_driver kmb_driver = {
 439         .driver_features = DRIVER_GEM |
 440             DRIVER_MODESET | DRIVER_ATOMIC,
 441         /* GEM Operations */
 442         .fops = &fops,
 443         DRM_GEM_DMA_DRIVER_OPS_VMAP,
 444         .name = "kmb-drm",
 445         .desc = "KEEMBAY DISPLAY DRIVER",
 446         .date = DRIVER_DATE,
 447         .major = DRIVER_MAJOR,
 448         .minor = DRIVER_MINOR,
 449 };
 450
 451 static int kmb_remove(struct platform_device *pdev)
 452 {
 453         struct device *dev = &pdev->dev;
 454         struct drm_device *drm = dev_get_drvdata(dev);
 455         struct kmb_drm_private *kmb = to_kmb(drm);
 456
 457         drm_dev_unregister(drm);
 458         drm_kms_helper_poll_fini(drm);
 459         of_node_put(kmb->crtc.port);
 460         kmb->crtc.port = NULL;
 461         pm_runtime_get_sync(drm->dev);
 462         kmb_irq_uninstall(drm);
 463         pm_runtime_put_sync(drm->dev);
 464         pm_runtime_disable(drm->dev);
 465
 466         of_reserved_mem_device_release(drm->dev);
 467
 468         /* Release clks */
 469         kmb_display_clk_disable(kmb);
 470
 471         dev_set_drvdata(dev, NULL);
 472
 473         /* Unregister DSI host */
 474         kmb_dsi_host_unregister(kmb->kmb_dsi);
 475         drm_atomic_helper_shutdown(drm);
 476         return 0;
 477 }
 478
 479 static int kmb_probe(struct platform_device *pdev)
 480 {
 481         struct device *dev = get_device(&pdev->dev);
 482         struct kmb_drm_private *kmb;
 483         int ret = 0;
 484         struct device_node *dsi_in;
 485         struct device_node *dsi_node;
 486         struct platform_device *dsi_pdev;
 487
 488         /* The bridge (ADV 7535) will return -EPROBE_DEFER until it
 489          * has a mipi_dsi_host to register its device to. So, we
 490          * first register the DSI host during probe time, and then return
 491          * -EPROBE_DEFER until the bridge is loaded. Probe will be called again
 492          *  and then the rest of the driver initialization can proceed
 493          *  afterwards and the bridge can be successfully attached.
 494          */
 495         dsi_in = of_graph_get_endpoint_by_regs(dev->of_node, 0, 0);
 496         if (!dsi_in) {
 497                 DRM_ERROR("Failed to get dsi_in node info from DT");
 498                 return -EINVAL;
 499         }
 500         dsi_node = of_graph_get_remote_port_parent(dsi_in);
 501         if (!dsi_node) {
 502                 of_node_put(dsi_in);
 503                 DRM_ERROR("Failed to get dsi node from DT\n");
 504                 return -EINVAL;
 505         }
 506
 507         dsi_pdev = of_find_device_by_node(dsi_node);
 508         if (!dsi_pdev) {
 509                 of_node_put(dsi_in);
 510                 of_node_put(dsi_node);
 511                 DRM_ERROR("Failed to get dsi platform device\n");
 512                 return -EINVAL;
 513         }
 514
 515         of_node_put(dsi_in);
 516         of_node_put(dsi_node);
 517         ret = kmb_dsi_host_bridge_init(get_device(&dsi_pdev->dev));
 518
 519         if (ret == -EPROBE_DEFER) {
 520                 return -EPROBE_DEFER;
 521         } else if (ret) {
 522                 DRM_ERROR("probe failed to initialize DSI host bridge\n");
 523                 return ret;
 524         }
 525
 526         /* Create DRM device */
 527         kmb = devm_drm_dev_alloc(dev, &kmb_driver,
 528                                  struct kmb_drm_private, drm);
 529         if (IS_ERR(kmb))
 530                 return PTR_ERR(kmb);
 531
 532         dev_set_drvdata(dev, &kmb->drm);
 533
 534         /* Initialize MIPI DSI */
 535         kmb->kmb_dsi = kmb_dsi_init(dsi_pdev);
 536         if (IS_ERR(kmb->kmb_dsi)) {
 537                 drm_err(&kmb->drm, "failed to initialize DSI\n");
 538                 ret = PTR_ERR(kmb->kmb_dsi);
 539                 goto err_free1;
 540         }
 541
 542         kmb->kmb_dsi->dev = &dsi_pdev->dev;
 543         kmb->kmb_dsi->pdev = dsi_pdev;
 544         ret = kmb_hw_init(&kmb->drm, 0);
 545         if (ret)
 546                 goto err_free1;
 547
 548         ret = kmb_setup_mode_config(&kmb->drm);
 549         if (ret)
 550                 goto err_free;
 551
 552         ret = kmb_irq_install(&kmb->drm, kmb->irq_lcd);
 553         if (ret < 0) {
 554                 drm_err(&kmb->drm, "failed to install IRQ handler\n");
 555                 goto err_irq;
 556         }
 557
 558         drm_kms_helper_poll_init(&kmb->drm);
 559
 560         /* Register graphics device with the kernel */
 561         ret = drm_dev_register(&kmb->drm, 0);
 562         if (ret)
 563                 goto err_register;
 564
 565         drm_fbdev_dma_setup(&kmb->drm, 0);
 566
 567         return 0;
 568
 569  err_register:
 570         drm_kms_helper_poll_fini(&kmb->drm);
 571  err_irq:
 572         pm_runtime_disable(kmb->drm.dev);
 573  err_free:
 574         drm_crtc_cleanup(&kmb->crtc);
 575         drm_mode_config_cleanup(&kmb->drm);
 576  err_free1:
 577         dev_set_drvdata(dev, NULL);
 578         kmb_dsi_host_unregister(kmb->kmb_dsi);
 579
 580         return ret;
 581 }
 582
 583 static const struct of_device_id kmb_of_match[] = {
 584         {.compatible = "intel,keembay-display"},
 585         {},
 586 };
 587
 588 MODULE_DEVICE_TABLE(of, kmb_of_match);
 589
 590 static int __maybe_unused kmb_pm_suspend(struct device *dev)
 591 {
 592         struct drm_device *drm = dev_get_drvdata(dev);
 593         struct kmb_drm_private *kmb = to_kmb(drm);
 594
 595         drm_kms_helper_poll_disable(drm);
 596
 597         kmb->state = drm_atomic_helper_suspend(drm);
 598         if (IS_ERR(kmb->state)) {
 599                 drm_kms_helper_poll_enable(drm);
 600                 return PTR_ERR(kmb->state);
 601         }
 602
 603         return 0;
 604 }
 605
 606 static int __maybe_unused kmb_pm_resume(struct device *dev)
 607 {
 608         struct drm_device *drm = dev_get_drvdata(dev);
 609         struct kmb_drm_private *kmb = drm ? to_kmb(drm) : NULL;
 610
 611         if (!kmb)
 612                 return 0;
 613
 614         drm_atomic_helper_resume(drm, kmb->state);
 615         drm_kms_helper_poll_enable(drm);
 616
 617         return 0;
 618 }
 619
 620 static SIMPLE_DEV_PM_OPS(kmb_pm_ops, kmb_pm_suspend, kmb_pm_resume);
 621
 622 static struct platform_driver kmb_platform_driver = {
 623         .probe = kmb_probe,
 624         .remove = kmb_remove,
 625         .driver = {
 626                 .name = "kmb-drm",
 627                 .pm = &kmb_pm_ops,
 628                 .of_match_table = kmb_of_match,
 629         },
 630 };
 631
 632 drm_module_platform_driver(kmb_platform_driver);
 633
 634 MODULE_AUTHOR("Intel Corporation");
 635 MODULE_DESCRIPTION("Keembay Display driver");
 636 MODULE_LICENSE("GPL v2");