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