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 | |
20 | DEFINE_DRM_GEM_DMA_FOPS(dcss_cma_fops); |
21 | |
22 | static 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 | |
28 | static 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 | |
40 | static const struct drm_mode_config_helper_funcs dcss_mode_config_helpers = { |
41 | .atomic_commit_tail = drm_atomic_helper_commit_tail_rpm, |
42 | }; |
43 | |
44 | static 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(dev: &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 | |
60 | static const struct drm_encoder_funcs dcss_kms_simple_encoder_funcs = { |
61 | .destroy = drm_encoder_cleanup, |
62 | }; |
63 | |
64 | static 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(np: ddev->dev->of_node, port: 0, endpoint: 0, |
74 | panel: &panel, bridge: &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(dev: &kms->base, encoder, |
86 | funcs: &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 | flags: DRM_BRIDGE_ATTACH_NO_CONNECTOR); |
95 | if (ret < 0) |
96 | return ret; |
97 | |
98 | kms->connector = drm_bridge_connector_init(drm: ddev, encoder); |
99 | if (IS_ERR(ptr: kms->connector)) { |
100 | dev_err(ddev->dev, "Unable to create bridge connector.\n" ); |
101 | return PTR_ERR(ptr: kms->connector); |
102 | } |
103 | |
104 | drm_connector_attach_encoder(connector: kms->connector, encoder); |
105 | |
106 | return 0; |
107 | } |
108 | |
109 | struct 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(ptr: 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(dev: drm, num_crtcs: 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(dev: drm); |
141 | |
142 | drm_kms_helper_poll_init(dev: drm); |
143 | |
144 | ret = drm_dev_register(dev: drm, flags: 0); |
145 | if (ret) |
146 | goto cleanup_crtc; |
147 | |
148 | drm_fbdev_dma_setup(dev: drm, preferred_bpp: 32); |
149 | |
150 | return kms; |
151 | |
152 | cleanup_crtc: |
153 | drm_kms_helper_poll_fini(dev: drm); |
154 | dcss_crtc_deinit(crtc, drm); |
155 | |
156 | cleanup_mode_config: |
157 | drm_mode_config_cleanup(dev: drm); |
158 | drm->dev_private = NULL; |
159 | |
160 | return ERR_PTR(error: ret); |
161 | } |
162 | |
163 | void dcss_kms_detach(struct dcss_kms_dev *kms) |
164 | { |
165 | struct drm_device *drm = &kms->base; |
166 | |
167 | drm_dev_unregister(dev: drm); |
168 | drm_kms_helper_poll_fini(dev: drm); |
169 | drm_atomic_helper_shutdown(dev: drm); |
170 | drm_crtc_vblank_off(crtc: &kms->crtc.base); |
171 | drm_mode_config_cleanup(dev: drm); |
172 | dcss_crtc_deinit(crtc: &kms->crtc, drm); |
173 | drm->dev_private = NULL; |
174 | } |
175 | |
176 | void dcss_kms_shutdown(struct dcss_kms_dev *kms) |
177 | { |
178 | struct drm_device *drm = &kms->base; |
179 | |
180 | drm_atomic_helper_shutdown(dev: drm); |
181 | } |
182 | |