1061 lines
		
	
	
		
			24 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			1061 lines
		
	
	
		
			24 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| // SPDX-License-Identifier: GPL-2.0-only
 | |
| /*
 | |
|  * vivid-vid-common.c - common video support functions.
 | |
|  *
 | |
|  * Copyright 2014 Cisco Systems, Inc. and/or its affiliates. All rights reserved.
 | |
|  */
 | |
| 
 | |
| #include <linux/errno.h>
 | |
| #include <linux/kernel.h>
 | |
| #include <linux/sched.h>
 | |
| #include <linux/videodev2.h>
 | |
| #include <linux/v4l2-dv-timings.h>
 | |
| #include <media/v4l2-common.h>
 | |
| #include <media/v4l2-event.h>
 | |
| #include <media/v4l2-dv-timings.h>
 | |
| 
 | |
| #include "vivid-core.h"
 | |
| #include "vivid-vid-common.h"
 | |
| 
 | |
| const struct v4l2_dv_timings_cap vivid_dv_timings_cap = {
 | |
| 	.type = V4L2_DV_BT_656_1120,
 | |
| 	/* keep this initialization for compatibility with GCC < 4.4.6 */
 | |
| 	.reserved = { 0 },
 | |
| 	V4L2_INIT_BT_TIMINGS(16, MAX_WIDTH, 16, MAX_HEIGHT, 14000000, 775000000,
 | |
| 		V4L2_DV_BT_STD_CEA861 | V4L2_DV_BT_STD_DMT |
 | |
| 		V4L2_DV_BT_STD_CVT | V4L2_DV_BT_STD_GTF,
 | |
| 		V4L2_DV_BT_CAP_PROGRESSIVE | V4L2_DV_BT_CAP_INTERLACED)
 | |
| };
 | |
| 
 | |
| /* ------------------------------------------------------------------
 | |
| 	Basic structures
 | |
|    ------------------------------------------------------------------*/
 | |
| 
 | |
| struct vivid_fmt vivid_formats[] = {
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_YUYV,
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 16 },
 | |
| 		.color_enc = TGP_COLOR_ENC_YCBCR,
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 		.data_offset = { PLANE0_DATA_OFFSET },
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_UYVY,
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 16 },
 | |
| 		.color_enc = TGP_COLOR_ENC_YCBCR,
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_YVYU,
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 16 },
 | |
| 		.color_enc = TGP_COLOR_ENC_YCBCR,
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_VYUY,
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 16 },
 | |
| 		.color_enc = TGP_COLOR_ENC_YCBCR,
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_YUV422P,
 | |
| 		.vdownsampling = { 1, 1, 1 },
 | |
| 		.bit_depth = { 8, 4, 4 },
 | |
| 		.color_enc = TGP_COLOR_ENC_YCBCR,
 | |
| 		.planes   = 3,
 | |
| 		.buffers = 1,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_YUV420,
 | |
| 		.vdownsampling = { 1, 2, 2 },
 | |
| 		.bit_depth = { 8, 4, 4 },
 | |
| 		.color_enc = TGP_COLOR_ENC_YCBCR,
 | |
| 		.planes   = 3,
 | |
| 		.buffers = 1,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_YVU420,
 | |
| 		.vdownsampling = { 1, 2, 2 },
 | |
| 		.bit_depth = { 8, 4, 4 },
 | |
| 		.color_enc = TGP_COLOR_ENC_YCBCR,
 | |
| 		.planes   = 3,
 | |
| 		.buffers = 1,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_NV12,
 | |
| 		.vdownsampling = { 1, 2 },
 | |
| 		.bit_depth = { 8, 8 },
 | |
| 		.color_enc = TGP_COLOR_ENC_YCBCR,
 | |
| 		.planes   = 2,
 | |
| 		.buffers = 1,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_NV21,
 | |
| 		.vdownsampling = { 1, 2 },
 | |
| 		.bit_depth = { 8, 8 },
 | |
| 		.color_enc = TGP_COLOR_ENC_YCBCR,
 | |
| 		.planes   = 2,
 | |
| 		.buffers = 1,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_NV16,
 | |
| 		.vdownsampling = { 1, 1 },
 | |
| 		.bit_depth = { 8, 8 },
 | |
| 		.color_enc = TGP_COLOR_ENC_YCBCR,
 | |
| 		.planes   = 2,
 | |
| 		.buffers = 1,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_NV61,
 | |
| 		.vdownsampling = { 1, 1 },
 | |
| 		.bit_depth = { 8, 8 },
 | |
| 		.color_enc = TGP_COLOR_ENC_YCBCR,
 | |
| 		.planes   = 2,
 | |
| 		.buffers = 1,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_NV24,
 | |
| 		.vdownsampling = { 1, 1 },
 | |
| 		.bit_depth = { 8, 16 },
 | |
| 		.color_enc = TGP_COLOR_ENC_YCBCR,
 | |
| 		.planes   = 2,
 | |
| 		.buffers = 1,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_NV42,
 | |
| 		.vdownsampling = { 1, 1 },
 | |
| 		.bit_depth = { 8, 16 },
 | |
| 		.color_enc = TGP_COLOR_ENC_YCBCR,
 | |
| 		.planes   = 2,
 | |
| 		.buffers = 1,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_YUV555, /* uuuvvvvv ayyyyyuu */
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 16 },
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 		.alpha_mask = 0x8000,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_YUV565, /* uuuvvvvv yyyyyuuu */
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 16 },
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_YUV444, /* uuuuvvvv aaaayyyy */
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 16 },
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 		.alpha_mask = 0xf000,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_YUV32, /* ayuv */
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 32 },
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 		.alpha_mask = 0x000000ff,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_AYUV32,
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 32 },
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 		.alpha_mask = 0x000000ff,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_XYUV32,
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 32 },
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_VUYA32,
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 32 },
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 		.alpha_mask = 0xff000000,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_VUYX32,
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 32 },
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_GREY,
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 8 },
 | |
| 		.color_enc = TGP_COLOR_ENC_LUMA,
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_Y10,
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 16 },
 | |
| 		.color_enc = TGP_COLOR_ENC_LUMA,
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_Y12,
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 16 },
 | |
| 		.color_enc = TGP_COLOR_ENC_LUMA,
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_Y16,
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 16 },
 | |
| 		.color_enc = TGP_COLOR_ENC_LUMA,
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_Y16_BE,
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 16 },
 | |
| 		.color_enc = TGP_COLOR_ENC_LUMA,
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_RGB332, /* rrrgggbb */
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 8 },
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_RGB565, /* gggbbbbb rrrrrggg */
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 16 },
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 		.can_do_overlay = true,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_RGB565X, /* rrrrrggg gggbbbbb */
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 16 },
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 		.can_do_overlay = true,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_RGB444, /* ggggbbbb xxxxrrrr */
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 16 },
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_XRGB444, /* ggggbbbb xxxxrrrr */
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 16 },
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_ARGB444, /* ggggbbbb aaaarrrr */
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 16 },
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 		.alpha_mask = 0x00f0,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_RGBX444, /* bbbbxxxx rrrrgggg */
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 16 },
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_RGBA444, /* bbbbaaaa rrrrgggg */
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 16 },
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 		.alpha_mask = 0x00f0,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_XBGR444, /* ggggrrrr xxxxbbbb */
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 16 },
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_ABGR444, /* ggggrrrr aaaabbbb */
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 16 },
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 		.alpha_mask = 0x00f0,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_BGRX444, /* rrrrxxxx bbbbgggg */
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 16 },
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_BGRA444, /* rrrraaaa bbbbgggg  */
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 16 },
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 		.alpha_mask = 0x00f0,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_RGB555, /* gggbbbbb xrrrrrgg */
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 16 },
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 		.can_do_overlay = true,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_XRGB555, /* gggbbbbb xrrrrrgg */
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 16 },
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 		.can_do_overlay = true,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_ARGB555, /* gggbbbbb arrrrrgg */
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 16 },
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 		.can_do_overlay = true,
 | |
| 		.alpha_mask = 0x8000,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_RGBX555, /* ggbbbbbx rrrrrggg */
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 16 },
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 		.can_do_overlay = true,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_RGBA555, /* ggbbbbba rrrrrggg */
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 16 },
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 		.can_do_overlay = true,
 | |
| 		.alpha_mask = 0x8000,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_XBGR555, /* gggrrrrr xbbbbbgg */
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 16 },
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 		.can_do_overlay = true,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_ABGR555, /* gggrrrrr abbbbbgg */
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 16 },
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 		.can_do_overlay = true,
 | |
| 		.alpha_mask = 0x8000,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_BGRX555, /* ggrrrrrx bbbbbggg */
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 16 },
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 		.can_do_overlay = true,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_BGRA555, /* ggrrrrra bbbbbggg */
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 16 },
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 		.can_do_overlay = true,
 | |
| 		.alpha_mask = 0x8000,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_RGB555X, /* xrrrrrgg gggbbbbb */
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 16 },
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_XRGB555X, /* xrrrrrgg gggbbbbb */
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 16 },
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_ARGB555X, /* arrrrrgg gggbbbbb */
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 16 },
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 		.alpha_mask = 0x0080,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_RGB24, /* rgb */
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 24 },
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_BGR24, /* bgr */
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 24 },
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_BGR666, /* bbbbbbgg ggggrrrr rrxxxxxx */
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 32 },
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_RGB32, /* xrgb */
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 32 },
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_BGR32, /* bgrx */
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 32 },
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_XRGB32, /* xrgb */
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 32 },
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_XBGR32, /* bgrx */
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 32 },
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_ARGB32, /* argb */
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 32 },
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 		.alpha_mask = 0x000000ff,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_ABGR32, /* bgra */
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 32 },
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 		.alpha_mask = 0xff000000,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_RGBX32, /* rgbx */
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 32 },
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_BGRX32, /* xbgr */
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 32 },
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_RGBA32, /* rgba */
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 32 },
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 		.alpha_mask = 0x000000ff,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_BGRA32, /* abgr */
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 32 },
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 		.alpha_mask = 0xff000000,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_SBGGR8, /* Bayer BG/GR */
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 8 },
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_SGBRG8, /* Bayer GB/RG */
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 8 },
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_SGRBG8, /* Bayer GR/BG */
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 8 },
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_SRGGB8, /* Bayer RG/GB */
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 8 },
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_SBGGR10, /* Bayer BG/GR */
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 16 },
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_SGBRG10, /* Bayer GB/RG */
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 16 },
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_SGRBG10, /* Bayer GR/BG */
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 16 },
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_SRGGB10, /* Bayer RG/GB */
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 16 },
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_SBGGR12, /* Bayer BG/GR */
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 16 },
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_SGBRG12, /* Bayer GB/RG */
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 16 },
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_SGRBG12, /* Bayer GR/BG */
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 16 },
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_SRGGB12, /* Bayer RG/GB */
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 16 },
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_SBGGR16, /* Bayer BG/GR */
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 16 },
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_SGBRG16, /* Bayer GB/RG */
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 16 },
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_SGRBG16, /* Bayer GR/BG */
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 16 },
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_SRGGB16, /* Bayer RG/GB */
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 16 },
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_HSV24, /* HSV 24bits */
 | |
| 		.color_enc = TGP_COLOR_ENC_HSV,
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 24 },
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_HSV32, /* HSV 32bits */
 | |
| 		.color_enc = TGP_COLOR_ENC_HSV,
 | |
| 		.vdownsampling = { 1 },
 | |
| 		.bit_depth = { 32 },
 | |
| 		.planes   = 1,
 | |
| 		.buffers = 1,
 | |
| 	},
 | |
| 
 | |
| 	/* Multiplanar formats */
 | |
| 
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_NV16M,
 | |
| 		.vdownsampling = { 1, 1 },
 | |
| 		.bit_depth = { 8, 8 },
 | |
| 		.color_enc = TGP_COLOR_ENC_YCBCR,
 | |
| 		.planes   = 2,
 | |
| 		.buffers = 2,
 | |
| 		.data_offset = { PLANE0_DATA_OFFSET, 0 },
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_NV61M,
 | |
| 		.vdownsampling = { 1, 1 },
 | |
| 		.bit_depth = { 8, 8 },
 | |
| 		.color_enc = TGP_COLOR_ENC_YCBCR,
 | |
| 		.planes   = 2,
 | |
| 		.buffers = 2,
 | |
| 		.data_offset = { 0, PLANE0_DATA_OFFSET },
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_YUV420M,
 | |
| 		.vdownsampling = { 1, 2, 2 },
 | |
| 		.bit_depth = { 8, 4, 4 },
 | |
| 		.color_enc = TGP_COLOR_ENC_YCBCR,
 | |
| 		.planes   = 3,
 | |
| 		.buffers = 3,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_YVU420M,
 | |
| 		.vdownsampling = { 1, 2, 2 },
 | |
| 		.bit_depth = { 8, 4, 4 },
 | |
| 		.color_enc = TGP_COLOR_ENC_YCBCR,
 | |
| 		.planes   = 3,
 | |
| 		.buffers = 3,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_NV12M,
 | |
| 		.vdownsampling = { 1, 2 },
 | |
| 		.bit_depth = { 8, 8 },
 | |
| 		.color_enc = TGP_COLOR_ENC_YCBCR,
 | |
| 		.planes   = 2,
 | |
| 		.buffers = 2,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_NV21M,
 | |
| 		.vdownsampling = { 1, 2 },
 | |
| 		.bit_depth = { 8, 8 },
 | |
| 		.color_enc = TGP_COLOR_ENC_YCBCR,
 | |
| 		.planes   = 2,
 | |
| 		.buffers = 2,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_YUV422M,
 | |
| 		.vdownsampling = { 1, 1, 1 },
 | |
| 		.bit_depth = { 8, 4, 4 },
 | |
| 		.color_enc = TGP_COLOR_ENC_YCBCR,
 | |
| 		.planes   = 3,
 | |
| 		.buffers = 3,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_YVU422M,
 | |
| 		.vdownsampling = { 1, 1, 1 },
 | |
| 		.bit_depth = { 8, 4, 4 },
 | |
| 		.color_enc = TGP_COLOR_ENC_YCBCR,
 | |
| 		.planes   = 3,
 | |
| 		.buffers = 3,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_YUV444M,
 | |
| 		.vdownsampling = { 1, 1, 1 },
 | |
| 		.bit_depth = { 8, 8, 8 },
 | |
| 		.color_enc = TGP_COLOR_ENC_YCBCR,
 | |
| 		.planes   = 3,
 | |
| 		.buffers = 3,
 | |
| 	},
 | |
| 	{
 | |
| 		.fourcc   = V4L2_PIX_FMT_YVU444M,
 | |
| 		.vdownsampling = { 1, 1, 1 },
 | |
| 		.bit_depth = { 8, 8, 8 },
 | |
| 		.color_enc = TGP_COLOR_ENC_YCBCR,
 | |
| 		.planes   = 3,
 | |
| 		.buffers = 3,
 | |
| 	},
 | |
| };
 | |
| 
 | |
| /* There are this many multiplanar formats in the list */
 | |
| #define VIVID_MPLANAR_FORMATS 10
 | |
| 
 | |
| const struct vivid_fmt *vivid_get_format(struct vivid_dev *dev, u32 pixelformat)
 | |
| {
 | |
| 	const struct vivid_fmt *fmt;
 | |
| 	unsigned k;
 | |
| 
 | |
| 	for (k = 0; k < ARRAY_SIZE(vivid_formats); k++) {
 | |
| 		fmt = &vivid_formats[k];
 | |
| 		if (fmt->fourcc == pixelformat)
 | |
| 			if (fmt->buffers == 1 || dev->multiplanar)
 | |
| 				return fmt;
 | |
| 	}
 | |
| 
 | |
| 	return NULL;
 | |
| }
 | |
| 
 | |
| bool vivid_vid_can_loop(struct vivid_dev *dev)
 | |
| {
 | |
| 	if (dev->src_rect.width != dev->sink_rect.width ||
 | |
| 	    dev->src_rect.height != dev->sink_rect.height)
 | |
| 		return false;
 | |
| 	if (dev->fmt_cap->fourcc != dev->fmt_out->fourcc)
 | |
| 		return false;
 | |
| 	if (dev->field_cap != dev->field_out)
 | |
| 		return false;
 | |
| 	/*
 | |
| 	 * While this can be supported, it is just too much work
 | |
| 	 * to actually implement.
 | |
| 	 */
 | |
| 	if (dev->field_cap == V4L2_FIELD_SEQ_TB ||
 | |
| 	    dev->field_cap == V4L2_FIELD_SEQ_BT)
 | |
| 		return false;
 | |
| 	if (vivid_is_svid_cap(dev) && vivid_is_svid_out(dev)) {
 | |
| 		if (!(dev->std_cap[dev->input] & V4L2_STD_525_60) !=
 | |
| 		    !(dev->std_out & V4L2_STD_525_60))
 | |
| 			return false;
 | |
| 		return true;
 | |
| 	}
 | |
| 	if (vivid_is_hdmi_cap(dev) && vivid_is_hdmi_out(dev))
 | |
| 		return true;
 | |
| 	return false;
 | |
| }
 | |
| 
 | |
| void vivid_send_source_change(struct vivid_dev *dev, unsigned type)
 | |
| {
 | |
| 	struct v4l2_event ev = {
 | |
| 		.type = V4L2_EVENT_SOURCE_CHANGE,
 | |
| 		.u.src_change.changes = V4L2_EVENT_SRC_CH_RESOLUTION,
 | |
| 	};
 | |
| 	unsigned i;
 | |
| 
 | |
| 	for (i = 0; i < dev->num_inputs; i++) {
 | |
| 		ev.id = i;
 | |
| 		if (dev->input_type[i] == type) {
 | |
| 			if (video_is_registered(&dev->vid_cap_dev) && dev->has_vid_cap)
 | |
| 				v4l2_event_queue(&dev->vid_cap_dev, &ev);
 | |
| 			if (video_is_registered(&dev->vbi_cap_dev) && dev->has_vbi_cap)
 | |
| 				v4l2_event_queue(&dev->vbi_cap_dev, &ev);
 | |
| 		}
 | |
| 	}
 | |
| }
 | |
| 
 | |
| /*
 | |
|  * Conversion function that converts a single-planar format to a
 | |
|  * single-plane multiplanar format.
 | |
|  */
 | |
| void fmt_sp2mp(const struct v4l2_format *sp_fmt, struct v4l2_format *mp_fmt)
 | |
| {
 | |
| 	struct v4l2_pix_format_mplane *mp = &mp_fmt->fmt.pix_mp;
 | |
| 	struct v4l2_plane_pix_format *ppix = &mp->plane_fmt[0];
 | |
| 	const struct v4l2_pix_format *pix = &sp_fmt->fmt.pix;
 | |
| 	bool is_out = sp_fmt->type == V4L2_BUF_TYPE_VIDEO_OUTPUT;
 | |
| 
 | |
| 	memset(mp->reserved, 0, sizeof(mp->reserved));
 | |
| 	mp_fmt->type = is_out ? V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE :
 | |
| 			   V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE;
 | |
| 	mp->width = pix->width;
 | |
| 	mp->height = pix->height;
 | |
| 	mp->pixelformat = pix->pixelformat;
 | |
| 	mp->field = pix->field;
 | |
| 	mp->colorspace = pix->colorspace;
 | |
| 	mp->xfer_func = pix->xfer_func;
 | |
| 	/* Also copies hsv_enc */
 | |
| 	mp->ycbcr_enc = pix->ycbcr_enc;
 | |
| 	mp->quantization = pix->quantization;
 | |
| 	mp->num_planes = 1;
 | |
| 	mp->flags = pix->flags;
 | |
| 	ppix->sizeimage = pix->sizeimage;
 | |
| 	ppix->bytesperline = pix->bytesperline;
 | |
| 	memset(ppix->reserved, 0, sizeof(ppix->reserved));
 | |
| }
 | |
| 
 | |
| int fmt_sp2mp_func(struct file *file, void *priv,
 | |
| 		struct v4l2_format *f, fmtfunc func)
 | |
| {
 | |
| 	struct v4l2_format fmt;
 | |
| 	struct v4l2_pix_format_mplane *mp = &fmt.fmt.pix_mp;
 | |
| 	struct v4l2_plane_pix_format *ppix = &mp->plane_fmt[0];
 | |
| 	struct v4l2_pix_format *pix = &f->fmt.pix;
 | |
| 	int ret;
 | |
| 
 | |
| 	/* Converts to a mplane format */
 | |
| 	fmt_sp2mp(f, &fmt);
 | |
| 	/* Passes it to the generic mplane format function */
 | |
| 	ret = func(file, priv, &fmt);
 | |
| 	/* Copies back the mplane data to the single plane format */
 | |
| 	pix->width = mp->width;
 | |
| 	pix->height = mp->height;
 | |
| 	pix->pixelformat = mp->pixelformat;
 | |
| 	pix->field = mp->field;
 | |
| 	pix->colorspace = mp->colorspace;
 | |
| 	pix->xfer_func = mp->xfer_func;
 | |
| 	/* Also copies hsv_enc */
 | |
| 	pix->ycbcr_enc = mp->ycbcr_enc;
 | |
| 	pix->quantization = mp->quantization;
 | |
| 	pix->sizeimage = ppix->sizeimage;
 | |
| 	pix->bytesperline = ppix->bytesperline;
 | |
| 	pix->flags = mp->flags;
 | |
| 	return ret;
 | |
| }
 | |
| 
 | |
| int vivid_vid_adjust_sel(unsigned flags, struct v4l2_rect *r)
 | |
| {
 | |
| 	unsigned w = r->width;
 | |
| 	unsigned h = r->height;
 | |
| 
 | |
| 	/* sanitize w and h in case someone passes ~0 as the value */
 | |
| 	w &= 0xffff;
 | |
| 	h &= 0xffff;
 | |
| 	if (!(flags & V4L2_SEL_FLAG_LE)) {
 | |
| 		w++;
 | |
| 		h++;
 | |
| 		if (w < 2)
 | |
| 			w = 2;
 | |
| 		if (h < 2)
 | |
| 			h = 2;
 | |
| 	}
 | |
| 	if (!(flags & V4L2_SEL_FLAG_GE)) {
 | |
| 		if (w > MAX_WIDTH)
 | |
| 			w = MAX_WIDTH;
 | |
| 		if (h > MAX_HEIGHT)
 | |
| 			h = MAX_HEIGHT;
 | |
| 	}
 | |
| 	w = w & ~1;
 | |
| 	h = h & ~1;
 | |
| 	if (w < 2 || h < 2)
 | |
| 		return -ERANGE;
 | |
| 	if (w > MAX_WIDTH || h > MAX_HEIGHT)
 | |
| 		return -ERANGE;
 | |
| 	if (r->top < 0)
 | |
| 		r->top = 0;
 | |
| 	if (r->left < 0)
 | |
| 		r->left = 0;
 | |
| 	/* sanitize left and top in case someone passes ~0 as the value */
 | |
| 	r->left &= 0xfffe;
 | |
| 	r->top &= 0xfffe;
 | |
| 	if (r->left + w > MAX_WIDTH)
 | |
| 		r->left = MAX_WIDTH - w;
 | |
| 	if (r->top + h > MAX_HEIGHT)
 | |
| 		r->top = MAX_HEIGHT - h;
 | |
| 	if ((flags & (V4L2_SEL_FLAG_GE | V4L2_SEL_FLAG_LE)) ==
 | |
| 			(V4L2_SEL_FLAG_GE | V4L2_SEL_FLAG_LE) &&
 | |
| 	    (r->width != w || r->height != h))
 | |
| 		return -ERANGE;
 | |
| 	r->width = w;
 | |
| 	r->height = h;
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| int vivid_enum_fmt_vid(struct file *file, void  *priv,
 | |
| 					struct v4l2_fmtdesc *f)
 | |
| {
 | |
| 	struct vivid_dev *dev = video_drvdata(file);
 | |
| 	const struct vivid_fmt *fmt;
 | |
| 
 | |
| 	if (f->index >= ARRAY_SIZE(vivid_formats) -
 | |
| 	    (dev->multiplanar ? 0 : VIVID_MPLANAR_FORMATS))
 | |
| 		return -EINVAL;
 | |
| 
 | |
| 	fmt = &vivid_formats[f->index];
 | |
| 
 | |
| 	f->pixelformat = fmt->fourcc;
 | |
| 
 | |
| 	if (f->type != V4L2_BUF_TYPE_VIDEO_CAPTURE &&
 | |
| 	    f->type != V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE)
 | |
| 		return 0;
 | |
| 	/*
 | |
| 	 * For capture devices, we support the CSC API.
 | |
| 	 * We allow userspace to:
 | |
| 	 * 1. set the colorspace
 | |
| 	 * 2. set the xfer_func
 | |
| 	 * 3. set the ycbcr_enc on YUV formats
 | |
| 	 * 4. set the hsv_enc on HSV formats
 | |
| 	 * 5. set the quantization on YUV and RGB formats
 | |
| 	 */
 | |
| 	f->flags |= V4L2_FMT_FLAG_CSC_COLORSPACE;
 | |
| 	f->flags |= V4L2_FMT_FLAG_CSC_XFER_FUNC;
 | |
| 
 | |
| 	if (fmt->color_enc == TGP_COLOR_ENC_YCBCR) {
 | |
| 		f->flags |= V4L2_FMT_FLAG_CSC_YCBCR_ENC;
 | |
| 		f->flags |= V4L2_FMT_FLAG_CSC_QUANTIZATION;
 | |
| 	} else if (fmt->color_enc == TGP_COLOR_ENC_HSV) {
 | |
| 		f->flags |= V4L2_FMT_FLAG_CSC_HSV_ENC;
 | |
| 	} else if (fmt->color_enc == TGP_COLOR_ENC_RGB) {
 | |
| 		f->flags |= V4L2_FMT_FLAG_CSC_QUANTIZATION;
 | |
| 	}
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| int vidioc_g_std(struct file *file, void *priv, v4l2_std_id *id)
 | |
| {
 | |
| 	struct vivid_dev *dev = video_drvdata(file);
 | |
| 	struct video_device *vdev = video_devdata(file);
 | |
| 
 | |
| 	if (vdev->vfl_dir == VFL_DIR_RX) {
 | |
| 		if (!vivid_is_sdtv_cap(dev))
 | |
| 			return -ENODATA;
 | |
| 		*id = dev->std_cap[dev->input];
 | |
| 	} else {
 | |
| 		if (!vivid_is_svid_out(dev))
 | |
| 			return -ENODATA;
 | |
| 		*id = dev->std_out;
 | |
| 	}
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| int vidioc_g_dv_timings(struct file *file, void *_fh,
 | |
| 				    struct v4l2_dv_timings *timings)
 | |
| {
 | |
| 	struct vivid_dev *dev = video_drvdata(file);
 | |
| 	struct video_device *vdev = video_devdata(file);
 | |
| 
 | |
| 	if (vdev->vfl_dir == VFL_DIR_RX) {
 | |
| 		if (!vivid_is_hdmi_cap(dev))
 | |
| 			return -ENODATA;
 | |
| 		*timings = dev->dv_timings_cap[dev->input];
 | |
| 	} else {
 | |
| 		if (!vivid_is_hdmi_out(dev))
 | |
| 			return -ENODATA;
 | |
| 		*timings = dev->dv_timings_out;
 | |
| 	}
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| int vidioc_enum_dv_timings(struct file *file, void *_fh,
 | |
| 				    struct v4l2_enum_dv_timings *timings)
 | |
| {
 | |
| 	struct vivid_dev *dev = video_drvdata(file);
 | |
| 	struct video_device *vdev = video_devdata(file);
 | |
| 
 | |
| 	if (vdev->vfl_dir == VFL_DIR_RX) {
 | |
| 		if (!vivid_is_hdmi_cap(dev))
 | |
| 			return -ENODATA;
 | |
| 	} else {
 | |
| 		if (!vivid_is_hdmi_out(dev))
 | |
| 			return -ENODATA;
 | |
| 	}
 | |
| 	return v4l2_enum_dv_timings_cap(timings, &vivid_dv_timings_cap,
 | |
| 			NULL, NULL);
 | |
| }
 | |
| 
 | |
| int vidioc_dv_timings_cap(struct file *file, void *_fh,
 | |
| 				    struct v4l2_dv_timings_cap *cap)
 | |
| {
 | |
| 	struct vivid_dev *dev = video_drvdata(file);
 | |
| 	struct video_device *vdev = video_devdata(file);
 | |
| 
 | |
| 	if (vdev->vfl_dir == VFL_DIR_RX) {
 | |
| 		if (!vivid_is_hdmi_cap(dev))
 | |
| 			return -ENODATA;
 | |
| 	} else {
 | |
| 		if (!vivid_is_hdmi_out(dev))
 | |
| 			return -ENODATA;
 | |
| 	}
 | |
| 	*cap = vivid_dv_timings_cap;
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| int vidioc_g_edid(struct file *file, void *_fh,
 | |
| 			 struct v4l2_edid *edid)
 | |
| {
 | |
| 	struct vivid_dev *dev = video_drvdata(file);
 | |
| 	struct video_device *vdev = video_devdata(file);
 | |
| 	struct cec_adapter *adap;
 | |
| 
 | |
| 	memset(edid->reserved, 0, sizeof(edid->reserved));
 | |
| 	if (vdev->vfl_dir == VFL_DIR_RX) {
 | |
| 		if (edid->pad >= dev->num_inputs)
 | |
| 			return -EINVAL;
 | |
| 		if (dev->input_type[edid->pad] != HDMI)
 | |
| 			return -EINVAL;
 | |
| 		adap = dev->cec_rx_adap;
 | |
| 	} else {
 | |
| 		unsigned int bus_idx;
 | |
| 
 | |
| 		if (edid->pad >= dev->num_outputs)
 | |
| 			return -EINVAL;
 | |
| 		if (dev->output_type[edid->pad] != HDMI)
 | |
| 			return -EINVAL;
 | |
| 		if (!dev->display_present[edid->pad])
 | |
| 			return -ENODATA;
 | |
| 		bus_idx = dev->cec_output2bus_map[edid->pad];
 | |
| 		adap = dev->cec_tx_adap[bus_idx];
 | |
| 	}
 | |
| 	if (edid->start_block == 0 && edid->blocks == 0) {
 | |
| 		edid->blocks = dev->edid_blocks;
 | |
| 		return 0;
 | |
| 	}
 | |
| 	if (dev->edid_blocks == 0)
 | |
| 		return -ENODATA;
 | |
| 	if (edid->start_block >= dev->edid_blocks)
 | |
| 		return -EINVAL;
 | |
| 	if (edid->blocks > dev->edid_blocks - edid->start_block)
 | |
| 		edid->blocks = dev->edid_blocks - edid->start_block;
 | |
| 	if (adap)
 | |
| 		v4l2_set_edid_phys_addr(dev->edid, dev->edid_blocks * 128, adap->phys_addr);
 | |
| 	memcpy(edid->edid, dev->edid + edid->start_block * 128, edid->blocks * 128);
 | |
| 	return 0;
 | |
| }
 |