1
2
3
4
5
6
7
8
9
10
11
12
13#include <drm/drmP.h>
14#include <drm/drm_atomic_helper.h>
15#include <drm/drm_crtc.h>
16#include <drm/drm_crtc_helper.h>
17#include <drm/drm_modes.h>
18
19#include <linux/clk-provider.h>
20#include <linux/ioport.h>
21#include <linux/of_address.h>
22#include <linux/of_graph.h>
23#include <linux/of_irq.h>
24#include <linux/regmap.h>
25
26#include <video/videomode.h>
27
28#include "sun4i_backend.h"
29#include "sun4i_crtc.h"
30#include "sun4i_drv.h"
31#include "sunxi_engine.h"
32#include "sun4i_tcon.h"
33
34
35
36
37
38
39static struct drm_encoder *sun4i_crtc_get_encoder(struct drm_crtc *crtc)
40{
41 struct drm_encoder *encoder;
42
43 drm_for_each_encoder(encoder, crtc->dev)
44 if (encoder->crtc == crtc)
45 return encoder;
46
47 return NULL;
48}
49
50static int sun4i_crtc_atomic_check(struct drm_crtc *crtc,
51 struct drm_crtc_state *state)
52{
53 struct sun4i_crtc *scrtc = drm_crtc_to_sun4i_crtc(crtc);
54 struct sunxi_engine *engine = scrtc->engine;
55 int ret = 0;
56
57 if (engine && engine->ops && engine->ops->atomic_check)
58 ret = engine->ops->atomic_check(engine, state);
59
60 return ret;
61}
62
63static void sun4i_crtc_atomic_begin(struct drm_crtc *crtc,
64 struct drm_crtc_state *old_state)
65{
66 struct sun4i_crtc *scrtc = drm_crtc_to_sun4i_crtc(crtc);
67 struct drm_device *dev = crtc->dev;
68 struct sunxi_engine *engine = scrtc->engine;
69 unsigned long flags;
70
71 if (crtc->state->event) {
72 WARN_ON(drm_crtc_vblank_get(crtc) != 0);
73
74 spin_lock_irqsave(&dev->event_lock, flags);
75 scrtc->event = crtc->state->event;
76 spin_unlock_irqrestore(&dev->event_lock, flags);
77 crtc->state->event = NULL;
78 }
79
80 if (engine->ops->atomic_begin)
81 engine->ops->atomic_begin(engine, old_state);
82}
83
84static void sun4i_crtc_atomic_flush(struct drm_crtc *crtc,
85 struct drm_crtc_state *old_state)
86{
87 struct sun4i_crtc *scrtc = drm_crtc_to_sun4i_crtc(crtc);
88 struct drm_pending_vblank_event *event = crtc->state->event;
89
90 DRM_DEBUG_DRIVER("Committing plane changes\n");
91
92 sunxi_engine_commit(scrtc->engine);
93
94 if (event) {
95 crtc->state->event = NULL;
96
97 spin_lock_irq(&crtc->dev->event_lock);
98 if (drm_crtc_vblank_get(crtc) == 0)
99 drm_crtc_arm_vblank_event(crtc, event);
100 else
101 drm_crtc_send_vblank_event(crtc, event);
102 spin_unlock_irq(&crtc->dev->event_lock);
103 }
104}
105
106static void sun4i_crtc_atomic_disable(struct drm_crtc *crtc,
107 struct drm_crtc_state *old_state)
108{
109 struct drm_encoder *encoder = sun4i_crtc_get_encoder(crtc);
110 struct sun4i_crtc *scrtc = drm_crtc_to_sun4i_crtc(crtc);
111
112 DRM_DEBUG_DRIVER("Disabling the CRTC\n");
113
114 drm_crtc_vblank_off(crtc);
115
116 sun4i_tcon_set_status(scrtc->tcon, encoder, false);
117
118 if (crtc->state->event && !crtc->state->active) {
119 spin_lock_irq(&crtc->dev->event_lock);
120 drm_crtc_send_vblank_event(crtc, crtc->state->event);
121 spin_unlock_irq(&crtc->dev->event_lock);
122
123 crtc->state->event = NULL;
124 }
125}
126
127static void sun4i_crtc_atomic_enable(struct drm_crtc *crtc,
128 struct drm_crtc_state *old_state)
129{
130 struct drm_encoder *encoder = sun4i_crtc_get_encoder(crtc);
131 struct sun4i_crtc *scrtc = drm_crtc_to_sun4i_crtc(crtc);
132
133 DRM_DEBUG_DRIVER("Enabling the CRTC\n");
134
135 sun4i_tcon_set_status(scrtc->tcon, encoder, true);
136
137 drm_crtc_vblank_on(crtc);
138}
139
140static void sun4i_crtc_mode_set_nofb(struct drm_crtc *crtc)
141{
142 struct drm_display_mode *mode = &crtc->state->adjusted_mode;
143 struct drm_encoder *encoder = sun4i_crtc_get_encoder(crtc);
144 struct sun4i_crtc *scrtc = drm_crtc_to_sun4i_crtc(crtc);
145
146 sun4i_tcon_mode_set(scrtc->tcon, encoder, mode);
147}
148
149static const struct drm_crtc_helper_funcs sun4i_crtc_helper_funcs = {
150 .atomic_check = sun4i_crtc_atomic_check,
151 .atomic_begin = sun4i_crtc_atomic_begin,
152 .atomic_flush = sun4i_crtc_atomic_flush,
153 .atomic_enable = sun4i_crtc_atomic_enable,
154 .atomic_disable = sun4i_crtc_atomic_disable,
155 .mode_set_nofb = sun4i_crtc_mode_set_nofb,
156};
157
158static int sun4i_crtc_enable_vblank(struct drm_crtc *crtc)
159{
160 struct sun4i_crtc *scrtc = drm_crtc_to_sun4i_crtc(crtc);
161
162 DRM_DEBUG_DRIVER("Enabling VBLANK on crtc %p\n", crtc);
163
164 sun4i_tcon_enable_vblank(scrtc->tcon, true);
165
166 return 0;
167}
168
169static void sun4i_crtc_disable_vblank(struct drm_crtc *crtc)
170{
171 struct sun4i_crtc *scrtc = drm_crtc_to_sun4i_crtc(crtc);
172
173 DRM_DEBUG_DRIVER("Disabling VBLANK on crtc %p\n", crtc);
174
175 sun4i_tcon_enable_vblank(scrtc->tcon, false);
176}
177
178static const struct drm_crtc_funcs sun4i_crtc_funcs = {
179 .atomic_destroy_state = drm_atomic_helper_crtc_destroy_state,
180 .atomic_duplicate_state = drm_atomic_helper_crtc_duplicate_state,
181 .destroy = drm_crtc_cleanup,
182 .page_flip = drm_atomic_helper_page_flip,
183 .reset = drm_atomic_helper_crtc_reset,
184 .set_config = drm_atomic_helper_set_config,
185 .enable_vblank = sun4i_crtc_enable_vblank,
186 .disable_vblank = sun4i_crtc_disable_vblank,
187};
188
189struct sun4i_crtc *sun4i_crtc_init(struct drm_device *drm,
190 struct sunxi_engine *engine,
191 struct sun4i_tcon *tcon)
192{
193 struct sun4i_crtc *scrtc;
194 struct drm_plane **planes;
195 struct drm_plane *primary = NULL, *cursor = NULL;
196 int ret, i;
197
198 scrtc = devm_kzalloc(drm->dev, sizeof(*scrtc), GFP_KERNEL);
199 if (!scrtc)
200 return ERR_PTR(-ENOMEM);
201 scrtc->engine = engine;
202 scrtc->tcon = tcon;
203
204
205 planes = sunxi_engine_layers_init(drm, engine);
206 if (IS_ERR(planes)) {
207 dev_err(drm->dev, "Couldn't create the planes\n");
208 return NULL;
209 }
210
211
212 for (i = 0; planes[i]; i++) {
213 struct drm_plane *plane = planes[i];
214
215 switch (plane->type) {
216 case DRM_PLANE_TYPE_PRIMARY:
217 primary = plane;
218 break;
219 case DRM_PLANE_TYPE_CURSOR:
220 cursor = plane;
221 break;
222 default:
223 break;
224 }
225 }
226
227 ret = drm_crtc_init_with_planes(drm, &scrtc->crtc,
228 primary,
229 cursor,
230 &sun4i_crtc_funcs,
231 NULL);
232 if (ret) {
233 dev_err(drm->dev, "Couldn't init DRM CRTC\n");
234 return ERR_PTR(ret);
235 }
236
237 drm_crtc_helper_add(&scrtc->crtc, &sun4i_crtc_helper_funcs);
238
239
240 scrtc->crtc.port = of_graph_get_port_by_id(scrtc->tcon->dev->of_node,
241 1);
242
243
244 for (i = 0; planes[i]; i++) {
245 uint32_t possible_crtcs = BIT(drm_crtc_index(&scrtc->crtc));
246 struct drm_plane *plane = planes[i];
247
248 if (plane->type == DRM_PLANE_TYPE_OVERLAY)
249 plane->possible_crtcs = possible_crtcs;
250 }
251
252 return scrtc;
253}
254