1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 * Driver for MT9M111/MT9M112/MT9M131 CMOS Image Sensor from Micron/Aptina
4 *
5 * Copyright (C) 2008, Robert Jarzmik <robert.jarzmik@free.fr>
6 */
7 #include <linux/clk.h>
8 #include <linux/videodev2.h>
9 #include <linux/slab.h>
10 #include <linux/i2c.h>
11 #include <linux/log2.h>
12 #include <linux/delay.h>
13 #include <linux/regulator/consumer.h>
14 #include <linux/v4l2-mediabus.h>
15 #include <linux/module.h>
16 #include <linux/property.h>
17
18 #include <media/v4l2-async.h>
19 #include <media/v4l2-common.h>
20 #include <media/v4l2-ctrls.h>
21 #include <media/v4l2-device.h>
22 #include <media/v4l2-event.h>
23 #include <media/v4l2-fwnode.h>
24
25 /*
26 * MT9M111, MT9M112 and MT9M131:
27 * i2c address is 0x48 or 0x5d (depending on SADDR pin)
28 * The platform has to define struct i2c_board_info objects and link to them
29 * from struct soc_camera_host_desc
30 */
31
32 /*
33 * Sensor core register addresses (0x000..0x0ff)
34 */
35 #define MT9M111_CHIP_VERSION 0x000
36 #define MT9M111_ROW_START 0x001
37 #define MT9M111_COLUMN_START 0x002
38 #define MT9M111_WINDOW_HEIGHT 0x003
39 #define MT9M111_WINDOW_WIDTH 0x004
40 #define MT9M111_HORIZONTAL_BLANKING_B 0x005
41 #define MT9M111_VERTICAL_BLANKING_B 0x006
42 #define MT9M111_HORIZONTAL_BLANKING_A 0x007
43 #define MT9M111_VERTICAL_BLANKING_A 0x008
44 #define MT9M111_SHUTTER_WIDTH 0x009
45 #define MT9M111_ROW_SPEED 0x00a
46 #define MT9M111_EXTRA_DELAY 0x00b
47 #define MT9M111_SHUTTER_DELAY 0x00c
48 #define MT9M111_RESET 0x00d
49 #define MT9M111_READ_MODE_B 0x020
50 #define MT9M111_READ_MODE_A 0x021
51 #define MT9M111_FLASH_CONTROL 0x023
52 #define MT9M111_GREEN1_GAIN 0x02b
53 #define MT9M111_BLUE_GAIN 0x02c
54 #define MT9M111_RED_GAIN 0x02d
55 #define MT9M111_GREEN2_GAIN 0x02e
56 #define MT9M111_GLOBAL_GAIN 0x02f
57 #define MT9M111_CONTEXT_CONTROL 0x0c8
58 #define MT9M111_PAGE_MAP 0x0f0
59 #define MT9M111_BYTE_WISE_ADDR 0x0f1
60
61 #define MT9M111_RESET_SYNC_CHANGES (1 << 15)
62 #define MT9M111_RESET_RESTART_BAD_FRAME (1 << 9)
63 #define MT9M111_RESET_SHOW_BAD_FRAMES (1 << 8)
64 #define MT9M111_RESET_RESET_SOC (1 << 5)
65 #define MT9M111_RESET_OUTPUT_DISABLE (1 << 4)
66 #define MT9M111_RESET_CHIP_ENABLE (1 << 3)
67 #define MT9M111_RESET_ANALOG_STANDBY (1 << 2)
68 #define MT9M111_RESET_RESTART_FRAME (1 << 1)
69 #define MT9M111_RESET_RESET_MODE (1 << 0)
70
71 #define MT9M111_RM_FULL_POWER_RD (0 << 10)
72 #define MT9M111_RM_LOW_POWER_RD (1 << 10)
73 #define MT9M111_RM_COL_SKIP_4X (1 << 5)
74 #define MT9M111_RM_ROW_SKIP_4X (1 << 4)
75 #define MT9M111_RM_COL_SKIP_2X (1 << 3)
76 #define MT9M111_RM_ROW_SKIP_2X (1 << 2)
77 #define MT9M111_RMB_MIRROR_COLS (1 << 1)
78 #define MT9M111_RMB_MIRROR_ROWS (1 << 0)
79 #define MT9M111_CTXT_CTRL_RESTART (1 << 15)
80 #define MT9M111_CTXT_CTRL_DEFECTCOR_B (1 << 12)
81 #define MT9M111_CTXT_CTRL_RESIZE_B (1 << 10)
82 #define MT9M111_CTXT_CTRL_CTRL2_B (1 << 9)
83 #define MT9M111_CTXT_CTRL_GAMMA_B (1 << 8)
84 #define MT9M111_CTXT_CTRL_XENON_EN (1 << 7)
85 #define MT9M111_CTXT_CTRL_READ_MODE_B (1 << 3)
86 #define MT9M111_CTXT_CTRL_LED_FLASH_EN (1 << 2)
87 #define MT9M111_CTXT_CTRL_VBLANK_SEL_B (1 << 1)
88 #define MT9M111_CTXT_CTRL_HBLANK_SEL_B (1 << 0)
89
90 /*
91 * Colorpipe register addresses (0x100..0x1ff)
92 */
93 #define MT9M111_OPER_MODE_CTRL 0x106
94 #define MT9M111_OUTPUT_FORMAT_CTRL 0x108
95 #define MT9M111_TPG_CTRL 0x148
96 #define MT9M111_REDUCER_XZOOM_B 0x1a0
97 #define MT9M111_REDUCER_XSIZE_B 0x1a1
98 #define MT9M111_REDUCER_YZOOM_B 0x1a3
99 #define MT9M111_REDUCER_YSIZE_B 0x1a4
100 #define MT9M111_REDUCER_XZOOM_A 0x1a6
101 #define MT9M111_REDUCER_XSIZE_A 0x1a7
102 #define MT9M111_REDUCER_YZOOM_A 0x1a9
103 #define MT9M111_REDUCER_YSIZE_A 0x1aa
104 #define MT9M111_EFFECTS_MODE 0x1e2
105
106 #define MT9M111_OUTPUT_FORMAT_CTRL2_A 0x13a
107 #define MT9M111_OUTPUT_FORMAT_CTRL2_B 0x19b
108
109 #define MT9M111_OPMODE_AUTOEXPO_EN (1 << 14)
110 #define MT9M111_OPMODE_AUTOWHITEBAL_EN (1 << 1)
111 #define MT9M111_OUTFMT_FLIP_BAYER_COL (1 << 9)
112 #define MT9M111_OUTFMT_FLIP_BAYER_ROW (1 << 8)
113 #define MT9M111_OUTFMT_PROCESSED_BAYER (1 << 14)
114 #define MT9M111_OUTFMT_BYPASS_IFP (1 << 10)
115 #define MT9M111_OUTFMT_INV_PIX_CLOCK (1 << 9)
116 #define MT9M111_OUTFMT_RGB (1 << 8)
117 #define MT9M111_OUTFMT_RGB565 (0 << 6)
118 #define MT9M111_OUTFMT_RGB555 (1 << 6)
119 #define MT9M111_OUTFMT_RGB444x (2 << 6)
120 #define MT9M111_OUTFMT_RGBx444 (3 << 6)
121 #define MT9M111_OUTFMT_TST_RAMP_OFF (0 << 4)
122 #define MT9M111_OUTFMT_TST_RAMP_COL (1 << 4)
123 #define MT9M111_OUTFMT_TST_RAMP_ROW (2 << 4)
124 #define MT9M111_OUTFMT_TST_RAMP_FRAME (3 << 4)
125 #define MT9M111_OUTFMT_SHIFT_3_UP (1 << 3)
126 #define MT9M111_OUTFMT_AVG_CHROMA (1 << 2)
127 #define MT9M111_OUTFMT_SWAP_YCbCr_C_Y_RGB_EVEN (1 << 1)
128 #define MT9M111_OUTFMT_SWAP_YCbCr_Cb_Cr_RGB_R_B (1 << 0)
129 #define MT9M111_TPG_SEL_MASK GENMASK(2, 0)
130 #define MT9M111_EFFECTS_MODE_MASK GENMASK(2, 0)
131 #define MT9M111_RM_PWR_MASK BIT(10)
132 #define MT9M111_RM_SKIP2_MASK GENMASK(3, 2)
133
134 /*
135 * Camera control register addresses (0x200..0x2ff not implemented)
136 */
137
138 #define reg_read(reg) mt9m111_reg_read(client, MT9M111_##reg)
139 #define reg_write(reg, val) mt9m111_reg_write(client, MT9M111_##reg, (val))
140 #define reg_set(reg, val) mt9m111_reg_set(client, MT9M111_##reg, (val))
141 #define reg_clear(reg, val) mt9m111_reg_clear(client, MT9M111_##reg, (val))
142 #define reg_mask(reg, val, mask) mt9m111_reg_mask(client, MT9M111_##reg, \
143 (val), (mask))
144
145 #define MT9M111_MIN_DARK_ROWS 8
146 #define MT9M111_MIN_DARK_COLS 26
147 #define MT9M111_MAX_HEIGHT 1024
148 #define MT9M111_MAX_WIDTH 1280
149
150 struct mt9m111_context {
151 u16 read_mode;
152 u16 blanking_h;
153 u16 blanking_v;
154 u16 reducer_xzoom;
155 u16 reducer_yzoom;
156 u16 reducer_xsize;
157 u16 reducer_ysize;
158 u16 output_fmt_ctrl2;
159 u16 control;
160 };
161
162 static struct mt9m111_context context_a = {
163 .read_mode = MT9M111_READ_MODE_A,
164 .blanking_h = MT9M111_HORIZONTAL_BLANKING_A,
165 .blanking_v = MT9M111_VERTICAL_BLANKING_A,
166 .reducer_xzoom = MT9M111_REDUCER_XZOOM_A,
167 .reducer_yzoom = MT9M111_REDUCER_YZOOM_A,
168 .reducer_xsize = MT9M111_REDUCER_XSIZE_A,
169 .reducer_ysize = MT9M111_REDUCER_YSIZE_A,
170 .output_fmt_ctrl2 = MT9M111_OUTPUT_FORMAT_CTRL2_A,
171 .control = MT9M111_CTXT_CTRL_RESTART,
172 };
173
174 static struct mt9m111_context context_b = {
175 .read_mode = MT9M111_READ_MODE_B,
176 .blanking_h = MT9M111_HORIZONTAL_BLANKING_B,
177 .blanking_v = MT9M111_VERTICAL_BLANKING_B,
178 .reducer_xzoom = MT9M111_REDUCER_XZOOM_B,
179 .reducer_yzoom = MT9M111_REDUCER_YZOOM_B,
180 .reducer_xsize = MT9M111_REDUCER_XSIZE_B,
181 .reducer_ysize = MT9M111_REDUCER_YSIZE_B,
182 .output_fmt_ctrl2 = MT9M111_OUTPUT_FORMAT_CTRL2_B,
183 .control = MT9M111_CTXT_CTRL_RESTART |
184 MT9M111_CTXT_CTRL_DEFECTCOR_B | MT9M111_CTXT_CTRL_RESIZE_B |
185 MT9M111_CTXT_CTRL_CTRL2_B | MT9M111_CTXT_CTRL_GAMMA_B |
186 MT9M111_CTXT_CTRL_READ_MODE_B | MT9M111_CTXT_CTRL_VBLANK_SEL_B |
187 MT9M111_CTXT_CTRL_HBLANK_SEL_B,
188 };
189
190 /* MT9M111 has only one fixed colorspace per pixelcode */
191 struct mt9m111_datafmt {
192 u32 code;
193 enum v4l2_colorspace colorspace;
194 };
195
196 static const struct mt9m111_datafmt mt9m111_colour_fmts[] = {
197 {MEDIA_BUS_FMT_YUYV8_2X8, V4L2_COLORSPACE_SRGB},
198 {MEDIA_BUS_FMT_YVYU8_2X8, V4L2_COLORSPACE_SRGB},
199 {MEDIA_BUS_FMT_UYVY8_2X8, V4L2_COLORSPACE_SRGB},
200 {MEDIA_BUS_FMT_VYUY8_2X8, V4L2_COLORSPACE_SRGB},
201 {MEDIA_BUS_FMT_RGB555_2X8_PADHI_LE, V4L2_COLORSPACE_SRGB},
202 {MEDIA_BUS_FMT_RGB555_2X8_PADHI_BE, V4L2_COLORSPACE_SRGB},
203 {MEDIA_BUS_FMT_RGB565_2X8_LE, V4L2_COLORSPACE_SRGB},
204 {MEDIA_BUS_FMT_RGB565_2X8_BE, V4L2_COLORSPACE_SRGB},
205 {MEDIA_BUS_FMT_BGR565_2X8_LE, V4L2_COLORSPACE_SRGB},
206 {MEDIA_BUS_FMT_BGR565_2X8_BE, V4L2_COLORSPACE_SRGB},
207 {MEDIA_BUS_FMT_SBGGR8_1X8, V4L2_COLORSPACE_SRGB},
208 {MEDIA_BUS_FMT_SBGGR10_2X8_PADHI_LE, V4L2_COLORSPACE_SRGB},
209 };
210
211 enum mt9m111_mode_id {
212 MT9M111_MODE_SXGA_8FPS,
213 MT9M111_MODE_SXGA_15FPS,
214 MT9M111_MODE_QSXGA_30FPS,
215 MT9M111_NUM_MODES,
216 };
217
218 struct mt9m111_mode_info {
219 unsigned int sensor_w;
220 unsigned int sensor_h;
221 unsigned int max_image_w;
222 unsigned int max_image_h;
223 unsigned int max_fps;
224 unsigned int reg_val;
225 unsigned int reg_mask;
226 };
227
228 struct mt9m111 {
229 struct v4l2_subdev subdev;
230 struct v4l2_ctrl_handler hdl;
231 struct v4l2_ctrl *gain;
232 struct mt9m111_context *ctx;
233 struct v4l2_rect rect; /* cropping rectangle */
234 struct clk *clk;
235 unsigned int width; /* output */
236 unsigned int height; /* sizes */
237 struct v4l2_fract frame_interval;
238 const struct mt9m111_mode_info *current_mode;
239 struct mutex power_lock; /* lock to protect power_count */
240 int power_count;
241 const struct mt9m111_datafmt *fmt;
242 int lastpage; /* PageMap cache value */
243 struct regulator *regulator;
244 bool is_streaming;
245 /* user point of view - 0: falling 1: rising edge */
246 unsigned int pclk_sample:1;
247 struct media_pad pad;
248 };
249
250 static const struct mt9m111_mode_info mt9m111_mode_data[MT9M111_NUM_MODES] = {
251 [MT9M111_MODE_SXGA_8FPS] = {
252 .sensor_w = 1280,
253 .sensor_h = 1024,
254 .max_image_w = 1280,
255 .max_image_h = 1024,
256 .max_fps = 8,
257 .reg_val = MT9M111_RM_LOW_POWER_RD,
258 .reg_mask = MT9M111_RM_PWR_MASK | MT9M111_RM_SKIP2_MASK,
259 },
260 [MT9M111_MODE_SXGA_15FPS] = {
261 .sensor_w = 1280,
262 .sensor_h = 1024,
263 .max_image_w = 1280,
264 .max_image_h = 1024,
265 .max_fps = 15,
266 .reg_val = MT9M111_RM_FULL_POWER_RD,
267 .reg_mask = MT9M111_RM_PWR_MASK | MT9M111_RM_SKIP2_MASK,
268 },
269 [MT9M111_MODE_QSXGA_30FPS] = {
270 .sensor_w = 1280,
271 .sensor_h = 1024,
272 .max_image_w = 640,
273 .max_image_h = 512,
274 .max_fps = 30,
275 .reg_val = MT9M111_RM_LOW_POWER_RD | MT9M111_RM_COL_SKIP_2X |
276 MT9M111_RM_ROW_SKIP_2X,
277 .reg_mask = MT9M111_RM_PWR_MASK | MT9M111_RM_SKIP2_MASK,
278 },
279 };
280
281 /* Find a data format by a pixel code */
mt9m111_find_datafmt(struct mt9m111 * mt9m111,u32 code)282 static const struct mt9m111_datafmt *mt9m111_find_datafmt(struct mt9m111 *mt9m111,
283 u32 code)
284 {
285 int i;
286 for (i = 0; i < ARRAY_SIZE(mt9m111_colour_fmts); i++)
287 if (mt9m111_colour_fmts[i].code == code)
288 return mt9m111_colour_fmts + i;
289
290 return mt9m111->fmt;
291 }
292
to_mt9m111(const struct i2c_client * client)293 static struct mt9m111 *to_mt9m111(const struct i2c_client *client)
294 {
295 return container_of(i2c_get_clientdata(client), struct mt9m111, subdev);
296 }
297
reg_page_map_set(struct i2c_client * client,const u16 reg)298 static int reg_page_map_set(struct i2c_client *client, const u16 reg)
299 {
300 int ret;
301 u16 page;
302 struct mt9m111 *mt9m111 = to_mt9m111(client);
303
304 page = (reg >> 8);
305 if (page == mt9m111->lastpage)
306 return 0;
307 if (page > 2)
308 return -EINVAL;
309
310 ret = i2c_smbus_write_word_swapped(client, MT9M111_PAGE_MAP, page);
311 if (!ret)
312 mt9m111->lastpage = page;
313 return ret;
314 }
315
mt9m111_reg_read(struct i2c_client * client,const u16 reg)316 static int mt9m111_reg_read(struct i2c_client *client, const u16 reg)
317 {
318 int ret;
319
320 ret = reg_page_map_set(client, reg);
321 if (!ret)
322 ret = i2c_smbus_read_word_swapped(client, reg & 0xff);
323
324 dev_dbg(&client->dev, "read reg.%03x -> %04x\n", reg, ret);
325 return ret;
326 }
327
mt9m111_reg_write(struct i2c_client * client,const u16 reg,const u16 data)328 static int mt9m111_reg_write(struct i2c_client *client, const u16 reg,
329 const u16 data)
330 {
331 int ret;
332
333 ret = reg_page_map_set(client, reg);
334 if (!ret)
335 ret = i2c_smbus_write_word_swapped(client, reg & 0xff, data);
336 dev_dbg(&client->dev, "write reg.%03x = %04x -> %d\n", reg, data, ret);
337 return ret;
338 }
339
mt9m111_reg_set(struct i2c_client * client,const u16 reg,const u16 data)340 static int mt9m111_reg_set(struct i2c_client *client, const u16 reg,
341 const u16 data)
342 {
343 int ret;
344
345 ret = mt9m111_reg_read(client, reg);
346 if (ret >= 0)
347 ret = mt9m111_reg_write(client, reg, ret | data);
348 return ret;
349 }
350
mt9m111_reg_clear(struct i2c_client * client,const u16 reg,const u16 data)351 static int mt9m111_reg_clear(struct i2c_client *client, const u16 reg,
352 const u16 data)
353 {
354 int ret;
355
356 ret = mt9m111_reg_read(client, reg);
357 if (ret >= 0)
358 ret = mt9m111_reg_write(client, reg, ret & ~data);
359 return ret;
360 }
361
mt9m111_reg_mask(struct i2c_client * client,const u16 reg,const u16 data,const u16 mask)362 static int mt9m111_reg_mask(struct i2c_client *client, const u16 reg,
363 const u16 data, const u16 mask)
364 {
365 int ret;
366
367 ret = mt9m111_reg_read(client, reg);
368 if (ret >= 0)
369 ret = mt9m111_reg_write(client, reg, (ret & ~mask) | data);
370 return ret;
371 }
372
mt9m111_set_context(struct mt9m111 * mt9m111,struct mt9m111_context * ctx)373 static int mt9m111_set_context(struct mt9m111 *mt9m111,
374 struct mt9m111_context *ctx)
375 {
376 struct i2c_client *client = v4l2_get_subdevdata(&mt9m111->subdev);
377 return reg_write(CONTEXT_CONTROL, ctx->control);
378 }
379
mt9m111_setup_rect_ctx(struct mt9m111 * mt9m111,struct mt9m111_context * ctx,struct v4l2_rect * rect,unsigned int width,unsigned int height)380 static int mt9m111_setup_rect_ctx(struct mt9m111 *mt9m111,
381 struct mt9m111_context *ctx, struct v4l2_rect *rect,
382 unsigned int width, unsigned int height)
383 {
384 struct i2c_client *client = v4l2_get_subdevdata(&mt9m111->subdev);
385 int ret = mt9m111_reg_write(client, ctx->reducer_xzoom, rect->width);
386 if (!ret)
387 ret = mt9m111_reg_write(client, ctx->reducer_yzoom, rect->height);
388 if (!ret)
389 ret = mt9m111_reg_write(client, ctx->reducer_xsize, width);
390 if (!ret)
391 ret = mt9m111_reg_write(client, ctx->reducer_ysize, height);
392 return ret;
393 }
394
mt9m111_setup_geometry(struct mt9m111 * mt9m111,struct v4l2_rect * rect,int width,int height,u32 code)395 static int mt9m111_setup_geometry(struct mt9m111 *mt9m111, struct v4l2_rect *rect,
396 int width, int height, u32 code)
397 {
398 struct i2c_client *client = v4l2_get_subdevdata(&mt9m111->subdev);
399 int ret;
400
401 ret = reg_write(COLUMN_START, rect->left);
402 if (!ret)
403 ret = reg_write(ROW_START, rect->top);
404
405 if (!ret)
406 ret = reg_write(WINDOW_WIDTH, rect->width);
407 if (!ret)
408 ret = reg_write(WINDOW_HEIGHT, rect->height);
409
410 if (code != MEDIA_BUS_FMT_SBGGR10_2X8_PADHI_LE) {
411 /* IFP in use, down-scaling possible */
412 if (!ret)
413 ret = mt9m111_setup_rect_ctx(mt9m111, &context_b,
414 rect, width, height);
415 if (!ret)
416 ret = mt9m111_setup_rect_ctx(mt9m111, &context_a,
417 rect, width, height);
418 }
419
420 dev_dbg(&client->dev, "%s(%x): %ux%u@%u:%u -> %ux%u = %d\n",
421 __func__, code, rect->width, rect->height, rect->left, rect->top,
422 width, height, ret);
423
424 return ret;
425 }
426
mt9m111_enable(struct mt9m111 * mt9m111)427 static int mt9m111_enable(struct mt9m111 *mt9m111)
428 {
429 struct i2c_client *client = v4l2_get_subdevdata(&mt9m111->subdev);
430 return reg_write(RESET, MT9M111_RESET_CHIP_ENABLE);
431 }
432
mt9m111_reset(struct mt9m111 * mt9m111)433 static int mt9m111_reset(struct mt9m111 *mt9m111)
434 {
435 struct i2c_client *client = v4l2_get_subdevdata(&mt9m111->subdev);
436 int ret;
437
438 ret = reg_set(RESET, MT9M111_RESET_RESET_MODE);
439 if (!ret)
440 ret = reg_set(RESET, MT9M111_RESET_RESET_SOC);
441 if (!ret)
442 ret = reg_clear(RESET, MT9M111_RESET_RESET_MODE
443 | MT9M111_RESET_RESET_SOC);
444
445 return ret;
446 }
447
mt9m111_set_selection(struct v4l2_subdev * sd,struct v4l2_subdev_state * sd_state,struct v4l2_subdev_selection * sel)448 static int mt9m111_set_selection(struct v4l2_subdev *sd,
449 struct v4l2_subdev_state *sd_state,
450 struct v4l2_subdev_selection *sel)
451 {
452 struct i2c_client *client = v4l2_get_subdevdata(sd);
453 struct mt9m111 *mt9m111 = to_mt9m111(client);
454 struct v4l2_rect rect = sel->r;
455 int width, height;
456 int ret, align = 0;
457
458 if (sel->which != V4L2_SUBDEV_FORMAT_ACTIVE ||
459 sel->target != V4L2_SEL_TGT_CROP)
460 return -EINVAL;
461
462 if (mt9m111->fmt->code == MEDIA_BUS_FMT_SBGGR8_1X8 ||
463 mt9m111->fmt->code == MEDIA_BUS_FMT_SBGGR10_2X8_PADHI_LE) {
464 /* Bayer format - even size lengths */
465 align = 1;
466 /* Let the user play with the starting pixel */
467 }
468
469 /* FIXME: the datasheet doesn't specify minimum sizes */
470 v4l_bound_align_image(&rect.width, 2, MT9M111_MAX_WIDTH, align,
471 &rect.height, 2, MT9M111_MAX_HEIGHT, align, 0);
472 rect.left = clamp(rect.left, MT9M111_MIN_DARK_COLS,
473 MT9M111_MIN_DARK_COLS + MT9M111_MAX_WIDTH -
474 (__s32)rect.width);
475 rect.top = clamp(rect.top, MT9M111_MIN_DARK_ROWS,
476 MT9M111_MIN_DARK_ROWS + MT9M111_MAX_HEIGHT -
477 (__s32)rect.height);
478
479 width = min(mt9m111->width, rect.width);
480 height = min(mt9m111->height, rect.height);
481
482 ret = mt9m111_setup_geometry(mt9m111, &rect, width, height, mt9m111->fmt->code);
483 if (!ret) {
484 mt9m111->rect = rect;
485 mt9m111->width = width;
486 mt9m111->height = height;
487 }
488
489 return ret;
490 }
491
mt9m111_get_selection(struct v4l2_subdev * sd,struct v4l2_subdev_state * sd_state,struct v4l2_subdev_selection * sel)492 static int mt9m111_get_selection(struct v4l2_subdev *sd,
493 struct v4l2_subdev_state *sd_state,
494 struct v4l2_subdev_selection *sel)
495 {
496 struct i2c_client *client = v4l2_get_subdevdata(sd);
497 struct mt9m111 *mt9m111 = to_mt9m111(client);
498
499 if (sel->which != V4L2_SUBDEV_FORMAT_ACTIVE)
500 return -EINVAL;
501
502 switch (sel->target) {
503 case V4L2_SEL_TGT_CROP_BOUNDS:
504 sel->r.left = MT9M111_MIN_DARK_COLS;
505 sel->r.top = MT9M111_MIN_DARK_ROWS;
506 sel->r.width = MT9M111_MAX_WIDTH;
507 sel->r.height = MT9M111_MAX_HEIGHT;
508 return 0;
509 case V4L2_SEL_TGT_CROP:
510 sel->r = mt9m111->rect;
511 return 0;
512 default:
513 return -EINVAL;
514 }
515 }
516
mt9m111_get_fmt(struct v4l2_subdev * sd,struct v4l2_subdev_state * sd_state,struct v4l2_subdev_format * format)517 static int mt9m111_get_fmt(struct v4l2_subdev *sd,
518 struct v4l2_subdev_state *sd_state,
519 struct v4l2_subdev_format *format)
520 {
521 struct v4l2_mbus_framefmt *mf = &format->format;
522 struct mt9m111 *mt9m111 = container_of(sd, struct mt9m111, subdev);
523
524 if (format->pad)
525 return -EINVAL;
526
527 if (format->which == V4L2_SUBDEV_FORMAT_TRY) {
528 mf = v4l2_subdev_state_get_format(sd_state, format->pad);
529 format->format = *mf;
530 return 0;
531 }
532
533 mf->width = mt9m111->width;
534 mf->height = mt9m111->height;
535 mf->code = mt9m111->fmt->code;
536 mf->colorspace = mt9m111->fmt->colorspace;
537 mf->field = V4L2_FIELD_NONE;
538 mf->ycbcr_enc = V4L2_YCBCR_ENC_DEFAULT;
539 mf->quantization = V4L2_QUANTIZATION_DEFAULT;
540 mf->xfer_func = V4L2_XFER_FUNC_DEFAULT;
541
542 return 0;
543 }
544
mt9m111_set_pixfmt(struct mt9m111 * mt9m111,u32 code)545 static int mt9m111_set_pixfmt(struct mt9m111 *mt9m111,
546 u32 code)
547 {
548 struct i2c_client *client = v4l2_get_subdevdata(&mt9m111->subdev);
549 u16 data_outfmt2, mask_outfmt2 = MT9M111_OUTFMT_PROCESSED_BAYER |
550 MT9M111_OUTFMT_BYPASS_IFP | MT9M111_OUTFMT_RGB |
551 MT9M111_OUTFMT_RGB565 | MT9M111_OUTFMT_RGB555 |
552 MT9M111_OUTFMT_RGB444x | MT9M111_OUTFMT_RGBx444 |
553 MT9M111_OUTFMT_SWAP_YCbCr_C_Y_RGB_EVEN |
554 MT9M111_OUTFMT_SWAP_YCbCr_Cb_Cr_RGB_R_B;
555 int ret;
556
557 switch (code) {
558 case MEDIA_BUS_FMT_SBGGR8_1X8:
559 data_outfmt2 = MT9M111_OUTFMT_PROCESSED_BAYER |
560 MT9M111_OUTFMT_RGB;
561 break;
562 case MEDIA_BUS_FMT_SBGGR10_2X8_PADHI_LE:
563 data_outfmt2 = MT9M111_OUTFMT_BYPASS_IFP | MT9M111_OUTFMT_RGB;
564 break;
565 case MEDIA_BUS_FMT_RGB555_2X8_PADHI_LE:
566 data_outfmt2 = MT9M111_OUTFMT_RGB | MT9M111_OUTFMT_RGB555 |
567 MT9M111_OUTFMT_SWAP_YCbCr_C_Y_RGB_EVEN;
568 break;
569 case MEDIA_BUS_FMT_RGB555_2X8_PADHI_BE:
570 data_outfmt2 = MT9M111_OUTFMT_RGB | MT9M111_OUTFMT_RGB555;
571 break;
572 case MEDIA_BUS_FMT_RGB565_2X8_LE:
573 data_outfmt2 = MT9M111_OUTFMT_RGB | MT9M111_OUTFMT_RGB565 |
574 MT9M111_OUTFMT_SWAP_YCbCr_C_Y_RGB_EVEN;
575 break;
576 case MEDIA_BUS_FMT_RGB565_2X8_BE:
577 data_outfmt2 = MT9M111_OUTFMT_RGB | MT9M111_OUTFMT_RGB565;
578 break;
579 case MEDIA_BUS_FMT_BGR565_2X8_BE:
580 data_outfmt2 = MT9M111_OUTFMT_RGB | MT9M111_OUTFMT_RGB565 |
581 MT9M111_OUTFMT_SWAP_YCbCr_Cb_Cr_RGB_R_B;
582 break;
583 case MEDIA_BUS_FMT_BGR565_2X8_LE:
584 data_outfmt2 = MT9M111_OUTFMT_RGB | MT9M111_OUTFMT_RGB565 |
585 MT9M111_OUTFMT_SWAP_YCbCr_C_Y_RGB_EVEN |
586 MT9M111_OUTFMT_SWAP_YCbCr_Cb_Cr_RGB_R_B;
587 break;
588 case MEDIA_BUS_FMT_UYVY8_2X8:
589 data_outfmt2 = 0;
590 break;
591 case MEDIA_BUS_FMT_VYUY8_2X8:
592 data_outfmt2 = MT9M111_OUTFMT_SWAP_YCbCr_Cb_Cr_RGB_R_B;
593 break;
594 case MEDIA_BUS_FMT_YUYV8_2X8:
595 data_outfmt2 = MT9M111_OUTFMT_SWAP_YCbCr_C_Y_RGB_EVEN;
596 break;
597 case MEDIA_BUS_FMT_YVYU8_2X8:
598 data_outfmt2 = MT9M111_OUTFMT_SWAP_YCbCr_C_Y_RGB_EVEN |
599 MT9M111_OUTFMT_SWAP_YCbCr_Cb_Cr_RGB_R_B;
600 break;
601 default:
602 dev_err(&client->dev, "Pixel format not handled: %x\n", code);
603 return -EINVAL;
604 }
605
606 /* receiver samples on falling edge, chip-hw default is rising */
607 if (mt9m111->pclk_sample == 0)
608 mask_outfmt2 |= MT9M111_OUTFMT_INV_PIX_CLOCK;
609
610 ret = mt9m111_reg_mask(client, context_a.output_fmt_ctrl2,
611 data_outfmt2, mask_outfmt2);
612 if (!ret)
613 ret = mt9m111_reg_mask(client, context_b.output_fmt_ctrl2,
614 data_outfmt2, mask_outfmt2);
615
616 return ret;
617 }
618
mt9m111_set_fmt(struct v4l2_subdev * sd,struct v4l2_subdev_state * sd_state,struct v4l2_subdev_format * format)619 static int mt9m111_set_fmt(struct v4l2_subdev *sd,
620 struct v4l2_subdev_state *sd_state,
621 struct v4l2_subdev_format *format)
622 {
623 struct v4l2_mbus_framefmt *mf = &format->format;
624 struct i2c_client *client = v4l2_get_subdevdata(sd);
625 struct mt9m111 *mt9m111 = container_of(sd, struct mt9m111, subdev);
626 const struct mt9m111_datafmt *fmt;
627 struct v4l2_rect *rect = &mt9m111->rect;
628 bool bayer;
629 int ret;
630
631 if (mt9m111->is_streaming)
632 return -EBUSY;
633
634 if (format->pad)
635 return -EINVAL;
636
637 fmt = mt9m111_find_datafmt(mt9m111, mf->code);
638
639 bayer = fmt->code == MEDIA_BUS_FMT_SBGGR8_1X8 ||
640 fmt->code == MEDIA_BUS_FMT_SBGGR10_2X8_PADHI_LE;
641
642 /*
643 * With Bayer format enforce even side lengths, but let the user play
644 * with the starting pixel
645 */
646 if (bayer) {
647 rect->width = ALIGN(rect->width, 2);
648 rect->height = ALIGN(rect->height, 2);
649 }
650
651 if (fmt->code == MEDIA_BUS_FMT_SBGGR10_2X8_PADHI_LE) {
652 /* IFP bypass mode, no scaling */
653 mf->width = rect->width;
654 mf->height = rect->height;
655 } else {
656 /* No upscaling */
657 if (mf->width > rect->width)
658 mf->width = rect->width;
659 if (mf->height > rect->height)
660 mf->height = rect->height;
661 }
662
663 dev_dbg(&client->dev, "%s(): %ux%u, code=%x\n", __func__,
664 mf->width, mf->height, fmt->code);
665
666 mf->code = fmt->code;
667 mf->colorspace = fmt->colorspace;
668 mf->field = V4L2_FIELD_NONE;
669 mf->ycbcr_enc = V4L2_YCBCR_ENC_DEFAULT;
670 mf->quantization = V4L2_QUANTIZATION_DEFAULT;
671 mf->xfer_func = V4L2_XFER_FUNC_DEFAULT;
672
673 if (format->which == V4L2_SUBDEV_FORMAT_TRY) {
674 *v4l2_subdev_state_get_format(sd_state, 0) = *mf;
675 return 0;
676 }
677
678 ret = mt9m111_setup_geometry(mt9m111, rect, mf->width, mf->height, mf->code);
679 if (!ret)
680 ret = mt9m111_set_pixfmt(mt9m111, mf->code);
681 if (!ret) {
682 mt9m111->width = mf->width;
683 mt9m111->height = mf->height;
684 mt9m111->fmt = fmt;
685 }
686
687 return ret;
688 }
689
690 static const struct mt9m111_mode_info *
mt9m111_find_mode(struct mt9m111 * mt9m111,unsigned int req_fps,unsigned int width,unsigned int height)691 mt9m111_find_mode(struct mt9m111 *mt9m111, unsigned int req_fps,
692 unsigned int width, unsigned int height)
693 {
694 const struct mt9m111_mode_info *mode;
695 struct v4l2_rect *sensor_rect = &mt9m111->rect;
696 unsigned int gap, gap_best = (unsigned int) -1;
697 int i, best_gap_idx = MT9M111_MODE_SXGA_15FPS;
698 bool skip_30fps = false;
699
700 /*
701 * The fps selection is based on the row, column skipping mechanism.
702 * So ensure that the sensor window is set to default else the fps
703 * aren't calculated correctly within the sensor hw.
704 */
705 if (sensor_rect->width != MT9M111_MAX_WIDTH ||
706 sensor_rect->height != MT9M111_MAX_HEIGHT) {
707 dev_info(mt9m111->subdev.dev,
708 "Framerate selection is not supported for cropped "
709 "images\n");
710 return NULL;
711 }
712
713 /* 30fps only supported for images not exceeding 640x512 */
714 if (width > MT9M111_MAX_WIDTH / 2 || height > MT9M111_MAX_HEIGHT / 2) {
715 dev_dbg(mt9m111->subdev.dev,
716 "Framerates > 15fps are supported only for images "
717 "not exceeding 640x512\n");
718 skip_30fps = true;
719 }
720
721 /* find best matched fps */
722 for (i = 0; i < MT9M111_NUM_MODES; i++) {
723 unsigned int fps = mt9m111_mode_data[i].max_fps;
724
725 if (fps == 30 && skip_30fps)
726 continue;
727
728 gap = abs(fps - req_fps);
729 if (gap < gap_best) {
730 best_gap_idx = i;
731 gap_best = gap;
732 }
733 }
734
735 /*
736 * Use context a/b default timing values instead of calculate blanking
737 * timing values.
738 */
739 mode = &mt9m111_mode_data[best_gap_idx];
740 mt9m111->ctx = (best_gap_idx == MT9M111_MODE_QSXGA_30FPS) ? &context_a :
741 &context_b;
742 return mode;
743 }
744
745 #ifdef CONFIG_VIDEO_ADV_DEBUG
mt9m111_g_register(struct v4l2_subdev * sd,struct v4l2_dbg_register * reg)746 static int mt9m111_g_register(struct v4l2_subdev *sd,
747 struct v4l2_dbg_register *reg)
748 {
749 struct i2c_client *client = v4l2_get_subdevdata(sd);
750 int val;
751
752 if (reg->reg > 0x2ff)
753 return -EINVAL;
754
755 val = mt9m111_reg_read(client, reg->reg);
756 reg->size = 2;
757 reg->val = (u64)val;
758
759 if (reg->val > 0xffff)
760 return -EIO;
761
762 return 0;
763 }
764
mt9m111_s_register(struct v4l2_subdev * sd,const struct v4l2_dbg_register * reg)765 static int mt9m111_s_register(struct v4l2_subdev *sd,
766 const struct v4l2_dbg_register *reg)
767 {
768 struct i2c_client *client = v4l2_get_subdevdata(sd);
769
770 if (reg->reg > 0x2ff)
771 return -EINVAL;
772
773 if (mt9m111_reg_write(client, reg->reg, reg->val) < 0)
774 return -EIO;
775
776 return 0;
777 }
778 #endif
779
mt9m111_set_flip(struct mt9m111 * mt9m111,int flip,int mask)780 static int mt9m111_set_flip(struct mt9m111 *mt9m111, int flip, int mask)
781 {
782 struct i2c_client *client = v4l2_get_subdevdata(&mt9m111->subdev);
783 int ret;
784
785 if (flip)
786 ret = mt9m111_reg_set(client, mt9m111->ctx->read_mode, mask);
787 else
788 ret = mt9m111_reg_clear(client, mt9m111->ctx->read_mode, mask);
789
790 return ret;
791 }
792
mt9m111_get_global_gain(struct mt9m111 * mt9m111)793 static int mt9m111_get_global_gain(struct mt9m111 *mt9m111)
794 {
795 struct i2c_client *client = v4l2_get_subdevdata(&mt9m111->subdev);
796 int data;
797
798 data = reg_read(GLOBAL_GAIN);
799 if (data >= 0)
800 return (data & 0x2f) * (1 << ((data >> 10) & 1)) *
801 (1 << ((data >> 9) & 1));
802 return data;
803 }
804
mt9m111_set_global_gain(struct mt9m111 * mt9m111,int gain)805 static int mt9m111_set_global_gain(struct mt9m111 *mt9m111, int gain)
806 {
807 struct i2c_client *client = v4l2_get_subdevdata(&mt9m111->subdev);
808 u16 val;
809
810 if (gain > 63 * 2 * 2)
811 return -EINVAL;
812
813 if ((gain >= 64 * 2) && (gain < 63 * 2 * 2))
814 val = (1 << 10) | (1 << 9) | (gain / 4);
815 else if ((gain >= 64) && (gain < 64 * 2))
816 val = (1 << 9) | (gain / 2);
817 else
818 val = gain;
819
820 return reg_write(GLOBAL_GAIN, val);
821 }
822
mt9m111_set_autoexposure(struct mt9m111 * mt9m111,int val)823 static int mt9m111_set_autoexposure(struct mt9m111 *mt9m111, int val)
824 {
825 struct i2c_client *client = v4l2_get_subdevdata(&mt9m111->subdev);
826
827 if (val == V4L2_EXPOSURE_AUTO)
828 return reg_set(OPER_MODE_CTRL, MT9M111_OPMODE_AUTOEXPO_EN);
829 return reg_clear(OPER_MODE_CTRL, MT9M111_OPMODE_AUTOEXPO_EN);
830 }
831
mt9m111_set_autowhitebalance(struct mt9m111 * mt9m111,int on)832 static int mt9m111_set_autowhitebalance(struct mt9m111 *mt9m111, int on)
833 {
834 struct i2c_client *client = v4l2_get_subdevdata(&mt9m111->subdev);
835
836 if (on)
837 return reg_set(OPER_MODE_CTRL, MT9M111_OPMODE_AUTOWHITEBAL_EN);
838 return reg_clear(OPER_MODE_CTRL, MT9M111_OPMODE_AUTOWHITEBAL_EN);
839 }
840
841 static const char * const mt9m111_test_pattern_menu[] = {
842 "Disabled",
843 "Vertical monochrome gradient",
844 "Flat color type 1",
845 "Flat color type 2",
846 "Flat color type 3",
847 "Flat color type 4",
848 "Flat color type 5",
849 "Color bar",
850 };
851
mt9m111_set_test_pattern(struct mt9m111 * mt9m111,int val)852 static int mt9m111_set_test_pattern(struct mt9m111 *mt9m111, int val)
853 {
854 struct i2c_client *client = v4l2_get_subdevdata(&mt9m111->subdev);
855
856 return mt9m111_reg_mask(client, MT9M111_TPG_CTRL, val,
857 MT9M111_TPG_SEL_MASK);
858 }
859
mt9m111_set_colorfx(struct mt9m111 * mt9m111,int val)860 static int mt9m111_set_colorfx(struct mt9m111 *mt9m111, int val)
861 {
862 struct i2c_client *client = v4l2_get_subdevdata(&mt9m111->subdev);
863 static const struct v4l2_control colorfx[] = {
864 { V4L2_COLORFX_NONE, 0 },
865 { V4L2_COLORFX_BW, 1 },
866 { V4L2_COLORFX_SEPIA, 2 },
867 { V4L2_COLORFX_NEGATIVE, 3 },
868 { V4L2_COLORFX_SOLARIZATION, 4 },
869 };
870 int i;
871
872 for (i = 0; i < ARRAY_SIZE(colorfx); i++) {
873 if (colorfx[i].id == val) {
874 return mt9m111_reg_mask(client, MT9M111_EFFECTS_MODE,
875 colorfx[i].value,
876 MT9M111_EFFECTS_MODE_MASK);
877 }
878 }
879
880 return -EINVAL;
881 }
882
mt9m111_s_ctrl(struct v4l2_ctrl * ctrl)883 static int mt9m111_s_ctrl(struct v4l2_ctrl *ctrl)
884 {
885 struct mt9m111 *mt9m111 = container_of(ctrl->handler,
886 struct mt9m111, hdl);
887
888 switch (ctrl->id) {
889 case V4L2_CID_VFLIP:
890 return mt9m111_set_flip(mt9m111, ctrl->val,
891 MT9M111_RMB_MIRROR_ROWS);
892 case V4L2_CID_HFLIP:
893 return mt9m111_set_flip(mt9m111, ctrl->val,
894 MT9M111_RMB_MIRROR_COLS);
895 case V4L2_CID_GAIN:
896 return mt9m111_set_global_gain(mt9m111, ctrl->val);
897 case V4L2_CID_EXPOSURE_AUTO:
898 return mt9m111_set_autoexposure(mt9m111, ctrl->val);
899 case V4L2_CID_AUTO_WHITE_BALANCE:
900 return mt9m111_set_autowhitebalance(mt9m111, ctrl->val);
901 case V4L2_CID_TEST_PATTERN:
902 return mt9m111_set_test_pattern(mt9m111, ctrl->val);
903 case V4L2_CID_COLORFX:
904 return mt9m111_set_colorfx(mt9m111, ctrl->val);
905 }
906
907 return -EINVAL;
908 }
909
mt9m111_suspend(struct mt9m111 * mt9m111)910 static int mt9m111_suspend(struct mt9m111 *mt9m111)
911 {
912 struct i2c_client *client = v4l2_get_subdevdata(&mt9m111->subdev);
913 int ret;
914
915 v4l2_ctrl_s_ctrl(mt9m111->gain, mt9m111_get_global_gain(mt9m111));
916
917 ret = reg_set(RESET, MT9M111_RESET_RESET_MODE);
918 if (!ret)
919 ret = reg_set(RESET, MT9M111_RESET_RESET_SOC |
920 MT9M111_RESET_OUTPUT_DISABLE |
921 MT9M111_RESET_ANALOG_STANDBY);
922 if (!ret)
923 ret = reg_clear(RESET, MT9M111_RESET_CHIP_ENABLE);
924
925 return ret;
926 }
927
mt9m111_restore_state(struct mt9m111 * mt9m111)928 static void mt9m111_restore_state(struct mt9m111 *mt9m111)
929 {
930 struct i2c_client *client = v4l2_get_subdevdata(&mt9m111->subdev);
931
932 mt9m111_set_context(mt9m111, mt9m111->ctx);
933 mt9m111_set_pixfmt(mt9m111, mt9m111->fmt->code);
934 mt9m111_setup_geometry(mt9m111, &mt9m111->rect,
935 mt9m111->width, mt9m111->height, mt9m111->fmt->code);
936 v4l2_ctrl_handler_setup(&mt9m111->hdl);
937 mt9m111_reg_mask(client, mt9m111->ctx->read_mode,
938 mt9m111->current_mode->reg_val,
939 mt9m111->current_mode->reg_mask);
940 }
941
mt9m111_resume(struct mt9m111 * mt9m111)942 static int mt9m111_resume(struct mt9m111 *mt9m111)
943 {
944 int ret = mt9m111_enable(mt9m111);
945 if (!ret)
946 ret = mt9m111_reset(mt9m111);
947 if (!ret)
948 mt9m111_restore_state(mt9m111);
949
950 return ret;
951 }
952
mt9m111_init(struct mt9m111 * mt9m111)953 static int mt9m111_init(struct mt9m111 *mt9m111)
954 {
955 struct i2c_client *client = v4l2_get_subdevdata(&mt9m111->subdev);
956 int ret;
957
958 ret = mt9m111_enable(mt9m111);
959 if (!ret)
960 ret = mt9m111_reset(mt9m111);
961 if (!ret)
962 ret = mt9m111_set_context(mt9m111, mt9m111->ctx);
963 if (ret)
964 dev_err(&client->dev, "mt9m111 init failed: %d\n", ret);
965 return ret;
966 }
967
mt9m111_power_on(struct mt9m111 * mt9m111)968 static int mt9m111_power_on(struct mt9m111 *mt9m111)
969 {
970 struct i2c_client *client = v4l2_get_subdevdata(&mt9m111->subdev);
971 int ret;
972
973 ret = clk_prepare_enable(mt9m111->clk);
974 if (ret < 0)
975 return ret;
976
977 ret = regulator_enable(mt9m111->regulator);
978 if (ret < 0)
979 goto out_clk_disable;
980
981 ret = mt9m111_resume(mt9m111);
982 if (ret < 0)
983 goto out_regulator_disable;
984
985 return 0;
986
987 out_regulator_disable:
988 regulator_disable(mt9m111->regulator);
989
990 out_clk_disable:
991 clk_disable_unprepare(mt9m111->clk);
992
993 dev_err(&client->dev, "Failed to resume the sensor: %d\n", ret);
994
995 return ret;
996 }
997
mt9m111_power_off(struct mt9m111 * mt9m111)998 static void mt9m111_power_off(struct mt9m111 *mt9m111)
999 {
1000 mt9m111_suspend(mt9m111);
1001 regulator_disable(mt9m111->regulator);
1002 clk_disable_unprepare(mt9m111->clk);
1003 }
1004
mt9m111_s_power(struct v4l2_subdev * sd,int on)1005 static int mt9m111_s_power(struct v4l2_subdev *sd, int on)
1006 {
1007 struct mt9m111 *mt9m111 = container_of(sd, struct mt9m111, subdev);
1008 int ret = 0;
1009
1010 mutex_lock(&mt9m111->power_lock);
1011
1012 /*
1013 * If the power count is modified from 0 to != 0 or from != 0 to 0,
1014 * update the power state.
1015 */
1016 if (mt9m111->power_count == !on) {
1017 if (on)
1018 ret = mt9m111_power_on(mt9m111);
1019 else
1020 mt9m111_power_off(mt9m111);
1021 }
1022
1023 if (!ret) {
1024 /* Update the power count. */
1025 mt9m111->power_count += on ? 1 : -1;
1026 WARN_ON(mt9m111->power_count < 0);
1027 }
1028
1029 mutex_unlock(&mt9m111->power_lock);
1030 return ret;
1031 }
1032
1033 static const struct v4l2_ctrl_ops mt9m111_ctrl_ops = {
1034 .s_ctrl = mt9m111_s_ctrl,
1035 };
1036
1037 static const struct v4l2_subdev_core_ops mt9m111_subdev_core_ops = {
1038 .s_power = mt9m111_s_power,
1039 .log_status = v4l2_ctrl_subdev_log_status,
1040 .subscribe_event = v4l2_ctrl_subdev_subscribe_event,
1041 .unsubscribe_event = v4l2_event_subdev_unsubscribe,
1042 #ifdef CONFIG_VIDEO_ADV_DEBUG
1043 .g_register = mt9m111_g_register,
1044 .s_register = mt9m111_s_register,
1045 #endif
1046 };
1047
mt9m111_get_frame_interval(struct v4l2_subdev * sd,struct v4l2_subdev_state * sd_state,struct v4l2_subdev_frame_interval * fi)1048 static int mt9m111_get_frame_interval(struct v4l2_subdev *sd,
1049 struct v4l2_subdev_state *sd_state,
1050 struct v4l2_subdev_frame_interval *fi)
1051 {
1052 struct mt9m111 *mt9m111 = container_of(sd, struct mt9m111, subdev);
1053
1054 /*
1055 * FIXME: Implement support for V4L2_SUBDEV_FORMAT_TRY, using the V4L2
1056 * subdev active state API.
1057 */
1058 if (fi->which != V4L2_SUBDEV_FORMAT_ACTIVE)
1059 return -EINVAL;
1060
1061 fi->interval = mt9m111->frame_interval;
1062
1063 return 0;
1064 }
1065
mt9m111_set_frame_interval(struct v4l2_subdev * sd,struct v4l2_subdev_state * sd_state,struct v4l2_subdev_frame_interval * fi)1066 static int mt9m111_set_frame_interval(struct v4l2_subdev *sd,
1067 struct v4l2_subdev_state *sd_state,
1068 struct v4l2_subdev_frame_interval *fi)
1069 {
1070 struct mt9m111 *mt9m111 = container_of(sd, struct mt9m111, subdev);
1071 const struct mt9m111_mode_info *mode;
1072 struct v4l2_fract *fract = &fi->interval;
1073 int fps;
1074
1075 if (mt9m111->is_streaming)
1076 return -EBUSY;
1077
1078 /*
1079 * FIXME: Implement support for V4L2_SUBDEV_FORMAT_TRY, using the V4L2
1080 * subdev active state API.
1081 */
1082 if (fi->which != V4L2_SUBDEV_FORMAT_ACTIVE)
1083 return -EINVAL;
1084
1085 if (fi->pad != 0)
1086 return -EINVAL;
1087
1088 if (fract->numerator == 0) {
1089 fract->denominator = 30;
1090 fract->numerator = 1;
1091 }
1092
1093 fps = DIV_ROUND_CLOSEST(fract->denominator, fract->numerator);
1094
1095 /* Find best fitting mode. Do not update the mode if no one was found. */
1096 mode = mt9m111_find_mode(mt9m111, fps, mt9m111->width, mt9m111->height);
1097 if (!mode)
1098 return 0;
1099
1100 if (mode->max_fps != fps) {
1101 fract->denominator = mode->max_fps;
1102 fract->numerator = 1;
1103 }
1104
1105 mt9m111->current_mode = mode;
1106 mt9m111->frame_interval = fi->interval;
1107
1108 return 0;
1109 }
1110
mt9m111_enum_mbus_code(struct v4l2_subdev * sd,struct v4l2_subdev_state * sd_state,struct v4l2_subdev_mbus_code_enum * code)1111 static int mt9m111_enum_mbus_code(struct v4l2_subdev *sd,
1112 struct v4l2_subdev_state *sd_state,
1113 struct v4l2_subdev_mbus_code_enum *code)
1114 {
1115 if (code->pad || code->index >= ARRAY_SIZE(mt9m111_colour_fmts))
1116 return -EINVAL;
1117
1118 code->code = mt9m111_colour_fmts[code->index].code;
1119 return 0;
1120 }
1121
mt9m111_s_stream(struct v4l2_subdev * sd,int enable)1122 static int mt9m111_s_stream(struct v4l2_subdev *sd, int enable)
1123 {
1124 struct mt9m111 *mt9m111 = container_of(sd, struct mt9m111, subdev);
1125
1126 mt9m111->is_streaming = !!enable;
1127 return 0;
1128 }
1129
mt9m111_init_state(struct v4l2_subdev * sd,struct v4l2_subdev_state * sd_state)1130 static int mt9m111_init_state(struct v4l2_subdev *sd,
1131 struct v4l2_subdev_state *sd_state)
1132 {
1133 struct v4l2_mbus_framefmt *format =
1134 v4l2_subdev_state_get_format(sd_state, 0);
1135
1136 format->width = MT9M111_MAX_WIDTH;
1137 format->height = MT9M111_MAX_HEIGHT;
1138 format->code = mt9m111_colour_fmts[0].code;
1139 format->colorspace = mt9m111_colour_fmts[0].colorspace;
1140 format->field = V4L2_FIELD_NONE;
1141 format->ycbcr_enc = V4L2_YCBCR_ENC_DEFAULT;
1142 format->quantization = V4L2_QUANTIZATION_DEFAULT;
1143 format->xfer_func = V4L2_XFER_FUNC_DEFAULT;
1144
1145 return 0;
1146 }
1147
mt9m111_get_mbus_config(struct v4l2_subdev * sd,unsigned int pad,struct v4l2_mbus_config * cfg)1148 static int mt9m111_get_mbus_config(struct v4l2_subdev *sd,
1149 unsigned int pad,
1150 struct v4l2_mbus_config *cfg)
1151 {
1152 struct mt9m111 *mt9m111 = container_of(sd, struct mt9m111, subdev);
1153
1154 cfg->type = V4L2_MBUS_PARALLEL;
1155
1156 cfg->bus.parallel.flags = V4L2_MBUS_MASTER |
1157 V4L2_MBUS_HSYNC_ACTIVE_HIGH |
1158 V4L2_MBUS_VSYNC_ACTIVE_HIGH |
1159 V4L2_MBUS_DATA_ACTIVE_HIGH;
1160
1161 cfg->bus.parallel.flags |= mt9m111->pclk_sample ?
1162 V4L2_MBUS_PCLK_SAMPLE_RISING :
1163 V4L2_MBUS_PCLK_SAMPLE_FALLING;
1164
1165 return 0;
1166 }
1167
1168 static const struct v4l2_subdev_video_ops mt9m111_subdev_video_ops = {
1169 .s_stream = mt9m111_s_stream,
1170 };
1171
1172 static const struct v4l2_subdev_pad_ops mt9m111_subdev_pad_ops = {
1173 .enum_mbus_code = mt9m111_enum_mbus_code,
1174 .get_selection = mt9m111_get_selection,
1175 .set_selection = mt9m111_set_selection,
1176 .get_fmt = mt9m111_get_fmt,
1177 .set_fmt = mt9m111_set_fmt,
1178 .get_frame_interval = mt9m111_get_frame_interval,
1179 .set_frame_interval = mt9m111_set_frame_interval,
1180 .get_mbus_config = mt9m111_get_mbus_config,
1181 };
1182
1183 static const struct v4l2_subdev_ops mt9m111_subdev_ops = {
1184 .core = &mt9m111_subdev_core_ops,
1185 .video = &mt9m111_subdev_video_ops,
1186 .pad = &mt9m111_subdev_pad_ops,
1187 };
1188
1189 static const struct v4l2_subdev_internal_ops mt9m111_internal_ops = {
1190 .init_state = mt9m111_init_state,
1191 };
1192
1193 /*
1194 * Interface active, can use i2c. If it fails, it can indeed mean, that
1195 * this wasn't our capture interface, so, we wait for the right one
1196 */
mt9m111_video_probe(struct i2c_client * client)1197 static int mt9m111_video_probe(struct i2c_client *client)
1198 {
1199 struct mt9m111 *mt9m111 = to_mt9m111(client);
1200 s32 data;
1201 int ret;
1202
1203 ret = mt9m111_s_power(&mt9m111->subdev, 1);
1204 if (ret < 0)
1205 return ret;
1206
1207 data = reg_read(CHIP_VERSION);
1208
1209 switch (data) {
1210 case 0x143a: /* MT9M111 or MT9M131 */
1211 dev_info(&client->dev,
1212 "Detected a MT9M111/MT9M131 chip ID %x\n", data);
1213 break;
1214 case 0x148c: /* MT9M112 */
1215 dev_info(&client->dev, "Detected a MT9M112 chip ID %x\n", data);
1216 break;
1217 default:
1218 dev_err(&client->dev,
1219 "No MT9M111/MT9M112/MT9M131 chip detected register read %x\n",
1220 data);
1221 ret = -ENODEV;
1222 goto done;
1223 }
1224
1225 ret = mt9m111_init(mt9m111);
1226 if (ret)
1227 goto done;
1228
1229 ret = v4l2_ctrl_handler_setup(&mt9m111->hdl);
1230
1231 done:
1232 mt9m111_s_power(&mt9m111->subdev, 0);
1233 return ret;
1234 }
1235
mt9m111_probe_fw(struct i2c_client * client,struct mt9m111 * mt9m111)1236 static int mt9m111_probe_fw(struct i2c_client *client, struct mt9m111 *mt9m111)
1237 {
1238 struct v4l2_fwnode_endpoint bus_cfg = {
1239 .bus_type = V4L2_MBUS_PARALLEL
1240 };
1241 struct fwnode_handle *np;
1242 int ret;
1243
1244 np = fwnode_graph_get_next_endpoint(dev_fwnode(&client->dev), NULL);
1245 if (!np)
1246 return -EINVAL;
1247
1248 ret = v4l2_fwnode_endpoint_parse(np, &bus_cfg);
1249 if (ret)
1250 goto out_put_fw;
1251
1252 mt9m111->pclk_sample = !!(bus_cfg.bus.parallel.flags &
1253 V4L2_MBUS_PCLK_SAMPLE_RISING);
1254
1255 out_put_fw:
1256 fwnode_handle_put(np);
1257 return ret;
1258 }
1259
mt9m111_probe(struct i2c_client * client)1260 static int mt9m111_probe(struct i2c_client *client)
1261 {
1262 struct mt9m111 *mt9m111;
1263 struct i2c_adapter *adapter = client->adapter;
1264 int ret;
1265
1266 if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_WORD_DATA)) {
1267 dev_warn(&adapter->dev,
1268 "I2C-Adapter doesn't support I2C_FUNC_SMBUS_WORD\n");
1269 return -EIO;
1270 }
1271
1272 mt9m111 = devm_kzalloc(&client->dev, sizeof(struct mt9m111), GFP_KERNEL);
1273 if (!mt9m111)
1274 return -ENOMEM;
1275
1276 if (dev_fwnode(&client->dev)) {
1277 ret = mt9m111_probe_fw(client, mt9m111);
1278 if (ret)
1279 return ret;
1280 }
1281
1282 mt9m111->clk = devm_clk_get(&client->dev, "mclk");
1283 if (IS_ERR(mt9m111->clk))
1284 return PTR_ERR(mt9m111->clk);
1285
1286 mt9m111->regulator = devm_regulator_get(&client->dev, "vdd");
1287 if (IS_ERR(mt9m111->regulator)) {
1288 dev_err(&client->dev, "regulator not found: %ld\n",
1289 PTR_ERR(mt9m111->regulator));
1290 return PTR_ERR(mt9m111->regulator);
1291 }
1292
1293 /* Default HIGHPOWER context */
1294 mt9m111->ctx = &context_b;
1295
1296 v4l2_i2c_subdev_init(&mt9m111->subdev, client, &mt9m111_subdev_ops);
1297 mt9m111->subdev.internal_ops = &mt9m111_internal_ops;
1298 mt9m111->subdev.flags |= V4L2_SUBDEV_FL_HAS_DEVNODE |
1299 V4L2_SUBDEV_FL_HAS_EVENTS;
1300
1301 v4l2_ctrl_handler_init(&mt9m111->hdl, 7);
1302 v4l2_ctrl_new_std(&mt9m111->hdl, &mt9m111_ctrl_ops,
1303 V4L2_CID_VFLIP, 0, 1, 1, 0);
1304 v4l2_ctrl_new_std(&mt9m111->hdl, &mt9m111_ctrl_ops,
1305 V4L2_CID_HFLIP, 0, 1, 1, 0);
1306 v4l2_ctrl_new_std(&mt9m111->hdl, &mt9m111_ctrl_ops,
1307 V4L2_CID_AUTO_WHITE_BALANCE, 0, 1, 1, 1);
1308 mt9m111->gain = v4l2_ctrl_new_std(&mt9m111->hdl, &mt9m111_ctrl_ops,
1309 V4L2_CID_GAIN, 0, 63 * 2 * 2, 1, 32);
1310 v4l2_ctrl_new_std_menu(&mt9m111->hdl,
1311 &mt9m111_ctrl_ops, V4L2_CID_EXPOSURE_AUTO, 1, 0,
1312 V4L2_EXPOSURE_AUTO);
1313 v4l2_ctrl_new_std_menu_items(&mt9m111->hdl,
1314 &mt9m111_ctrl_ops, V4L2_CID_TEST_PATTERN,
1315 ARRAY_SIZE(mt9m111_test_pattern_menu) - 1, 0, 0,
1316 mt9m111_test_pattern_menu);
1317 v4l2_ctrl_new_std_menu(&mt9m111->hdl, &mt9m111_ctrl_ops,
1318 V4L2_CID_COLORFX, V4L2_COLORFX_SOLARIZATION,
1319 ~(BIT(V4L2_COLORFX_NONE) |
1320 BIT(V4L2_COLORFX_BW) |
1321 BIT(V4L2_COLORFX_SEPIA) |
1322 BIT(V4L2_COLORFX_NEGATIVE) |
1323 BIT(V4L2_COLORFX_SOLARIZATION)),
1324 V4L2_COLORFX_NONE);
1325 mt9m111->subdev.ctrl_handler = &mt9m111->hdl;
1326 if (mt9m111->hdl.error) {
1327 ret = mt9m111->hdl.error;
1328 return ret;
1329 }
1330
1331 mt9m111->pad.flags = MEDIA_PAD_FL_SOURCE;
1332 mt9m111->subdev.entity.function = MEDIA_ENT_F_CAM_SENSOR;
1333 ret = media_entity_pads_init(&mt9m111->subdev.entity, 1, &mt9m111->pad);
1334 if (ret < 0)
1335 goto out_hdlfree;
1336
1337 mt9m111->current_mode = &mt9m111_mode_data[MT9M111_MODE_SXGA_15FPS];
1338 mt9m111->frame_interval.numerator = 1;
1339 mt9m111->frame_interval.denominator = mt9m111->current_mode->max_fps;
1340
1341 /* Second stage probe - when a capture adapter is there */
1342 mt9m111->rect.left = MT9M111_MIN_DARK_COLS;
1343 mt9m111->rect.top = MT9M111_MIN_DARK_ROWS;
1344 mt9m111->rect.width = MT9M111_MAX_WIDTH;
1345 mt9m111->rect.height = MT9M111_MAX_HEIGHT;
1346 mt9m111->width = mt9m111->rect.width;
1347 mt9m111->height = mt9m111->rect.height;
1348 mt9m111->fmt = &mt9m111_colour_fmts[0];
1349 mt9m111->lastpage = -1;
1350 mutex_init(&mt9m111->power_lock);
1351
1352 ret = mt9m111_video_probe(client);
1353 if (ret < 0)
1354 goto out_entityclean;
1355
1356 mt9m111->subdev.dev = &client->dev;
1357 ret = v4l2_async_register_subdev(&mt9m111->subdev);
1358 if (ret < 0)
1359 goto out_entityclean;
1360
1361 return 0;
1362
1363 out_entityclean:
1364 media_entity_cleanup(&mt9m111->subdev.entity);
1365 out_hdlfree:
1366 v4l2_ctrl_handler_free(&mt9m111->hdl);
1367
1368 return ret;
1369 }
1370
mt9m111_remove(struct i2c_client * client)1371 static void mt9m111_remove(struct i2c_client *client)
1372 {
1373 struct mt9m111 *mt9m111 = to_mt9m111(client);
1374
1375 v4l2_async_unregister_subdev(&mt9m111->subdev);
1376 media_entity_cleanup(&mt9m111->subdev.entity);
1377 v4l2_ctrl_handler_free(&mt9m111->hdl);
1378 }
1379 static const struct of_device_id mt9m111_of_match[] = {
1380 { .compatible = "micron,mt9m111", },
1381 {},
1382 };
1383 MODULE_DEVICE_TABLE(of, mt9m111_of_match);
1384
1385 static const struct i2c_device_id mt9m111_id[] = {
1386 { "mt9m111" },
1387 { }
1388 };
1389 MODULE_DEVICE_TABLE(i2c, mt9m111_id);
1390
1391 static struct i2c_driver mt9m111_i2c_driver = {
1392 .driver = {
1393 .name = "mt9m111",
1394 .of_match_table = mt9m111_of_match,
1395 },
1396 .probe = mt9m111_probe,
1397 .remove = mt9m111_remove,
1398 .id_table = mt9m111_id,
1399 };
1400
1401 module_i2c_driver(mt9m111_i2c_driver);
1402
1403 MODULE_DESCRIPTION("Micron/Aptina MT9M111/MT9M112/MT9M131 Camera driver");
1404 MODULE_AUTHOR("Robert Jarzmik");
1405 MODULE_LICENSE("GPL");
1406