Commit | Line | Data |
---|---|---|
864ee9e6 JS |
1 | /* |
2 | * Copyright (C) 2011 Samsung Electronics Co.Ltd | |
3 | * Authors: Joonyoung Shim <jy0922.shim@samsung.com> | |
4 | * | |
5 | * This program is free software; you can redistribute it and/or modify it | |
6 | * under the terms of the GNU General Public License as published by the | |
7 | * Free Software Foundation; either version 2 of the License, or (at your | |
8 | * option) any later version. | |
9 | * | |
10 | */ | |
11 | ||
760285e7 | 12 | #include <drm/drmP.h> |
864ee9e6 | 13 | |
81e50bcd | 14 | #include <drm/drm_atomic.h> |
4ea9526b | 15 | #include <drm/drm_atomic_helper.h> |
81e50bcd AH |
16 | #include <drm/drm_plane_helper.h> |
17 | #include <drm/exynos_drm.h> | |
864ee9e6 | 18 | #include "exynos_drm_drv.h" |
080be03d | 19 | #include "exynos_drm_crtc.h" |
4070d212 JS |
20 | #include "exynos_drm_fb.h" |
21 | #include "exynos_drm_gem.h" | |
e30655d0 | 22 | #include "exynos_drm_plane.h" |
864ee9e6 | 23 | |
2ab97921 JS |
24 | /* |
25 | * This function is to get X or Y size shown via screen. This needs length and | |
26 | * start position of CRTC. | |
27 | * | |
28 | * <--- length ---> | |
29 | * CRTC ---------------- | |
30 | * ^ start ^ end | |
31 | * | |
60a705a9 | 32 | * There are six cases from a to f. |
2ab97921 JS |
33 | * |
34 | * <----- SCREEN -----> | |
35 | * 0 last | |
36 | * ----------|------------------|---------- | |
37 | * CRTCs | |
38 | * a ------- | |
39 | * b ------- | |
40 | * c -------------------------- | |
41 | * d -------- | |
42 | * e ------- | |
43 | * f ------- | |
44 | */ | |
45 | static int exynos_plane_get_size(int start, unsigned length, unsigned last) | |
46 | { | |
47 | int end = start + length; | |
48 | int size = 0; | |
49 | ||
50 | if (start <= 0) { | |
51 | if (end > 0) | |
52 | size = min_t(unsigned, end, last); | |
53 | } else if (start <= last) { | |
54 | size = min_t(unsigned, last - start, length); | |
55 | } | |
56 | ||
57 | return size; | |
58 | } | |
59 | ||
0114f404 | 60 | static void exynos_plane_mode_set(struct exynos_drm_plane_state *exynos_state) |
adf5691c | 61 | { |
0114f404 | 62 | struct drm_plane_state *state = &exynos_state->base; |
81e50bcd AH |
63 | struct drm_crtc *crtc = state->crtc; |
64 | struct drm_crtc_state *crtc_state = | |
65 | drm_atomic_get_existing_crtc_state(state->state, crtc); | |
66 | struct drm_display_mode *mode = &crtc_state->adjusted_mode; | |
0114f404 MS |
67 | int crtc_x, crtc_y; |
68 | unsigned int crtc_w, crtc_h; | |
69 | unsigned int src_x, src_y; | |
70 | unsigned int src_w, src_h; | |
adf5691c GP |
71 | unsigned int actual_w; |
72 | unsigned int actual_h; | |
73 | ||
0114f404 MS |
74 | /* |
75 | * The original src/dest coordinates are stored in exynos_state->base, | |
76 | * but we want to keep another copy internal to our driver that we can | |
77 | * clip/modify ourselves. | |
78 | */ | |
79 | ||
80 | crtc_x = state->crtc_x; | |
81 | crtc_y = state->crtc_y; | |
82 | crtc_w = state->crtc_w; | |
83 | crtc_h = state->crtc_h; | |
84 | ||
85 | src_x = state->src_x >> 16; | |
86 | src_y = state->src_y >> 16; | |
87 | src_w = state->src_w >> 16; | |
88 | src_h = state->src_h >> 16; | |
89 | ||
d16a11a0 MS |
90 | /* set ratio */ |
91 | exynos_state->h_ratio = (src_w << 16) / crtc_w; | |
92 | exynos_state->v_ratio = (src_h << 16) / crtc_h; | |
93 | ||
94 | /* clip to visible area */ | |
020e79de JS |
95 | actual_w = exynos_plane_get_size(crtc_x, crtc_w, mode->hdisplay); |
96 | actual_h = exynos_plane_get_size(crtc_y, crtc_h, mode->vdisplay); | |
2ab97921 JS |
97 | |
98 | if (crtc_x < 0) { | |
99 | if (actual_w) | |
d16a11a0 | 100 | src_x += ((-crtc_x) * exynos_state->h_ratio) >> 16; |
2ab97921 JS |
101 | crtc_x = 0; |
102 | } | |
103 | ||
104 | if (crtc_y < 0) { | |
105 | if (actual_h) | |
d16a11a0 | 106 | src_y += ((-crtc_y) * exynos_state->v_ratio) >> 16; |
2ab97921 JS |
107 | crtc_y = 0; |
108 | } | |
4070d212 JS |
109 | |
110 | /* set drm framebuffer data. */ | |
0114f404 MS |
111 | exynos_state->src.x = src_x; |
112 | exynos_state->src.y = src_y; | |
113 | exynos_state->src.w = (actual_w * exynos_state->h_ratio) >> 16; | |
114 | exynos_state->src.h = (actual_h * exynos_state->v_ratio) >> 16; | |
8837deea GP |
115 | |
116 | /* set plane range to be displayed. */ | |
0114f404 MS |
117 | exynos_state->crtc.x = crtc_x; |
118 | exynos_state->crtc.y = crtc_y; | |
119 | exynos_state->crtc.w = actual_w; | |
120 | exynos_state->crtc.h = actual_h; | |
d88d2463 | 121 | |
8837deea | 122 | DRM_DEBUG_KMS("plane : offset_x/y(%d,%d), width/height(%d,%d)", |
0114f404 MS |
123 | exynos_state->crtc.x, exynos_state->crtc.y, |
124 | exynos_state->crtc.w, exynos_state->crtc.h); | |
125 | } | |
126 | ||
127 | static void exynos_drm_plane_reset(struct drm_plane *plane) | |
128 | { | |
0ea72405 | 129 | struct exynos_drm_plane *exynos_plane = to_exynos_plane(plane); |
0114f404 MS |
130 | struct exynos_drm_plane_state *exynos_state; |
131 | ||
132 | if (plane->state) { | |
133 | exynos_state = to_exynos_plane_state(plane->state); | |
134 | if (exynos_state->base.fb) | |
135 | drm_framebuffer_unreference(exynos_state->base.fb); | |
136 | kfree(exynos_state); | |
137 | plane->state = NULL; | |
138 | } | |
139 | ||
140 | exynos_state = kzalloc(sizeof(*exynos_state), GFP_KERNEL); | |
141 | if (exynos_state) { | |
142 | plane->state = &exynos_state->base; | |
143 | plane->state->plane = plane; | |
e47726a1 | 144 | plane->state->zpos = exynos_plane->config->zpos; |
0114f404 MS |
145 | } |
146 | } | |
147 | ||
148 | static struct drm_plane_state * | |
149 | exynos_drm_plane_duplicate_state(struct drm_plane *plane) | |
150 | { | |
151 | struct exynos_drm_plane_state *exynos_state; | |
152 | struct exynos_drm_plane_state *copy; | |
153 | ||
154 | exynos_state = to_exynos_plane_state(plane->state); | |
155 | copy = kzalloc(sizeof(*exynos_state), GFP_KERNEL); | |
156 | if (!copy) | |
157 | return NULL; | |
4070d212 | 158 | |
0114f404 MS |
159 | __drm_atomic_helper_plane_duplicate_state(plane, ©->base); |
160 | return ©->base; | |
161 | } | |
4070d212 | 162 | |
0114f404 MS |
163 | static void exynos_drm_plane_destroy_state(struct drm_plane *plane, |
164 | struct drm_plane_state *old_state) | |
165 | { | |
166 | struct exynos_drm_plane_state *old_exynos_state = | |
167 | to_exynos_plane_state(old_state); | |
2f701695 | 168 | __drm_atomic_helper_plane_destroy_state(old_state); |
0114f404 | 169 | kfree(old_exynos_state); |
4070d212 JS |
170 | } |
171 | ||
864ee9e6 | 172 | static struct drm_plane_funcs exynos_plane_funcs = { |
910874a8 GP |
173 | .update_plane = drm_atomic_helper_update_plane, |
174 | .disable_plane = drm_atomic_helper_disable_plane, | |
97464d7d | 175 | .destroy = drm_plane_cleanup, |
0ea72405 | 176 | .set_property = drm_atomic_helper_plane_set_property, |
0114f404 MS |
177 | .reset = exynos_drm_plane_reset, |
178 | .atomic_duplicate_state = exynos_drm_plane_duplicate_state, | |
179 | .atomic_destroy_state = exynos_drm_plane_destroy_state, | |
864ee9e6 JS |
180 | }; |
181 | ||
6178d3d1 MS |
182 | static int |
183 | exynos_drm_plane_check_size(const struct exynos_drm_plane_config *config, | |
184 | struct exynos_drm_plane_state *state) | |
185 | { | |
186 | bool width_ok = false, height_ok = false; | |
187 | ||
188 | if (config->capabilities & EXYNOS_DRM_PLANE_CAP_SCALE) | |
189 | return 0; | |
190 | ||
191 | if (state->src.w == state->crtc.w) | |
192 | width_ok = true; | |
193 | ||
194 | if (state->src.h == state->crtc.h) | |
195 | height_ok = true; | |
196 | ||
197 | if ((config->capabilities & EXYNOS_DRM_PLANE_CAP_DOUBLE) && | |
198 | state->h_ratio == (1 << 15)) | |
199 | width_ok = true; | |
200 | ||
201 | if ((config->capabilities & EXYNOS_DRM_PLANE_CAP_DOUBLE) && | |
202 | state->v_ratio == (1 << 15)) | |
203 | height_ok = true; | |
204 | ||
39bf8609 | 205 | if (width_ok && height_ok) |
6178d3d1 MS |
206 | return 0; |
207 | ||
208 | DRM_DEBUG_KMS("scaling mode is not supported"); | |
209 | return -ENOTSUPP; | |
210 | } | |
211 | ||
43dbdad2 GP |
212 | static int exynos_plane_atomic_check(struct drm_plane *plane, |
213 | struct drm_plane_state *state) | |
214 | { | |
d5f5223c | 215 | struct exynos_drm_plane *exynos_plane = to_exynos_plane(plane); |
0114f404 MS |
216 | struct exynos_drm_plane_state *exynos_state = |
217 | to_exynos_plane_state(state); | |
218 | int ret = 0; | |
d5f5223c | 219 | |
0114f404 | 220 | if (!state->crtc || !state->fb) |
d5f5223c GP |
221 | return 0; |
222 | ||
0114f404 MS |
223 | /* translate state into exynos_state */ |
224 | exynos_plane_mode_set(exynos_state); | |
d5f5223c | 225 | |
6178d3d1 | 226 | ret = exynos_drm_plane_check_size(exynos_plane->config, exynos_state); |
0114f404 | 227 | return ret; |
43dbdad2 GP |
228 | } |
229 | ||
230 | static void exynos_plane_atomic_update(struct drm_plane *plane, | |
231 | struct drm_plane_state *old_state) | |
232 | { | |
233 | struct drm_plane_state *state = plane->state; | |
d5f5223c GP |
234 | struct exynos_drm_crtc *exynos_crtc = to_exynos_crtc(state->crtc); |
235 | struct exynos_drm_plane *exynos_plane = to_exynos_plane(plane); | |
43dbdad2 GP |
236 | |
237 | if (!state->crtc) | |
238 | return; | |
239 | ||
0114f404 | 240 | plane->crtc = state->crtc; |
822f6dfd | 241 | |
9cc7610a | 242 | if (exynos_crtc->ops->update_plane) |
1e1d1393 | 243 | exynos_crtc->ops->update_plane(exynos_crtc, exynos_plane); |
43dbdad2 GP |
244 | } |
245 | ||
b744868c GP |
246 | static void exynos_plane_atomic_disable(struct drm_plane *plane, |
247 | struct drm_plane_state *old_state) | |
248 | { | |
249 | struct exynos_drm_plane *exynos_plane = to_exynos_plane(plane); | |
250 | struct exynos_drm_crtc *exynos_crtc = to_exynos_crtc(old_state->crtc); | |
251 | ||
252 | if (!old_state->crtc) | |
253 | return; | |
254 | ||
9cc7610a | 255 | if (exynos_crtc->ops->disable_plane) |
0114f404 | 256 | exynos_crtc->ops->disable_plane(exynos_crtc, exynos_plane); |
b744868c GP |
257 | } |
258 | ||
43dbdad2 GP |
259 | static const struct drm_plane_helper_funcs plane_helper_funcs = { |
260 | .atomic_check = exynos_plane_atomic_check, | |
261 | .atomic_update = exynos_plane_atomic_update, | |
b744868c | 262 | .atomic_disable = exynos_plane_atomic_disable, |
43dbdad2 GP |
263 | }; |
264 | ||
6e2a3b66 | 265 | static void exynos_plane_attach_zpos_property(struct drm_plane *plane, |
e47726a1 | 266 | bool immutable) |
00ae67cf | 267 | { |
e47726a1 MS |
268 | /* FIXME */ |
269 | if (immutable) | |
270 | drm_plane_create_zpos_immutable_property(plane, 0); | |
271 | else | |
272 | drm_plane_create_zpos_property(plane, 0, 0, MAX_PLANE - 1); | |
00ae67cf JS |
273 | } |
274 | ||
7ee14cdc | 275 | int exynos_plane_init(struct drm_device *dev, |
2c82607b | 276 | struct exynos_drm_plane *exynos_plane, unsigned int index, |
fd2d2fc2 | 277 | const struct exynos_drm_plane_config *config) |
864ee9e6 | 278 | { |
b5d2eb3b | 279 | int err; |
864ee9e6 | 280 | |
fd2d2fc2 | 281 | err = drm_universal_plane_init(dev, &exynos_plane->base, |
2c82607b | 282 | 1 << dev->mode_config.num_crtc, |
fd2d2fc2 MS |
283 | &exynos_plane_funcs, |
284 | config->pixel_formats, | |
285 | config->num_pixel_formats, | |
e6fc3b68 | 286 | NULL, config->type, NULL); |
b5d2eb3b JS |
287 | if (err) { |
288 | DRM_ERROR("failed to initialize plane\n"); | |
7ee14cdc | 289 | return err; |
b5d2eb3b JS |
290 | } |
291 | ||
43dbdad2 GP |
292 | drm_plane_helper_add(&exynos_plane->base, &plane_helper_funcs); |
293 | ||
40bdfb0a | 294 | exynos_plane->index = index; |
fd2d2fc2 | 295 | exynos_plane->config = config; |
6e2a3b66 | 296 | |
e47726a1 MS |
297 | exynos_plane_attach_zpos_property(&exynos_plane->base, |
298 | !(config->capabilities & EXYNOS_DRM_PLANE_CAP_ZPOS)); | |
864ee9e6 | 299 | |
7ee14cdc | 300 | return 0; |
864ee9e6 | 301 | } |