drivers/media/i2c/soc_camera/rockchip/ov2710_v4l2-i2c-subdev.c

   1 /*
   2  * drivers/media/i2c/soc_camera/xgold/ov2710.c
   3  *
   4  * ov2710 sensor driver
   5  *
   6  * Copyright (C) 2016 Fuzhou Rockchip Electronics Co., Ltd.
   7  *
   8  * Copyright (C) 2012-2014 Intel Mobile Communications GmbH
   9  *
  10  * Copyright (C) 2008 Texas Instruments.
  11  *
  12  * This file is licensed under the terms of the GNU General Public License
  13  * version 2. This program is licensed "as is" without any warranty of any
  14  * kind, whether express or implied.
  15  *
  16  * Note:
  17  *
  18  * v0.1.0:
  19  *      1. Initialize version;
  20  *      2. Stream on sensor in configuration,
  21  *     and stream off sensor after 1frame;
  22  *      3. Stream delay time is define in power_up_delays_ms[2];
  23  */
  24
  25 #include <linux/i2c.h>
  26 #include <linux/io.h>
  27 #include <linux/delay.h>
  28 #include <linux/module.h>
  29 #include <media/v4l2-subdev.h>
  30 #include <media/videobuf-core.h>
  31 #include <linux/slab.h>
  32 #include <media/v4l2-controls_rockchip.h>
  33 #include "ov_camera_module.h"
  34
  35 #define OV2710_DRIVER_NAME "ov2710"
  36
  37 #define OV2710_FETCH_LSB_GAIN(VAL) (VAL & 0x00FF)       /* gain[7:0] */
  38 #define OV2710_FETCH_MSB_GAIN(VAL) ((VAL >> 8) & 0x1)   /* gain[10:8] */
  39 #define OV2710_AEC_PK_LONG_GAIN_HIGH_REG 0x350a /* Bit 8 */
  40 #define OV2710_AEC_PK_LONG_GAIN_LOW_REG  0x350b /* Bits 0 -7 */
  41
  42 #define OV2710_AEC_PK_LONG_EXPO_3RD_REG 0x3500  /* Exposure Bits 16-19 */
  43 #define OV2710_AEC_PK_LONG_EXPO_2ND_REG 0x3501  /* Exposure Bits 8-15 */
  44 #define OV2710_AEC_PK_LONG_EXPO_1ST_REG 0x3502  /* Exposure Bits 0-7 */
  45
  46 #define OV2710_AEC_GROUP_UPDATE_ADDRESS 0x3212
  47 #define OV2710_AEC_GROUP_UPDATE_START_DATA 0x00
  48 #define OV2710_AEC_GROUP_UPDATE_END_DATA 0x10
  49 #define OV2710_AEC_GROUP_UPDATE_END_LAUNCH 0xA0
  50
  51 #define OV2710_FETCH_3RD_BYTE_EXP(VAL) (((VAL) >> 12) & 0xF)    /* 4 Bits */
  52 #define OV2710_FETCH_2ND_BYTE_EXP(VAL) (((VAL) >> 4) & 0xFF)    /* 8 Bits */
  53 #define OV2710_FETCH_1ST_BYTE_EXP(VAL) (((VAL) & 0x0F) << 4)    /* 4 Bits */
  54
  55 #define OV2710_PIDH_ADDR     0x300A
  56 #define OV2710_PIDL_ADDR     0x300B
  57
  58 /* High byte of product ID */
  59 #define OV2710_PIDH_MAGIC 0x27
  60 /* Low byte of product ID  */
  61 #define OV2710_PIDL_MAGIC 0x10
  62
  63 #define OV2710_EXT_CLK 24000000
  64 #define OV2710_PLL_PREDIV0_REG 0x3088
  65 #define OV2710_PLL_PREDIV_REG  0x3080
  66 #define OV2710_PLL_MUL_HIGH_REG 0x3081
  67 #define OV2710_PLL_MUL_LOW_REG 0x3082
  68 #define OV2710_PLL_SPDIV_REG 0x3086
  69 #define OV2710_PLL_DIVSYS_REG 0x3084
  70 #define OV2710_TIMING_VTS_HIGH_REG 0x380e
  71 #define OV2710_TIMING_VTS_LOW_REG 0x380f
  72 #define OV2710_TIMING_HTS_HIGH_REG 0x380c
  73 #define OV2710_TIMING_HTS_LOW_REG 0x380d
  74 #define OV2710_FINE_INTG_TIME_MIN 0
  75 #define OV2710_FINE_INTG_TIME_MAX_MARGIN 0
  76 #define OV2710_COARSE_INTG_TIME_MIN 1
  77 #define OV2710_COARSE_INTG_TIME_MAX_MARGIN 4
  78 #define OV2710_TIMING_X_INC             0x3814
  79 #define OV2710_TIMING_Y_INC             0x3815
  80 #define OV2710_HORIZONTAL_START_HIGH_REG 0x3800
  81 #define OV2710_HORIZONTAL_START_LOW_REG 0x3801
  82 #define OV2710_VERTICAL_START_HIGH_REG 0x3802
  83 #define OV2710_VERTICAL_START_LOW_REG 0x3803
  84 #define OV2710_HORIZONTAL_END_HIGH_REG 0x3804
  85 #define OV2710_HORIZONTAL_END_LOW_REG 0x3805
  86 #define OV2710_VERTICAL_END_HIGH_REG 0x3806
  87 #define OV2710_VERTICAL_END_LOW_REG 0x3807
  88 #define OV2710_HORIZONTAL_OUTPUT_SIZE_HIGH_REG 0x3808
  89 #define OV2710_HORIZONTAL_OUTPUT_SIZE_LOW_REG 0x3809
  90 #define OV2710_VERTICAL_OUTPUT_SIZE_HIGH_REG 0x380a
  91 #define OV2710_VERTICAL_OUTPUT_SIZE_LOW_REG 0x380b
  92 #define OV2710_H_WIN_OFF_HIGH_REG 0x3810
  93 #define OV2710_H_WIN_OFF_LOW_REG 0x3811
  94 #define OV2710_V_WIN_OFF_HIGH_REG 0x3812
  95 #define OV2710_V_WIN_OFF_LOW_REG 0x3813
  96
  97 #define OV2710_ANA_ARRAR01 0x3621
  98 #define OV2710_TIMING_CONCTROL_VH 0x3803
  99 #define OV2710_TIMING_CONCTROL18 0x3818
 100
 101 /* ======================================================================== */
 102 /* Base sensor configs */
 103 /* ======================================================================== */
 104 /* MCLK:24MHz  1920x1080  30fps   mipi 1lane   800Mbps/lane */
 105 static struct ov_camera_module_reg ov2710_init_tab_1920_1080_30fps[] = {
 106 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3008, 0x82},
 107 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3008, 0x42},
 108 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x4201, 0x00},
 109 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x4202, 0x0f},
 110 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3103, 0x93},
 111 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3017, 0x7f},
 112 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3018, 0xfc},
 113 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3706, 0x61},
 114 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3712, 0x0c},
 115 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3630, 0x6d},
 116 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3800, 0x01},
 117 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3801, 0xb4},
 118 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3802, 0x00},
 119 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3803, 0x0a},
 120 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3818, 0x80},
 121 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3804, 0x07},
 122 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3805, 0x80},
 123 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3806, 0x04},
 124 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3807, 0x38},
 125 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3808, 0x07},
 126 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3809, 0x80},
 127 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x380a, 0x04},
 128 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x380b, 0x38},
 129 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3810, 0x10},
 130 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3811, 0x06},
 131 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3812, 0x00},
 132 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3813, 0x00},
 133 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3621, 0x04},
 134 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3604, 0x60},
 135 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3603, 0xa7},
 136 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3631, 0x26},
 137 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3600, 0x04},
 138 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3620, 0x37},
 139 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3623, 0x00},
 140 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3702, 0x9e},
 141 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3703, 0x5c},
 142 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3704, 0x40},
 143 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x370d, 0x0f},
 144 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3713, 0x9f},
 145 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3714, 0x4c},
 146 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3710, 0x9e},
 147 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3801, 0xc4},
 148 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3605, 0x05},
 149 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3606, 0x3f},
 150 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x302d, 0x90},
 151 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x370b, 0x40},
 152 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3716, 0x31},
 153 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3707, 0x52},
 154 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x380d, 0x74},
 155 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x5181, 0x20},
 156 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x518f, 0x00},
 157 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x4301, 0xff},
 158 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x4303, 0x00},
 159 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3a00, 0x78},
 160 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x300f, 0x88},
 161 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3011, 0x28},
 162 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3a1a, 0x06},
 163 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3a18, 0x00},
 164 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3a19, 0x7a},
 165 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3a13, 0x54},
 166 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x382e, 0x0f},
 167 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x381a, 0x1a},
 168 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x401d, 0x02},
 169 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x5688, 0x03},
 170 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x5684, 0x07},
 171 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x5685, 0xa0},
 172 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x5686, 0x04},
 173 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x5687, 0x43},
 174 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3011, 0x0a},
 175 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x300f, 0x8a},
 176 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3017, 0x00},
 177 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3018, 0x00},
 178 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x300e, 0x04},
 179 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x4801, 0x0f},
 180 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x300f, 0xc3},
 181 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3a0f, 0x40},
 182 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3a10, 0x38},
 183 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3a1b, 0x48},
 184 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3a1e, 0x30},
 185 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3a11, 0x90},
 186 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3a1f, 0x10},
 187 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x380c, 0x09},/* HTS H */
 188 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x380d, 0x74},/* HTS L */
 189 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x380e, 0x04},/* VTS H */
 190 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x380f, 0x50},/* VTS L */
 191 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3500, 0x00},
 192 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3501, 0x28},
 193 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3502, 0x90},
 194 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3503, 0x07},
 195 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x350a, 0x00},
 196 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x350b, 0x1f},
 197 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x5000, 0x5f},
 198 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x5001, 0x4e},
 199 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3406, 0x01},
 200 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3400, 0x04},
 201 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3401, 0x00},
 202 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3402, 0x04},
 203 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3403, 0x00},
 204 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3404, 0x04},
 205 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3405, 0x00},
 206 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x4800, 0x24},
 207 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x4201, 0x00},
 208 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x4202, 0x00},
 209 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3008, 0x02},
 210 {OV_CAMERA_MODULE_REG_TYPE_TIMEOUT, 0x0000, 40},
 211 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x3008, 0x42},
 212 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x4201, 0x00},
 213 {OV_CAMERA_MODULE_REG_TYPE_DATA, 0x4202, 0x0f}
 214 };
 215
 216 /* ======================================================================== */
 217 static struct ov_camera_module_config ov2710_configs[] = {
 218         {
 219                 .name = "1920x1080_30fps",
 220                 .frm_fmt = {
 221                         .width = 1920,
 222                         .height = 1080,
 223                         .code = MEDIA_BUS_FMT_SBGGR10_1X10
 224                 },
 225                 .frm_intrvl = {
 226                         .interval = {
 227                                 .numerator = 1,
 228                                 .denominator = 30
 229                         }
 230                 },
 231                 .auto_exp_enabled = false,
 232                 .auto_gain_enabled = false,
 233                 .auto_wb_enabled = false,
 234                 .reg_table = (void *)ov2710_init_tab_1920_1080_30fps,
 235                 .reg_table_num_entries =
 236                         sizeof(ov2710_init_tab_1920_1080_30fps) /
 237                         sizeof(ov2710_init_tab_1920_1080_30fps[0]),
 238                 .v_blanking_time_us = 3078,
 239                 .ignore_measurement_check = 1,
 240                 PLTFRM_CAM_ITF_MIPI_CFG(0, 1, 800, 24000000)
 241         }
 242 };
 243
 244 /*--------------------------------------------------------------------------*/
 245 static int ov2710_set_flip(
 246         struct ov_camera_module *cam_mod,
 247         struct pltfrm_camera_module_reg reglist[],
 248         int len)
 249 {
 250         int i, mode = 0;
 251         u16 match_reg[3];
 252
 253         mode = ov_camera_module_get_flip_mirror(cam_mod);
 254
 255         if (mode == -1) {
 256                 ov_camera_module_pr_debug(
 257                         cam_mod,
 258                         "dts don't set flip, return!\n");
 259                 return 0;
 260         }
 261
 262         if (mode == OV_FLIP_BIT_MASK) {
 263                 match_reg[0] = 0x04;
 264                 match_reg[1] = 0x09;
 265                 match_reg[2] = 0xa0;
 266         } else if (mode == OV_MIRROR_BIT_MASK) {
 267                 match_reg[0] = 0x14;
 268                 match_reg[1] = 0x0a;
 269                 match_reg[2] = 0xc0;
 270         } else if (mode == (OV_MIRROR_BIT_MASK |
 271                 OV_FLIP_BIT_MASK)) {
 272                 match_reg[0] = 0x14;
 273                 match_reg[1] = 0x09;
 274                 match_reg[2] = 0xe0;
 275         } else {
 276                 match_reg[0] = 0x04;
 277                 match_reg[1] = 0x0a;
 278                 match_reg[2] = 0x80;
 279         }
 280
 281         for (i = len; i > 0; i--) {
 282                 if (reglist[i].reg == OV2710_ANA_ARRAR01)
 283                         reglist[i].val = match_reg[0];
 284                 else if (reglist[i].reg == OV2710_TIMING_CONCTROL_VH)
 285                         reglist[i].val = match_reg[1];
 286                 else if (reglist[i].reg == OV2710_TIMING_CONCTROL18)
 287                         reglist[i].val = match_reg[2];
 288         }
 289
 290         return 0;
 291 }
 292
 293 /*--------------------------------------------------------------------------*/
 294 static int OV2710_g_VTS(struct ov_camera_module *cam_mod, u32 *vts)
 295 {
 296         u32 msb, lsb;
 297         int ret;
 298
 299         ret = ov_camera_module_read_reg_table(
 300                 cam_mod,
 301                 OV2710_TIMING_VTS_HIGH_REG,
 302                 &msb);
 303         if (IS_ERR_VALUE(ret))
 304                 goto err;
 305
 306         ret = ov_camera_module_read_reg_table(
 307                 cam_mod,
 308                 OV2710_TIMING_VTS_LOW_REG,
 309                 &lsb);
 310         if (IS_ERR_VALUE(ret))
 311                 goto err;
 312
 313         *vts = (msb << 8) | lsb;
 314
 315         return 0;
 316 err:
 317         ov_camera_module_pr_err(cam_mod,
 318                         "failed with error (%d)\n", ret);
 319         return ret;
 320 }
 321
 322 static int OV2710_auto_adjust_fps(struct ov_camera_module *cam_mod,
 323         u32 exp_time)
 324 {
 325         int ret;
 326         u32 vts;
 327
 328         if ((cam_mod->exp_config.exp_time + OV2710_COARSE_INTG_TIME_MAX_MARGIN)
 329                 > cam_mod->vts_min)
 330                 vts = cam_mod->exp_config.exp_time +
 331                         OV2710_COARSE_INTG_TIME_MAX_MARGIN;
 332         else
 333                 vts = cam_mod->vts_min;
 334
 335         /*
 336          * if (cam_mod->fps_ctrl > 0 && cam_mod->fps_ctrl < 100)
 337          * vts = vts * 100 / cam_mod->fps_ctrl;
 338          */
 339
 340         if (vts > 0xfff)
 341                 vts = 0xfff;
 342         else
 343                 vts = vts;/* VTS value is 0x380e[3:0]/380f[7:0] */
 344
 345         ret = ov_camera_module_write_reg(cam_mod,
 346                 OV2710_TIMING_VTS_LOW_REG,
 347                 vts & 0xFF);
 348         ret |= ov_camera_module_write_reg(cam_mod,
 349                 OV2710_TIMING_VTS_HIGH_REG,
 350                 (vts >> 8) & 0x0F);
 351
 352         if (IS_ERR_VALUE(ret))
 353                 ov_camera_module_pr_err(cam_mod,
 354                                 "failed with error (%d)\n", ret);
 355         else
 356                 ov_camera_module_pr_debug(cam_mod,
 357                         "updated vts = 0x%x,vts_min=0x%x\n",
 358                         vts, cam_mod->vts_min);
 359
 360         return ret;
 361 }
 362
 363 static int ov2710_write_aec(struct ov_camera_module *cam_mod)
 364 {
 365         int ret = 0;
 366
 367         ov_camera_module_pr_debug(cam_mod,
 368                 "exp_time = %d lines, gain = %d, flash_mode = %d\n",
 369                 cam_mod->exp_config.exp_time,
 370                 cam_mod->exp_config.gain,
 371                 cam_mod->exp_config.flash_mode);
 372
 373         /*
 374          * if the sensor is already streaming, write to shadow registers,
 375          * if the sensor is in SW standby, write to active registers,
 376          * if the sensor is off/registers are not writeable, do nothing
 377          */
 378         if ((cam_mod->state == OV_CAMERA_MODULE_SW_STANDBY) ||
 379                 (cam_mod->state == OV_CAMERA_MODULE_STREAMING)) {
 380                 u32 a_gain = cam_mod->exp_config.gain;
 381                 u32 exp_time = cam_mod->exp_config.exp_time;
 382
 383                 a_gain = a_gain * cam_mod->exp_config.gain_percent / 100;
 384
 385                 if (cam_mod->state == OV_CAMERA_MODULE_STREAMING)
 386                         ret = ov_camera_module_write_reg(cam_mod,
 387                                 OV2710_AEC_GROUP_UPDATE_ADDRESS,
 388                                 OV2710_AEC_GROUP_UPDATE_START_DATA);
 389                 if (!IS_ERR_VALUE(ret) && cam_mod->auto_adjust_fps)
 390                         ret = OV2710_auto_adjust_fps(cam_mod,
 391                                 cam_mod->exp_config.exp_time);
 392                 ret |= ov_camera_module_write_reg(cam_mod,
 393                         OV2710_AEC_PK_LONG_GAIN_HIGH_REG,
 394                         OV2710_FETCH_MSB_GAIN(a_gain));
 395                 ret |= ov_camera_module_write_reg(cam_mod,
 396                         OV2710_AEC_PK_LONG_GAIN_LOW_REG,
 397                         OV2710_FETCH_LSB_GAIN(a_gain));
 398                 ret = ov_camera_module_write_reg(cam_mod,
 399                         OV2710_AEC_PK_LONG_EXPO_3RD_REG,
 400                         OV2710_FETCH_3RD_BYTE_EXP(exp_time));
 401                 ret |= ov_camera_module_write_reg(cam_mod,
 402                         OV2710_AEC_PK_LONG_EXPO_2ND_REG,
 403                         OV2710_FETCH_2ND_BYTE_EXP(exp_time));
 404                 ret |= ov_camera_module_write_reg(cam_mod,
 405                         OV2710_AEC_PK_LONG_EXPO_1ST_REG,
 406                         OV2710_FETCH_1ST_BYTE_EXP(exp_time));
 407                 if (cam_mod->state == OV_CAMERA_MODULE_STREAMING) {
 408                         ret = ov_camera_module_write_reg(cam_mod,
 409                                 OV2710_AEC_GROUP_UPDATE_ADDRESS,
 410                                 OV2710_AEC_GROUP_UPDATE_END_DATA);
 411                         ret = ov_camera_module_write_reg(cam_mod,
 412                                 OV2710_AEC_GROUP_UPDATE_ADDRESS,
 413                                 OV2710_AEC_GROUP_UPDATE_END_LAUNCH);
 414                 }
 415         }
 416
 417         if (IS_ERR_VALUE(ret))
 418                 ov_camera_module_pr_err(cam_mod,
 419                         "failed with error (%d)\n", ret);
 420         return ret;
 421 }
 422
 423 static int ov2710_g_ctrl(struct ov_camera_module *cam_mod, u32 ctrl_id)
 424 {
 425         int ret = 0;
 426
 427         ov_camera_module_pr_debug(cam_mod, "\n");
 428
 429         switch (ctrl_id) {
 430         case V4L2_CID_GAIN:
 431         case V4L2_CID_EXPOSURE:
 432         case V4L2_CID_FLASH_LED_MODE:
 433                 /* nothing to be done here */
 434                 break;
 435         default:
 436                 ret = -EINVAL;
 437                 break;
 438         }
 439
 440         if (IS_ERR_VALUE(ret))
 441                 ov_camera_module_pr_debug(cam_mod,
 442                         "failed with error (%d)\n", ret);
 443         return ret;
 444 }
 445
 446 /*--------------------------------------------------------------------------*/
 447
 448 static int ov2710_filltimings(struct ov_camera_module_custom_config *custom)
 449 {
 450         int i, j;
 451         u32 win_h_off = 0, win_v_off = 0;
 452         struct ov_camera_module_config *config;
 453         struct ov_camera_module_timings *timings;
 454         struct ov_camera_module_reg *reg_table;
 455         int reg_table_num_entries;
 456
 457         for (i = 0; i < custom->num_configs; i++) {
 458                 config = &custom->configs[i];
 459                 reg_table = config->reg_table;
 460                 reg_table_num_entries = config->reg_table_num_entries;
 461                 timings = &config->timings;
 462
 463                 memset(timings, 0x00, sizeof(*timings));
 464                 for (j = 0; j < reg_table_num_entries; j++) {
 465                         switch (reg_table[j].reg) {
 466                         case OV2710_TIMING_VTS_HIGH_REG:
 467                                 timings->frame_length_lines =
 468                                         ((reg_table[j].val << 8) |
 469                                         (timings->frame_length_lines & 0xff));
 470                                 break;
 471                         case OV2710_TIMING_VTS_LOW_REG:
 472                                 timings->frame_length_lines =
 473                                         (reg_table[j].val |
 474                                         (timings->frame_length_lines & 0xff00));
 475                                 break;
 476                         case OV2710_TIMING_HTS_HIGH_REG:
 477                                 timings->line_length_pck =
 478                                         ((reg_table[j].val << 8) |
 479                                         timings->line_length_pck);
 480                                 break;
 481                         case OV2710_TIMING_HTS_LOW_REG:
 482                                 timings->line_length_pck =
 483                                         (reg_table[j].val |
 484                                         (timings->line_length_pck & 0xff00));
 485                                 break;
 486                         case OV2710_TIMING_X_INC:
 487                                 timings->binning_factor_x =
 488                                         ((reg_table[j].val >> 4) + 1) / 2;
 489                                 if (timings->binning_factor_x == 0)
 490                                         timings->binning_factor_x = 1;
 491                                 break;
 492                         case OV2710_TIMING_Y_INC:
 493                                 timings->binning_factor_y =
 494                                         ((reg_table[j].val >> 4) + 1) / 2;
 495                                 if (timings->binning_factor_y == 0)
 496                                         timings->binning_factor_y = 1;
 497                                 break;
 498                         case OV2710_HORIZONTAL_START_HIGH_REG:
 499                                 timings->crop_horizontal_start =
 500                                         ((reg_table[j].val << 8) |
 501                                         (timings->crop_horizontal_start &
 502                                         0xff));
 503                                 break;
 504                         case OV2710_HORIZONTAL_START_LOW_REG:
 505                                 timings->crop_horizontal_start =
 506                                         (reg_table[j].val |
 507                                         (timings->crop_horizontal_start &
 508                                         0xff00));
 509                                 break;
 510                         case OV2710_VERTICAL_START_HIGH_REG:
 511                                 timings->crop_vertical_start =
 512                                         ((reg_table[j].val << 8) |
 513                                         (timings->crop_vertical_start & 0xff));
 514                                 break;
 515                         case OV2710_VERTICAL_START_LOW_REG:
 516                                 timings->crop_vertical_start =
 517                                         ((reg_table[j].val) |
 518                                         (timings->crop_vertical_start &
 519                                         0xff00));
 520                                 break;
 521                         case OV2710_HORIZONTAL_END_HIGH_REG:
 522                                 timings->crop_horizontal_end =
 523                                         ((reg_table[j].val << 8) |
 524                                         (timings->crop_horizontal_end & 0xff));
 525                                 break;
 526                         case OV2710_HORIZONTAL_END_LOW_REG:
 527                                 timings->crop_horizontal_end =
 528                                         (reg_table[j].val |
 529                                         (timings->crop_horizontal_end &
 530                                         0xff00));
 531                                 break;
 532                         case OV2710_VERTICAL_END_HIGH_REG:
 533                                 timings->crop_vertical_end =
 534                                         ((reg_table[j].val << 8) |
 535                                         (timings->crop_vertical_end & 0xff));
 536                                 break;
 537                         case OV2710_VERTICAL_END_LOW_REG:
 538                                 timings->crop_vertical_end =
 539                                         (reg_table[j].val |
 540                                         (timings->crop_vertical_end & 0xff00));
 541                                 break;
 542                         case OV2710_H_WIN_OFF_HIGH_REG:
 543                                 win_h_off = (reg_table[j].val & 0xf) << 8;
 544                                 break;
 545                         case OV2710_H_WIN_OFF_LOW_REG:
 546                                 win_h_off |= (reg_table[j].val & 0xff);
 547                                 break;
 548                         case OV2710_V_WIN_OFF_HIGH_REG:
 549                                 win_v_off = (reg_table[j].val & 0xf) << 8;
 550                                 break;
 551                         case OV2710_V_WIN_OFF_LOW_REG:
 552                                 win_v_off |= (reg_table[j].val & 0xff);
 553                                 break;
 554                         case OV2710_HORIZONTAL_OUTPUT_SIZE_HIGH_REG:
 555                                 timings->sensor_output_width =
 556                                         ((reg_table[j].val << 8) |
 557                                         (timings->sensor_output_width & 0xff));
 558                                 break;
 559                         case OV2710_HORIZONTAL_OUTPUT_SIZE_LOW_REG:
 560                                 timings->sensor_output_width =
 561                                         (reg_table[j].val |
 562                                         (timings->sensor_output_width &
 563                                         0xff00));
 564                                 break;
 565                         case OV2710_VERTICAL_OUTPUT_SIZE_HIGH_REG:
 566                                 timings->sensor_output_height =
 567                                         ((reg_table[j].val << 8) |
 568                                         (timings->sensor_output_height & 0xff));
 569                                 break;
 570                         case OV2710_VERTICAL_OUTPUT_SIZE_LOW_REG:
 571                                 timings->sensor_output_height =
 572                                         (reg_table[j].val |
 573                                         (timings->sensor_output_height &
 574                                         0xff00));
 575                                 break;
 576                         }
 577                 }
 578
 579                 timings->crop_horizontal_start += win_h_off;
 580                 timings->crop_horizontal_end -= win_h_off;
 581                 timings->crop_vertical_start += win_v_off;
 582                 timings->crop_vertical_end -= win_v_off;
 583
 584                 timings->exp_time >>= 4;
 585                 timings->vt_pix_clk_freq_hz =
 586                         config->frm_intrvl.interval.denominator *
 587                         timings->frame_length_lines *
 588                         timings->line_length_pck;
 589
 590                 timings->coarse_integration_time_min =
 591                         OV2710_COARSE_INTG_TIME_MIN;
 592                 timings->coarse_integration_time_max_margin =
 593                         OV2710_COARSE_INTG_TIME_MAX_MARGIN;
 594
 595                 /* OV Sensor do not use fine integration time. */
 596                 timings->fine_integration_time_min =
 597                         OV2710_FINE_INTG_TIME_MIN;
 598                 timings->fine_integration_time_max_margin =
 599                         OV2710_FINE_INTG_TIME_MAX_MARGIN;
 600         }
 601
 602         return 0;
 603 }
 604
 605 /*--------------------------------------------------------------------------*/
 606
 607 static int ov2710_g_timings(struct ov_camera_module *cam_mod,
 608                             struct ov_camera_module_timings *timings)
 609 {
 610         int ret = 0;
 611         unsigned int vts;
 612
 613         if (IS_ERR_OR_NULL(cam_mod->active_config))
 614                 goto err;
 615
 616         *timings = cam_mod->active_config->timings;
 617
 618         vts = (!cam_mod->vts_cur) ?
 619                 timings->frame_length_lines :
 620                 cam_mod->vts_cur;
 621         if (cam_mod->frm_intrvl_valid)
 622                 timings->vt_pix_clk_freq_hz =
 623                         cam_mod->frm_intrvl.interval.denominator
 624                         * vts
 625                         * timings->line_length_pck;
 626         else
 627                 timings->vt_pix_clk_freq_hz =
 628                 cam_mod->active_config->frm_intrvl.interval.denominator *
 629                 vts * timings->line_length_pck;
 630
 631         return ret;
 632 err:
 633         ov_camera_module_pr_err(cam_mod,
 634                         "failed with error (%d)\n", ret);
 635         return ret;
 636 }
 637
 638 /*--------------------------------------------------------------------------*/
 639
 640 static int ov2710_s_ctrl(struct ov_camera_module *cam_mod, u32 ctrl_id)
 641 {
 642         int ret = 0;
 643
 644         ov_camera_module_pr_debug(cam_mod, "\n");
 645
 646         switch (ctrl_id) {
 647         case V4L2_CID_GAIN:
 648         case V4L2_CID_EXPOSURE:
 649                 ret = ov2710_write_aec(cam_mod);
 650                 break;
 651         case V4L2_CID_FLASH_LED_MODE:
 652                 /* nothing to be done here */
 653                 break;
 654         case V4L2_CID_FOCUS_ABSOLUTE:
 655                 /* todo*/
 656                 break;
 657         /*
 658          * case RK_V4L2_CID_FPS_CTRL:
 659          * if (cam_mod->auto_adjust_fps)
 660          * ret = OV2710_auto_adjust_fps(
 661          * cam_mod,
 662          * cam_mod->exp_config.exp_time);
 663          * break;
 664          */
 665         default:
 666                 ret = -EINVAL;
 667                 break;
 668         }
 669
 670         if (IS_ERR_VALUE(ret))
 671                 ov_camera_module_pr_err(cam_mod,
 672                         "failed with error (%d)\n", ret);
 673         return ret;
 674 }
 675
 676 /*--------------------------------------------------------------------------*/
 677
 678 static int ov2710_s_ext_ctrls(struct ov_camera_module *cam_mod,
 679                                  struct ov_camera_module_ext_ctrls *ctrls)
 680 {
 681         int ret = 0;
 682
 683         /* Handles only exposure and gain together special case. */
 684         if (ctrls->count == 1)
 685                 ret = ov2710_s_ctrl(cam_mod, ctrls->ctrls[0].id);
 686         else if ((ctrls->count == 3) &&
 687                 (ctrls->ctrls[0].id == V4L2_CID_GAIN ||
 688                 ctrls->ctrls[0].id == V4L2_CID_EXPOSURE ||
 689                 ctrls->ctrls[1].id == V4L2_CID_GAIN ||
 690                 ctrls->ctrls[1].id == V4L2_CID_EXPOSURE))
 691                 ret = ov2710_write_aec(cam_mod);
 692         else
 693                 ret = -EINVAL;
 694
 695         if (IS_ERR_VALUE(ret))
 696                 ov_camera_module_pr_debug(cam_mod,
 697                         "failed with error (%d)\n", ret);
 698
 699         return ret;
 700 }
 701
 702 /*--------------------------------------------------------------------------*/
 703
 704 static int ov2710_start_streaming(struct ov_camera_module *cam_mod)
 705 {
 706         int ret = 0;
 707
 708         ov_camera_module_pr_debug(cam_mod,
 709                 "active config=%s\n", cam_mod->active_config->name);
 710
 711         ret = OV2710_g_VTS(cam_mod, &cam_mod->vts_min);
 712         if (IS_ERR_VALUE(ret))
 713                 goto err;
 714         ov_camera_module_pr_debug(cam_mod, "=====streaming on ===\n");
 715         ret = ov_camera_module_write_reg(cam_mod, 0x3008, 0x02);
 716         ret |= ov_camera_module_write_reg(cam_mod, 0x4201, 0x00);
 717         ret |= ov_camera_module_write_reg(cam_mod, 0x4202, 0x00);
 718
 719         if (IS_ERR_VALUE(ret))
 720                 goto err;
 721
 722         return 0;
 723 err:
 724         ov_camera_module_pr_err(cam_mod, "failed with error (%d)\n",
 725                 ret);
 726         return ret;
 727 }
 728
 729 /*--------------------------------------------------------------------------*/
 730
 731 static int ov2710_stop_streaming(struct ov_camera_module *cam_mod)
 732 {
 733         int ret = 0;
 734
 735         ov_camera_module_pr_debug(cam_mod, "\n");
 736         ret = ov_camera_module_write_reg(cam_mod, 0x3008, 0x42);
 737         ret |= ov_camera_module_write_reg(cam_mod, 0x4201, 0x00);
 738         ret |= ov_camera_module_write_reg(cam_mod, 0x4202, 0x0f);
 739
 740         if (IS_ERR_VALUE(ret))
 741                 goto err;
 742
 743         return 0;
 744 err:
 745         ov_camera_module_pr_err(cam_mod, "failed with error (%d)\n", ret);
 746         return ret;
 747 }
 748
 749 /*--------------------------------------------------------------------------*/
 750
 751 static int ov2710_check_camera_id(struct ov_camera_module *cam_mod)
 752 {
 753         u32 pidh, pidl;
 754         int ret = 0;
 755
 756         ov_camera_module_pr_debug(cam_mod, "\n");
 757
 758         ret |= ov_camera_module_read_reg(cam_mod, 1, OV2710_PIDH_ADDR, &pidh);
 759         ret |= ov_camera_module_read_reg(cam_mod, 1, OV2710_PIDL_ADDR, &pidl);
 760         if (IS_ERR_VALUE(ret)) {
 761                 ov_camera_module_pr_err(cam_mod,
 762                         "register read failed, camera module powered off?\n");
 763                 goto err;
 764         }
 765
 766         if ((pidh == OV2710_PIDH_MAGIC) && (pidl == OV2710_PIDL_MAGIC))
 767                 ov_camera_module_pr_debug(cam_mod,
 768                         "successfully detected camera ID 0x%02x%02x\n",
 769                         pidh, pidl);
 770         else {
 771                 ov_camera_module_pr_err(cam_mod,
 772                         "wrong camera ID, expected 0x%02x%02x, detected 0x%02x%02x\n",
 773                         OV2710_PIDH_MAGIC, OV2710_PIDL_MAGIC, pidh, pidl);
 774                 ret = -EINVAL;
 775                 goto err;
 776         }
 777
 778         return 0;
 779 err:
 780         ov_camera_module_pr_err(cam_mod, "failed with error (%d)\n", ret);
 781         return ret;
 782 }
 783
 784 /* ======================================================================== */
 785 int ov_camera_2710_module_s_ctrl(
 786         struct v4l2_subdev *sd,
 787         struct v4l2_control *ctrl)
 788 {
 789         return 0;
 790 }
 791
 792 /* ======================================================================== */
 793
 794 int ov_camera_2710_module_s_ext_ctrls(
 795         struct v4l2_subdev *sd,
 796         struct v4l2_ext_controls *ctrls)
 797 {
 798         return 0;
 799 }
 800
 801 long ov_camera_2710_module_ioctl(struct v4l2_subdev *sd,
 802         unsigned int cmd,
 803         void *arg)
 804 {
 805         return 0;
 806 }
 807
 808 /* ======================================================================== */
 809 /* This part is platform dependent */
 810 /* ======================================================================== */
 811
 812 static struct v4l2_subdev_core_ops ov2710_camera_module_core_ops = {
 813         .g_ctrl = ov_camera_module_g_ctrl,
 814         .s_ctrl = ov_camera_module_s_ctrl,
 815         .s_ext_ctrls = ov_camera_module_s_ext_ctrls,
 816         .s_power = ov_camera_module_s_power,
 817         .ioctl = ov_camera_module_ioctl
 818 };
 819
 820 static struct v4l2_subdev_video_ops ov2710_camera_module_video_ops = {
 821         .s_frame_interval = ov_camera_module_s_frame_interval,
 822         .s_stream = ov_camera_module_s_stream
 823 };
 824
 825 static struct v4l2_subdev_pad_ops ov2710_camera_module_pad_ops = {
 826         .enum_frame_interval = ov_camera_module_enum_frameintervals,
 827         .get_fmt = ov_camera_module_g_fmt,
 828         .set_fmt = ov_camera_module_s_fmt,
 829 };
 830
 831 static struct v4l2_subdev_ops ov2710_camera_module_ops = {
 832         .core = &ov2710_camera_module_core_ops,
 833         .video = &ov2710_camera_module_video_ops,
 834         .pad = &ov2710_camera_module_pad_ops
 835 };
 836
 837 static struct ov_camera_module ov2710;
 838
 839 static struct ov_camera_module_custom_config ov2710_custom_config = {
 840         .start_streaming = ov2710_start_streaming,
 841         .stop_streaming = ov2710_stop_streaming,
 842         .s_ctrl = ov2710_s_ctrl,
 843         .g_ctrl = ov2710_g_ctrl,
 844         .s_ext_ctrls = ov2710_s_ext_ctrls,
 845         .g_timings = ov2710_g_timings,
 846         .set_flip = ov2710_set_flip,
 847         .check_camera_id = ov2710_check_camera_id,
 848         .configs = ov2710_configs,
 849         .num_configs = ARRAY_SIZE(ov2710_configs),
 850         .power_up_delays_ms = {5, 30, 30}
 851 };
 852
 853 static int ov2710_probe(
 854         struct i2c_client *client,
 855         const struct i2c_device_id *id)
 856 {
 857         dev_info(&client->dev, "probing...\n");
 858
 859         ov2710_filltimings(&ov2710_custom_config);
 860         v4l2_i2c_subdev_init(&ov2710.sd, client,
 861                                 &ov2710_camera_module_ops);
 862
 863         ov2710.custom = ov2710_custom_config;
 864
 865         dev_info(&client->dev, "probing successful\n");
 866         return 0;
 867 }
 868
 869 /* ======================================================================== */
 870
 871 static int ov2710_remove(
 872         struct i2c_client *client)
 873 {
 874         struct ov_camera_module *cam_mod = i2c_get_clientdata(client);
 875
 876         dev_info(&client->dev, "removing device...\n");
 877
 878         if (!client->adapter)
 879                 return -ENODEV; /* our client isn't attached */
 880
 881         ov_camera_module_release(cam_mod);
 882
 883         dev_info(&client->dev, "removed\n");
 884         return 0;
 885 }
 886
 887 static const struct i2c_device_id ov2710_id[] = {
 888         { OV2710_DRIVER_NAME, 0 },
 889         { }
 890 };
 891
 892 static const struct of_device_id ov2710_of_match[] = {
 893         {.compatible = "omnivision,ov2710-v4l2-i2c-subdev"},
 894         {},
 895 };
 896
 897 MODULE_DEVICE_TABLE(i2c, ov2710_id);
 898
 899 static struct i2c_driver ov2710_i2c_driver = {
 900         .driver = {
 901                 .name = OV2710_DRIVER_NAME,
 902                 .owner = THIS_MODULE,
 903                 .of_match_table = ov2710_of_match
 904         },
 905         .probe = ov2710_probe,
 906         .remove = ov2710_remove,
 907         .id_table = ov2710_id,
 908 };
 909
 910 module_i2c_driver(ov2710_i2c_driver);
 911
 912 MODULE_DESCRIPTION("SoC Camera driver for ov2710");
 913 MODULE_AUTHOR("Eike Grimpe");
 914 MODULE_LICENSE("GPL");
 915