1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 * VRFB Rotation Engine
4 *
5 * Copyright (C) 2009 Nokia Corporation
6 * Author: Tomi Valkeinen <tomi.valkeinen@nokia.com>
7 */
8
9 /*#define DEBUG*/
10
11 #include <linux/err.h>
12 #include <linux/export.h>
13 #include <linux/kernel.h>
14 #include <linux/module.h>
15 #include <linux/ioport.h>
16 #include <linux/io.h>
17 #include <linux/bitops.h>
18 #include <linux/mutex.h>
19 #include <linux/platform_device.h>
20
21 #include <video/omapvrfb.h>
22
23 #ifdef DEBUG
24 #define DBG(format, ...) pr_debug("VRFB: " format, ## __VA_ARGS__)
25 #else
26 #define DBG(format, ...)
27 #endif
28
29 #define SMS_ROT_CONTROL(context) (0x0 + 0x10 * context)
30 #define SMS_ROT_SIZE(context) (0x4 + 0x10 * context)
31 #define SMS_ROT_PHYSICAL_BA(context) (0x8 + 0x10 * context)
32 #define SMS_ROT_VIRT_BASE(rot) (0x1000000 * (rot))
33
34 #define OMAP_VRFB_SIZE (2048 * 2048 * 4)
35
36 #define VRFB_PAGE_WIDTH_EXP 5 /* Assuming SDRAM pagesize= 1024 */
37 #define VRFB_PAGE_HEIGHT_EXP 5 /* 1024 = 2^5 * 2^5 */
38 #define VRFB_PAGE_WIDTH (1 << VRFB_PAGE_WIDTH_EXP)
39 #define VRFB_PAGE_HEIGHT (1 << VRFB_PAGE_HEIGHT_EXP)
40 #define SMS_IMAGEHEIGHT_OFFSET 16
41 #define SMS_IMAGEWIDTH_OFFSET 0
42 #define SMS_PH_OFFSET 8
43 #define SMS_PW_OFFSET 4
44 #define SMS_PS_OFFSET 0
45
46 /* bitmap of reserved contexts */
47 static unsigned long ctx_map;
48
49 struct vrfb_ctx {
50 u32 base;
51 u32 physical_ba;
52 u32 control;
53 u32 size;
54 };
55
56 static DEFINE_MUTEX(ctx_lock);
57
58 /*
59 * Access to this happens from client drivers or the PM core after wake-up.
60 * For the first case we require locking at the driver level, for the second
61 * we don't need locking, since no drivers will run until after the wake-up
62 * has finished.
63 */
64
65 static void __iomem *vrfb_base;
66
67 static int num_ctxs;
68 static struct vrfb_ctx *ctxs;
69
70 static bool vrfb_loaded;
71
omap2_sms_write_rot_control(u32 val,unsigned ctx)72 static void omap2_sms_write_rot_control(u32 val, unsigned ctx)
73 {
74 __raw_writel(val, vrfb_base + SMS_ROT_CONTROL(ctx));
75 }
76
omap2_sms_write_rot_size(u32 val,unsigned ctx)77 static void omap2_sms_write_rot_size(u32 val, unsigned ctx)
78 {
79 __raw_writel(val, vrfb_base + SMS_ROT_SIZE(ctx));
80 }
81
omap2_sms_write_rot_physical_ba(u32 val,unsigned ctx)82 static void omap2_sms_write_rot_physical_ba(u32 val, unsigned ctx)
83 {
84 __raw_writel(val, vrfb_base + SMS_ROT_PHYSICAL_BA(ctx));
85 }
86
restore_hw_context(int ctx)87 static inline void restore_hw_context(int ctx)
88 {
89 omap2_sms_write_rot_control(ctxs[ctx].control, ctx);
90 omap2_sms_write_rot_size(ctxs[ctx].size, ctx);
91 omap2_sms_write_rot_physical_ba(ctxs[ctx].physical_ba, ctx);
92 }
93
get_image_width_roundup(u16 width,u8 bytespp)94 static u32 get_image_width_roundup(u16 width, u8 bytespp)
95 {
96 unsigned long stride = width * bytespp;
97 unsigned long ceil_pages_per_stride = (stride / VRFB_PAGE_WIDTH) +
98 (stride % VRFB_PAGE_WIDTH != 0);
99
100 return ceil_pages_per_stride * VRFB_PAGE_WIDTH / bytespp;
101 }
102
103 /*
104 * This the extra space needed in the VRFB physical area for VRFB to safely wrap
105 * any memory accesses to the invisible part of the virtual view to the physical
106 * area.
107 */
get_extra_physical_size(u16 image_width_roundup,u8 bytespp)108 static inline u32 get_extra_physical_size(u16 image_width_roundup, u8 bytespp)
109 {
110 return (OMAP_VRFB_LINE_LEN - image_width_roundup) * VRFB_PAGE_HEIGHT *
111 bytespp;
112 }
113
omap_vrfb_restore_context(void)114 void omap_vrfb_restore_context(void)
115 {
116 int i;
117 unsigned long map = ctx_map;
118
119 for (i = ffs(map); i; i = ffs(map)) {
120 /* i=1..32 */
121 i--;
122 map &= ~(1 << i);
123 restore_hw_context(i);
124 }
125 }
126
omap_vrfb_adjust_size(u16 * width,u16 * height,u8 bytespp)127 void omap_vrfb_adjust_size(u16 *width, u16 *height,
128 u8 bytespp)
129 {
130 *width = ALIGN(*width * bytespp, VRFB_PAGE_WIDTH) / bytespp;
131 *height = ALIGN(*height, VRFB_PAGE_HEIGHT);
132 }
133 EXPORT_SYMBOL(omap_vrfb_adjust_size);
134
omap_vrfb_min_phys_size(u16 width,u16 height,u8 bytespp)135 u32 omap_vrfb_min_phys_size(u16 width, u16 height, u8 bytespp)
136 {
137 unsigned long image_width_roundup = get_image_width_roundup(width,
138 bytespp);
139
140 if (image_width_roundup > OMAP_VRFB_LINE_LEN)
141 return 0;
142
143 return (width * height * bytespp) + get_extra_physical_size(
144 image_width_roundup, bytespp);
145 }
146 EXPORT_SYMBOL(omap_vrfb_min_phys_size);
147
omap_vrfb_max_height(u32 phys_size,u16 width,u8 bytespp)148 u16 omap_vrfb_max_height(u32 phys_size, u16 width, u8 bytespp)
149 {
150 unsigned long image_width_roundup = get_image_width_roundup(width,
151 bytespp);
152 unsigned long height;
153 unsigned long extra;
154
155 if (image_width_roundup > OMAP_VRFB_LINE_LEN)
156 return 0;
157
158 extra = get_extra_physical_size(image_width_roundup, bytespp);
159
160 if (phys_size < extra)
161 return 0;
162
163 height = (phys_size - extra) / (width * bytespp);
164
165 /* Virtual views provided by VRFB are limited to 2048x2048. */
166 return min_t(unsigned long, height, 2048);
167 }
168 EXPORT_SYMBOL(omap_vrfb_max_height);
169
omap_vrfb_setup(struct vrfb * vrfb,unsigned long paddr,u16 width,u16 height,unsigned bytespp,bool yuv_mode)170 void omap_vrfb_setup(struct vrfb *vrfb, unsigned long paddr,
171 u16 width, u16 height,
172 unsigned bytespp, bool yuv_mode)
173 {
174 unsigned pixel_size_exp;
175 u16 vrfb_width;
176 u16 vrfb_height;
177 u8 ctx = vrfb->context;
178 u32 size;
179 u32 control;
180
181 DBG("omapfb_set_vrfb(%d, %lx, %dx%d, %d, %d)\n", ctx, paddr,
182 width, height, bytespp, yuv_mode);
183
184 /* For YUV2 and UYVY modes VRFB needs to handle pixels a bit
185 * differently. See TRM. */
186 if (yuv_mode) {
187 bytespp *= 2;
188 width /= 2;
189 }
190
191 if (bytespp == 4)
192 pixel_size_exp = 2;
193 else if (bytespp == 2)
194 pixel_size_exp = 1;
195 else {
196 BUG();
197 return;
198 }
199
200 vrfb_width = ALIGN(width * bytespp, VRFB_PAGE_WIDTH) / bytespp;
201 vrfb_height = ALIGN(height, VRFB_PAGE_HEIGHT);
202
203 DBG("vrfb w %u, h %u bytespp %d\n", vrfb_width, vrfb_height, bytespp);
204
205 size = vrfb_width << SMS_IMAGEWIDTH_OFFSET;
206 size |= vrfb_height << SMS_IMAGEHEIGHT_OFFSET;
207
208 control = pixel_size_exp << SMS_PS_OFFSET;
209 control |= VRFB_PAGE_WIDTH_EXP << SMS_PW_OFFSET;
210 control |= VRFB_PAGE_HEIGHT_EXP << SMS_PH_OFFSET;
211
212 ctxs[ctx].physical_ba = paddr;
213 ctxs[ctx].size = size;
214 ctxs[ctx].control = control;
215
216 omap2_sms_write_rot_physical_ba(paddr, ctx);
217 omap2_sms_write_rot_size(size, ctx);
218 omap2_sms_write_rot_control(control, ctx);
219
220 DBG("vrfb offset pixels %d, %d\n",
221 vrfb_width - width, vrfb_height - height);
222
223 vrfb->xres = width;
224 vrfb->yres = height;
225 vrfb->xoffset = vrfb_width - width;
226 vrfb->yoffset = vrfb_height - height;
227 vrfb->bytespp = bytespp;
228 vrfb->yuv_mode = yuv_mode;
229 }
230 EXPORT_SYMBOL(omap_vrfb_setup);
231
omap_vrfb_map_angle(struct vrfb * vrfb,u16 height,u8 rot)232 int omap_vrfb_map_angle(struct vrfb *vrfb, u16 height, u8 rot)
233 {
234 unsigned long size = height * OMAP_VRFB_LINE_LEN * vrfb->bytespp;
235
236 vrfb->vaddr[rot] = ioremap_wc(vrfb->paddr[rot], size);
237
238 if (!vrfb->vaddr[rot]) {
239 printk(KERN_ERR "vrfb: ioremap failed\n");
240 return -ENOMEM;
241 }
242
243 DBG("ioremapped vrfb area %d of size %lu into %p\n", rot, size,
244 vrfb->vaddr[rot]);
245
246 return 0;
247 }
248 EXPORT_SYMBOL(omap_vrfb_map_angle);
249
omap_vrfb_release_ctx(struct vrfb * vrfb)250 void omap_vrfb_release_ctx(struct vrfb *vrfb)
251 {
252 int rot;
253 int ctx = vrfb->context;
254
255 if (ctx == 0xff)
256 return;
257
258 DBG("release ctx %d\n", ctx);
259
260 mutex_lock(&ctx_lock);
261
262 BUG_ON(!(ctx_map & (1 << ctx)));
263
264 clear_bit(ctx, &ctx_map);
265
266 for (rot = 0; rot < 4; ++rot) {
267 if (vrfb->paddr[rot]) {
268 release_mem_region(vrfb->paddr[rot], OMAP_VRFB_SIZE);
269 vrfb->paddr[rot] = 0;
270 }
271 }
272
273 vrfb->context = 0xff;
274
275 mutex_unlock(&ctx_lock);
276 }
277 EXPORT_SYMBOL(omap_vrfb_release_ctx);
278
omap_vrfb_request_ctx(struct vrfb * vrfb)279 int omap_vrfb_request_ctx(struct vrfb *vrfb)
280 {
281 int rot;
282 u32 paddr;
283 u8 ctx;
284 int r;
285
286 DBG("request ctx\n");
287
288 mutex_lock(&ctx_lock);
289
290 for (ctx = 0; ctx < num_ctxs; ++ctx)
291 if ((ctx_map & (1 << ctx)) == 0)
292 break;
293
294 if (ctx == num_ctxs) {
295 pr_err("vrfb: no free contexts\n");
296 r = -EBUSY;
297 goto out;
298 }
299
300 DBG("found free ctx %d\n", ctx);
301
302 set_bit(ctx, &ctx_map);
303
304 memset(vrfb, 0, sizeof(*vrfb));
305
306 vrfb->context = ctx;
307
308 for (rot = 0; rot < 4; ++rot) {
309 paddr = ctxs[ctx].base + SMS_ROT_VIRT_BASE(rot);
310 if (!request_mem_region(paddr, OMAP_VRFB_SIZE, "vrfb")) {
311 pr_err("vrfb: failed to reserve VRFB "
312 "area for ctx %d, rotation %d\n",
313 ctx, rot * 90);
314 omap_vrfb_release_ctx(vrfb);
315 r = -ENOMEM;
316 goto out;
317 }
318
319 vrfb->paddr[rot] = paddr;
320
321 DBG("VRFB %d/%d: %lx\n", ctx, rot*90, vrfb->paddr[rot]);
322 }
323
324 r = 0;
325 out:
326 mutex_unlock(&ctx_lock);
327 return r;
328 }
329 EXPORT_SYMBOL(omap_vrfb_request_ctx);
330
omap_vrfb_supported(void)331 bool omap_vrfb_supported(void)
332 {
333 return vrfb_loaded;
334 }
335 EXPORT_SYMBOL(omap_vrfb_supported);
336
vrfb_probe(struct platform_device * pdev)337 static int __init vrfb_probe(struct platform_device *pdev)
338 {
339 struct resource *mem;
340 int i;
341
342 /* first resource is the register res, the rest are vrfb contexts */
343 vrfb_base = devm_platform_ioremap_resource(pdev, 0);
344 if (IS_ERR(vrfb_base))
345 return PTR_ERR(vrfb_base);
346
347 num_ctxs = pdev->num_resources - 1;
348
349 ctxs = devm_kcalloc(&pdev->dev,
350 num_ctxs, sizeof(struct vrfb_ctx),
351 GFP_KERNEL);
352
353 if (!ctxs)
354 return -ENOMEM;
355
356 for (i = 0; i < num_ctxs; ++i) {
357 mem = platform_get_resource(pdev, IORESOURCE_MEM, 1 + i);
358 if (!mem) {
359 dev_err(&pdev->dev, "can't get vrfb ctx %d address\n",
360 i);
361 return -EINVAL;
362 }
363
364 ctxs[i].base = mem->start;
365 }
366
367 vrfb_loaded = true;
368
369 return 0;
370 }
371
372 static struct platform_driver vrfb_driver = {
373 .driver.name = "omapvrfb",
374 };
375 builtin_platform_driver_probe(vrfb_driver, vrfb_probe);
376
377 MODULE_AUTHOR("Tomi Valkeinen <tomi.valkeinen@ti.com>");
378 MODULE_DESCRIPTION("OMAP VRFB");
379 MODULE_LICENSE("GPL v2");
380