1 /*
2 * Controls for M-5MOLS 8M Pixel camera sensor with ISP
3 *
4 * Copyright (C) 2011 Samsung Electronics Co., Ltd.
5 * Author: HeungJun Kim <riverful.kim@samsung.com>
6 *
7 * Copyright (C) 2009 Samsung Electronics Co., Ltd.
8 * Author: Dongsoo Nathaniel Kim <dongsoo45.kim@samsung.com>
9 *
10 * This program is free software; you can redistribute it and/or modify
11 * it under the terms of the GNU General Public License as published by
12 * the Free Software Foundation; either version 2 of the License, or
13 * (at your option) any later version.
14 */
15
16 #include <linux/i2c.h>
17 #include <linux/delay.h>
18 #include <linux/videodev2.h>
19 #include <media/v4l2-ctrls.h>
20
21 #include "m5mols.h"
22 #include "m5mols_reg.h"
23
24 static struct m5mols_scenemode m5mols_default_scenemode[] = {
25 [REG_SCENE_NORMAL] = {
26 REG_AE_CENTER, REG_AE_INDEX_00, REG_AWB_AUTO, 0,
27 REG_CHROMA_ON, 3, REG_EDGE_ON, 5,
28 REG_AF_NORMAL, REG_FD_OFF,
29 REG_MCC_NORMAL, REG_LIGHT_OFF, REG_FLASH_OFF,
30 5, REG_ISO_AUTO, REG_CAP_NONE, REG_WDR_OFF,
31 },
32 [REG_SCENE_PORTRAIT] = {
33 REG_AE_CENTER, REG_AE_INDEX_00, REG_AWB_AUTO, 0,
34 REG_CHROMA_ON, 3, REG_EDGE_ON, 4,
35 REG_AF_NORMAL, BIT_FD_EN | BIT_FD_DRAW_FACE_FRAME,
36 REG_MCC_OFF, REG_LIGHT_OFF, REG_FLASH_OFF,
37 6, REG_ISO_AUTO, REG_CAP_NONE, REG_WDR_OFF,
38 },
39 [REG_SCENE_LANDSCAPE] = {
40 REG_AE_ALL, REG_AE_INDEX_00, REG_AWB_AUTO, 0,
41 REG_CHROMA_ON, 4, REG_EDGE_ON, 6,
42 REG_AF_NORMAL, REG_FD_OFF,
43 REG_MCC_OFF, REG_LIGHT_OFF, REG_FLASH_OFF,
44 6, REG_ISO_AUTO, REG_CAP_NONE, REG_WDR_OFF,
45 },
46 [REG_SCENE_SPORTS] = {
47 REG_AE_CENTER, REG_AE_INDEX_00, REG_AWB_AUTO, 0,
48 REG_CHROMA_ON, 3, REG_EDGE_ON, 5,
49 REG_AF_NORMAL, REG_FD_OFF,
50 REG_MCC_OFF, REG_LIGHT_OFF, REG_FLASH_OFF,
51 6, REG_ISO_AUTO, REG_CAP_NONE, REG_WDR_OFF,
52 },
53 [REG_SCENE_PARTY_INDOOR] = {
54 REG_AE_CENTER, REG_AE_INDEX_00, REG_AWB_AUTO, 0,
55 REG_CHROMA_ON, 4, REG_EDGE_ON, 5,
56 REG_AF_NORMAL, REG_FD_OFF,
57 REG_MCC_OFF, REG_LIGHT_OFF, REG_FLASH_OFF,
58 6, REG_ISO_200, REG_CAP_NONE, REG_WDR_OFF,
59 },
60 [REG_SCENE_BEACH_SNOW] = {
61 REG_AE_CENTER, REG_AE_INDEX_10_POS, REG_AWB_AUTO, 0,
62 REG_CHROMA_ON, 4, REG_EDGE_ON, 5,
63 REG_AF_NORMAL, REG_FD_OFF,
64 REG_MCC_OFF, REG_LIGHT_OFF, REG_FLASH_OFF,
65 6, REG_ISO_50, REG_CAP_NONE, REG_WDR_OFF,
66 },
67 [REG_SCENE_SUNSET] = {
68 REG_AE_CENTER, REG_AE_INDEX_00, REG_AWB_PRESET,
69 REG_AWB_DAYLIGHT,
70 REG_CHROMA_ON, 3, REG_EDGE_ON, 5,
71 REG_AF_NORMAL, REG_FD_OFF,
72 REG_MCC_OFF, REG_LIGHT_OFF, REG_FLASH_OFF,
73 6, REG_ISO_AUTO, REG_CAP_NONE, REG_WDR_OFF,
74 },
75 [REG_SCENE_DAWN_DUSK] = {
76 REG_AE_CENTER, REG_AE_INDEX_00, REG_AWB_PRESET,
77 REG_AWB_FLUORESCENT_1,
78 REG_CHROMA_ON, 3, REG_EDGE_ON, 5,
79 REG_AF_NORMAL, REG_FD_OFF,
80 REG_MCC_OFF, REG_LIGHT_OFF, REG_FLASH_OFF,
81 6, REG_ISO_AUTO, REG_CAP_NONE, REG_WDR_OFF,
82 },
83 [REG_SCENE_FALL] = {
84 REG_AE_CENTER, REG_AE_INDEX_00, REG_AWB_AUTO, 0,
85 REG_CHROMA_ON, 5, REG_EDGE_ON, 5,
86 REG_AF_NORMAL, REG_FD_OFF,
87 REG_MCC_OFF, REG_LIGHT_OFF, REG_FLASH_OFF,
88 6, REG_ISO_AUTO, REG_CAP_NONE, REG_WDR_OFF,
89 },
90 [REG_SCENE_NIGHT] = {
91 REG_AE_CENTER, REG_AE_INDEX_00, REG_AWB_AUTO, 0,
92 REG_CHROMA_ON, 3, REG_EDGE_ON, 5,
93 REG_AF_NORMAL, REG_FD_OFF,
94 REG_MCC_OFF, REG_LIGHT_OFF, REG_FLASH_OFF,
95 6, REG_ISO_AUTO, REG_CAP_NONE, REG_WDR_OFF,
96 },
97 [REG_SCENE_AGAINST_LIGHT] = {
98 REG_AE_CENTER, REG_AE_INDEX_00, REG_AWB_AUTO, 0,
99 REG_CHROMA_ON, 3, REG_EDGE_ON, 5,
100 REG_AF_NORMAL, REG_FD_OFF,
101 REG_MCC_OFF, REG_LIGHT_OFF, REG_FLASH_OFF,
102 6, REG_ISO_AUTO, REG_CAP_NONE, REG_WDR_OFF,
103 },
104 [REG_SCENE_FIRE] = {
105 REG_AE_CENTER, REG_AE_INDEX_00, REG_AWB_AUTO, 0,
106 REG_CHROMA_ON, 3, REG_EDGE_ON, 5,
107 REG_AF_NORMAL, REG_FD_OFF,
108 REG_MCC_OFF, REG_LIGHT_OFF, REG_FLASH_OFF,
109 6, REG_ISO_50, REG_CAP_NONE, REG_WDR_OFF,
110 },
111 [REG_SCENE_TEXT] = {
112 REG_AE_CENTER, REG_AE_INDEX_00, REG_AWB_AUTO, 0,
113 REG_CHROMA_ON, 3, REG_EDGE_ON, 7,
114 REG_AF_MACRO, REG_FD_OFF,
115 REG_MCC_OFF, REG_LIGHT_OFF, REG_FLASH_OFF,
116 6, REG_ISO_AUTO, REG_CAP_ANTI_SHAKE, REG_WDR_ON,
117 },
118 [REG_SCENE_CANDLE] = {
119 REG_AE_CENTER, REG_AE_INDEX_00, REG_AWB_AUTO, 0,
120 REG_CHROMA_ON, 3, REG_EDGE_ON, 5,
121 REG_AF_NORMAL, REG_FD_OFF,
122 REG_MCC_OFF, REG_LIGHT_OFF, REG_FLASH_OFF,
123 6, REG_ISO_AUTO, REG_CAP_NONE, REG_WDR_OFF,
124 },
125 };
126
127 /**
128 * m5mols_do_scenemode() - Change current scenemode
129 * @mode: Desired mode of the scenemode
130 *
131 * WARNING: The execution order is important. Do not change the order.
132 */
m5mols_do_scenemode(struct m5mols_info * info,u8 mode)133 int m5mols_do_scenemode(struct m5mols_info *info, u8 mode)
134 {
135 struct v4l2_subdev *sd = &info->sd;
136 struct m5mols_scenemode scenemode = m5mols_default_scenemode[mode];
137 int ret;
138
139 if (mode > REG_SCENE_CANDLE)
140 return -EINVAL;
141
142 ret = v4l2_ctrl_s_ctrl(info->lock_3a, 0);
143 if (!ret)
144 ret = m5mols_write(sd, AE_EV_PRESET_MONITOR, mode);
145 if (!ret)
146 ret = m5mols_write(sd, AE_EV_PRESET_CAPTURE, mode);
147 if (!ret)
148 ret = m5mols_write(sd, AE_MODE, scenemode.metering);
149 if (!ret)
150 ret = m5mols_write(sd, AE_INDEX, scenemode.ev_bias);
151 if (!ret)
152 ret = m5mols_write(sd, AWB_MODE, scenemode.wb_mode);
153 if (!ret)
154 ret = m5mols_write(sd, AWB_MANUAL, scenemode.wb_preset);
155 if (!ret)
156 ret = m5mols_write(sd, MON_CHROMA_EN, scenemode.chroma_en);
157 if (!ret)
158 ret = m5mols_write(sd, MON_CHROMA_LVL, scenemode.chroma_lvl);
159 if (!ret)
160 ret = m5mols_write(sd, MON_EDGE_EN, scenemode.edge_en);
161 if (!ret)
162 ret = m5mols_write(sd, MON_EDGE_LVL, scenemode.edge_lvl);
163 if (!ret && is_available_af(info))
164 ret = m5mols_write(sd, AF_MODE, scenemode.af_range);
165 if (!ret && is_available_af(info))
166 ret = m5mols_write(sd, FD_CTL, scenemode.fd_mode);
167 if (!ret)
168 ret = m5mols_write(sd, MON_TONE_CTL, scenemode.tone);
169 if (!ret)
170 ret = m5mols_write(sd, AE_ISO, scenemode.iso);
171 if (!ret)
172 ret = m5mols_set_mode(info, REG_CAPTURE);
173 if (!ret)
174 ret = m5mols_write(sd, CAPP_WDR_EN, scenemode.wdr);
175 if (!ret)
176 ret = m5mols_write(sd, CAPP_MCC_MODE, scenemode.mcc);
177 if (!ret)
178 ret = m5mols_write(sd, CAPP_LIGHT_CTRL, scenemode.light);
179 if (!ret)
180 ret = m5mols_write(sd, CAPP_FLASH_CTRL, scenemode.flash);
181 if (!ret)
182 ret = m5mols_write(sd, CAPC_MODE, scenemode.capt_mode);
183 if (!ret)
184 ret = m5mols_set_mode(info, REG_MONITOR);
185
186 return ret;
187 }
188
m5mols_3a_lock(struct m5mols_info * info,struct v4l2_ctrl * ctrl)189 static int m5mols_3a_lock(struct m5mols_info *info, struct v4l2_ctrl *ctrl)
190 {
191 bool af_lock = ctrl->val & V4L2_LOCK_FOCUS;
192 int ret = 0;
193
194 if ((ctrl->val ^ ctrl->cur.val) & V4L2_LOCK_EXPOSURE) {
195 bool ae_lock = ctrl->val & V4L2_LOCK_EXPOSURE;
196
197 ret = m5mols_write(&info->sd, AE_LOCK, ae_lock ?
198 REG_AE_LOCK : REG_AE_UNLOCK);
199 if (ret)
200 return ret;
201 }
202
203 if (((ctrl->val ^ ctrl->cur.val) & V4L2_LOCK_WHITE_BALANCE)
204 && info->auto_wb->val) {
205 bool awb_lock = ctrl->val & V4L2_LOCK_WHITE_BALANCE;
206
207 ret = m5mols_write(&info->sd, AWB_LOCK, awb_lock ?
208 REG_AWB_LOCK : REG_AWB_UNLOCK);
209 if (ret)
210 return ret;
211 }
212
213 if (!info->ver.af || !af_lock)
214 return ret;
215
216 if ((ctrl->val ^ ctrl->cur.val) & V4L2_LOCK_FOCUS)
217 ret = m5mols_write(&info->sd, AF_EXECUTE, REG_AF_STOP);
218
219 return ret;
220 }
221
m5mols_set_metering_mode(struct m5mols_info * info,int mode)222 static int m5mols_set_metering_mode(struct m5mols_info *info, int mode)
223 {
224 unsigned int metering;
225
226 switch (mode) {
227 case V4L2_EXPOSURE_METERING_CENTER_WEIGHTED:
228 metering = REG_AE_CENTER;
229 break;
230 case V4L2_EXPOSURE_METERING_SPOT:
231 metering = REG_AE_SPOT;
232 break;
233 default:
234 metering = REG_AE_ALL;
235 break;
236 }
237
238 return m5mols_write(&info->sd, AE_MODE, metering);
239 }
240
m5mols_set_exposure(struct m5mols_info * info,int exposure)241 static int m5mols_set_exposure(struct m5mols_info *info, int exposure)
242 {
243 struct v4l2_subdev *sd = &info->sd;
244 int ret = 0;
245
246 if (exposure == V4L2_EXPOSURE_AUTO) {
247 /* Unlock auto exposure */
248 info->lock_3a->val &= ~V4L2_LOCK_EXPOSURE;
249 m5mols_3a_lock(info, info->lock_3a);
250
251 ret = m5mols_set_metering_mode(info, info->metering->val);
252 if (ret < 0)
253 return ret;
254
255 v4l2_dbg(1, m5mols_debug, sd,
256 "%s: exposure bias: %#x, metering: %#x\n",
257 __func__, info->exposure_bias->val,
258 info->metering->val);
259
260 return m5mols_write(sd, AE_INDEX, info->exposure_bias->val);
261 }
262
263 if (exposure == V4L2_EXPOSURE_MANUAL) {
264 ret = m5mols_write(sd, AE_MODE, REG_AE_OFF);
265 if (ret == 0)
266 ret = m5mols_write(sd, AE_MAN_GAIN_MON,
267 info->exposure->val);
268 if (ret == 0)
269 ret = m5mols_write(sd, AE_MAN_GAIN_CAP,
270 info->exposure->val);
271
272 v4l2_dbg(1, m5mols_debug, sd, "%s: exposure: %#x\n",
273 __func__, info->exposure->val);
274 }
275
276 return ret;
277 }
278
m5mols_set_white_balance(struct m5mols_info * info,int val)279 static int m5mols_set_white_balance(struct m5mols_info *info, int val)
280 {
281 static const unsigned short wb[][2] = {
282 { V4L2_WHITE_BALANCE_INCANDESCENT, REG_AWB_INCANDESCENT },
283 { V4L2_WHITE_BALANCE_FLUORESCENT, REG_AWB_FLUORESCENT_1 },
284 { V4L2_WHITE_BALANCE_FLUORESCENT_H, REG_AWB_FLUORESCENT_2 },
285 { V4L2_WHITE_BALANCE_HORIZON, REG_AWB_HORIZON },
286 { V4L2_WHITE_BALANCE_DAYLIGHT, REG_AWB_DAYLIGHT },
287 { V4L2_WHITE_BALANCE_FLASH, REG_AWB_LEDLIGHT },
288 { V4L2_WHITE_BALANCE_CLOUDY, REG_AWB_CLOUDY },
289 { V4L2_WHITE_BALANCE_SHADE, REG_AWB_SHADE },
290 { V4L2_WHITE_BALANCE_AUTO, REG_AWB_AUTO },
291 };
292 int i;
293 struct v4l2_subdev *sd = &info->sd;
294 int ret = -EINVAL;
295
296 for (i = 0; i < ARRAY_SIZE(wb); i++) {
297 int awb;
298 if (wb[i][0] != val)
299 continue;
300
301 v4l2_dbg(1, m5mols_debug, sd,
302 "Setting white balance to: %#x\n", wb[i][0]);
303
304 awb = wb[i][0] == V4L2_WHITE_BALANCE_AUTO;
305 ret = m5mols_write(sd, AWB_MODE, awb ? REG_AWB_AUTO :
306 REG_AWB_PRESET);
307 if (ret < 0)
308 return ret;
309
310 if (!awb)
311 ret = m5mols_write(sd, AWB_MANUAL, wb[i][1]);
312 }
313
314 return ret;
315 }
316
m5mols_set_saturation(struct m5mols_info * info,int val)317 static int m5mols_set_saturation(struct m5mols_info *info, int val)
318 {
319 int ret = m5mols_write(&info->sd, MON_CHROMA_LVL, val);
320 if (ret < 0)
321 return ret;
322
323 return m5mols_write(&info->sd, MON_CHROMA_EN, REG_CHROMA_ON);
324 }
325
m5mols_set_color_effect(struct m5mols_info * info,int val)326 static int m5mols_set_color_effect(struct m5mols_info *info, int val)
327 {
328 unsigned int m_effect = REG_COLOR_EFFECT_OFF;
329 unsigned int p_effect = REG_EFFECT_OFF;
330 unsigned int cfix_r = 0, cfix_b = 0;
331 struct v4l2_subdev *sd = &info->sd;
332 int ret = 0;
333
334 switch (val) {
335 case V4L2_COLORFX_BW:
336 m_effect = REG_COLOR_EFFECT_ON;
337 break;
338 case V4L2_COLORFX_NEGATIVE:
339 p_effect = REG_EFFECT_NEGA;
340 break;
341 case V4L2_COLORFX_EMBOSS:
342 p_effect = REG_EFFECT_EMBOSS;
343 break;
344 case V4L2_COLORFX_SEPIA:
345 m_effect = REG_COLOR_EFFECT_ON;
346 cfix_r = REG_CFIXR_SEPIA;
347 cfix_b = REG_CFIXB_SEPIA;
348 break;
349 }
350
351 ret = m5mols_write(sd, PARM_EFFECT, p_effect);
352 if (!ret)
353 ret = m5mols_write(sd, MON_EFFECT, m_effect);
354
355 if (ret == 0 && m_effect == REG_COLOR_EFFECT_ON) {
356 ret = m5mols_write(sd, MON_CFIXR, cfix_r);
357 if (!ret)
358 ret = m5mols_write(sd, MON_CFIXB, cfix_b);
359 }
360
361 v4l2_dbg(1, m5mols_debug, sd,
362 "p_effect: %#x, m_effect: %#x, r: %#x, b: %#x (%d)\n",
363 p_effect, m_effect, cfix_r, cfix_b, ret);
364
365 return ret;
366 }
367
m5mols_set_iso(struct m5mols_info * info,int auto_iso)368 static int m5mols_set_iso(struct m5mols_info *info, int auto_iso)
369 {
370 u32 iso = auto_iso ? 0 : info->iso->val + 1;
371
372 return m5mols_write(&info->sd, AE_ISO, iso);
373 }
374
m5mols_set_wdr(struct m5mols_info * info,int wdr)375 static int m5mols_set_wdr(struct m5mols_info *info, int wdr)
376 {
377 int ret;
378
379 ret = m5mols_write(&info->sd, MON_TONE_CTL, wdr ? 9 : 5);
380 if (ret < 0)
381 return ret;
382
383 ret = m5mols_set_mode(info, REG_CAPTURE);
384 if (ret < 0)
385 return ret;
386
387 return m5mols_write(&info->sd, CAPP_WDR_EN, wdr);
388 }
389
m5mols_set_stabilization(struct m5mols_info * info,int val)390 static int m5mols_set_stabilization(struct m5mols_info *info, int val)
391 {
392 struct v4l2_subdev *sd = &info->sd;
393 unsigned int evp = val ? 0xe : 0x0;
394 int ret;
395
396 ret = m5mols_write(sd, AE_EV_PRESET_MONITOR, evp);
397 if (ret < 0)
398 return ret;
399
400 return m5mols_write(sd, AE_EV_PRESET_CAPTURE, evp);
401 }
402
m5mols_g_volatile_ctrl(struct v4l2_ctrl * ctrl)403 static int m5mols_g_volatile_ctrl(struct v4l2_ctrl *ctrl)
404 {
405 struct v4l2_subdev *sd = to_sd(ctrl);
406 struct m5mols_info *info = to_m5mols(sd);
407 int ret = 0;
408 u8 status;
409
410 v4l2_dbg(1, m5mols_debug, sd, "%s: ctrl: %s (%d)\n",
411 __func__, ctrl->name, info->isp_ready);
412
413 if (!info->isp_ready)
414 return -EBUSY;
415
416 switch (ctrl->id) {
417 case V4L2_CID_ISO_SENSITIVITY_AUTO:
418 ret = m5mols_read_u8(sd, AE_ISO, &status);
419 if (ret == 0)
420 ctrl->val = !status;
421 if (status != REG_ISO_AUTO)
422 info->iso->val = status - 1;
423 break;
424
425 case V4L2_CID_3A_LOCK:
426 ctrl->val &= ~0x7;
427
428 ret = m5mols_read_u8(sd, AE_LOCK, &status);
429 if (ret)
430 return ret;
431 if (status)
432 info->lock_3a->val |= V4L2_LOCK_EXPOSURE;
433
434 ret = m5mols_read_u8(sd, AWB_LOCK, &status);
435 if (ret)
436 return ret;
437 if (status)
438 info->lock_3a->val |= V4L2_LOCK_EXPOSURE;
439
440 ret = m5mols_read_u8(sd, AF_EXECUTE, &status);
441 if (!status)
442 info->lock_3a->val |= V4L2_LOCK_EXPOSURE;
443 break;
444 }
445
446 return ret;
447 }
448
m5mols_s_ctrl(struct v4l2_ctrl * ctrl)449 static int m5mols_s_ctrl(struct v4l2_ctrl *ctrl)
450 {
451 unsigned int ctrl_mode = m5mols_get_ctrl_mode(ctrl);
452 struct v4l2_subdev *sd = to_sd(ctrl);
453 struct m5mols_info *info = to_m5mols(sd);
454 int last_mode = info->mode;
455 int ret = 0;
456
457 /*
458 * If needed, defer restoring the controls until
459 * the device is fully initialized.
460 */
461 if (!info->isp_ready) {
462 info->ctrl_sync = 0;
463 return 0;
464 }
465
466 v4l2_dbg(1, m5mols_debug, sd, "%s: %s, val: %d, priv: %p\n",
467 __func__, ctrl->name, ctrl->val, ctrl->priv);
468
469 if (ctrl_mode && ctrl_mode != info->mode) {
470 ret = m5mols_set_mode(info, ctrl_mode);
471 if (ret < 0)
472 return ret;
473 }
474
475 switch (ctrl->id) {
476 case V4L2_CID_3A_LOCK:
477 ret = m5mols_3a_lock(info, ctrl);
478 break;
479
480 case V4L2_CID_ZOOM_ABSOLUTE:
481 ret = m5mols_write(sd, MON_ZOOM, ctrl->val);
482 break;
483
484 case V4L2_CID_EXPOSURE_AUTO:
485 ret = m5mols_set_exposure(info, ctrl->val);
486 break;
487
488 case V4L2_CID_ISO_SENSITIVITY:
489 ret = m5mols_set_iso(info, ctrl->val);
490 break;
491
492 case V4L2_CID_AUTO_N_PRESET_WHITE_BALANCE:
493 ret = m5mols_set_white_balance(info, ctrl->val);
494 break;
495
496 case V4L2_CID_SATURATION:
497 ret = m5mols_set_saturation(info, ctrl->val);
498 break;
499
500 case V4L2_CID_COLORFX:
501 ret = m5mols_set_color_effect(info, ctrl->val);
502 break;
503
504 case V4L2_CID_WIDE_DYNAMIC_RANGE:
505 ret = m5mols_set_wdr(info, ctrl->val);
506 break;
507
508 case V4L2_CID_IMAGE_STABILIZATION:
509 ret = m5mols_set_stabilization(info, ctrl->val);
510 break;
511
512 case V4L2_CID_JPEG_COMPRESSION_QUALITY:
513 ret = m5mols_write(sd, CAPP_JPEG_RATIO, ctrl->val);
514 break;
515 }
516
517 if (ret == 0 && info->mode != last_mode)
518 ret = m5mols_set_mode(info, last_mode);
519
520 return ret;
521 }
522
523 static const struct v4l2_ctrl_ops m5mols_ctrl_ops = {
524 .g_volatile_ctrl = m5mols_g_volatile_ctrl,
525 .s_ctrl = m5mols_s_ctrl,
526 };
527
528 /* Supported manual ISO values */
529 static const s64 iso_qmenu[] = {
530 /* AE_ISO: 0x01...0x07 (ISO: 50...3200) */
531 50000, 100000, 200000, 400000, 800000, 1600000, 3200000
532 };
533
534 /* Supported Exposure Bias values, -2.0EV...+2.0EV */
535 static const s64 ev_bias_qmenu[] = {
536 /* AE_INDEX: 0x00...0x08 */
537 -2000, -1500, -1000, -500, 0, 500, 1000, 1500, 2000
538 };
539
m5mols_init_controls(struct v4l2_subdev * sd)540 int m5mols_init_controls(struct v4l2_subdev *sd)
541 {
542 struct m5mols_info *info = to_m5mols(sd);
543 u16 exposure_max;
544 u16 zoom_step;
545 int ret;
546
547 /* Determine the firmware dependent control range and step values */
548 ret = m5mols_read_u16(sd, AE_MAX_GAIN_MON, &exposure_max);
549 if (ret < 0)
550 return ret;
551
552 zoom_step = is_manufacturer(info, REG_SAMSUNG_OPTICS) ? 31 : 1;
553 v4l2_ctrl_handler_init(&info->handle, 20);
554
555 info->auto_wb = v4l2_ctrl_new_std_menu(&info->handle,
556 &m5mols_ctrl_ops, V4L2_CID_AUTO_N_PRESET_WHITE_BALANCE,
557 9, ~0x3fe, V4L2_WHITE_BALANCE_AUTO);
558
559 /* Exposure control cluster */
560 info->auto_exposure = v4l2_ctrl_new_std_menu(&info->handle,
561 &m5mols_ctrl_ops, V4L2_CID_EXPOSURE_AUTO,
562 1, ~0x03, V4L2_EXPOSURE_AUTO);
563
564 info->exposure = v4l2_ctrl_new_std(&info->handle,
565 &m5mols_ctrl_ops, V4L2_CID_EXPOSURE,
566 0, exposure_max, 1, exposure_max / 2);
567
568 info->exposure_bias = v4l2_ctrl_new_int_menu(&info->handle,
569 &m5mols_ctrl_ops, V4L2_CID_AUTO_EXPOSURE_BIAS,
570 ARRAY_SIZE(ev_bias_qmenu) - 1,
571 ARRAY_SIZE(ev_bias_qmenu)/2 - 1,
572 ev_bias_qmenu);
573
574 info->metering = v4l2_ctrl_new_std_menu(&info->handle,
575 &m5mols_ctrl_ops, V4L2_CID_EXPOSURE_METERING,
576 2, ~0x7, V4L2_EXPOSURE_METERING_AVERAGE);
577
578 /* ISO control cluster */
579 info->auto_iso = v4l2_ctrl_new_std_menu(&info->handle, &m5mols_ctrl_ops,
580 V4L2_CID_ISO_SENSITIVITY_AUTO, 1, ~0x03, 1);
581
582 info->iso = v4l2_ctrl_new_int_menu(&info->handle, &m5mols_ctrl_ops,
583 V4L2_CID_ISO_SENSITIVITY, ARRAY_SIZE(iso_qmenu) - 1,
584 ARRAY_SIZE(iso_qmenu)/2 - 1, iso_qmenu);
585
586 info->saturation = v4l2_ctrl_new_std(&info->handle, &m5mols_ctrl_ops,
587 V4L2_CID_SATURATION, 1, 5, 1, 3);
588
589 info->zoom = v4l2_ctrl_new_std(&info->handle, &m5mols_ctrl_ops,
590 V4L2_CID_ZOOM_ABSOLUTE, 1, 70, zoom_step, 1);
591
592 info->colorfx = v4l2_ctrl_new_std_menu(&info->handle, &m5mols_ctrl_ops,
593 V4L2_CID_COLORFX, 4, 0, V4L2_COLORFX_NONE);
594
595 info->wdr = v4l2_ctrl_new_std(&info->handle, &m5mols_ctrl_ops,
596 V4L2_CID_WIDE_DYNAMIC_RANGE, 0, 1, 1, 0);
597
598 info->stabilization = v4l2_ctrl_new_std(&info->handle, &m5mols_ctrl_ops,
599 V4L2_CID_IMAGE_STABILIZATION, 0, 1, 1, 0);
600
601 info->jpeg_quality = v4l2_ctrl_new_std(&info->handle, &m5mols_ctrl_ops,
602 V4L2_CID_JPEG_COMPRESSION_QUALITY, 1, 100, 1, 80);
603
604 info->lock_3a = v4l2_ctrl_new_std(&info->handle, &m5mols_ctrl_ops,
605 V4L2_CID_3A_LOCK, 0, 0x7, 0, 0);
606
607 if (info->handle.error) {
608 int ret = info->handle.error;
609 v4l2_err(sd, "Failed to initialize controls: %d\n", ret);
610 v4l2_ctrl_handler_free(&info->handle);
611 return ret;
612 }
613
614 v4l2_ctrl_auto_cluster(4, &info->auto_exposure, 1, false);
615 info->auto_iso->flags |= V4L2_CTRL_FLAG_VOLATILE |
616 V4L2_CTRL_FLAG_UPDATE;
617 v4l2_ctrl_auto_cluster(2, &info->auto_iso, 0, false);
618
619 info->lock_3a->flags |= V4L2_CTRL_FLAG_VOLATILE;
620
621 m5mols_set_ctrl_mode(info->auto_exposure, REG_PARAMETER);
622 m5mols_set_ctrl_mode(info->auto_wb, REG_PARAMETER);
623 m5mols_set_ctrl_mode(info->colorfx, REG_MONITOR);
624
625 sd->ctrl_handler = &info->handle;
626
627 return 0;
628 }
629