1aab7ed1cSJacopo Mondi // SPDX-License-Identifier: GPL-2.0
2aab7ed1cSJacopo Mondi /*
3aab7ed1cSJacopo Mondi * V4L2 sensor driver for Aptina MT9V111 image sensor
4aab7ed1cSJacopo Mondi * Copyright (C) 2018 Jacopo Mondi <jacopo@jmondi.org>
5aab7ed1cSJacopo Mondi *
6aab7ed1cSJacopo Mondi * Based on mt9v032 driver
7aab7ed1cSJacopo Mondi * Copyright (C) 2010, Laurent Pinchart <laurent.pinchart@ideasonboard.com>
8aab7ed1cSJacopo Mondi * Copyright (C) 2008, Guennadi Liakhovetski <kernel@pengutronix.de>
9aab7ed1cSJacopo Mondi *
10aab7ed1cSJacopo Mondi * Based on mt9v011 driver
11aab7ed1cSJacopo Mondi * Copyright (c) 2009 Mauro Carvalho Chehab <mchehab@kernel.org>
12aab7ed1cSJacopo Mondi */
13aab7ed1cSJacopo Mondi
14aab7ed1cSJacopo Mondi #include <linux/clk.h>
15aab7ed1cSJacopo Mondi #include <linux/delay.h>
16aab7ed1cSJacopo Mondi #include <linux/gpio/consumer.h>
17aab7ed1cSJacopo Mondi #include <linux/i2c.h>
18aab7ed1cSJacopo Mondi #include <linux/of.h>
19aab7ed1cSJacopo Mondi #include <linux/slab.h>
20aab7ed1cSJacopo Mondi #include <linux/videodev2.h>
21aab7ed1cSJacopo Mondi #include <linux/v4l2-mediabus.h>
22aab7ed1cSJacopo Mondi #include <linux/module.h>
23aab7ed1cSJacopo Mondi
24aab7ed1cSJacopo Mondi #include <media/v4l2-ctrls.h>
25aab7ed1cSJacopo Mondi #include <media/v4l2-device.h>
26aab7ed1cSJacopo Mondi #include <media/v4l2-fwnode.h>
27aab7ed1cSJacopo Mondi #include <media/v4l2-image-sizes.h>
28aab7ed1cSJacopo Mondi #include <media/v4l2-subdev.h>
29aab7ed1cSJacopo Mondi
30aab7ed1cSJacopo Mondi /*
31aab7ed1cSJacopo Mondi * MT9V111 is a 1/4-Inch CMOS digital image sensor with an integrated
32aab7ed1cSJacopo Mondi * Image Flow Processing (IFP) engine and a sensor core loosely based on
33aab7ed1cSJacopo Mondi * MT9V011.
34aab7ed1cSJacopo Mondi *
35aab7ed1cSJacopo Mondi * The IFP can produce several output image formats from the sensor core
36aab7ed1cSJacopo Mondi * output. This driver currently supports only YUYV format permutations.
37aab7ed1cSJacopo Mondi *
38aab7ed1cSJacopo Mondi * The driver allows manual frame rate control through s_frame_interval subdev
39aab7ed1cSJacopo Mondi * operation or V4L2_CID_V/HBLANK controls, but it is known that the
40aab7ed1cSJacopo Mondi * auto-exposure algorithm might modify the programmed frame rate. While the
41aab7ed1cSJacopo Mondi * driver initially programs the sensor with auto-exposure and
42aab7ed1cSJacopo Mondi * auto-white-balancing enabled, it is possible to disable them and more
43aab7ed1cSJacopo Mondi * precisely control the frame rate.
44aab7ed1cSJacopo Mondi *
45aab7ed1cSJacopo Mondi * While it seems possible to instruct the auto-exposure control algorithm to
46aab7ed1cSJacopo Mondi * respect a programmed frame rate when adjusting the pixel integration time,
47aab7ed1cSJacopo Mondi * registers controlling this feature are not documented in the public
48aab7ed1cSJacopo Mondi * available sensor manual used to develop this driver (09005aef80e90084,
49aab7ed1cSJacopo Mondi * MT9V111_1.fm - Rev. G 1/05 EN).
50aab7ed1cSJacopo Mondi */
51aab7ed1cSJacopo Mondi
52aab7ed1cSJacopo Mondi #define MT9V111_CHIP_ID_HIGH 0x82
53aab7ed1cSJacopo Mondi #define MT9V111_CHIP_ID_LOW 0x3a
54aab7ed1cSJacopo Mondi
55aab7ed1cSJacopo Mondi #define MT9V111_R01_ADDR_SPACE 0x01
56aab7ed1cSJacopo Mondi #define MT9V111_R01_IFP 0x01
57aab7ed1cSJacopo Mondi #define MT9V111_R01_CORE 0x04
58aab7ed1cSJacopo Mondi
59aab7ed1cSJacopo Mondi #define MT9V111_IFP_R06_OPMODE_CTRL 0x06
60aab7ed1cSJacopo Mondi #define MT9V111_IFP_R06_OPMODE_CTRL_AWB_EN BIT(1)
61aab7ed1cSJacopo Mondi #define MT9V111_IFP_R06_OPMODE_CTRL_AE_EN BIT(14)
62aab7ed1cSJacopo Mondi #define MT9V111_IFP_R07_IFP_RESET 0x07
63aab7ed1cSJacopo Mondi #define MT9V111_IFP_R07_IFP_RESET_MASK BIT(0)
64aab7ed1cSJacopo Mondi #define MT9V111_IFP_R08_OUTFMT_CTRL 0x08
65aab7ed1cSJacopo Mondi #define MT9V111_IFP_R08_OUTFMT_CTRL_FLICKER BIT(11)
66aab7ed1cSJacopo Mondi #define MT9V111_IFP_R08_OUTFMT_CTRL_PCLK BIT(5)
67aab7ed1cSJacopo Mondi #define MT9V111_IFP_R3A_OUTFMT_CTRL2 0x3a
68aab7ed1cSJacopo Mondi #define MT9V111_IFP_R3A_OUTFMT_CTRL2_SWAP_CBCR BIT(0)
69aab7ed1cSJacopo Mondi #define MT9V111_IFP_R3A_OUTFMT_CTRL2_SWAP_YC BIT(1)
70aab7ed1cSJacopo Mondi #define MT9V111_IFP_R3A_OUTFMT_CTRL2_SWAP_MASK GENMASK(2, 0)
71aab7ed1cSJacopo Mondi #define MT9V111_IFP_RA5_HPAN 0xa5
72aab7ed1cSJacopo Mondi #define MT9V111_IFP_RA6_HZOOM 0xa6
73aab7ed1cSJacopo Mondi #define MT9V111_IFP_RA7_HOUT 0xa7
74aab7ed1cSJacopo Mondi #define MT9V111_IFP_RA8_VPAN 0xa8
75aab7ed1cSJacopo Mondi #define MT9V111_IFP_RA9_VZOOM 0xa9
76aab7ed1cSJacopo Mondi #define MT9V111_IFP_RAA_VOUT 0xaa
77aab7ed1cSJacopo Mondi #define MT9V111_IFP_DECIMATION_MASK GENMASK(9, 0)
78aab7ed1cSJacopo Mondi #define MT9V111_IFP_DECIMATION_FREEZE BIT(15)
79aab7ed1cSJacopo Mondi
80aab7ed1cSJacopo Mondi #define MT9V111_CORE_R03_WIN_HEIGHT 0x03
81aab7ed1cSJacopo Mondi #define MT9V111_CORE_R03_WIN_V_OFFS 2
82aab7ed1cSJacopo Mondi #define MT9V111_CORE_R04_WIN_WIDTH 0x04
83aab7ed1cSJacopo Mondi #define MT9V111_CORE_R04_WIN_H_OFFS 114
84aab7ed1cSJacopo Mondi #define MT9V111_CORE_R05_HBLANK 0x05
85aab7ed1cSJacopo Mondi #define MT9V111_CORE_R05_MIN_HBLANK 0x09
86aab7ed1cSJacopo Mondi #define MT9V111_CORE_R05_MAX_HBLANK GENMASK(9, 0)
87aab7ed1cSJacopo Mondi #define MT9V111_CORE_R05_DEF_HBLANK 0x26
88aab7ed1cSJacopo Mondi #define MT9V111_CORE_R06_VBLANK 0x06
89aab7ed1cSJacopo Mondi #define MT9V111_CORE_R06_MIN_VBLANK 0x03
90aab7ed1cSJacopo Mondi #define MT9V111_CORE_R06_MAX_VBLANK GENMASK(11, 0)
91aab7ed1cSJacopo Mondi #define MT9V111_CORE_R06_DEF_VBLANK 0x04
92aab7ed1cSJacopo Mondi #define MT9V111_CORE_R07_OUT_CTRL 0x07
93aab7ed1cSJacopo Mondi #define MT9V111_CORE_R07_OUT_CTRL_SAMPLE BIT(4)
94aab7ed1cSJacopo Mondi #define MT9V111_CORE_R09_PIXEL_INT 0x09
95aab7ed1cSJacopo Mondi #define MT9V111_CORE_R09_PIXEL_INT_MASK GENMASK(11, 0)
96aab7ed1cSJacopo Mondi #define MT9V111_CORE_R0D_CORE_RESET 0x0d
97aab7ed1cSJacopo Mondi #define MT9V111_CORE_R0D_CORE_RESET_MASK BIT(0)
98aab7ed1cSJacopo Mondi #define MT9V111_CORE_RFF_CHIP_VER 0xff
99aab7ed1cSJacopo Mondi
100aab7ed1cSJacopo Mondi #define MT9V111_PIXEL_ARRAY_WIDTH 640
101aab7ed1cSJacopo Mondi #define MT9V111_PIXEL_ARRAY_HEIGHT 480
102aab7ed1cSJacopo Mondi
103aab7ed1cSJacopo Mondi #define MT9V111_MAX_CLKIN 27000000
104aab7ed1cSJacopo Mondi
105aab7ed1cSJacopo Mondi /* The default sensor configuration at startup time. */
106a03003c5SJulia Lawall static const struct v4l2_mbus_framefmt mt9v111_def_fmt = {
107aab7ed1cSJacopo Mondi .width = 640,
108aab7ed1cSJacopo Mondi .height = 480,
109aab7ed1cSJacopo Mondi .code = MEDIA_BUS_FMT_UYVY8_2X8,
110aab7ed1cSJacopo Mondi .field = V4L2_FIELD_NONE,
111aab7ed1cSJacopo Mondi .colorspace = V4L2_COLORSPACE_SRGB,
112aab7ed1cSJacopo Mondi .ycbcr_enc = V4L2_YCBCR_ENC_601,
113aab7ed1cSJacopo Mondi .quantization = V4L2_QUANTIZATION_LIM_RANGE,
114aab7ed1cSJacopo Mondi .xfer_func = V4L2_XFER_FUNC_SRGB,
115aab7ed1cSJacopo Mondi };
116aab7ed1cSJacopo Mondi
117aab7ed1cSJacopo Mondi struct mt9v111_dev {
118aab7ed1cSJacopo Mondi struct device *dev;
119aab7ed1cSJacopo Mondi struct i2c_client *client;
120aab7ed1cSJacopo Mondi
121aab7ed1cSJacopo Mondi u8 addr_space;
122aab7ed1cSJacopo Mondi
123aab7ed1cSJacopo Mondi struct v4l2_subdev sd;
124aab7ed1cSJacopo Mondi #if IS_ENABLED(CONFIG_MEDIA_CONTROLLER)
125aab7ed1cSJacopo Mondi struct media_pad pad;
126aab7ed1cSJacopo Mondi #endif
127aab7ed1cSJacopo Mondi
128aab7ed1cSJacopo Mondi struct v4l2_ctrl *auto_awb;
129aab7ed1cSJacopo Mondi struct v4l2_ctrl *auto_exp;
130aab7ed1cSJacopo Mondi struct v4l2_ctrl *hblank;
131aab7ed1cSJacopo Mondi struct v4l2_ctrl *vblank;
132aab7ed1cSJacopo Mondi struct v4l2_ctrl_handler ctrls;
133aab7ed1cSJacopo Mondi
134aab7ed1cSJacopo Mondi /* Output image format and sizes. */
135aab7ed1cSJacopo Mondi struct v4l2_mbus_framefmt fmt;
136aab7ed1cSJacopo Mondi unsigned int fps;
137aab7ed1cSJacopo Mondi
138aab7ed1cSJacopo Mondi /* Protects power up/down sequences. */
139aab7ed1cSJacopo Mondi struct mutex pwr_mutex;
140aab7ed1cSJacopo Mondi int pwr_count;
141aab7ed1cSJacopo Mondi
142aab7ed1cSJacopo Mondi /* Protects stream on/off sequences. */
143aab7ed1cSJacopo Mondi struct mutex stream_mutex;
144aab7ed1cSJacopo Mondi bool streaming;
145aab7ed1cSJacopo Mondi
146aab7ed1cSJacopo Mondi /* Flags to mark HW settings as not yet applied. */
147aab7ed1cSJacopo Mondi bool pending;
148aab7ed1cSJacopo Mondi
149aab7ed1cSJacopo Mondi /* Clock provider and system clock frequency. */
150aab7ed1cSJacopo Mondi struct clk *clk;
151aab7ed1cSJacopo Mondi u32 sysclk;
152aab7ed1cSJacopo Mondi
153aab7ed1cSJacopo Mondi struct gpio_desc *oe;
154aab7ed1cSJacopo Mondi struct gpio_desc *standby;
155aab7ed1cSJacopo Mondi struct gpio_desc *reset;
156aab7ed1cSJacopo Mondi };
157aab7ed1cSJacopo Mondi
158aab7ed1cSJacopo Mondi #define sd_to_mt9v111(__sd) container_of((__sd), struct mt9v111_dev, sd)
159aab7ed1cSJacopo Mondi
160aab7ed1cSJacopo Mondi /*
161aab7ed1cSJacopo Mondi * mt9v111_mbus_fmt - List all media bus formats supported by the driver.
162aab7ed1cSJacopo Mondi *
163aab7ed1cSJacopo Mondi * Only list the media bus code here. The image sizes are freely configurable
164aab7ed1cSJacopo Mondi * in the pixel array sizes range.
165aab7ed1cSJacopo Mondi *
166aab7ed1cSJacopo Mondi * The desired frame interval, in the supported frame interval range, is
167aab7ed1cSJacopo Mondi * obtained by configuring blanking as the sensor does not have a PLL but
168aab7ed1cSJacopo Mondi * only a fixed clock divider that generates the output pixel clock.
169aab7ed1cSJacopo Mondi */
170aab7ed1cSJacopo Mondi static struct mt9v111_mbus_fmt {
171aab7ed1cSJacopo Mondi u32 code;
172aab7ed1cSJacopo Mondi } mt9v111_formats[] = {
173aab7ed1cSJacopo Mondi {
174aab7ed1cSJacopo Mondi .code = MEDIA_BUS_FMT_UYVY8_2X8,
175aab7ed1cSJacopo Mondi },
176aab7ed1cSJacopo Mondi {
177aab7ed1cSJacopo Mondi .code = MEDIA_BUS_FMT_YUYV8_2X8,
178aab7ed1cSJacopo Mondi },
179aab7ed1cSJacopo Mondi {
180aab7ed1cSJacopo Mondi .code = MEDIA_BUS_FMT_VYUY8_2X8,
181aab7ed1cSJacopo Mondi },
182aab7ed1cSJacopo Mondi {
183aab7ed1cSJacopo Mondi .code = MEDIA_BUS_FMT_YVYU8_2X8,
184aab7ed1cSJacopo Mondi },
185aab7ed1cSJacopo Mondi };
186aab7ed1cSJacopo Mondi
187aab7ed1cSJacopo Mondi static u32 mt9v111_frame_intervals[] = {5, 10, 15, 20, 30};
188aab7ed1cSJacopo Mondi
189aab7ed1cSJacopo Mondi /*
190aab7ed1cSJacopo Mondi * mt9v111_frame_sizes - List sensor's supported resolutions.
191aab7ed1cSJacopo Mondi *
192aab7ed1cSJacopo Mondi * Resolution generated through decimation in the IFP block from the
193aab7ed1cSJacopo Mondi * full VGA pixel array.
194aab7ed1cSJacopo Mondi */
195aab7ed1cSJacopo Mondi static struct v4l2_rect mt9v111_frame_sizes[] = {
196aab7ed1cSJacopo Mondi {
197aab7ed1cSJacopo Mondi .width = 640,
198aab7ed1cSJacopo Mondi .height = 480,
199aab7ed1cSJacopo Mondi },
200aab7ed1cSJacopo Mondi {
201aab7ed1cSJacopo Mondi .width = 352,
202aab7ed1cSJacopo Mondi .height = 288
203aab7ed1cSJacopo Mondi },
204aab7ed1cSJacopo Mondi {
205aab7ed1cSJacopo Mondi .width = 320,
206aab7ed1cSJacopo Mondi .height = 240,
207aab7ed1cSJacopo Mondi },
208aab7ed1cSJacopo Mondi {
209aab7ed1cSJacopo Mondi .width = 176,
210aab7ed1cSJacopo Mondi .height = 144,
211aab7ed1cSJacopo Mondi },
212aab7ed1cSJacopo Mondi {
213aab7ed1cSJacopo Mondi .width = 160,
214aab7ed1cSJacopo Mondi .height = 120,
215aab7ed1cSJacopo Mondi },
216aab7ed1cSJacopo Mondi };
217aab7ed1cSJacopo Mondi
218aab7ed1cSJacopo Mondi /* --- Device I/O access --- */
219aab7ed1cSJacopo Mondi
__mt9v111_read(struct i2c_client * c,u8 reg,u16 * val)220aab7ed1cSJacopo Mondi static int __mt9v111_read(struct i2c_client *c, u8 reg, u16 *val)
221aab7ed1cSJacopo Mondi {
222aab7ed1cSJacopo Mondi struct i2c_msg msg[2];
223aab7ed1cSJacopo Mondi __be16 buf;
224aab7ed1cSJacopo Mondi int ret;
225aab7ed1cSJacopo Mondi
226aab7ed1cSJacopo Mondi msg[0].addr = c->addr;
227aab7ed1cSJacopo Mondi msg[0].flags = 0;
228aab7ed1cSJacopo Mondi msg[0].len = 1;
229aab7ed1cSJacopo Mondi msg[0].buf = ®
230aab7ed1cSJacopo Mondi
231aab7ed1cSJacopo Mondi msg[1].addr = c->addr;
232aab7ed1cSJacopo Mondi msg[1].flags = I2C_M_RD;
233aab7ed1cSJacopo Mondi msg[1].len = 2;
234aab7ed1cSJacopo Mondi msg[1].buf = (char *)&buf;
235aab7ed1cSJacopo Mondi
236aab7ed1cSJacopo Mondi ret = i2c_transfer(c->adapter, msg, 2);
237aab7ed1cSJacopo Mondi if (ret < 0) {
238aab7ed1cSJacopo Mondi dev_err(&c->dev, "i2c read transfer error: %d\n", ret);
239aab7ed1cSJacopo Mondi return ret;
240aab7ed1cSJacopo Mondi }
241aab7ed1cSJacopo Mondi
242aab7ed1cSJacopo Mondi *val = be16_to_cpu(buf);
243aab7ed1cSJacopo Mondi
244aab7ed1cSJacopo Mondi dev_dbg(&c->dev, "%s: %x=%x\n", __func__, reg, *val);
245aab7ed1cSJacopo Mondi
246aab7ed1cSJacopo Mondi return 0;
247aab7ed1cSJacopo Mondi }
248aab7ed1cSJacopo Mondi
__mt9v111_write(struct i2c_client * c,u8 reg,u16 val)249aab7ed1cSJacopo Mondi static int __mt9v111_write(struct i2c_client *c, u8 reg, u16 val)
250aab7ed1cSJacopo Mondi {
251aab7ed1cSJacopo Mondi struct i2c_msg msg;
252aab7ed1cSJacopo Mondi u8 buf[3] = { 0 };
253aab7ed1cSJacopo Mondi int ret;
254aab7ed1cSJacopo Mondi
255aab7ed1cSJacopo Mondi buf[0] = reg;
256aab7ed1cSJacopo Mondi buf[1] = val >> 8;
257aab7ed1cSJacopo Mondi buf[2] = val & 0xff;
258aab7ed1cSJacopo Mondi
259aab7ed1cSJacopo Mondi msg.addr = c->addr;
260aab7ed1cSJacopo Mondi msg.flags = 0;
261aab7ed1cSJacopo Mondi msg.len = 3;
262aab7ed1cSJacopo Mondi msg.buf = (char *)buf;
263aab7ed1cSJacopo Mondi
264aab7ed1cSJacopo Mondi dev_dbg(&c->dev, "%s: %x = %x%x\n", __func__, reg, buf[1], buf[2]);
265aab7ed1cSJacopo Mondi
266aab7ed1cSJacopo Mondi ret = i2c_transfer(c->adapter, &msg, 1);
267aab7ed1cSJacopo Mondi if (ret < 0) {
268aab7ed1cSJacopo Mondi dev_err(&c->dev, "i2c write transfer error: %d\n", ret);
269aab7ed1cSJacopo Mondi return ret;
270aab7ed1cSJacopo Mondi }
271aab7ed1cSJacopo Mondi
272aab7ed1cSJacopo Mondi return 0;
273aab7ed1cSJacopo Mondi }
274aab7ed1cSJacopo Mondi
__mt9v111_addr_space_select(struct i2c_client * c,u16 addr_space)275aab7ed1cSJacopo Mondi static int __mt9v111_addr_space_select(struct i2c_client *c, u16 addr_space)
276aab7ed1cSJacopo Mondi {
277aab7ed1cSJacopo Mondi struct v4l2_subdev *sd = i2c_get_clientdata(c);
278aab7ed1cSJacopo Mondi struct mt9v111_dev *mt9v111 = sd_to_mt9v111(sd);
279aab7ed1cSJacopo Mondi u16 val;
280aab7ed1cSJacopo Mondi int ret;
281aab7ed1cSJacopo Mondi
282aab7ed1cSJacopo Mondi if (mt9v111->addr_space == addr_space)
283aab7ed1cSJacopo Mondi return 0;
284aab7ed1cSJacopo Mondi
285aab7ed1cSJacopo Mondi ret = __mt9v111_write(c, MT9V111_R01_ADDR_SPACE, addr_space);
286aab7ed1cSJacopo Mondi if (ret)
287aab7ed1cSJacopo Mondi return ret;
288aab7ed1cSJacopo Mondi
289aab7ed1cSJacopo Mondi /* Verify address space has been updated */
290aab7ed1cSJacopo Mondi ret = __mt9v111_read(c, MT9V111_R01_ADDR_SPACE, &val);
291aab7ed1cSJacopo Mondi if (ret)
292aab7ed1cSJacopo Mondi return ret;
293aab7ed1cSJacopo Mondi
294aab7ed1cSJacopo Mondi if (val != addr_space)
295aab7ed1cSJacopo Mondi return -EINVAL;
296aab7ed1cSJacopo Mondi
297aab7ed1cSJacopo Mondi mt9v111->addr_space = addr_space;
298aab7ed1cSJacopo Mondi
299aab7ed1cSJacopo Mondi return 0;
300aab7ed1cSJacopo Mondi }
301aab7ed1cSJacopo Mondi
mt9v111_read(struct i2c_client * c,u8 addr_space,u8 reg,u16 * val)302aab7ed1cSJacopo Mondi static int mt9v111_read(struct i2c_client *c, u8 addr_space, u8 reg, u16 *val)
303aab7ed1cSJacopo Mondi {
304aab7ed1cSJacopo Mondi int ret;
305aab7ed1cSJacopo Mondi
306aab7ed1cSJacopo Mondi /* Select register address space first. */
307aab7ed1cSJacopo Mondi ret = __mt9v111_addr_space_select(c, addr_space);
308aab7ed1cSJacopo Mondi if (ret)
309aab7ed1cSJacopo Mondi return ret;
310aab7ed1cSJacopo Mondi
311aab7ed1cSJacopo Mondi ret = __mt9v111_read(c, reg, val);
312aab7ed1cSJacopo Mondi if (ret)
313aab7ed1cSJacopo Mondi return ret;
314aab7ed1cSJacopo Mondi
315aab7ed1cSJacopo Mondi return 0;
316aab7ed1cSJacopo Mondi }
317aab7ed1cSJacopo Mondi
mt9v111_write(struct i2c_client * c,u8 addr_space,u8 reg,u16 val)318aab7ed1cSJacopo Mondi static int mt9v111_write(struct i2c_client *c, u8 addr_space, u8 reg, u16 val)
319aab7ed1cSJacopo Mondi {
320aab7ed1cSJacopo Mondi int ret;
321aab7ed1cSJacopo Mondi
322aab7ed1cSJacopo Mondi /* Select register address space first. */
323aab7ed1cSJacopo Mondi ret = __mt9v111_addr_space_select(c, addr_space);
324aab7ed1cSJacopo Mondi if (ret)
325aab7ed1cSJacopo Mondi return ret;
326aab7ed1cSJacopo Mondi
327aab7ed1cSJacopo Mondi ret = __mt9v111_write(c, reg, val);
328aab7ed1cSJacopo Mondi if (ret)
329aab7ed1cSJacopo Mondi return ret;
330aab7ed1cSJacopo Mondi
331aab7ed1cSJacopo Mondi return 0;
332aab7ed1cSJacopo Mondi }
333aab7ed1cSJacopo Mondi
mt9v111_update(struct i2c_client * c,u8 addr_space,u8 reg,u16 mask,u16 val)334aab7ed1cSJacopo Mondi static int mt9v111_update(struct i2c_client *c, u8 addr_space, u8 reg,
335aab7ed1cSJacopo Mondi u16 mask, u16 val)
336aab7ed1cSJacopo Mondi {
337aab7ed1cSJacopo Mondi u16 current_val;
338aab7ed1cSJacopo Mondi int ret;
339aab7ed1cSJacopo Mondi
340aab7ed1cSJacopo Mondi /* Select register address space first. */
341aab7ed1cSJacopo Mondi ret = __mt9v111_addr_space_select(c, addr_space);
342aab7ed1cSJacopo Mondi if (ret)
343aab7ed1cSJacopo Mondi return ret;
344aab7ed1cSJacopo Mondi
345aab7ed1cSJacopo Mondi /* Read the current register value, then update it. */
346aab7ed1cSJacopo Mondi ret = __mt9v111_read(c, reg, ¤t_val);
347aab7ed1cSJacopo Mondi if (ret)
348aab7ed1cSJacopo Mondi return ret;
349aab7ed1cSJacopo Mondi
350aab7ed1cSJacopo Mondi current_val &= ~mask;
351aab7ed1cSJacopo Mondi current_val |= (val & mask);
352aab7ed1cSJacopo Mondi ret = __mt9v111_write(c, reg, current_val);
353aab7ed1cSJacopo Mondi if (ret)
354aab7ed1cSJacopo Mondi return ret;
355aab7ed1cSJacopo Mondi
356aab7ed1cSJacopo Mondi return 0;
357aab7ed1cSJacopo Mondi }
358aab7ed1cSJacopo Mondi
359aab7ed1cSJacopo Mondi /* --- Sensor HW operations --- */
360aab7ed1cSJacopo Mondi
__mt9v111_power_on(struct v4l2_subdev * sd)361aab7ed1cSJacopo Mondi static int __mt9v111_power_on(struct v4l2_subdev *sd)
362aab7ed1cSJacopo Mondi {
363aab7ed1cSJacopo Mondi struct mt9v111_dev *mt9v111 = sd_to_mt9v111(sd);
364aab7ed1cSJacopo Mondi int ret;
365aab7ed1cSJacopo Mondi
366aab7ed1cSJacopo Mondi ret = clk_prepare_enable(mt9v111->clk);
367aab7ed1cSJacopo Mondi if (ret)
368aab7ed1cSJacopo Mondi return ret;
369aab7ed1cSJacopo Mondi
370aab7ed1cSJacopo Mondi clk_set_rate(mt9v111->clk, mt9v111->sysclk);
371aab7ed1cSJacopo Mondi
372aab7ed1cSJacopo Mondi gpiod_set_value(mt9v111->standby, 0);
373aab7ed1cSJacopo Mondi usleep_range(500, 1000);
374aab7ed1cSJacopo Mondi
375aab7ed1cSJacopo Mondi gpiod_set_value(mt9v111->oe, 1);
376aab7ed1cSJacopo Mondi usleep_range(500, 1000);
377aab7ed1cSJacopo Mondi
378aab7ed1cSJacopo Mondi return 0;
379aab7ed1cSJacopo Mondi }
380aab7ed1cSJacopo Mondi
__mt9v111_power_off(struct v4l2_subdev * sd)381aab7ed1cSJacopo Mondi static int __mt9v111_power_off(struct v4l2_subdev *sd)
382aab7ed1cSJacopo Mondi {
383aab7ed1cSJacopo Mondi struct mt9v111_dev *mt9v111 = sd_to_mt9v111(sd);
384aab7ed1cSJacopo Mondi
385aab7ed1cSJacopo Mondi gpiod_set_value(mt9v111->oe, 0);
386aab7ed1cSJacopo Mondi usleep_range(500, 1000);
387aab7ed1cSJacopo Mondi
388aab7ed1cSJacopo Mondi gpiod_set_value(mt9v111->standby, 1);
389aab7ed1cSJacopo Mondi usleep_range(500, 1000);
390aab7ed1cSJacopo Mondi
391aab7ed1cSJacopo Mondi clk_disable_unprepare(mt9v111->clk);
392aab7ed1cSJacopo Mondi
393aab7ed1cSJacopo Mondi return 0;
394aab7ed1cSJacopo Mondi }
395aab7ed1cSJacopo Mondi
__mt9v111_hw_reset(struct mt9v111_dev * mt9v111)396aab7ed1cSJacopo Mondi static int __mt9v111_hw_reset(struct mt9v111_dev *mt9v111)
397aab7ed1cSJacopo Mondi {
398aab7ed1cSJacopo Mondi if (!mt9v111->reset)
399aab7ed1cSJacopo Mondi return -EINVAL;
400aab7ed1cSJacopo Mondi
401aab7ed1cSJacopo Mondi gpiod_set_value(mt9v111->reset, 1);
402aab7ed1cSJacopo Mondi usleep_range(500, 1000);
403aab7ed1cSJacopo Mondi
404aab7ed1cSJacopo Mondi gpiod_set_value(mt9v111->reset, 0);
405aab7ed1cSJacopo Mondi usleep_range(500, 1000);
406aab7ed1cSJacopo Mondi
407aab7ed1cSJacopo Mondi return 0;
408aab7ed1cSJacopo Mondi }
409aab7ed1cSJacopo Mondi
__mt9v111_sw_reset(struct mt9v111_dev * mt9v111)410aab7ed1cSJacopo Mondi static int __mt9v111_sw_reset(struct mt9v111_dev *mt9v111)
411aab7ed1cSJacopo Mondi {
412aab7ed1cSJacopo Mondi struct i2c_client *c = mt9v111->client;
413aab7ed1cSJacopo Mondi int ret;
414aab7ed1cSJacopo Mondi
415aab7ed1cSJacopo Mondi /* Software reset core and IFP blocks. */
416aab7ed1cSJacopo Mondi
417aab7ed1cSJacopo Mondi ret = mt9v111_update(c, MT9V111_R01_CORE,
418aab7ed1cSJacopo Mondi MT9V111_CORE_R0D_CORE_RESET,
419aab7ed1cSJacopo Mondi MT9V111_CORE_R0D_CORE_RESET_MASK, 1);
420aab7ed1cSJacopo Mondi if (ret)
421aab7ed1cSJacopo Mondi return ret;
422aab7ed1cSJacopo Mondi usleep_range(500, 1000);
423aab7ed1cSJacopo Mondi
424aab7ed1cSJacopo Mondi ret = mt9v111_update(c, MT9V111_R01_CORE,
425aab7ed1cSJacopo Mondi MT9V111_CORE_R0D_CORE_RESET,
426aab7ed1cSJacopo Mondi MT9V111_CORE_R0D_CORE_RESET_MASK, 0);
427aab7ed1cSJacopo Mondi if (ret)
428aab7ed1cSJacopo Mondi return ret;
429aab7ed1cSJacopo Mondi usleep_range(500, 1000);
430aab7ed1cSJacopo Mondi
431aab7ed1cSJacopo Mondi ret = mt9v111_update(c, MT9V111_R01_IFP,
432aab7ed1cSJacopo Mondi MT9V111_IFP_R07_IFP_RESET,
433aab7ed1cSJacopo Mondi MT9V111_IFP_R07_IFP_RESET_MASK, 1);
434aab7ed1cSJacopo Mondi if (ret)
435aab7ed1cSJacopo Mondi return ret;
436aab7ed1cSJacopo Mondi usleep_range(500, 1000);
437aab7ed1cSJacopo Mondi
438aab7ed1cSJacopo Mondi ret = mt9v111_update(c, MT9V111_R01_IFP,
439aab7ed1cSJacopo Mondi MT9V111_IFP_R07_IFP_RESET,
440aab7ed1cSJacopo Mondi MT9V111_IFP_R07_IFP_RESET_MASK, 0);
441aab7ed1cSJacopo Mondi if (ret)
442aab7ed1cSJacopo Mondi return ret;
443aab7ed1cSJacopo Mondi usleep_range(500, 1000);
444aab7ed1cSJacopo Mondi
445aab7ed1cSJacopo Mondi return 0;
446aab7ed1cSJacopo Mondi }
447aab7ed1cSJacopo Mondi
mt9v111_calc_frame_rate(struct mt9v111_dev * mt9v111,struct v4l2_fract * tpf)448aab7ed1cSJacopo Mondi static int mt9v111_calc_frame_rate(struct mt9v111_dev *mt9v111,
449aab7ed1cSJacopo Mondi struct v4l2_fract *tpf)
450aab7ed1cSJacopo Mondi {
451aab7ed1cSJacopo Mondi unsigned int fps = tpf->numerator ?
452aab7ed1cSJacopo Mondi tpf->denominator / tpf->numerator :
453aab7ed1cSJacopo Mondi tpf->denominator;
454aab7ed1cSJacopo Mondi unsigned int best_diff;
455aab7ed1cSJacopo Mondi unsigned int frm_cols;
456aab7ed1cSJacopo Mondi unsigned int row_pclk;
457aab7ed1cSJacopo Mondi unsigned int best_fps;
458aab7ed1cSJacopo Mondi unsigned int pclk;
459aab7ed1cSJacopo Mondi unsigned int diff;
460aab7ed1cSJacopo Mondi unsigned int idx;
461aab7ed1cSJacopo Mondi unsigned int hb;
462aab7ed1cSJacopo Mondi unsigned int vb;
463aab7ed1cSJacopo Mondi unsigned int i;
464aab7ed1cSJacopo Mondi int ret;
465aab7ed1cSJacopo Mondi
466aab7ed1cSJacopo Mondi /* Approximate to the closest supported frame interval. */
467aab7ed1cSJacopo Mondi best_diff = ~0L;
468aab7ed1cSJacopo Mondi for (i = 0, idx = 0; i < ARRAY_SIZE(mt9v111_frame_intervals); i++) {
469aab7ed1cSJacopo Mondi diff = abs(fps - mt9v111_frame_intervals[i]);
470aab7ed1cSJacopo Mondi if (diff < best_diff) {
471aab7ed1cSJacopo Mondi idx = i;
472aab7ed1cSJacopo Mondi best_diff = diff;
473aab7ed1cSJacopo Mondi }
474aab7ed1cSJacopo Mondi }
475aab7ed1cSJacopo Mondi fps = mt9v111_frame_intervals[idx];
476aab7ed1cSJacopo Mondi
477aab7ed1cSJacopo Mondi /*
478aab7ed1cSJacopo Mondi * The sensor does not provide a PLL circuitry and pixel clock is
479aab7ed1cSJacopo Mondi * generated dividing the master clock source by two.
480aab7ed1cSJacopo Mondi *
481aab7ed1cSJacopo Mondi * Trow = (W + Hblank + 114) * 2 * (1 / SYSCLK)
482aab7ed1cSJacopo Mondi * TFrame = Trow * (H + Vblank + 2)
483aab7ed1cSJacopo Mondi *
484aab7ed1cSJacopo Mondi * FPS = (SYSCLK / 2) / (Trow * (H + Vblank + 2))
485aab7ed1cSJacopo Mondi *
486aab7ed1cSJacopo Mondi * This boils down to tune H and V blanks to best approximate the
487aab7ed1cSJacopo Mondi * above equation.
488aab7ed1cSJacopo Mondi *
489aab7ed1cSJacopo Mondi * Test all available H/V blank values, until we reach the
490aab7ed1cSJacopo Mondi * desired frame rate.
491aab7ed1cSJacopo Mondi */
492aab7ed1cSJacopo Mondi best_fps = vb = hb = 0;
493aab7ed1cSJacopo Mondi pclk = DIV_ROUND_CLOSEST(mt9v111->sysclk, 2);
494aab7ed1cSJacopo Mondi row_pclk = MT9V111_PIXEL_ARRAY_WIDTH + 7 + MT9V111_CORE_R04_WIN_H_OFFS;
495aab7ed1cSJacopo Mondi frm_cols = MT9V111_PIXEL_ARRAY_HEIGHT + 7 + MT9V111_CORE_R03_WIN_V_OFFS;
496aab7ed1cSJacopo Mondi
497aab7ed1cSJacopo Mondi best_diff = ~0L;
498aab7ed1cSJacopo Mondi for (vb = MT9V111_CORE_R06_MIN_VBLANK;
499aab7ed1cSJacopo Mondi vb < MT9V111_CORE_R06_MAX_VBLANK; vb++) {
500aab7ed1cSJacopo Mondi for (hb = MT9V111_CORE_R05_MIN_HBLANK;
501aab7ed1cSJacopo Mondi hb < MT9V111_CORE_R05_MAX_HBLANK; hb += 10) {
502aab7ed1cSJacopo Mondi unsigned int t_frame = (row_pclk + hb) *
503aab7ed1cSJacopo Mondi (frm_cols + vb);
504aab7ed1cSJacopo Mondi unsigned int t_fps = DIV_ROUND_CLOSEST(pclk, t_frame);
505aab7ed1cSJacopo Mondi
506aab7ed1cSJacopo Mondi diff = abs(fps - t_fps);
507aab7ed1cSJacopo Mondi if (diff < best_diff) {
508aab7ed1cSJacopo Mondi best_diff = diff;
509aab7ed1cSJacopo Mondi best_fps = t_fps;
510aab7ed1cSJacopo Mondi
511aab7ed1cSJacopo Mondi if (diff == 0)
512aab7ed1cSJacopo Mondi break;
513aab7ed1cSJacopo Mondi }
514aab7ed1cSJacopo Mondi }
515aab7ed1cSJacopo Mondi
516aab7ed1cSJacopo Mondi if (diff == 0)
517aab7ed1cSJacopo Mondi break;
518aab7ed1cSJacopo Mondi }
519aab7ed1cSJacopo Mondi
520aab7ed1cSJacopo Mondi ret = v4l2_ctrl_s_ctrl_int64(mt9v111->hblank, hb);
521aab7ed1cSJacopo Mondi if (ret)
522aab7ed1cSJacopo Mondi return ret;
523aab7ed1cSJacopo Mondi
524aab7ed1cSJacopo Mondi ret = v4l2_ctrl_s_ctrl_int64(mt9v111->vblank, vb);
525aab7ed1cSJacopo Mondi if (ret)
526aab7ed1cSJacopo Mondi return ret;
527aab7ed1cSJacopo Mondi
528aab7ed1cSJacopo Mondi tpf->numerator = 1;
529aab7ed1cSJacopo Mondi tpf->denominator = best_fps;
530aab7ed1cSJacopo Mondi
531aab7ed1cSJacopo Mondi return 0;
532aab7ed1cSJacopo Mondi }
533aab7ed1cSJacopo Mondi
mt9v111_hw_config(struct mt9v111_dev * mt9v111)534aab7ed1cSJacopo Mondi static int mt9v111_hw_config(struct mt9v111_dev *mt9v111)
535aab7ed1cSJacopo Mondi {
536aab7ed1cSJacopo Mondi struct i2c_client *c = mt9v111->client;
537aab7ed1cSJacopo Mondi unsigned int ret;
538aab7ed1cSJacopo Mondi u16 outfmtctrl2;
539aab7ed1cSJacopo Mondi
540aab7ed1cSJacopo Mondi /* Force device reset. */
541aab7ed1cSJacopo Mondi ret = __mt9v111_hw_reset(mt9v111);
542aab7ed1cSJacopo Mondi if (ret == -EINVAL)
543aab7ed1cSJacopo Mondi ret = __mt9v111_sw_reset(mt9v111);
544aab7ed1cSJacopo Mondi if (ret)
545aab7ed1cSJacopo Mondi return ret;
546aab7ed1cSJacopo Mondi
547aab7ed1cSJacopo Mondi /* Configure internal clock sample rate. */
548aab7ed1cSJacopo Mondi ret = mt9v111->sysclk < DIV_ROUND_CLOSEST(MT9V111_MAX_CLKIN, 2) ?
549aab7ed1cSJacopo Mondi mt9v111_update(c, MT9V111_R01_CORE,
550aab7ed1cSJacopo Mondi MT9V111_CORE_R07_OUT_CTRL,
551aab7ed1cSJacopo Mondi MT9V111_CORE_R07_OUT_CTRL_SAMPLE, 1) :
552aab7ed1cSJacopo Mondi mt9v111_update(c, MT9V111_R01_CORE,
553aab7ed1cSJacopo Mondi MT9V111_CORE_R07_OUT_CTRL,
554aab7ed1cSJacopo Mondi MT9V111_CORE_R07_OUT_CTRL_SAMPLE, 0);
555aab7ed1cSJacopo Mondi if (ret)
556aab7ed1cSJacopo Mondi return ret;
557aab7ed1cSJacopo Mondi
558aab7ed1cSJacopo Mondi /*
559aab7ed1cSJacopo Mondi * Configure output image format components ordering.
560aab7ed1cSJacopo Mondi *
561aab7ed1cSJacopo Mondi * TODO: IFP block can also output several RGB permutations, we only
562aab7ed1cSJacopo Mondi * support YUYV permutations at the moment.
563aab7ed1cSJacopo Mondi */
564aab7ed1cSJacopo Mondi switch (mt9v111->fmt.code) {
565aab7ed1cSJacopo Mondi case MEDIA_BUS_FMT_YUYV8_2X8:
566aab7ed1cSJacopo Mondi outfmtctrl2 = MT9V111_IFP_R3A_OUTFMT_CTRL2_SWAP_YC;
567aab7ed1cSJacopo Mondi break;
568aab7ed1cSJacopo Mondi case MEDIA_BUS_FMT_VYUY8_2X8:
569aab7ed1cSJacopo Mondi outfmtctrl2 = MT9V111_IFP_R3A_OUTFMT_CTRL2_SWAP_CBCR;
570aab7ed1cSJacopo Mondi break;
571aab7ed1cSJacopo Mondi case MEDIA_BUS_FMT_YVYU8_2X8:
572aab7ed1cSJacopo Mondi outfmtctrl2 = MT9V111_IFP_R3A_OUTFMT_CTRL2_SWAP_YC |
573aab7ed1cSJacopo Mondi MT9V111_IFP_R3A_OUTFMT_CTRL2_SWAP_CBCR;
574aab7ed1cSJacopo Mondi break;
575aab7ed1cSJacopo Mondi case MEDIA_BUS_FMT_UYVY8_2X8:
576aab7ed1cSJacopo Mondi default:
577aab7ed1cSJacopo Mondi outfmtctrl2 = 0;
578aab7ed1cSJacopo Mondi break;
579aab7ed1cSJacopo Mondi }
580aab7ed1cSJacopo Mondi
581aab7ed1cSJacopo Mondi ret = mt9v111_update(c, MT9V111_R01_IFP, MT9V111_IFP_R3A_OUTFMT_CTRL2,
582aab7ed1cSJacopo Mondi MT9V111_IFP_R3A_OUTFMT_CTRL2_SWAP_MASK,
583aab7ed1cSJacopo Mondi outfmtctrl2);
584aab7ed1cSJacopo Mondi if (ret)
585aab7ed1cSJacopo Mondi return ret;
586aab7ed1cSJacopo Mondi
587aab7ed1cSJacopo Mondi /*
588aab7ed1cSJacopo Mondi * Do not change default sensor's core configuration:
589aab7ed1cSJacopo Mondi * output the whole 640x480 pixel array, skip 18 columns and 6 rows.
590aab7ed1cSJacopo Mondi *
591aab7ed1cSJacopo Mondi * Instead, control the output image size through IFP block.
592aab7ed1cSJacopo Mondi *
593aab7ed1cSJacopo Mondi * TODO: No zoom&pan support. Currently we control the output image
594aab7ed1cSJacopo Mondi * size only through decimation, with no zoom support.
595aab7ed1cSJacopo Mondi */
596aab7ed1cSJacopo Mondi ret = mt9v111_write(c, MT9V111_R01_IFP, MT9V111_IFP_RA5_HPAN,
597aab7ed1cSJacopo Mondi MT9V111_IFP_DECIMATION_FREEZE);
598aab7ed1cSJacopo Mondi if (ret)
599aab7ed1cSJacopo Mondi return ret;
600aab7ed1cSJacopo Mondi
601aab7ed1cSJacopo Mondi ret = mt9v111_write(c, MT9V111_R01_IFP, MT9V111_IFP_RA8_VPAN,
602aab7ed1cSJacopo Mondi MT9V111_IFP_DECIMATION_FREEZE);
603aab7ed1cSJacopo Mondi if (ret)
604aab7ed1cSJacopo Mondi return ret;
605aab7ed1cSJacopo Mondi
606aab7ed1cSJacopo Mondi ret = mt9v111_write(c, MT9V111_R01_IFP, MT9V111_IFP_RA6_HZOOM,
607aab7ed1cSJacopo Mondi MT9V111_IFP_DECIMATION_FREEZE |
608aab7ed1cSJacopo Mondi MT9V111_PIXEL_ARRAY_WIDTH);
609aab7ed1cSJacopo Mondi if (ret)
610aab7ed1cSJacopo Mondi return ret;
611aab7ed1cSJacopo Mondi
612aab7ed1cSJacopo Mondi ret = mt9v111_write(c, MT9V111_R01_IFP, MT9V111_IFP_RA9_VZOOM,
613aab7ed1cSJacopo Mondi MT9V111_IFP_DECIMATION_FREEZE |
614aab7ed1cSJacopo Mondi MT9V111_PIXEL_ARRAY_HEIGHT);
615aab7ed1cSJacopo Mondi if (ret)
616aab7ed1cSJacopo Mondi return ret;
617aab7ed1cSJacopo Mondi
618aab7ed1cSJacopo Mondi ret = mt9v111_write(c, MT9V111_R01_IFP, MT9V111_IFP_RA7_HOUT,
619aab7ed1cSJacopo Mondi MT9V111_IFP_DECIMATION_FREEZE |
620aab7ed1cSJacopo Mondi mt9v111->fmt.width);
621aab7ed1cSJacopo Mondi if (ret)
622aab7ed1cSJacopo Mondi return ret;
623aab7ed1cSJacopo Mondi
624aab7ed1cSJacopo Mondi ret = mt9v111_write(c, MT9V111_R01_IFP, MT9V111_IFP_RAA_VOUT,
625aab7ed1cSJacopo Mondi mt9v111->fmt.height);
626aab7ed1cSJacopo Mondi if (ret)
627aab7ed1cSJacopo Mondi return ret;
628aab7ed1cSJacopo Mondi
629aab7ed1cSJacopo Mondi /* Apply controls to set auto exp, auto awb and timings */
630aab7ed1cSJacopo Mondi ret = v4l2_ctrl_handler_setup(&mt9v111->ctrls);
631aab7ed1cSJacopo Mondi if (ret)
632aab7ed1cSJacopo Mondi return ret;
633aab7ed1cSJacopo Mondi
634aab7ed1cSJacopo Mondi /*
635aab7ed1cSJacopo Mondi * Set pixel integration time to the whole frame time.
6369c6dee9aSSlark Xiao * This value controls the shutter delay when running with AE
637aab7ed1cSJacopo Mondi * disabled. If longer than frame time, it affects the output
638aab7ed1cSJacopo Mondi * frame rate.
639aab7ed1cSJacopo Mondi */
640aab7ed1cSJacopo Mondi return mt9v111_write(c, MT9V111_R01_CORE, MT9V111_CORE_R09_PIXEL_INT,
641aab7ed1cSJacopo Mondi MT9V111_PIXEL_ARRAY_HEIGHT);
642aab7ed1cSJacopo Mondi }
643aab7ed1cSJacopo Mondi
644aab7ed1cSJacopo Mondi /* --- V4L2 subdev operations --- */
645aab7ed1cSJacopo Mondi
mt9v111_s_power(struct v4l2_subdev * sd,int on)646aab7ed1cSJacopo Mondi static int mt9v111_s_power(struct v4l2_subdev *sd, int on)
647aab7ed1cSJacopo Mondi {
648aab7ed1cSJacopo Mondi struct mt9v111_dev *mt9v111 = sd_to_mt9v111(sd);
649aab7ed1cSJacopo Mondi int pwr_count;
650aab7ed1cSJacopo Mondi int ret = 0;
651aab7ed1cSJacopo Mondi
652aab7ed1cSJacopo Mondi mutex_lock(&mt9v111->pwr_mutex);
653aab7ed1cSJacopo Mondi
654aab7ed1cSJacopo Mondi /*
655aab7ed1cSJacopo Mondi * Make sure we're transitioning from 0 to 1, or viceversa,
656aab7ed1cSJacopo Mondi * before actually changing the power state.
657aab7ed1cSJacopo Mondi */
658aab7ed1cSJacopo Mondi pwr_count = mt9v111->pwr_count;
659aab7ed1cSJacopo Mondi pwr_count += on ? 1 : -1;
660aab7ed1cSJacopo Mondi if (pwr_count == !!on) {
661aab7ed1cSJacopo Mondi ret = on ? __mt9v111_power_on(sd) :
662aab7ed1cSJacopo Mondi __mt9v111_power_off(sd);
663aab7ed1cSJacopo Mondi if (!ret)
664aab7ed1cSJacopo Mondi /* All went well, updated power counter. */
665aab7ed1cSJacopo Mondi mt9v111->pwr_count = pwr_count;
666aab7ed1cSJacopo Mondi
667aab7ed1cSJacopo Mondi mutex_unlock(&mt9v111->pwr_mutex);
668aab7ed1cSJacopo Mondi
669aab7ed1cSJacopo Mondi return ret;
670aab7ed1cSJacopo Mondi }
671aab7ed1cSJacopo Mondi
672aab7ed1cSJacopo Mondi /*
673aab7ed1cSJacopo Mondi * Update power counter to keep track of how many nested calls we
674aab7ed1cSJacopo Mondi * received.
675aab7ed1cSJacopo Mondi */
676aab7ed1cSJacopo Mondi WARN_ON(pwr_count < 0 || pwr_count > 1);
677aab7ed1cSJacopo Mondi mt9v111->pwr_count = pwr_count;
678aab7ed1cSJacopo Mondi
679aab7ed1cSJacopo Mondi mutex_unlock(&mt9v111->pwr_mutex);
680aab7ed1cSJacopo Mondi
681aab7ed1cSJacopo Mondi return ret;
682aab7ed1cSJacopo Mondi }
683aab7ed1cSJacopo Mondi
mt9v111_s_stream(struct v4l2_subdev * subdev,int enable)684aab7ed1cSJacopo Mondi static int mt9v111_s_stream(struct v4l2_subdev *subdev, int enable)
685aab7ed1cSJacopo Mondi {
686aab7ed1cSJacopo Mondi struct mt9v111_dev *mt9v111 = sd_to_mt9v111(subdev);
687aab7ed1cSJacopo Mondi int ret;
688aab7ed1cSJacopo Mondi
689aab7ed1cSJacopo Mondi mutex_lock(&mt9v111->stream_mutex);
690aab7ed1cSJacopo Mondi
691aab7ed1cSJacopo Mondi if (mt9v111->streaming == enable) {
692aab7ed1cSJacopo Mondi mutex_unlock(&mt9v111->stream_mutex);
693aab7ed1cSJacopo Mondi return 0;
694aab7ed1cSJacopo Mondi }
695aab7ed1cSJacopo Mondi
696aab7ed1cSJacopo Mondi ret = mt9v111_s_power(subdev, enable);
697aab7ed1cSJacopo Mondi if (ret)
698aab7ed1cSJacopo Mondi goto error_unlock;
699aab7ed1cSJacopo Mondi
700aab7ed1cSJacopo Mondi if (enable && mt9v111->pending) {
701aab7ed1cSJacopo Mondi ret = mt9v111_hw_config(mt9v111);
702aab7ed1cSJacopo Mondi if (ret)
703aab7ed1cSJacopo Mondi goto error_unlock;
704aab7ed1cSJacopo Mondi
705aab7ed1cSJacopo Mondi /*
706aab7ed1cSJacopo Mondi * No need to update control here as far as only H/VBLANK are
707aab7ed1cSJacopo Mondi * supported and immediately programmed to registers in .s_ctrl
708aab7ed1cSJacopo Mondi */
709aab7ed1cSJacopo Mondi
710aab7ed1cSJacopo Mondi mt9v111->pending = false;
711aab7ed1cSJacopo Mondi }
712aab7ed1cSJacopo Mondi
713aab7ed1cSJacopo Mondi mt9v111->streaming = enable ? true : false;
714aab7ed1cSJacopo Mondi mutex_unlock(&mt9v111->stream_mutex);
715aab7ed1cSJacopo Mondi
716aab7ed1cSJacopo Mondi return 0;
717aab7ed1cSJacopo Mondi
718aab7ed1cSJacopo Mondi error_unlock:
719aab7ed1cSJacopo Mondi mutex_unlock(&mt9v111->stream_mutex);
720aab7ed1cSJacopo Mondi
721aab7ed1cSJacopo Mondi return ret;
722aab7ed1cSJacopo Mondi }
723aab7ed1cSJacopo Mondi
mt9v111_s_frame_interval(struct v4l2_subdev * sd,struct v4l2_subdev_frame_interval * ival)724aab7ed1cSJacopo Mondi static int mt9v111_s_frame_interval(struct v4l2_subdev *sd,
725aab7ed1cSJacopo Mondi struct v4l2_subdev_frame_interval *ival)
726aab7ed1cSJacopo Mondi {
727aab7ed1cSJacopo Mondi struct mt9v111_dev *mt9v111 = sd_to_mt9v111(sd);
728aab7ed1cSJacopo Mondi struct v4l2_fract *tpf = &ival->interval;
729aab7ed1cSJacopo Mondi unsigned int fps = tpf->numerator ?
730aab7ed1cSJacopo Mondi tpf->denominator / tpf->numerator :
731aab7ed1cSJacopo Mondi tpf->denominator;
732aab7ed1cSJacopo Mondi unsigned int max_fps;
733aab7ed1cSJacopo Mondi
734aab7ed1cSJacopo Mondi if (!tpf->numerator)
735aab7ed1cSJacopo Mondi tpf->numerator = 1;
736aab7ed1cSJacopo Mondi
737aab7ed1cSJacopo Mondi mutex_lock(&mt9v111->stream_mutex);
738aab7ed1cSJacopo Mondi
739aab7ed1cSJacopo Mondi if (mt9v111->streaming) {
740aab7ed1cSJacopo Mondi mutex_unlock(&mt9v111->stream_mutex);
741aab7ed1cSJacopo Mondi return -EBUSY;
742aab7ed1cSJacopo Mondi }
743aab7ed1cSJacopo Mondi
744aab7ed1cSJacopo Mondi if (mt9v111->fps == fps) {
745aab7ed1cSJacopo Mondi mutex_unlock(&mt9v111->stream_mutex);
746aab7ed1cSJacopo Mondi return 0;
747aab7ed1cSJacopo Mondi }
748aab7ed1cSJacopo Mondi
749aab7ed1cSJacopo Mondi /* Make sure frame rate/image sizes constraints are respected. */
750aab7ed1cSJacopo Mondi if (mt9v111->fmt.width < QVGA_WIDTH &&
751aab7ed1cSJacopo Mondi mt9v111->fmt.height < QVGA_HEIGHT)
752aab7ed1cSJacopo Mondi max_fps = 90;
753aab7ed1cSJacopo Mondi else if (mt9v111->fmt.width < CIF_WIDTH &&
754aab7ed1cSJacopo Mondi mt9v111->fmt.height < CIF_HEIGHT)
755aab7ed1cSJacopo Mondi max_fps = 60;
756aab7ed1cSJacopo Mondi else
757aab7ed1cSJacopo Mondi max_fps = mt9v111->sysclk <
758aab7ed1cSJacopo Mondi DIV_ROUND_CLOSEST(MT9V111_MAX_CLKIN, 2) ? 15 :
759aab7ed1cSJacopo Mondi 30;
760aab7ed1cSJacopo Mondi
761aab7ed1cSJacopo Mondi if (fps > max_fps) {
762aab7ed1cSJacopo Mondi mutex_unlock(&mt9v111->stream_mutex);
763aab7ed1cSJacopo Mondi return -EINVAL;
764aab7ed1cSJacopo Mondi }
765aab7ed1cSJacopo Mondi
766aab7ed1cSJacopo Mondi mt9v111_calc_frame_rate(mt9v111, tpf);
767aab7ed1cSJacopo Mondi
768aab7ed1cSJacopo Mondi mt9v111->fps = fps;
769aab7ed1cSJacopo Mondi mt9v111->pending = true;
770aab7ed1cSJacopo Mondi
771aab7ed1cSJacopo Mondi mutex_unlock(&mt9v111->stream_mutex);
772aab7ed1cSJacopo Mondi
773aab7ed1cSJacopo Mondi return 0;
774aab7ed1cSJacopo Mondi }
775aab7ed1cSJacopo Mondi
mt9v111_g_frame_interval(struct v4l2_subdev * sd,struct v4l2_subdev_frame_interval * ival)776aab7ed1cSJacopo Mondi static int mt9v111_g_frame_interval(struct v4l2_subdev *sd,
777aab7ed1cSJacopo Mondi struct v4l2_subdev_frame_interval *ival)
778aab7ed1cSJacopo Mondi {
779aab7ed1cSJacopo Mondi struct mt9v111_dev *mt9v111 = sd_to_mt9v111(sd);
780aab7ed1cSJacopo Mondi struct v4l2_fract *tpf = &ival->interval;
781aab7ed1cSJacopo Mondi
782aab7ed1cSJacopo Mondi mutex_lock(&mt9v111->stream_mutex);
783aab7ed1cSJacopo Mondi
784aab7ed1cSJacopo Mondi tpf->numerator = 1;
785aab7ed1cSJacopo Mondi tpf->denominator = mt9v111->fps;
786aab7ed1cSJacopo Mondi
787aab7ed1cSJacopo Mondi mutex_unlock(&mt9v111->stream_mutex);
788aab7ed1cSJacopo Mondi
789aab7ed1cSJacopo Mondi return 0;
790aab7ed1cSJacopo Mondi }
791aab7ed1cSJacopo Mondi
__mt9v111_get_pad_format(struct mt9v111_dev * mt9v111,struct v4l2_subdev_state * sd_state,unsigned int pad,enum v4l2_subdev_format_whence which)792aab7ed1cSJacopo Mondi static struct v4l2_mbus_framefmt *__mt9v111_get_pad_format(
793aab7ed1cSJacopo Mondi struct mt9v111_dev *mt9v111,
7940d346d2aSTomi Valkeinen struct v4l2_subdev_state *sd_state,
795aab7ed1cSJacopo Mondi unsigned int pad,
796aab7ed1cSJacopo Mondi enum v4l2_subdev_format_whence which)
797aab7ed1cSJacopo Mondi {
798aab7ed1cSJacopo Mondi switch (which) {
799aab7ed1cSJacopo Mondi case V4L2_SUBDEV_FORMAT_TRY:
800484f9b37SJacopo Mondi #if IS_ENABLED(CONFIG_VIDEO_V4L2_SUBDEV_API)
8010d346d2aSTomi Valkeinen return v4l2_subdev_get_try_format(&mt9v111->sd, sd_state, pad);
802aab7ed1cSJacopo Mondi #else
8030d346d2aSTomi Valkeinen return &sd_state->pads->try_fmt;
804aab7ed1cSJacopo Mondi #endif
805aab7ed1cSJacopo Mondi case V4L2_SUBDEV_FORMAT_ACTIVE:
806aab7ed1cSJacopo Mondi return &mt9v111->fmt;
807aab7ed1cSJacopo Mondi default:
808aab7ed1cSJacopo Mondi return NULL;
809aab7ed1cSJacopo Mondi }
810aab7ed1cSJacopo Mondi }
811aab7ed1cSJacopo Mondi
mt9v111_enum_mbus_code(struct v4l2_subdev * subdev,struct v4l2_subdev_state * sd_state,struct v4l2_subdev_mbus_code_enum * code)812aab7ed1cSJacopo Mondi static int mt9v111_enum_mbus_code(struct v4l2_subdev *subdev,
8130d346d2aSTomi Valkeinen struct v4l2_subdev_state *sd_state,
814aab7ed1cSJacopo Mondi struct v4l2_subdev_mbus_code_enum *code)
815aab7ed1cSJacopo Mondi {
816aab7ed1cSJacopo Mondi if (code->pad || code->index > ARRAY_SIZE(mt9v111_formats) - 1)
817aab7ed1cSJacopo Mondi return -EINVAL;
818aab7ed1cSJacopo Mondi
819aab7ed1cSJacopo Mondi code->code = mt9v111_formats[code->index].code;
820aab7ed1cSJacopo Mondi
821aab7ed1cSJacopo Mondi return 0;
822aab7ed1cSJacopo Mondi }
823aab7ed1cSJacopo Mondi
mt9v111_enum_frame_interval(struct v4l2_subdev * sd,struct v4l2_subdev_state * sd_state,struct v4l2_subdev_frame_interval_enum * fie)824aab7ed1cSJacopo Mondi static int mt9v111_enum_frame_interval(struct v4l2_subdev *sd,
8250d346d2aSTomi Valkeinen struct v4l2_subdev_state *sd_state,
826aab7ed1cSJacopo Mondi struct v4l2_subdev_frame_interval_enum *fie)
827aab7ed1cSJacopo Mondi {
828aab7ed1cSJacopo Mondi unsigned int i;
829aab7ed1cSJacopo Mondi
830aab7ed1cSJacopo Mondi if (fie->pad || fie->index >= ARRAY_SIZE(mt9v111_frame_intervals))
831aab7ed1cSJacopo Mondi return -EINVAL;
832aab7ed1cSJacopo Mondi
833aab7ed1cSJacopo Mondi for (i = 0; i < ARRAY_SIZE(mt9v111_frame_sizes); i++)
834aab7ed1cSJacopo Mondi if (fie->width == mt9v111_frame_sizes[i].width &&
835aab7ed1cSJacopo Mondi fie->height == mt9v111_frame_sizes[i].height)
836aab7ed1cSJacopo Mondi break;
837aab7ed1cSJacopo Mondi
838aab7ed1cSJacopo Mondi if (i == ARRAY_SIZE(mt9v111_frame_sizes))
839aab7ed1cSJacopo Mondi return -EINVAL;
840aab7ed1cSJacopo Mondi
841aab7ed1cSJacopo Mondi fie->interval.numerator = 1;
842aab7ed1cSJacopo Mondi fie->interval.denominator = mt9v111_frame_intervals[fie->index];
843aab7ed1cSJacopo Mondi
844aab7ed1cSJacopo Mondi return 0;
845aab7ed1cSJacopo Mondi }
846aab7ed1cSJacopo Mondi
mt9v111_enum_frame_size(struct v4l2_subdev * subdev,struct v4l2_subdev_state * sd_state,struct v4l2_subdev_frame_size_enum * fse)847aab7ed1cSJacopo Mondi static int mt9v111_enum_frame_size(struct v4l2_subdev *subdev,
8480d346d2aSTomi Valkeinen struct v4l2_subdev_state *sd_state,
849aab7ed1cSJacopo Mondi struct v4l2_subdev_frame_size_enum *fse)
850aab7ed1cSJacopo Mondi {
851d9a71866SMauro Carvalho Chehab if (fse->pad || fse->index >= ARRAY_SIZE(mt9v111_frame_sizes))
852aab7ed1cSJacopo Mondi return -EINVAL;
853aab7ed1cSJacopo Mondi
854aab7ed1cSJacopo Mondi fse->min_width = mt9v111_frame_sizes[fse->index].width;
855aab7ed1cSJacopo Mondi fse->max_width = mt9v111_frame_sizes[fse->index].width;
856aab7ed1cSJacopo Mondi fse->min_height = mt9v111_frame_sizes[fse->index].height;
857aab7ed1cSJacopo Mondi fse->max_height = mt9v111_frame_sizes[fse->index].height;
858aab7ed1cSJacopo Mondi
859aab7ed1cSJacopo Mondi return 0;
860aab7ed1cSJacopo Mondi }
861aab7ed1cSJacopo Mondi
mt9v111_get_format(struct v4l2_subdev * subdev,struct v4l2_subdev_state * sd_state,struct v4l2_subdev_format * format)862aab7ed1cSJacopo Mondi static int mt9v111_get_format(struct v4l2_subdev *subdev,
8630d346d2aSTomi Valkeinen struct v4l2_subdev_state *sd_state,
864aab7ed1cSJacopo Mondi struct v4l2_subdev_format *format)
865aab7ed1cSJacopo Mondi {
866aab7ed1cSJacopo Mondi struct mt9v111_dev *mt9v111 = sd_to_mt9v111(subdev);
867aab7ed1cSJacopo Mondi
868aab7ed1cSJacopo Mondi if (format->pad)
869aab7ed1cSJacopo Mondi return -EINVAL;
870aab7ed1cSJacopo Mondi
871aab7ed1cSJacopo Mondi mutex_lock(&mt9v111->stream_mutex);
8720d346d2aSTomi Valkeinen format->format = *__mt9v111_get_pad_format(mt9v111, sd_state,
8730d346d2aSTomi Valkeinen format->pad,
874aab7ed1cSJacopo Mondi format->which);
875aab7ed1cSJacopo Mondi mutex_unlock(&mt9v111->stream_mutex);
876aab7ed1cSJacopo Mondi
877aab7ed1cSJacopo Mondi return 0;
878aab7ed1cSJacopo Mondi }
879aab7ed1cSJacopo Mondi
mt9v111_set_format(struct v4l2_subdev * subdev,struct v4l2_subdev_state * sd_state,struct v4l2_subdev_format * format)880aab7ed1cSJacopo Mondi static int mt9v111_set_format(struct v4l2_subdev *subdev,
8810d346d2aSTomi Valkeinen struct v4l2_subdev_state *sd_state,
882aab7ed1cSJacopo Mondi struct v4l2_subdev_format *format)
883aab7ed1cSJacopo Mondi {
884aab7ed1cSJacopo Mondi struct mt9v111_dev *mt9v111 = sd_to_mt9v111(subdev);
885aab7ed1cSJacopo Mondi struct v4l2_mbus_framefmt new_fmt;
886aab7ed1cSJacopo Mondi struct v4l2_mbus_framefmt *__fmt;
887aab7ed1cSJacopo Mondi unsigned int best_fit = ~0L;
8884effa8bfSJasmin Jessich unsigned int idx = 0;
889aab7ed1cSJacopo Mondi unsigned int i;
890aab7ed1cSJacopo Mondi
891aab7ed1cSJacopo Mondi mutex_lock(&mt9v111->stream_mutex);
892aab7ed1cSJacopo Mondi if (mt9v111->streaming) {
893aab7ed1cSJacopo Mondi mutex_unlock(&mt9v111->stream_mutex);
894aab7ed1cSJacopo Mondi return -EBUSY;
895aab7ed1cSJacopo Mondi }
896aab7ed1cSJacopo Mondi
897aab7ed1cSJacopo Mondi if (format->pad) {
898aab7ed1cSJacopo Mondi mutex_unlock(&mt9v111->stream_mutex);
899aab7ed1cSJacopo Mondi return -EINVAL;
900aab7ed1cSJacopo Mondi }
901aab7ed1cSJacopo Mondi
902aab7ed1cSJacopo Mondi /* Update mbus format code and sizes. */
903aab7ed1cSJacopo Mondi for (i = 0; i < ARRAY_SIZE(mt9v111_formats); i++) {
904aab7ed1cSJacopo Mondi if (format->format.code == mt9v111_formats[i].code) {
905aab7ed1cSJacopo Mondi new_fmt.code = mt9v111_formats[i].code;
906aab7ed1cSJacopo Mondi break;
907aab7ed1cSJacopo Mondi }
908aab7ed1cSJacopo Mondi }
909aab7ed1cSJacopo Mondi if (i == ARRAY_SIZE(mt9v111_formats))
910aab7ed1cSJacopo Mondi new_fmt.code = mt9v111_formats[0].code;
911aab7ed1cSJacopo Mondi
912aab7ed1cSJacopo Mondi for (i = 0; i < ARRAY_SIZE(mt9v111_frame_sizes); i++) {
913aab7ed1cSJacopo Mondi unsigned int fit = abs(mt9v111_frame_sizes[i].width -
914aab7ed1cSJacopo Mondi format->format.width) +
915aab7ed1cSJacopo Mondi abs(mt9v111_frame_sizes[i].height -
916aab7ed1cSJacopo Mondi format->format.height);
917aab7ed1cSJacopo Mondi if (fit < best_fit) {
918aab7ed1cSJacopo Mondi best_fit = fit;
919aab7ed1cSJacopo Mondi idx = i;
920aab7ed1cSJacopo Mondi
921aab7ed1cSJacopo Mondi if (fit == 0)
922aab7ed1cSJacopo Mondi break;
923aab7ed1cSJacopo Mondi }
924aab7ed1cSJacopo Mondi }
925aab7ed1cSJacopo Mondi new_fmt.width = mt9v111_frame_sizes[idx].width;
926aab7ed1cSJacopo Mondi new_fmt.height = mt9v111_frame_sizes[idx].height;
927aab7ed1cSJacopo Mondi
928aab7ed1cSJacopo Mondi /* Update the device (or pad) format if it has changed. */
9290d346d2aSTomi Valkeinen __fmt = __mt9v111_get_pad_format(mt9v111, sd_state, format->pad,
930aab7ed1cSJacopo Mondi format->which);
931aab7ed1cSJacopo Mondi
932aab7ed1cSJacopo Mondi /* Format hasn't changed, stop here. */
933aab7ed1cSJacopo Mondi if (__fmt->code == new_fmt.code &&
934aab7ed1cSJacopo Mondi __fmt->width == new_fmt.width &&
935aab7ed1cSJacopo Mondi __fmt->height == new_fmt.height)
936aab7ed1cSJacopo Mondi goto done;
937aab7ed1cSJacopo Mondi
938aab7ed1cSJacopo Mondi /* Update the format and sizes, then mark changes as pending. */
939aab7ed1cSJacopo Mondi __fmt->code = new_fmt.code;
940aab7ed1cSJacopo Mondi __fmt->width = new_fmt.width;
941aab7ed1cSJacopo Mondi __fmt->height = new_fmt.height;
942aab7ed1cSJacopo Mondi
943aab7ed1cSJacopo Mondi if (format->which == V4L2_SUBDEV_FORMAT_ACTIVE)
944aab7ed1cSJacopo Mondi mt9v111->pending = true;
945aab7ed1cSJacopo Mondi
946aab7ed1cSJacopo Mondi dev_dbg(mt9v111->dev, "%s: mbus_code: %x - (%ux%u)\n",
947aab7ed1cSJacopo Mondi __func__, __fmt->code, __fmt->width, __fmt->height);
948aab7ed1cSJacopo Mondi
949aab7ed1cSJacopo Mondi done:
950aab7ed1cSJacopo Mondi format->format = *__fmt;
951aab7ed1cSJacopo Mondi
952aab7ed1cSJacopo Mondi mutex_unlock(&mt9v111->stream_mutex);
953aab7ed1cSJacopo Mondi
954aab7ed1cSJacopo Mondi return 0;
955aab7ed1cSJacopo Mondi }
956aab7ed1cSJacopo Mondi
mt9v111_init_cfg(struct v4l2_subdev * subdev,struct v4l2_subdev_state * sd_state)957aab7ed1cSJacopo Mondi static int mt9v111_init_cfg(struct v4l2_subdev *subdev,
9580d346d2aSTomi Valkeinen struct v4l2_subdev_state *sd_state)
959aab7ed1cSJacopo Mondi {
9600d346d2aSTomi Valkeinen sd_state->pads->try_fmt = mt9v111_def_fmt;
961aab7ed1cSJacopo Mondi
962aab7ed1cSJacopo Mondi return 0;
963aab7ed1cSJacopo Mondi }
964aab7ed1cSJacopo Mondi
965aab7ed1cSJacopo Mondi static const struct v4l2_subdev_core_ops mt9v111_core_ops = {
966aab7ed1cSJacopo Mondi .s_power = mt9v111_s_power,
967aab7ed1cSJacopo Mondi };
968aab7ed1cSJacopo Mondi
969aab7ed1cSJacopo Mondi static const struct v4l2_subdev_video_ops mt9v111_video_ops = {
970aab7ed1cSJacopo Mondi .s_stream = mt9v111_s_stream,
971aab7ed1cSJacopo Mondi .s_frame_interval = mt9v111_s_frame_interval,
972aab7ed1cSJacopo Mondi .g_frame_interval = mt9v111_g_frame_interval,
973aab7ed1cSJacopo Mondi };
974aab7ed1cSJacopo Mondi
975aab7ed1cSJacopo Mondi static const struct v4l2_subdev_pad_ops mt9v111_pad_ops = {
976aab7ed1cSJacopo Mondi .init_cfg = mt9v111_init_cfg,
977aab7ed1cSJacopo Mondi .enum_mbus_code = mt9v111_enum_mbus_code,
978aab7ed1cSJacopo Mondi .enum_frame_size = mt9v111_enum_frame_size,
979aab7ed1cSJacopo Mondi .enum_frame_interval = mt9v111_enum_frame_interval,
980aab7ed1cSJacopo Mondi .get_fmt = mt9v111_get_format,
981aab7ed1cSJacopo Mondi .set_fmt = mt9v111_set_format,
982aab7ed1cSJacopo Mondi };
983aab7ed1cSJacopo Mondi
984aab7ed1cSJacopo Mondi static const struct v4l2_subdev_ops mt9v111_ops = {
985aab7ed1cSJacopo Mondi .core = &mt9v111_core_ops,
986aab7ed1cSJacopo Mondi .video = &mt9v111_video_ops,
987aab7ed1cSJacopo Mondi .pad = &mt9v111_pad_ops,
988aab7ed1cSJacopo Mondi };
989aab7ed1cSJacopo Mondi
990aab7ed1cSJacopo Mondi #if IS_ENABLED(CONFIG_MEDIA_CONTROLLER)
991aab7ed1cSJacopo Mondi static const struct media_entity_operations mt9v111_subdev_entity_ops = {
992aab7ed1cSJacopo Mondi .link_validate = v4l2_subdev_link_validate,
993aab7ed1cSJacopo Mondi };
994aab7ed1cSJacopo Mondi #endif
995aab7ed1cSJacopo Mondi
996aab7ed1cSJacopo Mondi /* --- V4L2 ctrl --- */
mt9v111_s_ctrl(struct v4l2_ctrl * ctrl)997aab7ed1cSJacopo Mondi static int mt9v111_s_ctrl(struct v4l2_ctrl *ctrl)
998aab7ed1cSJacopo Mondi {
999aab7ed1cSJacopo Mondi struct mt9v111_dev *mt9v111 = container_of(ctrl->handler,
1000aab7ed1cSJacopo Mondi struct mt9v111_dev,
1001aab7ed1cSJacopo Mondi ctrls);
1002aab7ed1cSJacopo Mondi int ret;
1003aab7ed1cSJacopo Mondi
1004aab7ed1cSJacopo Mondi mutex_lock(&mt9v111->pwr_mutex);
1005aab7ed1cSJacopo Mondi /*
1006aab7ed1cSJacopo Mondi * If sensor is powered down, just cache new control values,
1007aab7ed1cSJacopo Mondi * no actual register access.
1008aab7ed1cSJacopo Mondi */
1009aab7ed1cSJacopo Mondi if (!mt9v111->pwr_count) {
1010aab7ed1cSJacopo Mondi mt9v111->pending = true;
1011aab7ed1cSJacopo Mondi mutex_unlock(&mt9v111->pwr_mutex);
1012aab7ed1cSJacopo Mondi return 0;
1013aab7ed1cSJacopo Mondi }
1014aab7ed1cSJacopo Mondi mutex_unlock(&mt9v111->pwr_mutex);
1015aab7ed1cSJacopo Mondi
1016aab7ed1cSJacopo Mondi /*
1017aab7ed1cSJacopo Mondi * Flickering control gets disabled if both auto exp and auto awb
1018aab7ed1cSJacopo Mondi * are disabled too. If any of the two is enabled, enable it.
1019aab7ed1cSJacopo Mondi *
1020aab7ed1cSJacopo Mondi * Disabling flickering when ae and awb are off allows a more precise
1021aab7ed1cSJacopo Mondi * control of the programmed frame rate.
1022aab7ed1cSJacopo Mondi */
1023aab7ed1cSJacopo Mondi if (mt9v111->auto_exp->is_new || mt9v111->auto_awb->is_new) {
1024aab7ed1cSJacopo Mondi if (mt9v111->auto_exp->val == V4L2_EXPOSURE_MANUAL &&
1025aab7ed1cSJacopo Mondi mt9v111->auto_awb->val == V4L2_WHITE_BALANCE_MANUAL)
1026aab7ed1cSJacopo Mondi ret = mt9v111_update(mt9v111->client, MT9V111_R01_IFP,
1027aab7ed1cSJacopo Mondi MT9V111_IFP_R08_OUTFMT_CTRL,
1028aab7ed1cSJacopo Mondi MT9V111_IFP_R08_OUTFMT_CTRL_FLICKER,
1029aab7ed1cSJacopo Mondi 0);
1030aab7ed1cSJacopo Mondi else
1031aab7ed1cSJacopo Mondi ret = mt9v111_update(mt9v111->client, MT9V111_R01_IFP,
1032aab7ed1cSJacopo Mondi MT9V111_IFP_R08_OUTFMT_CTRL,
1033aab7ed1cSJacopo Mondi MT9V111_IFP_R08_OUTFMT_CTRL_FLICKER,
1034aab7ed1cSJacopo Mondi 1);
1035aab7ed1cSJacopo Mondi if (ret)
1036aab7ed1cSJacopo Mondi return ret;
1037aab7ed1cSJacopo Mondi }
1038aab7ed1cSJacopo Mondi
1039aab7ed1cSJacopo Mondi ret = -EINVAL;
1040aab7ed1cSJacopo Mondi switch (ctrl->id) {
1041aab7ed1cSJacopo Mondi case V4L2_CID_AUTO_WHITE_BALANCE:
1042aab7ed1cSJacopo Mondi ret = mt9v111_update(mt9v111->client, MT9V111_R01_IFP,
1043aab7ed1cSJacopo Mondi MT9V111_IFP_R06_OPMODE_CTRL,
1044aab7ed1cSJacopo Mondi MT9V111_IFP_R06_OPMODE_CTRL_AWB_EN,
1045aab7ed1cSJacopo Mondi ctrl->val == V4L2_WHITE_BALANCE_AUTO ?
1046aab7ed1cSJacopo Mondi MT9V111_IFP_R06_OPMODE_CTRL_AWB_EN : 0);
1047aab7ed1cSJacopo Mondi break;
1048aab7ed1cSJacopo Mondi case V4L2_CID_EXPOSURE_AUTO:
1049aab7ed1cSJacopo Mondi ret = mt9v111_update(mt9v111->client, MT9V111_R01_IFP,
1050aab7ed1cSJacopo Mondi MT9V111_IFP_R06_OPMODE_CTRL,
1051aab7ed1cSJacopo Mondi MT9V111_IFP_R06_OPMODE_CTRL_AE_EN,
1052aab7ed1cSJacopo Mondi ctrl->val == V4L2_EXPOSURE_AUTO ?
1053aab7ed1cSJacopo Mondi MT9V111_IFP_R06_OPMODE_CTRL_AE_EN : 0);
1054aab7ed1cSJacopo Mondi break;
1055aab7ed1cSJacopo Mondi case V4L2_CID_HBLANK:
1056aab7ed1cSJacopo Mondi ret = mt9v111_update(mt9v111->client, MT9V111_R01_CORE,
1057aab7ed1cSJacopo Mondi MT9V111_CORE_R05_HBLANK,
1058aab7ed1cSJacopo Mondi MT9V111_CORE_R05_MAX_HBLANK,
1059aab7ed1cSJacopo Mondi mt9v111->hblank->val);
1060aab7ed1cSJacopo Mondi break;
1061aab7ed1cSJacopo Mondi case V4L2_CID_VBLANK:
1062aab7ed1cSJacopo Mondi ret = mt9v111_update(mt9v111->client, MT9V111_R01_CORE,
1063aab7ed1cSJacopo Mondi MT9V111_CORE_R06_VBLANK,
1064aab7ed1cSJacopo Mondi MT9V111_CORE_R06_MAX_VBLANK,
1065aab7ed1cSJacopo Mondi mt9v111->vblank->val);
1066aab7ed1cSJacopo Mondi break;
1067aab7ed1cSJacopo Mondi }
1068aab7ed1cSJacopo Mondi
1069aab7ed1cSJacopo Mondi return ret;
1070aab7ed1cSJacopo Mondi }
1071aab7ed1cSJacopo Mondi
1072aab7ed1cSJacopo Mondi static const struct v4l2_ctrl_ops mt9v111_ctrl_ops = {
1073aab7ed1cSJacopo Mondi .s_ctrl = mt9v111_s_ctrl,
1074aab7ed1cSJacopo Mondi };
1075aab7ed1cSJacopo Mondi
mt9v111_chip_probe(struct mt9v111_dev * mt9v111)1076aab7ed1cSJacopo Mondi static int mt9v111_chip_probe(struct mt9v111_dev *mt9v111)
1077aab7ed1cSJacopo Mondi {
1078aab7ed1cSJacopo Mondi int ret;
1079aab7ed1cSJacopo Mondi u16 val;
1080aab7ed1cSJacopo Mondi
1081aab7ed1cSJacopo Mondi ret = __mt9v111_power_on(&mt9v111->sd);
1082aab7ed1cSJacopo Mondi if (ret)
1083aab7ed1cSJacopo Mondi return ret;
1084aab7ed1cSJacopo Mondi
1085aab7ed1cSJacopo Mondi ret = mt9v111_read(mt9v111->client, MT9V111_R01_CORE,
1086aab7ed1cSJacopo Mondi MT9V111_CORE_RFF_CHIP_VER, &val);
1087aab7ed1cSJacopo Mondi if (ret)
1088aab7ed1cSJacopo Mondi goto power_off;
1089aab7ed1cSJacopo Mondi
1090aab7ed1cSJacopo Mondi if ((val >> 8) != MT9V111_CHIP_ID_HIGH &&
1091aab7ed1cSJacopo Mondi (val & 0xff) != MT9V111_CHIP_ID_LOW) {
1092aab7ed1cSJacopo Mondi dev_err(mt9v111->dev,
1093aab7ed1cSJacopo Mondi "Unable to identify MT9V111 chip: 0x%2x%2x\n",
1094aab7ed1cSJacopo Mondi val >> 8, val & 0xff);
1095aab7ed1cSJacopo Mondi ret = -EIO;
1096aab7ed1cSJacopo Mondi goto power_off;
1097aab7ed1cSJacopo Mondi }
1098aab7ed1cSJacopo Mondi
1099aab7ed1cSJacopo Mondi dev_dbg(mt9v111->dev, "Chip identified: 0x%2x%2x\n",
1100aab7ed1cSJacopo Mondi val >> 8, val & 0xff);
1101aab7ed1cSJacopo Mondi
1102aab7ed1cSJacopo Mondi power_off:
1103aab7ed1cSJacopo Mondi __mt9v111_power_off(&mt9v111->sd);
1104aab7ed1cSJacopo Mondi
1105aab7ed1cSJacopo Mondi return ret;
1106aab7ed1cSJacopo Mondi }
1107aab7ed1cSJacopo Mondi
mt9v111_probe(struct i2c_client * client)1108aab7ed1cSJacopo Mondi static int mt9v111_probe(struct i2c_client *client)
1109aab7ed1cSJacopo Mondi {
1110aab7ed1cSJacopo Mondi struct mt9v111_dev *mt9v111;
1111aab7ed1cSJacopo Mondi struct v4l2_fract tpf;
1112aab7ed1cSJacopo Mondi int ret;
1113aab7ed1cSJacopo Mondi
1114aab7ed1cSJacopo Mondi mt9v111 = devm_kzalloc(&client->dev, sizeof(*mt9v111), GFP_KERNEL);
1115aab7ed1cSJacopo Mondi if (!mt9v111)
1116aab7ed1cSJacopo Mondi return -ENOMEM;
1117aab7ed1cSJacopo Mondi
1118aab7ed1cSJacopo Mondi mt9v111->dev = &client->dev;
1119aab7ed1cSJacopo Mondi mt9v111->client = client;
1120aab7ed1cSJacopo Mondi
1121aab7ed1cSJacopo Mondi mt9v111->clk = devm_clk_get(&client->dev, NULL);
1122aab7ed1cSJacopo Mondi if (IS_ERR(mt9v111->clk))
1123aab7ed1cSJacopo Mondi return PTR_ERR(mt9v111->clk);
1124aab7ed1cSJacopo Mondi
1125aab7ed1cSJacopo Mondi mt9v111->sysclk = clk_get_rate(mt9v111->clk);
1126aab7ed1cSJacopo Mondi if (mt9v111->sysclk > MT9V111_MAX_CLKIN)
1127aab7ed1cSJacopo Mondi return -EINVAL;
1128aab7ed1cSJacopo Mondi
1129aab7ed1cSJacopo Mondi mt9v111->oe = devm_gpiod_get_optional(&client->dev, "enable",
1130aab7ed1cSJacopo Mondi GPIOD_OUT_LOW);
1131aab7ed1cSJacopo Mondi if (IS_ERR(mt9v111->oe)) {
1132aab7ed1cSJacopo Mondi dev_err(&client->dev, "Unable to get GPIO \"enable\": %ld\n",
1133aab7ed1cSJacopo Mondi PTR_ERR(mt9v111->oe));
1134aab7ed1cSJacopo Mondi return PTR_ERR(mt9v111->oe);
1135aab7ed1cSJacopo Mondi }
1136aab7ed1cSJacopo Mondi
1137aab7ed1cSJacopo Mondi mt9v111->standby = devm_gpiod_get_optional(&client->dev, "standby",
1138aab7ed1cSJacopo Mondi GPIOD_OUT_HIGH);
1139aab7ed1cSJacopo Mondi if (IS_ERR(mt9v111->standby)) {
1140aab7ed1cSJacopo Mondi dev_err(&client->dev, "Unable to get GPIO \"standby\": %ld\n",
1141aab7ed1cSJacopo Mondi PTR_ERR(mt9v111->standby));
1142aab7ed1cSJacopo Mondi return PTR_ERR(mt9v111->standby);
1143aab7ed1cSJacopo Mondi }
1144aab7ed1cSJacopo Mondi
1145aab7ed1cSJacopo Mondi mt9v111->reset = devm_gpiod_get_optional(&client->dev, "reset",
1146aab7ed1cSJacopo Mondi GPIOD_OUT_LOW);
1147aab7ed1cSJacopo Mondi if (IS_ERR(mt9v111->reset)) {
1148aab7ed1cSJacopo Mondi dev_err(&client->dev, "Unable to get GPIO \"reset\": %ld\n",
1149aab7ed1cSJacopo Mondi PTR_ERR(mt9v111->reset));
1150aab7ed1cSJacopo Mondi return PTR_ERR(mt9v111->reset);
1151aab7ed1cSJacopo Mondi }
1152aab7ed1cSJacopo Mondi
1153aab7ed1cSJacopo Mondi mutex_init(&mt9v111->pwr_mutex);
1154aab7ed1cSJacopo Mondi mutex_init(&mt9v111->stream_mutex);
1155aab7ed1cSJacopo Mondi
1156aab7ed1cSJacopo Mondi v4l2_ctrl_handler_init(&mt9v111->ctrls, 5);
1157aab7ed1cSJacopo Mondi
1158aab7ed1cSJacopo Mondi mt9v111->auto_awb = v4l2_ctrl_new_std(&mt9v111->ctrls,
1159aab7ed1cSJacopo Mondi &mt9v111_ctrl_ops,
1160aab7ed1cSJacopo Mondi V4L2_CID_AUTO_WHITE_BALANCE,
1161aab7ed1cSJacopo Mondi 0, 1, 1,
1162aab7ed1cSJacopo Mondi V4L2_WHITE_BALANCE_AUTO);
1163aab7ed1cSJacopo Mondi mt9v111->auto_exp = v4l2_ctrl_new_std_menu(&mt9v111->ctrls,
1164aab7ed1cSJacopo Mondi &mt9v111_ctrl_ops,
1165aab7ed1cSJacopo Mondi V4L2_CID_EXPOSURE_AUTO,
1166aab7ed1cSJacopo Mondi V4L2_EXPOSURE_MANUAL,
1167aab7ed1cSJacopo Mondi 0, V4L2_EXPOSURE_AUTO);
1168aab7ed1cSJacopo Mondi mt9v111->hblank = v4l2_ctrl_new_std(&mt9v111->ctrls, &mt9v111_ctrl_ops,
1169aab7ed1cSJacopo Mondi V4L2_CID_HBLANK,
1170aab7ed1cSJacopo Mondi MT9V111_CORE_R05_MIN_HBLANK,
1171aab7ed1cSJacopo Mondi MT9V111_CORE_R05_MAX_HBLANK, 1,
1172aab7ed1cSJacopo Mondi MT9V111_CORE_R05_DEF_HBLANK);
1173aab7ed1cSJacopo Mondi mt9v111->vblank = v4l2_ctrl_new_std(&mt9v111->ctrls, &mt9v111_ctrl_ops,
1174aab7ed1cSJacopo Mondi V4L2_CID_VBLANK,
1175aab7ed1cSJacopo Mondi MT9V111_CORE_R06_MIN_VBLANK,
1176aab7ed1cSJacopo Mondi MT9V111_CORE_R06_MAX_VBLANK, 1,
1177aab7ed1cSJacopo Mondi MT9V111_CORE_R06_DEF_VBLANK);
1178aab7ed1cSJacopo Mondi
1179aab7ed1cSJacopo Mondi /* PIXEL_RATE is fixed: just expose it to user space. */
1180aab7ed1cSJacopo Mondi v4l2_ctrl_new_std(&mt9v111->ctrls, &mt9v111_ctrl_ops,
1181aab7ed1cSJacopo Mondi V4L2_CID_PIXEL_RATE, 0,
1182aab7ed1cSJacopo Mondi DIV_ROUND_CLOSEST(mt9v111->sysclk, 2), 1,
1183aab7ed1cSJacopo Mondi DIV_ROUND_CLOSEST(mt9v111->sysclk, 2));
1184aab7ed1cSJacopo Mondi
11859d2ac5f4SJacopo Mondi if (mt9v111->ctrls.error) {
11869d2ac5f4SJacopo Mondi ret = mt9v111->ctrls.error;
11879d2ac5f4SJacopo Mondi goto error_free_ctrls;
11889d2ac5f4SJacopo Mondi }
1189aab7ed1cSJacopo Mondi mt9v111->sd.ctrl_handler = &mt9v111->ctrls;
1190aab7ed1cSJacopo Mondi
1191aab7ed1cSJacopo Mondi /* Start with default configuration: 640x480 UYVY. */
1192aab7ed1cSJacopo Mondi mt9v111->fmt = mt9v111_def_fmt;
1193aab7ed1cSJacopo Mondi
1194aab7ed1cSJacopo Mondi /* Re-calculate blankings for 640x480@15fps. */
1195aab7ed1cSJacopo Mondi mt9v111->fps = 15;
1196aab7ed1cSJacopo Mondi tpf.numerator = 1;
1197aab7ed1cSJacopo Mondi tpf.denominator = mt9v111->fps;
1198aab7ed1cSJacopo Mondi mt9v111_calc_frame_rate(mt9v111, &tpf);
1199aab7ed1cSJacopo Mondi
1200aab7ed1cSJacopo Mondi mt9v111->pwr_count = 0;
1201aab7ed1cSJacopo Mondi mt9v111->addr_space = MT9V111_R01_IFP;
1202aab7ed1cSJacopo Mondi mt9v111->pending = true;
1203aab7ed1cSJacopo Mondi
1204aab7ed1cSJacopo Mondi v4l2_i2c_subdev_init(&mt9v111->sd, client, &mt9v111_ops);
1205aab7ed1cSJacopo Mondi
1206aab7ed1cSJacopo Mondi #if IS_ENABLED(CONFIG_MEDIA_CONTROLLER)
1207aab7ed1cSJacopo Mondi mt9v111->sd.flags |= V4L2_SUBDEV_FL_HAS_DEVNODE;
1208aab7ed1cSJacopo Mondi mt9v111->sd.entity.ops = &mt9v111_subdev_entity_ops;
1209aab7ed1cSJacopo Mondi mt9v111->sd.entity.function = MEDIA_ENT_F_CAM_SENSOR;
1210aab7ed1cSJacopo Mondi
1211aab7ed1cSJacopo Mondi mt9v111->pad.flags = MEDIA_PAD_FL_SOURCE;
1212aab7ed1cSJacopo Mondi ret = media_entity_pads_init(&mt9v111->sd.entity, 1, &mt9v111->pad);
1213aab7ed1cSJacopo Mondi if (ret)
12149d2ac5f4SJacopo Mondi goto error_free_entity;
1215aab7ed1cSJacopo Mondi #endif
1216aab7ed1cSJacopo Mondi
1217aab7ed1cSJacopo Mondi ret = mt9v111_chip_probe(mt9v111);
1218aab7ed1cSJacopo Mondi if (ret)
12199d2ac5f4SJacopo Mondi goto error_free_entity;
1220aab7ed1cSJacopo Mondi
1221aab7ed1cSJacopo Mondi ret = v4l2_async_register_subdev(&mt9v111->sd);
1222aab7ed1cSJacopo Mondi if (ret)
12239d2ac5f4SJacopo Mondi goto error_free_entity;
1224aab7ed1cSJacopo Mondi
1225aab7ed1cSJacopo Mondi return 0;
1226aab7ed1cSJacopo Mondi
12279d2ac5f4SJacopo Mondi error_free_entity:
1228aab7ed1cSJacopo Mondi #if IS_ENABLED(CONFIG_MEDIA_CONTROLLER)
1229aab7ed1cSJacopo Mondi media_entity_cleanup(&mt9v111->sd.entity);
1230aab7ed1cSJacopo Mondi #endif
1231aab7ed1cSJacopo Mondi
12329d2ac5f4SJacopo Mondi error_free_ctrls:
12339d2ac5f4SJacopo Mondi v4l2_ctrl_handler_free(&mt9v111->ctrls);
12349d2ac5f4SJacopo Mondi
1235aab7ed1cSJacopo Mondi mutex_destroy(&mt9v111->pwr_mutex);
1236aab7ed1cSJacopo Mondi mutex_destroy(&mt9v111->stream_mutex);
1237aab7ed1cSJacopo Mondi
1238aab7ed1cSJacopo Mondi return ret;
1239aab7ed1cSJacopo Mondi }
1240aab7ed1cSJacopo Mondi
mt9v111_remove(struct i2c_client * client)1241ed5c2f5fSUwe Kleine-König static void mt9v111_remove(struct i2c_client *client)
1242aab7ed1cSJacopo Mondi {
1243aab7ed1cSJacopo Mondi struct v4l2_subdev *sd = i2c_get_clientdata(client);
1244aab7ed1cSJacopo Mondi struct mt9v111_dev *mt9v111 = sd_to_mt9v111(sd);
1245aab7ed1cSJacopo Mondi
1246aab7ed1cSJacopo Mondi v4l2_async_unregister_subdev(sd);
1247aab7ed1cSJacopo Mondi
1248aab7ed1cSJacopo Mondi #if IS_ENABLED(CONFIG_MEDIA_CONTROLLER)
1249aab7ed1cSJacopo Mondi media_entity_cleanup(&sd->entity);
1250aab7ed1cSJacopo Mondi #endif
1251aab7ed1cSJacopo Mondi
12529d2ac5f4SJacopo Mondi v4l2_ctrl_handler_free(&mt9v111->ctrls);
12539d2ac5f4SJacopo Mondi
1254aab7ed1cSJacopo Mondi mutex_destroy(&mt9v111->pwr_mutex);
1255aab7ed1cSJacopo Mondi mutex_destroy(&mt9v111->stream_mutex);
1256aab7ed1cSJacopo Mondi }
1257aab7ed1cSJacopo Mondi
1258aab7ed1cSJacopo Mondi static const struct of_device_id mt9v111_of_match[] = {
1259aab7ed1cSJacopo Mondi { .compatible = "aptina,mt9v111", },
1260aab7ed1cSJacopo Mondi { /* sentinel */ },
1261aab7ed1cSJacopo Mondi };
1262aab7ed1cSJacopo Mondi
1263aab7ed1cSJacopo Mondi static struct i2c_driver mt9v111_driver = {
1264aab7ed1cSJacopo Mondi .driver = {
1265aab7ed1cSJacopo Mondi .name = "mt9v111",
1266aab7ed1cSJacopo Mondi .of_match_table = mt9v111_of_match,
1267aab7ed1cSJacopo Mondi },
1268*aaeb31c0SUwe Kleine-König .probe = mt9v111_probe,
1269aab7ed1cSJacopo Mondi .remove = mt9v111_remove,
1270aab7ed1cSJacopo Mondi };
1271aab7ed1cSJacopo Mondi
1272aab7ed1cSJacopo Mondi module_i2c_driver(mt9v111_driver);
1273aab7ed1cSJacopo Mondi
1274aab7ed1cSJacopo Mondi MODULE_DESCRIPTION("V4L2 sensor driver for Aptina MT9V111");
1275aab7ed1cSJacopo Mondi MODULE_AUTHOR("Jacopo Mondi <jacopo@jmondi.org>");
1276aab7ed1cSJacopo Mondi MODULE_LICENSE("GPL v2");
1277