1 // SPDX-License-Identifier: GPL-2.0
2 /*
3  * (C) COPYRIGHT 2018 ARM Limited. All rights reserved.
4  * Author: James.Qian.Wang <james.qian.wang@arm.com>
5  *
6  */
7 #include <drm/drm_device.h>
8 #include <drm/drm_fb_cma_helper.h>
9 #include <drm/drm_gem.h>
10 #include <drm/drm_gem_cma_helper.h>
11 #include <drm/drm_gem_framebuffer_helper.h>
12 
13 #include "komeda_framebuffer.h"
14 #include "komeda_dev.h"
15 
16 static void komeda_fb_destroy(struct drm_framebuffer *fb)
17 {
18 	struct komeda_fb *kfb = to_kfb(fb);
19 	u32 i;
20 
21 	for (i = 0; i < fb->format->num_planes; i++)
22 		drm_gem_object_put(fb->obj[i]);
23 
24 	drm_framebuffer_cleanup(fb);
25 	kfree(kfb);
26 }
27 
28 static int komeda_fb_create_handle(struct drm_framebuffer *fb,
29 				   struct drm_file *file, u32 *handle)
30 {
31 	return drm_gem_handle_create(file, fb->obj[0], handle);
32 }
33 
34 static const struct drm_framebuffer_funcs komeda_fb_funcs = {
35 	.destroy	= komeda_fb_destroy,
36 	.create_handle	= komeda_fb_create_handle,
37 };
38 
39 static int
40 komeda_fb_afbc_size_check(struct komeda_fb *kfb, struct drm_file *file,
41 			  const struct drm_mode_fb_cmd2 *mode_cmd)
42 {
43 	struct drm_framebuffer *fb = &kfb->base;
44 	const struct drm_format_info *info = fb->format;
45 	struct drm_gem_object *obj;
46 	u32 alignment_w = 0, alignment_h = 0, alignment_header, n_blocks, bpp;
47 	u64 min_size;
48 
49 	obj = drm_gem_object_lookup(file, mode_cmd->handles[0]);
50 	if (!obj) {
51 		DRM_DEBUG_KMS("Failed to lookup GEM object\n");
52 		return -ENOENT;
53 	}
54 
55 	switch (fb->modifier & AFBC_FORMAT_MOD_BLOCK_SIZE_MASK) {
56 	case AFBC_FORMAT_MOD_BLOCK_SIZE_32x8:
57 		alignment_w = 32;
58 		alignment_h = 8;
59 		break;
60 	case AFBC_FORMAT_MOD_BLOCK_SIZE_16x16:
61 		alignment_w = 16;
62 		alignment_h = 16;
63 		break;
64 	default:
65 		WARN(1, "Invalid AFBC_FORMAT_MOD_BLOCK_SIZE: %lld.\n",
66 		     fb->modifier & AFBC_FORMAT_MOD_BLOCK_SIZE_MASK);
67 		break;
68 	}
69 
70 	/* tiled header afbc */
71 	if (fb->modifier & AFBC_FORMAT_MOD_TILED) {
72 		alignment_w *= AFBC_TH_LAYOUT_ALIGNMENT;
73 		alignment_h *= AFBC_TH_LAYOUT_ALIGNMENT;
74 		alignment_header = AFBC_TH_BODY_START_ALIGNMENT;
75 	} else {
76 		alignment_header = AFBC_BODY_START_ALIGNMENT;
77 	}
78 
79 	kfb->aligned_w = ALIGN(fb->width, alignment_w);
80 	kfb->aligned_h = ALIGN(fb->height, alignment_h);
81 
82 	if (fb->offsets[0] % alignment_header) {
83 		DRM_DEBUG_KMS("afbc offset alignment check failed.\n");
84 		goto check_failed;
85 	}
86 
87 	n_blocks = (kfb->aligned_w * kfb->aligned_h) / AFBC_SUPERBLK_PIXELS;
88 	kfb->offset_payload = ALIGN(n_blocks * AFBC_HEADER_SIZE,
89 				    alignment_header);
90 
91 	bpp = komeda_get_afbc_format_bpp(info, fb->modifier);
92 	kfb->afbc_size = kfb->offset_payload + n_blocks *
93 			 ALIGN(bpp * AFBC_SUPERBLK_PIXELS / 8,
94 			       AFBC_SUPERBLK_ALIGNMENT);
95 	min_size = kfb->afbc_size + fb->offsets[0];
96 	if (min_size > obj->size) {
97 		DRM_DEBUG_KMS("afbc size check failed, obj_size: 0x%zx. min_size 0x%llx.\n",
98 			      obj->size, min_size);
99 		goto check_failed;
100 	}
101 
102 	fb->obj[0] = obj;
103 	return 0;
104 
105 check_failed:
106 	drm_gem_object_put(obj);
107 	return -EINVAL;
108 }
109 
110 static int
111 komeda_fb_none_afbc_size_check(struct komeda_dev *mdev, struct komeda_fb *kfb,
112 			       struct drm_file *file,
113 			       const struct drm_mode_fb_cmd2 *mode_cmd)
114 {
115 	struct drm_framebuffer *fb = &kfb->base;
116 	const struct drm_format_info *info = fb->format;
117 	struct drm_gem_object *obj;
118 	u32 i, block_h;
119 	u64 min_size;
120 
121 	if (komeda_fb_check_src_coords(kfb, 0, 0, fb->width, fb->height))
122 		return -EINVAL;
123 
124 	for (i = 0; i < info->num_planes; i++) {
125 		obj = drm_gem_object_lookup(file, mode_cmd->handles[i]);
126 		if (!obj) {
127 			DRM_DEBUG_KMS("Failed to lookup GEM object\n");
128 			return -ENOENT;
129 		}
130 		fb->obj[i] = obj;
131 
132 		block_h = drm_format_info_block_height(info, i);
133 		if ((fb->pitches[i] * block_h) % mdev->chip.bus_width) {
134 			DRM_DEBUG_KMS("Pitch[%d]: 0x%x doesn't align to 0x%x\n",
135 				      i, fb->pitches[i], mdev->chip.bus_width);
136 			return -EINVAL;
137 		}
138 
139 		min_size = komeda_fb_get_pixel_addr(kfb, 0, fb->height, i)
140 			 - to_drm_gem_cma_obj(obj)->paddr;
141 		if (obj->size < min_size) {
142 			DRM_DEBUG_KMS("The fb->obj[%d] size: 0x%zx lower than the minimum requirement: 0x%llx.\n",
143 				      i, obj->size, min_size);
144 			return -EINVAL;
145 		}
146 	}
147 
148 	if (fb->format->num_planes == 3) {
149 		if (fb->pitches[1] != fb->pitches[2]) {
150 			DRM_DEBUG_KMS("The pitch[1] and [2] are not same\n");
151 			return -EINVAL;
152 		}
153 	}
154 
155 	return 0;
156 }
157 
158 struct drm_framebuffer *
159 komeda_fb_create(struct drm_device *dev, struct drm_file *file,
160 		 const struct drm_mode_fb_cmd2 *mode_cmd)
161 {
162 	struct komeda_dev *mdev = dev->dev_private;
163 	struct komeda_fb *kfb;
164 	int ret = 0, i;
165 
166 	kfb = kzalloc(sizeof(*kfb), GFP_KERNEL);
167 	if (!kfb)
168 		return ERR_PTR(-ENOMEM);
169 
170 	kfb->format_caps = komeda_get_format_caps(&mdev->fmt_tbl,
171 						  mode_cmd->pixel_format,
172 						  mode_cmd->modifier[0]);
173 	if (!kfb->format_caps) {
174 		DRM_DEBUG_KMS("FMT %x is not supported.\n",
175 			      mode_cmd->pixel_format);
176 		kfree(kfb);
177 		return ERR_PTR(-EINVAL);
178 	}
179 
180 	drm_helper_mode_fill_fb_struct(dev, &kfb->base, mode_cmd);
181 
182 	if (kfb->base.modifier)
183 		ret = komeda_fb_afbc_size_check(kfb, file, mode_cmd);
184 	else
185 		ret = komeda_fb_none_afbc_size_check(mdev, kfb, file, mode_cmd);
186 	if (ret < 0)
187 		goto err_cleanup;
188 
189 	ret = drm_framebuffer_init(dev, &kfb->base, &komeda_fb_funcs);
190 	if (ret < 0) {
191 		DRM_DEBUG_KMS("failed to initialize fb\n");
192 
193 		goto err_cleanup;
194 	}
195 
196 	kfb->is_va = mdev->iommu ? true : false;
197 
198 	return &kfb->base;
199 
200 err_cleanup:
201 	for (i = 0; i < kfb->base.format->num_planes; i++)
202 		drm_gem_object_put(kfb->base.obj[i]);
203 
204 	kfree(kfb);
205 	return ERR_PTR(ret);
206 }
207 
208 int komeda_fb_check_src_coords(const struct komeda_fb *kfb,
209 			       u32 src_x, u32 src_y, u32 src_w, u32 src_h)
210 {
211 	const struct drm_framebuffer *fb = &kfb->base;
212 	const struct drm_format_info *info = fb->format;
213 	u32 block_w = drm_format_info_block_width(fb->format, 0);
214 	u32 block_h = drm_format_info_block_height(fb->format, 0);
215 
216 	if ((src_x + src_w > fb->width) || (src_y + src_h > fb->height)) {
217 		DRM_DEBUG_ATOMIC("Invalid source coordinate.\n");
218 		return -EINVAL;
219 	}
220 
221 	if ((src_x % info->hsub) || (src_w % info->hsub) ||
222 	    (src_y % info->vsub) || (src_h % info->vsub)) {
223 		DRM_DEBUG_ATOMIC("Wrong subsampling dimension x:%d, y:%d, w:%d, h:%d for format: %x.\n",
224 				 src_x, src_y, src_w, src_h, info->format);
225 		return -EINVAL;
226 	}
227 
228 	if ((src_x % block_w) || (src_w % block_w) ||
229 	    (src_y % block_h) || (src_h % block_h)) {
230 		DRM_DEBUG_ATOMIC("x:%d, y:%d, w:%d, h:%d should be multiple of block_w/h for format: %x.\n",
231 				 src_x, src_y, src_w, src_h, info->format);
232 		return -EINVAL;
233 	}
234 
235 	return 0;
236 }
237 
238 dma_addr_t
239 komeda_fb_get_pixel_addr(struct komeda_fb *kfb, int x, int y, int plane)
240 {
241 	struct drm_framebuffer *fb = &kfb->base;
242 	const struct drm_gem_cma_object *obj;
243 	u32 offset, plane_x, plane_y, block_w, block_sz;
244 
245 	if (plane >= fb->format->num_planes) {
246 		DRM_DEBUG_KMS("Out of max plane num.\n");
247 		return -EINVAL;
248 	}
249 
250 	obj = drm_fb_cma_get_gem_obj(fb, plane);
251 
252 	offset = fb->offsets[plane];
253 	if (!fb->modifier) {
254 		block_w = drm_format_info_block_width(fb->format, plane);
255 		block_sz = fb->format->char_per_block[plane];
256 		plane_x = x / (plane ? fb->format->hsub : 1);
257 		plane_y = y / (plane ? fb->format->vsub : 1);
258 
259 		offset += (plane_x / block_w) * block_sz
260 			+ plane_y * fb->pitches[plane];
261 	}
262 
263 	return obj->paddr + offset;
264 }
265 
266 /* if the fb can be supported by a specific layer */
267 bool komeda_fb_is_layer_supported(struct komeda_fb *kfb, u32 layer_type,
268 				  u32 rot)
269 {
270 	struct drm_framebuffer *fb = &kfb->base;
271 	struct komeda_dev *mdev = fb->dev->dev_private;
272 	u32 fourcc = fb->format->format;
273 	u64 modifier = fb->modifier;
274 	bool supported;
275 
276 	supported = komeda_format_mod_supported(&mdev->fmt_tbl, layer_type,
277 						fourcc, modifier, rot);
278 	if (!supported)
279 		DRM_DEBUG_ATOMIC("Layer TYPE: %d doesn't support fb FMT: %p4cc with modifier: 0x%llx.\n",
280 				 layer_type, &fourcc, modifier);
281 
282 	return supported;
283 }
284