Commit | Line | Data |
---|---|---|
c8afe684 RC |
1 | /* |
2 | * Copyright (C) 2013 Red Hat | |
3 | * Author: Rob Clark <robdclark@gmail.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 version 2 as published by | |
7 | * the Free Software Foundation. | |
8 | * | |
9 | * This program is distributed in the hope that it will be useful, but WITHOUT | |
10 | * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or | |
11 | * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for | |
12 | * more details. | |
13 | * | |
14 | * You should have received a copy of the GNU General Public License along with | |
15 | * this program. If not, see <http://www.gnu.org/licenses/>. | |
16 | */ | |
17 | ||
78f27b1c MY |
18 | #include <drm/drm_crtc.h> |
19 | #include <drm/drm_crtc_helper.h> | |
20 | ||
c8afe684 | 21 | #include "msm_drv.h" |
dd2da6e3 | 22 | #include "msm_kms.h" |
c8afe684 | 23 | |
c8afe684 RC |
24 | struct msm_framebuffer { |
25 | struct drm_framebuffer base; | |
26 | const struct msm_format *format; | |
7ca12718 | 27 | struct drm_gem_object *planes[MAX_PLANE]; |
c8afe684 RC |
28 | }; |
29 | #define to_msm_framebuffer(x) container_of(x, struct msm_framebuffer, base) | |
30 | ||
31 | ||
32 | static int msm_framebuffer_create_handle(struct drm_framebuffer *fb, | |
33 | struct drm_file *file_priv, | |
34 | unsigned int *handle) | |
35 | { | |
36 | struct msm_framebuffer *msm_fb = to_msm_framebuffer(fb); | |
37 | return drm_gem_handle_create(file_priv, | |
38 | msm_fb->planes[0], handle); | |
39 | } | |
40 | ||
41 | static void msm_framebuffer_destroy(struct drm_framebuffer *fb) | |
42 | { | |
43 | struct msm_framebuffer *msm_fb = to_msm_framebuffer(fb); | |
bcb0b461 | 44 | int i, n = fb->format->num_planes; |
c8afe684 RC |
45 | |
46 | DBG("destroy: FB ID: %d (%p)", fb->base.id, fb); | |
47 | ||
48 | drm_framebuffer_cleanup(fb); | |
49 | ||
50 | for (i = 0; i < n; i++) { | |
51 | struct drm_gem_object *bo = msm_fb->planes[i]; | |
e73a8569 ME |
52 | |
53 | drm_gem_object_unreference_unlocked(bo); | |
c8afe684 RC |
54 | } |
55 | ||
56 | kfree(msm_fb); | |
57 | } | |
58 | ||
c8afe684 RC |
59 | static const struct drm_framebuffer_funcs msm_framebuffer_funcs = { |
60 | .create_handle = msm_framebuffer_create_handle, | |
61 | .destroy = msm_framebuffer_destroy, | |
c8afe684 RC |
62 | }; |
63 | ||
64 | #ifdef CONFIG_DEBUG_FS | |
65 | void msm_framebuffer_describe(struct drm_framebuffer *fb, struct seq_file *m) | |
66 | { | |
67 | struct msm_framebuffer *msm_fb = to_msm_framebuffer(fb); | |
bcb0b461 | 68 | int i, n = fb->format->num_planes; |
c8afe684 RC |
69 | |
70 | seq_printf(m, "fb: %dx%d@%4.4s (%2d, ID:%d)\n", | |
438b74a5 | 71 | fb->width, fb->height, (char *)&fb->format->format, |
747a598f | 72 | drm_framebuffer_read_refcount(fb), fb->base.id); |
c8afe684 RC |
73 | |
74 | for (i = 0; i < n; i++) { | |
75 | seq_printf(m, " %d: offset=%d pitch=%d, obj: ", | |
76 | i, fb->offsets[i], fb->pitches[i]); | |
77 | msm_gem_describe(msm_fb->planes[i], m); | |
78 | } | |
79 | } | |
80 | #endif | |
81 | ||
2638d90a RC |
82 | /* prepare/pin all the fb's bo's for scanout. Note that it is not valid |
83 | * to prepare an fb more multiple different initiator 'id's. But that | |
84 | * should be fine, since only the scanout (mdpN) side of things needs | |
85 | * this, the gpu doesn't care about fb's. | |
86 | */ | |
8bdcd949 RC |
87 | int msm_framebuffer_prepare(struct drm_framebuffer *fb, |
88 | struct msm_gem_address_space *aspace) | |
2638d90a RC |
89 | { |
90 | struct msm_framebuffer *msm_fb = to_msm_framebuffer(fb); | |
bcb0b461 | 91 | int ret, i, n = fb->format->num_planes; |
78babc16 | 92 | uint64_t iova; |
2638d90a RC |
93 | |
94 | for (i = 0; i < n; i++) { | |
8bdcd949 | 95 | ret = msm_gem_get_iova(msm_fb->planes[i], aspace, &iova); |
78babc16 | 96 | DBG("FB[%u]: iova[%d]: %08llx (%d)", fb->base.id, i, iova, ret); |
2638d90a RC |
97 | if (ret) |
98 | return ret; | |
99 | } | |
100 | ||
101 | return 0; | |
102 | } | |
103 | ||
8bdcd949 RC |
104 | void msm_framebuffer_cleanup(struct drm_framebuffer *fb, |
105 | struct msm_gem_address_space *aspace) | |
2638d90a RC |
106 | { |
107 | struct msm_framebuffer *msm_fb = to_msm_framebuffer(fb); | |
bcb0b461 | 108 | int i, n = fb->format->num_planes; |
2638d90a RC |
109 | |
110 | for (i = 0; i < n; i++) | |
8bdcd949 | 111 | msm_gem_put_iova(msm_fb->planes[i], aspace); |
2638d90a RC |
112 | } |
113 | ||
8bdcd949 RC |
114 | uint32_t msm_framebuffer_iova(struct drm_framebuffer *fb, |
115 | struct msm_gem_address_space *aspace, int plane) | |
2638d90a RC |
116 | { |
117 | struct msm_framebuffer *msm_fb = to_msm_framebuffer(fb); | |
3e2f29e4 RC |
118 | if (!msm_fb->planes[plane]) |
119 | return 0; | |
8bdcd949 | 120 | return msm_gem_iova(msm_fb->planes[plane], aspace) + fb->offsets[plane]; |
2638d90a RC |
121 | } |
122 | ||
c8afe684 RC |
123 | struct drm_gem_object *msm_framebuffer_bo(struct drm_framebuffer *fb, int plane) |
124 | { | |
125 | struct msm_framebuffer *msm_fb = to_msm_framebuffer(fb); | |
126 | return msm_fb->planes[plane]; | |
127 | } | |
128 | ||
129 | const struct msm_format *msm_framebuffer_format(struct drm_framebuffer *fb) | |
130 | { | |
131 | struct msm_framebuffer *msm_fb = to_msm_framebuffer(fb); | |
132 | return msm_fb->format; | |
133 | } | |
134 | ||
135 | struct drm_framebuffer *msm_framebuffer_create(struct drm_device *dev, | |
1eb83451 | 136 | struct drm_file *file, const struct drm_mode_fb_cmd2 *mode_cmd) |
c8afe684 RC |
137 | { |
138 | struct drm_gem_object *bos[4] = {0}; | |
139 | struct drm_framebuffer *fb; | |
140 | int ret, i, n = drm_format_num_planes(mode_cmd->pixel_format); | |
141 | ||
142 | for (i = 0; i < n; i++) { | |
a8ad0bd8 | 143 | bos[i] = drm_gem_object_lookup(file, mode_cmd->handles[i]); |
c8afe684 RC |
144 | if (!bos[i]) { |
145 | ret = -ENXIO; | |
146 | goto out_unref; | |
147 | } | |
148 | } | |
149 | ||
150 | fb = msm_framebuffer_init(dev, mode_cmd, bos); | |
151 | if (IS_ERR(fb)) { | |
152 | ret = PTR_ERR(fb); | |
153 | goto out_unref; | |
154 | } | |
155 | ||
156 | return fb; | |
157 | ||
158 | out_unref: | |
159 | for (i = 0; i < n; i++) | |
160 | drm_gem_object_unreference_unlocked(bos[i]); | |
161 | return ERR_PTR(ret); | |
162 | } | |
163 | ||
164 | struct drm_framebuffer *msm_framebuffer_init(struct drm_device *dev, | |
1eb83451 | 165 | const struct drm_mode_fb_cmd2 *mode_cmd, struct drm_gem_object **bos) |
c8afe684 RC |
166 | { |
167 | struct msm_drm_private *priv = dev->dev_private; | |
168 | struct msm_kms *kms = priv->kms; | |
7194b62c SV |
169 | struct msm_framebuffer *msm_fb = NULL; |
170 | struct drm_framebuffer *fb; | |
c8afe684 RC |
171 | const struct msm_format *format; |
172 | int ret, i, n; | |
173 | unsigned int hsub, vsub; | |
174 | ||
175 | DBG("create framebuffer: dev=%p, mode_cmd=%p (%dx%d@%4.4s)", | |
176 | dev, mode_cmd, mode_cmd->width, mode_cmd->height, | |
177 | (char *)&mode_cmd->pixel_format); | |
178 | ||
179 | n = drm_format_num_planes(mode_cmd->pixel_format); | |
180 | hsub = drm_format_horz_chroma_subsampling(mode_cmd->pixel_format); | |
181 | vsub = drm_format_vert_chroma_subsampling(mode_cmd->pixel_format); | |
182 | ||
183 | format = kms->funcs->get_format(kms, mode_cmd->pixel_format); | |
184 | if (!format) { | |
185 | dev_err(dev->dev, "unsupported pixel format: %4.4s\n", | |
186 | (char *)&mode_cmd->pixel_format); | |
187 | ret = -EINVAL; | |
188 | goto fail; | |
189 | } | |
190 | ||
191 | msm_fb = kzalloc(sizeof(*msm_fb), GFP_KERNEL); | |
192 | if (!msm_fb) { | |
193 | ret = -ENOMEM; | |
194 | goto fail; | |
195 | } | |
196 | ||
197 | fb = &msm_fb->base; | |
198 | ||
199 | msm_fb->format = format; | |
200 | ||
10291bff RC |
201 | if (n > ARRAY_SIZE(msm_fb->planes)) { |
202 | ret = -EINVAL; | |
203 | goto fail; | |
204 | } | |
205 | ||
c8afe684 RC |
206 | for (i = 0; i < n; i++) { |
207 | unsigned int width = mode_cmd->width / (i ? hsub : 1); | |
208 | unsigned int height = mode_cmd->height / (i ? vsub : 1); | |
209 | unsigned int min_size; | |
210 | ||
211 | min_size = (height - 1) * mode_cmd->pitches[i] | |
212 | + width * drm_format_plane_cpp(mode_cmd->pixel_format, i) | |
213 | + mode_cmd->offsets[i]; | |
214 | ||
215 | if (bos[i]->size < min_size) { | |
216 | ret = -EINVAL; | |
217 | goto fail; | |
218 | } | |
219 | ||
220 | msm_fb->planes[i] = bos[i]; | |
221 | } | |
222 | ||
a3f913ca | 223 | drm_helper_mode_fill_fb_struct(dev, fb, mode_cmd); |
c8afe684 RC |
224 | |
225 | ret = drm_framebuffer_init(dev, fb, &msm_framebuffer_funcs); | |
226 | if (ret) { | |
227 | dev_err(dev->dev, "framebuffer init failed: %d\n", ret); | |
228 | goto fail; | |
229 | } | |
230 | ||
231 | DBG("create: FB ID: %d (%p)", fb->base.id, fb); | |
232 | ||
233 | return fb; | |
234 | ||
235 | fail: | |
7194b62c | 236 | kfree(msm_fb); |
c8afe684 RC |
237 | |
238 | return ERR_PTR(ret); | |
239 | } |