1 | // SPDX-License-Identifier: GPL-2.0-only |
2 | /* |
3 | * vivid-osd.c - osd support for testing overlays. |
4 | * |
5 | * Copyright 2014 Cisco Systems, Inc. and/or its affiliates. All rights reserved. |
6 | */ |
7 | |
8 | #include <linux/module.h> |
9 | #include <linux/errno.h> |
10 | #include <linux/kernel.h> |
11 | #include <linux/init.h> |
12 | #include <linux/sched.h> |
13 | #include <linux/slab.h> |
14 | #include <linux/font.h> |
15 | #include <linux/mutex.h> |
16 | #include <linux/videodev2.h> |
17 | #include <linux/kthread.h> |
18 | #include <linux/freezer.h> |
19 | #include <linux/fb.h> |
20 | #include <media/videobuf2-vmalloc.h> |
21 | #include <media/v4l2-device.h> |
22 | #include <media/v4l2-ioctl.h> |
23 | #include <media/v4l2-ctrls.h> |
24 | #include <media/v4l2-fh.h> |
25 | #include <media/v4l2-event.h> |
26 | #include <media/v4l2-common.h> |
27 | |
28 | #include "vivid-core.h" |
29 | #include "vivid-osd.h" |
30 | |
31 | #define MAX_OSD_WIDTH 720 |
32 | #define MAX_OSD_HEIGHT 576 |
33 | |
34 | /* |
35 | * Order: white, yellow, cyan, green, magenta, red, blue, black, |
36 | * and same again with the alpha bit set (if any) |
37 | */ |
38 | static const u16 rgb555[16] = { |
39 | 0x7fff, 0x7fe0, 0x03ff, 0x03e0, 0x7c1f, 0x7c00, 0x001f, 0x0000, |
40 | 0xffff, 0xffe0, 0x83ff, 0x83e0, 0xfc1f, 0xfc00, 0x801f, 0x8000 |
41 | }; |
42 | |
43 | static const u16 rgb565[16] = { |
44 | 0xffff, 0xffe0, 0x07ff, 0x07e0, 0xf81f, 0xf800, 0x001f, 0x0000, |
45 | 0xffff, 0xffe0, 0x07ff, 0x07e0, 0xf81f, 0xf800, 0x001f, 0x0000 |
46 | }; |
47 | |
48 | void vivid_clear_fb(struct vivid_dev *dev) |
49 | { |
50 | void *p = dev->video_vbase; |
51 | const u16 *rgb = rgb555; |
52 | unsigned x, y; |
53 | |
54 | if (dev->fb_defined.green.length == 6) |
55 | rgb = rgb565; |
56 | |
57 | for (y = 0; y < dev->display_height; y++) { |
58 | u16 *d = p; |
59 | |
60 | for (x = 0; x < dev->display_width; x++) |
61 | d[x] = rgb[(y / 16 + x / 16) % 16]; |
62 | p += dev->display_byte_stride; |
63 | } |
64 | } |
65 | |
66 | /* --------------------------------------------------------------------- */ |
67 | |
68 | static int vivid_fb_ioctl(struct fb_info *info, unsigned cmd, unsigned long arg) |
69 | { |
70 | struct vivid_dev *dev = (struct vivid_dev *)info->par; |
71 | |
72 | switch (cmd) { |
73 | case FBIOGET_VBLANK: { |
74 | struct fb_vblank vblank; |
75 | |
76 | memset(&vblank, 0, sizeof(vblank)); |
77 | vblank.flags = FB_VBLANK_HAVE_COUNT | FB_VBLANK_HAVE_VCOUNT | |
78 | FB_VBLANK_HAVE_VSYNC; |
79 | vblank.count = 0; |
80 | vblank.vcount = 0; |
81 | vblank.hcount = 0; |
82 | if (copy_to_user(to: (void __user *)arg, from: &vblank, n: sizeof(vblank))) |
83 | return -EFAULT; |
84 | return 0; |
85 | } |
86 | |
87 | default: |
88 | dprintk(dev, 1, "Unknown ioctl %08x\n" , cmd); |
89 | return -EINVAL; |
90 | } |
91 | return 0; |
92 | } |
93 | |
94 | /* Framebuffer device handling */ |
95 | |
96 | static int vivid_fb_set_var(struct vivid_dev *dev, struct fb_var_screeninfo *var) |
97 | { |
98 | dprintk(dev, 1, "vivid_fb_set_var\n" ); |
99 | |
100 | if (var->bits_per_pixel != 16) { |
101 | dprintk(dev, 1, "vivid_fb_set_var - Invalid bpp\n" ); |
102 | return -EINVAL; |
103 | } |
104 | dev->display_byte_stride = var->xres * dev->bytes_per_pixel; |
105 | |
106 | return 0; |
107 | } |
108 | |
109 | static int vivid_fb_get_fix(struct vivid_dev *dev, struct fb_fix_screeninfo *fix) |
110 | { |
111 | dprintk(dev, 1, "vivid_fb_get_fix\n" ); |
112 | memset(fix, 0, sizeof(struct fb_fix_screeninfo)); |
113 | strscpy(fix->id, "vioverlay fb" , sizeof(fix->id)); |
114 | fix->smem_start = dev->video_pbase; |
115 | fix->smem_len = dev->video_buffer_size; |
116 | fix->type = FB_TYPE_PACKED_PIXELS; |
117 | fix->visual = FB_VISUAL_TRUECOLOR; |
118 | fix->xpanstep = 1; |
119 | fix->ypanstep = 1; |
120 | fix->ywrapstep = 0; |
121 | fix->line_length = dev->display_byte_stride; |
122 | fix->accel = FB_ACCEL_NONE; |
123 | return 0; |
124 | } |
125 | |
126 | /* Check the requested display mode, returning -EINVAL if we can't |
127 | handle it. */ |
128 | |
129 | static int _vivid_fb_check_var(struct fb_var_screeninfo *var, struct vivid_dev *dev) |
130 | { |
131 | dprintk(dev, 1, "vivid_fb_check_var\n" ); |
132 | |
133 | var->bits_per_pixel = 16; |
134 | if (var->green.length == 5) { |
135 | var->red.offset = 10; |
136 | var->red.length = 5; |
137 | var->green.offset = 5; |
138 | var->green.length = 5; |
139 | var->blue.offset = 0; |
140 | var->blue.length = 5; |
141 | var->transp.offset = 15; |
142 | var->transp.length = 1; |
143 | } else { |
144 | var->red.offset = 11; |
145 | var->red.length = 5; |
146 | var->green.offset = 5; |
147 | var->green.length = 6; |
148 | var->blue.offset = 0; |
149 | var->blue.length = 5; |
150 | var->transp.offset = 0; |
151 | var->transp.length = 0; |
152 | } |
153 | var->xoffset = var->yoffset = 0; |
154 | var->left_margin = var->upper_margin = 0; |
155 | var->nonstd = 0; |
156 | |
157 | var->vmode &= ~FB_VMODE_MASK; |
158 | var->vmode |= FB_VMODE_NONINTERLACED; |
159 | |
160 | /* Dummy values */ |
161 | var->hsync_len = 24; |
162 | var->vsync_len = 2; |
163 | var->pixclock = 84316; |
164 | var->right_margin = 776; |
165 | var->lower_margin = 591; |
166 | return 0; |
167 | } |
168 | |
169 | static int vivid_fb_check_var(struct fb_var_screeninfo *var, struct fb_info *info) |
170 | { |
171 | struct vivid_dev *dev = (struct vivid_dev *) info->par; |
172 | |
173 | dprintk(dev, 1, "vivid_fb_check_var\n" ); |
174 | return _vivid_fb_check_var(var, dev); |
175 | } |
176 | |
177 | static int vivid_fb_pan_display(struct fb_var_screeninfo *var, struct fb_info *info) |
178 | { |
179 | return 0; |
180 | } |
181 | |
182 | static int vivid_fb_set_par(struct fb_info *info) |
183 | { |
184 | int rc = 0; |
185 | struct vivid_dev *dev = (struct vivid_dev *) info->par; |
186 | |
187 | dprintk(dev, 1, "vivid_fb_set_par\n" ); |
188 | |
189 | rc = vivid_fb_set_var(dev, var: &info->var); |
190 | vivid_fb_get_fix(dev, fix: &info->fix); |
191 | return rc; |
192 | } |
193 | |
194 | static int vivid_fb_setcolreg(unsigned regno, unsigned red, unsigned green, |
195 | unsigned blue, unsigned transp, |
196 | struct fb_info *info) |
197 | { |
198 | u32 color, *palette; |
199 | |
200 | if (regno >= info->cmap.len) |
201 | return -EINVAL; |
202 | |
203 | color = ((transp & 0xFF00) << 16) | ((red & 0xFF00) << 8) | |
204 | (green & 0xFF00) | ((blue & 0xFF00) >> 8); |
205 | if (regno >= 16) |
206 | return -EINVAL; |
207 | |
208 | palette = info->pseudo_palette; |
209 | if (info->var.bits_per_pixel == 16) { |
210 | switch (info->var.green.length) { |
211 | case 6: |
212 | color = (red & 0xf800) | |
213 | ((green & 0xfc00) >> 5) | |
214 | ((blue & 0xf800) >> 11); |
215 | break; |
216 | case 5: |
217 | color = ((red & 0xf800) >> 1) | |
218 | ((green & 0xf800) >> 6) | |
219 | ((blue & 0xf800) >> 11) | |
220 | (transp ? 0x8000 : 0); |
221 | break; |
222 | } |
223 | } |
224 | palette[regno] = color; |
225 | return 0; |
226 | } |
227 | |
228 | /* We don't really support blanking. All this does is enable or |
229 | disable the OSD. */ |
230 | static int vivid_fb_blank(int blank_mode, struct fb_info *info) |
231 | { |
232 | struct vivid_dev *dev = (struct vivid_dev *)info->par; |
233 | |
234 | dprintk(dev, 1, "Set blanking mode : %d\n" , blank_mode); |
235 | switch (blank_mode) { |
236 | case FB_BLANK_UNBLANK: |
237 | break; |
238 | case FB_BLANK_NORMAL: |
239 | case FB_BLANK_HSYNC_SUSPEND: |
240 | case FB_BLANK_VSYNC_SUSPEND: |
241 | case FB_BLANK_POWERDOWN: |
242 | break; |
243 | } |
244 | return 0; |
245 | } |
246 | |
247 | static const struct fb_ops vivid_fb_ops = { |
248 | .owner = THIS_MODULE, |
249 | FB_DEFAULT_IOMEM_OPS, |
250 | .fb_check_var = vivid_fb_check_var, |
251 | .fb_set_par = vivid_fb_set_par, |
252 | .fb_setcolreg = vivid_fb_setcolreg, |
253 | .fb_cursor = NULL, |
254 | .fb_ioctl = vivid_fb_ioctl, |
255 | .fb_pan_display = vivid_fb_pan_display, |
256 | .fb_blank = vivid_fb_blank, |
257 | }; |
258 | |
259 | /* Initialization */ |
260 | |
261 | |
262 | /* Setup our initial video mode */ |
263 | static int vivid_fb_init_vidmode(struct vivid_dev *dev) |
264 | { |
265 | struct v4l2_rect start_window; |
266 | |
267 | /* Color mode */ |
268 | |
269 | dev->bits_per_pixel = 16; |
270 | dev->bytes_per_pixel = dev->bits_per_pixel / 8; |
271 | |
272 | start_window.width = MAX_OSD_WIDTH; |
273 | start_window.left = 0; |
274 | |
275 | dev->display_byte_stride = start_window.width * dev->bytes_per_pixel; |
276 | |
277 | /* Vertical size & position */ |
278 | |
279 | start_window.height = MAX_OSD_HEIGHT; |
280 | start_window.top = 0; |
281 | |
282 | dev->display_width = start_window.width; |
283 | dev->display_height = start_window.height; |
284 | |
285 | /* Generate a valid fb_var_screeninfo */ |
286 | |
287 | dev->fb_defined.xres = dev->display_width; |
288 | dev->fb_defined.yres = dev->display_height; |
289 | dev->fb_defined.xres_virtual = dev->display_width; |
290 | dev->fb_defined.yres_virtual = dev->display_height; |
291 | dev->fb_defined.bits_per_pixel = dev->bits_per_pixel; |
292 | dev->fb_defined.vmode = FB_VMODE_NONINTERLACED; |
293 | dev->fb_defined.left_margin = start_window.left + 1; |
294 | dev->fb_defined.upper_margin = start_window.top + 1; |
295 | dev->fb_defined.accel_flags = FB_ACCEL_NONE; |
296 | dev->fb_defined.nonstd = 0; |
297 | /* set default to 1:5:5:5 */ |
298 | dev->fb_defined.green.length = 5; |
299 | |
300 | /* We've filled in the most data, let the usual mode check |
301 | routine fill in the rest. */ |
302 | _vivid_fb_check_var(var: &dev->fb_defined, dev); |
303 | |
304 | /* Generate valid fb_fix_screeninfo */ |
305 | |
306 | vivid_fb_get_fix(dev, fix: &dev->fb_fix); |
307 | |
308 | /* Generate valid fb_info */ |
309 | |
310 | dev->fb_info.node = -1; |
311 | dev->fb_info.par = dev; |
312 | dev->fb_info.var = dev->fb_defined; |
313 | dev->fb_info.fix = dev->fb_fix; |
314 | dev->fb_info.screen_base = (u8 __iomem *)dev->video_vbase; |
315 | dev->fb_info.fbops = &vivid_fb_ops; |
316 | |
317 | /* Supply some monitor specs. Bogus values will do for now */ |
318 | dev->fb_info.monspecs.hfmin = 8000; |
319 | dev->fb_info.monspecs.hfmax = 70000; |
320 | dev->fb_info.monspecs.vfmin = 10; |
321 | dev->fb_info.monspecs.vfmax = 100; |
322 | |
323 | /* Allocate color map */ |
324 | if (fb_alloc_cmap(cmap: &dev->fb_info.cmap, len: 256, transp: 1)) { |
325 | pr_err("abort, unable to alloc cmap\n" ); |
326 | return -ENOMEM; |
327 | } |
328 | |
329 | /* Allocate the pseudo palette */ |
330 | dev->fb_info.pseudo_palette = kmalloc_array(n: 16, size: sizeof(u32), GFP_KERNEL); |
331 | |
332 | return dev->fb_info.pseudo_palette ? 0 : -ENOMEM; |
333 | } |
334 | |
335 | /* Release any memory we've grabbed */ |
336 | void vivid_fb_release_buffers(struct vivid_dev *dev) |
337 | { |
338 | if (dev->video_vbase == NULL) |
339 | return; |
340 | |
341 | /* Release cmap */ |
342 | if (dev->fb_info.cmap.len) |
343 | fb_dealloc_cmap(cmap: &dev->fb_info.cmap); |
344 | |
345 | /* Release pseudo palette */ |
346 | kfree(objp: dev->fb_info.pseudo_palette); |
347 | kfree(objp: dev->video_vbase); |
348 | } |
349 | |
350 | /* Initialize the specified card */ |
351 | |
352 | int vivid_fb_init(struct vivid_dev *dev) |
353 | { |
354 | int ret; |
355 | |
356 | dev->video_buffer_size = MAX_OSD_HEIGHT * MAX_OSD_WIDTH * 2; |
357 | dev->video_vbase = kzalloc(size: dev->video_buffer_size, GFP_KERNEL); |
358 | if (dev->video_vbase == NULL) |
359 | return -ENOMEM; |
360 | dev->video_pbase = virt_to_phys(address: dev->video_vbase); |
361 | |
362 | pr_info("Framebuffer at 0x%lx, mapped to 0x%p, size %dk\n" , |
363 | dev->video_pbase, dev->video_vbase, |
364 | dev->video_buffer_size / 1024); |
365 | |
366 | /* Set the startup video mode information */ |
367 | ret = vivid_fb_init_vidmode(dev); |
368 | if (ret) { |
369 | vivid_fb_release_buffers(dev); |
370 | return ret; |
371 | } |
372 | |
373 | vivid_clear_fb(dev); |
374 | |
375 | /* Register the framebuffer */ |
376 | if (register_framebuffer(fb_info: &dev->fb_info) < 0) { |
377 | vivid_fb_release_buffers(dev); |
378 | return -EINVAL; |
379 | } |
380 | |
381 | /* Set the card to the requested mode */ |
382 | vivid_fb_set_par(info: &dev->fb_info); |
383 | return 0; |
384 | |
385 | } |
386 | |