2020-05-11 15:41:14 +02:00
// SPDX-License-Identifier: GPL-2.0
// Copyright (c) 2020 Intel Corporation.
# include <asm/unaligned.h>
# include <linux/acpi.h>
2023-12-04 13:39:39 +01:00
# include <linux/clk.h>
2020-05-11 15:41:14 +02:00
# include <linux/delay.h>
2023-12-04 13:39:38 +01:00
# include <linux/gpio/consumer.h>
2020-05-11 15:41:14 +02:00
# include <linux/i2c.h>
# include <linux/module.h>
# include <linux/pm_runtime.h>
2020-06-12 11:42:02 +02:00
# include <linux/nvmem-provider.h>
# include <linux/regmap.h>
2020-05-11 15:41:14 +02:00
# include <media/v4l2-ctrls.h>
# include <media/v4l2-device.h>
# include <media/v4l2-fwnode.h>
# define OV2740_LINK_FREQ_360MHZ 360000000ULL
2023-12-04 13:39:44 +01:00
# define OV2740_LINK_FREQ_180MHZ 180000000ULL
2020-05-11 15:41:14 +02:00
# define OV2740_SCLK 72000000LL
# define OV2740_MCLK 19200000
# define OV2740_DATA_LANES 2
# define OV2740_RGB_DEPTH 10
# define OV2740_REG_CHIP_ID 0x300a
# define OV2740_CHIP_ID 0x2740
# define OV2740_REG_MODE_SELECT 0x0100
# define OV2740_MODE_STANDBY 0x00
# define OV2740_MODE_STREAMING 0x01
/* vertical-timings from sensor */
# define OV2740_REG_VTS 0x380e
/* horizontal-timings from sensor */
# define OV2740_REG_HTS 0x380c
/* Exposure controls from sensor */
# define OV2740_REG_EXPOSURE 0x3500
2020-09-25 03:59:20 +02:00
# define OV2740_EXPOSURE_MIN 4
2020-05-11 15:41:14 +02:00
# define OV2740_EXPOSURE_MAX_MARGIN 8
# define OV2740_EXPOSURE_STEP 1
/* Analog gain controls from sensor */
# define OV2740_REG_ANALOG_GAIN 0x3508
# define OV2740_ANAL_GAIN_MIN 128
# define OV2740_ANAL_GAIN_MAX 1983
# define OV2740_ANAL_GAIN_STEP 1
/* Digital gain controls from sensor */
# define OV2740_REG_MWB_R_GAIN 0x500a
# define OV2740_REG_MWB_G_GAIN 0x500c
# define OV2740_REG_MWB_B_GAIN 0x500e
2021-07-05 08:50:59 +02:00
# define OV2740_DGTL_GAIN_MIN 1024
2020-05-11 15:41:14 +02:00
# define OV2740_DGTL_GAIN_MAX 4095
# define OV2740_DGTL_GAIN_STEP 1
# define OV2740_DGTL_GAIN_DEFAULT 1024
/* Test Pattern Control */
# define OV2740_REG_TEST_PATTERN 0x5040
# define OV2740_TEST_PATTERN_ENABLE BIT(7)
# define OV2740_TEST_PATTERN_BAR_SHIFT 2
2021-07-05 08:50:59 +02:00
/* Group Access */
# define OV2740_REG_GROUP_ACCESS 0x3208
# define OV2740_GROUP_HOLD_START 0x0
# define OV2740_GROUP_HOLD_END 0x10
# define OV2740_GROUP_HOLD_LAUNCH 0xa0
2020-06-12 11:42:02 +02:00
/* ISP CTRL00 */
# define OV2740_REG_ISP_CTRL00 0x5000
/* ISP CTRL01 */
# define OV2740_REG_ISP_CTRL01 0x5001
/* Customer Addresses: 0x7010 - 0x710F */
# define CUSTOMER_USE_OTP_SIZE 0x100
/* OTP registers from sensor */
# define OV2740_REG_OTP_CUSTOMER 0x7010
struct nvm_data {
struct nvmem_device * nvmem ;
struct regmap * regmap ;
2020-11-13 04:06:57 +01:00
char * nvm_buffer ;
2020-06-12 11:42:02 +02:00
} ;
2020-05-11 15:41:14 +02:00
enum {
OV2740_LINK_FREQ_360MHZ_INDEX ,
2023-12-04 13:39:44 +01:00
OV2740_LINK_FREQ_180MHZ_INDEX ,
2020-05-11 15:41:14 +02:00
} ;
struct ov2740_reg {
u16 address ;
u8 val ;
} ;
struct ov2740_reg_list {
u32 num_of_regs ;
const struct ov2740_reg * regs ;
} ;
struct ov2740_link_freq_config {
const struct ov2740_reg_list reg_list ;
} ;
struct ov2740_mode {
/* Frame width in pixels */
u32 width ;
/* Frame height in pixels */
u32 height ;
/* Horizontal timining size */
u32 hts ;
/* Default vertical timining size */
u32 vts_def ;
/* Min vertical timining size */
u32 vts_min ;
2023-12-04 13:39:44 +01:00
/* Max vertical timining size */
u32 vts_max ;
2020-05-11 15:41:14 +02:00
/* Link frequency needed for this resolution */
u32 link_freq_index ;
/* Sensor register settings for this resolution */
const struct ov2740_reg_list reg_list ;
} ;
static const struct ov2740_reg mipi_data_rate_720mbps [ ] = {
{ 0x0302 , 0x4b } ,
{ 0x030d , 0x4b } ,
{ 0x030e , 0x02 } ,
{ 0x030a , 0x01 } ,
{ 0x0312 , 0x11 } ,
} ;
2023-12-04 13:39:44 +01:00
static const struct ov2740_reg mipi_data_rate_360mbps [ ] = {
{ 0x0302 , 0x4b } ,
{ 0x0303 , 0x01 } ,
{ 0x030d , 0x4b } ,
{ 0x030e , 0x02 } ,
{ 0x030a , 0x01 } ,
{ 0x0312 , 0x11 } ,
{ 0x4837 , 0x2c } ,
} ;
static const struct ov2740_reg mode_1932x1092_regs_360mhz [ ] = {
2020-05-11 15:41:14 +02:00
{ 0x3000 , 0x00 } ,
{ 0x3018 , 0x32 } ,
{ 0x3031 , 0x0a } ,
{ 0x3080 , 0x08 } ,
{ 0x3083 , 0xB4 } ,
{ 0x3103 , 0x00 } ,
{ 0x3104 , 0x01 } ,
{ 0x3106 , 0x01 } ,
{ 0x3500 , 0x00 } ,
{ 0x3501 , 0x44 } ,
{ 0x3502 , 0x40 } ,
{ 0x3503 , 0x88 } ,
{ 0x3507 , 0x00 } ,
{ 0x3508 , 0x00 } ,
{ 0x3509 , 0x80 } ,
{ 0x350c , 0x00 } ,
{ 0x350d , 0x80 } ,
{ 0x3510 , 0x00 } ,
{ 0x3511 , 0x00 } ,
{ 0x3512 , 0x20 } ,
{ 0x3632 , 0x00 } ,
{ 0x3633 , 0x10 } ,
{ 0x3634 , 0x10 } ,
{ 0x3635 , 0x10 } ,
{ 0x3645 , 0x13 } ,
{ 0x3646 , 0x81 } ,
{ 0x3636 , 0x10 } ,
{ 0x3651 , 0x0a } ,
{ 0x3656 , 0x02 } ,
{ 0x3659 , 0x04 } ,
{ 0x365a , 0xda } ,
{ 0x365b , 0xa2 } ,
{ 0x365c , 0x04 } ,
{ 0x365d , 0x1d } ,
{ 0x365e , 0x1a } ,
{ 0x3662 , 0xd7 } ,
{ 0x3667 , 0x78 } ,
{ 0x3669 , 0x0a } ,
{ 0x366a , 0x92 } ,
{ 0x3700 , 0x54 } ,
{ 0x3702 , 0x10 } ,
{ 0x3706 , 0x42 } ,
{ 0x3709 , 0x30 } ,
{ 0x370b , 0xc2 } ,
{ 0x3714 , 0x63 } ,
{ 0x3715 , 0x01 } ,
{ 0x3716 , 0x00 } ,
{ 0x371a , 0x3e } ,
{ 0x3732 , 0x0e } ,
{ 0x3733 , 0x10 } ,
{ 0x375f , 0x0e } ,
{ 0x3768 , 0x30 } ,
{ 0x3769 , 0x44 } ,
{ 0x376a , 0x22 } ,
{ 0x377b , 0x20 } ,
{ 0x377c , 0x00 } ,
{ 0x377d , 0x0c } ,
{ 0x3798 , 0x00 } ,
{ 0x37a1 , 0x55 } ,
{ 0x37a8 , 0x6d } ,
{ 0x37c2 , 0x04 } ,
{ 0x37c5 , 0x00 } ,
{ 0x37c8 , 0x00 } ,
{ 0x3800 , 0x00 } ,
{ 0x3801 , 0x00 } ,
{ 0x3802 , 0x00 } ,
{ 0x3803 , 0x00 } ,
{ 0x3804 , 0x07 } ,
{ 0x3805 , 0x8f } ,
{ 0x3806 , 0x04 } ,
{ 0x3807 , 0x47 } ,
{ 0x3808 , 0x07 } ,
{ 0x3809 , 0x88 } ,
{ 0x380a , 0x04 } ,
{ 0x380b , 0x40 } ,
{ 0x380c , 0x04 } ,
{ 0x380d , 0x38 } ,
{ 0x380e , 0x04 } ,
{ 0x380f , 0x60 } ,
{ 0x3810 , 0x00 } ,
{ 0x3811 , 0x04 } ,
{ 0x3812 , 0x00 } ,
{ 0x3813 , 0x04 } ,
{ 0x3814 , 0x01 } ,
{ 0x3815 , 0x01 } ,
{ 0x3820 , 0x80 } ,
{ 0x3821 , 0x46 } ,
{ 0x3822 , 0x84 } ,
{ 0x3829 , 0x00 } ,
{ 0x382a , 0x01 } ,
{ 0x382b , 0x01 } ,
{ 0x3830 , 0x04 } ,
{ 0x3836 , 0x01 } ,
{ 0x3837 , 0x08 } ,
{ 0x3839 , 0x01 } ,
{ 0x383a , 0x00 } ,
{ 0x383b , 0x08 } ,
{ 0x383c , 0x00 } ,
{ 0x3f0b , 0x00 } ,
{ 0x4001 , 0x20 } ,
{ 0x4009 , 0x07 } ,
{ 0x4003 , 0x10 } ,
{ 0x4010 , 0xe0 } ,
{ 0x4016 , 0x00 } ,
{ 0x4017 , 0x10 } ,
{ 0x4044 , 0x02 } ,
{ 0x4304 , 0x08 } ,
{ 0x4307 , 0x30 } ,
{ 0x4320 , 0x80 } ,
{ 0x4322 , 0x00 } ,
{ 0x4323 , 0x00 } ,
{ 0x4324 , 0x00 } ,
{ 0x4325 , 0x00 } ,
{ 0x4326 , 0x00 } ,
{ 0x4327 , 0x00 } ,
{ 0x4328 , 0x00 } ,
{ 0x4329 , 0x00 } ,
{ 0x432c , 0x03 } ,
{ 0x432d , 0x81 } ,
{ 0x4501 , 0x84 } ,
{ 0x4502 , 0x40 } ,
{ 0x4503 , 0x18 } ,
{ 0x4504 , 0x04 } ,
{ 0x4508 , 0x02 } ,
{ 0x4601 , 0x10 } ,
{ 0x4800 , 0x00 } ,
{ 0x4816 , 0x52 } ,
{ 0x4837 , 0x16 } ,
{ 0x5000 , 0x7f } ,
{ 0x5001 , 0x00 } ,
{ 0x5005 , 0x38 } ,
{ 0x501e , 0x0d } ,
{ 0x5040 , 0x00 } ,
{ 0x5901 , 0x00 } ,
{ 0x3800 , 0x00 } ,
{ 0x3801 , 0x00 } ,
{ 0x3802 , 0x00 } ,
{ 0x3803 , 0x00 } ,
{ 0x3804 , 0x07 } ,
{ 0x3805 , 0x8f } ,
{ 0x3806 , 0x04 } ,
{ 0x3807 , 0x47 } ,
{ 0x3808 , 0x07 } ,
{ 0x3809 , 0x8c } ,
{ 0x380a , 0x04 } ,
{ 0x380b , 0x44 } ,
{ 0x3810 , 0x00 } ,
{ 0x3811 , 0x00 } ,
{ 0x3812 , 0x00 } ,
{ 0x3813 , 0x01 } ,
} ;
2023-12-04 13:39:44 +01:00
static const struct ov2740_reg mode_1932x1092_regs_180mhz [ ] = {
{ 0x3000 , 0x00 } ,
{ 0x3018 , 0x32 } , /* 0x32 for 2 lanes, 0x12 for 1 lane */
{ 0x3031 , 0x0a } ,
{ 0x3080 , 0x08 } ,
{ 0x3083 , 0xB4 } ,
{ 0x3103 , 0x00 } ,
{ 0x3104 , 0x01 } ,
{ 0x3106 , 0x01 } ,
{ 0x3500 , 0x00 } ,
{ 0x3501 , 0x44 } ,
{ 0x3502 , 0x40 } ,
{ 0x3503 , 0x88 } ,
{ 0x3507 , 0x00 } ,
{ 0x3508 , 0x00 } ,
{ 0x3509 , 0x80 } ,
{ 0x350c , 0x00 } ,
{ 0x350d , 0x80 } ,
{ 0x3510 , 0x00 } ,
{ 0x3511 , 0x00 } ,
{ 0x3512 , 0x20 } ,
{ 0x3632 , 0x00 } ,
{ 0x3633 , 0x10 } ,
{ 0x3634 , 0x10 } ,
{ 0x3635 , 0x10 } ,
{ 0x3645 , 0x13 } ,
{ 0x3646 , 0x81 } ,
{ 0x3636 , 0x10 } ,
{ 0x3651 , 0x0a } ,
{ 0x3656 , 0x02 } ,
{ 0x3659 , 0x04 } ,
{ 0x365a , 0xda } ,
{ 0x365b , 0xa2 } ,
{ 0x365c , 0x04 } ,
{ 0x365d , 0x1d } ,
{ 0x365e , 0x1a } ,
{ 0x3662 , 0xd7 } ,
{ 0x3667 , 0x78 } ,
{ 0x3669 , 0x0a } ,
{ 0x366a , 0x92 } ,
{ 0x3700 , 0x54 } ,
{ 0x3702 , 0x10 } ,
{ 0x3706 , 0x42 } ,
{ 0x3709 , 0x30 } ,
{ 0x370b , 0xc2 } ,
{ 0x3714 , 0x63 } ,
{ 0x3715 , 0x01 } ,
{ 0x3716 , 0x00 } ,
{ 0x371a , 0x3e } ,
{ 0x3732 , 0x0e } ,
{ 0x3733 , 0x10 } ,
{ 0x375f , 0x0e } ,
{ 0x3768 , 0x30 } ,
{ 0x3769 , 0x44 } ,
{ 0x376a , 0x22 } ,
{ 0x377b , 0x20 } ,
{ 0x377c , 0x00 } ,
{ 0x377d , 0x0c } ,
{ 0x3798 , 0x00 } ,
{ 0x37a1 , 0x55 } ,
{ 0x37a8 , 0x6d } ,
{ 0x37c2 , 0x04 } ,
{ 0x37c5 , 0x00 } ,
{ 0x37c8 , 0x00 } ,
{ 0x3800 , 0x00 } ,
{ 0x3801 , 0x00 } ,
{ 0x3802 , 0x00 } ,
{ 0x3803 , 0x00 } ,
{ 0x3804 , 0x07 } ,
{ 0x3805 , 0x8f } ,
{ 0x3806 , 0x04 } ,
{ 0x3807 , 0x47 } ,
{ 0x3808 , 0x07 } ,
{ 0x3809 , 0x88 } ,
{ 0x380a , 0x04 } ,
{ 0x380b , 0x40 } ,
{ 0x380c , 0x08 } ,
{ 0x380d , 0x70 } ,
{ 0x380e , 0x04 } ,
{ 0x380f , 0x56 } ,
{ 0x3810 , 0x00 } ,
{ 0x3811 , 0x04 } ,
{ 0x3812 , 0x00 } ,
{ 0x3813 , 0x04 } ,
{ 0x3814 , 0x01 } ,
{ 0x3815 , 0x01 } ,
{ 0x3820 , 0x80 } ,
{ 0x3821 , 0x46 } ,
{ 0x3822 , 0x84 } ,
{ 0x3829 , 0x00 } ,
{ 0x382a , 0x01 } ,
{ 0x382b , 0x01 } ,
{ 0x3830 , 0x04 } ,
{ 0x3836 , 0x01 } ,
{ 0x3837 , 0x08 } ,
{ 0x3839 , 0x01 } ,
{ 0x383a , 0x00 } ,
{ 0x383b , 0x08 } ,
{ 0x383c , 0x00 } ,
{ 0x3f0b , 0x00 } ,
{ 0x4001 , 0x20 } ,
{ 0x4009 , 0x07 } ,
{ 0x4003 , 0x10 } ,
{ 0x4010 , 0xe0 } ,
{ 0x4016 , 0x00 } ,
{ 0x4017 , 0x10 } ,
{ 0x4044 , 0x02 } ,
{ 0x4304 , 0x08 } ,
{ 0x4307 , 0x30 } ,
{ 0x4320 , 0x80 } ,
{ 0x4322 , 0x00 } ,
{ 0x4323 , 0x00 } ,
{ 0x4324 , 0x00 } ,
{ 0x4325 , 0x00 } ,
{ 0x4326 , 0x00 } ,
{ 0x4327 , 0x00 } ,
{ 0x4328 , 0x00 } ,
{ 0x4329 , 0x00 } ,
{ 0x432c , 0x03 } ,
{ 0x432d , 0x81 } ,
{ 0x4501 , 0x84 } ,
{ 0x4502 , 0x40 } ,
{ 0x4503 , 0x18 } ,
{ 0x4504 , 0x04 } ,
{ 0x4508 , 0x02 } ,
{ 0x4601 , 0x10 } ,
{ 0x4800 , 0x00 } ,
{ 0x4816 , 0x52 } ,
{ 0x5000 , 0x73 } , /* 0x7f enable DPC */
{ 0x5001 , 0x00 } ,
{ 0x5005 , 0x38 } ,
{ 0x501e , 0x0d } ,
{ 0x5040 , 0x00 } ,
{ 0x5901 , 0x00 } ,
{ 0x3800 , 0x00 } ,
{ 0x3801 , 0x00 } ,
{ 0x3802 , 0x00 } ,
{ 0x3803 , 0x00 } ,
{ 0x3804 , 0x07 } ,
{ 0x3805 , 0x8f } ,
{ 0x3806 , 0x04 } ,
{ 0x3807 , 0x47 } ,
{ 0x3808 , 0x07 } ,
{ 0x3809 , 0x8c } ,
{ 0x380a , 0x04 } ,
{ 0x380b , 0x44 } ,
{ 0x3810 , 0x00 } ,
{ 0x3811 , 0x00 } ,
{ 0x3812 , 0x00 } ,
{ 0x3813 , 0x01 } ,
{ 0x4003 , 0x40 } , /* set Black level to 0x40 */
} ;
2020-05-11 15:41:14 +02:00
static const char * const ov2740_test_pattern_menu [ ] = {
" Disabled " ,
" Color Bar " ,
" Top-Bottom Darker Color Bar " ,
" Right-Left Darker Color Bar " ,
" Bottom-Top Darker Color Bar " ,
} ;
static const s64 link_freq_menu_items [ ] = {
OV2740_LINK_FREQ_360MHZ ,
2023-12-04 13:39:44 +01:00
OV2740_LINK_FREQ_180MHZ ,
2020-05-11 15:41:14 +02:00
} ;
static const struct ov2740_link_freq_config link_freq_configs [ ] = {
[ OV2740_LINK_FREQ_360MHZ_INDEX ] = {
. reg_list = {
. num_of_regs = ARRAY_SIZE ( mipi_data_rate_720mbps ) ,
. regs = mipi_data_rate_720mbps ,
}
} ,
2023-12-04 13:39:44 +01:00
[ OV2740_LINK_FREQ_180MHZ_INDEX ] = {
. reg_list = {
. num_of_regs = ARRAY_SIZE ( mipi_data_rate_360mbps ) ,
. regs = mipi_data_rate_360mbps ,
}
} ,
2020-05-11 15:41:14 +02:00
} ;
2023-12-04 13:39:44 +01:00
static const struct ov2740_mode supported_modes_360mhz [ ] = {
2020-05-11 15:41:14 +02:00
{
. width = 1932 ,
. height = 1092 ,
2023-12-04 13:39:42 +01:00
. hts = 2160 ,
2023-12-04 13:39:44 +01:00
. vts_min = 1120 ,
. vts_def = 2186 ,
. vts_max = 32767 ,
2020-05-11 15:41:14 +02:00
. reg_list = {
2023-12-04 13:39:44 +01:00
. num_of_regs = ARRAY_SIZE ( mode_1932x1092_regs_360mhz ) ,
. regs = mode_1932x1092_regs_360mhz ,
2020-05-11 15:41:14 +02:00
} ,
. link_freq_index = OV2740_LINK_FREQ_360MHZ_INDEX ,
} ,
} ;
2023-12-04 13:39:44 +01:00
static const struct ov2740_mode supported_modes_180mhz [ ] = {
{
. width = 1932 ,
. height = 1092 ,
. hts = 2160 ,
. vts_min = 1110 ,
. vts_def = 1110 ,
. vts_max = 2047 ,
. reg_list = {
. num_of_regs = ARRAY_SIZE ( mode_1932x1092_regs_180mhz ) ,
. regs = mode_1932x1092_regs_180mhz ,
} ,
. link_freq_index = OV2740_LINK_FREQ_180MHZ_INDEX ,
} ,
} ;
2020-05-11 15:41:14 +02:00
struct ov2740 {
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 ;
2023-12-04 13:39:38 +01:00
/* GPIOs, clocks */
struct gpio_desc * reset_gpio ;
2023-12-04 13:39:39 +01:00
struct clk * clk ;
2023-12-04 13:39:38 +01:00
2020-05-11 15:41:14 +02:00
/* Current mode */
const struct ov2740_mode * cur_mode ;
2020-11-13 04:06:57 +01:00
/* NVM data inforamtion */
struct nvm_data * nvm ;
2021-12-15 12:09:00 +01:00
2023-12-04 13:39:44 +01:00
/* Supported modes */
const struct ov2740_mode * supported_modes ;
int supported_modes_count ;
2021-12-15 12:09:00 +01:00
/* True if the device has been identified */
bool identified ;
2020-05-11 15:41:14 +02:00
} ;
static inline struct ov2740 * to_ov2740 ( struct v4l2_subdev * subdev )
{
return container_of ( subdev , struct ov2740 , sd ) ;
}
static u64 to_pixel_rate ( u32 f_index )
{
u64 pixel_rate = link_freq_menu_items [ f_index ] * 2 * OV2740_DATA_LANES ;
do_div ( pixel_rate , OV2740_RGB_DEPTH ) ;
return pixel_rate ;
}
static int ov2740_read_reg ( struct ov2740 * ov2740 , u16 reg , u16 len , u32 * val )
{
struct i2c_client * client = v4l2_get_subdevdata ( & ov2740 - > sd ) ;
struct i2c_msg msgs [ 2 ] ;
u8 addr_buf [ 2 ] ;
u8 data_buf [ 4 ] = { 0 } ;
2022-07-26 13:05:53 +01:00
int ret ;
2020-05-11 15:41:14 +02:00
if ( len > sizeof ( data_buf ) )
return - EINVAL ;
put_unaligned_be16 ( reg , addr_buf ) ;
msgs [ 0 ] . addr = client - > addr ;
msgs [ 0 ] . flags = 0 ;
msgs [ 0 ] . len = sizeof ( addr_buf ) ;
msgs [ 0 ] . buf = addr_buf ;
msgs [ 1 ] . addr = client - > addr ;
msgs [ 1 ] . flags = I2C_M_RD ;
msgs [ 1 ] . len = len ;
msgs [ 1 ] . buf = & data_buf [ sizeof ( data_buf ) - len ] ;
ret = i2c_transfer ( client - > adapter , msgs , ARRAY_SIZE ( msgs ) ) ;
if ( ret ! = ARRAY_SIZE ( msgs ) )
return ret < 0 ? ret : - EIO ;
* val = get_unaligned_be32 ( data_buf ) ;
return 0 ;
}
static int ov2740_write_reg ( struct ov2740 * ov2740 , u16 reg , u16 len , u32 val )
{
struct i2c_client * client = v4l2_get_subdevdata ( & ov2740 - > sd ) ;
u8 buf [ 6 ] ;
2022-07-26 13:05:53 +01:00
int ret ;
2020-05-11 15:41:14 +02:00
if ( len > 4 )
return - EINVAL ;
put_unaligned_be16 ( reg , buf ) ;
put_unaligned_be32 ( val < < 8 * ( 4 - len ) , buf + 2 ) ;
ret = i2c_master_send ( client , buf , len + 2 ) ;
if ( ret ! = len + 2 )
return ret < 0 ? ret : - EIO ;
return 0 ;
}
static int ov2740_write_reg_list ( struct ov2740 * ov2740 ,
const struct ov2740_reg_list * r_list )
{
struct i2c_client * client = v4l2_get_subdevdata ( & ov2740 - > sd ) ;
unsigned int i ;
2022-07-26 13:05:53 +01:00
int ret ;
2020-05-11 15:41:14 +02:00
for ( i = 0 ; i < r_list - > num_of_regs ; i + + ) {
ret = ov2740_write_reg ( ov2740 , r_list - > regs [ i ] . address , 1 ,
r_list - > regs [ i ] . val ) ;
if ( ret ) {
dev_err_ratelimited ( & client - > dev ,
2022-07-26 13:05:55 +01:00
" write reg 0x%4.4x return err = %d \n " ,
2020-05-11 15:41:14 +02:00
r_list - > regs [ i ] . address , ret ) ;
return ret ;
}
}
return 0 ;
}
2021-12-15 12:09:00 +01:00
static int ov2740_identify_module ( struct ov2740 * ov2740 )
{
struct i2c_client * client = v4l2_get_subdevdata ( & ov2740 - > sd ) ;
int ret ;
u32 val ;
if ( ov2740 - > identified )
return 0 ;
ret = ov2740_read_reg ( ov2740 , OV2740_REG_CHIP_ID , 3 , & val ) ;
if ( ret )
return ret ;
if ( val ! = OV2740_CHIP_ID ) {
2022-07-26 13:05:55 +01:00
dev_err ( & client - > dev , " chip id mismatch: %x != %x \n " ,
2021-12-15 12:09:00 +01:00
OV2740_CHIP_ID , val ) ;
return - ENXIO ;
}
ov2740 - > identified = true ;
return 0 ;
}
2020-05-11 15:41:14 +02:00
static int ov2740_update_digital_gain ( struct ov2740 * ov2740 , u32 d_gain )
{
2022-07-26 13:05:53 +01:00
int ret ;
2020-05-11 15:41:14 +02:00
2021-07-05 08:50:59 +02:00
ret = ov2740_write_reg ( ov2740 , OV2740_REG_GROUP_ACCESS , 1 ,
OV2740_GROUP_HOLD_START ) ;
if ( ret )
return ret ;
2020-05-11 15:41:14 +02:00
ret = ov2740_write_reg ( ov2740 , OV2740_REG_MWB_R_GAIN , 2 , d_gain ) ;
if ( ret )
return ret ;
ret = ov2740_write_reg ( ov2740 , OV2740_REG_MWB_G_GAIN , 2 , d_gain ) ;
if ( ret )
return ret ;
2021-07-05 08:50:59 +02:00
ret = ov2740_write_reg ( ov2740 , OV2740_REG_MWB_B_GAIN , 2 , d_gain ) ;
if ( ret )
return ret ;
ret = ov2740_write_reg ( ov2740 , OV2740_REG_GROUP_ACCESS , 1 ,
OV2740_GROUP_HOLD_END ) ;
if ( ret )
return ret ;
ret = ov2740_write_reg ( ov2740 , OV2740_REG_GROUP_ACCESS , 1 ,
OV2740_GROUP_HOLD_LAUNCH ) ;
return ret ;
2020-05-11 15:41:14 +02:00
}
static int ov2740_test_pattern ( struct ov2740 * ov2740 , u32 pattern )
{
if ( pattern )
pattern = ( pattern - 1 ) < < OV2740_TEST_PATTERN_BAR_SHIFT |
OV2740_TEST_PATTERN_ENABLE ;
return ov2740_write_reg ( ov2740 , OV2740_REG_TEST_PATTERN , 1 , pattern ) ;
}
static int ov2740_set_ctrl ( struct v4l2_ctrl * ctrl )
{
struct ov2740 * ov2740 = container_of ( ctrl - > handler ,
struct ov2740 , ctrl_handler ) ;
struct i2c_client * client = v4l2_get_subdevdata ( & ov2740 - > sd ) ;
s64 exposure_max ;
2022-07-26 13:05:53 +01:00
int ret ;
2020-05-11 15:41:14 +02:00
/* Propagate change of current control to all related controls */
if ( ctrl - > id = = V4L2_CID_VBLANK ) {
/* Update max exposure while meeting expected vblanking */
exposure_max = ov2740 - > cur_mode - > height + ctrl - > val -
OV2740_EXPOSURE_MAX_MARGIN ;
__v4l2_ctrl_modify_range ( ov2740 - > exposure ,
ov2740 - > exposure - > minimum ,
exposure_max , ov2740 - > exposure - > step ,
exposure_max ) ;
}
/* V4L2 controls values will be applied only when power is already up */
if ( ! pm_runtime_get_if_in_use ( & client - > dev ) )
return 0 ;
switch ( ctrl - > id ) {
case V4L2_CID_ANALOGUE_GAIN :
ret = ov2740_write_reg ( ov2740 , OV2740_REG_ANALOG_GAIN , 2 ,
ctrl - > val ) ;
break ;
case V4L2_CID_DIGITAL_GAIN :
ret = ov2740_update_digital_gain ( ov2740 , ctrl - > val ) ;
break ;
case V4L2_CID_EXPOSURE :
/* 4 least significant bits of expsoure are fractional part */
ret = ov2740_write_reg ( ov2740 , OV2740_REG_EXPOSURE , 3 ,
ctrl - > val < < 4 ) ;
break ;
case V4L2_CID_VBLANK :
ret = ov2740_write_reg ( ov2740 , OV2740_REG_VTS , 2 ,
ov2740 - > cur_mode - > height + ctrl - > val ) ;
break ;
case V4L2_CID_TEST_PATTERN :
ret = ov2740_test_pattern ( ov2740 , ctrl - > val ) ;
break ;
default :
ret = - EINVAL ;
break ;
}
pm_runtime_put ( & client - > dev ) ;
return ret ;
}
static const struct v4l2_ctrl_ops ov2740_ctrl_ops = {
. s_ctrl = ov2740_set_ctrl ,
} ;
static int ov2740_init_controls ( struct ov2740 * ov2740 )
{
struct v4l2_ctrl_handler * ctrl_hdlr ;
const struct ov2740_mode * cur_mode ;
s64 exposure_max , h_blank , pixel_rate ;
u32 vblank_min , vblank_max , vblank_default ;
int size ;
2022-07-26 13:05:53 +01:00
int ret ;
2020-05-11 15:41:14 +02:00
ctrl_hdlr = & ov2740 - > ctrl_handler ;
ret = v4l2_ctrl_handler_init ( ctrl_hdlr , 8 ) ;
if ( ret )
return ret ;
cur_mode = ov2740 - > cur_mode ;
size = ARRAY_SIZE ( link_freq_menu_items ) ;
2024-03-27 10:57:31 +02:00
ov2740 - > link_freq =
v4l2_ctrl_new_int_menu ( ctrl_hdlr , & ov2740_ctrl_ops ,
V4L2_CID_LINK_FREQ , size - 1 ,
ov2740 - > supported_modes - > link_freq_index ,
link_freq_menu_items ) ;
2020-05-11 15:41:14 +02:00
if ( ov2740 - > link_freq )
ov2740 - > link_freq - > flags | = V4L2_CTRL_FLAG_READ_ONLY ;
2024-03-27 10:57:31 +02:00
pixel_rate = to_pixel_rate ( ov2740 - > supported_modes - > link_freq_index ) ;
2020-05-11 15:41:14 +02:00
ov2740 - > pixel_rate = v4l2_ctrl_new_std ( ctrl_hdlr , & ov2740_ctrl_ops ,
V4L2_CID_PIXEL_RATE , 0 ,
pixel_rate , 1 , pixel_rate ) ;
vblank_min = cur_mode - > vts_min - cur_mode - > height ;
2023-12-04 13:39:44 +01:00
vblank_max = cur_mode - > vts_max - cur_mode - > height ;
2020-05-11 15:41:14 +02:00
vblank_default = cur_mode - > vts_def - cur_mode - > height ;
ov2740 - > vblank = v4l2_ctrl_new_std ( ctrl_hdlr , & ov2740_ctrl_ops ,
V4L2_CID_VBLANK , vblank_min ,
vblank_max , 1 , vblank_default ) ;
2023-12-04 13:39:42 +01:00
h_blank = cur_mode - > hts - cur_mode - > width ;
2020-05-11 15:41:14 +02:00
ov2740 - > hblank = v4l2_ctrl_new_std ( ctrl_hdlr , & ov2740_ctrl_ops ,
V4L2_CID_HBLANK , h_blank , h_blank , 1 ,
h_blank ) ;
if ( ov2740 - > hblank )
ov2740 - > hblank - > flags | = V4L2_CTRL_FLAG_READ_ONLY ;
v4l2_ctrl_new_std ( ctrl_hdlr , & ov2740_ctrl_ops , V4L2_CID_ANALOGUE_GAIN ,
OV2740_ANAL_GAIN_MIN , OV2740_ANAL_GAIN_MAX ,
OV2740_ANAL_GAIN_STEP , OV2740_ANAL_GAIN_MIN ) ;
v4l2_ctrl_new_std ( ctrl_hdlr , & ov2740_ctrl_ops , V4L2_CID_DIGITAL_GAIN ,
OV2740_DGTL_GAIN_MIN , OV2740_DGTL_GAIN_MAX ,
OV2740_DGTL_GAIN_STEP , OV2740_DGTL_GAIN_DEFAULT ) ;
exposure_max = cur_mode - > vts_def - OV2740_EXPOSURE_MAX_MARGIN ;
ov2740 - > exposure = v4l2_ctrl_new_std ( ctrl_hdlr , & ov2740_ctrl_ops ,
V4L2_CID_EXPOSURE ,
OV2740_EXPOSURE_MIN , exposure_max ,
OV2740_EXPOSURE_STEP ,
exposure_max ) ;
v4l2_ctrl_new_std_menu_items ( ctrl_hdlr , & ov2740_ctrl_ops ,
V4L2_CID_TEST_PATTERN ,
ARRAY_SIZE ( ov2740_test_pattern_menu ) - 1 ,
0 , 0 , ov2740_test_pattern_menu ) ;
2022-12-08 08:59:37 +01:00
if ( ctrl_hdlr - > error ) {
v4l2_ctrl_handler_free ( ctrl_hdlr ) ;
2020-05-11 15:41:14 +02:00
return ctrl_hdlr - > error ;
2022-12-08 08:59:37 +01:00
}
2020-05-11 15:41:14 +02:00
ov2740 - > sd . ctrl_handler = ctrl_hdlr ;
return 0 ;
}
static void ov2740_update_pad_format ( const struct ov2740_mode * mode ,
struct v4l2_mbus_framefmt * fmt )
{
fmt - > width = mode - > width ;
fmt - > height = mode - > height ;
fmt - > code = MEDIA_BUS_FMT_SGRBG10_1X10 ;
fmt - > field = V4L2_FIELD_NONE ;
}
2020-11-13 04:06:58 +01:00
static int ov2740_load_otp_data ( struct nvm_data * nvm )
{
2022-07-26 13:05:49 +01:00
struct device * dev = regmap_get_device ( nvm - > regmap ) ;
struct ov2740 * ov2740 = to_ov2740 ( dev_get_drvdata ( dev ) ) ;
2020-11-13 04:06:58 +01:00
u32 isp_ctrl00 = 0 ;
u32 isp_ctrl01 = 0 ;
int ret ;
if ( nvm - > nvm_buffer )
return 0 ;
nvm - > nvm_buffer = kzalloc ( CUSTOMER_USE_OTP_SIZE , GFP_KERNEL ) ;
if ( ! nvm - > nvm_buffer )
return - ENOMEM ;
ret = ov2740_read_reg ( ov2740 , OV2740_REG_ISP_CTRL00 , 1 , & isp_ctrl00 ) ;
if ( ret ) {
2022-07-26 13:05:49 +01:00
dev_err ( dev , " failed to read ISP CTRL00 \n " ) ;
2020-11-13 04:06:58 +01:00
goto err ;
}
ret = ov2740_read_reg ( ov2740 , OV2740_REG_ISP_CTRL01 , 1 , & isp_ctrl01 ) ;
if ( ret ) {
2022-07-26 13:05:49 +01:00
dev_err ( dev , " failed to read ISP CTRL01 \n " ) ;
2020-11-13 04:06:58 +01:00
goto err ;
}
/* Clear bit 5 of ISP CTRL00 */
ret = ov2740_write_reg ( ov2740 , OV2740_REG_ISP_CTRL00 , 1 ,
isp_ctrl00 & ~ BIT ( 5 ) ) ;
if ( ret ) {
2022-07-26 13:05:49 +01:00
dev_err ( dev , " failed to set ISP CTRL00 \n " ) ;
2020-11-13 04:06:58 +01:00
goto err ;
}
/* Clear bit 7 of ISP CTRL01 */
ret = ov2740_write_reg ( ov2740 , OV2740_REG_ISP_CTRL01 , 1 ,
isp_ctrl01 & ~ BIT ( 7 ) ) ;
if ( ret ) {
2022-07-26 13:05:49 +01:00
dev_err ( dev , " failed to set ISP CTRL01 \n " ) ;
2020-11-13 04:06:58 +01:00
goto err ;
}
ret = ov2740_write_reg ( ov2740 , OV2740_REG_MODE_SELECT , 1 ,
OV2740_MODE_STREAMING ) ;
if ( ret ) {
2022-07-26 13:05:49 +01:00
dev_err ( dev , " failed to set streaming mode \n " ) ;
2020-11-13 04:06:58 +01:00
goto err ;
}
/*
* Users are not allowed to access OTP - related registers and memory
* during the 20 ms period after streaming starts ( 0x100 = 0x01 ) .
*/
msleep ( 20 ) ;
ret = regmap_bulk_read ( nvm - > regmap , OV2740_REG_OTP_CUSTOMER ,
nvm - > nvm_buffer , CUSTOMER_USE_OTP_SIZE ) ;
if ( ret ) {
2022-07-26 13:05:49 +01:00
dev_err ( dev , " failed to read OTP data, ret %d \n " , ret ) ;
2020-11-13 04:06:58 +01:00
goto err ;
}
ret = ov2740_write_reg ( ov2740 , OV2740_REG_MODE_SELECT , 1 ,
OV2740_MODE_STANDBY ) ;
if ( ret ) {
2022-07-26 13:05:49 +01:00
dev_err ( dev , " failed to set streaming mode \n " ) ;
2020-11-13 04:06:58 +01:00
goto err ;
}
ret = ov2740_write_reg ( ov2740 , OV2740_REG_ISP_CTRL01 , 1 , isp_ctrl01 ) ;
if ( ret ) {
2022-07-26 13:05:49 +01:00
dev_err ( dev , " failed to set ISP CTRL01 \n " ) ;
2020-11-13 04:06:58 +01:00
goto err ;
}
ret = ov2740_write_reg ( ov2740 , OV2740_REG_ISP_CTRL00 , 1 , isp_ctrl00 ) ;
if ( ret ) {
2022-07-26 13:05:49 +01:00
dev_err ( dev , " failed to set ISP CTRL00 \n " ) ;
2020-11-13 04:06:58 +01:00
goto err ;
}
return 0 ;
err :
kfree ( nvm - > nvm_buffer ) ;
nvm - > nvm_buffer = NULL ;
return ret ;
}
2020-05-11 15:41:14 +02:00
static int ov2740_start_streaming ( struct ov2740 * ov2740 )
{
struct i2c_client * client = v4l2_get_subdevdata ( & ov2740 - > sd ) ;
const struct ov2740_reg_list * reg_list ;
int link_freq_index ;
2022-07-26 13:05:53 +01:00
int ret ;
2020-05-11 15:41:14 +02:00
2021-12-15 12:09:00 +01:00
ret = ov2740_identify_module ( ov2740 ) ;
if ( ret )
return ret ;
2022-07-26 13:05:49 +01:00
if ( ov2740 - > nvm )
ov2740_load_otp_data ( ov2740 - > nvm ) ;
2020-11-13 04:06:58 +01:00
2023-12-04 13:39:45 +01:00
/* Reset the sensor */
ret = ov2740_write_reg ( ov2740 , 0x0103 , 1 , 0x01 ) ;
if ( ret ) {
dev_err ( & client - > dev , " failed to reset \n " ) ;
return ret ;
}
usleep_range ( 10000 , 15000 ) ;
2020-05-11 15:41:14 +02:00
link_freq_index = ov2740 - > cur_mode - > link_freq_index ;
reg_list = & link_freq_configs [ link_freq_index ] . reg_list ;
ret = ov2740_write_reg_list ( ov2740 , reg_list ) ;
if ( ret ) {
2022-07-26 13:05:55 +01:00
dev_err ( & client - > dev , " failed to set plls \n " ) ;
2020-05-11 15:41:14 +02:00
return ret ;
}
reg_list = & ov2740 - > cur_mode - > reg_list ;
ret = ov2740_write_reg_list ( ov2740 , reg_list ) ;
if ( ret ) {
2022-07-26 13:05:55 +01:00
dev_err ( & client - > dev , " failed to set mode \n " ) ;
2020-05-11 15:41:14 +02:00
return ret ;
}
ret = __v4l2_ctrl_handler_setup ( ov2740 - > sd . ctrl_handler ) ;
if ( ret )
return ret ;
ret = ov2740_write_reg ( ov2740 , OV2740_REG_MODE_SELECT , 1 ,
OV2740_MODE_STREAMING ) ;
if ( ret )
2022-07-26 13:05:55 +01:00
dev_err ( & client - > dev , " failed to start streaming \n " ) ;
2020-05-11 15:41:14 +02:00
return ret ;
}
static void ov2740_stop_streaming ( struct ov2740 * ov2740 )
{
struct i2c_client * client = v4l2_get_subdevdata ( & ov2740 - > sd ) ;
if ( ov2740_write_reg ( ov2740 , OV2740_REG_MODE_SELECT , 1 ,
OV2740_MODE_STANDBY ) )
2022-07-26 13:05:55 +01:00
dev_err ( & client - > dev , " failed to stop streaming \n " ) ;
2020-05-11 15:41:14 +02:00
}
static int ov2740_set_stream ( struct v4l2_subdev * sd , int enable )
{
struct ov2740 * ov2740 = to_ov2740 ( sd ) ;
struct i2c_client * client = v4l2_get_subdevdata ( sd ) ;
2023-09-07 15:10:03 +03:00
struct v4l2_subdev_state * sd_state ;
2020-05-11 15:41:14 +02:00
int ret = 0 ;
2023-09-07 15:10:03 +03:00
sd_state = v4l2_subdev_lock_and_get_active_state ( & ov2740 - > sd ) ;
2020-05-11 15:41:14 +02:00
if ( enable ) {
2021-04-23 17:19:15 +02:00
ret = pm_runtime_resume_and_get ( & client - > dev ) ;
2023-09-07 15:10:03 +03:00
if ( ret < 0 )
goto out_unlock ;
2020-05-11 15:41:14 +02:00
ret = ov2740_start_streaming ( ov2740 ) ;
if ( ret ) {
enable = 0 ;
ov2740_stop_streaming ( ov2740 ) ;
pm_runtime_put ( & client - > dev ) ;
}
} else {
ov2740_stop_streaming ( ov2740 ) ;
pm_runtime_put ( & client - > dev ) ;
}
2023-09-07 15:10:03 +03:00
out_unlock :
v4l2_subdev_unlock_state ( sd_state ) ;
2020-05-11 15:41:14 +02:00
return ret ;
}
static int ov2740_set_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 17:55:58 +03:00
struct v4l2_subdev_state * sd_state ,
2020-05-11 15:41:14 +02:00
struct v4l2_subdev_format * fmt )
{
struct ov2740 * ov2740 = to_ov2740 ( sd ) ;
const struct ov2740_mode * mode ;
s32 vblank_def , h_blank ;
2023-12-04 13:39:44 +01:00
mode = v4l2_find_nearest_size ( ov2740 - > supported_modes ,
ov2740 - > supported_modes_count ,
width , height ,
fmt - > format . width , fmt - > format . height ) ;
2020-05-11 15:41:14 +02:00
ov2740_update_pad_format ( mode , & fmt - > format ) ;
media: v4l: subdev: Switch to stream-aware state functions
Switch all drivers accessing sub-device state to use the stream-aware
functions. We will soon remove the old ones.
This patch has been generated using the following Coccinelle script:
---------8<------------
@@
expression E1, E2, E3;
@@
- v4l2_subdev_get_pad_format(E1, E2, E3)
+ v4l2_subdev_state_get_format(E2, E3)
@@
expression E1, E2, E3;
@@
- v4l2_subdev_get_pad_crop(E1, E2, E3)
+ v4l2_subdev_state_get_crop(E2, E3)
@@
expression E1, E2, E3;
@@
- v4l2_subdev_get_pad_compose(E1, E2, E3)
+ v4l2_subdev_state_get_compose(E2, E3)
@@
expression E1, E2, E3;
@@
- v4l2_subdev_get_try_format(E1, E2, E3)
+ v4l2_subdev_state_get_format(E2, E3)
@@
expression E1, E2, E3;
@@
- v4l2_subdev_get_try_crop(E1, E2, E3)
+ v4l2_subdev_state_get_crop(E2, E3)
@@
expression E1, E2, E3;
@@
- v4l2_subdev_get_try_compose(E1, E2, E3)
+ v4l2_subdev_state_get_compose(E2, E3)
---------8<------------
Additionally drivers/media/i2c/s5k5baf.c and
drivers/media/platform/samsung/s3c-camif/camif-capture.c have been
manually changed as Coccinelle didn't. Further local variables have been
removed as they became unused as a result of the other changes.
Also Coccinelle introduced indentation by space in files
drivers/media/i2c/st-mipid02.c and
drivers/media/platform/rockchip/rkisp1/rkisp1-isp.c. This has been also
corrected.
The diff from Coccinelle-generated changes are:
> diff --git b/drivers/media/i2c/imx319.c a/drivers/media/i2c/imx319.c
> index e549692ff478..420984382173 100644
> --- b/drivers/media/i2c/imx319.c
> +++ a/drivers/media/i2c/imx319.c
> @@ -2001,7 +2001,6 @@ static int imx319_do_get_pad_format(struct imx319 *imx319,
> struct v4l2_subdev_format *fmt)
> {
> struct v4l2_mbus_framefmt *framefmt;
> - struct v4l2_subdev *sd = &imx319->sd;
>
> if (fmt->which == V4L2_SUBDEV_FORMAT_TRY) {
> framefmt = v4l2_subdev_state_get_format(sd_state, fmt->pad);
> diff --git b/drivers/media/i2c/imx355.c a/drivers/media/i2c/imx355.c
> index 96bdde685d65..e1b1d2fc79dd 100644
> --- b/drivers/media/i2c/imx355.c
> +++ a/drivers/media/i2c/imx355.c
> @@ -1299,7 +1299,6 @@ static int imx355_do_get_pad_format(struct imx355 *imx355,
> struct v4l2_subdev_format *fmt)
> {
> struct v4l2_mbus_framefmt *framefmt;
> - struct v4l2_subdev *sd = &imx355->sd;
>
> if (fmt->which == V4L2_SUBDEV_FORMAT_TRY) {
> framefmt = v4l2_subdev_state_get_format(sd_state, fmt->pad);
> diff --git b/drivers/media/i2c/ov08x40.c a/drivers/media/i2c/ov08x40.c
> index ca799bbcfdb7..abbb0b774d43 100644
> --- b/drivers/media/i2c/ov08x40.c
> +++ a/drivers/media/i2c/ov08x40.c
> @@ -2774,7 +2774,6 @@ static int ov08x40_do_get_pad_format(struct ov08x40 *ov08x,
> struct v4l2_subdev_format *fmt)
> {
> struct v4l2_mbus_framefmt *framefmt;
> - struct v4l2_subdev *sd = &ov08x->sd;
>
> if (fmt->which == V4L2_SUBDEV_FORMAT_TRY) {
> framefmt = v4l2_subdev_state_get_format(sd_state, fmt->pad);
> diff --git b/drivers/media/i2c/ov13858.c a/drivers/media/i2c/ov13858.c
> index 7816d9787c61..09387e335d80 100644
> --- b/drivers/media/i2c/ov13858.c
> +++ a/drivers/media/i2c/ov13858.c
> @@ -1316,7 +1316,6 @@ static int ov13858_do_get_pad_format(struct ov13858 *ov13858,
> struct v4l2_subdev_format *fmt)
> {
> struct v4l2_mbus_framefmt *framefmt;
> - struct v4l2_subdev *sd = &ov13858->sd;
>
> if (fmt->which == V4L2_SUBDEV_FORMAT_TRY) {
> framefmt = v4l2_subdev_state_get_format(sd_state, fmt->pad);
> diff --git b/drivers/media/i2c/ov13b10.c a/drivers/media/i2c/ov13b10.c
> index 268cd4b03f9c..c06411d5ee2b 100644
> --- b/drivers/media/i2c/ov13b10.c
> +++ a/drivers/media/i2c/ov13b10.c
> @@ -1001,7 +1001,6 @@ static int ov13b10_do_get_pad_format(struct ov13b10 *ov13b,
> struct v4l2_subdev_format *fmt)
> {
> struct v4l2_mbus_framefmt *framefmt;
> - struct v4l2_subdev *sd = &ov13b->sd;
>
> if (fmt->which == V4L2_SUBDEV_FORMAT_TRY) {
> framefmt = v4l2_subdev_state_get_format(sd_state, fmt->pad);
> diff --git b/drivers/media/i2c/s5c73m3/s5c73m3-core.c a/drivers/media/i2c/s5c73m3/s5c73m3-core.c
> index 47605e36bc60..8f9b5713daf7 100644
> --- b/drivers/media/i2c/s5c73m3/s5c73m3-core.c
> +++ a/drivers/media/i2c/s5c73m3/s5c73m3-core.c
> @@ -819,7 +819,6 @@ static void s5c73m3_oif_try_format(struct s5c73m3 *state,
> struct v4l2_subdev_format *fmt,
> const struct s5c73m3_frame_size **fs)
> {
> - struct v4l2_subdev *sd = &state->sensor_sd;
> u32 code;
>
> switch (fmt->pad) {
> diff --git a/drivers/media/i2c/s5k5baf.c b/drivers/media/i2c/s5k5baf.c
> index 67da2045f543..03ccfb0e1e11 100644
> --- a/drivers/media/i2c/s5k5baf.c
> +++ b/drivers/media/i2c/s5k5baf.c
> @@ -1472,14 +1472,11 @@ static int s5k5baf_set_selection(struct v4l2_subdev *sd,
>
> if (sel->which == V4L2_SUBDEV_FORMAT_TRY) {
> rects = (struct v4l2_rect * []) {
> - &s5k5baf_cis_rect,
> - v4l2_subdev_get_try_crop(sd, sd_state,
> - PAD_CIS),
> - v4l2_subdev_get_try_compose(sd, sd_state,
> - PAD_CIS),
> - v4l2_subdev_get_try_crop(sd, sd_state,
> - PAD_OUT)
> - };
> + &s5k5baf_cis_rect,
> + v4l2_subdev_state_get_crop(sd_state, PAD_CIS),
> + v4l2_subdev_state_get_compose(sd_state, PAD_CIS),
> + v4l2_subdev_state_get_crop(sd_state, PAD_OUT)
> + };
> s5k5baf_set_rect_and_adjust(rects, rtype, &sel->r);
> return 0;
> }
> diff --git b/drivers/media/platform/samsung/s3c-camif/camif-capture.c a/drivers/media/platform/samsung/s3c-camif/camif-capture.c
> index 295e083f38e8..be58260ea67e 100644
> --- b/drivers/media/platform/samsung/s3c-camif/camif-capture.c
> +++ a/drivers/media/platform/samsung/s3c-camif/camif-capture.c
> @@ -1216,7 +1216,7 @@ static int s3c_camif_subdev_get_fmt(struct v4l2_subdev *sd,
> struct v4l2_mbus_framefmt *mf = &fmt->format;
>
> if (fmt->which == V4L2_SUBDEV_FORMAT_TRY) {
> - mf = v4l2_subdev_get_try_format(sd, sd_state, fmt->pad);
> + mf = v4l2_subdev_state_get_format(sd_state, fmt->pad);
> fmt->format = *mf;
> return 0;
> }
> @@ -1305,7 +1305,7 @@ static int s3c_camif_subdev_set_fmt(struct v4l2_subdev *sd,
> __camif_subdev_try_format(camif, mf, fmt->pad);
>
> if (fmt->which == V4L2_SUBDEV_FORMAT_TRY) {
> - mf = v4l2_subdev_get_try_format(sd, sd_state, fmt->pad);
> + mf = v4l2_subdev_state_get_format(sd_state, fmt->pad);
> *mf = fmt->format;
> mutex_unlock(&camif->lock);
> return 0;
> diff --git b/drivers/media/platform/ti/cal/cal-camerarx.c a/drivers/media/platform/ti/cal/cal-camerarx.c
> index cea454ed9c20..61433744c6c4 100644
> --- b/drivers/media/platform/ti/cal/cal-camerarx.c
> +++ a/drivers/media/platform/ti/cal/cal-camerarx.c
> @@ -621,8 +621,6 @@ static int cal_camerarx_sd_enum_mbus_code(struct v4l2_subdev *sd,
> struct v4l2_subdev_state *state,
> struct v4l2_subdev_mbus_code_enum *code)
> {
> - struct cal_camerarx *phy = to_cal_camerarx(sd);
> -
> /* No transcoding, source and sink codes must match. */
> if (cal_rx_pad_is_source(code->pad)) {
> struct v4l2_mbus_framefmt *fmt;
> diff --git b/drivers/staging/media/imx/imx-ic-prp.c a/drivers/staging/media/imx/imx-ic-prp.c
> index dd558fac6477..61d69f19657e 100644
> --- b/drivers/staging/media/imx/imx-ic-prp.c
> +++ a/drivers/staging/media/imx/imx-ic-prp.c
> @@ -82,8 +82,6 @@ static struct v4l2_mbus_framefmt *
> __prp_get_fmt(struct prp_priv *priv, struct v4l2_subdev_state *sd_state,
> unsigned int pad, enum v4l2_subdev_format_whence which)
> {
> - struct imx_ic_priv *ic_priv = priv->ic_priv;
> -
> if (which == V4L2_SUBDEV_FORMAT_TRY)
> return v4l2_subdev_state_get_format(sd_state, pad);
> else
> diff --git b/drivers/staging/media/imx/imx-ic-prpencvf.c a/drivers/staging/media/imx/imx-ic-prpencvf.c
> index 02db7dbb884b..ec73c901079e 100644
> --- b/drivers/staging/media/imx/imx-ic-prpencvf.c
> +++ a/drivers/staging/media/imx/imx-ic-prpencvf.c
> @@ -790,8 +790,6 @@ static struct v4l2_mbus_framefmt *
> __prp_get_fmt(struct prp_priv *priv, struct v4l2_subdev_state *sd_state,
> unsigned int pad, enum v4l2_subdev_format_whence which)
> {
> - struct imx_ic_priv *ic_priv = priv->ic_priv;
> -
> if (which == V4L2_SUBDEV_FORMAT_TRY)
> return v4l2_subdev_state_get_format(sd_state, pad);
> else
> diff --git a/drivers/media/i2c/st-mipid02.c b/drivers/media/i2c/st-mipid02.c
> index 9c9361354c00..b08a249b5fdd 100644
> --- a/drivers/media/i2c/st-mipid02.c
> +++ b/drivers/media/i2c/st-mipid02.c
> @@ -751,7 +751,7 @@ static void mipid02_set_fmt_source(struct v4l2_subdev *sd,
> format->format = bridge->fmt;
> else
> format->format = *v4l2_subdev_state_get_format(sd_state,
> - MIPID02_SINK_0);
> + MIPID02_SINK_0);
>
> /* but code may need to be converted */
> format->format.code = serial_to_parallel_code(format->format.code);
> diff --git a/drivers/media/platform/rockchip/rkisp1/rkisp1-isp.c b/drivers/media/platform/rockchip/rkisp1/rkisp1-isp.c
> index 117912d3bfbd..96353648c032 100644
> --- a/drivers/media/platform/rockchip/rkisp1/rkisp1-isp.c
> +++ b/drivers/media/platform/rockchip/rkisp1/rkisp1-isp.c
> @@ -319,7 +319,7 @@ static void rkisp1_isp_start(struct rkisp1_isp *isp,
> rkisp1_write(rkisp1, RKISP1_CIF_ISP_CTRL, val);
>
> src_fmt = v4l2_subdev_state_get_format(sd_state,
> - RKISP1_ISP_PAD_SOURCE_VIDEO);
> + RKISP1_ISP_PAD_SOURCE_VIDEO);
> src_info = rkisp1_mbus_info_get_by_code(src_fmt->code);
>
> if (src_info->pixel_enc != V4L2_PIXEL_ENC_BAYER)
> @@ -475,9 +475,9 @@ static void rkisp1_isp_set_src_fmt(struct rkisp1_isp *isp,
> sink_fmt = v4l2_subdev_state_get_format(sd_state,
> RKISP1_ISP_PAD_SINK_VIDEO);
> src_fmt = v4l2_subdev_state_get_format(sd_state,
> - RKISP1_ISP_PAD_SOURCE_VIDEO);
> + RKISP1_ISP_PAD_SOURCE_VIDEO);
> src_crop = v4l2_subdev_state_get_crop(sd_state,
> - RKISP1_ISP_PAD_SOURCE_VIDEO);
> + RKISP1_ISP_PAD_SOURCE_VIDEO);
>
> /*
> * Media bus code. The ISP can operate in pass-through mode (Bayer in,
Signed-off-by: Sakari Ailus <sakari.ailus@linux.intel.com>
Reviewed-by: Laurent Pinchart <laurent.pinchart@ideasonboard.com>
Signed-off-by: Mauro Carvalho Chehab <mchehab@kernel.org>
2023-10-13 09:37:10 +02:00
* v4l2_subdev_state_get_format ( sd_state , fmt - > pad ) = fmt - > format ;
2020-05-11 15:41:14 +02:00
if ( fmt - > which = = V4L2_SUBDEV_FORMAT_TRY )
2023-09-07 15:10:03 +03:00
return 0 ;
2020-05-11 15:41:14 +02:00
2023-09-07 15:10:03 +03:00
ov2740 - > cur_mode = mode ;
__v4l2_ctrl_s_ctrl ( ov2740 - > link_freq , mode - > link_freq_index ) ;
__v4l2_ctrl_s_ctrl_int64 ( ov2740 - > pixel_rate ,
to_pixel_rate ( mode - > link_freq_index ) ) ;
/* Update limits and set FPS to default */
vblank_def = mode - > vts_def - mode - > height ;
__v4l2_ctrl_modify_range ( ov2740 - > vblank ,
mode - > vts_min - mode - > height ,
2023-12-04 13:39:44 +01:00
mode - > vts_max - mode - > height , 1 , vblank_def ) ;
2023-09-07 15:10:03 +03:00
__v4l2_ctrl_s_ctrl ( ov2740 - > vblank , vblank_def ) ;
2023-12-04 13:39:42 +01:00
h_blank = mode - > hts - mode - > width ;
2023-09-07 15:10:03 +03:00
__v4l2_ctrl_modify_range ( ov2740 - > hblank , h_blank , h_blank , 1 , h_blank ) ;
2020-05-11 15:41:14 +02:00
return 0 ;
}
static int ov2740_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 17:55:58 +03:00
struct v4l2_subdev_state * sd_state ,
2020-05-11 15:41:14 +02:00
struct v4l2_subdev_mbus_code_enum * code )
{
if ( code - > index > 0 )
return - EINVAL ;
code - > code = MEDIA_BUS_FMT_SGRBG10_1X10 ;
return 0 ;
}
static int ov2740_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 17:55:58 +03:00
struct v4l2_subdev_state * sd_state ,
2020-05-11 15:41:14 +02:00
struct v4l2_subdev_frame_size_enum * fse )
{
2023-12-04 13:39:44 +01:00
struct ov2740 * ov2740 = to_ov2740 ( sd ) ;
const struct ov2740_mode * supported_modes = ov2740 - > supported_modes ;
if ( fse - > index > = ov2740 - > supported_modes_count )
2020-05-11 15:41:14 +02:00
return - EINVAL ;
if ( fse - > code ! = MEDIA_BUS_FMT_SGRBG10_1X10 )
return - EINVAL ;
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 ;
}
2023-11-27 11:07:44 +02:00
static int ov2740_init_state ( struct v4l2_subdev * sd ,
struct v4l2_subdev_state * sd_state )
2020-05-11 15:41:14 +02:00
{
2023-12-04 13:39:44 +01:00
struct ov2740 * ov2740 = to_ov2740 ( sd ) ;
2020-05-11 15:41:14 +02:00
2023-12-04 13:39:44 +01:00
ov2740_update_pad_format ( & ov2740 - > supported_modes [ 0 ] ,
v4l2_subdev_state_get_format ( sd_state , 0 ) ) ;
2020-05-11 15:41:14 +02:00
return 0 ;
}
static const struct v4l2_subdev_video_ops ov2740_video_ops = {
. s_stream = ov2740_set_stream ,
} ;
static const struct v4l2_subdev_pad_ops ov2740_pad_ops = {
2023-09-07 15:10:03 +03:00
. get_fmt = v4l2_subdev_get_fmt ,
2020-05-11 15:41:14 +02:00
. set_fmt = ov2740_set_format ,
. enum_mbus_code = ov2740_enum_mbus_code ,
. enum_frame_size = ov2740_enum_frame_size ,
} ;
static const struct v4l2_subdev_ops ov2740_subdev_ops = {
. video = & ov2740_video_ops ,
. pad = & ov2740_pad_ops ,
} ;
2023-11-27 11:07:44 +02:00
static const struct v4l2_subdev_internal_ops ov2740_internal_ops = {
. init_state = ov2740_init_state ,
} ;
2020-05-11 15:41:14 +02:00
static const struct media_entity_operations ov2740_subdev_entity_ops = {
. link_validate = v4l2_subdev_link_validate ,
} ;
static int ov2740_check_hwcfg ( struct device * dev )
{
2023-12-04 13:39:44 +01:00
struct v4l2_subdev * sd = dev_get_drvdata ( dev ) ;
struct ov2740 * ov2740 = to_ov2740 ( sd ) ;
2020-05-11 15:41:14 +02:00
struct fwnode_handle * ep ;
struct fwnode_handle * fwnode = dev_fwnode ( dev ) ;
struct v4l2_fwnode_endpoint bus_cfg = {
. bus_type = V4L2_MBUS_CSI2_DPHY
} ;
u32 mclk ;
int ret ;
unsigned int i , j ;
2023-12-04 13:39:40 +01:00
/*
* Sometimes the fwnode graph is initialized by the bridge driver ,
* wait for this .
*/
ep = fwnode_graph_get_next_endpoint ( fwnode , NULL ) ;
if ( ! ep )
return - EPROBE_DEFER ;
2020-05-11 15:41:14 +02:00
ret = fwnode_property_read_u32 ( fwnode , " clock-frequency " , & mclk ) ;
2023-12-04 13:39:40 +01:00
if ( ret ) {
fwnode_handle_put ( ep ) ;
2023-12-04 13:39:41 +01:00
return dev_err_probe ( dev , ret ,
" reading clock-frequency property \n " ) ;
2023-12-04 13:39:40 +01:00
}
2020-05-11 15:41:14 +02:00
2023-12-04 13:39:40 +01:00
if ( mclk ! = OV2740_MCLK ) {
fwnode_handle_put ( ep ) ;
2022-07-26 13:05:54 +01:00
return dev_err_probe ( dev , - EINVAL ,
" external clock %d is not supported \n " ,
mclk ) ;
2023-12-04 13:39:40 +01:00
}
2020-05-11 15:41:14 +02:00
ret = v4l2_fwnode_endpoint_alloc_parse ( ep , & bus_cfg ) ;
fwnode_handle_put ( ep ) ;
if ( ret )
2023-12-04 13:39:41 +01:00
return dev_err_probe ( dev , ret , " parsing endpoint failed \n " ) ;
2020-05-11 15:41:14 +02:00
if ( bus_cfg . bus . mipi_csi2 . num_data_lanes ! = OV2740_DATA_LANES ) {
2022-07-26 13:05:54 +01:00
ret = dev_err_probe ( dev , - EINVAL ,
" number of CSI2 data lanes %d is not supported \n " ,
bus_cfg . bus . mipi_csi2 . num_data_lanes ) ;
2020-05-11 15:41:14 +02:00
goto check_hwcfg_error ;
}
if ( ! bus_cfg . nr_of_link_frequencies ) {
2022-07-26 13:05:54 +01:00
ret = dev_err_probe ( dev , - EINVAL , " no link frequencies defined \n " ) ;
2020-05-11 15:41:14 +02:00
goto check_hwcfg_error ;
}
for ( i = 0 ; i < ARRAY_SIZE ( link_freq_menu_items ) ; i + + ) {
for ( j = 0 ; j < bus_cfg . nr_of_link_frequencies ; j + + ) {
if ( link_freq_menu_items [ i ] = =
bus_cfg . link_frequencies [ j ] )
break ;
}
2023-12-04 13:39:44 +01:00
if ( j = = bus_cfg . nr_of_link_frequencies )
continue ;
switch ( i ) {
case OV2740_LINK_FREQ_360MHZ_INDEX :
ov2740 - > supported_modes = supported_modes_360mhz ;
ov2740 - > supported_modes_count =
ARRAY_SIZE ( supported_modes_360mhz ) ;
break ;
case OV2740_LINK_FREQ_180MHZ_INDEX :
ov2740 - > supported_modes = supported_modes_180mhz ;
ov2740 - > supported_modes_count =
ARRAY_SIZE ( supported_modes_180mhz ) ;
break ;
2020-05-11 15:41:14 +02:00
}
2023-12-04 13:39:44 +01:00
break ; /* Prefer modes from first available link-freq */
2020-05-11 15:41:14 +02:00
}
2023-12-04 13:39:44 +01:00
if ( ! ov2740 - > supported_modes )
ret = dev_err_probe ( dev , - EINVAL ,
" no supported link frequencies \n " ) ;
2020-05-11 15:41:14 +02:00
check_hwcfg_error :
v4l2_fwnode_endpoint_free ( & bus_cfg ) ;
return ret ;
}
2022-08-15 10:02:30 +02:00
static void ov2740_remove ( struct i2c_client * client )
2020-05-11 15:41:14 +02:00
{
struct v4l2_subdev * sd = i2c_get_clientdata ( client ) ;
v4l2_async_unregister_subdev ( sd ) ;
media_entity_cleanup ( & sd - > entity ) ;
2023-09-07 15:10:03 +03:00
v4l2_subdev_cleanup ( sd ) ;
2020-05-11 15:41:14 +02:00
v4l2_ctrl_handler_free ( sd - > ctrl_handler ) ;
pm_runtime_disable ( & client - > dev ) ;
}
2020-06-12 11:42:02 +02:00
static int ov2740_nvmem_read ( void * priv , unsigned int off , void * val ,
size_t count )
{
struct nvm_data * nvm = priv ;
2022-07-26 13:05:49 +01:00
struct device * dev = regmap_get_device ( nvm - > regmap ) ;
struct ov2740 * ov2740 = to_ov2740 ( dev_get_drvdata ( dev ) ) ;
2023-09-07 15:10:03 +03:00
struct v4l2_subdev_state * sd_state ;
2020-11-13 04:06:57 +01:00
int ret = 0 ;
2020-06-12 11:42:02 +02:00
2023-09-07 15:10:03 +03:00
/* Serialise sensor access */
sd_state = v4l2_subdev_lock_and_get_active_state ( & ov2740 - > sd ) ;
2020-06-12 11:42:02 +02:00
2020-11-13 04:06:57 +01:00
if ( nvm - > nvm_buffer ) {
memcpy ( val , nvm - > nvm_buffer + off , count ) ;
goto exit ;
}
2021-04-23 17:19:15 +02:00
ret = pm_runtime_resume_and_get ( dev ) ;
2020-11-13 04:06:57 +01:00
if ( ret < 0 ) {
goto exit ;
}
ret = ov2740_load_otp_data ( nvm ) ;
if ( ! ret )
memcpy ( val , nvm - > nvm_buffer + off , count ) ;
pm_runtime_put ( dev ) ;
exit :
2023-09-07 15:10:03 +03:00
v4l2_subdev_unlock_state ( sd_state ) ;
2020-11-13 04:06:57 +01:00
return ret ;
2020-06-12 11:42:02 +02:00
}
2020-11-13 04:06:57 +01:00
static int ov2740_register_nvmem ( struct i2c_client * client ,
struct ov2740 * ov2740 )
2020-06-12 11:42:02 +02:00
{
struct nvm_data * nvm ;
struct regmap_config regmap_config = { } ;
struct nvmem_config nvmem_config = { } ;
struct regmap * regmap ;
struct device * dev = & client - > dev ;
nvm = devm_kzalloc ( dev , sizeof ( * nvm ) , GFP_KERNEL ) ;
if ( ! nvm )
return - ENOMEM ;
regmap_config . val_bits = 8 ;
regmap_config . reg_bits = 16 ;
regmap_config . disable_locking = true ;
regmap = devm_regmap_init_i2c ( client , & regmap_config ) ;
if ( IS_ERR ( regmap ) )
return PTR_ERR ( regmap ) ;
nvm - > regmap = regmap ;
2020-07-24 05:45:38 +02:00
2020-06-12 11:42:02 +02:00
nvmem_config . name = dev_name ( dev ) ;
nvmem_config . dev = dev ;
nvmem_config . read_only = true ;
nvmem_config . root_only = true ;
nvmem_config . owner = THIS_MODULE ;
nvmem_config . compat = true ;
nvmem_config . base_dev = dev ;
nvmem_config . reg_read = ov2740_nvmem_read ;
nvmem_config . reg_write = NULL ;
nvmem_config . priv = nvm ;
nvmem_config . stride = 1 ;
nvmem_config . word_size = 1 ;
nvmem_config . size = CUSTOMER_USE_OTP_SIZE ;
nvm - > nvmem = devm_nvmem_register ( dev , & nvmem_config ) ;
2022-07-26 13:05:56 +01:00
if ( IS_ERR ( nvm - > nvmem ) )
return PTR_ERR ( nvm - > nvmem ) ;
2020-06-12 11:42:02 +02:00
2022-07-26 13:05:56 +01:00
ov2740 - > nvm = nvm ;
return 0 ;
2020-06-12 11:42:02 +02:00
}
2023-12-04 13:39:38 +01:00
static int ov2740_suspend ( struct device * dev )
{
struct v4l2_subdev * sd = dev_get_drvdata ( dev ) ;
struct ov2740 * ov2740 = to_ov2740 ( sd ) ;
gpiod_set_value_cansleep ( ov2740 - > reset_gpio , 1 ) ;
2023-12-04 13:39:39 +01:00
clk_disable_unprepare ( ov2740 - > clk ) ;
2023-12-04 13:39:38 +01:00
return 0 ;
}
static int ov2740_resume ( struct device * dev )
{
struct v4l2_subdev * sd = dev_get_drvdata ( dev ) ;
struct ov2740 * ov2740 = to_ov2740 ( sd ) ;
2023-12-04 13:39:39 +01:00
int ret ;
ret = clk_prepare_enable ( ov2740 - > clk ) ;
if ( ret )
return ret ;
2023-12-04 13:39:38 +01:00
gpiod_set_value_cansleep ( ov2740 - > reset_gpio , 0 ) ;
msleep ( 20 ) ;
return 0 ;
}
2020-05-11 15:41:14 +02:00
static int ov2740_probe ( struct i2c_client * client )
{
2022-07-26 13:05:54 +01:00
struct device * dev = & client - > dev ;
2020-05-11 15:41:14 +02:00
struct ov2740 * ov2740 ;
2021-12-15 12:09:00 +01:00
bool full_power ;
2022-07-26 13:05:53 +01:00
int ret ;
2020-05-11 15:41:14 +02:00
ov2740 = devm_kzalloc ( & client - > dev , sizeof ( * ov2740 ) , GFP_KERNEL ) ;
if ( ! ov2740 )
return - ENOMEM ;
2023-12-04 13:39:43 +01:00
v4l2_i2c_subdev_init ( & ov2740 - > sd , client , & ov2740_subdev_ops ) ;
ov2740 - > sd . internal_ops = & ov2740_internal_ops ;
ret = ov2740_check_hwcfg ( dev ) ;
if ( ret )
return dev_err_probe ( dev , ret , " failed to check HW configuration \n " ) ;
2023-12-04 13:39:38 +01:00
ov2740 - > reset_gpio = devm_gpiod_get_optional ( dev , " reset " , GPIOD_OUT_HIGH ) ;
2024-05-06 15:24:38 +02:00
if ( IS_ERR ( ov2740 - > reset_gpio ) ) {
2023-12-04 13:39:38 +01:00
return dev_err_probe ( dev , PTR_ERR ( ov2740 - > reset_gpio ) ,
" failed to get reset GPIO \n " ) ;
2024-05-06 15:24:38 +02:00
} else if ( ov2740 - > reset_gpio ) {
/*
* Ensure reset is asserted for at least 20 ms before
* ov2740_resume ( ) deasserts it .
*/
msleep ( 20 ) ;
}
2023-12-04 13:39:38 +01:00
2023-12-04 13:39:39 +01:00
ov2740 - > clk = devm_clk_get_optional ( dev , " clk " ) ;
if ( IS_ERR ( ov2740 - > clk ) )
return dev_err_probe ( dev , PTR_ERR ( ov2740 - > clk ) ,
" failed to get clock \n " ) ;
2021-12-15 12:09:00 +01:00
full_power = acpi_dev_state_d0 ( & client - > dev ) ;
if ( full_power ) {
2023-12-04 13:39:38 +01:00
/* ACPI does not always clear the reset GPIO / enable the clock */
ret = ov2740_resume ( dev ) ;
2022-07-26 13:05:54 +01:00
if ( ret )
2023-12-04 13:39:38 +01:00
return dev_err_probe ( dev , ret , " failed to power on sensor \n " ) ;
ret = ov2740_identify_module ( ov2740 ) ;
if ( ret ) {
dev_err_probe ( dev , ret , " failed to find sensor \n " ) ;
goto probe_error_power_off ;
}
2021-12-15 12:09:00 +01:00
}
2023-12-04 13:39:44 +01:00
ov2740 - > cur_mode = & ov2740 - > supported_modes [ 0 ] ;
2020-05-11 15:41:14 +02:00
ret = ov2740_init_controls ( ov2740 ) ;
if ( ret ) {
2022-07-26 13:05:54 +01:00
dev_err_probe ( dev , ret , " failed to init controls \n " ) ;
2020-05-11 15:41:14 +02:00
goto probe_error_v4l2_ctrl_handler_free ;
}
2023-09-07 15:10:03 +03:00
ov2740 - > sd . state_lock = ov2740 - > ctrl_handler . lock ;
2020-05-11 15:41:14 +02:00
ov2740 - > sd . flags | = V4L2_SUBDEV_FL_HAS_DEVNODE ;
ov2740 - > sd . entity . ops = & ov2740_subdev_entity_ops ;
ov2740 - > sd . entity . function = MEDIA_ENT_F_CAM_SENSOR ;
ov2740 - > pad . flags = MEDIA_PAD_FL_SOURCE ;
ret = media_entity_pads_init ( & ov2740 - > sd . entity , 1 , & ov2740 - > pad ) ;
if ( ret ) {
2022-07-26 13:05:54 +01:00
dev_err_probe ( dev , ret , " failed to init entity pads \n " ) ;
2020-05-11 15:41:14 +02:00
goto probe_error_v4l2_ctrl_handler_free ;
}
2023-09-07 15:10:03 +03:00
ret = v4l2_subdev_init_finalize ( & ov2740 - > sd ) ;
if ( ret )
goto probe_error_media_entity_cleanup ;
2023-09-08 11:52:12 +03:00
/* 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 ) ;
2021-03-05 17:42:34 +01:00
ret = v4l2_async_register_subdev_sensor ( & ov2740 - > sd ) ;
2020-05-11 15:41:14 +02:00
if ( ret < 0 ) {
2022-07-26 13:05:54 +01:00
dev_err_probe ( dev , ret , " failed to register V4L2 subdev \n " ) ;
2023-09-07 15:10:03 +03:00
goto probe_error_v4l2_subdev_cleanup ;
2020-05-11 15:41:14 +02:00
}
2020-11-13 04:06:57 +01:00
ret = ov2740_register_nvmem ( client , ov2740 ) ;
2020-06-12 11:42:02 +02:00
if ( ret )
2020-07-24 05:45:38 +02:00
dev_warn ( & client - > dev , " register nvmem failed, ret %d \n " , ret ) ;
2020-06-12 11:42:02 +02:00
2020-05-11 15:41:14 +02:00
return 0 ;
2023-09-07 15:10:03 +03:00
probe_error_v4l2_subdev_cleanup :
v4l2_subdev_cleanup ( & ov2740 - > sd ) ;
2020-05-11 15:41:14 +02:00
probe_error_media_entity_cleanup :
media_entity_cleanup ( & ov2740 - > sd . entity ) ;
2023-09-08 11:52:12 +03:00
pm_runtime_disable ( & client - > dev ) ;
pm_runtime_set_suspended ( & client - > dev ) ;
2020-05-11 15:41:14 +02:00
probe_error_v4l2_ctrl_handler_free :
v4l2_ctrl_handler_free ( ov2740 - > sd . ctrl_handler ) ;
2023-12-04 13:39:38 +01:00
probe_error_power_off :
if ( full_power )
ov2740_suspend ( dev ) ;
2020-05-11 15:41:14 +02:00
return ret ;
}
2023-12-04 13:39:38 +01:00
static DEFINE_RUNTIME_DEV_PM_OPS ( ov2740_pm_ops , ov2740_suspend , ov2740_resume ,
NULL ) ;
2020-05-11 15:41:14 +02:00
static const struct acpi_device_id ov2740_acpi_ids [ ] = {
{ " INT3474 " } ,
{ }
} ;
MODULE_DEVICE_TABLE ( acpi , ov2740_acpi_ids ) ;
static struct i2c_driver ov2740_i2c_driver = {
. driver = {
. name = " ov2740 " ,
2020-06-04 03:25:19 +02:00
. acpi_match_table = ov2740_acpi_ids ,
2023-12-04 13:39:38 +01:00
. pm = pm_sleep_ptr ( & ov2740_pm_ops ) ,
2020-05-11 15:41:14 +02:00
} ,
2023-05-14 14:04:07 +02:00
. probe = ov2740_probe ,
2020-05-11 15:41:14 +02:00
. remove = ov2740_remove ,
2021-12-15 12:09:00 +01:00
. flags = I2C_DRV_ACPI_WAIVE_D0_PROBE ,
2020-05-11 15:41:14 +02:00
} ;
module_i2c_driver ( ov2740_i2c_driver ) ;
MODULE_AUTHOR ( " Qiu, Tianshu <tian.shu.qiu@intel.com> " ) ;
2023-06-09 11:19:28 +02:00
MODULE_AUTHOR ( " Shawn Tu " ) ;
2020-05-11 15:41:14 +02:00
MODULE_AUTHOR ( " Bingbu Cao <bingbu.cao@intel.com> " ) ;
MODULE_DESCRIPTION ( " OmniVision OV2740 sensor driver " ) ;
MODULE_LICENSE ( " GPL v2 " ) ;