xref: /openbmc/linux/drivers/media/i2c/ov9282.c (revision aaeb31c0)
114ea315bSMartina Krasteva // SPDX-License-Identifier: GPL-2.0-only
214ea315bSMartina Krasteva /*
314ea315bSMartina Krasteva  * OmniVision ov9282 Camera Sensor Driver
414ea315bSMartina Krasteva  *
514ea315bSMartina Krasteva  * Copyright (C) 2021 Intel Corporation
614ea315bSMartina Krasteva  */
714ea315bSMartina Krasteva #include <asm/unaligned.h>
814ea315bSMartina Krasteva 
914ea315bSMartina Krasteva #include <linux/clk.h>
1014ea315bSMartina Krasteva #include <linux/delay.h>
1114ea315bSMartina Krasteva #include <linux/i2c.h>
1214ea315bSMartina Krasteva #include <linux/module.h>
1314ea315bSMartina Krasteva #include <linux/pm_runtime.h>
143bc80e89SDave Stevenson #include <linux/regulator/consumer.h>
1514ea315bSMartina Krasteva 
1614ea315bSMartina Krasteva #include <media/v4l2-ctrls.h>
1734ec7248SDave Stevenson #include <media/v4l2-event.h>
1814ea315bSMartina Krasteva #include <media/v4l2-fwnode.h>
1914ea315bSMartina Krasteva #include <media/v4l2-subdev.h>
2014ea315bSMartina Krasteva 
2114ea315bSMartina Krasteva /* Streaming Mode */
2214ea315bSMartina Krasteva #define OV9282_REG_MODE_SELECT	0x0100
2314ea315bSMartina Krasteva #define OV9282_MODE_STANDBY	0x00
2414ea315bSMartina Krasteva #define OV9282_MODE_STREAMING	0x01
2514ea315bSMartina Krasteva 
2643ac0cacSDave Stevenson #define OV9282_REG_PLL_CTRL_0D	0x030d
2743ac0cacSDave Stevenson #define OV9282_PLL_CTRL_0D_RAW8		0x60
2843ac0cacSDave Stevenson #define OV9282_PLL_CTRL_0D_RAW10	0x50
2943ac0cacSDave Stevenson 
30a387834cSDave Stevenson #define OV9282_REG_TIMING_HTS	0x380c
31a387834cSDave Stevenson #define OV9282_TIMING_HTS_MAX	0x7fff
32a387834cSDave Stevenson 
3314ea315bSMartina Krasteva /* Lines per frame */
3414ea315bSMartina Krasteva #define OV9282_REG_LPFR		0x380e
3514ea315bSMartina Krasteva 
3614ea315bSMartina Krasteva /* Chip ID */
3714ea315bSMartina Krasteva #define OV9282_REG_ID		0x300a
3814ea315bSMartina Krasteva #define OV9282_ID		0x9281
3914ea315bSMartina Krasteva 
4014ea315bSMartina Krasteva /* Exposure control */
4114ea315bSMartina Krasteva #define OV9282_REG_EXPOSURE	0x3500
4214ea315bSMartina Krasteva #define OV9282_EXPOSURE_MIN	1
4314ea315bSMartina Krasteva #define OV9282_EXPOSURE_OFFSET	12
4414ea315bSMartina Krasteva #define OV9282_EXPOSURE_STEP	1
4514ea315bSMartina Krasteva #define OV9282_EXPOSURE_DEFAULT	0x0282
4614ea315bSMartina Krasteva 
4714ea315bSMartina Krasteva /* Analog gain control */
4814ea315bSMartina Krasteva #define OV9282_REG_AGAIN	0x3509
4914ea315bSMartina Krasteva #define OV9282_AGAIN_MIN	0x10
5014ea315bSMartina Krasteva #define OV9282_AGAIN_MAX	0xff
5114ea315bSMartina Krasteva #define OV9282_AGAIN_STEP	1
5214ea315bSMartina Krasteva #define OV9282_AGAIN_DEFAULT	0x10
5314ea315bSMartina Krasteva 
5414ea315bSMartina Krasteva /* Group hold register */
5514ea315bSMartina Krasteva #define OV9282_REG_HOLD		0x3308
5614ea315bSMartina Krasteva 
5743ac0cacSDave Stevenson #define OV9282_REG_ANA_CORE_2	0x3662
5843ac0cacSDave Stevenson #define OV9282_ANA_CORE2_RAW8	0x07
5943ac0cacSDave Stevenson #define OV9282_ANA_CORE2_RAW10	0x05
6043ac0cacSDave Stevenson 
61af2775dcSDave Stevenson #define OV9282_REG_TIMING_FORMAT_1	0x3820
62af2775dcSDave Stevenson #define OV9282_REG_TIMING_FORMAT_2	0x3821
63af2775dcSDave Stevenson #define OV9282_FLIP_BIT			BIT(2)
64af2775dcSDave Stevenson 
656f7def3dSDave Stevenson #define OV9282_REG_MIPI_CTRL00	0x4800
666f7def3dSDave Stevenson #define OV9282_GATED_CLOCK	BIT(5)
676f7def3dSDave Stevenson 
6814ea315bSMartina Krasteva /* Input clock rate */
6914ea315bSMartina Krasteva #define OV9282_INCLK_RATE	24000000
7014ea315bSMartina Krasteva 
7114ea315bSMartina Krasteva /* CSI2 HW configuration */
7214ea315bSMartina Krasteva #define OV9282_LINK_FREQ	400000000
7314ea315bSMartina Krasteva #define OV9282_NUM_DATA_LANES	2
7414ea315bSMartina Krasteva 
75f15b0612SDave Stevenson /* Pixel rate */
7643ac0cacSDave Stevenson #define OV9282_PIXEL_RATE_10BIT		(OV9282_LINK_FREQ * 2 * \
77f15b0612SDave Stevenson 					 OV9282_NUM_DATA_LANES / 10)
7843ac0cacSDave Stevenson #define OV9282_PIXEL_RATE_8BIT		(OV9282_LINK_FREQ * 2 * \
7943ac0cacSDave Stevenson 					 OV9282_NUM_DATA_LANES / 8)
80f15b0612SDave Stevenson 
812cb730c6SDave Stevenson /*
822cb730c6SDave Stevenson  * OV9282 native and active pixel array size.
832cb730c6SDave Stevenson  * 8 dummy rows/columns on each edge of a 1280x800 active array
842cb730c6SDave Stevenson  */
852cb730c6SDave Stevenson #define OV9282_NATIVE_WIDTH		1296U
862cb730c6SDave Stevenson #define OV9282_NATIVE_HEIGHT		816U
872cb730c6SDave Stevenson #define OV9282_PIXEL_ARRAY_LEFT		8U
882cb730c6SDave Stevenson #define OV9282_PIXEL_ARRAY_TOP		8U
892cb730c6SDave Stevenson #define OV9282_PIXEL_ARRAY_WIDTH	1280U
902cb730c6SDave Stevenson #define OV9282_PIXEL_ARRAY_HEIGHT	800U
912cb730c6SDave Stevenson 
9214ea315bSMartina Krasteva #define OV9282_REG_MIN		0x00
9314ea315bSMartina Krasteva #define OV9282_REG_MAX		0xfffff
9414ea315bSMartina Krasteva 
953bc80e89SDave Stevenson static const char * const ov9282_supply_names[] = {
963bc80e89SDave Stevenson 	"avdd",		/* Analog power */
973bc80e89SDave Stevenson 	"dovdd",	/* Digital I/O power */
983bc80e89SDave Stevenson 	"dvdd",		/* Digital core power */
993bc80e89SDave Stevenson };
1003bc80e89SDave Stevenson 
1013bc80e89SDave Stevenson #define OV9282_NUM_SUPPLIES ARRAY_SIZE(ov9282_supply_names)
1023bc80e89SDave Stevenson 
10314ea315bSMartina Krasteva /**
10414ea315bSMartina Krasteva  * struct ov9282_reg - ov9282 sensor register
10514ea315bSMartina Krasteva  * @address: Register address
10614ea315bSMartina Krasteva  * @val: Register value
10714ea315bSMartina Krasteva  */
10814ea315bSMartina Krasteva struct ov9282_reg {
10914ea315bSMartina Krasteva 	u16 address;
11014ea315bSMartina Krasteva 	u8 val;
11114ea315bSMartina Krasteva };
11214ea315bSMartina Krasteva 
11314ea315bSMartina Krasteva /**
11414ea315bSMartina Krasteva  * struct ov9282_reg_list - ov9282 sensor register list
11514ea315bSMartina Krasteva  * @num_of_regs: Number of registers in the list
11614ea315bSMartina Krasteva  * @regs: Pointer to register list
11714ea315bSMartina Krasteva  */
11814ea315bSMartina Krasteva struct ov9282_reg_list {
11914ea315bSMartina Krasteva 	u32 num_of_regs;
12014ea315bSMartina Krasteva 	const struct ov9282_reg *regs;
12114ea315bSMartina Krasteva };
12214ea315bSMartina Krasteva 
12314ea315bSMartina Krasteva /**
12414ea315bSMartina Krasteva  * struct ov9282_mode - ov9282 sensor mode structure
12514ea315bSMartina Krasteva  * @width: Frame width
12614ea315bSMartina Krasteva  * @height: Frame height
127a387834cSDave Stevenson  * @hblank_min: Minimum horizontal blanking in lines for non-continuous[0] and
128a387834cSDave Stevenson  *		continuous[1] clock modes
12914ea315bSMartina Krasteva  * @vblank: Vertical blanking in lines
13014ea315bSMartina Krasteva  * @vblank_min: Minimum vertical blanking in lines
13114ea315bSMartina Krasteva  * @vblank_max: Maximum vertical blanking in lines
13214ea315bSMartina Krasteva  * @link_freq_idx: Link frequency index
133f9c77feaSDave Stevenson  * @crop: on-sensor cropping for this mode
13414ea315bSMartina Krasteva  * @reg_list: Register list for sensor mode
13514ea315bSMartina Krasteva  */
13614ea315bSMartina Krasteva struct ov9282_mode {
13714ea315bSMartina Krasteva 	u32 width;
13814ea315bSMartina Krasteva 	u32 height;
139a387834cSDave Stevenson 	u32 hblank_min[2];
14014ea315bSMartina Krasteva 	u32 vblank;
14114ea315bSMartina Krasteva 	u32 vblank_min;
14214ea315bSMartina Krasteva 	u32 vblank_max;
14314ea315bSMartina Krasteva 	u32 link_freq_idx;
1442cb730c6SDave Stevenson 	struct v4l2_rect crop;
14514ea315bSMartina Krasteva 	struct ov9282_reg_list reg_list;
14614ea315bSMartina Krasteva };
14714ea315bSMartina Krasteva 
14814ea315bSMartina Krasteva /**
14914ea315bSMartina Krasteva  * struct ov9282 - ov9282 sensor device structure
15014ea315bSMartina Krasteva  * @dev: Pointer to generic device
15114ea315bSMartina Krasteva  * @sd: V4L2 sub-device
15214ea315bSMartina Krasteva  * @pad: Media pad. Only one pad supported
15314ea315bSMartina Krasteva  * @reset_gpio: Sensor reset gpio
15414ea315bSMartina Krasteva  * @inclk: Sensor input clock
155f9c77feaSDave Stevenson  * @supplies: Regulator supplies for the sensor
15614ea315bSMartina Krasteva  * @ctrl_handler: V4L2 control handler
15714ea315bSMartina Krasteva  * @link_freq_ctrl: Pointer to link frequency control
15814ea315bSMartina Krasteva  * @hblank_ctrl: Pointer to horizontal blanking control
15914ea315bSMartina Krasteva  * @vblank_ctrl: Pointer to vertical blanking control
16014ea315bSMartina Krasteva  * @exp_ctrl: Pointer to exposure control
16114ea315bSMartina Krasteva  * @again_ctrl: Pointer to analog gain control
162f9c77feaSDave Stevenson  * @pixel_rate: Pointer to pixel rate control
16314ea315bSMartina Krasteva  * @vblank: Vertical blanking in lines
164f9c77feaSDave Stevenson  * @noncontinuous_clock: Selection of CSI2 noncontinuous clock mode
16514ea315bSMartina Krasteva  * @cur_mode: Pointer to current selected sensor mode
16643ac0cacSDave Stevenson  * @code: Mbus code currently selected
16714ea315bSMartina Krasteva  * @mutex: Mutex for serializing sensor controls
16814ea315bSMartina Krasteva  * @streaming: Flag indicating streaming state
16914ea315bSMartina Krasteva  */
17014ea315bSMartina Krasteva struct ov9282 {
17114ea315bSMartina Krasteva 	struct device *dev;
17214ea315bSMartina Krasteva 	struct v4l2_subdev sd;
17314ea315bSMartina Krasteva 	struct media_pad pad;
17414ea315bSMartina Krasteva 	struct gpio_desc *reset_gpio;
17514ea315bSMartina Krasteva 	struct clk *inclk;
1763bc80e89SDave Stevenson 	struct regulator_bulk_data supplies[OV9282_NUM_SUPPLIES];
17714ea315bSMartina Krasteva 	struct v4l2_ctrl_handler ctrl_handler;
17814ea315bSMartina Krasteva 	struct v4l2_ctrl *link_freq_ctrl;
17914ea315bSMartina Krasteva 	struct v4l2_ctrl *hblank_ctrl;
18014ea315bSMartina Krasteva 	struct v4l2_ctrl *vblank_ctrl;
18114ea315bSMartina Krasteva 	struct {
18214ea315bSMartina Krasteva 		struct v4l2_ctrl *exp_ctrl;
18314ea315bSMartina Krasteva 		struct v4l2_ctrl *again_ctrl;
18414ea315bSMartina Krasteva 	};
18543ac0cacSDave Stevenson 	struct v4l2_ctrl *pixel_rate;
18614ea315bSMartina Krasteva 	u32 vblank;
1876f7def3dSDave Stevenson 	bool noncontinuous_clock;
18814ea315bSMartina Krasteva 	const struct ov9282_mode *cur_mode;
18943ac0cacSDave Stevenson 	u32 code;
19014ea315bSMartina Krasteva 	struct mutex mutex;
19114ea315bSMartina Krasteva 	bool streaming;
19214ea315bSMartina Krasteva };
19314ea315bSMartina Krasteva 
19414ea315bSMartina Krasteva static const s64 link_freq[] = {
19514ea315bSMartina Krasteva 	OV9282_LINK_FREQ,
19614ea315bSMartina Krasteva };
19714ea315bSMartina Krasteva 
1986f7def3dSDave Stevenson /*
1996f7def3dSDave Stevenson  * Common registers
2006f7def3dSDave Stevenson  *
2016f7def3dSDave Stevenson  * Note: Do NOT include a software reset (0x0103, 0x01) in any of these
2026f7def3dSDave Stevenson  * register arrays as some settings are written as part of ov9282_power_on,
2036f7def3dSDave Stevenson  * and the reset will clear them.
2046f7def3dSDave Stevenson  */
2057195aabfSDave Stevenson static const struct ov9282_reg common_regs[] = {
20614ea315bSMartina Krasteva 	{0x0302, 0x32},
20714ea315bSMartina Krasteva 	{0x030e, 0x02},
20814ea315bSMartina Krasteva 	{0x3001, 0x00},
20914ea315bSMartina Krasteva 	{0x3004, 0x00},
21014ea315bSMartina Krasteva 	{0x3005, 0x00},
21114ea315bSMartina Krasteva 	{0x3006, 0x04},
21214ea315bSMartina Krasteva 	{0x3011, 0x0a},
21314ea315bSMartina Krasteva 	{0x3013, 0x18},
21414ea315bSMartina Krasteva 	{0x301c, 0xf0},
21514ea315bSMartina Krasteva 	{0x3022, 0x01},
21614ea315bSMartina Krasteva 	{0x3030, 0x10},
21714ea315bSMartina Krasteva 	{0x3039, 0x32},
21814ea315bSMartina Krasteva 	{0x303a, 0x00},
21914ea315bSMartina Krasteva 	{0x3503, 0x08},
22014ea315bSMartina Krasteva 	{0x3505, 0x8c},
22114ea315bSMartina Krasteva 	{0x3507, 0x03},
22214ea315bSMartina Krasteva 	{0x3508, 0x00},
22314ea315bSMartina Krasteva 	{0x3610, 0x80},
22414ea315bSMartina Krasteva 	{0x3611, 0xa0},
22514ea315bSMartina Krasteva 	{0x3620, 0x6e},
22614ea315bSMartina Krasteva 	{0x3632, 0x56},
22714ea315bSMartina Krasteva 	{0x3633, 0x78},
22814ea315bSMartina Krasteva 	{0x3666, 0x00},
22914ea315bSMartina Krasteva 	{0x366f, 0x5a},
23014ea315bSMartina Krasteva 	{0x3680, 0x84},
23114ea315bSMartina Krasteva 	{0x3712, 0x80},
23214ea315bSMartina Krasteva 	{0x372d, 0x22},
23314ea315bSMartina Krasteva 	{0x3731, 0x80},
23414ea315bSMartina Krasteva 	{0x3732, 0x30},
23514ea315bSMartina Krasteva 	{0x377d, 0x22},
23614ea315bSMartina Krasteva 	{0x3788, 0x02},
23714ea315bSMartina Krasteva 	{0x3789, 0xa4},
23814ea315bSMartina Krasteva 	{0x378a, 0x00},
23914ea315bSMartina Krasteva 	{0x378b, 0x4a},
24014ea315bSMartina Krasteva 	{0x3799, 0x20},
2417195aabfSDave Stevenson 	{0x3881, 0x42},
2427195aabfSDave Stevenson 	{0x38a8, 0x02},
2437195aabfSDave Stevenson 	{0x38a9, 0x80},
2447195aabfSDave Stevenson 	{0x38b1, 0x00},
2457195aabfSDave Stevenson 	{0x38c4, 0x00},
2467195aabfSDave Stevenson 	{0x38c5, 0xc0},
2477195aabfSDave Stevenson 	{0x38c6, 0x04},
2487195aabfSDave Stevenson 	{0x38c7, 0x80},
2497195aabfSDave Stevenson 	{0x3920, 0xff},
2507195aabfSDave Stevenson 	{0x4010, 0x40},
2517195aabfSDave Stevenson 	{0x4043, 0x40},
2527195aabfSDave Stevenson 	{0x4307, 0x30},
2537195aabfSDave Stevenson 	{0x4317, 0x00},
2547195aabfSDave Stevenson 	{0x4501, 0x00},
2557195aabfSDave Stevenson 	{0x450a, 0x08},
2567195aabfSDave Stevenson 	{0x4601, 0x04},
2577195aabfSDave Stevenson 	{0x470f, 0x00},
2587195aabfSDave Stevenson 	{0x4f07, 0x00},
2597195aabfSDave Stevenson 	{0x5000, 0x9f},
2607195aabfSDave Stevenson 	{0x5001, 0x00},
2617195aabfSDave Stevenson 	{0x5e00, 0x00},
2627195aabfSDave Stevenson 	{0x5d00, 0x07},
2637195aabfSDave Stevenson 	{0x5d01, 0x00},
2647195aabfSDave Stevenson 	{0x0101, 0x01},
2657195aabfSDave Stevenson 	{0x1000, 0x03},
2667195aabfSDave Stevenson 	{0x5a08, 0x84},
2677195aabfSDave Stevenson };
2687195aabfSDave Stevenson 
269483c84bfSDave Stevenson static struct ov9282_reg_list common_regs_list = {
2707195aabfSDave Stevenson 	.num_of_regs = ARRAY_SIZE(common_regs),
2717195aabfSDave Stevenson 	.regs = common_regs,
2727195aabfSDave Stevenson };
2737195aabfSDave Stevenson 
274c84f43a8SDave Stevenson #define MODE_1280_800		0
275c84f43a8SDave Stevenson #define MODE_1280_720		1
276c84f43a8SDave Stevenson #define MODE_640_400		2
277995809ceSDave Stevenson 
278995809ceSDave Stevenson #define DEFAULT_MODE		MODE_1280_720
279995809ceSDave Stevenson 
2807195aabfSDave Stevenson /* Sensor mode registers */
281c84f43a8SDave Stevenson static const struct ov9282_reg mode_1280x800_regs[] = {
282c84f43a8SDave Stevenson 	{0x3778, 0x00},
283c84f43a8SDave Stevenson 	{0x3800, 0x00},
284c84f43a8SDave Stevenson 	{0x3801, 0x00},
285c84f43a8SDave Stevenson 	{0x3802, 0x00},
286c84f43a8SDave Stevenson 	{0x3803, 0x00},
287c84f43a8SDave Stevenson 	{0x3804, 0x05},
288c84f43a8SDave Stevenson 	{0x3805, 0x0f},
289c84f43a8SDave Stevenson 	{0x3806, 0x03},
290c84f43a8SDave Stevenson 	{0x3807, 0x2f},
291c84f43a8SDave Stevenson 	{0x3808, 0x05},
292c84f43a8SDave Stevenson 	{0x3809, 0x00},
293c84f43a8SDave Stevenson 	{0x380a, 0x03},
294c84f43a8SDave Stevenson 	{0x380b, 0x20},
295c84f43a8SDave Stevenson 	{0x3810, 0x00},
296c84f43a8SDave Stevenson 	{0x3811, 0x08},
297c84f43a8SDave Stevenson 	{0x3812, 0x00},
298c84f43a8SDave Stevenson 	{0x3813, 0x08},
299c84f43a8SDave Stevenson 	{0x3814, 0x11},
300c84f43a8SDave Stevenson 	{0x3815, 0x11},
301c84f43a8SDave Stevenson 	{0x3820, 0x40},
302c84f43a8SDave Stevenson 	{0x3821, 0x00},
303c84f43a8SDave Stevenson 	{0x4003, 0x40},
304c84f43a8SDave Stevenson 	{0x4008, 0x04},
305c84f43a8SDave Stevenson 	{0x4009, 0x0b},
306c84f43a8SDave Stevenson 	{0x400c, 0x00},
307c84f43a8SDave Stevenson 	{0x400d, 0x07},
308c84f43a8SDave Stevenson 	{0x4507, 0x00},
309c84f43a8SDave Stevenson 	{0x4509, 0x00},
310c84f43a8SDave Stevenson };
311c84f43a8SDave Stevenson 
3127195aabfSDave Stevenson static const struct ov9282_reg mode_1280x720_regs[] = {
3137195aabfSDave Stevenson 	{0x3778, 0x00},
31414ea315bSMartina Krasteva 	{0x3800, 0x00},
31514ea315bSMartina Krasteva 	{0x3801, 0x00},
31614ea315bSMartina Krasteva 	{0x3802, 0x00},
31714ea315bSMartina Krasteva 	{0x3803, 0x00},
31814ea315bSMartina Krasteva 	{0x3804, 0x05},
31914ea315bSMartina Krasteva 	{0x3805, 0x0f},
32014ea315bSMartina Krasteva 	{0x3806, 0x02},
32114ea315bSMartina Krasteva 	{0x3807, 0xdf},
32214ea315bSMartina Krasteva 	{0x3808, 0x05},
32314ea315bSMartina Krasteva 	{0x3809, 0x00},
32414ea315bSMartina Krasteva 	{0x380a, 0x02},
32514ea315bSMartina Krasteva 	{0x380b, 0xd0},
32614ea315bSMartina Krasteva 	{0x3810, 0x00},
32714ea315bSMartina Krasteva 	{0x3811, 0x08},
32814ea315bSMartina Krasteva 	{0x3812, 0x00},
32914ea315bSMartina Krasteva 	{0x3813, 0x08},
33014ea315bSMartina Krasteva 	{0x3814, 0x11},
33114ea315bSMartina Krasteva 	{0x3815, 0x11},
33214ea315bSMartina Krasteva 	{0x3820, 0x3c},
33314ea315bSMartina Krasteva 	{0x3821, 0x84},
33414ea315bSMartina Krasteva 	{0x4003, 0x40},
33514ea315bSMartina Krasteva 	{0x4008, 0x02},
33614ea315bSMartina Krasteva 	{0x4009, 0x05},
33714ea315bSMartina Krasteva 	{0x400c, 0x00},
33814ea315bSMartina Krasteva 	{0x400d, 0x03},
33914ea315bSMartina Krasteva 	{0x4507, 0x00},
34014ea315bSMartina Krasteva 	{0x4509, 0x80},
34114ea315bSMartina Krasteva };
34214ea315bSMartina Krasteva 
343c84f43a8SDave Stevenson static const struct ov9282_reg mode_640x400_regs[] = {
344c84f43a8SDave Stevenson 	{0x3778, 0x10},
345c84f43a8SDave Stevenson 	{0x3800, 0x00},
346c84f43a8SDave Stevenson 	{0x3801, 0x00},
347c84f43a8SDave Stevenson 	{0x3802, 0x00},
348c84f43a8SDave Stevenson 	{0x3803, 0x00},
349c84f43a8SDave Stevenson 	{0x3804, 0x05},
350c84f43a8SDave Stevenson 	{0x3805, 0x0f},
351c84f43a8SDave Stevenson 	{0x3806, 0x03},
352c84f43a8SDave Stevenson 	{0x3807, 0x2f},
353c84f43a8SDave Stevenson 	{0x3808, 0x02},
354c84f43a8SDave Stevenson 	{0x3809, 0x80},
355c84f43a8SDave Stevenson 	{0x380a, 0x01},
356c84f43a8SDave Stevenson 	{0x380b, 0x90},
357c84f43a8SDave Stevenson 	{0x3810, 0x00},
358c84f43a8SDave Stevenson 	{0x3811, 0x04},
359c84f43a8SDave Stevenson 	{0x3812, 0x00},
360c84f43a8SDave Stevenson 	{0x3813, 0x04},
361c84f43a8SDave Stevenson 	{0x3814, 0x31},
362c84f43a8SDave Stevenson 	{0x3815, 0x22},
363c84f43a8SDave Stevenson 	{0x3820, 0x60},
364c84f43a8SDave Stevenson 	{0x3821, 0x01},
365c84f43a8SDave Stevenson 	{0x4008, 0x02},
366c84f43a8SDave Stevenson 	{0x4009, 0x05},
367c84f43a8SDave Stevenson 	{0x400c, 0x00},
368c84f43a8SDave Stevenson 	{0x400d, 0x03},
369c84f43a8SDave Stevenson 	{0x4507, 0x03},
370c84f43a8SDave Stevenson 	{0x4509, 0x80},
371c84f43a8SDave Stevenson };
372c84f43a8SDave Stevenson 
37314ea315bSMartina Krasteva /* Supported sensor mode configurations */
374995809ceSDave Stevenson static const struct ov9282_mode supported_modes[] = {
375c84f43a8SDave Stevenson 	[MODE_1280_800] = {
376c84f43a8SDave Stevenson 		.width = 1280,
377c84f43a8SDave Stevenson 		.height = 800,
378c84f43a8SDave Stevenson 		.hblank_min = { 250, 176 },
379c84f43a8SDave Stevenson 		.vblank = 1022,
380c84f43a8SDave Stevenson 		.vblank_min = 110,
381c84f43a8SDave Stevenson 		.vblank_max = 51540,
382c84f43a8SDave Stevenson 		.link_freq_idx = 0,
383c84f43a8SDave Stevenson 		.crop = {
384c84f43a8SDave Stevenson 			.left = OV9282_PIXEL_ARRAY_LEFT,
385c84f43a8SDave Stevenson 			.top = OV9282_PIXEL_ARRAY_TOP,
386c84f43a8SDave Stevenson 			.width = 1280,
387c84f43a8SDave Stevenson 			.height = 800
388c84f43a8SDave Stevenson 		},
389c84f43a8SDave Stevenson 		.reg_list = {
390c84f43a8SDave Stevenson 			.num_of_regs = ARRAY_SIZE(mode_1280x800_regs),
391c84f43a8SDave Stevenson 			.regs = mode_1280x800_regs,
392c84f43a8SDave Stevenson 		},
393c84f43a8SDave Stevenson 	},
394995809ceSDave Stevenson 	[MODE_1280_720] = {
39514ea315bSMartina Krasteva 		.width = 1280,
39614ea315bSMartina Krasteva 		.height = 720,
397a387834cSDave Stevenson 		.hblank_min = { 250, 176 },
39814ea315bSMartina Krasteva 		.vblank = 1022,
3999fd61bb0SDave Stevenson 		.vblank_min = 41,
40014ea315bSMartina Krasteva 		.vblank_max = 51540,
40114ea315bSMartina Krasteva 		.link_freq_idx = 0,
4022cb730c6SDave Stevenson 		.crop = {
4032cb730c6SDave Stevenson 			/*
4042cb730c6SDave Stevenson 			 * Note that this mode takes the top 720 lines from the
4052cb730c6SDave Stevenson 			 * 800 of the sensor. It does not take a middle crop.
4062cb730c6SDave Stevenson 			 */
4072cb730c6SDave Stevenson 			.left = OV9282_PIXEL_ARRAY_LEFT,
4082cb730c6SDave Stevenson 			.top = OV9282_PIXEL_ARRAY_TOP,
4092cb730c6SDave Stevenson 			.width = 1280,
4102cb730c6SDave Stevenson 			.height = 720
4112cb730c6SDave Stevenson 		},
41214ea315bSMartina Krasteva 		.reg_list = {
41314ea315bSMartina Krasteva 			.num_of_regs = ARRAY_SIZE(mode_1280x720_regs),
41414ea315bSMartina Krasteva 			.regs = mode_1280x720_regs,
41514ea315bSMartina Krasteva 		},
416995809ceSDave Stevenson 	},
417c84f43a8SDave Stevenson 	[MODE_640_400] = {
418c84f43a8SDave Stevenson 		.width = 640,
419c84f43a8SDave Stevenson 		.height = 400,
420c84f43a8SDave Stevenson 		.hblank_min = { 890, 816 },
421c84f43a8SDave Stevenson 		.vblank = 1022,
422c84f43a8SDave Stevenson 		.vblank_min = 22,
423c84f43a8SDave Stevenson 		.vblank_max = 51540,
424c84f43a8SDave Stevenson 		.link_freq_idx = 0,
425c84f43a8SDave Stevenson 		.crop = {
426c84f43a8SDave Stevenson 			.left = OV9282_PIXEL_ARRAY_LEFT,
427c84f43a8SDave Stevenson 			.top = OV9282_PIXEL_ARRAY_TOP,
428c84f43a8SDave Stevenson 			.width = 1280,
429c84f43a8SDave Stevenson 			.height = 800
430c84f43a8SDave Stevenson 		},
431c84f43a8SDave Stevenson 		.reg_list = {
432c84f43a8SDave Stevenson 			.num_of_regs = ARRAY_SIZE(mode_640x400_regs),
433c84f43a8SDave Stevenson 			.regs = mode_640x400_regs,
434c84f43a8SDave Stevenson 		},
435c84f43a8SDave Stevenson 	},
43614ea315bSMartina Krasteva };
43714ea315bSMartina Krasteva 
43814ea315bSMartina Krasteva /**
43914ea315bSMartina Krasteva  * to_ov9282() - ov9282 V4L2 sub-device to ov9282 device.
44014ea315bSMartina Krasteva  * @subdev: pointer to ov9282 V4L2 sub-device
44114ea315bSMartina Krasteva  *
44214ea315bSMartina Krasteva  * Return: pointer to ov9282 device
44314ea315bSMartina Krasteva  */
to_ov9282(struct v4l2_subdev * subdev)44414ea315bSMartina Krasteva static inline struct ov9282 *to_ov9282(struct v4l2_subdev *subdev)
44514ea315bSMartina Krasteva {
44614ea315bSMartina Krasteva 	return container_of(subdev, struct ov9282, sd);
44714ea315bSMartina Krasteva }
44814ea315bSMartina Krasteva 
44914ea315bSMartina Krasteva /**
45014ea315bSMartina Krasteva  * ov9282_read_reg() - Read registers.
45114ea315bSMartina Krasteva  * @ov9282: pointer to ov9282 device
45214ea315bSMartina Krasteva  * @reg: register address
45314ea315bSMartina Krasteva  * @len: length of bytes to read. Max supported bytes is 4
45414ea315bSMartina Krasteva  * @val: pointer to register value to be filled.
45514ea315bSMartina Krasteva  *
45614ea315bSMartina Krasteva  * Return: 0 if successful, error code otherwise.
45714ea315bSMartina Krasteva  */
ov9282_read_reg(struct ov9282 * ov9282,u16 reg,u32 len,u32 * val)45814ea315bSMartina Krasteva static int ov9282_read_reg(struct ov9282 *ov9282, u16 reg, u32 len, u32 *val)
45914ea315bSMartina Krasteva {
46014ea315bSMartina Krasteva 	struct i2c_client *client = v4l2_get_subdevdata(&ov9282->sd);
46114ea315bSMartina Krasteva 	struct i2c_msg msgs[2] = {0};
46214ea315bSMartina Krasteva 	u8 addr_buf[2] = {0};
46314ea315bSMartina Krasteva 	u8 data_buf[4] = {0};
46414ea315bSMartina Krasteva 	int ret;
46514ea315bSMartina Krasteva 
46614ea315bSMartina Krasteva 	if (WARN_ON(len > 4))
46714ea315bSMartina Krasteva 		return -EINVAL;
46814ea315bSMartina Krasteva 
46914ea315bSMartina Krasteva 	put_unaligned_be16(reg, addr_buf);
47014ea315bSMartina Krasteva 
47114ea315bSMartina Krasteva 	/* Write register address */
47214ea315bSMartina Krasteva 	msgs[0].addr = client->addr;
47314ea315bSMartina Krasteva 	msgs[0].flags = 0;
47414ea315bSMartina Krasteva 	msgs[0].len = ARRAY_SIZE(addr_buf);
47514ea315bSMartina Krasteva 	msgs[0].buf = addr_buf;
47614ea315bSMartina Krasteva 
47714ea315bSMartina Krasteva 	/* Read data from register */
47814ea315bSMartina Krasteva 	msgs[1].addr = client->addr;
47914ea315bSMartina Krasteva 	msgs[1].flags = I2C_M_RD;
48014ea315bSMartina Krasteva 	msgs[1].len = len;
48114ea315bSMartina Krasteva 	msgs[1].buf = &data_buf[4 - len];
48214ea315bSMartina Krasteva 
48314ea315bSMartina Krasteva 	ret = i2c_transfer(client->adapter, msgs, ARRAY_SIZE(msgs));
48414ea315bSMartina Krasteva 	if (ret != ARRAY_SIZE(msgs))
48514ea315bSMartina Krasteva 		return -EIO;
48614ea315bSMartina Krasteva 
48714ea315bSMartina Krasteva 	*val = get_unaligned_be32(data_buf);
48814ea315bSMartina Krasteva 
48914ea315bSMartina Krasteva 	return 0;
49014ea315bSMartina Krasteva }
49114ea315bSMartina Krasteva 
49214ea315bSMartina Krasteva /**
49314ea315bSMartina Krasteva  * ov9282_write_reg() - Write register
49414ea315bSMartina Krasteva  * @ov9282: pointer to ov9282 device
49514ea315bSMartina Krasteva  * @reg: register address
49614ea315bSMartina Krasteva  * @len: length of bytes. Max supported bytes is 4
49714ea315bSMartina Krasteva  * @val: register value
49814ea315bSMartina Krasteva  *
49914ea315bSMartina Krasteva  * Return: 0 if successful, error code otherwise.
50014ea315bSMartina Krasteva  */
ov9282_write_reg(struct ov9282 * ov9282,u16 reg,u32 len,u32 val)50114ea315bSMartina Krasteva static int ov9282_write_reg(struct ov9282 *ov9282, u16 reg, u32 len, u32 val)
50214ea315bSMartina Krasteva {
50314ea315bSMartina Krasteva 	struct i2c_client *client = v4l2_get_subdevdata(&ov9282->sd);
50414ea315bSMartina Krasteva 	u8 buf[6] = {0};
50514ea315bSMartina Krasteva 
50614ea315bSMartina Krasteva 	if (WARN_ON(len > 4))
50714ea315bSMartina Krasteva 		return -EINVAL;
50814ea315bSMartina Krasteva 
50914ea315bSMartina Krasteva 	put_unaligned_be16(reg, buf);
51014ea315bSMartina Krasteva 	put_unaligned_be32(val << (8 * (4 - len)), buf + 2);
51114ea315bSMartina Krasteva 	if (i2c_master_send(client, buf, len + 2) != len + 2)
51214ea315bSMartina Krasteva 		return -EIO;
51314ea315bSMartina Krasteva 
51414ea315bSMartina Krasteva 	return 0;
51514ea315bSMartina Krasteva }
51614ea315bSMartina Krasteva 
51714ea315bSMartina Krasteva /**
51814ea315bSMartina Krasteva  * ov9282_write_regs() - Write a list of registers
51914ea315bSMartina Krasteva  * @ov9282: pointer to ov9282 device
52014ea315bSMartina Krasteva  * @regs: list of registers to be written
52114ea315bSMartina Krasteva  * @len: length of registers array
52214ea315bSMartina Krasteva  *
52314ea315bSMartina Krasteva  * Return: 0 if successful, error code otherwise.
52414ea315bSMartina Krasteva  */
ov9282_write_regs(struct ov9282 * ov9282,const struct ov9282_reg * regs,u32 len)52514ea315bSMartina Krasteva static int ov9282_write_regs(struct ov9282 *ov9282,
52614ea315bSMartina Krasteva 			     const struct ov9282_reg *regs, u32 len)
52714ea315bSMartina Krasteva {
52814ea315bSMartina Krasteva 	unsigned int i;
52914ea315bSMartina Krasteva 	int ret;
53014ea315bSMartina Krasteva 
53114ea315bSMartina Krasteva 	for (i = 0; i < len; i++) {
53214ea315bSMartina Krasteva 		ret = ov9282_write_reg(ov9282, regs[i].address, 1, regs[i].val);
53314ea315bSMartina Krasteva 		if (ret)
53414ea315bSMartina Krasteva 			return ret;
53514ea315bSMartina Krasteva 	}
53614ea315bSMartina Krasteva 
53714ea315bSMartina Krasteva 	return 0;
53814ea315bSMartina Krasteva }
53914ea315bSMartina Krasteva 
54014ea315bSMartina Krasteva /**
54114ea315bSMartina Krasteva  * ov9282_update_controls() - Update control ranges based on streaming mode
54214ea315bSMartina Krasteva  * @ov9282: pointer to ov9282 device
54314ea315bSMartina Krasteva  * @mode: pointer to ov9282_mode sensor mode
54443ac0cacSDave Stevenson  * @fmt: pointer to the requested mode
54514ea315bSMartina Krasteva  *
54614ea315bSMartina Krasteva  * Return: 0 if successful, error code otherwise.
54714ea315bSMartina Krasteva  */
ov9282_update_controls(struct ov9282 * ov9282,const struct ov9282_mode * mode,const struct v4l2_subdev_format * fmt)54814ea315bSMartina Krasteva static int ov9282_update_controls(struct ov9282 *ov9282,
54943ac0cacSDave Stevenson 				  const struct ov9282_mode *mode,
55043ac0cacSDave Stevenson 				  const struct v4l2_subdev_format *fmt)
55114ea315bSMartina Krasteva {
552a387834cSDave Stevenson 	u32 hblank_min;
55343ac0cacSDave Stevenson 	s64 pixel_rate;
55414ea315bSMartina Krasteva 	int ret;
55514ea315bSMartina Krasteva 
55614ea315bSMartina Krasteva 	ret = __v4l2_ctrl_s_ctrl(ov9282->link_freq_ctrl, mode->link_freq_idx);
55714ea315bSMartina Krasteva 	if (ret)
55814ea315bSMartina Krasteva 		return ret;
55914ea315bSMartina Krasteva 
56043ac0cacSDave Stevenson 	pixel_rate = (fmt->format.code == MEDIA_BUS_FMT_Y10_1X10) ?
56143ac0cacSDave Stevenson 		OV9282_PIXEL_RATE_10BIT : OV9282_PIXEL_RATE_8BIT;
56243ac0cacSDave Stevenson 	ret = __v4l2_ctrl_modify_range(ov9282->pixel_rate, pixel_rate,
56343ac0cacSDave Stevenson 				       pixel_rate, 1, pixel_rate);
56443ac0cacSDave Stevenson 	if (ret)
56543ac0cacSDave Stevenson 		return ret;
56643ac0cacSDave Stevenson 
567a387834cSDave Stevenson 	hblank_min = mode->hblank_min[ov9282->noncontinuous_clock ? 0 : 1];
568a387834cSDave Stevenson 	ret =  __v4l2_ctrl_modify_range(ov9282->hblank_ctrl, hblank_min,
569a387834cSDave Stevenson 					OV9282_TIMING_HTS_MAX - mode->width, 1,
570a387834cSDave Stevenson 					hblank_min);
57114ea315bSMartina Krasteva 	if (ret)
57214ea315bSMartina Krasteva 		return ret;
57314ea315bSMartina Krasteva 
57414ea315bSMartina Krasteva 	return __v4l2_ctrl_modify_range(ov9282->vblank_ctrl, mode->vblank_min,
57514ea315bSMartina Krasteva 					mode->vblank_max, 1, mode->vblank);
57614ea315bSMartina Krasteva }
57714ea315bSMartina Krasteva 
57814ea315bSMartina Krasteva /**
57914ea315bSMartina Krasteva  * ov9282_update_exp_gain() - Set updated exposure and gain
58014ea315bSMartina Krasteva  * @ov9282: pointer to ov9282 device
58114ea315bSMartina Krasteva  * @exposure: updated exposure value
58214ea315bSMartina Krasteva  * @gain: updated analog gain value
58314ea315bSMartina Krasteva  *
58414ea315bSMartina Krasteva  * Return: 0 if successful, error code otherwise.
58514ea315bSMartina Krasteva  */
ov9282_update_exp_gain(struct ov9282 * ov9282,u32 exposure,u32 gain)58614ea315bSMartina Krasteva static int ov9282_update_exp_gain(struct ov9282 *ov9282, u32 exposure, u32 gain)
58714ea315bSMartina Krasteva {
58814ea315bSMartina Krasteva 	int ret;
58914ea315bSMartina Krasteva 
590ed80071bSDave Stevenson 	dev_dbg(ov9282->dev, "Set exp %u, analog gain %u",
591ed80071bSDave Stevenson 		exposure, gain);
59214ea315bSMartina Krasteva 
59314ea315bSMartina Krasteva 	ret = ov9282_write_reg(ov9282, OV9282_REG_HOLD, 1, 1);
59414ea315bSMartina Krasteva 	if (ret)
59514ea315bSMartina Krasteva 		return ret;
59614ea315bSMartina Krasteva 
59714ea315bSMartina Krasteva 	ret = ov9282_write_reg(ov9282, OV9282_REG_EXPOSURE, 3, exposure << 4);
59814ea315bSMartina Krasteva 	if (ret)
59914ea315bSMartina Krasteva 		goto error_release_group_hold;
60014ea315bSMartina Krasteva 
60114ea315bSMartina Krasteva 	ret = ov9282_write_reg(ov9282, OV9282_REG_AGAIN, 1, gain);
60214ea315bSMartina Krasteva 
60314ea315bSMartina Krasteva error_release_group_hold:
60414ea315bSMartina Krasteva 	ov9282_write_reg(ov9282, OV9282_REG_HOLD, 1, 0);
60514ea315bSMartina Krasteva 
60614ea315bSMartina Krasteva 	return ret;
60714ea315bSMartina Krasteva }
60814ea315bSMartina Krasteva 
ov9282_set_ctrl_hflip(struct ov9282 * ov9282,int value)609af2775dcSDave Stevenson static int ov9282_set_ctrl_hflip(struct ov9282 *ov9282, int value)
610af2775dcSDave Stevenson {
611af2775dcSDave Stevenson 	u32 current_val;
612af2775dcSDave Stevenson 	int ret = ov9282_read_reg(ov9282, OV9282_REG_TIMING_FORMAT_2, 1,
613af2775dcSDave Stevenson 				  &current_val);
614af2775dcSDave Stevenson 	if (ret)
615af2775dcSDave Stevenson 		return ret;
616af2775dcSDave Stevenson 
617af2775dcSDave Stevenson 	if (value)
618af2775dcSDave Stevenson 		current_val |= OV9282_FLIP_BIT;
619af2775dcSDave Stevenson 	else
620af2775dcSDave Stevenson 		current_val &= ~OV9282_FLIP_BIT;
621af2775dcSDave Stevenson 
622af2775dcSDave Stevenson 	return ov9282_write_reg(ov9282, OV9282_REG_TIMING_FORMAT_2, 1,
623af2775dcSDave Stevenson 				current_val);
624af2775dcSDave Stevenson }
625af2775dcSDave Stevenson 
ov9282_set_ctrl_vflip(struct ov9282 * ov9282,int value)626af2775dcSDave Stevenson static int ov9282_set_ctrl_vflip(struct ov9282 *ov9282, int value)
627af2775dcSDave Stevenson {
628af2775dcSDave Stevenson 	u32 current_val;
629af2775dcSDave Stevenson 	int ret = ov9282_read_reg(ov9282, OV9282_REG_TIMING_FORMAT_1, 1,
630af2775dcSDave Stevenson 				  &current_val);
631af2775dcSDave Stevenson 	if (ret)
632af2775dcSDave Stevenson 		return ret;
633af2775dcSDave Stevenson 
634af2775dcSDave Stevenson 	if (value)
635af2775dcSDave Stevenson 		current_val |= OV9282_FLIP_BIT;
636af2775dcSDave Stevenson 	else
637af2775dcSDave Stevenson 		current_val &= ~OV9282_FLIP_BIT;
638af2775dcSDave Stevenson 
639af2775dcSDave Stevenson 	return ov9282_write_reg(ov9282, OV9282_REG_TIMING_FORMAT_1, 1,
640af2775dcSDave Stevenson 				current_val);
641af2775dcSDave Stevenson }
642af2775dcSDave Stevenson 
64314ea315bSMartina Krasteva /**
64414ea315bSMartina Krasteva  * ov9282_set_ctrl() - Set subdevice control
64514ea315bSMartina Krasteva  * @ctrl: pointer to v4l2_ctrl structure
64614ea315bSMartina Krasteva  *
64714ea315bSMartina Krasteva  * Supported controls:
64814ea315bSMartina Krasteva  * - V4L2_CID_VBLANK
64914ea315bSMartina Krasteva  * - cluster controls:
65014ea315bSMartina Krasteva  *   - V4L2_CID_ANALOGUE_GAIN
65114ea315bSMartina Krasteva  *   - V4L2_CID_EXPOSURE
65214ea315bSMartina Krasteva  *
65314ea315bSMartina Krasteva  * Return: 0 if successful, error code otherwise.
65414ea315bSMartina Krasteva  */
ov9282_set_ctrl(struct v4l2_ctrl * ctrl)65514ea315bSMartina Krasteva static int ov9282_set_ctrl(struct v4l2_ctrl *ctrl)
65614ea315bSMartina Krasteva {
65714ea315bSMartina Krasteva 	struct ov9282 *ov9282 =
65814ea315bSMartina Krasteva 		container_of(ctrl->handler, struct ov9282, ctrl_handler);
65914ea315bSMartina Krasteva 	u32 analog_gain;
66014ea315bSMartina Krasteva 	u32 exposure;
661ed80071bSDave Stevenson 	u32 lpfr;
66214ea315bSMartina Krasteva 	int ret;
66314ea315bSMartina Krasteva 
66414ea315bSMartina Krasteva 	switch (ctrl->id) {
66514ea315bSMartina Krasteva 	case V4L2_CID_VBLANK:
66614ea315bSMartina Krasteva 		ov9282->vblank = ov9282->vblank_ctrl->val;
66714ea315bSMartina Krasteva 
66814ea315bSMartina Krasteva 		dev_dbg(ov9282->dev, "Received vblank %u, new lpfr %u",
66914ea315bSMartina Krasteva 			ov9282->vblank,
67014ea315bSMartina Krasteva 			ov9282->vblank + ov9282->cur_mode->height);
67114ea315bSMartina Krasteva 
67214ea315bSMartina Krasteva 		ret = __v4l2_ctrl_modify_range(ov9282->exp_ctrl,
67314ea315bSMartina Krasteva 					       OV9282_EXPOSURE_MIN,
67414ea315bSMartina Krasteva 					       ov9282->vblank +
67514ea315bSMartina Krasteva 					       ov9282->cur_mode->height -
67614ea315bSMartina Krasteva 					       OV9282_EXPOSURE_OFFSET,
67714ea315bSMartina Krasteva 					       1, OV9282_EXPOSURE_DEFAULT);
67814ea315bSMartina Krasteva 		break;
679ed80071bSDave Stevenson 	}
680ed80071bSDave Stevenson 
68114ea315bSMartina Krasteva 	/* Set controls only if sensor is in power on state */
68214ea315bSMartina Krasteva 	if (!pm_runtime_get_if_in_use(ov9282->dev))
68314ea315bSMartina Krasteva 		return 0;
68414ea315bSMartina Krasteva 
685ed80071bSDave Stevenson 	switch (ctrl->id) {
686ed80071bSDave Stevenson 	case V4L2_CID_EXPOSURE:
68714ea315bSMartina Krasteva 		exposure = ctrl->val;
68814ea315bSMartina Krasteva 		analog_gain = ov9282->again_ctrl->val;
68914ea315bSMartina Krasteva 
69014ea315bSMartina Krasteva 		dev_dbg(ov9282->dev, "Received exp %u, analog gain %u",
69114ea315bSMartina Krasteva 			exposure, analog_gain);
69214ea315bSMartina Krasteva 
69314ea315bSMartina Krasteva 		ret = ov9282_update_exp_gain(ov9282, exposure, analog_gain);
694ed80071bSDave Stevenson 		break;
695ed80071bSDave Stevenson 	case V4L2_CID_VBLANK:
696ed80071bSDave Stevenson 		lpfr = ov9282->vblank + ov9282->cur_mode->height;
697ed80071bSDave Stevenson 		ret = ov9282_write_reg(ov9282, OV9282_REG_LPFR, 2, lpfr);
69814ea315bSMartina Krasteva 		break;
699af2775dcSDave Stevenson 	case V4L2_CID_HFLIP:
700af2775dcSDave Stevenson 		ret = ov9282_set_ctrl_hflip(ov9282, ctrl->val);
701af2775dcSDave Stevenson 		break;
702af2775dcSDave Stevenson 	case V4L2_CID_VFLIP:
703af2775dcSDave Stevenson 		ret = ov9282_set_ctrl_vflip(ov9282, ctrl->val);
704af2775dcSDave Stevenson 		break;
705a387834cSDave Stevenson 	case V4L2_CID_HBLANK:
706a387834cSDave Stevenson 		ret = ov9282_write_reg(ov9282, OV9282_REG_TIMING_HTS, 2,
707a387834cSDave Stevenson 				       (ctrl->val + ov9282->cur_mode->width) >> 1);
708a387834cSDave Stevenson 		break;
70914ea315bSMartina Krasteva 	default:
71014ea315bSMartina Krasteva 		dev_err(ov9282->dev, "Invalid control %d", ctrl->id);
71114ea315bSMartina Krasteva 		ret = -EINVAL;
71214ea315bSMartina Krasteva 	}
71314ea315bSMartina Krasteva 
714ed80071bSDave Stevenson 	pm_runtime_put(ov9282->dev);
715ed80071bSDave Stevenson 
71614ea315bSMartina Krasteva 	return ret;
71714ea315bSMartina Krasteva }
71814ea315bSMartina Krasteva 
71914ea315bSMartina Krasteva /* V4l2 subdevice control ops*/
72014ea315bSMartina Krasteva static const struct v4l2_ctrl_ops ov9282_ctrl_ops = {
72114ea315bSMartina Krasteva 	.s_ctrl = ov9282_set_ctrl,
72214ea315bSMartina Krasteva };
72314ea315bSMartina Krasteva 
72414ea315bSMartina Krasteva /**
72514ea315bSMartina Krasteva  * ov9282_enum_mbus_code() - Enumerate V4L2 sub-device mbus codes
72614ea315bSMartina Krasteva  * @sd: pointer to ov9282 V4L2 sub-device structure
72714ea315bSMartina Krasteva  * @sd_state: V4L2 sub-device configuration
72814ea315bSMartina Krasteva  * @code: V4L2 sub-device code enumeration need to be filled
72914ea315bSMartina Krasteva  *
73014ea315bSMartina Krasteva  * Return: 0 if successful, error code otherwise.
73114ea315bSMartina Krasteva  */
ov9282_enum_mbus_code(struct v4l2_subdev * sd,struct v4l2_subdev_state * sd_state,struct v4l2_subdev_mbus_code_enum * code)73214ea315bSMartina Krasteva static int ov9282_enum_mbus_code(struct v4l2_subdev *sd,
73314ea315bSMartina Krasteva 				 struct v4l2_subdev_state *sd_state,
73414ea315bSMartina Krasteva 				 struct v4l2_subdev_mbus_code_enum *code)
73514ea315bSMartina Krasteva {
73643ac0cacSDave Stevenson 	switch (code->index) {
73743ac0cacSDave Stevenson 	case 0:
738bf3c4a5bSDave Stevenson 		code->code = MEDIA_BUS_FMT_Y10_1X10;
73943ac0cacSDave Stevenson 		break;
74043ac0cacSDave Stevenson 	case 1:
74143ac0cacSDave Stevenson 		code->code = MEDIA_BUS_FMT_Y8_1X8;
74243ac0cacSDave Stevenson 		break;
74343ac0cacSDave Stevenson 	default:
74443ac0cacSDave Stevenson 		return -EINVAL;
74543ac0cacSDave Stevenson 	}
74614ea315bSMartina Krasteva 
74714ea315bSMartina Krasteva 	return 0;
74814ea315bSMartina Krasteva }
74914ea315bSMartina Krasteva 
75014ea315bSMartina Krasteva /**
75114ea315bSMartina Krasteva  * ov9282_enum_frame_size() - Enumerate V4L2 sub-device frame sizes
75214ea315bSMartina Krasteva  * @sd: pointer to ov9282 V4L2 sub-device structure
75314ea315bSMartina Krasteva  * @sd_state: V4L2 sub-device configuration
75414ea315bSMartina Krasteva  * @fsize: V4L2 sub-device size enumeration need to be filled
75514ea315bSMartina Krasteva  *
75614ea315bSMartina Krasteva  * Return: 0 if successful, error code otherwise.
75714ea315bSMartina Krasteva  */
ov9282_enum_frame_size(struct v4l2_subdev * sd,struct v4l2_subdev_state * sd_state,struct v4l2_subdev_frame_size_enum * fsize)75814ea315bSMartina Krasteva static int ov9282_enum_frame_size(struct v4l2_subdev *sd,
75914ea315bSMartina Krasteva 				  struct v4l2_subdev_state *sd_state,
76014ea315bSMartina Krasteva 				  struct v4l2_subdev_frame_size_enum *fsize)
76114ea315bSMartina Krasteva {
762995809ceSDave Stevenson 	if (fsize->index >= ARRAY_SIZE(supported_modes))
76314ea315bSMartina Krasteva 		return -EINVAL;
76414ea315bSMartina Krasteva 
76543ac0cacSDave Stevenson 	if (fsize->code != MEDIA_BUS_FMT_Y10_1X10 &&
76643ac0cacSDave Stevenson 	    fsize->code != MEDIA_BUS_FMT_Y8_1X8)
76714ea315bSMartina Krasteva 		return -EINVAL;
76814ea315bSMartina Krasteva 
769995809ceSDave Stevenson 	fsize->min_width = supported_modes[fsize->index].width;
77014ea315bSMartina Krasteva 	fsize->max_width = fsize->min_width;
771995809ceSDave Stevenson 	fsize->min_height = supported_modes[fsize->index].height;
77214ea315bSMartina Krasteva 	fsize->max_height = fsize->min_height;
77314ea315bSMartina Krasteva 
77414ea315bSMartina Krasteva 	return 0;
77514ea315bSMartina Krasteva }
77614ea315bSMartina Krasteva 
77714ea315bSMartina Krasteva /**
77814ea315bSMartina Krasteva  * ov9282_fill_pad_format() - Fill subdevice pad format
77914ea315bSMartina Krasteva  *                            from selected sensor mode
78014ea315bSMartina Krasteva  * @ov9282: pointer to ov9282 device
78114ea315bSMartina Krasteva  * @mode: pointer to ov9282_mode sensor mode
78243ac0cacSDave Stevenson  * @code: mbus code to be stored
78314ea315bSMartina Krasteva  * @fmt: V4L2 sub-device format need to be filled
78414ea315bSMartina Krasteva  */
ov9282_fill_pad_format(struct ov9282 * ov9282,const struct ov9282_mode * mode,u32 code,struct v4l2_subdev_format * fmt)78514ea315bSMartina Krasteva static void ov9282_fill_pad_format(struct ov9282 *ov9282,
78614ea315bSMartina Krasteva 				   const struct ov9282_mode *mode,
78743ac0cacSDave Stevenson 				   u32 code,
78814ea315bSMartina Krasteva 				   struct v4l2_subdev_format *fmt)
78914ea315bSMartina Krasteva {
79014ea315bSMartina Krasteva 	fmt->format.width = mode->width;
79114ea315bSMartina Krasteva 	fmt->format.height = mode->height;
79243ac0cacSDave Stevenson 	fmt->format.code = code;
79314ea315bSMartina Krasteva 	fmt->format.field = V4L2_FIELD_NONE;
79414ea315bSMartina Krasteva 	fmt->format.colorspace = V4L2_COLORSPACE_RAW;
79514ea315bSMartina Krasteva 	fmt->format.ycbcr_enc = V4L2_YCBCR_ENC_DEFAULT;
79614ea315bSMartina Krasteva 	fmt->format.quantization = V4L2_QUANTIZATION_DEFAULT;
79714ea315bSMartina Krasteva 	fmt->format.xfer_func = V4L2_XFER_FUNC_NONE;
79814ea315bSMartina Krasteva }
79914ea315bSMartina Krasteva 
80014ea315bSMartina Krasteva /**
80114ea315bSMartina Krasteva  * ov9282_get_pad_format() - Get subdevice pad format
80214ea315bSMartina Krasteva  * @sd: pointer to ov9282 V4L2 sub-device structure
80314ea315bSMartina Krasteva  * @sd_state: V4L2 sub-device configuration
80414ea315bSMartina Krasteva  * @fmt: V4L2 sub-device format need to be set
80514ea315bSMartina Krasteva  *
80614ea315bSMartina Krasteva  * Return: 0 if successful, error code otherwise.
80714ea315bSMartina Krasteva  */
ov9282_get_pad_format(struct v4l2_subdev * sd,struct v4l2_subdev_state * sd_state,struct v4l2_subdev_format * fmt)80814ea315bSMartina Krasteva static int ov9282_get_pad_format(struct v4l2_subdev *sd,
80914ea315bSMartina Krasteva 				 struct v4l2_subdev_state *sd_state,
81014ea315bSMartina Krasteva 				 struct v4l2_subdev_format *fmt)
81114ea315bSMartina Krasteva {
81214ea315bSMartina Krasteva 	struct ov9282 *ov9282 = to_ov9282(sd);
81314ea315bSMartina Krasteva 
81414ea315bSMartina Krasteva 	mutex_lock(&ov9282->mutex);
81514ea315bSMartina Krasteva 
81614ea315bSMartina Krasteva 	if (fmt->which == V4L2_SUBDEV_FORMAT_TRY) {
81714ea315bSMartina Krasteva 		struct v4l2_mbus_framefmt *framefmt;
81814ea315bSMartina Krasteva 
81914ea315bSMartina Krasteva 		framefmt = v4l2_subdev_get_try_format(sd, sd_state, fmt->pad);
82014ea315bSMartina Krasteva 		fmt->format = *framefmt;
82114ea315bSMartina Krasteva 	} else {
82243ac0cacSDave Stevenson 		ov9282_fill_pad_format(ov9282, ov9282->cur_mode, ov9282->code,
82343ac0cacSDave Stevenson 				       fmt);
82414ea315bSMartina Krasteva 	}
82514ea315bSMartina Krasteva 
82614ea315bSMartina Krasteva 	mutex_unlock(&ov9282->mutex);
82714ea315bSMartina Krasteva 
82814ea315bSMartina Krasteva 	return 0;
82914ea315bSMartina Krasteva }
83014ea315bSMartina Krasteva 
83114ea315bSMartina Krasteva /**
83214ea315bSMartina Krasteva  * ov9282_set_pad_format() - Set subdevice pad format
83314ea315bSMartina Krasteva  * @sd: pointer to ov9282 V4L2 sub-device structure
83414ea315bSMartina Krasteva  * @sd_state: V4L2 sub-device configuration
83514ea315bSMartina Krasteva  * @fmt: V4L2 sub-device format need to be set
83614ea315bSMartina Krasteva  *
83714ea315bSMartina Krasteva  * Return: 0 if successful, error code otherwise.
83814ea315bSMartina Krasteva  */
ov9282_set_pad_format(struct v4l2_subdev * sd,struct v4l2_subdev_state * sd_state,struct v4l2_subdev_format * fmt)83914ea315bSMartina Krasteva static int ov9282_set_pad_format(struct v4l2_subdev *sd,
84014ea315bSMartina Krasteva 				 struct v4l2_subdev_state *sd_state,
84114ea315bSMartina Krasteva 				 struct v4l2_subdev_format *fmt)
84214ea315bSMartina Krasteva {
84314ea315bSMartina Krasteva 	struct ov9282 *ov9282 = to_ov9282(sd);
84414ea315bSMartina Krasteva 	const struct ov9282_mode *mode;
84543ac0cacSDave Stevenson 	u32 code;
84614ea315bSMartina Krasteva 	int ret = 0;
84714ea315bSMartina Krasteva 
84814ea315bSMartina Krasteva 	mutex_lock(&ov9282->mutex);
84914ea315bSMartina Krasteva 
850995809ceSDave Stevenson 	mode = v4l2_find_nearest_size(supported_modes,
851995809ceSDave Stevenson 				      ARRAY_SIZE(supported_modes),
852995809ceSDave Stevenson 				      width, height,
853995809ceSDave Stevenson 				      fmt->format.width,
854995809ceSDave Stevenson 				      fmt->format.height);
85543ac0cacSDave Stevenson 	if (fmt->format.code == MEDIA_BUS_FMT_Y8_1X8)
85643ac0cacSDave Stevenson 		code = MEDIA_BUS_FMT_Y8_1X8;
85743ac0cacSDave Stevenson 	else
85843ac0cacSDave Stevenson 		code = MEDIA_BUS_FMT_Y10_1X10;
85943ac0cacSDave Stevenson 
86043ac0cacSDave Stevenson 	ov9282_fill_pad_format(ov9282, mode, code, fmt);
86114ea315bSMartina Krasteva 
86214ea315bSMartina Krasteva 	if (fmt->which == V4L2_SUBDEV_FORMAT_TRY) {
86314ea315bSMartina Krasteva 		struct v4l2_mbus_framefmt *framefmt;
86414ea315bSMartina Krasteva 
86514ea315bSMartina Krasteva 		framefmt = v4l2_subdev_get_try_format(sd, sd_state, fmt->pad);
86614ea315bSMartina Krasteva 		*framefmt = fmt->format;
86714ea315bSMartina Krasteva 	} else {
86843ac0cacSDave Stevenson 		ret = ov9282_update_controls(ov9282, mode, fmt);
86943ac0cacSDave Stevenson 		if (!ret) {
87014ea315bSMartina Krasteva 			ov9282->cur_mode = mode;
87143ac0cacSDave Stevenson 			ov9282->code = code;
87243ac0cacSDave Stevenson 		}
87314ea315bSMartina Krasteva 	}
87414ea315bSMartina Krasteva 
87514ea315bSMartina Krasteva 	mutex_unlock(&ov9282->mutex);
87614ea315bSMartina Krasteva 
87714ea315bSMartina Krasteva 	return ret;
87814ea315bSMartina Krasteva }
87914ea315bSMartina Krasteva 
88014ea315bSMartina Krasteva /**
88114ea315bSMartina Krasteva  * ov9282_init_pad_cfg() - Initialize sub-device pad configuration
88214ea315bSMartina Krasteva  * @sd: pointer to ov9282 V4L2 sub-device structure
88314ea315bSMartina Krasteva  * @sd_state: V4L2 sub-device configuration
88414ea315bSMartina Krasteva  *
88514ea315bSMartina Krasteva  * Return: 0 if successful, error code otherwise.
88614ea315bSMartina Krasteva  */
ov9282_init_pad_cfg(struct v4l2_subdev * sd,struct v4l2_subdev_state * sd_state)88714ea315bSMartina Krasteva static int ov9282_init_pad_cfg(struct v4l2_subdev *sd,
88814ea315bSMartina Krasteva 			       struct v4l2_subdev_state *sd_state)
88914ea315bSMartina Krasteva {
89014ea315bSMartina Krasteva 	struct ov9282 *ov9282 = to_ov9282(sd);
89114ea315bSMartina Krasteva 	struct v4l2_subdev_format fmt = { 0 };
89214ea315bSMartina Krasteva 
89314ea315bSMartina Krasteva 	fmt.which = sd_state ? V4L2_SUBDEV_FORMAT_TRY : V4L2_SUBDEV_FORMAT_ACTIVE;
89443ac0cacSDave Stevenson 	ov9282_fill_pad_format(ov9282, &supported_modes[DEFAULT_MODE],
89543ac0cacSDave Stevenson 			       ov9282->code, &fmt);
89614ea315bSMartina Krasteva 
89714ea315bSMartina Krasteva 	return ov9282_set_pad_format(sd, sd_state, &fmt);
89814ea315bSMartina Krasteva }
89914ea315bSMartina Krasteva 
9002cb730c6SDave Stevenson static const struct v4l2_rect *
__ov9282_get_pad_crop(struct ov9282 * ov9282,struct v4l2_subdev_state * sd_state,unsigned int pad,enum v4l2_subdev_format_whence which)9012cb730c6SDave Stevenson __ov9282_get_pad_crop(struct ov9282 *ov9282,
9022cb730c6SDave Stevenson 		      struct v4l2_subdev_state *sd_state,
9032cb730c6SDave Stevenson 		      unsigned int pad, enum v4l2_subdev_format_whence which)
9042cb730c6SDave Stevenson {
9052cb730c6SDave Stevenson 	switch (which) {
9062cb730c6SDave Stevenson 	case V4L2_SUBDEV_FORMAT_TRY:
9072cb730c6SDave Stevenson 		return v4l2_subdev_get_try_crop(&ov9282->sd, sd_state, pad);
9082cb730c6SDave Stevenson 	case V4L2_SUBDEV_FORMAT_ACTIVE:
9092cb730c6SDave Stevenson 		return &ov9282->cur_mode->crop;
9102cb730c6SDave Stevenson 	}
9112cb730c6SDave Stevenson 
9122cb730c6SDave Stevenson 	return NULL;
9132cb730c6SDave Stevenson }
9142cb730c6SDave Stevenson 
ov9282_get_selection(struct v4l2_subdev * sd,struct v4l2_subdev_state * sd_state,struct v4l2_subdev_selection * sel)9152cb730c6SDave Stevenson static int ov9282_get_selection(struct v4l2_subdev *sd,
9162cb730c6SDave Stevenson 				struct v4l2_subdev_state *sd_state,
9172cb730c6SDave Stevenson 				struct v4l2_subdev_selection *sel)
9182cb730c6SDave Stevenson {
9192cb730c6SDave Stevenson 	switch (sel->target) {
9202cb730c6SDave Stevenson 	case V4L2_SEL_TGT_CROP: {
9212cb730c6SDave Stevenson 		struct ov9282 *ov9282 = to_ov9282(sd);
9222cb730c6SDave Stevenson 
9232cb730c6SDave Stevenson 		mutex_lock(&ov9282->mutex);
9242cb730c6SDave Stevenson 		sel->r = *__ov9282_get_pad_crop(ov9282, sd_state, sel->pad,
9252cb730c6SDave Stevenson 						sel->which);
9262cb730c6SDave Stevenson 		mutex_unlock(&ov9282->mutex);
9272cb730c6SDave Stevenson 
9282cb730c6SDave Stevenson 		return 0;
9292cb730c6SDave Stevenson 	}
9302cb730c6SDave Stevenson 
9312cb730c6SDave Stevenson 	case V4L2_SEL_TGT_NATIVE_SIZE:
9322cb730c6SDave Stevenson 		sel->r.top = 0;
9332cb730c6SDave Stevenson 		sel->r.left = 0;
9342cb730c6SDave Stevenson 		sel->r.width = OV9282_NATIVE_WIDTH;
9352cb730c6SDave Stevenson 		sel->r.height = OV9282_NATIVE_HEIGHT;
9362cb730c6SDave Stevenson 
9372cb730c6SDave Stevenson 		return 0;
9382cb730c6SDave Stevenson 
9392cb730c6SDave Stevenson 	case V4L2_SEL_TGT_CROP_DEFAULT:
9402cb730c6SDave Stevenson 	case V4L2_SEL_TGT_CROP_BOUNDS:
9412cb730c6SDave Stevenson 		sel->r.top = OV9282_PIXEL_ARRAY_TOP;
9422cb730c6SDave Stevenson 		sel->r.left = OV9282_PIXEL_ARRAY_LEFT;
9432cb730c6SDave Stevenson 		sel->r.width = OV9282_PIXEL_ARRAY_WIDTH;
9442cb730c6SDave Stevenson 		sel->r.height = OV9282_PIXEL_ARRAY_HEIGHT;
9452cb730c6SDave Stevenson 
9462cb730c6SDave Stevenson 		return 0;
9472cb730c6SDave Stevenson 	}
9482cb730c6SDave Stevenson 
9492cb730c6SDave Stevenson 	return -EINVAL;
9502cb730c6SDave Stevenson }
9512cb730c6SDave Stevenson 
95214ea315bSMartina Krasteva /**
95314ea315bSMartina Krasteva  * ov9282_start_streaming() - Start sensor stream
95414ea315bSMartina Krasteva  * @ov9282: pointer to ov9282 device
95514ea315bSMartina Krasteva  *
95614ea315bSMartina Krasteva  * Return: 0 if successful, error code otherwise.
95714ea315bSMartina Krasteva  */
ov9282_start_streaming(struct ov9282 * ov9282)95814ea315bSMartina Krasteva static int ov9282_start_streaming(struct ov9282 *ov9282)
95914ea315bSMartina Krasteva {
96043ac0cacSDave Stevenson 	const struct ov9282_reg bitdepth_regs[2][2] = {
96143ac0cacSDave Stevenson 		{
96243ac0cacSDave Stevenson 			{OV9282_REG_PLL_CTRL_0D, OV9282_PLL_CTRL_0D_RAW10},
96343ac0cacSDave Stevenson 			{OV9282_REG_ANA_CORE_2, OV9282_ANA_CORE2_RAW10},
96443ac0cacSDave Stevenson 		}, {
96543ac0cacSDave Stevenson 			{OV9282_REG_PLL_CTRL_0D, OV9282_PLL_CTRL_0D_RAW8},
96643ac0cacSDave Stevenson 			{OV9282_REG_ANA_CORE_2, OV9282_ANA_CORE2_RAW8},
96743ac0cacSDave Stevenson 		}
96843ac0cacSDave Stevenson 	};
96914ea315bSMartina Krasteva 	const struct ov9282_reg_list *reg_list;
97043ac0cacSDave Stevenson 	int bitdepth_index;
97114ea315bSMartina Krasteva 	int ret;
97214ea315bSMartina Krasteva 
9737195aabfSDave Stevenson 	/* Write common registers */
9747195aabfSDave Stevenson 	ret = ov9282_write_regs(ov9282, common_regs_list.regs,
9757195aabfSDave Stevenson 				common_regs_list.num_of_regs);
9767195aabfSDave Stevenson 	if (ret) {
9777195aabfSDave Stevenson 		dev_err(ov9282->dev, "fail to write common registers");
9787195aabfSDave Stevenson 		return ret;
9797195aabfSDave Stevenson 	}
9807195aabfSDave Stevenson 
98143ac0cacSDave Stevenson 	bitdepth_index = ov9282->code == MEDIA_BUS_FMT_Y10_1X10 ? 0 : 1;
98243ac0cacSDave Stevenson 	ret = ov9282_write_regs(ov9282, bitdepth_regs[bitdepth_index], 2);
98343ac0cacSDave Stevenson 	if (ret) {
98443ac0cacSDave Stevenson 		dev_err(ov9282->dev, "fail to write bitdepth regs");
98543ac0cacSDave Stevenson 		return ret;
98643ac0cacSDave Stevenson 	}
98743ac0cacSDave Stevenson 
98814ea315bSMartina Krasteva 	/* Write sensor mode registers */
98914ea315bSMartina Krasteva 	reg_list = &ov9282->cur_mode->reg_list;
99014ea315bSMartina Krasteva 	ret = ov9282_write_regs(ov9282, reg_list->regs, reg_list->num_of_regs);
99114ea315bSMartina Krasteva 	if (ret) {
99214ea315bSMartina Krasteva 		dev_err(ov9282->dev, "fail to write initial registers");
99314ea315bSMartina Krasteva 		return ret;
99414ea315bSMartina Krasteva 	}
99514ea315bSMartina Krasteva 
99614ea315bSMartina Krasteva 	/* Setup handler will write actual exposure and gain */
99714ea315bSMartina Krasteva 	ret =  __v4l2_ctrl_handler_setup(ov9282->sd.ctrl_handler);
99814ea315bSMartina Krasteva 	if (ret) {
99914ea315bSMartina Krasteva 		dev_err(ov9282->dev, "fail to setup handler");
100014ea315bSMartina Krasteva 		return ret;
100114ea315bSMartina Krasteva 	}
100214ea315bSMartina Krasteva 
100314ea315bSMartina Krasteva 	/* Start streaming */
100414ea315bSMartina Krasteva 	ret = ov9282_write_reg(ov9282, OV9282_REG_MODE_SELECT,
100514ea315bSMartina Krasteva 			       1, OV9282_MODE_STREAMING);
100614ea315bSMartina Krasteva 	if (ret) {
100714ea315bSMartina Krasteva 		dev_err(ov9282->dev, "fail to start streaming");
100814ea315bSMartina Krasteva 		return ret;
100914ea315bSMartina Krasteva 	}
101014ea315bSMartina Krasteva 
101114ea315bSMartina Krasteva 	return 0;
101214ea315bSMartina Krasteva }
101314ea315bSMartina Krasteva 
101414ea315bSMartina Krasteva /**
101514ea315bSMartina Krasteva  * ov9282_stop_streaming() - Stop sensor stream
101614ea315bSMartina Krasteva  * @ov9282: pointer to ov9282 device
101714ea315bSMartina Krasteva  *
101814ea315bSMartina Krasteva  * Return: 0 if successful, error code otherwise.
101914ea315bSMartina Krasteva  */
ov9282_stop_streaming(struct ov9282 * ov9282)102014ea315bSMartina Krasteva static int ov9282_stop_streaming(struct ov9282 *ov9282)
102114ea315bSMartina Krasteva {
102214ea315bSMartina Krasteva 	return ov9282_write_reg(ov9282, OV9282_REG_MODE_SELECT,
102314ea315bSMartina Krasteva 				1, OV9282_MODE_STANDBY);
102414ea315bSMartina Krasteva }
102514ea315bSMartina Krasteva 
102614ea315bSMartina Krasteva /**
102714ea315bSMartina Krasteva  * ov9282_set_stream() - Enable sensor streaming
102814ea315bSMartina Krasteva  * @sd: pointer to ov9282 subdevice
102914ea315bSMartina Krasteva  * @enable: set to enable sensor streaming
103014ea315bSMartina Krasteva  *
103114ea315bSMartina Krasteva  * Return: 0 if successful, error code otherwise.
103214ea315bSMartina Krasteva  */
ov9282_set_stream(struct v4l2_subdev * sd,int enable)103314ea315bSMartina Krasteva static int ov9282_set_stream(struct v4l2_subdev *sd, int enable)
103414ea315bSMartina Krasteva {
103514ea315bSMartina Krasteva 	struct ov9282 *ov9282 = to_ov9282(sd);
103614ea315bSMartina Krasteva 	int ret;
103714ea315bSMartina Krasteva 
103814ea315bSMartina Krasteva 	mutex_lock(&ov9282->mutex);
103914ea315bSMartina Krasteva 
104014ea315bSMartina Krasteva 	if (ov9282->streaming == enable) {
104114ea315bSMartina Krasteva 		mutex_unlock(&ov9282->mutex);
104214ea315bSMartina Krasteva 		return 0;
104314ea315bSMartina Krasteva 	}
104414ea315bSMartina Krasteva 
104514ea315bSMartina Krasteva 	if (enable) {
104614ea315bSMartina Krasteva 		ret = pm_runtime_resume_and_get(ov9282->dev);
104714ea315bSMartina Krasteva 		if (ret)
104814ea315bSMartina Krasteva 			goto error_unlock;
104914ea315bSMartina Krasteva 
105014ea315bSMartina Krasteva 		ret = ov9282_start_streaming(ov9282);
105114ea315bSMartina Krasteva 		if (ret)
105214ea315bSMartina Krasteva 			goto error_power_off;
105314ea315bSMartina Krasteva 	} else {
105414ea315bSMartina Krasteva 		ov9282_stop_streaming(ov9282);
105514ea315bSMartina Krasteva 		pm_runtime_put(ov9282->dev);
105614ea315bSMartina Krasteva 	}
105714ea315bSMartina Krasteva 
105814ea315bSMartina Krasteva 	ov9282->streaming = enable;
105914ea315bSMartina Krasteva 
106014ea315bSMartina Krasteva 	mutex_unlock(&ov9282->mutex);
106114ea315bSMartina Krasteva 
106214ea315bSMartina Krasteva 	return 0;
106314ea315bSMartina Krasteva 
106414ea315bSMartina Krasteva error_power_off:
106514ea315bSMartina Krasteva 	pm_runtime_put(ov9282->dev);
106614ea315bSMartina Krasteva error_unlock:
106714ea315bSMartina Krasteva 	mutex_unlock(&ov9282->mutex);
106814ea315bSMartina Krasteva 
106914ea315bSMartina Krasteva 	return ret;
107014ea315bSMartina Krasteva }
107114ea315bSMartina Krasteva 
107214ea315bSMartina Krasteva /**
107314ea315bSMartina Krasteva  * ov9282_detect() - Detect ov9282 sensor
107414ea315bSMartina Krasteva  * @ov9282: pointer to ov9282 device
107514ea315bSMartina Krasteva  *
107614ea315bSMartina Krasteva  * Return: 0 if successful, -EIO if sensor id does not match
107714ea315bSMartina Krasteva  */
ov9282_detect(struct ov9282 * ov9282)107814ea315bSMartina Krasteva static int ov9282_detect(struct ov9282 *ov9282)
107914ea315bSMartina Krasteva {
108014ea315bSMartina Krasteva 	int ret;
108114ea315bSMartina Krasteva 	u32 val;
108214ea315bSMartina Krasteva 
108314ea315bSMartina Krasteva 	ret = ov9282_read_reg(ov9282, OV9282_REG_ID, 2, &val);
108414ea315bSMartina Krasteva 	if (ret)
108514ea315bSMartina Krasteva 		return ret;
108614ea315bSMartina Krasteva 
108714ea315bSMartina Krasteva 	if (val != OV9282_ID) {
108814ea315bSMartina Krasteva 		dev_err(ov9282->dev, "chip id mismatch: %x!=%x",
108914ea315bSMartina Krasteva 			OV9282_ID, val);
109014ea315bSMartina Krasteva 		return -ENXIO;
109114ea315bSMartina Krasteva 	}
109214ea315bSMartina Krasteva 
109314ea315bSMartina Krasteva 	return 0;
109414ea315bSMartina Krasteva }
109514ea315bSMartina Krasteva 
ov9282_configure_regulators(struct ov9282 * ov9282)10963bc80e89SDave Stevenson static int ov9282_configure_regulators(struct ov9282 *ov9282)
10973bc80e89SDave Stevenson {
10983bc80e89SDave Stevenson 	unsigned int i;
10993bc80e89SDave Stevenson 
11003bc80e89SDave Stevenson 	for (i = 0; i < OV9282_NUM_SUPPLIES; i++)
11013bc80e89SDave Stevenson 		ov9282->supplies[i].supply = ov9282_supply_names[i];
11023bc80e89SDave Stevenson 
11033bc80e89SDave Stevenson 	return devm_regulator_bulk_get(ov9282->dev,
11043bc80e89SDave Stevenson 				       OV9282_NUM_SUPPLIES,
11053bc80e89SDave Stevenson 				       ov9282->supplies);
11063bc80e89SDave Stevenson }
11073bc80e89SDave Stevenson 
110814ea315bSMartina Krasteva /**
110914ea315bSMartina Krasteva  * ov9282_parse_hw_config() - Parse HW configuration and check if supported
111014ea315bSMartina Krasteva  * @ov9282: pointer to ov9282 device
111114ea315bSMartina Krasteva  *
111214ea315bSMartina Krasteva  * Return: 0 if successful, error code otherwise.
111314ea315bSMartina Krasteva  */
ov9282_parse_hw_config(struct ov9282 * ov9282)111414ea315bSMartina Krasteva static int ov9282_parse_hw_config(struct ov9282 *ov9282)
111514ea315bSMartina Krasteva {
111614ea315bSMartina Krasteva 	struct fwnode_handle *fwnode = dev_fwnode(ov9282->dev);
111714ea315bSMartina Krasteva 	struct v4l2_fwnode_endpoint bus_cfg = {
111814ea315bSMartina Krasteva 		.bus_type = V4L2_MBUS_CSI2_DPHY
111914ea315bSMartina Krasteva 	};
112014ea315bSMartina Krasteva 	struct fwnode_handle *ep;
112114ea315bSMartina Krasteva 	unsigned long rate;
112214ea315bSMartina Krasteva 	unsigned int i;
112314ea315bSMartina Krasteva 	int ret;
112414ea315bSMartina Krasteva 
112514ea315bSMartina Krasteva 	if (!fwnode)
112614ea315bSMartina Krasteva 		return -ENXIO;
112714ea315bSMartina Krasteva 
112814ea315bSMartina Krasteva 	/* Request optional reset pin */
112914ea315bSMartina Krasteva 	ov9282->reset_gpio = devm_gpiod_get_optional(ov9282->dev, "reset",
113014ea315bSMartina Krasteva 						     GPIOD_OUT_LOW);
113114ea315bSMartina Krasteva 	if (IS_ERR(ov9282->reset_gpio)) {
113214ea315bSMartina Krasteva 		dev_err(ov9282->dev, "failed to get reset gpio %ld",
113314ea315bSMartina Krasteva 			PTR_ERR(ov9282->reset_gpio));
113414ea315bSMartina Krasteva 		return PTR_ERR(ov9282->reset_gpio);
113514ea315bSMartina Krasteva 	}
113614ea315bSMartina Krasteva 
113714ea315bSMartina Krasteva 	/* Get sensor input clock */
113814ea315bSMartina Krasteva 	ov9282->inclk = devm_clk_get(ov9282->dev, NULL);
113914ea315bSMartina Krasteva 	if (IS_ERR(ov9282->inclk)) {
114014ea315bSMartina Krasteva 		dev_err(ov9282->dev, "could not get inclk");
114114ea315bSMartina Krasteva 		return PTR_ERR(ov9282->inclk);
114214ea315bSMartina Krasteva 	}
114314ea315bSMartina Krasteva 
11443bc80e89SDave Stevenson 	ret = ov9282_configure_regulators(ov9282);
1145e1610209SAlexander Stein 	if (ret)
1146e1610209SAlexander Stein 		return dev_err_probe(ov9282->dev, ret,
1147e1610209SAlexander Stein 				     "Failed to get power regulators\n");
11483bc80e89SDave Stevenson 
114914ea315bSMartina Krasteva 	rate = clk_get_rate(ov9282->inclk);
115014ea315bSMartina Krasteva 	if (rate != OV9282_INCLK_RATE) {
115114ea315bSMartina Krasteva 		dev_err(ov9282->dev, "inclk frequency mismatch");
115214ea315bSMartina Krasteva 		return -EINVAL;
115314ea315bSMartina Krasteva 	}
115414ea315bSMartina Krasteva 
115514ea315bSMartina Krasteva 	ep = fwnode_graph_get_next_endpoint(fwnode, NULL);
115614ea315bSMartina Krasteva 	if (!ep)
115714ea315bSMartina Krasteva 		return -ENXIO;
115814ea315bSMartina Krasteva 
115914ea315bSMartina Krasteva 	ret = v4l2_fwnode_endpoint_alloc_parse(ep, &bus_cfg);
116014ea315bSMartina Krasteva 	fwnode_handle_put(ep);
116114ea315bSMartina Krasteva 	if (ret)
116214ea315bSMartina Krasteva 		return ret;
116314ea315bSMartina Krasteva 
11646f7def3dSDave Stevenson 	ov9282->noncontinuous_clock =
11656f7def3dSDave Stevenson 		bus_cfg.bus.mipi_csi2.flags & V4L2_MBUS_CSI2_NONCONTINUOUS_CLOCK;
11666f7def3dSDave Stevenson 
116714ea315bSMartina Krasteva 	if (bus_cfg.bus.mipi_csi2.num_data_lanes != OV9282_NUM_DATA_LANES) {
116814ea315bSMartina Krasteva 		dev_err(ov9282->dev,
116914ea315bSMartina Krasteva 			"number of CSI2 data lanes %d is not supported",
117014ea315bSMartina Krasteva 			bus_cfg.bus.mipi_csi2.num_data_lanes);
117114ea315bSMartina Krasteva 		ret = -EINVAL;
117214ea315bSMartina Krasteva 		goto done_endpoint_free;
117314ea315bSMartina Krasteva 	}
117414ea315bSMartina Krasteva 
117514ea315bSMartina Krasteva 	if (!bus_cfg.nr_of_link_frequencies) {
117614ea315bSMartina Krasteva 		dev_err(ov9282->dev, "no link frequencies defined");
117714ea315bSMartina Krasteva 		ret = -EINVAL;
117814ea315bSMartina Krasteva 		goto done_endpoint_free;
117914ea315bSMartina Krasteva 	}
118014ea315bSMartina Krasteva 
118114ea315bSMartina Krasteva 	for (i = 0; i < bus_cfg.nr_of_link_frequencies; i++)
118214ea315bSMartina Krasteva 		if (bus_cfg.link_frequencies[i] == OV9282_LINK_FREQ)
118314ea315bSMartina Krasteva 			goto done_endpoint_free;
118414ea315bSMartina Krasteva 
118514ea315bSMartina Krasteva 	ret = -EINVAL;
118614ea315bSMartina Krasteva 
118714ea315bSMartina Krasteva done_endpoint_free:
118814ea315bSMartina Krasteva 	v4l2_fwnode_endpoint_free(&bus_cfg);
118914ea315bSMartina Krasteva 
119014ea315bSMartina Krasteva 	return ret;
119114ea315bSMartina Krasteva }
119214ea315bSMartina Krasteva 
119314ea315bSMartina Krasteva /* V4l2 subdevice ops */
119434ec7248SDave Stevenson static const struct v4l2_subdev_core_ops ov9282_core_ops = {
119534ec7248SDave Stevenson 	.subscribe_event = v4l2_ctrl_subdev_subscribe_event,
119634ec7248SDave Stevenson 	.unsubscribe_event = v4l2_event_subdev_unsubscribe,
119734ec7248SDave Stevenson };
119834ec7248SDave Stevenson 
119914ea315bSMartina Krasteva static const struct v4l2_subdev_video_ops ov9282_video_ops = {
120014ea315bSMartina Krasteva 	.s_stream = ov9282_set_stream,
120114ea315bSMartina Krasteva };
120214ea315bSMartina Krasteva 
120314ea315bSMartina Krasteva static const struct v4l2_subdev_pad_ops ov9282_pad_ops = {
120414ea315bSMartina Krasteva 	.init_cfg = ov9282_init_pad_cfg,
120514ea315bSMartina Krasteva 	.enum_mbus_code = ov9282_enum_mbus_code,
120614ea315bSMartina Krasteva 	.enum_frame_size = ov9282_enum_frame_size,
120714ea315bSMartina Krasteva 	.get_fmt = ov9282_get_pad_format,
120814ea315bSMartina Krasteva 	.set_fmt = ov9282_set_pad_format,
12092cb730c6SDave Stevenson 	.get_selection = ov9282_get_selection,
121014ea315bSMartina Krasteva };
121114ea315bSMartina Krasteva 
121214ea315bSMartina Krasteva static const struct v4l2_subdev_ops ov9282_subdev_ops = {
121334ec7248SDave Stevenson 	.core = &ov9282_core_ops,
121414ea315bSMartina Krasteva 	.video = &ov9282_video_ops,
121514ea315bSMartina Krasteva 	.pad = &ov9282_pad_ops,
121614ea315bSMartina Krasteva };
121714ea315bSMartina Krasteva 
121814ea315bSMartina Krasteva /**
121914ea315bSMartina Krasteva  * ov9282_power_on() - Sensor power on sequence
122014ea315bSMartina Krasteva  * @dev: pointer to i2c device
122114ea315bSMartina Krasteva  *
122214ea315bSMartina Krasteva  * Return: 0 if successful, error code otherwise.
122314ea315bSMartina Krasteva  */
ov9282_power_on(struct device * dev)122414ea315bSMartina Krasteva static int ov9282_power_on(struct device *dev)
122514ea315bSMartina Krasteva {
122614ea315bSMartina Krasteva 	struct v4l2_subdev *sd = dev_get_drvdata(dev);
122714ea315bSMartina Krasteva 	struct ov9282 *ov9282 = to_ov9282(sd);
122814ea315bSMartina Krasteva 	int ret;
122914ea315bSMartina Krasteva 
12303bc80e89SDave Stevenson 	ret = regulator_bulk_enable(OV9282_NUM_SUPPLIES, ov9282->supplies);
12313bc80e89SDave Stevenson 	if (ret < 0) {
12323bc80e89SDave Stevenson 		dev_err(dev, "Failed to enable regulators\n");
12333bc80e89SDave Stevenson 		return ret;
12343bc80e89SDave Stevenson 	}
12353bc80e89SDave Stevenson 
123614ea315bSMartina Krasteva 	usleep_range(400, 600);
123714ea315bSMartina Krasteva 
123814ea315bSMartina Krasteva 	gpiod_set_value_cansleep(ov9282->reset_gpio, 1);
123914ea315bSMartina Krasteva 
124014ea315bSMartina Krasteva 	ret = clk_prepare_enable(ov9282->inclk);
124114ea315bSMartina Krasteva 	if (ret) {
124214ea315bSMartina Krasteva 		dev_err(ov9282->dev, "fail to enable inclk");
124314ea315bSMartina Krasteva 		goto error_reset;
124414ea315bSMartina Krasteva 	}
124514ea315bSMartina Krasteva 
124614ea315bSMartina Krasteva 	usleep_range(400, 600);
124714ea315bSMartina Krasteva 
12486f7def3dSDave Stevenson 	ret = ov9282_write_reg(ov9282, OV9282_REG_MIPI_CTRL00, 1,
12496f7def3dSDave Stevenson 			       ov9282->noncontinuous_clock ?
12506f7def3dSDave Stevenson 					OV9282_GATED_CLOCK : 0);
12516f7def3dSDave Stevenson 	if (ret) {
12526f7def3dSDave Stevenson 		dev_err(ov9282->dev, "fail to write MIPI_CTRL00");
1253b2ea130cSDave Stevenson 		goto error_clk;
12546f7def3dSDave Stevenson 	}
12556f7def3dSDave Stevenson 
125614ea315bSMartina Krasteva 	return 0;
125714ea315bSMartina Krasteva 
1258b2ea130cSDave Stevenson error_clk:
1259b2ea130cSDave Stevenson 	clk_disable_unprepare(ov9282->inclk);
126014ea315bSMartina Krasteva error_reset:
126114ea315bSMartina Krasteva 	gpiod_set_value_cansleep(ov9282->reset_gpio, 0);
126214ea315bSMartina Krasteva 
12633bc80e89SDave Stevenson 	regulator_bulk_disable(OV9282_NUM_SUPPLIES, ov9282->supplies);
12643bc80e89SDave Stevenson 
126514ea315bSMartina Krasteva 	return ret;
126614ea315bSMartina Krasteva }
126714ea315bSMartina Krasteva 
126814ea315bSMartina Krasteva /**
126914ea315bSMartina Krasteva  * ov9282_power_off() - Sensor power off sequence
127014ea315bSMartina Krasteva  * @dev: pointer to i2c device
127114ea315bSMartina Krasteva  *
127214ea315bSMartina Krasteva  * Return: 0 if successful, error code otherwise.
127314ea315bSMartina Krasteva  */
ov9282_power_off(struct device * dev)127414ea315bSMartina Krasteva static int ov9282_power_off(struct device *dev)
127514ea315bSMartina Krasteva {
127614ea315bSMartina Krasteva 	struct v4l2_subdev *sd = dev_get_drvdata(dev);
127714ea315bSMartina Krasteva 	struct ov9282 *ov9282 = to_ov9282(sd);
127814ea315bSMartina Krasteva 
127914ea315bSMartina Krasteva 	gpiod_set_value_cansleep(ov9282->reset_gpio, 0);
128014ea315bSMartina Krasteva 
128114ea315bSMartina Krasteva 	clk_disable_unprepare(ov9282->inclk);
128214ea315bSMartina Krasteva 
12833bc80e89SDave Stevenson 	regulator_bulk_disable(OV9282_NUM_SUPPLIES, ov9282->supplies);
12843bc80e89SDave Stevenson 
128514ea315bSMartina Krasteva 	return 0;
128614ea315bSMartina Krasteva }
128714ea315bSMartina Krasteva 
128814ea315bSMartina Krasteva /**
128914ea315bSMartina Krasteva  * ov9282_init_controls() - Initialize sensor subdevice controls
129014ea315bSMartina Krasteva  * @ov9282: pointer to ov9282 device
129114ea315bSMartina Krasteva  *
129214ea315bSMartina Krasteva  * Return: 0 if successful, error code otherwise.
129314ea315bSMartina Krasteva  */
ov9282_init_controls(struct ov9282 * ov9282)129414ea315bSMartina Krasteva static int ov9282_init_controls(struct ov9282 *ov9282)
129514ea315bSMartina Krasteva {
129614ea315bSMartina Krasteva 	struct v4l2_ctrl_handler *ctrl_hdlr = &ov9282->ctrl_handler;
129714ea315bSMartina Krasteva 	const struct ov9282_mode *mode = ov9282->cur_mode;
1298f6a88082SDave Stevenson 	struct v4l2_fwnode_device_properties props;
1299a387834cSDave Stevenson 	u32 hblank_min;
130014ea315bSMartina Krasteva 	u32 lpfr;
130114ea315bSMartina Krasteva 	int ret;
130214ea315bSMartina Krasteva 
1303af2775dcSDave Stevenson 	ret = v4l2_ctrl_handler_init(ctrl_hdlr, 10);
130414ea315bSMartina Krasteva 	if (ret)
130514ea315bSMartina Krasteva 		return ret;
130614ea315bSMartina Krasteva 
130714ea315bSMartina Krasteva 	/* Serialize controls with sensor device */
130814ea315bSMartina Krasteva 	ctrl_hdlr->lock = &ov9282->mutex;
130914ea315bSMartina Krasteva 
131014ea315bSMartina Krasteva 	/* Initialize exposure and gain */
131114ea315bSMartina Krasteva 	lpfr = mode->vblank + mode->height;
131214ea315bSMartina Krasteva 	ov9282->exp_ctrl = v4l2_ctrl_new_std(ctrl_hdlr,
131314ea315bSMartina Krasteva 					     &ov9282_ctrl_ops,
131414ea315bSMartina Krasteva 					     V4L2_CID_EXPOSURE,
131514ea315bSMartina Krasteva 					     OV9282_EXPOSURE_MIN,
131614ea315bSMartina Krasteva 					     lpfr - OV9282_EXPOSURE_OFFSET,
131714ea315bSMartina Krasteva 					     OV9282_EXPOSURE_STEP,
131814ea315bSMartina Krasteva 					     OV9282_EXPOSURE_DEFAULT);
131914ea315bSMartina Krasteva 
132014ea315bSMartina Krasteva 	ov9282->again_ctrl = v4l2_ctrl_new_std(ctrl_hdlr,
132114ea315bSMartina Krasteva 					       &ov9282_ctrl_ops,
132214ea315bSMartina Krasteva 					       V4L2_CID_ANALOGUE_GAIN,
132314ea315bSMartina Krasteva 					       OV9282_AGAIN_MIN,
132414ea315bSMartina Krasteva 					       OV9282_AGAIN_MAX,
132514ea315bSMartina Krasteva 					       OV9282_AGAIN_STEP,
132614ea315bSMartina Krasteva 					       OV9282_AGAIN_DEFAULT);
132714ea315bSMartina Krasteva 
132814ea315bSMartina Krasteva 	v4l2_ctrl_cluster(2, &ov9282->exp_ctrl);
132914ea315bSMartina Krasteva 
133014ea315bSMartina Krasteva 	ov9282->vblank_ctrl = v4l2_ctrl_new_std(ctrl_hdlr,
133114ea315bSMartina Krasteva 						&ov9282_ctrl_ops,
133214ea315bSMartina Krasteva 						V4L2_CID_VBLANK,
133314ea315bSMartina Krasteva 						mode->vblank_min,
133414ea315bSMartina Krasteva 						mode->vblank_max,
133514ea315bSMartina Krasteva 						1, mode->vblank);
133614ea315bSMartina Krasteva 
1337af2775dcSDave Stevenson 	v4l2_ctrl_new_std(ctrl_hdlr, &ov9282_ctrl_ops, V4L2_CID_VFLIP,
1338af2775dcSDave Stevenson 			  0, 1, 1, 1);
1339af2775dcSDave Stevenson 
1340af2775dcSDave Stevenson 	v4l2_ctrl_new_std(ctrl_hdlr, &ov9282_ctrl_ops, V4L2_CID_HFLIP,
1341af2775dcSDave Stevenson 			  0, 1, 1, 1);
1342af2775dcSDave Stevenson 
134314ea315bSMartina Krasteva 	/* Read only controls */
134443ac0cacSDave Stevenson 	ov9282->pixel_rate = v4l2_ctrl_new_std(ctrl_hdlr, &ov9282_ctrl_ops,
134543ac0cacSDave Stevenson 					       V4L2_CID_PIXEL_RATE,
134643ac0cacSDave Stevenson 					       OV9282_PIXEL_RATE_10BIT,
134743ac0cacSDave Stevenson 					       OV9282_PIXEL_RATE_10BIT, 1,
134843ac0cacSDave Stevenson 					       OV9282_PIXEL_RATE_10BIT);
134914ea315bSMartina Krasteva 
135014ea315bSMartina Krasteva 	ov9282->link_freq_ctrl = v4l2_ctrl_new_int_menu(ctrl_hdlr,
135114ea315bSMartina Krasteva 							&ov9282_ctrl_ops,
135214ea315bSMartina Krasteva 							V4L2_CID_LINK_FREQ,
135314ea315bSMartina Krasteva 							ARRAY_SIZE(link_freq) -
135414ea315bSMartina Krasteva 							1,
135514ea315bSMartina Krasteva 							mode->link_freq_idx,
135614ea315bSMartina Krasteva 							link_freq);
135714ea315bSMartina Krasteva 	if (ov9282->link_freq_ctrl)
135814ea315bSMartina Krasteva 		ov9282->link_freq_ctrl->flags |= V4L2_CTRL_FLAG_READ_ONLY;
135914ea315bSMartina Krasteva 
1360a387834cSDave Stevenson 	hblank_min = mode->hblank_min[ov9282->noncontinuous_clock ? 0 : 1];
136114ea315bSMartina Krasteva 	ov9282->hblank_ctrl = v4l2_ctrl_new_std(ctrl_hdlr,
136214ea315bSMartina Krasteva 						&ov9282_ctrl_ops,
136314ea315bSMartina Krasteva 						V4L2_CID_HBLANK,
1364a387834cSDave Stevenson 						hblank_min,
1365a387834cSDave Stevenson 						OV9282_TIMING_HTS_MAX - mode->width,
1366a387834cSDave Stevenson 						1, hblank_min);
136714ea315bSMartina Krasteva 
1368f6a88082SDave Stevenson 	ret = v4l2_fwnode_device_parse(ov9282->dev, &props);
1369f6a88082SDave Stevenson 	if (!ret) {
1370f6a88082SDave Stevenson 		/* Failure sets ctrl_hdlr->error, which we check afterwards anyway */
1371f6a88082SDave Stevenson 		v4l2_ctrl_new_fwnode_properties(ctrl_hdlr, &ov9282_ctrl_ops,
1372f6a88082SDave Stevenson 						&props);
1373f6a88082SDave Stevenson 	}
1374f6a88082SDave Stevenson 
1375f6a88082SDave Stevenson 	if (ctrl_hdlr->error || ret) {
137614ea315bSMartina Krasteva 		dev_err(ov9282->dev, "control init failed: %d",
137714ea315bSMartina Krasteva 			ctrl_hdlr->error);
137814ea315bSMartina Krasteva 		v4l2_ctrl_handler_free(ctrl_hdlr);
137914ea315bSMartina Krasteva 		return ctrl_hdlr->error;
138014ea315bSMartina Krasteva 	}
138114ea315bSMartina Krasteva 
138214ea315bSMartina Krasteva 	ov9282->sd.ctrl_handler = ctrl_hdlr;
138314ea315bSMartina Krasteva 
138414ea315bSMartina Krasteva 	return 0;
138514ea315bSMartina Krasteva }
138614ea315bSMartina Krasteva 
138714ea315bSMartina Krasteva /**
138814ea315bSMartina Krasteva  * ov9282_probe() - I2C client device binding
138914ea315bSMartina Krasteva  * @client: pointer to i2c client device
139014ea315bSMartina Krasteva  *
139114ea315bSMartina Krasteva  * Return: 0 if successful, error code otherwise.
139214ea315bSMartina Krasteva  */
ov9282_probe(struct i2c_client * client)139314ea315bSMartina Krasteva static int ov9282_probe(struct i2c_client *client)
139414ea315bSMartina Krasteva {
139514ea315bSMartina Krasteva 	struct ov9282 *ov9282;
139614ea315bSMartina Krasteva 	int ret;
139714ea315bSMartina Krasteva 
139814ea315bSMartina Krasteva 	ov9282 = devm_kzalloc(&client->dev, sizeof(*ov9282), GFP_KERNEL);
139914ea315bSMartina Krasteva 	if (!ov9282)
140014ea315bSMartina Krasteva 		return -ENOMEM;
140114ea315bSMartina Krasteva 
140214ea315bSMartina Krasteva 	ov9282->dev = &client->dev;
140314ea315bSMartina Krasteva 
140414ea315bSMartina Krasteva 	/* Initialize subdev */
140514ea315bSMartina Krasteva 	v4l2_i2c_subdev_init(&ov9282->sd, client, &ov9282_subdev_ops);
14061b584f20SAlexander Stein 	v4l2_i2c_subdev_set_name(&ov9282->sd, client,
14071b584f20SAlexander Stein 				 device_get_match_data(ov9282->dev), NULL);
140814ea315bSMartina Krasteva 
140914ea315bSMartina Krasteva 	ret = ov9282_parse_hw_config(ov9282);
141014ea315bSMartina Krasteva 	if (ret) {
141114ea315bSMartina Krasteva 		dev_err(ov9282->dev, "HW configuration is not supported");
141214ea315bSMartina Krasteva 		return ret;
141314ea315bSMartina Krasteva 	}
141414ea315bSMartina Krasteva 
141514ea315bSMartina Krasteva 	mutex_init(&ov9282->mutex);
141614ea315bSMartina Krasteva 
141714ea315bSMartina Krasteva 	ret = ov9282_power_on(ov9282->dev);
141814ea315bSMartina Krasteva 	if (ret) {
141914ea315bSMartina Krasteva 		dev_err(ov9282->dev, "failed to power-on the sensor");
142014ea315bSMartina Krasteva 		goto error_mutex_destroy;
142114ea315bSMartina Krasteva 	}
142214ea315bSMartina Krasteva 
142314ea315bSMartina Krasteva 	/* Check module identity */
142414ea315bSMartina Krasteva 	ret = ov9282_detect(ov9282);
142514ea315bSMartina Krasteva 	if (ret) {
142614ea315bSMartina Krasteva 		dev_err(ov9282->dev, "failed to find sensor: %d", ret);
142714ea315bSMartina Krasteva 		goto error_power_off;
142814ea315bSMartina Krasteva 	}
142914ea315bSMartina Krasteva 
1430995809ceSDave Stevenson 	/* Set default mode to first mode */
1431995809ceSDave Stevenson 	ov9282->cur_mode = &supported_modes[DEFAULT_MODE];
143243ac0cacSDave Stevenson 	ov9282->code = MEDIA_BUS_FMT_Y10_1X10;
143314ea315bSMartina Krasteva 	ov9282->vblank = ov9282->cur_mode->vblank;
143414ea315bSMartina Krasteva 
143514ea315bSMartina Krasteva 	ret = ov9282_init_controls(ov9282);
143614ea315bSMartina Krasteva 	if (ret) {
143714ea315bSMartina Krasteva 		dev_err(ov9282->dev, "failed to init controls: %d", ret);
143814ea315bSMartina Krasteva 		goto error_power_off;
143914ea315bSMartina Krasteva 	}
144014ea315bSMartina Krasteva 
144114ea315bSMartina Krasteva 	/* Initialize subdev */
144234ec7248SDave Stevenson 	ov9282->sd.flags |= V4L2_SUBDEV_FL_HAS_DEVNODE |
144334ec7248SDave Stevenson 			    V4L2_SUBDEV_FL_HAS_EVENTS;
144414ea315bSMartina Krasteva 	ov9282->sd.entity.function = MEDIA_ENT_F_CAM_SENSOR;
144514ea315bSMartina Krasteva 
144614ea315bSMartina Krasteva 	/* Initialize source pad */
144714ea315bSMartina Krasteva 	ov9282->pad.flags = MEDIA_PAD_FL_SOURCE;
144814ea315bSMartina Krasteva 	ret = media_entity_pads_init(&ov9282->sd.entity, 1, &ov9282->pad);
144914ea315bSMartina Krasteva 	if (ret) {
145014ea315bSMartina Krasteva 		dev_err(ov9282->dev, "failed to init entity pads: %d", ret);
145114ea315bSMartina Krasteva 		goto error_handler_free;
145214ea315bSMartina Krasteva 	}
145314ea315bSMartina Krasteva 
145414ea315bSMartina Krasteva 	ret = v4l2_async_register_subdev_sensor(&ov9282->sd);
145514ea315bSMartina Krasteva 	if (ret < 0) {
145614ea315bSMartina Krasteva 		dev_err(ov9282->dev,
145714ea315bSMartina Krasteva 			"failed to register async subdev: %d", ret);
145814ea315bSMartina Krasteva 		goto error_media_entity;
145914ea315bSMartina Krasteva 	}
146014ea315bSMartina Krasteva 
146114ea315bSMartina Krasteva 	pm_runtime_set_active(ov9282->dev);
146214ea315bSMartina Krasteva 	pm_runtime_enable(ov9282->dev);
146314ea315bSMartina Krasteva 	pm_runtime_idle(ov9282->dev);
146414ea315bSMartina Krasteva 
146514ea315bSMartina Krasteva 	return 0;
146614ea315bSMartina Krasteva 
146714ea315bSMartina Krasteva error_media_entity:
146814ea315bSMartina Krasteva 	media_entity_cleanup(&ov9282->sd.entity);
146914ea315bSMartina Krasteva error_handler_free:
147014ea315bSMartina Krasteva 	v4l2_ctrl_handler_free(ov9282->sd.ctrl_handler);
147114ea315bSMartina Krasteva error_power_off:
147214ea315bSMartina Krasteva 	ov9282_power_off(ov9282->dev);
147314ea315bSMartina Krasteva error_mutex_destroy:
147414ea315bSMartina Krasteva 	mutex_destroy(&ov9282->mutex);
147514ea315bSMartina Krasteva 
147614ea315bSMartina Krasteva 	return ret;
147714ea315bSMartina Krasteva }
147814ea315bSMartina Krasteva 
147914ea315bSMartina Krasteva /**
148014ea315bSMartina Krasteva  * ov9282_remove() - I2C client device unbinding
148114ea315bSMartina Krasteva  * @client: pointer to I2C client device
148214ea315bSMartina Krasteva  *
148314ea315bSMartina Krasteva  * Return: 0 if successful, error code otherwise.
148414ea315bSMartina Krasteva  */
ov9282_remove(struct i2c_client * client)1485ed5c2f5fSUwe Kleine-König static void ov9282_remove(struct i2c_client *client)
148614ea315bSMartina Krasteva {
148714ea315bSMartina Krasteva 	struct v4l2_subdev *sd = i2c_get_clientdata(client);
148814ea315bSMartina Krasteva 	struct ov9282 *ov9282 = to_ov9282(sd);
148914ea315bSMartina Krasteva 
149014ea315bSMartina Krasteva 	v4l2_async_unregister_subdev(sd);
149114ea315bSMartina Krasteva 	media_entity_cleanup(&sd->entity);
149214ea315bSMartina Krasteva 	v4l2_ctrl_handler_free(sd->ctrl_handler);
149314ea315bSMartina Krasteva 
149414ea315bSMartina Krasteva 	pm_runtime_disable(&client->dev);
149514ea315bSMartina Krasteva 	if (!pm_runtime_status_suspended(&client->dev))
149614ea315bSMartina Krasteva 		ov9282_power_off(&client->dev);
149714ea315bSMartina Krasteva 	pm_runtime_set_suspended(&client->dev);
149814ea315bSMartina Krasteva 
149914ea315bSMartina Krasteva 	mutex_destroy(&ov9282->mutex);
150014ea315bSMartina Krasteva }
150114ea315bSMartina Krasteva 
150214ea315bSMartina Krasteva static const struct dev_pm_ops ov9282_pm_ops = {
150314ea315bSMartina Krasteva 	SET_RUNTIME_PM_OPS(ov9282_power_off, ov9282_power_on, NULL)
150414ea315bSMartina Krasteva };
150514ea315bSMartina Krasteva 
150614ea315bSMartina Krasteva static const struct of_device_id ov9282_of_match[] = {
15071b584f20SAlexander Stein 	{ .compatible = "ovti,ov9281", .data = "ov9281" },
15081b584f20SAlexander Stein 	{ .compatible = "ovti,ov9282", .data = "ov9282" },
150914ea315bSMartina Krasteva 	{ }
151014ea315bSMartina Krasteva };
151114ea315bSMartina Krasteva 
151214ea315bSMartina Krasteva MODULE_DEVICE_TABLE(of, ov9282_of_match);
151314ea315bSMartina Krasteva 
151414ea315bSMartina Krasteva static struct i2c_driver ov9282_driver = {
1515*aaeb31c0SUwe Kleine-König 	.probe = ov9282_probe,
151614ea315bSMartina Krasteva 	.remove = ov9282_remove,
151714ea315bSMartina Krasteva 	.driver = {
151814ea315bSMartina Krasteva 		.name = "ov9282",
151914ea315bSMartina Krasteva 		.pm = &ov9282_pm_ops,
152014ea315bSMartina Krasteva 		.of_match_table = ov9282_of_match,
152114ea315bSMartina Krasteva 	},
152214ea315bSMartina Krasteva };
152314ea315bSMartina Krasteva 
152414ea315bSMartina Krasteva module_i2c_driver(ov9282_driver);
152514ea315bSMartina Krasteva 
152614ea315bSMartina Krasteva MODULE_DESCRIPTION("OmniVision ov9282 sensor driver");
152714ea315bSMartina Krasteva MODULE_LICENSE("GPL");
1528