| Message ID | 20230908124344.171662-3-umang.jain@ideasonboard.com (mailing list archive) |
|---|---|
| State | New, archived |
| Headers | show |
| Series | media: i2c: imx519: Support for Sony IMX519 sensor | expand |
Hi Umang Thanks for the patch. On Fri, 8 Sept 2023 at 13:44, Umang Jain <umang.jain@ideasonboard.com> wrote: > > From: Lee Jackson <lee.jackson@arducam.com> > > Add a driver for the 16MPix IMX519 CSI2 sensor. > Whilst the sensor supports 2 or 4 CSI2 data lanes, this driver > currently only supports 2 lanes. > > The following Bayer modes are currently available: > > 4656x3496 10-bit @ 10fps > 3840x2160 10-bit (cropped) @ 21fps > 2328x1748 10-bit (binned) @ 30fps > 1920x1080 10-bit (cropped/binned) @ 60fps > 1280x720 10-bit (cropped/binned) @ 120fps > > Signed-off-by: Lee Jackson <lee.jackson@arducam.com> > Signed-off-by: Umang Jain <umang.jain@ideasonboard.com> > --- > MAINTAINERS | 1 + > drivers/media/i2c/Kconfig | 14 + > drivers/media/i2c/Makefile | 1 + > drivers/media/i2c/imx519.c | 1842 ++++++++++++++++++++++++++++++++++++ > 4 files changed, 1858 insertions(+) > create mode 100644 drivers/media/i2c/imx519.c > > diff --git a/MAINTAINERS b/MAINTAINERS > index bca8512c0439..8e5647958e9c 100644 > --- a/MAINTAINERS > +++ b/MAINTAINERS > @@ -19905,6 +19905,7 @@ L: linux-media@vger.kernel.org > S: Maintained > T: git git://linuxtv.org/media_tree.git > F: Documentation/devicetree/bindings/media/i2c/sony,imx519.yaml > +F: drivers/media/i2c/imx519.c > > SONY MEMORYSTICK SUBSYSTEM > M: Maxim Levitsky <maximlevitsky@gmail.com> > diff --git a/drivers/media/i2c/Kconfig b/drivers/media/i2c/Kconfig > index f7cea5c53ead..eb8cf80313b0 100644 > --- a/drivers/media/i2c/Kconfig > +++ b/drivers/media/i2c/Kconfig > @@ -256,6 +256,20 @@ config VIDEO_IMX415 > To compile this driver as a module, choose M here: the > module will be called imx415. > > +config VIDEO_IMX519 > + tristate "Sony IMX519 sensor support" > + depends on I2C && VIDEO_DEV > + select MEDIA_CONTROLLER > + select VIDEO_V4L2_SUBDEV_API > + select V4L2_CCI_I2C > + select V4L2_FWNODE > + help > + This is a Video4Linux2 sensor driver for the Sony > + IMX519 camera. > + > + To compile this driver as a module, choose M here: the > + module will be called imx519. > + > config VIDEO_MAX9271_LIB > tristate > > diff --git a/drivers/media/i2c/Makefile b/drivers/media/i2c/Makefile > index c743aeb5d1ad..a00ac6c7fc81 100644 > --- a/drivers/media/i2c/Makefile > +++ b/drivers/media/i2c/Makefile > @@ -49,6 +49,7 @@ obj-$(CONFIG_VIDEO_IMX335) += imx335.o > obj-$(CONFIG_VIDEO_IMX355) += imx355.o > obj-$(CONFIG_VIDEO_IMX412) += imx412.o > obj-$(CONFIG_VIDEO_IMX415) += imx415.o > +obj-$(CONFIG_VIDEO_IMX519) += imx519.o > obj-$(CONFIG_VIDEO_IR_I2C) += ir-kbd-i2c.o > obj-$(CONFIG_VIDEO_ISL7998X) += isl7998x.o > obj-$(CONFIG_VIDEO_KS0127) += ks0127.o > diff --git a/drivers/media/i2c/imx519.c b/drivers/media/i2c/imx519.c > new file mode 100644 > index 000000000000..f818a3d0bd25 > --- /dev/null > +++ b/drivers/media/i2c/imx519.c > @@ -0,0 +1,1842 @@ > +// SPDX-License-Identifier: GPL-2.0 > +/* > + * A V4L2 driver for Sony IMX519 cameras. > + * Copyright (C) 2022 Arducam Technology co., Ltd. > + * > + * Based on Sony IMX477 camera driver > + * Copyright (C) 2020 Raspberry Pi (Trading) Ltd > + */ > +#include <asm/unaligned.h> > +#include <linux/clk.h> > +#include <linux/delay.h> > +#include <linux/gpio/consumer.h> > +#include <linux/i2c.h> > +#include <linux/module.h> > +#include <linux/of_device.h> > +#include <linux/pm_runtime.h> > +#include <linux/regulator/consumer.h> > + > +#include <media/v4l2-cci.h> > +#include <media/v4l2-ctrls.h> > +#include <media/v4l2-device.h> > +#include <media/v4l2-event.h> > +#include <media/v4l2-fwnode.h> > +#include <media/v4l2-mediabus.h> > + > +/* Chip ID */ > +#define IMX519_REG_CHIP_ID CCI_REG16(0x0016) > +#define IMX519_CHIP_ID 0x0519 > + > +#define IMX519_REG_MODE_SELECT CCI_REG8(0x0100) > +#define IMX519_MODE_STANDBY 0x00 > +#define IMX519_MODE_STREAMING 0x01 > + > +#define IMX519_REG_ORIENTATION CCI_REG8(0x101) > + > +#define IMX519_XCLK_FREQ 24000000 > + > +#define IMX519_DEFAULT_LINK_FREQ 408000000 > + > +/* Pixel rate is fixed at 686MHz for all the modes */ > +#define IMX519_PIXEL_RATE 426666667 686MHz, or 426.66MHz? > + > +/* V_TIMING internal */ > +#define IMX519_REG_FRAME_LENGTH CCI_REG16(0x0340) > +#define IMX519_FRAME_LENGTH_MAX 0xffdc My data sheet says it can go up to 65535. > + > +/* Long exposure multiplier */ > +#define IMX519_LONG_EXP_SHIFT_MAX 7 > +#define IMX519_LONG_EXP_SHIFT_REG CCI_REG8(0x3100) > + > +/* Exposure control */ > +#define IMX519_REG_EXPOSURE CCI_REG16(0x0202) > +#define IMX519_EXPOSURE_OFFSET 32 > +#define IMX519_EXPOSURE_MIN 20 Table 5-22 lists a COARSE_INTEG_TIME register value of 1 as being prohibited, but >=2 is valid. Is there a reason for increasing the min exposure to 20 lines? > +#define IMX519_EXPOSURE_STEP 1 > +#define IMX519_EXPOSURE_DEFAULT 0x3e8 This feels like a fairly arbitrary number. Is there any reason not to make the default just the minimum to remove this define that's only used once? > +#define IMX519_EXPOSURE_MAX (IMX519_FRAME_LENGTH_MAX - \ > + IMX519_EXPOSURE_OFFSET) > + > +/* Analog gain control */ > +#define IMX519_REG_ANALOG_GAIN CCI_REG16(0x0204) > +#define IMX519_ANA_GAIN_MIN 0 > +#define IMX519_ANA_GAIN_MAX 960 > +#define IMX519_ANA_GAIN_STEP 1 > +#define IMX519_ANA_GAIN_DEFAULT 0x0 > + > +/* Digital gain control */ > +#define IMX519_REG_DIGITAL_GAIN CCI_REG16(0x020e) > +#define IMX519_DGTL_GAIN_MIN 0x0100 > +#define IMX519_DGTL_GAIN_MAX 0xffff Please verify. I read the datasheet as saying 0x020e can go up to 15, not 255, so max 0xfff (12 bits set, not 16). > +#define IMX519_DGTL_GAIN_DEFAULT 0x0100 > +#define IMX519_DGTL_GAIN_STEP 1 > + > +/* Test Pattern Control */ > +#define IMX519_REG_TEST_PATTERN CCI_REG16(0x0600) > +#define IMX519_TEST_PATTERN_DISABLE 0 > +#define IMX519_TEST_PATTERN_SOLID_COLOR 1 > +#define IMX519_TEST_PATTERN_COLOR_BARS 2 > +#define IMX519_TEST_PATTERN_GREY_COLOR 3 > +#define IMX519_TEST_PATTERN_PN9 4 > + > +/* Test pattern colour components */ > +#define IMX519_REG_TEST_PATTERN_R CCI_REG16(0x0602) > +#define IMX519_REG_TEST_PATTERN_GR CCI_REG16(0x0604) > +#define IMX519_REG_TEST_PATTERN_B CCI_REG16(0x0606) > +#define IMX519_REG_TEST_PATTERN_GB CCI_REG16(0x0608) > +#define IMX519_TEST_PATTERN_COLOUR_MIN 0 > +#define IMX519_TEST_PATTERN_COLOUR_MAX 0x0fff Test pattern colour registers are 10 bit, so 0x3ff > +#define IMX519_TEST_PATTERN_COLOUR_STEP 1 > +#define IMX519_TEST_PATTERN_R_DEFAULT IMX519_TEST_PATTERN_COLOUR_MAX > +#define IMX519_TEST_PATTERN_GR_DEFAULT 0 > +#define IMX519_TEST_PATTERN_B_DEFAULT 0 > +#define IMX519_TEST_PATTERN_GB_DEFAULT 0 IMX519_TEST_PATTERN_xx_DEFAULT values not used > + > +/* IMX519 native and active pixel array size. */ > +#define IMX519_NATIVE_WIDTH 4672U > +#define IMX519_NATIVE_HEIGHT 3648U > +#define IMX519_PIXEL_ARRAY_LEFT 8U > +#define IMX519_PIXEL_ARRAY_TOP 48U > +#define IMX519_PIXEL_ARRAY_WIDTH 4656U > +#define IMX519_PIXEL_ARRAY_HEIGHT 3496U > + > +struct imx519_reg_list { > + unsigned int num_of_regs; > + const struct cci_reg_sequence *regs; > +}; > + > +/* Mode : resolution and related config&values */ > +struct imx519_mode { > + /* Frame width */ > + unsigned int width; > + > + /* Frame height */ > + unsigned int height; > + > + /* H-timing in pixels */ > + unsigned int line_length_pix; > + > + /* Analog crop rectangle. */ > + struct v4l2_rect crop; > + > + /* Highest possible framerate. */ > + struct v4l2_fract timeperframe_min; > + > + /* Default framerate. */ > + struct v4l2_fract timeperframe_default; I know this comes from imx477, but storing frame rates here as a v4l2_fract is pretty grim in my view. The registers have explicit minimum values, whereas the computed value will be an approximation. Compute the value for IMX519_REG_FRAME_LENGTH, or the value for V4L2_CID_VBLANK for each mode. > + > + /* Default register values */ > + struct imx519_reg_list reg_list; > +}; > + > +static const struct cci_reg_sequence mode_common_regs[] = { > + { CCI_REG8(0x0136), 0x18 }, > + { CCI_REG8(0x0137), 0x00 }, CCI_REG16. 0x18 is (IMX519_XCLK_FREQ << 8) / 1000000 (please confirm that operation rather than accepting it blindly). I haven't checked the rest of these common registers for whether they are actually >8 bit values - in the normal manner, many are undocumented. > + { CCI_REG8(0x3c7e), 0x01 }, > + { CCI_REG8(0x3c7f), 0x07 }, > + { CCI_REG8(0x3020), 0x00 }, > + { CCI_REG8(0x3e35), 0x01 }, > + { CCI_REG8(0x3f7f), 0x01 }, > + { CCI_REG8(0x5609), 0x57 }, > + { CCI_REG8(0x5613), 0x51 }, > + { CCI_REG8(0x561f), 0x5e }, > + { CCI_REG8(0x5623), 0xd2 }, > + { CCI_REG8(0x5637), 0x11 }, > + { CCI_REG8(0x5657), 0x11 }, > + { CCI_REG8(0x5659), 0x12 }, > + { CCI_REG8(0x5733), 0x60 }, > + { CCI_REG8(0x5905), 0x57 }, > + { CCI_REG8(0x590f), 0x51 }, > + { CCI_REG8(0x591b), 0x5e }, > + { CCI_REG8(0x591f), 0xd2 }, > + { CCI_REG8(0x5933), 0x11 }, > + { CCI_REG8(0x5953), 0x11 }, > + { CCI_REG8(0x5955), 0x12 }, > + { CCI_REG8(0x5a2f), 0x60 }, > + { CCI_REG8(0x5a85), 0x57 }, > + { CCI_REG8(0x5a8f), 0x51 }, > + { CCI_REG8(0x5a9b), 0x5e }, > + { CCI_REG8(0x5a9f), 0xd2 }, > + { CCI_REG8(0x5ab3), 0x11 }, > + { CCI_REG8(0x5ad3), 0x11 }, > + { CCI_REG8(0x5ad5), 0x12 }, > + { CCI_REG8(0x5baf), 0x60 }, > + { CCI_REG8(0x5c15), 0x2a }, > + { CCI_REG8(0x5c17), 0x80 }, > + { CCI_REG8(0x5c19), 0x31 }, > + { CCI_REG8(0x5c1b), 0x87 }, > + { CCI_REG8(0x5c25), 0x25 }, > + { CCI_REG8(0x5c27), 0x7b }, > + { CCI_REG8(0x5c29), 0x2a }, > + { CCI_REG8(0x5c2b), 0x80 }, > + { CCI_REG8(0x5c2d), 0x31 }, > + { CCI_REG8(0x5c2f), 0x87 }, > + { CCI_REG8(0x5c35), 0x2b }, > + { CCI_REG8(0x5c37), 0x81 }, > + { CCI_REG8(0x5c39), 0x31 }, > + { CCI_REG8(0x5c3b), 0x87 }, > + { CCI_REG8(0x5c45), 0x25 }, > + { CCI_REG8(0x5c47), 0x7b }, > + { CCI_REG8(0x5c49), 0x2a }, > + { CCI_REG8(0x5c4b), 0x80 }, > + { CCI_REG8(0x5c4d), 0x31 }, > + { CCI_REG8(0x5c4f), 0x87 }, > + { CCI_REG8(0x5c55), 0x2d }, > + { CCI_REG8(0x5c57), 0x83 }, > + { CCI_REG8(0x5c59), 0x32 }, > + { CCI_REG8(0x5c5b), 0x88 }, > + { CCI_REG8(0x5c65), 0x29 }, > + { CCI_REG8(0x5c67), 0x7f }, > + { CCI_REG8(0x5c69), 0x2e }, > + { CCI_REG8(0x5c6b), 0x84 }, > + { CCI_REG8(0x5c6d), 0x32 }, > + { CCI_REG8(0x5c6f), 0x88 }, > + { CCI_REG8(0x5e69), 0x04 }, > + { CCI_REG8(0x5e9d), 0x00 }, > + { CCI_REG8(0x5f18), 0x10 }, > + { CCI_REG8(0x5f1a), 0x0e }, > + { CCI_REG8(0x5f20), 0x12 }, > + { CCI_REG8(0x5f22), 0x10 }, > + { CCI_REG8(0x5f24), 0x0e }, > + { CCI_REG8(0x5f28), 0x10 }, > + { CCI_REG8(0x5f2a), 0x0e }, > + { CCI_REG8(0x5f30), 0x12 }, > + { CCI_REG8(0x5f32), 0x10 }, > + { CCI_REG8(0x5f34), 0x0e }, > + { CCI_REG8(0x5f38), 0x0f }, > + { CCI_REG8(0x5f39), 0x0d }, > + { CCI_REG8(0x5f3c), 0x11 }, > + { CCI_REG8(0x5f3d), 0x0f }, > + { CCI_REG8(0x5f3e), 0x0d }, > + { CCI_REG8(0x5f61), 0x07 }, > + { CCI_REG8(0x5f64), 0x05 }, > + { CCI_REG8(0x5f67), 0x03 }, > + { CCI_REG8(0x5f6a), 0x03 }, > + { CCI_REG8(0x5f6d), 0x07 }, > + { CCI_REG8(0x5f70), 0x07 }, > + { CCI_REG8(0x5f73), 0x05 }, > + { CCI_REG8(0x5f76), 0x02 }, > + { CCI_REG8(0x5f79), 0x07 }, > + { CCI_REG8(0x5f7c), 0x07 }, > + { CCI_REG8(0x5f7f), 0x07 }, > + { CCI_REG8(0x5f82), 0x07 }, > + { CCI_REG8(0x5f85), 0x03 }, > + { CCI_REG8(0x5f88), 0x02 }, > + { CCI_REG8(0x5f8b), 0x01 }, > + { CCI_REG8(0x5f8e), 0x01 }, > + { CCI_REG8(0x5f91), 0x04 }, > + { CCI_REG8(0x5f94), 0x05 }, > + { CCI_REG8(0x5f97), 0x02 }, > + { CCI_REG8(0x5f9d), 0x07 }, > + { CCI_REG8(0x5fa0), 0x07 }, > + { CCI_REG8(0x5fa3), 0x07 }, > + { CCI_REG8(0x5fa6), 0x07 }, > + { CCI_REG8(0x5fa9), 0x03 }, > + { CCI_REG8(0x5fac), 0x01 }, > + { CCI_REG8(0x5faf), 0x01 }, > + { CCI_REG8(0x5fb5), 0x03 }, > + { CCI_REG8(0x5fb8), 0x02 }, > + { CCI_REG8(0x5fbb), 0x01 }, > + { CCI_REG8(0x5fc1), 0x07 }, > + { CCI_REG8(0x5fc4), 0x07 }, > + { CCI_REG8(0x5fc7), 0x07 }, > + { CCI_REG8(0x5fd1), 0x00 }, > + { CCI_REG8(0x6302), 0x79 }, > + { CCI_REG8(0x6305), 0x78 }, > + { CCI_REG8(0x6306), 0xa5 }, > + { CCI_REG8(0x6308), 0x03 }, > + { CCI_REG8(0x6309), 0x20 }, > + { CCI_REG8(0x630b), 0x0a }, > + { CCI_REG8(0x630d), 0x48 }, > + { CCI_REG8(0x630f), 0x06 }, > + { CCI_REG8(0x6311), 0xa4 }, > + { CCI_REG8(0x6313), 0x03 }, > + { CCI_REG8(0x6314), 0x20 }, > + { CCI_REG8(0x6316), 0x0a }, > + { CCI_REG8(0x6317), 0x31 }, > + { CCI_REG8(0x6318), 0x4a }, > + { CCI_REG8(0x631a), 0x06 }, > + { CCI_REG8(0x631b), 0x40 }, > + { CCI_REG8(0x631c), 0xa4 }, > + { CCI_REG8(0x631e), 0x03 }, > + { CCI_REG8(0x631f), 0x20 }, > + { CCI_REG8(0x6321), 0x0a }, > + { CCI_REG8(0x6323), 0x4a }, > + { CCI_REG8(0x6328), 0x80 }, > + { CCI_REG8(0x6329), 0x01 }, > + { CCI_REG8(0x632a), 0x30 }, > + { CCI_REG8(0x632b), 0x02 }, > + { CCI_REG8(0x632c), 0x20 }, > + { CCI_REG8(0x632d), 0x02 }, > + { CCI_REG8(0x632e), 0x30 }, > + { CCI_REG8(0x6330), 0x60 }, > + { CCI_REG8(0x6332), 0x90 }, > + { CCI_REG8(0x6333), 0x01 }, > + { CCI_REG8(0x6334), 0x30 }, > + { CCI_REG8(0x6335), 0x02 }, > + { CCI_REG8(0x6336), 0x20 }, > + { CCI_REG8(0x6338), 0x80 }, > + { CCI_REG8(0x633a), 0xa0 }, > + { CCI_REG8(0x633b), 0x01 }, > + { CCI_REG8(0x633c), 0x60 }, > + { CCI_REG8(0x633d), 0x02 }, > + { CCI_REG8(0x633e), 0x60 }, > + { CCI_REG8(0x633f), 0x01 }, > + { CCI_REG8(0x6340), 0x30 }, > + { CCI_REG8(0x6341), 0x02 }, > + { CCI_REG8(0x6342), 0x20 }, > + { CCI_REG8(0x6343), 0x03 }, > + { CCI_REG8(0x6344), 0x80 }, > + { CCI_REG8(0x6345), 0x03 }, > + { CCI_REG8(0x6346), 0x90 }, > + { CCI_REG8(0x6348), 0xf0 }, > + { CCI_REG8(0x6349), 0x01 }, > + { CCI_REG8(0x634a), 0x20 }, > + { CCI_REG8(0x634b), 0x02 }, > + { CCI_REG8(0x634c), 0x10 }, > + { CCI_REG8(0x634d), 0x03 }, > + { CCI_REG8(0x634e), 0x60 }, > + { CCI_REG8(0x6350), 0xa0 }, > + { CCI_REG8(0x6351), 0x01 }, > + { CCI_REG8(0x6352), 0x60 }, > + { CCI_REG8(0x6353), 0x02 }, > + { CCI_REG8(0x6354), 0x50 }, > + { CCI_REG8(0x6355), 0x02 }, > + { CCI_REG8(0x6356), 0x60 }, > + { CCI_REG8(0x6357), 0x01 }, > + { CCI_REG8(0x6358), 0x30 }, > + { CCI_REG8(0x6359), 0x02 }, > + { CCI_REG8(0x635a), 0x30 }, > + { CCI_REG8(0x635b), 0x03 }, > + { CCI_REG8(0x635c), 0x90 }, > + { CCI_REG8(0x635f), 0x01 }, > + { CCI_REG8(0x6360), 0x10 }, > + { CCI_REG8(0x6361), 0x01 }, > + { CCI_REG8(0x6362), 0x40 }, > + { CCI_REG8(0x6363), 0x02 }, > + { CCI_REG8(0x6364), 0x50 }, > + { CCI_REG8(0x6368), 0x70 }, > + { CCI_REG8(0x636a), 0xa0 }, > + { CCI_REG8(0x636b), 0x01 }, > + { CCI_REG8(0x636c), 0x50 }, > + { CCI_REG8(0x637d), 0xe4 }, > + { CCI_REG8(0x637e), 0xb4 }, > + { CCI_REG8(0x638c), 0x8e }, > + { CCI_REG8(0x638d), 0x38 }, > + { CCI_REG8(0x638e), 0xe3 }, > + { CCI_REG8(0x638f), 0x4c }, > + { CCI_REG8(0x6390), 0x30 }, > + { CCI_REG8(0x6391), 0xc3 }, > + { CCI_REG8(0x6392), 0xae }, > + { CCI_REG8(0x6393), 0xba }, > + { CCI_REG8(0x6394), 0xeb }, > + { CCI_REG8(0x6395), 0x6e }, > + { CCI_REG8(0x6396), 0x34 }, > + { CCI_REG8(0x6397), 0xe3 }, > + { CCI_REG8(0x6398), 0xcf }, > + { CCI_REG8(0x6399), 0x3c }, > + { CCI_REG8(0x639a), 0xf3 }, > + { CCI_REG8(0x639b), 0x0c }, > + { CCI_REG8(0x639c), 0x30 }, > + { CCI_REG8(0x639d), 0xc1 }, > + { CCI_REG8(0x63b9), 0xa3 }, > + { CCI_REG8(0x63ba), 0xfe }, > + { CCI_REG8(0x7600), 0x01 }, > + { CCI_REG8(0x79a0), 0x01 }, > + { CCI_REG8(0x79a1), 0x01 }, > + { CCI_REG8(0x79a2), 0x01 }, > + { CCI_REG8(0x79a3), 0x01 }, > + { CCI_REG8(0x79a4), 0x01 }, > + { CCI_REG8(0x79a5), 0x20 }, > + { CCI_REG8(0x79a9), 0x00 }, > + { CCI_REG8(0x79aa), 0x01 }, > + { CCI_REG8(0x79ad), 0x00 }, > + { CCI_REG8(0x79af), 0x00 }, > + { CCI_REG8(0x8173), 0x01 }, > + { CCI_REG8(0x835c), 0x01 }, > + { CCI_REG8(0x8a74), 0x01 }, > + { CCI_REG8(0x8c1f), 0x00 }, > + { CCI_REG8(0x8c27), 0x00 }, > + { CCI_REG8(0x8c3b), 0x03 }, > + { CCI_REG8(0x9004), 0x0b }, > + { CCI_REG8(0x920c), 0x6a }, > + { CCI_REG8(0x920d), 0x22 }, > + { CCI_REG8(0x920e), 0x6a }, > + { CCI_REG8(0x920f), 0x23 }, > + { CCI_REG8(0x9214), 0x6a }, > + { CCI_REG8(0x9215), 0x20 }, > + { CCI_REG8(0x9216), 0x6a }, > + { CCI_REG8(0x9217), 0x21 }, > + { CCI_REG8(0x9385), 0x3e }, > + { CCI_REG8(0x9387), 0x1b }, > + { CCI_REG8(0x938d), 0x4d }, > + { CCI_REG8(0x938f), 0x43 }, > + { CCI_REG8(0x9391), 0x1b }, > + { CCI_REG8(0x9395), 0x4d }, > + { CCI_REG8(0x9397), 0x43 }, > + { CCI_REG8(0x9399), 0x1b }, > + { CCI_REG8(0x939d), 0x3e }, > + { CCI_REG8(0x939f), 0x2f }, > + { CCI_REG8(0x93a5), 0x43 }, > + { CCI_REG8(0x93a7), 0x2f }, > + { CCI_REG8(0x93a9), 0x2f }, > + { CCI_REG8(0x93ad), 0x34 }, > + { CCI_REG8(0x93af), 0x2f }, > + { CCI_REG8(0x93b5), 0x3e }, > + { CCI_REG8(0x93b7), 0x2f }, > + { CCI_REG8(0x93bd), 0x4d }, > + { CCI_REG8(0x93bf), 0x43 }, > + { CCI_REG8(0x93c1), 0x2f }, > + { CCI_REG8(0x93c5), 0x4d }, > + { CCI_REG8(0x93c7), 0x43 }, > + { CCI_REG8(0x93c9), 0x2f }, > + { CCI_REG8(0x974b), 0x02 }, > + { CCI_REG8(0x995c), 0x8c }, > + { CCI_REG8(0x995d), 0x00 }, > + { CCI_REG8(0x995e), 0x00 }, > + { CCI_REG8(0x9963), 0x64 }, > + { CCI_REG8(0x9964), 0x50 }, > + { CCI_REG8(0xaa0a), 0x26 }, > + { CCI_REG8(0xae03), 0x04 }, > + { CCI_REG8(0xae04), 0x03 }, > + { CCI_REG8(0xae05), 0x03 }, > + { CCI_REG8(0xbc1c), 0x08 }, > + { CCI_REG8(0xbcf1), 0x02 }, > +}; > + > +/* 16 mpix 10fps */ > +static const struct cci_reg_sequence mode_4656x3496_regs[] = { > + { CCI_REG8(0x0111), 0x02 }, > + { CCI_REG8(0x0112), 0x0a }, > + { CCI_REG8(0x0113), 0x0a }, > + { CCI_REG8(0x0114), 0x01 }, > + { CCI_REG8(0x0342), 0x42 }, > + { CCI_REG8(0x0343), 0x00 }, CCI_REG16(0x342) - LINE_LENGTH_PCK > + { CCI_REG8(0x0340), 0x0d }, > + { CCI_REG8(0x0341), 0xf4 }, CCI_REG16(0x340) - FRM_LENGTH_LINES But also shouldn't be here as IMX519_REG_FRAME_LENGTH is written as part of the vblank control > + { CCI_REG8(0x0344), 0x00 }, > + { CCI_REG8(0x0345), 0x00 }, CCI_REG16(0x344) - X_ADD_STA > + { CCI_REG8(0x0346), 0x00 }, > + { CCI_REG8(0x0347), 0x00 }, CCI_REG16(0x0346) - Y_ADD_STA > + { CCI_REG8(0x0348), 0x12 }, > + { CCI_REG8(0x0349), 0x2f }, CCI_REG16(0x0348) - X_ADD_END > + { CCI_REG8(0x034a), 0x0d }, > + { CCI_REG8(0x034b), 0xa7 }, CCI_REG16(0x034a) - Y_ADD_END > + { CCI_REG8(0x0220), 0x00 }, > + { CCI_REG8(0x0221), 0x11 }, > + { CCI_REG8(0x0222), 0x01 }, > + { CCI_REG8(0x0900), 0x00 }, > + { CCI_REG8(0x0901), 0x11 }, > + { CCI_REG8(0x0902), 0x0a }, > + { CCI_REG8(0x3f4c), 0x01 }, > + { CCI_REG8(0x3f4d), 0x01 }, > + { CCI_REG8(0x4254), 0x7f }, > + { CCI_REG8(0x0401), 0x00 }, > + { CCI_REG8(0x0404), 0x00 }, > + { CCI_REG8(0x0405), 0x10 }, > + { CCI_REG8(0x0408), 0x00 }, > + { CCI_REG8(0x0409), 0x00 }, > + { CCI_REG8(0x040a), 0x00 }, > + { CCI_REG8(0x040b), 0x00 }, > + { CCI_REG8(0x040c), 0x12 }, > + { CCI_REG8(0x040d), 0x30 }, > + { CCI_REG8(0x040e), 0x0d }, > + { CCI_REG8(0x040f), 0xa8 }, > + { CCI_REG8(0x034c), 0x12 }, > + { CCI_REG8(0x034d), 0x30 }, > + { CCI_REG8(0x034e), 0x0d }, > + { CCI_REG8(0x034f), 0xa8 }, > + { CCI_REG8(0x0301), 0x06 }, > + { CCI_REG8(0x0303), 0x04 }, > + { CCI_REG8(0x0305), 0x04 }, > + { CCI_REG8(0x0306), 0x01 }, > + { CCI_REG8(0x0307), 0x57 }, > + { CCI_REG8(0x0309), 0x0a }, > + { CCI_REG8(0x030b), 0x02 }, > + { CCI_REG8(0x030d), 0x04 }, > + { CCI_REG8(0x030e), 0x01 }, > + { CCI_REG8(0x030f), 0x49 }, > + { CCI_REG8(0x0310), 0x01 }, > + { CCI_REG8(0x0820), 0x07 }, > + { CCI_REG8(0x0821), 0xb6 }, > + { CCI_REG8(0x0822), 0x00 }, > + { CCI_REG8(0x0823), 0x00 }, > + { CCI_REG8(0x3e20), 0x01 }, > + { CCI_REG8(0x3e37), 0x00 }, > + { CCI_REG8(0x3e3b), 0x00 }, > + { CCI_REG8(0x0106), 0x00 }, > + { CCI_REG8(0x0b00), 0x00 }, > + { CCI_REG8(0x3230), 0x00 }, > + { CCI_REG8(0x3f14), 0x01 }, > + { CCI_REG8(0x3f3c), 0x01 }, > + { CCI_REG8(0x3f0d), 0x0a }, > + { CCI_REG8(0x3fbc), 0x00 }, > + { CCI_REG8(0x3c06), 0x00 }, > + { CCI_REG8(0x3c07), 0x48 }, > + { CCI_REG8(0x3c0a), 0x00 }, > + { CCI_REG8(0x3c0b), 0x00 }, > + { CCI_REG8(0x3f78), 0x00 }, > + { CCI_REG8(0x3f79), 0x40 }, > + { CCI_REG8(0x3f7c), 0x00 }, > + { CCI_REG8(0x3f7d), 0x00 }, > +}; > + > +/* 4k 21fps mode */ > +static const struct cci_reg_sequence mode_3840x2160_regs[] = { The comments for the "16 mpix 10fps" mode above will also apply here and for the other modes. > + { CCI_REG8(0x0111), 0x02 }, > + { CCI_REG8(0x0112), 0x0a }, > + { CCI_REG8(0x0113), 0x0a }, > + { CCI_REG8(0x0114), 0x01 }, > + { CCI_REG8(0x0342), 0x38 }, > + { CCI_REG8(0x0343), 0x70 }, > + { CCI_REG8(0x0340), 0x08 }, > + { CCI_REG8(0x0341), 0xd4 }, > + { CCI_REG8(0x0344), 0x01 }, > + { CCI_REG8(0x0345), 0x98 }, > + { CCI_REG8(0x0346), 0x02 }, > + { CCI_REG8(0x0347), 0xa0 }, > + { CCI_REG8(0x0348), 0x10 }, > + { CCI_REG8(0x0349), 0x97 }, > + { CCI_REG8(0x034a), 0x0b }, > + { CCI_REG8(0x034b), 0x17 }, > + { CCI_REG8(0x0220), 0x00 }, > + { CCI_REG8(0x0221), 0x11 }, > + { CCI_REG8(0x0222), 0x01 }, > + { CCI_REG8(0x0900), 0x00 }, > + { CCI_REG8(0x0901), 0x11 }, > + { CCI_REG8(0x0902), 0x0a }, > + { CCI_REG8(0x3f4c), 0x01 }, > + { CCI_REG8(0x3f4d), 0x01 }, > + { CCI_REG8(0x4254), 0x7f }, > + { CCI_REG8(0x0401), 0x00 }, > + { CCI_REG8(0x0404), 0x00 }, > + { CCI_REG8(0x0405), 0x10 }, > + { CCI_REG8(0x0408), 0x00 }, > + { CCI_REG8(0x0409), 0x00 }, > + { CCI_REG8(0x040a), 0x00 }, > + { CCI_REG8(0x040b), 0x00 }, > + { CCI_REG8(0x040c), 0x0f }, > + { CCI_REG8(0x040d), 0x00 }, > + { CCI_REG8(0x040e), 0x08 }, > + { CCI_REG8(0x040f), 0x70 }, > + { CCI_REG8(0x034c), 0x0f }, > + { CCI_REG8(0x034d), 0x00 }, > + { CCI_REG8(0x034e), 0x08 }, > + { CCI_REG8(0x034f), 0x70 }, > + { CCI_REG8(0x0301), 0x06 }, > + { CCI_REG8(0x0303), 0x04 }, > + { CCI_REG8(0x0305), 0x04 }, > + { CCI_REG8(0x0306), 0x01 }, > + { CCI_REG8(0x0307), 0x57 }, > + { CCI_REG8(0x0309), 0x0a }, > + { CCI_REG8(0x030b), 0x02 }, > + { CCI_REG8(0x030d), 0x04 }, > + { CCI_REG8(0x030e), 0x01 }, > + { CCI_REG8(0x030f), 0x49 }, > + { CCI_REG8(0x0310), 0x01 }, > + { CCI_REG8(0x0820), 0x07 }, > + { CCI_REG8(0x0821), 0xb6 }, > + { CCI_REG8(0x0822), 0x00 }, > + { CCI_REG8(0x0823), 0x00 }, > + { CCI_REG8(0x3e20), 0x01 }, > + { CCI_REG8(0x3e37), 0x00 }, > + { CCI_REG8(0x3e3b), 0x00 }, > + { CCI_REG8(0x0106), 0x00 }, > + { CCI_REG8(0x0b00), 0x00 }, > + { CCI_REG8(0x3230), 0x00 }, > + { CCI_REG8(0x3f14), 0x01 }, > + { CCI_REG8(0x3f3c), 0x01 }, > + { CCI_REG8(0x3f0d), 0x0a }, > + { CCI_REG8(0x3fbc), 0x00 }, > + { CCI_REG8(0x3c06), 0x00 }, > + { CCI_REG8(0x3c07), 0x48 }, > + { CCI_REG8(0x3c0a), 0x00 }, > + { CCI_REG8(0x3c0b), 0x00 }, > + { CCI_REG8(0x3f78), 0x00 }, > + { CCI_REG8(0x3f79), 0x40 }, > + { CCI_REG8(0x3f7c), 0x00 }, > + { CCI_REG8(0x3f7d), 0x00 }, > +}; > + > +/* 2x2 binned 30fps mode */ > +static const struct cci_reg_sequence mode_2328x1748_regs[] = { > + { CCI_REG8(0x0111), 0x02 }, > + { CCI_REG8(0x0112), 0x0a }, > + { CCI_REG8(0x0113), 0x0a }, > + { CCI_REG8(0x0114), 0x01 }, > + { CCI_REG8(0x0342), 0x24 }, > + { CCI_REG8(0x0343), 0x12 }, > + { CCI_REG8(0x0340), 0x09 }, > + { CCI_REG8(0x0341), 0xac }, > + { CCI_REG8(0x0344), 0x00 }, > + { CCI_REG8(0x0345), 0x00 }, > + { CCI_REG8(0x0346), 0x00 }, > + { CCI_REG8(0x0347), 0x00 }, > + { CCI_REG8(0x0348), 0x12 }, > + { CCI_REG8(0x0349), 0x2f }, > + { CCI_REG8(0x034a), 0x0d }, > + { CCI_REG8(0x034b), 0xa7 }, > + { CCI_REG8(0x0220), 0x00 }, > + { CCI_REG8(0x0221), 0x11 }, > + { CCI_REG8(0x0222), 0x01 }, > + { CCI_REG8(0x0900), 0x01 }, > + { CCI_REG8(0x0901), 0x22 }, > + { CCI_REG8(0x0902), 0x0a }, > + { CCI_REG8(0x3f4c), 0x01 }, > + { CCI_REG8(0x3f4d), 0x01 }, > + { CCI_REG8(0x4254), 0x7f }, > + { CCI_REG8(0x0401), 0x00 }, > + { CCI_REG8(0x0404), 0x00 }, > + { CCI_REG8(0x0405), 0x10 }, > + { CCI_REG8(0x0408), 0x00 }, > + { CCI_REG8(0x0409), 0x00 }, > + { CCI_REG8(0x040a), 0x00 }, > + { CCI_REG8(0x040b), 0x00 }, > + { CCI_REG8(0x040c), 0x09 }, > + { CCI_REG8(0x040d), 0x18 }, > + { CCI_REG8(0x040e), 0x06 }, > + { CCI_REG8(0x040f), 0xd4 }, > + { CCI_REG8(0x034c), 0x09 }, > + { CCI_REG8(0x034d), 0x18 }, > + { CCI_REG8(0x034e), 0x06 }, > + { CCI_REG8(0x034f), 0xd4 }, > + { CCI_REG8(0x0301), 0x06 }, > + { CCI_REG8(0x0303), 0x04 }, > + { CCI_REG8(0x0305), 0x04 }, > + { CCI_REG8(0x0306), 0x01 }, > + { CCI_REG8(0x0307), 0x57 }, > + { CCI_REG8(0x0309), 0x0a }, > + { CCI_REG8(0x030b), 0x02 }, > + { CCI_REG8(0x030d), 0x04 }, > + { CCI_REG8(0x030e), 0x01 }, > + { CCI_REG8(0x030f), 0x49 }, > + { CCI_REG8(0x0310), 0x01 }, > + { CCI_REG8(0x0820), 0x07 }, > + { CCI_REG8(0x0821), 0xb6 }, > + { CCI_REG8(0x0822), 0x00 }, > + { CCI_REG8(0x0823), 0x00 }, > + { CCI_REG8(0x3e20), 0x01 }, > + { CCI_REG8(0x3e37), 0x00 }, > + { CCI_REG8(0x3e3b), 0x00 }, > + { CCI_REG8(0x0106), 0x00 }, > + { CCI_REG8(0x0b00), 0x00 }, > + { CCI_REG8(0x3230), 0x00 }, > + { CCI_REG8(0x3f14), 0x01 }, > + { CCI_REG8(0x3f3c), 0x01 }, > + { CCI_REG8(0x3f0d), 0x0a }, > + { CCI_REG8(0x3fbc), 0x00 }, > + { CCI_REG8(0x3c06), 0x00 }, > + { CCI_REG8(0x3c07), 0x48 }, > + { CCI_REG8(0x3c0a), 0x00 }, > + { CCI_REG8(0x3c0b), 0x00 }, > + { CCI_REG8(0x3f78), 0x00 }, > + { CCI_REG8(0x3f79), 0x40 }, > + { CCI_REG8(0x3f7c), 0x00 }, > + { CCI_REG8(0x3f7d), 0x00 }, > +}; > + > +/* 1080p 60fps mode */ > +static const struct cci_reg_sequence mode_1920x1080_regs[] = { > + { CCI_REG8(0x0111), 0x02 }, > + { CCI_REG8(0x0112), 0x0a }, > + { CCI_REG8(0x0113), 0x0a }, > + { CCI_REG8(0x0114), 0x01 }, > + { CCI_REG8(0x0342), 0x25 }, > + { CCI_REG8(0x0343), 0xd9 }, > + { CCI_REG8(0x0340), 0x04 }, > + { CCI_REG8(0x0341), 0x9c }, > + { CCI_REG8(0x0344), 0x01 }, > + { CCI_REG8(0x0345), 0x98 }, > + { CCI_REG8(0x0346), 0x02 }, > + { CCI_REG8(0x0347), 0xa2 }, > + { CCI_REG8(0x0348), 0x10 }, > + { CCI_REG8(0x0349), 0x97 }, > + { CCI_REG8(0x034a), 0x0b }, > + { CCI_REG8(0x034b), 0x15 }, > + { CCI_REG8(0x0220), 0x00 }, > + { CCI_REG8(0x0221), 0x11 }, > + { CCI_REG8(0x0222), 0x01 }, > + { CCI_REG8(0x0900), 0x01 }, > + { CCI_REG8(0x0901), 0x22 }, > + { CCI_REG8(0x0902), 0x0a }, > + { CCI_REG8(0x3f4c), 0x01 }, > + { CCI_REG8(0x3f4d), 0x01 }, > + { CCI_REG8(0x4254), 0x7f }, > + { CCI_REG8(0x0401), 0x00 }, > + { CCI_REG8(0x0404), 0x00 }, > + { CCI_REG8(0x0405), 0x10 }, > + { CCI_REG8(0x0408), 0x00 }, > + { CCI_REG8(0x0409), 0x00 }, > + { CCI_REG8(0x040a), 0x00 }, > + { CCI_REG8(0x040b), 0x00 }, > + { CCI_REG8(0x040c), 0x07 }, > + { CCI_REG8(0x040d), 0x80 }, > + { CCI_REG8(0x040e), 0x04 }, > + { CCI_REG8(0x040f), 0x38 }, > + { CCI_REG8(0x034c), 0x07 }, > + { CCI_REG8(0x034d), 0x80 }, > + { CCI_REG8(0x034e), 0x04 }, > + { CCI_REG8(0x034f), 0x38 }, > + { CCI_REG8(0x0301), 0x06 }, > + { CCI_REG8(0x0303), 0x04 }, > + { CCI_REG8(0x0305), 0x04 }, > + { CCI_REG8(0x0306), 0x01 }, > + { CCI_REG8(0x0307), 0x57 }, > + { CCI_REG8(0x0309), 0x0a }, > + { CCI_REG8(0x030b), 0x02 }, > + { CCI_REG8(0x030d), 0x04 }, > + { CCI_REG8(0x030e), 0x01 }, > + { CCI_REG8(0x030f), 0x49 }, > + { CCI_REG8(0x0310), 0x01 }, > + { CCI_REG8(0x0820), 0x07 }, > + { CCI_REG8(0x0821), 0xb6 }, > + { CCI_REG8(0x0822), 0x00 }, > + { CCI_REG8(0x0823), 0x00 }, > + { CCI_REG8(0x3e20), 0x01 }, > + { CCI_REG8(0x3e37), 0x00 }, > + { CCI_REG8(0x3e3b), 0x00 }, > + { CCI_REG8(0x0106), 0x00 }, > + { CCI_REG8(0x0b00), 0x00 }, > + { CCI_REG8(0x3230), 0x00 }, > + { CCI_REG8(0x3f14), 0x01 }, > + { CCI_REG8(0x3f3c), 0x01 }, > + { CCI_REG8(0x3f0d), 0x0a }, > + { CCI_REG8(0x3fbc), 0x00 }, > + { CCI_REG8(0x3c06), 0x00 }, > + { CCI_REG8(0x3c07), 0x48 }, > + { CCI_REG8(0x3c0a), 0x00 }, > + { CCI_REG8(0x3c0b), 0x00 }, > + { CCI_REG8(0x3f78), 0x00 }, > + { CCI_REG8(0x3f79), 0x40 }, > + { CCI_REG8(0x3f7c), 0x00 }, > + { CCI_REG8(0x3f7d), 0x00 }, > +}; > + > +/* 720p 120fps mode */ > +static const struct cci_reg_sequence mode_1280x720_regs[] = { > + { CCI_REG8(0x0111), 0x02 }, > + { CCI_REG8(0x0112), 0x0a }, > + { CCI_REG8(0x0113), 0x0a }, > + { CCI_REG8(0x0114), 0x01 }, > + { CCI_REG8(0x0342), 0x1b }, > + { CCI_REG8(0x0343), 0x3b }, > + { CCI_REG8(0x0340), 0x03 }, > + { CCI_REG8(0x0341), 0x34 }, > + { CCI_REG8(0x0344), 0x04 }, > + { CCI_REG8(0x0345), 0x18 }, > + { CCI_REG8(0x0346), 0x04 }, > + { CCI_REG8(0x0347), 0x12 }, > + { CCI_REG8(0x0348), 0x0e }, > + { CCI_REG8(0x0349), 0x17 }, > + { CCI_REG8(0x034a), 0x09 }, > + { CCI_REG8(0x034b), 0xb6 }, > + { CCI_REG8(0x0220), 0x00 }, > + { CCI_REG8(0x0221), 0x11 }, > + { CCI_REG8(0x0222), 0x01 }, > + { CCI_REG8(0x0900), 0x01 }, > + { CCI_REG8(0x0901), 0x22 }, > + { CCI_REG8(0x0902), 0x0a }, > + { CCI_REG8(0x3f4c), 0x01 }, > + { CCI_REG8(0x3f4d), 0x01 }, > + { CCI_REG8(0x4254), 0x7f }, > + { CCI_REG8(0x0401), 0x00 }, > + { CCI_REG8(0x0404), 0x00 }, > + { CCI_REG8(0x0405), 0x10 }, > + { CCI_REG8(0x0408), 0x00 }, > + { CCI_REG8(0x0409), 0x00 }, > + { CCI_REG8(0x040a), 0x00 }, > + { CCI_REG8(0x040b), 0x00 }, > + { CCI_REG8(0x040c), 0x05 }, > + { CCI_REG8(0x040d), 0x00 }, > + { CCI_REG8(0x040e), 0x02 }, > + { CCI_REG8(0x040f), 0xd0 }, > + { CCI_REG8(0x034c), 0x05 }, > + { CCI_REG8(0x034d), 0x00 }, > + { CCI_REG8(0x034e), 0x02 }, > + { CCI_REG8(0x034f), 0xd0 }, > + { CCI_REG8(0x0301), 0x06 }, > + { CCI_REG8(0x0303), 0x04 }, > + { CCI_REG8(0x0305), 0x04 }, > + { CCI_REG8(0x0306), 0x01 }, > + { CCI_REG8(0x0307), 0x57 }, > + { CCI_REG8(0x0309), 0x0a }, > + { CCI_REG8(0x030b), 0x02 }, > + { CCI_REG8(0x030d), 0x04 }, > + { CCI_REG8(0x030e), 0x01 }, > + { CCI_REG8(0x030f), 0x49 }, > + { CCI_REG8(0x0310), 0x01 }, > + { CCI_REG8(0x0820), 0x07 }, > + { CCI_REG8(0x0821), 0xb6 }, > + { CCI_REG8(0x0822), 0x00 }, > + { CCI_REG8(0x0823), 0x00 }, > + { CCI_REG8(0x3e20), 0x01 }, > + { CCI_REG8(0x3e37), 0x00 }, > + { CCI_REG8(0x3e3b), 0x00 }, > + { CCI_REG8(0x0106), 0x00 }, > + { CCI_REG8(0x0b00), 0x00 }, > + { CCI_REG8(0x3230), 0x00 }, > + { CCI_REG8(0x3f14), 0x01 }, > + { CCI_REG8(0x3f3c), 0x01 }, > + { CCI_REG8(0x3f0d), 0x0a }, > + { CCI_REG8(0x3fbc), 0x00 }, > + { CCI_REG8(0x3c06), 0x00 }, > + { CCI_REG8(0x3c07), 0x48 }, > + { CCI_REG8(0x3c0a), 0x00 }, > + { CCI_REG8(0x3c0b), 0x00 }, > + { CCI_REG8(0x3f78), 0x00 }, > + { CCI_REG8(0x3f79), 0x40 }, > + { CCI_REG8(0x3f7c), 0x00 }, > + { CCI_REG8(0x3f7d), 0x00 }, > +}; > + > +/* Mode configs */ > +static const struct imx519_mode supported_modes_10bit[] = { > + { > + .width = 4656, > + .height = 3496, > + .line_length_pix = 0x4200, These numbers duplicate those in CCI_REG16(0x342), so the duplication could be removed between the register tables and struct imx519_mode. More interesting is that the datasheet lists constraints on LINE_LENGTH_PCK. None of the values for line_length_pix meet the constraints listed. I guess seeing as Arducam are prepared to act as maintainers for this driver, that's on them. > + .crop = { > + .left = IMX519_PIXEL_ARRAY_LEFT, > + .top = IMX519_PIXEL_ARRAY_TOP, > + .width = 4656, > + .height = 3496, > + }, > + .timeperframe_min = { > + .numerator = 100, > + .denominator = 1000 > + }, > + .timeperframe_default = { > + .numerator = 100, > + .denominator = 1000 > + }, > + .reg_list = { > + .num_of_regs = ARRAY_SIZE(mode_4656x3496_regs), > + .regs = mode_4656x3496_regs, > + } > + }, > + { > + .width = 3840, > + .height = 2160, > + .line_length_pix = 0x3870, > + .crop = { > + .left = IMX519_PIXEL_ARRAY_LEFT + 408, > + .top = IMX519_PIXEL_ARRAY_TOP + 672, > + .width = 3840, > + .height = 2160, Doesn't match the registers defined for the height - rows 0x2a0 to 0xb17 is 2168 rows high. > + }, > + .timeperframe_min = { > + .numerator = 100, > + .denominator = 2100 > + }, > + .timeperframe_default = { > + .numerator = 100, > + .denominator = 2100 > + }, > + .reg_list = { > + .num_of_regs = ARRAY_SIZE(mode_3840x2160_regs), > + .regs = mode_3840x2160_regs, > + } > + }, > + { > + .width = 2328, > + .height = 1748, > + .line_length_pix = 0x2412, > + .crop = { > + .left = IMX519_PIXEL_ARRAY_LEFT, > + .top = IMX519_PIXEL_ARRAY_TOP, > + .width = 4656, > + .height = 3496, > + }, > + .timeperframe_min = { > + .numerator = 100, > + .denominator = 3000 > + }, > + .timeperframe_default = { > + .numerator = 100, > + .denominator = 3000 > + }, > + .reg_list = { > + .num_of_regs = ARRAY_SIZE(mode_2328x1748_regs), > + .regs = mode_2328x1748_regs, > + } > + }, > + { > + .width = 1920, > + .height = 1080, > + .line_length_pix = 0x25D9, > + .crop = { > + .left = IMX519_PIXEL_ARRAY_LEFT + 408, > + .top = IMX519_PIXEL_ARRAY_TOP + 674, > + .width = 3840, > + .height = 2160, Doesn't match the registers defined for the height - rows 0x2a0 to 0xb15 is 2166 rows high, binned by a factor of 2 is 1082. > + }, > + .timeperframe_min = { > + .numerator = 100, > + .denominator = 6000 > + }, > + .timeperframe_default = { > + .numerator = 100, > + .denominator = 6000 > + }, > + .reg_list = { > + .num_of_regs = ARRAY_SIZE(mode_1920x1080_regs), > + .regs = mode_1920x1080_regs, > + } > + }, > + { > + .width = 1280, > + .height = 720, > + .line_length_pix = 0x1B3B, > + .crop = { > + .left = IMX519_PIXEL_ARRAY_LEFT + 1048, > + .top = IMX519_PIXEL_ARRAY_TOP + 1042, > + .width = 2560, > + .height = 1440, Doesn't match the registers defined for the height - rows 0x412 to 0x9b6 is 1445 rows high (an odd number - very curious for a Bayer image), binned by a factor of 2 is 722.5 lines. Seeing as the Bayer pattern changes based on flip, does this mode work correctly if vflipped and therefore starting on an even line number? > + }, > + .timeperframe_min = { > + .numerator = 100, > + .denominator = 12000 > + }, > + .timeperframe_default = { > + .numerator = 100, > + .denominator = 12000 > + }, > + .reg_list = { > + .num_of_regs = ARRAY_SIZE(mode_1280x720_regs), > + .regs = mode_1280x720_regs, > + } > + } > +}; > + > +/* > + * The supported formats. > + * This table MUST contain 4 entries per format, to cover the various flip > + * combinations in the order > + * - no flip > + * - h flip > + * - v flip > + * - h&v flips > + */ > +static const u32 imx519_mbus_formats[] = { > + /* 10-bit modes. */ > + MEDIA_BUS_FMT_SRGGB10_1X10, > + MEDIA_BUS_FMT_SGRBG10_1X10, > + MEDIA_BUS_FMT_SGBRG10_1X10, > + MEDIA_BUS_FMT_SBGGR10_1X10, > +}; > + > +static const char * const imx519_test_pattern_menu[] = { > + "Disabled", > + "Color Bars", > + "Solid Color", > + "Grey Color Bars", > + "PN9" > +}; > + > +static const int imx519_test_pattern_val[] = { > + IMX519_TEST_PATTERN_DISABLE, > + IMX519_TEST_PATTERN_COLOR_BARS, > + IMX519_TEST_PATTERN_SOLID_COLOR, > + IMX519_TEST_PATTERN_GREY_COLOR, > + IMX519_TEST_PATTERN_PN9, > +}; > + > +/* regulator supplies */ > +static const char * const imx519_supply_name[] = { > + /* Supplies can be enabled in any order */ > + "vana", /* Analog (2.8V) supply */ > + "vdig", /* Digital Core (1.05V) supply */ > + "vddl", /* IF (1.8V) supply */ > +}; > + > +/* > + * Initialisation delay between XCLR low->high and the moment when the sensor > + * can start capture (i.e. can leave software standby), given by T7 in the > + * datasheet is 8ms. This does include I2C setup time as well. > + * > + * Note, that delay between XCLR low->high and reading the CCI ID register (T6 > + * in the datasheet) is much smaller - 600us. > + */ > +#define IMX519_XCLR_MIN_DELAY_US 8000 > +#define IMX519_XCLR_DELAY_RANGE_US 1000 > + > +struct imx519 { > + struct v4l2_subdev sd; > + struct media_pad pad; > + > + struct regmap *regmap; > + struct clk *xclk; > + > + struct gpio_desc *reset_gpio; > + struct regulator_bulk_data supplies[ARRAY_SIZE(imx519_supply_name)]; > + > + struct v4l2_ctrl_handler ctrl_handler; > + /* V4L2 Controls */ > + struct v4l2_ctrl *exposure; > + struct v4l2_ctrl *vflip; > + struct v4l2_ctrl *hflip; > + struct v4l2_ctrl *vblank; > + struct v4l2_ctrl *hblank; > + > + /* Current mode */ > + const struct imx519_mode *mode; > + > + /* Rewrite common registers on stream on? */ > + bool common_regs_written; > + > + /* Current long exposure factor in use. Set through V4L2_CID_VBLANK */ > + unsigned int long_exp_shift; > +}; > + > +static inline struct imx519 *to_imx519(struct v4l2_subdev *sd) > +{ > + return container_of(sd, struct imx519, sd); > +} > + > +/* Get bayer order based on flip setting. */ > +static u32 imx519_get_format_code(struct imx519 *imx519) > +{ > + unsigned int i; > + > + i = (imx519->vflip->val ? 2 : 0) | > + (imx519->hflip->val ? 1 : 0); > + > + return imx519_mbus_formats[i]; > +} > + > +static void imx519_adjust_exposure_range(struct imx519 *imx519) > +{ > + int exposure_max, exposure_def; > + > + /* Honour the VBLANK limits when setting exposure. */ > + exposure_max = imx519->mode->height + imx519->vblank->val - > + IMX519_EXPOSURE_OFFSET; > + exposure_def = min(exposure_max, imx519->exposure->val); > + __v4l2_ctrl_modify_range(imx519->exposure, imx519->exposure->minimum, > + exposure_max, imx519->exposure->step, > + exposure_def); > +} > + > +static int imx519_set_frame_length(struct imx519 *imx519, unsigned int val) > +{ > + int ret = 0; > + > + imx519->long_exp_shift = 0; > + > + while (val > IMX519_FRAME_LENGTH_MAX) { > + imx519->long_exp_shift++; > + val >>= 1; > + } > + > + cci_write(imx519->regmap, IMX519_REG_FRAME_LENGTH, val, &ret); > + if (ret) > + return ret; cci_write already aborts if ret != 0, so no need to check it here. There may be other similar cases through the file. > + > + cci_write(imx519->regmap, IMX519_LONG_EXP_SHIFT_REG, > + imx519->long_exp_shift, &ret); > + > + return ret; > +} > + > +static int imx519_set_ctrl(struct v4l2_ctrl *ctrl) > +{ > + struct imx519 *imx519 = > + container_of(ctrl->handler, struct imx519, ctrl_handler); > + struct i2c_client *client = v4l2_get_subdevdata(&imx519->sd); > + int ret = 0; > + > + /* > + * The VBLANK control may change the limits of usable exposure, so check > + * and adjust if necessary. > + */ > + if (ctrl->id == V4L2_CID_VBLANK) > + imx519_adjust_exposure_range(imx519); > + > + /* > + * Applying V4L2 control value only happens > + * when power is up for streaming > + */ > + if (pm_runtime_get_if_in_use(&client->dev) == 0) > + return 0; > + > + switch (ctrl->id) { > + case V4L2_CID_ANALOGUE_GAIN: > + cci_write(imx519->regmap, IMX519_REG_ANALOG_GAIN, > + ctrl->val, &ret); > + break; > + case V4L2_CID_EXPOSURE: > + cci_write(imx519->regmap, IMX519_REG_EXPOSURE, > + ctrl->val >> imx519->long_exp_shift, &ret); > + break; > + case V4L2_CID_DIGITAL_GAIN: > + cci_write(imx519->regmap, IMX519_REG_DIGITAL_GAIN, > + ctrl->val, &ret); > + break; > + case V4L2_CID_TEST_PATTERN: > + cci_write(imx519->regmap, IMX519_REG_TEST_PATTERN, > + imx519_test_pattern_val[ctrl->val], &ret); > + break; > + case V4L2_CID_TEST_PATTERN_RED: > + cci_write(imx519->regmap, IMX519_REG_TEST_PATTERN_R, > + ctrl->val, &ret); > + break; > + case V4L2_CID_TEST_PATTERN_GREENR: > + cci_write(imx519->regmap, IMX519_REG_TEST_PATTERN_GR, > + ctrl->val, &ret); > + break; > + case V4L2_CID_TEST_PATTERN_BLUE: > + cci_write(imx519->regmap, IMX519_REG_TEST_PATTERN_B, > + ctrl->val, &ret); > + break; > + case V4L2_CID_TEST_PATTERN_GREENB: > + cci_write(imx519->regmap, IMX519_REG_TEST_PATTERN_GB, > + ctrl->val, &ret); > + break; > + case V4L2_CID_HFLIP: > + case V4L2_CID_VFLIP: > + cci_write(imx519->regmap, IMX519_REG_ORIENTATION, > + imx519->hflip->val | imx519->vflip->val << 1, &ret); As these are always set together, define them as a cluster. > + break; > + case V4L2_CID_VBLANK: > + ret = imx519_set_frame_length(imx519, > + imx519->mode->height + ctrl->val); This can change IMX519_LONG_EXP_SHIFT_REG, in which case IMX519_REG_EXPOSURE needs to be rewritten with the new value of imx519->long_exp_shift taken into account. > + break; > + default: > + dev_info(&client->dev, > + "ctrl(id:0x%x,val:0x%x) is not handled\n", > + ctrl->id, ctrl->val); > + ret = -EINVAL; > + break; > + } > + > + pm_runtime_mark_last_busy(&client->dev); > + pm_runtime_put_autosuspend(&client->dev); > + > + return ret; > +} > + > +static const struct v4l2_ctrl_ops imx519_ctrl_ops = { > + .s_ctrl = imx519_set_ctrl, > +}; > + > +static int imx519_init_cfg(struct v4l2_subdev *sd, > + struct v4l2_subdev_state *state) > +{ > + struct imx519 *imx519 = to_imx519(sd); > + struct v4l2_mbus_framefmt *format; > + struct v4l2_rect *crop; > + > + /* Initialize try_fmt. */ > + format = v4l2_subdev_get_pad_format(sd, state, 0); > + format->width = supported_modes_10bit[0].width; > + format->height = supported_modes_10bit[0].height; > + format->code = imx519_get_format_code(imx519); > + format->field = V4L2_FIELD_NONE; > + format->colorspace = V4L2_COLORSPACE_RAW; > + format->ycbcr_enc = V4L2_MAP_YCBCR_ENC_DEFAULT(format->colorspace); > + format->quantization = V4L2_QUANTIZATION_FULL_RANGE; > + format->xfer_func = V4L2_XFER_FUNC_NONE; Mix and match between using the _DEFAULT and direct assignment. Largely duplicated in imx519_update_image_pad_format too - Laurent sorted this for imx219 in https://patchwork.linuxtv.org/project/linux-media/patch/20230821223001.28480-16-laurent.pinchart@ideasonboard.com/ > + > + /* Initialize crop rectangle. */ > + crop = v4l2_subdev_get_pad_crop(sd, state, 0); > + crop->top = IMX519_PIXEL_ARRAY_TOP; > + crop->left = IMX519_PIXEL_ARRAY_LEFT; > + crop->width = IMX519_PIXEL_ARRAY_WIDTH; > + crop->height = IMX519_PIXEL_ARRAY_HEIGHT; > + > + return 0; > +} > + > +static int imx519_enum_mbus_code(struct v4l2_subdev *sd, > + struct v4l2_subdev_state *sd_state, > + struct v4l2_subdev_mbus_code_enum *code) > +{ > + struct imx519 *imx519 = to_imx519(sd); > + > + if (code->index > 0) > + return -EINVAL; > + > + code->code = imx519_get_format_code(imx519); > + > + return 0; > +} > + > +static int imx519_enum_frame_size(struct v4l2_subdev *sd, > + struct v4l2_subdev_state *sd_state, > + struct v4l2_subdev_frame_size_enum *fse) > +{ > + struct imx519 *imx519 = to_imx519(sd); > + > + if (fse->index >= ARRAY_SIZE(supported_modes_10bit)) > + return -EINVAL; > + > + if (fse->code != imx519_get_format_code(imx519)) > + return -EINVAL; > + > + fse->min_width = supported_modes_10bit[fse->index].width; > + fse->max_width = fse->min_width; > + fse->min_height = supported_modes_10bit[fse->index].height; > + fse->max_height = fse->min_height; > + > + return 0; > +} > + > +static void imx519_update_image_pad_format(struct imx519 *imx519, > + const struct imx519_mode *mode, > + struct v4l2_subdev_format *fmt) > +{ > + fmt->format.width = mode->width; > + fmt->format.height = mode->height; > + fmt->format.field = V4L2_FIELD_NONE; > + fmt->format.colorspace = V4L2_COLORSPACE_RAW; > + fmt->format.xfer_func = V4L2_XFER_FUNC_NONE; > + fmt->format.ycbcr_enc = V4L2_YCBCR_ENC_601; > + fmt->format.quantization = V4L2_QUANTIZATION_FULL_RANGE; > +} > + > +static > +unsigned int imx519_get_frame_length(const struct imx519_mode *mode, > + const struct v4l2_fract *timeperframe) > +{ > + u64 frame_length; > + > + frame_length = (u64)timeperframe->numerator * IMX519_PIXEL_RATE; > + do_div(frame_length, > + (u64)timeperframe->denominator * mode->line_length_pix); > + > + if (WARN_ON(frame_length > IMX519_FRAME_LENGTH_MAX)) > + frame_length = IMX519_FRAME_LENGTH_MAX; > + > + return max_t(unsigned int, frame_length, mode->height); > +} > + > +static void imx519_set_framing_limits(struct imx519 *imx519) > +{ > + unsigned int frm_length_min, frm_length_default, hblank; > + const struct imx519_mode *mode = imx519->mode; > + > + frm_length_min = imx519_get_frame_length(mode, &mode->timeperframe_min); > + frm_length_default = > + imx519_get_frame_length(mode, &mode->timeperframe_default); > + > + /* Default to no long exposure multiplier. */ > + imx519->long_exp_shift = 0; > + > + /* Update limits and set FPS to default */ > + __v4l2_ctrl_modify_range(imx519->vblank, frm_length_min - mode->height, > + ((1 << IMX519_LONG_EXP_SHIFT_MAX) * > + IMX519_FRAME_LENGTH_MAX) - mode->height, > + 1, frm_length_default - mode->height); > + > + /* Setting this will adjust the exposure limits as well. */ > + __v4l2_ctrl_s_ctrl(imx519->vblank, frm_length_default - mode->height); > + > + /* > + * Currently PPL is fixed to the mode specified value, so hblank > + * depends on mode->width only, and is not changeable in any > + * way other than changing the mode. > + */ > + hblank = mode->line_length_pix - mode->width; > + __v4l2_ctrl_modify_range(imx519->hblank, hblank, hblank, 1, hblank); > +} > + > +static int imx519_set_pad_format(struct v4l2_subdev *sd, > + struct v4l2_subdev_state *sd_state, > + struct v4l2_subdev_format *fmt) > +{ > + struct v4l2_mbus_framefmt *format; > + const struct imx519_mode *mode; > + struct imx519 *imx519 = to_imx519(sd); > + > + /* Bayer order varies with flips */ > + fmt->format.code = imx519_get_format_code(imx519); > + > + mode = v4l2_find_nearest_size(supported_modes_10bit, > + ARRAY_SIZE(supported_modes_10bit), > + width, height, > + fmt->format.width, > + fmt->format.height); > + imx519_update_image_pad_format(imx519, mode, fmt); > + format = v4l2_subdev_get_pad_format(sd, sd_state, 0); > + if (imx519->mode == mode && format->code == fmt->format.code) > + return 0; > + > + if (fmt->which == V4L2_SUBDEV_FORMAT_ACTIVE) { > + imx519->mode = mode; > + imx519_set_framing_limits(imx519); > + } > + > + *format = fmt->format; > + > + return 0; > +} > + > +static int imx519_get_selection(struct v4l2_subdev *sd, > + struct v4l2_subdev_state *sd_state, > + struct v4l2_subdev_selection *sel) > +{ > + switch (sel->target) { > + case V4L2_SEL_TGT_CROP: { > + sel->r = *v4l2_subdev_get_pad_crop(sd, sd_state, 0); > + return 0; > + } > + > + case V4L2_SEL_TGT_NATIVE_SIZE: > + sel->r.left = 0; > + sel->r.top = 0; > + sel->r.width = IMX519_NATIVE_WIDTH; > + sel->r.height = IMX519_NATIVE_HEIGHT; > + > + return 0; > + > + case V4L2_SEL_TGT_CROP_DEFAULT: > + case V4L2_SEL_TGT_CROP_BOUNDS: > + sel->r.left = IMX519_PIXEL_ARRAY_LEFT; > + sel->r.top = IMX519_PIXEL_ARRAY_TOP; > + sel->r.width = IMX519_PIXEL_ARRAY_WIDTH; > + sel->r.height = IMX519_PIXEL_ARRAY_HEIGHT; > + > + return 0; > + } > + > + return -EINVAL; > +} > + > +/* Start streaming */ > +static int imx519_start_streaming(struct imx519 *imx519, > + struct v4l2_subdev_state *state) > +{ > + struct i2c_client *client = v4l2_get_subdevdata(&imx519->sd); > + const struct imx519_reg_list *reg_list; > + int ret; > + > + ret = pm_runtime_resume_and_get(&client->dev); > + if (ret < 0) > + return ret; > + > + if (!imx519->common_regs_written) { > + ret = cci_multi_reg_write(imx519->regmap, mode_common_regs, > + ARRAY_SIZE(mode_common_regs), NULL); > + > + if (ret) { > + dev_err(&client->dev, "%s failed to set common settings\n", > + __func__); > + goto err_rpm_put; > + } > + imx519->common_regs_written = true; > + } > + > + /* Apply default values of current mode */ > + reg_list = &imx519->mode->reg_list; > + ret = cci_multi_reg_write(imx519->regmap, reg_list->regs, > + reg_list->num_of_regs, NULL); > + if (ret) { > + dev_err(&client->dev, "%s failed to set mode\n", __func__); > + goto err_rpm_put; > + } > + > + /* Apply customized values from user */ > + ret = __v4l2_ctrl_handler_setup(imx519->sd.ctrl_handler); > + if (ret) > + goto err_rpm_put; > + > + /* set stream on register */ > + ret = cci_write(imx519->regmap, IMX519_REG_MODE_SELECT, > + IMX519_MODE_STREAMING, NULL); > + if (ret) > + goto err_rpm_put; > + > + /* vflip and hflip cannot change during streaming */ > + __v4l2_ctrl_grab(imx519->vflip, true); > + __v4l2_ctrl_grab(imx519->hflip, true); > + > + return 0; > + > +err_rpm_put: > + pm_runtime_mark_last_busy(&client->dev); > + pm_runtime_put_autosuspend(&client->dev); > + > + return ret; > +} > + > +/* Stop streaming */ > +static void imx519_stop_streaming(struct imx519 *imx519) > +{ > + struct i2c_client *client = v4l2_get_subdevdata(&imx519->sd); > + int ret; > + > + /* set stream off register */ > + ret = cci_write(imx519->regmap, IMX519_REG_MODE_SELECT, > + IMX519_MODE_STANDBY, NULL); > + if (ret) > + dev_err(&client->dev, "%s failed to set stream\n", __func__); > + > + __v4l2_ctrl_grab(imx519->vflip, false); > + __v4l2_ctrl_grab(imx519->hflip, false); > + > + pm_runtime_mark_last_busy(&client->dev); > + pm_runtime_put_autosuspend(&client->dev); > +} > + > +static int imx519_set_stream(struct v4l2_subdev *sd, int enable) > +{ > + struct imx519 *imx519 = to_imx519(sd); > + struct v4l2_subdev_state *state; > + int ret = 0; > + > + state = v4l2_subdev_lock_and_get_active_state(sd); > + > + if (enable) > + ret = imx519_start_streaming(imx519, state); > + else > + imx519_stop_streaming(imx519); > + > + v4l2_subdev_unlock_state(state); > + > + return ret; > +} > + > +static const struct v4l2_subdev_core_ops imx519_core_ops = { > + .subscribe_event = v4l2_ctrl_subdev_subscribe_event, > + .unsubscribe_event = v4l2_event_subdev_unsubscribe, > +}; > + > +static const struct v4l2_subdev_video_ops imx519_video_ops = { > + .s_stream = imx519_set_stream, > +}; > + > +static const struct v4l2_subdev_pad_ops imx519_pad_ops = { > + .init_cfg = imx519_init_cfg, > + .enum_mbus_code = imx519_enum_mbus_code, > + .get_fmt = v4l2_subdev_get_fmt, > + .set_fmt = imx519_set_pad_format, > + .get_selection = imx519_get_selection, > + .enum_frame_size = imx519_enum_frame_size, > +}; > + > +static const struct v4l2_subdev_ops imx519_subdev_ops = { > + .core = &imx519_core_ops, > + .video = &imx519_video_ops, > + .pad = &imx519_pad_ops, > +}; > + > +/* Power/clock management functions */ > +static int imx519_power_on(struct device *dev) > +{ > + struct i2c_client *client = to_i2c_client(dev); > + struct v4l2_subdev *sd = i2c_get_clientdata(client); > + struct imx519 *imx519 = to_imx519(sd); > + int ret; > + > + ret = regulator_bulk_enable(ARRAY_SIZE(imx519_supply_name), > + imx519->supplies); > + if (ret) { > + dev_err(&client->dev, "%s: failed to enable regulators\n", > + __func__); > + return ret; > + } > + > + ret = clk_prepare_enable(imx519->xclk); > + if (ret) { > + dev_err(&client->dev, "%s: failed to enable clock\n", > + __func__); > + goto reg_off; > + } > + > + gpiod_set_value_cansleep(imx519->reset_gpio, 1); > + usleep_range(IMX519_XCLR_MIN_DELAY_US, > + IMX519_XCLR_MIN_DELAY_US + IMX519_XCLR_DELAY_RANGE_US); > + > + return 0; > + > +reg_off: > + regulator_bulk_disable(ARRAY_SIZE(imx519_supply_name), imx519->supplies); > + > + return ret; > +} > + > +static int imx519_power_off(struct device *dev) > +{ > + struct i2c_client *client = to_i2c_client(dev); > + struct v4l2_subdev *sd = i2c_get_clientdata(client); > + struct imx519 *imx519 = to_imx519(sd); > + > + gpiod_set_value_cansleep(imx519->reset_gpio, 0); > + regulator_bulk_disable(ARRAY_SIZE(imx519_supply_name), imx519->supplies); > + clk_disable_unprepare(imx519->xclk); > + > + /* Force reprogramming of the common registers when powered up again. */ > + imx519->common_regs_written = false; > + > + return 0; > +} > + > +static int imx519_get_regulators(struct imx519 *imx519) > +{ > + struct i2c_client *client = v4l2_get_subdevdata(&imx519->sd); > + unsigned int i; > + > + for (i = 0; i < ARRAY_SIZE(imx519_supply_name); i++) > + imx519->supplies[i].supply = imx519_supply_name[i]; > + > + return devm_regulator_bulk_get(&client->dev, > + ARRAY_SIZE(imx519_supply_name), > + imx519->supplies); > +} > + > +/* Verify chip ID */ > +static int imx519_identify_module(struct imx519 *imx519) > +{ > + struct i2c_client *client = v4l2_get_subdevdata(&imx519->sd); > + int ret; > + u64 val; > + > + ret = cci_read(imx519->regmap, IMX519_REG_CHIP_ID, &val, NULL); > + if (ret) { > + dev_err(&client->dev, "failed to read chip id %x, with error %d\n", > + IMX519_CHIP_ID, ret); > + return ret; > + } > + > + if (val != IMX519_CHIP_ID) { > + dev_err(&client->dev, "chip id mismatch: %x!=%llx\n", > + IMX519_CHIP_ID, val); > + return -EIO; > + } > + > + dev_info(&client->dev, "Device found is imx%llx\n", val); Does this log line help? It's always going to be imx519 or a failure. > + > + return 0; > +} > + > +/* Initialize control handlers */ > +static int imx519_init_controls(struct imx519 *imx519) > +{ > + struct v4l2_ctrl_handler *ctrl_hdlr; > + struct i2c_client *client = v4l2_get_subdevdata(&imx519->sd); > + struct v4l2_fwnode_device_properties props; > + unsigned int i; > + int ret; > + > + ctrl_hdlr = &imx519->ctrl_handler; > + ret = v4l2_ctrl_handler_init(ctrl_hdlr, 16); > + if (ret) > + return ret; > + > + /* By default, PIXEL_RATE is read only */ > + v4l2_ctrl_new_std(ctrl_hdlr, &imx519_ctrl_ops, V4L2_CID_PIXEL_RATE, > + IMX519_PIXEL_RATE, IMX519_PIXEL_RATE, 1, > + IMX519_PIXEL_RATE); > + > + /* > + * Create the controls here, but mode specific limits are setup > + * in the imx519_set_framing_limits() call below. > + */ > + imx519->vblank = v4l2_ctrl_new_std(ctrl_hdlr, &imx519_ctrl_ops, > + V4L2_CID_VBLANK, 0, 0xffff, 1, 0); > + imx519->hblank = v4l2_ctrl_new_std(ctrl_hdlr, &imx519_ctrl_ops, > + V4L2_CID_HBLANK, 0, 0xffff, 1, 0); > + > + /* HBLANK is read-only for now, but does change with mode. */ > + if (imx519->hblank) > + imx519->hblank->flags |= V4L2_CTRL_FLAG_READ_ONLY; All the ctrls that need flags setting are stored in the struct imx519, so do them all after checking ctrl_hdlr->error at the end. I think a number of the fixes that Laurent is working on in the imx219 series could apply generally to this driver too. https://patchwork.linuxtv.org/project/linux-media/cover/20230821223001.28480-1-laurent.pinchart@ideasonboard.com/ Dave > + > + imx519->exposure = v4l2_ctrl_new_std(ctrl_hdlr, &imx519_ctrl_ops, > + V4L2_CID_EXPOSURE, > + IMX519_EXPOSURE_MIN, > + IMX519_EXPOSURE_MAX, > + IMX519_EXPOSURE_STEP, > + IMX519_EXPOSURE_DEFAULT); > + > + v4l2_ctrl_new_std(ctrl_hdlr, &imx519_ctrl_ops, V4L2_CID_ANALOGUE_GAIN, > + IMX519_ANA_GAIN_MIN, IMX519_ANA_GAIN_MAX, > + IMX519_ANA_GAIN_STEP, IMX519_ANA_GAIN_DEFAULT); > + > + v4l2_ctrl_new_std(ctrl_hdlr, &imx519_ctrl_ops, V4L2_CID_DIGITAL_GAIN, > + IMX519_DGTL_GAIN_MIN, IMX519_DGTL_GAIN_MAX, > + IMX519_DGTL_GAIN_STEP, IMX519_DGTL_GAIN_DEFAULT); > + > + imx519->hflip = v4l2_ctrl_new_std(ctrl_hdlr, &imx519_ctrl_ops, > + V4L2_CID_HFLIP, 0, 1, 1, 0); > + if (imx519->hflip) > + imx519->hflip->flags |= V4L2_CTRL_FLAG_MODIFY_LAYOUT; > + > + imx519->vflip = v4l2_ctrl_new_std(ctrl_hdlr, &imx519_ctrl_ops, > + V4L2_CID_VFLIP, 0, 1, 1, 0); > + if (imx519->vflip) > + imx519->vflip->flags |= V4L2_CTRL_FLAG_MODIFY_LAYOUT; > + > + v4l2_ctrl_new_std_menu_items(ctrl_hdlr, &imx519_ctrl_ops, > + V4L2_CID_TEST_PATTERN, > + ARRAY_SIZE(imx519_test_pattern_menu) - 1, > + 0, 0, imx519_test_pattern_menu); > + for (i = 0; i < 4; i++) { > + /* > + * The assumption is that > + * V4L2_CID_TEST_PATTERN_GREENR == V4L2_CID_TEST_PATTERN_RED + 1 > + * V4L2_CID_TEST_PATTERN_BLUE == V4L2_CID_TEST_PATTERN_RED + 2 > + * V4L2_CID_TEST_PATTERN_GREENB == V4L2_CID_TEST_PATTERN_RED + 3 > + */ > + v4l2_ctrl_new_std(ctrl_hdlr, &imx519_ctrl_ops, > + V4L2_CID_TEST_PATTERN_RED + i, > + IMX519_TEST_PATTERN_COLOUR_MIN, > + IMX519_TEST_PATTERN_COLOUR_MAX, > + IMX519_TEST_PATTERN_COLOUR_STEP, > + IMX519_TEST_PATTERN_COLOUR_MAX); > + /* The "Solid color" pattern is white by default */ > + } > + > + if (ctrl_hdlr->error) { > + ret = ctrl_hdlr->error; > + dev_err(&client->dev, "%s control init failed (%d)\n", > + __func__, ret); > + goto error; > + } > + > + ret = v4l2_fwnode_device_parse(&client->dev, &props); > + if (ret) > + goto error; > + > + ret = v4l2_ctrl_new_fwnode_properties(ctrl_hdlr, &imx519_ctrl_ops, > + &props); > + if (ret) > + goto error; > + > + imx519->sd.ctrl_handler = ctrl_hdlr; > + > + mutex_lock(imx519->ctrl_handler.lock); > + > + /* Setup exposure and frame/line length limits. */ > + imx519_set_framing_limits(imx519); > + > + mutex_unlock(imx519->ctrl_handler.lock); > + > + return 0; > + > +error: > + v4l2_ctrl_handler_free(ctrl_hdlr); > + > + return ret; > +} > + > +static void imx519_free_controls(struct imx519 *imx519) > +{ > + v4l2_ctrl_handler_free(imx519->sd.ctrl_handler); > +} > + > +static int imx519_check_hwcfg(struct device *dev) > +{ > + struct fwnode_handle *endpoint; > + struct v4l2_fwnode_endpoint ep_cfg = { > + .bus_type = V4L2_MBUS_CSI2_DPHY > + }; > + int ret = -EINVAL; > + > + endpoint = fwnode_graph_get_next_endpoint(dev_fwnode(dev), NULL); > + if (!endpoint) { > + dev_err(dev, "endpoint node not found\n"); > + return -EINVAL; > + } > + > + if (v4l2_fwnode_endpoint_alloc_parse(endpoint, &ep_cfg)) { > + dev_err(dev, "could not parse endpoint\n"); > + goto out; > + } > + > + /* Check the number of MIPI CSI2 data lanes */ > + if (ep_cfg.bus.mipi_csi2.num_data_lanes != 2) { > + dev_err(dev, "only 2 data lanes are currently supported\n"); > + goto out; > + } > + > + /* Check the link frequency set in device tree */ > + if (!ep_cfg.nr_of_link_frequencies) { > + dev_err(dev, "link-frequency property not found in DT\n"); > + goto out; > + } > + > + if (ep_cfg.nr_of_link_frequencies != 1 || > + ep_cfg.link_frequencies[0] != IMX519_DEFAULT_LINK_FREQ) { > + dev_err(dev, "Link frequency not supported: %lld\n", > + ep_cfg.link_frequencies[0]); > + goto out; > + } > + > + ret = 0; > + > +out: > + v4l2_fwnode_endpoint_free(&ep_cfg); > + fwnode_handle_put(endpoint); > + > + return ret; > +} > + > +static const struct of_device_id imx519_dt_ids[] = { > + { .compatible = "sony,imx519" }, > + { /* sentinel */ } > +}; > + > +static int imx519_probe(struct i2c_client *client) > +{ > + struct device *dev = &client->dev; > + struct imx519 *imx519; > + u32 xclk_freq; > + int ret; > + > + imx519 = devm_kzalloc(&client->dev, sizeof(*imx519), GFP_KERNEL); > + if (!imx519) > + return -ENOMEM; > + > + v4l2_i2c_subdev_init(&imx519->sd, client, &imx519_subdev_ops); > + > + /* Check the hardware configuration in device tree */ > + if (imx519_check_hwcfg(dev)) > + return -EINVAL; > + > + imx519->regmap = devm_cci_regmap_init_i2c(client, 16); > + if (IS_ERR(imx519->regmap)) > + return dev_err_probe(dev, PTR_ERR(imx519->regmap), > + "failed to initialize CCI\n"); > + > + /* Get system clock (xclk) */ > + imx519->xclk = devm_clk_get(dev, NULL); > + if (IS_ERR(imx519->xclk)) > + return dev_err_probe(dev, PTR_ERR(imx519->xclk), > + "failed to get xclk\n"); > + > + xclk_freq = clk_get_rate(imx519->xclk); > + if (xclk_freq != IMX519_XCLK_FREQ) > + return dev_err_probe(dev, -EINVAL, > + "xclk frequency not supported: %d Hz\n", > + xclk_freq); > + > + ret = imx519_get_regulators(imx519); > + if (ret) > + return dev_err_probe(dev, ret, "failed to get regulators\n"); > + > + /* Request optional enable pin */ > + imx519->reset_gpio = devm_gpiod_get_optional(dev, "reset", > + GPIOD_OUT_HIGH); > + if (IS_ERR(imx519->reset_gpio)) > + return dev_err_probe(dev, PTR_ERR(imx519->reset_gpio), > + "failed to get reset gpio\n"); > + > + /* > + * The sensor must be powered for imx519_identify_module() > + * to be able to read the CHIP_ID register > + */ > + ret = imx519_power_on(dev); > + if (ret) > + return ret; > + > + ret = imx519_identify_module(imx519); > + if (ret) > + goto error_power_off; > + > + /* Set default mode to max resolution */ > + imx519->mode = &supported_modes_10bit[0]; > + > + /* > + * Enable runtime PM. As the device has been powered manually, mark it > + * as active, and increase the usage count without resuming the device. > + */ > + pm_runtime_set_active(dev); > + pm_runtime_get_noresume(dev); > + pm_runtime_enable(dev); > + > + pm_runtime_set_autosuspend_delay(dev, 1000); > + pm_runtime_use_autosuspend(dev); > + > + /* This needs the pm runtime to be registered. */ > + ret = imx519_init_controls(imx519); > + if (ret) > + goto error_rpm_disable; > + > + /* Initialize subdev */ > + imx519->sd.flags |= V4L2_SUBDEV_FL_HAS_DEVNODE | > + V4L2_SUBDEV_FL_HAS_EVENTS; > + imx519->sd.entity.function = MEDIA_ENT_F_CAM_SENSOR; > + > + /* Initialize source pads */ > + imx519->pad.flags = MEDIA_PAD_FL_SOURCE; > + > + ret = media_entity_pads_init(&imx519->sd.entity, 1, &imx519->pad); > + if (ret) { > + dev_err(dev, "failed to init entity pads: %d\n", ret); > + goto error_handler_free; > + } > + > + imx519->sd.state_lock = imx519->ctrl_handler.lock; > + ret = v4l2_subdev_init_finalize(&imx519->sd); > + if (ret < 0) { > + dev_err(dev, "subdev init error: %d\n", ret); > + goto error_media_entity; > + } > + > + ret = v4l2_async_register_subdev_sensor(&imx519->sd); > + if (ret < 0) { > + dev_err(dev, "failed to register sensor sub-device: %d\n", ret); > + goto error_subdev_cleanup; > + } > + > + pm_runtime_mark_last_busy(dev); > + pm_runtime_put_autosuspend(dev); > + > + return 0; > + > +error_subdev_cleanup: > + v4l2_subdev_cleanup(&imx519->sd); > + > +error_media_entity: > + media_entity_cleanup(&imx519->sd.entity); > + > +error_handler_free: > + imx519_free_controls(imx519); > + > +error_rpm_disable: > + pm_runtime_disable(&client->dev); > + pm_runtime_put_noidle(&client->dev); > + > +error_power_off: > + imx519_power_off(&client->dev); > + > + return ret; > +} > + > +static void imx519_remove(struct i2c_client *client) > +{ > + struct v4l2_subdev *sd = i2c_get_clientdata(client); > + struct imx519 *imx519 = to_imx519(sd); > + > + v4l2_async_unregister_subdev(sd); > + v4l2_subdev_cleanup(sd); > + media_entity_cleanup(&sd->entity); > + imx519_free_controls(imx519); > + > + pm_runtime_disable(&client->dev); > + if (!pm_runtime_status_suspended(&client->dev)) > + imx519_power_off(&client->dev); > + pm_runtime_set_suspended(&client->dev); > +} > + > +MODULE_DEVICE_TABLE(of, imx519_dt_ids); > + > +static const struct dev_pm_ops imx519_pm_ops = { > + SET_RUNTIME_PM_OPS(imx519_power_off, imx519_power_on, NULL) > +}; > + > +static struct i2c_driver imx519_i2c_driver = { > + .driver = { > + .name = "imx519", > + .of_match_table = imx519_dt_ids, > + .pm = &imx519_pm_ops, > + }, > + .probe = imx519_probe, > + .remove = imx519_remove, > +}; > + > +module_i2c_driver(imx519_i2c_driver); > + > +MODULE_AUTHOR("Lee Jackson <lee.jackson@arducam.com>"); > +MODULE_DESCRIPTION("Sony IMX519 sensor driver"); > +MODULE_LICENSE("GPL v2"); > -- > 2.41.0 >
Hi Umang On Fri, Sep 08, 2023 at 08:43:44AM -0400, Umang Jain wrote: > From: Lee Jackson <lee.jackson@arducam.com> > > Add a driver for the 16MPix IMX519 CSI2 sensor. > Whilst the sensor supports 2 or 4 CSI2 data lanes, this driver > currently only supports 2 lanes. > > The following Bayer modes are currently available: > > 4656x3496 10-bit @ 10fps > 3840x2160 10-bit (cropped) @ 21fps > 2328x1748 10-bit (binned) @ 30fps > 1920x1080 10-bit (cropped/binned) @ 60fps > 1280x720 10-bit (cropped/binned) @ 120fps > > Signed-off-by: Lee Jackson <lee.jackson@arducam.com> > Signed-off-by: Umang Jain <umang.jain@ideasonboard.com> > --- > MAINTAINERS | 1 + > drivers/media/i2c/Kconfig | 14 + > drivers/media/i2c/Makefile | 1 + > drivers/media/i2c/imx519.c | 1842 ++++++++++++++++++++++++++++++++++++ > 4 files changed, 1858 insertions(+) > create mode 100644 drivers/media/i2c/imx519.c > > diff --git a/MAINTAINERS b/MAINTAINERS > index bca8512c0439..8e5647958e9c 100644 > --- a/MAINTAINERS > +++ b/MAINTAINERS > @@ -19905,6 +19905,7 @@ L: linux-media@vger.kernel.org > S: Maintained > T: git git://linuxtv.org/media_tree.git > F: Documentation/devicetree/bindings/media/i2c/sony,imx519.yaml > +F: drivers/media/i2c/imx519.c > > SONY MEMORYSTICK SUBSYSTEM > M: Maxim Levitsky <maximlevitsky@gmail.com> > diff --git a/drivers/media/i2c/Kconfig b/drivers/media/i2c/Kconfig > index f7cea5c53ead..eb8cf80313b0 100644 > --- a/drivers/media/i2c/Kconfig > +++ b/drivers/media/i2c/Kconfig > @@ -256,6 +256,20 @@ config VIDEO_IMX415 > To compile this driver as a module, choose M here: the > module will be called imx415. > > +config VIDEO_IMX519 > + tristate "Sony IMX519 sensor support" > + depends on I2C && VIDEO_DEV > + select MEDIA_CONTROLLER > + select VIDEO_V4L2_SUBDEV_API > + select V4L2_CCI_I2C > + select V4L2_FWNODE Since commit 11ec2c45b554 ("media: i2c: Remove common dependencies from sensor drivers") it is not required to specify V4L2_FWNODE, MEDIA_CONTROLLER, VIDEO_V4L2_SUBDEV_API, I2C and VIDEO_DEV anymore as they're now selected by the top-level menu. Only select V4L2_CCI_I2C is needed > + help > + This is a Video4Linux2 sensor driver for the Sony > + IMX519 camera. > + > + To compile this driver as a module, choose M here: the > + module will be called imx519. > + > config VIDEO_MAX9271_LIB > tristate > > diff --git a/drivers/media/i2c/Makefile b/drivers/media/i2c/Makefile > index c743aeb5d1ad..a00ac6c7fc81 100644 > --- a/drivers/media/i2c/Makefile > +++ b/drivers/media/i2c/Makefile > @@ -49,6 +49,7 @@ obj-$(CONFIG_VIDEO_IMX335) += imx335.o > obj-$(CONFIG_VIDEO_IMX355) += imx355.o > obj-$(CONFIG_VIDEO_IMX412) += imx412.o > obj-$(CONFIG_VIDEO_IMX415) += imx415.o > +obj-$(CONFIG_VIDEO_IMX519) += imx519.o > obj-$(CONFIG_VIDEO_IR_I2C) += ir-kbd-i2c.o > obj-$(CONFIG_VIDEO_ISL7998X) += isl7998x.o > obj-$(CONFIG_VIDEO_KS0127) += ks0127.o > diff --git a/drivers/media/i2c/imx519.c b/drivers/media/i2c/imx519.c > new file mode 100644 > index 000000000000..f818a3d0bd25 > --- /dev/null > +++ b/drivers/media/i2c/imx519.c > @@ -0,0 +1,1842 @@ > +// SPDX-License-Identifier: GPL-2.0 > +/* Should you retain the copyright as well ? > + * A V4L2 driver for Sony IMX519 cameras. > + * Copyright (C) 2022 Arducam Technology co., Ltd. > + * > + * Based on Sony IMX477 camera driver > + * Copyright (C) 2020 Raspberry Pi (Trading) Ltd > + */ > +#include <asm/unaligned.h> > +#include <linux/clk.h> > +#include <linux/delay.h> > +#include <linux/gpio/consumer.h> > +#include <linux/i2c.h> > +#include <linux/module.h> > +#include <linux/of_device.h> > +#include <linux/pm_runtime.h> > +#include <linux/regulator/consumer.h> > + > +#include <media/v4l2-cci.h> > +#include <media/v4l2-ctrls.h> > +#include <media/v4l2-device.h> > +#include <media/v4l2-event.h> > +#include <media/v4l2-fwnode.h> > +#include <media/v4l2-mediabus.h> > + > +/* Chip ID */ > +#define IMX519_REG_CHIP_ID CCI_REG16(0x0016) > +#define IMX519_CHIP_ID 0x0519 > + > +#define IMX519_REG_MODE_SELECT CCI_REG8(0x0100) > +#define IMX519_MODE_STANDBY 0x00 > +#define IMX519_MODE_STREAMING 0x01 > + > +#define IMX519_REG_ORIENTATION CCI_REG8(0x101) > + > +#define IMX519_XCLK_FREQ 24000000 > + > +#define IMX519_DEFAULT_LINK_FREQ 408000000 > + > +/* Pixel rate is fixed at 686MHz for all the modes */ This doesn't look like 686MHz though :) > +#define IMX519_PIXEL_RATE 426666667 > + > +/* V_TIMING internal */ > +#define IMX519_REG_FRAME_LENGTH CCI_REG16(0x0340) > +#define IMX519_FRAME_LENGTH_MAX 0xffdc > + > +/* Long exposure multiplier */ > +#define IMX519_LONG_EXP_SHIFT_MAX 7 > +#define IMX519_LONG_EXP_SHIFT_REG CCI_REG8(0x3100) > + > +/* Exposure control */ > +#define IMX519_REG_EXPOSURE CCI_REG16(0x0202) > +#define IMX519_EXPOSURE_OFFSET 32 > +#define IMX519_EXPOSURE_MIN 20 > +#define IMX519_EXPOSURE_STEP 1 > +#define IMX519_EXPOSURE_DEFAULT 0x3e8 > +#define IMX519_EXPOSURE_MAX (IMX519_FRAME_LENGTH_MAX - \ > + IMX519_EXPOSURE_OFFSET) > + > +/* Analog gain control */ > +#define IMX519_REG_ANALOG_GAIN CCI_REG16(0x0204) > +#define IMX519_ANA_GAIN_MIN 0 > +#define IMX519_ANA_GAIN_MAX 960 > +#define IMX519_ANA_GAIN_STEP 1 > +#define IMX519_ANA_GAIN_DEFAULT 0x0 > + > +/* Digital gain control */ > +#define IMX519_REG_DIGITAL_GAIN CCI_REG16(0x020e) > +#define IMX519_DGTL_GAIN_MIN 0x0100 > +#define IMX519_DGTL_GAIN_MAX 0xffff > +#define IMX519_DGTL_GAIN_DEFAULT 0x0100 > +#define IMX519_DGTL_GAIN_STEP 1 > + > +/* Test Pattern Control */ > +#define IMX519_REG_TEST_PATTERN CCI_REG16(0x0600) > +#define IMX519_TEST_PATTERN_DISABLE 0 > +#define IMX519_TEST_PATTERN_SOLID_COLOR 1 > +#define IMX519_TEST_PATTERN_COLOR_BARS 2 > +#define IMX519_TEST_PATTERN_GREY_COLOR 3 > +#define IMX519_TEST_PATTERN_PN9 4 > + > +/* Test pattern colour components */ > +#define IMX519_REG_TEST_PATTERN_R CCI_REG16(0x0602) > +#define IMX519_REG_TEST_PATTERN_GR CCI_REG16(0x0604) > +#define IMX519_REG_TEST_PATTERN_B CCI_REG16(0x0606) > +#define IMX519_REG_TEST_PATTERN_GB CCI_REG16(0x0608) > +#define IMX519_TEST_PATTERN_COLOUR_MIN 0 > +#define IMX519_TEST_PATTERN_COLOUR_MAX 0x0fff > +#define IMX519_TEST_PATTERN_COLOUR_STEP 1 > +#define IMX519_TEST_PATTERN_R_DEFAULT IMX519_TEST_PATTERN_COLOUR_MAX > +#define IMX519_TEST_PATTERN_GR_DEFAULT 0 > +#define IMX519_TEST_PATTERN_B_DEFAULT 0 > +#define IMX519_TEST_PATTERN_GB_DEFAULT 0 > + > +/* IMX519 native and active pixel array size. */ > +#define IMX519_NATIVE_WIDTH 4672U > +#define IMX519_NATIVE_HEIGHT 3648U > +#define IMX519_PIXEL_ARRAY_LEFT 8U > +#define IMX519_PIXEL_ARRAY_TOP 48U > +#define IMX519_PIXEL_ARRAY_WIDTH 4656U > +#define IMX519_PIXEL_ARRAY_HEIGHT 3496U > + > +struct imx519_reg_list { > + unsigned int num_of_regs; > + const struct cci_reg_sequence *regs; > +}; > + > +/* Mode : resolution and related config&values */ > +struct imx519_mode { > + /* Frame width */ > + unsigned int width; > + > + /* Frame height */ > + unsigned int height; > + > + /* H-timing in pixels */ > + unsigned int line_length_pix; > + > + /* Analog crop rectangle. */ > + struct v4l2_rect crop; > + > + /* Highest possible framerate. */ > + struct v4l2_fract timeperframe_min; > + > + /* Default framerate. */ > + struct v4l2_fract timeperframe_default; > + > + /* Default register values */ > + struct imx519_reg_list reg_list; > +}; > + > +static const struct cci_reg_sequence mode_common_regs[] = { > + { CCI_REG8(0x0136), 0x18 }, > + { CCI_REG8(0x0137), 0x00 }, > + { CCI_REG8(0x3c7e), 0x01 }, > + { CCI_REG8(0x3c7f), 0x07 }, > + { CCI_REG8(0x3020), 0x00 }, > + { CCI_REG8(0x3e35), 0x01 }, > + { CCI_REG8(0x3f7f), 0x01 }, > + { CCI_REG8(0x5609), 0x57 }, > + { CCI_REG8(0x5613), 0x51 }, > + { CCI_REG8(0x561f), 0x5e }, > + { CCI_REG8(0x5623), 0xd2 }, > + { CCI_REG8(0x5637), 0x11 }, > + { CCI_REG8(0x5657), 0x11 }, > + { CCI_REG8(0x5659), 0x12 }, > + { CCI_REG8(0x5733), 0x60 }, > + { CCI_REG8(0x5905), 0x57 }, > + { CCI_REG8(0x590f), 0x51 }, > + { CCI_REG8(0x591b), 0x5e }, > + { CCI_REG8(0x591f), 0xd2 }, > + { CCI_REG8(0x5933), 0x11 }, > + { CCI_REG8(0x5953), 0x11 }, > + { CCI_REG8(0x5955), 0x12 }, > + { CCI_REG8(0x5a2f), 0x60 }, > + { CCI_REG8(0x5a85), 0x57 }, > + { CCI_REG8(0x5a8f), 0x51 }, > + { CCI_REG8(0x5a9b), 0x5e }, > + { CCI_REG8(0x5a9f), 0xd2 }, > + { CCI_REG8(0x5ab3), 0x11 }, > + { CCI_REG8(0x5ad3), 0x11 }, > + { CCI_REG8(0x5ad5), 0x12 }, > + { CCI_REG8(0x5baf), 0x60 }, > + { CCI_REG8(0x5c15), 0x2a }, > + { CCI_REG8(0x5c17), 0x80 }, > + { CCI_REG8(0x5c19), 0x31 }, > + { CCI_REG8(0x5c1b), 0x87 }, > + { CCI_REG8(0x5c25), 0x25 }, > + { CCI_REG8(0x5c27), 0x7b }, > + { CCI_REG8(0x5c29), 0x2a }, > + { CCI_REG8(0x5c2b), 0x80 }, > + { CCI_REG8(0x5c2d), 0x31 }, > + { CCI_REG8(0x5c2f), 0x87 }, > + { CCI_REG8(0x5c35), 0x2b }, > + { CCI_REG8(0x5c37), 0x81 }, > + { CCI_REG8(0x5c39), 0x31 }, > + { CCI_REG8(0x5c3b), 0x87 }, > + { CCI_REG8(0x5c45), 0x25 }, > + { CCI_REG8(0x5c47), 0x7b }, > + { CCI_REG8(0x5c49), 0x2a }, > + { CCI_REG8(0x5c4b), 0x80 }, > + { CCI_REG8(0x5c4d), 0x31 }, > + { CCI_REG8(0x5c4f), 0x87 }, > + { CCI_REG8(0x5c55), 0x2d }, > + { CCI_REG8(0x5c57), 0x83 }, > + { CCI_REG8(0x5c59), 0x32 }, > + { CCI_REG8(0x5c5b), 0x88 }, > + { CCI_REG8(0x5c65), 0x29 }, > + { CCI_REG8(0x5c67), 0x7f }, > + { CCI_REG8(0x5c69), 0x2e }, > + { CCI_REG8(0x5c6b), 0x84 }, > + { CCI_REG8(0x5c6d), 0x32 }, > + { CCI_REG8(0x5c6f), 0x88 }, > + { CCI_REG8(0x5e69), 0x04 }, > + { CCI_REG8(0x5e9d), 0x00 }, > + { CCI_REG8(0x5f18), 0x10 }, > + { CCI_REG8(0x5f1a), 0x0e }, > + { CCI_REG8(0x5f20), 0x12 }, > + { CCI_REG8(0x5f22), 0x10 }, > + { CCI_REG8(0x5f24), 0x0e }, > + { CCI_REG8(0x5f28), 0x10 }, > + { CCI_REG8(0x5f2a), 0x0e }, > + { CCI_REG8(0x5f30), 0x12 }, > + { CCI_REG8(0x5f32), 0x10 }, > + { CCI_REG8(0x5f34), 0x0e }, > + { CCI_REG8(0x5f38), 0x0f }, > + { CCI_REG8(0x5f39), 0x0d }, > + { CCI_REG8(0x5f3c), 0x11 }, > + { CCI_REG8(0x5f3d), 0x0f }, > + { CCI_REG8(0x5f3e), 0x0d }, > + { CCI_REG8(0x5f61), 0x07 }, > + { CCI_REG8(0x5f64), 0x05 }, > + { CCI_REG8(0x5f67), 0x03 }, > + { CCI_REG8(0x5f6a), 0x03 }, > + { CCI_REG8(0x5f6d), 0x07 }, > + { CCI_REG8(0x5f70), 0x07 }, > + { CCI_REG8(0x5f73), 0x05 }, > + { CCI_REG8(0x5f76), 0x02 }, > + { CCI_REG8(0x5f79), 0x07 }, > + { CCI_REG8(0x5f7c), 0x07 }, > + { CCI_REG8(0x5f7f), 0x07 }, > + { CCI_REG8(0x5f82), 0x07 }, > + { CCI_REG8(0x5f85), 0x03 }, > + { CCI_REG8(0x5f88), 0x02 }, > + { CCI_REG8(0x5f8b), 0x01 }, > + { CCI_REG8(0x5f8e), 0x01 }, > + { CCI_REG8(0x5f91), 0x04 }, > + { CCI_REG8(0x5f94), 0x05 }, > + { CCI_REG8(0x5f97), 0x02 }, > + { CCI_REG8(0x5f9d), 0x07 }, > + { CCI_REG8(0x5fa0), 0x07 }, > + { CCI_REG8(0x5fa3), 0x07 }, > + { CCI_REG8(0x5fa6), 0x07 }, > + { CCI_REG8(0x5fa9), 0x03 }, > + { CCI_REG8(0x5fac), 0x01 }, > + { CCI_REG8(0x5faf), 0x01 }, > + { CCI_REG8(0x5fb5), 0x03 }, > + { CCI_REG8(0x5fb8), 0x02 }, > + { CCI_REG8(0x5fbb), 0x01 }, > + { CCI_REG8(0x5fc1), 0x07 }, > + { CCI_REG8(0x5fc4), 0x07 }, > + { CCI_REG8(0x5fc7), 0x07 }, > + { CCI_REG8(0x5fd1), 0x00 }, > + { CCI_REG8(0x6302), 0x79 }, > + { CCI_REG8(0x6305), 0x78 }, > + { CCI_REG8(0x6306), 0xa5 }, > + { CCI_REG8(0x6308), 0x03 }, > + { CCI_REG8(0x6309), 0x20 }, > + { CCI_REG8(0x630b), 0x0a }, > + { CCI_REG8(0x630d), 0x48 }, > + { CCI_REG8(0x630f), 0x06 }, > + { CCI_REG8(0x6311), 0xa4 }, > + { CCI_REG8(0x6313), 0x03 }, > + { CCI_REG8(0x6314), 0x20 }, > + { CCI_REG8(0x6316), 0x0a }, > + { CCI_REG8(0x6317), 0x31 }, > + { CCI_REG8(0x6318), 0x4a }, > + { CCI_REG8(0x631a), 0x06 }, > + { CCI_REG8(0x631b), 0x40 }, > + { CCI_REG8(0x631c), 0xa4 }, > + { CCI_REG8(0x631e), 0x03 }, > + { CCI_REG8(0x631f), 0x20 }, > + { CCI_REG8(0x6321), 0x0a }, > + { CCI_REG8(0x6323), 0x4a }, > + { CCI_REG8(0x6328), 0x80 }, > + { CCI_REG8(0x6329), 0x01 }, > + { CCI_REG8(0x632a), 0x30 }, > + { CCI_REG8(0x632b), 0x02 }, > + { CCI_REG8(0x632c), 0x20 }, > + { CCI_REG8(0x632d), 0x02 }, > + { CCI_REG8(0x632e), 0x30 }, > + { CCI_REG8(0x6330), 0x60 }, > + { CCI_REG8(0x6332), 0x90 }, > + { CCI_REG8(0x6333), 0x01 }, > + { CCI_REG8(0x6334), 0x30 }, > + { CCI_REG8(0x6335), 0x02 }, > + { CCI_REG8(0x6336), 0x20 }, > + { CCI_REG8(0x6338), 0x80 }, > + { CCI_REG8(0x633a), 0xa0 }, > + { CCI_REG8(0x633b), 0x01 }, > + { CCI_REG8(0x633c), 0x60 }, > + { CCI_REG8(0x633d), 0x02 }, > + { CCI_REG8(0x633e), 0x60 }, > + { CCI_REG8(0x633f), 0x01 }, > + { CCI_REG8(0x6340), 0x30 }, > + { CCI_REG8(0x6341), 0x02 }, > + { CCI_REG8(0x6342), 0x20 }, > + { CCI_REG8(0x6343), 0x03 }, > + { CCI_REG8(0x6344), 0x80 }, > + { CCI_REG8(0x6345), 0x03 }, > + { CCI_REG8(0x6346), 0x90 }, > + { CCI_REG8(0x6348), 0xf0 }, > + { CCI_REG8(0x6349), 0x01 }, > + { CCI_REG8(0x634a), 0x20 }, > + { CCI_REG8(0x634b), 0x02 }, > + { CCI_REG8(0x634c), 0x10 }, > + { CCI_REG8(0x634d), 0x03 }, > + { CCI_REG8(0x634e), 0x60 }, > + { CCI_REG8(0x6350), 0xa0 }, > + { CCI_REG8(0x6351), 0x01 }, > + { CCI_REG8(0x6352), 0x60 }, > + { CCI_REG8(0x6353), 0x02 }, > + { CCI_REG8(0x6354), 0x50 }, > + { CCI_REG8(0x6355), 0x02 }, > + { CCI_REG8(0x6356), 0x60 }, > + { CCI_REG8(0x6357), 0x01 }, > + { CCI_REG8(0x6358), 0x30 }, > + { CCI_REG8(0x6359), 0x02 }, > + { CCI_REG8(0x635a), 0x30 }, > + { CCI_REG8(0x635b), 0x03 }, > + { CCI_REG8(0x635c), 0x90 }, > + { CCI_REG8(0x635f), 0x01 }, > + { CCI_REG8(0x6360), 0x10 }, > + { CCI_REG8(0x6361), 0x01 }, > + { CCI_REG8(0x6362), 0x40 }, > + { CCI_REG8(0x6363), 0x02 }, > + { CCI_REG8(0x6364), 0x50 }, > + { CCI_REG8(0x6368), 0x70 }, > + { CCI_REG8(0x636a), 0xa0 }, > + { CCI_REG8(0x636b), 0x01 }, > + { CCI_REG8(0x636c), 0x50 }, > + { CCI_REG8(0x637d), 0xe4 }, > + { CCI_REG8(0x637e), 0xb4 }, > + { CCI_REG8(0x638c), 0x8e }, > + { CCI_REG8(0x638d), 0x38 }, > + { CCI_REG8(0x638e), 0xe3 }, > + { CCI_REG8(0x638f), 0x4c }, > + { CCI_REG8(0x6390), 0x30 }, > + { CCI_REG8(0x6391), 0xc3 }, > + { CCI_REG8(0x6392), 0xae }, > + { CCI_REG8(0x6393), 0xba }, > + { CCI_REG8(0x6394), 0xeb }, > + { CCI_REG8(0x6395), 0x6e }, > + { CCI_REG8(0x6396), 0x34 }, > + { CCI_REG8(0x6397), 0xe3 }, > + { CCI_REG8(0x6398), 0xcf }, > + { CCI_REG8(0x6399), 0x3c }, > + { CCI_REG8(0x639a), 0xf3 }, > + { CCI_REG8(0x639b), 0x0c }, > + { CCI_REG8(0x639c), 0x30 }, > + { CCI_REG8(0x639d), 0xc1 }, > + { CCI_REG8(0x63b9), 0xa3 }, > + { CCI_REG8(0x63ba), 0xfe }, > + { CCI_REG8(0x7600), 0x01 }, > + { CCI_REG8(0x79a0), 0x01 }, > + { CCI_REG8(0x79a1), 0x01 }, > + { CCI_REG8(0x79a2), 0x01 }, > + { CCI_REG8(0x79a3), 0x01 }, > + { CCI_REG8(0x79a4), 0x01 }, > + { CCI_REG8(0x79a5), 0x20 }, > + { CCI_REG8(0x79a9), 0x00 }, > + { CCI_REG8(0x79aa), 0x01 }, > + { CCI_REG8(0x79ad), 0x00 }, > + { CCI_REG8(0x79af), 0x00 }, > + { CCI_REG8(0x8173), 0x01 }, > + { CCI_REG8(0x835c), 0x01 }, > + { CCI_REG8(0x8a74), 0x01 }, > + { CCI_REG8(0x8c1f), 0x00 }, > + { CCI_REG8(0x8c27), 0x00 }, > + { CCI_REG8(0x8c3b), 0x03 }, > + { CCI_REG8(0x9004), 0x0b }, > + { CCI_REG8(0x920c), 0x6a }, > + { CCI_REG8(0x920d), 0x22 }, > + { CCI_REG8(0x920e), 0x6a }, > + { CCI_REG8(0x920f), 0x23 }, > + { CCI_REG8(0x9214), 0x6a }, > + { CCI_REG8(0x9215), 0x20 }, > + { CCI_REG8(0x9216), 0x6a }, > + { CCI_REG8(0x9217), 0x21 }, > + { CCI_REG8(0x9385), 0x3e }, > + { CCI_REG8(0x9387), 0x1b }, > + { CCI_REG8(0x938d), 0x4d }, > + { CCI_REG8(0x938f), 0x43 }, > + { CCI_REG8(0x9391), 0x1b }, > + { CCI_REG8(0x9395), 0x4d }, > + { CCI_REG8(0x9397), 0x43 }, > + { CCI_REG8(0x9399), 0x1b }, > + { CCI_REG8(0x939d), 0x3e }, > + { CCI_REG8(0x939f), 0x2f }, > + { CCI_REG8(0x93a5), 0x43 }, > + { CCI_REG8(0x93a7), 0x2f }, > + { CCI_REG8(0x93a9), 0x2f }, > + { CCI_REG8(0x93ad), 0x34 }, > + { CCI_REG8(0x93af), 0x2f }, > + { CCI_REG8(0x93b5), 0x3e }, > + { CCI_REG8(0x93b7), 0x2f }, > + { CCI_REG8(0x93bd), 0x4d }, > + { CCI_REG8(0x93bf), 0x43 }, > + { CCI_REG8(0x93c1), 0x2f }, > + { CCI_REG8(0x93c5), 0x4d }, > + { CCI_REG8(0x93c7), 0x43 }, > + { CCI_REG8(0x93c9), 0x2f }, > + { CCI_REG8(0x974b), 0x02 }, > + { CCI_REG8(0x995c), 0x8c }, > + { CCI_REG8(0x995d), 0x00 }, > + { CCI_REG8(0x995e), 0x00 }, > + { CCI_REG8(0x9963), 0x64 }, > + { CCI_REG8(0x9964), 0x50 }, > + { CCI_REG8(0xaa0a), 0x26 }, > + { CCI_REG8(0xae03), 0x04 }, > + { CCI_REG8(0xae04), 0x03 }, > + { CCI_REG8(0xae05), 0x03 }, > + { CCI_REG8(0xbc1c), 0x08 }, > + { CCI_REG8(0xbcf1), 0x02 }, > +}; > + > +/* 16 mpix 10fps */ > +static const struct cci_reg_sequence mode_4656x3496_regs[] = { > + { CCI_REG8(0x0111), 0x02 }, > + { CCI_REG8(0x0112), 0x0a }, > + { CCI_REG8(0x0113), 0x0a }, > + { CCI_REG8(0x0114), 0x01 }, > + { CCI_REG8(0x0342), 0x42 }, > + { CCI_REG8(0x0343), 0x00 }, > + { CCI_REG8(0x0340), 0x0d }, > + { CCI_REG8(0x0341), 0xf4 }, > + { CCI_REG8(0x0344), 0x00 }, > + { CCI_REG8(0x0345), 0x00 }, > + { CCI_REG8(0x0346), 0x00 }, > + { CCI_REG8(0x0347), 0x00 }, > + { CCI_REG8(0x0348), 0x12 }, > + { CCI_REG8(0x0349), 0x2f }, > + { CCI_REG8(0x034a), 0x0d }, > + { CCI_REG8(0x034b), 0xa7 }, > + { CCI_REG8(0x0220), 0x00 }, > + { CCI_REG8(0x0221), 0x11 }, > + { CCI_REG8(0x0222), 0x01 }, > + { CCI_REG8(0x0900), 0x00 }, > + { CCI_REG8(0x0901), 0x11 }, > + { CCI_REG8(0x0902), 0x0a }, > + { CCI_REG8(0x3f4c), 0x01 }, > + { CCI_REG8(0x3f4d), 0x01 }, > + { CCI_REG8(0x4254), 0x7f }, > + { CCI_REG8(0x0401), 0x00 }, > + { CCI_REG8(0x0404), 0x00 }, > + { CCI_REG8(0x0405), 0x10 }, > + { CCI_REG8(0x0408), 0x00 }, > + { CCI_REG8(0x0409), 0x00 }, > + { CCI_REG8(0x040a), 0x00 }, > + { CCI_REG8(0x040b), 0x00 }, > + { CCI_REG8(0x040c), 0x12 }, > + { CCI_REG8(0x040d), 0x30 }, > + { CCI_REG8(0x040e), 0x0d }, > + { CCI_REG8(0x040f), 0xa8 }, > + { CCI_REG8(0x034c), 0x12 }, > + { CCI_REG8(0x034d), 0x30 }, > + { CCI_REG8(0x034e), 0x0d }, > + { CCI_REG8(0x034f), 0xa8 }, > + { CCI_REG8(0x0301), 0x06 }, > + { CCI_REG8(0x0303), 0x04 }, > + { CCI_REG8(0x0305), 0x04 }, > + { CCI_REG8(0x0306), 0x01 }, > + { CCI_REG8(0x0307), 0x57 }, > + { CCI_REG8(0x0309), 0x0a }, > + { CCI_REG8(0x030b), 0x02 }, > + { CCI_REG8(0x030d), 0x04 }, > + { CCI_REG8(0x030e), 0x01 }, > + { CCI_REG8(0x030f), 0x49 }, > + { CCI_REG8(0x0310), 0x01 }, > + { CCI_REG8(0x0820), 0x07 }, > + { CCI_REG8(0x0821), 0xb6 }, > + { CCI_REG8(0x0822), 0x00 }, > + { CCI_REG8(0x0823), 0x00 }, > + { CCI_REG8(0x3e20), 0x01 }, > + { CCI_REG8(0x3e37), 0x00 }, > + { CCI_REG8(0x3e3b), 0x00 }, > + { CCI_REG8(0x0106), 0x00 }, > + { CCI_REG8(0x0b00), 0x00 }, > + { CCI_REG8(0x3230), 0x00 }, > + { CCI_REG8(0x3f14), 0x01 }, > + { CCI_REG8(0x3f3c), 0x01 }, > + { CCI_REG8(0x3f0d), 0x0a }, > + { CCI_REG8(0x3fbc), 0x00 }, > + { CCI_REG8(0x3c06), 0x00 }, > + { CCI_REG8(0x3c07), 0x48 }, > + { CCI_REG8(0x3c0a), 0x00 }, > + { CCI_REG8(0x3c0b), 0x00 }, > + { CCI_REG8(0x3f78), 0x00 }, > + { CCI_REG8(0x3f79), 0x40 }, > + { CCI_REG8(0x3f7c), 0x00 }, > + { CCI_REG8(0x3f7d), 0x00 }, > +}; > + > +/* 4k 21fps mode */ > +static const struct cci_reg_sequence mode_3840x2160_regs[] = { > + { CCI_REG8(0x0111), 0x02 }, > + { CCI_REG8(0x0112), 0x0a }, > + { CCI_REG8(0x0113), 0x0a }, > + { CCI_REG8(0x0114), 0x01 }, > + { CCI_REG8(0x0342), 0x38 }, > + { CCI_REG8(0x0343), 0x70 }, > + { CCI_REG8(0x0340), 0x08 }, > + { CCI_REG8(0x0341), 0xd4 }, > + { CCI_REG8(0x0344), 0x01 }, > + { CCI_REG8(0x0345), 0x98 }, > + { CCI_REG8(0x0346), 0x02 }, > + { CCI_REG8(0x0347), 0xa0 }, > + { CCI_REG8(0x0348), 0x10 }, > + { CCI_REG8(0x0349), 0x97 }, > + { CCI_REG8(0x034a), 0x0b }, > + { CCI_REG8(0x034b), 0x17 }, > + { CCI_REG8(0x0220), 0x00 }, > + { CCI_REG8(0x0221), 0x11 }, > + { CCI_REG8(0x0222), 0x01 }, > + { CCI_REG8(0x0900), 0x00 }, > + { CCI_REG8(0x0901), 0x11 }, > + { CCI_REG8(0x0902), 0x0a }, > + { CCI_REG8(0x3f4c), 0x01 }, > + { CCI_REG8(0x3f4d), 0x01 }, > + { CCI_REG8(0x4254), 0x7f }, > + { CCI_REG8(0x0401), 0x00 }, > + { CCI_REG8(0x0404), 0x00 }, > + { CCI_REG8(0x0405), 0x10 }, > + { CCI_REG8(0x0408), 0x00 }, > + { CCI_REG8(0x0409), 0x00 }, > + { CCI_REG8(0x040a), 0x00 }, > + { CCI_REG8(0x040b), 0x00 }, > + { CCI_REG8(0x040c), 0x0f }, > + { CCI_REG8(0x040d), 0x00 }, > + { CCI_REG8(0x040e), 0x08 }, > + { CCI_REG8(0x040f), 0x70 }, > + { CCI_REG8(0x034c), 0x0f }, > + { CCI_REG8(0x034d), 0x00 }, > + { CCI_REG8(0x034e), 0x08 }, > + { CCI_REG8(0x034f), 0x70 }, > + { CCI_REG8(0x0301), 0x06 }, > + { CCI_REG8(0x0303), 0x04 }, > + { CCI_REG8(0x0305), 0x04 }, > + { CCI_REG8(0x0306), 0x01 }, > + { CCI_REG8(0x0307), 0x57 }, > + { CCI_REG8(0x0309), 0x0a }, > + { CCI_REG8(0x030b), 0x02 }, > + { CCI_REG8(0x030d), 0x04 }, > + { CCI_REG8(0x030e), 0x01 }, > + { CCI_REG8(0x030f), 0x49 }, > + { CCI_REG8(0x0310), 0x01 }, > + { CCI_REG8(0x0820), 0x07 }, > + { CCI_REG8(0x0821), 0xb6 }, > + { CCI_REG8(0x0822), 0x00 }, > + { CCI_REG8(0x0823), 0x00 }, > + { CCI_REG8(0x3e20), 0x01 }, > + { CCI_REG8(0x3e37), 0x00 }, > + { CCI_REG8(0x3e3b), 0x00 }, > + { CCI_REG8(0x0106), 0x00 }, > + { CCI_REG8(0x0b00), 0x00 }, > + { CCI_REG8(0x3230), 0x00 }, > + { CCI_REG8(0x3f14), 0x01 }, > + { CCI_REG8(0x3f3c), 0x01 }, > + { CCI_REG8(0x3f0d), 0x0a }, > + { CCI_REG8(0x3fbc), 0x00 }, > + { CCI_REG8(0x3c06), 0x00 }, > + { CCI_REG8(0x3c07), 0x48 }, > + { CCI_REG8(0x3c0a), 0x00 }, > + { CCI_REG8(0x3c0b), 0x00 }, > + { CCI_REG8(0x3f78), 0x00 }, > + { CCI_REG8(0x3f79), 0x40 }, > + { CCI_REG8(0x3f7c), 0x00 }, > + { CCI_REG8(0x3f7d), 0x00 }, > +}; > + > +/* 2x2 binned 30fps mode */ > +static const struct cci_reg_sequence mode_2328x1748_regs[] = { > + { CCI_REG8(0x0111), 0x02 }, > + { CCI_REG8(0x0112), 0x0a }, > + { CCI_REG8(0x0113), 0x0a }, > + { CCI_REG8(0x0114), 0x01 }, > + { CCI_REG8(0x0342), 0x24 }, > + { CCI_REG8(0x0343), 0x12 }, > + { CCI_REG8(0x0340), 0x09 }, > + { CCI_REG8(0x0341), 0xac }, > + { CCI_REG8(0x0344), 0x00 }, > + { CCI_REG8(0x0345), 0x00 }, > + { CCI_REG8(0x0346), 0x00 }, > + { CCI_REG8(0x0347), 0x00 }, > + { CCI_REG8(0x0348), 0x12 }, > + { CCI_REG8(0x0349), 0x2f }, > + { CCI_REG8(0x034a), 0x0d }, > + { CCI_REG8(0x034b), 0xa7 }, > + { CCI_REG8(0x0220), 0x00 }, > + { CCI_REG8(0x0221), 0x11 }, > + { CCI_REG8(0x0222), 0x01 }, > + { CCI_REG8(0x0900), 0x01 }, > + { CCI_REG8(0x0901), 0x22 }, > + { CCI_REG8(0x0902), 0x0a }, > + { CCI_REG8(0x3f4c), 0x01 }, > + { CCI_REG8(0x3f4d), 0x01 }, > + { CCI_REG8(0x4254), 0x7f }, > + { CCI_REG8(0x0401), 0x00 }, > + { CCI_REG8(0x0404), 0x00 }, > + { CCI_REG8(0x0405), 0x10 }, > + { CCI_REG8(0x0408), 0x00 }, > + { CCI_REG8(0x0409), 0x00 }, > + { CCI_REG8(0x040a), 0x00 }, > + { CCI_REG8(0x040b), 0x00 }, > + { CCI_REG8(0x040c), 0x09 }, > + { CCI_REG8(0x040d), 0x18 }, > + { CCI_REG8(0x040e), 0x06 }, > + { CCI_REG8(0x040f), 0xd4 }, > + { CCI_REG8(0x034c), 0x09 }, > + { CCI_REG8(0x034d), 0x18 }, > + { CCI_REG8(0x034e), 0x06 }, > + { CCI_REG8(0x034f), 0xd4 }, > + { CCI_REG8(0x0301), 0x06 }, > + { CCI_REG8(0x0303), 0x04 }, > + { CCI_REG8(0x0305), 0x04 }, > + { CCI_REG8(0x0306), 0x01 }, > + { CCI_REG8(0x0307), 0x57 }, > + { CCI_REG8(0x0309), 0x0a }, > + { CCI_REG8(0x030b), 0x02 }, > + { CCI_REG8(0x030d), 0x04 }, > + { CCI_REG8(0x030e), 0x01 }, > + { CCI_REG8(0x030f), 0x49 }, > + { CCI_REG8(0x0310), 0x01 }, > + { CCI_REG8(0x0820), 0x07 }, > + { CCI_REG8(0x0821), 0xb6 }, > + { CCI_REG8(0x0822), 0x00 }, > + { CCI_REG8(0x0823), 0x00 }, > + { CCI_REG8(0x3e20), 0x01 }, > + { CCI_REG8(0x3e37), 0x00 }, > + { CCI_REG8(0x3e3b), 0x00 }, > + { CCI_REG8(0x0106), 0x00 }, > + { CCI_REG8(0x0b00), 0x00 }, > + { CCI_REG8(0x3230), 0x00 }, > + { CCI_REG8(0x3f14), 0x01 }, > + { CCI_REG8(0x3f3c), 0x01 }, > + { CCI_REG8(0x3f0d), 0x0a }, > + { CCI_REG8(0x3fbc), 0x00 }, > + { CCI_REG8(0x3c06), 0x00 }, > + { CCI_REG8(0x3c07), 0x48 }, > + { CCI_REG8(0x3c0a), 0x00 }, > + { CCI_REG8(0x3c0b), 0x00 }, > + { CCI_REG8(0x3f78), 0x00 }, > + { CCI_REG8(0x3f79), 0x40 }, > + { CCI_REG8(0x3f7c), 0x00 }, > + { CCI_REG8(0x3f7d), 0x00 }, > +}; > + > +/* 1080p 60fps mode */ > +static const struct cci_reg_sequence mode_1920x1080_regs[] = { > + { CCI_REG8(0x0111), 0x02 }, > + { CCI_REG8(0x0112), 0x0a }, > + { CCI_REG8(0x0113), 0x0a }, > + { CCI_REG8(0x0114), 0x01 }, > + { CCI_REG8(0x0342), 0x25 }, > + { CCI_REG8(0x0343), 0xd9 }, > + { CCI_REG8(0x0340), 0x04 }, > + { CCI_REG8(0x0341), 0x9c }, > + { CCI_REG8(0x0344), 0x01 }, > + { CCI_REG8(0x0345), 0x98 }, > + { CCI_REG8(0x0346), 0x02 }, > + { CCI_REG8(0x0347), 0xa2 }, > + { CCI_REG8(0x0348), 0x10 }, > + { CCI_REG8(0x0349), 0x97 }, > + { CCI_REG8(0x034a), 0x0b }, > + { CCI_REG8(0x034b), 0x15 }, > + { CCI_REG8(0x0220), 0x00 }, > + { CCI_REG8(0x0221), 0x11 }, > + { CCI_REG8(0x0222), 0x01 }, > + { CCI_REG8(0x0900), 0x01 }, > + { CCI_REG8(0x0901), 0x22 }, > + { CCI_REG8(0x0902), 0x0a }, > + { CCI_REG8(0x3f4c), 0x01 }, > + { CCI_REG8(0x3f4d), 0x01 }, > + { CCI_REG8(0x4254), 0x7f }, > + { CCI_REG8(0x0401), 0x00 }, > + { CCI_REG8(0x0404), 0x00 }, > + { CCI_REG8(0x0405), 0x10 }, > + { CCI_REG8(0x0408), 0x00 }, > + { CCI_REG8(0x0409), 0x00 }, > + { CCI_REG8(0x040a), 0x00 }, > + { CCI_REG8(0x040b), 0x00 }, > + { CCI_REG8(0x040c), 0x07 }, > + { CCI_REG8(0x040d), 0x80 }, > + { CCI_REG8(0x040e), 0x04 }, > + { CCI_REG8(0x040f), 0x38 }, > + { CCI_REG8(0x034c), 0x07 }, > + { CCI_REG8(0x034d), 0x80 }, > + { CCI_REG8(0x034e), 0x04 }, > + { CCI_REG8(0x034f), 0x38 }, > + { CCI_REG8(0x0301), 0x06 }, > + { CCI_REG8(0x0303), 0x04 }, > + { CCI_REG8(0x0305), 0x04 }, > + { CCI_REG8(0x0306), 0x01 }, > + { CCI_REG8(0x0307), 0x57 }, > + { CCI_REG8(0x0309), 0x0a }, > + { CCI_REG8(0x030b), 0x02 }, > + { CCI_REG8(0x030d), 0x04 }, > + { CCI_REG8(0x030e), 0x01 }, > + { CCI_REG8(0x030f), 0x49 }, > + { CCI_REG8(0x0310), 0x01 }, > + { CCI_REG8(0x0820), 0x07 }, > + { CCI_REG8(0x0821), 0xb6 }, > + { CCI_REG8(0x0822), 0x00 }, > + { CCI_REG8(0x0823), 0x00 }, > + { CCI_REG8(0x3e20), 0x01 }, > + { CCI_REG8(0x3e37), 0x00 }, > + { CCI_REG8(0x3e3b), 0x00 }, > + { CCI_REG8(0x0106), 0x00 }, > + { CCI_REG8(0x0b00), 0x00 }, > + { CCI_REG8(0x3230), 0x00 }, > + { CCI_REG8(0x3f14), 0x01 }, > + { CCI_REG8(0x3f3c), 0x01 }, > + { CCI_REG8(0x3f0d), 0x0a }, > + { CCI_REG8(0x3fbc), 0x00 }, > + { CCI_REG8(0x3c06), 0x00 }, > + { CCI_REG8(0x3c07), 0x48 }, > + { CCI_REG8(0x3c0a), 0x00 }, > + { CCI_REG8(0x3c0b), 0x00 }, > + { CCI_REG8(0x3f78), 0x00 }, > + { CCI_REG8(0x3f79), 0x40 }, > + { CCI_REG8(0x3f7c), 0x00 }, > + { CCI_REG8(0x3f7d), 0x00 }, > +}; > + > +/* 720p 120fps mode */ > +static const struct cci_reg_sequence mode_1280x720_regs[] = { > + { CCI_REG8(0x0111), 0x02 }, > + { CCI_REG8(0x0112), 0x0a }, > + { CCI_REG8(0x0113), 0x0a }, > + { CCI_REG8(0x0114), 0x01 }, > + { CCI_REG8(0x0342), 0x1b }, > + { CCI_REG8(0x0343), 0x3b }, > + { CCI_REG8(0x0340), 0x03 }, > + { CCI_REG8(0x0341), 0x34 }, > + { CCI_REG8(0x0344), 0x04 }, > + { CCI_REG8(0x0345), 0x18 }, > + { CCI_REG8(0x0346), 0x04 }, > + { CCI_REG8(0x0347), 0x12 }, > + { CCI_REG8(0x0348), 0x0e }, > + { CCI_REG8(0x0349), 0x17 }, > + { CCI_REG8(0x034a), 0x09 }, > + { CCI_REG8(0x034b), 0xb6 }, > + { CCI_REG8(0x0220), 0x00 }, > + { CCI_REG8(0x0221), 0x11 }, > + { CCI_REG8(0x0222), 0x01 }, > + { CCI_REG8(0x0900), 0x01 }, > + { CCI_REG8(0x0901), 0x22 }, > + { CCI_REG8(0x0902), 0x0a }, > + { CCI_REG8(0x3f4c), 0x01 }, > + { CCI_REG8(0x3f4d), 0x01 }, > + { CCI_REG8(0x4254), 0x7f }, > + { CCI_REG8(0x0401), 0x00 }, > + { CCI_REG8(0x0404), 0x00 }, > + { CCI_REG8(0x0405), 0x10 }, > + { CCI_REG8(0x0408), 0x00 }, > + { CCI_REG8(0x0409), 0x00 }, > + { CCI_REG8(0x040a), 0x00 }, > + { CCI_REG8(0x040b), 0x00 }, > + { CCI_REG8(0x040c), 0x05 }, > + { CCI_REG8(0x040d), 0x00 }, > + { CCI_REG8(0x040e), 0x02 }, > + { CCI_REG8(0x040f), 0xd0 }, > + { CCI_REG8(0x034c), 0x05 }, > + { CCI_REG8(0x034d), 0x00 }, > + { CCI_REG8(0x034e), 0x02 }, > + { CCI_REG8(0x034f), 0xd0 }, > + { CCI_REG8(0x0301), 0x06 }, > + { CCI_REG8(0x0303), 0x04 }, > + { CCI_REG8(0x0305), 0x04 }, > + { CCI_REG8(0x0306), 0x01 }, > + { CCI_REG8(0x0307), 0x57 }, > + { CCI_REG8(0x0309), 0x0a }, > + { CCI_REG8(0x030b), 0x02 }, > + { CCI_REG8(0x030d), 0x04 }, > + { CCI_REG8(0x030e), 0x01 }, > + { CCI_REG8(0x030f), 0x49 }, > + { CCI_REG8(0x0310), 0x01 }, > + { CCI_REG8(0x0820), 0x07 }, > + { CCI_REG8(0x0821), 0xb6 }, > + { CCI_REG8(0x0822), 0x00 }, > + { CCI_REG8(0x0823), 0x00 }, > + { CCI_REG8(0x3e20), 0x01 }, > + { CCI_REG8(0x3e37), 0x00 }, > + { CCI_REG8(0x3e3b), 0x00 }, > + { CCI_REG8(0x0106), 0x00 }, > + { CCI_REG8(0x0b00), 0x00 }, > + { CCI_REG8(0x3230), 0x00 }, > + { CCI_REG8(0x3f14), 0x01 }, > + { CCI_REG8(0x3f3c), 0x01 }, > + { CCI_REG8(0x3f0d), 0x0a }, > + { CCI_REG8(0x3fbc), 0x00 }, > + { CCI_REG8(0x3c06), 0x00 }, > + { CCI_REG8(0x3c07), 0x48 }, > + { CCI_REG8(0x3c0a), 0x00 }, > + { CCI_REG8(0x3c0b), 0x00 }, > + { CCI_REG8(0x3f78), 0x00 }, > + { CCI_REG8(0x3f79), 0x40 }, > + { CCI_REG8(0x3f7c), 0x00 }, > + { CCI_REG8(0x3f7d), 0x00 }, > +}; > + > +/* Mode configs */ > +static const struct imx519_mode supported_modes_10bit[] = { > + { > + .width = 4656, > + .height = 3496, > + .line_length_pix = 0x4200, ppl (pixel per line) is also often used as a name for the horizontal total length, and it's shorter, up to you > + .crop = { > + .left = IMX519_PIXEL_ARRAY_LEFT, > + .top = IMX519_PIXEL_ARRAY_TOP, > + .width = 4656, > + .height = 3496, > + }, > + .timeperframe_min = { > + .numerator = 100, > + .denominator = 1000 > + }, > + .timeperframe_default = { > + .numerator = 100, > + .denominator = 1000 > + }, This is quite suspicious! _min and _default are the same for all modes and all the numerators are fixed to 100... more on this below > + .reg_list = { > + .num_of_regs = ARRAY_SIZE(mode_4656x3496_regs), > + .regs = mode_4656x3496_regs, > + } > + }, > + { > + .width = 3840, > + .height = 2160, > + .line_length_pix = 0x3870, > + .crop = { > + .left = IMX519_PIXEL_ARRAY_LEFT + 408, > + .top = IMX519_PIXEL_ARRAY_TOP + 672, > + .width = 3840, > + .height = 2160, > + }, > + .timeperframe_min = { > + .numerator = 100, > + .denominator = 2100 > + }, > + .timeperframe_default = { > + .numerator = 100, > + .denominator = 2100 > + }, > + .reg_list = { > + .num_of_regs = ARRAY_SIZE(mode_3840x2160_regs), > + .regs = mode_3840x2160_regs, > + } > + }, > + { > + .width = 2328, > + .height = 1748, > + .line_length_pix = 0x2412, > + .crop = { > + .left = IMX519_PIXEL_ARRAY_LEFT, > + .top = IMX519_PIXEL_ARRAY_TOP, > + .width = 4656, > + .height = 3496, > + }, > + .timeperframe_min = { > + .numerator = 100, > + .denominator = 3000 > + }, > + .timeperframe_default = { > + .numerator = 100, > + .denominator = 3000 > + }, > + .reg_list = { > + .num_of_regs = ARRAY_SIZE(mode_2328x1748_regs), > + .regs = mode_2328x1748_regs, > + } > + }, > + { > + .width = 1920, > + .height = 1080, > + .line_length_pix = 0x25D9, > + .crop = { > + .left = IMX519_PIXEL_ARRAY_LEFT + 408, > + .top = IMX519_PIXEL_ARRAY_TOP + 674, > + .width = 3840, > + .height = 2160, > + }, > + .timeperframe_min = { > + .numerator = 100, > + .denominator = 6000 > + }, > + .timeperframe_default = { > + .numerator = 100, > + .denominator = 6000 > + }, > + .reg_list = { > + .num_of_regs = ARRAY_SIZE(mode_1920x1080_regs), > + .regs = mode_1920x1080_regs, > + } > + }, > + { > + .width = 1280, > + .height = 720, > + .line_length_pix = 0x1B3B, > + .crop = { > + .left = IMX519_PIXEL_ARRAY_LEFT + 1048, > + .top = IMX519_PIXEL_ARRAY_TOP + 1042, > + .width = 2560, > + .height = 1440, > + }, > + .timeperframe_min = { > + .numerator = 100, > + .denominator = 12000 > + }, > + .timeperframe_default = { > + .numerator = 100, > + .denominator = 12000 > + }, > + .reg_list = { > + .num_of_regs = ARRAY_SIZE(mode_1280x720_regs), > + .regs = mode_1280x720_regs, > + } > + } > +}; > + > +/* > + * The supported formats. > + * This table MUST contain 4 entries per format, to cover the various flip > + * combinations in the order > + * - no flip > + * - h flip > + * - v flip > + * - h&v flips > + */ > +static const u32 imx519_mbus_formats[] = { > + /* 10-bit modes. */ > + MEDIA_BUS_FMT_SRGGB10_1X10, > + MEDIA_BUS_FMT_SGRBG10_1X10, > + MEDIA_BUS_FMT_SGBRG10_1X10, > + MEDIA_BUS_FMT_SBGGR10_1X10, > +}; > + > +static const char * const imx519_test_pattern_menu[] = { > + "Disabled", > + "Color Bars", > + "Solid Color", > + "Grey Color Bars", > + "PN9" > +}; > + > +static const int imx519_test_pattern_val[] = { > + IMX519_TEST_PATTERN_DISABLE, > + IMX519_TEST_PATTERN_COLOR_BARS, > + IMX519_TEST_PATTERN_SOLID_COLOR, > + IMX519_TEST_PATTERN_GREY_COLOR, > + IMX519_TEST_PATTERN_PN9, > +}; > + > +/* regulator supplies */ > +static const char * const imx519_supply_name[] = { > + /* Supplies can be enabled in any order */ > + "vana", /* Analog (2.8V) supply */ > + "vdig", /* Digital Core (1.05V) supply */ > + "vddl", /* IF (1.8V) supply */ > +}; > + > +/* > + * Initialisation delay between XCLR low->high and the moment when the sensor > + * can start capture (i.e. can leave software standby), given by T7 in the > + * datasheet is 8ms. This does include I2C setup time as well. ^ double space > + * > + * Note, that delay between XCLR low->high and reading the CCI ID register (T6 > + * in the datasheet) is much smaller - 600us. > + */ > +#define IMX519_XCLR_MIN_DELAY_US 8000 > +#define IMX519_XCLR_DELAY_RANGE_US 1000 Giving such a small range to usleep_range() is in my understanding highly reduces the chances your wakeup is coalesced with others. I think you could use fsleep here.. > + > +struct imx519 { > + struct v4l2_subdev sd; > + struct media_pad pad; > + > + struct regmap *regmap; > + struct clk *xclk; > + > + struct gpio_desc *reset_gpio; > + struct regulator_bulk_data supplies[ARRAY_SIZE(imx519_supply_name)]; > + > + struct v4l2_ctrl_handler ctrl_handler; > + /* V4L2 Controls */ > + struct v4l2_ctrl *exposure; > + struct v4l2_ctrl *vflip; > + struct v4l2_ctrl *hflip; > + struct v4l2_ctrl *vblank; > + struct v4l2_ctrl *hblank; > + > + /* Current mode */ > + const struct imx519_mode *mode; > + > + /* Rewrite common registers on stream on? */ > + bool common_regs_written; Suspicious, let's see how it is used > + > + /* Current long exposure factor in use. Set through V4L2_CID_VBLANK */ > + unsigned int long_exp_shift; > +}; > + > +static inline struct imx519 *to_imx519(struct v4l2_subdev *sd) > +{ > + return container_of(sd, struct imx519, sd); > +} > + > +/* Get bayer order based on flip setting. */ > +static u32 imx519_get_format_code(struct imx519 *imx519) > +{ > + unsigned int i; > + > + i = (imx519->vflip->val ? 2 : 0) | > + (imx519->hflip->val ? 1 : 0); > + > + return imx519_mbus_formats[i]; > +} > + > +static void imx519_adjust_exposure_range(struct imx519 *imx519) > +{ > + int exposure_max, exposure_def; > + > + /* Honour the VBLANK limits when setting exposure. */ > + exposure_max = imx519->mode->height + imx519->vblank->val - > + IMX519_EXPOSURE_OFFSET; > + exposure_def = min(exposure_max, imx519->exposure->val); > + __v4l2_ctrl_modify_range(imx519->exposure, imx519->exposure->minimum, > + exposure_max, imx519->exposure->step, > + exposure_def); > +} > + > +static int imx519_set_frame_length(struct imx519 *imx519, unsigned int val) > +{ > + int ret = 0; > + > + imx519->long_exp_shift = 0; > + > + while (val > IMX519_FRAME_LENGTH_MAX) { > + imx519->long_exp_shift++; > + val >>= 1; > + } > + > + cci_write(imx519->regmap, IMX519_REG_FRAME_LENGTH, val, &ret); > + if (ret) > + return ret; > + > + cci_write(imx519->regmap, IMX519_LONG_EXP_SHIFT_REG, > + imx519->long_exp_shift, &ret); > + > + return ret; > +} > + > +static int imx519_set_ctrl(struct v4l2_ctrl *ctrl) > +{ > + struct imx519 *imx519 = > + container_of(ctrl->handler, struct imx519, ctrl_handler); > + struct i2c_client *client = v4l2_get_subdevdata(&imx519->sd); > + int ret = 0; > + > + /* > + * The VBLANK control may change the limits of usable exposure, so check > + * and adjust if necessary. > + */ > + if (ctrl->id == V4L2_CID_VBLANK) > + imx519_adjust_exposure_range(imx519); > + > + /* > + * Applying V4L2 control value only happens Weird line break > + * when power is up for streaming > + */ > + if (pm_runtime_get_if_in_use(&client->dev) == 0) > + return 0; > + > + switch (ctrl->id) { > + case V4L2_CID_ANALOGUE_GAIN: > + cci_write(imx519->regmap, IMX519_REG_ANALOG_GAIN, > + ctrl->val, &ret); > + break; > + case V4L2_CID_EXPOSURE: > + cci_write(imx519->regmap, IMX519_REG_EXPOSURE, > + ctrl->val >> imx519->long_exp_shift, &ret); > + break; > + case V4L2_CID_DIGITAL_GAIN: > + cci_write(imx519->regmap, IMX519_REG_DIGITAL_GAIN, > + ctrl->val, &ret); > + break; > + case V4L2_CID_TEST_PATTERN: > + cci_write(imx519->regmap, IMX519_REG_TEST_PATTERN, > + imx519_test_pattern_val[ctrl->val], &ret); > + break; > + case V4L2_CID_TEST_PATTERN_RED: > + cci_write(imx519->regmap, IMX519_REG_TEST_PATTERN_R, > + ctrl->val, &ret); > + break; > + case V4L2_CID_TEST_PATTERN_GREENR: > + cci_write(imx519->regmap, IMX519_REG_TEST_PATTERN_GR, > + ctrl->val, &ret); > + break; > + case V4L2_CID_TEST_PATTERN_BLUE: > + cci_write(imx519->regmap, IMX519_REG_TEST_PATTERN_B, > + ctrl->val, &ret); > + break; > + case V4L2_CID_TEST_PATTERN_GREENB: > + cci_write(imx519->regmap, IMX519_REG_TEST_PATTERN_GB, > + ctrl->val, &ret); > + break; > + case V4L2_CID_HFLIP: > + case V4L2_CID_VFLIP: > + cci_write(imx519->regmap, IMX519_REG_ORIENTATION, > + imx519->hflip->val | imx519->vflip->val << 1, &ret); > + break; > + case V4L2_CID_VBLANK: > + ret = imx519_set_frame_length(imx519, > + imx519->mode->height + ctrl->val); > + break; > + default: > + dev_info(&client->dev, > + "ctrl(id:0x%x,val:0x%x) is not handled\n", > + ctrl->id, ctrl->val); > + ret = -EINVAL; > + break; > + } > + > + pm_runtime_mark_last_busy(&client->dev); > + pm_runtime_put_autosuspend(&client->dev); > + > + return ret; > +} > + > +static const struct v4l2_ctrl_ops imx519_ctrl_ops = { > + .s_ctrl = imx519_set_ctrl, > +}; > + > +static int imx519_init_cfg(struct v4l2_subdev *sd, > + struct v4l2_subdev_state *state) > +{ > + struct imx519 *imx519 = to_imx519(sd); > + struct v4l2_mbus_framefmt *format; > + struct v4l2_rect *crop; > + > + /* Initialize try_fmt. */ > + format = v4l2_subdev_get_pad_format(sd, state, 0); > + format->width = supported_modes_10bit[0].width; > + format->height = supported_modes_10bit[0].height; > + format->code = imx519_get_format_code(imx519); > + format->field = V4L2_FIELD_NONE; > + format->colorspace = V4L2_COLORSPACE_RAW; > + format->ycbcr_enc = V4L2_MAP_YCBCR_ENC_DEFAULT(format->colorspace); > + format->quantization = V4L2_QUANTIZATION_FULL_RANGE; > + format->xfer_func = V4L2_XFER_FUNC_NONE; > + > + /* Initialize crop rectangle. */ > + crop = v4l2_subdev_get_pad_crop(sd, state, 0); > + crop->top = IMX519_PIXEL_ARRAY_TOP; > + crop->left = IMX519_PIXEL_ARRAY_LEFT; > + crop->width = IMX519_PIXEL_ARRAY_WIDTH; > + crop->height = IMX519_PIXEL_ARRAY_HEIGHT; > + > + return 0; > +} > + > +static int imx519_enum_mbus_code(struct v4l2_subdev *sd, > + struct v4l2_subdev_state *sd_state, > + struct v4l2_subdev_mbus_code_enum *code) > +{ > + struct imx519 *imx519 = to_imx519(sd); > + > + if (code->index > 0) > + return -EINVAL; > + > + code->code = imx519_get_format_code(imx519); > + > + return 0; > +} > + > +static int imx519_enum_frame_size(struct v4l2_subdev *sd, > + struct v4l2_subdev_state *sd_state, > + struct v4l2_subdev_frame_size_enum *fse) > +{ > + struct imx519 *imx519 = to_imx519(sd); > + > + if (fse->index >= ARRAY_SIZE(supported_modes_10bit)) > + return -EINVAL; > + > + if (fse->code != imx519_get_format_code(imx519)) > + return -EINVAL; I wonder if this is correct, I know there's not much consistency among sensor drivers that handles multiple Bayer permutations, but should we allow enumeration of frame sizes for all the supported bus codes or only for the currently active one ? > + > + fse->min_width = supported_modes_10bit[fse->index].width; > + fse->max_width = fse->min_width; > + fse->min_height = supported_modes_10bit[fse->index].height; > + fse->max_height = fse->min_height; > + > + return 0; > +} > + > +static void imx519_update_image_pad_format(struct imx519 *imx519, > + const struct imx519_mode *mode, > + struct v4l2_subdev_format *fmt) Called from a single place, could be inlined > +{ > + fmt->format.width = mode->width; > + fmt->format.height = mode->height; > + fmt->format.field = V4L2_FIELD_NONE; > + fmt->format.colorspace = V4L2_COLORSPACE_RAW; > + fmt->format.xfer_func = V4L2_XFER_FUNC_NONE; > + fmt->format.ycbcr_enc = V4L2_YCBCR_ENC_601; > + fmt->format.quantization = V4L2_QUANTIZATION_FULL_RANGE; > +} > + > +static > +unsigned int imx519_get_frame_length(const struct imx519_mode *mode, > + const struct v4l2_fract *timeperframe) > +{ > + u64 frame_length; > + > + frame_length = (u64)timeperframe->numerator * IMX519_PIXEL_RATE; > + do_div(frame_length, > + (u64)timeperframe->denominator * mode->line_length_pix); all of this to get the max frame height in lines ? I would rather define a max_vts for each mode, as your _min and _defaul are the same, and remove this calculations > + > + if (WARN_ON(frame_length > IMX519_FRAME_LENGTH_MAX)) Can this happen with this driver ? > + frame_length = IMX519_FRAME_LENGTH_MAX; > + > + return max_t(unsigned int, frame_length, mode->height); > +} > + > +static void imx519_set_framing_limits(struct imx519 *imx519) > +{ > + unsigned int frm_length_min, frm_length_default, hblank; > + const struct imx519_mode *mode = imx519->mode; > + > + frm_length_min = imx519_get_frame_length(mode, &mode->timeperframe_min); > + frm_length_default = > + imx519_get_frame_length(mode, &mode->timeperframe_default); > + > + /* Default to no long exposure multiplier. */ > + imx519->long_exp_shift = 0; > + > + /* Update limits and set FPS to default */ > + __v4l2_ctrl_modify_range(imx519->vblank, frm_length_min - mode->height, > + ((1 << IMX519_LONG_EXP_SHIFT_MAX) * > + IMX519_FRAME_LENGTH_MAX) - mode->height, > + 1, frm_length_default - mode->height); > + > + /* Setting this will adjust the exposure limits as well. */ > + __v4l2_ctrl_s_ctrl(imx519->vblank, frm_length_default - mode->height); > + > + /* > + * Currently PPL is fixed to the mode specified value, so hblank > + * depends on mode->width only, and is not changeable in any > + * way other than changing the mode. > + */ > + hblank = mode->line_length_pix - mode->width; > + __v4l2_ctrl_modify_range(imx519->hblank, hblank, hblank, 1, hblank); > +} > + > +static int imx519_set_pad_format(struct v4l2_subdev *sd, > + struct v4l2_subdev_state *sd_state, > + struct v4l2_subdev_format *fmt) > +{ > + struct v4l2_mbus_framefmt *format; > + const struct imx519_mode *mode; > + struct imx519 *imx519 = to_imx519(sd); > + > + /* Bayer order varies with flips */ > + fmt->format.code = imx519_get_format_code(imx519); > + > + mode = v4l2_find_nearest_size(supported_modes_10bit, > + ARRAY_SIZE(supported_modes_10bit), > + width, height, > + fmt->format.width, > + fmt->format.height); > + imx519_update_image_pad_format(imx519, mode, fmt); > + format = v4l2_subdev_get_pad_format(sd, sd_state, 0); > + if (imx519->mode == mode && format->code == fmt->format.code) > + return 0; As you can read in Laurent's [PATCH v2 3/3] media: i2c: imx219: Perform a full mode set unconditionally this is not correct for V4L2_SUBDEV_FORMAT_TRY You can remove this > + > + if (fmt->which == V4L2_SUBDEV_FORMAT_ACTIVE) { > + imx519->mode = mode; > + imx519_set_framing_limits(imx519); > + } > + > + *format = fmt->format; [PATCH v2 2/3] media: i2c: imx219: Fix crop rectangle setting when changing format Applies here too > + > + return 0; > +} > + > +static int imx519_get_selection(struct v4l2_subdev *sd, > + struct v4l2_subdev_state *sd_state, > + struct v4l2_subdev_selection *sel) > +{ > + switch (sel->target) { > + case V4L2_SEL_TGT_CROP: { > + sel->r = *v4l2_subdev_get_pad_crop(sd, sd_state, 0); > + return 0; > + } > + > + case V4L2_SEL_TGT_NATIVE_SIZE: > + sel->r.left = 0; > + sel->r.top = 0; > + sel->r.width = IMX519_NATIVE_WIDTH; > + sel->r.height = IMX519_NATIVE_HEIGHT; > + > + return 0; > + > + case V4L2_SEL_TGT_CROP_DEFAULT: > + case V4L2_SEL_TGT_CROP_BOUNDS: > + sel->r.left = IMX519_PIXEL_ARRAY_LEFT; > + sel->r.top = IMX519_PIXEL_ARRAY_TOP; > + sel->r.width = IMX519_PIXEL_ARRAY_WIDTH; > + sel->r.height = IMX519_PIXEL_ARRAY_HEIGHT; > + > + return 0; > + } > + > + return -EINVAL; > +} > + > +/* Start streaming */ > +static int imx519_start_streaming(struct imx519 *imx519, > + struct v4l2_subdev_state *state) > +{ > + struct i2c_client *client = v4l2_get_subdevdata(&imx519->sd); > + const struct imx519_reg_list *reg_list; > + int ret; > + > + ret = pm_runtime_resume_and_get(&client->dev); > + if (ret < 0) > + return ret; > + > + if (!imx519->common_regs_written) { This is supicious. You use runtime_pm and at streaming stop the device enters autosuspend, which is exited at the next streaming start. So I suspect this condition is always true and can be removed, as the sensor has to be fully re-programmed anyway > + ret = cci_multi_reg_write(imx519->regmap, mode_common_regs, > + ARRAY_SIZE(mode_common_regs), NULL); > + > + if (ret) { > + dev_err(&client->dev, "%s failed to set common settings\n", > + __func__); > + goto err_rpm_put; > + } > + imx519->common_regs_written = true; > + } > + > + /* Apply default values of current mode */ > + reg_list = &imx519->mode->reg_list; > + ret = cci_multi_reg_write(imx519->regmap, reg_list->regs, > + reg_list->num_of_regs, NULL); > + if (ret) { > + dev_err(&client->dev, "%s failed to set mode\n", __func__); > + goto err_rpm_put; > + } > + > + /* Apply customized values from user */ > + ret = __v4l2_ctrl_handler_setup(imx519->sd.ctrl_handler); > + if (ret) > + goto err_rpm_put; > + > + /* set stream on register */ > + ret = cci_write(imx519->regmap, IMX519_REG_MODE_SELECT, > + IMX519_MODE_STREAMING, NULL); > + if (ret) > + goto err_rpm_put; > + > + /* vflip and hflip cannot change during streaming */ > + __v4l2_ctrl_grab(imx519->vflip, true); > + __v4l2_ctrl_grab(imx519->hflip, true); > + > + return 0; > + > +err_rpm_put: > + pm_runtime_mark_last_busy(&client->dev); > + pm_runtime_put_autosuspend(&client->dev); > + > + return ret; > +} > + > +/* Stop streaming */ > +static void imx519_stop_streaming(struct imx519 *imx519) > +{ > + struct i2c_client *client = v4l2_get_subdevdata(&imx519->sd); > + int ret; > + > + /* set stream off register */ > + ret = cci_write(imx519->regmap, IMX519_REG_MODE_SELECT, > + IMX519_MODE_STANDBY, NULL); > + if (ret) > + dev_err(&client->dev, "%s failed to set stream\n", __func__); > + > + __v4l2_ctrl_grab(imx519->vflip, false); > + __v4l2_ctrl_grab(imx519->hflip, false); > + > + pm_runtime_mark_last_busy(&client->dev); > + pm_runtime_put_autosuspend(&client->dev); > +} > + > +static int imx519_set_stream(struct v4l2_subdev *sd, int enable) > +{ > + struct imx519 *imx519 = to_imx519(sd); > + struct v4l2_subdev_state *state; > + int ret = 0; > + > + state = v4l2_subdev_lock_and_get_active_state(sd); > + > + if (enable) > + ret = imx519_start_streaming(imx519, state); > + else > + imx519_stop_streaming(imx519); > + > + v4l2_subdev_unlock_state(state); > + > + return ret; > +} > + > +static const struct v4l2_subdev_core_ops imx519_core_ops = { > + .subscribe_event = v4l2_ctrl_subdev_subscribe_event, > + .unsubscribe_event = v4l2_event_subdev_unsubscribe, > +}; > + > +static const struct v4l2_subdev_video_ops imx519_video_ops = { > + .s_stream = imx519_set_stream, > +}; > + > +static const struct v4l2_subdev_pad_ops imx519_pad_ops = { > + .init_cfg = imx519_init_cfg, > + .enum_mbus_code = imx519_enum_mbus_code, > + .get_fmt = v4l2_subdev_get_fmt, > + .set_fmt = imx519_set_pad_format, > + .get_selection = imx519_get_selection, > + .enum_frame_size = imx519_enum_frame_size, > +}; > + > +static const struct v4l2_subdev_ops imx519_subdev_ops = { > + .core = &imx519_core_ops, > + .video = &imx519_video_ops, > + .pad = &imx519_pad_ops, > +}; > + > +/* Power/clock management functions */ > +static int imx519_power_on(struct device *dev) > +{ > + struct i2c_client *client = to_i2c_client(dev); > + struct v4l2_subdev *sd = i2c_get_clientdata(client); > + struct imx519 *imx519 = to_imx519(sd); > + int ret; > + > + ret = regulator_bulk_enable(ARRAY_SIZE(imx519_supply_name), > + imx519->supplies); > + if (ret) { > + dev_err(&client->dev, "%s: failed to enable regulators\n", > + __func__); > + return ret; > + } > + > + ret = clk_prepare_enable(imx519->xclk); > + if (ret) { > + dev_err(&client->dev, "%s: failed to enable clock\n", > + __func__); > + goto reg_off; > + } > + > + gpiod_set_value_cansleep(imx519->reset_gpio, 1); Usually on power_on the reset/poweron gpios are set to logical 0. If this works for you I think you need to invert the line polarity in your .dts. > + usleep_range(IMX519_XCLR_MIN_DELAY_US, > + IMX519_XCLR_MIN_DELAY_US + IMX519_XCLR_DELAY_RANGE_US); fsleep() will do > + > + return 0; > + > +reg_off: > + regulator_bulk_disable(ARRAY_SIZE(imx519_supply_name), imx519->supplies); > + > + return ret; > +} > + > +static int imx519_power_off(struct device *dev) > +{ > + struct i2c_client *client = to_i2c_client(dev); > + struct v4l2_subdev *sd = i2c_get_clientdata(client); > + struct imx519 *imx519 = to_imx519(sd); > + > + gpiod_set_value_cansleep(imx519->reset_gpio, 0); > + regulator_bulk_disable(ARRAY_SIZE(imx519_supply_name), imx519->supplies); > + clk_disable_unprepare(imx519->xclk); Usually, the reverse power up sequence is used. It shouldn't make any difference, unless the datasheet prescribes this sequence. > + > + /* Force reprogramming of the common registers when powered up again. */ > + imx519->common_regs_written = false; > + > + return 0; > +} > + > +static int imx519_get_regulators(struct imx519 *imx519) > +{ > + struct i2c_client *client = v4l2_get_subdevdata(&imx519->sd); > + unsigned int i; > + > + for (i = 0; i < ARRAY_SIZE(imx519_supply_name); i++) > + imx519->supplies[i].supply = imx519_supply_name[i]; > + > + return devm_regulator_bulk_get(&client->dev, > + ARRAY_SIZE(imx519_supply_name), > + imx519->supplies); > +} > + > +/* Verify chip ID */ > +static int imx519_identify_module(struct imx519 *imx519) > +{ > + struct i2c_client *client = v4l2_get_subdevdata(&imx519->sd); > + int ret; > + u64 val; > + > + ret = cci_read(imx519->regmap, IMX519_REG_CHIP_ID, &val, NULL); > + if (ret) { > + dev_err(&client->dev, "failed to read chip id %x, with error %d\n", > + IMX519_CHIP_ID, ret); > + return ret; > + } > + > + if (val != IMX519_CHIP_ID) { > + dev_err(&client->dev, "chip id mismatch: %x!=%llx\n", > + IMX519_CHIP_ID, val); > + return -EIO; > + } > + > + dev_info(&client->dev, "Device found is imx%llx\n", val); dev_dbg maybe > + > + return 0; > +} > + > +/* Initialize control handlers */ > +static int imx519_init_controls(struct imx519 *imx519) > +{ > + struct v4l2_ctrl_handler *ctrl_hdlr; > + struct i2c_client *client = v4l2_get_subdevdata(&imx519->sd); > + struct v4l2_fwnode_device_properties props; > + unsigned int i; > + int ret; > + > + ctrl_hdlr = &imx519->ctrl_handler; > + ret = v4l2_ctrl_handler_init(ctrl_hdlr, 16); > + if (ret) > + return ret; > + > + /* By default, PIXEL_RATE is read only */ > + v4l2_ctrl_new_std(ctrl_hdlr, &imx519_ctrl_ops, V4L2_CID_PIXEL_RATE, > + IMX519_PIXEL_RATE, IMX519_PIXEL_RATE, 1, > + IMX519_PIXEL_RATE); > + > + /* > + * Create the controls here, but mode specific limits are setup > + * in the imx519_set_framing_limits() call below. > + */ > + imx519->vblank = v4l2_ctrl_new_std(ctrl_hdlr, &imx519_ctrl_ops, > + V4L2_CID_VBLANK, 0, 0xffff, 1, 0); > + imx519->hblank = v4l2_ctrl_new_std(ctrl_hdlr, &imx519_ctrl_ops, > + V4L2_CID_HBLANK, 0, 0xffff, 1, 0); > + > + /* HBLANK is read-only for now, but does change with mode. */ > + if (imx519->hblank) > + imx519->hblank->flags |= V4L2_CTRL_FLAG_READ_ONLY; > + > + imx519->exposure = v4l2_ctrl_new_std(ctrl_hdlr, &imx519_ctrl_ops, > + V4L2_CID_EXPOSURE, > + IMX519_EXPOSURE_MIN, > + IMX519_EXPOSURE_MAX, > + IMX519_EXPOSURE_STEP, > + IMX519_EXPOSURE_DEFAULT); > + > + v4l2_ctrl_new_std(ctrl_hdlr, &imx519_ctrl_ops, V4L2_CID_ANALOGUE_GAIN, > + IMX519_ANA_GAIN_MIN, IMX519_ANA_GAIN_MAX, > + IMX519_ANA_GAIN_STEP, IMX519_ANA_GAIN_DEFAULT); > + > + v4l2_ctrl_new_std(ctrl_hdlr, &imx519_ctrl_ops, V4L2_CID_DIGITAL_GAIN, > + IMX519_DGTL_GAIN_MIN, IMX519_DGTL_GAIN_MAX, > + IMX519_DGTL_GAIN_STEP, IMX519_DGTL_GAIN_DEFAULT); > + > + imx519->hflip = v4l2_ctrl_new_std(ctrl_hdlr, &imx519_ctrl_ops, > + V4L2_CID_HFLIP, 0, 1, 1, 0); > + if (imx519->hflip) > + imx519->hflip->flags |= V4L2_CTRL_FLAG_MODIFY_LAYOUT; > + > + imx519->vflip = v4l2_ctrl_new_std(ctrl_hdlr, &imx519_ctrl_ops, > + V4L2_CID_VFLIP, 0, 1, 1, 0); > + if (imx519->vflip) > + imx519->vflip->flags |= V4L2_CTRL_FLAG_MODIFY_LAYOUT; As Dave suggested, you can cluster these two > + > + v4l2_ctrl_new_std_menu_items(ctrl_hdlr, &imx519_ctrl_ops, > + V4L2_CID_TEST_PATTERN, > + ARRAY_SIZE(imx519_test_pattern_menu) - 1, > + 0, 0, imx519_test_pattern_menu); > + for (i = 0; i < 4; i++) { > + /* > + * The assumption is that > + * V4L2_CID_TEST_PATTERN_GREENR == V4L2_CID_TEST_PATTERN_RED + 1 > + * V4L2_CID_TEST_PATTERN_BLUE == V4L2_CID_TEST_PATTERN_RED + 2 > + * V4L2_CID_TEST_PATTERN_GREENB == V4L2_CID_TEST_PATTERN_RED + 3 > + */ > + v4l2_ctrl_new_std(ctrl_hdlr, &imx519_ctrl_ops, > + V4L2_CID_TEST_PATTERN_RED + i, > + IMX519_TEST_PATTERN_COLOUR_MIN, > + IMX519_TEST_PATTERN_COLOUR_MAX, > + IMX519_TEST_PATTERN_COLOUR_STEP, > + IMX519_TEST_PATTERN_COLOUR_MAX); > + /* The "Solid color" pattern is white by default */ > + } > + > + if (ctrl_hdlr->error) { > + ret = ctrl_hdlr->error; > + dev_err(&client->dev, "%s control init failed (%d)\n", > + __func__, ret); > + goto error; > + } > + > + ret = v4l2_fwnode_device_parse(&client->dev, &props); > + if (ret) > + goto error; > + > + ret = v4l2_ctrl_new_fwnode_properties(ctrl_hdlr, &imx519_ctrl_ops, > + &props); > + if (ret) > + goto error; > + > + imx519->sd.ctrl_handler = ctrl_hdlr; > + > + mutex_lock(imx519->ctrl_handler.lock); Is locking the mutex required during the driver's probe sequence ? > + > + /* Setup exposure and frame/line length limits. */ > + imx519_set_framing_limits(imx519); > + > + mutex_unlock(imx519->ctrl_handler.lock); > + > + return 0; > + > +error: > + v4l2_ctrl_handler_free(ctrl_hdlr); > + > + return ret; > +} > + > +static void imx519_free_controls(struct imx519 *imx519) > +{ > + v4l2_ctrl_handler_free(imx519->sd.ctrl_handler); > +} > + > +static int imx519_check_hwcfg(struct device *dev) > +{ > + struct fwnode_handle *endpoint; > + struct v4l2_fwnode_endpoint ep_cfg = { > + .bus_type = V4L2_MBUS_CSI2_DPHY > + }; > + int ret = -EINVAL; > + > + endpoint = fwnode_graph_get_next_endpoint(dev_fwnode(dev), NULL); > + if (!endpoint) { > + dev_err(dev, "endpoint node not found\n"); > + return -EINVAL; > + } > + > + if (v4l2_fwnode_endpoint_alloc_parse(endpoint, &ep_cfg)) { > + dev_err(dev, "could not parse endpoint\n"); > + goto out; If v4l2_fwnode_endpoint_alloc_parse() fails there's no need to call v4l2_fwnode_endpoint_free() (but you still need to put() the endpoint). > + } > + > + /* Check the number of MIPI CSI2 data lanes */ > + if (ep_cfg.bus.mipi_csi2.num_data_lanes != 2) { > + dev_err(dev, "only 2 data lanes are currently supported\n"); > + goto out; > + } > + > + /* Check the link frequency set in device tree */ > + if (!ep_cfg.nr_of_link_frequencies) { > + dev_err(dev, "link-frequency property not found in DT\n"); > + goto out; > + } > + > + if (ep_cfg.nr_of_link_frequencies != 1 || > + ep_cfg.link_frequencies[0] != IMX519_DEFAULT_LINK_FREQ) { > + dev_err(dev, "Link frequency not supported: %lld\n", > + ep_cfg.link_frequencies[0]); > + goto out; > + } > + > + ret = 0; > + > +out: > + v4l2_fwnode_endpoint_free(&ep_cfg); > + fwnode_handle_put(endpoint); > + > + return ret; > +} > + > +static const struct of_device_id imx519_dt_ids[] = { > + { .compatible = "sony,imx519" }, > + { /* sentinel */ } > +}; > + > +static int imx519_probe(struct i2c_client *client) > +{ > + struct device *dev = &client->dev; > + struct imx519 *imx519; > + u32 xclk_freq; > + int ret; > + > + imx519 = devm_kzalloc(&client->dev, sizeof(*imx519), GFP_KERNEL); > + if (!imx519) > + return -ENOMEM; > + > + v4l2_i2c_subdev_init(&imx519->sd, client, &imx519_subdev_ops); > + > + /* Check the hardware configuration in device tree */ > + if (imx519_check_hwcfg(dev)) > + return -EINVAL; > + > + imx519->regmap = devm_cci_regmap_init_i2c(client, 16); > + if (IS_ERR(imx519->regmap)) > + return dev_err_probe(dev, PTR_ERR(imx519->regmap), > + "failed to initialize CCI\n"); Can this function EPROBE_DEFER ? > + > + /* Get system clock (xclk) */ > + imx519->xclk = devm_clk_get(dev, NULL); > + if (IS_ERR(imx519->xclk)) > + return dev_err_probe(dev, PTR_ERR(imx519->xclk), > + "failed to get xclk\n"); > + > + xclk_freq = clk_get_rate(imx519->xclk); > + if (xclk_freq != IMX519_XCLK_FREQ) > + return dev_err_probe(dev, -EINVAL, What is dev_err_probe useful for if you're passing -EINVAL ? > + "xclk frequency not supported: %d Hz\n", > + xclk_freq); > + > + ret = imx519_get_regulators(imx519); > + if (ret) > + return dev_err_probe(dev, ret, "failed to get regulators\n"); > + > + /* Request optional enable pin */ > + imx519->reset_gpio = devm_gpiod_get_optional(dev, "reset", > + GPIOD_OUT_HIGH); > + if (IS_ERR(imx519->reset_gpio)) > + return dev_err_probe(dev, PTR_ERR(imx519->reset_gpio), > + "failed to get reset gpio\n"); > + > + /* > + * The sensor must be powered for imx519_identify_module() > + * to be able to read the CHIP_ID register > + */ > + ret = imx519_power_on(dev); > + if (ret) > + return ret; > + > + ret = imx519_identify_module(imx519); > + if (ret) > + goto error_power_off; > + > + /* Set default mode to max resolution */ > + imx519->mode = &supported_modes_10bit[0]; > + > + /* > + * Enable runtime PM. As the device has been powered manually, mark it > + * as active, and increase the usage count without resuming the device. > + */ > + pm_runtime_set_active(dev); > + pm_runtime_get_noresume(dev); > + pm_runtime_enable(dev); > + > + pm_runtime_set_autosuspend_delay(dev, 1000); > + pm_runtime_use_autosuspend(dev); > + > + /* This needs the pm runtime to be registered. */ How so ? > + ret = imx519_init_controls(imx519); > + if (ret) > + goto error_rpm_disable; > + > + /* Initialize subdev */ > + imx519->sd.flags |= V4L2_SUBDEV_FL_HAS_DEVNODE | > + V4L2_SUBDEV_FL_HAS_EVENTS; > + imx519->sd.entity.function = MEDIA_ENT_F_CAM_SENSOR; > + > + /* Initialize source pads */ > + imx519->pad.flags = MEDIA_PAD_FL_SOURCE; > + > + ret = media_entity_pads_init(&imx519->sd.entity, 1, &imx519->pad); > + if (ret) { > + dev_err(dev, "failed to init entity pads: %d\n", ret); > + goto error_handler_free; > + } > + > + imx519->sd.state_lock = imx519->ctrl_handler.lock; > + ret = v4l2_subdev_init_finalize(&imx519->sd); > + if (ret < 0) { > + dev_err(dev, "subdev init error: %d\n", ret); > + goto error_media_entity; > + } > + > + ret = v4l2_async_register_subdev_sensor(&imx519->sd); > + if (ret < 0) { > + dev_err(dev, "failed to register sensor sub-device: %d\n", ret); > + goto error_subdev_cleanup; > + } > + > + pm_runtime_mark_last_busy(dev); > + pm_runtime_put_autosuspend(dev); > + > + return 0; > + > +error_subdev_cleanup: > + v4l2_subdev_cleanup(&imx519->sd); > + > +error_media_entity: > + media_entity_cleanup(&imx519->sd.entity); > + > +error_handler_free: > + imx519_free_controls(imx519); > + > +error_rpm_disable: > + pm_runtime_disable(&client->dev); > + pm_runtime_put_noidle(&client->dev); > + > +error_power_off: > + imx519_power_off(&client->dev); > + > + return ret; > +} > + > +static void imx519_remove(struct i2c_client *client) > +{ > + struct v4l2_subdev *sd = i2c_get_clientdata(client); > + struct imx519 *imx519 = to_imx519(sd); > + > + v4l2_async_unregister_subdev(sd); > + v4l2_subdev_cleanup(sd); > + media_entity_cleanup(&sd->entity); > + imx519_free_controls(imx519); > + > + pm_runtime_disable(&client->dev); > + if (!pm_runtime_status_suspended(&client->dev)) > + imx519_power_off(&client->dev); > + pm_runtime_set_suspended(&client->dev); > +} > + > +MODULE_DEVICE_TABLE(of, imx519_dt_ids); I would define imx519_dt_ids just above here > + > +static const struct dev_pm_ops imx519_pm_ops = { > + SET_RUNTIME_PM_OPS(imx519_power_off, imx519_power_on, NULL) > +}; > + > +static struct i2c_driver imx519_i2c_driver = { > + .driver = { > + .name = "imx519", > + .of_match_table = imx519_dt_ids, > + .pm = &imx519_pm_ops, > + }, > + .probe = imx519_probe, > + .remove = imx519_remove, > +}; > + > +module_i2c_driver(imx519_i2c_driver); > + > +MODULE_AUTHOR("Lee Jackson <lee.jackson@arducam.com>"); > +MODULE_DESCRIPTION("Sony IMX519 sensor driver"); > +MODULE_LICENSE("GPL v2"); checkpatch.pl suggests to just use "GPL" here Thanks j > -- > 2.41.0 >
Hi Jacopo On Fri, 8 Sept 2023 at 17:24, Jacopo Mondi <jacopo.mondi@ideasonboard.com> wrote: > > Hi Umang > > On Fri, Sep 08, 2023 at 08:43:44AM -0400, Umang Jain wrote: > > From: Lee Jackson <lee.jackson@arducam.com> > > > > Add a driver for the 16MPix IMX519 CSI2 sensor. > > Whilst the sensor supports 2 or 4 CSI2 data lanes, this driver > > currently only supports 2 lanes. > > > > The following Bayer modes are currently available: > > > > 4656x3496 10-bit @ 10fps > > 3840x2160 10-bit (cropped) @ 21fps > > 2328x1748 10-bit (binned) @ 30fps > > 1920x1080 10-bit (cropped/binned) @ 60fps > > 1280x720 10-bit (cropped/binned) @ 120fps > > > > Signed-off-by: Lee Jackson <lee.jackson@arducam.com> > > Signed-off-by: Umang Jain <umang.jain@ideasonboard.com> > > --- > > MAINTAINERS | 1 + > > drivers/media/i2c/Kconfig | 14 + > > drivers/media/i2c/Makefile | 1 + > > drivers/media/i2c/imx519.c | 1842 ++++++++++++++++++++++++++++++++++++ > > 4 files changed, 1858 insertions(+) > > create mode 100644 drivers/media/i2c/imx519.c > > > > diff --git a/MAINTAINERS b/MAINTAINERS > > index bca8512c0439..8e5647958e9c 100644 > > --- a/MAINTAINERS > > +++ b/MAINTAINERS > > @@ -19905,6 +19905,7 @@ L: linux-media@vger.kernel.org > > S: Maintained > > T: git git://linuxtv.org/media_tree.git > > F: Documentation/devicetree/bindings/media/i2c/sony,imx519.yaml > > +F: drivers/media/i2c/imx519.c > > > > SONY MEMORYSTICK SUBSYSTEM > > M: Maxim Levitsky <maximlevitsky@gmail.com> > > diff --git a/drivers/media/i2c/Kconfig b/drivers/media/i2c/Kconfig > > index f7cea5c53ead..eb8cf80313b0 100644 > > --- a/drivers/media/i2c/Kconfig > > +++ b/drivers/media/i2c/Kconfig > > @@ -256,6 +256,20 @@ config VIDEO_IMX415 > > To compile this driver as a module, choose M here: the > > module will be called imx415. > > > > +config VIDEO_IMX519 > > + tristate "Sony IMX519 sensor support" > > + depends on I2C && VIDEO_DEV > > + select MEDIA_CONTROLLER > > + select VIDEO_V4L2_SUBDEV_API > > + select V4L2_CCI_I2C > > + select V4L2_FWNODE > > Since commit 11ec2c45b554 ("media: i2c: Remove common dependencies from > sensor drivers") it is not required to specify V4L2_FWNODE, MEDIA_CONTROLLER, > VIDEO_V4L2_SUBDEV_API, I2C and VIDEO_DEV anymore as they're now > selected by the top-level menu. Only > > select V4L2_CCI_I2C > > is needed > > > + help > > + This is a Video4Linux2 sensor driver for the Sony > > + IMX519 camera. > > + > > + To compile this driver as a module, choose M here: the > > + module will be called imx519. > > + > > config VIDEO_MAX9271_LIB > > tristate > > > > diff --git a/drivers/media/i2c/Makefile b/drivers/media/i2c/Makefile > > index c743aeb5d1ad..a00ac6c7fc81 100644 > > --- a/drivers/media/i2c/Makefile > > +++ b/drivers/media/i2c/Makefile > > @@ -49,6 +49,7 @@ obj-$(CONFIG_VIDEO_IMX335) += imx335.o > > obj-$(CONFIG_VIDEO_IMX355) += imx355.o > > obj-$(CONFIG_VIDEO_IMX412) += imx412.o > > obj-$(CONFIG_VIDEO_IMX415) += imx415.o > > +obj-$(CONFIG_VIDEO_IMX519) += imx519.o > > obj-$(CONFIG_VIDEO_IR_I2C) += ir-kbd-i2c.o > > obj-$(CONFIG_VIDEO_ISL7998X) += isl7998x.o > > obj-$(CONFIG_VIDEO_KS0127) += ks0127.o > > diff --git a/drivers/media/i2c/imx519.c b/drivers/media/i2c/imx519.c > > new file mode 100644 > > index 000000000000..f818a3d0bd25 > > --- /dev/null > > +++ b/drivers/media/i2c/imx519.c > > @@ -0,0 +1,1842 @@ > > +// SPDX-License-Identifier: GPL-2.0 > > +/* > > Should you retain the copyright as well ? > > > + * A V4L2 driver for Sony IMX519 cameras. > > + * Copyright (C) 2022 Arducam Technology co., Ltd. > > + * > > + * Based on Sony IMX477 camera driver > > + * Copyright (C) 2020 Raspberry Pi (Trading) Ltd > > + */ > > +#include <asm/unaligned.h> > > +#include <linux/clk.h> > > +#include <linux/delay.h> > > +#include <linux/gpio/consumer.h> > > +#include <linux/i2c.h> > > +#include <linux/module.h> > > +#include <linux/of_device.h> > > +#include <linux/pm_runtime.h> > > +#include <linux/regulator/consumer.h> > > + > > +#include <media/v4l2-cci.h> > > +#include <media/v4l2-ctrls.h> > > +#include <media/v4l2-device.h> > > +#include <media/v4l2-event.h> > > +#include <media/v4l2-fwnode.h> > > +#include <media/v4l2-mediabus.h> > > + > > +/* Chip ID */ > > +#define IMX519_REG_CHIP_ID CCI_REG16(0x0016) > > +#define IMX519_CHIP_ID 0x0519 > > + > > +#define IMX519_REG_MODE_SELECT CCI_REG8(0x0100) > > +#define IMX519_MODE_STANDBY 0x00 > > +#define IMX519_MODE_STREAMING 0x01 > > + > > +#define IMX519_REG_ORIENTATION CCI_REG8(0x101) > > + > > +#define IMX519_XCLK_FREQ 24000000 > > + > > +#define IMX519_DEFAULT_LINK_FREQ 408000000 > > + > > +/* Pixel rate is fixed at 686MHz for all the modes */ > > This doesn't look like 686MHz though :) > > > +#define IMX519_PIXEL_RATE 426666667 > > + > > +/* V_TIMING internal */ > > +#define IMX519_REG_FRAME_LENGTH CCI_REG16(0x0340) > > +#define IMX519_FRAME_LENGTH_MAX 0xffdc > > + > > +/* Long exposure multiplier */ > > +#define IMX519_LONG_EXP_SHIFT_MAX 7 > > +#define IMX519_LONG_EXP_SHIFT_REG CCI_REG8(0x3100) > > + > > +/* Exposure control */ > > +#define IMX519_REG_EXPOSURE CCI_REG16(0x0202) > > +#define IMX519_EXPOSURE_OFFSET 32 > > +#define IMX519_EXPOSURE_MIN 20 > > +#define IMX519_EXPOSURE_STEP 1 > > +#define IMX519_EXPOSURE_DEFAULT 0x3e8 > > +#define IMX519_EXPOSURE_MAX (IMX519_FRAME_LENGTH_MAX - \ > > + IMX519_EXPOSURE_OFFSET) > > + > > +/* Analog gain control */ > > +#define IMX519_REG_ANALOG_GAIN CCI_REG16(0x0204) > > +#define IMX519_ANA_GAIN_MIN 0 > > +#define IMX519_ANA_GAIN_MAX 960 > > +#define IMX519_ANA_GAIN_STEP 1 > > +#define IMX519_ANA_GAIN_DEFAULT 0x0 > > + > > +/* Digital gain control */ > > +#define IMX519_REG_DIGITAL_GAIN CCI_REG16(0x020e) > > +#define IMX519_DGTL_GAIN_MIN 0x0100 > > +#define IMX519_DGTL_GAIN_MAX 0xffff > > +#define IMX519_DGTL_GAIN_DEFAULT 0x0100 > > +#define IMX519_DGTL_GAIN_STEP 1 > > + > > +/* Test Pattern Control */ > > +#define IMX519_REG_TEST_PATTERN CCI_REG16(0x0600) > > +#define IMX519_TEST_PATTERN_DISABLE 0 > > +#define IMX519_TEST_PATTERN_SOLID_COLOR 1 > > +#define IMX519_TEST_PATTERN_COLOR_BARS 2 > > +#define IMX519_TEST_PATTERN_GREY_COLOR 3 > > +#define IMX519_TEST_PATTERN_PN9 4 > > + > > +/* Test pattern colour components */ > > +#define IMX519_REG_TEST_PATTERN_R CCI_REG16(0x0602) > > +#define IMX519_REG_TEST_PATTERN_GR CCI_REG16(0x0604) > > +#define IMX519_REG_TEST_PATTERN_B CCI_REG16(0x0606) > > +#define IMX519_REG_TEST_PATTERN_GB CCI_REG16(0x0608) > > +#define IMX519_TEST_PATTERN_COLOUR_MIN 0 > > +#define IMX519_TEST_PATTERN_COLOUR_MAX 0x0fff > > +#define IMX519_TEST_PATTERN_COLOUR_STEP 1 > > +#define IMX519_TEST_PATTERN_R_DEFAULT IMX519_TEST_PATTERN_COLOUR_MAX > > +#define IMX519_TEST_PATTERN_GR_DEFAULT 0 > > +#define IMX519_TEST_PATTERN_B_DEFAULT 0 > > +#define IMX519_TEST_PATTERN_GB_DEFAULT 0 > > + > > +/* IMX519 native and active pixel array size. */ > > +#define IMX519_NATIVE_WIDTH 4672U > > +#define IMX519_NATIVE_HEIGHT 3648U > > +#define IMX519_PIXEL_ARRAY_LEFT 8U > > +#define IMX519_PIXEL_ARRAY_TOP 48U > > +#define IMX519_PIXEL_ARRAY_WIDTH 4656U > > +#define IMX519_PIXEL_ARRAY_HEIGHT 3496U > > + > > +struct imx519_reg_list { > > + unsigned int num_of_regs; > > + const struct cci_reg_sequence *regs; > > +}; > > + > > +/* Mode : resolution and related config&values */ > > +struct imx519_mode { > > + /* Frame width */ > > + unsigned int width; > > + > > + /* Frame height */ > > + unsigned int height; > > + > > + /* H-timing in pixels */ > > + unsigned int line_length_pix; > > + > > + /* Analog crop rectangle. */ > > + struct v4l2_rect crop; > > + > > + /* Highest possible framerate. */ > > + struct v4l2_fract timeperframe_min; > > + > > + /* Default framerate. */ > > + struct v4l2_fract timeperframe_default; > > + > > + /* Default register values */ > > + struct imx519_reg_list reg_list; > > +}; > > + > > +static const struct cci_reg_sequence mode_common_regs[] = { > > + { CCI_REG8(0x0136), 0x18 }, > > + { CCI_REG8(0x0137), 0x00 }, > > + { CCI_REG8(0x3c7e), 0x01 }, > > + { CCI_REG8(0x3c7f), 0x07 }, > > + { CCI_REG8(0x3020), 0x00 }, > > + { CCI_REG8(0x3e35), 0x01 }, > > + { CCI_REG8(0x3f7f), 0x01 }, > > + { CCI_REG8(0x5609), 0x57 }, > > + { CCI_REG8(0x5613), 0x51 }, > > + { CCI_REG8(0x561f), 0x5e }, > > + { CCI_REG8(0x5623), 0xd2 }, > > + { CCI_REG8(0x5637), 0x11 }, > > + { CCI_REG8(0x5657), 0x11 }, > > + { CCI_REG8(0x5659), 0x12 }, > > + { CCI_REG8(0x5733), 0x60 }, > > + { CCI_REG8(0x5905), 0x57 }, > > + { CCI_REG8(0x590f), 0x51 }, > > + { CCI_REG8(0x591b), 0x5e }, > > + { CCI_REG8(0x591f), 0xd2 }, > > + { CCI_REG8(0x5933), 0x11 }, > > + { CCI_REG8(0x5953), 0x11 }, > > + { CCI_REG8(0x5955), 0x12 }, > > + { CCI_REG8(0x5a2f), 0x60 }, > > + { CCI_REG8(0x5a85), 0x57 }, > > + { CCI_REG8(0x5a8f), 0x51 }, > > + { CCI_REG8(0x5a9b), 0x5e }, > > + { CCI_REG8(0x5a9f), 0xd2 }, > > + { CCI_REG8(0x5ab3), 0x11 }, > > + { CCI_REG8(0x5ad3), 0x11 }, > > + { CCI_REG8(0x5ad5), 0x12 }, > > + { CCI_REG8(0x5baf), 0x60 }, > > + { CCI_REG8(0x5c15), 0x2a }, > > + { CCI_REG8(0x5c17), 0x80 }, > > + { CCI_REG8(0x5c19), 0x31 }, > > + { CCI_REG8(0x5c1b), 0x87 }, > > + { CCI_REG8(0x5c25), 0x25 }, > > + { CCI_REG8(0x5c27), 0x7b }, > > + { CCI_REG8(0x5c29), 0x2a }, > > + { CCI_REG8(0x5c2b), 0x80 }, > > + { CCI_REG8(0x5c2d), 0x31 }, > > + { CCI_REG8(0x5c2f), 0x87 }, > > + { CCI_REG8(0x5c35), 0x2b }, > > + { CCI_REG8(0x5c37), 0x81 }, > > + { CCI_REG8(0x5c39), 0x31 }, > > + { CCI_REG8(0x5c3b), 0x87 }, > > + { CCI_REG8(0x5c45), 0x25 }, > > + { CCI_REG8(0x5c47), 0x7b }, > > + { CCI_REG8(0x5c49), 0x2a }, > > + { CCI_REG8(0x5c4b), 0x80 }, > > + { CCI_REG8(0x5c4d), 0x31 }, > > + { CCI_REG8(0x5c4f), 0x87 }, > > + { CCI_REG8(0x5c55), 0x2d }, > > + { CCI_REG8(0x5c57), 0x83 }, > > + { CCI_REG8(0x5c59), 0x32 }, > > + { CCI_REG8(0x5c5b), 0x88 }, > > + { CCI_REG8(0x5c65), 0x29 }, > > + { CCI_REG8(0x5c67), 0x7f }, > > + { CCI_REG8(0x5c69), 0x2e }, > > + { CCI_REG8(0x5c6b), 0x84 }, > > + { CCI_REG8(0x5c6d), 0x32 }, > > + { CCI_REG8(0x5c6f), 0x88 }, > > + { CCI_REG8(0x5e69), 0x04 }, > > + { CCI_REG8(0x5e9d), 0x00 }, > > + { CCI_REG8(0x5f18), 0x10 }, > > + { CCI_REG8(0x5f1a), 0x0e }, > > + { CCI_REG8(0x5f20), 0x12 }, > > + { CCI_REG8(0x5f22), 0x10 }, > > + { CCI_REG8(0x5f24), 0x0e }, > > + { CCI_REG8(0x5f28), 0x10 }, > > + { CCI_REG8(0x5f2a), 0x0e }, > > + { CCI_REG8(0x5f30), 0x12 }, > > + { CCI_REG8(0x5f32), 0x10 }, > > + { CCI_REG8(0x5f34), 0x0e }, > > + { CCI_REG8(0x5f38), 0x0f }, > > + { CCI_REG8(0x5f39), 0x0d }, > > + { CCI_REG8(0x5f3c), 0x11 }, > > + { CCI_REG8(0x5f3d), 0x0f }, > > + { CCI_REG8(0x5f3e), 0x0d }, > > + { CCI_REG8(0x5f61), 0x07 }, > > + { CCI_REG8(0x5f64), 0x05 }, > > + { CCI_REG8(0x5f67), 0x03 }, > > + { CCI_REG8(0x5f6a), 0x03 }, > > + { CCI_REG8(0x5f6d), 0x07 }, > > + { CCI_REG8(0x5f70), 0x07 }, > > + { CCI_REG8(0x5f73), 0x05 }, > > + { CCI_REG8(0x5f76), 0x02 }, > > + { CCI_REG8(0x5f79), 0x07 }, > > + { CCI_REG8(0x5f7c), 0x07 }, > > + { CCI_REG8(0x5f7f), 0x07 }, > > + { CCI_REG8(0x5f82), 0x07 }, > > + { CCI_REG8(0x5f85), 0x03 }, > > + { CCI_REG8(0x5f88), 0x02 }, > > + { CCI_REG8(0x5f8b), 0x01 }, > > + { CCI_REG8(0x5f8e), 0x01 }, > > + { CCI_REG8(0x5f91), 0x04 }, > > + { CCI_REG8(0x5f94), 0x05 }, > > + { CCI_REG8(0x5f97), 0x02 }, > > + { CCI_REG8(0x5f9d), 0x07 }, > > + { CCI_REG8(0x5fa0), 0x07 }, > > + { CCI_REG8(0x5fa3), 0x07 }, > > + { CCI_REG8(0x5fa6), 0x07 }, > > + { CCI_REG8(0x5fa9), 0x03 }, > > + { CCI_REG8(0x5fac), 0x01 }, > > + { CCI_REG8(0x5faf), 0x01 }, > > + { CCI_REG8(0x5fb5), 0x03 }, > > + { CCI_REG8(0x5fb8), 0x02 }, > > + { CCI_REG8(0x5fbb), 0x01 }, > > + { CCI_REG8(0x5fc1), 0x07 }, > > + { CCI_REG8(0x5fc4), 0x07 }, > > + { CCI_REG8(0x5fc7), 0x07 }, > > + { CCI_REG8(0x5fd1), 0x00 }, > > + { CCI_REG8(0x6302), 0x79 }, > > + { CCI_REG8(0x6305), 0x78 }, > > + { CCI_REG8(0x6306), 0xa5 }, > > + { CCI_REG8(0x6308), 0x03 }, > > + { CCI_REG8(0x6309), 0x20 }, > > + { CCI_REG8(0x630b), 0x0a }, > > + { CCI_REG8(0x630d), 0x48 }, > > + { CCI_REG8(0x630f), 0x06 }, > > + { CCI_REG8(0x6311), 0xa4 }, > > + { CCI_REG8(0x6313), 0x03 }, > > + { CCI_REG8(0x6314), 0x20 }, > > + { CCI_REG8(0x6316), 0x0a }, > > + { CCI_REG8(0x6317), 0x31 }, > > + { CCI_REG8(0x6318), 0x4a }, > > + { CCI_REG8(0x631a), 0x06 }, > > + { CCI_REG8(0x631b), 0x40 }, > > + { CCI_REG8(0x631c), 0xa4 }, > > + { CCI_REG8(0x631e), 0x03 }, > > + { CCI_REG8(0x631f), 0x20 }, > > + { CCI_REG8(0x6321), 0x0a }, > > + { CCI_REG8(0x6323), 0x4a }, > > + { CCI_REG8(0x6328), 0x80 }, > > + { CCI_REG8(0x6329), 0x01 }, > > + { CCI_REG8(0x632a), 0x30 }, > > + { CCI_REG8(0x632b), 0x02 }, > > + { CCI_REG8(0x632c), 0x20 }, > > + { CCI_REG8(0x632d), 0x02 }, > > + { CCI_REG8(0x632e), 0x30 }, > > + { CCI_REG8(0x6330), 0x60 }, > > + { CCI_REG8(0x6332), 0x90 }, > > + { CCI_REG8(0x6333), 0x01 }, > > + { CCI_REG8(0x6334), 0x30 }, > > + { CCI_REG8(0x6335), 0x02 }, > > + { CCI_REG8(0x6336), 0x20 }, > > + { CCI_REG8(0x6338), 0x80 }, > > + { CCI_REG8(0x633a), 0xa0 }, > > + { CCI_REG8(0x633b), 0x01 }, > > + { CCI_REG8(0x633c), 0x60 }, > > + { CCI_REG8(0x633d), 0x02 }, > > + { CCI_REG8(0x633e), 0x60 }, > > + { CCI_REG8(0x633f), 0x01 }, > > + { CCI_REG8(0x6340), 0x30 }, > > + { CCI_REG8(0x6341), 0x02 }, > > + { CCI_REG8(0x6342), 0x20 }, > > + { CCI_REG8(0x6343), 0x03 }, > > + { CCI_REG8(0x6344), 0x80 }, > > + { CCI_REG8(0x6345), 0x03 }, > > + { CCI_REG8(0x6346), 0x90 }, > > + { CCI_REG8(0x6348), 0xf0 }, > > + { CCI_REG8(0x6349), 0x01 }, > > + { CCI_REG8(0x634a), 0x20 }, > > + { CCI_REG8(0x634b), 0x02 }, > > + { CCI_REG8(0x634c), 0x10 }, > > + { CCI_REG8(0x634d), 0x03 }, > > + { CCI_REG8(0x634e), 0x60 }, > > + { CCI_REG8(0x6350), 0xa0 }, > > + { CCI_REG8(0x6351), 0x01 }, > > + { CCI_REG8(0x6352), 0x60 }, > > + { CCI_REG8(0x6353), 0x02 }, > > + { CCI_REG8(0x6354), 0x50 }, > > + { CCI_REG8(0x6355), 0x02 }, > > + { CCI_REG8(0x6356), 0x60 }, > > + { CCI_REG8(0x6357), 0x01 }, > > + { CCI_REG8(0x6358), 0x30 }, > > + { CCI_REG8(0x6359), 0x02 }, > > + { CCI_REG8(0x635a), 0x30 }, > > + { CCI_REG8(0x635b), 0x03 }, > > + { CCI_REG8(0x635c), 0x90 }, > > + { CCI_REG8(0x635f), 0x01 }, > > + { CCI_REG8(0x6360), 0x10 }, > > + { CCI_REG8(0x6361), 0x01 }, > > + { CCI_REG8(0x6362), 0x40 }, > > + { CCI_REG8(0x6363), 0x02 }, > > + { CCI_REG8(0x6364), 0x50 }, > > + { CCI_REG8(0x6368), 0x70 }, > > + { CCI_REG8(0x636a), 0xa0 }, > > + { CCI_REG8(0x636b), 0x01 }, > > + { CCI_REG8(0x636c), 0x50 }, > > + { CCI_REG8(0x637d), 0xe4 }, > > + { CCI_REG8(0x637e), 0xb4 }, > > + { CCI_REG8(0x638c), 0x8e }, > > + { CCI_REG8(0x638d), 0x38 }, > > + { CCI_REG8(0x638e), 0xe3 }, > > + { CCI_REG8(0x638f), 0x4c }, > > + { CCI_REG8(0x6390), 0x30 }, > > + { CCI_REG8(0x6391), 0xc3 }, > > + { CCI_REG8(0x6392), 0xae }, > > + { CCI_REG8(0x6393), 0xba }, > > + { CCI_REG8(0x6394), 0xeb }, > > + { CCI_REG8(0x6395), 0x6e }, > > + { CCI_REG8(0x6396), 0x34 }, > > + { CCI_REG8(0x6397), 0xe3 }, > > + { CCI_REG8(0x6398), 0xcf }, > > + { CCI_REG8(0x6399), 0x3c }, > > + { CCI_REG8(0x639a), 0xf3 }, > > + { CCI_REG8(0x639b), 0x0c }, > > + { CCI_REG8(0x639c), 0x30 }, > > + { CCI_REG8(0x639d), 0xc1 }, > > + { CCI_REG8(0x63b9), 0xa3 }, > > + { CCI_REG8(0x63ba), 0xfe }, > > + { CCI_REG8(0x7600), 0x01 }, > > + { CCI_REG8(0x79a0), 0x01 }, > > + { CCI_REG8(0x79a1), 0x01 }, > > + { CCI_REG8(0x79a2), 0x01 }, > > + { CCI_REG8(0x79a3), 0x01 }, > > + { CCI_REG8(0x79a4), 0x01 }, > > + { CCI_REG8(0x79a5), 0x20 }, > > + { CCI_REG8(0x79a9), 0x00 }, > > + { CCI_REG8(0x79aa), 0x01 }, > > + { CCI_REG8(0x79ad), 0x00 }, > > + { CCI_REG8(0x79af), 0x00 }, > > + { CCI_REG8(0x8173), 0x01 }, > > + { CCI_REG8(0x835c), 0x01 }, > > + { CCI_REG8(0x8a74), 0x01 }, > > + { CCI_REG8(0x8c1f), 0x00 }, > > + { CCI_REG8(0x8c27), 0x00 }, > > + { CCI_REG8(0x8c3b), 0x03 }, > > + { CCI_REG8(0x9004), 0x0b }, > > + { CCI_REG8(0x920c), 0x6a }, > > + { CCI_REG8(0x920d), 0x22 }, > > + { CCI_REG8(0x920e), 0x6a }, > > + { CCI_REG8(0x920f), 0x23 }, > > + { CCI_REG8(0x9214), 0x6a }, > > + { CCI_REG8(0x9215), 0x20 }, > > + { CCI_REG8(0x9216), 0x6a }, > > + { CCI_REG8(0x9217), 0x21 }, > > + { CCI_REG8(0x9385), 0x3e }, > > + { CCI_REG8(0x9387), 0x1b }, > > + { CCI_REG8(0x938d), 0x4d }, > > + { CCI_REG8(0x938f), 0x43 }, > > + { CCI_REG8(0x9391), 0x1b }, > > + { CCI_REG8(0x9395), 0x4d }, > > + { CCI_REG8(0x9397), 0x43 }, > > + { CCI_REG8(0x9399), 0x1b }, > > + { CCI_REG8(0x939d), 0x3e }, > > + { CCI_REG8(0x939f), 0x2f }, > > + { CCI_REG8(0x93a5), 0x43 }, > > + { CCI_REG8(0x93a7), 0x2f }, > > + { CCI_REG8(0x93a9), 0x2f }, > > + { CCI_REG8(0x93ad), 0x34 }, > > + { CCI_REG8(0x93af), 0x2f }, > > + { CCI_REG8(0x93b5), 0x3e }, > > + { CCI_REG8(0x93b7), 0x2f }, > > + { CCI_REG8(0x93bd), 0x4d }, > > + { CCI_REG8(0x93bf), 0x43 }, > > + { CCI_REG8(0x93c1), 0x2f }, > > + { CCI_REG8(0x93c5), 0x4d }, > > + { CCI_REG8(0x93c7), 0x43 }, > > + { CCI_REG8(0x93c9), 0x2f }, > > + { CCI_REG8(0x974b), 0x02 }, > > + { CCI_REG8(0x995c), 0x8c }, > > + { CCI_REG8(0x995d), 0x00 }, > > + { CCI_REG8(0x995e), 0x00 }, > > + { CCI_REG8(0x9963), 0x64 }, > > + { CCI_REG8(0x9964), 0x50 }, > > + { CCI_REG8(0xaa0a), 0x26 }, > > + { CCI_REG8(0xae03), 0x04 }, > > + { CCI_REG8(0xae04), 0x03 }, > > + { CCI_REG8(0xae05), 0x03 }, > > + { CCI_REG8(0xbc1c), 0x08 }, > > + { CCI_REG8(0xbcf1), 0x02 }, > > +}; > > + > > +/* 16 mpix 10fps */ > > +static const struct cci_reg_sequence mode_4656x3496_regs[] = { > > + { CCI_REG8(0x0111), 0x02 }, > > + { CCI_REG8(0x0112), 0x0a }, > > + { CCI_REG8(0x0113), 0x0a }, > > + { CCI_REG8(0x0114), 0x01 }, > > + { CCI_REG8(0x0342), 0x42 }, > > + { CCI_REG8(0x0343), 0x00 }, > > + { CCI_REG8(0x0340), 0x0d }, > > + { CCI_REG8(0x0341), 0xf4 }, > > + { CCI_REG8(0x0344), 0x00 }, > > + { CCI_REG8(0x0345), 0x00 }, > > + { CCI_REG8(0x0346), 0x00 }, > > + { CCI_REG8(0x0347), 0x00 }, > > + { CCI_REG8(0x0348), 0x12 }, > > + { CCI_REG8(0x0349), 0x2f }, > > + { CCI_REG8(0x034a), 0x0d }, > > + { CCI_REG8(0x034b), 0xa7 }, > > + { CCI_REG8(0x0220), 0x00 }, > > + { CCI_REG8(0x0221), 0x11 }, > > + { CCI_REG8(0x0222), 0x01 }, > > + { CCI_REG8(0x0900), 0x00 }, > > + { CCI_REG8(0x0901), 0x11 }, > > + { CCI_REG8(0x0902), 0x0a }, > > + { CCI_REG8(0x3f4c), 0x01 }, > > + { CCI_REG8(0x3f4d), 0x01 }, > > + { CCI_REG8(0x4254), 0x7f }, > > + { CCI_REG8(0x0401), 0x00 }, > > + { CCI_REG8(0x0404), 0x00 }, > > + { CCI_REG8(0x0405), 0x10 }, > > + { CCI_REG8(0x0408), 0x00 }, > > + { CCI_REG8(0x0409), 0x00 }, > > + { CCI_REG8(0x040a), 0x00 }, > > + { CCI_REG8(0x040b), 0x00 }, > > + { CCI_REG8(0x040c), 0x12 }, > > + { CCI_REG8(0x040d), 0x30 }, > > + { CCI_REG8(0x040e), 0x0d }, > > + { CCI_REG8(0x040f), 0xa8 }, > > + { CCI_REG8(0x034c), 0x12 }, > > + { CCI_REG8(0x034d), 0x30 }, > > + { CCI_REG8(0x034e), 0x0d }, > > + { CCI_REG8(0x034f), 0xa8 }, > > + { CCI_REG8(0x0301), 0x06 }, > > + { CCI_REG8(0x0303), 0x04 }, > > + { CCI_REG8(0x0305), 0x04 }, > > + { CCI_REG8(0x0306), 0x01 }, > > + { CCI_REG8(0x0307), 0x57 }, > > + { CCI_REG8(0x0309), 0x0a }, > > + { CCI_REG8(0x030b), 0x02 }, > > + { CCI_REG8(0x030d), 0x04 }, > > + { CCI_REG8(0x030e), 0x01 }, > > + { CCI_REG8(0x030f), 0x49 }, > > + { CCI_REG8(0x0310), 0x01 }, > > + { CCI_REG8(0x0820), 0x07 }, > > + { CCI_REG8(0x0821), 0xb6 }, > > + { CCI_REG8(0x0822), 0x00 }, > > + { CCI_REG8(0x0823), 0x00 }, > > + { CCI_REG8(0x3e20), 0x01 }, > > + { CCI_REG8(0x3e37), 0x00 }, > > + { CCI_REG8(0x3e3b), 0x00 }, > > + { CCI_REG8(0x0106), 0x00 }, > > + { CCI_REG8(0x0b00), 0x00 }, > > + { CCI_REG8(0x3230), 0x00 }, > > + { CCI_REG8(0x3f14), 0x01 }, > > + { CCI_REG8(0x3f3c), 0x01 }, > > + { CCI_REG8(0x3f0d), 0x0a }, > > + { CCI_REG8(0x3fbc), 0x00 }, > > + { CCI_REG8(0x3c06), 0x00 }, > > + { CCI_REG8(0x3c07), 0x48 }, > > + { CCI_REG8(0x3c0a), 0x00 }, > > + { CCI_REG8(0x3c0b), 0x00 }, > > + { CCI_REG8(0x3f78), 0x00 }, > > + { CCI_REG8(0x3f79), 0x40 }, > > + { CCI_REG8(0x3f7c), 0x00 }, > > + { CCI_REG8(0x3f7d), 0x00 }, > > +}; > > + > > +/* 4k 21fps mode */ > > +static const struct cci_reg_sequence mode_3840x2160_regs[] = { > > + { CCI_REG8(0x0111), 0x02 }, > > + { CCI_REG8(0x0112), 0x0a }, > > + { CCI_REG8(0x0113), 0x0a }, > > + { CCI_REG8(0x0114), 0x01 }, > > + { CCI_REG8(0x0342), 0x38 }, > > + { CCI_REG8(0x0343), 0x70 }, > > + { CCI_REG8(0x0340), 0x08 }, > > + { CCI_REG8(0x0341), 0xd4 }, > > + { CCI_REG8(0x0344), 0x01 }, > > + { CCI_REG8(0x0345), 0x98 }, > > + { CCI_REG8(0x0346), 0x02 }, > > + { CCI_REG8(0x0347), 0xa0 }, > > + { CCI_REG8(0x0348), 0x10 }, > > + { CCI_REG8(0x0349), 0x97 }, > > + { CCI_REG8(0x034a), 0x0b }, > > + { CCI_REG8(0x034b), 0x17 }, > > + { CCI_REG8(0x0220), 0x00 }, > > + { CCI_REG8(0x0221), 0x11 }, > > + { CCI_REG8(0x0222), 0x01 }, > > + { CCI_REG8(0x0900), 0x00 }, > > + { CCI_REG8(0x0901), 0x11 }, > > + { CCI_REG8(0x0902), 0x0a }, > > + { CCI_REG8(0x3f4c), 0x01 }, > > + { CCI_REG8(0x3f4d), 0x01 }, > > + { CCI_REG8(0x4254), 0x7f }, > > + { CCI_REG8(0x0401), 0x00 }, > > + { CCI_REG8(0x0404), 0x00 }, > > + { CCI_REG8(0x0405), 0x10 }, > > + { CCI_REG8(0x0408), 0x00 }, > > + { CCI_REG8(0x0409), 0x00 }, > > + { CCI_REG8(0x040a), 0x00 }, > > + { CCI_REG8(0x040b), 0x00 }, > > + { CCI_REG8(0x040c), 0x0f }, > > + { CCI_REG8(0x040d), 0x00 }, > > + { CCI_REG8(0x040e), 0x08 }, > > + { CCI_REG8(0x040f), 0x70 }, > > + { CCI_REG8(0x034c), 0x0f }, > > + { CCI_REG8(0x034d), 0x00 }, > > + { CCI_REG8(0x034e), 0x08 }, > > + { CCI_REG8(0x034f), 0x70 }, > > + { CCI_REG8(0x0301), 0x06 }, > > + { CCI_REG8(0x0303), 0x04 }, > > + { CCI_REG8(0x0305), 0x04 }, > > + { CCI_REG8(0x0306), 0x01 }, > > + { CCI_REG8(0x0307), 0x57 }, > > + { CCI_REG8(0x0309), 0x0a }, > > + { CCI_REG8(0x030b), 0x02 }, > > + { CCI_REG8(0x030d), 0x04 }, > > + { CCI_REG8(0x030e), 0x01 }, > > + { CCI_REG8(0x030f), 0x49 }, > > + { CCI_REG8(0x0310), 0x01 }, > > + { CCI_REG8(0x0820), 0x07 }, > > + { CCI_REG8(0x0821), 0xb6 }, > > + { CCI_REG8(0x0822), 0x00 }, > > + { CCI_REG8(0x0823), 0x00 }, > > + { CCI_REG8(0x3e20), 0x01 }, > > + { CCI_REG8(0x3e37), 0x00 }, > > + { CCI_REG8(0x3e3b), 0x00 }, > > + { CCI_REG8(0x0106), 0x00 }, > > + { CCI_REG8(0x0b00), 0x00 }, > > + { CCI_REG8(0x3230), 0x00 }, > > + { CCI_REG8(0x3f14), 0x01 }, > > + { CCI_REG8(0x3f3c), 0x01 }, > > + { CCI_REG8(0x3f0d), 0x0a }, > > + { CCI_REG8(0x3fbc), 0x00 }, > > + { CCI_REG8(0x3c06), 0x00 }, > > + { CCI_REG8(0x3c07), 0x48 }, > > + { CCI_REG8(0x3c0a), 0x00 }, > > + { CCI_REG8(0x3c0b), 0x00 }, > > + { CCI_REG8(0x3f78), 0x00 }, > > + { CCI_REG8(0x3f79), 0x40 }, > > + { CCI_REG8(0x3f7c), 0x00 }, > > + { CCI_REG8(0x3f7d), 0x00 }, > > +}; > > + > > +/* 2x2 binned 30fps mode */ > > +static const struct cci_reg_sequence mode_2328x1748_regs[] = { > > + { CCI_REG8(0x0111), 0x02 }, > > + { CCI_REG8(0x0112), 0x0a }, > > + { CCI_REG8(0x0113), 0x0a }, > > + { CCI_REG8(0x0114), 0x01 }, > > + { CCI_REG8(0x0342), 0x24 }, > > + { CCI_REG8(0x0343), 0x12 }, > > + { CCI_REG8(0x0340), 0x09 }, > > + { CCI_REG8(0x0341), 0xac }, > > + { CCI_REG8(0x0344), 0x00 }, > > + { CCI_REG8(0x0345), 0x00 }, > > + { CCI_REG8(0x0346), 0x00 }, > > + { CCI_REG8(0x0347), 0x00 }, > > + { CCI_REG8(0x0348), 0x12 }, > > + { CCI_REG8(0x0349), 0x2f }, > > + { CCI_REG8(0x034a), 0x0d }, > > + { CCI_REG8(0x034b), 0xa7 }, > > + { CCI_REG8(0x0220), 0x00 }, > > + { CCI_REG8(0x0221), 0x11 }, > > + { CCI_REG8(0x0222), 0x01 }, > > + { CCI_REG8(0x0900), 0x01 }, > > + { CCI_REG8(0x0901), 0x22 }, > > + { CCI_REG8(0x0902), 0x0a }, > > + { CCI_REG8(0x3f4c), 0x01 }, > > + { CCI_REG8(0x3f4d), 0x01 }, > > + { CCI_REG8(0x4254), 0x7f }, > > + { CCI_REG8(0x0401), 0x00 }, > > + { CCI_REG8(0x0404), 0x00 }, > > + { CCI_REG8(0x0405), 0x10 }, > > + { CCI_REG8(0x0408), 0x00 }, > > + { CCI_REG8(0x0409), 0x00 }, > > + { CCI_REG8(0x040a), 0x00 }, > > + { CCI_REG8(0x040b), 0x00 }, > > + { CCI_REG8(0x040c), 0x09 }, > > + { CCI_REG8(0x040d), 0x18 }, > > + { CCI_REG8(0x040e), 0x06 }, > > + { CCI_REG8(0x040f), 0xd4 }, > > + { CCI_REG8(0x034c), 0x09 }, > > + { CCI_REG8(0x034d), 0x18 }, > > + { CCI_REG8(0x034e), 0x06 }, > > + { CCI_REG8(0x034f), 0xd4 }, > > + { CCI_REG8(0x0301), 0x06 }, > > + { CCI_REG8(0x0303), 0x04 }, > > + { CCI_REG8(0x0305), 0x04 }, > > + { CCI_REG8(0x0306), 0x01 }, > > + { CCI_REG8(0x0307), 0x57 }, > > + { CCI_REG8(0x0309), 0x0a }, > > + { CCI_REG8(0x030b), 0x02 }, > > + { CCI_REG8(0x030d), 0x04 }, > > + { CCI_REG8(0x030e), 0x01 }, > > + { CCI_REG8(0x030f), 0x49 }, > > + { CCI_REG8(0x0310), 0x01 }, > > + { CCI_REG8(0x0820), 0x07 }, > > + { CCI_REG8(0x0821), 0xb6 }, > > + { CCI_REG8(0x0822), 0x00 }, > > + { CCI_REG8(0x0823), 0x00 }, > > + { CCI_REG8(0x3e20), 0x01 }, > > + { CCI_REG8(0x3e37), 0x00 }, > > + { CCI_REG8(0x3e3b), 0x00 }, > > + { CCI_REG8(0x0106), 0x00 }, > > + { CCI_REG8(0x0b00), 0x00 }, > > + { CCI_REG8(0x3230), 0x00 }, > > + { CCI_REG8(0x3f14), 0x01 }, > > + { CCI_REG8(0x3f3c), 0x01 }, > > + { CCI_REG8(0x3f0d), 0x0a }, > > + { CCI_REG8(0x3fbc), 0x00 }, > > + { CCI_REG8(0x3c06), 0x00 }, > > + { CCI_REG8(0x3c07), 0x48 }, > > + { CCI_REG8(0x3c0a), 0x00 }, > > + { CCI_REG8(0x3c0b), 0x00 }, > > + { CCI_REG8(0x3f78), 0x00 }, > > + { CCI_REG8(0x3f79), 0x40 }, > > + { CCI_REG8(0x3f7c), 0x00 }, > > + { CCI_REG8(0x3f7d), 0x00 }, > > +}; > > + > > +/* 1080p 60fps mode */ > > +static const struct cci_reg_sequence mode_1920x1080_regs[] = { > > + { CCI_REG8(0x0111), 0x02 }, > > + { CCI_REG8(0x0112), 0x0a }, > > + { CCI_REG8(0x0113), 0x0a }, > > + { CCI_REG8(0x0114), 0x01 }, > > + { CCI_REG8(0x0342), 0x25 }, > > + { CCI_REG8(0x0343), 0xd9 }, > > + { CCI_REG8(0x0340), 0x04 }, > > + { CCI_REG8(0x0341), 0x9c }, > > + { CCI_REG8(0x0344), 0x01 }, > > + { CCI_REG8(0x0345), 0x98 }, > > + { CCI_REG8(0x0346), 0x02 }, > > + { CCI_REG8(0x0347), 0xa2 }, > > + { CCI_REG8(0x0348), 0x10 }, > > + { CCI_REG8(0x0349), 0x97 }, > > + { CCI_REG8(0x034a), 0x0b }, > > + { CCI_REG8(0x034b), 0x15 }, > > + { CCI_REG8(0x0220), 0x00 }, > > + { CCI_REG8(0x0221), 0x11 }, > > + { CCI_REG8(0x0222), 0x01 }, > > + { CCI_REG8(0x0900), 0x01 }, > > + { CCI_REG8(0x0901), 0x22 }, > > + { CCI_REG8(0x0902), 0x0a }, > > + { CCI_REG8(0x3f4c), 0x01 }, > > + { CCI_REG8(0x3f4d), 0x01 }, > > + { CCI_REG8(0x4254), 0x7f }, > > + { CCI_REG8(0x0401), 0x00 }, > > + { CCI_REG8(0x0404), 0x00 }, > > + { CCI_REG8(0x0405), 0x10 }, > > + { CCI_REG8(0x0408), 0x00 }, > > + { CCI_REG8(0x0409), 0x00 }, > > + { CCI_REG8(0x040a), 0x00 }, > > + { CCI_REG8(0x040b), 0x00 }, > > + { CCI_REG8(0x040c), 0x07 }, > > + { CCI_REG8(0x040d), 0x80 }, > > + { CCI_REG8(0x040e), 0x04 }, > > + { CCI_REG8(0x040f), 0x38 }, > > + { CCI_REG8(0x034c), 0x07 }, > > + { CCI_REG8(0x034d), 0x80 }, > > + { CCI_REG8(0x034e), 0x04 }, > > + { CCI_REG8(0x034f), 0x38 }, > > + { CCI_REG8(0x0301), 0x06 }, > > + { CCI_REG8(0x0303), 0x04 }, > > + { CCI_REG8(0x0305), 0x04 }, > > + { CCI_REG8(0x0306), 0x01 }, > > + { CCI_REG8(0x0307), 0x57 }, > > + { CCI_REG8(0x0309), 0x0a }, > > + { CCI_REG8(0x030b), 0x02 }, > > + { CCI_REG8(0x030d), 0x04 }, > > + { CCI_REG8(0x030e), 0x01 }, > > + { CCI_REG8(0x030f), 0x49 }, > > + { CCI_REG8(0x0310), 0x01 }, > > + { CCI_REG8(0x0820), 0x07 }, > > + { CCI_REG8(0x0821), 0xb6 }, > > + { CCI_REG8(0x0822), 0x00 }, > > + { CCI_REG8(0x0823), 0x00 }, > > + { CCI_REG8(0x3e20), 0x01 }, > > + { CCI_REG8(0x3e37), 0x00 }, > > + { CCI_REG8(0x3e3b), 0x00 }, > > + { CCI_REG8(0x0106), 0x00 }, > > + { CCI_REG8(0x0b00), 0x00 }, > > + { CCI_REG8(0x3230), 0x00 }, > > + { CCI_REG8(0x3f14), 0x01 }, > > + { CCI_REG8(0x3f3c), 0x01 }, > > + { CCI_REG8(0x3f0d), 0x0a }, > > + { CCI_REG8(0x3fbc), 0x00 }, > > + { CCI_REG8(0x3c06), 0x00 }, > > + { CCI_REG8(0x3c07), 0x48 }, > > + { CCI_REG8(0x3c0a), 0x00 }, > > + { CCI_REG8(0x3c0b), 0x00 }, > > + { CCI_REG8(0x3f78), 0x00 }, > > + { CCI_REG8(0x3f79), 0x40 }, > > + { CCI_REG8(0x3f7c), 0x00 }, > > + { CCI_REG8(0x3f7d), 0x00 }, > > +}; > > + > > +/* 720p 120fps mode */ > > +static const struct cci_reg_sequence mode_1280x720_regs[] = { > > + { CCI_REG8(0x0111), 0x02 }, > > + { CCI_REG8(0x0112), 0x0a }, > > + { CCI_REG8(0x0113), 0x0a }, > > + { CCI_REG8(0x0114), 0x01 }, > > + { CCI_REG8(0x0342), 0x1b }, > > + { CCI_REG8(0x0343), 0x3b }, > > + { CCI_REG8(0x0340), 0x03 }, > > + { CCI_REG8(0x0341), 0x34 }, > > + { CCI_REG8(0x0344), 0x04 }, > > + { CCI_REG8(0x0345), 0x18 }, > > + { CCI_REG8(0x0346), 0x04 }, > > + { CCI_REG8(0x0347), 0x12 }, > > + { CCI_REG8(0x0348), 0x0e }, > > + { CCI_REG8(0x0349), 0x17 }, > > + { CCI_REG8(0x034a), 0x09 }, > > + { CCI_REG8(0x034b), 0xb6 }, > > + { CCI_REG8(0x0220), 0x00 }, > > + { CCI_REG8(0x0221), 0x11 }, > > + { CCI_REG8(0x0222), 0x01 }, > > + { CCI_REG8(0x0900), 0x01 }, > > + { CCI_REG8(0x0901), 0x22 }, > > + { CCI_REG8(0x0902), 0x0a }, > > + { CCI_REG8(0x3f4c), 0x01 }, > > + { CCI_REG8(0x3f4d), 0x01 }, > > + { CCI_REG8(0x4254), 0x7f }, > > + { CCI_REG8(0x0401), 0x00 }, > > + { CCI_REG8(0x0404), 0x00 }, > > + { CCI_REG8(0x0405), 0x10 }, > > + { CCI_REG8(0x0408), 0x00 }, > > + { CCI_REG8(0x0409), 0x00 }, > > + { CCI_REG8(0x040a), 0x00 }, > > + { CCI_REG8(0x040b), 0x00 }, > > + { CCI_REG8(0x040c), 0x05 }, > > + { CCI_REG8(0x040d), 0x00 }, > > + { CCI_REG8(0x040e), 0x02 }, > > + { CCI_REG8(0x040f), 0xd0 }, > > + { CCI_REG8(0x034c), 0x05 }, > > + { CCI_REG8(0x034d), 0x00 }, > > + { CCI_REG8(0x034e), 0x02 }, > > + { CCI_REG8(0x034f), 0xd0 }, > > + { CCI_REG8(0x0301), 0x06 }, > > + { CCI_REG8(0x0303), 0x04 }, > > + { CCI_REG8(0x0305), 0x04 }, > > + { CCI_REG8(0x0306), 0x01 }, > > + { CCI_REG8(0x0307), 0x57 }, > > + { CCI_REG8(0x0309), 0x0a }, > > + { CCI_REG8(0x030b), 0x02 }, > > + { CCI_REG8(0x030d), 0x04 }, > > + { CCI_REG8(0x030e), 0x01 }, > > + { CCI_REG8(0x030f), 0x49 }, > > + { CCI_REG8(0x0310), 0x01 }, > > + { CCI_REG8(0x0820), 0x07 }, > > + { CCI_REG8(0x0821), 0xb6 }, > > + { CCI_REG8(0x0822), 0x00 }, > > + { CCI_REG8(0x0823), 0x00 }, > > + { CCI_REG8(0x3e20), 0x01 }, > > + { CCI_REG8(0x3e37), 0x00 }, > > + { CCI_REG8(0x3e3b), 0x00 }, > > + { CCI_REG8(0x0106), 0x00 }, > > + { CCI_REG8(0x0b00), 0x00 }, > > + { CCI_REG8(0x3230), 0x00 }, > > + { CCI_REG8(0x3f14), 0x01 }, > > + { CCI_REG8(0x3f3c), 0x01 }, > > + { CCI_REG8(0x3f0d), 0x0a }, > > + { CCI_REG8(0x3fbc), 0x00 }, > > + { CCI_REG8(0x3c06), 0x00 }, > > + { CCI_REG8(0x3c07), 0x48 }, > > + { CCI_REG8(0x3c0a), 0x00 }, > > + { CCI_REG8(0x3c0b), 0x00 }, > > + { CCI_REG8(0x3f78), 0x00 }, > > + { CCI_REG8(0x3f79), 0x40 }, > > + { CCI_REG8(0x3f7c), 0x00 }, > > + { CCI_REG8(0x3f7d), 0x00 }, > > +}; > > + > > +/* Mode configs */ > > +static const struct imx519_mode supported_modes_10bit[] = { > > + { > > + .width = 4656, > > + .height = 3496, > > + .line_length_pix = 0x4200, > > ppl (pixel per line) is also often used as a name for the horizontal > total length, and it's shorter, up to you > > > + .crop = { > > + .left = IMX519_PIXEL_ARRAY_LEFT, > > + .top = IMX519_PIXEL_ARRAY_TOP, > > + .width = 4656, > > + .height = 3496, > > + }, > > + .timeperframe_min = { > > + .numerator = 100, > > + .denominator = 1000 > > + }, > > + .timeperframe_default = { > > + .numerator = 100, > > + .denominator = 1000 > > + }, > > This is quite suspicious! _min and _default are the same for all modes > and all the numerators are fixed to 100... more on this below > > > + .reg_list = { > > + .num_of_regs = ARRAY_SIZE(mode_4656x3496_regs), > > + .regs = mode_4656x3496_regs, > > + } > > + }, > > + { > > + .width = 3840, > > + .height = 2160, > > + .line_length_pix = 0x3870, > > + .crop = { > > + .left = IMX519_PIXEL_ARRAY_LEFT + 408, > > + .top = IMX519_PIXEL_ARRAY_TOP + 672, > > + .width = 3840, > > + .height = 2160, > > + }, > > + .timeperframe_min = { > > + .numerator = 100, > > + .denominator = 2100 > > + }, > > + .timeperframe_default = { > > + .numerator = 100, > > + .denominator = 2100 > > + }, > > + .reg_list = { > > + .num_of_regs = ARRAY_SIZE(mode_3840x2160_regs), > > + .regs = mode_3840x2160_regs, > > + } > > + }, > > + { > > + .width = 2328, > > + .height = 1748, > > + .line_length_pix = 0x2412, > > + .crop = { > > + .left = IMX519_PIXEL_ARRAY_LEFT, > > + .top = IMX519_PIXEL_ARRAY_TOP, > > + .width = 4656, > > + .height = 3496, > > + }, > > + .timeperframe_min = { > > + .numerator = 100, > > + .denominator = 3000 > > + }, > > + .timeperframe_default = { > > + .numerator = 100, > > + .denominator = 3000 > > + }, > > + .reg_list = { > > + .num_of_regs = ARRAY_SIZE(mode_2328x1748_regs), > > + .regs = mode_2328x1748_regs, > > + } > > + }, > > + { > > + .width = 1920, > > + .height = 1080, > > + .line_length_pix = 0x25D9, > > + .crop = { > > + .left = IMX519_PIXEL_ARRAY_LEFT + 408, > > + .top = IMX519_PIXEL_ARRAY_TOP + 674, > > + .width = 3840, > > + .height = 2160, > > + }, > > + .timeperframe_min = { > > + .numerator = 100, > > + .denominator = 6000 > > + }, > > + .timeperframe_default = { > > + .numerator = 100, > > + .denominator = 6000 > > + }, > > + .reg_list = { > > + .num_of_regs = ARRAY_SIZE(mode_1920x1080_regs), > > + .regs = mode_1920x1080_regs, > > + } > > + }, > > + { > > + .width = 1280, > > + .height = 720, > > + .line_length_pix = 0x1B3B, > > + .crop = { > > + .left = IMX519_PIXEL_ARRAY_LEFT + 1048, > > + .top = IMX519_PIXEL_ARRAY_TOP + 1042, > > + .width = 2560, > > + .height = 1440, > > + }, > > + .timeperframe_min = { > > + .numerator = 100, > > + .denominator = 12000 > > + }, > > + .timeperframe_default = { > > + .numerator = 100, > > + .denominator = 12000 > > + }, > > + .reg_list = { > > + .num_of_regs = ARRAY_SIZE(mode_1280x720_regs), > > + .regs = mode_1280x720_regs, > > + } > > + } > > +}; > > + > > +/* > > + * The supported formats. > > + * This table MUST contain 4 entries per format, to cover the various flip > > + * combinations in the order > > + * - no flip > > + * - h flip > > + * - v flip > > + * - h&v flips > > + */ > > +static const u32 imx519_mbus_formats[] = { > > + /* 10-bit modes. */ > > + MEDIA_BUS_FMT_SRGGB10_1X10, > > + MEDIA_BUS_FMT_SGRBG10_1X10, > > + MEDIA_BUS_FMT_SGBRG10_1X10, > > + MEDIA_BUS_FMT_SBGGR10_1X10, > > +}; > > + > > +static const char * const imx519_test_pattern_menu[] = { > > + "Disabled", > > + "Color Bars", > > + "Solid Color", > > + "Grey Color Bars", > > + "PN9" > > +}; > > + > > +static const int imx519_test_pattern_val[] = { > > + IMX519_TEST_PATTERN_DISABLE, > > + IMX519_TEST_PATTERN_COLOR_BARS, > > + IMX519_TEST_PATTERN_SOLID_COLOR, > > + IMX519_TEST_PATTERN_GREY_COLOR, > > + IMX519_TEST_PATTERN_PN9, > > +}; > > + > > +/* regulator supplies */ > > +static const char * const imx519_supply_name[] = { > > + /* Supplies can be enabled in any order */ > > + "vana", /* Analog (2.8V) supply */ > > + "vdig", /* Digital Core (1.05V) supply */ > > + "vddl", /* IF (1.8V) supply */ > > +}; > > + > > +/* > > + * Initialisation delay between XCLR low->high and the moment when the sensor > > + * can start capture (i.e. can leave software standby), given by T7 in the > > + * datasheet is 8ms. This does include I2C setup time as well. > > ^ double space > > > + * > > + * Note, that delay between XCLR low->high and reading the CCI ID register (T6 > > + * in the datasheet) is much smaller - 600us. > > + */ > > +#define IMX519_XCLR_MIN_DELAY_US 8000 > > +#define IMX519_XCLR_DELAY_RANGE_US 1000 > > Giving such a small range to usleep_range() is in my understanding > highly reduces the chances your wakeup is coalesced with others. I > think you could use fsleep here.. > > > + > > +struct imx519 { > > + struct v4l2_subdev sd; > > + struct media_pad pad; > > + > > + struct regmap *regmap; > > + struct clk *xclk; > > + > > + struct gpio_desc *reset_gpio; > > + struct regulator_bulk_data supplies[ARRAY_SIZE(imx519_supply_name)]; > > + > > + struct v4l2_ctrl_handler ctrl_handler; > > + /* V4L2 Controls */ > > + struct v4l2_ctrl *exposure; > > + struct v4l2_ctrl *vflip; > > + struct v4l2_ctrl *hflip; > > + struct v4l2_ctrl *vblank; > > + struct v4l2_ctrl *hblank; > > + > > + /* Current mode */ > > + const struct imx519_mode *mode; > > + > > + /* Rewrite common registers on stream on? */ > > + bool common_regs_written; > > Suspicious, let's see how it is used > > > + > > + /* Current long exposure factor in use. Set through V4L2_CID_VBLANK */ > > + unsigned int long_exp_shift; > > +}; > > + > > +static inline struct imx519 *to_imx519(struct v4l2_subdev *sd) > > +{ > > + return container_of(sd, struct imx519, sd); > > +} > > + > > +/* Get bayer order based on flip setting. */ > > +static u32 imx519_get_format_code(struct imx519 *imx519) > > +{ > > + unsigned int i; > > + > > + i = (imx519->vflip->val ? 2 : 0) | > > + (imx519->hflip->val ? 1 : 0); > > + > > + return imx519_mbus_formats[i]; > > +} > > + > > +static void imx519_adjust_exposure_range(struct imx519 *imx519) > > +{ > > + int exposure_max, exposure_def; > > + > > + /* Honour the VBLANK limits when setting exposure. */ > > + exposure_max = imx519->mode->height + imx519->vblank->val - > > + IMX519_EXPOSURE_OFFSET; > > + exposure_def = min(exposure_max, imx519->exposure->val); > > + __v4l2_ctrl_modify_range(imx519->exposure, imx519->exposure->minimum, > > + exposure_max, imx519->exposure->step, > > + exposure_def); > > +} > > + > > +static int imx519_set_frame_length(struct imx519 *imx519, unsigned int val) > > +{ > > + int ret = 0; > > + > > + imx519->long_exp_shift = 0; > > + > > + while (val > IMX519_FRAME_LENGTH_MAX) { > > + imx519->long_exp_shift++; > > + val >>= 1; > > + } > > + > > + cci_write(imx519->regmap, IMX519_REG_FRAME_LENGTH, val, &ret); > > + if (ret) > > + return ret; > > + > > + cci_write(imx519->regmap, IMX519_LONG_EXP_SHIFT_REG, > > + imx519->long_exp_shift, &ret); > > + > > + return ret; > > +} > > + > > +static int imx519_set_ctrl(struct v4l2_ctrl *ctrl) > > +{ > > + struct imx519 *imx519 = > > + container_of(ctrl->handler, struct imx519, ctrl_handler); > > + struct i2c_client *client = v4l2_get_subdevdata(&imx519->sd); > > + int ret = 0; > > + > > + /* > > + * The VBLANK control may change the limits of usable exposure, so check > > + * and adjust if necessary. > > + */ > > + if (ctrl->id == V4L2_CID_VBLANK) > > + imx519_adjust_exposure_range(imx519); > > + > > + /* > > + * Applying V4L2 control value only happens > > Weird line break > > > + * when power is up for streaming > > + */ > > + if (pm_runtime_get_if_in_use(&client->dev) == 0) > > + return 0; > > + > > + switch (ctrl->id) { > > + case V4L2_CID_ANALOGUE_GAIN: > > + cci_write(imx519->regmap, IMX519_REG_ANALOG_GAIN, > > + ctrl->val, &ret); > > + break; > > + case V4L2_CID_EXPOSURE: > > + cci_write(imx519->regmap, IMX519_REG_EXPOSURE, > > + ctrl->val >> imx519->long_exp_shift, &ret); > > + break; > > + case V4L2_CID_DIGITAL_GAIN: > > + cci_write(imx519->regmap, IMX519_REG_DIGITAL_GAIN, > > + ctrl->val, &ret); > > + break; > > + case V4L2_CID_TEST_PATTERN: > > + cci_write(imx519->regmap, IMX519_REG_TEST_PATTERN, > > + imx519_test_pattern_val[ctrl->val], &ret); > > + break; > > + case V4L2_CID_TEST_PATTERN_RED: > > + cci_write(imx519->regmap, IMX519_REG_TEST_PATTERN_R, > > + ctrl->val, &ret); > > + break; > > + case V4L2_CID_TEST_PATTERN_GREENR: > > + cci_write(imx519->regmap, IMX519_REG_TEST_PATTERN_GR, > > + ctrl->val, &ret); > > + break; > > + case V4L2_CID_TEST_PATTERN_BLUE: > > + cci_write(imx519->regmap, IMX519_REG_TEST_PATTERN_B, > > + ctrl->val, &ret); > > + break; > > + case V4L2_CID_TEST_PATTERN_GREENB: > > + cci_write(imx519->regmap, IMX519_REG_TEST_PATTERN_GB, > > + ctrl->val, &ret); > > + break; > > + case V4L2_CID_HFLIP: > > + case V4L2_CID_VFLIP: > > + cci_write(imx519->regmap, IMX519_REG_ORIENTATION, > > + imx519->hflip->val | imx519->vflip->val << 1, &ret); > > + break; > > + case V4L2_CID_VBLANK: > > + ret = imx519_set_frame_length(imx519, > > + imx519->mode->height + ctrl->val); > > + break; > > + default: > > + dev_info(&client->dev, > > + "ctrl(id:0x%x,val:0x%x) is not handled\n", > > + ctrl->id, ctrl->val); > > + ret = -EINVAL; > > + break; > > + } > > + > > + pm_runtime_mark_last_busy(&client->dev); > > + pm_runtime_put_autosuspend(&client->dev); > > + > > + return ret; > > +} > > + > > +static const struct v4l2_ctrl_ops imx519_ctrl_ops = { > > + .s_ctrl = imx519_set_ctrl, > > +}; > > + > > +static int imx519_init_cfg(struct v4l2_subdev *sd, > > + struct v4l2_subdev_state *state) > > +{ > > + struct imx519 *imx519 = to_imx519(sd); > > + struct v4l2_mbus_framefmt *format; > > + struct v4l2_rect *crop; > > + > > + /* Initialize try_fmt. */ > > + format = v4l2_subdev_get_pad_format(sd, state, 0); > > + format->width = supported_modes_10bit[0].width; > > + format->height = supported_modes_10bit[0].height; > > + format->code = imx519_get_format_code(imx519); > > + format->field = V4L2_FIELD_NONE; > > + format->colorspace = V4L2_COLORSPACE_RAW; > > + format->ycbcr_enc = V4L2_MAP_YCBCR_ENC_DEFAULT(format->colorspace); > > + format->quantization = V4L2_QUANTIZATION_FULL_RANGE; > > + format->xfer_func = V4L2_XFER_FUNC_NONE; > > + > > + /* Initialize crop rectangle. */ > > + crop = v4l2_subdev_get_pad_crop(sd, state, 0); > > + crop->top = IMX519_PIXEL_ARRAY_TOP; > > + crop->left = IMX519_PIXEL_ARRAY_LEFT; > > + crop->width = IMX519_PIXEL_ARRAY_WIDTH; > > + crop->height = IMX519_PIXEL_ARRAY_HEIGHT; > > + > > + return 0; > > +} > > + > > +static int imx519_enum_mbus_code(struct v4l2_subdev *sd, > > + struct v4l2_subdev_state *sd_state, > > + struct v4l2_subdev_mbus_code_enum *code) > > +{ > > + struct imx519 *imx519 = to_imx519(sd); > > + > > + if (code->index > 0) > > + return -EINVAL; > > + > > + code->code = imx519_get_format_code(imx519); > > + > > + return 0; > > +} > > + > > +static int imx519_enum_frame_size(struct v4l2_subdev *sd, > > + struct v4l2_subdev_state *sd_state, > > + struct v4l2_subdev_frame_size_enum *fse) > > +{ > > + struct imx519 *imx519 = to_imx519(sd); > > + > > + if (fse->index >= ARRAY_SIZE(supported_modes_10bit)) > > + return -EINVAL; > > + > > + if (fse->code != imx519_get_format_code(imx519)) > > + return -EINVAL; > > I wonder if this is correct, I know there's not much consistency among > sensor drivers that handles multiple Bayer permutations, but should we > allow enumeration of frame sizes for all the supported bus codes or > only for the currently active one ? > > > + > > + fse->min_width = supported_modes_10bit[fse->index].width; > > + fse->max_width = fse->min_width; > > + fse->min_height = supported_modes_10bit[fse->index].height; > > + fse->max_height = fse->min_height; > > + > > + return 0; > > +} > > + > > +static void imx519_update_image_pad_format(struct imx519 *imx519, > > + const struct imx519_mode *mode, > > + struct v4l2_subdev_format *fmt) > > Called from a single place, could be inlined > > > +{ > > + fmt->format.width = mode->width; > > + fmt->format.height = mode->height; > > + fmt->format.field = V4L2_FIELD_NONE; > > + fmt->format.colorspace = V4L2_COLORSPACE_RAW; > > + fmt->format.xfer_func = V4L2_XFER_FUNC_NONE; > > + fmt->format.ycbcr_enc = V4L2_YCBCR_ENC_601; > > + fmt->format.quantization = V4L2_QUANTIZATION_FULL_RANGE; > > +} > > + > > +static > > +unsigned int imx519_get_frame_length(const struct imx519_mode *mode, > > + const struct v4l2_fract *timeperframe) > > +{ > > + u64 frame_length; > > + > > + frame_length = (u64)timeperframe->numerator * IMX519_PIXEL_RATE; > > + do_div(frame_length, > > + (u64)timeperframe->denominator * mode->line_length_pix); > > all of this to get the max frame height in lines ? > > I would rather define a max_vts for each mode, as your _min and > _defaul are the same, and remove this calculations > > > + > > + if (WARN_ON(frame_length > IMX519_FRAME_LENGTH_MAX)) > > Can this happen with this driver ? > > > + frame_length = IMX519_FRAME_LENGTH_MAX; > > + > > + return max_t(unsigned int, frame_length, mode->height); > > +} > > + > > +static void imx519_set_framing_limits(struct imx519 *imx519) > > +{ > > + unsigned int frm_length_min, frm_length_default, hblank; > > + const struct imx519_mode *mode = imx519->mode; > > + > > + frm_length_min = imx519_get_frame_length(mode, &mode->timeperframe_min); > > + frm_length_default = > > + imx519_get_frame_length(mode, &mode->timeperframe_default); > > + > > + /* Default to no long exposure multiplier. */ > > + imx519->long_exp_shift = 0; > > + > > + /* Update limits and set FPS to default */ > > + __v4l2_ctrl_modify_range(imx519->vblank, frm_length_min - mode->height, > > + ((1 << IMX519_LONG_EXP_SHIFT_MAX) * > > + IMX519_FRAME_LENGTH_MAX) - mode->height, > > + 1, frm_length_default - mode->height); > > + > > + /* Setting this will adjust the exposure limits as well. */ > > + __v4l2_ctrl_s_ctrl(imx519->vblank, frm_length_default - mode->height); > > + > > + /* > > + * Currently PPL is fixed to the mode specified value, so hblank > > + * depends on mode->width only, and is not changeable in any > > + * way other than changing the mode. > > + */ > > + hblank = mode->line_length_pix - mode->width; > > + __v4l2_ctrl_modify_range(imx519->hblank, hblank, hblank, 1, hblank); > > +} > > + > > +static int imx519_set_pad_format(struct v4l2_subdev *sd, > > + struct v4l2_subdev_state *sd_state, > > + struct v4l2_subdev_format *fmt) > > +{ > > + struct v4l2_mbus_framefmt *format; > > + const struct imx519_mode *mode; > > + struct imx519 *imx519 = to_imx519(sd); > > + > > + /* Bayer order varies with flips */ > > + fmt->format.code = imx519_get_format_code(imx519); > > + > > + mode = v4l2_find_nearest_size(supported_modes_10bit, > > + ARRAY_SIZE(supported_modes_10bit), > > + width, height, > > + fmt->format.width, > > + fmt->format.height); > > + imx519_update_image_pad_format(imx519, mode, fmt); > > + format = v4l2_subdev_get_pad_format(sd, sd_state, 0); > > + if (imx519->mode == mode && format->code == fmt->format.code) > > + return 0; > > As you can read in Laurent's > [PATCH v2 3/3] media: i2c: imx219: Perform a full mode set unconditionally > > this is not correct for V4L2_SUBDEV_FORMAT_TRY > > You can remove this > > > + > > + if (fmt->which == V4L2_SUBDEV_FORMAT_ACTIVE) { > > + imx519->mode = mode; > > + imx519_set_framing_limits(imx519); > > + } > > + > > + *format = fmt->format; > > [PATCH v2 2/3] media: i2c: imx219: Fix crop rectangle setting when changing format > Applies here too > > > + > > + return 0; > > +} > > + > > +static int imx519_get_selection(struct v4l2_subdev *sd, > > + struct v4l2_subdev_state *sd_state, > > + struct v4l2_subdev_selection *sel) > > +{ > > + switch (sel->target) { > > + case V4L2_SEL_TGT_CROP: { > > + sel->r = *v4l2_subdev_get_pad_crop(sd, sd_state, 0); > > + return 0; > > + } > > + > > + case V4L2_SEL_TGT_NATIVE_SIZE: > > + sel->r.left = 0; > > + sel->r.top = 0; > > + sel->r.width = IMX519_NATIVE_WIDTH; > > + sel->r.height = IMX519_NATIVE_HEIGHT; > > + > > + return 0; > > + > > + case V4L2_SEL_TGT_CROP_DEFAULT: > > + case V4L2_SEL_TGT_CROP_BOUNDS: > > + sel->r.left = IMX519_PIXEL_ARRAY_LEFT; > > + sel->r.top = IMX519_PIXEL_ARRAY_TOP; > > + sel->r.width = IMX519_PIXEL_ARRAY_WIDTH; > > + sel->r.height = IMX519_PIXEL_ARRAY_HEIGHT; > > + > > + return 0; > > + } > > + > > + return -EINVAL; > > +} > > + > > +/* Start streaming */ > > +static int imx519_start_streaming(struct imx519 *imx519, > > + struct v4l2_subdev_state *state) > > +{ > > + struct i2c_client *client = v4l2_get_subdevdata(&imx519->sd); > > + const struct imx519_reg_list *reg_list; > > + int ret; > > + > > + ret = pm_runtime_resume_and_get(&client->dev); > > + if (ret < 0) > > + return ret; > > + > > + if (!imx519->common_regs_written) { > > This is supicious. You use runtime_pm and at streaming stop the device > enters autosuspend, which is exited at the next streaming start. So I > suspect this condition is always true and can be removed, as the > sensor has to be fully re-programmed anyway > > > + ret = cci_multi_reg_write(imx519->regmap, mode_common_regs, > > + ARRAY_SIZE(mode_common_regs), NULL); > > + > > + if (ret) { > > + dev_err(&client->dev, "%s failed to set common settings\n", > > + __func__); > > + goto err_rpm_put; > > + } > > + imx519->common_regs_written = true; > > + } > > + > > + /* Apply default values of current mode */ > > + reg_list = &imx519->mode->reg_list; > > + ret = cci_multi_reg_write(imx519->regmap, reg_list->regs, > > + reg_list->num_of_regs, NULL); > > + if (ret) { > > + dev_err(&client->dev, "%s failed to set mode\n", __func__); > > + goto err_rpm_put; > > + } > > + > > + /* Apply customized values from user */ > > + ret = __v4l2_ctrl_handler_setup(imx519->sd.ctrl_handler); > > + if (ret) > > + goto err_rpm_put; > > + > > + /* set stream on register */ > > + ret = cci_write(imx519->regmap, IMX519_REG_MODE_SELECT, > > + IMX519_MODE_STREAMING, NULL); > > + if (ret) > > + goto err_rpm_put; > > + > > + /* vflip and hflip cannot change during streaming */ > > + __v4l2_ctrl_grab(imx519->vflip, true); > > + __v4l2_ctrl_grab(imx519->hflip, true); > > + > > + return 0; > > + > > +err_rpm_put: > > + pm_runtime_mark_last_busy(&client->dev); > > + pm_runtime_put_autosuspend(&client->dev); > > + > > + return ret; > > +} > > + > > +/* Stop streaming */ > > +static void imx519_stop_streaming(struct imx519 *imx519) > > +{ > > + struct i2c_client *client = v4l2_get_subdevdata(&imx519->sd); > > + int ret; > > + > > + /* set stream off register */ > > + ret = cci_write(imx519->regmap, IMX519_REG_MODE_SELECT, > > + IMX519_MODE_STANDBY, NULL); > > + if (ret) > > + dev_err(&client->dev, "%s failed to set stream\n", __func__); > > + > > + __v4l2_ctrl_grab(imx519->vflip, false); > > + __v4l2_ctrl_grab(imx519->hflip, false); > > + > > + pm_runtime_mark_last_busy(&client->dev); > > + pm_runtime_put_autosuspend(&client->dev); > > +} > > + > > +static int imx519_set_stream(struct v4l2_subdev *sd, int enable) > > +{ > > + struct imx519 *imx519 = to_imx519(sd); > > + struct v4l2_subdev_state *state; > > + int ret = 0; > > + > > + state = v4l2_subdev_lock_and_get_active_state(sd); > > + > > + if (enable) > > + ret = imx519_start_streaming(imx519, state); > > + else > > + imx519_stop_streaming(imx519); > > + > > + v4l2_subdev_unlock_state(state); > > + > > + return ret; > > +} > > + > > +static const struct v4l2_subdev_core_ops imx519_core_ops = { > > + .subscribe_event = v4l2_ctrl_subdev_subscribe_event, > > + .unsubscribe_event = v4l2_event_subdev_unsubscribe, > > +}; > > + > > +static const struct v4l2_subdev_video_ops imx519_video_ops = { > > + .s_stream = imx519_set_stream, > > +}; > > + > > +static const struct v4l2_subdev_pad_ops imx519_pad_ops = { > > + .init_cfg = imx519_init_cfg, > > + .enum_mbus_code = imx519_enum_mbus_code, > > + .get_fmt = v4l2_subdev_get_fmt, > > + .set_fmt = imx519_set_pad_format, > > + .get_selection = imx519_get_selection, > > + .enum_frame_size = imx519_enum_frame_size, > > +}; > > + > > +static const struct v4l2_subdev_ops imx519_subdev_ops = { > > + .core = &imx519_core_ops, > > + .video = &imx519_video_ops, > > + .pad = &imx519_pad_ops, > > +}; > > + > > +/* Power/clock management functions */ > > +static int imx519_power_on(struct device *dev) > > +{ > > + struct i2c_client *client = to_i2c_client(dev); > > + struct v4l2_subdev *sd = i2c_get_clientdata(client); > > + struct imx519 *imx519 = to_imx519(sd); > > + int ret; > > + > > + ret = regulator_bulk_enable(ARRAY_SIZE(imx519_supply_name), > > + imx519->supplies); > > + if (ret) { > > + dev_err(&client->dev, "%s: failed to enable regulators\n", > > + __func__); > > + return ret; > > + } > > + > > + ret = clk_prepare_enable(imx519->xclk); > > + if (ret) { > > + dev_err(&client->dev, "%s: failed to enable clock\n", > > + __func__); > > + goto reg_off; > > + } > > + > > + gpiod_set_value_cansleep(imx519->reset_gpio, 1); > > Usually on power_on the reset/poweron gpios are set to logical 0. > If this works for you I think you need to invert the line polarity in > your .dts. XCLR needs to go high for IMX519 to power on. I think it possibly depends on what you've named it - reset vs power_on Quick sample (admittedly on 6.1 as that's what I happen to have): gpiod_set_value_cansleep(XXX_gpio, 1); in power_on. - imx219 - imx214 - imx274 - imx334 - imx335 - ov7251 gpiod_set_value_cansleep(XXX_gpio, 0) in power_on - imx290 - imx296 - imx412 > > + usleep_range(IMX519_XCLR_MIN_DELAY_US, > > + IMX519_XCLR_MIN_DELAY_US + IMX519_XCLR_DELAY_RANGE_US); > > fsleep() will do > > > + > > + return 0; > > + > > +reg_off: > > + regulator_bulk_disable(ARRAY_SIZE(imx519_supply_name), imx519->supplies); > > + > > + return ret; > > +} > > + > > +static int imx519_power_off(struct device *dev) > > +{ > > + struct i2c_client *client = to_i2c_client(dev); > > + struct v4l2_subdev *sd = i2c_get_clientdata(client); > > + struct imx519 *imx519 = to_imx519(sd); > > + > > + gpiod_set_value_cansleep(imx519->reset_gpio, 0); > > + regulator_bulk_disable(ARRAY_SIZE(imx519_supply_name), imx519->supplies); > > + clk_disable_unprepare(imx519->xclk); > > Usually, the reverse power up sequence is used. It shouldn't make any > difference, unless the datasheet prescribes this sequence. I'd agree. T1 from XCLR falling to VANA/VDIG/VIF falling is 0us, so XCLR must go low first. VANA, VDIG, and VIF can then fall in any order. The diagram shows INCK stopping before XCLR is dropped. Driving a clock signal into powered down electronics is generally "a bad thing", so the clock should be stopped before the regulators are killed. Again this is copied from imx477. Our modules don't matter as all 3 regulators, clock, and XCLR are sequenced off one GPIO. > > + > > + /* Force reprogramming of the common registers when powered up again. */ > > + imx519->common_regs_written = false; > > + > > + return 0; > > +} > > + > > +static int imx519_get_regulators(struct imx519 *imx519) > > +{ > > + struct i2c_client *client = v4l2_get_subdevdata(&imx519->sd); > > + unsigned int i; > > + > > + for (i = 0; i < ARRAY_SIZE(imx519_supply_name); i++) > > + imx519->supplies[i].supply = imx519_supply_name[i]; > > + > > + return devm_regulator_bulk_get(&client->dev, > > + ARRAY_SIZE(imx519_supply_name), > > + imx519->supplies); > > +} > > + > > +/* Verify chip ID */ > > +static int imx519_identify_module(struct imx519 *imx519) > > +{ > > + struct i2c_client *client = v4l2_get_subdevdata(&imx519->sd); > > + int ret; > > + u64 val; > > + > > + ret = cci_read(imx519->regmap, IMX519_REG_CHIP_ID, &val, NULL); > > + if (ret) { > > + dev_err(&client->dev, "failed to read chip id %x, with error %d\n", > > + IMX519_CHIP_ID, ret); > > + return ret; > > + } > > + > > + if (val != IMX519_CHIP_ID) { > > + dev_err(&client->dev, "chip id mismatch: %x!=%llx\n", > > + IMX519_CHIP_ID, val); > > + return -EIO; > > + } > > + > > + dev_info(&client->dev, "Device found is imx%llx\n", val); > > dev_dbg maybe > > > + > > + return 0; > > +} > > + > > +/* Initialize control handlers */ > > +static int imx519_init_controls(struct imx519 *imx519) > > +{ > > + struct v4l2_ctrl_handler *ctrl_hdlr; > > + struct i2c_client *client = v4l2_get_subdevdata(&imx519->sd); > > + struct v4l2_fwnode_device_properties props; > > + unsigned int i; > > + int ret; > > + > > + ctrl_hdlr = &imx519->ctrl_handler; > > + ret = v4l2_ctrl_handler_init(ctrl_hdlr, 16); > > + if (ret) > > + return ret; > > + > > + /* By default, PIXEL_RATE is read only */ > > + v4l2_ctrl_new_std(ctrl_hdlr, &imx519_ctrl_ops, V4L2_CID_PIXEL_RATE, > > + IMX519_PIXEL_RATE, IMX519_PIXEL_RATE, 1, > > + IMX519_PIXEL_RATE); > > + > > + /* > > + * Create the controls here, but mode specific limits are setup > > + * in the imx519_set_framing_limits() call below. > > + */ > > + imx519->vblank = v4l2_ctrl_new_std(ctrl_hdlr, &imx519_ctrl_ops, > > + V4L2_CID_VBLANK, 0, 0xffff, 1, 0); > > + imx519->hblank = v4l2_ctrl_new_std(ctrl_hdlr, &imx519_ctrl_ops, > > + V4L2_CID_HBLANK, 0, 0xffff, 1, 0); > > + > > + /* HBLANK is read-only for now, but does change with mode. */ > > + if (imx519->hblank) > > + imx519->hblank->flags |= V4L2_CTRL_FLAG_READ_ONLY; > > + > > + imx519->exposure = v4l2_ctrl_new_std(ctrl_hdlr, &imx519_ctrl_ops, > > + V4L2_CID_EXPOSURE, > > + IMX519_EXPOSURE_MIN, > > + IMX519_EXPOSURE_MAX, > > + IMX519_EXPOSURE_STEP, > > + IMX519_EXPOSURE_DEFAULT); > > + > > + v4l2_ctrl_new_std(ctrl_hdlr, &imx519_ctrl_ops, V4L2_CID_ANALOGUE_GAIN, > > + IMX519_ANA_GAIN_MIN, IMX519_ANA_GAIN_MAX, > > + IMX519_ANA_GAIN_STEP, IMX519_ANA_GAIN_DEFAULT); > > + > > + v4l2_ctrl_new_std(ctrl_hdlr, &imx519_ctrl_ops, V4L2_CID_DIGITAL_GAIN, > > + IMX519_DGTL_GAIN_MIN, IMX519_DGTL_GAIN_MAX, > > + IMX519_DGTL_GAIN_STEP, IMX519_DGTL_GAIN_DEFAULT); > > + > > + imx519->hflip = v4l2_ctrl_new_std(ctrl_hdlr, &imx519_ctrl_ops, > > + V4L2_CID_HFLIP, 0, 1, 1, 0); > > + if (imx519->hflip) > > + imx519->hflip->flags |= V4L2_CTRL_FLAG_MODIFY_LAYOUT; > > + > > + imx519->vflip = v4l2_ctrl_new_std(ctrl_hdlr, &imx519_ctrl_ops, > > + V4L2_CID_VFLIP, 0, 1, 1, 0); > > + if (imx519->vflip) > > + imx519->vflip->flags |= V4L2_CTRL_FLAG_MODIFY_LAYOUT; > > As Dave suggested, you can cluster these two > > > + > > + v4l2_ctrl_new_std_menu_items(ctrl_hdlr, &imx519_ctrl_ops, > > + V4L2_CID_TEST_PATTERN, > > + ARRAY_SIZE(imx519_test_pattern_menu) - 1, > > + 0, 0, imx519_test_pattern_menu); > > + for (i = 0; i < 4; i++) { > > + /* > > + * The assumption is that > > + * V4L2_CID_TEST_PATTERN_GREENR == V4L2_CID_TEST_PATTERN_RED + 1 > > + * V4L2_CID_TEST_PATTERN_BLUE == V4L2_CID_TEST_PATTERN_RED + 2 > > + * V4L2_CID_TEST_PATTERN_GREENB == V4L2_CID_TEST_PATTERN_RED + 3 > > + */ > > + v4l2_ctrl_new_std(ctrl_hdlr, &imx519_ctrl_ops, > > + V4L2_CID_TEST_PATTERN_RED + i, > > + IMX519_TEST_PATTERN_COLOUR_MIN, > > + IMX519_TEST_PATTERN_COLOUR_MAX, > > + IMX519_TEST_PATTERN_COLOUR_STEP, > > + IMX519_TEST_PATTERN_COLOUR_MAX); > > + /* The "Solid color" pattern is white by default */ > > + } > > + > > + if (ctrl_hdlr->error) { > > + ret = ctrl_hdlr->error; > > + dev_err(&client->dev, "%s control init failed (%d)\n", > > + __func__, ret); > > + goto error; > > + } > > + > > + ret = v4l2_fwnode_device_parse(&client->dev, &props); > > + if (ret) > > + goto error; > > + > > + ret = v4l2_ctrl_new_fwnode_properties(ctrl_hdlr, &imx519_ctrl_ops, > > + &props); > > + if (ret) > > + goto error; > > + > > + imx519->sd.ctrl_handler = ctrl_hdlr; > > + > > + mutex_lock(imx519->ctrl_handler.lock); > > Is locking the mutex required during the driver's probe sequence ? > > > + > > + /* Setup exposure and frame/line length limits. */ > > + imx519_set_framing_limits(imx519); > > + > > + mutex_unlock(imx519->ctrl_handler.lock); > > + > > + return 0; > > + > > +error: > > + v4l2_ctrl_handler_free(ctrl_hdlr); > > + > > + return ret; > > +} > > + > > +static void imx519_free_controls(struct imx519 *imx519) > > +{ > > + v4l2_ctrl_handler_free(imx519->sd.ctrl_handler); > > +} > > + > > +static int imx519_check_hwcfg(struct device *dev) > > +{ > > + struct fwnode_handle *endpoint; > > + struct v4l2_fwnode_endpoint ep_cfg = { > > + .bus_type = V4L2_MBUS_CSI2_DPHY > > + }; > > + int ret = -EINVAL; > > + > > + endpoint = fwnode_graph_get_next_endpoint(dev_fwnode(dev), NULL); > > + if (!endpoint) { > > + dev_err(dev, "endpoint node not found\n"); > > + return -EINVAL; > > + } > > + > > + if (v4l2_fwnode_endpoint_alloc_parse(endpoint, &ep_cfg)) { > > + dev_err(dev, "could not parse endpoint\n"); > > + goto out; > > If v4l2_fwnode_endpoint_alloc_parse() fails there's no need to call > v4l2_fwnode_endpoint_free() (but you still need to put() the > endpoint). > > > + } > > + > > + /* Check the number of MIPI CSI2 data lanes */ > > + if (ep_cfg.bus.mipi_csi2.num_data_lanes != 2) { > > + dev_err(dev, "only 2 data lanes are currently supported\n"); > > + goto out; > > + } > > + > > + /* Check the link frequency set in device tree */ > > + if (!ep_cfg.nr_of_link_frequencies) { > > + dev_err(dev, "link-frequency property not found in DT\n"); > > + goto out; > > + } > > + > > + if (ep_cfg.nr_of_link_frequencies != 1 || > > + ep_cfg.link_frequencies[0] != IMX519_DEFAULT_LINK_FREQ) { > > + dev_err(dev, "Link frequency not supported: %lld\n", > > + ep_cfg.link_frequencies[0]); > > + goto out; > > + } > > + > > + ret = 0; > > + > > +out: > > + v4l2_fwnode_endpoint_free(&ep_cfg); > > + fwnode_handle_put(endpoint); > > + > > + return ret; > > +} > > + > > +static const struct of_device_id imx519_dt_ids[] = { > > + { .compatible = "sony,imx519" }, > > + { /* sentinel */ } > > +}; > > + > > +static int imx519_probe(struct i2c_client *client) > > +{ > > + struct device *dev = &client->dev; > > + struct imx519 *imx519; > > + u32 xclk_freq; > > + int ret; > > + > > + imx519 = devm_kzalloc(&client->dev, sizeof(*imx519), GFP_KERNEL); > > + if (!imx519) > > + return -ENOMEM; > > + > > + v4l2_i2c_subdev_init(&imx519->sd, client, &imx519_subdev_ops); > > + > > + /* Check the hardware configuration in device tree */ > > + if (imx519_check_hwcfg(dev)) > > + return -EINVAL; > > + > > + imx519->regmap = devm_cci_regmap_init_i2c(client, 16); > > + if (IS_ERR(imx519->regmap)) > > + return dev_err_probe(dev, PTR_ERR(imx519->regmap), > > + "failed to initialize CCI\n"); > > Can this function EPROBE_DEFER ? > > > + > > + /* Get system clock (xclk) */ > > + imx519->xclk = devm_clk_get(dev, NULL); > > + if (IS_ERR(imx519->xclk)) > > + return dev_err_probe(dev, PTR_ERR(imx519->xclk), > > + "failed to get xclk\n"); > > + > > + xclk_freq = clk_get_rate(imx519->xclk); > > + if (xclk_freq != IMX519_XCLK_FREQ) > > + return dev_err_probe(dev, -EINVAL, > > What is dev_err_probe useful for if you're passing -EINVAL ? > > > + "xclk frequency not supported: %d Hz\n", > > + xclk_freq); > > + > > + ret = imx519_get_regulators(imx519); > > + if (ret) > > + return dev_err_probe(dev, ret, "failed to get regulators\n"); > > + > > + /* Request optional enable pin */ > > + imx519->reset_gpio = devm_gpiod_get_optional(dev, "reset", > > + GPIOD_OUT_HIGH); > > + if (IS_ERR(imx519->reset_gpio)) > > + return dev_err_probe(dev, PTR_ERR(imx519->reset_gpio), > > + "failed to get reset gpio\n"); > > + > > + /* > > + * The sensor must be powered for imx519_identify_module() > > + * to be able to read the CHIP_ID register > > + */ > > + ret = imx519_power_on(dev); > > + if (ret) > > + return ret; > > + > > + ret = imx519_identify_module(imx519); > > + if (ret) > > + goto error_power_off; > > + > > + /* Set default mode to max resolution */ > > + imx519->mode = &supported_modes_10bit[0]; > > + > > + /* > > + * Enable runtime PM. As the device has been powered manually, mark it > > + * as active, and increase the usage count without resuming the device. > > + */ > > + pm_runtime_set_active(dev); > > + pm_runtime_get_noresume(dev); > > + pm_runtime_enable(dev); > > + > > + pm_runtime_set_autosuspend_delay(dev, 1000); > > + pm_runtime_use_autosuspend(dev); > > + > > + /* This needs the pm runtime to be registered. */ > > How so ? It calls imx519_set_framing_limits, which calls __v4l2_ctrl_s_ctrl(vblank). imx519_set_ctrl then calls pm_runtime_get_if_in_use to see if the sensor is powered up. pm_runtime_get_if_active then checks dev->power.runtime_status != RPM_ACTIVE [1], but RPM_ACTIVE = 0, so the default answer is that we're powered up and hence try writing the relevant I2C registers. Memory says it was Laurent's imx290 patches that first tripped over that one when he'd tried moving the ctrl_handler_init. Dave [1] https://elixir.bootlin.com/linux/latest/source/drivers/base/power/runtime.c#L1199 > > + ret = imx519_init_controls(imx519); > > + if (ret) > > + goto error_rpm_disable; > > + > > + /* Initialize subdev */ > > + imx519->sd.flags |= V4L2_SUBDEV_FL_HAS_DEVNODE | > > + V4L2_SUBDEV_FL_HAS_EVENTS; > > + imx519->sd.entity.function = MEDIA_ENT_F_CAM_SENSOR; > > + > > + /* Initialize source pads */ > > + imx519->pad.flags = MEDIA_PAD_FL_SOURCE; > > + > > + ret = media_entity_pads_init(&imx519->sd.entity, 1, &imx519->pad); > > + if (ret) { > > + dev_err(dev, "failed to init entity pads: %d\n", ret); > > + goto error_handler_free; > > + } > > + > > + imx519->sd.state_lock = imx519->ctrl_handler.lock; > > + ret = v4l2_subdev_init_finalize(&imx519->sd); > > + if (ret < 0) { > > + dev_err(dev, "subdev init error: %d\n", ret); > > + goto error_media_entity; > > + } > > + > > + ret = v4l2_async_register_subdev_sensor(&imx519->sd); > > + if (ret < 0) { > > + dev_err(dev, "failed to register sensor sub-device: %d\n", ret); > > + goto error_subdev_cleanup; > > + } > > + > > + pm_runtime_mark_last_busy(dev); > > + pm_runtime_put_autosuspend(dev); > > + > > + return 0; > > + > > +error_subdev_cleanup: > > + v4l2_subdev_cleanup(&imx519->sd); > > + > > +error_media_entity: > > + media_entity_cleanup(&imx519->sd.entity); > > + > > +error_handler_free: > > + imx519_free_controls(imx519); > > + > > +error_rpm_disable: > > + pm_runtime_disable(&client->dev); > > + pm_runtime_put_noidle(&client->dev); > > + > > +error_power_off: > > + imx519_power_off(&client->dev); > > + > > + return ret; > > +} > > + > > +static void imx519_remove(struct i2c_client *client) > > +{ > > + struct v4l2_subdev *sd = i2c_get_clientdata(client); > > + struct imx519 *imx519 = to_imx519(sd); > > + > > + v4l2_async_unregister_subdev(sd); > > + v4l2_subdev_cleanup(sd); > > + media_entity_cleanup(&sd->entity); > > + imx519_free_controls(imx519); > > + > > + pm_runtime_disable(&client->dev); > > + if (!pm_runtime_status_suspended(&client->dev)) > > + imx519_power_off(&client->dev); > > + pm_runtime_set_suspended(&client->dev); > > +} > > + > > +MODULE_DEVICE_TABLE(of, imx519_dt_ids); > > I would define imx519_dt_ids just above here > > > + > > +static const struct dev_pm_ops imx519_pm_ops = { > > + SET_RUNTIME_PM_OPS(imx519_power_off, imx519_power_on, NULL) > > +}; > > + > > +static struct i2c_driver imx519_i2c_driver = { > > + .driver = { > > + .name = "imx519", > > + .of_match_table = imx519_dt_ids, > > + .pm = &imx519_pm_ops, > > + }, > > + .probe = imx519_probe, > > + .remove = imx519_remove, > > +}; > > + > > +module_i2c_driver(imx519_i2c_driver); > > + > > +MODULE_AUTHOR("Lee Jackson <lee.jackson@arducam.com>"); > > +MODULE_DESCRIPTION("Sony IMX519 sensor driver"); > > +MODULE_LICENSE("GPL v2"); > > checkpatch.pl suggests to just use "GPL" here > > Thanks > j > > > -- > > 2.41.0 > >
Hi Umang, Thank you for the patch. On Fri, Sep 08, 2023 at 08:43:44AM -0400, Umang Jain wrote: > From: Lee Jackson <lee.jackson@arducam.com> > > Add a driver for the 16MPix IMX519 CSI2 sensor. > Whilst the sensor supports 2 or 4 CSI2 data lanes, this driver > currently only supports 2 lanes. > > The following Bayer modes are currently available: > > 4656x3496 10-bit @ 10fps > 3840x2160 10-bit (cropped) @ 21fps > 2328x1748 10-bit (binned) @ 30fps > 1920x1080 10-bit (cropped/binned) @ 60fps > 1280x720 10-bit (cropped/binned) @ 120fps > > Signed-off-by: Lee Jackson <lee.jackson@arducam.com> > Signed-off-by: Umang Jain <umang.jain@ideasonboard.com> > --- > MAINTAINERS | 1 + > drivers/media/i2c/Kconfig | 14 + > drivers/media/i2c/Makefile | 1 + > drivers/media/i2c/imx519.c | 1842 ++++++++++++++++++++++++++++++++++++ > 4 files changed, 1858 insertions(+) > create mode 100644 drivers/media/i2c/imx519.c [snip] > diff --git a/drivers/media/i2c/imx519.c b/drivers/media/i2c/imx519.c > new file mode 100644 > index 000000000000..f818a3d0bd25 > --- /dev/null > +++ b/drivers/media/i2c/imx519.c > @@ -0,0 +1,1842 @@ [snip] > +/* 16 mpix 10fps */ > +static const struct cci_reg_sequence mode_4656x3496_regs[] = { > + { CCI_REG8(0x0111), 0x02 }, > + { CCI_REG8(0x0112), 0x0a }, > + { CCI_REG8(0x0113), 0x0a }, > + { CCI_REG8(0x0114), 0x01 }, > + { CCI_REG8(0x0342), 0x42 }, > + { CCI_REG8(0x0343), 0x00 }, > + { CCI_REG8(0x0340), 0x0d }, > + { CCI_REG8(0x0341), 0xf4 }, > + { CCI_REG8(0x0344), 0x00 }, > + { CCI_REG8(0x0345), 0x00 }, > + { CCI_REG8(0x0346), 0x00 }, > + { CCI_REG8(0x0347), 0x00 }, > + { CCI_REG8(0x0348), 0x12 }, > + { CCI_REG8(0x0349), 0x2f }, > + { CCI_REG8(0x034a), 0x0d }, > + { CCI_REG8(0x034b), 0xa7 }, > + { CCI_REG8(0x0220), 0x00 }, > + { CCI_REG8(0x0221), 0x11 }, > + { CCI_REG8(0x0222), 0x01 }, > + { CCI_REG8(0x0900), 0x00 }, > + { CCI_REG8(0x0901), 0x11 }, > + { CCI_REG8(0x0902), 0x0a }, > + { CCI_REG8(0x3f4c), 0x01 }, > + { CCI_REG8(0x3f4d), 0x01 }, > + { CCI_REG8(0x4254), 0x7f }, > + { CCI_REG8(0x0401), 0x00 }, > + { CCI_REG8(0x0404), 0x00 }, > + { CCI_REG8(0x0405), 0x10 }, > + { CCI_REG8(0x0408), 0x00 }, > + { CCI_REG8(0x0409), 0x00 }, > + { CCI_REG8(0x040a), 0x00 }, > + { CCI_REG8(0x040b), 0x00 }, > + { CCI_REG8(0x040c), 0x12 }, > + { CCI_REG8(0x040d), 0x30 }, > + { CCI_REG8(0x040e), 0x0d }, > + { CCI_REG8(0x040f), 0xa8 }, > + { CCI_REG8(0x034c), 0x12 }, > + { CCI_REG8(0x034d), 0x30 }, > + { CCI_REG8(0x034e), 0x0d }, > + { CCI_REG8(0x034f), 0xa8 }, > + { CCI_REG8(0x0301), 0x06 }, > + { CCI_REG8(0x0303), 0x04 }, > + { CCI_REG8(0x0305), 0x04 }, > + { CCI_REG8(0x0306), 0x01 }, > + { CCI_REG8(0x0307), 0x57 }, > + { CCI_REG8(0x0309), 0x0a }, > + { CCI_REG8(0x030b), 0x02 }, > + { CCI_REG8(0x030d), 0x04 }, > + { CCI_REG8(0x030e), 0x01 }, > + { CCI_REG8(0x030f), 0x49 }, > + { CCI_REG8(0x0310), 0x01 }, > + { CCI_REG8(0x0820), 0x07 }, > + { CCI_REG8(0x0821), 0xb6 }, > + { CCI_REG8(0x0822), 0x00 }, > + { CCI_REG8(0x0823), 0x00 }, > + { CCI_REG8(0x3e20), 0x01 }, > + { CCI_REG8(0x3e37), 0x00 }, > + { CCI_REG8(0x3e3b), 0x00 }, > + { CCI_REG8(0x0106), 0x00 }, > + { CCI_REG8(0x0b00), 0x00 }, > + { CCI_REG8(0x3230), 0x00 }, > + { CCI_REG8(0x3f14), 0x01 }, > + { CCI_REG8(0x3f3c), 0x01 }, > + { CCI_REG8(0x3f0d), 0x0a }, > + { CCI_REG8(0x3fbc), 0x00 }, > + { CCI_REG8(0x3c06), 0x00 }, > + { CCI_REG8(0x3c07), 0x48 }, > + { CCI_REG8(0x3c0a), 0x00 }, > + { CCI_REG8(0x3c0b), 0x00 }, > + { CCI_REG8(0x3f78), 0x00 }, > + { CCI_REG8(0x3f79), 0x40 }, > + { CCI_REG8(0x3f7c), 0x00 }, > + { CCI_REG8(0x3f7d), 0x00 }, > +}; Looking at the per-mode tables, it appears that all registers below 0x3000 are CCS-compliant. Furthermore, all registers from 0x3000 above (defined in CCS as the manufacturer-specific register - or MSR - range) are identical for all modes. I can't tell if other modes could require different values for MSRs, so it's hard to assess real CCS compliance, but it looks like giving the CCS driver a try would be a good idea. I'm sure Sakari will be delighted :-) [snip]
Hi Dave, Quoting Dave Stevenson (2023-09-08 17:57:01) > Hi Jacopo > > On Fri, 8 Sept 2023 at 17:24, Jacopo Mondi > <jacopo.mondi@ideasonboard.com> wrote: > > > > Hi Umang > > > > On Fri, Sep 08, 2023 at 08:43:44AM -0400, Umang Jain wrote: > > > From: Lee Jackson <lee.jackson@arducam.com> > > > ... <snip> > > > +/* Power/clock management functions */ > > > +static int imx519_power_on(struct device *dev) > > > +{ > > > + struct i2c_client *client = to_i2c_client(dev); > > > + struct v4l2_subdev *sd = i2c_get_clientdata(client); > > > + struct imx519 *imx519 = to_imx519(sd); > > > + int ret; > > > + > > > + ret = regulator_bulk_enable(ARRAY_SIZE(imx519_supply_name), > > > + imx519->supplies); > > > + if (ret) { > > > + dev_err(&client->dev, "%s: failed to enable regulators\n", > > > + __func__); > > > + return ret; > > > + } > > > + > > > + ret = clk_prepare_enable(imx519->xclk); > > > + if (ret) { > > > + dev_err(&client->dev, "%s: failed to enable clock\n", > > > + __func__); > > > + goto reg_off; > > > + } > > > + > > > + gpiod_set_value_cansleep(imx519->reset_gpio, 1); > > > > Usually on power_on the reset/poweron gpios are set to logical 0. > > If this works for you I think you need to invert the line polarity in > > your .dts. > > XCLR needs to go high for IMX519 to power on. > I think it possibly depends on what you've named it - reset vs power_on > > Quick sample (admittedly on 6.1 as that's what I happen to have): > gpiod_set_value_cansleep(XXX_gpio, 1); in power_on. > - imx219 > - imx214 > - imx274 > - imx334 > - imx335 > - ov7251 > > gpiod_set_value_cansleep(XXX_gpio, 0) in power_on > - imx290 > - imx296 > - imx412 As this is a camera connected using the Raspberry Pi connector - I have been looking in this area too to add support for an IMX283. It occured to me that the GPIO line on the RPi Camera Connector seems to be named 'POWER_EN' ... and is usually responsible for enabling the power to the regulators on the camera module... It seems to me more 'clean/clear' to do something like the following: / { /* 12 MHz Crystal on the camera module */ imx283_inclk_0: imx283-inclk-12m { compatible = "fixed-clock"; #clock-cells = <0>; status = "okay"; clock-frequency = <12000000>; }; reg_imx283_0_3v3: regulator-imx283-0-vdd3v3 { compatible = "regulator-fixed"; pinctrl-names = "default"; pinctrl-0 = <&pinctrl_csi0_pwdn>; regulator-min-microvolt = <3300000>; regulator-max-microvolt = <3300000>; regulator-name = "IMX283_0_POWER"; gpio = <&gpio2 11 GPIO_ACTIVE_HIGH>; vin-supply = <®_csi1_3v3>; startup-delay-us = <300000>; enable-active-high; }; }; &i2c2 { sensor@1a { compatible = "sony,imx283"; reg = <0x1a>; clocks = <&imx283_inclk_0>; clock-names = "xclk"; rotation = <180>; orientation = <0>; status = "okay"; VANA-supply = <®_imx283_0_3v3>; /* Analog 2.8v */ VDIG-supply = <®_imx283_0_3v3>; /* Digital Core 1.05v */ VDDL-supply = <®_imx283_0_3v3>; /* IF 1.8v */ port { imx283_0_ep: endpoint { remote-endpoint = <&mipi_csi_0_in>; clock-lanes = <0>; data-lanes = <1 2 3 4>; }; }; }; }; I wondered if that's more clear than using a 'reset' line which isn't actually what the schematics show. > > > + usleep_range(IMX519_XCLR_MIN_DELAY_US, > > > + IMX519_XCLR_MIN_DELAY_US + IMX519_XCLR_DELAY_RANGE_US); > > > > fsleep() will do > > > > > + > > > + return 0; > > > + > > > +reg_off: > > > + regulator_bulk_disable(ARRAY_SIZE(imx519_supply_name), imx519->supplies); > > > + > > > + return ret; > > > +} > > > + > > > +static int imx519_power_off(struct device *dev) > > > +{ > > > + struct i2c_client *client = to_i2c_client(dev); > > > + struct v4l2_subdev *sd = i2c_get_clientdata(client); > > > + struct imx519 *imx519 = to_imx519(sd); > > > + > > > + gpiod_set_value_cansleep(imx519->reset_gpio, 0); > > > + regulator_bulk_disable(ARRAY_SIZE(imx519_supply_name), imx519->supplies); > > > + clk_disable_unprepare(imx519->xclk); > > > > Usually, the reverse power up sequence is used. It shouldn't make any > > difference, unless the datasheet prescribes this sequence. > > I'd agree. > T1 from XCLR falling to VANA/VDIG/VIF falling is 0us, so XCLR must go > low first. VANA, VDIG, and VIF can then fall in any order. > > The diagram shows INCK stopping before XCLR is dropped. > Driving a clock signal into powered down electronics is generally "a > bad thing", so the clock should be stopped before the regulators are > killed. > > Again this is copied from imx477. Our modules don't matter as all 3 > regulators, clock, and XCLR are sequenced off one GPIO. Indeed, that's the part that makes me think modelling the regulator part rather than a reset gpio could potentially make sense, but I'm sure this is one of those scenarios that someone is about to shoot down my idea ;-) -- Kieran
Hi Kieran On Fri, 8 Sept 2023 at 18:30, Kieran Bingham <kieran.bingham@ideasonboard.com> wrote: > > Hi Dave, > > Quoting Dave Stevenson (2023-09-08 17:57:01) > > Hi Jacopo > > > > On Fri, 8 Sept 2023 at 17:24, Jacopo Mondi > > <jacopo.mondi@ideasonboard.com> wrote: > > > > > > Hi Umang > > > > > > On Fri, Sep 08, 2023 at 08:43:44AM -0400, Umang Jain wrote: > > > > From: Lee Jackson <lee.jackson@arducam.com> > > > > > > ... <snip> > > > > > +/* Power/clock management functions */ > > > > +static int imx519_power_on(struct device *dev) > > > > +{ > > > > + struct i2c_client *client = to_i2c_client(dev); > > > > + struct v4l2_subdev *sd = i2c_get_clientdata(client); > > > > + struct imx519 *imx519 = to_imx519(sd); > > > > + int ret; > > > > + > > > > + ret = regulator_bulk_enable(ARRAY_SIZE(imx519_supply_name), > > > > + imx519->supplies); > > > > + if (ret) { > > > > + dev_err(&client->dev, "%s: failed to enable regulators\n", > > > > + __func__); > > > > + return ret; > > > > + } > > > > + > > > > + ret = clk_prepare_enable(imx519->xclk); > > > > + if (ret) { > > > > + dev_err(&client->dev, "%s: failed to enable clock\n", > > > > + __func__); > > > > + goto reg_off; > > > > + } > > > > + > > > > + gpiod_set_value_cansleep(imx519->reset_gpio, 1); > > > > > > Usually on power_on the reset/poweron gpios are set to logical 0. > > > If this works for you I think you need to invert the line polarity in > > > your .dts. > > > > XCLR needs to go high for IMX519 to power on. > > I think it possibly depends on what you've named it - reset vs power_on > > > > Quick sample (admittedly on 6.1 as that's what I happen to have): > > gpiod_set_value_cansleep(XXX_gpio, 1); in power_on. > > - imx219 > > - imx214 > > - imx274 > > - imx334 > > - imx335 > > - ov7251 > > > > gpiod_set_value_cansleep(XXX_gpio, 0) in power_on > > - imx290 > > - imx296 > > - imx412 > > As this is a camera connected using the Raspberry Pi connector - I have > been looking in this area too to add support for an IMX283. > > It occured to me that the GPIO line on the RPi Camera Connector seems to > be named 'POWER_EN' ... and is usually responsible for enabling the > power to the regulators on the camera module... > > It seems to me more 'clean/clear' to do something like the following: > > > / { > /* 12 MHz Crystal on the camera module */ > imx283_inclk_0: imx283-inclk-12m { > compatible = "fixed-clock"; > #clock-cells = <0>; > status = "okay"; > clock-frequency = <12000000>; > }; > > reg_imx283_0_3v3: regulator-imx283-0-vdd3v3 { > compatible = "regulator-fixed"; > pinctrl-names = "default"; > pinctrl-0 = <&pinctrl_csi0_pwdn>; > regulator-min-microvolt = <3300000>; > regulator-max-microvolt = <3300000>; > regulator-name = "IMX283_0_POWER"; > gpio = <&gpio2 11 GPIO_ACTIVE_HIGH>; > vin-supply = <®_csi1_3v3>; > startup-delay-us = <300000>; > enable-active-high; > }; > }; > > > &i2c2 { > sensor@1a { > compatible = "sony,imx283"; > reg = <0x1a>; > > clocks = <&imx283_inclk_0>; > clock-names = "xclk"; > > rotation = <180>; > orientation = <0>; > > status = "okay"; > > VANA-supply = <®_imx283_0_3v3>; /* Analog 2.8v */ > VDIG-supply = <®_imx283_0_3v3>; /* Digital Core 1.05v */ > VDDL-supply = <®_imx283_0_3v3>; /* IF 1.8v */ > > port { > imx283_0_ep: endpoint { > remote-endpoint = <&mipi_csi_0_in>; > clock-lanes = <0>; > data-lanes = <1 2 3 4>; > }; > }; > }; > }; > > > I wondered if that's more clear than using a 'reset' line which isn't > actually what the schematics show. That's almost exactly what Raspberry Pi do :-) About the only difference is that our overlays only assign one supply (generally vana) to the regulator that controls the GPIO, with the others attached to a dummy regulator. It's a little spread between files, but combine: https://github.com/raspberrypi/linux/blob/rpi-6.1.y/arch/arm/boot/dts/overlays/imx219.dtsi https://github.com/raspberrypi/linux/blob/rpi-6.1.y/arch/arm/boot/dts/overlays/imx219-overlay.dts with cam1_reg definition in https://github.com/raspberrypi/linux/blob/rpi-6.1.y/arch/arm/boot/dts/bcm270x.dtsi#L178-L184 and then the per board configuration of where the control GPIO is in https://github.com/raspberrypi/linux/blob/rpi-6.1.y/arch/arm/boot/dts/bcm2711-rpi-4-b.dts#L396-L398 You'll find the same arrangement for the imx519 in imx519.dtsi and imx519-overlay.dts Exposing the (optional) reset GPIO is generally so that it is accurately describing the hardware, and there is the option for driving all regulators, clocks, and reset lines from the SoC. > > > > + usleep_range(IMX519_XCLR_MIN_DELAY_US, > > > > + IMX519_XCLR_MIN_DELAY_US + IMX519_XCLR_DELAY_RANGE_US); > > > > > > fsleep() will do > > > > > > > + > > > > + return 0; > > > > + > > > > +reg_off: > > > > + regulator_bulk_disable(ARRAY_SIZE(imx519_supply_name), imx519->supplies); > > > > + > > > > + return ret; > > > > +} > > > > + > > > > +static int imx519_power_off(struct device *dev) > > > > +{ > > > > + struct i2c_client *client = to_i2c_client(dev); > > > > + struct v4l2_subdev *sd = i2c_get_clientdata(client); > > > > + struct imx519 *imx519 = to_imx519(sd); > > > > + > > > > + gpiod_set_value_cansleep(imx519->reset_gpio, 0); > > > > + regulator_bulk_disable(ARRAY_SIZE(imx519_supply_name), imx519->supplies); > > > > + clk_disable_unprepare(imx519->xclk); > > > > > > Usually, the reverse power up sequence is used. It shouldn't make any > > > difference, unless the datasheet prescribes this sequence. > > > > I'd agree. > > T1 from XCLR falling to VANA/VDIG/VIF falling is 0us, so XCLR must go > > low first. VANA, VDIG, and VIF can then fall in any order. > > > > The diagram shows INCK stopping before XCLR is dropped. > > Driving a clock signal into powered down electronics is generally "a > > bad thing", so the clock should be stopped before the regulators are > > killed. > > > > Again this is copied from imx477. Our modules don't matter as all 3 > > regulators, clock, and XCLR are sequenced off one GPIO. > > Indeed, that's the part that makes me think modelling the regulator part > rather than a reset gpio could potentially make sense, but I'm sure this > is one of those scenarios that someone is about to shoot down my idea > ;-) Going back about 4 years I used to have the firmware patching the reset GPIO for the relevant sensor driver. That fell apart with the CM4 where there is one shutdown line fed to both camera ports - only one driver instance could claim the GPIO. Switching to regulators meant that the regulator framework did all the required refcounting for me, and life was happy again. It is also easier to define the relevant GPIO for the regulator at a platform level, rather than in the overlays, therefore the firmware didn't need to do any patching. Dave
diff --git a/MAINTAINERS b/MAINTAINERS index bca8512c0439..8e5647958e9c 100644 --- a/MAINTAINERS +++ b/MAINTAINERS @@ -19905,6 +19905,7 @@ L: linux-media@vger.kernel.org S: Maintained T: git git://linuxtv.org/media_tree.git F: Documentation/devicetree/bindings/media/i2c/sony,imx519.yaml +F: drivers/media/i2c/imx519.c SONY MEMORYSTICK SUBSYSTEM M: Maxim Levitsky <maximlevitsky@gmail.com> diff --git a/drivers/media/i2c/Kconfig b/drivers/media/i2c/Kconfig index f7cea5c53ead..eb8cf80313b0 100644 --- a/drivers/media/i2c/Kconfig +++ b/drivers/media/i2c/Kconfig @@ -256,6 +256,20 @@ config VIDEO_IMX415 To compile this driver as a module, choose M here: the module will be called imx415. +config VIDEO_IMX519 + tristate "Sony IMX519 sensor support" + depends on I2C && VIDEO_DEV + select MEDIA_CONTROLLER + select VIDEO_V4L2_SUBDEV_API + select V4L2_CCI_I2C + select V4L2_FWNODE + help + This is a Video4Linux2 sensor driver for the Sony + IMX519 camera. + + To compile this driver as a module, choose M here: the + module will be called imx519. + config VIDEO_MAX9271_LIB tristate diff --git a/drivers/media/i2c/Makefile b/drivers/media/i2c/Makefile index c743aeb5d1ad..a00ac6c7fc81 100644 --- a/drivers/media/i2c/Makefile +++ b/drivers/media/i2c/Makefile @@ -49,6 +49,7 @@ obj-$(CONFIG_VIDEO_IMX335) += imx335.o obj-$(CONFIG_VIDEO_IMX355) += imx355.o obj-$(CONFIG_VIDEO_IMX412) += imx412.o obj-$(CONFIG_VIDEO_IMX415) += imx415.o +obj-$(CONFIG_VIDEO_IMX519) += imx519.o obj-$(CONFIG_VIDEO_IR_I2C) += ir-kbd-i2c.o obj-$(CONFIG_VIDEO_ISL7998X) += isl7998x.o obj-$(CONFIG_VIDEO_KS0127) += ks0127.o diff --git a/drivers/media/i2c/imx519.c b/drivers/media/i2c/imx519.c new file mode 100644 index 000000000000..f818a3d0bd25 --- /dev/null +++ b/drivers/media/i2c/imx519.c @@ -0,0 +1,1842 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * A V4L2 driver for Sony IMX519 cameras. + * Copyright (C) 2022 Arducam Technology co., Ltd. + * + * Based on Sony IMX477 camera driver + * Copyright (C) 2020 Raspberry Pi (Trading) Ltd + */ +#include <asm/unaligned.h> +#include <linux/clk.h> +#include <linux/delay.h> +#include <linux/gpio/consumer.h> +#include <linux/i2c.h> +#include <linux/module.h> +#include <linux/of_device.h> +#include <linux/pm_runtime.h> +#include <linux/regulator/consumer.h> + +#include <media/v4l2-cci.h> +#include <media/v4l2-ctrls.h> +#include <media/v4l2-device.h> +#include <media/v4l2-event.h> +#include <media/v4l2-fwnode.h> +#include <media/v4l2-mediabus.h> + +/* Chip ID */ +#define IMX519_REG_CHIP_ID CCI_REG16(0x0016) +#define IMX519_CHIP_ID 0x0519 + +#define IMX519_REG_MODE_SELECT CCI_REG8(0x0100) +#define IMX519_MODE_STANDBY 0x00 +#define IMX519_MODE_STREAMING 0x01 + +#define IMX519_REG_ORIENTATION CCI_REG8(0x101) + +#define IMX519_XCLK_FREQ 24000000 + +#define IMX519_DEFAULT_LINK_FREQ 408000000 + +/* Pixel rate is fixed at 686MHz for all the modes */ +#define IMX519_PIXEL_RATE 426666667 + +/* V_TIMING internal */ +#define IMX519_REG_FRAME_LENGTH CCI_REG16(0x0340) +#define IMX519_FRAME_LENGTH_MAX 0xffdc + +/* Long exposure multiplier */ +#define IMX519_LONG_EXP_SHIFT_MAX 7 +#define IMX519_LONG_EXP_SHIFT_REG CCI_REG8(0x3100) + +/* Exposure control */ +#define IMX519_REG_EXPOSURE CCI_REG16(0x0202) +#define IMX519_EXPOSURE_OFFSET 32 +#define IMX519_EXPOSURE_MIN 20 +#define IMX519_EXPOSURE_STEP 1 +#define IMX519_EXPOSURE_DEFAULT 0x3e8 +#define IMX519_EXPOSURE_MAX (IMX519_FRAME_LENGTH_MAX - \ + IMX519_EXPOSURE_OFFSET) + +/* Analog gain control */ +#define IMX519_REG_ANALOG_GAIN CCI_REG16(0x0204) +#define IMX519_ANA_GAIN_MIN 0 +#define IMX519_ANA_GAIN_MAX 960 +#define IMX519_ANA_GAIN_STEP 1 +#define IMX519_ANA_GAIN_DEFAULT 0x0 + +/* Digital gain control */ +#define IMX519_REG_DIGITAL_GAIN CCI_REG16(0x020e) +#define IMX519_DGTL_GAIN_MIN 0x0100 +#define IMX519_DGTL_GAIN_MAX 0xffff +#define IMX519_DGTL_GAIN_DEFAULT 0x0100 +#define IMX519_DGTL_GAIN_STEP 1 + +/* Test Pattern Control */ +#define IMX519_REG_TEST_PATTERN CCI_REG16(0x0600) +#define IMX519_TEST_PATTERN_DISABLE 0 +#define IMX519_TEST_PATTERN_SOLID_COLOR 1 +#define IMX519_TEST_PATTERN_COLOR_BARS 2 +#define IMX519_TEST_PATTERN_GREY_COLOR 3 +#define IMX519_TEST_PATTERN_PN9 4 + +/* Test pattern colour components */ +#define IMX519_REG_TEST_PATTERN_R CCI_REG16(0x0602) +#define IMX519_REG_TEST_PATTERN_GR CCI_REG16(0x0604) +#define IMX519_REG_TEST_PATTERN_B CCI_REG16(0x0606) +#define IMX519_REG_TEST_PATTERN_GB CCI_REG16(0x0608) +#define IMX519_TEST_PATTERN_COLOUR_MIN 0 +#define IMX519_TEST_PATTERN_COLOUR_MAX 0x0fff +#define IMX519_TEST_PATTERN_COLOUR_STEP 1 +#define IMX519_TEST_PATTERN_R_DEFAULT IMX519_TEST_PATTERN_COLOUR_MAX +#define IMX519_TEST_PATTERN_GR_DEFAULT 0 +#define IMX519_TEST_PATTERN_B_DEFAULT 0 +#define IMX519_TEST_PATTERN_GB_DEFAULT 0 + +/* IMX519 native and active pixel array size. */ +#define IMX519_NATIVE_WIDTH 4672U +#define IMX519_NATIVE_HEIGHT 3648U +#define IMX519_PIXEL_ARRAY_LEFT 8U +#define IMX519_PIXEL_ARRAY_TOP 48U +#define IMX519_PIXEL_ARRAY_WIDTH 4656U +#define IMX519_PIXEL_ARRAY_HEIGHT 3496U + +struct imx519_reg_list { + unsigned int num_of_regs; + const struct cci_reg_sequence *regs; +}; + +/* Mode : resolution and related config&values */ +struct imx519_mode { + /* Frame width */ + unsigned int width; + + /* Frame height */ + unsigned int height; + + /* H-timing in pixels */ + unsigned int line_length_pix; + + /* Analog crop rectangle. */ + struct v4l2_rect crop; + + /* Highest possible framerate. */ + struct v4l2_fract timeperframe_min; + + /* Default framerate. */ + struct v4l2_fract timeperframe_default; + + /* Default register values */ + struct imx519_reg_list reg_list; +}; + +static const struct cci_reg_sequence mode_common_regs[] = { + { CCI_REG8(0x0136), 0x18 }, + { CCI_REG8(0x0137), 0x00 }, + { CCI_REG8(0x3c7e), 0x01 }, + { CCI_REG8(0x3c7f), 0x07 }, + { CCI_REG8(0x3020), 0x00 }, + { CCI_REG8(0x3e35), 0x01 }, + { CCI_REG8(0x3f7f), 0x01 }, + { CCI_REG8(0x5609), 0x57 }, + { CCI_REG8(0x5613), 0x51 }, + { CCI_REG8(0x561f), 0x5e }, + { CCI_REG8(0x5623), 0xd2 }, + { CCI_REG8(0x5637), 0x11 }, + { CCI_REG8(0x5657), 0x11 }, + { CCI_REG8(0x5659), 0x12 }, + { CCI_REG8(0x5733), 0x60 }, + { CCI_REG8(0x5905), 0x57 }, + { CCI_REG8(0x590f), 0x51 }, + { CCI_REG8(0x591b), 0x5e }, + { CCI_REG8(0x591f), 0xd2 }, + { CCI_REG8(0x5933), 0x11 }, + { CCI_REG8(0x5953), 0x11 }, + { CCI_REG8(0x5955), 0x12 }, + { CCI_REG8(0x5a2f), 0x60 }, + { CCI_REG8(0x5a85), 0x57 }, + { CCI_REG8(0x5a8f), 0x51 }, + { CCI_REG8(0x5a9b), 0x5e }, + { CCI_REG8(0x5a9f), 0xd2 }, + { CCI_REG8(0x5ab3), 0x11 }, + { CCI_REG8(0x5ad3), 0x11 }, + { CCI_REG8(0x5ad5), 0x12 }, + { CCI_REG8(0x5baf), 0x60 }, + { CCI_REG8(0x5c15), 0x2a }, + { CCI_REG8(0x5c17), 0x80 }, + { CCI_REG8(0x5c19), 0x31 }, + { CCI_REG8(0x5c1b), 0x87 }, + { CCI_REG8(0x5c25), 0x25 }, + { CCI_REG8(0x5c27), 0x7b }, + { CCI_REG8(0x5c29), 0x2a }, + { CCI_REG8(0x5c2b), 0x80 }, + { CCI_REG8(0x5c2d), 0x31 }, + { CCI_REG8(0x5c2f), 0x87 }, + { CCI_REG8(0x5c35), 0x2b }, + { CCI_REG8(0x5c37), 0x81 }, + { CCI_REG8(0x5c39), 0x31 }, + { CCI_REG8(0x5c3b), 0x87 }, + { CCI_REG8(0x5c45), 0x25 }, + { CCI_REG8(0x5c47), 0x7b }, + { CCI_REG8(0x5c49), 0x2a }, + { CCI_REG8(0x5c4b), 0x80 }, + { CCI_REG8(0x5c4d), 0x31 }, + { CCI_REG8(0x5c4f), 0x87 }, + { CCI_REG8(0x5c55), 0x2d }, + { CCI_REG8(0x5c57), 0x83 }, + { CCI_REG8(0x5c59), 0x32 }, + { CCI_REG8(0x5c5b), 0x88 }, + { CCI_REG8(0x5c65), 0x29 }, + { CCI_REG8(0x5c67), 0x7f }, + { CCI_REG8(0x5c69), 0x2e }, + { CCI_REG8(0x5c6b), 0x84 }, + { CCI_REG8(0x5c6d), 0x32 }, + { CCI_REG8(0x5c6f), 0x88 }, + { CCI_REG8(0x5e69), 0x04 }, + { CCI_REG8(0x5e9d), 0x00 }, + { CCI_REG8(0x5f18), 0x10 }, + { CCI_REG8(0x5f1a), 0x0e }, + { CCI_REG8(0x5f20), 0x12 }, + { CCI_REG8(0x5f22), 0x10 }, + { CCI_REG8(0x5f24), 0x0e }, + { CCI_REG8(0x5f28), 0x10 }, + { CCI_REG8(0x5f2a), 0x0e }, + { CCI_REG8(0x5f30), 0x12 }, + { CCI_REG8(0x5f32), 0x10 }, + { CCI_REG8(0x5f34), 0x0e }, + { CCI_REG8(0x5f38), 0x0f }, + { CCI_REG8(0x5f39), 0x0d }, + { CCI_REG8(0x5f3c), 0x11 }, + { CCI_REG8(0x5f3d), 0x0f }, + { CCI_REG8(0x5f3e), 0x0d }, + { CCI_REG8(0x5f61), 0x07 }, + { CCI_REG8(0x5f64), 0x05 }, + { CCI_REG8(0x5f67), 0x03 }, + { CCI_REG8(0x5f6a), 0x03 }, + { CCI_REG8(0x5f6d), 0x07 }, + { CCI_REG8(0x5f70), 0x07 }, + { CCI_REG8(0x5f73), 0x05 }, + { CCI_REG8(0x5f76), 0x02 }, + { CCI_REG8(0x5f79), 0x07 }, + { CCI_REG8(0x5f7c), 0x07 }, + { CCI_REG8(0x5f7f), 0x07 }, + { CCI_REG8(0x5f82), 0x07 }, + { CCI_REG8(0x5f85), 0x03 }, + { CCI_REG8(0x5f88), 0x02 }, + { CCI_REG8(0x5f8b), 0x01 }, + { CCI_REG8(0x5f8e), 0x01 }, + { CCI_REG8(0x5f91), 0x04 }, + { CCI_REG8(0x5f94), 0x05 }, + { CCI_REG8(0x5f97), 0x02 }, + { CCI_REG8(0x5f9d), 0x07 }, + { CCI_REG8(0x5fa0), 0x07 }, + { CCI_REG8(0x5fa3), 0x07 }, + { CCI_REG8(0x5fa6), 0x07 }, + { CCI_REG8(0x5fa9), 0x03 }, + { CCI_REG8(0x5fac), 0x01 }, + { CCI_REG8(0x5faf), 0x01 }, + { CCI_REG8(0x5fb5), 0x03 }, + { CCI_REG8(0x5fb8), 0x02 }, + { CCI_REG8(0x5fbb), 0x01 }, + { CCI_REG8(0x5fc1), 0x07 }, + { CCI_REG8(0x5fc4), 0x07 }, + { CCI_REG8(0x5fc7), 0x07 }, + { CCI_REG8(0x5fd1), 0x00 }, + { CCI_REG8(0x6302), 0x79 }, + { CCI_REG8(0x6305), 0x78 }, + { CCI_REG8(0x6306), 0xa5 }, + { CCI_REG8(0x6308), 0x03 }, + { CCI_REG8(0x6309), 0x20 }, + { CCI_REG8(0x630b), 0x0a }, + { CCI_REG8(0x630d), 0x48 }, + { CCI_REG8(0x630f), 0x06 }, + { CCI_REG8(0x6311), 0xa4 }, + { CCI_REG8(0x6313), 0x03 }, + { CCI_REG8(0x6314), 0x20 }, + { CCI_REG8(0x6316), 0x0a }, + { CCI_REG8(0x6317), 0x31 }, + { CCI_REG8(0x6318), 0x4a }, + { CCI_REG8(0x631a), 0x06 }, + { CCI_REG8(0x631b), 0x40 }, + { CCI_REG8(0x631c), 0xa4 }, + { CCI_REG8(0x631e), 0x03 }, + { CCI_REG8(0x631f), 0x20 }, + { CCI_REG8(0x6321), 0x0a }, + { CCI_REG8(0x6323), 0x4a }, + { CCI_REG8(0x6328), 0x80 }, + { CCI_REG8(0x6329), 0x01 }, + { CCI_REG8(0x632a), 0x30 }, + { CCI_REG8(0x632b), 0x02 }, + { CCI_REG8(0x632c), 0x20 }, + { CCI_REG8(0x632d), 0x02 }, + { CCI_REG8(0x632e), 0x30 }, + { CCI_REG8(0x6330), 0x60 }, + { CCI_REG8(0x6332), 0x90 }, + { CCI_REG8(0x6333), 0x01 }, + { CCI_REG8(0x6334), 0x30 }, + { CCI_REG8(0x6335), 0x02 }, + { CCI_REG8(0x6336), 0x20 }, + { CCI_REG8(0x6338), 0x80 }, + { CCI_REG8(0x633a), 0xa0 }, + { CCI_REG8(0x633b), 0x01 }, + { CCI_REG8(0x633c), 0x60 }, + { CCI_REG8(0x633d), 0x02 }, + { CCI_REG8(0x633e), 0x60 }, + { CCI_REG8(0x633f), 0x01 }, + { CCI_REG8(0x6340), 0x30 }, + { CCI_REG8(0x6341), 0x02 }, + { CCI_REG8(0x6342), 0x20 }, + { CCI_REG8(0x6343), 0x03 }, + { CCI_REG8(0x6344), 0x80 }, + { CCI_REG8(0x6345), 0x03 }, + { CCI_REG8(0x6346), 0x90 }, + { CCI_REG8(0x6348), 0xf0 }, + { CCI_REG8(0x6349), 0x01 }, + { CCI_REG8(0x634a), 0x20 }, + { CCI_REG8(0x634b), 0x02 }, + { CCI_REG8(0x634c), 0x10 }, + { CCI_REG8(0x634d), 0x03 }, + { CCI_REG8(0x634e), 0x60 }, + { CCI_REG8(0x6350), 0xa0 }, + { CCI_REG8(0x6351), 0x01 }, + { CCI_REG8(0x6352), 0x60 }, + { CCI_REG8(0x6353), 0x02 }, + { CCI_REG8(0x6354), 0x50 }, + { CCI_REG8(0x6355), 0x02 }, + { CCI_REG8(0x6356), 0x60 }, + { CCI_REG8(0x6357), 0x01 }, + { CCI_REG8(0x6358), 0x30 }, + { CCI_REG8(0x6359), 0x02 }, + { CCI_REG8(0x635a), 0x30 }, + { CCI_REG8(0x635b), 0x03 }, + { CCI_REG8(0x635c), 0x90 }, + { CCI_REG8(0x635f), 0x01 }, + { CCI_REG8(0x6360), 0x10 }, + { CCI_REG8(0x6361), 0x01 }, + { CCI_REG8(0x6362), 0x40 }, + { CCI_REG8(0x6363), 0x02 }, + { CCI_REG8(0x6364), 0x50 }, + { CCI_REG8(0x6368), 0x70 }, + { CCI_REG8(0x636a), 0xa0 }, + { CCI_REG8(0x636b), 0x01 }, + { CCI_REG8(0x636c), 0x50 }, + { CCI_REG8(0x637d), 0xe4 }, + { CCI_REG8(0x637e), 0xb4 }, + { CCI_REG8(0x638c), 0x8e }, + { CCI_REG8(0x638d), 0x38 }, + { CCI_REG8(0x638e), 0xe3 }, + { CCI_REG8(0x638f), 0x4c }, + { CCI_REG8(0x6390), 0x30 }, + { CCI_REG8(0x6391), 0xc3 }, + { CCI_REG8(0x6392), 0xae }, + { CCI_REG8(0x6393), 0xba }, + { CCI_REG8(0x6394), 0xeb }, + { CCI_REG8(0x6395), 0x6e }, + { CCI_REG8(0x6396), 0x34 }, + { CCI_REG8(0x6397), 0xe3 }, + { CCI_REG8(0x6398), 0xcf }, + { CCI_REG8(0x6399), 0x3c }, + { CCI_REG8(0x639a), 0xf3 }, + { CCI_REG8(0x639b), 0x0c }, + { CCI_REG8(0x639c), 0x30 }, + { CCI_REG8(0x639d), 0xc1 }, + { CCI_REG8(0x63b9), 0xa3 }, + { CCI_REG8(0x63ba), 0xfe }, + { CCI_REG8(0x7600), 0x01 }, + { CCI_REG8(0x79a0), 0x01 }, + { CCI_REG8(0x79a1), 0x01 }, + { CCI_REG8(0x79a2), 0x01 }, + { CCI_REG8(0x79a3), 0x01 }, + { CCI_REG8(0x79a4), 0x01 }, + { CCI_REG8(0x79a5), 0x20 }, + { CCI_REG8(0x79a9), 0x00 }, + { CCI_REG8(0x79aa), 0x01 }, + { CCI_REG8(0x79ad), 0x00 }, + { CCI_REG8(0x79af), 0x00 }, + { CCI_REG8(0x8173), 0x01 }, + { CCI_REG8(0x835c), 0x01 }, + { CCI_REG8(0x8a74), 0x01 }, + { CCI_REG8(0x8c1f), 0x00 }, + { CCI_REG8(0x8c27), 0x00 }, + { CCI_REG8(0x8c3b), 0x03 }, + { CCI_REG8(0x9004), 0x0b }, + { CCI_REG8(0x920c), 0x6a }, + { CCI_REG8(0x920d), 0x22 }, + { CCI_REG8(0x920e), 0x6a }, + { CCI_REG8(0x920f), 0x23 }, + { CCI_REG8(0x9214), 0x6a }, + { CCI_REG8(0x9215), 0x20 }, + { CCI_REG8(0x9216), 0x6a }, + { CCI_REG8(0x9217), 0x21 }, + { CCI_REG8(0x9385), 0x3e }, + { CCI_REG8(0x9387), 0x1b }, + { CCI_REG8(0x938d), 0x4d }, + { CCI_REG8(0x938f), 0x43 }, + { CCI_REG8(0x9391), 0x1b }, + { CCI_REG8(0x9395), 0x4d }, + { CCI_REG8(0x9397), 0x43 }, + { CCI_REG8(0x9399), 0x1b }, + { CCI_REG8(0x939d), 0x3e }, + { CCI_REG8(0x939f), 0x2f }, + { CCI_REG8(0x93a5), 0x43 }, + { CCI_REG8(0x93a7), 0x2f }, + { CCI_REG8(0x93a9), 0x2f }, + { CCI_REG8(0x93ad), 0x34 }, + { CCI_REG8(0x93af), 0x2f }, + { CCI_REG8(0x93b5), 0x3e }, + { CCI_REG8(0x93b7), 0x2f }, + { CCI_REG8(0x93bd), 0x4d }, + { CCI_REG8(0x93bf), 0x43 }, + { CCI_REG8(0x93c1), 0x2f }, + { CCI_REG8(0x93c5), 0x4d }, + { CCI_REG8(0x93c7), 0x43 }, + { CCI_REG8(0x93c9), 0x2f }, + { CCI_REG8(0x974b), 0x02 }, + { CCI_REG8(0x995c), 0x8c }, + { CCI_REG8(0x995d), 0x00 }, + { CCI_REG8(0x995e), 0x00 }, + { CCI_REG8(0x9963), 0x64 }, + { CCI_REG8(0x9964), 0x50 }, + { CCI_REG8(0xaa0a), 0x26 }, + { CCI_REG8(0xae03), 0x04 }, + { CCI_REG8(0xae04), 0x03 }, + { CCI_REG8(0xae05), 0x03 }, + { CCI_REG8(0xbc1c), 0x08 }, + { CCI_REG8(0xbcf1), 0x02 }, +}; + +/* 16 mpix 10fps */ +static const struct cci_reg_sequence mode_4656x3496_regs[] = { + { CCI_REG8(0x0111), 0x02 }, + { CCI_REG8(0x0112), 0x0a }, + { CCI_REG8(0x0113), 0x0a }, + { CCI_REG8(0x0114), 0x01 }, + { CCI_REG8(0x0342), 0x42 }, + { CCI_REG8(0x0343), 0x00 }, + { CCI_REG8(0x0340), 0x0d }, + { CCI_REG8(0x0341), 0xf4 }, + { CCI_REG8(0x0344), 0x00 }, + { CCI_REG8(0x0345), 0x00 }, + { CCI_REG8(0x0346), 0x00 }, + { CCI_REG8(0x0347), 0x00 }, + { CCI_REG8(0x0348), 0x12 }, + { CCI_REG8(0x0349), 0x2f }, + { CCI_REG8(0x034a), 0x0d }, + { CCI_REG8(0x034b), 0xa7 }, + { CCI_REG8(0x0220), 0x00 }, + { CCI_REG8(0x0221), 0x11 }, + { CCI_REG8(0x0222), 0x01 }, + { CCI_REG8(0x0900), 0x00 }, + { CCI_REG8(0x0901), 0x11 }, + { CCI_REG8(0x0902), 0x0a }, + { CCI_REG8(0x3f4c), 0x01 }, + { CCI_REG8(0x3f4d), 0x01 }, + { CCI_REG8(0x4254), 0x7f }, + { CCI_REG8(0x0401), 0x00 }, + { CCI_REG8(0x0404), 0x00 }, + { CCI_REG8(0x0405), 0x10 }, + { CCI_REG8(0x0408), 0x00 }, + { CCI_REG8(0x0409), 0x00 }, + { CCI_REG8(0x040a), 0x00 }, + { CCI_REG8(0x040b), 0x00 }, + { CCI_REG8(0x040c), 0x12 }, + { CCI_REG8(0x040d), 0x30 }, + { CCI_REG8(0x040e), 0x0d }, + { CCI_REG8(0x040f), 0xa8 }, + { CCI_REG8(0x034c), 0x12 }, + { CCI_REG8(0x034d), 0x30 }, + { CCI_REG8(0x034e), 0x0d }, + { CCI_REG8(0x034f), 0xa8 }, + { CCI_REG8(0x0301), 0x06 }, + { CCI_REG8(0x0303), 0x04 }, + { CCI_REG8(0x0305), 0x04 }, + { CCI_REG8(0x0306), 0x01 }, + { CCI_REG8(0x0307), 0x57 }, + { CCI_REG8(0x0309), 0x0a }, + { CCI_REG8(0x030b), 0x02 }, + { CCI_REG8(0x030d), 0x04 }, + { CCI_REG8(0x030e), 0x01 }, + { CCI_REG8(0x030f), 0x49 }, + { CCI_REG8(0x0310), 0x01 }, + { CCI_REG8(0x0820), 0x07 }, + { CCI_REG8(0x0821), 0xb6 }, + { CCI_REG8(0x0822), 0x00 }, + { CCI_REG8(0x0823), 0x00 }, + { CCI_REG8(0x3e20), 0x01 }, + { CCI_REG8(0x3e37), 0x00 }, + { CCI_REG8(0x3e3b), 0x00 }, + { CCI_REG8(0x0106), 0x00 }, + { CCI_REG8(0x0b00), 0x00 }, + { CCI_REG8(0x3230), 0x00 }, + { CCI_REG8(0x3f14), 0x01 }, + { CCI_REG8(0x3f3c), 0x01 }, + { CCI_REG8(0x3f0d), 0x0a }, + { CCI_REG8(0x3fbc), 0x00 }, + { CCI_REG8(0x3c06), 0x00 }, + { CCI_REG8(0x3c07), 0x48 }, + { CCI_REG8(0x3c0a), 0x00 }, + { CCI_REG8(0x3c0b), 0x00 }, + { CCI_REG8(0x3f78), 0x00 }, + { CCI_REG8(0x3f79), 0x40 }, + { CCI_REG8(0x3f7c), 0x00 }, + { CCI_REG8(0x3f7d), 0x00 }, +}; + +/* 4k 21fps mode */ +static const struct cci_reg_sequence mode_3840x2160_regs[] = { + { CCI_REG8(0x0111), 0x02 }, + { CCI_REG8(0x0112), 0x0a }, + { CCI_REG8(0x0113), 0x0a }, + { CCI_REG8(0x0114), 0x01 }, + { CCI_REG8(0x0342), 0x38 }, + { CCI_REG8(0x0343), 0x70 }, + { CCI_REG8(0x0340), 0x08 }, + { CCI_REG8(0x0341), 0xd4 }, + { CCI_REG8(0x0344), 0x01 }, + { CCI_REG8(0x0345), 0x98 }, + { CCI_REG8(0x0346), 0x02 }, + { CCI_REG8(0x0347), 0xa0 }, + { CCI_REG8(0x0348), 0x10 }, + { CCI_REG8(0x0349), 0x97 }, + { CCI_REG8(0x034a), 0x0b }, + { CCI_REG8(0x034b), 0x17 }, + { CCI_REG8(0x0220), 0x00 }, + { CCI_REG8(0x0221), 0x11 }, + { CCI_REG8(0x0222), 0x01 }, + { CCI_REG8(0x0900), 0x00 }, + { CCI_REG8(0x0901), 0x11 }, + { CCI_REG8(0x0902), 0x0a }, + { CCI_REG8(0x3f4c), 0x01 }, + { CCI_REG8(0x3f4d), 0x01 }, + { CCI_REG8(0x4254), 0x7f }, + { CCI_REG8(0x0401), 0x00 }, + { CCI_REG8(0x0404), 0x00 }, + { CCI_REG8(0x0405), 0x10 }, + { CCI_REG8(0x0408), 0x00 }, + { CCI_REG8(0x0409), 0x00 }, + { CCI_REG8(0x040a), 0x00 }, + { CCI_REG8(0x040b), 0x00 }, + { CCI_REG8(0x040c), 0x0f }, + { CCI_REG8(0x040d), 0x00 }, + { CCI_REG8(0x040e), 0x08 }, + { CCI_REG8(0x040f), 0x70 }, + { CCI_REG8(0x034c), 0x0f }, + { CCI_REG8(0x034d), 0x00 }, + { CCI_REG8(0x034e), 0x08 }, + { CCI_REG8(0x034f), 0x70 }, + { CCI_REG8(0x0301), 0x06 }, + { CCI_REG8(0x0303), 0x04 }, + { CCI_REG8(0x0305), 0x04 }, + { CCI_REG8(0x0306), 0x01 }, + { CCI_REG8(0x0307), 0x57 }, + { CCI_REG8(0x0309), 0x0a }, + { CCI_REG8(0x030b), 0x02 }, + { CCI_REG8(0x030d), 0x04 }, + { CCI_REG8(0x030e), 0x01 }, + { CCI_REG8(0x030f), 0x49 }, + { CCI_REG8(0x0310), 0x01 }, + { CCI_REG8(0x0820), 0x07 }, + { CCI_REG8(0x0821), 0xb6 }, + { CCI_REG8(0x0822), 0x00 }, + { CCI_REG8(0x0823), 0x00 }, + { CCI_REG8(0x3e20), 0x01 }, + { CCI_REG8(0x3e37), 0x00 }, + { CCI_REG8(0x3e3b), 0x00 }, + { CCI_REG8(0x0106), 0x00 }, + { CCI_REG8(0x0b00), 0x00 }, + { CCI_REG8(0x3230), 0x00 }, + { CCI_REG8(0x3f14), 0x01 }, + { CCI_REG8(0x3f3c), 0x01 }, + { CCI_REG8(0x3f0d), 0x0a }, + { CCI_REG8(0x3fbc), 0x00 }, + { CCI_REG8(0x3c06), 0x00 }, + { CCI_REG8(0x3c07), 0x48 }, + { CCI_REG8(0x3c0a), 0x00 }, + { CCI_REG8(0x3c0b), 0x00 }, + { CCI_REG8(0x3f78), 0x00 }, + { CCI_REG8(0x3f79), 0x40 }, + { CCI_REG8(0x3f7c), 0x00 }, + { CCI_REG8(0x3f7d), 0x00 }, +}; + +/* 2x2 binned 30fps mode */ +static const struct cci_reg_sequence mode_2328x1748_regs[] = { + { CCI_REG8(0x0111), 0x02 }, + { CCI_REG8(0x0112), 0x0a }, + { CCI_REG8(0x0113), 0x0a }, + { CCI_REG8(0x0114), 0x01 }, + { CCI_REG8(0x0342), 0x24 }, + { CCI_REG8(0x0343), 0x12 }, + { CCI_REG8(0x0340), 0x09 }, + { CCI_REG8(0x0341), 0xac }, + { CCI_REG8(0x0344), 0x00 }, + { CCI_REG8(0x0345), 0x00 }, + { CCI_REG8(0x0346), 0x00 }, + { CCI_REG8(0x0347), 0x00 }, + { CCI_REG8(0x0348), 0x12 }, + { CCI_REG8(0x0349), 0x2f }, + { CCI_REG8(0x034a), 0x0d }, + { CCI_REG8(0x034b), 0xa7 }, + { CCI_REG8(0x0220), 0x00 }, + { CCI_REG8(0x0221), 0x11 }, + { CCI_REG8(0x0222), 0x01 }, + { CCI_REG8(0x0900), 0x01 }, + { CCI_REG8(0x0901), 0x22 }, + { CCI_REG8(0x0902), 0x0a }, + { CCI_REG8(0x3f4c), 0x01 }, + { CCI_REG8(0x3f4d), 0x01 }, + { CCI_REG8(0x4254), 0x7f }, + { CCI_REG8(0x0401), 0x00 }, + { CCI_REG8(0x0404), 0x00 }, + { CCI_REG8(0x0405), 0x10 }, + { CCI_REG8(0x0408), 0x00 }, + { CCI_REG8(0x0409), 0x00 }, + { CCI_REG8(0x040a), 0x00 }, + { CCI_REG8(0x040b), 0x00 }, + { CCI_REG8(0x040c), 0x09 }, + { CCI_REG8(0x040d), 0x18 }, + { CCI_REG8(0x040e), 0x06 }, + { CCI_REG8(0x040f), 0xd4 }, + { CCI_REG8(0x034c), 0x09 }, + { CCI_REG8(0x034d), 0x18 }, + { CCI_REG8(0x034e), 0x06 }, + { CCI_REG8(0x034f), 0xd4 }, + { CCI_REG8(0x0301), 0x06 }, + { CCI_REG8(0x0303), 0x04 }, + { CCI_REG8(0x0305), 0x04 }, + { CCI_REG8(0x0306), 0x01 }, + { CCI_REG8(0x0307), 0x57 }, + { CCI_REG8(0x0309), 0x0a }, + { CCI_REG8(0x030b), 0x02 }, + { CCI_REG8(0x030d), 0x04 }, + { CCI_REG8(0x030e), 0x01 }, + { CCI_REG8(0x030f), 0x49 }, + { CCI_REG8(0x0310), 0x01 }, + { CCI_REG8(0x0820), 0x07 }, + { CCI_REG8(0x0821), 0xb6 }, + { CCI_REG8(0x0822), 0x00 }, + { CCI_REG8(0x0823), 0x00 }, + { CCI_REG8(0x3e20), 0x01 }, + { CCI_REG8(0x3e37), 0x00 }, + { CCI_REG8(0x3e3b), 0x00 }, + { CCI_REG8(0x0106), 0x00 }, + { CCI_REG8(0x0b00), 0x00 }, + { CCI_REG8(0x3230), 0x00 }, + { CCI_REG8(0x3f14), 0x01 }, + { CCI_REG8(0x3f3c), 0x01 }, + { CCI_REG8(0x3f0d), 0x0a }, + { CCI_REG8(0x3fbc), 0x00 }, + { CCI_REG8(0x3c06), 0x00 }, + { CCI_REG8(0x3c07), 0x48 }, + { CCI_REG8(0x3c0a), 0x00 }, + { CCI_REG8(0x3c0b), 0x00 }, + { CCI_REG8(0x3f78), 0x00 }, + { CCI_REG8(0x3f79), 0x40 }, + { CCI_REG8(0x3f7c), 0x00 }, + { CCI_REG8(0x3f7d), 0x00 }, +}; + +/* 1080p 60fps mode */ +static const struct cci_reg_sequence mode_1920x1080_regs[] = { + { CCI_REG8(0x0111), 0x02 }, + { CCI_REG8(0x0112), 0x0a }, + { CCI_REG8(0x0113), 0x0a }, + { CCI_REG8(0x0114), 0x01 }, + { CCI_REG8(0x0342), 0x25 }, + { CCI_REG8(0x0343), 0xd9 }, + { CCI_REG8(0x0340), 0x04 }, + { CCI_REG8(0x0341), 0x9c }, + { CCI_REG8(0x0344), 0x01 }, + { CCI_REG8(0x0345), 0x98 }, + { CCI_REG8(0x0346), 0x02 }, + { CCI_REG8(0x0347), 0xa2 }, + { CCI_REG8(0x0348), 0x10 }, + { CCI_REG8(0x0349), 0x97 }, + { CCI_REG8(0x034a), 0x0b }, + { CCI_REG8(0x034b), 0x15 }, + { CCI_REG8(0x0220), 0x00 }, + { CCI_REG8(0x0221), 0x11 }, + { CCI_REG8(0x0222), 0x01 }, + { CCI_REG8(0x0900), 0x01 }, + { CCI_REG8(0x0901), 0x22 }, + { CCI_REG8(0x0902), 0x0a }, + { CCI_REG8(0x3f4c), 0x01 }, + { CCI_REG8(0x3f4d), 0x01 }, + { CCI_REG8(0x4254), 0x7f }, + { CCI_REG8(0x0401), 0x00 }, + { CCI_REG8(0x0404), 0x00 }, + { CCI_REG8(0x0405), 0x10 }, + { CCI_REG8(0x0408), 0x00 }, + { CCI_REG8(0x0409), 0x00 }, + { CCI_REG8(0x040a), 0x00 }, + { CCI_REG8(0x040b), 0x00 }, + { CCI_REG8(0x040c), 0x07 }, + { CCI_REG8(0x040d), 0x80 }, + { CCI_REG8(0x040e), 0x04 }, + { CCI_REG8(0x040f), 0x38 }, + { CCI_REG8(0x034c), 0x07 }, + { CCI_REG8(0x034d), 0x80 }, + { CCI_REG8(0x034e), 0x04 }, + { CCI_REG8(0x034f), 0x38 }, + { CCI_REG8(0x0301), 0x06 }, + { CCI_REG8(0x0303), 0x04 }, + { CCI_REG8(0x0305), 0x04 }, + { CCI_REG8(0x0306), 0x01 }, + { CCI_REG8(0x0307), 0x57 }, + { CCI_REG8(0x0309), 0x0a }, + { CCI_REG8(0x030b), 0x02 }, + { CCI_REG8(0x030d), 0x04 }, + { CCI_REG8(0x030e), 0x01 }, + { CCI_REG8(0x030f), 0x49 }, + { CCI_REG8(0x0310), 0x01 }, + { CCI_REG8(0x0820), 0x07 }, + { CCI_REG8(0x0821), 0xb6 }, + { CCI_REG8(0x0822), 0x00 }, + { CCI_REG8(0x0823), 0x00 }, + { CCI_REG8(0x3e20), 0x01 }, + { CCI_REG8(0x3e37), 0x00 }, + { CCI_REG8(0x3e3b), 0x00 }, + { CCI_REG8(0x0106), 0x00 }, + { CCI_REG8(0x0b00), 0x00 }, + { CCI_REG8(0x3230), 0x00 }, + { CCI_REG8(0x3f14), 0x01 }, + { CCI_REG8(0x3f3c), 0x01 }, + { CCI_REG8(0x3f0d), 0x0a }, + { CCI_REG8(0x3fbc), 0x00 }, + { CCI_REG8(0x3c06), 0x00 }, + { CCI_REG8(0x3c07), 0x48 }, + { CCI_REG8(0x3c0a), 0x00 }, + { CCI_REG8(0x3c0b), 0x00 }, + { CCI_REG8(0x3f78), 0x00 }, + { CCI_REG8(0x3f79), 0x40 }, + { CCI_REG8(0x3f7c), 0x00 }, + { CCI_REG8(0x3f7d), 0x00 }, +}; + +/* 720p 120fps mode */ +static const struct cci_reg_sequence mode_1280x720_regs[] = { + { CCI_REG8(0x0111), 0x02 }, + { CCI_REG8(0x0112), 0x0a }, + { CCI_REG8(0x0113), 0x0a }, + { CCI_REG8(0x0114), 0x01 }, + { CCI_REG8(0x0342), 0x1b }, + { CCI_REG8(0x0343), 0x3b }, + { CCI_REG8(0x0340), 0x03 }, + { CCI_REG8(0x0341), 0x34 }, + { CCI_REG8(0x0344), 0x04 }, + { CCI_REG8(0x0345), 0x18 }, + { CCI_REG8(0x0346), 0x04 }, + { CCI_REG8(0x0347), 0x12 }, + { CCI_REG8(0x0348), 0x0e }, + { CCI_REG8(0x0349), 0x17 }, + { CCI_REG8(0x034a), 0x09 }, + { CCI_REG8(0x034b), 0xb6 }, + { CCI_REG8(0x0220), 0x00 }, + { CCI_REG8(0x0221), 0x11 }, + { CCI_REG8(0x0222), 0x01 }, + { CCI_REG8(0x0900), 0x01 }, + { CCI_REG8(0x0901), 0x22 }, + { CCI_REG8(0x0902), 0x0a }, + { CCI_REG8(0x3f4c), 0x01 }, + { CCI_REG8(0x3f4d), 0x01 }, + { CCI_REG8(0x4254), 0x7f }, + { CCI_REG8(0x0401), 0x00 }, + { CCI_REG8(0x0404), 0x00 }, + { CCI_REG8(0x0405), 0x10 }, + { CCI_REG8(0x0408), 0x00 }, + { CCI_REG8(0x0409), 0x00 }, + { CCI_REG8(0x040a), 0x00 }, + { CCI_REG8(0x040b), 0x00 }, + { CCI_REG8(0x040c), 0x05 }, + { CCI_REG8(0x040d), 0x00 }, + { CCI_REG8(0x040e), 0x02 }, + { CCI_REG8(0x040f), 0xd0 }, + { CCI_REG8(0x034c), 0x05 }, + { CCI_REG8(0x034d), 0x00 }, + { CCI_REG8(0x034e), 0x02 }, + { CCI_REG8(0x034f), 0xd0 }, + { CCI_REG8(0x0301), 0x06 }, + { CCI_REG8(0x0303), 0x04 }, + { CCI_REG8(0x0305), 0x04 }, + { CCI_REG8(0x0306), 0x01 }, + { CCI_REG8(0x0307), 0x57 }, + { CCI_REG8(0x0309), 0x0a }, + { CCI_REG8(0x030b), 0x02 }, + { CCI_REG8(0x030d), 0x04 }, + { CCI_REG8(0x030e), 0x01 }, + { CCI_REG8(0x030f), 0x49 }, + { CCI_REG8(0x0310), 0x01 }, + { CCI_REG8(0x0820), 0x07 }, + { CCI_REG8(0x0821), 0xb6 }, + { CCI_REG8(0x0822), 0x00 }, + { CCI_REG8(0x0823), 0x00 }, + { CCI_REG8(0x3e20), 0x01 }, + { CCI_REG8(0x3e37), 0x00 }, + { CCI_REG8(0x3e3b), 0x00 }, + { CCI_REG8(0x0106), 0x00 }, + { CCI_REG8(0x0b00), 0x00 }, + { CCI_REG8(0x3230), 0x00 }, + { CCI_REG8(0x3f14), 0x01 }, + { CCI_REG8(0x3f3c), 0x01 }, + { CCI_REG8(0x3f0d), 0x0a }, + { CCI_REG8(0x3fbc), 0x00 }, + { CCI_REG8(0x3c06), 0x00 }, + { CCI_REG8(0x3c07), 0x48 }, + { CCI_REG8(0x3c0a), 0x00 }, + { CCI_REG8(0x3c0b), 0x00 }, + { CCI_REG8(0x3f78), 0x00 }, + { CCI_REG8(0x3f79), 0x40 }, + { CCI_REG8(0x3f7c), 0x00 }, + { CCI_REG8(0x3f7d), 0x00 }, +}; + +/* Mode configs */ +static const struct imx519_mode supported_modes_10bit[] = { + { + .width = 4656, + .height = 3496, + .line_length_pix = 0x4200, + .crop = { + .left = IMX519_PIXEL_ARRAY_LEFT, + .top = IMX519_PIXEL_ARRAY_TOP, + .width = 4656, + .height = 3496, + }, + .timeperframe_min = { + .numerator = 100, + .denominator = 1000 + }, + .timeperframe_default = { + .numerator = 100, + .denominator = 1000 + }, + .reg_list = { + .num_of_regs = ARRAY_SIZE(mode_4656x3496_regs), + .regs = mode_4656x3496_regs, + } + }, + { + .width = 3840, + .height = 2160, + .line_length_pix = 0x3870, + .crop = { + .left = IMX519_PIXEL_ARRAY_LEFT + 408, + .top = IMX519_PIXEL_ARRAY_TOP + 672, + .width = 3840, + .height = 2160, + }, + .timeperframe_min = { + .numerator = 100, + .denominator = 2100 + }, + .timeperframe_default = { + .numerator = 100, + .denominator = 2100 + }, + .reg_list = { + .num_of_regs = ARRAY_SIZE(mode_3840x2160_regs), + .regs = mode_3840x2160_regs, + } + }, + { + .width = 2328, + .height = 1748, + .line_length_pix = 0x2412, + .crop = { + .left = IMX519_PIXEL_ARRAY_LEFT, + .top = IMX519_PIXEL_ARRAY_TOP, + .width = 4656, + .height = 3496, + }, + .timeperframe_min = { + .numerator = 100, + .denominator = 3000 + }, + .timeperframe_default = { + .numerator = 100, + .denominator = 3000 + }, + .reg_list = { + .num_of_regs = ARRAY_SIZE(mode_2328x1748_regs), + .regs = mode_2328x1748_regs, + } + }, + { + .width = 1920, + .height = 1080, + .line_length_pix = 0x25D9, + .crop = { + .left = IMX519_PIXEL_ARRAY_LEFT + 408, + .top = IMX519_PIXEL_ARRAY_TOP + 674, + .width = 3840, + .height = 2160, + }, + .timeperframe_min = { + .numerator = 100, + .denominator = 6000 + }, + .timeperframe_default = { + .numerator = 100, + .denominator = 6000 + }, + .reg_list = { + .num_of_regs = ARRAY_SIZE(mode_1920x1080_regs), + .regs = mode_1920x1080_regs, + } + }, + { + .width = 1280, + .height = 720, + .line_length_pix = 0x1B3B, + .crop = { + .left = IMX519_PIXEL_ARRAY_LEFT + 1048, + .top = IMX519_PIXEL_ARRAY_TOP + 1042, + .width = 2560, + .height = 1440, + }, + .timeperframe_min = { + .numerator = 100, + .denominator = 12000 + }, + .timeperframe_default = { + .numerator = 100, + .denominator = 12000 + }, + .reg_list = { + .num_of_regs = ARRAY_SIZE(mode_1280x720_regs), + .regs = mode_1280x720_regs, + } + } +}; + +/* + * The supported formats. + * This table MUST contain 4 entries per format, to cover the various flip + * combinations in the order + * - no flip + * - h flip + * - v flip + * - h&v flips + */ +static const u32 imx519_mbus_formats[] = { + /* 10-bit modes. */ + MEDIA_BUS_FMT_SRGGB10_1X10, + MEDIA_BUS_FMT_SGRBG10_1X10, + MEDIA_BUS_FMT_SGBRG10_1X10, + MEDIA_BUS_FMT_SBGGR10_1X10, +}; + +static const char * const imx519_test_pattern_menu[] = { + "Disabled", + "Color Bars", + "Solid Color", + "Grey Color Bars", + "PN9" +}; + +static const int imx519_test_pattern_val[] = { + IMX519_TEST_PATTERN_DISABLE, + IMX519_TEST_PATTERN_COLOR_BARS, + IMX519_TEST_PATTERN_SOLID_COLOR, + IMX519_TEST_PATTERN_GREY_COLOR, + IMX519_TEST_PATTERN_PN9, +}; + +/* regulator supplies */ +static const char * const imx519_supply_name[] = { + /* Supplies can be enabled in any order */ + "vana", /* Analog (2.8V) supply */ + "vdig", /* Digital Core (1.05V) supply */ + "vddl", /* IF (1.8V) supply */ +}; + +/* + * Initialisation delay between XCLR low->high and the moment when the sensor + * can start capture (i.e. can leave software standby), given by T7 in the + * datasheet is 8ms. This does include I2C setup time as well. + * + * Note, that delay between XCLR low->high and reading the CCI ID register (T6 + * in the datasheet) is much smaller - 600us. + */ +#define IMX519_XCLR_MIN_DELAY_US 8000 +#define IMX519_XCLR_DELAY_RANGE_US 1000 + +struct imx519 { + struct v4l2_subdev sd; + struct media_pad pad; + + struct regmap *regmap; + struct clk *xclk; + + struct gpio_desc *reset_gpio; + struct regulator_bulk_data supplies[ARRAY_SIZE(imx519_supply_name)]; + + struct v4l2_ctrl_handler ctrl_handler; + /* V4L2 Controls */ + struct v4l2_ctrl *exposure; + struct v4l2_ctrl *vflip; + struct v4l2_ctrl *hflip; + struct v4l2_ctrl *vblank; + struct v4l2_ctrl *hblank; + + /* Current mode */ + const struct imx519_mode *mode; + + /* Rewrite common registers on stream on? */ + bool common_regs_written; + + /* Current long exposure factor in use. Set through V4L2_CID_VBLANK */ + unsigned int long_exp_shift; +}; + +static inline struct imx519 *to_imx519(struct v4l2_subdev *sd) +{ + return container_of(sd, struct imx519, sd); +} + +/* Get bayer order based on flip setting. */ +static u32 imx519_get_format_code(struct imx519 *imx519) +{ + unsigned int i; + + i = (imx519->vflip->val ? 2 : 0) | + (imx519->hflip->val ? 1 : 0); + + return imx519_mbus_formats[i]; +} + +static void imx519_adjust_exposure_range(struct imx519 *imx519) +{ + int exposure_max, exposure_def; + + /* Honour the VBLANK limits when setting exposure. */ + exposure_max = imx519->mode->height + imx519->vblank->val - + IMX519_EXPOSURE_OFFSET; + exposure_def = min(exposure_max, imx519->exposure->val); + __v4l2_ctrl_modify_range(imx519->exposure, imx519->exposure->minimum, + exposure_max, imx519->exposure->step, + exposure_def); +} + +static int imx519_set_frame_length(struct imx519 *imx519, unsigned int val) +{ + int ret = 0; + + imx519->long_exp_shift = 0; + + while (val > IMX519_FRAME_LENGTH_MAX) { + imx519->long_exp_shift++; + val >>= 1; + } + + cci_write(imx519->regmap, IMX519_REG_FRAME_LENGTH, val, &ret); + if (ret) + return ret; + + cci_write(imx519->regmap, IMX519_LONG_EXP_SHIFT_REG, + imx519->long_exp_shift, &ret); + + return ret; +} + +static int imx519_set_ctrl(struct v4l2_ctrl *ctrl) +{ + struct imx519 *imx519 = + container_of(ctrl->handler, struct imx519, ctrl_handler); + struct i2c_client *client = v4l2_get_subdevdata(&imx519->sd); + int ret = 0; + + /* + * The VBLANK control may change the limits of usable exposure, so check + * and adjust if necessary. + */ + if (ctrl->id == V4L2_CID_VBLANK) + imx519_adjust_exposure_range(imx519); + + /* + * Applying V4L2 control value only happens + * when power is up for streaming + */ + if (pm_runtime_get_if_in_use(&client->dev) == 0) + return 0; + + switch (ctrl->id) { + case V4L2_CID_ANALOGUE_GAIN: + cci_write(imx519->regmap, IMX519_REG_ANALOG_GAIN, + ctrl->val, &ret); + break; + case V4L2_CID_EXPOSURE: + cci_write(imx519->regmap, IMX519_REG_EXPOSURE, + ctrl->val >> imx519->long_exp_shift, &ret); + break; + case V4L2_CID_DIGITAL_GAIN: + cci_write(imx519->regmap, IMX519_REG_DIGITAL_GAIN, + ctrl->val, &ret); + break; + case V4L2_CID_TEST_PATTERN: + cci_write(imx519->regmap, IMX519_REG_TEST_PATTERN, + imx519_test_pattern_val[ctrl->val], &ret); + break; + case V4L2_CID_TEST_PATTERN_RED: + cci_write(imx519->regmap, IMX519_REG_TEST_PATTERN_R, + ctrl->val, &ret); + break; + case V4L2_CID_TEST_PATTERN_GREENR: + cci_write(imx519->regmap, IMX519_REG_TEST_PATTERN_GR, + ctrl->val, &ret); + break; + case V4L2_CID_TEST_PATTERN_BLUE: + cci_write(imx519->regmap, IMX519_REG_TEST_PATTERN_B, + ctrl->val, &ret); + break; + case V4L2_CID_TEST_PATTERN_GREENB: + cci_write(imx519->regmap, IMX519_REG_TEST_PATTERN_GB, + ctrl->val, &ret); + break; + case V4L2_CID_HFLIP: + case V4L2_CID_VFLIP: + cci_write(imx519->regmap, IMX519_REG_ORIENTATION, + imx519->hflip->val | imx519->vflip->val << 1, &ret); + break; + case V4L2_CID_VBLANK: + ret = imx519_set_frame_length(imx519, + imx519->mode->height + ctrl->val); + break; + default: + dev_info(&client->dev, + "ctrl(id:0x%x,val:0x%x) is not handled\n", + ctrl->id, ctrl->val); + ret = -EINVAL; + break; + } + + pm_runtime_mark_last_busy(&client->dev); + pm_runtime_put_autosuspend(&client->dev); + + return ret; +} + +static const struct v4l2_ctrl_ops imx519_ctrl_ops = { + .s_ctrl = imx519_set_ctrl, +}; + +static int imx519_init_cfg(struct v4l2_subdev *sd, + struct v4l2_subdev_state *state) +{ + struct imx519 *imx519 = to_imx519(sd); + struct v4l2_mbus_framefmt *format; + struct v4l2_rect *crop; + + /* Initialize try_fmt. */ + format = v4l2_subdev_get_pad_format(sd, state, 0); + format->width = supported_modes_10bit[0].width; + format->height = supported_modes_10bit[0].height; + format->code = imx519_get_format_code(imx519); + format->field = V4L2_FIELD_NONE; + format->colorspace = V4L2_COLORSPACE_RAW; + format->ycbcr_enc = V4L2_MAP_YCBCR_ENC_DEFAULT(format->colorspace); + format->quantization = V4L2_QUANTIZATION_FULL_RANGE; + format->xfer_func = V4L2_XFER_FUNC_NONE; + + /* Initialize crop rectangle. */ + crop = v4l2_subdev_get_pad_crop(sd, state, 0); + crop->top = IMX519_PIXEL_ARRAY_TOP; + crop->left = IMX519_PIXEL_ARRAY_LEFT; + crop->width = IMX519_PIXEL_ARRAY_WIDTH; + crop->height = IMX519_PIXEL_ARRAY_HEIGHT; + + return 0; +} + +static int imx519_enum_mbus_code(struct v4l2_subdev *sd, + struct v4l2_subdev_state *sd_state, + struct v4l2_subdev_mbus_code_enum *code) +{ + struct imx519 *imx519 = to_imx519(sd); + + if (code->index > 0) + return -EINVAL; + + code->code = imx519_get_format_code(imx519); + + return 0; +} + +static int imx519_enum_frame_size(struct v4l2_subdev *sd, + struct v4l2_subdev_state *sd_state, + struct v4l2_subdev_frame_size_enum *fse) +{ + struct imx519 *imx519 = to_imx519(sd); + + if (fse->index >= ARRAY_SIZE(supported_modes_10bit)) + return -EINVAL; + + if (fse->code != imx519_get_format_code(imx519)) + return -EINVAL; + + fse->min_width = supported_modes_10bit[fse->index].width; + fse->max_width = fse->min_width; + fse->min_height = supported_modes_10bit[fse->index].height; + fse->max_height = fse->min_height; + + return 0; +} + +static void imx519_update_image_pad_format(struct imx519 *imx519, + const struct imx519_mode *mode, + struct v4l2_subdev_format *fmt) +{ + fmt->format.width = mode->width; + fmt->format.height = mode->height; + fmt->format.field = V4L2_FIELD_NONE; + fmt->format.colorspace = V4L2_COLORSPACE_RAW; + fmt->format.xfer_func = V4L2_XFER_FUNC_NONE; + fmt->format.ycbcr_enc = V4L2_YCBCR_ENC_601; + fmt->format.quantization = V4L2_QUANTIZATION_FULL_RANGE; +} + +static +unsigned int imx519_get_frame_length(const struct imx519_mode *mode, + const struct v4l2_fract *timeperframe) +{ + u64 frame_length; + + frame_length = (u64)timeperframe->numerator * IMX519_PIXEL_RATE; + do_div(frame_length, + (u64)timeperframe->denominator * mode->line_length_pix); + + if (WARN_ON(frame_length > IMX519_FRAME_LENGTH_MAX)) + frame_length = IMX519_FRAME_LENGTH_MAX; + + return max_t(unsigned int, frame_length, mode->height); +} + +static void imx519_set_framing_limits(struct imx519 *imx519) +{ + unsigned int frm_length_min, frm_length_default, hblank; + const struct imx519_mode *mode = imx519->mode; + + frm_length_min = imx519_get_frame_length(mode, &mode->timeperframe_min); + frm_length_default = + imx519_get_frame_length(mode, &mode->timeperframe_default); + + /* Default to no long exposure multiplier. */ + imx519->long_exp_shift = 0; + + /* Update limits and set FPS to default */ + __v4l2_ctrl_modify_range(imx519->vblank, frm_length_min - mode->height, + ((1 << IMX519_LONG_EXP_SHIFT_MAX) * + IMX519_FRAME_LENGTH_MAX) - mode->height, + 1, frm_length_default - mode->height); + + /* Setting this will adjust the exposure limits as well. */ + __v4l2_ctrl_s_ctrl(imx519->vblank, frm_length_default - mode->height); + + /* + * Currently PPL is fixed to the mode specified value, so hblank + * depends on mode->width only, and is not changeable in any + * way other than changing the mode. + */ + hblank = mode->line_length_pix - mode->width; + __v4l2_ctrl_modify_range(imx519->hblank, hblank, hblank, 1, hblank); +} + +static int imx519_set_pad_format(struct v4l2_subdev *sd, + struct v4l2_subdev_state *sd_state, + struct v4l2_subdev_format *fmt) +{ + struct v4l2_mbus_framefmt *format; + const struct imx519_mode *mode; + struct imx519 *imx519 = to_imx519(sd); + + /* Bayer order varies with flips */ + fmt->format.code = imx519_get_format_code(imx519); + + mode = v4l2_find_nearest_size(supported_modes_10bit, + ARRAY_SIZE(supported_modes_10bit), + width, height, + fmt->format.width, + fmt->format.height); + imx519_update_image_pad_format(imx519, mode, fmt); + format = v4l2_subdev_get_pad_format(sd, sd_state, 0); + if (imx519->mode == mode && format->code == fmt->format.code) + return 0; + + if (fmt->which == V4L2_SUBDEV_FORMAT_ACTIVE) { + imx519->mode = mode; + imx519_set_framing_limits(imx519); + } + + *format = fmt->format; + + return 0; +} + +static int imx519_get_selection(struct v4l2_subdev *sd, + struct v4l2_subdev_state *sd_state, + struct v4l2_subdev_selection *sel) +{ + switch (sel->target) { + case V4L2_SEL_TGT_CROP: { + sel->r = *v4l2_subdev_get_pad_crop(sd, sd_state, 0); + return 0; + } + + case V4L2_SEL_TGT_NATIVE_SIZE: + sel->r.left = 0; + sel->r.top = 0; + sel->r.width = IMX519_NATIVE_WIDTH; + sel->r.height = IMX519_NATIVE_HEIGHT; + + return 0; + + case V4L2_SEL_TGT_CROP_DEFAULT: + case V4L2_SEL_TGT_CROP_BOUNDS: + sel->r.left = IMX519_PIXEL_ARRAY_LEFT; + sel->r.top = IMX519_PIXEL_ARRAY_TOP; + sel->r.width = IMX519_PIXEL_ARRAY_WIDTH; + sel->r.height = IMX519_PIXEL_ARRAY_HEIGHT; + + return 0; + } + + return -EINVAL; +} + +/* Start streaming */ +static int imx519_start_streaming(struct imx519 *imx519, + struct v4l2_subdev_state *state) +{ + struct i2c_client *client = v4l2_get_subdevdata(&imx519->sd); + const struct imx519_reg_list *reg_list; + int ret; + + ret = pm_runtime_resume_and_get(&client->dev); + if (ret < 0) + return ret; + + if (!imx519->common_regs_written) { + ret = cci_multi_reg_write(imx519->regmap, mode_common_regs, + ARRAY_SIZE(mode_common_regs), NULL); + + if (ret) { + dev_err(&client->dev, "%s failed to set common settings\n", + __func__); + goto err_rpm_put; + } + imx519->common_regs_written = true; + } + + /* Apply default values of current mode */ + reg_list = &imx519->mode->reg_list; + ret = cci_multi_reg_write(imx519->regmap, reg_list->regs, + reg_list->num_of_regs, NULL); + if (ret) { + dev_err(&client->dev, "%s failed to set mode\n", __func__); + goto err_rpm_put; + } + + /* Apply customized values from user */ + ret = __v4l2_ctrl_handler_setup(imx519->sd.ctrl_handler); + if (ret) + goto err_rpm_put; + + /* set stream on register */ + ret = cci_write(imx519->regmap, IMX519_REG_MODE_SELECT, + IMX519_MODE_STREAMING, NULL); + if (ret) + goto err_rpm_put; + + /* vflip and hflip cannot change during streaming */ + __v4l2_ctrl_grab(imx519->vflip, true); + __v4l2_ctrl_grab(imx519->hflip, true); + + return 0; + +err_rpm_put: + pm_runtime_mark_last_busy(&client->dev); + pm_runtime_put_autosuspend(&client->dev); + + return ret; +} + +/* Stop streaming */ +static void imx519_stop_streaming(struct imx519 *imx519) +{ + struct i2c_client *client = v4l2_get_subdevdata(&imx519->sd); + int ret; + + /* set stream off register */ + ret = cci_write(imx519->regmap, IMX519_REG_MODE_SELECT, + IMX519_MODE_STANDBY, NULL); + if (ret) + dev_err(&client->dev, "%s failed to set stream\n", __func__); + + __v4l2_ctrl_grab(imx519->vflip, false); + __v4l2_ctrl_grab(imx519->hflip, false); + + pm_runtime_mark_last_busy(&client->dev); + pm_runtime_put_autosuspend(&client->dev); +} + +static int imx519_set_stream(struct v4l2_subdev *sd, int enable) +{ + struct imx519 *imx519 = to_imx519(sd); + struct v4l2_subdev_state *state; + int ret = 0; + + state = v4l2_subdev_lock_and_get_active_state(sd); + + if (enable) + ret = imx519_start_streaming(imx519, state); + else + imx519_stop_streaming(imx519); + + v4l2_subdev_unlock_state(state); + + return ret; +} + +static const struct v4l2_subdev_core_ops imx519_core_ops = { + .subscribe_event = v4l2_ctrl_subdev_subscribe_event, + .unsubscribe_event = v4l2_event_subdev_unsubscribe, +}; + +static const struct v4l2_subdev_video_ops imx519_video_ops = { + .s_stream = imx519_set_stream, +}; + +static const struct v4l2_subdev_pad_ops imx519_pad_ops = { + .init_cfg = imx519_init_cfg, + .enum_mbus_code = imx519_enum_mbus_code, + .get_fmt = v4l2_subdev_get_fmt, + .set_fmt = imx519_set_pad_format, + .get_selection = imx519_get_selection, + .enum_frame_size = imx519_enum_frame_size, +}; + +static const struct v4l2_subdev_ops imx519_subdev_ops = { + .core = &imx519_core_ops, + .video = &imx519_video_ops, + .pad = &imx519_pad_ops, +}; + +/* Power/clock management functions */ +static int imx519_power_on(struct device *dev) +{ + struct i2c_client *client = to_i2c_client(dev); + struct v4l2_subdev *sd = i2c_get_clientdata(client); + struct imx519 *imx519 = to_imx519(sd); + int ret; + + ret = regulator_bulk_enable(ARRAY_SIZE(imx519_supply_name), + imx519->supplies); + if (ret) { + dev_err(&client->dev, "%s: failed to enable regulators\n", + __func__); + return ret; + } + + ret = clk_prepare_enable(imx519->xclk); + if (ret) { + dev_err(&client->dev, "%s: failed to enable clock\n", + __func__); + goto reg_off; + } + + gpiod_set_value_cansleep(imx519->reset_gpio, 1); + usleep_range(IMX519_XCLR_MIN_DELAY_US, + IMX519_XCLR_MIN_DELAY_US + IMX519_XCLR_DELAY_RANGE_US); + + return 0; + +reg_off: + regulator_bulk_disable(ARRAY_SIZE(imx519_supply_name), imx519->supplies); + + return ret; +} + +static int imx519_power_off(struct device *dev) +{ + struct i2c_client *client = to_i2c_client(dev); + struct v4l2_subdev *sd = i2c_get_clientdata(client); + struct imx519 *imx519 = to_imx519(sd); + + gpiod_set_value_cansleep(imx519->reset_gpio, 0); + regulator_bulk_disable(ARRAY_SIZE(imx519_supply_name), imx519->supplies); + clk_disable_unprepare(imx519->xclk); + + /* Force reprogramming of the common registers when powered up again. */ + imx519->common_regs_written = false; + + return 0; +} + +static int imx519_get_regulators(struct imx519 *imx519) +{ + struct i2c_client *client = v4l2_get_subdevdata(&imx519->sd); + unsigned int i; + + for (i = 0; i < ARRAY_SIZE(imx519_supply_name); i++) + imx519->supplies[i].supply = imx519_supply_name[i]; + + return devm_regulator_bulk_get(&client->dev, + ARRAY_SIZE(imx519_supply_name), + imx519->supplies); +} + +/* Verify chip ID */ +static int imx519_identify_module(struct imx519 *imx519) +{ + struct i2c_client *client = v4l2_get_subdevdata(&imx519->sd); + int ret; + u64 val; + + ret = cci_read(imx519->regmap, IMX519_REG_CHIP_ID, &val, NULL); + if (ret) { + dev_err(&client->dev, "failed to read chip id %x, with error %d\n", + IMX519_CHIP_ID, ret); + return ret; + } + + if (val != IMX519_CHIP_ID) { + dev_err(&client->dev, "chip id mismatch: %x!=%llx\n", + IMX519_CHIP_ID, val); + return -EIO; + } + + dev_info(&client->dev, "Device found is imx%llx\n", val); + + return 0; +} + +/* Initialize control handlers */ +static int imx519_init_controls(struct imx519 *imx519) +{ + struct v4l2_ctrl_handler *ctrl_hdlr; + struct i2c_client *client = v4l2_get_subdevdata(&imx519->sd); + struct v4l2_fwnode_device_properties props; + unsigned int i; + int ret; + + ctrl_hdlr = &imx519->ctrl_handler; + ret = v4l2_ctrl_handler_init(ctrl_hdlr, 16); + if (ret) + return ret; + + /* By default, PIXEL_RATE is read only */ + v4l2_ctrl_new_std(ctrl_hdlr, &imx519_ctrl_ops, V4L2_CID_PIXEL_RATE, + IMX519_PIXEL_RATE, IMX519_PIXEL_RATE, 1, + IMX519_PIXEL_RATE); + + /* + * Create the controls here, but mode specific limits are setup + * in the imx519_set_framing_limits() call below. + */ + imx519->vblank = v4l2_ctrl_new_std(ctrl_hdlr, &imx519_ctrl_ops, + V4L2_CID_VBLANK, 0, 0xffff, 1, 0); + imx519->hblank = v4l2_ctrl_new_std(ctrl_hdlr, &imx519_ctrl_ops, + V4L2_CID_HBLANK, 0, 0xffff, 1, 0); + + /* HBLANK is read-only for now, but does change with mode. */ + if (imx519->hblank) + imx519->hblank->flags |= V4L2_CTRL_FLAG_READ_ONLY; + + imx519->exposure = v4l2_ctrl_new_std(ctrl_hdlr, &imx519_ctrl_ops, + V4L2_CID_EXPOSURE, + IMX519_EXPOSURE_MIN, + IMX519_EXPOSURE_MAX, + IMX519_EXPOSURE_STEP, + IMX519_EXPOSURE_DEFAULT); + + v4l2_ctrl_new_std(ctrl_hdlr, &imx519_ctrl_ops, V4L2_CID_ANALOGUE_GAIN, + IMX519_ANA_GAIN_MIN, IMX519_ANA_GAIN_MAX, + IMX519_ANA_GAIN_STEP, IMX519_ANA_GAIN_DEFAULT); + + v4l2_ctrl_new_std(ctrl_hdlr, &imx519_ctrl_ops, V4L2_CID_DIGITAL_GAIN, + IMX519_DGTL_GAIN_MIN, IMX519_DGTL_GAIN_MAX, + IMX519_DGTL_GAIN_STEP, IMX519_DGTL_GAIN_DEFAULT); + + imx519->hflip = v4l2_ctrl_new_std(ctrl_hdlr, &imx519_ctrl_ops, + V4L2_CID_HFLIP, 0, 1, 1, 0); + if (imx519->hflip) + imx519->hflip->flags |= V4L2_CTRL_FLAG_MODIFY_LAYOUT; + + imx519->vflip = v4l2_ctrl_new_std(ctrl_hdlr, &imx519_ctrl_ops, + V4L2_CID_VFLIP, 0, 1, 1, 0); + if (imx519->vflip) + imx519->vflip->flags |= V4L2_CTRL_FLAG_MODIFY_LAYOUT; + + v4l2_ctrl_new_std_menu_items(ctrl_hdlr, &imx519_ctrl_ops, + V4L2_CID_TEST_PATTERN, + ARRAY_SIZE(imx519_test_pattern_menu) - 1, + 0, 0, imx519_test_pattern_menu); + for (i = 0; i < 4; i++) { + /* + * The assumption is that + * V4L2_CID_TEST_PATTERN_GREENR == V4L2_CID_TEST_PATTERN_RED + 1 + * V4L2_CID_TEST_PATTERN_BLUE == V4L2_CID_TEST_PATTERN_RED + 2 + * V4L2_CID_TEST_PATTERN_GREENB == V4L2_CID_TEST_PATTERN_RED + 3 + */ + v4l2_ctrl_new_std(ctrl_hdlr, &imx519_ctrl_ops, + V4L2_CID_TEST_PATTERN_RED + i, + IMX519_TEST_PATTERN_COLOUR_MIN, + IMX519_TEST_PATTERN_COLOUR_MAX, + IMX519_TEST_PATTERN_COLOUR_STEP, + IMX519_TEST_PATTERN_COLOUR_MAX); + /* The "Solid color" pattern is white by default */ + } + + if (ctrl_hdlr->error) { + ret = ctrl_hdlr->error; + dev_err(&client->dev, "%s control init failed (%d)\n", + __func__, ret); + goto error; + } + + ret = v4l2_fwnode_device_parse(&client->dev, &props); + if (ret) + goto error; + + ret = v4l2_ctrl_new_fwnode_properties(ctrl_hdlr, &imx519_ctrl_ops, + &props); + if (ret) + goto error; + + imx519->sd.ctrl_handler = ctrl_hdlr; + + mutex_lock(imx519->ctrl_handler.lock); + + /* Setup exposure and frame/line length limits. */ + imx519_set_framing_limits(imx519); + + mutex_unlock(imx519->ctrl_handler.lock); + + return 0; + +error: + v4l2_ctrl_handler_free(ctrl_hdlr); + + return ret; +} + +static void imx519_free_controls(struct imx519 *imx519) +{ + v4l2_ctrl_handler_free(imx519->sd.ctrl_handler); +} + +static int imx519_check_hwcfg(struct device *dev) +{ + struct fwnode_handle *endpoint; + struct v4l2_fwnode_endpoint ep_cfg = { + .bus_type = V4L2_MBUS_CSI2_DPHY + }; + int ret = -EINVAL; + + endpoint = fwnode_graph_get_next_endpoint(dev_fwnode(dev), NULL); + if (!endpoint) { + dev_err(dev, "endpoint node not found\n"); + return -EINVAL; + } + + if (v4l2_fwnode_endpoint_alloc_parse(endpoint, &ep_cfg)) { + dev_err(dev, "could not parse endpoint\n"); + goto out; + } + + /* Check the number of MIPI CSI2 data lanes */ + if (ep_cfg.bus.mipi_csi2.num_data_lanes != 2) { + dev_err(dev, "only 2 data lanes are currently supported\n"); + goto out; + } + + /* Check the link frequency set in device tree */ + if (!ep_cfg.nr_of_link_frequencies) { + dev_err(dev, "link-frequency property not found in DT\n"); + goto out; + } + + if (ep_cfg.nr_of_link_frequencies != 1 || + ep_cfg.link_frequencies[0] != IMX519_DEFAULT_LINK_FREQ) { + dev_err(dev, "Link frequency not supported: %lld\n", + ep_cfg.link_frequencies[0]); + goto out; + } + + ret = 0; + +out: + v4l2_fwnode_endpoint_free(&ep_cfg); + fwnode_handle_put(endpoint); + + return ret; +} + +static const struct of_device_id imx519_dt_ids[] = { + { .compatible = "sony,imx519" }, + { /* sentinel */ } +}; + +static int imx519_probe(struct i2c_client *client) +{ + struct device *dev = &client->dev; + struct imx519 *imx519; + u32 xclk_freq; + int ret; + + imx519 = devm_kzalloc(&client->dev, sizeof(*imx519), GFP_KERNEL); + if (!imx519) + return -ENOMEM; + + v4l2_i2c_subdev_init(&imx519->sd, client, &imx519_subdev_ops); + + /* Check the hardware configuration in device tree */ + if (imx519_check_hwcfg(dev)) + return -EINVAL; + + imx519->regmap = devm_cci_regmap_init_i2c(client, 16); + if (IS_ERR(imx519->regmap)) + return dev_err_probe(dev, PTR_ERR(imx519->regmap), + "failed to initialize CCI\n"); + + /* Get system clock (xclk) */ + imx519->xclk = devm_clk_get(dev, NULL); + if (IS_ERR(imx519->xclk)) + return dev_err_probe(dev, PTR_ERR(imx519->xclk), + "failed to get xclk\n"); + + xclk_freq = clk_get_rate(imx519->xclk); + if (xclk_freq != IMX519_XCLK_FREQ) + return dev_err_probe(dev, -EINVAL, + "xclk frequency not supported: %d Hz\n", + xclk_freq); + + ret = imx519_get_regulators(imx519); + if (ret) + return dev_err_probe(dev, ret, "failed to get regulators\n"); + + /* Request optional enable pin */ + imx519->reset_gpio = devm_gpiod_get_optional(dev, "reset", + GPIOD_OUT_HIGH); + if (IS_ERR(imx519->reset_gpio)) + return dev_err_probe(dev, PTR_ERR(imx519->reset_gpio), + "failed to get reset gpio\n"); + + /* + * The sensor must be powered for imx519_identify_module() + * to be able to read the CHIP_ID register + */ + ret = imx519_power_on(dev); + if (ret) + return ret; + + ret = imx519_identify_module(imx519); + if (ret) + goto error_power_off; + + /* Set default mode to max resolution */ + imx519->mode = &supported_modes_10bit[0]; + + /* + * Enable runtime PM. As the device has been powered manually, mark it + * as active, and increase the usage count without resuming the device. + */ + pm_runtime_set_active(dev); + pm_runtime_get_noresume(dev); + pm_runtime_enable(dev); + + pm_runtime_set_autosuspend_delay(dev, 1000); + pm_runtime_use_autosuspend(dev); + + /* This needs the pm runtime to be registered. */ + ret = imx519_init_controls(imx519); + if (ret) + goto error_rpm_disable; + + /* Initialize subdev */ + imx519->sd.flags |= V4L2_SUBDEV_FL_HAS_DEVNODE | + V4L2_SUBDEV_FL_HAS_EVENTS; + imx519->sd.entity.function = MEDIA_ENT_F_CAM_SENSOR; + + /* Initialize source pads */ + imx519->pad.flags = MEDIA_PAD_FL_SOURCE; + + ret = media_entity_pads_init(&imx519->sd.entity, 1, &imx519->pad); + if (ret) { + dev_err(dev, "failed to init entity pads: %d\n", ret); + goto error_handler_free; + } + + imx519->sd.state_lock = imx519->ctrl_handler.lock; + ret = v4l2_subdev_init_finalize(&imx519->sd); + if (ret < 0) { + dev_err(dev, "subdev init error: %d\n", ret); + goto error_media_entity; + } + + ret = v4l2_async_register_subdev_sensor(&imx519->sd); + if (ret < 0) { + dev_err(dev, "failed to register sensor sub-device: %d\n", ret); + goto error_subdev_cleanup; + } + + pm_runtime_mark_last_busy(dev); + pm_runtime_put_autosuspend(dev); + + return 0; + +error_subdev_cleanup: + v4l2_subdev_cleanup(&imx519->sd); + +error_media_entity: + media_entity_cleanup(&imx519->sd.entity); + +error_handler_free: + imx519_free_controls(imx519); + +error_rpm_disable: + pm_runtime_disable(&client->dev); + pm_runtime_put_noidle(&client->dev); + +error_power_off: + imx519_power_off(&client->dev); + + return ret; +} + +static void imx519_remove(struct i2c_client *client) +{ + struct v4l2_subdev *sd = i2c_get_clientdata(client); + struct imx519 *imx519 = to_imx519(sd); + + v4l2_async_unregister_subdev(sd); + v4l2_subdev_cleanup(sd); + media_entity_cleanup(&sd->entity); + imx519_free_controls(imx519); + + pm_runtime_disable(&client->dev); + if (!pm_runtime_status_suspended(&client->dev)) + imx519_power_off(&client->dev); + pm_runtime_set_suspended(&client->dev); +} + +MODULE_DEVICE_TABLE(of, imx519_dt_ids); + +static const struct dev_pm_ops imx519_pm_ops = { + SET_RUNTIME_PM_OPS(imx519_power_off, imx519_power_on, NULL) +}; + +static struct i2c_driver imx519_i2c_driver = { + .driver = { + .name = "imx519", + .of_match_table = imx519_dt_ids, + .pm = &imx519_pm_ops, + }, + .probe = imx519_probe, + .remove = imx519_remove, +}; + +module_i2c_driver(imx519_i2c_driver); + +MODULE_AUTHOR("Lee Jackson <lee.jackson@arducam.com>"); +MODULE_DESCRIPTION("Sony IMX519 sensor driver"); +MODULE_LICENSE("GPL v2");