1 // SPDX-License-Identifier: GPL-2.0 2 /* 3 * imx214.c - imx214 sensor driver 4 * 5 * Copyright 2018 Qtechnology A/S 6 * 7 * Ricardo Ribalda <ribalda@kernel.org> 8 */ 9 #include <linux/clk.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/regmap.h> 16 #include <linux/regulator/consumer.h> 17 #include <media/media-entity.h> 18 #include <media/v4l2-ctrls.h> 19 #include <media/v4l2-fwnode.h> 20 #include <media/v4l2-subdev.h> 21 22 #define IMX214_DEFAULT_CLK_FREQ 24000000 23 #define IMX214_DEFAULT_LINK_FREQ 480000000 24 #define IMX214_DEFAULT_PIXEL_RATE ((IMX214_DEFAULT_LINK_FREQ * 8LL) / 10) 25 #define IMX214_FPS 30 26 #define IMX214_MBUS_CODE MEDIA_BUS_FMT_SRGGB10_1X10 27 28 static const char * const imx214_supply_name[] = { 29 "vdda", 30 "vddd", 31 "vdddo", 32 }; 33 34 #define IMX214_NUM_SUPPLIES ARRAY_SIZE(imx214_supply_name) 35 36 struct imx214 { 37 struct device *dev; 38 struct clk *xclk; 39 struct regmap *regmap; 40 41 struct v4l2_subdev sd; 42 struct media_pad pad; 43 struct v4l2_mbus_framefmt fmt; 44 struct v4l2_rect crop; 45 46 struct v4l2_ctrl_handler ctrls; 47 struct v4l2_ctrl *pixel_rate; 48 struct v4l2_ctrl *link_freq; 49 struct v4l2_ctrl *exposure; 50 struct v4l2_ctrl *unit_size; 51 52 struct regulator_bulk_data supplies[IMX214_NUM_SUPPLIES]; 53 54 struct gpio_desc *enable_gpio; 55 56 /* 57 * Serialize control access, get/set format, get selection 58 * and start streaming. 59 */ 60 struct mutex mutex; 61 62 bool streaming; 63 }; 64 65 struct reg_8 { 66 u16 addr; 67 u8 val; 68 }; 69 70 enum { 71 IMX214_TABLE_WAIT_MS = 0, 72 IMX214_TABLE_END, 73 IMX214_MAX_RETRIES, 74 IMX214_WAIT_MS 75 }; 76 77 /*From imx214_mode_tbls.h*/ 78 static const struct reg_8 mode_4096x2304[] = { 79 {0x0114, 0x03}, 80 {0x0220, 0x00}, 81 {0x0221, 0x11}, 82 {0x0222, 0x01}, 83 {0x0340, 0x0C}, 84 {0x0341, 0x7A}, 85 {0x0342, 0x13}, 86 {0x0343, 0x90}, 87 {0x0344, 0x00}, 88 {0x0345, 0x38}, 89 {0x0346, 0x01}, 90 {0x0347, 0x98}, 91 {0x0348, 0x10}, 92 {0x0349, 0x37}, 93 {0x034A, 0x0A}, 94 {0x034B, 0x97}, 95 {0x0381, 0x01}, 96 {0x0383, 0x01}, 97 {0x0385, 0x01}, 98 {0x0387, 0x01}, 99 {0x0900, 0x00}, 100 {0x0901, 0x00}, 101 {0x0902, 0x00}, 102 {0x3000, 0x35}, 103 {0x3054, 0x01}, 104 {0x305C, 0x11}, 105 106 {0x0112, 0x0A}, 107 {0x0113, 0x0A}, 108 {0x034C, 0x10}, 109 {0x034D, 0x00}, 110 {0x034E, 0x09}, 111 {0x034F, 0x00}, 112 {0x0401, 0x00}, 113 {0x0404, 0x00}, 114 {0x0405, 0x10}, 115 {0x0408, 0x00}, 116 {0x0409, 0x00}, 117 {0x040A, 0x00}, 118 {0x040B, 0x00}, 119 {0x040C, 0x10}, 120 {0x040D, 0x00}, 121 {0x040E, 0x09}, 122 {0x040F, 0x00}, 123 124 {0x0301, 0x05}, 125 {0x0303, 0x02}, 126 {0x0305, 0x03}, 127 {0x0306, 0x00}, 128 {0x0307, 0x96}, 129 {0x0309, 0x0A}, 130 {0x030B, 0x01}, 131 {0x0310, 0x00}, 132 133 {0x0820, 0x12}, 134 {0x0821, 0xC0}, 135 {0x0822, 0x00}, 136 {0x0823, 0x00}, 137 138 {0x3A03, 0x09}, 139 {0x3A04, 0x50}, 140 {0x3A05, 0x01}, 141 142 {0x0B06, 0x01}, 143 {0x30A2, 0x00}, 144 145 {0x30B4, 0x00}, 146 147 {0x3A02, 0xFF}, 148 149 {0x3011, 0x00}, 150 {0x3013, 0x01}, 151 152 {0x0202, 0x0C}, 153 {0x0203, 0x70}, 154 {0x0224, 0x01}, 155 {0x0225, 0xF4}, 156 157 {0x0204, 0x00}, 158 {0x0205, 0x00}, 159 {0x020E, 0x01}, 160 {0x020F, 0x00}, 161 {0x0210, 0x01}, 162 {0x0211, 0x00}, 163 {0x0212, 0x01}, 164 {0x0213, 0x00}, 165 {0x0214, 0x01}, 166 {0x0215, 0x00}, 167 {0x0216, 0x00}, 168 {0x0217, 0x00}, 169 170 {0x4170, 0x00}, 171 {0x4171, 0x10}, 172 {0x4176, 0x00}, 173 {0x4177, 0x3C}, 174 {0xAE20, 0x04}, 175 {0xAE21, 0x5C}, 176 177 {IMX214_TABLE_WAIT_MS, 10}, 178 {0x0138, 0x01}, 179 {IMX214_TABLE_END, 0x00} 180 }; 181 182 static const struct reg_8 mode_1920x1080[] = { 183 {0x0114, 0x03}, 184 {0x0220, 0x00}, 185 {0x0221, 0x11}, 186 {0x0222, 0x01}, 187 {0x0340, 0x0C}, 188 {0x0341, 0x7A}, 189 {0x0342, 0x13}, 190 {0x0343, 0x90}, 191 {0x0344, 0x04}, 192 {0x0345, 0x78}, 193 {0x0346, 0x03}, 194 {0x0347, 0xFC}, 195 {0x0348, 0x0B}, 196 {0x0349, 0xF7}, 197 {0x034A, 0x08}, 198 {0x034B, 0x33}, 199 {0x0381, 0x01}, 200 {0x0383, 0x01}, 201 {0x0385, 0x01}, 202 {0x0387, 0x01}, 203 {0x0900, 0x00}, 204 {0x0901, 0x00}, 205 {0x0902, 0x00}, 206 {0x3000, 0x35}, 207 {0x3054, 0x01}, 208 {0x305C, 0x11}, 209 210 {0x0112, 0x0A}, 211 {0x0113, 0x0A}, 212 {0x034C, 0x07}, 213 {0x034D, 0x80}, 214 {0x034E, 0x04}, 215 {0x034F, 0x38}, 216 {0x0401, 0x00}, 217 {0x0404, 0x00}, 218 {0x0405, 0x10}, 219 {0x0408, 0x00}, 220 {0x0409, 0x00}, 221 {0x040A, 0x00}, 222 {0x040B, 0x00}, 223 {0x040C, 0x07}, 224 {0x040D, 0x80}, 225 {0x040E, 0x04}, 226 {0x040F, 0x38}, 227 228 {0x0301, 0x05}, 229 {0x0303, 0x02}, 230 {0x0305, 0x03}, 231 {0x0306, 0x00}, 232 {0x0307, 0x96}, 233 {0x0309, 0x0A}, 234 {0x030B, 0x01}, 235 {0x0310, 0x00}, 236 237 {0x0820, 0x12}, 238 {0x0821, 0xC0}, 239 {0x0822, 0x00}, 240 {0x0823, 0x00}, 241 242 {0x3A03, 0x04}, 243 {0x3A04, 0xF8}, 244 {0x3A05, 0x02}, 245 246 {0x0B06, 0x01}, 247 {0x30A2, 0x00}, 248 249 {0x30B4, 0x00}, 250 251 {0x3A02, 0xFF}, 252 253 {0x3011, 0x00}, 254 {0x3013, 0x01}, 255 256 {0x0202, 0x0C}, 257 {0x0203, 0x70}, 258 {0x0224, 0x01}, 259 {0x0225, 0xF4}, 260 261 {0x0204, 0x00}, 262 {0x0205, 0x00}, 263 {0x020E, 0x01}, 264 {0x020F, 0x00}, 265 {0x0210, 0x01}, 266 {0x0211, 0x00}, 267 {0x0212, 0x01}, 268 {0x0213, 0x00}, 269 {0x0214, 0x01}, 270 {0x0215, 0x00}, 271 {0x0216, 0x00}, 272 {0x0217, 0x00}, 273 274 {0x4170, 0x00}, 275 {0x4171, 0x10}, 276 {0x4176, 0x00}, 277 {0x4177, 0x3C}, 278 {0xAE20, 0x04}, 279 {0xAE21, 0x5C}, 280 281 {IMX214_TABLE_WAIT_MS, 10}, 282 {0x0138, 0x01}, 283 {IMX214_TABLE_END, 0x00} 284 }; 285 286 static const struct reg_8 mode_table_common[] = { 287 /* software reset */ 288 289 /* software standby settings */ 290 {0x0100, 0x00}, 291 292 /* ATR setting */ 293 {0x9300, 0x02}, 294 295 /* external clock setting */ 296 {0x0136, 0x18}, 297 {0x0137, 0x00}, 298 299 /* global setting */ 300 /* basic config */ 301 {0x0101, 0x00}, 302 {0x0105, 0x01}, 303 {0x0106, 0x01}, 304 {0x4550, 0x02}, 305 {0x4601, 0x00}, 306 {0x4642, 0x05}, 307 {0x6227, 0x11}, 308 {0x6276, 0x00}, 309 {0x900E, 0x06}, 310 {0xA802, 0x90}, 311 {0xA803, 0x11}, 312 {0xA804, 0x62}, 313 {0xA805, 0x77}, 314 {0xA806, 0xAE}, 315 {0xA807, 0x34}, 316 {0xA808, 0xAE}, 317 {0xA809, 0x35}, 318 {0xA80A, 0x62}, 319 {0xA80B, 0x83}, 320 {0xAE33, 0x00}, 321 322 /* analog setting */ 323 {0x4174, 0x00}, 324 {0x4175, 0x11}, 325 {0x4612, 0x29}, 326 {0x461B, 0x12}, 327 {0x461F, 0x06}, 328 {0x4635, 0x07}, 329 {0x4637, 0x30}, 330 {0x463F, 0x18}, 331 {0x4641, 0x0D}, 332 {0x465B, 0x12}, 333 {0x465F, 0x11}, 334 {0x4663, 0x11}, 335 {0x4667, 0x0F}, 336 {0x466F, 0x0F}, 337 {0x470E, 0x09}, 338 {0x4909, 0xAB}, 339 {0x490B, 0x95}, 340 {0x4915, 0x5D}, 341 {0x4A5F, 0xFF}, 342 {0x4A61, 0xFF}, 343 {0x4A73, 0x62}, 344 {0x4A85, 0x00}, 345 {0x4A87, 0xFF}, 346 347 /* embedded data */ 348 {0x5041, 0x04}, 349 {0x583C, 0x04}, 350 {0x620E, 0x04}, 351 {0x6EB2, 0x01}, 352 {0x6EB3, 0x00}, 353 {0x9300, 0x02}, 354 355 /* imagequality */ 356 /* HDR setting */ 357 {0x3001, 0x07}, 358 {0x6D12, 0x3F}, 359 {0x6D13, 0xFF}, 360 {0x9344, 0x03}, 361 {0x9706, 0x10}, 362 {0x9707, 0x03}, 363 {0x9708, 0x03}, 364 {0x9E04, 0x01}, 365 {0x9E05, 0x00}, 366 {0x9E0C, 0x01}, 367 {0x9E0D, 0x02}, 368 {0x9E24, 0x00}, 369 {0x9E25, 0x8C}, 370 {0x9E26, 0x00}, 371 {0x9E27, 0x94}, 372 {0x9E28, 0x00}, 373 {0x9E29, 0x96}, 374 375 /* CNR parameter setting */ 376 {0x69DB, 0x01}, 377 378 /* Moire reduction */ 379 {0x6957, 0x01}, 380 381 /* image enhancement */ 382 {0x6987, 0x17}, 383 {0x698A, 0x03}, 384 {0x698B, 0x03}, 385 386 /* white balanace */ 387 {0x0B8E, 0x01}, 388 {0x0B8F, 0x00}, 389 {0x0B90, 0x01}, 390 {0x0B91, 0x00}, 391 {0x0B92, 0x01}, 392 {0x0B93, 0x00}, 393 {0x0B94, 0x01}, 394 {0x0B95, 0x00}, 395 396 /* ATR setting */ 397 {0x6E50, 0x00}, 398 {0x6E51, 0x32}, 399 {0x9340, 0x00}, 400 {0x9341, 0x3C}, 401 {0x9342, 0x03}, 402 {0x9343, 0xFF}, 403 {IMX214_TABLE_END, 0x00} 404 }; 405 406 /* 407 * Declare modes in order, from biggest 408 * to smallest height. 409 */ 410 static const struct imx214_mode { 411 u32 width; 412 u32 height; 413 const struct reg_8 *reg_table; 414 } imx214_modes[] = { 415 { 416 .width = 4096, 417 .height = 2304, 418 .reg_table = mode_4096x2304, 419 }, 420 { 421 .width = 1920, 422 .height = 1080, 423 .reg_table = mode_1920x1080, 424 }, 425 }; 426 427 static inline struct imx214 *to_imx214(struct v4l2_subdev *sd) 428 { 429 return container_of(sd, struct imx214, sd); 430 } 431 432 static int __maybe_unused imx214_power_on(struct device *dev) 433 { 434 struct i2c_client *client = to_i2c_client(dev); 435 struct v4l2_subdev *sd = i2c_get_clientdata(client); 436 struct imx214 *imx214 = to_imx214(sd); 437 int ret; 438 439 ret = regulator_bulk_enable(IMX214_NUM_SUPPLIES, imx214->supplies); 440 if (ret < 0) { 441 dev_err(imx214->dev, "failed to enable regulators: %d\n", ret); 442 return ret; 443 } 444 445 usleep_range(2000, 3000); 446 447 ret = clk_prepare_enable(imx214->xclk); 448 if (ret < 0) { 449 regulator_bulk_disable(IMX214_NUM_SUPPLIES, imx214->supplies); 450 dev_err(imx214->dev, "clk prepare enable failed\n"); 451 return ret; 452 } 453 454 gpiod_set_value_cansleep(imx214->enable_gpio, 1); 455 usleep_range(12000, 15000); 456 457 return 0; 458 } 459 460 static int __maybe_unused imx214_power_off(struct device *dev) 461 { 462 struct i2c_client *client = to_i2c_client(dev); 463 struct v4l2_subdev *sd = i2c_get_clientdata(client); 464 struct imx214 *imx214 = to_imx214(sd); 465 466 gpiod_set_value_cansleep(imx214->enable_gpio, 0); 467 468 clk_disable_unprepare(imx214->xclk); 469 470 regulator_bulk_disable(IMX214_NUM_SUPPLIES, imx214->supplies); 471 usleep_range(10, 20); 472 473 return 0; 474 } 475 476 static int imx214_enum_mbus_code(struct v4l2_subdev *sd, 477 struct v4l2_subdev_state *sd_state, 478 struct v4l2_subdev_mbus_code_enum *code) 479 { 480 if (code->index > 0) 481 return -EINVAL; 482 483 code->code = IMX214_MBUS_CODE; 484 485 return 0; 486 } 487 488 static int imx214_enum_frame_size(struct v4l2_subdev *subdev, 489 struct v4l2_subdev_state *sd_state, 490 struct v4l2_subdev_frame_size_enum *fse) 491 { 492 if (fse->code != IMX214_MBUS_CODE) 493 return -EINVAL; 494 495 if (fse->index >= ARRAY_SIZE(imx214_modes)) 496 return -EINVAL; 497 498 fse->min_width = fse->max_width = imx214_modes[fse->index].width; 499 fse->min_height = fse->max_height = imx214_modes[fse->index].height; 500 501 return 0; 502 } 503 504 #ifdef CONFIG_VIDEO_ADV_DEBUG 505 static int imx214_s_register(struct v4l2_subdev *subdev, 506 const struct v4l2_dbg_register *reg) 507 { 508 struct imx214 *imx214 = container_of(subdev, struct imx214, sd); 509 510 return regmap_write(imx214->regmap, reg->reg, reg->val); 511 } 512 513 static int imx214_g_register(struct v4l2_subdev *subdev, 514 struct v4l2_dbg_register *reg) 515 { 516 struct imx214 *imx214 = container_of(subdev, struct imx214, sd); 517 unsigned int aux; 518 int ret; 519 520 reg->size = 1; 521 ret = regmap_read(imx214->regmap, reg->reg, &aux); 522 reg->val = aux; 523 524 return ret; 525 } 526 #endif 527 528 static const struct v4l2_subdev_core_ops imx214_core_ops = { 529 #ifdef CONFIG_VIDEO_ADV_DEBUG 530 .g_register = imx214_g_register, 531 .s_register = imx214_s_register, 532 #endif 533 }; 534 535 static struct v4l2_mbus_framefmt * 536 __imx214_get_pad_format(struct imx214 *imx214, 537 struct v4l2_subdev_state *sd_state, 538 unsigned int pad, 539 enum v4l2_subdev_format_whence which) 540 { 541 switch (which) { 542 case V4L2_SUBDEV_FORMAT_TRY: 543 return v4l2_subdev_get_try_format(&imx214->sd, sd_state, pad); 544 case V4L2_SUBDEV_FORMAT_ACTIVE: 545 return &imx214->fmt; 546 default: 547 return NULL; 548 } 549 } 550 551 static int imx214_get_format(struct v4l2_subdev *sd, 552 struct v4l2_subdev_state *sd_state, 553 struct v4l2_subdev_format *format) 554 { 555 struct imx214 *imx214 = to_imx214(sd); 556 557 mutex_lock(&imx214->mutex); 558 format->format = *__imx214_get_pad_format(imx214, sd_state, 559 format->pad, 560 format->which); 561 mutex_unlock(&imx214->mutex); 562 563 return 0; 564 } 565 566 static struct v4l2_rect * 567 __imx214_get_pad_crop(struct imx214 *imx214, 568 struct v4l2_subdev_state *sd_state, 569 unsigned int pad, enum v4l2_subdev_format_whence which) 570 { 571 switch (which) { 572 case V4L2_SUBDEV_FORMAT_TRY: 573 return v4l2_subdev_get_try_crop(&imx214->sd, sd_state, pad); 574 case V4L2_SUBDEV_FORMAT_ACTIVE: 575 return &imx214->crop; 576 default: 577 return NULL; 578 } 579 } 580 581 static int imx214_set_format(struct v4l2_subdev *sd, 582 struct v4l2_subdev_state *sd_state, 583 struct v4l2_subdev_format *format) 584 { 585 struct imx214 *imx214 = to_imx214(sd); 586 struct v4l2_mbus_framefmt *__format; 587 struct v4l2_rect *__crop; 588 const struct imx214_mode *mode; 589 590 mutex_lock(&imx214->mutex); 591 592 __crop = __imx214_get_pad_crop(imx214, sd_state, format->pad, 593 format->which); 594 595 mode = v4l2_find_nearest_size(imx214_modes, 596 ARRAY_SIZE(imx214_modes), width, height, 597 format->format.width, 598 format->format.height); 599 600 __crop->width = mode->width; 601 __crop->height = mode->height; 602 603 __format = __imx214_get_pad_format(imx214, sd_state, format->pad, 604 format->which); 605 __format->width = __crop->width; 606 __format->height = __crop->height; 607 __format->code = IMX214_MBUS_CODE; 608 __format->field = V4L2_FIELD_NONE; 609 __format->colorspace = V4L2_COLORSPACE_SRGB; 610 __format->ycbcr_enc = V4L2_MAP_YCBCR_ENC_DEFAULT(__format->colorspace); 611 __format->quantization = V4L2_MAP_QUANTIZATION_DEFAULT(true, 612 __format->colorspace, __format->ycbcr_enc); 613 __format->xfer_func = V4L2_MAP_XFER_FUNC_DEFAULT(__format->colorspace); 614 615 format->format = *__format; 616 617 mutex_unlock(&imx214->mutex); 618 619 return 0; 620 } 621 622 static int imx214_get_selection(struct v4l2_subdev *sd, 623 struct v4l2_subdev_state *sd_state, 624 struct v4l2_subdev_selection *sel) 625 { 626 struct imx214 *imx214 = to_imx214(sd); 627 628 if (sel->target != V4L2_SEL_TGT_CROP) 629 return -EINVAL; 630 631 mutex_lock(&imx214->mutex); 632 sel->r = *__imx214_get_pad_crop(imx214, sd_state, sel->pad, 633 sel->which); 634 mutex_unlock(&imx214->mutex); 635 return 0; 636 } 637 638 static int imx214_entity_init_cfg(struct v4l2_subdev *subdev, 639 struct v4l2_subdev_state *sd_state) 640 { 641 struct v4l2_subdev_format fmt = { }; 642 643 fmt.which = sd_state ? V4L2_SUBDEV_FORMAT_TRY : V4L2_SUBDEV_FORMAT_ACTIVE; 644 fmt.format.width = imx214_modes[0].width; 645 fmt.format.height = imx214_modes[0].height; 646 647 imx214_set_format(subdev, sd_state, &fmt); 648 649 return 0; 650 } 651 652 static int imx214_set_ctrl(struct v4l2_ctrl *ctrl) 653 { 654 struct imx214 *imx214 = container_of(ctrl->handler, 655 struct imx214, ctrls); 656 u8 vals[2]; 657 int ret; 658 659 /* 660 * Applying V4L2 control value only happens 661 * when power is up for streaming 662 */ 663 if (!pm_runtime_get_if_in_use(imx214->dev)) 664 return 0; 665 666 switch (ctrl->id) { 667 case V4L2_CID_EXPOSURE: 668 vals[1] = ctrl->val; 669 vals[0] = ctrl->val >> 8; 670 ret = regmap_bulk_write(imx214->regmap, 0x202, vals, 2); 671 if (ret < 0) 672 dev_err(imx214->dev, "Error %d\n", ret); 673 ret = 0; 674 break; 675 676 default: 677 ret = -EINVAL; 678 } 679 680 pm_runtime_put(imx214->dev); 681 682 return ret; 683 } 684 685 static const struct v4l2_ctrl_ops imx214_ctrl_ops = { 686 .s_ctrl = imx214_set_ctrl, 687 }; 688 689 #define MAX_CMD 4 690 static int imx214_write_table(struct imx214 *imx214, 691 const struct reg_8 table[]) 692 { 693 u8 vals[MAX_CMD]; 694 int i; 695 int ret; 696 697 for (; table->addr != IMX214_TABLE_END ; table++) { 698 if (table->addr == IMX214_TABLE_WAIT_MS) { 699 usleep_range(table->val * 1000, 700 table->val * 1000 + 500); 701 continue; 702 } 703 704 for (i = 0; i < MAX_CMD; i++) { 705 if (table[i].addr != (table[0].addr + i)) 706 break; 707 vals[i] = table[i].val; 708 } 709 710 ret = regmap_bulk_write(imx214->regmap, table->addr, vals, i); 711 712 if (ret) { 713 dev_err(imx214->dev, "write_table error: %d\n", ret); 714 return ret; 715 } 716 717 table += i - 1; 718 } 719 720 return 0; 721 } 722 723 static int imx214_start_streaming(struct imx214 *imx214) 724 { 725 const struct imx214_mode *mode; 726 int ret; 727 728 mutex_lock(&imx214->mutex); 729 ret = imx214_write_table(imx214, mode_table_common); 730 if (ret < 0) { 731 dev_err(imx214->dev, "could not sent common table %d\n", ret); 732 goto error; 733 } 734 735 mode = v4l2_find_nearest_size(imx214_modes, 736 ARRAY_SIZE(imx214_modes), width, height, 737 imx214->fmt.width, imx214->fmt.height); 738 ret = imx214_write_table(imx214, mode->reg_table); 739 if (ret < 0) { 740 dev_err(imx214->dev, "could not sent mode table %d\n", ret); 741 goto error; 742 } 743 ret = __v4l2_ctrl_handler_setup(&imx214->ctrls); 744 if (ret < 0) { 745 dev_err(imx214->dev, "could not sync v4l2 controls\n"); 746 goto error; 747 } 748 ret = regmap_write(imx214->regmap, 0x100, 1); 749 if (ret < 0) { 750 dev_err(imx214->dev, "could not sent start table %d\n", ret); 751 goto error; 752 } 753 754 mutex_unlock(&imx214->mutex); 755 return 0; 756 757 error: 758 mutex_unlock(&imx214->mutex); 759 return ret; 760 } 761 762 static int imx214_stop_streaming(struct imx214 *imx214) 763 { 764 int ret; 765 766 ret = regmap_write(imx214->regmap, 0x100, 0); 767 if (ret < 0) 768 dev_err(imx214->dev, "could not sent stop table %d\n", ret); 769 770 return ret; 771 } 772 773 static int imx214_s_stream(struct v4l2_subdev *subdev, int enable) 774 { 775 struct imx214 *imx214 = to_imx214(subdev); 776 int ret; 777 778 if (imx214->streaming == enable) 779 return 0; 780 781 if (enable) { 782 ret = pm_runtime_resume_and_get(imx214->dev); 783 if (ret < 0) 784 return ret; 785 786 ret = imx214_start_streaming(imx214); 787 if (ret < 0) 788 goto err_rpm_put; 789 } else { 790 ret = imx214_stop_streaming(imx214); 791 if (ret < 0) 792 goto err_rpm_put; 793 pm_runtime_put(imx214->dev); 794 } 795 796 imx214->streaming = enable; 797 return 0; 798 799 err_rpm_put: 800 pm_runtime_put(imx214->dev); 801 return ret; 802 } 803 804 static int imx214_g_frame_interval(struct v4l2_subdev *subdev, 805 struct v4l2_subdev_frame_interval *fival) 806 { 807 fival->interval.numerator = 1; 808 fival->interval.denominator = IMX214_FPS; 809 810 return 0; 811 } 812 813 static int imx214_enum_frame_interval(struct v4l2_subdev *subdev, 814 struct v4l2_subdev_state *sd_state, 815 struct v4l2_subdev_frame_interval_enum *fie) 816 { 817 const struct imx214_mode *mode; 818 819 if (fie->index != 0) 820 return -EINVAL; 821 822 mode = v4l2_find_nearest_size(imx214_modes, 823 ARRAY_SIZE(imx214_modes), width, height, 824 fie->width, fie->height); 825 826 fie->code = IMX214_MBUS_CODE; 827 fie->width = mode->width; 828 fie->height = mode->height; 829 fie->interval.numerator = 1; 830 fie->interval.denominator = IMX214_FPS; 831 832 return 0; 833 } 834 835 static const struct v4l2_subdev_video_ops imx214_video_ops = { 836 .s_stream = imx214_s_stream, 837 .g_frame_interval = imx214_g_frame_interval, 838 .s_frame_interval = imx214_g_frame_interval, 839 }; 840 841 static const struct v4l2_subdev_pad_ops imx214_subdev_pad_ops = { 842 .enum_mbus_code = imx214_enum_mbus_code, 843 .enum_frame_size = imx214_enum_frame_size, 844 .enum_frame_interval = imx214_enum_frame_interval, 845 .get_fmt = imx214_get_format, 846 .set_fmt = imx214_set_format, 847 .get_selection = imx214_get_selection, 848 .init_cfg = imx214_entity_init_cfg, 849 }; 850 851 static const struct v4l2_subdev_ops imx214_subdev_ops = { 852 .core = &imx214_core_ops, 853 .video = &imx214_video_ops, 854 .pad = &imx214_subdev_pad_ops, 855 }; 856 857 static const struct regmap_config sensor_regmap_config = { 858 .reg_bits = 16, 859 .val_bits = 8, 860 .cache_type = REGCACHE_RBTREE, 861 }; 862 863 static int imx214_get_regulators(struct device *dev, struct imx214 *imx214) 864 { 865 unsigned int i; 866 867 for (i = 0; i < IMX214_NUM_SUPPLIES; i++) 868 imx214->supplies[i].supply = imx214_supply_name[i]; 869 870 return devm_regulator_bulk_get(dev, IMX214_NUM_SUPPLIES, 871 imx214->supplies); 872 } 873 874 static int imx214_parse_fwnode(struct device *dev) 875 { 876 struct fwnode_handle *endpoint; 877 struct v4l2_fwnode_endpoint bus_cfg = { 878 .bus_type = V4L2_MBUS_CSI2_DPHY, 879 }; 880 unsigned int i; 881 int ret; 882 883 endpoint = fwnode_graph_get_next_endpoint(dev_fwnode(dev), NULL); 884 if (!endpoint) { 885 dev_err(dev, "endpoint node not found\n"); 886 return -EINVAL; 887 } 888 889 ret = v4l2_fwnode_endpoint_alloc_parse(endpoint, &bus_cfg); 890 if (ret) { 891 dev_err(dev, "parsing endpoint node failed\n"); 892 goto done; 893 } 894 895 for (i = 0; i < bus_cfg.nr_of_link_frequencies; i++) 896 if (bus_cfg.link_frequencies[i] == IMX214_DEFAULT_LINK_FREQ) 897 break; 898 899 if (i == bus_cfg.nr_of_link_frequencies) { 900 dev_err(dev, "link-frequencies %d not supported, Please review your DT\n", 901 IMX214_DEFAULT_LINK_FREQ); 902 ret = -EINVAL; 903 goto done; 904 } 905 906 done: 907 v4l2_fwnode_endpoint_free(&bus_cfg); 908 fwnode_handle_put(endpoint); 909 return ret; 910 } 911 912 static int __maybe_unused imx214_suspend(struct device *dev) 913 { 914 struct i2c_client *client = to_i2c_client(dev); 915 struct v4l2_subdev *sd = i2c_get_clientdata(client); 916 struct imx214 *imx214 = to_imx214(sd); 917 918 if (imx214->streaming) 919 imx214_stop_streaming(imx214); 920 921 return 0; 922 } 923 924 static int __maybe_unused imx214_resume(struct device *dev) 925 { 926 struct i2c_client *client = to_i2c_client(dev); 927 struct v4l2_subdev *sd = i2c_get_clientdata(client); 928 struct imx214 *imx214 = to_imx214(sd); 929 int ret; 930 931 if (imx214->streaming) { 932 ret = imx214_start_streaming(imx214); 933 if (ret) 934 goto error; 935 } 936 937 return 0; 938 939 error: 940 imx214_stop_streaming(imx214); 941 imx214->streaming = 0; 942 return ret; 943 } 944 945 static int imx214_probe(struct i2c_client *client) 946 { 947 struct device *dev = &client->dev; 948 struct imx214 *imx214; 949 static const s64 link_freq[] = { 950 IMX214_DEFAULT_LINK_FREQ, 951 }; 952 static const struct v4l2_area unit_size = { 953 .width = 1120, 954 .height = 1120, 955 }; 956 int ret; 957 958 ret = imx214_parse_fwnode(dev); 959 if (ret) 960 return ret; 961 962 imx214 = devm_kzalloc(dev, sizeof(*imx214), GFP_KERNEL); 963 if (!imx214) 964 return -ENOMEM; 965 966 imx214->dev = dev; 967 968 imx214->xclk = devm_clk_get(dev, NULL); 969 if (IS_ERR(imx214->xclk)) { 970 dev_err(dev, "could not get xclk"); 971 return PTR_ERR(imx214->xclk); 972 } 973 974 ret = clk_set_rate(imx214->xclk, IMX214_DEFAULT_CLK_FREQ); 975 if (ret) { 976 dev_err(dev, "could not set xclk frequency\n"); 977 return ret; 978 } 979 980 ret = imx214_get_regulators(dev, imx214); 981 if (ret < 0) { 982 dev_err(dev, "cannot get regulators\n"); 983 return ret; 984 } 985 986 imx214->enable_gpio = devm_gpiod_get(dev, "enable", GPIOD_OUT_LOW); 987 if (IS_ERR(imx214->enable_gpio)) { 988 dev_err(dev, "cannot get enable gpio\n"); 989 return PTR_ERR(imx214->enable_gpio); 990 } 991 992 imx214->regmap = devm_regmap_init_i2c(client, &sensor_regmap_config); 993 if (IS_ERR(imx214->regmap)) { 994 dev_err(dev, "regmap init failed\n"); 995 return PTR_ERR(imx214->regmap); 996 } 997 998 v4l2_i2c_subdev_init(&imx214->sd, client, &imx214_subdev_ops); 999 1000 /* 1001 * Enable power initially, to avoid warnings 1002 * from clk_disable on power_off 1003 */ 1004 imx214_power_on(imx214->dev); 1005 1006 pm_runtime_set_active(imx214->dev); 1007 pm_runtime_enable(imx214->dev); 1008 pm_runtime_idle(imx214->dev); 1009 1010 v4l2_ctrl_handler_init(&imx214->ctrls, 3); 1011 1012 imx214->pixel_rate = v4l2_ctrl_new_std(&imx214->ctrls, NULL, 1013 V4L2_CID_PIXEL_RATE, 0, 1014 IMX214_DEFAULT_PIXEL_RATE, 1, 1015 IMX214_DEFAULT_PIXEL_RATE); 1016 imx214->link_freq = v4l2_ctrl_new_int_menu(&imx214->ctrls, NULL, 1017 V4L2_CID_LINK_FREQ, 1018 ARRAY_SIZE(link_freq) - 1, 1019 0, link_freq); 1020 if (imx214->link_freq) 1021 imx214->link_freq->flags |= V4L2_CTRL_FLAG_READ_ONLY; 1022 1023 /* 1024 * WARNING! 1025 * Values obtained reverse engineering blobs and/or devices. 1026 * Ranges and functionality might be wrong. 1027 * 1028 * Sony, please release some register set documentation for the 1029 * device. 1030 * 1031 * Yours sincerely, Ricardo. 1032 */ 1033 imx214->exposure = v4l2_ctrl_new_std(&imx214->ctrls, &imx214_ctrl_ops, 1034 V4L2_CID_EXPOSURE, 1035 0, 3184, 1, 0x0c70); 1036 1037 imx214->unit_size = v4l2_ctrl_new_std_compound(&imx214->ctrls, 1038 NULL, 1039 V4L2_CID_UNIT_CELL_SIZE, 1040 v4l2_ctrl_ptr_create((void *)&unit_size)); 1041 ret = imx214->ctrls.error; 1042 if (ret) { 1043 dev_err(&client->dev, "%s control init failed (%d)\n", 1044 __func__, ret); 1045 goto free_ctrl; 1046 } 1047 1048 imx214->sd.ctrl_handler = &imx214->ctrls; 1049 mutex_init(&imx214->mutex); 1050 imx214->ctrls.lock = &imx214->mutex; 1051 1052 imx214->sd.flags |= V4L2_SUBDEV_FL_HAS_DEVNODE; 1053 imx214->pad.flags = MEDIA_PAD_FL_SOURCE; 1054 imx214->sd.dev = &client->dev; 1055 imx214->sd.entity.function = MEDIA_ENT_F_CAM_SENSOR; 1056 1057 ret = media_entity_pads_init(&imx214->sd.entity, 1, &imx214->pad); 1058 if (ret < 0) { 1059 dev_err(dev, "could not register media entity\n"); 1060 goto free_ctrl; 1061 } 1062 1063 imx214_entity_init_cfg(&imx214->sd, NULL); 1064 1065 ret = v4l2_async_register_subdev_sensor(&imx214->sd); 1066 if (ret < 0) { 1067 dev_err(dev, "could not register v4l2 device\n"); 1068 goto free_entity; 1069 } 1070 1071 return 0; 1072 1073 free_entity: 1074 media_entity_cleanup(&imx214->sd.entity); 1075 free_ctrl: 1076 mutex_destroy(&imx214->mutex); 1077 v4l2_ctrl_handler_free(&imx214->ctrls); 1078 pm_runtime_disable(imx214->dev); 1079 1080 return ret; 1081 } 1082 1083 static int imx214_remove(struct i2c_client *client) 1084 { 1085 struct v4l2_subdev *sd = i2c_get_clientdata(client); 1086 struct imx214 *imx214 = to_imx214(sd); 1087 1088 v4l2_async_unregister_subdev(&imx214->sd); 1089 media_entity_cleanup(&imx214->sd.entity); 1090 v4l2_ctrl_handler_free(&imx214->ctrls); 1091 1092 pm_runtime_disable(&client->dev); 1093 pm_runtime_set_suspended(&client->dev); 1094 1095 mutex_destroy(&imx214->mutex); 1096 1097 return 0; 1098 } 1099 1100 static const struct of_device_id imx214_of_match[] = { 1101 { .compatible = "sony,imx214" }, 1102 { } 1103 }; 1104 MODULE_DEVICE_TABLE(of, imx214_of_match); 1105 1106 static const struct dev_pm_ops imx214_pm_ops = { 1107 SET_SYSTEM_SLEEP_PM_OPS(imx214_suspend, imx214_resume) 1108 SET_RUNTIME_PM_OPS(imx214_power_off, imx214_power_on, NULL) 1109 }; 1110 1111 static struct i2c_driver imx214_i2c_driver = { 1112 .driver = { 1113 .of_match_table = imx214_of_match, 1114 .pm = &imx214_pm_ops, 1115 .name = "imx214", 1116 }, 1117 .probe_new = imx214_probe, 1118 .remove = imx214_remove, 1119 }; 1120 1121 module_i2c_driver(imx214_i2c_driver); 1122 1123 MODULE_DESCRIPTION("Sony IMX214 Camera driver"); 1124 MODULE_AUTHOR("Ricardo Ribalda <ribalda@kernel.org>"); 1125 MODULE_LICENSE("GPL v2"); 1126