drivers/media/i2c/ov2685.c

   1 // SPDX-License-Identifier: GPL-2.0
   2 /*
   3  * ov2685 driver
   4  *
   5  * Copyright (C) 2017 Fuzhou Rockchip Electronics Co., Ltd.
   6  */
   7
   8 #include <linux/clk.h>
   9 #include <linux/device.h>
  10 #include <linux/delay.h>
  11 #include <linux/gpio/consumer.h>
  12 #include <linux/i2c.h>
  13 #include <linux/module.h>
  14 #include <linux/pm_runtime.h>
  15 #include <linux/regulator/consumer.h>
  16 #include <linux/sysfs.h>
  17 #include <media/media-entity.h>
  18 #include <media/v4l2-async.h>
  19 #include <media/v4l2-ctrls.h>
  20 #include <media/v4l2-fwnode.h>
  21 #include <media/v4l2-subdev.h>
  22
  23 #define CHIP_ID                         0x2685
  24 #define OV2685_REG_CHIP_ID              0x300a
  25
  26 #define OV2685_XVCLK_FREQ               24000000
  27
  28 #define REG_SC_CTRL_MODE                0x0100
  29 #define     SC_CTRL_MODE_STANDBY        0x0
  30 #define     SC_CTRL_MODE_STREAMING      BIT(0)
  31
  32 #define OV2685_REG_EXPOSURE             0x3500
  33 #define OV2685_EXPOSURE_MIN             4
  34 #define OV2685_EXPOSURE_STEP            1
  35
  36 #define OV2685_REG_VTS                  0x380e
  37 #define OV2685_VTS_MAX                  0x7fff
  38
  39 #define OV2685_REG_GAIN                 0x350a
  40 #define OV2685_GAIN_MIN                 0
  41 #define OV2685_GAIN_MAX                 0x07ff
  42 #define OV2685_GAIN_STEP                0x1
  43 #define OV2685_GAIN_DEFAULT             0x0036
  44
  45 #define OV2685_REG_TEST_PATTERN         0x5080
  46 #define OV2685_TEST_PATTERN_DISABLED            0x00
  47 #define OV2685_TEST_PATTERN_COLOR_BAR           0x80
  48 #define OV2685_TEST_PATTERN_RANDOM              0x81
  49 #define OV2685_TEST_PATTERN_COLOR_BAR_FADE      0x88
  50 #define OV2685_TEST_PATTERN_BW_SQUARE           0x92
  51 #define OV2685_TEST_PATTERN_COLOR_SQUARE        0x82
  52
  53 #define REG_NULL                        0xFFFF
  54
  55 #define OV2685_REG_VALUE_08BIT          1
  56 #define OV2685_REG_VALUE_16BIT          2
  57 #define OV2685_REG_VALUE_24BIT          3
  58
  59 #define OV2685_NATIVE_WIDTH             1616
  60 #define OV2685_NATIVE_HEIGHT            1216
  61
  62 #define OV2685_LANES                    1
  63 #define OV2685_BITS_PER_SAMPLE          10
  64
  65 static const char * const ov2685_supply_names[] = {
  66         "avdd",         /* Analog power */
  67         "dovdd",        /* Digital I/O power */
  68         "dvdd",         /* Digital core power */
  69 };
  70
  71 #define OV2685_NUM_SUPPLIES ARRAY_SIZE(ov2685_supply_names)
  72
  73 struct regval {
  74         u16 addr;
  75         u8 val;
  76 };
  77
  78 struct ov2685_mode {
  79         u32 width;
  80         u32 height;
  81         u32 exp_def;
  82         u32 hts_def;
  83         u32 vts_def;
  84         const struct v4l2_rect *analog_crop;
  85         const struct regval *reg_list;
  86 };
  87
  88 struct ov2685 {
  89         struct i2c_client       *client;
  90         struct clk              *xvclk;
  91         struct gpio_desc        *reset_gpio;
  92         struct regulator_bulk_data supplies[OV2685_NUM_SUPPLIES];
  93
  94         struct mutex            mutex;
  95         struct v4l2_subdev      subdev;
  96         struct media_pad        pad;
  97         struct v4l2_ctrl        *anal_gain;
  98         struct v4l2_ctrl        *exposure;
  99         struct v4l2_ctrl        *hblank;
 100         struct v4l2_ctrl        *vblank;
 101         struct v4l2_ctrl        *test_pattern;
 102         struct v4l2_ctrl_handler ctrl_handler;
 103
 104         const struct ov2685_mode *cur_mode;
 105 };
 106
 107 #define to_ov2685(sd) container_of(sd, struct ov2685, subdev)
 108
 109 /* PLL settings bases on 24M xvclk */
 110 static struct regval ov2685_1600x1200_regs[] = {
 111         {0x0103, 0x01},
 112         {0x0100, 0x00},
 113         {0x3002, 0x00},
 114         {0x3016, 0x1c},
 115         {0x3018, 0x44},
 116         {0x301d, 0xf0},
 117         {0x3020, 0x00},
 118         {0x3082, 0x37},
 119         {0x3083, 0x03},
 120         {0x3084, 0x09},
 121         {0x3085, 0x04},
 122         {0x3086, 0x00},
 123         {0x3087, 0x00},
 124         {0x3501, 0x4e},
 125         {0x3502, 0xe0},
 126         {0x3503, 0x27},
 127         {0x350b, 0x36},
 128         {0x3600, 0xb4},
 129         {0x3603, 0x35},
 130         {0x3604, 0x24},
 131         {0x3605, 0x00},
 132         {0x3620, 0x24},
 133         {0x3621, 0x34},
 134         {0x3622, 0x03},
 135         {0x3628, 0x10},
 136         {0x3705, 0x3c},
 137         {0x370a, 0x21},
 138         {0x370c, 0x50},
 139         {0x370d, 0xc0},
 140         {0x3717, 0x58},
 141         {0x3718, 0x80},
 142         {0x3720, 0x00},
 143         {0x3721, 0x09},
 144         {0x3722, 0x06},
 145         {0x3723, 0x59},
 146         {0x3738, 0x99},
 147         {0x3781, 0x80},
 148         {0x3784, 0x0c},
 149         {0x3789, 0x60},
 150         {0x3800, 0x00},
 151         {0x3801, 0x00},
 152         {0x3802, 0x00},
 153         {0x3803, 0x00},
 154         {0x3804, 0x06},
 155         {0x3805, 0x4f},
 156         {0x3806, 0x04},
 157         {0x3807, 0xbf},
 158         {0x3808, 0x06},
 159         {0x3809, 0x40},
 160         {0x380a, 0x04},
 161         {0x380b, 0xb0},
 162         {0x380c, 0x06},
 163         {0x380d, 0xa4},
 164         {0x380e, 0x05},
 165         {0x380f, 0x0e},
 166         {0x3810, 0x00},
 167         {0x3811, 0x08},
 168         {0x3812, 0x00},
 169         {0x3813, 0x08},
 170         {0x3814, 0x11},
 171         {0x3815, 0x11},
 172         {0x3819, 0x04},
 173         {0x3820, 0xc0},
 174         {0x3821, 0x00},
 175         {0x3a06, 0x01},
 176         {0x3a07, 0x84},
 177         {0x3a08, 0x01},
 178         {0x3a09, 0x43},
 179         {0x3a0a, 0x24},
 180         {0x3a0b, 0x60},
 181         {0x3a0c, 0x28},
 182         {0x3a0d, 0x60},
 183         {0x3a0e, 0x04},
 184         {0x3a0f, 0x8c},
 185         {0x3a10, 0x05},
 186         {0x3a11, 0x0c},
 187         {0x4000, 0x81},
 188         {0x4001, 0x40},
 189         {0x4008, 0x02},
 190         {0x4009, 0x09},
 191         {0x4300, 0x00},
 192         {0x430e, 0x00},
 193         {0x4602, 0x02},
 194         {0x481b, 0x40},
 195         {0x481f, 0x40},
 196         {0x4837, 0x18},
 197         {0x5000, 0x1f},
 198         {0x5001, 0x05},
 199         {0x5002, 0x30},
 200         {0x5003, 0x04},
 201         {0x5004, 0x00},
 202         {0x5005, 0x0c},
 203         {0x5280, 0x15},
 204         {0x5281, 0x06},
 205         {0x5282, 0x06},
 206         {0x5283, 0x08},
 207         {0x5284, 0x1c},
 208         {0x5285, 0x1c},
 209         {0x5286, 0x20},
 210         {0x5287, 0x10},
 211         {REG_NULL, 0x00}
 212 };
 213
 214 #define OV2685_LINK_FREQ_330MHZ         330000000
 215 static const s64 link_freq_menu_items[] = {
 216         OV2685_LINK_FREQ_330MHZ
 217 };
 218
 219 static const char * const ov2685_test_pattern_menu[] = {
 220         "Disabled",
 221         "Color Bar",
 222         "Color Bar FADE",
 223         "Random Data",
 224         "Black White Square",
 225         "Color Square"
 226 };
 227
 228 static const int ov2685_test_pattern_val[] = {
 229         OV2685_TEST_PATTERN_DISABLED,
 230         OV2685_TEST_PATTERN_COLOR_BAR,
 231         OV2685_TEST_PATTERN_COLOR_BAR_FADE,
 232         OV2685_TEST_PATTERN_RANDOM,
 233         OV2685_TEST_PATTERN_BW_SQUARE,
 234         OV2685_TEST_PATTERN_COLOR_SQUARE,
 235 };
 236
 237 static const struct v4l2_rect ov2685_analog_crop = {
 238         .left   = 8,
 239         .top    = 8,
 240         .width  = 1600,
 241         .height = 1200,
 242 };
 243
 244 static const struct ov2685_mode supported_modes[] = {
 245         {
 246                 .width = 1600,
 247                 .height = 1200,
 248                 .exp_def = 0x04ee,
 249                 .hts_def = 0x06a4,
 250                 .vts_def = 0x050e,
 251                 .analog_crop = &ov2685_analog_crop,
 252                 .reg_list = ov2685_1600x1200_regs,
 253         },
 254 };
 255
 256 /* Write registers up to 4 at a time */
 257 static int ov2685_write_reg(struct i2c_client *client, u16 reg,
 258                             u32 len, u32 val)
 259 {
 260         u32 val_i, buf_i;
 261         u8 buf[6];
 262         u8 *val_p;
 263         __be32 val_be;
 264
 265         if (len > 4)
 266                 return -EINVAL;
 267
 268         buf[0] = reg >> 8;
 269         buf[1] = reg & 0xff;
 270
 271         val_be = cpu_to_be32(val);
 272         val_p = (u8 *)&val_be;
 273         buf_i = 2;
 274         val_i = 4 - len;
 275
 276         while (val_i < 4)
 277                 buf[buf_i++] = val_p[val_i++];
 278
 279         if (i2c_master_send(client, buf, len + 2) != len + 2)
 280                 return -EIO;
 281
 282         return 0;
 283 }
 284
 285 static int ov2685_write_array(struct i2c_client *client,
 286                               const struct regval *regs)
 287 {
 288         int ret = 0;
 289         u32 i;
 290
 291         for (i = 0; ret == 0 && regs[i].addr != REG_NULL; i++)
 292                 ret = ov2685_write_reg(client, regs[i].addr,
 293                                        OV2685_REG_VALUE_08BIT, regs[i].val);
 294
 295         return ret;
 296 }
 297
 298 /* Read registers up to 4 at a time */
 299 static int ov2685_read_reg(struct i2c_client *client, u16 reg,
 300                            u32 len, u32 *val)
 301 {
 302         struct i2c_msg msgs[2];
 303         u8 *data_be_p;
 304         __be32 data_be = 0;
 305         __be16 reg_addr_be = cpu_to_be16(reg);
 306         int ret;
 307
 308         if (len > 4)
 309                 return -EINVAL;
 310
 311         data_be_p = (u8 *)&data_be;
 312         /* Write register address */
 313         msgs[0].addr = client->addr;
 314         msgs[0].flags = 0;
 315         msgs[0].len = 2;
 316         msgs[0].buf = (u8 *)&reg_addr_be;
 317
 318         /* Read data from register */
 319         msgs[1].addr = client->addr;
 320         msgs[1].flags = I2C_M_RD;
 321         msgs[1].len = len;
 322         msgs[1].buf = &data_be_p[4 - len];
 323
 324         ret = i2c_transfer(client->adapter, msgs, ARRAY_SIZE(msgs));
 325         if (ret != ARRAY_SIZE(msgs))
 326                 return -EIO;
 327
 328         *val = be32_to_cpu(data_be);
 329
 330         return 0;
 331 }
 332
 333 static void ov2685_fill_fmt(const struct ov2685_mode *mode,
 334                             struct v4l2_mbus_framefmt *fmt)
 335 {
 336         fmt->code = MEDIA_BUS_FMT_SBGGR10_1X10;
 337         fmt->width = mode->width;
 338         fmt->height = mode->height;
 339         fmt->field = V4L2_FIELD_NONE;
 340 }
 341
 342 static int ov2685_set_fmt(struct v4l2_subdev *sd,
 343                           struct v4l2_subdev_state *sd_state,
 344                           struct v4l2_subdev_format *fmt)
 345 {
 346         struct ov2685 *ov2685 = to_ov2685(sd);
 347         struct v4l2_mbus_framefmt *mbus_fmt = &fmt->format;
 348
 349         /* only one mode supported for now */
 350         ov2685_fill_fmt(ov2685->cur_mode, mbus_fmt);
 351
 352         return 0;
 353 }
 354
 355 static int ov2685_get_fmt(struct v4l2_subdev *sd,
 356                           struct v4l2_subdev_state *sd_state,
 357                           struct v4l2_subdev_format *fmt)
 358 {
 359         struct ov2685 *ov2685 = to_ov2685(sd);
 360         struct v4l2_mbus_framefmt *mbus_fmt = &fmt->format;
 361
 362         ov2685_fill_fmt(ov2685->cur_mode, mbus_fmt);
 363
 364         return 0;
 365 }
 366
 367 static int ov2685_enum_mbus_code(struct v4l2_subdev *sd,
 368                                  struct v4l2_subdev_state *sd_state,
 369                                  struct v4l2_subdev_mbus_code_enum *code)
 370 {
 371         if (code->index >= ARRAY_SIZE(supported_modes))
 372                 return -EINVAL;
 373
 374         code->code = MEDIA_BUS_FMT_SBGGR10_1X10;
 375
 376         return 0;
 377 }
 378
 379 static int ov2685_enum_frame_sizes(struct v4l2_subdev *sd,
 380                                    struct v4l2_subdev_state *sd_state,
 381                                    struct v4l2_subdev_frame_size_enum *fse)
 382 {
 383         int index = fse->index;
 384
 385         if (index >= ARRAY_SIZE(supported_modes))
 386                 return -EINVAL;
 387
 388         fse->code = MEDIA_BUS_FMT_SBGGR10_1X10;
 389
 390         fse->min_width  = supported_modes[index].width;
 391         fse->max_width  = supported_modes[index].width;
 392         fse->max_height = supported_modes[index].height;
 393         fse->min_height = supported_modes[index].height;
 394
 395         return 0;
 396 }
 397
 398 static const struct v4l2_rect *
 399 __ov2685_get_pad_crop(struct ov2685 *ov2685,
 400                       struct v4l2_subdev_state *state, unsigned int pad,
 401                       enum v4l2_subdev_format_whence which)
 402 {
 403         const struct ov2685_mode *mode = ov2685->cur_mode;
 404
 405         switch (which) {
 406         case V4L2_SUBDEV_FORMAT_TRY:
 407                 return v4l2_subdev_get_try_crop(&ov2685->subdev, state, pad);
 408         case V4L2_SUBDEV_FORMAT_ACTIVE:
 409                 return mode->analog_crop;
 410         }
 411
 412         return NULL;
 413 }
 414
 415 static int ov2685_get_selection(struct v4l2_subdev *sd,
 416                                 struct v4l2_subdev_state *sd_state,
 417                                 struct v4l2_subdev_selection *sel)
 418 {
 419         struct ov2685 *ov2685 = to_ov2685(sd);
 420
 421         switch (sel->target) {
 422         case V4L2_SEL_TGT_CROP:
 423                 mutex_lock(&ov2685->mutex);
 424                 sel->r = *__ov2685_get_pad_crop(ov2685, sd_state, sel->pad,
 425                                 sel->which);
 426                 mutex_unlock(&ov2685->mutex);
 427                 break;
 428         case V4L2_SEL_TGT_NATIVE_SIZE:
 429         case V4L2_SEL_TGT_CROP_BOUNDS:
 430                 sel->r.top = 0;
 431                 sel->r.left = 0;
 432                 sel->r.width = OV2685_NATIVE_WIDTH;
 433                 sel->r.height = OV2685_NATIVE_HEIGHT;
 434                 break;
 435         case V4L2_SEL_TGT_CROP_DEFAULT:
 436                 sel->r = ov2685_analog_crop;
 437                 break;
 438         default:
 439                 return -EINVAL;
 440         }
 441
 442         return 0;
 443 }
 444
 445 /* Calculate the delay in us by clock rate and clock cycles */
 446 static inline u32 ov2685_cal_delay(u32 cycles)
 447 {
 448         return DIV_ROUND_UP(cycles, OV2685_XVCLK_FREQ / 1000 / 1000);
 449 }
 450
 451 static int __ov2685_power_on(struct ov2685 *ov2685)
 452 {
 453         int ret;
 454         u32 delay_us;
 455         struct device *dev = &ov2685->client->dev;
 456
 457         ret = clk_prepare_enable(ov2685->xvclk);
 458         if (ret < 0) {
 459                 dev_err(dev, "Failed to enable xvclk\n");
 460                 return ret;
 461         }
 462
 463         gpiod_set_value_cansleep(ov2685->reset_gpio, 1);
 464
 465         ret = regulator_bulk_enable(OV2685_NUM_SUPPLIES, ov2685->supplies);
 466         if (ret < 0) {
 467                 dev_err(dev, "Failed to enable regulators\n");
 468                 goto disable_clk;
 469         }
 470
 471         /* The minimum delay between power supplies and reset rising can be 0 */
 472         gpiod_set_value_cansleep(ov2685->reset_gpio, 0);
 473         /* 8192 xvclk cycles prior to the first SCCB transaction */
 474         delay_us = ov2685_cal_delay(8192);
 475         usleep_range(delay_us, delay_us * 2);
 476
 477         /* HACK: ov2685 would output messy data after reset(R0103),
 478          * writing register before .s_stream() as a workaround
 479          */
 480         ret = ov2685_write_array(ov2685->client, ov2685->cur_mode->reg_list);
 481         if (ret) {
 482                 dev_err(dev, "Failed to set regs for power on\n");
 483                 goto disable_supplies;
 484         }
 485
 486         return 0;
 487
 488 disable_supplies:
 489         regulator_bulk_disable(OV2685_NUM_SUPPLIES, ov2685->supplies);
 490 disable_clk:
 491         clk_disable_unprepare(ov2685->xvclk);
 492
 493         return ret;
 494 }
 495
 496 static void __ov2685_power_off(struct ov2685 *ov2685)
 497 {
 498         /* 512 xvclk cycles after the last SCCB transaction or MIPI frame end */
 499         u32 delay_us = ov2685_cal_delay(512);
 500
 501         usleep_range(delay_us, delay_us * 2);
 502         clk_disable_unprepare(ov2685->xvclk);
 503         gpiod_set_value_cansleep(ov2685->reset_gpio, 1);
 504         regulator_bulk_disable(OV2685_NUM_SUPPLIES, ov2685->supplies);
 505 }
 506
 507 static int ov2685_s_stream(struct v4l2_subdev *sd, int on)
 508 {
 509         struct ov2685 *ov2685 = to_ov2685(sd);
 510         struct i2c_client *client = ov2685->client;
 511         int ret = 0;
 512
 513         mutex_lock(&ov2685->mutex);
 514
 515         if (on) {
 516                 ret = pm_runtime_resume_and_get(&ov2685->client->dev);
 517                 if (ret < 0)
 518                         goto unlock_and_return;
 519
 520                 ret = __v4l2_ctrl_handler_setup(&ov2685->ctrl_handler);
 521                 if (ret) {
 522                         pm_runtime_put(&client->dev);
 523                         goto unlock_and_return;
 524                 }
 525                 ret = ov2685_write_reg(client, REG_SC_CTRL_MODE,
 526                                 OV2685_REG_VALUE_08BIT, SC_CTRL_MODE_STREAMING);
 527                 if (ret) {
 528                         pm_runtime_put(&client->dev);
 529                         goto unlock_and_return;
 530                 }
 531         } else {
 532                 ov2685_write_reg(client, REG_SC_CTRL_MODE,
 533                                 OV2685_REG_VALUE_08BIT, SC_CTRL_MODE_STANDBY);
 534                 pm_runtime_put(&ov2685->client->dev);
 535         }
 536
 537 unlock_and_return:
 538         mutex_unlock(&ov2685->mutex);
 539
 540         return ret;
 541 }
 542
 543 static int ov2685_open(struct v4l2_subdev *sd, struct v4l2_subdev_fh *fh)
 544 {
 545         struct ov2685 *ov2685 = to_ov2685(sd);
 546         struct v4l2_mbus_framefmt *try_fmt;
 547
 548         mutex_lock(&ov2685->mutex);
 549
 550         try_fmt = v4l2_subdev_get_try_format(sd, fh->state, 0);
 551         /* Initialize try_fmt */
 552         ov2685_fill_fmt(&supported_modes[0], try_fmt);
 553
 554         mutex_unlock(&ov2685->mutex);
 555
 556         return 0;
 557 }
 558
 559 static int __maybe_unused ov2685_runtime_resume(struct device *dev)
 560 {
 561         struct v4l2_subdev *sd = dev_get_drvdata(dev);
 562         struct ov2685 *ov2685 = to_ov2685(sd);
 563
 564         return __ov2685_power_on(ov2685);
 565 }
 566
 567 static int __maybe_unused ov2685_runtime_suspend(struct device *dev)
 568 {
 569         struct v4l2_subdev *sd = dev_get_drvdata(dev);
 570         struct ov2685 *ov2685 = to_ov2685(sd);
 571
 572         __ov2685_power_off(ov2685);
 573
 574         return 0;
 575 }
 576
 577 static const struct dev_pm_ops ov2685_pm_ops = {
 578         SET_RUNTIME_PM_OPS(ov2685_runtime_suspend,
 579                            ov2685_runtime_resume, NULL)
 580 };
 581
 582 static int ov2685_set_ctrl(struct v4l2_ctrl *ctrl)
 583 {
 584         struct ov2685 *ov2685 = container_of(ctrl->handler,
 585                                              struct ov2685, ctrl_handler);
 586         struct i2c_client *client = ov2685->client;
 587         s64 max_expo;
 588         int ret;
 589
 590         /* Propagate change of current control to all related controls */
 591         switch (ctrl->id) {
 592         case V4L2_CID_VBLANK:
 593                 /* Update max exposure while meeting expected vblanking */
 594                 max_expo = ov2685->cur_mode->height + ctrl->val - 4;
 595                 __v4l2_ctrl_modify_range(ov2685->exposure,
 596                                          ov2685->exposure->minimum, max_expo,
 597                                          ov2685->exposure->step,
 598                                          ov2685->exposure->default_value);
 599                 break;
 600         }
 601
 602         if (!pm_runtime_get_if_in_use(&client->dev))
 603                 return 0;
 604
 605         switch (ctrl->id) {
 606         case V4L2_CID_EXPOSURE:
 607                 ret = ov2685_write_reg(ov2685->client, OV2685_REG_EXPOSURE,
 608                                        OV2685_REG_VALUE_24BIT, ctrl->val << 4);
 609                 break;
 610         case V4L2_CID_ANALOGUE_GAIN:
 611                 ret = ov2685_write_reg(ov2685->client, OV2685_REG_GAIN,
 612                                        OV2685_REG_VALUE_16BIT, ctrl->val);
 613                 break;
 614         case V4L2_CID_VBLANK:
 615                 ret = ov2685_write_reg(ov2685->client, OV2685_REG_VTS,
 616                                        OV2685_REG_VALUE_16BIT,
 617                                        ctrl->val + ov2685->cur_mode->height);
 618                 break;
 619         case V4L2_CID_TEST_PATTERN:
 620                 ret = ov2685_write_reg(ov2685->client, OV2685_REG_TEST_PATTERN,
 621                                        OV2685_REG_VALUE_08BIT,
 622                                        ov2685_test_pattern_val[ctrl->val]);
 623                 break;
 624         default:
 625                 dev_warn(&client->dev, "%s Unhandled id:0x%x, val:0x%x\n",
 626                          __func__, ctrl->id, ctrl->val);
 627                 ret = -EINVAL;
 628                 break;
 629         }
 630
 631         pm_runtime_put(&client->dev);
 632
 633         return ret;
 634 }
 635
 636 static const struct v4l2_subdev_video_ops ov2685_video_ops = {
 637         .s_stream = ov2685_s_stream,
 638 };
 639
 640 static const struct v4l2_subdev_pad_ops ov2685_pad_ops = {
 641         .enum_mbus_code = ov2685_enum_mbus_code,
 642         .enum_frame_size = ov2685_enum_frame_sizes,
 643         .get_fmt = ov2685_get_fmt,
 644         .set_fmt = ov2685_set_fmt,
 645         .get_selection = ov2685_get_selection,
 646         .set_selection = ov2685_get_selection,
 647 };
 648
 649 static const struct v4l2_subdev_ops ov2685_subdev_ops = {
 650         .video  = &ov2685_video_ops,
 651         .pad    = &ov2685_pad_ops,
 652 };
 653
 654 static const struct v4l2_subdev_internal_ops ov2685_internal_ops = {
 655         .open = ov2685_open,
 656 };
 657
 658 static const struct v4l2_ctrl_ops ov2685_ctrl_ops = {
 659         .s_ctrl = ov2685_set_ctrl,
 660 };
 661
 662 static int ov2685_initialize_controls(struct ov2685 *ov2685)
 663 {
 664         const struct ov2685_mode *mode;
 665         struct v4l2_ctrl_handler *handler;
 666         struct v4l2_ctrl *ctrl;
 667         struct v4l2_fwnode_device_properties props;
 668         u64 exposure_max;
 669         u32 pixel_rate, h_blank;
 670         int ret;
 671
 672         handler = &ov2685->ctrl_handler;
 673         mode = ov2685->cur_mode;
 674         ret = v4l2_ctrl_handler_init(handler, 10);
 675         if (ret)
 676                 return ret;
 677         handler->lock = &ov2685->mutex;
 678
 679         ctrl = v4l2_ctrl_new_int_menu(handler, NULL, V4L2_CID_LINK_FREQ,
 680                                       0, 0, link_freq_menu_items);
 681         if (ctrl)
 682                 ctrl->flags |= V4L2_CTRL_FLAG_READ_ONLY;
 683
 684         pixel_rate = (link_freq_menu_items[0] * 2 * OV2685_LANES) /
 685                      OV2685_BITS_PER_SAMPLE;
 686         v4l2_ctrl_new_std(handler, NULL, V4L2_CID_PIXEL_RATE,
 687                           0, pixel_rate, 1, pixel_rate);
 688
 689         h_blank = mode->hts_def - mode->width;
 690         ov2685->hblank = v4l2_ctrl_new_std(handler, NULL, V4L2_CID_HBLANK,
 691                                 h_blank, h_blank, 1, h_blank);
 692         if (ov2685->hblank)
 693                 ov2685->hblank->flags |= V4L2_CTRL_FLAG_READ_ONLY;
 694
 695         ov2685->vblank = v4l2_ctrl_new_std(handler, &ov2685_ctrl_ops,
 696                                 V4L2_CID_VBLANK, mode->vts_def - mode->height,
 697                                 OV2685_VTS_MAX - mode->height, 1,
 698                                 mode->vts_def - mode->height);
 699
 700         exposure_max = mode->vts_def - 4;
 701         ov2685->exposure = v4l2_ctrl_new_std(handler, &ov2685_ctrl_ops,
 702                                 V4L2_CID_EXPOSURE, OV2685_EXPOSURE_MIN,
 703                                 exposure_max, OV2685_EXPOSURE_STEP,
 704                                 mode->exp_def);
 705
 706         ov2685->anal_gain = v4l2_ctrl_new_std(handler, &ov2685_ctrl_ops,
 707                                 V4L2_CID_ANALOGUE_GAIN, OV2685_GAIN_MIN,
 708                                 OV2685_GAIN_MAX, OV2685_GAIN_STEP,
 709                                 OV2685_GAIN_DEFAULT);
 710
 711         ov2685->test_pattern = v4l2_ctrl_new_std_menu_items(handler,
 712                                 &ov2685_ctrl_ops, V4L2_CID_TEST_PATTERN,
 713                                 ARRAY_SIZE(ov2685_test_pattern_menu) - 1,
 714                                 0, 0, ov2685_test_pattern_menu);
 715
 716         /* set properties from fwnode (e.g. rotation, orientation) */
 717         ret = v4l2_fwnode_device_parse(&ov2685->client->dev, &props);
 718         if (ret)
 719                 goto err_free_handler;
 720
 721         ret = v4l2_ctrl_new_fwnode_properties(handler, &ov2685_ctrl_ops, &props);
 722         if (ret)
 723                 goto err_free_handler;
 724
 725         if (handler->error) {
 726                 ret = handler->error;
 727                 dev_err(&ov2685->client->dev,
 728                         "Failed to init controls(%d)\n", ret);
 729                 goto err_free_handler;
 730         }
 731
 732         ov2685->subdev.ctrl_handler = handler;
 733
 734         return 0;
 735
 736 err_free_handler:
 737         v4l2_ctrl_handler_free(handler);
 738
 739         return ret;
 740 }
 741
 742 static int ov2685_check_sensor_id(struct ov2685 *ov2685,
 743                                   struct i2c_client *client)
 744 {
 745         struct device *dev = &ov2685->client->dev;
 746         int ret;
 747         u32 id = 0;
 748
 749         ret = ov2685_read_reg(client, OV2685_REG_CHIP_ID,
 750                               OV2685_REG_VALUE_16BIT, &id);
 751         if (id != CHIP_ID) {
 752                 dev_err(dev, "Unexpected sensor id(%04x), ret(%d)\n", id, ret);
 753                 return ret;
 754         }
 755
 756         dev_info(dev, "Detected OV%04x sensor\n", CHIP_ID);
 757
 758         return 0;
 759 }
 760
 761 static int ov2685_configure_regulators(struct ov2685 *ov2685)
 762 {
 763         int i;
 764
 765         for (i = 0; i < OV2685_NUM_SUPPLIES; i++)
 766                 ov2685->supplies[i].supply = ov2685_supply_names[i];
 767
 768         return devm_regulator_bulk_get(&ov2685->client->dev,
 769                                        OV2685_NUM_SUPPLIES,
 770                                        ov2685->supplies);
 771 }
 772
 773 static int ov2685_probe(struct i2c_client *client)
 774 {
 775         struct device *dev = &client->dev;
 776         struct ov2685 *ov2685;
 777         int ret;
 778
 779         ov2685 = devm_kzalloc(dev, sizeof(*ov2685), GFP_KERNEL);
 780         if (!ov2685)
 781                 return -ENOMEM;
 782
 783         ov2685->client = client;
 784         ov2685->cur_mode = &supported_modes[0];
 785
 786         ov2685->xvclk = devm_clk_get(dev, "xvclk");
 787         if (IS_ERR(ov2685->xvclk)) {
 788                 dev_err(dev, "Failed to get xvclk\n");
 789                 return -EINVAL;
 790         }
 791         ret = clk_set_rate(ov2685->xvclk, OV2685_XVCLK_FREQ);
 792         if (ret < 0) {
 793                 dev_err(dev, "Failed to set xvclk rate (24MHz)\n");
 794                 return ret;
 795         }
 796         if (clk_get_rate(ov2685->xvclk) != OV2685_XVCLK_FREQ)
 797                 dev_warn(dev, "xvclk mismatched, modes are based on 24MHz\n");
 798
 799         ov2685->reset_gpio = devm_gpiod_get_optional(dev, "reset", GPIOD_OUT_LOW);
 800         if (IS_ERR(ov2685->reset_gpio)) {
 801                 dev_err(dev, "Failed to get reset-gpios\n");
 802                 return -EINVAL;
 803         }
 804
 805         ret = ov2685_configure_regulators(ov2685);
 806         if (ret) {
 807                 dev_err(dev, "Failed to get power regulators\n");
 808                 return ret;
 809         }
 810
 811         mutex_init(&ov2685->mutex);
 812         v4l2_i2c_subdev_init(&ov2685->subdev, client, &ov2685_subdev_ops);
 813         ret = ov2685_initialize_controls(ov2685);
 814         if (ret)
 815                 goto err_destroy_mutex;
 816
 817         ret = __ov2685_power_on(ov2685);
 818         if (ret)
 819                 goto err_free_handler;
 820
 821         ret = ov2685_check_sensor_id(ov2685, client);
 822         if (ret)
 823                 goto err_power_off;
 824
 825         ov2685->subdev.internal_ops = &ov2685_internal_ops;
 826         ov2685->subdev.flags |= V4L2_SUBDEV_FL_HAS_DEVNODE;
 827         ov2685->pad.flags = MEDIA_PAD_FL_SOURCE;
 828         ov2685->subdev.entity.function = MEDIA_ENT_F_CAM_SENSOR;
 829         ret = media_entity_pads_init(&ov2685->subdev.entity, 1, &ov2685->pad);
 830         if (ret < 0)
 831                 goto err_power_off;
 832
 833         ret = v4l2_async_register_subdev(&ov2685->subdev);
 834         if (ret) {
 835                 dev_err(dev, "v4l2 async register subdev failed\n");
 836                 goto err_clean_entity;
 837         }
 838
 839         pm_runtime_set_active(dev);
 840         pm_runtime_enable(dev);
 841         pm_runtime_idle(dev);
 842
 843         return 0;
 844
 845 err_clean_entity:
 846         media_entity_cleanup(&ov2685->subdev.entity);
 847 err_power_off:
 848         __ov2685_power_off(ov2685);
 849 err_free_handler:
 850         v4l2_ctrl_handler_free(&ov2685->ctrl_handler);
 851 err_destroy_mutex:
 852         mutex_destroy(&ov2685->mutex);
 853
 854         return ret;
 855 }
 856
 857 static void ov2685_remove(struct i2c_client *client)
 858 {
 859         struct v4l2_subdev *sd = i2c_get_clientdata(client);
 860         struct ov2685 *ov2685 = to_ov2685(sd);
 861
 862         v4l2_async_unregister_subdev(sd);
 863         media_entity_cleanup(&sd->entity);
 864         v4l2_ctrl_handler_free(&ov2685->ctrl_handler);
 865         mutex_destroy(&ov2685->mutex);
 866
 867         pm_runtime_disable(&client->dev);
 868         if (!pm_runtime_status_suspended(&client->dev))
 869                 __ov2685_power_off(ov2685);
 870         pm_runtime_set_suspended(&client->dev);
 871 }
 872
 873 #if IS_ENABLED(CONFIG_OF)
 874 static const struct of_device_id ov2685_of_match[] = {
 875         { .compatible = "ovti,ov2685" },
 876         {},
 877 };
 878 MODULE_DEVICE_TABLE(of, ov2685_of_match);
 879 #endif
 880
 881 static struct i2c_driver ov2685_i2c_driver = {
 882         .driver = {
 883                 .name = "ov2685",
 884                 .pm = &ov2685_pm_ops,
 885                 .of_match_table = of_match_ptr(ov2685_of_match),
 886         },
 887         .probe          = ov2685_probe,
 888         .remove         = ov2685_remove,
 889 };
 890
 891 module_i2c_driver(ov2685_i2c_driver);
 892
 893 MODULE_DESCRIPTION("OmniVision ov2685 sensor driver");
 894 MODULE_LICENSE("GPL v2");