1828dbc29SManivannan Sadhasivam // SPDX-License-Identifier: GPL-2.0
2828dbc29SManivannan Sadhasivam /*
3828dbc29SManivannan Sadhasivam * Sony IMX290 CMOS Image Sensor Driver
4828dbc29SManivannan Sadhasivam *
5828dbc29SManivannan Sadhasivam * Copyright (C) 2019 FRAMOS GmbH.
6828dbc29SManivannan Sadhasivam *
7828dbc29SManivannan Sadhasivam * Copyright (C) 2019 Linaro Ltd.
8828dbc29SManivannan Sadhasivam * Author: Manivannan Sadhasivam <manivannan.sadhasivam@linaro.org>
9828dbc29SManivannan Sadhasivam */
10828dbc29SManivannan Sadhasivam
11828dbc29SManivannan Sadhasivam #include <linux/clk.h>
12828dbc29SManivannan Sadhasivam #include <linux/delay.h>
13828dbc29SManivannan Sadhasivam #include <linux/gpio/consumer.h>
14828dbc29SManivannan Sadhasivam #include <linux/i2c.h>
15828dbc29SManivannan Sadhasivam #include <linux/module.h>
167c7e33b7SRob Herring #include <linux/of.h>
17828dbc29SManivannan Sadhasivam #include <linux/pm_runtime.h>
18828dbc29SManivannan Sadhasivam #include <linux/regmap.h>
19828dbc29SManivannan Sadhasivam #include <linux/regulator/consumer.h>
2044cedb7bSAndy Shevchenko
2144cedb7bSAndy Shevchenko #include <asm/unaligned.h>
2244cedb7bSAndy Shevchenko
23828dbc29SManivannan Sadhasivam #include <media/media-entity.h>
24af73323bSHans de Goede #include <media/v4l2-cci.h>
25828dbc29SManivannan Sadhasivam #include <media/v4l2-ctrls.h>
26828dbc29SManivannan Sadhasivam #include <media/v4l2-device.h>
27f5398587SDave Stevenson #include <media/v4l2-event.h>
28828dbc29SManivannan Sadhasivam #include <media/v4l2-fwnode.h>
29828dbc29SManivannan Sadhasivam #include <media/v4l2-subdev.h>
30828dbc29SManivannan Sadhasivam
31af73323bSHans de Goede #define IMX290_STANDBY CCI_REG8(0x3000)
32af73323bSHans de Goede #define IMX290_REGHOLD CCI_REG8(0x3001)
33af73323bSHans de Goede #define IMX290_XMSTA CCI_REG8(0x3002)
34af73323bSHans de Goede #define IMX290_ADBIT CCI_REG8(0x3005)
3579d99ae8SLaurent Pinchart #define IMX290_ADBIT_10BIT (0 << 0)
3679d99ae8SLaurent Pinchart #define IMX290_ADBIT_12BIT (1 << 0)
37af73323bSHans de Goede #define IMX290_CTRL_07 CCI_REG8(0x3007)
3879d99ae8SLaurent Pinchart #define IMX290_VREVERSE BIT(0)
3979d99ae8SLaurent Pinchart #define IMX290_HREVERSE BIT(1)
4079d99ae8SLaurent Pinchart #define IMX290_WINMODE_1080P (0 << 4)
4179d99ae8SLaurent Pinchart #define IMX290_WINMODE_720P (1 << 4)
4279d99ae8SLaurent Pinchart #define IMX290_WINMODE_CROP (4 << 4)
43af73323bSHans de Goede #define IMX290_FR_FDG_SEL CCI_REG8(0x3009)
44cca76386SAlexander Stein #define IMX290_BLKLEVEL CCI_REG16_LE(0x300a)
45af73323bSHans de Goede #define IMX290_GAIN CCI_REG8(0x3014)
46cca76386SAlexander Stein #define IMX290_VMAX CCI_REG24_LE(0x3018)
479fe4eee9SDave Stevenson #define IMX290_VMAX_MAX 0x3ffff
48cca76386SAlexander Stein #define IMX290_HMAX CCI_REG16_LE(0x301c)
4908a0061dSDave Stevenson #define IMX290_HMAX_MAX 0xffff
50cca76386SAlexander Stein #define IMX290_SHS1 CCI_REG24_LE(0x3020)
51af73323bSHans de Goede #define IMX290_WINWV_OB CCI_REG8(0x303a)
52cca76386SAlexander Stein #define IMX290_WINPV CCI_REG16_LE(0x303c)
53cca76386SAlexander Stein #define IMX290_WINWV CCI_REG16_LE(0x303e)
54cca76386SAlexander Stein #define IMX290_WINPH CCI_REG16_LE(0x3040)
55cca76386SAlexander Stein #define IMX290_WINWH CCI_REG16_LE(0x3042)
56af73323bSHans de Goede #define IMX290_OUT_CTRL CCI_REG8(0x3046)
5779d99ae8SLaurent Pinchart #define IMX290_ODBIT_10BIT (0 << 0)
5879d99ae8SLaurent Pinchart #define IMX290_ODBIT_12BIT (1 << 0)
5979d99ae8SLaurent Pinchart #define IMX290_OPORTSEL_PARALLEL (0x0 << 4)
6079d99ae8SLaurent Pinchart #define IMX290_OPORTSEL_LVDS_2CH (0xd << 4)
6179d99ae8SLaurent Pinchart #define IMX290_OPORTSEL_LVDS_4CH (0xe << 4)
6279d99ae8SLaurent Pinchart #define IMX290_OPORTSEL_LVDS_8CH (0xf << 4)
63af73323bSHans de Goede #define IMX290_XSOUTSEL CCI_REG8(0x304b)
6479d99ae8SLaurent Pinchart #define IMX290_XSOUTSEL_XVSOUTSEL_HIGH (0 << 0)
6579d99ae8SLaurent Pinchart #define IMX290_XSOUTSEL_XVSOUTSEL_VSYNC (2 << 0)
6679d99ae8SLaurent Pinchart #define IMX290_XSOUTSEL_XHSOUTSEL_HIGH (0 << 2)
6779d99ae8SLaurent Pinchart #define IMX290_XSOUTSEL_XHSOUTSEL_HSYNC (2 << 2)
68af73323bSHans de Goede #define IMX290_INCKSEL1 CCI_REG8(0x305c)
69af73323bSHans de Goede #define IMX290_INCKSEL2 CCI_REG8(0x305d)
70af73323bSHans de Goede #define IMX290_INCKSEL3 CCI_REG8(0x305e)
71af73323bSHans de Goede #define IMX290_INCKSEL4 CCI_REG8(0x305f)
72af73323bSHans de Goede #define IMX290_PGCTRL CCI_REG8(0x308c)
73af73323bSHans de Goede #define IMX290_ADBIT1 CCI_REG8(0x3129)
7479d99ae8SLaurent Pinchart #define IMX290_ADBIT1_10BIT 0x1d
7579d99ae8SLaurent Pinchart #define IMX290_ADBIT1_12BIT 0x00
76af73323bSHans de Goede #define IMX290_INCKSEL5 CCI_REG8(0x315e)
77af73323bSHans de Goede #define IMX290_INCKSEL6 CCI_REG8(0x3164)
78af73323bSHans de Goede #define IMX290_ADBIT2 CCI_REG8(0x317c)
7979d99ae8SLaurent Pinchart #define IMX290_ADBIT2_10BIT 0x12
8079d99ae8SLaurent Pinchart #define IMX290_ADBIT2_12BIT 0x00
81cca76386SAlexander Stein #define IMX290_CHIP_ID CCI_REG16_LE(0x319a)
82af73323bSHans de Goede #define IMX290_ADBIT3 CCI_REG8(0x31ec)
8379d99ae8SLaurent Pinchart #define IMX290_ADBIT3_10BIT 0x37
8479d99ae8SLaurent Pinchart #define IMX290_ADBIT3_12BIT 0x0e
85af73323bSHans de Goede #define IMX290_REPETITION CCI_REG8(0x3405)
86af73323bSHans de Goede #define IMX290_PHY_LANE_NUM CCI_REG8(0x3407)
87af73323bSHans de Goede #define IMX290_OPB_SIZE_V CCI_REG8(0x3414)
88cca76386SAlexander Stein #define IMX290_Y_OUT_SIZE CCI_REG16_LE(0x3418)
89cca76386SAlexander Stein #define IMX290_CSI_DT_FMT CCI_REG16_LE(0x3441)
9079d99ae8SLaurent Pinchart #define IMX290_CSI_DT_FMT_RAW10 0x0a0a
9179d99ae8SLaurent Pinchart #define IMX290_CSI_DT_FMT_RAW12 0x0c0c
92af73323bSHans de Goede #define IMX290_CSI_LANE_MODE CCI_REG8(0x3443)
93cca76386SAlexander Stein #define IMX290_EXTCK_FREQ CCI_REG16_LE(0x3444)
94cca76386SAlexander Stein #define IMX290_TCLKPOST CCI_REG16_LE(0x3446)
95cca76386SAlexander Stein #define IMX290_THSZERO CCI_REG16_LE(0x3448)
96cca76386SAlexander Stein #define IMX290_THSPREPARE CCI_REG16_LE(0x344a)
97cca76386SAlexander Stein #define IMX290_TCLKTRAIL CCI_REG16_LE(0x344c)
98cca76386SAlexander Stein #define IMX290_THSTRAIL CCI_REG16_LE(0x344e)
99cca76386SAlexander Stein #define IMX290_TCLKZERO CCI_REG16_LE(0x3450)
100cca76386SAlexander Stein #define IMX290_TCLKPREPARE CCI_REG16_LE(0x3452)
101cca76386SAlexander Stein #define IMX290_TLPX CCI_REG16_LE(0x3454)
102cca76386SAlexander Stein #define IMX290_X_OUT_SIZE CCI_REG16_LE(0x3472)
103af73323bSHans de Goede #define IMX290_INCKSEL7 CCI_REG8(0x3480)
104828dbc29SManivannan Sadhasivam
105a58df1f9SManivannan Sadhasivam #define IMX290_PGCTRL_REGEN BIT(0)
106a58df1f9SManivannan Sadhasivam #define IMX290_PGCTRL_THRU BIT(1)
107a58df1f9SManivannan Sadhasivam #define IMX290_PGCTRL_MODE(n) ((n) << 4)
108a58df1f9SManivannan Sadhasivam
1099fe4eee9SDave Stevenson /* Number of lines by which exposure must be less than VMAX */
1109fe4eee9SDave Stevenson #define IMX290_EXPOSURE_OFFSET 2
1119fe4eee9SDave Stevenson
112bc35f9a2SDave Stevenson #define IMX290_PIXEL_RATE 148500000
113bc35f9a2SDave Stevenson
114b4ab57b0SLaurent Pinchart /*
115b4ab57b0SLaurent Pinchart * The IMX290 pixel array is organized as follows:
116b4ab57b0SLaurent Pinchart *
117b4ab57b0SLaurent Pinchart * +------------------------------------+
118b4ab57b0SLaurent Pinchart * | Optical Black | } Vertical effective optical black (10)
119b4ab57b0SLaurent Pinchart * +---+------------------------------------+---+
120b4ab57b0SLaurent Pinchart * | | | | } Effective top margin (8)
121b4ab57b0SLaurent Pinchart * | | +----------------------------+ | | \
122b4ab57b0SLaurent Pinchart * | | | | | | |
123b4ab57b0SLaurent Pinchart * | | | | | | |
124b4ab57b0SLaurent Pinchart * | | | | | | |
125b4ab57b0SLaurent Pinchart * | | | Recording Pixel Area | | | | Recommended height (1080)
126b4ab57b0SLaurent Pinchart * | | | | | | |
127b4ab57b0SLaurent Pinchart * | | | | | | |
128b4ab57b0SLaurent Pinchart * | | | | | | |
129b4ab57b0SLaurent Pinchart * | | +----------------------------+ | | /
130b4ab57b0SLaurent Pinchart * | | | | } Effective bottom margin (9)
131b4ab57b0SLaurent Pinchart * +---+------------------------------------+---+
132b4ab57b0SLaurent Pinchart * <-> <-> <--------------------------> <-> <->
133b4ab57b0SLaurent Pinchart * \---- Ignored right margin (4)
134b4ab57b0SLaurent Pinchart * \-------- Effective right margin (9)
135b4ab57b0SLaurent Pinchart * \------------------------- Recommended width (1920)
136b4ab57b0SLaurent Pinchart * \----------------------------------------- Effective left margin (8)
137b4ab57b0SLaurent Pinchart * \--------------------------------------------- Ignored left margin (4)
138b4ab57b0SLaurent Pinchart *
139b4ab57b0SLaurent Pinchart * The optical black lines are output over CSI-2 with a separate data type.
140b4ab57b0SLaurent Pinchart *
141b4ab57b0SLaurent Pinchart * The pixel array is meant to have 1920x1080 usable pixels after image
142b4ab57b0SLaurent Pinchart * processing in an ISP. It has 8 (9) extra active pixels usable for color
143b4ab57b0SLaurent Pinchart * processing in the ISP on the top and left (bottom and right) sides of the
144b4ab57b0SLaurent Pinchart * image. In addition, 4 additional pixels are present on the left and right
145b4ab57b0SLaurent Pinchart * sides of the image, documented as "ignored area".
146b4ab57b0SLaurent Pinchart *
147b4ab57b0SLaurent Pinchart * As far as is understood, all pixels of the pixel array (ignored area, color
148b4ab57b0SLaurent Pinchart * processing margins and recording area) can be output by the sensor.
149b4ab57b0SLaurent Pinchart */
150b4ab57b0SLaurent Pinchart
151b4ab57b0SLaurent Pinchart #define IMX290_PIXEL_ARRAY_WIDTH 1945
152b4ab57b0SLaurent Pinchart #define IMX290_PIXEL_ARRAY_HEIGHT 1097
153*81d998e1SAlexander Stein #define IMX290_PIXEL_ARRAY_MARGIN_LEFT 12
154*81d998e1SAlexander Stein #define IMX290_PIXEL_ARRAY_MARGIN_RIGHT 13
155*81d998e1SAlexander Stein #define IMX290_PIXEL_ARRAY_MARGIN_TOP 8
156*81d998e1SAlexander Stein #define IMX290_PIXEL_ARRAY_MARGIN_BOTTOM 9
157b4ab57b0SLaurent Pinchart #define IMX290_PIXEL_ARRAY_RECORDING_WIDTH 1920
158b4ab57b0SLaurent Pinchart #define IMX290_PIXEL_ARRAY_RECORDING_HEIGHT 1080
159b4ab57b0SLaurent Pinchart
160ee4ce893SLaurent Pinchart /* Equivalent value for 16bpp */
161ee4ce893SLaurent Pinchart #define IMX290_BLACK_LEVEL_DEFAULT 3840
162ee4ce893SLaurent Pinchart
163cb7e1c8dSLaurent Pinchart #define IMX290_NUM_SUPPLIES 3
164828dbc29SManivannan Sadhasivam
1658bb19dd7SDave Stevenson enum imx290_colour_variant {
1668bb19dd7SDave Stevenson IMX290_VARIANT_COLOUR,
1678bb19dd7SDave Stevenson IMX290_VARIANT_MONO,
1688bb19dd7SDave Stevenson IMX290_VARIANT_MAX
1698bb19dd7SDave Stevenson };
1708bb19dd7SDave Stevenson
1718bb19dd7SDave Stevenson enum imx290_model {
1728bb19dd7SDave Stevenson IMX290_MODEL_IMX290LQR,
1738bb19dd7SDave Stevenson IMX290_MODEL_IMX290LLR,
1742d41947eSAlexander Stein IMX290_MODEL_IMX327LQR,
1758bb19dd7SDave Stevenson };
1768bb19dd7SDave Stevenson
1778bb19dd7SDave Stevenson struct imx290_model_info {
1788bb19dd7SDave Stevenson enum imx290_colour_variant colour_variant;
179af73323bSHans de Goede const struct cci_reg_sequence *init_regs;
1802d41947eSAlexander Stein size_t init_regs_num;
1812d41947eSAlexander Stein const char *name;
1828bb19dd7SDave Stevenson };
1838bb19dd7SDave Stevenson
184ffbe3d82SDave Stevenson enum imx290_clk_freq {
185ffbe3d82SDave Stevenson IMX290_CLK_37_125,
186ffbe3d82SDave Stevenson IMX290_CLK_74_25,
187ffbe3d82SDave Stevenson IMX290_NUM_CLK
188ffbe3d82SDave Stevenson };
189ffbe3d82SDave Stevenson
190ffbe3d82SDave Stevenson /*
191ffbe3d82SDave Stevenson * Clock configuration for registers INCKSEL1 to INCKSEL6.
192ffbe3d82SDave Stevenson */
193ffbe3d82SDave Stevenson struct imx290_clk_cfg {
194ffbe3d82SDave Stevenson u8 incksel1;
195ffbe3d82SDave Stevenson u8 incksel2;
196ffbe3d82SDave Stevenson u8 incksel3;
197ffbe3d82SDave Stevenson u8 incksel4;
198ffbe3d82SDave Stevenson u8 incksel5;
199ffbe3d82SDave Stevenson u8 incksel6;
200ffbe3d82SDave Stevenson };
201ffbe3d82SDave Stevenson
202828dbc29SManivannan Sadhasivam struct imx290_mode {
203828dbc29SManivannan Sadhasivam u32 width;
204828dbc29SManivannan Sadhasivam u32 height;
20508a0061dSDave Stevenson u32 hmax_min;
206bdb55fb2SDave Stevenson u32 vmax_min;
20798e0500eSManivannan Sadhasivam u8 link_freq_index;
208924350aeSDave Stevenson u8 ctrl_07;
209828dbc29SManivannan Sadhasivam
210af73323bSHans de Goede const struct cci_reg_sequence *data;
211828dbc29SManivannan Sadhasivam u32 data_size;
212ffbe3d82SDave Stevenson
213ffbe3d82SDave Stevenson const struct imx290_clk_cfg *clk_cfg;
214828dbc29SManivannan Sadhasivam };
215828dbc29SManivannan Sadhasivam
216d0347f98SDave Stevenson struct imx290_csi_cfg {
217d0347f98SDave Stevenson u16 repetition;
218d0347f98SDave Stevenson u16 tclkpost;
219d0347f98SDave Stevenson u16 thszero;
220d0347f98SDave Stevenson u16 thsprepare;
221d0347f98SDave Stevenson u16 tclktrail;
222d0347f98SDave Stevenson u16 thstrail;
223d0347f98SDave Stevenson u16 tclkzero;
224d0347f98SDave Stevenson u16 tclkprepare;
225d0347f98SDave Stevenson u16 tlpx;
226d0347f98SDave Stevenson };
227d0347f98SDave Stevenson
228828dbc29SManivannan Sadhasivam struct imx290 {
229828dbc29SManivannan Sadhasivam struct device *dev;
230828dbc29SManivannan Sadhasivam struct clk *xclk;
231828dbc29SManivannan Sadhasivam struct regmap *regmap;
232ffbe3d82SDave Stevenson enum imx290_clk_freq xclk_idx;
23397589ad6SManivannan Sadhasivam u8 nlanes;
2348bb19dd7SDave Stevenson const struct imx290_model_info *model;
235828dbc29SManivannan Sadhasivam
236828dbc29SManivannan Sadhasivam struct v4l2_subdev sd;
237828dbc29SManivannan Sadhasivam struct media_pad pad;
238a2514b9aSLaurent Pinchart
239828dbc29SManivannan Sadhasivam const struct imx290_mode *current_mode;
240828dbc29SManivannan Sadhasivam
241828dbc29SManivannan Sadhasivam struct regulator_bulk_data supplies[IMX290_NUM_SUPPLIES];
242828dbc29SManivannan Sadhasivam struct gpio_desc *rst_gpio;
243828dbc29SManivannan Sadhasivam
244828dbc29SManivannan Sadhasivam struct v4l2_ctrl_handler ctrls;
245828dbc29SManivannan Sadhasivam struct v4l2_ctrl *link_freq;
2460c3b56c9SLaurent Pinchart struct v4l2_ctrl *hblank;
2470c3b56c9SLaurent Pinchart struct v4l2_ctrl *vblank;
2489fe4eee9SDave Stevenson struct v4l2_ctrl *exposure;
249924350aeSDave Stevenson struct {
250924350aeSDave Stevenson struct v4l2_ctrl *hflip;
251924350aeSDave Stevenson struct v4l2_ctrl *vflip;
252924350aeSDave Stevenson };
253828dbc29SManivannan Sadhasivam };
254828dbc29SManivannan Sadhasivam
to_imx290(struct v4l2_subdev * _sd)255cb7e1c8dSLaurent Pinchart static inline struct imx290 *to_imx290(struct v4l2_subdev *_sd)
256cb7e1c8dSLaurent Pinchart {
257cb7e1c8dSLaurent Pinchart return container_of(_sd, struct imx290, sd);
258cb7e1c8dSLaurent Pinchart }
259828dbc29SManivannan Sadhasivam
260cb7e1c8dSLaurent Pinchart /* -----------------------------------------------------------------------------
261cb7e1c8dSLaurent Pinchart * Modes and formats
262cb7e1c8dSLaurent Pinchart */
263a58df1f9SManivannan Sadhasivam
264af73323bSHans de Goede static const struct cci_reg_sequence imx290_global_init_settings[] = {
26579d99ae8SLaurent Pinchart { IMX290_WINWV_OB, 12 },
26679d99ae8SLaurent Pinchart { IMX290_WINPH, 0 },
26779d99ae8SLaurent Pinchart { IMX290_WINPV, 0 },
26879d99ae8SLaurent Pinchart { IMX290_WINWH, 1948 },
26979d99ae8SLaurent Pinchart { IMX290_WINWV, 1097 },
27079d99ae8SLaurent Pinchart { IMX290_XSOUTSEL, IMX290_XSOUTSEL_XVSOUTSEL_VSYNC |
27179d99ae8SLaurent Pinchart IMX290_XSOUTSEL_XHSOUTSEL_HSYNC },
272af73323bSHans de Goede { CCI_REG8(0x3011), 0x02 },
273af73323bSHans de Goede { CCI_REG8(0x3012), 0x64 },
274af73323bSHans de Goede { CCI_REG8(0x3013), 0x00 },
2752d41947eSAlexander Stein };
2762d41947eSAlexander Stein
277af73323bSHans de Goede static const struct cci_reg_sequence imx290_global_init_settings_290[] = {
278af73323bSHans de Goede { CCI_REG8(0x300f), 0x00 },
279af73323bSHans de Goede { CCI_REG8(0x3010), 0x21 },
280af73323bSHans de Goede { CCI_REG8(0x3016), 0x09 },
281af73323bSHans de Goede { CCI_REG8(0x3070), 0x02 },
282af73323bSHans de Goede { CCI_REG8(0x3071), 0x11 },
283af73323bSHans de Goede { CCI_REG8(0x309b), 0x10 },
284af73323bSHans de Goede { CCI_REG8(0x309c), 0x22 },
285af73323bSHans de Goede { CCI_REG8(0x30a2), 0x02 },
286af73323bSHans de Goede { CCI_REG8(0x30a6), 0x20 },
287af73323bSHans de Goede { CCI_REG8(0x30a8), 0x20 },
288af73323bSHans de Goede { CCI_REG8(0x30aa), 0x20 },
289af73323bSHans de Goede { CCI_REG8(0x30ac), 0x20 },
290af73323bSHans de Goede { CCI_REG8(0x30b0), 0x43 },
291af73323bSHans de Goede { CCI_REG8(0x3119), 0x9e },
292af73323bSHans de Goede { CCI_REG8(0x311c), 0x1e },
293af73323bSHans de Goede { CCI_REG8(0x311e), 0x08 },
294af73323bSHans de Goede { CCI_REG8(0x3128), 0x05 },
295af73323bSHans de Goede { CCI_REG8(0x313d), 0x83 },
296af73323bSHans de Goede { CCI_REG8(0x3150), 0x03 },
297af73323bSHans de Goede { CCI_REG8(0x317e), 0x00 },
298af73323bSHans de Goede { CCI_REG8(0x32b8), 0x50 },
299af73323bSHans de Goede { CCI_REG8(0x32b9), 0x10 },
300af73323bSHans de Goede { CCI_REG8(0x32ba), 0x00 },
301af73323bSHans de Goede { CCI_REG8(0x32bb), 0x04 },
302af73323bSHans de Goede { CCI_REG8(0x32c8), 0x50 },
303af73323bSHans de Goede { CCI_REG8(0x32c9), 0x10 },
304af73323bSHans de Goede { CCI_REG8(0x32ca), 0x00 },
305af73323bSHans de Goede { CCI_REG8(0x32cb), 0x04 },
306af73323bSHans de Goede { CCI_REG8(0x332c), 0xd3 },
307af73323bSHans de Goede { CCI_REG8(0x332d), 0x10 },
308af73323bSHans de Goede { CCI_REG8(0x332e), 0x0d },
309af73323bSHans de Goede { CCI_REG8(0x3358), 0x06 },
310af73323bSHans de Goede { CCI_REG8(0x3359), 0xe1 },
311af73323bSHans de Goede { CCI_REG8(0x335a), 0x11 },
312af73323bSHans de Goede { CCI_REG8(0x3360), 0x1e },
313af73323bSHans de Goede { CCI_REG8(0x3361), 0x61 },
314af73323bSHans de Goede { CCI_REG8(0x3362), 0x10 },
315af73323bSHans de Goede { CCI_REG8(0x33b0), 0x50 },
316af73323bSHans de Goede { CCI_REG8(0x33b2), 0x1a },
317af73323bSHans de Goede { CCI_REG8(0x33b3), 0x04 },
318ffbe3d82SDave Stevenson };
319ffbe3d82SDave Stevenson
320ffbe3d82SDave Stevenson #define IMX290_NUM_CLK_REGS 2
321af73323bSHans de Goede static const struct cci_reg_sequence xclk_regs[][IMX290_NUM_CLK_REGS] = {
322ffbe3d82SDave Stevenson [IMX290_CLK_37_125] = {
323ffbe3d82SDave Stevenson { IMX290_EXTCK_FREQ, (37125 * 256) / 1000 },
324ffbe3d82SDave Stevenson { IMX290_INCKSEL7, 0x49 },
325ffbe3d82SDave Stevenson },
326ffbe3d82SDave Stevenson [IMX290_CLK_74_25] = {
327ffbe3d82SDave Stevenson { IMX290_EXTCK_FREQ, (74250 * 256) / 1000 },
328ffbe3d82SDave Stevenson { IMX290_INCKSEL7, 0x92 },
329ffbe3d82SDave Stevenson },
330828dbc29SManivannan Sadhasivam };
331828dbc29SManivannan Sadhasivam
332af73323bSHans de Goede static const struct cci_reg_sequence imx290_global_init_settings_327[] = {
333af73323bSHans de Goede { CCI_REG8(0x309e), 0x4A },
334af73323bSHans de Goede { CCI_REG8(0x309f), 0x4A },
335af73323bSHans de Goede { CCI_REG8(0x313b), 0x61 },
3362d41947eSAlexander Stein };
3372d41947eSAlexander Stein
338af73323bSHans de Goede static const struct cci_reg_sequence imx290_1080p_settings[] = {
339828dbc29SManivannan Sadhasivam /* mode settings */
34079d99ae8SLaurent Pinchart { IMX290_WINWV_OB, 12 },
34179d99ae8SLaurent Pinchart { IMX290_OPB_SIZE_V, 10 },
34279d99ae8SLaurent Pinchart { IMX290_X_OUT_SIZE, 1920 },
34379d99ae8SLaurent Pinchart { IMX290_Y_OUT_SIZE, 1080 },
344828dbc29SManivannan Sadhasivam };
345828dbc29SManivannan Sadhasivam
346af73323bSHans de Goede static const struct cci_reg_sequence imx290_720p_settings[] = {
347828dbc29SManivannan Sadhasivam /* mode settings */
34879d99ae8SLaurent Pinchart { IMX290_WINWV_OB, 6 },
34979d99ae8SLaurent Pinchart { IMX290_OPB_SIZE_V, 4 },
35079d99ae8SLaurent Pinchart { IMX290_X_OUT_SIZE, 1280 },
35179d99ae8SLaurent Pinchart { IMX290_Y_OUT_SIZE, 720 },
352828dbc29SManivannan Sadhasivam };
353828dbc29SManivannan Sadhasivam
354af73323bSHans de Goede static const struct cci_reg_sequence imx290_10bit_settings[] = {
35579d99ae8SLaurent Pinchart { IMX290_ADBIT, IMX290_ADBIT_10BIT },
35679d99ae8SLaurent Pinchart { IMX290_OUT_CTRL, IMX290_ODBIT_10BIT },
35779d99ae8SLaurent Pinchart { IMX290_ADBIT1, IMX290_ADBIT1_10BIT },
35879d99ae8SLaurent Pinchart { IMX290_ADBIT2, IMX290_ADBIT2_10BIT },
35979d99ae8SLaurent Pinchart { IMX290_ADBIT3, IMX290_ADBIT3_10BIT },
36079d99ae8SLaurent Pinchart { IMX290_CSI_DT_FMT, IMX290_CSI_DT_FMT_RAW10 },
361828dbc29SManivannan Sadhasivam };
362828dbc29SManivannan Sadhasivam
363af73323bSHans de Goede static const struct cci_reg_sequence imx290_12bit_settings[] = {
36479d99ae8SLaurent Pinchart { IMX290_ADBIT, IMX290_ADBIT_12BIT },
36579d99ae8SLaurent Pinchart { IMX290_OUT_CTRL, IMX290_ODBIT_12BIT },
36679d99ae8SLaurent Pinchart { IMX290_ADBIT1, IMX290_ADBIT1_12BIT },
36779d99ae8SLaurent Pinchart { IMX290_ADBIT2, IMX290_ADBIT2_12BIT },
36879d99ae8SLaurent Pinchart { IMX290_ADBIT3, IMX290_ADBIT3_12BIT },
36979d99ae8SLaurent Pinchart { IMX290_CSI_DT_FMT, IMX290_CSI_DT_FMT_RAW12 },
370c566ac01SManivannan Sadhasivam };
371c566ac01SManivannan Sadhasivam
372d0347f98SDave Stevenson static const struct imx290_csi_cfg imx290_csi_222_75mhz = {
373d0347f98SDave Stevenson /* 222.75MHz or 445.5Mbit/s per lane */
374d0347f98SDave Stevenson .repetition = 0x10,
375d0347f98SDave Stevenson .tclkpost = 87,
376d0347f98SDave Stevenson .thszero = 55,
377d0347f98SDave Stevenson .thsprepare = 31,
378d0347f98SDave Stevenson .tclktrail = 31,
379d0347f98SDave Stevenson .thstrail = 31,
380d0347f98SDave Stevenson .tclkzero = 119,
381d0347f98SDave Stevenson .tclkprepare = 31,
382d0347f98SDave Stevenson .tlpx = 23,
383d0347f98SDave Stevenson };
384d0347f98SDave Stevenson
385d0347f98SDave Stevenson static const struct imx290_csi_cfg imx290_csi_445_5mhz = {
386d0347f98SDave Stevenson /* 445.5MHz or 891Mbit/s per lane */
387d0347f98SDave Stevenson .repetition = 0x00,
388d0347f98SDave Stevenson .tclkpost = 119,
389d0347f98SDave Stevenson .thszero = 103,
390d0347f98SDave Stevenson .thsprepare = 71,
391d0347f98SDave Stevenson .tclktrail = 55,
392d0347f98SDave Stevenson .thstrail = 63,
393d0347f98SDave Stevenson .tclkzero = 255,
394d0347f98SDave Stevenson .tclkprepare = 63,
395d0347f98SDave Stevenson .tlpx = 55,
396d0347f98SDave Stevenson };
397d0347f98SDave Stevenson
398d0347f98SDave Stevenson static const struct imx290_csi_cfg imx290_csi_148_5mhz = {
399d0347f98SDave Stevenson /* 148.5MHz or 297Mbit/s per lane */
400d0347f98SDave Stevenson .repetition = 0x10,
401d0347f98SDave Stevenson .tclkpost = 79,
402d0347f98SDave Stevenson .thszero = 47,
403d0347f98SDave Stevenson .thsprepare = 23,
404d0347f98SDave Stevenson .tclktrail = 23,
405d0347f98SDave Stevenson .thstrail = 23,
406d0347f98SDave Stevenson .tclkzero = 87,
407d0347f98SDave Stevenson .tclkprepare = 23,
408d0347f98SDave Stevenson .tlpx = 23,
409d0347f98SDave Stevenson };
410d0347f98SDave Stevenson
411d0347f98SDave Stevenson static const struct imx290_csi_cfg imx290_csi_297mhz = {
412d0347f98SDave Stevenson /* 297MHz or 594Mbit/s per lane */
413d0347f98SDave Stevenson .repetition = 0x00,
414d0347f98SDave Stevenson .tclkpost = 103,
415d0347f98SDave Stevenson .thszero = 87,
416d0347f98SDave Stevenson .thsprepare = 47,
417d0347f98SDave Stevenson .tclktrail = 39,
418d0347f98SDave Stevenson .thstrail = 47,
419d0347f98SDave Stevenson .tclkzero = 191,
420d0347f98SDave Stevenson .tclkprepare = 47,
421d0347f98SDave Stevenson .tlpx = 39,
422d0347f98SDave Stevenson };
423d0347f98SDave Stevenson
424828dbc29SManivannan Sadhasivam /* supported link frequencies */
42598e0500eSManivannan Sadhasivam #define FREQ_INDEX_1080P 0
42698e0500eSManivannan Sadhasivam #define FREQ_INDEX_720P 1
42798e0500eSManivannan Sadhasivam static const s64 imx290_link_freq_2lanes[] = {
42898e0500eSManivannan Sadhasivam [FREQ_INDEX_1080P] = 445500000,
42998e0500eSManivannan Sadhasivam [FREQ_INDEX_720P] = 297000000,
430828dbc29SManivannan Sadhasivam };
4319a78e937SDave Stevenson
43298e0500eSManivannan Sadhasivam static const s64 imx290_link_freq_4lanes[] = {
43398e0500eSManivannan Sadhasivam [FREQ_INDEX_1080P] = 222750000,
43498e0500eSManivannan Sadhasivam [FREQ_INDEX_720P] = 148500000,
43598e0500eSManivannan Sadhasivam };
43698e0500eSManivannan Sadhasivam
43798e0500eSManivannan Sadhasivam /*
43898e0500eSManivannan Sadhasivam * In this function and in the similar ones below We rely on imx290_probe()
43998e0500eSManivannan Sadhasivam * to ensure that nlanes is either 2 or 4.
44098e0500eSManivannan Sadhasivam */
imx290_link_freqs_ptr(const struct imx290 * imx290)44198e0500eSManivannan Sadhasivam static inline const s64 *imx290_link_freqs_ptr(const struct imx290 *imx290)
44298e0500eSManivannan Sadhasivam {
44398e0500eSManivannan Sadhasivam if (imx290->nlanes == 2)
44498e0500eSManivannan Sadhasivam return imx290_link_freq_2lanes;
44598e0500eSManivannan Sadhasivam else
44698e0500eSManivannan Sadhasivam return imx290_link_freq_4lanes;
44798e0500eSManivannan Sadhasivam }
44898e0500eSManivannan Sadhasivam
imx290_link_freqs_num(const struct imx290 * imx290)44998e0500eSManivannan Sadhasivam static inline int imx290_link_freqs_num(const struct imx290 *imx290)
45098e0500eSManivannan Sadhasivam {
45198e0500eSManivannan Sadhasivam if (imx290->nlanes == 2)
45298e0500eSManivannan Sadhasivam return ARRAY_SIZE(imx290_link_freq_2lanes);
45398e0500eSManivannan Sadhasivam else
45498e0500eSManivannan Sadhasivam return ARRAY_SIZE(imx290_link_freq_4lanes);
45598e0500eSManivannan Sadhasivam }
456828dbc29SManivannan Sadhasivam
457ffbe3d82SDave Stevenson static const struct imx290_clk_cfg imx290_1080p_clock_config[] = {
458ffbe3d82SDave Stevenson [IMX290_CLK_37_125] = {
459ffbe3d82SDave Stevenson /* 37.125MHz clock config */
460ffbe3d82SDave Stevenson .incksel1 = 0x18,
461ffbe3d82SDave Stevenson .incksel2 = 0x03,
462ffbe3d82SDave Stevenson .incksel3 = 0x20,
463ffbe3d82SDave Stevenson .incksel4 = 0x01,
464ffbe3d82SDave Stevenson .incksel5 = 0x1a,
465ffbe3d82SDave Stevenson .incksel6 = 0x1a,
466ffbe3d82SDave Stevenson },
467ffbe3d82SDave Stevenson [IMX290_CLK_74_25] = {
468ffbe3d82SDave Stevenson /* 74.25MHz clock config */
469ffbe3d82SDave Stevenson .incksel1 = 0x0c,
470ffbe3d82SDave Stevenson .incksel2 = 0x03,
471ffbe3d82SDave Stevenson .incksel3 = 0x10,
472ffbe3d82SDave Stevenson .incksel4 = 0x01,
473ffbe3d82SDave Stevenson .incksel5 = 0x1b,
474ffbe3d82SDave Stevenson .incksel6 = 0x1b,
475ffbe3d82SDave Stevenson },
476ffbe3d82SDave Stevenson };
477ffbe3d82SDave Stevenson
478ffbe3d82SDave Stevenson static const struct imx290_clk_cfg imx290_720p_clock_config[] = {
479ffbe3d82SDave Stevenson [IMX290_CLK_37_125] = {
480ffbe3d82SDave Stevenson /* 37.125MHz clock config */
481ffbe3d82SDave Stevenson .incksel1 = 0x20,
482ffbe3d82SDave Stevenson .incksel2 = 0x00,
483ffbe3d82SDave Stevenson .incksel3 = 0x20,
484ffbe3d82SDave Stevenson .incksel4 = 0x01,
485ffbe3d82SDave Stevenson .incksel5 = 0x1a,
486ffbe3d82SDave Stevenson .incksel6 = 0x1a,
487ffbe3d82SDave Stevenson },
488ffbe3d82SDave Stevenson [IMX290_CLK_74_25] = {
489ffbe3d82SDave Stevenson /* 74.25MHz clock config */
490ffbe3d82SDave Stevenson .incksel1 = 0x10,
491ffbe3d82SDave Stevenson .incksel2 = 0x00,
492ffbe3d82SDave Stevenson .incksel3 = 0x10,
493ffbe3d82SDave Stevenson .incksel4 = 0x01,
494ffbe3d82SDave Stevenson .incksel5 = 0x1b,
495ffbe3d82SDave Stevenson .incksel6 = 0x1b,
496ffbe3d82SDave Stevenson },
497ffbe3d82SDave Stevenson };
498ffbe3d82SDave Stevenson
499828dbc29SManivannan Sadhasivam /* Mode configs */
50097589ad6SManivannan Sadhasivam static const struct imx290_mode imx290_modes_2lanes[] = {
501828dbc29SManivannan Sadhasivam {
502828dbc29SManivannan Sadhasivam .width = 1920,
503828dbc29SManivannan Sadhasivam .height = 1080,
50408a0061dSDave Stevenson .hmax_min = 2200,
505bdb55fb2SDave Stevenson .vmax_min = 1125,
50698e0500eSManivannan Sadhasivam .link_freq_index = FREQ_INDEX_1080P,
507924350aeSDave Stevenson .ctrl_07 = IMX290_WINMODE_1080P,
508828dbc29SManivannan Sadhasivam .data = imx290_1080p_settings,
509828dbc29SManivannan Sadhasivam .data_size = ARRAY_SIZE(imx290_1080p_settings),
510ffbe3d82SDave Stevenson .clk_cfg = imx290_1080p_clock_config,
511828dbc29SManivannan Sadhasivam },
512828dbc29SManivannan Sadhasivam {
513828dbc29SManivannan Sadhasivam .width = 1280,
514828dbc29SManivannan Sadhasivam .height = 720,
51508a0061dSDave Stevenson .hmax_min = 3300,
516bdb55fb2SDave Stevenson .vmax_min = 750,
51798e0500eSManivannan Sadhasivam .link_freq_index = FREQ_INDEX_720P,
518924350aeSDave Stevenson .ctrl_07 = IMX290_WINMODE_720P,
519828dbc29SManivannan Sadhasivam .data = imx290_720p_settings,
520828dbc29SManivannan Sadhasivam .data_size = ARRAY_SIZE(imx290_720p_settings),
521ffbe3d82SDave Stevenson .clk_cfg = imx290_720p_clock_config,
522828dbc29SManivannan Sadhasivam },
523828dbc29SManivannan Sadhasivam };
524828dbc29SManivannan Sadhasivam
52597589ad6SManivannan Sadhasivam static const struct imx290_mode imx290_modes_4lanes[] = {
52697589ad6SManivannan Sadhasivam {
52797589ad6SManivannan Sadhasivam .width = 1920,
52897589ad6SManivannan Sadhasivam .height = 1080,
52908a0061dSDave Stevenson .hmax_min = 2200,
530bdb55fb2SDave Stevenson .vmax_min = 1125,
53198e0500eSManivannan Sadhasivam .link_freq_index = FREQ_INDEX_1080P,
532924350aeSDave Stevenson .ctrl_07 = IMX290_WINMODE_1080P,
53397589ad6SManivannan Sadhasivam .data = imx290_1080p_settings,
53497589ad6SManivannan Sadhasivam .data_size = ARRAY_SIZE(imx290_1080p_settings),
535ffbe3d82SDave Stevenson .clk_cfg = imx290_1080p_clock_config,
53697589ad6SManivannan Sadhasivam },
53797589ad6SManivannan Sadhasivam {
53897589ad6SManivannan Sadhasivam .width = 1280,
53997589ad6SManivannan Sadhasivam .height = 720,
54008a0061dSDave Stevenson .hmax_min = 3300,
541bdb55fb2SDave Stevenson .vmax_min = 750,
54298e0500eSManivannan Sadhasivam .link_freq_index = FREQ_INDEX_720P,
543924350aeSDave Stevenson .ctrl_07 = IMX290_WINMODE_720P,
54497589ad6SManivannan Sadhasivam .data = imx290_720p_settings,
54597589ad6SManivannan Sadhasivam .data_size = ARRAY_SIZE(imx290_720p_settings),
546ffbe3d82SDave Stevenson .clk_cfg = imx290_720p_clock_config,
54797589ad6SManivannan Sadhasivam },
54897589ad6SManivannan Sadhasivam };
54997589ad6SManivannan Sadhasivam
imx290_modes_ptr(const struct imx290 * imx290)55097589ad6SManivannan Sadhasivam static inline const struct imx290_mode *imx290_modes_ptr(const struct imx290 *imx290)
55197589ad6SManivannan Sadhasivam {
55297589ad6SManivannan Sadhasivam if (imx290->nlanes == 2)
55397589ad6SManivannan Sadhasivam return imx290_modes_2lanes;
55497589ad6SManivannan Sadhasivam else
55597589ad6SManivannan Sadhasivam return imx290_modes_4lanes;
55697589ad6SManivannan Sadhasivam }
55797589ad6SManivannan Sadhasivam
imx290_modes_num(const struct imx290 * imx290)55897589ad6SManivannan Sadhasivam static inline int imx290_modes_num(const struct imx290 *imx290)
55997589ad6SManivannan Sadhasivam {
56097589ad6SManivannan Sadhasivam if (imx290->nlanes == 2)
56197589ad6SManivannan Sadhasivam return ARRAY_SIZE(imx290_modes_2lanes);
56297589ad6SManivannan Sadhasivam else
56397589ad6SManivannan Sadhasivam return ARRAY_SIZE(imx290_modes_4lanes);
56497589ad6SManivannan Sadhasivam }
56597589ad6SManivannan Sadhasivam
56610591fe6SLaurent Pinchart struct imx290_format_info {
5678bb19dd7SDave Stevenson u32 code[IMX290_VARIANT_MAX];
568cb7e1c8dSLaurent Pinchart u8 bpp;
569af73323bSHans de Goede const struct cci_reg_sequence *regs;
57010591fe6SLaurent Pinchart unsigned int num_regs;
571cb7e1c8dSLaurent Pinchart };
572cb7e1c8dSLaurent Pinchart
57310591fe6SLaurent Pinchart static const struct imx290_format_info imx290_formats[] = {
57410591fe6SLaurent Pinchart {
5758bb19dd7SDave Stevenson .code = {
5768bb19dd7SDave Stevenson [IMX290_VARIANT_COLOUR] = MEDIA_BUS_FMT_SRGGB10_1X10,
5778bb19dd7SDave Stevenson [IMX290_VARIANT_MONO] = MEDIA_BUS_FMT_Y10_1X10
5788bb19dd7SDave Stevenson },
57910591fe6SLaurent Pinchart .bpp = 10,
58010591fe6SLaurent Pinchart .regs = imx290_10bit_settings,
58110591fe6SLaurent Pinchart .num_regs = ARRAY_SIZE(imx290_10bit_settings),
58210591fe6SLaurent Pinchart }, {
5838bb19dd7SDave Stevenson .code = {
5848bb19dd7SDave Stevenson [IMX290_VARIANT_COLOUR] = MEDIA_BUS_FMT_SRGGB12_1X12,
5858bb19dd7SDave Stevenson [IMX290_VARIANT_MONO] = MEDIA_BUS_FMT_Y12_1X12
5868bb19dd7SDave Stevenson },
58710591fe6SLaurent Pinchart .bpp = 12,
58810591fe6SLaurent Pinchart .regs = imx290_12bit_settings,
58910591fe6SLaurent Pinchart .num_regs = ARRAY_SIZE(imx290_12bit_settings),
59010591fe6SLaurent Pinchart }
591cb7e1c8dSLaurent Pinchart };
592cb7e1c8dSLaurent Pinchart
5938bb19dd7SDave Stevenson static const struct imx290_format_info *
imx290_format_info(const struct imx290 * imx290,u32 code)5948bb19dd7SDave Stevenson imx290_format_info(const struct imx290 *imx290, u32 code)
59510591fe6SLaurent Pinchart {
59610591fe6SLaurent Pinchart unsigned int i;
59710591fe6SLaurent Pinchart
59810591fe6SLaurent Pinchart for (i = 0; i < ARRAY_SIZE(imx290_formats); ++i) {
59910591fe6SLaurent Pinchart const struct imx290_format_info *info = &imx290_formats[i];
60010591fe6SLaurent Pinchart
6018bb19dd7SDave Stevenson if (info->code[imx290->model->colour_variant] == code)
60210591fe6SLaurent Pinchart return info;
60310591fe6SLaurent Pinchart }
60410591fe6SLaurent Pinchart
60510591fe6SLaurent Pinchart return NULL;
60610591fe6SLaurent Pinchart }
60710591fe6SLaurent Pinchart
imx290_set_register_array(struct imx290 * imx290,const struct cci_reg_sequence * settings,unsigned int num_settings)608828dbc29SManivannan Sadhasivam static int imx290_set_register_array(struct imx290 *imx290,
609af73323bSHans de Goede const struct cci_reg_sequence *settings,
610828dbc29SManivannan Sadhasivam unsigned int num_settings)
611828dbc29SManivannan Sadhasivam {
612828dbc29SManivannan Sadhasivam int ret;
613828dbc29SManivannan Sadhasivam
614af73323bSHans de Goede ret = cci_multi_reg_write(imx290->regmap, settings, num_settings, NULL);
615828dbc29SManivannan Sadhasivam if (ret < 0)
616828dbc29SManivannan Sadhasivam return ret;
617828dbc29SManivannan Sadhasivam
6186544af9bSManivannan Sadhasivam /* Provide 10ms settle time */
6198e5652aeSAndrey Konovalov usleep_range(10000, 11000);
6206544af9bSManivannan Sadhasivam
621828dbc29SManivannan Sadhasivam return 0;
622828dbc29SManivannan Sadhasivam }
623828dbc29SManivannan Sadhasivam
imx290_set_clock(struct imx290 * imx290)624ffbe3d82SDave Stevenson static int imx290_set_clock(struct imx290 *imx290)
625ffbe3d82SDave Stevenson {
626ffbe3d82SDave Stevenson const struct imx290_mode *mode = imx290->current_mode;
627ffbe3d82SDave Stevenson enum imx290_clk_freq clk_idx = imx290->xclk_idx;
628ffbe3d82SDave Stevenson const struct imx290_clk_cfg *clk_cfg = &mode->clk_cfg[clk_idx];
629ffbe3d82SDave Stevenson int ret;
630ffbe3d82SDave Stevenson
631ffbe3d82SDave Stevenson ret = imx290_set_register_array(imx290, xclk_regs[clk_idx],
632ffbe3d82SDave Stevenson IMX290_NUM_CLK_REGS);
633ffbe3d82SDave Stevenson
634af73323bSHans de Goede cci_write(imx290->regmap, IMX290_INCKSEL1, clk_cfg->incksel1, &ret);
635af73323bSHans de Goede cci_write(imx290->regmap, IMX290_INCKSEL2, clk_cfg->incksel2, &ret);
636af73323bSHans de Goede cci_write(imx290->regmap, IMX290_INCKSEL3, clk_cfg->incksel3, &ret);
637af73323bSHans de Goede cci_write(imx290->regmap, IMX290_INCKSEL4, clk_cfg->incksel4, &ret);
638af73323bSHans de Goede cci_write(imx290->regmap, IMX290_INCKSEL5, clk_cfg->incksel5, &ret);
639af73323bSHans de Goede cci_write(imx290->regmap, IMX290_INCKSEL6, clk_cfg->incksel6, &ret);
640ffbe3d82SDave Stevenson
641ffbe3d82SDave Stevenson return ret;
642ffbe3d82SDave Stevenson }
643ffbe3d82SDave Stevenson
imx290_set_data_lanes(struct imx290 * imx290)644cb7e1c8dSLaurent Pinchart static int imx290_set_data_lanes(struct imx290 *imx290)
645828dbc29SManivannan Sadhasivam {
64676c00128SLaurent Pinchart int ret = 0;
647828dbc29SManivannan Sadhasivam
648af73323bSHans de Goede cci_write(imx290->regmap, IMX290_PHY_LANE_NUM, imx290->nlanes - 1,
649af73323bSHans de Goede &ret);
650af73323bSHans de Goede cci_write(imx290->regmap, IMX290_CSI_LANE_MODE, imx290->nlanes - 1,
651af73323bSHans de Goede &ret);
652af73323bSHans de Goede cci_write(imx290->regmap, IMX290_FR_FDG_SEL, 0x01, &ret);
653cb7e1c8dSLaurent Pinchart
654cb7e1c8dSLaurent Pinchart return ret;
655cb7e1c8dSLaurent Pinchart }
656cb7e1c8dSLaurent Pinchart
imx290_set_black_level(struct imx290 * imx290,const struct v4l2_mbus_framefmt * format,unsigned int black_level,int * err)657ee4ce893SLaurent Pinchart static int imx290_set_black_level(struct imx290 *imx290,
65810591fe6SLaurent Pinchart const struct v4l2_mbus_framefmt *format,
659ee4ce893SLaurent Pinchart unsigned int black_level, int *err)
660ee4ce893SLaurent Pinchart {
6618bb19dd7SDave Stevenson unsigned int bpp = imx290_format_info(imx290, format->code)->bpp;
66210591fe6SLaurent Pinchart
663af73323bSHans de Goede return cci_write(imx290->regmap, IMX290_BLKLEVEL,
66410591fe6SLaurent Pinchart black_level >> (16 - bpp), err);
665ee4ce893SLaurent Pinchart }
666ee4ce893SLaurent Pinchart
imx290_set_csi_config(struct imx290 * imx290)667d0347f98SDave Stevenson static int imx290_set_csi_config(struct imx290 *imx290)
668d0347f98SDave Stevenson {
669d0347f98SDave Stevenson const s64 *link_freqs = imx290_link_freqs_ptr(imx290);
670d0347f98SDave Stevenson const struct imx290_csi_cfg *csi_cfg;
671d0347f98SDave Stevenson int ret = 0;
672d0347f98SDave Stevenson
673d0347f98SDave Stevenson switch (link_freqs[imx290->current_mode->link_freq_index]) {
674d0347f98SDave Stevenson case 445500000:
675d0347f98SDave Stevenson csi_cfg = &imx290_csi_445_5mhz;
676d0347f98SDave Stevenson break;
677d0347f98SDave Stevenson case 297000000:
678d0347f98SDave Stevenson csi_cfg = &imx290_csi_297mhz;
679d0347f98SDave Stevenson break;
680d0347f98SDave Stevenson case 222750000:
681d0347f98SDave Stevenson csi_cfg = &imx290_csi_222_75mhz;
682d0347f98SDave Stevenson break;
683d0347f98SDave Stevenson case 148500000:
684d0347f98SDave Stevenson csi_cfg = &imx290_csi_148_5mhz;
685d0347f98SDave Stevenson break;
686d0347f98SDave Stevenson default:
687d0347f98SDave Stevenson return -EINVAL;
688d0347f98SDave Stevenson }
689d0347f98SDave Stevenson
690af73323bSHans de Goede cci_write(imx290->regmap, IMX290_REPETITION, csi_cfg->repetition, &ret);
691af73323bSHans de Goede cci_write(imx290->regmap, IMX290_TCLKPOST, csi_cfg->tclkpost, &ret);
692af73323bSHans de Goede cci_write(imx290->regmap, IMX290_THSZERO, csi_cfg->thszero, &ret);
693af73323bSHans de Goede cci_write(imx290->regmap, IMX290_THSPREPARE, csi_cfg->thsprepare, &ret);
694af73323bSHans de Goede cci_write(imx290->regmap, IMX290_TCLKTRAIL, csi_cfg->tclktrail, &ret);
695af73323bSHans de Goede cci_write(imx290->regmap, IMX290_THSTRAIL, csi_cfg->thstrail, &ret);
696af73323bSHans de Goede cci_write(imx290->regmap, IMX290_TCLKZERO, csi_cfg->tclkzero, &ret);
697af73323bSHans de Goede cci_write(imx290->regmap, IMX290_TCLKPREPARE, csi_cfg->tclkprepare,
698af73323bSHans de Goede &ret);
699af73323bSHans de Goede cci_write(imx290->regmap, IMX290_TLPX, csi_cfg->tlpx, &ret);
700d0347f98SDave Stevenson
701d0347f98SDave Stevenson return ret;
702d0347f98SDave Stevenson }
703d0347f98SDave Stevenson
imx290_setup_format(struct imx290 * imx290,const struct v4l2_mbus_framefmt * format)704a2514b9aSLaurent Pinchart static int imx290_setup_format(struct imx290 *imx290,
705a2514b9aSLaurent Pinchart const struct v4l2_mbus_framefmt *format)
706cb7e1c8dSLaurent Pinchart {
70710591fe6SLaurent Pinchart const struct imx290_format_info *info;
708cb7e1c8dSLaurent Pinchart int ret;
709cb7e1c8dSLaurent Pinchart
7108bb19dd7SDave Stevenson info = imx290_format_info(imx290, format->code);
711cb7e1c8dSLaurent Pinchart
71210591fe6SLaurent Pinchart ret = imx290_set_register_array(imx290, info->regs, info->num_regs);
713ee4ce893SLaurent Pinchart if (ret < 0) {
714ee4ce893SLaurent Pinchart dev_err(imx290->dev, "Could not set format registers\n");
715ee4ce893SLaurent Pinchart return ret;
716ee4ce893SLaurent Pinchart }
717ee4ce893SLaurent Pinchart
71810591fe6SLaurent Pinchart return imx290_set_black_level(imx290, format,
71910591fe6SLaurent Pinchart IMX290_BLACK_LEVEL_DEFAULT, &ret);
720cb7e1c8dSLaurent Pinchart }
721cb7e1c8dSLaurent Pinchart
722cb7e1c8dSLaurent Pinchart /* ----------------------------------------------------------------------------
723cb7e1c8dSLaurent Pinchart * Controls
724cb7e1c8dSLaurent Pinchart */
imx290_exposure_update(struct imx290 * imx290,const struct imx290_mode * mode)7259fe4eee9SDave Stevenson static void imx290_exposure_update(struct imx290 *imx290,
7269fe4eee9SDave Stevenson const struct imx290_mode *mode)
7279fe4eee9SDave Stevenson {
7289fe4eee9SDave Stevenson unsigned int exposure_max;
7299fe4eee9SDave Stevenson
7309fe4eee9SDave Stevenson exposure_max = imx290->vblank->val + mode->height -
7319fe4eee9SDave Stevenson IMX290_EXPOSURE_OFFSET;
7329fe4eee9SDave Stevenson __v4l2_ctrl_modify_range(imx290->exposure, 1, exposure_max, 1,
7339fe4eee9SDave Stevenson exposure_max);
7349fe4eee9SDave Stevenson }
735cb7e1c8dSLaurent Pinchart
imx290_set_ctrl(struct v4l2_ctrl * ctrl)736828dbc29SManivannan Sadhasivam static int imx290_set_ctrl(struct v4l2_ctrl *ctrl)
737828dbc29SManivannan Sadhasivam {
738828dbc29SManivannan Sadhasivam struct imx290 *imx290 = container_of(ctrl->handler,
739828dbc29SManivannan Sadhasivam struct imx290, ctrls);
74010591fe6SLaurent Pinchart const struct v4l2_mbus_framefmt *format;
74110591fe6SLaurent Pinchart struct v4l2_subdev_state *state;
7429fe4eee9SDave Stevenson int ret = 0, vmax;
743828dbc29SManivannan Sadhasivam
744a2514b9aSLaurent Pinchart /*
745a2514b9aSLaurent Pinchart * Return immediately for controls that don't need to be applied to the
74602852c01SLaurent Pinchart * device.
747a2514b9aSLaurent Pinchart */
748a2514b9aSLaurent Pinchart if (ctrl->flags & V4L2_CTRL_FLAG_READ_ONLY)
749a2514b9aSLaurent Pinchart return 0;
750a2514b9aSLaurent Pinchart
7519fe4eee9SDave Stevenson if (ctrl->id == V4L2_CID_VBLANK) {
7529fe4eee9SDave Stevenson /* Changing vblank changes the allowed range for exposure. */
7539fe4eee9SDave Stevenson imx290_exposure_update(imx290, imx290->current_mode);
7549fe4eee9SDave Stevenson }
7559fe4eee9SDave Stevenson
756828dbc29SManivannan Sadhasivam /* V4L2 controls values will be applied only when power is already up */
757828dbc29SManivannan Sadhasivam if (!pm_runtime_get_if_in_use(imx290->dev))
758828dbc29SManivannan Sadhasivam return 0;
759828dbc29SManivannan Sadhasivam
76010591fe6SLaurent Pinchart state = v4l2_subdev_get_locked_active_state(&imx290->sd);
76110591fe6SLaurent Pinchart format = v4l2_subdev_get_pad_format(&imx290->sd, state, 0);
76210591fe6SLaurent Pinchart
763828dbc29SManivannan Sadhasivam switch (ctrl->id) {
7643dd10515SLaurent Pinchart case V4L2_CID_ANALOGUE_GAIN:
765af73323bSHans de Goede ret = cci_write(imx290->regmap, IMX290_GAIN, ctrl->val, NULL);
766828dbc29SManivannan Sadhasivam break;
767827c7e69SLaurent Pinchart
7689fe4eee9SDave Stevenson case V4L2_CID_VBLANK:
769af73323bSHans de Goede ret = cci_write(imx290->regmap, IMX290_VMAX,
770af73323bSHans de Goede ctrl->val + imx290->current_mode->height, NULL);
7719fe4eee9SDave Stevenson /*
7729fe4eee9SDave Stevenson * Due to the way that exposure is programmed in this sensor in
7739fe4eee9SDave Stevenson * relation to VMAX, we have to reprogramme it whenever VMAX is
7749fe4eee9SDave Stevenson * changed.
7759fe4eee9SDave Stevenson * Update ctrl so that the V4L2_CID_EXPOSURE case can refer to
7769fe4eee9SDave Stevenson * it.
7779fe4eee9SDave Stevenson */
7789fe4eee9SDave Stevenson ctrl = imx290->exposure;
7799fe4eee9SDave Stevenson fallthrough;
780827c7e69SLaurent Pinchart case V4L2_CID_EXPOSURE:
7819fe4eee9SDave Stevenson vmax = imx290->vblank->val + imx290->current_mode->height;
782af73323bSHans de Goede ret = cci_write(imx290->regmap, IMX290_SHS1,
7839fe4eee9SDave Stevenson vmax - ctrl->val - 1, NULL);
784827c7e69SLaurent Pinchart break;
785827c7e69SLaurent Pinchart
786a58df1f9SManivannan Sadhasivam case V4L2_CID_TEST_PATTERN:
787a58df1f9SManivannan Sadhasivam if (ctrl->val) {
78810591fe6SLaurent Pinchart imx290_set_black_level(imx290, format, 0, &ret);
7898e5652aeSAndrey Konovalov usleep_range(10000, 11000);
790af73323bSHans de Goede cci_write(imx290->regmap, IMX290_PGCTRL,
791a58df1f9SManivannan Sadhasivam (u8)(IMX290_PGCTRL_REGEN |
792a58df1f9SManivannan Sadhasivam IMX290_PGCTRL_THRU |
793e611f3daSLaurent Pinchart IMX290_PGCTRL_MODE(ctrl->val)), &ret);
794a58df1f9SManivannan Sadhasivam } else {
795af73323bSHans de Goede cci_write(imx290->regmap, IMX290_PGCTRL, 0x00, &ret);
7968e5652aeSAndrey Konovalov usleep_range(10000, 11000);
79710591fe6SLaurent Pinchart imx290_set_black_level(imx290, format,
79810591fe6SLaurent Pinchart IMX290_BLACK_LEVEL_DEFAULT, &ret);
799a58df1f9SManivannan Sadhasivam }
800a58df1f9SManivannan Sadhasivam break;
801a2514b9aSLaurent Pinchart
80208a0061dSDave Stevenson case V4L2_CID_HBLANK:
803af73323bSHans de Goede ret = cci_write(imx290->regmap, IMX290_HMAX,
804af73323bSHans de Goede ctrl->val + imx290->current_mode->width, NULL);
80508a0061dSDave Stevenson break;
80608a0061dSDave Stevenson
807924350aeSDave Stevenson case V4L2_CID_HFLIP:
808924350aeSDave Stevenson case V4L2_CID_VFLIP:
809924350aeSDave Stevenson {
810924350aeSDave Stevenson u32 reg;
811924350aeSDave Stevenson
812924350aeSDave Stevenson reg = imx290->current_mode->ctrl_07;
813924350aeSDave Stevenson if (imx290->hflip->val)
814924350aeSDave Stevenson reg |= IMX290_HREVERSE;
815924350aeSDave Stevenson if (imx290->vflip->val)
816924350aeSDave Stevenson reg |= IMX290_VREVERSE;
817af73323bSHans de Goede ret = cci_write(imx290->regmap, IMX290_CTRL_07, reg, NULL);
818924350aeSDave Stevenson break;
819924350aeSDave Stevenson }
820924350aeSDave Stevenson
821828dbc29SManivannan Sadhasivam default:
822828dbc29SManivannan Sadhasivam ret = -EINVAL;
823828dbc29SManivannan Sadhasivam break;
824828dbc29SManivannan Sadhasivam }
825828dbc29SManivannan Sadhasivam
826a8c3e0c1SLaurent Pinchart pm_runtime_mark_last_busy(imx290->dev);
827a8c3e0c1SLaurent Pinchart pm_runtime_put_autosuspend(imx290->dev);
828828dbc29SManivannan Sadhasivam
829828dbc29SManivannan Sadhasivam return ret;
830828dbc29SManivannan Sadhasivam }
831828dbc29SManivannan Sadhasivam
832828dbc29SManivannan Sadhasivam static const struct v4l2_ctrl_ops imx290_ctrl_ops = {
833828dbc29SManivannan Sadhasivam .s_ctrl = imx290_set_ctrl,
834828dbc29SManivannan Sadhasivam };
835828dbc29SManivannan Sadhasivam
836cb7e1c8dSLaurent Pinchart static const char * const imx290_test_pattern_menu[] = {
837cb7e1c8dSLaurent Pinchart "Disabled",
838cb7e1c8dSLaurent Pinchart "Sequence Pattern 1",
839cb7e1c8dSLaurent Pinchart "Horizontal Color-bar Chart",
840cb7e1c8dSLaurent Pinchart "Vertical Color-bar Chart",
841cb7e1c8dSLaurent Pinchart "Sequence Pattern 2",
842cb7e1c8dSLaurent Pinchart "Gradation Pattern 1",
843cb7e1c8dSLaurent Pinchart "Gradation Pattern 2",
844cb7e1c8dSLaurent Pinchart "000/555h Toggle Pattern",
845cb7e1c8dSLaurent Pinchart };
846cb7e1c8dSLaurent Pinchart
imx290_ctrl_update(struct imx290 * imx290,const struct imx290_mode * mode)847a7941da3SLaurent Pinchart static void imx290_ctrl_update(struct imx290 *imx290,
848a7941da3SLaurent Pinchart const struct imx290_mode *mode)
849a7941da3SLaurent Pinchart {
85008a0061dSDave Stevenson unsigned int hblank_min = mode->hmax_min - mode->width;
85108a0061dSDave Stevenson unsigned int hblank_max = IMX290_HMAX_MAX - mode->width;
852bdb55fb2SDave Stevenson unsigned int vblank_min = mode->vmax_min - mode->height;
8539fe4eee9SDave Stevenson unsigned int vblank_max = IMX290_VMAX_MAX - mode->height;
854693b5cb5SLaurent Pinchart
85570bbf56aSLaurent Pinchart __v4l2_ctrl_s_ctrl(imx290->link_freq, mode->link_freq_index);
856a7941da3SLaurent Pinchart
85708a0061dSDave Stevenson __v4l2_ctrl_modify_range(imx290->hblank, hblank_min, hblank_max, 1,
85808a0061dSDave Stevenson hblank_min);
8599fe4eee9SDave Stevenson __v4l2_ctrl_modify_range(imx290->vblank, vblank_min, vblank_max, 1,
8609fe4eee9SDave Stevenson vblank_min);
861a7941da3SLaurent Pinchart }
862a7941da3SLaurent Pinchart
imx290_ctrl_init(struct imx290 * imx290)863cb7e1c8dSLaurent Pinchart static int imx290_ctrl_init(struct imx290 *imx290)
864cb7e1c8dSLaurent Pinchart {
865cb7e1c8dSLaurent Pinchart struct v4l2_fwnode_device_properties props;
866cb7e1c8dSLaurent Pinchart int ret;
867cb7e1c8dSLaurent Pinchart
868cb7e1c8dSLaurent Pinchart ret = v4l2_fwnode_device_parse(imx290->dev, &props);
869cb7e1c8dSLaurent Pinchart if (ret < 0)
870cb7e1c8dSLaurent Pinchart return ret;
871cb7e1c8dSLaurent Pinchart
872924350aeSDave Stevenson v4l2_ctrl_handler_init(&imx290->ctrls, 11);
873cb7e1c8dSLaurent Pinchart
874cb7e1c8dSLaurent Pinchart /*
875cb7e1c8dSLaurent Pinchart * The sensor has an analog gain and a digital gain, both controlled
876cb7e1c8dSLaurent Pinchart * through a single gain value, expressed in 0.3dB increments. Values
877cb7e1c8dSLaurent Pinchart * from 0.0dB (0) to 30.0dB (100) apply analog gain only, higher values
878cb7e1c8dSLaurent Pinchart * up to 72.0dB (240) add further digital gain. Limit the range to
879cb7e1c8dSLaurent Pinchart * analog gain only, support for digital gain can be added separately
880cb7e1c8dSLaurent Pinchart * if needed.
881cb7e1c8dSLaurent Pinchart *
882cb7e1c8dSLaurent Pinchart * The IMX327 and IMX462 are largely compatible with the IMX290, but
883cb7e1c8dSLaurent Pinchart * have an analog gain range of 0.0dB to 29.4dB and 42dB of digital
884cb7e1c8dSLaurent Pinchart * gain. When support for those sensors gets added to the driver, the
885cb7e1c8dSLaurent Pinchart * gain control should be adjusted accordingly.
886cb7e1c8dSLaurent Pinchart */
887cb7e1c8dSLaurent Pinchart v4l2_ctrl_new_std(&imx290->ctrls, &imx290_ctrl_ops,
888cb7e1c8dSLaurent Pinchart V4L2_CID_ANALOGUE_GAIN, 0, 100, 1, 0);
889cb7e1c8dSLaurent Pinchart
8909fe4eee9SDave Stevenson /*
8919fe4eee9SDave Stevenson * Correct range will be determined through imx290_ctrl_update setting
8929fe4eee9SDave Stevenson * V4L2_CID_VBLANK.
8939fe4eee9SDave Stevenson */
8949fe4eee9SDave Stevenson imx290->exposure = v4l2_ctrl_new_std(&imx290->ctrls, &imx290_ctrl_ops,
8959fe4eee9SDave Stevenson V4L2_CID_EXPOSURE, 1, 65535, 1,
8969fe4eee9SDave Stevenson 65535);
897cb7e1c8dSLaurent Pinchart
898693b5cb5SLaurent Pinchart /*
899693b5cb5SLaurent Pinchart * Set the link frequency, pixel rate, horizontal blanking and vertical
900693b5cb5SLaurent Pinchart * blanking to hardcoded values, they will be updated by
901693b5cb5SLaurent Pinchart * imx290_ctrl_update().
902693b5cb5SLaurent Pinchart */
903cb7e1c8dSLaurent Pinchart imx290->link_freq =
904cb7e1c8dSLaurent Pinchart v4l2_ctrl_new_int_menu(&imx290->ctrls, &imx290_ctrl_ops,
905cb7e1c8dSLaurent Pinchart V4L2_CID_LINK_FREQ,
906cb7e1c8dSLaurent Pinchart imx290_link_freqs_num(imx290) - 1, 0,
907cb7e1c8dSLaurent Pinchart imx290_link_freqs_ptr(imx290));
908cb7e1c8dSLaurent Pinchart if (imx290->link_freq)
909cb7e1c8dSLaurent Pinchart imx290->link_freq->flags |= V4L2_CTRL_FLAG_READ_ONLY;
910cb7e1c8dSLaurent Pinchart
911bc35f9a2SDave Stevenson v4l2_ctrl_new_std(&imx290->ctrls, &imx290_ctrl_ops, V4L2_CID_PIXEL_RATE,
912bc35f9a2SDave Stevenson IMX290_PIXEL_RATE, IMX290_PIXEL_RATE, 1,
913bc35f9a2SDave Stevenson IMX290_PIXEL_RATE);
914cb7e1c8dSLaurent Pinchart
915cb7e1c8dSLaurent Pinchart v4l2_ctrl_new_std_menu_items(&imx290->ctrls, &imx290_ctrl_ops,
916cb7e1c8dSLaurent Pinchart V4L2_CID_TEST_PATTERN,
917cb7e1c8dSLaurent Pinchart ARRAY_SIZE(imx290_test_pattern_menu) - 1,
918cb7e1c8dSLaurent Pinchart 0, 0, imx290_test_pattern_menu);
919cb7e1c8dSLaurent Pinchart
92008a0061dSDave Stevenson /*
92108a0061dSDave Stevenson * Actual range will be set from imx290_ctrl_update later in the probe.
92208a0061dSDave Stevenson */
923cb7e1c8dSLaurent Pinchart imx290->hblank = v4l2_ctrl_new_std(&imx290->ctrls, &imx290_ctrl_ops,
924693b5cb5SLaurent Pinchart V4L2_CID_HBLANK, 1, 1, 1, 1);
925cb7e1c8dSLaurent Pinchart
926cb7e1c8dSLaurent Pinchart imx290->vblank = v4l2_ctrl_new_std(&imx290->ctrls, &imx290_ctrl_ops,
927693b5cb5SLaurent Pinchart V4L2_CID_VBLANK, 1, 1, 1, 1);
928cb7e1c8dSLaurent Pinchart
929924350aeSDave Stevenson imx290->hflip = v4l2_ctrl_new_std(&imx290->ctrls, &imx290_ctrl_ops,
930924350aeSDave Stevenson V4L2_CID_HFLIP, 0, 1, 1, 0);
931924350aeSDave Stevenson imx290->vflip = v4l2_ctrl_new_std(&imx290->ctrls, &imx290_ctrl_ops,
932924350aeSDave Stevenson V4L2_CID_VFLIP, 0, 1, 1, 0);
933924350aeSDave Stevenson v4l2_ctrl_cluster(2, &imx290->hflip);
934924350aeSDave Stevenson
935cb7e1c8dSLaurent Pinchart v4l2_ctrl_new_fwnode_properties(&imx290->ctrls, &imx290_ctrl_ops,
936cb7e1c8dSLaurent Pinchart &props);
937cb7e1c8dSLaurent Pinchart
938cb7e1c8dSLaurent Pinchart imx290->sd.ctrl_handler = &imx290->ctrls;
939cb7e1c8dSLaurent Pinchart
940cb7e1c8dSLaurent Pinchart if (imx290->ctrls.error) {
941cb7e1c8dSLaurent Pinchart ret = imx290->ctrls.error;
942cb7e1c8dSLaurent Pinchart v4l2_ctrl_handler_free(&imx290->ctrls);
943cb7e1c8dSLaurent Pinchart return ret;
944cb7e1c8dSLaurent Pinchart }
945cb7e1c8dSLaurent Pinchart
946cb7e1c8dSLaurent Pinchart return 0;
947cb7e1c8dSLaurent Pinchart }
948cb7e1c8dSLaurent Pinchart
949cb7e1c8dSLaurent Pinchart /* ----------------------------------------------------------------------------
950cb7e1c8dSLaurent Pinchart * Subdev operations
951cb7e1c8dSLaurent Pinchart */
952cb7e1c8dSLaurent Pinchart
953cb7e1c8dSLaurent Pinchart /* Start streaming */
imx290_start_streaming(struct imx290 * imx290,struct v4l2_subdev_state * state)954a2514b9aSLaurent Pinchart static int imx290_start_streaming(struct imx290 *imx290,
955a2514b9aSLaurent Pinchart struct v4l2_subdev_state *state)
956cb7e1c8dSLaurent Pinchart {
957a2514b9aSLaurent Pinchart const struct v4l2_mbus_framefmt *format;
958cb7e1c8dSLaurent Pinchart int ret;
959cb7e1c8dSLaurent Pinchart
960cb7e1c8dSLaurent Pinchart /* Set init register settings */
961cb7e1c8dSLaurent Pinchart ret = imx290_set_register_array(imx290, imx290_global_init_settings,
9629a78e937SDave Stevenson ARRAY_SIZE(imx290_global_init_settings));
963cb7e1c8dSLaurent Pinchart if (ret < 0) {
964cb7e1c8dSLaurent Pinchart dev_err(imx290->dev, "Could not set init registers\n");
965cb7e1c8dSLaurent Pinchart return ret;
966cb7e1c8dSLaurent Pinchart }
967cb7e1c8dSLaurent Pinchart
9682d41947eSAlexander Stein /* Set mdel specific init register settings */
9692d41947eSAlexander Stein ret = imx290_set_register_array(imx290, imx290->model->init_regs,
9702d41947eSAlexander Stein imx290->model->init_regs_num);
9712d41947eSAlexander Stein if (ret < 0) {
9722d41947eSAlexander Stein dev_err(imx290->dev, "Could not set model specific init registers\n");
9732d41947eSAlexander Stein return ret;
9742d41947eSAlexander Stein }
9752d41947eSAlexander Stein
976ffbe3d82SDave Stevenson /* Set clock parameters based on mode and xclk */
977ffbe3d82SDave Stevenson ret = imx290_set_clock(imx290);
978ffbe3d82SDave Stevenson if (ret < 0) {
979a3d4bba7SDave Stevenson dev_err(imx290->dev, "Could not set clocks - %d\n", ret);
980ffbe3d82SDave Stevenson return ret;
981ffbe3d82SDave Stevenson }
982ffbe3d82SDave Stevenson
9837d399658SLaurent Pinchart /* Set data lane count */
98405ef7ec4SLaurent Pinchart ret = imx290_set_data_lanes(imx290);
98505ef7ec4SLaurent Pinchart if (ret < 0) {
986a3d4bba7SDave Stevenson dev_err(imx290->dev, "Could not set data lanes - %d\n", ret);
98705ef7ec4SLaurent Pinchart return ret;
98805ef7ec4SLaurent Pinchart }
9897d399658SLaurent Pinchart
990d0347f98SDave Stevenson ret = imx290_set_csi_config(imx290);
991d0347f98SDave Stevenson if (ret < 0) {
992a3d4bba7SDave Stevenson dev_err(imx290->dev, "Could not set csi cfg - %d\n", ret);
993d0347f98SDave Stevenson return ret;
994d0347f98SDave Stevenson }
995d0347f98SDave Stevenson
996cb7e1c8dSLaurent Pinchart /* Apply the register values related to current frame format */
997a2514b9aSLaurent Pinchart format = v4l2_subdev_get_pad_format(&imx290->sd, state, 0);
998a2514b9aSLaurent Pinchart ret = imx290_setup_format(imx290, format);
999cb7e1c8dSLaurent Pinchart if (ret < 0) {
1000a3d4bba7SDave Stevenson dev_err(imx290->dev, "Could not set frame format - %d\n", ret);
1001cb7e1c8dSLaurent Pinchart return ret;
1002cb7e1c8dSLaurent Pinchart }
1003cb7e1c8dSLaurent Pinchart
1004cb7e1c8dSLaurent Pinchart /* Apply default values of current mode */
1005cb7e1c8dSLaurent Pinchart ret = imx290_set_register_array(imx290, imx290->current_mode->data,
1006cb7e1c8dSLaurent Pinchart imx290->current_mode->data_size);
1007cb7e1c8dSLaurent Pinchart if (ret < 0) {
1008a3d4bba7SDave Stevenson dev_err(imx290->dev, "Could not set current mode - %d\n", ret);
1009cb7e1c8dSLaurent Pinchart return ret;
1010cb7e1c8dSLaurent Pinchart }
1011cb7e1c8dSLaurent Pinchart
1012cb7e1c8dSLaurent Pinchart /* Apply customized values from user */
1013a2514b9aSLaurent Pinchart ret = __v4l2_ctrl_handler_setup(imx290->sd.ctrl_handler);
1014cb7e1c8dSLaurent Pinchart if (ret) {
1015a3d4bba7SDave Stevenson dev_err(imx290->dev, "Could not sync v4l2 controls - %d\n", ret);
1016cb7e1c8dSLaurent Pinchart return ret;
1017cb7e1c8dSLaurent Pinchart }
1018cb7e1c8dSLaurent Pinchart
1019af73323bSHans de Goede cci_write(imx290->regmap, IMX290_STANDBY, 0x00, &ret);
1020cb7e1c8dSLaurent Pinchart
1021cb7e1c8dSLaurent Pinchart msleep(30);
1022cb7e1c8dSLaurent Pinchart
1023cb7e1c8dSLaurent Pinchart /* Start streaming */
1024af73323bSHans de Goede return cci_write(imx290->regmap, IMX290_XMSTA, 0x00, &ret);
1025cb7e1c8dSLaurent Pinchart }
1026cb7e1c8dSLaurent Pinchart
1027cb7e1c8dSLaurent Pinchart /* Stop streaming */
imx290_stop_streaming(struct imx290 * imx290)1028cb7e1c8dSLaurent Pinchart static int imx290_stop_streaming(struct imx290 *imx290)
1029cb7e1c8dSLaurent Pinchart {
1030cb7e1c8dSLaurent Pinchart int ret = 0;
1031cb7e1c8dSLaurent Pinchart
1032af73323bSHans de Goede cci_write(imx290->regmap, IMX290_STANDBY, 0x01, &ret);
1033cb7e1c8dSLaurent Pinchart
1034cb7e1c8dSLaurent Pinchart msleep(30);
1035cb7e1c8dSLaurent Pinchart
1036af73323bSHans de Goede return cci_write(imx290->regmap, IMX290_XMSTA, 0x01, &ret);
1037cb7e1c8dSLaurent Pinchart }
1038cb7e1c8dSLaurent Pinchart
imx290_set_stream(struct v4l2_subdev * sd,int enable)1039cb7e1c8dSLaurent Pinchart static int imx290_set_stream(struct v4l2_subdev *sd, int enable)
1040cb7e1c8dSLaurent Pinchart {
1041cb7e1c8dSLaurent Pinchart struct imx290 *imx290 = to_imx290(sd);
1042a2514b9aSLaurent Pinchart struct v4l2_subdev_state *state;
1043cb7e1c8dSLaurent Pinchart int ret = 0;
1044cb7e1c8dSLaurent Pinchart
1045a2514b9aSLaurent Pinchart state = v4l2_subdev_lock_and_get_active_state(sd);
1046a2514b9aSLaurent Pinchart
1047cb7e1c8dSLaurent Pinchart if (enable) {
1048cb7e1c8dSLaurent Pinchart ret = pm_runtime_resume_and_get(imx290->dev);
1049cb7e1c8dSLaurent Pinchart if (ret < 0)
1050a2514b9aSLaurent Pinchart goto unlock;
1051cb7e1c8dSLaurent Pinchart
1052a2514b9aSLaurent Pinchart ret = imx290_start_streaming(imx290, state);
1053cb7e1c8dSLaurent Pinchart if (ret) {
1054cb7e1c8dSLaurent Pinchart dev_err(imx290->dev, "Start stream failed\n");
1055a8c3e0c1SLaurent Pinchart pm_runtime_put_sync(imx290->dev);
1056a2514b9aSLaurent Pinchart goto unlock;
1057cb7e1c8dSLaurent Pinchart }
1058cb7e1c8dSLaurent Pinchart } else {
1059cb7e1c8dSLaurent Pinchart imx290_stop_streaming(imx290);
1060a8c3e0c1SLaurent Pinchart pm_runtime_mark_last_busy(imx290->dev);
1061a8c3e0c1SLaurent Pinchart pm_runtime_put_autosuspend(imx290->dev);
1062cb7e1c8dSLaurent Pinchart }
1063cb7e1c8dSLaurent Pinchart
1064924350aeSDave Stevenson /*
1065924350aeSDave Stevenson * vflip and hflip should not be changed during streaming as the sensor
1066924350aeSDave Stevenson * will produce an invalid frame.
1067924350aeSDave Stevenson */
1068924350aeSDave Stevenson __v4l2_ctrl_grab(imx290->vflip, enable);
1069924350aeSDave Stevenson __v4l2_ctrl_grab(imx290->hflip, enable);
1070924350aeSDave Stevenson
1071a2514b9aSLaurent Pinchart unlock:
1072a2514b9aSLaurent Pinchart v4l2_subdev_unlock_state(state);
1073cb7e1c8dSLaurent Pinchart return ret;
1074cb7e1c8dSLaurent Pinchart }
1075cb7e1c8dSLaurent Pinchart
imx290_enum_mbus_code(struct v4l2_subdev * sd,struct v4l2_subdev_state * sd_state,struct v4l2_subdev_mbus_code_enum * code)1076828dbc29SManivannan Sadhasivam static int imx290_enum_mbus_code(struct v4l2_subdev *sd,
10770d346d2aSTomi Valkeinen struct v4l2_subdev_state *sd_state,
1078828dbc29SManivannan Sadhasivam struct v4l2_subdev_mbus_code_enum *code)
1079828dbc29SManivannan Sadhasivam {
10808bb19dd7SDave Stevenson const struct imx290 *imx290 = to_imx290(sd);
10818bb19dd7SDave Stevenson
1082828dbc29SManivannan Sadhasivam if (code->index >= ARRAY_SIZE(imx290_formats))
1083828dbc29SManivannan Sadhasivam return -EINVAL;
1084828dbc29SManivannan Sadhasivam
10858bb19dd7SDave Stevenson code->code = imx290_formats[code->index].code[imx290->model->colour_variant];
1086828dbc29SManivannan Sadhasivam
1087828dbc29SManivannan Sadhasivam return 0;
1088828dbc29SManivannan Sadhasivam }
1089828dbc29SManivannan Sadhasivam
imx290_enum_frame_size(struct v4l2_subdev * sd,struct v4l2_subdev_state * sd_state,struct v4l2_subdev_frame_size_enum * fse)10903b867fb6SManivannan Sadhasivam static int imx290_enum_frame_size(struct v4l2_subdev *sd,
10910d346d2aSTomi Valkeinen struct v4l2_subdev_state *sd_state,
10923b867fb6SManivannan Sadhasivam struct v4l2_subdev_frame_size_enum *fse)
10933b867fb6SManivannan Sadhasivam {
10943b867fb6SManivannan Sadhasivam const struct imx290 *imx290 = to_imx290(sd);
10953b867fb6SManivannan Sadhasivam const struct imx290_mode *imx290_modes = imx290_modes_ptr(imx290);
10963b867fb6SManivannan Sadhasivam
10978bb19dd7SDave Stevenson if (!imx290_format_info(imx290, fse->code))
10983b867fb6SManivannan Sadhasivam return -EINVAL;
10993b867fb6SManivannan Sadhasivam
11003b867fb6SManivannan Sadhasivam if (fse->index >= imx290_modes_num(imx290))
11013b867fb6SManivannan Sadhasivam return -EINVAL;
11023b867fb6SManivannan Sadhasivam
11033b867fb6SManivannan Sadhasivam fse->min_width = imx290_modes[fse->index].width;
11043b867fb6SManivannan Sadhasivam fse->max_width = imx290_modes[fse->index].width;
11053b867fb6SManivannan Sadhasivam fse->min_height = imx290_modes[fse->index].height;
11063b867fb6SManivannan Sadhasivam fse->max_height = imx290_modes[fse->index].height;
11073b867fb6SManivannan Sadhasivam
11083b867fb6SManivannan Sadhasivam return 0;
11093b867fb6SManivannan Sadhasivam }
11103b867fb6SManivannan Sadhasivam
imx290_set_fmt(struct v4l2_subdev * sd,struct v4l2_subdev_state * sd_state,struct v4l2_subdev_format * fmt)1111828dbc29SManivannan Sadhasivam static int imx290_set_fmt(struct v4l2_subdev *sd,
11120d346d2aSTomi Valkeinen struct v4l2_subdev_state *sd_state,
1113828dbc29SManivannan Sadhasivam struct v4l2_subdev_format *fmt)
1114828dbc29SManivannan Sadhasivam {
1115828dbc29SManivannan Sadhasivam struct imx290 *imx290 = to_imx290(sd);
1116828dbc29SManivannan Sadhasivam const struct imx290_mode *mode;
1117828dbc29SManivannan Sadhasivam struct v4l2_mbus_framefmt *format;
1118828dbc29SManivannan Sadhasivam
111997589ad6SManivannan Sadhasivam mode = v4l2_find_nearest_size(imx290_modes_ptr(imx290),
112097589ad6SManivannan Sadhasivam imx290_modes_num(imx290), width, height,
1121828dbc29SManivannan Sadhasivam fmt->format.width, fmt->format.height);
1122828dbc29SManivannan Sadhasivam
1123828dbc29SManivannan Sadhasivam fmt->format.width = mode->width;
1124828dbc29SManivannan Sadhasivam fmt->format.height = mode->height;
1125828dbc29SManivannan Sadhasivam
11268bb19dd7SDave Stevenson if (!imx290_format_info(imx290, fmt->format.code))
11278bb19dd7SDave Stevenson fmt->format.code = imx290_formats[0].code[imx290->model->colour_variant];
1128828dbc29SManivannan Sadhasivam
1129828dbc29SManivannan Sadhasivam fmt->format.field = V4L2_FIELD_NONE;
1130077d1b32SDave Stevenson fmt->format.colorspace = V4L2_COLORSPACE_RAW;
1131077d1b32SDave Stevenson fmt->format.ycbcr_enc = V4L2_YCBCR_ENC_601;
1132077d1b32SDave Stevenson fmt->format.quantization = V4L2_QUANTIZATION_FULL_RANGE;
1133077d1b32SDave Stevenson fmt->format.xfer_func = V4L2_XFER_FUNC_NONE;
1134828dbc29SManivannan Sadhasivam
1135a2514b9aSLaurent Pinchart format = v4l2_subdev_get_pad_format(sd, sd_state, 0);
1136b25537efSLaurent Pinchart
1137b25537efSLaurent Pinchart if (fmt->which == V4L2_SUBDEV_FORMAT_ACTIVE) {
1138828dbc29SManivannan Sadhasivam imx290->current_mode = mode;
113998e0500eSManivannan Sadhasivam
11409b4e0e7aSTommaso Merciai imx290_ctrl_update(imx290, mode);
11419fe4eee9SDave Stevenson imx290_exposure_update(imx290, mode);
1142828dbc29SManivannan Sadhasivam }
1143828dbc29SManivannan Sadhasivam
1144828dbc29SManivannan Sadhasivam *format = fmt->format;
1145828dbc29SManivannan Sadhasivam
1146828dbc29SManivannan Sadhasivam return 0;
1147828dbc29SManivannan Sadhasivam }
1148828dbc29SManivannan Sadhasivam
imx290_get_selection(struct v4l2_subdev * sd,struct v4l2_subdev_state * sd_state,struct v4l2_subdev_selection * sel)1149b4ab57b0SLaurent Pinchart static int imx290_get_selection(struct v4l2_subdev *sd,
1150b4ab57b0SLaurent Pinchart struct v4l2_subdev_state *sd_state,
1151b4ab57b0SLaurent Pinchart struct v4l2_subdev_selection *sel)
1152b4ab57b0SLaurent Pinchart {
1153924350aeSDave Stevenson struct imx290 *imx290 = to_imx290(sd);
1154b4ab57b0SLaurent Pinchart struct v4l2_mbus_framefmt *format;
1155b4ab57b0SLaurent Pinchart
1156b4ab57b0SLaurent Pinchart switch (sel->target) {
1157b4ab57b0SLaurent Pinchart case V4L2_SEL_TGT_CROP: {
1158a2514b9aSLaurent Pinchart format = v4l2_subdev_get_pad_format(sd, sd_state, 0);
1159b4ab57b0SLaurent Pinchart
1160924350aeSDave Stevenson /*
1161924350aeSDave Stevenson * The sensor moves the readout by 1 pixel based on flips to
1162924350aeSDave Stevenson * keep the Bayer order the same.
1163924350aeSDave Stevenson */
1164*81d998e1SAlexander Stein sel->r.top = IMX290_PIXEL_ARRAY_MARGIN_TOP
1165924350aeSDave Stevenson + (IMX290_PIXEL_ARRAY_RECORDING_HEIGHT - format->height) / 2
1166924350aeSDave Stevenson + imx290->vflip->val;
1167*81d998e1SAlexander Stein sel->r.left = IMX290_PIXEL_ARRAY_MARGIN_LEFT
1168924350aeSDave Stevenson + (IMX290_PIXEL_ARRAY_RECORDING_WIDTH - format->width) / 2
1169924350aeSDave Stevenson + imx290->hflip->val;
1170b4ab57b0SLaurent Pinchart sel->r.width = format->width;
1171b4ab57b0SLaurent Pinchart sel->r.height = format->height;
1172b4ab57b0SLaurent Pinchart
1173b4ab57b0SLaurent Pinchart return 0;
1174b4ab57b0SLaurent Pinchart }
1175b4ab57b0SLaurent Pinchart
1176b4ab57b0SLaurent Pinchart case V4L2_SEL_TGT_NATIVE_SIZE:
1177b4ab57b0SLaurent Pinchart case V4L2_SEL_TGT_CROP_BOUNDS:
1178b4ab57b0SLaurent Pinchart sel->r.top = 0;
1179b4ab57b0SLaurent Pinchart sel->r.left = 0;
1180b4ab57b0SLaurent Pinchart sel->r.width = IMX290_PIXEL_ARRAY_WIDTH;
1181b4ab57b0SLaurent Pinchart sel->r.height = IMX290_PIXEL_ARRAY_HEIGHT;
1182b4ab57b0SLaurent Pinchart
1183b4ab57b0SLaurent Pinchart return 0;
1184b4ab57b0SLaurent Pinchart
1185b4ab57b0SLaurent Pinchart case V4L2_SEL_TGT_CROP_DEFAULT:
1186*81d998e1SAlexander Stein sel->r.top = IMX290_PIXEL_ARRAY_MARGIN_TOP;
1187*81d998e1SAlexander Stein sel->r.left = IMX290_PIXEL_ARRAY_MARGIN_LEFT;
1188b4ab57b0SLaurent Pinchart sel->r.width = IMX290_PIXEL_ARRAY_RECORDING_WIDTH;
1189b4ab57b0SLaurent Pinchart sel->r.height = IMX290_PIXEL_ARRAY_RECORDING_HEIGHT;
1190b4ab57b0SLaurent Pinchart
1191b4ab57b0SLaurent Pinchart return 0;
1192b4ab57b0SLaurent Pinchart
1193b4ab57b0SLaurent Pinchart default:
1194b4ab57b0SLaurent Pinchart return -EINVAL;
1195b4ab57b0SLaurent Pinchart }
1196b4ab57b0SLaurent Pinchart }
1197b4ab57b0SLaurent Pinchart
imx290_entity_init_cfg(struct v4l2_subdev * subdev,struct v4l2_subdev_state * sd_state)1198828dbc29SManivannan Sadhasivam static int imx290_entity_init_cfg(struct v4l2_subdev *subdev,
11990d346d2aSTomi Valkeinen struct v4l2_subdev_state *sd_state)
1200828dbc29SManivannan Sadhasivam {
1201a2514b9aSLaurent Pinchart struct v4l2_subdev_format fmt = {
1202a2514b9aSLaurent Pinchart .which = V4L2_SUBDEV_FORMAT_TRY,
1203a2514b9aSLaurent Pinchart .format = {
1204a2514b9aSLaurent Pinchart .width = 1920,
1205a2514b9aSLaurent Pinchart .height = 1080,
1206a2514b9aSLaurent Pinchart },
1207a2514b9aSLaurent Pinchart };
1208828dbc29SManivannan Sadhasivam
12090d346d2aSTomi Valkeinen imx290_set_fmt(subdev, sd_state, &fmt);
1210828dbc29SManivannan Sadhasivam
1211828dbc29SManivannan Sadhasivam return 0;
1212828dbc29SManivannan Sadhasivam }
1213828dbc29SManivannan Sadhasivam
1214f5398587SDave Stevenson static const struct v4l2_subdev_core_ops imx290_core_ops = {
1215f5398587SDave Stevenson .subscribe_event = v4l2_ctrl_subdev_subscribe_event,
1216f5398587SDave Stevenson .unsubscribe_event = v4l2_event_subdev_unsubscribe,
1217f5398587SDave Stevenson };
1218f5398587SDave Stevenson
1219cb7e1c8dSLaurent Pinchart static const struct v4l2_subdev_video_ops imx290_video_ops = {
1220cb7e1c8dSLaurent Pinchart .s_stream = imx290_set_stream,
1221cb7e1c8dSLaurent Pinchart };
1222828dbc29SManivannan Sadhasivam
1223cb7e1c8dSLaurent Pinchart static const struct v4l2_subdev_pad_ops imx290_pad_ops = {
1224cb7e1c8dSLaurent Pinchart .init_cfg = imx290_entity_init_cfg,
1225cb7e1c8dSLaurent Pinchart .enum_mbus_code = imx290_enum_mbus_code,
1226cb7e1c8dSLaurent Pinchart .enum_frame_size = imx290_enum_frame_size,
1227a2514b9aSLaurent Pinchart .get_fmt = v4l2_subdev_get_fmt,
1228cb7e1c8dSLaurent Pinchart .set_fmt = imx290_set_fmt,
1229cb7e1c8dSLaurent Pinchart .get_selection = imx290_get_selection,
1230cb7e1c8dSLaurent Pinchart };
1231828dbc29SManivannan Sadhasivam
1232cb7e1c8dSLaurent Pinchart static const struct v4l2_subdev_ops imx290_subdev_ops = {
1233f5398587SDave Stevenson .core = &imx290_core_ops,
1234cb7e1c8dSLaurent Pinchart .video = &imx290_video_ops,
1235cb7e1c8dSLaurent Pinchart .pad = &imx290_pad_ops,
1236cb7e1c8dSLaurent Pinchart };
1237828dbc29SManivannan Sadhasivam
1238cb7e1c8dSLaurent Pinchart static const struct media_entity_operations imx290_subdev_entity_ops = {
1239cb7e1c8dSLaurent Pinchart .link_validate = v4l2_subdev_link_validate,
1240cb7e1c8dSLaurent Pinchart };
1241828dbc29SManivannan Sadhasivam
imx290_subdev_init(struct imx290 * imx290)1242dfb704daSLaurent Pinchart static int imx290_subdev_init(struct imx290 *imx290)
1243dfb704daSLaurent Pinchart {
1244dfb704daSLaurent Pinchart struct i2c_client *client = to_i2c_client(imx290->dev);
124510591fe6SLaurent Pinchart struct v4l2_subdev_state *state;
1246dfb704daSLaurent Pinchart int ret;
1247dfb704daSLaurent Pinchart
1248a2514b9aSLaurent Pinchart imx290->current_mode = &imx290_modes_ptr(imx290)[0];
1249dfb704daSLaurent Pinchart
1250dfb704daSLaurent Pinchart v4l2_i2c_subdev_init(&imx290->sd, client, &imx290_subdev_ops);
1251f5398587SDave Stevenson imx290->sd.flags |= V4L2_SUBDEV_FL_HAS_DEVNODE |
1252f5398587SDave Stevenson V4L2_SUBDEV_FL_HAS_EVENTS;
1253dfb704daSLaurent Pinchart imx290->sd.dev = imx290->dev;
1254dfb704daSLaurent Pinchart imx290->sd.entity.ops = &imx290_subdev_entity_ops;
1255dfb704daSLaurent Pinchart imx290->sd.entity.function = MEDIA_ENT_F_CAM_SENSOR;
1256dfb704daSLaurent Pinchart
1257dfb704daSLaurent Pinchart imx290->pad.flags = MEDIA_PAD_FL_SOURCE;
1258dfb704daSLaurent Pinchart ret = media_entity_pads_init(&imx290->sd.entity, 1, &imx290->pad);
1259dfb704daSLaurent Pinchart if (ret < 0) {
1260dfb704daSLaurent Pinchart dev_err(imx290->dev, "Could not register media entity\n");
1261dfb704daSLaurent Pinchart return ret;
1262dfb704daSLaurent Pinchart }
1263dfb704daSLaurent Pinchart
1264a2514b9aSLaurent Pinchart ret = imx290_ctrl_init(imx290);
1265a2514b9aSLaurent Pinchart if (ret < 0) {
1266a2514b9aSLaurent Pinchart dev_err(imx290->dev, "Control initialization error %d\n", ret);
1267a2514b9aSLaurent Pinchart goto err_media;
1268a2514b9aSLaurent Pinchart }
1269a2514b9aSLaurent Pinchart
1270a2514b9aSLaurent Pinchart imx290->sd.state_lock = imx290->ctrls.lock;
1271a2514b9aSLaurent Pinchart
1272a2514b9aSLaurent Pinchart ret = v4l2_subdev_init_finalize(&imx290->sd);
1273a2514b9aSLaurent Pinchart if (ret < 0) {
1274a2514b9aSLaurent Pinchart dev_err(imx290->dev, "subdev initialization error %d\n", ret);
1275a2514b9aSLaurent Pinchart goto err_ctrls;
1276a2514b9aSLaurent Pinchart }
1277a2514b9aSLaurent Pinchart
127810591fe6SLaurent Pinchart state = v4l2_subdev_lock_and_get_active_state(&imx290->sd);
12799b4e0e7aSTommaso Merciai imx290_ctrl_update(imx290, imx290->current_mode);
128010591fe6SLaurent Pinchart v4l2_subdev_unlock_state(state);
1281a2514b9aSLaurent Pinchart
1282dfb704daSLaurent Pinchart return 0;
1283a2514b9aSLaurent Pinchart
1284a2514b9aSLaurent Pinchart err_ctrls:
1285a2514b9aSLaurent Pinchart v4l2_ctrl_handler_free(&imx290->ctrls);
1286a2514b9aSLaurent Pinchart err_media:
1287a2514b9aSLaurent Pinchart media_entity_cleanup(&imx290->sd.entity);
1288a2514b9aSLaurent Pinchart return ret;
1289dfb704daSLaurent Pinchart }
1290dfb704daSLaurent Pinchart
imx290_subdev_cleanup(struct imx290 * imx290)1291dfb704daSLaurent Pinchart static void imx290_subdev_cleanup(struct imx290 *imx290)
1292dfb704daSLaurent Pinchart {
1293a2514b9aSLaurent Pinchart v4l2_subdev_cleanup(&imx290->sd);
1294dfb704daSLaurent Pinchart media_entity_cleanup(&imx290->sd.entity);
1295dfb704daSLaurent Pinchart v4l2_ctrl_handler_free(&imx290->ctrls);
1296dfb704daSLaurent Pinchart }
1297dfb704daSLaurent Pinchart
1298cb7e1c8dSLaurent Pinchart /* ----------------------------------------------------------------------------
1299cb7e1c8dSLaurent Pinchart * Power management
130097589ad6SManivannan Sadhasivam */
130197589ad6SManivannan Sadhasivam
imx290_power_on(struct imx290 * imx290)130202852c01SLaurent Pinchart static int imx290_power_on(struct imx290 *imx290)
1303828dbc29SManivannan Sadhasivam {
1304828dbc29SManivannan Sadhasivam int ret;
1305828dbc29SManivannan Sadhasivam
1306828dbc29SManivannan Sadhasivam ret = clk_prepare_enable(imx290->xclk);
1307828dbc29SManivannan Sadhasivam if (ret) {
130802852c01SLaurent Pinchart dev_err(imx290->dev, "Failed to enable clock\n");
1309828dbc29SManivannan Sadhasivam return ret;
1310828dbc29SManivannan Sadhasivam }
1311828dbc29SManivannan Sadhasivam
13122548df53SLaurent Pinchart ret = regulator_bulk_enable(ARRAY_SIZE(imx290->supplies),
13132548df53SLaurent Pinchart imx290->supplies);
1314828dbc29SManivannan Sadhasivam if (ret) {
131502852c01SLaurent Pinchart dev_err(imx290->dev, "Failed to enable regulators\n");
1316828dbc29SManivannan Sadhasivam clk_disable_unprepare(imx290->xclk);
1317828dbc29SManivannan Sadhasivam return ret;
1318828dbc29SManivannan Sadhasivam }
1319828dbc29SManivannan Sadhasivam
1320828dbc29SManivannan Sadhasivam usleep_range(1, 2);
13213909a92dSAndrey Konovalov gpiod_set_value_cansleep(imx290->rst_gpio, 0);
1322828dbc29SManivannan Sadhasivam usleep_range(30000, 31000);
1323828dbc29SManivannan Sadhasivam
1324828dbc29SManivannan Sadhasivam return 0;
1325828dbc29SManivannan Sadhasivam }
1326828dbc29SManivannan Sadhasivam
imx290_power_off(struct imx290 * imx290)132702852c01SLaurent Pinchart static void imx290_power_off(struct imx290 *imx290)
132802852c01SLaurent Pinchart {
132902852c01SLaurent Pinchart clk_disable_unprepare(imx290->xclk);
133002852c01SLaurent Pinchart gpiod_set_value_cansleep(imx290->rst_gpio, 1);
133102852c01SLaurent Pinchart regulator_bulk_disable(ARRAY_SIZE(imx290->supplies), imx290->supplies);
133202852c01SLaurent Pinchart }
133302852c01SLaurent Pinchart
imx290_runtime_resume(struct device * dev)133402852c01SLaurent Pinchart static int imx290_runtime_resume(struct device *dev)
1335828dbc29SManivannan Sadhasivam {
1336b50ce25dSKrzysztof Kozlowski struct v4l2_subdev *sd = dev_get_drvdata(dev);
1337828dbc29SManivannan Sadhasivam struct imx290 *imx290 = to_imx290(sd);
1338828dbc29SManivannan Sadhasivam
133902852c01SLaurent Pinchart return imx290_power_on(imx290);
134002852c01SLaurent Pinchart }
134102852c01SLaurent Pinchart
imx290_runtime_suspend(struct device * dev)134202852c01SLaurent Pinchart static int imx290_runtime_suspend(struct device *dev)
134302852c01SLaurent Pinchart {
134402852c01SLaurent Pinchart struct v4l2_subdev *sd = dev_get_drvdata(dev);
134502852c01SLaurent Pinchart struct imx290 *imx290 = to_imx290(sd);
134602852c01SLaurent Pinchart
134702852c01SLaurent Pinchart imx290_power_off(imx290);
1348828dbc29SManivannan Sadhasivam
1349828dbc29SManivannan Sadhasivam return 0;
1350828dbc29SManivannan Sadhasivam }
1351828dbc29SManivannan Sadhasivam
1352828dbc29SManivannan Sadhasivam static const struct dev_pm_ops imx290_pm_ops = {
1353b928db94SArnd Bergmann RUNTIME_PM_OPS(imx290_runtime_suspend, imx290_runtime_resume, NULL)
1354828dbc29SManivannan Sadhasivam };
1355828dbc29SManivannan Sadhasivam
1356cb7e1c8dSLaurent Pinchart /* ----------------------------------------------------------------------------
1357cb7e1c8dSLaurent Pinchart * Probe & remove
135872c87b7aSLaurent Pinchart */
135972c87b7aSLaurent Pinchart
1360cb7e1c8dSLaurent Pinchart static const char * const imx290_supply_name[IMX290_NUM_SUPPLIES] = {
1361cb7e1c8dSLaurent Pinchart "vdda",
1362cb7e1c8dSLaurent Pinchart "vddd",
1363cb7e1c8dSLaurent Pinchart "vdddo",
1364cb7e1c8dSLaurent Pinchart };
136572c87b7aSLaurent Pinchart
imx290_get_regulators(struct device * dev,struct imx290 * imx290)1366cb7e1c8dSLaurent Pinchart static int imx290_get_regulators(struct device *dev, struct imx290 *imx290)
1367cb7e1c8dSLaurent Pinchart {
1368cb7e1c8dSLaurent Pinchart unsigned int i;
136972c87b7aSLaurent Pinchart
1370cb7e1c8dSLaurent Pinchart for (i = 0; i < ARRAY_SIZE(imx290->supplies); i++)
1371cb7e1c8dSLaurent Pinchart imx290->supplies[i].supply = imx290_supply_name[i];
137272c87b7aSLaurent Pinchart
1373cb7e1c8dSLaurent Pinchart return devm_regulator_bulk_get(dev, ARRAY_SIZE(imx290->supplies),
1374cb7e1c8dSLaurent Pinchart imx290->supplies);
137572c87b7aSLaurent Pinchart }
137672c87b7aSLaurent Pinchart
imx290_init_clk(struct imx290 * imx290)1377e5d363caSLaurent Pinchart static int imx290_init_clk(struct imx290 *imx290)
1378e5d363caSLaurent Pinchart {
1379e5d363caSLaurent Pinchart u32 xclk_freq;
1380e5d363caSLaurent Pinchart int ret;
1381e5d363caSLaurent Pinchart
138232fceaa6SAndy Shevchenko ret = device_property_read_u32(imx290->dev, "clock-frequency",
138332fceaa6SAndy Shevchenko &xclk_freq);
1384e5d363caSLaurent Pinchart if (ret) {
1385e5d363caSLaurent Pinchart dev_err(imx290->dev, "Could not get xclk frequency\n");
1386e5d363caSLaurent Pinchart return ret;
1387e5d363caSLaurent Pinchart }
1388e5d363caSLaurent Pinchart
1389ffbe3d82SDave Stevenson /* external clock must be 37.125 MHz or 74.25MHz */
1390ffbe3d82SDave Stevenson switch (xclk_freq) {
1391ffbe3d82SDave Stevenson case 37125000:
1392ffbe3d82SDave Stevenson imx290->xclk_idx = IMX290_CLK_37_125;
1393ffbe3d82SDave Stevenson break;
1394ffbe3d82SDave Stevenson case 74250000:
1395ffbe3d82SDave Stevenson imx290->xclk_idx = IMX290_CLK_74_25;
1396ffbe3d82SDave Stevenson break;
1397ffbe3d82SDave Stevenson default:
1398e5d363caSLaurent Pinchart dev_err(imx290->dev, "External clock frequency %u is not supported\n",
1399e5d363caSLaurent Pinchart xclk_freq);
1400e5d363caSLaurent Pinchart return -EINVAL;
1401e5d363caSLaurent Pinchart }
1402e5d363caSLaurent Pinchart
1403e5d363caSLaurent Pinchart ret = clk_set_rate(imx290->xclk, xclk_freq);
1404e5d363caSLaurent Pinchart if (ret) {
1405e5d363caSLaurent Pinchart dev_err(imx290->dev, "Could not set xclk frequency\n");
1406e5d363caSLaurent Pinchart return ret;
1407e5d363caSLaurent Pinchart }
1408e5d363caSLaurent Pinchart
1409e5d363caSLaurent Pinchart return 0;
1410e5d363caSLaurent Pinchart }
1411e5d363caSLaurent Pinchart
141298e0500eSManivannan Sadhasivam /*
141398e0500eSManivannan Sadhasivam * Returns 0 if all link frequencies used by the driver for the given number
141498e0500eSManivannan Sadhasivam * of MIPI data lanes are mentioned in the device tree, or the value of the
141598e0500eSManivannan Sadhasivam * first missing frequency otherwise.
141698e0500eSManivannan Sadhasivam */
imx290_check_link_freqs(const struct imx290 * imx290,const struct v4l2_fwnode_endpoint * ep)1417a2706758SAndrey Konovalov static s64 imx290_check_link_freqs(const struct imx290 *imx290,
1418a2706758SAndrey Konovalov const struct v4l2_fwnode_endpoint *ep)
141998e0500eSManivannan Sadhasivam {
142098e0500eSManivannan Sadhasivam int i, j;
142198e0500eSManivannan Sadhasivam const s64 *freqs = imx290_link_freqs_ptr(imx290);
142298e0500eSManivannan Sadhasivam int freqs_count = imx290_link_freqs_num(imx290);
142398e0500eSManivannan Sadhasivam
142498e0500eSManivannan Sadhasivam for (i = 0; i < freqs_count; i++) {
1425a2706758SAndrey Konovalov for (j = 0; j < ep->nr_of_link_frequencies; j++)
1426a2706758SAndrey Konovalov if (freqs[i] == ep->link_frequencies[j])
142798e0500eSManivannan Sadhasivam break;
1428a2706758SAndrey Konovalov if (j == ep->nr_of_link_frequencies)
142998e0500eSManivannan Sadhasivam return freqs[i];
143098e0500eSManivannan Sadhasivam }
143198e0500eSManivannan Sadhasivam return 0;
143298e0500eSManivannan Sadhasivam }
143398e0500eSManivannan Sadhasivam
14348bb19dd7SDave Stevenson static const struct imx290_model_info imx290_models[] = {
14358bb19dd7SDave Stevenson [IMX290_MODEL_IMX290LQR] = {
14368bb19dd7SDave Stevenson .colour_variant = IMX290_VARIANT_COLOUR,
14372d41947eSAlexander Stein .init_regs = imx290_global_init_settings_290,
14382d41947eSAlexander Stein .init_regs_num = ARRAY_SIZE(imx290_global_init_settings_290),
14392d41947eSAlexander Stein .name = "imx290",
14408bb19dd7SDave Stevenson },
14418bb19dd7SDave Stevenson [IMX290_MODEL_IMX290LLR] = {
14428bb19dd7SDave Stevenson .colour_variant = IMX290_VARIANT_MONO,
14432d41947eSAlexander Stein .init_regs = imx290_global_init_settings_290,
14442d41947eSAlexander Stein .init_regs_num = ARRAY_SIZE(imx290_global_init_settings_290),
14452d41947eSAlexander Stein .name = "imx290",
14462d41947eSAlexander Stein },
14472d41947eSAlexander Stein [IMX290_MODEL_IMX327LQR] = {
14482d41947eSAlexander Stein .colour_variant = IMX290_VARIANT_COLOUR,
14492d41947eSAlexander Stein .init_regs = imx290_global_init_settings_327,
14502d41947eSAlexander Stein .init_regs_num = ARRAY_SIZE(imx290_global_init_settings_327),
14512d41947eSAlexander Stein .name = "imx327",
14528bb19dd7SDave Stevenson },
14538bb19dd7SDave Stevenson };
14548bb19dd7SDave Stevenson
imx290_parse_dt(struct imx290 * imx290)14556b69c522SLaurent Pinchart static int imx290_parse_dt(struct imx290 *imx290)
1456828dbc29SManivannan Sadhasivam {
1457a2706758SAndrey Konovalov /* Only CSI2 is supported for now: */
1458a2706758SAndrey Konovalov struct v4l2_fwnode_endpoint ep = {
1459a2706758SAndrey Konovalov .bus_type = V4L2_MBUS_CSI2_DPHY
1460a2706758SAndrey Konovalov };
14616b69c522SLaurent Pinchart struct fwnode_handle *endpoint;
14626b69c522SLaurent Pinchart int ret;
14636b69c522SLaurent Pinchart s64 fq;
14646b69c522SLaurent Pinchart
14658bb19dd7SDave Stevenson imx290->model = of_device_get_match_data(imx290->dev);
14668bb19dd7SDave Stevenson
14676b69c522SLaurent Pinchart endpoint = fwnode_graph_get_next_endpoint(dev_fwnode(imx290->dev), NULL);
14686b69c522SLaurent Pinchart if (!endpoint) {
14696b69c522SLaurent Pinchart dev_err(imx290->dev, "Endpoint node not found\n");
14706b69c522SLaurent Pinchart return -EINVAL;
14716b69c522SLaurent Pinchart }
14726b69c522SLaurent Pinchart
14736b69c522SLaurent Pinchart ret = v4l2_fwnode_endpoint_alloc_parse(endpoint, &ep);
14746b69c522SLaurent Pinchart fwnode_handle_put(endpoint);
14756b69c522SLaurent Pinchart if (ret == -ENXIO) {
14766b69c522SLaurent Pinchart dev_err(imx290->dev, "Unsupported bus type, should be CSI2\n");
14776b69c522SLaurent Pinchart goto done;
14786b69c522SLaurent Pinchart } else if (ret) {
14796b69c522SLaurent Pinchart dev_err(imx290->dev, "Parsing endpoint node failed\n");
14806b69c522SLaurent Pinchart goto done;
14816b69c522SLaurent Pinchart }
14826b69c522SLaurent Pinchart
14836b69c522SLaurent Pinchart /* Get number of data lanes */
14846b69c522SLaurent Pinchart imx290->nlanes = ep.bus.mipi_csi2.num_data_lanes;
14856b69c522SLaurent Pinchart if (imx290->nlanes != 2 && imx290->nlanes != 4) {
14866b69c522SLaurent Pinchart dev_err(imx290->dev, "Invalid data lanes: %d\n", imx290->nlanes);
14876b69c522SLaurent Pinchart ret = -EINVAL;
14886b69c522SLaurent Pinchart goto done;
14896b69c522SLaurent Pinchart }
14906b69c522SLaurent Pinchart
14916b69c522SLaurent Pinchart dev_dbg(imx290->dev, "Using %u data lanes\n", imx290->nlanes);
14926b69c522SLaurent Pinchart
14936b69c522SLaurent Pinchart if (!ep.nr_of_link_frequencies) {
14946b69c522SLaurent Pinchart dev_err(imx290->dev, "link-frequency property not found in DT\n");
14956b69c522SLaurent Pinchart ret = -EINVAL;
14966b69c522SLaurent Pinchart goto done;
14976b69c522SLaurent Pinchart }
14986b69c522SLaurent Pinchart
14996b69c522SLaurent Pinchart /* Check that link frequences for all the modes are in device tree */
15006b69c522SLaurent Pinchart fq = imx290_check_link_freqs(imx290, &ep);
15016b69c522SLaurent Pinchart if (fq) {
15026b69c522SLaurent Pinchart dev_err(imx290->dev, "Link frequency of %lld is not supported\n",
15036b69c522SLaurent Pinchart fq);
15046b69c522SLaurent Pinchart ret = -EINVAL;
15056b69c522SLaurent Pinchart goto done;
15066b69c522SLaurent Pinchart }
15076b69c522SLaurent Pinchart
15086b69c522SLaurent Pinchart ret = 0;
15096b69c522SLaurent Pinchart
15106b69c522SLaurent Pinchart done:
15116b69c522SLaurent Pinchart v4l2_fwnode_endpoint_free(&ep);
15126b69c522SLaurent Pinchart return ret;
15136b69c522SLaurent Pinchart }
15146b69c522SLaurent Pinchart
imx290_probe(struct i2c_client * client)15156b69c522SLaurent Pinchart static int imx290_probe(struct i2c_client *client)
15166b69c522SLaurent Pinchart {
15176b69c522SLaurent Pinchart struct device *dev = &client->dev;
1518828dbc29SManivannan Sadhasivam struct imx290 *imx290;
1519828dbc29SManivannan Sadhasivam int ret;
1520828dbc29SManivannan Sadhasivam
1521828dbc29SManivannan Sadhasivam imx290 = devm_kzalloc(dev, sizeof(*imx290), GFP_KERNEL);
1522828dbc29SManivannan Sadhasivam if (!imx290)
1523828dbc29SManivannan Sadhasivam return -ENOMEM;
1524828dbc29SManivannan Sadhasivam
1525828dbc29SManivannan Sadhasivam imx290->dev = dev;
1526af73323bSHans de Goede imx290->regmap = devm_cci_regmap_init_i2c(client, 16);
1527828dbc29SManivannan Sadhasivam if (IS_ERR(imx290->regmap)) {
1528828dbc29SManivannan Sadhasivam dev_err(dev, "Unable to initialize I2C\n");
1529828dbc29SManivannan Sadhasivam return -ENODEV;
1530828dbc29SManivannan Sadhasivam }
1531828dbc29SManivannan Sadhasivam
15326b69c522SLaurent Pinchart ret = imx290_parse_dt(imx290);
15336b69c522SLaurent Pinchart if (ret)
15346b69c522SLaurent Pinchart return ret;
1535828dbc29SManivannan Sadhasivam
1536e5d363caSLaurent Pinchart /* Acquire resources. */
1537828dbc29SManivannan Sadhasivam imx290->xclk = devm_clk_get(dev, "xclk");
153863127235SLaurent Pinchart if (IS_ERR(imx290->xclk))
153963127235SLaurent Pinchart return dev_err_probe(dev, PTR_ERR(imx290->xclk),
1540d56f39f7SAlexander Stein "Could not get xclk\n");
1541828dbc29SManivannan Sadhasivam
1542828dbc29SManivannan Sadhasivam ret = imx290_get_regulators(dev, imx290);
154363127235SLaurent Pinchart if (ret < 0)
154463127235SLaurent Pinchart return dev_err_probe(dev, ret, "Cannot get regulators\n");
1545828dbc29SManivannan Sadhasivam
15463909a92dSAndrey Konovalov imx290->rst_gpio = devm_gpiod_get_optional(dev, "reset",
15473909a92dSAndrey Konovalov GPIOD_OUT_HIGH);
154863127235SLaurent Pinchart if (IS_ERR(imx290->rst_gpio))
154963127235SLaurent Pinchart return dev_err_probe(dev, PTR_ERR(imx290->rst_gpio),
155063127235SLaurent Pinchart "Cannot get reset gpio\n");
1551828dbc29SManivannan Sadhasivam
1552e5d363caSLaurent Pinchart /* Initialize external clock frequency. */
1553e5d363caSLaurent Pinchart ret = imx290_init_clk(imx290);
1554e5d363caSLaurent Pinchart if (ret)
1555e5d363caSLaurent Pinchart return ret;
1556e5d363caSLaurent Pinchart
1557a8c3e0c1SLaurent Pinchart /*
1558a8c3e0c1SLaurent Pinchart * Enable power management. The driver supports runtime PM, but needs to
1559a8c3e0c1SLaurent Pinchart * work when runtime PM is disabled in the kernel. To that end, power
1560a8c3e0c1SLaurent Pinchart * the sensor on manually here.
1561a8c3e0c1SLaurent Pinchart */
156202852c01SLaurent Pinchart ret = imx290_power_on(imx290);
1563828dbc29SManivannan Sadhasivam if (ret < 0) {
1564828dbc29SManivannan Sadhasivam dev_err(dev, "Could not power on the device\n");
156502852c01SLaurent Pinchart return ret;
1566828dbc29SManivannan Sadhasivam }
1567828dbc29SManivannan Sadhasivam
1568a8c3e0c1SLaurent Pinchart /*
1569a8c3e0c1SLaurent Pinchart * Enable runtime PM with autosuspend. As the device has been powered
1570a8c3e0c1SLaurent Pinchart * manually, mark it as active, and increase the usage count without
1571a8c3e0c1SLaurent Pinchart * resuming the device.
1572a8c3e0c1SLaurent Pinchart */
1573828dbc29SManivannan Sadhasivam pm_runtime_set_active(dev);
1574a8c3e0c1SLaurent Pinchart pm_runtime_get_noresume(dev);
1575828dbc29SManivannan Sadhasivam pm_runtime_enable(dev);
1576a8c3e0c1SLaurent Pinchart pm_runtime_set_autosuspend_delay(dev, 1000);
1577a8c3e0c1SLaurent Pinchart pm_runtime_use_autosuspend(dev);
1578a8c3e0c1SLaurent Pinchart
157902852c01SLaurent Pinchart /* Initialize the V4L2 subdev. */
158002852c01SLaurent Pinchart ret = imx290_subdev_init(imx290);
158102852c01SLaurent Pinchart if (ret)
158202852c01SLaurent Pinchart goto err_pm;
158302852c01SLaurent Pinchart
15842d41947eSAlexander Stein v4l2_i2c_subdev_set_name(&imx290->sd, client,
15852d41947eSAlexander Stein imx290->model->name, NULL);
15862d41947eSAlexander Stein
1587a8c3e0c1SLaurent Pinchart /*
1588a8c3e0c1SLaurent Pinchart * Finally, register the V4L2 subdev. This must be done after
1589a8c3e0c1SLaurent Pinchart * initializing everything as the subdev can be used immediately after
1590a8c3e0c1SLaurent Pinchart * being registered.
1591a8c3e0c1SLaurent Pinchart */
1592a8c3e0c1SLaurent Pinchart ret = v4l2_async_register_subdev(&imx290->sd);
1593a8c3e0c1SLaurent Pinchart if (ret < 0) {
1594a8c3e0c1SLaurent Pinchart dev_err(dev, "Could not register v4l2 device\n");
159502852c01SLaurent Pinchart goto err_subdev;
1596a8c3e0c1SLaurent Pinchart }
1597a8c3e0c1SLaurent Pinchart
1598a8c3e0c1SLaurent Pinchart /*
1599a8c3e0c1SLaurent Pinchart * Decrease the PM usage count. The device will get suspended after the
1600a8c3e0c1SLaurent Pinchart * autosuspend delay, turning the power off.
1601a8c3e0c1SLaurent Pinchart */
1602a8c3e0c1SLaurent Pinchart pm_runtime_mark_last_busy(dev);
1603a8c3e0c1SLaurent Pinchart pm_runtime_put_autosuspend(dev);
1604828dbc29SManivannan Sadhasivam
1605828dbc29SManivannan Sadhasivam return 0;
1606828dbc29SManivannan Sadhasivam
160702852c01SLaurent Pinchart err_subdev:
160802852c01SLaurent Pinchart imx290_subdev_cleanup(imx290);
1609a8c3e0c1SLaurent Pinchart err_pm:
1610a8c3e0c1SLaurent Pinchart pm_runtime_disable(dev);
1611a8c3e0c1SLaurent Pinchart pm_runtime_put_noidle(dev);
161202852c01SLaurent Pinchart imx290_power_off(imx290);
1613828dbc29SManivannan Sadhasivam return ret;
1614828dbc29SManivannan Sadhasivam }
1615828dbc29SManivannan Sadhasivam
imx290_remove(struct i2c_client * client)1616ed5c2f5fSUwe Kleine-König static void imx290_remove(struct i2c_client *client)
1617828dbc29SManivannan Sadhasivam {
1618828dbc29SManivannan Sadhasivam struct v4l2_subdev *sd = i2c_get_clientdata(client);
1619828dbc29SManivannan Sadhasivam struct imx290 *imx290 = to_imx290(sd);
1620828dbc29SManivannan Sadhasivam
1621828dbc29SManivannan Sadhasivam v4l2_async_unregister_subdev(sd);
1622dfb704daSLaurent Pinchart imx290_subdev_cleanup(imx290);
1623828dbc29SManivannan Sadhasivam
1624a8c3e0c1SLaurent Pinchart /*
1625a8c3e0c1SLaurent Pinchart * Disable runtime PM. In case runtime PM is disabled in the kernel,
1626a8c3e0c1SLaurent Pinchart * make sure to turn power off manually.
1627a8c3e0c1SLaurent Pinchart */
1628828dbc29SManivannan Sadhasivam pm_runtime_disable(imx290->dev);
1629828dbc29SManivannan Sadhasivam if (!pm_runtime_status_suspended(imx290->dev))
163002852c01SLaurent Pinchart imx290_power_off(imx290);
1631828dbc29SManivannan Sadhasivam pm_runtime_set_suspended(imx290->dev);
1632828dbc29SManivannan Sadhasivam }
1633828dbc29SManivannan Sadhasivam
1634828dbc29SManivannan Sadhasivam static const struct of_device_id imx290_of_match[] = {
16358bb19dd7SDave Stevenson {
16368bb19dd7SDave Stevenson /* Deprecated - synonym for "sony,imx290lqr" */
16378bb19dd7SDave Stevenson .compatible = "sony,imx290",
16388bb19dd7SDave Stevenson .data = &imx290_models[IMX290_MODEL_IMX290LQR],
16398bb19dd7SDave Stevenson }, {
16408bb19dd7SDave Stevenson .compatible = "sony,imx290lqr",
16418bb19dd7SDave Stevenson .data = &imx290_models[IMX290_MODEL_IMX290LQR],
16428bb19dd7SDave Stevenson }, {
16438bb19dd7SDave Stevenson .compatible = "sony,imx290llr",
16448bb19dd7SDave Stevenson .data = &imx290_models[IMX290_MODEL_IMX290LLR],
16452d41947eSAlexander Stein }, {
16462d41947eSAlexander Stein .compatible = "sony,imx327lqr",
16472d41947eSAlexander Stein .data = &imx290_models[IMX290_MODEL_IMX327LQR],
16488bb19dd7SDave Stevenson },
16498bb19dd7SDave Stevenson { /* sentinel */ },
1650828dbc29SManivannan Sadhasivam };
1651828dbc29SManivannan Sadhasivam MODULE_DEVICE_TABLE(of, imx290_of_match);
1652828dbc29SManivannan Sadhasivam
1653828dbc29SManivannan Sadhasivam static struct i2c_driver imx290_i2c_driver = {
1654aaeb31c0SUwe Kleine-König .probe = imx290_probe,
1655828dbc29SManivannan Sadhasivam .remove = imx290_remove,
1656828dbc29SManivannan Sadhasivam .driver = {
1657828dbc29SManivannan Sadhasivam .name = "imx290",
1658b928db94SArnd Bergmann .pm = pm_ptr(&imx290_pm_ops),
1659b928db94SArnd Bergmann .of_match_table = imx290_of_match,
1660828dbc29SManivannan Sadhasivam },
1661828dbc29SManivannan Sadhasivam };
1662828dbc29SManivannan Sadhasivam
1663828dbc29SManivannan Sadhasivam module_i2c_driver(imx290_i2c_driver);
1664828dbc29SManivannan Sadhasivam
1665828dbc29SManivannan Sadhasivam MODULE_DESCRIPTION("Sony IMX290 CMOS Image Sensor Driver");
1666828dbc29SManivannan Sadhasivam MODULE_AUTHOR("FRAMOS GmbH");
1667828dbc29SManivannan Sadhasivam MODULE_AUTHOR("Manivannan Sadhasivam <manivannan.sadhasivam@linaro.org>");
1668828dbc29SManivannan Sadhasivam MODULE_LICENSE("GPL v2");
1669