2 * Driver for IMX074 CMOS Image Sensor from Sony
4 * Copyright (C) 2010, Guennadi Liakhovetski <g.liakhovetski@gmx.de>
6 * Partially inspired by the IMX074 driver from the Android / MSM tree
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License version 2 as
10 * published by the Free Software Foundation.
13 #include <linux/delay.h>
14 #include <linux/i2c.h>
15 #include <linux/slab.h>
16 #include <linux/videodev2.h>
17 #include <linux/module.h>
19 #include <media/soc_camera.h>
20 #include <media/soc_mediabus.h>
21 #include <media/v4l2-subdev.h>
22 #include <media/v4l2-chip-ident.h>
24 /* IMX074 registers */
26 #define MODE_SELECT 0x0100
27 #define IMAGE_ORIENTATION 0x0101
28 #define GROUPED_PARAMETER_HOLD 0x0104
30 /* Integration Time */
31 #define COARSE_INTEGRATION_TIME_HI 0x0202
32 #define COARSE_INTEGRATION_TIME_LO 0x0203
34 #define ANALOGUE_GAIN_CODE_GLOBAL_HI 0x0204
35 #define ANALOGUE_GAIN_CODE_GLOBAL_LO 0x0205
38 #define PRE_PLL_CLK_DIV 0x0305
39 #define PLL_MULTIPLIER 0x0307
40 #define PLSTATIM 0x302b
41 #define VNDMY_ABLMGSHLMT 0x300a
42 #define Y_OPBADDR_START_DI 0x3014
44 #define FRAME_LENGTH_LINES_HI 0x0340
45 #define FRAME_LENGTH_LINES_LO 0x0341
46 #define LINE_LENGTH_PCK_HI 0x0342
47 #define LINE_LENGTH_PCK_LO 0x0343
48 #define YADDR_START 0x0347
49 #define YADDR_END 0x034b
50 #define X_OUTPUT_SIZE_MSB 0x034c
51 #define X_OUTPUT_SIZE_LSB 0x034d
52 #define Y_OUTPUT_SIZE_MSB 0x034e
53 #define Y_OUTPUT_SIZE_LSB 0x034f
54 #define X_EVEN_INC 0x0381
55 #define X_ODD_INC 0x0383
56 #define Y_EVEN_INC 0x0385
57 #define Y_ODD_INC 0x0387
59 #define HMODEADD 0x3001
60 #define VMODEADD 0x3016
61 #define VAPPLINE_START 0x3069
62 #define VAPPLINE_END 0x306b
63 #define SHUTTER 0x3086
64 #define HADDAVE 0x30e8
65 #define LANESEL 0x3301
67 /* IMX074 supported geometry */
68 #define IMX074_WIDTH 1052
69 #define IMX074_HEIGHT 780
71 /* IMX074 has only one fixed colorspace per pixelcode */
72 struct imx074_datafmt
{
73 enum v4l2_mbus_pixelcode code
;
74 enum v4l2_colorspace colorspace
;
78 struct v4l2_subdev subdev
;
79 const struct imx074_datafmt
*fmt
;
82 static const struct imx074_datafmt imx074_colour_fmts
[] = {
83 {V4L2_MBUS_FMT_SBGGR8_1X8
, V4L2_COLORSPACE_SRGB
},
86 static struct imx074
*to_imx074(const struct i2c_client
*client
)
88 return container_of(i2c_get_clientdata(client
), struct imx074
, subdev
);
91 /* Find a data format by a pixel code in an array */
92 static const struct imx074_datafmt
*imx074_find_datafmt(enum v4l2_mbus_pixelcode code
)
96 for (i
= 0; i
< ARRAY_SIZE(imx074_colour_fmts
); i
++)
97 if (imx074_colour_fmts
[i
].code
== code
)
98 return imx074_colour_fmts
+ i
;
103 static int reg_write(struct i2c_client
*client
, const u16 addr
, const u8 data
)
105 struct i2c_adapter
*adap
= client
->adapter
;
110 msg
.addr
= client
->addr
;
119 ret
= i2c_transfer(adap
, &msg
, 1);
123 return ret
== 1 ? 0 : -EIO
;
126 static int reg_read(struct i2c_client
*client
, const u16 addr
)
128 u8 buf
[2] = {addr
>> 8, addr
& 0xff};
130 struct i2c_msg msgs
[] = {
132 .addr
= client
->addr
,
137 .addr
= client
->addr
,
144 ret
= i2c_transfer(client
->adapter
, msgs
, ARRAY_SIZE(msgs
));
146 dev_warn(&client
->dev
, "Reading register %x from %x failed\n",
151 return buf
[0] & 0xff; /* no sign-extension */
154 static int imx074_try_fmt(struct v4l2_subdev
*sd
,
155 struct v4l2_mbus_framefmt
*mf
)
157 const struct imx074_datafmt
*fmt
= imx074_find_datafmt(mf
->code
);
159 dev_dbg(sd
->v4l2_dev
->dev
, "%s(%u)\n", __func__
, mf
->code
);
162 mf
->code
= imx074_colour_fmts
[0].code
;
163 mf
->colorspace
= imx074_colour_fmts
[0].colorspace
;
166 mf
->width
= IMX074_WIDTH
;
167 mf
->height
= IMX074_HEIGHT
;
168 mf
->field
= V4L2_FIELD_NONE
;
173 static int imx074_s_fmt(struct v4l2_subdev
*sd
,
174 struct v4l2_mbus_framefmt
*mf
)
176 struct i2c_client
*client
= v4l2_get_subdevdata(sd
);
177 struct imx074
*priv
= to_imx074(client
);
179 dev_dbg(sd
->v4l2_dev
->dev
, "%s(%u)\n", __func__
, mf
->code
);
181 /* MIPI CSI could have changed the format, double-check */
182 if (!imx074_find_datafmt(mf
->code
))
185 imx074_try_fmt(sd
, mf
);
187 priv
->fmt
= imx074_find_datafmt(mf
->code
);
192 static int imx074_g_fmt(struct v4l2_subdev
*sd
,
193 struct v4l2_mbus_framefmt
*mf
)
195 struct i2c_client
*client
= v4l2_get_subdevdata(sd
);
196 struct imx074
*priv
= to_imx074(client
);
198 const struct imx074_datafmt
*fmt
= priv
->fmt
;
200 mf
->code
= fmt
->code
;
201 mf
->colorspace
= fmt
->colorspace
;
202 mf
->width
= IMX074_WIDTH
;
203 mf
->height
= IMX074_HEIGHT
;
204 mf
->field
= V4L2_FIELD_NONE
;
209 static int imx074_g_crop(struct v4l2_subdev
*sd
, struct v4l2_crop
*a
)
211 struct v4l2_rect
*rect
= &a
->c
;
213 a
->type
= V4L2_BUF_TYPE_VIDEO_CAPTURE
;
216 rect
->width
= IMX074_WIDTH
;
217 rect
->height
= IMX074_HEIGHT
;
222 static int imx074_cropcap(struct v4l2_subdev
*sd
, struct v4l2_cropcap
*a
)
226 a
->bounds
.width
= IMX074_WIDTH
;
227 a
->bounds
.height
= IMX074_HEIGHT
;
228 a
->defrect
= a
->bounds
;
229 a
->type
= V4L2_BUF_TYPE_VIDEO_CAPTURE
;
230 a
->pixelaspect
.numerator
= 1;
231 a
->pixelaspect
.denominator
= 1;
236 static int imx074_enum_fmt(struct v4l2_subdev
*sd
, unsigned int index
,
237 enum v4l2_mbus_pixelcode
*code
)
239 if ((unsigned int)index
>= ARRAY_SIZE(imx074_colour_fmts
))
242 *code
= imx074_colour_fmts
[index
].code
;
246 static int imx074_s_stream(struct v4l2_subdev
*sd
, int enable
)
248 struct i2c_client
*client
= v4l2_get_subdevdata(sd
);
250 /* MODE_SELECT: stream or standby */
251 return reg_write(client
, MODE_SELECT
, !!enable
);
254 static int imx074_g_chip_ident(struct v4l2_subdev
*sd
,
255 struct v4l2_dbg_chip_ident
*id
)
257 struct i2c_client
*client
= v4l2_get_subdevdata(sd
);
259 if (id
->match
.type
!= V4L2_CHIP_MATCH_I2C_ADDR
)
262 if (id
->match
.addr
!= client
->addr
)
265 id
->ident
= V4L2_IDENT_IMX074
;
271 static struct v4l2_subdev_video_ops imx074_subdev_video_ops
= {
272 .s_stream
= imx074_s_stream
,
273 .s_mbus_fmt
= imx074_s_fmt
,
274 .g_mbus_fmt
= imx074_g_fmt
,
275 .try_mbus_fmt
= imx074_try_fmt
,
276 .enum_mbus_fmt
= imx074_enum_fmt
,
277 .g_crop
= imx074_g_crop
,
278 .cropcap
= imx074_cropcap
,
281 static struct v4l2_subdev_core_ops imx074_subdev_core_ops
= {
282 .g_chip_ident
= imx074_g_chip_ident
,
285 static struct v4l2_subdev_ops imx074_subdev_ops
= {
286 .core
= &imx074_subdev_core_ops
,
287 .video
= &imx074_subdev_video_ops
,
291 * We have to provide soc-camera operations, but we don't have anything to say
292 * there. The MIPI CSI2 driver will provide .query_bus_param and .set_bus_param
294 static unsigned long imx074_query_bus_param(struct soc_camera_device
*icd
)
299 static int imx074_set_bus_param(struct soc_camera_device
*icd
,
305 static struct soc_camera_ops imx074_ops
= {
306 .query_bus_param
= imx074_query_bus_param
,
307 .set_bus_param
= imx074_set_bus_param
,
310 static int imx074_video_probe(struct soc_camera_device
*icd
,
311 struct i2c_client
*client
)
316 /* Read sensor Model ID */
317 ret
= reg_read(client
, 0);
323 ret
= reg_read(client
, 1);
329 dev_info(&client
->dev
, "Chip ID 0x%04x detected\n", id
);
334 /* PLL Setting EXTCLK=24MHz, 22.5times */
335 reg_write(client
, PLL_MULTIPLIER
, 0x2D);
336 reg_write(client
, PRE_PLL_CLK_DIV
, 0x02);
337 reg_write(client
, PLSTATIM
, 0x4B);
340 reg_write(client
, 0x3024, 0x00);
342 reg_write(client
, IMAGE_ORIENTATION
, 0x00);
345 * 0x08+0x08 = top 8 bits
346 * 0x0a+0x08 = compressed 8-bits
347 * 0x0a+0x0a = 10 bits
349 reg_write(client
, 0x0112, 0x08);
350 reg_write(client
, 0x0113, 0x08);
352 /* Base setting for High frame mode */
353 reg_write(client
, VNDMY_ABLMGSHLMT
, 0x80);
354 reg_write(client
, Y_OPBADDR_START_DI
, 0x08);
355 reg_write(client
, 0x3015, 0x37);
356 reg_write(client
, 0x301C, 0x01);
357 reg_write(client
, 0x302C, 0x05);
358 reg_write(client
, 0x3031, 0x26);
359 reg_write(client
, 0x3041, 0x60);
360 reg_write(client
, 0x3051, 0x24);
361 reg_write(client
, 0x3053, 0x34);
362 reg_write(client
, 0x3057, 0xC0);
363 reg_write(client
, 0x305C, 0x09);
364 reg_write(client
, 0x305D, 0x07);
365 reg_write(client
, 0x3060, 0x30);
366 reg_write(client
, 0x3065, 0x00);
367 reg_write(client
, 0x30AA, 0x08);
368 reg_write(client
, 0x30AB, 0x1C);
369 reg_write(client
, 0x30B0, 0x32);
370 reg_write(client
, 0x30B2, 0x83);
371 reg_write(client
, 0x30D3, 0x04);
372 reg_write(client
, 0x3106, 0x78);
373 reg_write(client
, 0x310C, 0x82);
374 reg_write(client
, 0x3304, 0x05);
375 reg_write(client
, 0x3305, 0x04);
376 reg_write(client
, 0x3306, 0x11);
377 reg_write(client
, 0x3307, 0x02);
378 reg_write(client
, 0x3308, 0x0C);
379 reg_write(client
, 0x3309, 0x06);
380 reg_write(client
, 0x330A, 0x08);
381 reg_write(client
, 0x330B, 0x04);
382 reg_write(client
, 0x330C, 0x08);
383 reg_write(client
, 0x330D, 0x06);
384 reg_write(client
, 0x330E, 0x01);
385 reg_write(client
, 0x3381, 0x00);
387 /* V : 1/2V-addition (1,3), H : 1/2H-averaging (1,3) -> Full HD */
388 /* 1608 = 1560 + 48 (black lines) */
389 reg_write(client
, FRAME_LENGTH_LINES_HI
, 0x06);
390 reg_write(client
, FRAME_LENGTH_LINES_LO
, 0x48);
391 reg_write(client
, YADDR_START
, 0x00);
392 reg_write(client
, YADDR_END
, 0x2F);
394 reg_write(client
, X_OUTPUT_SIZE_MSB
, 0x08);
395 reg_write(client
, X_OUTPUT_SIZE_LSB
, 0x38);
397 reg_write(client
, Y_OUTPUT_SIZE_MSB
, 0x06);
398 reg_write(client
, Y_OUTPUT_SIZE_LSB
, 0x18);
399 reg_write(client
, X_EVEN_INC
, 0x01);
400 reg_write(client
, X_ODD_INC
, 0x03);
401 reg_write(client
, Y_EVEN_INC
, 0x01);
402 reg_write(client
, Y_ODD_INC
, 0x03);
403 reg_write(client
, HMODEADD
, 0x00);
404 reg_write(client
, VMODEADD
, 0x16);
405 reg_write(client
, VAPPLINE_START
, 0x24);
406 reg_write(client
, VAPPLINE_END
, 0x53);
407 reg_write(client
, SHUTTER
, 0x00);
408 reg_write(client
, HADDAVE
, 0x80);
410 reg_write(client
, LANESEL
, 0x00);
412 reg_write(client
, GROUPED_PARAMETER_HOLD
, 0x00); /* off */
417 static int imx074_probe(struct i2c_client
*client
,
418 const struct i2c_device_id
*did
)
421 struct soc_camera_device
*icd
= client
->dev
.platform_data
;
422 struct i2c_adapter
*adapter
= to_i2c_adapter(client
->dev
.parent
);
423 struct soc_camera_link
*icl
;
427 dev_err(&client
->dev
, "IMX074: missing soc-camera data!\n");
431 icl
= to_soc_camera_link(icd
);
433 dev_err(&client
->dev
, "IMX074: missing platform data!\n");
437 if (!i2c_check_functionality(adapter
, I2C_FUNC_SMBUS_BYTE_DATA
)) {
438 dev_warn(&adapter
->dev
,
439 "I2C-Adapter doesn't support I2C_FUNC_SMBUS_BYTE\n");
443 priv
= kzalloc(sizeof(struct imx074
), GFP_KERNEL
);
447 v4l2_i2c_subdev_init(&priv
->subdev
, client
, &imx074_subdev_ops
);
449 icd
->ops
= &imx074_ops
;
450 priv
->fmt
= &imx074_colour_fmts
[0];
452 ret
= imx074_video_probe(icd
, client
);
462 static int imx074_remove(struct i2c_client
*client
)
464 struct imx074
*priv
= to_imx074(client
);
465 struct soc_camera_device
*icd
= client
->dev
.platform_data
;
466 struct soc_camera_link
*icl
= to_soc_camera_link(icd
);
476 static const struct i2c_device_id imx074_id
[] = {
480 MODULE_DEVICE_TABLE(i2c
, imx074_id
);
482 static struct i2c_driver imx074_i2c_driver
= {
486 .probe
= imx074_probe
,
487 .remove
= imx074_remove
,
488 .id_table
= imx074_id
,
491 static int __init
imx074_mod_init(void)
493 return i2c_add_driver(&imx074_i2c_driver
);
496 static void __exit
imx074_mod_exit(void)
498 i2c_del_driver(&imx074_i2c_driver
);
501 module_init(imx074_mod_init
);
502 module_exit(imx074_mod_exit
);
504 MODULE_DESCRIPTION("Sony IMX074 Camera driver");
505 MODULE_AUTHOR("Guennadi Liakhovetski <g.liakhovetski@gmx.de>");
506 MODULE_LICENSE("GPL v2");