linux/drivers/media/i2c/imx319.c

2573 lines
54 KiB
C
Raw Normal View History

// SPDX-License-Identifier: GPL-2.0
// Copyright (C) 2018 Intel Corporation
#include <asm/unaligned.h>
#include <linux/acpi.h>
#include <linux/i2c.h>
#include <linux/module.h>
#include <linux/pm_runtime.h>
#include <media/v4l2-ctrls.h>
#include <media/v4l2-device.h>
#include <media/v4l2-event.h>
#include <media/v4l2-fwnode.h>
#define IMX319_REG_MODE_SELECT 0x0100
#define IMX319_MODE_STANDBY 0x00
#define IMX319_MODE_STREAMING 0x01
/* Chip ID */
#define IMX319_REG_CHIP_ID 0x0016
#define IMX319_CHIP_ID 0x0319
/* V_TIMING internal */
#define IMX319_REG_FLL 0x0340
#define IMX319_FLL_MAX 0xffff
/* Exposure control */
#define IMX319_REG_EXPOSURE 0x0202
#define IMX319_EXPOSURE_MIN 1
#define IMX319_EXPOSURE_STEP 1
#define IMX319_EXPOSURE_DEFAULT 0x04f6
/*
* the digital control register for all color control looks like:
* +-----------------+------------------+
* | [7:0] | [15:8] |
* +-----------------+------------------+
* | 0x020f | 0x020e |
* --------------------------------------
* it is used to calculate the digital gain times value(integral + fractional)
* the [15:8] bits is the fractional part and [7:0] bits is the integral
* calculation equation is:
* gain value (unit: times) = REG[15:8] + REG[7:0]/0x100
* Only value in 0x0100 ~ 0x0FFF range is allowed.
* Analog gain use 10 bits in the registers and allowed range is 0 ~ 960
*/
/* Analog gain control */
#define IMX319_REG_ANALOG_GAIN 0x0204
#define IMX319_ANA_GAIN_MIN 0
#define IMX319_ANA_GAIN_MAX 960
#define IMX319_ANA_GAIN_STEP 1
#define IMX319_ANA_GAIN_DEFAULT 0
/* Digital gain control */
#define IMX319_REG_DPGA_USE_GLOBAL_GAIN 0x3ff9
#define IMX319_REG_DIG_GAIN_GLOBAL 0x020e
#define IMX319_DGTL_GAIN_MIN 256
#define IMX319_DGTL_GAIN_MAX 4095
#define IMX319_DGTL_GAIN_STEP 1
#define IMX319_DGTL_GAIN_DEFAULT 256
/* Test Pattern Control */
#define IMX319_REG_TEST_PATTERN 0x0600
#define IMX319_TEST_PATTERN_DISABLED 0
#define IMX319_TEST_PATTERN_SOLID_COLOR 1
#define IMX319_TEST_PATTERN_COLOR_BARS 2
#define IMX319_TEST_PATTERN_GRAY_COLOR_BARS 3
#define IMX319_TEST_PATTERN_PN9 4
/* Flip Control */
#define IMX319_REG_ORIENTATION 0x0101
/* default link frequency and external clock */
#define IMX319_LINK_FREQ_DEFAULT 482400000
#define IMX319_EXT_CLK 19200000
#define IMX319_LINK_FREQ_INDEX 0
struct imx319_reg {
u16 address;
u8 val;
};
struct imx319_reg_list {
u32 num_of_regs;
const struct imx319_reg *regs;
};
/* Mode : resolution and related config&values */
struct imx319_mode {
/* Frame width */
u32 width;
/* Frame height */
u32 height;
/* V-timing */
u32 fll_def;
u32 fll_min;
/* H-timing */
u32 llp;
/* index of link frequency */
u32 link_freq_index;
/* Default register values */
struct imx319_reg_list reg_list;
};
struct imx319_hwcfg {
u32 ext_clk; /* sensor external clk */
s64 *link_freqs; /* CSI-2 link frequencies */
unsigned int nr_of_link_freqs;
};
struct imx319 {
struct v4l2_subdev sd;
struct media_pad pad;
struct v4l2_ctrl_handler ctrl_handler;
/* V4L2 Controls */
struct v4l2_ctrl *link_freq;
struct v4l2_ctrl *pixel_rate;
struct v4l2_ctrl *vblank;
struct v4l2_ctrl *hblank;
struct v4l2_ctrl *exposure;
struct v4l2_ctrl *vflip;
struct v4l2_ctrl *hflip;
/* Current mode */
const struct imx319_mode *cur_mode;
struct imx319_hwcfg *hwcfg;
s64 link_def_freq; /* CSI-2 link default frequency */
/*
* Mutex for serialized access:
* Protect sensor set pad format and start/stop streaming safely.
* Protect access to sensor v4l2 controls.
*/
struct mutex mutex;
/* Streaming on/off */
bool streaming;
/* True if the device has been identified */
bool identified;
};
static const struct imx319_reg imx319_global_regs[] = {
{ 0x0136, 0x13 },
{ 0x0137, 0x33 },
{ 0x3c7e, 0x05 },
{ 0x3c7f, 0x07 },
{ 0x4d39, 0x0b },
{ 0x4d41, 0x33 },
{ 0x4d43, 0x0c },
{ 0x4d49, 0x89 },
{ 0x4e05, 0x0b },
{ 0x4e0d, 0x33 },
{ 0x4e0f, 0x0c },
{ 0x4e15, 0x89 },
{ 0x4e49, 0x2a },
{ 0x4e51, 0x33 },
{ 0x4e53, 0x0c },
{ 0x4e59, 0x89 },
{ 0x5601, 0x4f },
{ 0x560b, 0x45 },
{ 0x562f, 0x0a },
{ 0x5643, 0x0a },
{ 0x5645, 0x0c },
{ 0x56ef, 0x51 },
{ 0x586f, 0x33 },
{ 0x5873, 0x89 },
{ 0x5905, 0x33 },
{ 0x5907, 0x89 },
{ 0x590d, 0x33 },
{ 0x590f, 0x89 },
{ 0x5915, 0x33 },
{ 0x5917, 0x89 },
{ 0x5969, 0x1c },
{ 0x596b, 0x72 },
{ 0x5971, 0x33 },
{ 0x5973, 0x89 },
{ 0x5975, 0x33 },
{ 0x5977, 0x89 },
{ 0x5979, 0x1c },
{ 0x597b, 0x72 },
{ 0x5985, 0x33 },
{ 0x5987, 0x89 },
{ 0x5999, 0x1c },
{ 0x599b, 0x72 },
{ 0x59a5, 0x33 },
{ 0x59a7, 0x89 },
{ 0x7485, 0x08 },
{ 0x7487, 0x0c },
{ 0x7489, 0xc7 },
{ 0x748b, 0x8b },
{ 0x9004, 0x09 },
{ 0x9200, 0x6a },
{ 0x9201, 0x22 },
{ 0x9202, 0x6a },
{ 0x9203, 0x23 },
{ 0x9204, 0x5f },
{ 0x9205, 0x23 },
{ 0x9206, 0x5f },
{ 0x9207, 0x24 },
{ 0x9208, 0x5f },
{ 0x9209, 0x26 },
{ 0x920a, 0x5f },
{ 0x920b, 0x27 },
{ 0x920c, 0x5f },
{ 0x920d, 0x29 },
{ 0x920e, 0x5f },
{ 0x920f, 0x2a },
{ 0x9210, 0x5f },
{ 0x9211, 0x2c },
{ 0xbc22, 0x1a },
{ 0xf01f, 0x04 },
{ 0xf021, 0x03 },
{ 0xf023, 0x02 },
{ 0xf03d, 0x05 },
{ 0xf03f, 0x03 },
{ 0xf041, 0x02 },
{ 0xf0af, 0x04 },
{ 0xf0b1, 0x03 },
{ 0xf0b3, 0x02 },
{ 0xf0cd, 0x05 },
{ 0xf0cf, 0x03 },
{ 0xf0d1, 0x02 },
{ 0xf13f, 0x04 },
{ 0xf141, 0x03 },
{ 0xf143, 0x02 },
{ 0xf15d, 0x05 },
{ 0xf15f, 0x03 },
{ 0xf161, 0x02 },
{ 0xf1cf, 0x04 },
{ 0xf1d1, 0x03 },
{ 0xf1d3, 0x02 },
{ 0xf1ed, 0x05 },
{ 0xf1ef, 0x03 },
{ 0xf1f1, 0x02 },
{ 0xf287, 0x04 },
{ 0xf289, 0x03 },
{ 0xf28b, 0x02 },
{ 0xf2a5, 0x05 },
{ 0xf2a7, 0x03 },
{ 0xf2a9, 0x02 },
{ 0xf2b7, 0x04 },
{ 0xf2b9, 0x03 },
{ 0xf2bb, 0x02 },
{ 0xf2d5, 0x05 },
{ 0xf2d7, 0x03 },
{ 0xf2d9, 0x02 },
};
static const struct imx319_reg_list imx319_global_setting = {
.num_of_regs = ARRAY_SIZE(imx319_global_regs),
.regs = imx319_global_regs,
};
static const struct imx319_reg mode_3264x2448_regs[] = {
{ 0x0112, 0x0a },
{ 0x0113, 0x0a },
{ 0x0114, 0x03 },
{ 0x0342, 0x0f },
{ 0x0343, 0x80 },
{ 0x0340, 0x0c },
{ 0x0341, 0xaa },
{ 0x0344, 0x00 },
{ 0x0345, 0x00 },
{ 0x0346, 0x00 },
{ 0x0347, 0x00 },
{ 0x0348, 0x0c },
{ 0x0349, 0xcf },
{ 0x034a, 0x09 },
{ 0x034b, 0x9f },
{ 0x0220, 0x00 },
{ 0x0221, 0x11 },
{ 0x0381, 0x01 },
{ 0x0383, 0x01 },
{ 0x0385, 0x01 },
{ 0x0387, 0x01 },
{ 0x0900, 0x00 },
{ 0x0901, 0x11 },
{ 0x0902, 0x0a },
{ 0x3140, 0x02 },
{ 0x3141, 0x00 },
{ 0x3f0d, 0x0a },
{ 0x3f14, 0x01 },
{ 0x3f3c, 0x01 },
{ 0x3f4d, 0x01 },
{ 0x3f4c, 0x01 },
{ 0x4254, 0x7f },
{ 0x0401, 0x00 },
{ 0x0404, 0x00 },
{ 0x0405, 0x10 },
{ 0x0408, 0x00 },
{ 0x0409, 0x08 },
{ 0x040a, 0x00 },
{ 0x040b, 0x08 },
{ 0x040c, 0x0c },
{ 0x040d, 0xc0 },
{ 0x040e, 0x09 },
{ 0x040f, 0x90 },
{ 0x034c, 0x0c },
{ 0x034d, 0xc0 },
{ 0x034e, 0x09 },
{ 0x034f, 0x90 },
{ 0x3261, 0x00 },
{ 0x3264, 0x00 },
{ 0x3265, 0x10 },
{ 0x0301, 0x05 },
{ 0x0303, 0x04 },
{ 0x0305, 0x04 },
{ 0x0306, 0x01 },
{ 0x0307, 0x92 },
{ 0x0309, 0x0a },
{ 0x030b, 0x02 },
{ 0x030d, 0x02 },
{ 0x030e, 0x00 },
{ 0x030f, 0xfa },
{ 0x0310, 0x00 },
{ 0x0820, 0x0f },
{ 0x0821, 0x13 },
{ 0x0822, 0x33 },
{ 0x0823, 0x33 },
{ 0x3e20, 0x01 },
{ 0x3e37, 0x00 },
{ 0x3e3b, 0x01 },
{ 0x38a3, 0x01 },
{ 0x38a8, 0x00 },
{ 0x38a9, 0x00 },
{ 0x38aa, 0x00 },
{ 0x38ab, 0x00 },
{ 0x3234, 0x00 },
{ 0x3fc1, 0x00 },
{ 0x3235, 0x00 },
{ 0x3802, 0x00 },
{ 0x3143, 0x04 },
{ 0x360a, 0x00 },
{ 0x0b00, 0x00 },
{ 0x0106, 0x00 },
{ 0x0b05, 0x01 },
{ 0x0b06, 0x01 },
{ 0x3230, 0x00 },
{ 0x3602, 0x01 },
{ 0x3607, 0x01 },
{ 0x3c00, 0x00 },
{ 0x3c01, 0x48 },
{ 0x3c02, 0xc8 },
{ 0x3c03, 0xaa },
{ 0x3c04, 0x91 },
{ 0x3c05, 0x54 },
{ 0x3c06, 0x26 },
{ 0x3c07, 0x20 },
{ 0x3c08, 0x51 },
{ 0x3d80, 0x00 },
{ 0x3f50, 0x00 },
{ 0x3f56, 0x00 },
{ 0x3f57, 0x30 },
{ 0x3f78, 0x01 },
{ 0x3f79, 0x18 },
{ 0x3f7c, 0x00 },
{ 0x3f7d, 0x00 },
{ 0x3fba, 0x00 },
{ 0x3fbb, 0x00 },
{ 0xa081, 0x00 },
{ 0xe014, 0x00 },
{ 0x0202, 0x0a },
{ 0x0203, 0x7a },
{ 0x0224, 0x01 },
{ 0x0225, 0xf4 },
{ 0x0204, 0x00 },
{ 0x0205, 0x00 },
{ 0x0216, 0x00 },
{ 0x0217, 0x00 },
{ 0x020e, 0x01 },
{ 0x020f, 0x00 },
{ 0x0210, 0x01 },
{ 0x0211, 0x00 },
{ 0x0212, 0x01 },
{ 0x0213, 0x00 },
{ 0x0214, 0x01 },
{ 0x0215, 0x00 },
{ 0x0218, 0x01 },
{ 0x0219, 0x00 },
{ 0x3614, 0x00 },
{ 0x3616, 0x0d },
{ 0x3617, 0x56 },
{ 0xb612, 0x20 },
{ 0xb613, 0x20 },
{ 0xb614, 0x20 },
{ 0xb615, 0x20 },
{ 0xb616, 0x0a },
{ 0xb617, 0x0a },
{ 0xb618, 0x20 },
{ 0xb619, 0x20 },
{ 0xb61a, 0x20 },
{ 0xb61b, 0x20 },
{ 0xb61c, 0x0a },
{ 0xb61d, 0x0a },
{ 0xb666, 0x30 },
{ 0xb667, 0x30 },
{ 0xb668, 0x30 },
{ 0xb669, 0x30 },
{ 0xb66a, 0x14 },
{ 0xb66b, 0x14 },
{ 0xb66c, 0x20 },
{ 0xb66d, 0x20 },
{ 0xb66e, 0x20 },
{ 0xb66f, 0x20 },
{ 0xb670, 0x10 },
{ 0xb671, 0x10 },
{ 0x3237, 0x00 },
{ 0x3900, 0x00 },
{ 0x3901, 0x00 },
{ 0x3902, 0x00 },
{ 0x3904, 0x00 },
{ 0x3905, 0x00 },
{ 0x3906, 0x00 },
{ 0x3907, 0x00 },
{ 0x3908, 0x00 },
{ 0x3909, 0x00 },
{ 0x3912, 0x00 },
{ 0x3930, 0x00 },
{ 0x3931, 0x00 },
{ 0x3933, 0x00 },
{ 0x3934, 0x00 },
{ 0x3935, 0x00 },
{ 0x3936, 0x00 },
{ 0x3937, 0x00 },
{ 0x30ac, 0x00 },
};
static const struct imx319_reg mode_3280x2464_regs[] = {
{ 0x0112, 0x0a },
{ 0x0113, 0x0a },
{ 0x0114, 0x03 },
{ 0x0342, 0x0f },
{ 0x0343, 0x80 },
{ 0x0340, 0x0c },
{ 0x0341, 0xaa },
{ 0x0344, 0x00 },
{ 0x0345, 0x00 },
{ 0x0346, 0x00 },
{ 0x0347, 0x00 },
{ 0x0348, 0x0c },
{ 0x0349, 0xcf },
{ 0x034a, 0x09 },
{ 0x034b, 0x9f },
{ 0x0220, 0x00 },
{ 0x0221, 0x11 },
{ 0x0381, 0x01 },
{ 0x0383, 0x01 },
{ 0x0385, 0x01 },
{ 0x0387, 0x01 },
{ 0x0900, 0x00 },
{ 0x0901, 0x11 },
{ 0x0902, 0x0a },
{ 0x3140, 0x02 },
{ 0x3141, 0x00 },
{ 0x3f0d, 0x0a },
{ 0x3f14, 0x01 },
{ 0x3f3c, 0x01 },
{ 0x3f4d, 0x01 },
{ 0x3f4c, 0x01 },
{ 0x4254, 0x7f },
{ 0x0401, 0x00 },
{ 0x0404, 0x00 },
{ 0x0405, 0x10 },
{ 0x0408, 0x00 },
{ 0x0409, 0x00 },
{ 0x040a, 0x00 },
{ 0x040b, 0x00 },
{ 0x040c, 0x0c },
{ 0x040d, 0xd0 },
{ 0x040e, 0x09 },
{ 0x040f, 0xa0 },
{ 0x034c, 0x0c },
{ 0x034d, 0xd0 },
{ 0x034e, 0x09 },
{ 0x034f, 0xa0 },
{ 0x3261, 0x00 },
{ 0x3264, 0x00 },
{ 0x3265, 0x10 },
{ 0x0301, 0x05 },
{ 0x0303, 0x04 },
{ 0x0305, 0x04 },
{ 0x0306, 0x01 },
{ 0x0307, 0x92 },
{ 0x0309, 0x0a },
{ 0x030b, 0x02 },
{ 0x030d, 0x02 },
{ 0x030e, 0x00 },
{ 0x030f, 0xfa },
{ 0x0310, 0x00 },
{ 0x0820, 0x0f },
{ 0x0821, 0x13 },
{ 0x0822, 0x33 },
{ 0x0823, 0x33 },
{ 0x3e20, 0x01 },
{ 0x3e37, 0x00 },
{ 0x3e3b, 0x01 },
{ 0x38a3, 0x01 },
{ 0x38a8, 0x00 },
{ 0x38a9, 0x00 },
{ 0x38aa, 0x00 },
{ 0x38ab, 0x00 },
{ 0x3234, 0x00 },
{ 0x3fc1, 0x00 },
{ 0x3235, 0x00 },
{ 0x3802, 0x00 },
{ 0x3143, 0x04 },
{ 0x360a, 0x00 },
{ 0x0b00, 0x00 },
{ 0x0106, 0x00 },
{ 0x0b05, 0x01 },
{ 0x0b06, 0x01 },
{ 0x3230, 0x00 },
{ 0x3602, 0x01 },
{ 0x3607, 0x01 },
{ 0x3c00, 0x00 },
{ 0x3c01, 0x48 },
{ 0x3c02, 0xc8 },
{ 0x3c03, 0xaa },
{ 0x3c04, 0x91 },
{ 0x3c05, 0x54 },
{ 0x3c06, 0x26 },
{ 0x3c07, 0x20 },
{ 0x3c08, 0x51 },
{ 0x3d80, 0x00 },
{ 0x3f50, 0x00 },
{ 0x3f56, 0x00 },
{ 0x3f57, 0x30 },
{ 0x3f78, 0x01 },
{ 0x3f79, 0x18 },
{ 0x3f7c, 0x00 },
{ 0x3f7d, 0x00 },
{ 0x3fba, 0x00 },
{ 0x3fbb, 0x00 },
{ 0xa081, 0x00 },
{ 0xe014, 0x00 },
{ 0x0202, 0x0a },
{ 0x0203, 0x7a },
{ 0x0224, 0x01 },
{ 0x0225, 0xf4 },
{ 0x0204, 0x00 },
{ 0x0205, 0x00 },
{ 0x0216, 0x00 },
{ 0x0217, 0x00 },
{ 0x020e, 0x01 },
{ 0x020f, 0x00 },
{ 0x0210, 0x01 },
{ 0x0211, 0x00 },
{ 0x0212, 0x01 },
{ 0x0213, 0x00 },
{ 0x0214, 0x01 },
{ 0x0215, 0x00 },
{ 0x0218, 0x01 },
{ 0x0219, 0x00 },
{ 0x3614, 0x00 },
{ 0x3616, 0x0d },
{ 0x3617, 0x56 },
{ 0xb612, 0x20 },
{ 0xb613, 0x20 },
{ 0xb614, 0x20 },
{ 0xb615, 0x20 },
{ 0xb616, 0x0a },
{ 0xb617, 0x0a },
{ 0xb618, 0x20 },
{ 0xb619, 0x20 },
{ 0xb61a, 0x20 },
{ 0xb61b, 0x20 },
{ 0xb61c, 0x0a },
{ 0xb61d, 0x0a },
{ 0xb666, 0x30 },
{ 0xb667, 0x30 },
{ 0xb668, 0x30 },
{ 0xb669, 0x30 },
{ 0xb66a, 0x14 },
{ 0xb66b, 0x14 },
{ 0xb66c, 0x20 },
{ 0xb66d, 0x20 },
{ 0xb66e, 0x20 },
{ 0xb66f, 0x20 },
{ 0xb670, 0x10 },
{ 0xb671, 0x10 },
{ 0x3237, 0x00 },
{ 0x3900, 0x00 },
{ 0x3901, 0x00 },
{ 0x3902, 0x00 },
{ 0x3904, 0x00 },
{ 0x3905, 0x00 },
{ 0x3906, 0x00 },
{ 0x3907, 0x00 },
{ 0x3908, 0x00 },
{ 0x3909, 0x00 },
{ 0x3912, 0x00 },
{ 0x3930, 0x00 },
{ 0x3931, 0x00 },
{ 0x3933, 0x00 },
{ 0x3934, 0x00 },
{ 0x3935, 0x00 },
{ 0x3936, 0x00 },
{ 0x3937, 0x00 },
{ 0x30ac, 0x00 },
};
static const struct imx319_reg mode_1936x1096_regs[] = {
{ 0x0112, 0x0a },
{ 0x0113, 0x0a },
{ 0x0114, 0x03 },
{ 0x0342, 0x0f },
{ 0x0343, 0x80 },
{ 0x0340, 0x0c },
{ 0x0341, 0xaa },
{ 0x0344, 0x00 },
{ 0x0345, 0x00 },
{ 0x0346, 0x02 },
{ 0x0347, 0xac },
{ 0x0348, 0x0c },
{ 0x0349, 0xcf },
{ 0x034a, 0x06 },
{ 0x034b, 0xf3 },
{ 0x0220, 0x00 },
{ 0x0221, 0x11 },
{ 0x0381, 0x01 },
{ 0x0383, 0x01 },
{ 0x0385, 0x01 },
{ 0x0387, 0x01 },
{ 0x0900, 0x00 },
{ 0x0901, 0x11 },
{ 0x0902, 0x0a },
{ 0x3140, 0x02 },
{ 0x3141, 0x00 },
{ 0x3f0d, 0x0a },
{ 0x3f14, 0x01 },
{ 0x3f3c, 0x01 },
{ 0x3f4d, 0x01 },
{ 0x3f4c, 0x01 },
{ 0x4254, 0x7f },
{ 0x0401, 0x00 },
{ 0x0404, 0x00 },
{ 0x0405, 0x10 },
{ 0x0408, 0x02 },
{ 0x0409, 0xa0 },
{ 0x040a, 0x00 },
{ 0x040b, 0x00 },
{ 0x040c, 0x07 },
{ 0x040d, 0x90 },
{ 0x040e, 0x04 },
{ 0x040f, 0x48 },
{ 0x034c, 0x07 },
{ 0x034d, 0x90 },
{ 0x034e, 0x04 },
{ 0x034f, 0x48 },
{ 0x3261, 0x00 },
{ 0x3264, 0x00 },
{ 0x3265, 0x10 },
{ 0x0301, 0x05 },
{ 0x0303, 0x04 },
{ 0x0305, 0x04 },
{ 0x0306, 0x01 },
{ 0x0307, 0x92 },
{ 0x0309, 0x0a },
{ 0x030b, 0x02 },
{ 0x030d, 0x02 },
{ 0x030e, 0x00 },
{ 0x030f, 0xfa },
{ 0x0310, 0x00 },
{ 0x0820, 0x0f },
{ 0x0821, 0x13 },
{ 0x0822, 0x33 },
{ 0x0823, 0x33 },
{ 0x3e20, 0x01 },
{ 0x3e37, 0x00 },
{ 0x3e3b, 0x01 },
{ 0x38a3, 0x01 },
{ 0x38a8, 0x00 },
{ 0x38a9, 0x00 },
{ 0x38aa, 0x00 },
{ 0x38ab, 0x00 },
{ 0x3234, 0x00 },
{ 0x3fc1, 0x00 },
{ 0x3235, 0x00 },
{ 0x3802, 0x00 },
{ 0x3143, 0x04 },
{ 0x360a, 0x00 },
{ 0x0b00, 0x00 },
{ 0x0106, 0x00 },
{ 0x0b05, 0x01 },
{ 0x0b06, 0x01 },
{ 0x3230, 0x00 },
{ 0x3602, 0x01 },
{ 0x3607, 0x01 },
{ 0x3c00, 0x00 },
{ 0x3c01, 0x48 },
{ 0x3c02, 0xc8 },
{ 0x3c03, 0xaa },
{ 0x3c04, 0x91 },
{ 0x3c05, 0x54 },
{ 0x3c06, 0x26 },
{ 0x3c07, 0x20 },
{ 0x3c08, 0x51 },
{ 0x3d80, 0x00 },
{ 0x3f50, 0x00 },
{ 0x3f56, 0x00 },
{ 0x3f57, 0x30 },
{ 0x3f78, 0x01 },
{ 0x3f79, 0x18 },
{ 0x3f7c, 0x00 },
{ 0x3f7d, 0x00 },
{ 0x3fba, 0x00 },
{ 0x3fbb, 0x00 },
{ 0xa081, 0x00 },
{ 0xe014, 0x00 },
{ 0x0202, 0x05 },
{ 0x0203, 0x34 },
{ 0x0224, 0x01 },
{ 0x0225, 0xf4 },
{ 0x0204, 0x00 },
{ 0x0205, 0x00 },
{ 0x0216, 0x00 },
{ 0x0217, 0x00 },
{ 0x020e, 0x01 },
{ 0x020f, 0x00 },
{ 0x0210, 0x01 },
{ 0x0211, 0x00 },
{ 0x0212, 0x01 },
{ 0x0213, 0x00 },
{ 0x0214, 0x01 },
{ 0x0215, 0x00 },
{ 0x0218, 0x01 },
{ 0x0219, 0x00 },
{ 0x3614, 0x00 },
{ 0x3616, 0x0d },
{ 0x3617, 0x56 },
{ 0xb612, 0x20 },
{ 0xb613, 0x20 },
{ 0xb614, 0x20 },
{ 0xb615, 0x20 },
{ 0xb616, 0x0a },
{ 0xb617, 0x0a },
{ 0xb618, 0x20 },
{ 0xb619, 0x20 },
{ 0xb61a, 0x20 },
{ 0xb61b, 0x20 },
{ 0xb61c, 0x0a },
{ 0xb61d, 0x0a },
{ 0xb666, 0x30 },
{ 0xb667, 0x30 },
{ 0xb668, 0x30 },
{ 0xb669, 0x30 },
{ 0xb66a, 0x14 },
{ 0xb66b, 0x14 },
{ 0xb66c, 0x20 },
{ 0xb66d, 0x20 },
{ 0xb66e, 0x20 },
{ 0xb66f, 0x20 },
{ 0xb670, 0x10 },
{ 0xb671, 0x10 },
{ 0x3237, 0x00 },
{ 0x3900, 0x00 },
{ 0x3901, 0x00 },
{ 0x3902, 0x00 },
{ 0x3904, 0x00 },
{ 0x3905, 0x00 },
{ 0x3906, 0x00 },
{ 0x3907, 0x00 },
{ 0x3908, 0x00 },
{ 0x3909, 0x00 },
{ 0x3912, 0x00 },
{ 0x3930, 0x00 },
{ 0x3931, 0x00 },
{ 0x3933, 0x00 },
{ 0x3934, 0x00 },
{ 0x3935, 0x00 },
{ 0x3936, 0x00 },
{ 0x3937, 0x00 },
{ 0x30ac, 0x00 },
};
static const struct imx319_reg mode_1920x1080_regs[] = {
{ 0x0112, 0x0a },
{ 0x0113, 0x0a },
{ 0x0114, 0x03 },
{ 0x0342, 0x0f },
{ 0x0343, 0x80 },
{ 0x0340, 0x0c },
{ 0x0341, 0xaa },
{ 0x0344, 0x00 },
{ 0x0345, 0x00 },
{ 0x0346, 0x02 },
{ 0x0347, 0xb4 },
{ 0x0348, 0x0c },
{ 0x0349, 0xcf },
{ 0x034a, 0x06 },
{ 0x034b, 0xeb },
{ 0x0220, 0x00 },
{ 0x0221, 0x11 },
{ 0x0381, 0x01 },
{ 0x0383, 0x01 },
{ 0x0385, 0x01 },
{ 0x0387, 0x01 },
{ 0x0900, 0x00 },
{ 0x0901, 0x11 },
{ 0x0902, 0x0a },
{ 0x3140, 0x02 },
{ 0x3141, 0x00 },
{ 0x3f0d, 0x0a },
{ 0x3f14, 0x01 },
{ 0x3f3c, 0x01 },
{ 0x3f4d, 0x01 },
{ 0x3f4c, 0x01 },
{ 0x4254, 0x7f },
{ 0x0401, 0x00 },
{ 0x0404, 0x00 },
{ 0x0405, 0x10 },
{ 0x0408, 0x02 },
{ 0x0409, 0xa8 },
{ 0x040a, 0x00 },
{ 0x040b, 0x00 },
{ 0x040c, 0x07 },
{ 0x040d, 0x80 },
{ 0x040e, 0x04 },
{ 0x040f, 0x38 },
{ 0x034c, 0x07 },
{ 0x034d, 0x80 },
{ 0x034e, 0x04 },
{ 0x034f, 0x38 },
{ 0x3261, 0x00 },
{ 0x3264, 0x00 },
{ 0x3265, 0x10 },
{ 0x0301, 0x05 },
{ 0x0303, 0x04 },
{ 0x0305, 0x04 },
{ 0x0306, 0x01 },
{ 0x0307, 0x92 },
{ 0x0309, 0x0a },
{ 0x030b, 0x02 },
{ 0x030d, 0x02 },
{ 0x030e, 0x00 },
{ 0x030f, 0xfa },
{ 0x0310, 0x00 },
{ 0x0820, 0x0f },
{ 0x0821, 0x13 },
{ 0x0822, 0x33 },
{ 0x0823, 0x33 },
{ 0x3e20, 0x01 },
{ 0x3e37, 0x00 },
{ 0x3e3b, 0x01 },
{ 0x38a3, 0x01 },
{ 0x38a8, 0x00 },
{ 0x38a9, 0x00 },
{ 0x38aa, 0x00 },
{ 0x38ab, 0x00 },
{ 0x3234, 0x00 },
{ 0x3fc1, 0x00 },
{ 0x3235, 0x00 },
{ 0x3802, 0x00 },
{ 0x3143, 0x04 },
{ 0x360a, 0x00 },
{ 0x0b00, 0x00 },
{ 0x0106, 0x00 },
{ 0x0b05, 0x01 },
{ 0x0b06, 0x01 },
{ 0x3230, 0x00 },
{ 0x3602, 0x01 },
{ 0x3607, 0x01 },
{ 0x3c00, 0x00 },
{ 0x3c01, 0x48 },
{ 0x3c02, 0xc8 },
{ 0x3c03, 0xaa },
{ 0x3c04, 0x91 },
{ 0x3c05, 0x54 },
{ 0x3c06, 0x26 },
{ 0x3c07, 0x20 },
{ 0x3c08, 0x51 },
{ 0x3d80, 0x00 },
{ 0x3f50, 0x00 },
{ 0x3f56, 0x00 },
{ 0x3f57, 0x30 },
{ 0x3f78, 0x01 },
{ 0x3f79, 0x18 },
{ 0x3f7c, 0x00 },
{ 0x3f7d, 0x00 },
{ 0x3fba, 0x00 },
{ 0x3fbb, 0x00 },
{ 0xa081, 0x00 },
{ 0xe014, 0x00 },
{ 0x0202, 0x05 },
{ 0x0203, 0x34 },
{ 0x0224, 0x01 },
{ 0x0225, 0xf4 },
{ 0x0204, 0x00 },
{ 0x0205, 0x00 },
{ 0x0216, 0x00 },
{ 0x0217, 0x00 },
{ 0x020e, 0x01 },
{ 0x020f, 0x00 },
{ 0x0210, 0x01 },
{ 0x0211, 0x00 },
{ 0x0212, 0x01 },
{ 0x0213, 0x00 },
{ 0x0214, 0x01 },
{ 0x0215, 0x00 },
{ 0x0218, 0x01 },
{ 0x0219, 0x00 },
{ 0x3614, 0x00 },
{ 0x3616, 0x0d },
{ 0x3617, 0x56 },
{ 0xb612, 0x20 },
{ 0xb613, 0x20 },
{ 0xb614, 0x20 },
{ 0xb615, 0x20 },
{ 0xb616, 0x0a },
{ 0xb617, 0x0a },
{ 0xb618, 0x20 },
{ 0xb619, 0x20 },
{ 0xb61a, 0x20 },
{ 0xb61b, 0x20 },
{ 0xb61c, 0x0a },
{ 0xb61d, 0x0a },
{ 0xb666, 0x30 },
{ 0xb667, 0x30 },
{ 0xb668, 0x30 },
{ 0xb669, 0x30 },
{ 0xb66a, 0x14 },
{ 0xb66b, 0x14 },
{ 0xb66c, 0x20 },
{ 0xb66d, 0x20 },
{ 0xb66e, 0x20 },
{ 0xb66f, 0x20 },
{ 0xb670, 0x10 },
{ 0xb671, 0x10 },
{ 0x3237, 0x00 },
{ 0x3900, 0x00 },
{ 0x3901, 0x00 },
{ 0x3902, 0x00 },
{ 0x3904, 0x00 },
{ 0x3905, 0x00 },
{ 0x3906, 0x00 },
{ 0x3907, 0x00 },
{ 0x3908, 0x00 },
{ 0x3909, 0x00 },
{ 0x3912, 0x00 },
{ 0x3930, 0x00 },
{ 0x3931, 0x00 },
{ 0x3933, 0x00 },
{ 0x3934, 0x00 },
{ 0x3935, 0x00 },
{ 0x3936, 0x00 },
{ 0x3937, 0x00 },
{ 0x30ac, 0x00 },
};
static const struct imx319_reg mode_1640x1232_regs[] = {
{ 0x0112, 0x0a },
{ 0x0113, 0x0a },
{ 0x0114, 0x03 },
{ 0x0342, 0x08 },
{ 0x0343, 0x20 },
{ 0x0340, 0x18 },
{ 0x0341, 0x2a },
{ 0x0344, 0x00 },
{ 0x0345, 0x00 },
{ 0x0346, 0x00 },
{ 0x0347, 0x00 },
{ 0x0348, 0x0c },
{ 0x0349, 0xcf },
{ 0x034a, 0x09 },
{ 0x034b, 0x9f },
{ 0x0220, 0x00 },
{ 0x0221, 0x11 },
{ 0x0381, 0x01 },
{ 0x0383, 0x01 },
{ 0x0385, 0x01 },
{ 0x0387, 0x01 },
{ 0x0900, 0x01 },
{ 0x0901, 0x22 },
{ 0x0902, 0x0a },
{ 0x3140, 0x02 },
{ 0x3141, 0x00 },
{ 0x3f0d, 0x0a },
{ 0x3f14, 0x01 },
{ 0x3f3c, 0x02 },
{ 0x3f4d, 0x01 },
{ 0x3f4c, 0x01 },
{ 0x4254, 0x7f },
{ 0x0401, 0x00 },
{ 0x0404, 0x00 },
{ 0x0405, 0x10 },
{ 0x0408, 0x00 },
{ 0x0409, 0x00 },
{ 0x040a, 0x00 },
{ 0x040b, 0x00 },
{ 0x040c, 0x06 },
{ 0x040d, 0x68 },
{ 0x040e, 0x04 },
{ 0x040f, 0xd0 },
{ 0x034c, 0x06 },
{ 0x034d, 0x68 },
{ 0x034e, 0x04 },
{ 0x034f, 0xd0 },
{ 0x3261, 0x00 },
{ 0x3264, 0x00 },
{ 0x3265, 0x10 },
{ 0x0301, 0x05 },
{ 0x0303, 0x04 },
{ 0x0305, 0x04 },
{ 0x0306, 0x01 },
{ 0x0307, 0x92 },
{ 0x0309, 0x0a },
{ 0x030b, 0x02 },
{ 0x030d, 0x02 },
{ 0x030e, 0x00 },
{ 0x030f, 0xfa },
{ 0x0310, 0x00 },
{ 0x0820, 0x0f },
{ 0x0821, 0x13 },
{ 0x0822, 0x33 },
{ 0x0823, 0x33 },
{ 0x3e20, 0x01 },
{ 0x3e37, 0x00 },
{ 0x3e3b, 0x01 },
{ 0x38a3, 0x01 },
{ 0x38a8, 0x00 },
{ 0x38a9, 0x00 },
{ 0x38aa, 0x00 },
{ 0x38ab, 0x00 },
{ 0x3234, 0x00 },
{ 0x3fc1, 0x00 },
{ 0x3235, 0x00 },
{ 0x3802, 0x00 },
{ 0x3143, 0x04 },
{ 0x360a, 0x00 },
{ 0x0b00, 0x00 },
{ 0x0106, 0x00 },
{ 0x0b05, 0x01 },
{ 0x0b06, 0x01 },
{ 0x3230, 0x00 },
{ 0x3602, 0x01 },
{ 0x3607, 0x01 },
{ 0x3c00, 0x00 },
{ 0x3c01, 0xba },
{ 0x3c02, 0xc8 },
{ 0x3c03, 0xaa },
{ 0x3c04, 0x91 },
{ 0x3c05, 0x54 },
{ 0x3c06, 0x26 },
{ 0x3c07, 0x20 },
{ 0x3c08, 0x51 },
{ 0x3d80, 0x00 },
{ 0x3f50, 0x00 },
{ 0x3f56, 0x00 },
{ 0x3f57, 0x30 },
{ 0x3f78, 0x00 },
{ 0x3f79, 0x34 },
{ 0x3f7c, 0x00 },
{ 0x3f7d, 0x00 },
{ 0x3fba, 0x00 },
{ 0x3fbb, 0x00 },
{ 0xa081, 0x04 },
{ 0xe014, 0x00 },
{ 0x0202, 0x04 },
{ 0x0203, 0xf6 },
{ 0x0224, 0x01 },
{ 0x0225, 0xf4 },
{ 0x0204, 0x00 },
{ 0x0205, 0x00 },
{ 0x0216, 0x00 },
{ 0x0217, 0x00 },
{ 0x020e, 0x01 },
{ 0x020f, 0x00 },
{ 0x0210, 0x01 },
{ 0x0211, 0x00 },
{ 0x0212, 0x01 },
{ 0x0213, 0x00 },
{ 0x0214, 0x01 },
{ 0x0215, 0x00 },
{ 0x0218, 0x01 },
{ 0x0219, 0x00 },
{ 0x3614, 0x00 },
{ 0x3616, 0x0d },
{ 0x3617, 0x56 },
{ 0xb612, 0x20 },
{ 0xb613, 0x20 },
{ 0xb614, 0x20 },
{ 0xb615, 0x20 },
{ 0xb616, 0x0a },
{ 0xb617, 0x0a },
{ 0xb618, 0x20 },
{ 0xb619, 0x20 },
{ 0xb61a, 0x20 },
{ 0xb61b, 0x20 },
{ 0xb61c, 0x0a },
{ 0xb61d, 0x0a },
{ 0xb666, 0x30 },
{ 0xb667, 0x30 },
{ 0xb668, 0x30 },
{ 0xb669, 0x30 },
{ 0xb66a, 0x14 },
{ 0xb66b, 0x14 },
{ 0xb66c, 0x20 },
{ 0xb66d, 0x20 },
{ 0xb66e, 0x20 },
{ 0xb66f, 0x20 },
{ 0xb670, 0x10 },
{ 0xb671, 0x10 },
{ 0x3237, 0x00 },
{ 0x3900, 0x00 },
{ 0x3901, 0x00 },
{ 0x3902, 0x00 },
{ 0x3904, 0x00 },
{ 0x3905, 0x00 },
{ 0x3906, 0x00 },
{ 0x3907, 0x00 },
{ 0x3908, 0x00 },
{ 0x3909, 0x00 },
{ 0x3912, 0x00 },
{ 0x3930, 0x00 },
{ 0x3931, 0x00 },
{ 0x3933, 0x00 },
{ 0x3934, 0x00 },
{ 0x3935, 0x00 },
{ 0x3936, 0x00 },
{ 0x3937, 0x00 },
{ 0x30ac, 0x00 },
};
static const struct imx319_reg mode_1640x922_regs[] = {
{ 0x0112, 0x0a },
{ 0x0113, 0x0a },
{ 0x0114, 0x03 },
{ 0x0342, 0x08 },
{ 0x0343, 0x20 },
{ 0x0340, 0x18 },
{ 0x0341, 0x2a },
{ 0x0344, 0x00 },
{ 0x0345, 0x00 },
{ 0x0346, 0x01 },
{ 0x0347, 0x30 },
{ 0x0348, 0x0c },
{ 0x0349, 0xcf },
{ 0x034a, 0x08 },
{ 0x034b, 0x6f },
{ 0x0220, 0x00 },
{ 0x0221, 0x11 },
{ 0x0381, 0x01 },
{ 0x0383, 0x01 },
{ 0x0385, 0x01 },
{ 0x0387, 0x01 },
{ 0x0900, 0x01 },
{ 0x0901, 0x22 },
{ 0x0902, 0x0a },
{ 0x3140, 0x02 },
{ 0x3141, 0x00 },
{ 0x3f0d, 0x0a },
{ 0x3f14, 0x01 },
{ 0x3f3c, 0x02 },
{ 0x3f4d, 0x01 },
{ 0x3f4c, 0x01 },
{ 0x4254, 0x7f },
{ 0x0401, 0x00 },
{ 0x0404, 0x00 },
{ 0x0405, 0x10 },
{ 0x0408, 0x00 },
{ 0x0409, 0x00 },
{ 0x040a, 0x00 },
{ 0x040b, 0x02 },
{ 0x040c, 0x06 },
{ 0x040d, 0x68 },
{ 0x040e, 0x03 },
{ 0x040f, 0x9a },
{ 0x034c, 0x06 },
{ 0x034d, 0x68 },
{ 0x034e, 0x03 },
{ 0x034f, 0x9a },
{ 0x3261, 0x00 },
{ 0x3264, 0x00 },
{ 0x3265, 0x10 },
{ 0x0301, 0x05 },
{ 0x0303, 0x04 },
{ 0x0305, 0x04 },
{ 0x0306, 0x01 },
{ 0x0307, 0x92 },
{ 0x0309, 0x0a },
{ 0x030b, 0x02 },
{ 0x030d, 0x02 },
{ 0x030e, 0x00 },
{ 0x030f, 0xfa },
{ 0x0310, 0x00 },
{ 0x0820, 0x0f },
{ 0x0821, 0x13 },
{ 0x0822, 0x33 },
{ 0x0823, 0x33 },
{ 0x3e20, 0x01 },
{ 0x3e37, 0x00 },
{ 0x3e3b, 0x01 },
{ 0x38a3, 0x01 },
{ 0x38a8, 0x00 },
{ 0x38a9, 0x00 },
{ 0x38aa, 0x00 },
{ 0x38ab, 0x00 },
{ 0x3234, 0x00 },
{ 0x3fc1, 0x00 },
{ 0x3235, 0x00 },
{ 0x3802, 0x00 },
{ 0x3143, 0x04 },
{ 0x360a, 0x00 },
{ 0x0b00, 0x00 },
{ 0x0106, 0x00 },
{ 0x0b05, 0x01 },
{ 0x0b06, 0x01 },
{ 0x3230, 0x00 },
{ 0x3602, 0x01 },
{ 0x3607, 0x01 },
{ 0x3c00, 0x00 },
{ 0x3c01, 0xba },
{ 0x3c02, 0xc8 },
{ 0x3c03, 0xaa },
{ 0x3c04, 0x91 },
{ 0x3c05, 0x54 },
{ 0x3c06, 0x26 },
{ 0x3c07, 0x20 },
{ 0x3c08, 0x51 },
{ 0x3d80, 0x00 },
{ 0x3f50, 0x00 },
{ 0x3f56, 0x00 },
{ 0x3f57, 0x30 },
{ 0x3f78, 0x00 },
{ 0x3f79, 0x34 },
{ 0x3f7c, 0x00 },
{ 0x3f7d, 0x00 },
{ 0x3fba, 0x00 },
{ 0x3fbb, 0x00 },
{ 0xa081, 0x04 },
{ 0xe014, 0x00 },
{ 0x0202, 0x04 },
{ 0x0203, 0xf6 },
{ 0x0224, 0x01 },
{ 0x0225, 0xf4 },
{ 0x0204, 0x00 },
{ 0x0205, 0x00 },
{ 0x0216, 0x00 },
{ 0x0217, 0x00 },
{ 0x020e, 0x01 },
{ 0x020f, 0x00 },
{ 0x0210, 0x01 },
{ 0x0211, 0x00 },
{ 0x0212, 0x01 },
{ 0x0213, 0x00 },
{ 0x0214, 0x01 },
{ 0x0215, 0x00 },
{ 0x0218, 0x01 },
{ 0x0219, 0x00 },
{ 0x3614, 0x00 },
{ 0x3616, 0x0d },
{ 0x3617, 0x56 },
{ 0xb612, 0x20 },
{ 0xb613, 0x20 },
{ 0xb614, 0x20 },
{ 0xb615, 0x20 },
{ 0xb616, 0x0a },
{ 0xb617, 0x0a },
{ 0xb618, 0x20 },
{ 0xb619, 0x20 },
{ 0xb61a, 0x20 },
{ 0xb61b, 0x20 },
{ 0xb61c, 0x0a },
{ 0xb61d, 0x0a },
{ 0xb666, 0x30 },
{ 0xb667, 0x30 },
{ 0xb668, 0x30 },
{ 0xb669, 0x30 },
{ 0xb66a, 0x14 },
{ 0xb66b, 0x14 },
{ 0xb66c, 0x20 },
{ 0xb66d, 0x20 },
{ 0xb66e, 0x20 },
{ 0xb66f, 0x20 },
{ 0xb670, 0x10 },
{ 0xb671, 0x10 },
{ 0x3237, 0x00 },
{ 0x3900, 0x00 },
{ 0x3901, 0x00 },
{ 0x3902, 0x00 },
{ 0x3904, 0x00 },
{ 0x3905, 0x00 },
{ 0x3906, 0x00 },
{ 0x3907, 0x00 },
{ 0x3908, 0x00 },
{ 0x3909, 0x00 },
{ 0x3912, 0x00 },
{ 0x3930, 0x00 },
{ 0x3931, 0x00 },
{ 0x3933, 0x00 },
{ 0x3934, 0x00 },
{ 0x3935, 0x00 },
{ 0x3936, 0x00 },
{ 0x3937, 0x00 },
{ 0x30ac, 0x00 },
};
static const struct imx319_reg mode_1296x736_regs[] = {
{ 0x0112, 0x0a },
{ 0x0113, 0x0a },
{ 0x0114, 0x03 },
{ 0x0342, 0x08 },
{ 0x0343, 0x20 },
{ 0x0340, 0x18 },
{ 0x0341, 0x2a },
{ 0x0344, 0x00 },
{ 0x0345, 0x00 },
{ 0x0346, 0x01 },
{ 0x0347, 0xf0 },
{ 0x0348, 0x0c },
{ 0x0349, 0xcf },
{ 0x034a, 0x07 },
{ 0x034b, 0xaf },
{ 0x0220, 0x00 },
{ 0x0221, 0x11 },
{ 0x0381, 0x01 },
{ 0x0383, 0x01 },
{ 0x0385, 0x01 },
{ 0x0387, 0x01 },
{ 0x0900, 0x01 },
{ 0x0901, 0x22 },
{ 0x0902, 0x0a },
{ 0x3140, 0x02 },
{ 0x3141, 0x00 },
{ 0x3f0d, 0x0a },
{ 0x3f14, 0x01 },
{ 0x3f3c, 0x02 },
{ 0x3f4d, 0x01 },
{ 0x3f4c, 0x01 },
{ 0x4254, 0x7f },
{ 0x0401, 0x00 },
{ 0x0404, 0x00 },
{ 0x0405, 0x10 },
{ 0x0408, 0x00 },
{ 0x0409, 0xac },
{ 0x040a, 0x00 },
{ 0x040b, 0x00 },
{ 0x040c, 0x05 },
{ 0x040d, 0x10 },
{ 0x040e, 0x02 },
{ 0x040f, 0xe0 },
{ 0x034c, 0x05 },
{ 0x034d, 0x10 },
{ 0x034e, 0x02 },
{ 0x034f, 0xe0 },
{ 0x3261, 0x00 },
{ 0x3264, 0x00 },
{ 0x3265, 0x10 },
{ 0x0301, 0x05 },
{ 0x0303, 0x04 },
{ 0x0305, 0x04 },
{ 0x0306, 0x01 },
{ 0x0307, 0x92 },
{ 0x0309, 0x0a },
{ 0x030b, 0x02 },
{ 0x030d, 0x02 },
{ 0x030e, 0x00 },
{ 0x030f, 0xfa },
{ 0x0310, 0x00 },
{ 0x0820, 0x0f },
{ 0x0821, 0x13 },
{ 0x0822, 0x33 },
{ 0x0823, 0x33 },
{ 0x3e20, 0x01 },
{ 0x3e37, 0x00 },
{ 0x3e3b, 0x01 },
{ 0x38a3, 0x01 },
{ 0x38a8, 0x00 },
{ 0x38a9, 0x00 },
{ 0x38aa, 0x00 },
{ 0x38ab, 0x00 },
{ 0x3234, 0x00 },
{ 0x3fc1, 0x00 },
{ 0x3235, 0x00 },
{ 0x3802, 0x00 },
{ 0x3143, 0x04 },
{ 0x360a, 0x00 },
{ 0x0b00, 0x00 },
{ 0x0106, 0x00 },
{ 0x0b05, 0x01 },
{ 0x0b06, 0x01 },
{ 0x3230, 0x00 },
{ 0x3602, 0x01 },
{ 0x3607, 0x01 },
{ 0x3c00, 0x00 },
{ 0x3c01, 0xba },
{ 0x3c02, 0xc8 },
{ 0x3c03, 0xaa },
{ 0x3c04, 0x91 },
{ 0x3c05, 0x54 },
{ 0x3c06, 0x26 },
{ 0x3c07, 0x20 },
{ 0x3c08, 0x51 },
{ 0x3d80, 0x00 },
{ 0x3f50, 0x00 },
{ 0x3f56, 0x00 },
{ 0x3f57, 0x30 },
{ 0x3f78, 0x00 },
{ 0x3f79, 0x34 },
{ 0x3f7c, 0x00 },
{ 0x3f7d, 0x00 },
{ 0x3fba, 0x00 },
{ 0x3fbb, 0x00 },
{ 0xa081, 0x04 },
{ 0xe014, 0x00 },
{ 0x0202, 0x04 },
{ 0x0203, 0xf6 },
{ 0x0224, 0x01 },
{ 0x0225, 0xf4 },
{ 0x0204, 0x00 },
{ 0x0205, 0x00 },
{ 0x0216, 0x00 },
{ 0x0217, 0x00 },
{ 0x020e, 0x01 },
{ 0x020f, 0x00 },
{ 0x0210, 0x01 },
{ 0x0211, 0x00 },
{ 0x0212, 0x01 },
{ 0x0213, 0x00 },
{ 0x0214, 0x01 },
{ 0x0215, 0x00 },
{ 0x0218, 0x01 },
{ 0x0219, 0x00 },
{ 0x3614, 0x00 },
{ 0x3616, 0x0d },
{ 0x3617, 0x56 },
{ 0xb612, 0x20 },
{ 0xb613, 0x20 },
{ 0xb614, 0x20 },
{ 0xb615, 0x20 },
{ 0xb616, 0x0a },
{ 0xb617, 0x0a },
{ 0xb618, 0x20 },
{ 0xb619, 0x20 },
{ 0xb61a, 0x20 },
{ 0xb61b, 0x20 },
{ 0xb61c, 0x0a },
{ 0xb61d, 0x0a },
{ 0xb666, 0x30 },
{ 0xb667, 0x30 },
{ 0xb668, 0x30 },
{ 0xb669, 0x30 },
{ 0xb66a, 0x14 },
{ 0xb66b, 0x14 },
{ 0xb66c, 0x20 },
{ 0xb66d, 0x20 },
{ 0xb66e, 0x20 },
{ 0xb66f, 0x20 },
{ 0xb670, 0x10 },
{ 0xb671, 0x10 },
{ 0x3237, 0x00 },
{ 0x3900, 0x00 },
{ 0x3901, 0x00 },
{ 0x3902, 0x00 },
{ 0x3904, 0x00 },
{ 0x3905, 0x00 },
{ 0x3906, 0x00 },
{ 0x3907, 0x00 },
{ 0x3908, 0x00 },
{ 0x3909, 0x00 },
{ 0x3912, 0x00 },
{ 0x3930, 0x00 },
{ 0x3931, 0x00 },
{ 0x3933, 0x00 },
{ 0x3934, 0x00 },
{ 0x3935, 0x00 },
{ 0x3936, 0x00 },
{ 0x3937, 0x00 },
{ 0x30ac, 0x00 },
};
static const struct imx319_reg mode_1280x720_regs[] = {
{ 0x0112, 0x0a },
{ 0x0113, 0x0a },
{ 0x0114, 0x03 },
{ 0x0342, 0x08 },
{ 0x0343, 0x20 },
{ 0x0340, 0x18 },
{ 0x0341, 0x2a },
{ 0x0344, 0x00 },
{ 0x0345, 0x00 },
{ 0x0346, 0x02 },
{ 0x0347, 0x00 },
{ 0x0348, 0x0c },
{ 0x0349, 0xcf },
{ 0x034a, 0x07 },
{ 0x034b, 0x9f },
{ 0x0220, 0x00 },
{ 0x0221, 0x11 },
{ 0x0381, 0x01 },
{ 0x0383, 0x01 },
{ 0x0385, 0x01 },
{ 0x0387, 0x01 },
{ 0x0900, 0x01 },
{ 0x0901, 0x22 },
{ 0x0902, 0x0a },
{ 0x3140, 0x02 },
{ 0x3141, 0x00 },
{ 0x3f0d, 0x0a },
{ 0x3f14, 0x01 },
{ 0x3f3c, 0x02 },
{ 0x3f4d, 0x01 },
{ 0x3f4c, 0x01 },
{ 0x4254, 0x7f },
{ 0x0401, 0x00 },
{ 0x0404, 0x00 },
{ 0x0405, 0x10 },
{ 0x0408, 0x00 },
{ 0x0409, 0xb4 },
{ 0x040a, 0x00 },
{ 0x040b, 0x00 },
{ 0x040c, 0x05 },
{ 0x040d, 0x00 },
{ 0x040e, 0x02 },
{ 0x040f, 0xd0 },
{ 0x034c, 0x05 },
{ 0x034d, 0x00 },
{ 0x034e, 0x02 },
{ 0x034f, 0xd0 },
{ 0x3261, 0x00 },
{ 0x3264, 0x00 },
{ 0x3265, 0x10 },
{ 0x0301, 0x05 },
{ 0x0303, 0x04 },
{ 0x0305, 0x04 },
{ 0x0306, 0x01 },
{ 0x0307, 0x92 },
{ 0x0309, 0x0a },
{ 0x030b, 0x02 },
{ 0x030d, 0x02 },
{ 0x030e, 0x00 },
{ 0x030f, 0xfa },
{ 0x0310, 0x00 },
{ 0x0820, 0x0f },
{ 0x0821, 0x13 },
{ 0x0822, 0x33 },
{ 0x0823, 0x33 },
{ 0x3e20, 0x01 },
{ 0x3e37, 0x00 },
{ 0x3e3b, 0x01 },
{ 0x38a3, 0x01 },
{ 0x38a8, 0x00 },
{ 0x38a9, 0x00 },
{ 0x38aa, 0x00 },
{ 0x38ab, 0x00 },
{ 0x3234, 0x00 },
{ 0x3fc1, 0x00 },
{ 0x3235, 0x00 },
{ 0x3802, 0x00 },
{ 0x3143, 0x04 },
{ 0x360a, 0x00 },
{ 0x0b00, 0x00 },
{ 0x0106, 0x00 },
{ 0x0b05, 0x01 },
{ 0x0b06, 0x01 },
{ 0x3230, 0x00 },
{ 0x3602, 0x01 },
{ 0x3607, 0x01 },
{ 0x3c00, 0x00 },
{ 0x3c01, 0xba },
{ 0x3c02, 0xc8 },
{ 0x3c03, 0xaa },
{ 0x3c04, 0x91 },
{ 0x3c05, 0x54 },
{ 0x3c06, 0x26 },
{ 0x3c07, 0x20 },
{ 0x3c08, 0x51 },
{ 0x3d80, 0x00 },
{ 0x3f50, 0x00 },
{ 0x3f56, 0x00 },
{ 0x3f57, 0x30 },
{ 0x3f78, 0x00 },
{ 0x3f79, 0x34 },
{ 0x3f7c, 0x00 },
{ 0x3f7d, 0x00 },
{ 0x3fba, 0x00 },
{ 0x3fbb, 0x00 },
{ 0xa081, 0x04 },
{ 0xe014, 0x00 },
{ 0x0202, 0x04 },
{ 0x0203, 0xf6 },
{ 0x0224, 0x01 },
{ 0x0225, 0xf4 },
{ 0x0204, 0x00 },
{ 0x0205, 0x00 },
{ 0x0216, 0x00 },
{ 0x0217, 0x00 },
{ 0x020e, 0x01 },
{ 0x020f, 0x00 },
{ 0x0210, 0x01 },
{ 0x0211, 0x00 },
{ 0x0212, 0x01 },
{ 0x0213, 0x00 },
{ 0x0214, 0x01 },
{ 0x0215, 0x00 },
{ 0x0218, 0x01 },
{ 0x0219, 0x00 },
{ 0x3614, 0x00 },
{ 0x3616, 0x0d },
{ 0x3617, 0x56 },
{ 0xb612, 0x20 },
{ 0xb613, 0x20 },
{ 0xb614, 0x20 },
{ 0xb615, 0x20 },
{ 0xb616, 0x0a },
{ 0xb617, 0x0a },
{ 0xb618, 0x20 },
{ 0xb619, 0x20 },
{ 0xb61a, 0x20 },
{ 0xb61b, 0x20 },
{ 0xb61c, 0x0a },
{ 0xb61d, 0x0a },
{ 0xb666, 0x30 },
{ 0xb667, 0x30 },
{ 0xb668, 0x30 },
{ 0xb669, 0x30 },
{ 0xb66a, 0x14 },
{ 0xb66b, 0x14 },
{ 0xb66c, 0x20 },
{ 0xb66d, 0x20 },
{ 0xb66e, 0x20 },
{ 0xb66f, 0x20 },
{ 0xb670, 0x10 },
{ 0xb671, 0x10 },
{ 0x3237, 0x00 },
{ 0x3900, 0x00 },
{ 0x3901, 0x00 },
{ 0x3902, 0x00 },
{ 0x3904, 0x00 },
{ 0x3905, 0x00 },
{ 0x3906, 0x00 },
{ 0x3907, 0x00 },
{ 0x3908, 0x00 },
{ 0x3909, 0x00 },
{ 0x3912, 0x00 },
{ 0x3930, 0x00 },
{ 0x3931, 0x00 },
{ 0x3933, 0x00 },
{ 0x3934, 0x00 },
{ 0x3935, 0x00 },
{ 0x3936, 0x00 },
{ 0x3937, 0x00 },
{ 0x30ac, 0x00 },
};
static const char * const imx319_test_pattern_menu[] = {
"Disabled",
"Solid Colour",
"Eight Vertical Colour Bars",
"Colour Bars With Fade to Grey",
"Pseudorandom Sequence (PN9)",
};
/* supported link frequencies */
static const s64 link_freq_menu_items[] = {
IMX319_LINK_FREQ_DEFAULT,
};
/* Mode configs */
static const struct imx319_mode supported_modes[] = {
{
.width = 3280,
.height = 2464,
.fll_def = 3242,
.fll_min = 3242,
.llp = 3968,
.link_freq_index = IMX319_LINK_FREQ_INDEX,
.reg_list = {
.num_of_regs = ARRAY_SIZE(mode_3280x2464_regs),
.regs = mode_3280x2464_regs,
},
},
{
.width = 3264,
.height = 2448,
.fll_def = 3242,
.fll_min = 3242,
.llp = 3968,
.link_freq_index = IMX319_LINK_FREQ_INDEX,
.reg_list = {
.num_of_regs = ARRAY_SIZE(mode_3264x2448_regs),
.regs = mode_3264x2448_regs,
},
},
{
.width = 1936,
.height = 1096,
.fll_def = 3242,
.fll_min = 3242,
.llp = 3968,
.link_freq_index = IMX319_LINK_FREQ_INDEX,
.reg_list = {
.num_of_regs = ARRAY_SIZE(mode_1936x1096_regs),
.regs = mode_1936x1096_regs,
},
},
{
.width = 1920,
.height = 1080,
.fll_def = 3242,
.fll_min = 3242,
.llp = 3968,
.link_freq_index = IMX319_LINK_FREQ_INDEX,
.reg_list = {
.num_of_regs = ARRAY_SIZE(mode_1920x1080_regs),
.regs = mode_1920x1080_regs,
},
},
{
.width = 1640,
.height = 1232,
.fll_def = 5146,
.fll_min = 5146,
.llp = 2500,
.link_freq_index = IMX319_LINK_FREQ_INDEX,
.reg_list = {
.num_of_regs = ARRAY_SIZE(mode_1640x1232_regs),
.regs = mode_1640x1232_regs,
},
},
{
.width = 1640,
.height = 922,
.fll_def = 5146,
.fll_min = 5146,
.llp = 2500,
.link_freq_index = IMX319_LINK_FREQ_INDEX,
.reg_list = {
.num_of_regs = ARRAY_SIZE(mode_1640x922_regs),
.regs = mode_1640x922_regs,
},
},
{
.width = 1296,
.height = 736,
.fll_def = 5146,
.fll_min = 5146,
.llp = 2500,
.link_freq_index = IMX319_LINK_FREQ_INDEX,
.reg_list = {
.num_of_regs = ARRAY_SIZE(mode_1296x736_regs),
.regs = mode_1296x736_regs,
},
},
{
.width = 1280,
.height = 720,
.fll_def = 5146,
.fll_min = 5146,
.llp = 2500,
.link_freq_index = IMX319_LINK_FREQ_INDEX,
.reg_list = {
.num_of_regs = ARRAY_SIZE(mode_1280x720_regs),
.regs = mode_1280x720_regs,
},
},
};
static inline struct imx319 *to_imx319(struct v4l2_subdev *_sd)
{
return container_of(_sd, struct imx319, sd);
}
/* Get bayer order based on flip setting. */
static u32 imx319_get_format_code(struct imx319 *imx319)
{
/*
* Only one bayer order is supported.
* It depends on the flip settings.
*/
u32 code;
static const u32 codes[2][2] = {
{ MEDIA_BUS_FMT_SRGGB10_1X10, MEDIA_BUS_FMT_SGRBG10_1X10, },
{ MEDIA_BUS_FMT_SGBRG10_1X10, MEDIA_BUS_FMT_SBGGR10_1X10, },
};
lockdep_assert_held(&imx319->mutex);
code = codes[imx319->vflip->val][imx319->hflip->val];
return code;
}
/* Read registers up to 4 at a time */
static int imx319_read_reg(struct imx319 *imx319, u16 reg, u32 len, u32 *val)
{
struct i2c_client *client = v4l2_get_subdevdata(&imx319->sd);
struct i2c_msg msgs[2];
u8 addr_buf[2];
u8 data_buf[4] = { 0 };
int ret;
if (len > 4)
return -EINVAL;
put_unaligned_be16(reg, addr_buf);
/* Write register address */
msgs[0].addr = client->addr;
msgs[0].flags = 0;
msgs[0].len = ARRAY_SIZE(addr_buf);
msgs[0].buf = addr_buf;
/* Read data from register */
msgs[1].addr = client->addr;
msgs[1].flags = I2C_M_RD;
msgs[1].len = len;
msgs[1].buf = &data_buf[4 - len];
ret = i2c_transfer(client->adapter, msgs, ARRAY_SIZE(msgs));
if (ret != ARRAY_SIZE(msgs))
return -EIO;
*val = get_unaligned_be32(data_buf);
return 0;
}
/* Write registers up to 4 at a time */
static int imx319_write_reg(struct imx319 *imx319, u16 reg, u32 len, u32 val)
{
struct i2c_client *client = v4l2_get_subdevdata(&imx319->sd);
u8 buf[6];
if (len > 4)
return -EINVAL;
put_unaligned_be16(reg, buf);
put_unaligned_be32(val << (8 * (4 - len)), buf + 2);
if (i2c_master_send(client, buf, len + 2) != len + 2)
return -EIO;
return 0;
}
/* Write a list of registers */
static int imx319_write_regs(struct imx319 *imx319,
const struct imx319_reg *regs, u32 len)
{
struct i2c_client *client = v4l2_get_subdevdata(&imx319->sd);
int ret;
u32 i;
for (i = 0; i < len; i++) {
ret = imx319_write_reg(imx319, regs[i].address, 1, regs[i].val);
if (ret) {
dev_err_ratelimited(&client->dev,
"write reg 0x%4.4x return err %d",
regs[i].address, ret);
return ret;
}
}
return 0;
}
/* Open sub-device */
static int imx319_open(struct v4l2_subdev *sd, struct v4l2_subdev_fh *fh)
{
struct imx319 *imx319 = to_imx319(sd);
struct v4l2_mbus_framefmt *try_fmt =
media: v4l2-subdev: add subdev-wide state struct We have 'struct v4l2_subdev_pad_config' which contains configuration for a single pad used for the TRY functionality, and an array of those structs is passed to various v4l2_subdev_pad_ops. I was working on subdev internal routing between pads, and realized that there's no way to add TRY functionality for routes, which is not pad specific configuration. Adding a separate struct for try-route config wouldn't work either, as e.g. set-fmt needs to know the try-route configuration to propagate the settings. This patch adds a new struct, 'struct v4l2_subdev_state' (which at the moment only contains the v4l2_subdev_pad_config array) and the new struct is used in most of the places where v4l2_subdev_pad_config was used. All v4l2_subdev_pad_ops functions taking v4l2_subdev_pad_config are changed to instead take v4l2_subdev_state. The changes to drivers/media/v4l2-core/v4l2-subdev.c and include/media/v4l2-subdev.h were written by hand, and all the driver changes were done with the semantic patch below. The spatch needs to be applied to a select list of directories. I used the following shell commands to apply the spatch: dirs="drivers/media/i2c drivers/media/platform drivers/media/usb drivers/media/test-drivers/vimc drivers/media/pci drivers/staging/media" for dir in $dirs; do spatch -j8 --dir --include-headers --no-show-diff --in-place --sp-file v4l2-subdev-state.cocci $dir; done Note that Coccinelle chokes on a few drivers (gcc extensions?). With minor changes we can make Coccinelle run fine, and these changes can be reverted after spatch. The diff for these changes is: For drivers/media/i2c/s5k5baf.c: @@ -1481,7 +1481,7 @@ static int s5k5baf_set_selection(struct v4l2_subdev *sd, &s5k5baf_cis_rect, v4l2_subdev_get_try_crop(sd, cfg, PAD_CIS), v4l2_subdev_get_try_compose(sd, cfg, PAD_CIS), - v4l2_subdev_get_try_crop(sd, cfg, PAD_OUT) + v4l2_subdev_get_try_crop(sd, cfg, PAD_OUT), }; s5k5baf_set_rect_and_adjust(rects, rtype, &sel->r); return 0; For drivers/media/platform/s3c-camif/camif-capture.c: @@ -1230,7 +1230,7 @@ static int s3c_camif_subdev_get_fmt(struct v4l2_subdev *sd, *mf = camif->mbus_fmt; break; - case CAMIF_SD_PAD_SOURCE_C...CAMIF_SD_PAD_SOURCE_P: + case CAMIF_SD_PAD_SOURCE_C: /* crop rectangle at camera interface input */ mf->width = camif->camif_crop.width; mf->height = camif->camif_crop.height; @@ -1332,7 +1332,7 @@ static int s3c_camif_subdev_set_fmt(struct v4l2_subdev *sd, } break; - case CAMIF_SD_PAD_SOURCE_C...CAMIF_SD_PAD_SOURCE_P: + case CAMIF_SD_PAD_SOURCE_C: /* Pixel format can be only changed on the sink pad. */ mf->code = camif->mbus_fmt.code; mf->width = crop->width; The semantic patch is: // <smpl> // Change function parameter @@ identifier func; identifier cfg; @@ func(..., - struct v4l2_subdev_pad_config *cfg + struct v4l2_subdev_state *sd_state , ...) { <... - cfg + sd_state ...> } // Change function declaration parameter @@ identifier func; identifier cfg; type T; @@ T func(..., - struct v4l2_subdev_pad_config *cfg + struct v4l2_subdev_state *sd_state , ...); // Change function return value @@ identifier func; @@ - struct v4l2_subdev_pad_config + struct v4l2_subdev_state *func(...) { ... } // Change function declaration return value @@ identifier func; @@ - struct v4l2_subdev_pad_config + struct v4l2_subdev_state *func(...); // Some drivers pass a local pad_cfg for a single pad to a called function. Wrap it // inside a pad_state. @@ identifier func; identifier pad_cfg; @@ func(...) { ... struct v4l2_subdev_pad_config pad_cfg; + struct v4l2_subdev_state pad_state = { .pads = &pad_cfg }; <+... ( v4l2_subdev_call | sensor_call | isi_try_fse | isc_try_fse | saa_call_all ) (..., - &pad_cfg + &pad_state ,...) ...+> } // If the function uses fields from pad_config, access via state->pads @@ identifier func; identifier state; @@ func(..., struct v4l2_subdev_state *state , ...) { <... ( - state->try_fmt + state->pads->try_fmt | - state->try_crop + state->pads->try_crop | - state->try_compose + state->pads->try_compose ) ...> } // If the function accesses the filehandle, use fh->state instead @@ struct v4l2_subdev_fh *fh; @@ - fh->pad + fh->state @@ struct v4l2_subdev_fh fh; @@ - fh.pad + fh.state // Start of vsp1 specific @@ @@ struct vsp1_entity { ... - struct v4l2_subdev_pad_config *config; + struct v4l2_subdev_state *config; ... }; @@ symbol entity; @@ vsp1_entity_init(...) { ... entity->config = - v4l2_subdev_alloc_pad_config + v4l2_subdev_alloc_state (&entity->subdev); ... } @@ symbol entity; @@ vsp1_entity_destroy(...) { ... - v4l2_subdev_free_pad_config + v4l2_subdev_free_state (entity->config); ... } @exists@ identifier func =~ "(^vsp1.*)|(hsit_set_format)|(sru_enum_frame_size)|(sru_set_format)|(uif_get_selection)|(uif_set_selection)|(uds_enum_frame_size)|(uds_set_format)|(brx_set_format)|(brx_get_selection)|(histo_get_selection)|(histo_set_selection)|(brx_set_selection)"; symbol config; @@ func(...) { ... - struct v4l2_subdev_pad_config *config; + struct v4l2_subdev_state *config; ... } // End of vsp1 specific // Start of rcar specific @@ identifier sd; identifier pad_cfg; @@ rvin_try_format(...) { ... - struct v4l2_subdev_pad_config *pad_cfg; + struct v4l2_subdev_state *sd_state; ... - pad_cfg = v4l2_subdev_alloc_pad_config(sd); + sd_state = v4l2_subdev_alloc_state(sd); <... - pad_cfg + sd_state ...> - v4l2_subdev_free_pad_config(pad_cfg); + v4l2_subdev_free_state(sd_state); ... } // End of rcar specific // Start of rockchip specific @@ identifier func =~ "(rkisp1_rsz_get_pad_fmt)|(rkisp1_rsz_get_pad_crop)|(rkisp1_rsz_register)"; symbol rsz; symbol pad_cfg; @@ func(...) { + struct v4l2_subdev_state state = { .pads = rsz->pad_cfg }; ... - rsz->pad_cfg + &state ... } @@ identifier func =~ "(rkisp1_isp_get_pad_fmt)|(rkisp1_isp_get_pad_crop)"; symbol isp; symbol pad_cfg; @@ func(...) { + struct v4l2_subdev_state state = { .pads = isp->pad_cfg }; ... - isp->pad_cfg + &state ... } @@ symbol rkisp1; symbol isp; symbol pad_cfg; @@ rkisp1_isp_register(...) { + struct v4l2_subdev_state state = { .pads = rkisp1->isp.pad_cfg }; ... - rkisp1->isp.pad_cfg + &state ... } // End of rockchip specific // Start of tegra-video specific @@ identifier sd; identifier pad_cfg; @@ __tegra_channel_try_format(...) { ... - struct v4l2_subdev_pad_config *pad_cfg; + struct v4l2_subdev_state *sd_state; ... - pad_cfg = v4l2_subdev_alloc_pad_config(sd); + sd_state = v4l2_subdev_alloc_state(sd); <... - pad_cfg + sd_state ...> - v4l2_subdev_free_pad_config(pad_cfg); + v4l2_subdev_free_state(sd_state); ... } @@ identifier sd_state; @@ __tegra_channel_try_format(...) { ... struct v4l2_subdev_state *sd_state; <... - sd_state->try_crop + sd_state->pads->try_crop ...> } // End of tegra-video specific // </smpl> Signed-off-by: Tomi Valkeinen <tomi.valkeinen@ideasonboard.com> Acked-by: Laurent Pinchart <laurent.pinchart@ideasonboard.com> Acked-by: Sakari Ailus <sakari.ailus@linux.intel.com> Signed-off-by: Hans Verkuil <hverkuil-cisco@xs4all.nl> Signed-off-by: Mauro Carvalho Chehab <mchehab+huawei@kernel.org>
2021-06-10 22:55:58 +08:00
v4l2_subdev_get_try_format(sd, fh->state, 0);
mutex_lock(&imx319->mutex);
/* Initialize try_fmt */
try_fmt->width = imx319->cur_mode->width;
try_fmt->height = imx319->cur_mode->height;
try_fmt->code = imx319_get_format_code(imx319);
try_fmt->field = V4L2_FIELD_NONE;
mutex_unlock(&imx319->mutex);
return 0;
}
static int imx319_set_ctrl(struct v4l2_ctrl *ctrl)
{
struct imx319 *imx319 = container_of(ctrl->handler,
struct imx319, ctrl_handler);
struct i2c_client *client = v4l2_get_subdevdata(&imx319->sd);
s64 max;
int ret;
/* Propagate change of current control to all related controls */
switch (ctrl->id) {
case V4L2_CID_VBLANK:
/* Update max exposure while meeting expected vblanking */
max = imx319->cur_mode->height + ctrl->val - 18;
__v4l2_ctrl_modify_range(imx319->exposure,
imx319->exposure->minimum,
max, imx319->exposure->step, max);
break;
}
/*
* Applying V4L2 control value only happens
* when power is up for streaming
*/
if (!pm_runtime_get_if_in_use(&client->dev))
return 0;
switch (ctrl->id) {
case V4L2_CID_ANALOGUE_GAIN:
/* Analog gain = 1024/(1024 - ctrl->val) times */
ret = imx319_write_reg(imx319, IMX319_REG_ANALOG_GAIN, 2,
ctrl->val);
break;
case V4L2_CID_DIGITAL_GAIN:
ret = imx319_write_reg(imx319, IMX319_REG_DIG_GAIN_GLOBAL, 2,
ctrl->val);
break;
case V4L2_CID_EXPOSURE:
ret = imx319_write_reg(imx319, IMX319_REG_EXPOSURE, 2,
ctrl->val);
break;
case V4L2_CID_VBLANK:
/* Update FLL that meets expected vertical blanking */
ret = imx319_write_reg(imx319, IMX319_REG_FLL, 2,
imx319->cur_mode->height + ctrl->val);
break;
case V4L2_CID_TEST_PATTERN:
ret = imx319_write_reg(imx319, IMX319_REG_TEST_PATTERN,
2, ctrl->val);
break;
case V4L2_CID_HFLIP:
case V4L2_CID_VFLIP:
ret = imx319_write_reg(imx319, IMX319_REG_ORIENTATION, 1,
imx319->hflip->val |
imx319->vflip->val << 1);
break;
default:
ret = -EINVAL;
dev_info(&client->dev, "ctrl(id:0x%x,val:0x%x) is not handled",
ctrl->id, ctrl->val);
break;
}
pm_runtime_put(&client->dev);
return ret;
}
static const struct v4l2_ctrl_ops imx319_ctrl_ops = {
.s_ctrl = imx319_set_ctrl,
};
static int imx319_enum_mbus_code(struct v4l2_subdev *sd,
media: v4l2-subdev: add subdev-wide state struct We have 'struct v4l2_subdev_pad_config' which contains configuration for a single pad used for the TRY functionality, and an array of those structs is passed to various v4l2_subdev_pad_ops. I was working on subdev internal routing between pads, and realized that there's no way to add TRY functionality for routes, which is not pad specific configuration. Adding a separate struct for try-route config wouldn't work either, as e.g. set-fmt needs to know the try-route configuration to propagate the settings. This patch adds a new struct, 'struct v4l2_subdev_state' (which at the moment only contains the v4l2_subdev_pad_config array) and the new struct is used in most of the places where v4l2_subdev_pad_config was used. All v4l2_subdev_pad_ops functions taking v4l2_subdev_pad_config are changed to instead take v4l2_subdev_state. The changes to drivers/media/v4l2-core/v4l2-subdev.c and include/media/v4l2-subdev.h were written by hand, and all the driver changes were done with the semantic patch below. The spatch needs to be applied to a select list of directories. I used the following shell commands to apply the spatch: dirs="drivers/media/i2c drivers/media/platform drivers/media/usb drivers/media/test-drivers/vimc drivers/media/pci drivers/staging/media" for dir in $dirs; do spatch -j8 --dir --include-headers --no-show-diff --in-place --sp-file v4l2-subdev-state.cocci $dir; done Note that Coccinelle chokes on a few drivers (gcc extensions?). With minor changes we can make Coccinelle run fine, and these changes can be reverted after spatch. The diff for these changes is: For drivers/media/i2c/s5k5baf.c: @@ -1481,7 +1481,7 @@ static int s5k5baf_set_selection(struct v4l2_subdev *sd, &s5k5baf_cis_rect, v4l2_subdev_get_try_crop(sd, cfg, PAD_CIS), v4l2_subdev_get_try_compose(sd, cfg, PAD_CIS), - v4l2_subdev_get_try_crop(sd, cfg, PAD_OUT) + v4l2_subdev_get_try_crop(sd, cfg, PAD_OUT), }; s5k5baf_set_rect_and_adjust(rects, rtype, &sel->r); return 0; For drivers/media/platform/s3c-camif/camif-capture.c: @@ -1230,7 +1230,7 @@ static int s3c_camif_subdev_get_fmt(struct v4l2_subdev *sd, *mf = camif->mbus_fmt; break; - case CAMIF_SD_PAD_SOURCE_C...CAMIF_SD_PAD_SOURCE_P: + case CAMIF_SD_PAD_SOURCE_C: /* crop rectangle at camera interface input */ mf->width = camif->camif_crop.width; mf->height = camif->camif_crop.height; @@ -1332,7 +1332,7 @@ static int s3c_camif_subdev_set_fmt(struct v4l2_subdev *sd, } break; - case CAMIF_SD_PAD_SOURCE_C...CAMIF_SD_PAD_SOURCE_P: + case CAMIF_SD_PAD_SOURCE_C: /* Pixel format can be only changed on the sink pad. */ mf->code = camif->mbus_fmt.code; mf->width = crop->width; The semantic patch is: // <smpl> // Change function parameter @@ identifier func; identifier cfg; @@ func(..., - struct v4l2_subdev_pad_config *cfg + struct v4l2_subdev_state *sd_state , ...) { <... - cfg + sd_state ...> } // Change function declaration parameter @@ identifier func; identifier cfg; type T; @@ T func(..., - struct v4l2_subdev_pad_config *cfg + struct v4l2_subdev_state *sd_state , ...); // Change function return value @@ identifier func; @@ - struct v4l2_subdev_pad_config + struct v4l2_subdev_state *func(...) { ... } // Change function declaration return value @@ identifier func; @@ - struct v4l2_subdev_pad_config + struct v4l2_subdev_state *func(...); // Some drivers pass a local pad_cfg for a single pad to a called function. Wrap it // inside a pad_state. @@ identifier func; identifier pad_cfg; @@ func(...) { ... struct v4l2_subdev_pad_config pad_cfg; + struct v4l2_subdev_state pad_state = { .pads = &pad_cfg }; <+... ( v4l2_subdev_call | sensor_call | isi_try_fse | isc_try_fse | saa_call_all ) (..., - &pad_cfg + &pad_state ,...) ...+> } // If the function uses fields from pad_config, access via state->pads @@ identifier func; identifier state; @@ func(..., struct v4l2_subdev_state *state , ...) { <... ( - state->try_fmt + state->pads->try_fmt | - state->try_crop + state->pads->try_crop | - state->try_compose + state->pads->try_compose ) ...> } // If the function accesses the filehandle, use fh->state instead @@ struct v4l2_subdev_fh *fh; @@ - fh->pad + fh->state @@ struct v4l2_subdev_fh fh; @@ - fh.pad + fh.state // Start of vsp1 specific @@ @@ struct vsp1_entity { ... - struct v4l2_subdev_pad_config *config; + struct v4l2_subdev_state *config; ... }; @@ symbol entity; @@ vsp1_entity_init(...) { ... entity->config = - v4l2_subdev_alloc_pad_config + v4l2_subdev_alloc_state (&entity->subdev); ... } @@ symbol entity; @@ vsp1_entity_destroy(...) { ... - v4l2_subdev_free_pad_config + v4l2_subdev_free_state (entity->config); ... } @exists@ identifier func =~ "(^vsp1.*)|(hsit_set_format)|(sru_enum_frame_size)|(sru_set_format)|(uif_get_selection)|(uif_set_selection)|(uds_enum_frame_size)|(uds_set_format)|(brx_set_format)|(brx_get_selection)|(histo_get_selection)|(histo_set_selection)|(brx_set_selection)"; symbol config; @@ func(...) { ... - struct v4l2_subdev_pad_config *config; + struct v4l2_subdev_state *config; ... } // End of vsp1 specific // Start of rcar specific @@ identifier sd; identifier pad_cfg; @@ rvin_try_format(...) { ... - struct v4l2_subdev_pad_config *pad_cfg; + struct v4l2_subdev_state *sd_state; ... - pad_cfg = v4l2_subdev_alloc_pad_config(sd); + sd_state = v4l2_subdev_alloc_state(sd); <... - pad_cfg + sd_state ...> - v4l2_subdev_free_pad_config(pad_cfg); + v4l2_subdev_free_state(sd_state); ... } // End of rcar specific // Start of rockchip specific @@ identifier func =~ "(rkisp1_rsz_get_pad_fmt)|(rkisp1_rsz_get_pad_crop)|(rkisp1_rsz_register)"; symbol rsz; symbol pad_cfg; @@ func(...) { + struct v4l2_subdev_state state = { .pads = rsz->pad_cfg }; ... - rsz->pad_cfg + &state ... } @@ identifier func =~ "(rkisp1_isp_get_pad_fmt)|(rkisp1_isp_get_pad_crop)"; symbol isp; symbol pad_cfg; @@ func(...) { + struct v4l2_subdev_state state = { .pads = isp->pad_cfg }; ... - isp->pad_cfg + &state ... } @@ symbol rkisp1; symbol isp; symbol pad_cfg; @@ rkisp1_isp_register(...) { + struct v4l2_subdev_state state = { .pads = rkisp1->isp.pad_cfg }; ... - rkisp1->isp.pad_cfg + &state ... } // End of rockchip specific // Start of tegra-video specific @@ identifier sd; identifier pad_cfg; @@ __tegra_channel_try_format(...) { ... - struct v4l2_subdev_pad_config *pad_cfg; + struct v4l2_subdev_state *sd_state; ... - pad_cfg = v4l2_subdev_alloc_pad_config(sd); + sd_state = v4l2_subdev_alloc_state(sd); <... - pad_cfg + sd_state ...> - v4l2_subdev_free_pad_config(pad_cfg); + v4l2_subdev_free_state(sd_state); ... } @@ identifier sd_state; @@ __tegra_channel_try_format(...) { ... struct v4l2_subdev_state *sd_state; <... - sd_state->try_crop + sd_state->pads->try_crop ...> } // End of tegra-video specific // </smpl> Signed-off-by: Tomi Valkeinen <tomi.valkeinen@ideasonboard.com> Acked-by: Laurent Pinchart <laurent.pinchart@ideasonboard.com> Acked-by: Sakari Ailus <sakari.ailus@linux.intel.com> Signed-off-by: Hans Verkuil <hverkuil-cisco@xs4all.nl> Signed-off-by: Mauro Carvalho Chehab <mchehab+huawei@kernel.org>
2021-06-10 22:55:58 +08:00
struct v4l2_subdev_state *sd_state,
struct v4l2_subdev_mbus_code_enum *code)
{
struct imx319 *imx319 = to_imx319(sd);
if (code->index > 0)
return -EINVAL;
mutex_lock(&imx319->mutex);
code->code = imx319_get_format_code(imx319);
mutex_unlock(&imx319->mutex);
return 0;
}
static int imx319_enum_frame_size(struct v4l2_subdev *sd,
media: v4l2-subdev: add subdev-wide state struct We have 'struct v4l2_subdev_pad_config' which contains configuration for a single pad used for the TRY functionality, and an array of those structs is passed to various v4l2_subdev_pad_ops. I was working on subdev internal routing between pads, and realized that there's no way to add TRY functionality for routes, which is not pad specific configuration. Adding a separate struct for try-route config wouldn't work either, as e.g. set-fmt needs to know the try-route configuration to propagate the settings. This patch adds a new struct, 'struct v4l2_subdev_state' (which at the moment only contains the v4l2_subdev_pad_config array) and the new struct is used in most of the places where v4l2_subdev_pad_config was used. All v4l2_subdev_pad_ops functions taking v4l2_subdev_pad_config are changed to instead take v4l2_subdev_state. The changes to drivers/media/v4l2-core/v4l2-subdev.c and include/media/v4l2-subdev.h were written by hand, and all the driver changes were done with the semantic patch below. The spatch needs to be applied to a select list of directories. I used the following shell commands to apply the spatch: dirs="drivers/media/i2c drivers/media/platform drivers/media/usb drivers/media/test-drivers/vimc drivers/media/pci drivers/staging/media" for dir in $dirs; do spatch -j8 --dir --include-headers --no-show-diff --in-place --sp-file v4l2-subdev-state.cocci $dir; done Note that Coccinelle chokes on a few drivers (gcc extensions?). With minor changes we can make Coccinelle run fine, and these changes can be reverted after spatch. The diff for these changes is: For drivers/media/i2c/s5k5baf.c: @@ -1481,7 +1481,7 @@ static int s5k5baf_set_selection(struct v4l2_subdev *sd, &s5k5baf_cis_rect, v4l2_subdev_get_try_crop(sd, cfg, PAD_CIS), v4l2_subdev_get_try_compose(sd, cfg, PAD_CIS), - v4l2_subdev_get_try_crop(sd, cfg, PAD_OUT) + v4l2_subdev_get_try_crop(sd, cfg, PAD_OUT), }; s5k5baf_set_rect_and_adjust(rects, rtype, &sel->r); return 0; For drivers/media/platform/s3c-camif/camif-capture.c: @@ -1230,7 +1230,7 @@ static int s3c_camif_subdev_get_fmt(struct v4l2_subdev *sd, *mf = camif->mbus_fmt; break; - case CAMIF_SD_PAD_SOURCE_C...CAMIF_SD_PAD_SOURCE_P: + case CAMIF_SD_PAD_SOURCE_C: /* crop rectangle at camera interface input */ mf->width = camif->camif_crop.width; mf->height = camif->camif_crop.height; @@ -1332,7 +1332,7 @@ static int s3c_camif_subdev_set_fmt(struct v4l2_subdev *sd, } break; - case CAMIF_SD_PAD_SOURCE_C...CAMIF_SD_PAD_SOURCE_P: + case CAMIF_SD_PAD_SOURCE_C: /* Pixel format can be only changed on the sink pad. */ mf->code = camif->mbus_fmt.code; mf->width = crop->width; The semantic patch is: // <smpl> // Change function parameter @@ identifier func; identifier cfg; @@ func(..., - struct v4l2_subdev_pad_config *cfg + struct v4l2_subdev_state *sd_state , ...) { <... - cfg + sd_state ...> } // Change function declaration parameter @@ identifier func; identifier cfg; type T; @@ T func(..., - struct v4l2_subdev_pad_config *cfg + struct v4l2_subdev_state *sd_state , ...); // Change function return value @@ identifier func; @@ - struct v4l2_subdev_pad_config + struct v4l2_subdev_state *func(...) { ... } // Change function declaration return value @@ identifier func; @@ - struct v4l2_subdev_pad_config + struct v4l2_subdev_state *func(...); // Some drivers pass a local pad_cfg for a single pad to a called function. Wrap it // inside a pad_state. @@ identifier func; identifier pad_cfg; @@ func(...) { ... struct v4l2_subdev_pad_config pad_cfg; + struct v4l2_subdev_state pad_state = { .pads = &pad_cfg }; <+... ( v4l2_subdev_call | sensor_call | isi_try_fse | isc_try_fse | saa_call_all ) (..., - &pad_cfg + &pad_state ,...) ...+> } // If the function uses fields from pad_config, access via state->pads @@ identifier func; identifier state; @@ func(..., struct v4l2_subdev_state *state , ...) { <... ( - state->try_fmt + state->pads->try_fmt | - state->try_crop + state->pads->try_crop | - state->try_compose + state->pads->try_compose ) ...> } // If the function accesses the filehandle, use fh->state instead @@ struct v4l2_subdev_fh *fh; @@ - fh->pad + fh->state @@ struct v4l2_subdev_fh fh; @@ - fh.pad + fh.state // Start of vsp1 specific @@ @@ struct vsp1_entity { ... - struct v4l2_subdev_pad_config *config; + struct v4l2_subdev_state *config; ... }; @@ symbol entity; @@ vsp1_entity_init(...) { ... entity->config = - v4l2_subdev_alloc_pad_config + v4l2_subdev_alloc_state (&entity->subdev); ... } @@ symbol entity; @@ vsp1_entity_destroy(...) { ... - v4l2_subdev_free_pad_config + v4l2_subdev_free_state (entity->config); ... } @exists@ identifier func =~ "(^vsp1.*)|(hsit_set_format)|(sru_enum_frame_size)|(sru_set_format)|(uif_get_selection)|(uif_set_selection)|(uds_enum_frame_size)|(uds_set_format)|(brx_set_format)|(brx_get_selection)|(histo_get_selection)|(histo_set_selection)|(brx_set_selection)"; symbol config; @@ func(...) { ... - struct v4l2_subdev_pad_config *config; + struct v4l2_subdev_state *config; ... } // End of vsp1 specific // Start of rcar specific @@ identifier sd; identifier pad_cfg; @@ rvin_try_format(...) { ... - struct v4l2_subdev_pad_config *pad_cfg; + struct v4l2_subdev_state *sd_state; ... - pad_cfg = v4l2_subdev_alloc_pad_config(sd); + sd_state = v4l2_subdev_alloc_state(sd); <... - pad_cfg + sd_state ...> - v4l2_subdev_free_pad_config(pad_cfg); + v4l2_subdev_free_state(sd_state); ... } // End of rcar specific // Start of rockchip specific @@ identifier func =~ "(rkisp1_rsz_get_pad_fmt)|(rkisp1_rsz_get_pad_crop)|(rkisp1_rsz_register)"; symbol rsz; symbol pad_cfg; @@ func(...) { + struct v4l2_subdev_state state = { .pads = rsz->pad_cfg }; ... - rsz->pad_cfg + &state ... } @@ identifier func =~ "(rkisp1_isp_get_pad_fmt)|(rkisp1_isp_get_pad_crop)"; symbol isp; symbol pad_cfg; @@ func(...) { + struct v4l2_subdev_state state = { .pads = isp->pad_cfg }; ... - isp->pad_cfg + &state ... } @@ symbol rkisp1; symbol isp; symbol pad_cfg; @@ rkisp1_isp_register(...) { + struct v4l2_subdev_state state = { .pads = rkisp1->isp.pad_cfg }; ... - rkisp1->isp.pad_cfg + &state ... } // End of rockchip specific // Start of tegra-video specific @@ identifier sd; identifier pad_cfg; @@ __tegra_channel_try_format(...) { ... - struct v4l2_subdev_pad_config *pad_cfg; + struct v4l2_subdev_state *sd_state; ... - pad_cfg = v4l2_subdev_alloc_pad_config(sd); + sd_state = v4l2_subdev_alloc_state(sd); <... - pad_cfg + sd_state ...> - v4l2_subdev_free_pad_config(pad_cfg); + v4l2_subdev_free_state(sd_state); ... } @@ identifier sd_state; @@ __tegra_channel_try_format(...) { ... struct v4l2_subdev_state *sd_state; <... - sd_state->try_crop + sd_state->pads->try_crop ...> } // End of tegra-video specific // </smpl> Signed-off-by: Tomi Valkeinen <tomi.valkeinen@ideasonboard.com> Acked-by: Laurent Pinchart <laurent.pinchart@ideasonboard.com> Acked-by: Sakari Ailus <sakari.ailus@linux.intel.com> Signed-off-by: Hans Verkuil <hverkuil-cisco@xs4all.nl> Signed-off-by: Mauro Carvalho Chehab <mchehab+huawei@kernel.org>
2021-06-10 22:55:58 +08:00
struct v4l2_subdev_state *sd_state,
struct v4l2_subdev_frame_size_enum *fse)
{
struct imx319 *imx319 = to_imx319(sd);
if (fse->index >= ARRAY_SIZE(supported_modes))
return -EINVAL;
mutex_lock(&imx319->mutex);
if (fse->code != imx319_get_format_code(imx319)) {
mutex_unlock(&imx319->mutex);
return -EINVAL;
}
mutex_unlock(&imx319->mutex);
fse->min_width = supported_modes[fse->index].width;
fse->max_width = fse->min_width;
fse->min_height = supported_modes[fse->index].height;
fse->max_height = fse->min_height;
return 0;
}
static void imx319_update_pad_format(struct imx319 *imx319,
const struct imx319_mode *mode,
struct v4l2_subdev_format *fmt)
{
fmt->format.width = mode->width;
fmt->format.height = mode->height;
fmt->format.code = imx319_get_format_code(imx319);
fmt->format.field = V4L2_FIELD_NONE;
}
static int imx319_do_get_pad_format(struct imx319 *imx319,
media: v4l2-subdev: add subdev-wide state struct We have 'struct v4l2_subdev_pad_config' which contains configuration for a single pad used for the TRY functionality, and an array of those structs is passed to various v4l2_subdev_pad_ops. I was working on subdev internal routing between pads, and realized that there's no way to add TRY functionality for routes, which is not pad specific configuration. Adding a separate struct for try-route config wouldn't work either, as e.g. set-fmt needs to know the try-route configuration to propagate the settings. This patch adds a new struct, 'struct v4l2_subdev_state' (which at the moment only contains the v4l2_subdev_pad_config array) and the new struct is used in most of the places where v4l2_subdev_pad_config was used. All v4l2_subdev_pad_ops functions taking v4l2_subdev_pad_config are changed to instead take v4l2_subdev_state. The changes to drivers/media/v4l2-core/v4l2-subdev.c and include/media/v4l2-subdev.h were written by hand, and all the driver changes were done with the semantic patch below. The spatch needs to be applied to a select list of directories. I used the following shell commands to apply the spatch: dirs="drivers/media/i2c drivers/media/platform drivers/media/usb drivers/media/test-drivers/vimc drivers/media/pci drivers/staging/media" for dir in $dirs; do spatch -j8 --dir --include-headers --no-show-diff --in-place --sp-file v4l2-subdev-state.cocci $dir; done Note that Coccinelle chokes on a few drivers (gcc extensions?). With minor changes we can make Coccinelle run fine, and these changes can be reverted after spatch. The diff for these changes is: For drivers/media/i2c/s5k5baf.c: @@ -1481,7 +1481,7 @@ static int s5k5baf_set_selection(struct v4l2_subdev *sd, &s5k5baf_cis_rect, v4l2_subdev_get_try_crop(sd, cfg, PAD_CIS), v4l2_subdev_get_try_compose(sd, cfg, PAD_CIS), - v4l2_subdev_get_try_crop(sd, cfg, PAD_OUT) + v4l2_subdev_get_try_crop(sd, cfg, PAD_OUT), }; s5k5baf_set_rect_and_adjust(rects, rtype, &sel->r); return 0; For drivers/media/platform/s3c-camif/camif-capture.c: @@ -1230,7 +1230,7 @@ static int s3c_camif_subdev_get_fmt(struct v4l2_subdev *sd, *mf = camif->mbus_fmt; break; - case CAMIF_SD_PAD_SOURCE_C...CAMIF_SD_PAD_SOURCE_P: + case CAMIF_SD_PAD_SOURCE_C: /* crop rectangle at camera interface input */ mf->width = camif->camif_crop.width; mf->height = camif->camif_crop.height; @@ -1332,7 +1332,7 @@ static int s3c_camif_subdev_set_fmt(struct v4l2_subdev *sd, } break; - case CAMIF_SD_PAD_SOURCE_C...CAMIF_SD_PAD_SOURCE_P: + case CAMIF_SD_PAD_SOURCE_C: /* Pixel format can be only changed on the sink pad. */ mf->code = camif->mbus_fmt.code; mf->width = crop->width; The semantic patch is: // <smpl> // Change function parameter @@ identifier func; identifier cfg; @@ func(..., - struct v4l2_subdev_pad_config *cfg + struct v4l2_subdev_state *sd_state , ...) { <... - cfg + sd_state ...> } // Change function declaration parameter @@ identifier func; identifier cfg; type T; @@ T func(..., - struct v4l2_subdev_pad_config *cfg + struct v4l2_subdev_state *sd_state , ...); // Change function return value @@ identifier func; @@ - struct v4l2_subdev_pad_config + struct v4l2_subdev_state *func(...) { ... } // Change function declaration return value @@ identifier func; @@ - struct v4l2_subdev_pad_config + struct v4l2_subdev_state *func(...); // Some drivers pass a local pad_cfg for a single pad to a called function. Wrap it // inside a pad_state. @@ identifier func; identifier pad_cfg; @@ func(...) { ... struct v4l2_subdev_pad_config pad_cfg; + struct v4l2_subdev_state pad_state = { .pads = &pad_cfg }; <+... ( v4l2_subdev_call | sensor_call | isi_try_fse | isc_try_fse | saa_call_all ) (..., - &pad_cfg + &pad_state ,...) ...+> } // If the function uses fields from pad_config, access via state->pads @@ identifier func; identifier state; @@ func(..., struct v4l2_subdev_state *state , ...) { <... ( - state->try_fmt + state->pads->try_fmt | - state->try_crop + state->pads->try_crop | - state->try_compose + state->pads->try_compose ) ...> } // If the function accesses the filehandle, use fh->state instead @@ struct v4l2_subdev_fh *fh; @@ - fh->pad + fh->state @@ struct v4l2_subdev_fh fh; @@ - fh.pad + fh.state // Start of vsp1 specific @@ @@ struct vsp1_entity { ... - struct v4l2_subdev_pad_config *config; + struct v4l2_subdev_state *config; ... }; @@ symbol entity; @@ vsp1_entity_init(...) { ... entity->config = - v4l2_subdev_alloc_pad_config + v4l2_subdev_alloc_state (&entity->subdev); ... } @@ symbol entity; @@ vsp1_entity_destroy(...) { ... - v4l2_subdev_free_pad_config + v4l2_subdev_free_state (entity->config); ... } @exists@ identifier func =~ "(^vsp1.*)|(hsit_set_format)|(sru_enum_frame_size)|(sru_set_format)|(uif_get_selection)|(uif_set_selection)|(uds_enum_frame_size)|(uds_set_format)|(brx_set_format)|(brx_get_selection)|(histo_get_selection)|(histo_set_selection)|(brx_set_selection)"; symbol config; @@ func(...) { ... - struct v4l2_subdev_pad_config *config; + struct v4l2_subdev_state *config; ... } // End of vsp1 specific // Start of rcar specific @@ identifier sd; identifier pad_cfg; @@ rvin_try_format(...) { ... - struct v4l2_subdev_pad_config *pad_cfg; + struct v4l2_subdev_state *sd_state; ... - pad_cfg = v4l2_subdev_alloc_pad_config(sd); + sd_state = v4l2_subdev_alloc_state(sd); <... - pad_cfg + sd_state ...> - v4l2_subdev_free_pad_config(pad_cfg); + v4l2_subdev_free_state(sd_state); ... } // End of rcar specific // Start of rockchip specific @@ identifier func =~ "(rkisp1_rsz_get_pad_fmt)|(rkisp1_rsz_get_pad_crop)|(rkisp1_rsz_register)"; symbol rsz; symbol pad_cfg; @@ func(...) { + struct v4l2_subdev_state state = { .pads = rsz->pad_cfg }; ... - rsz->pad_cfg + &state ... } @@ identifier func =~ "(rkisp1_isp_get_pad_fmt)|(rkisp1_isp_get_pad_crop)"; symbol isp; symbol pad_cfg; @@ func(...) { + struct v4l2_subdev_state state = { .pads = isp->pad_cfg }; ... - isp->pad_cfg + &state ... } @@ symbol rkisp1; symbol isp; symbol pad_cfg; @@ rkisp1_isp_register(...) { + struct v4l2_subdev_state state = { .pads = rkisp1->isp.pad_cfg }; ... - rkisp1->isp.pad_cfg + &state ... } // End of rockchip specific // Start of tegra-video specific @@ identifier sd; identifier pad_cfg; @@ __tegra_channel_try_format(...) { ... - struct v4l2_subdev_pad_config *pad_cfg; + struct v4l2_subdev_state *sd_state; ... - pad_cfg = v4l2_subdev_alloc_pad_config(sd); + sd_state = v4l2_subdev_alloc_state(sd); <... - pad_cfg + sd_state ...> - v4l2_subdev_free_pad_config(pad_cfg); + v4l2_subdev_free_state(sd_state); ... } @@ identifier sd_state; @@ __tegra_channel_try_format(...) { ... struct v4l2_subdev_state *sd_state; <... - sd_state->try_crop + sd_state->pads->try_crop ...> } // End of tegra-video specific // </smpl> Signed-off-by: Tomi Valkeinen <tomi.valkeinen@ideasonboard.com> Acked-by: Laurent Pinchart <laurent.pinchart@ideasonboard.com> Acked-by: Sakari Ailus <sakari.ailus@linux.intel.com> Signed-off-by: Hans Verkuil <hverkuil-cisco@xs4all.nl> Signed-off-by: Mauro Carvalho Chehab <mchehab+huawei@kernel.org>
2021-06-10 22:55:58 +08:00
struct v4l2_subdev_state *sd_state,
struct v4l2_subdev_format *fmt)
{
struct v4l2_mbus_framefmt *framefmt;
struct v4l2_subdev *sd = &imx319->sd;
if (fmt->which == V4L2_SUBDEV_FORMAT_TRY) {
media: v4l2-subdev: add subdev-wide state struct We have 'struct v4l2_subdev_pad_config' which contains configuration for a single pad used for the TRY functionality, and an array of those structs is passed to various v4l2_subdev_pad_ops. I was working on subdev internal routing between pads, and realized that there's no way to add TRY functionality for routes, which is not pad specific configuration. Adding a separate struct for try-route config wouldn't work either, as e.g. set-fmt needs to know the try-route configuration to propagate the settings. This patch adds a new struct, 'struct v4l2_subdev_state' (which at the moment only contains the v4l2_subdev_pad_config array) and the new struct is used in most of the places where v4l2_subdev_pad_config was used. All v4l2_subdev_pad_ops functions taking v4l2_subdev_pad_config are changed to instead take v4l2_subdev_state. The changes to drivers/media/v4l2-core/v4l2-subdev.c and include/media/v4l2-subdev.h were written by hand, and all the driver changes were done with the semantic patch below. The spatch needs to be applied to a select list of directories. I used the following shell commands to apply the spatch: dirs="drivers/media/i2c drivers/media/platform drivers/media/usb drivers/media/test-drivers/vimc drivers/media/pci drivers/staging/media" for dir in $dirs; do spatch -j8 --dir --include-headers --no-show-diff --in-place --sp-file v4l2-subdev-state.cocci $dir; done Note that Coccinelle chokes on a few drivers (gcc extensions?). With minor changes we can make Coccinelle run fine, and these changes can be reverted after spatch. The diff for these changes is: For drivers/media/i2c/s5k5baf.c: @@ -1481,7 +1481,7 @@ static int s5k5baf_set_selection(struct v4l2_subdev *sd, &s5k5baf_cis_rect, v4l2_subdev_get_try_crop(sd, cfg, PAD_CIS), v4l2_subdev_get_try_compose(sd, cfg, PAD_CIS), - v4l2_subdev_get_try_crop(sd, cfg, PAD_OUT) + v4l2_subdev_get_try_crop(sd, cfg, PAD_OUT), }; s5k5baf_set_rect_and_adjust(rects, rtype, &sel->r); return 0; For drivers/media/platform/s3c-camif/camif-capture.c: @@ -1230,7 +1230,7 @@ static int s3c_camif_subdev_get_fmt(struct v4l2_subdev *sd, *mf = camif->mbus_fmt; break; - case CAMIF_SD_PAD_SOURCE_C...CAMIF_SD_PAD_SOURCE_P: + case CAMIF_SD_PAD_SOURCE_C: /* crop rectangle at camera interface input */ mf->width = camif->camif_crop.width; mf->height = camif->camif_crop.height; @@ -1332,7 +1332,7 @@ static int s3c_camif_subdev_set_fmt(struct v4l2_subdev *sd, } break; - case CAMIF_SD_PAD_SOURCE_C...CAMIF_SD_PAD_SOURCE_P: + case CAMIF_SD_PAD_SOURCE_C: /* Pixel format can be only changed on the sink pad. */ mf->code = camif->mbus_fmt.code; mf->width = crop->width; The semantic patch is: // <smpl> // Change function parameter @@ identifier func; identifier cfg; @@ func(..., - struct v4l2_subdev_pad_config *cfg + struct v4l2_subdev_state *sd_state , ...) { <... - cfg + sd_state ...> } // Change function declaration parameter @@ identifier func; identifier cfg; type T; @@ T func(..., - struct v4l2_subdev_pad_config *cfg + struct v4l2_subdev_state *sd_state , ...); // Change function return value @@ identifier func; @@ - struct v4l2_subdev_pad_config + struct v4l2_subdev_state *func(...) { ... } // Change function declaration return value @@ identifier func; @@ - struct v4l2_subdev_pad_config + struct v4l2_subdev_state *func(...); // Some drivers pass a local pad_cfg for a single pad to a called function. Wrap it // inside a pad_state. @@ identifier func; identifier pad_cfg; @@ func(...) { ... struct v4l2_subdev_pad_config pad_cfg; + struct v4l2_subdev_state pad_state = { .pads = &pad_cfg }; <+... ( v4l2_subdev_call | sensor_call | isi_try_fse | isc_try_fse | saa_call_all ) (..., - &pad_cfg + &pad_state ,...) ...+> } // If the function uses fields from pad_config, access via state->pads @@ identifier func; identifier state; @@ func(..., struct v4l2_subdev_state *state , ...) { <... ( - state->try_fmt + state->pads->try_fmt | - state->try_crop + state->pads->try_crop | - state->try_compose + state->pads->try_compose ) ...> } // If the function accesses the filehandle, use fh->state instead @@ struct v4l2_subdev_fh *fh; @@ - fh->pad + fh->state @@ struct v4l2_subdev_fh fh; @@ - fh.pad + fh.state // Start of vsp1 specific @@ @@ struct vsp1_entity { ... - struct v4l2_subdev_pad_config *config; + struct v4l2_subdev_state *config; ... }; @@ symbol entity; @@ vsp1_entity_init(...) { ... entity->config = - v4l2_subdev_alloc_pad_config + v4l2_subdev_alloc_state (&entity->subdev); ... } @@ symbol entity; @@ vsp1_entity_destroy(...) { ... - v4l2_subdev_free_pad_config + v4l2_subdev_free_state (entity->config); ... } @exists@ identifier func =~ "(^vsp1.*)|(hsit_set_format)|(sru_enum_frame_size)|(sru_set_format)|(uif_get_selection)|(uif_set_selection)|(uds_enum_frame_size)|(uds_set_format)|(brx_set_format)|(brx_get_selection)|(histo_get_selection)|(histo_set_selection)|(brx_set_selection)"; symbol config; @@ func(...) { ... - struct v4l2_subdev_pad_config *config; + struct v4l2_subdev_state *config; ... } // End of vsp1 specific // Start of rcar specific @@ identifier sd; identifier pad_cfg; @@ rvin_try_format(...) { ... - struct v4l2_subdev_pad_config *pad_cfg; + struct v4l2_subdev_state *sd_state; ... - pad_cfg = v4l2_subdev_alloc_pad_config(sd); + sd_state = v4l2_subdev_alloc_state(sd); <... - pad_cfg + sd_state ...> - v4l2_subdev_free_pad_config(pad_cfg); + v4l2_subdev_free_state(sd_state); ... } // End of rcar specific // Start of rockchip specific @@ identifier func =~ "(rkisp1_rsz_get_pad_fmt)|(rkisp1_rsz_get_pad_crop)|(rkisp1_rsz_register)"; symbol rsz; symbol pad_cfg; @@ func(...) { + struct v4l2_subdev_state state = { .pads = rsz->pad_cfg }; ... - rsz->pad_cfg + &state ... } @@ identifier func =~ "(rkisp1_isp_get_pad_fmt)|(rkisp1_isp_get_pad_crop)"; symbol isp; symbol pad_cfg; @@ func(...) { + struct v4l2_subdev_state state = { .pads = isp->pad_cfg }; ... - isp->pad_cfg + &state ... } @@ symbol rkisp1; symbol isp; symbol pad_cfg; @@ rkisp1_isp_register(...) { + struct v4l2_subdev_state state = { .pads = rkisp1->isp.pad_cfg }; ... - rkisp1->isp.pad_cfg + &state ... } // End of rockchip specific // Start of tegra-video specific @@ identifier sd; identifier pad_cfg; @@ __tegra_channel_try_format(...) { ... - struct v4l2_subdev_pad_config *pad_cfg; + struct v4l2_subdev_state *sd_state; ... - pad_cfg = v4l2_subdev_alloc_pad_config(sd); + sd_state = v4l2_subdev_alloc_state(sd); <... - pad_cfg + sd_state ...> - v4l2_subdev_free_pad_config(pad_cfg); + v4l2_subdev_free_state(sd_state); ... } @@ identifier sd_state; @@ __tegra_channel_try_format(...) { ... struct v4l2_subdev_state *sd_state; <... - sd_state->try_crop + sd_state->pads->try_crop ...> } // End of tegra-video specific // </smpl> Signed-off-by: Tomi Valkeinen <tomi.valkeinen@ideasonboard.com> Acked-by: Laurent Pinchart <laurent.pinchart@ideasonboard.com> Acked-by: Sakari Ailus <sakari.ailus@linux.intel.com> Signed-off-by: Hans Verkuil <hverkuil-cisco@xs4all.nl> Signed-off-by: Mauro Carvalho Chehab <mchehab+huawei@kernel.org>
2021-06-10 22:55:58 +08:00
framefmt = v4l2_subdev_get_try_format(sd, sd_state, fmt->pad);
fmt->format = *framefmt;
} else {
imx319_update_pad_format(imx319, imx319->cur_mode, fmt);
}
return 0;
}
static int imx319_get_pad_format(struct v4l2_subdev *sd,
media: v4l2-subdev: add subdev-wide state struct We have 'struct v4l2_subdev_pad_config' which contains configuration for a single pad used for the TRY functionality, and an array of those structs is passed to various v4l2_subdev_pad_ops. I was working on subdev internal routing between pads, and realized that there's no way to add TRY functionality for routes, which is not pad specific configuration. Adding a separate struct for try-route config wouldn't work either, as e.g. set-fmt needs to know the try-route configuration to propagate the settings. This patch adds a new struct, 'struct v4l2_subdev_state' (which at the moment only contains the v4l2_subdev_pad_config array) and the new struct is used in most of the places where v4l2_subdev_pad_config was used. All v4l2_subdev_pad_ops functions taking v4l2_subdev_pad_config are changed to instead take v4l2_subdev_state. The changes to drivers/media/v4l2-core/v4l2-subdev.c and include/media/v4l2-subdev.h were written by hand, and all the driver changes were done with the semantic patch below. The spatch needs to be applied to a select list of directories. I used the following shell commands to apply the spatch: dirs="drivers/media/i2c drivers/media/platform drivers/media/usb drivers/media/test-drivers/vimc drivers/media/pci drivers/staging/media" for dir in $dirs; do spatch -j8 --dir --include-headers --no-show-diff --in-place --sp-file v4l2-subdev-state.cocci $dir; done Note that Coccinelle chokes on a few drivers (gcc extensions?). With minor changes we can make Coccinelle run fine, and these changes can be reverted after spatch. The diff for these changes is: For drivers/media/i2c/s5k5baf.c: @@ -1481,7 +1481,7 @@ static int s5k5baf_set_selection(struct v4l2_subdev *sd, &s5k5baf_cis_rect, v4l2_subdev_get_try_crop(sd, cfg, PAD_CIS), v4l2_subdev_get_try_compose(sd, cfg, PAD_CIS), - v4l2_subdev_get_try_crop(sd, cfg, PAD_OUT) + v4l2_subdev_get_try_crop(sd, cfg, PAD_OUT), }; s5k5baf_set_rect_and_adjust(rects, rtype, &sel->r); return 0; For drivers/media/platform/s3c-camif/camif-capture.c: @@ -1230,7 +1230,7 @@ static int s3c_camif_subdev_get_fmt(struct v4l2_subdev *sd, *mf = camif->mbus_fmt; break; - case CAMIF_SD_PAD_SOURCE_C...CAMIF_SD_PAD_SOURCE_P: + case CAMIF_SD_PAD_SOURCE_C: /* crop rectangle at camera interface input */ mf->width = camif->camif_crop.width; mf->height = camif->camif_crop.height; @@ -1332,7 +1332,7 @@ static int s3c_camif_subdev_set_fmt(struct v4l2_subdev *sd, } break; - case CAMIF_SD_PAD_SOURCE_C...CAMIF_SD_PAD_SOURCE_P: + case CAMIF_SD_PAD_SOURCE_C: /* Pixel format can be only changed on the sink pad. */ mf->code = camif->mbus_fmt.code; mf->width = crop->width; The semantic patch is: // <smpl> // Change function parameter @@ identifier func; identifier cfg; @@ func(..., - struct v4l2_subdev_pad_config *cfg + struct v4l2_subdev_state *sd_state , ...) { <... - cfg + sd_state ...> } // Change function declaration parameter @@ identifier func; identifier cfg; type T; @@ T func(..., - struct v4l2_subdev_pad_config *cfg + struct v4l2_subdev_state *sd_state , ...); // Change function return value @@ identifier func; @@ - struct v4l2_subdev_pad_config + struct v4l2_subdev_state *func(...) { ... } // Change function declaration return value @@ identifier func; @@ - struct v4l2_subdev_pad_config + struct v4l2_subdev_state *func(...); // Some drivers pass a local pad_cfg for a single pad to a called function. Wrap it // inside a pad_state. @@ identifier func; identifier pad_cfg; @@ func(...) { ... struct v4l2_subdev_pad_config pad_cfg; + struct v4l2_subdev_state pad_state = { .pads = &pad_cfg }; <+... ( v4l2_subdev_call | sensor_call | isi_try_fse | isc_try_fse | saa_call_all ) (..., - &pad_cfg + &pad_state ,...) ...+> } // If the function uses fields from pad_config, access via state->pads @@ identifier func; identifier state; @@ func(..., struct v4l2_subdev_state *state , ...) { <... ( - state->try_fmt + state->pads->try_fmt | - state->try_crop + state->pads->try_crop | - state->try_compose + state->pads->try_compose ) ...> } // If the function accesses the filehandle, use fh->state instead @@ struct v4l2_subdev_fh *fh; @@ - fh->pad + fh->state @@ struct v4l2_subdev_fh fh; @@ - fh.pad + fh.state // Start of vsp1 specific @@ @@ struct vsp1_entity { ... - struct v4l2_subdev_pad_config *config; + struct v4l2_subdev_state *config; ... }; @@ symbol entity; @@ vsp1_entity_init(...) { ... entity->config = - v4l2_subdev_alloc_pad_config + v4l2_subdev_alloc_state (&entity->subdev); ... } @@ symbol entity; @@ vsp1_entity_destroy(...) { ... - v4l2_subdev_free_pad_config + v4l2_subdev_free_state (entity->config); ... } @exists@ identifier func =~ "(^vsp1.*)|(hsit_set_format)|(sru_enum_frame_size)|(sru_set_format)|(uif_get_selection)|(uif_set_selection)|(uds_enum_frame_size)|(uds_set_format)|(brx_set_format)|(brx_get_selection)|(histo_get_selection)|(histo_set_selection)|(brx_set_selection)"; symbol config; @@ func(...) { ... - struct v4l2_subdev_pad_config *config; + struct v4l2_subdev_state *config; ... } // End of vsp1 specific // Start of rcar specific @@ identifier sd; identifier pad_cfg; @@ rvin_try_format(...) { ... - struct v4l2_subdev_pad_config *pad_cfg; + struct v4l2_subdev_state *sd_state; ... - pad_cfg = v4l2_subdev_alloc_pad_config(sd); + sd_state = v4l2_subdev_alloc_state(sd); <... - pad_cfg + sd_state ...> - v4l2_subdev_free_pad_config(pad_cfg); + v4l2_subdev_free_state(sd_state); ... } // End of rcar specific // Start of rockchip specific @@ identifier func =~ "(rkisp1_rsz_get_pad_fmt)|(rkisp1_rsz_get_pad_crop)|(rkisp1_rsz_register)"; symbol rsz; symbol pad_cfg; @@ func(...) { + struct v4l2_subdev_state state = { .pads = rsz->pad_cfg }; ... - rsz->pad_cfg + &state ... } @@ identifier func =~ "(rkisp1_isp_get_pad_fmt)|(rkisp1_isp_get_pad_crop)"; symbol isp; symbol pad_cfg; @@ func(...) { + struct v4l2_subdev_state state = { .pads = isp->pad_cfg }; ... - isp->pad_cfg + &state ... } @@ symbol rkisp1; symbol isp; symbol pad_cfg; @@ rkisp1_isp_register(...) { + struct v4l2_subdev_state state = { .pads = rkisp1->isp.pad_cfg }; ... - rkisp1->isp.pad_cfg + &state ... } // End of rockchip specific // Start of tegra-video specific @@ identifier sd; identifier pad_cfg; @@ __tegra_channel_try_format(...) { ... - struct v4l2_subdev_pad_config *pad_cfg; + struct v4l2_subdev_state *sd_state; ... - pad_cfg = v4l2_subdev_alloc_pad_config(sd); + sd_state = v4l2_subdev_alloc_state(sd); <... - pad_cfg + sd_state ...> - v4l2_subdev_free_pad_config(pad_cfg); + v4l2_subdev_free_state(sd_state); ... } @@ identifier sd_state; @@ __tegra_channel_try_format(...) { ... struct v4l2_subdev_state *sd_state; <... - sd_state->try_crop + sd_state->pads->try_crop ...> } // End of tegra-video specific // </smpl> Signed-off-by: Tomi Valkeinen <tomi.valkeinen@ideasonboard.com> Acked-by: Laurent Pinchart <laurent.pinchart@ideasonboard.com> Acked-by: Sakari Ailus <sakari.ailus@linux.intel.com> Signed-off-by: Hans Verkuil <hverkuil-cisco@xs4all.nl> Signed-off-by: Mauro Carvalho Chehab <mchehab+huawei@kernel.org>
2021-06-10 22:55:58 +08:00
struct v4l2_subdev_state *sd_state,
struct v4l2_subdev_format *fmt)
{
struct imx319 *imx319 = to_imx319(sd);
int ret;
mutex_lock(&imx319->mutex);
media: v4l2-subdev: add subdev-wide state struct We have 'struct v4l2_subdev_pad_config' which contains configuration for a single pad used for the TRY functionality, and an array of those structs is passed to various v4l2_subdev_pad_ops. I was working on subdev internal routing between pads, and realized that there's no way to add TRY functionality for routes, which is not pad specific configuration. Adding a separate struct for try-route config wouldn't work either, as e.g. set-fmt needs to know the try-route configuration to propagate the settings. This patch adds a new struct, 'struct v4l2_subdev_state' (which at the moment only contains the v4l2_subdev_pad_config array) and the new struct is used in most of the places where v4l2_subdev_pad_config was used. All v4l2_subdev_pad_ops functions taking v4l2_subdev_pad_config are changed to instead take v4l2_subdev_state. The changes to drivers/media/v4l2-core/v4l2-subdev.c and include/media/v4l2-subdev.h were written by hand, and all the driver changes were done with the semantic patch below. The spatch needs to be applied to a select list of directories. I used the following shell commands to apply the spatch: dirs="drivers/media/i2c drivers/media/platform drivers/media/usb drivers/media/test-drivers/vimc drivers/media/pci drivers/staging/media" for dir in $dirs; do spatch -j8 --dir --include-headers --no-show-diff --in-place --sp-file v4l2-subdev-state.cocci $dir; done Note that Coccinelle chokes on a few drivers (gcc extensions?). With minor changes we can make Coccinelle run fine, and these changes can be reverted after spatch. The diff for these changes is: For drivers/media/i2c/s5k5baf.c: @@ -1481,7 +1481,7 @@ static int s5k5baf_set_selection(struct v4l2_subdev *sd, &s5k5baf_cis_rect, v4l2_subdev_get_try_crop(sd, cfg, PAD_CIS), v4l2_subdev_get_try_compose(sd, cfg, PAD_CIS), - v4l2_subdev_get_try_crop(sd, cfg, PAD_OUT) + v4l2_subdev_get_try_crop(sd, cfg, PAD_OUT), }; s5k5baf_set_rect_and_adjust(rects, rtype, &sel->r); return 0; For drivers/media/platform/s3c-camif/camif-capture.c: @@ -1230,7 +1230,7 @@ static int s3c_camif_subdev_get_fmt(struct v4l2_subdev *sd, *mf = camif->mbus_fmt; break; - case CAMIF_SD_PAD_SOURCE_C...CAMIF_SD_PAD_SOURCE_P: + case CAMIF_SD_PAD_SOURCE_C: /* crop rectangle at camera interface input */ mf->width = camif->camif_crop.width; mf->height = camif->camif_crop.height; @@ -1332,7 +1332,7 @@ static int s3c_camif_subdev_set_fmt(struct v4l2_subdev *sd, } break; - case CAMIF_SD_PAD_SOURCE_C...CAMIF_SD_PAD_SOURCE_P: + case CAMIF_SD_PAD_SOURCE_C: /* Pixel format can be only changed on the sink pad. */ mf->code = camif->mbus_fmt.code; mf->width = crop->width; The semantic patch is: // <smpl> // Change function parameter @@ identifier func; identifier cfg; @@ func(..., - struct v4l2_subdev_pad_config *cfg + struct v4l2_subdev_state *sd_state , ...) { <... - cfg + sd_state ...> } // Change function declaration parameter @@ identifier func; identifier cfg; type T; @@ T func(..., - struct v4l2_subdev_pad_config *cfg + struct v4l2_subdev_state *sd_state , ...); // Change function return value @@ identifier func; @@ - struct v4l2_subdev_pad_config + struct v4l2_subdev_state *func(...) { ... } // Change function declaration return value @@ identifier func; @@ - struct v4l2_subdev_pad_config + struct v4l2_subdev_state *func(...); // Some drivers pass a local pad_cfg for a single pad to a called function. Wrap it // inside a pad_state. @@ identifier func; identifier pad_cfg; @@ func(...) { ... struct v4l2_subdev_pad_config pad_cfg; + struct v4l2_subdev_state pad_state = { .pads = &pad_cfg }; <+... ( v4l2_subdev_call | sensor_call | isi_try_fse | isc_try_fse | saa_call_all ) (..., - &pad_cfg + &pad_state ,...) ...+> } // If the function uses fields from pad_config, access via state->pads @@ identifier func; identifier state; @@ func(..., struct v4l2_subdev_state *state , ...) { <... ( - state->try_fmt + state->pads->try_fmt | - state->try_crop + state->pads->try_crop | - state->try_compose + state->pads->try_compose ) ...> } // If the function accesses the filehandle, use fh->state instead @@ struct v4l2_subdev_fh *fh; @@ - fh->pad + fh->state @@ struct v4l2_subdev_fh fh; @@ - fh.pad + fh.state // Start of vsp1 specific @@ @@ struct vsp1_entity { ... - struct v4l2_subdev_pad_config *config; + struct v4l2_subdev_state *config; ... }; @@ symbol entity; @@ vsp1_entity_init(...) { ... entity->config = - v4l2_subdev_alloc_pad_config + v4l2_subdev_alloc_state (&entity->subdev); ... } @@ symbol entity; @@ vsp1_entity_destroy(...) { ... - v4l2_subdev_free_pad_config + v4l2_subdev_free_state (entity->config); ... } @exists@ identifier func =~ "(^vsp1.*)|(hsit_set_format)|(sru_enum_frame_size)|(sru_set_format)|(uif_get_selection)|(uif_set_selection)|(uds_enum_frame_size)|(uds_set_format)|(brx_set_format)|(brx_get_selection)|(histo_get_selection)|(histo_set_selection)|(brx_set_selection)"; symbol config; @@ func(...) { ... - struct v4l2_subdev_pad_config *config; + struct v4l2_subdev_state *config; ... } // End of vsp1 specific // Start of rcar specific @@ identifier sd; identifier pad_cfg; @@ rvin_try_format(...) { ... - struct v4l2_subdev_pad_config *pad_cfg; + struct v4l2_subdev_state *sd_state; ... - pad_cfg = v4l2_subdev_alloc_pad_config(sd); + sd_state = v4l2_subdev_alloc_state(sd); <... - pad_cfg + sd_state ...> - v4l2_subdev_free_pad_config(pad_cfg); + v4l2_subdev_free_state(sd_state); ... } // End of rcar specific // Start of rockchip specific @@ identifier func =~ "(rkisp1_rsz_get_pad_fmt)|(rkisp1_rsz_get_pad_crop)|(rkisp1_rsz_register)"; symbol rsz; symbol pad_cfg; @@ func(...) { + struct v4l2_subdev_state state = { .pads = rsz->pad_cfg }; ... - rsz->pad_cfg + &state ... } @@ identifier func =~ "(rkisp1_isp_get_pad_fmt)|(rkisp1_isp_get_pad_crop)"; symbol isp; symbol pad_cfg; @@ func(...) { + struct v4l2_subdev_state state = { .pads = isp->pad_cfg }; ... - isp->pad_cfg + &state ... } @@ symbol rkisp1; symbol isp; symbol pad_cfg; @@ rkisp1_isp_register(...) { + struct v4l2_subdev_state state = { .pads = rkisp1->isp.pad_cfg }; ... - rkisp1->isp.pad_cfg + &state ... } // End of rockchip specific // Start of tegra-video specific @@ identifier sd; identifier pad_cfg; @@ __tegra_channel_try_format(...) { ... - struct v4l2_subdev_pad_config *pad_cfg; + struct v4l2_subdev_state *sd_state; ... - pad_cfg = v4l2_subdev_alloc_pad_config(sd); + sd_state = v4l2_subdev_alloc_state(sd); <... - pad_cfg + sd_state ...> - v4l2_subdev_free_pad_config(pad_cfg); + v4l2_subdev_free_state(sd_state); ... } @@ identifier sd_state; @@ __tegra_channel_try_format(...) { ... struct v4l2_subdev_state *sd_state; <... - sd_state->try_crop + sd_state->pads->try_crop ...> } // End of tegra-video specific // </smpl> Signed-off-by: Tomi Valkeinen <tomi.valkeinen@ideasonboard.com> Acked-by: Laurent Pinchart <laurent.pinchart@ideasonboard.com> Acked-by: Sakari Ailus <sakari.ailus@linux.intel.com> Signed-off-by: Hans Verkuil <hverkuil-cisco@xs4all.nl> Signed-off-by: Mauro Carvalho Chehab <mchehab+huawei@kernel.org>
2021-06-10 22:55:58 +08:00
ret = imx319_do_get_pad_format(imx319, sd_state, fmt);
mutex_unlock(&imx319->mutex);
return ret;
}
static int
imx319_set_pad_format(struct v4l2_subdev *sd,
media: v4l2-subdev: add subdev-wide state struct We have 'struct v4l2_subdev_pad_config' which contains configuration for a single pad used for the TRY functionality, and an array of those structs is passed to various v4l2_subdev_pad_ops. I was working on subdev internal routing between pads, and realized that there's no way to add TRY functionality for routes, which is not pad specific configuration. Adding a separate struct for try-route config wouldn't work either, as e.g. set-fmt needs to know the try-route configuration to propagate the settings. This patch adds a new struct, 'struct v4l2_subdev_state' (which at the moment only contains the v4l2_subdev_pad_config array) and the new struct is used in most of the places where v4l2_subdev_pad_config was used. All v4l2_subdev_pad_ops functions taking v4l2_subdev_pad_config are changed to instead take v4l2_subdev_state. The changes to drivers/media/v4l2-core/v4l2-subdev.c and include/media/v4l2-subdev.h were written by hand, and all the driver changes were done with the semantic patch below. The spatch needs to be applied to a select list of directories. I used the following shell commands to apply the spatch: dirs="drivers/media/i2c drivers/media/platform drivers/media/usb drivers/media/test-drivers/vimc drivers/media/pci drivers/staging/media" for dir in $dirs; do spatch -j8 --dir --include-headers --no-show-diff --in-place --sp-file v4l2-subdev-state.cocci $dir; done Note that Coccinelle chokes on a few drivers (gcc extensions?). With minor changes we can make Coccinelle run fine, and these changes can be reverted after spatch. The diff for these changes is: For drivers/media/i2c/s5k5baf.c: @@ -1481,7 +1481,7 @@ static int s5k5baf_set_selection(struct v4l2_subdev *sd, &s5k5baf_cis_rect, v4l2_subdev_get_try_crop(sd, cfg, PAD_CIS), v4l2_subdev_get_try_compose(sd, cfg, PAD_CIS), - v4l2_subdev_get_try_crop(sd, cfg, PAD_OUT) + v4l2_subdev_get_try_crop(sd, cfg, PAD_OUT), }; s5k5baf_set_rect_and_adjust(rects, rtype, &sel->r); return 0; For drivers/media/platform/s3c-camif/camif-capture.c: @@ -1230,7 +1230,7 @@ static int s3c_camif_subdev_get_fmt(struct v4l2_subdev *sd, *mf = camif->mbus_fmt; break; - case CAMIF_SD_PAD_SOURCE_C...CAMIF_SD_PAD_SOURCE_P: + case CAMIF_SD_PAD_SOURCE_C: /* crop rectangle at camera interface input */ mf->width = camif->camif_crop.width; mf->height = camif->camif_crop.height; @@ -1332,7 +1332,7 @@ static int s3c_camif_subdev_set_fmt(struct v4l2_subdev *sd, } break; - case CAMIF_SD_PAD_SOURCE_C...CAMIF_SD_PAD_SOURCE_P: + case CAMIF_SD_PAD_SOURCE_C: /* Pixel format can be only changed on the sink pad. */ mf->code = camif->mbus_fmt.code; mf->width = crop->width; The semantic patch is: // <smpl> // Change function parameter @@ identifier func; identifier cfg; @@ func(..., - struct v4l2_subdev_pad_config *cfg + struct v4l2_subdev_state *sd_state , ...) { <... - cfg + sd_state ...> } // Change function declaration parameter @@ identifier func; identifier cfg; type T; @@ T func(..., - struct v4l2_subdev_pad_config *cfg + struct v4l2_subdev_state *sd_state , ...); // Change function return value @@ identifier func; @@ - struct v4l2_subdev_pad_config + struct v4l2_subdev_state *func(...) { ... } // Change function declaration return value @@ identifier func; @@ - struct v4l2_subdev_pad_config + struct v4l2_subdev_state *func(...); // Some drivers pass a local pad_cfg for a single pad to a called function. Wrap it // inside a pad_state. @@ identifier func; identifier pad_cfg; @@ func(...) { ... struct v4l2_subdev_pad_config pad_cfg; + struct v4l2_subdev_state pad_state = { .pads = &pad_cfg }; <+... ( v4l2_subdev_call | sensor_call | isi_try_fse | isc_try_fse | saa_call_all ) (..., - &pad_cfg + &pad_state ,...) ...+> } // If the function uses fields from pad_config, access via state->pads @@ identifier func; identifier state; @@ func(..., struct v4l2_subdev_state *state , ...) { <... ( - state->try_fmt + state->pads->try_fmt | - state->try_crop + state->pads->try_crop | - state->try_compose + state->pads->try_compose ) ...> } // If the function accesses the filehandle, use fh->state instead @@ struct v4l2_subdev_fh *fh; @@ - fh->pad + fh->state @@ struct v4l2_subdev_fh fh; @@ - fh.pad + fh.state // Start of vsp1 specific @@ @@ struct vsp1_entity { ... - struct v4l2_subdev_pad_config *config; + struct v4l2_subdev_state *config; ... }; @@ symbol entity; @@ vsp1_entity_init(...) { ... entity->config = - v4l2_subdev_alloc_pad_config + v4l2_subdev_alloc_state (&entity->subdev); ... } @@ symbol entity; @@ vsp1_entity_destroy(...) { ... - v4l2_subdev_free_pad_config + v4l2_subdev_free_state (entity->config); ... } @exists@ identifier func =~ "(^vsp1.*)|(hsit_set_format)|(sru_enum_frame_size)|(sru_set_format)|(uif_get_selection)|(uif_set_selection)|(uds_enum_frame_size)|(uds_set_format)|(brx_set_format)|(brx_get_selection)|(histo_get_selection)|(histo_set_selection)|(brx_set_selection)"; symbol config; @@ func(...) { ... - struct v4l2_subdev_pad_config *config; + struct v4l2_subdev_state *config; ... } // End of vsp1 specific // Start of rcar specific @@ identifier sd; identifier pad_cfg; @@ rvin_try_format(...) { ... - struct v4l2_subdev_pad_config *pad_cfg; + struct v4l2_subdev_state *sd_state; ... - pad_cfg = v4l2_subdev_alloc_pad_config(sd); + sd_state = v4l2_subdev_alloc_state(sd); <... - pad_cfg + sd_state ...> - v4l2_subdev_free_pad_config(pad_cfg); + v4l2_subdev_free_state(sd_state); ... } // End of rcar specific // Start of rockchip specific @@ identifier func =~ "(rkisp1_rsz_get_pad_fmt)|(rkisp1_rsz_get_pad_crop)|(rkisp1_rsz_register)"; symbol rsz; symbol pad_cfg; @@ func(...) { + struct v4l2_subdev_state state = { .pads = rsz->pad_cfg }; ... - rsz->pad_cfg + &state ... } @@ identifier func =~ "(rkisp1_isp_get_pad_fmt)|(rkisp1_isp_get_pad_crop)"; symbol isp; symbol pad_cfg; @@ func(...) { + struct v4l2_subdev_state state = { .pads = isp->pad_cfg }; ... - isp->pad_cfg + &state ... } @@ symbol rkisp1; symbol isp; symbol pad_cfg; @@ rkisp1_isp_register(...) { + struct v4l2_subdev_state state = { .pads = rkisp1->isp.pad_cfg }; ... - rkisp1->isp.pad_cfg + &state ... } // End of rockchip specific // Start of tegra-video specific @@ identifier sd; identifier pad_cfg; @@ __tegra_channel_try_format(...) { ... - struct v4l2_subdev_pad_config *pad_cfg; + struct v4l2_subdev_state *sd_state; ... - pad_cfg = v4l2_subdev_alloc_pad_config(sd); + sd_state = v4l2_subdev_alloc_state(sd); <... - pad_cfg + sd_state ...> - v4l2_subdev_free_pad_config(pad_cfg); + v4l2_subdev_free_state(sd_state); ... } @@ identifier sd_state; @@ __tegra_channel_try_format(...) { ... struct v4l2_subdev_state *sd_state; <... - sd_state->try_crop + sd_state->pads->try_crop ...> } // End of tegra-video specific // </smpl> Signed-off-by: Tomi Valkeinen <tomi.valkeinen@ideasonboard.com> Acked-by: Laurent Pinchart <laurent.pinchart@ideasonboard.com> Acked-by: Sakari Ailus <sakari.ailus@linux.intel.com> Signed-off-by: Hans Verkuil <hverkuil-cisco@xs4all.nl> Signed-off-by: Mauro Carvalho Chehab <mchehab+huawei@kernel.org>
2021-06-10 22:55:58 +08:00
struct v4l2_subdev_state *sd_state,
struct v4l2_subdev_format *fmt)
{
struct imx319 *imx319 = to_imx319(sd);
const struct imx319_mode *mode;
struct v4l2_mbus_framefmt *framefmt;
s32 vblank_def;
s32 vblank_min;
s64 h_blank;
u64 pixel_rate;
u32 height;
mutex_lock(&imx319->mutex);
/*
* Only one bayer order is supported.
* It depends on the flip settings.
*/
fmt->format.code = imx319_get_format_code(imx319);
mode = v4l2_find_nearest_size(supported_modes,
ARRAY_SIZE(supported_modes),
width, height,
fmt->format.width, fmt->format.height);
imx319_update_pad_format(imx319, mode, fmt);
if (fmt->which == V4L2_SUBDEV_FORMAT_TRY) {
media: v4l2-subdev: add subdev-wide state struct We have 'struct v4l2_subdev_pad_config' which contains configuration for a single pad used for the TRY functionality, and an array of those structs is passed to various v4l2_subdev_pad_ops. I was working on subdev internal routing between pads, and realized that there's no way to add TRY functionality for routes, which is not pad specific configuration. Adding a separate struct for try-route config wouldn't work either, as e.g. set-fmt needs to know the try-route configuration to propagate the settings. This patch adds a new struct, 'struct v4l2_subdev_state' (which at the moment only contains the v4l2_subdev_pad_config array) and the new struct is used in most of the places where v4l2_subdev_pad_config was used. All v4l2_subdev_pad_ops functions taking v4l2_subdev_pad_config are changed to instead take v4l2_subdev_state. The changes to drivers/media/v4l2-core/v4l2-subdev.c and include/media/v4l2-subdev.h were written by hand, and all the driver changes were done with the semantic patch below. The spatch needs to be applied to a select list of directories. I used the following shell commands to apply the spatch: dirs="drivers/media/i2c drivers/media/platform drivers/media/usb drivers/media/test-drivers/vimc drivers/media/pci drivers/staging/media" for dir in $dirs; do spatch -j8 --dir --include-headers --no-show-diff --in-place --sp-file v4l2-subdev-state.cocci $dir; done Note that Coccinelle chokes on a few drivers (gcc extensions?). With minor changes we can make Coccinelle run fine, and these changes can be reverted after spatch. The diff for these changes is: For drivers/media/i2c/s5k5baf.c: @@ -1481,7 +1481,7 @@ static int s5k5baf_set_selection(struct v4l2_subdev *sd, &s5k5baf_cis_rect, v4l2_subdev_get_try_crop(sd, cfg, PAD_CIS), v4l2_subdev_get_try_compose(sd, cfg, PAD_CIS), - v4l2_subdev_get_try_crop(sd, cfg, PAD_OUT) + v4l2_subdev_get_try_crop(sd, cfg, PAD_OUT), }; s5k5baf_set_rect_and_adjust(rects, rtype, &sel->r); return 0; For drivers/media/platform/s3c-camif/camif-capture.c: @@ -1230,7 +1230,7 @@ static int s3c_camif_subdev_get_fmt(struct v4l2_subdev *sd, *mf = camif->mbus_fmt; break; - case CAMIF_SD_PAD_SOURCE_C...CAMIF_SD_PAD_SOURCE_P: + case CAMIF_SD_PAD_SOURCE_C: /* crop rectangle at camera interface input */ mf->width = camif->camif_crop.width; mf->height = camif->camif_crop.height; @@ -1332,7 +1332,7 @@ static int s3c_camif_subdev_set_fmt(struct v4l2_subdev *sd, } break; - case CAMIF_SD_PAD_SOURCE_C...CAMIF_SD_PAD_SOURCE_P: + case CAMIF_SD_PAD_SOURCE_C: /* Pixel format can be only changed on the sink pad. */ mf->code = camif->mbus_fmt.code; mf->width = crop->width; The semantic patch is: // <smpl> // Change function parameter @@ identifier func; identifier cfg; @@ func(..., - struct v4l2_subdev_pad_config *cfg + struct v4l2_subdev_state *sd_state , ...) { <... - cfg + sd_state ...> } // Change function declaration parameter @@ identifier func; identifier cfg; type T; @@ T func(..., - struct v4l2_subdev_pad_config *cfg + struct v4l2_subdev_state *sd_state , ...); // Change function return value @@ identifier func; @@ - struct v4l2_subdev_pad_config + struct v4l2_subdev_state *func(...) { ... } // Change function declaration return value @@ identifier func; @@ - struct v4l2_subdev_pad_config + struct v4l2_subdev_state *func(...); // Some drivers pass a local pad_cfg for a single pad to a called function. Wrap it // inside a pad_state. @@ identifier func; identifier pad_cfg; @@ func(...) { ... struct v4l2_subdev_pad_config pad_cfg; + struct v4l2_subdev_state pad_state = { .pads = &pad_cfg }; <+... ( v4l2_subdev_call | sensor_call | isi_try_fse | isc_try_fse | saa_call_all ) (..., - &pad_cfg + &pad_state ,...) ...+> } // If the function uses fields from pad_config, access via state->pads @@ identifier func; identifier state; @@ func(..., struct v4l2_subdev_state *state , ...) { <... ( - state->try_fmt + state->pads->try_fmt | - state->try_crop + state->pads->try_crop | - state->try_compose + state->pads->try_compose ) ...> } // If the function accesses the filehandle, use fh->state instead @@ struct v4l2_subdev_fh *fh; @@ - fh->pad + fh->state @@ struct v4l2_subdev_fh fh; @@ - fh.pad + fh.state // Start of vsp1 specific @@ @@ struct vsp1_entity { ... - struct v4l2_subdev_pad_config *config; + struct v4l2_subdev_state *config; ... }; @@ symbol entity; @@ vsp1_entity_init(...) { ... entity->config = - v4l2_subdev_alloc_pad_config + v4l2_subdev_alloc_state (&entity->subdev); ... } @@ symbol entity; @@ vsp1_entity_destroy(...) { ... - v4l2_subdev_free_pad_config + v4l2_subdev_free_state (entity->config); ... } @exists@ identifier func =~ "(^vsp1.*)|(hsit_set_format)|(sru_enum_frame_size)|(sru_set_format)|(uif_get_selection)|(uif_set_selection)|(uds_enum_frame_size)|(uds_set_format)|(brx_set_format)|(brx_get_selection)|(histo_get_selection)|(histo_set_selection)|(brx_set_selection)"; symbol config; @@ func(...) { ... - struct v4l2_subdev_pad_config *config; + struct v4l2_subdev_state *config; ... } // End of vsp1 specific // Start of rcar specific @@ identifier sd; identifier pad_cfg; @@ rvin_try_format(...) { ... - struct v4l2_subdev_pad_config *pad_cfg; + struct v4l2_subdev_state *sd_state; ... - pad_cfg = v4l2_subdev_alloc_pad_config(sd); + sd_state = v4l2_subdev_alloc_state(sd); <... - pad_cfg + sd_state ...> - v4l2_subdev_free_pad_config(pad_cfg); + v4l2_subdev_free_state(sd_state); ... } // End of rcar specific // Start of rockchip specific @@ identifier func =~ "(rkisp1_rsz_get_pad_fmt)|(rkisp1_rsz_get_pad_crop)|(rkisp1_rsz_register)"; symbol rsz; symbol pad_cfg; @@ func(...) { + struct v4l2_subdev_state state = { .pads = rsz->pad_cfg }; ... - rsz->pad_cfg + &state ... } @@ identifier func =~ "(rkisp1_isp_get_pad_fmt)|(rkisp1_isp_get_pad_crop)"; symbol isp; symbol pad_cfg; @@ func(...) { + struct v4l2_subdev_state state = { .pads = isp->pad_cfg }; ... - isp->pad_cfg + &state ... } @@ symbol rkisp1; symbol isp; symbol pad_cfg; @@ rkisp1_isp_register(...) { + struct v4l2_subdev_state state = { .pads = rkisp1->isp.pad_cfg }; ... - rkisp1->isp.pad_cfg + &state ... } // End of rockchip specific // Start of tegra-video specific @@ identifier sd; identifier pad_cfg; @@ __tegra_channel_try_format(...) { ... - struct v4l2_subdev_pad_config *pad_cfg; + struct v4l2_subdev_state *sd_state; ... - pad_cfg = v4l2_subdev_alloc_pad_config(sd); + sd_state = v4l2_subdev_alloc_state(sd); <... - pad_cfg + sd_state ...> - v4l2_subdev_free_pad_config(pad_cfg); + v4l2_subdev_free_state(sd_state); ... } @@ identifier sd_state; @@ __tegra_channel_try_format(...) { ... struct v4l2_subdev_state *sd_state; <... - sd_state->try_crop + sd_state->pads->try_crop ...> } // End of tegra-video specific // </smpl> Signed-off-by: Tomi Valkeinen <tomi.valkeinen@ideasonboard.com> Acked-by: Laurent Pinchart <laurent.pinchart@ideasonboard.com> Acked-by: Sakari Ailus <sakari.ailus@linux.intel.com> Signed-off-by: Hans Verkuil <hverkuil-cisco@xs4all.nl> Signed-off-by: Mauro Carvalho Chehab <mchehab+huawei@kernel.org>
2021-06-10 22:55:58 +08:00
framefmt = v4l2_subdev_get_try_format(sd, sd_state, fmt->pad);
*framefmt = fmt->format;
} else {
imx319->cur_mode = mode;
pixel_rate = imx319->link_def_freq * 2 * 4;
do_div(pixel_rate, 10);
__v4l2_ctrl_s_ctrl_int64(imx319->pixel_rate, pixel_rate);
/* Update limits and set FPS to default */
height = imx319->cur_mode->height;
vblank_def = imx319->cur_mode->fll_def - height;
vblank_min = imx319->cur_mode->fll_min - height;
height = IMX319_FLL_MAX - height;
__v4l2_ctrl_modify_range(imx319->vblank, vblank_min, height, 1,
vblank_def);
__v4l2_ctrl_s_ctrl(imx319->vblank, vblank_def);
h_blank = mode->llp - imx319->cur_mode->width;
/*
* Currently hblank is not changeable.
* So FPS control is done only by vblank.
*/
__v4l2_ctrl_modify_range(imx319->hblank, h_blank,
h_blank, 1, h_blank);
}
mutex_unlock(&imx319->mutex);
return 0;
}
/* Verify chip ID */
static int imx319_identify_module(struct imx319 *imx319)
{
struct i2c_client *client = v4l2_get_subdevdata(&imx319->sd);
int ret;
u32 val;
if (imx319->identified)
return 0;
ret = imx319_read_reg(imx319, IMX319_REG_CHIP_ID, 2, &val);
if (ret)
return ret;
if (val != IMX319_CHIP_ID) {
dev_err(&client->dev, "chip id mismatch: %x!=%x",
IMX319_CHIP_ID, val);
return -EIO;
}
imx319->identified = true;
return 0;
}
/* Start streaming */
static int imx319_start_streaming(struct imx319 *imx319)
{
struct i2c_client *client = v4l2_get_subdevdata(&imx319->sd);
const struct imx319_reg_list *reg_list;
int ret;
ret = imx319_identify_module(imx319);
if (ret)
return ret;
/* Global Setting */
reg_list = &imx319_global_setting;
ret = imx319_write_regs(imx319, reg_list->regs, reg_list->num_of_regs);
if (ret) {
dev_err(&client->dev, "failed to set global settings");
return ret;
}
/* Apply default values of current mode */
reg_list = &imx319->cur_mode->reg_list;
ret = imx319_write_regs(imx319, reg_list->regs, reg_list->num_of_regs);
if (ret) {
dev_err(&client->dev, "failed to set mode");
return ret;
}
/* set digital gain control to all color mode */
ret = imx319_write_reg(imx319, IMX319_REG_DPGA_USE_GLOBAL_GAIN, 1, 1);
if (ret)
return ret;
/* Apply customized values from user */
ret = __v4l2_ctrl_handler_setup(imx319->sd.ctrl_handler);
if (ret)
return ret;
return imx319_write_reg(imx319, IMX319_REG_MODE_SELECT,
1, IMX319_MODE_STREAMING);
}
/* Stop streaming */
static int imx319_stop_streaming(struct imx319 *imx319)
{
return imx319_write_reg(imx319, IMX319_REG_MODE_SELECT,
1, IMX319_MODE_STANDBY);
}
static int imx319_set_stream(struct v4l2_subdev *sd, int enable)
{
struct imx319 *imx319 = to_imx319(sd);
struct i2c_client *client = v4l2_get_subdevdata(sd);
int ret = 0;
mutex_lock(&imx319->mutex);
if (imx319->streaming == enable) {
mutex_unlock(&imx319->mutex);
return 0;
}
if (enable) {
ret = pm_runtime_resume_and_get(&client->dev);
if (ret < 0)
goto err_unlock;
/*
* Apply default & customized values
* and then start streaming.
*/
ret = imx319_start_streaming(imx319);
if (ret)
goto err_rpm_put;
} else {
imx319_stop_streaming(imx319);
pm_runtime_put(&client->dev);
}
imx319->streaming = enable;
/* vflip and hflip cannot change during streaming */
__v4l2_ctrl_grab(imx319->vflip, enable);
__v4l2_ctrl_grab(imx319->hflip, enable);
mutex_unlock(&imx319->mutex);
return ret;
err_rpm_put:
pm_runtime_put(&client->dev);
err_unlock:
mutex_unlock(&imx319->mutex);
return ret;
}
static int __maybe_unused imx319_suspend(struct device *dev)
{
struct v4l2_subdev *sd = dev_get_drvdata(dev);
struct imx319 *imx319 = to_imx319(sd);
if (imx319->streaming)
imx319_stop_streaming(imx319);
return 0;
}
static int __maybe_unused imx319_resume(struct device *dev)
{
struct v4l2_subdev *sd = dev_get_drvdata(dev);
struct imx319 *imx319 = to_imx319(sd);
int ret;
if (imx319->streaming) {
ret = imx319_start_streaming(imx319);
if (ret)
goto error;
}
return 0;
error:
imx319_stop_streaming(imx319);
imx319->streaming = 0;
return ret;
}
static const struct v4l2_subdev_core_ops imx319_subdev_core_ops = {
.subscribe_event = v4l2_ctrl_subdev_subscribe_event,
.unsubscribe_event = v4l2_event_subdev_unsubscribe,
};
static const struct v4l2_subdev_video_ops imx319_video_ops = {
.s_stream = imx319_set_stream,
};
static const struct v4l2_subdev_pad_ops imx319_pad_ops = {
.enum_mbus_code = imx319_enum_mbus_code,
.get_fmt = imx319_get_pad_format,
.set_fmt = imx319_set_pad_format,
.enum_frame_size = imx319_enum_frame_size,
};
static const struct v4l2_subdev_ops imx319_subdev_ops = {
.core = &imx319_subdev_core_ops,
.video = &imx319_video_ops,
.pad = &imx319_pad_ops,
};
static const struct media_entity_operations imx319_subdev_entity_ops = {
.link_validate = v4l2_subdev_link_validate,
};
static const struct v4l2_subdev_internal_ops imx319_internal_ops = {
.open = imx319_open,
};
/* Initialize control handlers */
static int imx319_init_controls(struct imx319 *imx319)
{
struct i2c_client *client = v4l2_get_subdevdata(&imx319->sd);
struct v4l2_ctrl_handler *ctrl_hdlr;
s64 exposure_max;
s64 vblank_def;
s64 vblank_min;
s64 hblank;
u64 pixel_rate;
const struct imx319_mode *mode;
u32 max;
int ret;
ctrl_hdlr = &imx319->ctrl_handler;
ret = v4l2_ctrl_handler_init(ctrl_hdlr, 10);
if (ret)
return ret;
ctrl_hdlr->lock = &imx319->mutex;
max = ARRAY_SIZE(link_freq_menu_items) - 1;
imx319->link_freq = v4l2_ctrl_new_int_menu(ctrl_hdlr, &imx319_ctrl_ops,
V4L2_CID_LINK_FREQ, max, 0,
link_freq_menu_items);
if (imx319->link_freq)
imx319->link_freq->flags |= V4L2_CTRL_FLAG_READ_ONLY;
/* pixel_rate = link_freq * 2 * nr_of_lanes / bits_per_sample */
pixel_rate = imx319->link_def_freq * 2 * 4;
do_div(pixel_rate, 10);
/* By default, PIXEL_RATE is read only */
imx319->pixel_rate = v4l2_ctrl_new_std(ctrl_hdlr, &imx319_ctrl_ops,
V4L2_CID_PIXEL_RATE, pixel_rate,
pixel_rate, 1, pixel_rate);
/* Initial vblank/hblank/exposure parameters based on current mode */
mode = imx319->cur_mode;
vblank_def = mode->fll_def - mode->height;
vblank_min = mode->fll_min - mode->height;
imx319->vblank = v4l2_ctrl_new_std(ctrl_hdlr, &imx319_ctrl_ops,
V4L2_CID_VBLANK, vblank_min,
IMX319_FLL_MAX - mode->height,
1, vblank_def);
hblank = mode->llp - mode->width;
imx319->hblank = v4l2_ctrl_new_std(ctrl_hdlr, &imx319_ctrl_ops,
V4L2_CID_HBLANK, hblank, hblank,
1, hblank);
if (imx319->hblank)
imx319->hblank->flags |= V4L2_CTRL_FLAG_READ_ONLY;
/* fll >= exposure time + adjust parameter (default value is 18) */
exposure_max = mode->fll_def - 18;
imx319->exposure = v4l2_ctrl_new_std(ctrl_hdlr, &imx319_ctrl_ops,
V4L2_CID_EXPOSURE,
IMX319_EXPOSURE_MIN, exposure_max,
IMX319_EXPOSURE_STEP,
IMX319_EXPOSURE_DEFAULT);
imx319->hflip = v4l2_ctrl_new_std(ctrl_hdlr, &imx319_ctrl_ops,
V4L2_CID_HFLIP, 0, 1, 1, 0);
if (imx319->hflip)
imx319->hflip->flags |= V4L2_CTRL_FLAG_MODIFY_LAYOUT;
imx319->vflip = v4l2_ctrl_new_std(ctrl_hdlr, &imx319_ctrl_ops,
V4L2_CID_VFLIP, 0, 1, 1, 0);
if (imx319->vflip)
imx319->vflip->flags |= V4L2_CTRL_FLAG_MODIFY_LAYOUT;
v4l2_ctrl_new_std(ctrl_hdlr, &imx319_ctrl_ops, V4L2_CID_ANALOGUE_GAIN,
IMX319_ANA_GAIN_MIN, IMX319_ANA_GAIN_MAX,
IMX319_ANA_GAIN_STEP, IMX319_ANA_GAIN_DEFAULT);
/* Digital gain */
v4l2_ctrl_new_std(ctrl_hdlr, &imx319_ctrl_ops, V4L2_CID_DIGITAL_GAIN,
IMX319_DGTL_GAIN_MIN, IMX319_DGTL_GAIN_MAX,
IMX319_DGTL_GAIN_STEP, IMX319_DGTL_GAIN_DEFAULT);
v4l2_ctrl_new_std_menu_items(ctrl_hdlr, &imx319_ctrl_ops,
V4L2_CID_TEST_PATTERN,
ARRAY_SIZE(imx319_test_pattern_menu) - 1,
0, 0, imx319_test_pattern_menu);
if (ctrl_hdlr->error) {
ret = ctrl_hdlr->error;
dev_err(&client->dev, "control init failed: %d", ret);
goto error;
}
imx319->sd.ctrl_handler = ctrl_hdlr;
return 0;
error:
v4l2_ctrl_handler_free(ctrl_hdlr);
return ret;
}
static struct imx319_hwcfg *imx319_get_hwcfg(struct device *dev)
{
struct imx319_hwcfg *cfg;
struct v4l2_fwnode_endpoint bus_cfg = {
.bus_type = V4L2_MBUS_CSI2_DPHY
};
struct fwnode_handle *ep;
struct fwnode_handle *fwnode = dev_fwnode(dev);
unsigned int i;
int ret;
if (!fwnode)
return NULL;
ep = fwnode_graph_get_next_endpoint(fwnode, NULL);
if (!ep)
return NULL;
ret = v4l2_fwnode_endpoint_alloc_parse(ep, &bus_cfg);
if (ret)
goto out_err;
cfg = devm_kzalloc(dev, sizeof(*cfg), GFP_KERNEL);
if (!cfg)
goto out_err;
ret = fwnode_property_read_u32(dev_fwnode(dev), "clock-frequency",
&cfg->ext_clk);
if (ret) {
dev_err(dev, "can't get clock frequency");
goto out_err;
}
dev_dbg(dev, "ext clk: %d", cfg->ext_clk);
if (cfg->ext_clk != IMX319_EXT_CLK) {
dev_err(dev, "external clock %d is not supported",
cfg->ext_clk);
goto out_err;
}
dev_dbg(dev, "num of link freqs: %d", bus_cfg.nr_of_link_frequencies);
if (!bus_cfg.nr_of_link_frequencies) {
dev_warn(dev, "no link frequencies defined");
goto out_err;
}
cfg->nr_of_link_freqs = bus_cfg.nr_of_link_frequencies;
cfg->link_freqs = devm_kcalloc(dev,
bus_cfg.nr_of_link_frequencies + 1,
sizeof(*cfg->link_freqs), GFP_KERNEL);
if (!cfg->link_freqs)
goto out_err;
for (i = 0; i < bus_cfg.nr_of_link_frequencies; i++) {
cfg->link_freqs[i] = bus_cfg.link_frequencies[i];
dev_dbg(dev, "link_freq[%d] = %lld", i, cfg->link_freqs[i]);
}
v4l2_fwnode_endpoint_free(&bus_cfg);
fwnode_handle_put(ep);
return cfg;
out_err:
v4l2_fwnode_endpoint_free(&bus_cfg);
fwnode_handle_put(ep);
return NULL;
}
static int imx319_probe(struct i2c_client *client)
{
struct imx319 *imx319;
bool full_power;
int ret;
u32 i;
imx319 = devm_kzalloc(&client->dev, sizeof(*imx319), GFP_KERNEL);
if (!imx319)
return -ENOMEM;
mutex_init(&imx319->mutex);
/* Initialize subdev */
v4l2_i2c_subdev_init(&imx319->sd, client, &imx319_subdev_ops);
full_power = acpi_dev_state_d0(&client->dev);
if (full_power) {
/* Check module identity */
ret = imx319_identify_module(imx319);
if (ret) {
dev_err(&client->dev, "failed to find sensor: %d", ret);
goto error_probe;
}
}
imx319->hwcfg = imx319_get_hwcfg(&client->dev);
if (!imx319->hwcfg) {
dev_err(&client->dev, "failed to get hwcfg");
ret = -ENODEV;
goto error_probe;
}
imx319->link_def_freq = link_freq_menu_items[IMX319_LINK_FREQ_INDEX];
for (i = 0; i < imx319->hwcfg->nr_of_link_freqs; i++) {
if (imx319->hwcfg->link_freqs[i] == imx319->link_def_freq) {
dev_dbg(&client->dev, "link freq index %d matched", i);
break;
}
}
if (i == imx319->hwcfg->nr_of_link_freqs) {
dev_err(&client->dev, "no link frequency supported");
ret = -EINVAL;
goto error_probe;
}
/* Set default mode to max resolution */
imx319->cur_mode = &supported_modes[0];
ret = imx319_init_controls(imx319);
if (ret) {
dev_err(&client->dev, "failed to init controls: %d", ret);
goto error_probe;
}
/* Initialize subdev */
imx319->sd.internal_ops = &imx319_internal_ops;
imx319->sd.flags |= V4L2_SUBDEV_FL_HAS_DEVNODE |
V4L2_SUBDEV_FL_HAS_EVENTS;
imx319->sd.entity.ops = &imx319_subdev_entity_ops;
imx319->sd.entity.function = MEDIA_ENT_F_CAM_SENSOR;
/* Initialize source pad */
imx319->pad.flags = MEDIA_PAD_FL_SOURCE;
ret = media_entity_pads_init(&imx319->sd.entity, 1, &imx319->pad);
if (ret) {
dev_err(&client->dev, "failed to init entity pads: %d", ret);
goto error_handler_free;
}
ret = v4l2_async_register_subdev_sensor(&imx319->sd);
if (ret < 0)
goto error_media_entity;
/* Set the device's state to active if it's in D0 state. */
if (full_power)
pm_runtime_set_active(&client->dev);
pm_runtime_enable(&client->dev);
pm_runtime_idle(&client->dev);
return 0;
error_media_entity:
media_entity_cleanup(&imx319->sd.entity);
error_handler_free:
v4l2_ctrl_handler_free(imx319->sd.ctrl_handler);
error_probe:
mutex_destroy(&imx319->mutex);
return ret;
}
i2c: Make remove callback return void The value returned by an i2c driver's remove function is mostly ignored. (Only an error message is printed if the value is non-zero that the error is ignored.) So change the prototype of the remove function to return no value. This way driver authors are not tempted to assume that passing an error to the upper layer is a good idea. All drivers are adapted accordingly. There is no intended change of behaviour, all callbacks were prepared to return 0 before. Reviewed-by: Peter Senna Tschudin <peter.senna@gmail.com> Reviewed-by: Jeremy Kerr <jk@codeconstruct.com.au> Reviewed-by: Benjamin Mugnier <benjamin.mugnier@foss.st.com> Reviewed-by: Javier Martinez Canillas <javierm@redhat.com> Reviewed-by: Crt Mori <cmo@melexis.com> Reviewed-by: Heikki Krogerus <heikki.krogerus@linux.intel.com> Acked-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org> Acked-by: Marek Behún <kabel@kernel.org> # for leds-turris-omnia Acked-by: Andy Shevchenko <andriy.shevchenko@linux.intel.com> Reviewed-by: Petr Machata <petrm@nvidia.com> # for mlxsw Reviewed-by: Maximilian Luz <luzmaximilian@gmail.com> # for surface3_power Acked-by: Srinivas Pandruvada <srinivas.pandruvada@linux.intel.com> # for bmc150-accel-i2c + kxcjk-1013 Reviewed-by: Hans Verkuil <hverkuil-cisco@xs4all.nl> # for media/* + staging/media/* Acked-by: Miguel Ojeda <ojeda@kernel.org> # for auxdisplay/ht16k33 + auxdisplay/lcd2s Reviewed-by: Luca Ceresoli <luca.ceresoli@bootlin.com> # for versaclock5 Reviewed-by: Ajay Gupta <ajayg@nvidia.com> # for ucsi_ccg Acked-by: Jonathan Cameron <Jonathan.Cameron@huawei.com> # for iio Acked-by: Peter Rosin <peda@axentia.se> # for i2c-mux-*, max9860 Acked-by: Adrien Grassein <adrien.grassein@gmail.com> # for lontium-lt8912b Reviewed-by: Jean Delvare <jdelvare@suse.de> # for hwmon, i2c-core and i2c/muxes Acked-by: Corey Minyard <cminyard@mvista.com> # for IPMI Reviewed-by: Vladimir Oltean <olteanv@gmail.com> Acked-by: Dmitry Torokhov <dmitry.torokhov@gmail.com> Acked-by: Sebastian Reichel <sebastian.reichel@collabora.com> # for drivers/power Acked-by: Krzysztof Hałasa <khalasa@piap.pl> Signed-off-by: Uwe Kleine-König <u.kleine-koenig@pengutronix.de> Signed-off-by: Wolfram Sang <wsa@kernel.org>
2022-08-15 16:02:30 +08:00
static void imx319_remove(struct i2c_client *client)
{
struct v4l2_subdev *sd = i2c_get_clientdata(client);
struct imx319 *imx319 = to_imx319(sd);
v4l2_async_unregister_subdev(sd);
media_entity_cleanup(&sd->entity);
v4l2_ctrl_handler_free(sd->ctrl_handler);
pm_runtime_disable(&client->dev);
pm_runtime_set_suspended(&client->dev);
mutex_destroy(&imx319->mutex);
}
static const struct dev_pm_ops imx319_pm_ops = {
SET_SYSTEM_SLEEP_PM_OPS(imx319_suspend, imx319_resume)
};
static const struct acpi_device_id imx319_acpi_ids[] __maybe_unused = {
{ "SONY319A" },
{ /* sentinel */ }
};
MODULE_DEVICE_TABLE(acpi, imx319_acpi_ids);
static struct i2c_driver imx319_i2c_driver = {
.driver = {
.name = "imx319",
.pm = &imx319_pm_ops,
.acpi_match_table = ACPI_PTR(imx319_acpi_ids),
},
.probe_new = imx319_probe,
.remove = imx319_remove,
.flags = I2C_DRV_ACPI_WAIVE_D0_PROBE,
};
module_i2c_driver(imx319_i2c_driver);
MODULE_AUTHOR("Qiu, Tianshu <tian.shu.qiu@intel.com>");
MODULE_AUTHOR("Rapolu, Chiranjeevi <chiranjeevi.rapolu@intel.com>");
MODULE_AUTHOR("Bingbu Cao <bingbu.cao@intel.com>");
MODULE_AUTHOR("Yang, Hyungwoo");
MODULE_DESCRIPTION("Sony imx319 sensor driver");
MODULE_LICENSE("GPL v2");