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 
vivid_clear_fb(struct vivid_dev * dev)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 
vivid_fb_ioctl(struct fb_info * info,unsigned cmd,unsigned long arg)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((void __user *)arg, &vblank, 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 
vivid_fb_set_var(struct vivid_dev * dev,struct fb_var_screeninfo * var)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 
vivid_fb_get_fix(struct vivid_dev * dev,struct fb_fix_screeninfo * fix)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 
_vivid_fb_check_var(struct fb_var_screeninfo * var,struct vivid_dev * dev)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 
vivid_fb_check_var(struct fb_var_screeninfo * var,struct fb_info * info)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 
vivid_fb_pan_display(struct fb_var_screeninfo * var,struct fb_info * info)177 static int vivid_fb_pan_display(struct fb_var_screeninfo *var, struct fb_info *info)
178 {
179 	return 0;
180 }
181 
vivid_fb_set_par(struct fb_info * info)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, &info->var);
190 	vivid_fb_get_fix(dev, &info->fix);
191 	return rc;
192 }
193 
vivid_fb_setcolreg(unsigned regno,unsigned red,unsigned green,unsigned blue,unsigned transp,struct fb_info * info)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. */
vivid_fb_blank(int blank_mode,struct fb_info * info)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 */
vivid_fb_init_vidmode(struct vivid_dev * dev)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(&dev->fb_defined, dev);
303 
304 	/* Generate valid fb_fix_screeninfo */
305 
306 	vivid_fb_get_fix(dev, &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(&dev->fb_info.cmap, 256, 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(16, sizeof(u32), GFP_KERNEL);
331 
332 	return dev->fb_info.pseudo_palette ? 0 : -ENOMEM;
333 }
334 
335 /* Release any memory we've grabbed */
vivid_fb_release_buffers(struct vivid_dev * dev)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(&dev->fb_info.cmap);
344 
345 	/* Release pseudo palette */
346 	kfree(dev->fb_info.pseudo_palette);
347 	kfree(dev->video_vbase);
348 }
349 
350 /* Initialize the specified card */
351 
vivid_fb_init(struct vivid_dev * dev)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(dev->video_buffer_size, GFP_KERNEL);
358 	if (dev->video_vbase == NULL)
359 		return -ENOMEM;
360 	dev->video_pbase = virt_to_phys(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(&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(&dev->fb_info);
383 	return 0;
384 
385 }
386