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_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