2 * Driver for MT9M111/MT9M112/MT9M131 CMOS Image Sensor from Micron/Aptina
4 * Copyright (C) 2008, Robert Jarzmik <robert.jarzmik@free.fr>
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License version 2 as
8 * published by the Free Software Foundation.
10 #include <linux/videodev2.h>
11 #include <linux/slab.h>
12 #include <linux/i2c.h>
13 #include <linux/log2.h>
14 #include <linux/gpio.h>
15 #include <linux/delay.h>
17 #include <media/v4l2-common.h>
18 #include <media/v4l2-chip-ident.h>
19 #include <media/soc_camera.h>
22 * MT9M111, MT9M112 and MT9M131:
23 * i2c address is 0x48 or 0x5d (depending on SADDR pin)
24 * The platform has to define i2c_board_info and call i2c_register_board_info()
28 * Sensor core register addresses (0x000..0x0ff)
30 #define MT9M111_CHIP_VERSION 0x000
31 #define MT9M111_ROW_START 0x001
32 #define MT9M111_COLUMN_START 0x002
33 #define MT9M111_WINDOW_HEIGHT 0x003
34 #define MT9M111_WINDOW_WIDTH 0x004
35 #define MT9M111_HORIZONTAL_BLANKING_B 0x005
36 #define MT9M111_VERTICAL_BLANKING_B 0x006
37 #define MT9M111_HORIZONTAL_BLANKING_A 0x007
38 #define MT9M111_VERTICAL_BLANKING_A 0x008
39 #define MT9M111_SHUTTER_WIDTH 0x009
40 #define MT9M111_ROW_SPEED 0x00a
41 #define MT9M111_EXTRA_DELAY 0x00b
42 #define MT9M111_SHUTTER_DELAY 0x00c
43 #define MT9M111_RESET 0x00d
44 #define MT9M111_READ_MODE_B 0x020
45 #define MT9M111_READ_MODE_A 0x021
46 #define MT9M111_FLASH_CONTROL 0x023
47 #define MT9M111_GREEN1_GAIN 0x02b
48 #define MT9M111_BLUE_GAIN 0x02c
49 #define MT9M111_RED_GAIN 0x02d
50 #define MT9M111_GREEN2_GAIN 0x02e
51 #define MT9M111_GLOBAL_GAIN 0x02f
52 #define MT9M111_CONTEXT_CONTROL 0x0c8
53 #define MT9M111_PAGE_MAP 0x0f0
54 #define MT9M111_BYTE_WISE_ADDR 0x0f1
56 #define MT9M111_RESET_SYNC_CHANGES (1 << 15)
57 #define MT9M111_RESET_RESTART_BAD_FRAME (1 << 9)
58 #define MT9M111_RESET_SHOW_BAD_FRAMES (1 << 8)
59 #define MT9M111_RESET_RESET_SOC (1 << 5)
60 #define MT9M111_RESET_OUTPUT_DISABLE (1 << 4)
61 #define MT9M111_RESET_CHIP_ENABLE (1 << 3)
62 #define MT9M111_RESET_ANALOG_STANDBY (1 << 2)
63 #define MT9M111_RESET_RESTART_FRAME (1 << 1)
64 #define MT9M111_RESET_RESET_MODE (1 << 0)
66 #define MT9M111_RMB_MIRROR_COLS (1 << 1)
67 #define MT9M111_RMB_MIRROR_ROWS (1 << 0)
68 #define MT9M111_CTXT_CTRL_RESTART (1 << 15)
69 #define MT9M111_CTXT_CTRL_DEFECTCOR_B (1 << 12)
70 #define MT9M111_CTXT_CTRL_RESIZE_B (1 << 10)
71 #define MT9M111_CTXT_CTRL_CTRL2_B (1 << 9)
72 #define MT9M111_CTXT_CTRL_GAMMA_B (1 << 8)
73 #define MT9M111_CTXT_CTRL_XENON_EN (1 << 7)
74 #define MT9M111_CTXT_CTRL_READ_MODE_B (1 << 3)
75 #define MT9M111_CTXT_CTRL_LED_FLASH_EN (1 << 2)
76 #define MT9M111_CTXT_CTRL_VBLANK_SEL_B (1 << 1)
77 #define MT9M111_CTXT_CTRL_HBLANK_SEL_B (1 << 0)
80 * Colorpipe register addresses (0x100..0x1ff)
82 #define MT9M111_OPER_MODE_CTRL 0x106
83 #define MT9M111_OUTPUT_FORMAT_CTRL 0x108
84 #define MT9M111_REDUCER_XZOOM_B 0x1a0
85 #define MT9M111_REDUCER_XSIZE_B 0x1a1
86 #define MT9M111_REDUCER_YZOOM_B 0x1a3
87 #define MT9M111_REDUCER_YSIZE_B 0x1a4
88 #define MT9M111_REDUCER_XZOOM_A 0x1a6
89 #define MT9M111_REDUCER_XSIZE_A 0x1a7
90 #define MT9M111_REDUCER_YZOOM_A 0x1a9
91 #define MT9M111_REDUCER_YSIZE_A 0x1aa
93 #define MT9M111_OUTPUT_FORMAT_CTRL2_A 0x13a
94 #define MT9M111_OUTPUT_FORMAT_CTRL2_B 0x19b
96 #define MT9M111_OPMODE_AUTOEXPO_EN (1 << 14)
97 #define MT9M111_OPMODE_AUTOWHITEBAL_EN (1 << 1)
99 #define MT9M111_OUTFMT_PROCESSED_BAYER (1 << 14)
100 #define MT9M111_OUTFMT_BYPASS_IFP (1 << 10)
101 #define MT9M111_OUTFMT_INV_PIX_CLOCK (1 << 9)
102 #define MT9M111_OUTFMT_RGB (1 << 8)
103 #define MT9M111_OUTFMT_RGB565 (0x0 << 6)
104 #define MT9M111_OUTFMT_RGB555 (0x1 << 6)
105 #define MT9M111_OUTFMT_RGB444x (0x2 << 6)
106 #define MT9M111_OUTFMT_RGBx444 (0x3 << 6)
107 #define MT9M111_OUTFMT_TST_RAMP_OFF (0x0 << 4)
108 #define MT9M111_OUTFMT_TST_RAMP_COL (0x1 << 4)
109 #define MT9M111_OUTFMT_TST_RAMP_ROW (0x2 << 4)
110 #define MT9M111_OUTFMT_TST_RAMP_FRAME (0x3 << 4)
111 #define MT9M111_OUTFMT_SHIFT_3_UP (1 << 3)
112 #define MT9M111_OUTFMT_AVG_CHROMA (1 << 2)
113 #define MT9M111_OUTFMT_SWAP_YCbCr_C_Y (1 << 1)
114 #define MT9M111_OUTFMT_SWAP_RGB_EVEN (1 << 1)
115 #define MT9M111_OUTFMT_SWAP_YCbCr_Cb_Cr (1 << 0)
118 * Camera control register addresses (0x200..0x2ff not implemented)
121 #define reg_read(reg) mt9m111_reg_read(client, MT9M111_##reg)
122 #define reg_write(reg, val) mt9m111_reg_write(client, MT9M111_##reg, (val))
123 #define reg_set(reg, val) mt9m111_reg_set(client, MT9M111_##reg, (val))
124 #define reg_clear(reg, val) mt9m111_reg_clear(client, MT9M111_##reg, (val))
126 #define MT9M111_MIN_DARK_ROWS 8
127 #define MT9M111_MIN_DARK_COLS 24
128 #define MT9M111_MAX_HEIGHT 1024
129 #define MT9M111_MAX_WIDTH 1280
131 /* MT9M111 has only one fixed colorspace per pixelcode */
132 struct mt9m111_datafmt
{
133 enum v4l2_mbus_pixelcode code
;
134 enum v4l2_colorspace colorspace
;
137 /* Find a data format by a pixel code in an array */
138 static const struct mt9m111_datafmt
*mt9m111_find_datafmt(
139 enum v4l2_mbus_pixelcode code
, const struct mt9m111_datafmt
*fmt
,
143 for (i
= 0; i
< n
; i
++)
144 if (fmt
[i
].code
== code
)
150 static const struct mt9m111_datafmt mt9m111_colour_fmts
[] = {
151 {V4L2_MBUS_FMT_YUYV8_2X8
, V4L2_COLORSPACE_JPEG
},
152 {V4L2_MBUS_FMT_YVYU8_2X8
, V4L2_COLORSPACE_JPEG
},
153 {V4L2_MBUS_FMT_UYVY8_2X8
, V4L2_COLORSPACE_JPEG
},
154 {V4L2_MBUS_FMT_VYUY8_2X8
, V4L2_COLORSPACE_JPEG
},
155 {V4L2_MBUS_FMT_RGB555_2X8_PADHI_LE
, V4L2_COLORSPACE_SRGB
},
156 {V4L2_MBUS_FMT_RGB565_2X8_LE
, V4L2_COLORSPACE_SRGB
},
157 {V4L2_MBUS_FMT_SBGGR8_1X8
, V4L2_COLORSPACE_SRGB
},
158 {V4L2_MBUS_FMT_SBGGR10_2X8_PADHI_LE
, V4L2_COLORSPACE_SRGB
},
161 enum mt9m111_context
{
167 struct v4l2_subdev subdev
;
168 int model
; /* V4L2_IDENT_MT9M111 or V4L2_IDENT_MT9M112 code
169 * from v4l2-chip-ident.h */
170 enum mt9m111_context context
;
171 struct v4l2_rect rect
;
172 const struct mt9m111_datafmt
*fmt
;
174 unsigned char autoexposure
;
175 unsigned char datawidth
;
176 unsigned int powered
:1;
177 unsigned int hflip
:1;
178 unsigned int vflip
:1;
179 unsigned int swap_rgb_even_odd
:1;
180 unsigned int swap_rgb_red_blue
:1;
181 unsigned int swap_yuv_y_chromas
:1;
182 unsigned int swap_yuv_cb_cr
:1;
183 unsigned int autowhitebalance
:1;
186 static struct mt9m111
*to_mt9m111(const struct i2c_client
*client
)
188 return container_of(i2c_get_clientdata(client
), struct mt9m111
, subdev
);
191 static int reg_page_map_set(struct i2c_client
*client
, const u16 reg
)
195 static int lastpage
= -1; /* PageMap cache value */
198 if (page
== lastpage
)
203 ret
= i2c_smbus_write_word_data(client
, MT9M111_PAGE_MAP
, swab16(page
));
209 static int mt9m111_reg_read(struct i2c_client
*client
, const u16 reg
)
213 ret
= reg_page_map_set(client
, reg
);
215 ret
= swab16(i2c_smbus_read_word_data(client
, reg
& 0xff));
217 dev_dbg(&client
->dev
, "read reg.%03x -> %04x\n", reg
, ret
);
221 static int mt9m111_reg_write(struct i2c_client
*client
, const u16 reg
,
226 ret
= reg_page_map_set(client
, reg
);
228 ret
= i2c_smbus_write_word_data(client
, reg
& 0xff,
230 dev_dbg(&client
->dev
, "write reg.%03x = %04x -> %d\n", reg
, data
, ret
);
234 static int mt9m111_reg_set(struct i2c_client
*client
, const u16 reg
,
239 ret
= mt9m111_reg_read(client
, reg
);
241 ret
= mt9m111_reg_write(client
, reg
, ret
| data
);
245 static int mt9m111_reg_clear(struct i2c_client
*client
, const u16 reg
,
250 ret
= mt9m111_reg_read(client
, reg
);
251 return mt9m111_reg_write(client
, reg
, ret
& ~data
);
254 static int mt9m111_set_context(struct i2c_client
*client
,
255 enum mt9m111_context ctxt
)
257 int valB
= MT9M111_CTXT_CTRL_RESTART
| MT9M111_CTXT_CTRL_DEFECTCOR_B
258 | MT9M111_CTXT_CTRL_RESIZE_B
| MT9M111_CTXT_CTRL_CTRL2_B
259 | MT9M111_CTXT_CTRL_GAMMA_B
| MT9M111_CTXT_CTRL_READ_MODE_B
260 | MT9M111_CTXT_CTRL_VBLANK_SEL_B
261 | MT9M111_CTXT_CTRL_HBLANK_SEL_B
;
262 int valA
= MT9M111_CTXT_CTRL_RESTART
;
264 if (ctxt
== HIGHPOWER
)
265 return reg_write(CONTEXT_CONTROL
, valB
);
267 return reg_write(CONTEXT_CONTROL
, valA
);
270 static int mt9m111_setup_rect(struct i2c_client
*client
,
271 struct v4l2_rect
*rect
)
273 struct mt9m111
*mt9m111
= to_mt9m111(client
);
274 int ret
, is_raw_format
;
275 int width
= rect
->width
;
276 int height
= rect
->height
;
278 if (mt9m111
->fmt
->code
== V4L2_MBUS_FMT_SBGGR8_1X8
||
279 mt9m111
->fmt
->code
== V4L2_MBUS_FMT_SBGGR10_2X8_PADHI_LE
)
284 ret
= reg_write(COLUMN_START
, rect
->left
);
286 ret
= reg_write(ROW_START
, rect
->top
);
290 ret
= reg_write(WINDOW_WIDTH
, width
);
292 ret
= reg_write(WINDOW_HEIGHT
, height
);
295 ret
= reg_write(REDUCER_XZOOM_B
, MT9M111_MAX_WIDTH
);
297 ret
= reg_write(REDUCER_YZOOM_B
, MT9M111_MAX_HEIGHT
);
299 ret
= reg_write(REDUCER_XSIZE_B
, width
);
301 ret
= reg_write(REDUCER_YSIZE_B
, height
);
303 ret
= reg_write(REDUCER_XZOOM_A
, MT9M111_MAX_WIDTH
);
305 ret
= reg_write(REDUCER_YZOOM_A
, MT9M111_MAX_HEIGHT
);
307 ret
= reg_write(REDUCER_XSIZE_A
, width
);
309 ret
= reg_write(REDUCER_YSIZE_A
, height
);
315 static int mt9m111_setup_pixfmt(struct i2c_client
*client
, u16 outfmt
)
319 ret
= reg_write(OUTPUT_FORMAT_CTRL2_A
, outfmt
);
321 ret
= reg_write(OUTPUT_FORMAT_CTRL2_B
, outfmt
);
325 static int mt9m111_setfmt_bayer8(struct i2c_client
*client
)
327 return mt9m111_setup_pixfmt(client
, MT9M111_OUTFMT_PROCESSED_BAYER
|
331 static int mt9m111_setfmt_bayer10(struct i2c_client
*client
)
333 return mt9m111_setup_pixfmt(client
, MT9M111_OUTFMT_BYPASS_IFP
);
336 static int mt9m111_setfmt_rgb565(struct i2c_client
*client
)
338 struct mt9m111
*mt9m111
= to_mt9m111(client
);
341 if (mt9m111
->swap_rgb_red_blue
)
342 val
|= MT9M111_OUTFMT_SWAP_YCbCr_Cb_Cr
;
343 if (mt9m111
->swap_rgb_even_odd
)
344 val
|= MT9M111_OUTFMT_SWAP_RGB_EVEN
;
345 val
|= MT9M111_OUTFMT_RGB
| MT9M111_OUTFMT_RGB565
;
347 return mt9m111_setup_pixfmt(client
, val
);
350 static int mt9m111_setfmt_rgb555(struct i2c_client
*client
)
352 struct mt9m111
*mt9m111
= to_mt9m111(client
);
355 if (mt9m111
->swap_rgb_red_blue
)
356 val
|= MT9M111_OUTFMT_SWAP_YCbCr_Cb_Cr
;
357 if (mt9m111
->swap_rgb_even_odd
)
358 val
|= MT9M111_OUTFMT_SWAP_RGB_EVEN
;
359 val
|= MT9M111_OUTFMT_RGB
| MT9M111_OUTFMT_RGB555
;
361 return mt9m111_setup_pixfmt(client
, val
);
364 static int mt9m111_setfmt_yuv(struct i2c_client
*client
)
366 struct mt9m111
*mt9m111
= to_mt9m111(client
);
369 if (mt9m111
->swap_yuv_cb_cr
)
370 val
|= MT9M111_OUTFMT_SWAP_YCbCr_Cb_Cr
;
371 if (mt9m111
->swap_yuv_y_chromas
)
372 val
|= MT9M111_OUTFMT_SWAP_YCbCr_C_Y
;
374 return mt9m111_setup_pixfmt(client
, val
);
377 static int mt9m111_enable(struct i2c_client
*client
)
379 struct mt9m111
*mt9m111
= to_mt9m111(client
);
382 ret
= reg_set(RESET
, MT9M111_RESET_CHIP_ENABLE
);
384 mt9m111
->powered
= 1;
388 static int mt9m111_reset(struct i2c_client
*client
)
392 ret
= reg_set(RESET
, MT9M111_RESET_RESET_MODE
);
394 ret
= reg_set(RESET
, MT9M111_RESET_RESET_SOC
);
396 ret
= reg_clear(RESET
, MT9M111_RESET_RESET_MODE
397 | MT9M111_RESET_RESET_SOC
);
402 static unsigned long mt9m111_query_bus_param(struct soc_camera_device
*icd
)
404 struct soc_camera_link
*icl
= to_soc_camera_link(icd
);
405 unsigned long flags
= SOCAM_MASTER
| SOCAM_PCLK_SAMPLE_RISING
|
406 SOCAM_HSYNC_ACTIVE_HIGH
| SOCAM_VSYNC_ACTIVE_HIGH
|
407 SOCAM_DATA_ACTIVE_HIGH
| SOCAM_DATAWIDTH_8
;
409 return soc_camera_apply_sensor_flags(icl
, flags
);
412 static int mt9m111_set_bus_param(struct soc_camera_device
*icd
, unsigned long f
)
417 static int mt9m111_make_rect(struct i2c_client
*client
,
418 struct v4l2_rect
*rect
)
420 struct mt9m111
*mt9m111
= to_mt9m111(client
);
422 if (mt9m111
->fmt
->code
== V4L2_MBUS_FMT_SBGGR8_1X8
||
423 mt9m111
->fmt
->code
== V4L2_MBUS_FMT_SBGGR10_2X8_PADHI_LE
) {
424 /* Bayer format - even size lengths */
425 rect
->width
= ALIGN(rect
->width
, 2);
426 rect
->height
= ALIGN(rect
->height
, 2);
427 /* Let the user play with the starting pixel */
430 /* FIXME: the datasheet doesn't specify minimum sizes */
431 soc_camera_limit_side(&rect
->left
, &rect
->width
,
432 MT9M111_MIN_DARK_COLS
, 2, MT9M111_MAX_WIDTH
);
434 soc_camera_limit_side(&rect
->top
, &rect
->height
,
435 MT9M111_MIN_DARK_ROWS
, 2, MT9M111_MAX_HEIGHT
);
437 return mt9m111_setup_rect(client
, rect
);
440 static int mt9m111_s_crop(struct v4l2_subdev
*sd
, struct v4l2_crop
*a
)
442 struct v4l2_rect rect
= a
->c
;
443 struct i2c_client
*client
= sd
->priv
;
444 struct mt9m111
*mt9m111
= to_mt9m111(client
);
447 dev_dbg(&client
->dev
, "%s left=%d, top=%d, width=%d, height=%d\n",
448 __func__
, rect
.left
, rect
.top
, rect
.width
, rect
.height
);
450 if (a
->type
!= V4L2_BUF_TYPE_VIDEO_CAPTURE
)
453 ret
= mt9m111_make_rect(client
, &rect
);
455 mt9m111
->rect
= rect
;
459 static int mt9m111_g_crop(struct v4l2_subdev
*sd
, struct v4l2_crop
*a
)
461 struct i2c_client
*client
= sd
->priv
;
462 struct mt9m111
*mt9m111
= to_mt9m111(client
);
464 a
->c
= mt9m111
->rect
;
465 a
->type
= V4L2_BUF_TYPE_VIDEO_CAPTURE
;
470 static int mt9m111_cropcap(struct v4l2_subdev
*sd
, struct v4l2_cropcap
*a
)
472 if (a
->type
!= V4L2_BUF_TYPE_VIDEO_CAPTURE
)
475 a
->bounds
.left
= MT9M111_MIN_DARK_COLS
;
476 a
->bounds
.top
= MT9M111_MIN_DARK_ROWS
;
477 a
->bounds
.width
= MT9M111_MAX_WIDTH
;
478 a
->bounds
.height
= MT9M111_MAX_HEIGHT
;
479 a
->defrect
= a
->bounds
;
480 a
->pixelaspect
.numerator
= 1;
481 a
->pixelaspect
.denominator
= 1;
486 static int mt9m111_g_fmt(struct v4l2_subdev
*sd
,
487 struct v4l2_mbus_framefmt
*mf
)
489 struct i2c_client
*client
= sd
->priv
;
490 struct mt9m111
*mt9m111
= to_mt9m111(client
);
492 mf
->width
= mt9m111
->rect
.width
;
493 mf
->height
= mt9m111
->rect
.height
;
494 mf
->code
= mt9m111
->fmt
->code
;
495 mf
->colorspace
= mt9m111
->fmt
->colorspace
;
496 mf
->field
= V4L2_FIELD_NONE
;
501 static int mt9m111_set_pixfmt(struct i2c_client
*client
,
502 enum v4l2_mbus_pixelcode code
)
504 struct mt9m111
*mt9m111
= to_mt9m111(client
);
508 case V4L2_MBUS_FMT_SBGGR8_1X8
:
509 ret
= mt9m111_setfmt_bayer8(client
);
511 case V4L2_MBUS_FMT_SBGGR10_2X8_PADHI_LE
:
512 ret
= mt9m111_setfmt_bayer10(client
);
514 case V4L2_MBUS_FMT_RGB555_2X8_PADHI_LE
:
515 ret
= mt9m111_setfmt_rgb555(client
);
517 case V4L2_MBUS_FMT_RGB565_2X8_LE
:
518 ret
= mt9m111_setfmt_rgb565(client
);
520 case V4L2_MBUS_FMT_UYVY8_2X8
:
521 mt9m111
->swap_yuv_y_chromas
= 0;
522 mt9m111
->swap_yuv_cb_cr
= 0;
523 ret
= mt9m111_setfmt_yuv(client
);
525 case V4L2_MBUS_FMT_VYUY8_2X8
:
526 mt9m111
->swap_yuv_y_chromas
= 0;
527 mt9m111
->swap_yuv_cb_cr
= 1;
528 ret
= mt9m111_setfmt_yuv(client
);
530 case V4L2_MBUS_FMT_YUYV8_2X8
:
531 mt9m111
->swap_yuv_y_chromas
= 1;
532 mt9m111
->swap_yuv_cb_cr
= 0;
533 ret
= mt9m111_setfmt_yuv(client
);
535 case V4L2_MBUS_FMT_YVYU8_2X8
:
536 mt9m111
->swap_yuv_y_chromas
= 1;
537 mt9m111
->swap_yuv_cb_cr
= 1;
538 ret
= mt9m111_setfmt_yuv(client
);
541 dev_err(&client
->dev
, "Pixel format not handled : %x\n",
549 static int mt9m111_s_fmt(struct v4l2_subdev
*sd
,
550 struct v4l2_mbus_framefmt
*mf
)
552 struct i2c_client
*client
= sd
->priv
;
553 const struct mt9m111_datafmt
*fmt
;
554 struct mt9m111
*mt9m111
= to_mt9m111(client
);
555 struct v4l2_rect rect
= {
556 .left
= mt9m111
->rect
.left
,
557 .top
= mt9m111
->rect
.top
,
559 .height
= mf
->height
,
563 fmt
= mt9m111_find_datafmt(mf
->code
, mt9m111_colour_fmts
,
564 ARRAY_SIZE(mt9m111_colour_fmts
));
568 dev_dbg(&client
->dev
,
569 "%s code=%x left=%d, top=%d, width=%d, height=%d\n", __func__
,
570 mf
->code
, rect
.left
, rect
.top
, rect
.width
, rect
.height
);
572 ret
= mt9m111_make_rect(client
, &rect
);
574 ret
= mt9m111_set_pixfmt(client
, mf
->code
);
576 mt9m111
->rect
= rect
;
578 mf
->colorspace
= fmt
->colorspace
;
584 static int mt9m111_try_fmt(struct v4l2_subdev
*sd
,
585 struct v4l2_mbus_framefmt
*mf
)
587 struct i2c_client
*client
= sd
->priv
;
588 struct mt9m111
*mt9m111
= to_mt9m111(client
);
589 const struct mt9m111_datafmt
*fmt
;
590 bool bayer
= mf
->code
== V4L2_MBUS_FMT_SBGGR8_1X8
||
591 mf
->code
== V4L2_MBUS_FMT_SBGGR10_2X8_PADHI_LE
;
593 fmt
= mt9m111_find_datafmt(mf
->code
, mt9m111_colour_fmts
,
594 ARRAY_SIZE(mt9m111_colour_fmts
));
597 mf
->code
= fmt
->code
;
601 * With Bayer format enforce even side lengths, but let the user play
602 * with the starting pixel
605 if (mf
->height
> MT9M111_MAX_HEIGHT
)
606 mf
->height
= MT9M111_MAX_HEIGHT
;
607 else if (mf
->height
< 2)
610 mf
->height
= ALIGN(mf
->height
, 2);
612 if (mf
->width
> MT9M111_MAX_WIDTH
)
613 mf
->width
= MT9M111_MAX_WIDTH
;
614 else if (mf
->width
< 2)
617 mf
->width
= ALIGN(mf
->width
, 2);
619 mf
->colorspace
= fmt
->colorspace
;
624 static int mt9m111_g_chip_ident(struct v4l2_subdev
*sd
,
625 struct v4l2_dbg_chip_ident
*id
)
627 struct i2c_client
*client
= sd
->priv
;
628 struct mt9m111
*mt9m111
= to_mt9m111(client
);
630 if (id
->match
.type
!= V4L2_CHIP_MATCH_I2C_ADDR
)
633 if (id
->match
.addr
!= client
->addr
)
636 id
->ident
= mt9m111
->model
;
642 #ifdef CONFIG_VIDEO_ADV_DEBUG
643 static int mt9m111_g_register(struct v4l2_subdev
*sd
,
644 struct v4l2_dbg_register
*reg
)
646 struct i2c_client
*client
= sd
->priv
;
649 if (reg
->match
.type
!= V4L2_CHIP_MATCH_I2C_ADDR
|| reg
->reg
> 0x2ff)
651 if (reg
->match
.addr
!= client
->addr
)
654 val
= mt9m111_reg_read(client
, reg
->reg
);
658 if (reg
->val
> 0xffff)
664 static int mt9m111_s_register(struct v4l2_subdev
*sd
,
665 struct v4l2_dbg_register
*reg
)
667 struct i2c_client
*client
= sd
->priv
;
669 if (reg
->match
.type
!= V4L2_CHIP_MATCH_I2C_ADDR
|| reg
->reg
> 0x2ff)
672 if (reg
->match
.addr
!= client
->addr
)
675 if (mt9m111_reg_write(client
, reg
->reg
, reg
->val
) < 0)
682 static const struct v4l2_queryctrl mt9m111_controls
[] = {
684 .id
= V4L2_CID_VFLIP
,
685 .type
= V4L2_CTRL_TYPE_BOOLEAN
,
686 .name
= "Flip Verticaly",
692 .id
= V4L2_CID_HFLIP
,
693 .type
= V4L2_CTRL_TYPE_BOOLEAN
,
694 .name
= "Flip Horizontaly",
699 }, { /* gain = 1/32*val (=>gain=1 if val==32) */
701 .type
= V4L2_CTRL_TYPE_INTEGER
,
704 .maximum
= 63 * 2 * 2,
707 .flags
= V4L2_CTRL_FLAG_SLIDER
,
709 .id
= V4L2_CID_EXPOSURE_AUTO
,
710 .type
= V4L2_CTRL_TYPE_BOOLEAN
,
711 .name
= "Auto Exposure",
719 static int mt9m111_resume(struct soc_camera_device
*icd
);
720 static int mt9m111_suspend(struct soc_camera_device
*icd
, pm_message_t state
);
722 static struct soc_camera_ops mt9m111_ops
= {
723 .suspend
= mt9m111_suspend
,
724 .resume
= mt9m111_resume
,
725 .query_bus_param
= mt9m111_query_bus_param
,
726 .set_bus_param
= mt9m111_set_bus_param
,
727 .controls
= mt9m111_controls
,
728 .num_controls
= ARRAY_SIZE(mt9m111_controls
),
731 static int mt9m111_set_flip(struct i2c_client
*client
, int flip
, int mask
)
733 struct mt9m111
*mt9m111
= to_mt9m111(client
);
736 if (mt9m111
->context
== HIGHPOWER
) {
738 ret
= reg_set(READ_MODE_B
, mask
);
740 ret
= reg_clear(READ_MODE_B
, mask
);
743 ret
= reg_set(READ_MODE_A
, mask
);
745 ret
= reg_clear(READ_MODE_A
, mask
);
751 static int mt9m111_get_global_gain(struct i2c_client
*client
)
755 data
= reg_read(GLOBAL_GAIN
);
757 return (data
& 0x2f) * (1 << ((data
>> 10) & 1)) *
758 (1 << ((data
>> 9) & 1));
762 static int mt9m111_set_global_gain(struct i2c_client
*client
, int gain
)
764 struct mt9m111
*mt9m111
= to_mt9m111(client
);
767 if (gain
> 63 * 2 * 2)
770 mt9m111
->gain
= gain
;
771 if ((gain
>= 64 * 2) && (gain
< 63 * 2 * 2))
772 val
= (1 << 10) | (1 << 9) | (gain
/ 4);
773 else if ((gain
>= 64) && (gain
< 64 * 2))
774 val
= (1 << 9) | (gain
/ 2);
778 return reg_write(GLOBAL_GAIN
, val
);
781 static int mt9m111_set_autoexposure(struct i2c_client
*client
, int on
)
783 struct mt9m111
*mt9m111
= to_mt9m111(client
);
787 ret
= reg_set(OPER_MODE_CTRL
, MT9M111_OPMODE_AUTOEXPO_EN
);
789 ret
= reg_clear(OPER_MODE_CTRL
, MT9M111_OPMODE_AUTOEXPO_EN
);
792 mt9m111
->autoexposure
= on
;
797 static int mt9m111_set_autowhitebalance(struct i2c_client
*client
, int on
)
799 struct mt9m111
*mt9m111
= to_mt9m111(client
);
803 ret
= reg_set(OPER_MODE_CTRL
, MT9M111_OPMODE_AUTOWHITEBAL_EN
);
805 ret
= reg_clear(OPER_MODE_CTRL
, MT9M111_OPMODE_AUTOWHITEBAL_EN
);
808 mt9m111
->autowhitebalance
= on
;
813 static int mt9m111_g_ctrl(struct v4l2_subdev
*sd
, struct v4l2_control
*ctrl
)
815 struct i2c_client
*client
= sd
->priv
;
816 struct mt9m111
*mt9m111
= to_mt9m111(client
);
821 if (mt9m111
->context
== HIGHPOWER
)
822 data
= reg_read(READ_MODE_B
);
824 data
= reg_read(READ_MODE_A
);
828 ctrl
->value
= !!(data
& MT9M111_RMB_MIRROR_ROWS
);
831 if (mt9m111
->context
== HIGHPOWER
)
832 data
= reg_read(READ_MODE_B
);
834 data
= reg_read(READ_MODE_A
);
838 ctrl
->value
= !!(data
& MT9M111_RMB_MIRROR_COLS
);
841 data
= mt9m111_get_global_gain(client
);
846 case V4L2_CID_EXPOSURE_AUTO
:
847 ctrl
->value
= mt9m111
->autoexposure
;
849 case V4L2_CID_AUTO_WHITE_BALANCE
:
850 ctrl
->value
= mt9m111
->autowhitebalance
;
856 static int mt9m111_s_ctrl(struct v4l2_subdev
*sd
, struct v4l2_control
*ctrl
)
858 struct i2c_client
*client
= sd
->priv
;
859 struct mt9m111
*mt9m111
= to_mt9m111(client
);
860 const struct v4l2_queryctrl
*qctrl
;
863 qctrl
= soc_camera_find_qctrl(&mt9m111_ops
, ctrl
->id
);
869 mt9m111
->vflip
= ctrl
->value
;
870 ret
= mt9m111_set_flip(client
, ctrl
->value
,
871 MT9M111_RMB_MIRROR_ROWS
);
874 mt9m111
->hflip
= ctrl
->value
;
875 ret
= mt9m111_set_flip(client
, ctrl
->value
,
876 MT9M111_RMB_MIRROR_COLS
);
879 ret
= mt9m111_set_global_gain(client
, ctrl
->value
);
881 case V4L2_CID_EXPOSURE_AUTO
:
882 ret
= mt9m111_set_autoexposure(client
, ctrl
->value
);
884 case V4L2_CID_AUTO_WHITE_BALANCE
:
885 ret
= mt9m111_set_autowhitebalance(client
, ctrl
->value
);
894 static int mt9m111_suspend(struct soc_camera_device
*icd
, pm_message_t state
)
896 struct i2c_client
*client
= to_i2c_client(to_soc_camera_control(icd
));
897 struct mt9m111
*mt9m111
= to_mt9m111(client
);
899 mt9m111
->gain
= mt9m111_get_global_gain(client
);
904 static int mt9m111_restore_state(struct i2c_client
*client
)
906 struct mt9m111
*mt9m111
= to_mt9m111(client
);
908 mt9m111_set_context(client
, mt9m111
->context
);
909 mt9m111_set_pixfmt(client
, mt9m111
->fmt
->code
);
910 mt9m111_setup_rect(client
, &mt9m111
->rect
);
911 mt9m111_set_flip(client
, mt9m111
->hflip
, MT9M111_RMB_MIRROR_COLS
);
912 mt9m111_set_flip(client
, mt9m111
->vflip
, MT9M111_RMB_MIRROR_ROWS
);
913 mt9m111_set_global_gain(client
, mt9m111
->gain
);
914 mt9m111_set_autoexposure(client
, mt9m111
->autoexposure
);
915 mt9m111_set_autowhitebalance(client
, mt9m111
->autowhitebalance
);
919 static int mt9m111_resume(struct soc_camera_device
*icd
)
921 struct i2c_client
*client
= to_i2c_client(to_soc_camera_control(icd
));
922 struct mt9m111
*mt9m111
= to_mt9m111(client
);
925 if (mt9m111
->powered
) {
926 ret
= mt9m111_enable(client
);
928 ret
= mt9m111_reset(client
);
930 ret
= mt9m111_restore_state(client
);
935 static int mt9m111_init(struct i2c_client
*client
)
937 struct mt9m111
*mt9m111
= to_mt9m111(client
);
940 mt9m111
->context
= HIGHPOWER
;
941 ret
= mt9m111_enable(client
);
943 ret
= mt9m111_reset(client
);
945 ret
= mt9m111_set_context(client
, mt9m111
->context
);
947 ret
= mt9m111_set_autoexposure(client
, mt9m111
->autoexposure
);
949 dev_err(&client
->dev
, "mt9m111 init failed: %d\n", ret
);
954 * Interface active, can use i2c. If it fails, it can indeed mean, that
955 * this wasn't our capture interface, so, we wait for the right one
957 static int mt9m111_video_probe(struct soc_camera_device
*icd
,
958 struct i2c_client
*client
)
960 struct mt9m111
*mt9m111
= to_mt9m111(client
);
965 * We must have a parent by now. And it cannot be a wrong one.
966 * So this entire test is completely redundant.
968 if (!icd
->dev
.parent
||
969 to_soc_camera_host(icd
->dev
.parent
)->nr
!= icd
->iface
)
972 mt9m111
->autoexposure
= 1;
973 mt9m111
->autowhitebalance
= 1;
975 mt9m111
->swap_rgb_even_odd
= 1;
976 mt9m111
->swap_rgb_red_blue
= 1;
978 data
= reg_read(CHIP_VERSION
);
981 case 0x143a: /* MT9M111 or MT9M131 */
982 mt9m111
->model
= V4L2_IDENT_MT9M111
;
983 dev_info(&client
->dev
,
984 "Detected a MT9M111/MT9M131 chip ID %x\n", data
);
986 case 0x148c: /* MT9M112 */
987 mt9m111
->model
= V4L2_IDENT_MT9M112
;
988 dev_info(&client
->dev
, "Detected a MT9M112 chip ID %x\n", data
);
992 dev_err(&client
->dev
,
993 "No MT9M111/MT9M112/MT9M131 chip detected register read %x\n",
998 ret
= mt9m111_init(client
);
1004 static struct v4l2_subdev_core_ops mt9m111_subdev_core_ops
= {
1005 .g_ctrl
= mt9m111_g_ctrl
,
1006 .s_ctrl
= mt9m111_s_ctrl
,
1007 .g_chip_ident
= mt9m111_g_chip_ident
,
1008 #ifdef CONFIG_VIDEO_ADV_DEBUG
1009 .g_register
= mt9m111_g_register
,
1010 .s_register
= mt9m111_s_register
,
1014 static int mt9m111_enum_fmt(struct v4l2_subdev
*sd
, unsigned int index
,
1015 enum v4l2_mbus_pixelcode
*code
)
1017 if (index
>= ARRAY_SIZE(mt9m111_colour_fmts
))
1020 *code
= mt9m111_colour_fmts
[index
].code
;
1024 static struct v4l2_subdev_video_ops mt9m111_subdev_video_ops
= {
1025 .s_mbus_fmt
= mt9m111_s_fmt
,
1026 .g_mbus_fmt
= mt9m111_g_fmt
,
1027 .try_mbus_fmt
= mt9m111_try_fmt
,
1028 .s_crop
= mt9m111_s_crop
,
1029 .g_crop
= mt9m111_g_crop
,
1030 .cropcap
= mt9m111_cropcap
,
1031 .enum_mbus_fmt
= mt9m111_enum_fmt
,
1034 static struct v4l2_subdev_ops mt9m111_subdev_ops
= {
1035 .core
= &mt9m111_subdev_core_ops
,
1036 .video
= &mt9m111_subdev_video_ops
,
1039 static int mt9m111_probe(struct i2c_client
*client
,
1040 const struct i2c_device_id
*did
)
1042 struct mt9m111
*mt9m111
;
1043 struct soc_camera_device
*icd
= client
->dev
.platform_data
;
1044 struct i2c_adapter
*adapter
= to_i2c_adapter(client
->dev
.parent
);
1045 struct soc_camera_link
*icl
;
1049 dev_err(&client
->dev
, "mt9m111: soc-camera data missing!\n");
1053 icl
= to_soc_camera_link(icd
);
1055 dev_err(&client
->dev
, "mt9m111: driver needs platform data\n");
1059 if (!i2c_check_functionality(adapter
, I2C_FUNC_SMBUS_WORD_DATA
)) {
1060 dev_warn(&adapter
->dev
,
1061 "I2C-Adapter doesn't support I2C_FUNC_SMBUS_WORD\n");
1065 mt9m111
= kzalloc(sizeof(struct mt9m111
), GFP_KERNEL
);
1069 v4l2_i2c_subdev_init(&mt9m111
->subdev
, client
, &mt9m111_subdev_ops
);
1071 /* Second stage probe - when a capture adapter is there */
1072 icd
->ops
= &mt9m111_ops
;
1074 mt9m111
->rect
.left
= MT9M111_MIN_DARK_COLS
;
1075 mt9m111
->rect
.top
= MT9M111_MIN_DARK_ROWS
;
1076 mt9m111
->rect
.width
= MT9M111_MAX_WIDTH
;
1077 mt9m111
->rect
.height
= MT9M111_MAX_HEIGHT
;
1078 mt9m111
->fmt
= &mt9m111_colour_fmts
[0];
1080 ret
= mt9m111_video_probe(icd
, client
);
1089 static int mt9m111_remove(struct i2c_client
*client
)
1091 struct mt9m111
*mt9m111
= to_mt9m111(client
);
1092 struct soc_camera_device
*icd
= client
->dev
.platform_data
;
1095 client
->driver
= NULL
;
1101 static const struct i2c_device_id mt9m111_id
[] = {
1105 MODULE_DEVICE_TABLE(i2c
, mt9m111_id
);
1107 static struct i2c_driver mt9m111_i2c_driver
= {
1111 .probe
= mt9m111_probe
,
1112 .remove
= mt9m111_remove
,
1113 .id_table
= mt9m111_id
,
1116 static int __init
mt9m111_mod_init(void)
1118 return i2c_add_driver(&mt9m111_i2c_driver
);
1121 static void __exit
mt9m111_mod_exit(void)
1123 i2c_del_driver(&mt9m111_i2c_driver
);
1126 module_init(mt9m111_mod_init
);
1127 module_exit(mt9m111_mod_exit
);
1129 MODULE_DESCRIPTION("Micron/Aptina MT9M111/MT9M112/MT9M131 Camera driver");
1130 MODULE_AUTHOR("Robert Jarzmik");
1131 MODULE_LICENSE("GPL");