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