drivers/gpu/drm/imx/dcss/dcss-kms.c

   1 // SPDX-License-Identifier: GPL-2.0
   2 /*
   3  * Copyright 2019 NXP.
   4  */
   5
   6 #include <drm/clients/drm_client_setup.h>
   7 #include <drm/drm_atomic.h>
   8 #include <drm/drm_atomic_helper.h>
   9 #include <drm/drm_bridge.h>
  10 #include <drm/drm_bridge_connector.h>
  11 #include <drm/drm_drv.h>
  12 #include <drm/drm_fbdev_dma.h>
  13 #include <drm/drm_gem_dma_helper.h>
  14 #include <drm/drm_gem_framebuffer_helper.h>
  15 #include <drm/drm_of.h>
  16 #include <drm/drm_probe_helper.h>
  17 #include <drm/drm_vblank.h>
  18
  19 #include "dcss-dev.h"
  20 #include "dcss-kms.h"
  21
  22 DEFINE_DRM_GEM_DMA_FOPS(dcss_cma_fops);
  23
  24 static const struct drm_mode_config_funcs dcss_drm_mode_config_funcs = {
  25         .fb_create = drm_gem_fb_create,
  26         .atomic_check = drm_atomic_helper_check,
  27         .atomic_commit = drm_atomic_helper_commit,
  28 };
  29
  30 static const struct drm_driver dcss_kms_driver = {
  31         .driver_features        = DRIVER_MODESET | DRIVER_GEM | DRIVER_ATOMIC,
  32         DRM_GEM_DMA_DRIVER_OPS,
  33         DRM_FBDEV_DMA_DRIVER_OPS,
  34         .fops                   = &dcss_cma_fops,
  35         .name                   = "imx-dcss",
  36         .desc                   = "i.MX8MQ Display Subsystem",
  37         .major                  = 1,
  38         .minor                  = 0,
  39         .patchlevel             = 0,
  40 };
  41
  42 static const struct drm_mode_config_helper_funcs dcss_mode_config_helpers = {
  43         .atomic_commit_tail = drm_atomic_helper_commit_tail_rpm,
  44 };
  45
  46 static void dcss_kms_mode_config_init(struct dcss_kms_dev *kms)
  47 {
  48         struct drm_mode_config *config = &kms->base.mode_config;
  49
  50         drm_mode_config_init(&kms->base);
  51
  52         config->min_width = 1;
  53         config->min_height = 1;
  54         config->max_width = 4096;
  55         config->max_height = 4096;
  56         config->normalize_zpos = true;
  57
  58         config->funcs = &dcss_drm_mode_config_funcs;
  59         config->helper_private = &dcss_mode_config_helpers;
  60 }
  61
  62 static const struct drm_encoder_funcs dcss_kms_simple_encoder_funcs = {
  63         .destroy = drm_encoder_cleanup,
  64 };
  65
  66 static int dcss_kms_bridge_connector_init(struct dcss_kms_dev *kms)
  67 {
  68         struct drm_device *ddev = &kms->base;
  69         struct drm_encoder *encoder = &kms->encoder;
  70         struct drm_crtc *crtc = (struct drm_crtc *)&kms->crtc;
  71         struct drm_panel *panel;
  72         struct drm_bridge *bridge;
  73         int ret;
  74
  75         ret = drm_of_find_panel_or_bridge(ddev->dev->of_node, 0, 0,
  76                                           &panel, &bridge);
  77         if (ret)
  78                 return ret;
  79
  80         if (!bridge) {
  81                 dev_err(ddev->dev, "No bridge found %d.\n", ret);
  82                 return -ENODEV;
  83         }
  84
  85         encoder->possible_crtcs = drm_crtc_mask(crtc);
  86
  87         ret = drm_encoder_init(&kms->base, encoder,
  88                                &dcss_kms_simple_encoder_funcs,
  89                                DRM_MODE_ENCODER_NONE, NULL);
  90         if (ret) {
  91                 dev_err(ddev->dev, "Failed initializing encoder %d.\n", ret);
  92                 return ret;
  93         }
  94
  95         ret = drm_bridge_attach(encoder, bridge, NULL,
  96                                 DRM_BRIDGE_ATTACH_NO_CONNECTOR);
  97         if (ret < 0)
  98                 return ret;
  99
 100         kms->connector = drm_bridge_connector_init(ddev, encoder);
 101         if (IS_ERR(kms->connector)) {
 102                 dev_err(ddev->dev, "Unable to create bridge connector.\n");
 103                 return PTR_ERR(kms->connector);
 104         }
 105
 106         drm_connector_attach_encoder(kms->connector, encoder);
 107
 108         return 0;
 109 }
 110
 111 struct dcss_kms_dev *dcss_kms_attach(struct dcss_dev *dcss)
 112 {
 113         struct dcss_kms_dev *kms;
 114         struct drm_device *drm;
 115         struct dcss_crtc *crtc;
 116         int ret;
 117
 118         kms = devm_drm_dev_alloc(dcss->dev, &dcss_kms_driver,
 119                                  struct dcss_kms_dev, base);
 120         if (IS_ERR(kms))
 121                 return kms;
 122
 123         drm = &kms->base;
 124         crtc = &kms->crtc;
 125
 126         drm->dev_private = dcss;
 127
 128         dcss_kms_mode_config_init(kms);
 129
 130         ret = drm_vblank_init(drm, 1);
 131         if (ret)
 132                 goto cleanup_mode_config;
 133
 134         ret = dcss_kms_bridge_connector_init(kms);
 135         if (ret)
 136                 goto cleanup_mode_config;
 137
 138         ret = dcss_crtc_init(crtc, drm);
 139         if (ret)
 140                 goto cleanup_mode_config;
 141
 142         drm_mode_config_reset(drm);
 143
 144         drm_kms_helper_poll_init(drm);
 145
 146         ret = drm_dev_register(drm, 0);
 147         if (ret)
 148                 goto cleanup_crtc;
 149
 150         drm_client_setup(drm, NULL);
 151
 152         return kms;
 153
 154 cleanup_crtc:
 155         drm_kms_helper_poll_fini(drm);
 156         dcss_crtc_deinit(crtc, drm);
 157
 158 cleanup_mode_config:
 159         drm_mode_config_cleanup(drm);
 160         drm->dev_private = NULL;
 161
 162         return ERR_PTR(ret);
 163 }
 164
 165 void dcss_kms_detach(struct dcss_kms_dev *kms)
 166 {
 167         struct drm_device *drm = &kms->base;
 168
 169         drm_dev_unregister(drm);
 170         drm_kms_helper_poll_fini(drm);
 171         drm_atomic_helper_shutdown(drm);
 172         drm_crtc_vblank_off(&kms->crtc.base);
 173         drm_mode_config_cleanup(drm);
 174         dcss_crtc_deinit(&kms->crtc, drm);
 175         drm->dev_private = NULL;
 176 }
 177
 178 void dcss_kms_shutdown(struct dcss_kms_dev *kms)
 179 {
 180         struct drm_device *drm = &kms->base;
 181
 182         drm_atomic_helper_shutdown(drm);
 183 }