HeungJun, Kim | bc12510 | 2011-05-20 02:27:28 -0300 | [diff] [blame] | 1 | /* |
| 2 | * Controls for M-5MOLS 8M Pixel camera sensor with ISP |
| 3 | * |
| 4 | * Copyright (C) 2011 Samsung Electronics Co., Ltd. |
HeungJun, Kim | c307011 | 2011-06-07 02:00:58 -0300 | [diff] [blame] | 5 | * Author: HeungJun Kim <riverful.kim@samsung.com> |
HeungJun, Kim | bc12510 | 2011-05-20 02:27:28 -0300 | [diff] [blame] | 6 | * |
| 7 | * Copyright (C) 2009 Samsung Electronics Co., Ltd. |
HeungJun, Kim | c307011 | 2011-06-07 02:00:58 -0300 | [diff] [blame] | 8 | * Author: Dongsoo Nathaniel Kim <dongsoo45.kim@samsung.com> |
HeungJun, Kim | bc12510 | 2011-05-20 02:27:28 -0300 | [diff] [blame] | 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 | */ |
HeungJun, Kim | 57644f5 | 2011-05-31 03:44:19 -0300 | [diff] [blame] | 133 | int m5mols_do_scenemode(struct m5mols_info *info, u8 mode) |
HeungJun, Kim | bc12510 | 2011-05-20 02:27:28 -0300 | [diff] [blame] | 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 | |
Sylwester Nawrocki | 9346459 | 2012-05-09 11:53:09 -0300 | [diff] [blame] | 142 | ret = v4l2_ctrl_s_ctrl(info->lock_3a, 0); |
HeungJun, Kim | bc12510 | 2011-05-20 02:27:28 -0300 | [diff] [blame] | 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) |
Sylwester Nawrocki | 3c5da0b | 2012-04-09 13:51:56 -0300 | [diff] [blame] | 172 | ret = m5mols_set_mode(info, REG_CAPTURE); |
HeungJun, Kim | bc12510 | 2011-05-20 02:27:28 -0300 | [diff] [blame] | 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) |
Sylwester Nawrocki | 3c5da0b | 2012-04-09 13:51:56 -0300 | [diff] [blame] | 184 | ret = m5mols_set_mode(info, REG_MONITOR); |
HeungJun, Kim | bc12510 | 2011-05-20 02:27:28 -0300 | [diff] [blame] | 185 | |
| 186 | return ret; |
| 187 | } |
| 188 | |
Sylwester Nawrocki | 9346459 | 2012-05-09 11:53:09 -0300 | [diff] [blame] | 189 | static int m5mols_3a_lock(struct m5mols_info *info, struct v4l2_ctrl *ctrl) |
HeungJun, Kim | bc12510 | 2011-05-20 02:27:28 -0300 | [diff] [blame] | 190 | { |
Sylwester Nawrocki | 9346459 | 2012-05-09 11:53:09 -0300 | [diff] [blame] | 191 | bool af_lock = ctrl->val & V4L2_LOCK_FOCUS; |
HeungJun, Kim | bc12510 | 2011-05-20 02:27:28 -0300 | [diff] [blame] | 192 | int ret = 0; |
| 193 | |
Sylwester Nawrocki | 9346459 | 2012-05-09 11:53:09 -0300 | [diff] [blame] | 194 | if ((ctrl->val ^ ctrl->cur.val) & V4L2_LOCK_EXPOSURE) { |
| 195 | bool ae_lock = ctrl->val & V4L2_LOCK_EXPOSURE; |
HeungJun, Kim | bc12510 | 2011-05-20 02:27:28 -0300 | [diff] [blame] | 196 | |
Sylwester Nawrocki | 9346459 | 2012-05-09 11:53:09 -0300 | [diff] [blame] | 197 | ret = m5mols_write(&info->sd, AE_LOCK, ae_lock ? |
| 198 | REG_AE_LOCK : REG_AE_UNLOCK); |
| 199 | if (ret) |
| 200 | return ret; |
| 201 | } |
HeungJun, Kim | bc12510 | 2011-05-20 02:27:28 -0300 | [diff] [blame] | 202 | |
Sylwester Nawrocki | 9346459 | 2012-05-09 11:53:09 -0300 | [diff] [blame] | 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; |
HeungJun, Kim | bc12510 | 2011-05-20 02:27:28 -0300 | [diff] [blame] | 206 | |
Sylwester Nawrocki | 9346459 | 2012-05-09 11:53:09 -0300 | [diff] [blame] | 207 | ret = m5mols_write(&info->sd, AWB_LOCK, awb_lock ? |
| 208 | REG_AWB_LOCK : REG_AWB_UNLOCK); |
| 209 | if (ret) |
| 210 | return ret; |
| 211 | } |
HeungJun, Kim | bc12510 | 2011-05-20 02:27:28 -0300 | [diff] [blame] | 212 | |
Sylwester Nawrocki | 9346459 | 2012-05-09 11:53:09 -0300 | [diff] [blame] | 213 | if (!info->ver.af || !af_lock) |
| 214 | return ret; |
HeungJun, Kim | bc12510 | 2011-05-20 02:27:28 -0300 | [diff] [blame] | 215 | |
Sylwester Nawrocki | 9346459 | 2012-05-09 11:53:09 -0300 | [diff] [blame] | 216 | if ((ctrl->val ^ ctrl->cur.val) & V4L2_LOCK_FOCUS) |
HeungJun, Kim | bc12510 | 2011-05-20 02:27:28 -0300 | [diff] [blame] | 217 | ret = m5mols_write(&info->sd, AF_EXECUTE, REG_AF_STOP); |
| 218 | |
| 219 | return ret; |
| 220 | } |
| 221 | |
Sylwester Nawrocki | 50d3f93 | 2012-04-09 14:51:49 -0300 | [diff] [blame] | 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 | |
Sylwester Nawrocki | 3c5da0b | 2012-04-09 13:51:56 -0300 | [diff] [blame] | 241 | static int m5mols_set_exposure(struct m5mols_info *info, int exposure) |
| 242 | { |
| 243 | struct v4l2_subdev *sd = &info->sd; |
Sylwester Nawrocki | 9346459 | 2012-05-09 11:53:09 -0300 | [diff] [blame] | 244 | int ret = 0; |
Sylwester Nawrocki | 3c5da0b | 2012-04-09 13:51:56 -0300 | [diff] [blame] | 245 | |
| 246 | if (exposure == V4L2_EXPOSURE_AUTO) { |
Sylwester Nawrocki | 9346459 | 2012-05-09 11:53:09 -0300 | [diff] [blame] | 247 | /* Unlock auto exposure */ |
| 248 | info->lock_3a->val &= ~V4L2_LOCK_EXPOSURE; |
| 249 | m5mols_3a_lock(info, info->lock_3a); |
| 250 | |
Sylwester Nawrocki | 50d3f93 | 2012-04-09 14:51:49 -0300 | [diff] [blame] | 251 | ret = m5mols_set_metering_mode(info, info->metering->val); |
Sylwester Nawrocki | 3c5da0b | 2012-04-09 13:51:56 -0300 | [diff] [blame] | 252 | if (ret < 0) |
| 253 | return ret; |
Sylwester Nawrocki | 48311db | 2012-03-06 07:10:00 -0300 | [diff] [blame] | 254 | |
Sylwester Nawrocki | 50d3f93 | 2012-04-09 14:51:49 -0300 | [diff] [blame] | 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); |
Sylwester Nawrocki | 48311db | 2012-03-06 07:10:00 -0300 | [diff] [blame] | 259 | |
| 260 | return m5mols_write(sd, AE_INDEX, info->exposure_bias->val); |
Sylwester Nawrocki | 3c5da0b | 2012-04-09 13:51:56 -0300 | [diff] [blame] | 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); |
Sylwester Nawrocki | 48311db | 2012-03-06 07:10:00 -0300 | [diff] [blame] | 271 | |
| 272 | v4l2_dbg(1, m5mols_debug, sd, "%s: exposure: %#x\n", |
| 273 | __func__, info->exposure->val); |
Sylwester Nawrocki | 3c5da0b | 2012-04-09 13:51:56 -0300 | [diff] [blame] | 274 | } |
| 275 | |
| 276 | return ret; |
| 277 | } |
| 278 | |
Sylwester Nawrocki | d7a87e4 | 2012-05-08 06:56:35 -0300 | [diff] [blame] | 279 | static int m5mols_set_white_balance(struct m5mols_info *info, int val) |
Sylwester Nawrocki | 3c5da0b | 2012-04-09 13:51:56 -0300 | [diff] [blame] | 280 | { |
Sylwester Nawrocki | d7a87e4 | 2012-05-08 06:56:35 -0300 | [diff] [blame] | 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; |
Sylwester Nawrocki | 3c5da0b | 2012-04-09 13:51:56 -0300 | [diff] [blame] | 295 | |
Sylwester Nawrocki | d7a87e4 | 2012-05-08 06:56:35 -0300 | [diff] [blame] | 296 | for (i = 0; i < ARRAY_SIZE(wb); i++) { |
| 297 | int awb; |
| 298 | if (wb[i][0] != val) |
| 299 | continue; |
Sylwester Nawrocki | 3c5da0b | 2012-04-09 13:51:56 -0300 | [diff] [blame] | 300 | |
Sylwester Nawrocki | d7a87e4 | 2012-05-08 06:56:35 -0300 | [diff] [blame] | 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; |
Sylwester Nawrocki | 3c5da0b | 2012-04-09 13:51:56 -0300 | [diff] [blame] | 315 | } |
| 316 | |
| 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 | |
| 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 | |
Sylwester Nawrocki | 44b153c | 2012-04-09 13:19:25 -0300 | [diff] [blame] | 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 | |
Sylwester Nawrocki | 4eb3419 | 2012-03-06 07:10:13 -0300 | [diff] [blame] | 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 | |
Sylwester Nawrocki | efcb07c | 2012-03-06 07:10:27 -0300 | [diff] [blame] | 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 | |
Sylwester Nawrocki | 44b153c | 2012-04-09 13:19:25 -0300 | [diff] [blame] | 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; |
Sylwester Nawrocki | 9346459 | 2012-05-09 11:53:09 -0300 | [diff] [blame] | 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; |
Sylwester Nawrocki | 44b153c | 2012-04-09 13:19:25 -0300 | [diff] [blame] | 444 | } |
| 445 | |
| 446 | return ret; |
| 447 | } |
| 448 | |
Sylwester Nawrocki | 3c5da0b | 2012-04-09 13:51:56 -0300 | [diff] [blame] | 449 | static int m5mols_s_ctrl(struct v4l2_ctrl *ctrl) |
HeungJun, Kim | bc12510 | 2011-05-20 02:27:28 -0300 | [diff] [blame] | 450 | { |
Sylwester Nawrocki | 0373e97 | 2012-04-09 13:52:06 -0300 | [diff] [blame] | 451 | unsigned int ctrl_mode = m5mols_get_ctrl_mode(ctrl); |
HeungJun, Kim | bc12510 | 2011-05-20 02:27:28 -0300 | [diff] [blame] | 452 | struct v4l2_subdev *sd = to_sd(ctrl); |
| 453 | struct m5mols_info *info = to_m5mols(sd); |
Sylwester Nawrocki | 0373e97 | 2012-04-09 13:52:06 -0300 | [diff] [blame] | 454 | int last_mode = info->mode; |
| 455 | int ret = 0; |
HeungJun, Kim | bc12510 | 2011-05-20 02:27:28 -0300 | [diff] [blame] | 456 | |
Sylwester Nawrocki | 3c5da0b | 2012-04-09 13:51:56 -0300 | [diff] [blame] | 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 | |
Sylwester Nawrocki | e169c9b | 2012-08-07 04:58:35 -0300 | [diff] [blame] | 466 | v4l2_dbg(1, m5mols_debug, sd, "%s: %s, val: %d, priv: %p\n", |
| 467 | __func__, ctrl->name, ctrl->val, ctrl->priv); |
Sylwester Nawrocki | 0373e97 | 2012-04-09 13:52:06 -0300 | [diff] [blame] | 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 | } |
Sylwester Nawrocki | 3c5da0b | 2012-04-09 13:51:56 -0300 | [diff] [blame] | 474 | |
HeungJun, Kim | bc12510 | 2011-05-20 02:27:28 -0300 | [diff] [blame] | 475 | switch (ctrl->id) { |
Sylwester Nawrocki | 9346459 | 2012-05-09 11:53:09 -0300 | [diff] [blame] | 476 | case V4L2_CID_3A_LOCK: |
| 477 | ret = m5mols_3a_lock(info, ctrl); |
| 478 | break; |
| 479 | |
HeungJun, Kim | bc12510 | 2011-05-20 02:27:28 -0300 | [diff] [blame] | 480 | case V4L2_CID_ZOOM_ABSOLUTE: |
Sylwester Nawrocki | 3c5da0b | 2012-04-09 13:51:56 -0300 | [diff] [blame] | 481 | ret = m5mols_write(sd, MON_ZOOM, ctrl->val); |
| 482 | break; |
HeungJun, Kim | bc12510 | 2011-05-20 02:27:28 -0300 | [diff] [blame] | 483 | |
| 484 | case V4L2_CID_EXPOSURE_AUTO: |
Sylwester Nawrocki | 3c5da0b | 2012-04-09 13:51:56 -0300 | [diff] [blame] | 485 | ret = m5mols_set_exposure(info, ctrl->val); |
| 486 | break; |
HeungJun, Kim | bc12510 | 2011-05-20 02:27:28 -0300 | [diff] [blame] | 487 | |
Sylwester Nawrocki | 44b153c | 2012-04-09 13:19:25 -0300 | [diff] [blame] | 488 | case V4L2_CID_ISO_SENSITIVITY: |
| 489 | ret = m5mols_set_iso(info, ctrl->val); |
| 490 | break; |
| 491 | |
Sylwester Nawrocki | d7a87e4 | 2012-05-08 06:56:35 -0300 | [diff] [blame] | 492 | case V4L2_CID_AUTO_N_PRESET_WHITE_BALANCE: |
Sylwester Nawrocki | 3c5da0b | 2012-04-09 13:51:56 -0300 | [diff] [blame] | 493 | ret = m5mols_set_white_balance(info, ctrl->val); |
| 494 | break; |
HeungJun, Kim | bc12510 | 2011-05-20 02:27:28 -0300 | [diff] [blame] | 495 | |
| 496 | case V4L2_CID_SATURATION: |
Sylwester Nawrocki | 3c5da0b | 2012-04-09 13:51:56 -0300 | [diff] [blame] | 497 | ret = m5mols_set_saturation(info, ctrl->val); |
| 498 | break; |
HeungJun, Kim | bc12510 | 2011-05-20 02:27:28 -0300 | [diff] [blame] | 499 | |
| 500 | case V4L2_CID_COLORFX: |
Sylwester Nawrocki | 3c5da0b | 2012-04-09 13:51:56 -0300 | [diff] [blame] | 501 | ret = m5mols_set_color_effect(info, ctrl->val); |
| 502 | break; |
Sylwester Nawrocki | 4eb3419 | 2012-03-06 07:10:13 -0300 | [diff] [blame] | 503 | |
| 504 | case V4L2_CID_WIDE_DYNAMIC_RANGE: |
| 505 | ret = m5mols_set_wdr(info, ctrl->val); |
| 506 | break; |
Sylwester Nawrocki | efcb07c | 2012-03-06 07:10:27 -0300 | [diff] [blame] | 507 | |
| 508 | case V4L2_CID_IMAGE_STABILIZATION: |
| 509 | ret = m5mols_set_stabilization(info, ctrl->val); |
| 510 | break; |
Sylwester Nawrocki | dd9c471 | 2012-02-28 06:29:01 -0300 | [diff] [blame] | 511 | |
| 512 | case V4L2_CID_JPEG_COMPRESSION_QUALITY: |
| 513 | ret = m5mols_write(sd, CAPP_JPEG_RATIO, ctrl->val); |
| 514 | break; |
Sylwester Nawrocki | 3c5da0b | 2012-04-09 13:51:56 -0300 | [diff] [blame] | 515 | } |
Sylwester Nawrocki | 3c5da0b | 2012-04-09 13:51:56 -0300 | [diff] [blame] | 516 | |
Sylwester Nawrocki | 0373e97 | 2012-04-09 13:52:06 -0300 | [diff] [blame] | 517 | if (ret == 0 && info->mode != last_mode) |
| 518 | ret = m5mols_set_mode(info, last_mode); |
| 519 | |
| 520 | return ret; |
Sylwester Nawrocki | 3c5da0b | 2012-04-09 13:51:56 -0300 | [diff] [blame] | 521 | } |
| 522 | |
| 523 | static const struct v4l2_ctrl_ops m5mols_ctrl_ops = { |
Sylwester Nawrocki | 44b153c | 2012-04-09 13:19:25 -0300 | [diff] [blame] | 524 | .g_volatile_ctrl = m5mols_g_volatile_ctrl, |
Sylwester Nawrocki | 3c5da0b | 2012-04-09 13:51:56 -0300 | [diff] [blame] | 525 | .s_ctrl = m5mols_s_ctrl, |
| 526 | }; |
| 527 | |
Sylwester Nawrocki | 44b153c | 2012-04-09 13:19:25 -0300 | [diff] [blame] | 528 | /* Supported manual ISO values */ |
| 529 | static const s64 iso_qmenu[] = { |
Sylwester Nawrocki | 6126b91 | 2012-07-24 12:12:07 -0300 | [diff] [blame] | 530 | /* AE_ISO: 0x01...0x07 (ISO: 50...3200) */ |
| 531 | 50000, 100000, 200000, 400000, 800000, 1600000, 3200000 |
Sylwester Nawrocki | 44b153c | 2012-04-09 13:19:25 -0300 | [diff] [blame] | 532 | }; |
| 533 | |
Sylwester Nawrocki | 48311db | 2012-03-06 07:10:00 -0300 | [diff] [blame] | 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 | |
Sylwester Nawrocki | 3c5da0b | 2012-04-09 13:51:56 -0300 | [diff] [blame] | 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 | |
Jonathan McCrohan | f58c91c | 2013-10-20 21:34:01 -0300 | [diff] [blame] | 547 | /* Determine the firmware dependent control range and step values */ |
Sylwester Nawrocki | 3c5da0b | 2012-04-09 13:51:56 -0300 | [diff] [blame] | 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; |
Sylwester Nawrocki | dd9c471 | 2012-02-28 06:29:01 -0300 | [diff] [blame] | 553 | v4l2_ctrl_handler_init(&info->handle, 20); |
Sylwester Nawrocki | 3c5da0b | 2012-04-09 13:51:56 -0300 | [diff] [blame] | 554 | |
Sylwester Nawrocki | d7a87e4 | 2012-05-08 06:56:35 -0300 | [diff] [blame] | 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); |
Sylwester Nawrocki | 3c5da0b | 2012-04-09 13:51:56 -0300 | [diff] [blame] | 558 | |
Sylwester Nawrocki | 48311db | 2012-03-06 07:10:00 -0300 | [diff] [blame] | 559 | /* Exposure control cluster */ |
Sylwester Nawrocki | 3c5da0b | 2012-04-09 13:51:56 -0300 | [diff] [blame] | 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 | |
Sylwester Nawrocki | 48311db | 2012-03-06 07:10:00 -0300 | [diff] [blame] | 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 | |
Sylwester Nawrocki | 50d3f93 | 2012-04-09 14:51:49 -0300 | [diff] [blame] | 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 | |
Sylwester Nawrocki | 44b153c | 2012-04-09 13:19:25 -0300 | [diff] [blame] | 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 | |
Sylwester Nawrocki | 3c5da0b | 2012-04-09 13:51:56 -0300 | [diff] [blame] | 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 | |
Sylwester Nawrocki | 4eb3419 | 2012-03-06 07:10:13 -0300 | [diff] [blame] | 595 | info->wdr = v4l2_ctrl_new_std(&info->handle, &m5mols_ctrl_ops, |
| 596 | V4L2_CID_WIDE_DYNAMIC_RANGE, 0, 1, 1, 0); |
| 597 | |
Sylwester Nawrocki | efcb07c | 2012-03-06 07:10:27 -0300 | [diff] [blame] | 598 | info->stabilization = v4l2_ctrl_new_std(&info->handle, &m5mols_ctrl_ops, |
| 599 | V4L2_CID_IMAGE_STABILIZATION, 0, 1, 1, 0); |
| 600 | |
Sylwester Nawrocki | dd9c471 | 2012-02-28 06:29:01 -0300 | [diff] [blame] | 601 | info->jpeg_quality = v4l2_ctrl_new_std(&info->handle, &m5mols_ctrl_ops, |
| 602 | V4L2_CID_JPEG_COMPRESSION_QUALITY, 1, 100, 1, 80); |
| 603 | |
Sylwester Nawrocki | 9346459 | 2012-05-09 11:53:09 -0300 | [diff] [blame] | 604 | info->lock_3a = v4l2_ctrl_new_std(&info->handle, &m5mols_ctrl_ops, |
| 605 | V4L2_CID_3A_LOCK, 0, 0x7, 0, 0); |
| 606 | |
Sylwester Nawrocki | 3c5da0b | 2012-04-09 13:51:56 -0300 | [diff] [blame] | 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); |
HeungJun, Kim | bc12510 | 2011-05-20 02:27:28 -0300 | [diff] [blame] | 611 | return ret; |
| 612 | } |
| 613 | |
Sylwester Nawrocki | 50d3f93 | 2012-04-09 14:51:49 -0300 | [diff] [blame] | 614 | v4l2_ctrl_auto_cluster(4, &info->auto_exposure, 1, false); |
Sylwester Nawrocki | 44b153c | 2012-04-09 13:19:25 -0300 | [diff] [blame] | 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 | |
Sylwester Nawrocki | 9346459 | 2012-05-09 11:53:09 -0300 | [diff] [blame] | 619 | info->lock_3a->flags |= V4L2_CTRL_FLAG_VOLATILE; |
| 620 | |
Sylwester Nawrocki | 0373e97 | 2012-04-09 13:52:06 -0300 | [diff] [blame] | 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 | |
Sylwester Nawrocki | 3c5da0b | 2012-04-09 13:51:56 -0300 | [diff] [blame] | 625 | sd->ctrl_handler = &info->handle; |
| 626 | |
| 627 | return 0; |
HeungJun, Kim | bc12510 | 2011-05-20 02:27:28 -0300 | [diff] [blame] | 628 | } |