386 lines · c
1// SPDX-License-Identifier: GPL-2.0-only2/*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 72032#define MAX_OSD_HEIGHT 57633 34/*35 * Order: white, yellow, cyan, green, magenta, red, blue, black,36 * and same again with the alpha bit set (if any)37 */38static const u16 rgb555[16] = {39 0x7fff, 0x7fe0, 0x03ff, 0x03e0, 0x7c1f, 0x7c00, 0x001f, 0x0000,40 0xffff, 0xffe0, 0x83ff, 0x83e0, 0xfc1f, 0xfc00, 0x801f, 0x800041};42 43static const u16 rgb565[16] = {44 0xffff, 0xffe0, 0x07ff, 0x07e0, 0xf81f, 0xf800, 0x001f, 0x0000,45 0xffff, 0xffe0, 0x07ff, 0x07e0, 0xf81f, 0xf800, 0x001f, 0x000046};47 48void 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 68static 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 96static 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 109static 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't127 handle it. */128 129static 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 169static 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 177static int vivid_fb_pan_display(struct fb_var_screeninfo *var, struct fb_info *info)178{179 return 0;180}181 182static 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 194static 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 or229 disable the OSD. */230static 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 247static 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 */263static 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 check301 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 */336void 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 352int 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