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
dcss_kms_mode_config_init(struct dcss_kms_dev * kms)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
dcss_kms_bridge_connector_init(struct dcss_kms_dev * kms)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
dcss_kms_attach(struct dcss_dev * dcss)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
dcss_kms_detach(struct dcss_kms_dev * kms)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
dcss_kms_shutdown(struct dcss_kms_dev * kms)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 }
184