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