1 // SPDX-License-Identifier: GPL-2.0 2 // Copyright (C) 2018 Intel Corporation 3 4 #include <asm/unaligned.h> 5 #include <linux/acpi.h> 6 #include <linux/i2c.h> 7 #include <linux/module.h> 8 #include <linux/pm_runtime.h> 9 #include <media/v4l2-ctrls.h> 10 #include <media/v4l2-device.h> 11 #include <media/v4l2-event.h> 12 #include <media/v4l2-fwnode.h> 13 14 #define IMX319_REG_MODE_SELECT 0x0100 15 #define IMX319_MODE_STANDBY 0x00 16 #define IMX319_MODE_STREAMING 0x01 17 18 /* Chip ID */ 19 #define IMX319_REG_CHIP_ID 0x0016 20 #define IMX319_CHIP_ID 0x0319 21 22 /* V_TIMING internal */ 23 #define IMX319_REG_FLL 0x0340 24 #define IMX319_FLL_MAX 0xffff 25 26 /* Exposure control */ 27 #define IMX319_REG_EXPOSURE 0x0202 28 #define IMX319_EXPOSURE_MIN 1 29 #define IMX319_EXPOSURE_STEP 1 30 #define IMX319_EXPOSURE_DEFAULT 0x04f6 31 32 /* 33 * the digital control register for all color control looks like: 34 * +-----------------+------------------+ 35 * | [7:0] | [15:8] | 36 * +-----------------+------------------+ 37 * | 0x020f | 0x020e | 38 * -------------------------------------- 39 * it is used to calculate the digital gain times value(integral + fractional) 40 * the [15:8] bits is the fractional part and [7:0] bits is the integral 41 * calculation equation is: 42 * gain value (unit: times) = REG[15:8] + REG[7:0]/0x100 43 * Only value in 0x0100 ~ 0x0FFF range is allowed. 44 * Analog gain use 10 bits in the registers and allowed range is 0 ~ 960 45 */ 46 /* Analog gain control */ 47 #define IMX319_REG_ANALOG_GAIN 0x0204 48 #define IMX319_ANA_GAIN_MIN 0 49 #define IMX319_ANA_GAIN_MAX 960 50 #define IMX319_ANA_GAIN_STEP 1 51 #define IMX319_ANA_GAIN_DEFAULT 0 52 53 /* Digital gain control */ 54 #define IMX319_REG_DPGA_USE_GLOBAL_GAIN 0x3ff9 55 #define IMX319_REG_DIG_GAIN_GLOBAL 0x020e 56 #define IMX319_DGTL_GAIN_MIN 256 57 #define IMX319_DGTL_GAIN_MAX 4095 58 #define IMX319_DGTL_GAIN_STEP 1 59 #define IMX319_DGTL_GAIN_DEFAULT 256 60 61 /* Test Pattern Control */ 62 #define IMX319_REG_TEST_PATTERN 0x0600 63 #define IMX319_TEST_PATTERN_DISABLED 0 64 #define IMX319_TEST_PATTERN_SOLID_COLOR 1 65 #define IMX319_TEST_PATTERN_COLOR_BARS 2 66 #define IMX319_TEST_PATTERN_GRAY_COLOR_BARS 3 67 #define IMX319_TEST_PATTERN_PN9 4 68 69 /* Flip Control */ 70 #define IMX319_REG_ORIENTATION 0x0101 71 72 /* default link frequency and external clock */ 73 #define IMX319_LINK_FREQ_DEFAULT 482400000LL 74 #define IMX319_EXT_CLK 19200000 75 #define IMX319_LINK_FREQ_INDEX 0 76 77 struct imx319_reg { 78 u16 address; 79 u8 val; 80 }; 81 82 struct imx319_reg_list { 83 u32 num_of_regs; 84 const struct imx319_reg *regs; 85 }; 86 87 /* Mode : resolution and related config&values */ 88 struct imx319_mode { 89 /* Frame width */ 90 u32 width; 91 /* Frame height */ 92 u32 height; 93 94 /* V-timing */ 95 u32 fll_def; 96 u32 fll_min; 97 98 /* H-timing */ 99 u32 llp; 100 101 /* index of link frequency */ 102 u32 link_freq_index; 103 104 /* Default register values */ 105 struct imx319_reg_list reg_list; 106 }; 107 108 struct imx319_hwcfg { 109 u32 ext_clk; /* sensor external clk */ 110 unsigned long link_freq_bitmap; 111 }; 112 113 struct imx319 { 114 struct v4l2_subdev sd; 115 struct media_pad pad; 116 117 struct v4l2_ctrl_handler ctrl_handler; 118 /* V4L2 Controls */ 119 struct v4l2_ctrl *link_freq; 120 struct v4l2_ctrl *pixel_rate; 121 struct v4l2_ctrl *vblank; 122 struct v4l2_ctrl *hblank; 123 struct v4l2_ctrl *exposure; 124 struct v4l2_ctrl *vflip; 125 struct v4l2_ctrl *hflip; 126 127 /* Current mode */ 128 const struct imx319_mode *cur_mode; 129 130 struct imx319_hwcfg *hwcfg; 131 132 /* 133 * Mutex for serialized access: 134 * Protect sensor set pad format and start/stop streaming safely. 135 * Protect access to sensor v4l2 controls. 136 */ 137 struct mutex mutex; 138 139 /* True if the device has been identified */ 140 bool identified; 141 }; 142 143 static const struct imx319_reg imx319_global_regs[] = { 144 { 0x0136, 0x13 }, 145 { 0x0137, 0x33 }, 146 { 0x3c7e, 0x05 }, 147 { 0x3c7f, 0x07 }, 148 { 0x4d39, 0x0b }, 149 { 0x4d41, 0x33 }, 150 { 0x4d43, 0x0c }, 151 { 0x4d49, 0x89 }, 152 { 0x4e05, 0x0b }, 153 { 0x4e0d, 0x33 }, 154 { 0x4e0f, 0x0c }, 155 { 0x4e15, 0x89 }, 156 { 0x4e49, 0x2a }, 157 { 0x4e51, 0x33 }, 158 { 0x4e53, 0x0c }, 159 { 0x4e59, 0x89 }, 160 { 0x5601, 0x4f }, 161 { 0x560b, 0x45 }, 162 { 0x562f, 0x0a }, 163 { 0x5643, 0x0a }, 164 { 0x5645, 0x0c }, 165 { 0x56ef, 0x51 }, 166 { 0x586f, 0x33 }, 167 { 0x5873, 0x89 }, 168 { 0x5905, 0x33 }, 169 { 0x5907, 0x89 }, 170 { 0x590d, 0x33 }, 171 { 0x590f, 0x89 }, 172 { 0x5915, 0x33 }, 173 { 0x5917, 0x89 }, 174 { 0x5969, 0x1c }, 175 { 0x596b, 0x72 }, 176 { 0x5971, 0x33 }, 177 { 0x5973, 0x89 }, 178 { 0x5975, 0x33 }, 179 { 0x5977, 0x89 }, 180 { 0x5979, 0x1c }, 181 { 0x597b, 0x72 }, 182 { 0x5985, 0x33 }, 183 { 0x5987, 0x89 }, 184 { 0x5999, 0x1c }, 185 { 0x599b, 0x72 }, 186 { 0x59a5, 0x33 }, 187 { 0x59a7, 0x89 }, 188 { 0x7485, 0x08 }, 189 { 0x7487, 0x0c }, 190 { 0x7489, 0xc7 }, 191 { 0x748b, 0x8b }, 192 { 0x9004, 0x09 }, 193 { 0x9200, 0x6a }, 194 { 0x9201, 0x22 }, 195 { 0x9202, 0x6a }, 196 { 0x9203, 0x23 }, 197 { 0x9204, 0x5f }, 198 { 0x9205, 0x23 }, 199 { 0x9206, 0x5f }, 200 { 0x9207, 0x24 }, 201 { 0x9208, 0x5f }, 202 { 0x9209, 0x26 }, 203 { 0x920a, 0x5f }, 204 { 0x920b, 0x27 }, 205 { 0x920c, 0x5f }, 206 { 0x920d, 0x29 }, 207 { 0x920e, 0x5f }, 208 { 0x920f, 0x2a }, 209 { 0x9210, 0x5f }, 210 { 0x9211, 0x2c }, 211 { 0xbc22, 0x1a }, 212 { 0xf01f, 0x04 }, 213 { 0xf021, 0x03 }, 214 { 0xf023, 0x02 }, 215 { 0xf03d, 0x05 }, 216 { 0xf03f, 0x03 }, 217 { 0xf041, 0x02 }, 218 { 0xf0af, 0x04 }, 219 { 0xf0b1, 0x03 }, 220 { 0xf0b3, 0x02 }, 221 { 0xf0cd, 0x05 }, 222 { 0xf0cf, 0x03 }, 223 { 0xf0d1, 0x02 }, 224 { 0xf13f, 0x04 }, 225 { 0xf141, 0x03 }, 226 { 0xf143, 0x02 }, 227 { 0xf15d, 0x05 }, 228 { 0xf15f, 0x03 }, 229 { 0xf161, 0x02 }, 230 { 0xf1cf, 0x04 }, 231 { 0xf1d1, 0x03 }, 232 { 0xf1d3, 0x02 }, 233 { 0xf1ed, 0x05 }, 234 { 0xf1ef, 0x03 }, 235 { 0xf1f1, 0x02 }, 236 { 0xf287, 0x04 }, 237 { 0xf289, 0x03 }, 238 { 0xf28b, 0x02 }, 239 { 0xf2a5, 0x05 }, 240 { 0xf2a7, 0x03 }, 241 { 0xf2a9, 0x02 }, 242 { 0xf2b7, 0x04 }, 243 { 0xf2b9, 0x03 }, 244 { 0xf2bb, 0x02 }, 245 { 0xf2d5, 0x05 }, 246 { 0xf2d7, 0x03 }, 247 { 0xf2d9, 0x02 }, 248 }; 249 250 static const struct imx319_reg_list imx319_global_setting = { 251 .num_of_regs = ARRAY_SIZE(imx319_global_regs), 252 .regs = imx319_global_regs, 253 }; 254 255 static const struct imx319_reg mode_3264x2448_regs[] = { 256 { 0x0112, 0x0a }, 257 { 0x0113, 0x0a }, 258 { 0x0114, 0x03 }, 259 { 0x0342, 0x0f }, 260 { 0x0343, 0x80 }, 261 { 0x0340, 0x0c }, 262 { 0x0341, 0xaa }, 263 { 0x0344, 0x00 }, 264 { 0x0345, 0x00 }, 265 { 0x0346, 0x00 }, 266 { 0x0347, 0x00 }, 267 { 0x0348, 0x0c }, 268 { 0x0349, 0xcf }, 269 { 0x034a, 0x09 }, 270 { 0x034b, 0x9f }, 271 { 0x0220, 0x00 }, 272 { 0x0221, 0x11 }, 273 { 0x0381, 0x01 }, 274 { 0x0383, 0x01 }, 275 { 0x0385, 0x01 }, 276 { 0x0387, 0x01 }, 277 { 0x0900, 0x00 }, 278 { 0x0901, 0x11 }, 279 { 0x0902, 0x0a }, 280 { 0x3140, 0x02 }, 281 { 0x3141, 0x00 }, 282 { 0x3f0d, 0x0a }, 283 { 0x3f14, 0x01 }, 284 { 0x3f3c, 0x01 }, 285 { 0x3f4d, 0x01 }, 286 { 0x3f4c, 0x01 }, 287 { 0x4254, 0x7f }, 288 { 0x0401, 0x00 }, 289 { 0x0404, 0x00 }, 290 { 0x0405, 0x10 }, 291 { 0x0408, 0x00 }, 292 { 0x0409, 0x08 }, 293 { 0x040a, 0x00 }, 294 { 0x040b, 0x08 }, 295 { 0x040c, 0x0c }, 296 { 0x040d, 0xc0 }, 297 { 0x040e, 0x09 }, 298 { 0x040f, 0x90 }, 299 { 0x034c, 0x0c }, 300 { 0x034d, 0xc0 }, 301 { 0x034e, 0x09 }, 302 { 0x034f, 0x90 }, 303 { 0x3261, 0x00 }, 304 { 0x3264, 0x00 }, 305 { 0x3265, 0x10 }, 306 { 0x0301, 0x05 }, 307 { 0x0303, 0x04 }, 308 { 0x0305, 0x04 }, 309 { 0x0306, 0x01 }, 310 { 0x0307, 0x92 }, 311 { 0x0309, 0x0a }, 312 { 0x030b, 0x02 }, 313 { 0x030d, 0x02 }, 314 { 0x030e, 0x00 }, 315 { 0x030f, 0xfa }, 316 { 0x0310, 0x00 }, 317 { 0x0820, 0x0f }, 318 { 0x0821, 0x13 }, 319 { 0x0822, 0x33 }, 320 { 0x0823, 0x33 }, 321 { 0x3e20, 0x01 }, 322 { 0x3e37, 0x00 }, 323 { 0x3e3b, 0x01 }, 324 { 0x38a3, 0x01 }, 325 { 0x38a8, 0x00 }, 326 { 0x38a9, 0x00 }, 327 { 0x38aa, 0x00 }, 328 { 0x38ab, 0x00 }, 329 { 0x3234, 0x00 }, 330 { 0x3fc1, 0x00 }, 331 { 0x3235, 0x00 }, 332 { 0x3802, 0x00 }, 333 { 0x3143, 0x04 }, 334 { 0x360a, 0x00 }, 335 { 0x0b00, 0x00 }, 336 { 0x0106, 0x00 }, 337 { 0x0b05, 0x01 }, 338 { 0x0b06, 0x01 }, 339 { 0x3230, 0x00 }, 340 { 0x3602, 0x01 }, 341 { 0x3607, 0x01 }, 342 { 0x3c00, 0x00 }, 343 { 0x3c01, 0x48 }, 344 { 0x3c02, 0xc8 }, 345 { 0x3c03, 0xaa }, 346 { 0x3c04, 0x91 }, 347 { 0x3c05, 0x54 }, 348 { 0x3c06, 0x26 }, 349 { 0x3c07, 0x20 }, 350 { 0x3c08, 0x51 }, 351 { 0x3d80, 0x00 }, 352 { 0x3f50, 0x00 }, 353 { 0x3f56, 0x00 }, 354 { 0x3f57, 0x30 }, 355 { 0x3f78, 0x01 }, 356 { 0x3f79, 0x18 }, 357 { 0x3f7c, 0x00 }, 358 { 0x3f7d, 0x00 }, 359 { 0x3fba, 0x00 }, 360 { 0x3fbb, 0x00 }, 361 { 0xa081, 0x00 }, 362 { 0xe014, 0x00 }, 363 { 0x0202, 0x0a }, 364 { 0x0203, 0x7a }, 365 { 0x0224, 0x01 }, 366 { 0x0225, 0xf4 }, 367 { 0x0204, 0x00 }, 368 { 0x0205, 0x00 }, 369 { 0x0216, 0x00 }, 370 { 0x0217, 0x00 }, 371 { 0x020e, 0x01 }, 372 { 0x020f, 0x00 }, 373 { 0x0210, 0x01 }, 374 { 0x0211, 0x00 }, 375 { 0x0212, 0x01 }, 376 { 0x0213, 0x00 }, 377 { 0x0214, 0x01 }, 378 { 0x0215, 0x00 }, 379 { 0x0218, 0x01 }, 380 { 0x0219, 0x00 }, 381 { 0x3614, 0x00 }, 382 { 0x3616, 0x0d }, 383 { 0x3617, 0x56 }, 384 { 0xb612, 0x20 }, 385 { 0xb613, 0x20 }, 386 { 0xb614, 0x20 }, 387 { 0xb615, 0x20 }, 388 { 0xb616, 0x0a }, 389 { 0xb617, 0x0a }, 390 { 0xb618, 0x20 }, 391 { 0xb619, 0x20 }, 392 { 0xb61a, 0x20 }, 393 { 0xb61b, 0x20 }, 394 { 0xb61c, 0x0a }, 395 { 0xb61d, 0x0a }, 396 { 0xb666, 0x30 }, 397 { 0xb667, 0x30 }, 398 { 0xb668, 0x30 }, 399 { 0xb669, 0x30 }, 400 { 0xb66a, 0x14 }, 401 { 0xb66b, 0x14 }, 402 { 0xb66c, 0x20 }, 403 { 0xb66d, 0x20 }, 404 { 0xb66e, 0x20 }, 405 { 0xb66f, 0x20 }, 406 { 0xb670, 0x10 }, 407 { 0xb671, 0x10 }, 408 { 0x3237, 0x00 }, 409 { 0x3900, 0x00 }, 410 { 0x3901, 0x00 }, 411 { 0x3902, 0x00 }, 412 { 0x3904, 0x00 }, 413 { 0x3905, 0x00 }, 414 { 0x3906, 0x00 }, 415 { 0x3907, 0x00 }, 416 { 0x3908, 0x00 }, 417 { 0x3909, 0x00 }, 418 { 0x3912, 0x00 }, 419 { 0x3930, 0x00 }, 420 { 0x3931, 0x00 }, 421 { 0x3933, 0x00 }, 422 { 0x3934, 0x00 }, 423 { 0x3935, 0x00 }, 424 { 0x3936, 0x00 }, 425 { 0x3937, 0x00 }, 426 { 0x30ac, 0x00 }, 427 }; 428 429 static const struct imx319_reg mode_3280x2464_regs[] = { 430 { 0x0112, 0x0a }, 431 { 0x0113, 0x0a }, 432 { 0x0114, 0x03 }, 433 { 0x0342, 0x0f }, 434 { 0x0343, 0x80 }, 435 { 0x0340, 0x0c }, 436 { 0x0341, 0xaa }, 437 { 0x0344, 0x00 }, 438 { 0x0345, 0x00 }, 439 { 0x0346, 0x00 }, 440 { 0x0347, 0x00 }, 441 { 0x0348, 0x0c }, 442 { 0x0349, 0xcf }, 443 { 0x034a, 0x09 }, 444 { 0x034b, 0x9f }, 445 { 0x0220, 0x00 }, 446 { 0x0221, 0x11 }, 447 { 0x0381, 0x01 }, 448 { 0x0383, 0x01 }, 449 { 0x0385, 0x01 }, 450 { 0x0387, 0x01 }, 451 { 0x0900, 0x00 }, 452 { 0x0901, 0x11 }, 453 { 0x0902, 0x0a }, 454 { 0x3140, 0x02 }, 455 { 0x3141, 0x00 }, 456 { 0x3f0d, 0x0a }, 457 { 0x3f14, 0x01 }, 458 { 0x3f3c, 0x01 }, 459 { 0x3f4d, 0x01 }, 460 { 0x3f4c, 0x01 }, 461 { 0x4254, 0x7f }, 462 { 0x0401, 0x00 }, 463 { 0x0404, 0x00 }, 464 { 0x0405, 0x10 }, 465 { 0x0408, 0x00 }, 466 { 0x0409, 0x00 }, 467 { 0x040a, 0x00 }, 468 { 0x040b, 0x00 }, 469 { 0x040c, 0x0c }, 470 { 0x040d, 0xd0 }, 471 { 0x040e, 0x09 }, 472 { 0x040f, 0xa0 }, 473 { 0x034c, 0x0c }, 474 { 0x034d, 0xd0 }, 475 { 0x034e, 0x09 }, 476 { 0x034f, 0xa0 }, 477 { 0x3261, 0x00 }, 478 { 0x3264, 0x00 }, 479 { 0x3265, 0x10 }, 480 { 0x0301, 0x05 }, 481 { 0x0303, 0x04 }, 482 { 0x0305, 0x04 }, 483 { 0x0306, 0x01 }, 484 { 0x0307, 0x92 }, 485 { 0x0309, 0x0a }, 486 { 0x030b, 0x02 }, 487 { 0x030d, 0x02 }, 488 { 0x030e, 0x00 }, 489 { 0x030f, 0xfa }, 490 { 0x0310, 0x00 }, 491 { 0x0820, 0x0f }, 492 { 0x0821, 0x13 }, 493 { 0x0822, 0x33 }, 494 { 0x0823, 0x33 }, 495 { 0x3e20, 0x01 }, 496 { 0x3e37, 0x00 }, 497 { 0x3e3b, 0x01 }, 498 { 0x38a3, 0x01 }, 499 { 0x38a8, 0x00 }, 500 { 0x38a9, 0x00 }, 501 { 0x38aa, 0x00 }, 502 { 0x38ab, 0x00 }, 503 { 0x3234, 0x00 }, 504 { 0x3fc1, 0x00 }, 505 { 0x3235, 0x00 }, 506 { 0x3802, 0x00 }, 507 { 0x3143, 0x04 }, 508 { 0x360a, 0x00 }, 509 { 0x0b00, 0x00 }, 510 { 0x0106, 0x00 }, 511 { 0x0b05, 0x01 }, 512 { 0x0b06, 0x01 }, 513 { 0x3230, 0x00 }, 514 { 0x3602, 0x01 }, 515 { 0x3607, 0x01 }, 516 { 0x3c00, 0x00 }, 517 { 0x3c01, 0x48 }, 518 { 0x3c02, 0xc8 }, 519 { 0x3c03, 0xaa }, 520 { 0x3c04, 0x91 }, 521 { 0x3c05, 0x54 }, 522 { 0x3c06, 0x26 }, 523 { 0x3c07, 0x20 }, 524 { 0x3c08, 0x51 }, 525 { 0x3d80, 0x00 }, 526 { 0x3f50, 0x00 }, 527 { 0x3f56, 0x00 }, 528 { 0x3f57, 0x30 }, 529 { 0x3f78, 0x01 }, 530 { 0x3f79, 0x18 }, 531 { 0x3f7c, 0x00 }, 532 { 0x3f7d, 0x00 }, 533 { 0x3fba, 0x00 }, 534 { 0x3fbb, 0x00 }, 535 { 0xa081, 0x00 }, 536 { 0xe014, 0x00 }, 537 { 0x0202, 0x0a }, 538 { 0x0203, 0x7a }, 539 { 0x0224, 0x01 }, 540 { 0x0225, 0xf4 }, 541 { 0x0204, 0x00 }, 542 { 0x0205, 0x00 }, 543 { 0x0216, 0x00 }, 544 { 0x0217, 0x00 }, 545 { 0x020e, 0x01 }, 546 { 0x020f, 0x00 }, 547 { 0x0210, 0x01 }, 548 { 0x0211, 0x00 }, 549 { 0x0212, 0x01 }, 550 { 0x0213, 0x00 }, 551 { 0x0214, 0x01 }, 552 { 0x0215, 0x00 }, 553 { 0x0218, 0x01 }, 554 { 0x0219, 0x00 }, 555 { 0x3614, 0x00 }, 556 { 0x3616, 0x0d }, 557 { 0x3617, 0x56 }, 558 { 0xb612, 0x20 }, 559 { 0xb613, 0x20 }, 560 { 0xb614, 0x20 }, 561 { 0xb615, 0x20 }, 562 { 0xb616, 0x0a }, 563 { 0xb617, 0x0a }, 564 { 0xb618, 0x20 }, 565 { 0xb619, 0x20 }, 566 { 0xb61a, 0x20 }, 567 { 0xb61b, 0x20 }, 568 { 0xb61c, 0x0a }, 569 { 0xb61d, 0x0a }, 570 { 0xb666, 0x30 }, 571 { 0xb667, 0x30 }, 572 { 0xb668, 0x30 }, 573 { 0xb669, 0x30 }, 574 { 0xb66a, 0x14 }, 575 { 0xb66b, 0x14 }, 576 { 0xb66c, 0x20 }, 577 { 0xb66d, 0x20 }, 578 { 0xb66e, 0x20 }, 579 { 0xb66f, 0x20 }, 580 { 0xb670, 0x10 }, 581 { 0xb671, 0x10 }, 582 { 0x3237, 0x00 }, 583 { 0x3900, 0x00 }, 584 { 0x3901, 0x00 }, 585 { 0x3902, 0x00 }, 586 { 0x3904, 0x00 }, 587 { 0x3905, 0x00 }, 588 { 0x3906, 0x00 }, 589 { 0x3907, 0x00 }, 590 { 0x3908, 0x00 }, 591 { 0x3909, 0x00 }, 592 { 0x3912, 0x00 }, 593 { 0x3930, 0x00 }, 594 { 0x3931, 0x00 }, 595 { 0x3933, 0x00 }, 596 { 0x3934, 0x00 }, 597 { 0x3935, 0x00 }, 598 { 0x3936, 0x00 }, 599 { 0x3937, 0x00 }, 600 { 0x30ac, 0x00 }, 601 }; 602 603 static const struct imx319_reg mode_1936x1096_regs[] = { 604 { 0x0112, 0x0a }, 605 { 0x0113, 0x0a }, 606 { 0x0114, 0x03 }, 607 { 0x0342, 0x0f }, 608 { 0x0343, 0x80 }, 609 { 0x0340, 0x0c }, 610 { 0x0341, 0xaa }, 611 { 0x0344, 0x00 }, 612 { 0x0345, 0x00 }, 613 { 0x0346, 0x02 }, 614 { 0x0347, 0xac }, 615 { 0x0348, 0x0c }, 616 { 0x0349, 0xcf }, 617 { 0x034a, 0x06 }, 618 { 0x034b, 0xf3 }, 619 { 0x0220, 0x00 }, 620 { 0x0221, 0x11 }, 621 { 0x0381, 0x01 }, 622 { 0x0383, 0x01 }, 623 { 0x0385, 0x01 }, 624 { 0x0387, 0x01 }, 625 { 0x0900, 0x00 }, 626 { 0x0901, 0x11 }, 627 { 0x0902, 0x0a }, 628 { 0x3140, 0x02 }, 629 { 0x3141, 0x00 }, 630 { 0x3f0d, 0x0a }, 631 { 0x3f14, 0x01 }, 632 { 0x3f3c, 0x01 }, 633 { 0x3f4d, 0x01 }, 634 { 0x3f4c, 0x01 }, 635 { 0x4254, 0x7f }, 636 { 0x0401, 0x00 }, 637 { 0x0404, 0x00 }, 638 { 0x0405, 0x10 }, 639 { 0x0408, 0x02 }, 640 { 0x0409, 0xa0 }, 641 { 0x040a, 0x00 }, 642 { 0x040b, 0x00 }, 643 { 0x040c, 0x07 }, 644 { 0x040d, 0x90 }, 645 { 0x040e, 0x04 }, 646 { 0x040f, 0x48 }, 647 { 0x034c, 0x07 }, 648 { 0x034d, 0x90 }, 649 { 0x034e, 0x04 }, 650 { 0x034f, 0x48 }, 651 { 0x3261, 0x00 }, 652 { 0x3264, 0x00 }, 653 { 0x3265, 0x10 }, 654 { 0x0301, 0x05 }, 655 { 0x0303, 0x04 }, 656 { 0x0305, 0x04 }, 657 { 0x0306, 0x01 }, 658 { 0x0307, 0x92 }, 659 { 0x0309, 0x0a }, 660 { 0x030b, 0x02 }, 661 { 0x030d, 0x02 }, 662 { 0x030e, 0x00 }, 663 { 0x030f, 0xfa }, 664 { 0x0310, 0x00 }, 665 { 0x0820, 0x0f }, 666 { 0x0821, 0x13 }, 667 { 0x0822, 0x33 }, 668 { 0x0823, 0x33 }, 669 { 0x3e20, 0x01 }, 670 { 0x3e37, 0x00 }, 671 { 0x3e3b, 0x01 }, 672 { 0x38a3, 0x01 }, 673 { 0x38a8, 0x00 }, 674 { 0x38a9, 0x00 }, 675 { 0x38aa, 0x00 }, 676 { 0x38ab, 0x00 }, 677 { 0x3234, 0x00 }, 678 { 0x3fc1, 0x00 }, 679 { 0x3235, 0x00 }, 680 { 0x3802, 0x00 }, 681 { 0x3143, 0x04 }, 682 { 0x360a, 0x00 }, 683 { 0x0b00, 0x00 }, 684 { 0x0106, 0x00 }, 685 { 0x0b05, 0x01 }, 686 { 0x0b06, 0x01 }, 687 { 0x3230, 0x00 }, 688 { 0x3602, 0x01 }, 689 { 0x3607, 0x01 }, 690 { 0x3c00, 0x00 }, 691 { 0x3c01, 0x48 }, 692 { 0x3c02, 0xc8 }, 693 { 0x3c03, 0xaa }, 694 { 0x3c04, 0x91 }, 695 { 0x3c05, 0x54 }, 696 { 0x3c06, 0x26 }, 697 { 0x3c07, 0x20 }, 698 { 0x3c08, 0x51 }, 699 { 0x3d80, 0x00 }, 700 { 0x3f50, 0x00 }, 701 { 0x3f56, 0x00 }, 702 { 0x3f57, 0x30 }, 703 { 0x3f78, 0x01 }, 704 { 0x3f79, 0x18 }, 705 { 0x3f7c, 0x00 }, 706 { 0x3f7d, 0x00 }, 707 { 0x3fba, 0x00 }, 708 { 0x3fbb, 0x00 }, 709 { 0xa081, 0x00 }, 710 { 0xe014, 0x00 }, 711 { 0x0202, 0x05 }, 712 { 0x0203, 0x34 }, 713 { 0x0224, 0x01 }, 714 { 0x0225, 0xf4 }, 715 { 0x0204, 0x00 }, 716 { 0x0205, 0x00 }, 717 { 0x0216, 0x00 }, 718 { 0x0217, 0x00 }, 719 { 0x020e, 0x01 }, 720 { 0x020f, 0x00 }, 721 { 0x0210, 0x01 }, 722 { 0x0211, 0x00 }, 723 { 0x0212, 0x01 }, 724 { 0x0213, 0x00 }, 725 { 0x0214, 0x01 }, 726 { 0x0215, 0x00 }, 727 { 0x0218, 0x01 }, 728 { 0x0219, 0x00 }, 729 { 0x3614, 0x00 }, 730 { 0x3616, 0x0d }, 731 { 0x3617, 0x56 }, 732 { 0xb612, 0x20 }, 733 { 0xb613, 0x20 }, 734 { 0xb614, 0x20 }, 735 { 0xb615, 0x20 }, 736 { 0xb616, 0x0a }, 737 { 0xb617, 0x0a }, 738 { 0xb618, 0x20 }, 739 { 0xb619, 0x20 }, 740 { 0xb61a, 0x20 }, 741 { 0xb61b, 0x20 }, 742 { 0xb61c, 0x0a }, 743 { 0xb61d, 0x0a }, 744 { 0xb666, 0x30 }, 745 { 0xb667, 0x30 }, 746 { 0xb668, 0x30 }, 747 { 0xb669, 0x30 }, 748 { 0xb66a, 0x14 }, 749 { 0xb66b, 0x14 }, 750 { 0xb66c, 0x20 }, 751 { 0xb66d, 0x20 }, 752 { 0xb66e, 0x20 }, 753 { 0xb66f, 0x20 }, 754 { 0xb670, 0x10 }, 755 { 0xb671, 0x10 }, 756 { 0x3237, 0x00 }, 757 { 0x3900, 0x00 }, 758 { 0x3901, 0x00 }, 759 { 0x3902, 0x00 }, 760 { 0x3904, 0x00 }, 761 { 0x3905, 0x00 }, 762 { 0x3906, 0x00 }, 763 { 0x3907, 0x00 }, 764 { 0x3908, 0x00 }, 765 { 0x3909, 0x00 }, 766 { 0x3912, 0x00 }, 767 { 0x3930, 0x00 }, 768 { 0x3931, 0x00 }, 769 { 0x3933, 0x00 }, 770 { 0x3934, 0x00 }, 771 { 0x3935, 0x00 }, 772 { 0x3936, 0x00 }, 773 { 0x3937, 0x00 }, 774 { 0x30ac, 0x00 }, 775 }; 776 777 static const struct imx319_reg mode_1920x1080_regs[] = { 778 { 0x0112, 0x0a }, 779 { 0x0113, 0x0a }, 780 { 0x0114, 0x03 }, 781 { 0x0342, 0x0f }, 782 { 0x0343, 0x80 }, 783 { 0x0340, 0x0c }, 784 { 0x0341, 0xaa }, 785 { 0x0344, 0x00 }, 786 { 0x0345, 0x00 }, 787 { 0x0346, 0x02 }, 788 { 0x0347, 0xb4 }, 789 { 0x0348, 0x0c }, 790 { 0x0349, 0xcf }, 791 { 0x034a, 0x06 }, 792 { 0x034b, 0xeb }, 793 { 0x0220, 0x00 }, 794 { 0x0221, 0x11 }, 795 { 0x0381, 0x01 }, 796 { 0x0383, 0x01 }, 797 { 0x0385, 0x01 }, 798 { 0x0387, 0x01 }, 799 { 0x0900, 0x00 }, 800 { 0x0901, 0x11 }, 801 { 0x0902, 0x0a }, 802 { 0x3140, 0x02 }, 803 { 0x3141, 0x00 }, 804 { 0x3f0d, 0x0a }, 805 { 0x3f14, 0x01 }, 806 { 0x3f3c, 0x01 }, 807 { 0x3f4d, 0x01 }, 808 { 0x3f4c, 0x01 }, 809 { 0x4254, 0x7f }, 810 { 0x0401, 0x00 }, 811 { 0x0404, 0x00 }, 812 { 0x0405, 0x10 }, 813 { 0x0408, 0x02 }, 814 { 0x0409, 0xa8 }, 815 { 0x040a, 0x00 }, 816 { 0x040b, 0x00 }, 817 { 0x040c, 0x07 }, 818 { 0x040d, 0x80 }, 819 { 0x040e, 0x04 }, 820 { 0x040f, 0x38 }, 821 { 0x034c, 0x07 }, 822 { 0x034d, 0x80 }, 823 { 0x034e, 0x04 }, 824 { 0x034f, 0x38 }, 825 { 0x3261, 0x00 }, 826 { 0x3264, 0x00 }, 827 { 0x3265, 0x10 }, 828 { 0x0301, 0x05 }, 829 { 0x0303, 0x04 }, 830 { 0x0305, 0x04 }, 831 { 0x0306, 0x01 }, 832 { 0x0307, 0x92 }, 833 { 0x0309, 0x0a }, 834 { 0x030b, 0x02 }, 835 { 0x030d, 0x02 }, 836 { 0x030e, 0x00 }, 837 { 0x030f, 0xfa }, 838 { 0x0310, 0x00 }, 839 { 0x0820, 0x0f }, 840 { 0x0821, 0x13 }, 841 { 0x0822, 0x33 }, 842 { 0x0823, 0x33 }, 843 { 0x3e20, 0x01 }, 844 { 0x3e37, 0x00 }, 845 { 0x3e3b, 0x01 }, 846 { 0x38a3, 0x01 }, 847 { 0x38a8, 0x00 }, 848 { 0x38a9, 0x00 }, 849 { 0x38aa, 0x00 }, 850 { 0x38ab, 0x00 }, 851 { 0x3234, 0x00 }, 852 { 0x3fc1, 0x00 }, 853 { 0x3235, 0x00 }, 854 { 0x3802, 0x00 }, 855 { 0x3143, 0x04 }, 856 { 0x360a, 0x00 }, 857 { 0x0b00, 0x00 }, 858 { 0x0106, 0x00 }, 859 { 0x0b05, 0x01 }, 860 { 0x0b06, 0x01 }, 861 { 0x3230, 0x00 }, 862 { 0x3602, 0x01 }, 863 { 0x3607, 0x01 }, 864 { 0x3c00, 0x00 }, 865 { 0x3c01, 0x48 }, 866 { 0x3c02, 0xc8 }, 867 { 0x3c03, 0xaa }, 868 { 0x3c04, 0x91 }, 869 { 0x3c05, 0x54 }, 870 { 0x3c06, 0x26 }, 871 { 0x3c07, 0x20 }, 872 { 0x3c08, 0x51 }, 873 { 0x3d80, 0x00 }, 874 { 0x3f50, 0x00 }, 875 { 0x3f56, 0x00 }, 876 { 0x3f57, 0x30 }, 877 { 0x3f78, 0x01 }, 878 { 0x3f79, 0x18 }, 879 { 0x3f7c, 0x00 }, 880 { 0x3f7d, 0x00 }, 881 { 0x3fba, 0x00 }, 882 { 0x3fbb, 0x00 }, 883 { 0xa081, 0x00 }, 884 { 0xe014, 0x00 }, 885 { 0x0202, 0x05 }, 886 { 0x0203, 0x34 }, 887 { 0x0224, 0x01 }, 888 { 0x0225, 0xf4 }, 889 { 0x0204, 0x00 }, 890 { 0x0205, 0x00 }, 891 { 0x0216, 0x00 }, 892 { 0x0217, 0x00 }, 893 { 0x020e, 0x01 }, 894 { 0x020f, 0x00 }, 895 { 0x0210, 0x01 }, 896 { 0x0211, 0x00 }, 897 { 0x0212, 0x01 }, 898 { 0x0213, 0x00 }, 899 { 0x0214, 0x01 }, 900 { 0x0215, 0x00 }, 901 { 0x0218, 0x01 }, 902 { 0x0219, 0x00 }, 903 { 0x3614, 0x00 }, 904 { 0x3616, 0x0d }, 905 { 0x3617, 0x56 }, 906 { 0xb612, 0x20 }, 907 { 0xb613, 0x20 }, 908 { 0xb614, 0x20 }, 909 { 0xb615, 0x20 }, 910 { 0xb616, 0x0a }, 911 { 0xb617, 0x0a }, 912 { 0xb618, 0x20 }, 913 { 0xb619, 0x20 }, 914 { 0xb61a, 0x20 }, 915 { 0xb61b, 0x20 }, 916 { 0xb61c, 0x0a }, 917 { 0xb61d, 0x0a }, 918 { 0xb666, 0x30 }, 919 { 0xb667, 0x30 }, 920 { 0xb668, 0x30 }, 921 { 0xb669, 0x30 }, 922 { 0xb66a, 0x14 }, 923 { 0xb66b, 0x14 }, 924 { 0xb66c, 0x20 }, 925 { 0xb66d, 0x20 }, 926 { 0xb66e, 0x20 }, 927 { 0xb66f, 0x20 }, 928 { 0xb670, 0x10 }, 929 { 0xb671, 0x10 }, 930 { 0x3237, 0x00 }, 931 { 0x3900, 0x00 }, 932 { 0x3901, 0x00 }, 933 { 0x3902, 0x00 }, 934 { 0x3904, 0x00 }, 935 { 0x3905, 0x00 }, 936 { 0x3906, 0x00 }, 937 { 0x3907, 0x00 }, 938 { 0x3908, 0x00 }, 939 { 0x3909, 0x00 }, 940 { 0x3912, 0x00 }, 941 { 0x3930, 0x00 }, 942 { 0x3931, 0x00 }, 943 { 0x3933, 0x00 }, 944 { 0x3934, 0x00 }, 945 { 0x3935, 0x00 }, 946 { 0x3936, 0x00 }, 947 { 0x3937, 0x00 }, 948 { 0x30ac, 0x00 }, 949 }; 950 951 static const struct imx319_reg mode_1640x1232_regs[] = { 952 { 0x0112, 0x0a }, 953 { 0x0113, 0x0a }, 954 { 0x0114, 0x03 }, 955 { 0x0342, 0x08 }, 956 { 0x0343, 0x20 }, 957 { 0x0340, 0x18 }, 958 { 0x0341, 0x2a }, 959 { 0x0344, 0x00 }, 960 { 0x0345, 0x00 }, 961 { 0x0346, 0x00 }, 962 { 0x0347, 0x00 }, 963 { 0x0348, 0x0c }, 964 { 0x0349, 0xcf }, 965 { 0x034a, 0x09 }, 966 { 0x034b, 0x9f }, 967 { 0x0220, 0x00 }, 968 { 0x0221, 0x11 }, 969 { 0x0381, 0x01 }, 970 { 0x0383, 0x01 }, 971 { 0x0385, 0x01 }, 972 { 0x0387, 0x01 }, 973 { 0x0900, 0x01 }, 974 { 0x0901, 0x22 }, 975 { 0x0902, 0x0a }, 976 { 0x3140, 0x02 }, 977 { 0x3141, 0x00 }, 978 { 0x3f0d, 0x0a }, 979 { 0x3f14, 0x01 }, 980 { 0x3f3c, 0x02 }, 981 { 0x3f4d, 0x01 }, 982 { 0x3f4c, 0x01 }, 983 { 0x4254, 0x7f }, 984 { 0x0401, 0x00 }, 985 { 0x0404, 0x00 }, 986 { 0x0405, 0x10 }, 987 { 0x0408, 0x00 }, 988 { 0x0409, 0x00 }, 989 { 0x040a, 0x00 }, 990 { 0x040b, 0x00 }, 991 { 0x040c, 0x06 }, 992 { 0x040d, 0x68 }, 993 { 0x040e, 0x04 }, 994 { 0x040f, 0xd0 }, 995 { 0x034c, 0x06 }, 996 { 0x034d, 0x68 }, 997 { 0x034e, 0x04 }, 998 { 0x034f, 0xd0 }, 999 { 0x3261, 0x00 }, 1000 { 0x3264, 0x00 }, 1001 { 0x3265, 0x10 }, 1002 { 0x0301, 0x05 }, 1003 { 0x0303, 0x04 }, 1004 { 0x0305, 0x04 }, 1005 { 0x0306, 0x01 }, 1006 { 0x0307, 0x92 }, 1007 { 0x0309, 0x0a }, 1008 { 0x030b, 0x02 }, 1009 { 0x030d, 0x02 }, 1010 { 0x030e, 0x00 }, 1011 { 0x030f, 0xfa }, 1012 { 0x0310, 0x00 }, 1013 { 0x0820, 0x0f }, 1014 { 0x0821, 0x13 }, 1015 { 0x0822, 0x33 }, 1016 { 0x0823, 0x33 }, 1017 { 0x3e20, 0x01 }, 1018 { 0x3e37, 0x00 }, 1019 { 0x3e3b, 0x01 }, 1020 { 0x38a3, 0x01 }, 1021 { 0x38a8, 0x00 }, 1022 { 0x38a9, 0x00 }, 1023 { 0x38aa, 0x00 }, 1024 { 0x38ab, 0x00 }, 1025 { 0x3234, 0x00 }, 1026 { 0x3fc1, 0x00 }, 1027 { 0x3235, 0x00 }, 1028 { 0x3802, 0x00 }, 1029 { 0x3143, 0x04 }, 1030 { 0x360a, 0x00 }, 1031 { 0x0b00, 0x00 }, 1032 { 0x0106, 0x00 }, 1033 { 0x0b05, 0x01 }, 1034 { 0x0b06, 0x01 }, 1035 { 0x3230, 0x00 }, 1036 { 0x3602, 0x01 }, 1037 { 0x3607, 0x01 }, 1038 { 0x3c00, 0x00 }, 1039 { 0x3c01, 0xba }, 1040 { 0x3c02, 0xc8 }, 1041 { 0x3c03, 0xaa }, 1042 { 0x3c04, 0x91 }, 1043 { 0x3c05, 0x54 }, 1044 { 0x3c06, 0x26 }, 1045 { 0x3c07, 0x20 }, 1046 { 0x3c08, 0x51 }, 1047 { 0x3d80, 0x00 }, 1048 { 0x3f50, 0x00 }, 1049 { 0x3f56, 0x00 }, 1050 { 0x3f57, 0x30 }, 1051 { 0x3f78, 0x00 }, 1052 { 0x3f79, 0x34 }, 1053 { 0x3f7c, 0x00 }, 1054 { 0x3f7d, 0x00 }, 1055 { 0x3fba, 0x00 }, 1056 { 0x3fbb, 0x00 }, 1057 { 0xa081, 0x04 }, 1058 { 0xe014, 0x00 }, 1059 { 0x0202, 0x04 }, 1060 { 0x0203, 0xf6 }, 1061 { 0x0224, 0x01 }, 1062 { 0x0225, 0xf4 }, 1063 { 0x0204, 0x00 }, 1064 { 0x0205, 0x00 }, 1065 { 0x0216, 0x00 }, 1066 { 0x0217, 0x00 }, 1067 { 0x020e, 0x01 }, 1068 { 0x020f, 0x00 }, 1069 { 0x0210, 0x01 }, 1070 { 0x0211, 0x00 }, 1071 { 0x0212, 0x01 }, 1072 { 0x0213, 0x00 }, 1073 { 0x0214, 0x01 }, 1074 { 0x0215, 0x00 }, 1075 { 0x0218, 0x01 }, 1076 { 0x0219, 0x00 }, 1077 { 0x3614, 0x00 }, 1078 { 0x3616, 0x0d }, 1079 { 0x3617, 0x56 }, 1080 { 0xb612, 0x20 }, 1081 { 0xb613, 0x20 }, 1082 { 0xb614, 0x20 }, 1083 { 0xb615, 0x20 }, 1084 { 0xb616, 0x0a }, 1085 { 0xb617, 0x0a }, 1086 { 0xb618, 0x20 }, 1087 { 0xb619, 0x20 }, 1088 { 0xb61a, 0x20 }, 1089 { 0xb61b, 0x20 }, 1090 { 0xb61c, 0x0a }, 1091 { 0xb61d, 0x0a }, 1092 { 0xb666, 0x30 }, 1093 { 0xb667, 0x30 }, 1094 { 0xb668, 0x30 }, 1095 { 0xb669, 0x30 }, 1096 { 0xb66a, 0x14 }, 1097 { 0xb66b, 0x14 }, 1098 { 0xb66c, 0x20 }, 1099 { 0xb66d, 0x20 }, 1100 { 0xb66e, 0x20 }, 1101 { 0xb66f, 0x20 }, 1102 { 0xb670, 0x10 }, 1103 { 0xb671, 0x10 }, 1104 { 0x3237, 0x00 }, 1105 { 0x3900, 0x00 }, 1106 { 0x3901, 0x00 }, 1107 { 0x3902, 0x00 }, 1108 { 0x3904, 0x00 }, 1109 { 0x3905, 0x00 }, 1110 { 0x3906, 0x00 }, 1111 { 0x3907, 0x00 }, 1112 { 0x3908, 0x00 }, 1113 { 0x3909, 0x00 }, 1114 { 0x3912, 0x00 }, 1115 { 0x3930, 0x00 }, 1116 { 0x3931, 0x00 }, 1117 { 0x3933, 0x00 }, 1118 { 0x3934, 0x00 }, 1119 { 0x3935, 0x00 }, 1120 { 0x3936, 0x00 }, 1121 { 0x3937, 0x00 }, 1122 { 0x30ac, 0x00 }, 1123 }; 1124 1125 static const struct imx319_reg mode_1640x922_regs[] = { 1126 { 0x0112, 0x0a }, 1127 { 0x0113, 0x0a }, 1128 { 0x0114, 0x03 }, 1129 { 0x0342, 0x08 }, 1130 { 0x0343, 0x20 }, 1131 { 0x0340, 0x18 }, 1132 { 0x0341, 0x2a }, 1133 { 0x0344, 0x00 }, 1134 { 0x0345, 0x00 }, 1135 { 0x0346, 0x01 }, 1136 { 0x0347, 0x30 }, 1137 { 0x0348, 0x0c }, 1138 { 0x0349, 0xcf }, 1139 { 0x034a, 0x08 }, 1140 { 0x034b, 0x6f }, 1141 { 0x0220, 0x00 }, 1142 { 0x0221, 0x11 }, 1143 { 0x0381, 0x01 }, 1144 { 0x0383, 0x01 }, 1145 { 0x0385, 0x01 }, 1146 { 0x0387, 0x01 }, 1147 { 0x0900, 0x01 }, 1148 { 0x0901, 0x22 }, 1149 { 0x0902, 0x0a }, 1150 { 0x3140, 0x02 }, 1151 { 0x3141, 0x00 }, 1152 { 0x3f0d, 0x0a }, 1153 { 0x3f14, 0x01 }, 1154 { 0x3f3c, 0x02 }, 1155 { 0x3f4d, 0x01 }, 1156 { 0x3f4c, 0x01 }, 1157 { 0x4254, 0x7f }, 1158 { 0x0401, 0x00 }, 1159 { 0x0404, 0x00 }, 1160 { 0x0405, 0x10 }, 1161 { 0x0408, 0x00 }, 1162 { 0x0409, 0x00 }, 1163 { 0x040a, 0x00 }, 1164 { 0x040b, 0x02 }, 1165 { 0x040c, 0x06 }, 1166 { 0x040d, 0x68 }, 1167 { 0x040e, 0x03 }, 1168 { 0x040f, 0x9a }, 1169 { 0x034c, 0x06 }, 1170 { 0x034d, 0x68 }, 1171 { 0x034e, 0x03 }, 1172 { 0x034f, 0x9a }, 1173 { 0x3261, 0x00 }, 1174 { 0x3264, 0x00 }, 1175 { 0x3265, 0x10 }, 1176 { 0x0301, 0x05 }, 1177 { 0x0303, 0x04 }, 1178 { 0x0305, 0x04 }, 1179 { 0x0306, 0x01 }, 1180 { 0x0307, 0x92 }, 1181 { 0x0309, 0x0a }, 1182 { 0x030b, 0x02 }, 1183 { 0x030d, 0x02 }, 1184 { 0x030e, 0x00 }, 1185 { 0x030f, 0xfa }, 1186 { 0x0310, 0x00 }, 1187 { 0x0820, 0x0f }, 1188 { 0x0821, 0x13 }, 1189 { 0x0822, 0x33 }, 1190 { 0x0823, 0x33 }, 1191 { 0x3e20, 0x01 }, 1192 { 0x3e37, 0x00 }, 1193 { 0x3e3b, 0x01 }, 1194 { 0x38a3, 0x01 }, 1195 { 0x38a8, 0x00 }, 1196 { 0x38a9, 0x00 }, 1197 { 0x38aa, 0x00 }, 1198 { 0x38ab, 0x00 }, 1199 { 0x3234, 0x00 }, 1200 { 0x3fc1, 0x00 }, 1201 { 0x3235, 0x00 }, 1202 { 0x3802, 0x00 }, 1203 { 0x3143, 0x04 }, 1204 { 0x360a, 0x00 }, 1205 { 0x0b00, 0x00 }, 1206 { 0x0106, 0x00 }, 1207 { 0x0b05, 0x01 }, 1208 { 0x0b06, 0x01 }, 1209 { 0x3230, 0x00 }, 1210 { 0x3602, 0x01 }, 1211 { 0x3607, 0x01 }, 1212 { 0x3c00, 0x00 }, 1213 { 0x3c01, 0xba }, 1214 { 0x3c02, 0xc8 }, 1215 { 0x3c03, 0xaa }, 1216 { 0x3c04, 0x91 }, 1217 { 0x3c05, 0x54 }, 1218 { 0x3c06, 0x26 }, 1219 { 0x3c07, 0x20 }, 1220 { 0x3c08, 0x51 }, 1221 { 0x3d80, 0x00 }, 1222 { 0x3f50, 0x00 }, 1223 { 0x3f56, 0x00 }, 1224 { 0x3f57, 0x30 }, 1225 { 0x3f78, 0x00 }, 1226 { 0x3f79, 0x34 }, 1227 { 0x3f7c, 0x00 }, 1228 { 0x3f7d, 0x00 }, 1229 { 0x3fba, 0x00 }, 1230 { 0x3fbb, 0x00 }, 1231 { 0xa081, 0x04 }, 1232 { 0xe014, 0x00 }, 1233 { 0x0202, 0x04 }, 1234 { 0x0203, 0xf6 }, 1235 { 0x0224, 0x01 }, 1236 { 0x0225, 0xf4 }, 1237 { 0x0204, 0x00 }, 1238 { 0x0205, 0x00 }, 1239 { 0x0216, 0x00 }, 1240 { 0x0217, 0x00 }, 1241 { 0x020e, 0x01 }, 1242 { 0x020f, 0x00 }, 1243 { 0x0210, 0x01 }, 1244 { 0x0211, 0x00 }, 1245 { 0x0212, 0x01 }, 1246 { 0x0213, 0x00 }, 1247 { 0x0214, 0x01 }, 1248 { 0x0215, 0x00 }, 1249 { 0x0218, 0x01 }, 1250 { 0x0219, 0x00 }, 1251 { 0x3614, 0x00 }, 1252 { 0x3616, 0x0d }, 1253 { 0x3617, 0x56 }, 1254 { 0xb612, 0x20 }, 1255 { 0xb613, 0x20 }, 1256 { 0xb614, 0x20 }, 1257 { 0xb615, 0x20 }, 1258 { 0xb616, 0x0a }, 1259 { 0xb617, 0x0a }, 1260 { 0xb618, 0x20 }, 1261 { 0xb619, 0x20 }, 1262 { 0xb61a, 0x20 }, 1263 { 0xb61b, 0x20 }, 1264 { 0xb61c, 0x0a }, 1265 { 0xb61d, 0x0a }, 1266 { 0xb666, 0x30 }, 1267 { 0xb667, 0x30 }, 1268 { 0xb668, 0x30 }, 1269 { 0xb669, 0x30 }, 1270 { 0xb66a, 0x14 }, 1271 { 0xb66b, 0x14 }, 1272 { 0xb66c, 0x20 }, 1273 { 0xb66d, 0x20 }, 1274 { 0xb66e, 0x20 }, 1275 { 0xb66f, 0x20 }, 1276 { 0xb670, 0x10 }, 1277 { 0xb671, 0x10 }, 1278 { 0x3237, 0x00 }, 1279 { 0x3900, 0x00 }, 1280 { 0x3901, 0x00 }, 1281 { 0x3902, 0x00 }, 1282 { 0x3904, 0x00 }, 1283 { 0x3905, 0x00 }, 1284 { 0x3906, 0x00 }, 1285 { 0x3907, 0x00 }, 1286 { 0x3908, 0x00 }, 1287 { 0x3909, 0x00 }, 1288 { 0x3912, 0x00 }, 1289 { 0x3930, 0x00 }, 1290 { 0x3931, 0x00 }, 1291 { 0x3933, 0x00 }, 1292 { 0x3934, 0x00 }, 1293 { 0x3935, 0x00 }, 1294 { 0x3936, 0x00 }, 1295 { 0x3937, 0x00 }, 1296 { 0x30ac, 0x00 }, 1297 }; 1298 1299 static const struct imx319_reg mode_1296x736_regs[] = { 1300 { 0x0112, 0x0a }, 1301 { 0x0113, 0x0a }, 1302 { 0x0114, 0x03 }, 1303 { 0x0342, 0x08 }, 1304 { 0x0343, 0x20 }, 1305 { 0x0340, 0x18 }, 1306 { 0x0341, 0x2a }, 1307 { 0x0344, 0x00 }, 1308 { 0x0345, 0x00 }, 1309 { 0x0346, 0x01 }, 1310 { 0x0347, 0xf0 }, 1311 { 0x0348, 0x0c }, 1312 { 0x0349, 0xcf }, 1313 { 0x034a, 0x07 }, 1314 { 0x034b, 0xaf }, 1315 { 0x0220, 0x00 }, 1316 { 0x0221, 0x11 }, 1317 { 0x0381, 0x01 }, 1318 { 0x0383, 0x01 }, 1319 { 0x0385, 0x01 }, 1320 { 0x0387, 0x01 }, 1321 { 0x0900, 0x01 }, 1322 { 0x0901, 0x22 }, 1323 { 0x0902, 0x0a }, 1324 { 0x3140, 0x02 }, 1325 { 0x3141, 0x00 }, 1326 { 0x3f0d, 0x0a }, 1327 { 0x3f14, 0x01 }, 1328 { 0x3f3c, 0x02 }, 1329 { 0x3f4d, 0x01 }, 1330 { 0x3f4c, 0x01 }, 1331 { 0x4254, 0x7f }, 1332 { 0x0401, 0x00 }, 1333 { 0x0404, 0x00 }, 1334 { 0x0405, 0x10 }, 1335 { 0x0408, 0x00 }, 1336 { 0x0409, 0xac }, 1337 { 0x040a, 0x00 }, 1338 { 0x040b, 0x00 }, 1339 { 0x040c, 0x05 }, 1340 { 0x040d, 0x10 }, 1341 { 0x040e, 0x02 }, 1342 { 0x040f, 0xe0 }, 1343 { 0x034c, 0x05 }, 1344 { 0x034d, 0x10 }, 1345 { 0x034e, 0x02 }, 1346 { 0x034f, 0xe0 }, 1347 { 0x3261, 0x00 }, 1348 { 0x3264, 0x00 }, 1349 { 0x3265, 0x10 }, 1350 { 0x0301, 0x05 }, 1351 { 0x0303, 0x04 }, 1352 { 0x0305, 0x04 }, 1353 { 0x0306, 0x01 }, 1354 { 0x0307, 0x92 }, 1355 { 0x0309, 0x0a }, 1356 { 0x030b, 0x02 }, 1357 { 0x030d, 0x02 }, 1358 { 0x030e, 0x00 }, 1359 { 0x030f, 0xfa }, 1360 { 0x0310, 0x00 }, 1361 { 0x0820, 0x0f }, 1362 { 0x0821, 0x13 }, 1363 { 0x0822, 0x33 }, 1364 { 0x0823, 0x33 }, 1365 { 0x3e20, 0x01 }, 1366 { 0x3e37, 0x00 }, 1367 { 0x3e3b, 0x01 }, 1368 { 0x38a3, 0x01 }, 1369 { 0x38a8, 0x00 }, 1370 { 0x38a9, 0x00 }, 1371 { 0x38aa, 0x00 }, 1372 { 0x38ab, 0x00 }, 1373 { 0x3234, 0x00 }, 1374 { 0x3fc1, 0x00 }, 1375 { 0x3235, 0x00 }, 1376 { 0x3802, 0x00 }, 1377 { 0x3143, 0x04 }, 1378 { 0x360a, 0x00 }, 1379 { 0x0b00, 0x00 }, 1380 { 0x0106, 0x00 }, 1381 { 0x0b05, 0x01 }, 1382 { 0x0b06, 0x01 }, 1383 { 0x3230, 0x00 }, 1384 { 0x3602, 0x01 }, 1385 { 0x3607, 0x01 }, 1386 { 0x3c00, 0x00 }, 1387 { 0x3c01, 0xba }, 1388 { 0x3c02, 0xc8 }, 1389 { 0x3c03, 0xaa }, 1390 { 0x3c04, 0x91 }, 1391 { 0x3c05, 0x54 }, 1392 { 0x3c06, 0x26 }, 1393 { 0x3c07, 0x20 }, 1394 { 0x3c08, 0x51 }, 1395 { 0x3d80, 0x00 }, 1396 { 0x3f50, 0x00 }, 1397 { 0x3f56, 0x00 }, 1398 { 0x3f57, 0x30 }, 1399 { 0x3f78, 0x00 }, 1400 { 0x3f79, 0x34 }, 1401 { 0x3f7c, 0x00 }, 1402 { 0x3f7d, 0x00 }, 1403 { 0x3fba, 0x00 }, 1404 { 0x3fbb, 0x00 }, 1405 { 0xa081, 0x04 }, 1406 { 0xe014, 0x00 }, 1407 { 0x0202, 0x04 }, 1408 { 0x0203, 0xf6 }, 1409 { 0x0224, 0x01 }, 1410 { 0x0225, 0xf4 }, 1411 { 0x0204, 0x00 }, 1412 { 0x0205, 0x00 }, 1413 { 0x0216, 0x00 }, 1414 { 0x0217, 0x00 }, 1415 { 0x020e, 0x01 }, 1416 { 0x020f, 0x00 }, 1417 { 0x0210, 0x01 }, 1418 { 0x0211, 0x00 }, 1419 { 0x0212, 0x01 }, 1420 { 0x0213, 0x00 }, 1421 { 0x0214, 0x01 }, 1422 { 0x0215, 0x00 }, 1423 { 0x0218, 0x01 }, 1424 { 0x0219, 0x00 }, 1425 { 0x3614, 0x00 }, 1426 { 0x3616, 0x0d }, 1427 { 0x3617, 0x56 }, 1428 { 0xb612, 0x20 }, 1429 { 0xb613, 0x20 }, 1430 { 0xb614, 0x20 }, 1431 { 0xb615, 0x20 }, 1432 { 0xb616, 0x0a }, 1433 { 0xb617, 0x0a }, 1434 { 0xb618, 0x20 }, 1435 { 0xb619, 0x20 }, 1436 { 0xb61a, 0x20 }, 1437 { 0xb61b, 0x20 }, 1438 { 0xb61c, 0x0a }, 1439 { 0xb61d, 0x0a }, 1440 { 0xb666, 0x30 }, 1441 { 0xb667, 0x30 }, 1442 { 0xb668, 0x30 }, 1443 { 0xb669, 0x30 }, 1444 { 0xb66a, 0x14 }, 1445 { 0xb66b, 0x14 }, 1446 { 0xb66c, 0x20 }, 1447 { 0xb66d, 0x20 }, 1448 { 0xb66e, 0x20 }, 1449 { 0xb66f, 0x20 }, 1450 { 0xb670, 0x10 }, 1451 { 0xb671, 0x10 }, 1452 { 0x3237, 0x00 }, 1453 { 0x3900, 0x00 }, 1454 { 0x3901, 0x00 }, 1455 { 0x3902, 0x00 }, 1456 { 0x3904, 0x00 }, 1457 { 0x3905, 0x00 }, 1458 { 0x3906, 0x00 }, 1459 { 0x3907, 0x00 }, 1460 { 0x3908, 0x00 }, 1461 { 0x3909, 0x00 }, 1462 { 0x3912, 0x00 }, 1463 { 0x3930, 0x00 }, 1464 { 0x3931, 0x00 }, 1465 { 0x3933, 0x00 }, 1466 { 0x3934, 0x00 }, 1467 { 0x3935, 0x00 }, 1468 { 0x3936, 0x00 }, 1469 { 0x3937, 0x00 }, 1470 { 0x30ac, 0x00 }, 1471 }; 1472 1473 static const struct imx319_reg mode_1280x720_regs[] = { 1474 { 0x0112, 0x0a }, 1475 { 0x0113, 0x0a }, 1476 { 0x0114, 0x03 }, 1477 { 0x0342, 0x08 }, 1478 { 0x0343, 0x20 }, 1479 { 0x0340, 0x18 }, 1480 { 0x0341, 0x2a }, 1481 { 0x0344, 0x00 }, 1482 { 0x0345, 0x00 }, 1483 { 0x0346, 0x02 }, 1484 { 0x0347, 0x00 }, 1485 { 0x0348, 0x0c }, 1486 { 0x0349, 0xcf }, 1487 { 0x034a, 0x07 }, 1488 { 0x034b, 0x9f }, 1489 { 0x0220, 0x00 }, 1490 { 0x0221, 0x11 }, 1491 { 0x0381, 0x01 }, 1492 { 0x0383, 0x01 }, 1493 { 0x0385, 0x01 }, 1494 { 0x0387, 0x01 }, 1495 { 0x0900, 0x01 }, 1496 { 0x0901, 0x22 }, 1497 { 0x0902, 0x0a }, 1498 { 0x3140, 0x02 }, 1499 { 0x3141, 0x00 }, 1500 { 0x3f0d, 0x0a }, 1501 { 0x3f14, 0x01 }, 1502 { 0x3f3c, 0x02 }, 1503 { 0x3f4d, 0x01 }, 1504 { 0x3f4c, 0x01 }, 1505 { 0x4254, 0x7f }, 1506 { 0x0401, 0x00 }, 1507 { 0x0404, 0x00 }, 1508 { 0x0405, 0x10 }, 1509 { 0x0408, 0x00 }, 1510 { 0x0409, 0xb4 }, 1511 { 0x040a, 0x00 }, 1512 { 0x040b, 0x00 }, 1513 { 0x040c, 0x05 }, 1514 { 0x040d, 0x00 }, 1515 { 0x040e, 0x02 }, 1516 { 0x040f, 0xd0 }, 1517 { 0x034c, 0x05 }, 1518 { 0x034d, 0x00 }, 1519 { 0x034e, 0x02 }, 1520 { 0x034f, 0xd0 }, 1521 { 0x3261, 0x00 }, 1522 { 0x3264, 0x00 }, 1523 { 0x3265, 0x10 }, 1524 { 0x0301, 0x05 }, 1525 { 0x0303, 0x04 }, 1526 { 0x0305, 0x04 }, 1527 { 0x0306, 0x01 }, 1528 { 0x0307, 0x92 }, 1529 { 0x0309, 0x0a }, 1530 { 0x030b, 0x02 }, 1531 { 0x030d, 0x02 }, 1532 { 0x030e, 0x00 }, 1533 { 0x030f, 0xfa }, 1534 { 0x0310, 0x00 }, 1535 { 0x0820, 0x0f }, 1536 { 0x0821, 0x13 }, 1537 { 0x0822, 0x33 }, 1538 { 0x0823, 0x33 }, 1539 { 0x3e20, 0x01 }, 1540 { 0x3e37, 0x00 }, 1541 { 0x3e3b, 0x01 }, 1542 { 0x38a3, 0x01 }, 1543 { 0x38a8, 0x00 }, 1544 { 0x38a9, 0x00 }, 1545 { 0x38aa, 0x00 }, 1546 { 0x38ab, 0x00 }, 1547 { 0x3234, 0x00 }, 1548 { 0x3fc1, 0x00 }, 1549 { 0x3235, 0x00 }, 1550 { 0x3802, 0x00 }, 1551 { 0x3143, 0x04 }, 1552 { 0x360a, 0x00 }, 1553 { 0x0b00, 0x00 }, 1554 { 0x0106, 0x00 }, 1555 { 0x0b05, 0x01 }, 1556 { 0x0b06, 0x01 }, 1557 { 0x3230, 0x00 }, 1558 { 0x3602, 0x01 }, 1559 { 0x3607, 0x01 }, 1560 { 0x3c00, 0x00 }, 1561 { 0x3c01, 0xba }, 1562 { 0x3c02, 0xc8 }, 1563 { 0x3c03, 0xaa }, 1564 { 0x3c04, 0x91 }, 1565 { 0x3c05, 0x54 }, 1566 { 0x3c06, 0x26 }, 1567 { 0x3c07, 0x20 }, 1568 { 0x3c08, 0x51 }, 1569 { 0x3d80, 0x00 }, 1570 { 0x3f50, 0x00 }, 1571 { 0x3f56, 0x00 }, 1572 { 0x3f57, 0x30 }, 1573 { 0x3f78, 0x00 }, 1574 { 0x3f79, 0x34 }, 1575 { 0x3f7c, 0x00 }, 1576 { 0x3f7d, 0x00 }, 1577 { 0x3fba, 0x00 }, 1578 { 0x3fbb, 0x00 }, 1579 { 0xa081, 0x04 }, 1580 { 0xe014, 0x00 }, 1581 { 0x0202, 0x04 }, 1582 { 0x0203, 0xf6 }, 1583 { 0x0224, 0x01 }, 1584 { 0x0225, 0xf4 }, 1585 { 0x0204, 0x00 }, 1586 { 0x0205, 0x00 }, 1587 { 0x0216, 0x00 }, 1588 { 0x0217, 0x00 }, 1589 { 0x020e, 0x01 }, 1590 { 0x020f, 0x00 }, 1591 { 0x0210, 0x01 }, 1592 { 0x0211, 0x00 }, 1593 { 0x0212, 0x01 }, 1594 { 0x0213, 0x00 }, 1595 { 0x0214, 0x01 }, 1596 { 0x0215, 0x00 }, 1597 { 0x0218, 0x01 }, 1598 { 0x0219, 0x00 }, 1599 { 0x3614, 0x00 }, 1600 { 0x3616, 0x0d }, 1601 { 0x3617, 0x56 }, 1602 { 0xb612, 0x20 }, 1603 { 0xb613, 0x20 }, 1604 { 0xb614, 0x20 }, 1605 { 0xb615, 0x20 }, 1606 { 0xb616, 0x0a }, 1607 { 0xb617, 0x0a }, 1608 { 0xb618, 0x20 }, 1609 { 0xb619, 0x20 }, 1610 { 0xb61a, 0x20 }, 1611 { 0xb61b, 0x20 }, 1612 { 0xb61c, 0x0a }, 1613 { 0xb61d, 0x0a }, 1614 { 0xb666, 0x30 }, 1615 { 0xb667, 0x30 }, 1616 { 0xb668, 0x30 }, 1617 { 0xb669, 0x30 }, 1618 { 0xb66a, 0x14 }, 1619 { 0xb66b, 0x14 }, 1620 { 0xb66c, 0x20 }, 1621 { 0xb66d, 0x20 }, 1622 { 0xb66e, 0x20 }, 1623 { 0xb66f, 0x20 }, 1624 { 0xb670, 0x10 }, 1625 { 0xb671, 0x10 }, 1626 { 0x3237, 0x00 }, 1627 { 0x3900, 0x00 }, 1628 { 0x3901, 0x00 }, 1629 { 0x3902, 0x00 }, 1630 { 0x3904, 0x00 }, 1631 { 0x3905, 0x00 }, 1632 { 0x3906, 0x00 }, 1633 { 0x3907, 0x00 }, 1634 { 0x3908, 0x00 }, 1635 { 0x3909, 0x00 }, 1636 { 0x3912, 0x00 }, 1637 { 0x3930, 0x00 }, 1638 { 0x3931, 0x00 }, 1639 { 0x3933, 0x00 }, 1640 { 0x3934, 0x00 }, 1641 { 0x3935, 0x00 }, 1642 { 0x3936, 0x00 }, 1643 { 0x3937, 0x00 }, 1644 { 0x30ac, 0x00 }, 1645 }; 1646 1647 static const char * const imx319_test_pattern_menu[] = { 1648 "Disabled", 1649 "Solid Colour", 1650 "Eight Vertical Colour Bars", 1651 "Colour Bars With Fade to Grey", 1652 "Pseudorandom Sequence (PN9)", 1653 }; 1654 1655 /* 1656 * When adding more than the one below, make sure the disallowed ones will 1657 * actually be disabled in the LINK_FREQ control. 1658 */ 1659 static const s64 link_freq_menu_items[] = { 1660 IMX319_LINK_FREQ_DEFAULT, 1661 }; 1662 1663 /* Mode configs */ 1664 static const struct imx319_mode supported_modes[] = { 1665 { 1666 .width = 3280, 1667 .height = 2464, 1668 .fll_def = 3242, 1669 .fll_min = 3242, 1670 .llp = 3968, 1671 .link_freq_index = IMX319_LINK_FREQ_INDEX, 1672 .reg_list = { 1673 .num_of_regs = ARRAY_SIZE(mode_3280x2464_regs), 1674 .regs = mode_3280x2464_regs, 1675 }, 1676 }, 1677 { 1678 .width = 3264, 1679 .height = 2448, 1680 .fll_def = 3242, 1681 .fll_min = 3242, 1682 .llp = 3968, 1683 .link_freq_index = IMX319_LINK_FREQ_INDEX, 1684 .reg_list = { 1685 .num_of_regs = ARRAY_SIZE(mode_3264x2448_regs), 1686 .regs = mode_3264x2448_regs, 1687 }, 1688 }, 1689 { 1690 .width = 1936, 1691 .height = 1096, 1692 .fll_def = 3242, 1693 .fll_min = 3242, 1694 .llp = 3968, 1695 .link_freq_index = IMX319_LINK_FREQ_INDEX, 1696 .reg_list = { 1697 .num_of_regs = ARRAY_SIZE(mode_1936x1096_regs), 1698 .regs = mode_1936x1096_regs, 1699 }, 1700 }, 1701 { 1702 .width = 1920, 1703 .height = 1080, 1704 .fll_def = 3242, 1705 .fll_min = 3242, 1706 .llp = 3968, 1707 .link_freq_index = IMX319_LINK_FREQ_INDEX, 1708 .reg_list = { 1709 .num_of_regs = ARRAY_SIZE(mode_1920x1080_regs), 1710 .regs = mode_1920x1080_regs, 1711 }, 1712 }, 1713 { 1714 .width = 1640, 1715 .height = 1232, 1716 .fll_def = 5146, 1717 .fll_min = 5146, 1718 .llp = 2500, 1719 .link_freq_index = IMX319_LINK_FREQ_INDEX, 1720 .reg_list = { 1721 .num_of_regs = ARRAY_SIZE(mode_1640x1232_regs), 1722 .regs = mode_1640x1232_regs, 1723 }, 1724 }, 1725 { 1726 .width = 1640, 1727 .height = 922, 1728 .fll_def = 5146, 1729 .fll_min = 5146, 1730 .llp = 2500, 1731 .link_freq_index = IMX319_LINK_FREQ_INDEX, 1732 .reg_list = { 1733 .num_of_regs = ARRAY_SIZE(mode_1640x922_regs), 1734 .regs = mode_1640x922_regs, 1735 }, 1736 }, 1737 { 1738 .width = 1296, 1739 .height = 736, 1740 .fll_def = 5146, 1741 .fll_min = 5146, 1742 .llp = 2500, 1743 .link_freq_index = IMX319_LINK_FREQ_INDEX, 1744 .reg_list = { 1745 .num_of_regs = ARRAY_SIZE(mode_1296x736_regs), 1746 .regs = mode_1296x736_regs, 1747 }, 1748 }, 1749 { 1750 .width = 1280, 1751 .height = 720, 1752 .fll_def = 5146, 1753 .fll_min = 5146, 1754 .llp = 2500, 1755 .link_freq_index = IMX319_LINK_FREQ_INDEX, 1756 .reg_list = { 1757 .num_of_regs = ARRAY_SIZE(mode_1280x720_regs), 1758 .regs = mode_1280x720_regs, 1759 }, 1760 }, 1761 }; 1762 1763 static inline struct imx319 *to_imx319(struct v4l2_subdev *_sd) 1764 { 1765 return container_of(_sd, struct imx319, sd); 1766 } 1767 1768 /* Get bayer order based on flip setting. */ 1769 static u32 imx319_get_format_code(struct imx319 *imx319) 1770 { 1771 /* 1772 * Only one bayer order is supported. 1773 * It depends on the flip settings. 1774 */ 1775 u32 code; 1776 static const u32 codes[2][2] = { 1777 { MEDIA_BUS_FMT_SRGGB10_1X10, MEDIA_BUS_FMT_SGRBG10_1X10, }, 1778 { MEDIA_BUS_FMT_SGBRG10_1X10, MEDIA_BUS_FMT_SBGGR10_1X10, }, 1779 }; 1780 1781 lockdep_assert_held(&imx319->mutex); 1782 code = codes[imx319->vflip->val][imx319->hflip->val]; 1783 1784 return code; 1785 } 1786 1787 /* Read registers up to 4 at a time */ 1788 static int imx319_read_reg(struct imx319 *imx319, u16 reg, u32 len, u32 *val) 1789 { 1790 struct i2c_client *client = v4l2_get_subdevdata(&imx319->sd); 1791 struct i2c_msg msgs[2]; 1792 u8 addr_buf[2]; 1793 u8 data_buf[4] = { 0 }; 1794 int ret; 1795 1796 if (len > 4) 1797 return -EINVAL; 1798 1799 put_unaligned_be16(reg, addr_buf); 1800 /* Write register address */ 1801 msgs[0].addr = client->addr; 1802 msgs[0].flags = 0; 1803 msgs[0].len = ARRAY_SIZE(addr_buf); 1804 msgs[0].buf = addr_buf; 1805 1806 /* Read data from register */ 1807 msgs[1].addr = client->addr; 1808 msgs[1].flags = I2C_M_RD; 1809 msgs[1].len = len; 1810 msgs[1].buf = &data_buf[4 - len]; 1811 1812 ret = i2c_transfer(client->adapter, msgs, ARRAY_SIZE(msgs)); 1813 if (ret != ARRAY_SIZE(msgs)) 1814 return -EIO; 1815 1816 *val = get_unaligned_be32(data_buf); 1817 1818 return 0; 1819 } 1820 1821 /* Write registers up to 4 at a time */ 1822 static int imx319_write_reg(struct imx319 *imx319, u16 reg, u32 len, u32 val) 1823 { 1824 struct i2c_client *client = v4l2_get_subdevdata(&imx319->sd); 1825 u8 buf[6]; 1826 1827 if (len > 4) 1828 return -EINVAL; 1829 1830 put_unaligned_be16(reg, buf); 1831 put_unaligned_be32(val << (8 * (4 - len)), buf + 2); 1832 if (i2c_master_send(client, buf, len + 2) != len + 2) 1833 return -EIO; 1834 1835 return 0; 1836 } 1837 1838 /* Write a list of registers */ 1839 static int imx319_write_regs(struct imx319 *imx319, 1840 const struct imx319_reg *regs, u32 len) 1841 { 1842 struct i2c_client *client = v4l2_get_subdevdata(&imx319->sd); 1843 int ret; 1844 u32 i; 1845 1846 for (i = 0; i < len; i++) { 1847 ret = imx319_write_reg(imx319, regs[i].address, 1, regs[i].val); 1848 if (ret) { 1849 dev_err_ratelimited(&client->dev, 1850 "write reg 0x%4.4x return err %d", 1851 regs[i].address, ret); 1852 return ret; 1853 } 1854 } 1855 1856 return 0; 1857 } 1858 1859 /* Open sub-device */ 1860 static int imx319_open(struct v4l2_subdev *sd, struct v4l2_subdev_fh *fh) 1861 { 1862 struct imx319 *imx319 = to_imx319(sd); 1863 struct v4l2_mbus_framefmt *try_fmt = 1864 v4l2_subdev_state_get_format(fh->state, 0); 1865 1866 mutex_lock(&imx319->mutex); 1867 1868 /* Initialize try_fmt */ 1869 try_fmt->width = imx319->cur_mode->width; 1870 try_fmt->height = imx319->cur_mode->height; 1871 try_fmt->code = imx319_get_format_code(imx319); 1872 try_fmt->field = V4L2_FIELD_NONE; 1873 1874 mutex_unlock(&imx319->mutex); 1875 1876 return 0; 1877 } 1878 1879 static int imx319_set_ctrl(struct v4l2_ctrl *ctrl) 1880 { 1881 struct imx319 *imx319 = container_of(ctrl->handler, 1882 struct imx319, ctrl_handler); 1883 struct i2c_client *client = v4l2_get_subdevdata(&imx319->sd); 1884 s64 max; 1885 int ret; 1886 1887 /* Propagate change of current control to all related controls */ 1888 switch (ctrl->id) { 1889 case V4L2_CID_VBLANK: 1890 /* Update max exposure while meeting expected vblanking */ 1891 max = imx319->cur_mode->height + ctrl->val - 18; 1892 __v4l2_ctrl_modify_range(imx319->exposure, 1893 imx319->exposure->minimum, 1894 max, imx319->exposure->step, max); 1895 break; 1896 } 1897 1898 /* 1899 * Applying V4L2 control value only happens 1900 * when power is up for streaming 1901 */ 1902 if (!pm_runtime_get_if_in_use(&client->dev)) 1903 return 0; 1904 1905 switch (ctrl->id) { 1906 case V4L2_CID_ANALOGUE_GAIN: 1907 /* Analog gain = 1024/(1024 - ctrl->val) times */ 1908 ret = imx319_write_reg(imx319, IMX319_REG_ANALOG_GAIN, 2, 1909 ctrl->val); 1910 break; 1911 case V4L2_CID_DIGITAL_GAIN: 1912 ret = imx319_write_reg(imx319, IMX319_REG_DIG_GAIN_GLOBAL, 2, 1913 ctrl->val); 1914 break; 1915 case V4L2_CID_EXPOSURE: 1916 ret = imx319_write_reg(imx319, IMX319_REG_EXPOSURE, 2, 1917 ctrl->val); 1918 break; 1919 case V4L2_CID_VBLANK: 1920 /* Update FLL that meets expected vertical blanking */ 1921 ret = imx319_write_reg(imx319, IMX319_REG_FLL, 2, 1922 imx319->cur_mode->height + ctrl->val); 1923 break; 1924 case V4L2_CID_TEST_PATTERN: 1925 ret = imx319_write_reg(imx319, IMX319_REG_TEST_PATTERN, 1926 2, ctrl->val); 1927 break; 1928 case V4L2_CID_HFLIP: 1929 case V4L2_CID_VFLIP: 1930 ret = imx319_write_reg(imx319, IMX319_REG_ORIENTATION, 1, 1931 imx319->hflip->val | 1932 imx319->vflip->val << 1); 1933 break; 1934 default: 1935 ret = -EINVAL; 1936 dev_info(&client->dev, "ctrl(id:0x%x,val:0x%x) is not handled", 1937 ctrl->id, ctrl->val); 1938 break; 1939 } 1940 1941 pm_runtime_put(&client->dev); 1942 1943 return ret; 1944 } 1945 1946 static const struct v4l2_ctrl_ops imx319_ctrl_ops = { 1947 .s_ctrl = imx319_set_ctrl, 1948 }; 1949 1950 static int imx319_enum_mbus_code(struct v4l2_subdev *sd, 1951 struct v4l2_subdev_state *sd_state, 1952 struct v4l2_subdev_mbus_code_enum *code) 1953 { 1954 struct imx319 *imx319 = to_imx319(sd); 1955 1956 if (code->index > 0) 1957 return -EINVAL; 1958 1959 mutex_lock(&imx319->mutex); 1960 code->code = imx319_get_format_code(imx319); 1961 mutex_unlock(&imx319->mutex); 1962 1963 return 0; 1964 } 1965 1966 static int imx319_enum_frame_size(struct v4l2_subdev *sd, 1967 struct v4l2_subdev_state *sd_state, 1968 struct v4l2_subdev_frame_size_enum *fse) 1969 { 1970 struct imx319 *imx319 = to_imx319(sd); 1971 1972 if (fse->index >= ARRAY_SIZE(supported_modes)) 1973 return -EINVAL; 1974 1975 mutex_lock(&imx319->mutex); 1976 if (fse->code != imx319_get_format_code(imx319)) { 1977 mutex_unlock(&imx319->mutex); 1978 return -EINVAL; 1979 } 1980 mutex_unlock(&imx319->mutex); 1981 1982 fse->min_width = supported_modes[fse->index].width; 1983 fse->max_width = fse->min_width; 1984 fse->min_height = supported_modes[fse->index].height; 1985 fse->max_height = fse->min_height; 1986 1987 return 0; 1988 } 1989 1990 static void imx319_update_pad_format(struct imx319 *imx319, 1991 const struct imx319_mode *mode, 1992 struct v4l2_subdev_format *fmt) 1993 { 1994 fmt->format.width = mode->width; 1995 fmt->format.height = mode->height; 1996 fmt->format.code = imx319_get_format_code(imx319); 1997 fmt->format.field = V4L2_FIELD_NONE; 1998 } 1999 2000 static int imx319_do_get_pad_format(struct imx319 *imx319, 2001 struct v4l2_subdev_state *sd_state, 2002 struct v4l2_subdev_format *fmt) 2003 { 2004 struct v4l2_mbus_framefmt *framefmt; 2005 2006 if (fmt->which == V4L2_SUBDEV_FORMAT_TRY) { 2007 framefmt = v4l2_subdev_state_get_format(sd_state, fmt->pad); 2008 fmt->format = *framefmt; 2009 } else { 2010 imx319_update_pad_format(imx319, imx319->cur_mode, fmt); 2011 } 2012 2013 return 0; 2014 } 2015 2016 static int imx319_get_pad_format(struct v4l2_subdev *sd, 2017 struct v4l2_subdev_state *sd_state, 2018 struct v4l2_subdev_format *fmt) 2019 { 2020 struct imx319 *imx319 = to_imx319(sd); 2021 int ret; 2022 2023 mutex_lock(&imx319->mutex); 2024 ret = imx319_do_get_pad_format(imx319, sd_state, fmt); 2025 mutex_unlock(&imx319->mutex); 2026 2027 return ret; 2028 } 2029 2030 static int 2031 imx319_set_pad_format(struct v4l2_subdev *sd, 2032 struct v4l2_subdev_state *sd_state, 2033 struct v4l2_subdev_format *fmt) 2034 { 2035 struct imx319 *imx319 = to_imx319(sd); 2036 const struct imx319_mode *mode; 2037 struct v4l2_mbus_framefmt *framefmt; 2038 s32 vblank_def; 2039 s32 vblank_min; 2040 s64 h_blank; 2041 u64 pixel_rate; 2042 u32 height; 2043 2044 mutex_lock(&imx319->mutex); 2045 2046 /* 2047 * Only one bayer order is supported. 2048 * It depends on the flip settings. 2049 */ 2050 fmt->format.code = imx319_get_format_code(imx319); 2051 2052 mode = v4l2_find_nearest_size(supported_modes, 2053 ARRAY_SIZE(supported_modes), 2054 width, height, 2055 fmt->format.width, fmt->format.height); 2056 imx319_update_pad_format(imx319, mode, fmt); 2057 if (fmt->which == V4L2_SUBDEV_FORMAT_TRY) { 2058 framefmt = v4l2_subdev_state_get_format(sd_state, fmt->pad); 2059 *framefmt = fmt->format; 2060 } else { 2061 imx319->cur_mode = mode; 2062 pixel_rate = IMX319_LINK_FREQ_DEFAULT * 2 * 4; 2063 do_div(pixel_rate, 10); 2064 __v4l2_ctrl_s_ctrl_int64(imx319->pixel_rate, pixel_rate); 2065 /* Update limits and set FPS to default */ 2066 height = imx319->cur_mode->height; 2067 vblank_def = imx319->cur_mode->fll_def - height; 2068 vblank_min = imx319->cur_mode->fll_min - height; 2069 height = IMX319_FLL_MAX - height; 2070 __v4l2_ctrl_modify_range(imx319->vblank, vblank_min, height, 1, 2071 vblank_def); 2072 __v4l2_ctrl_s_ctrl(imx319->vblank, vblank_def); 2073 h_blank = mode->llp - imx319->cur_mode->width; 2074 /* 2075 * Currently hblank is not changeable. 2076 * So FPS control is done only by vblank. 2077 */ 2078 __v4l2_ctrl_modify_range(imx319->hblank, h_blank, 2079 h_blank, 1, h_blank); 2080 } 2081 2082 mutex_unlock(&imx319->mutex); 2083 2084 return 0; 2085 } 2086 2087 /* Verify chip ID */ 2088 static int imx319_identify_module(struct imx319 *imx319) 2089 { 2090 struct i2c_client *client = v4l2_get_subdevdata(&imx319->sd); 2091 int ret; 2092 u32 val; 2093 2094 if (imx319->identified) 2095 return 0; 2096 2097 ret = imx319_read_reg(imx319, IMX319_REG_CHIP_ID, 2, &val); 2098 if (ret) 2099 return ret; 2100 2101 if (val != IMX319_CHIP_ID) { 2102 dev_err(&client->dev, "chip id mismatch: %x!=%x", 2103 IMX319_CHIP_ID, val); 2104 return -EIO; 2105 } 2106 2107 imx319->identified = true; 2108 2109 return 0; 2110 } 2111 2112 /* Start streaming */ 2113 static int imx319_start_streaming(struct imx319 *imx319) 2114 { 2115 struct i2c_client *client = v4l2_get_subdevdata(&imx319->sd); 2116 const struct imx319_reg_list *reg_list; 2117 int ret; 2118 2119 ret = imx319_identify_module(imx319); 2120 if (ret) 2121 return ret; 2122 2123 /* Global Setting */ 2124 reg_list = &imx319_global_setting; 2125 ret = imx319_write_regs(imx319, reg_list->regs, reg_list->num_of_regs); 2126 if (ret) { 2127 dev_err(&client->dev, "failed to set global settings"); 2128 return ret; 2129 } 2130 2131 /* Apply default values of current mode */ 2132 reg_list = &imx319->cur_mode->reg_list; 2133 ret = imx319_write_regs(imx319, reg_list->regs, reg_list->num_of_regs); 2134 if (ret) { 2135 dev_err(&client->dev, "failed to set mode"); 2136 return ret; 2137 } 2138 2139 /* set digital gain control to all color mode */ 2140 ret = imx319_write_reg(imx319, IMX319_REG_DPGA_USE_GLOBAL_GAIN, 1, 1); 2141 if (ret) 2142 return ret; 2143 2144 /* Apply customized values from user */ 2145 ret = __v4l2_ctrl_handler_setup(imx319->sd.ctrl_handler); 2146 if (ret) 2147 return ret; 2148 2149 return imx319_write_reg(imx319, IMX319_REG_MODE_SELECT, 2150 1, IMX319_MODE_STREAMING); 2151 } 2152 2153 /* Stop streaming */ 2154 static int imx319_stop_streaming(struct imx319 *imx319) 2155 { 2156 return imx319_write_reg(imx319, IMX319_REG_MODE_SELECT, 2157 1, IMX319_MODE_STANDBY); 2158 } 2159 2160 static int imx319_set_stream(struct v4l2_subdev *sd, int enable) 2161 { 2162 struct imx319 *imx319 = to_imx319(sd); 2163 struct i2c_client *client = v4l2_get_subdevdata(sd); 2164 int ret = 0; 2165 2166 mutex_lock(&imx319->mutex); 2167 2168 if (enable) { 2169 ret = pm_runtime_resume_and_get(&client->dev); 2170 if (ret < 0) 2171 goto err_unlock; 2172 2173 /* 2174 * Apply default & customized values 2175 * and then start streaming. 2176 */ 2177 ret = imx319_start_streaming(imx319); 2178 if (ret) 2179 goto err_rpm_put; 2180 } else { 2181 imx319_stop_streaming(imx319); 2182 pm_runtime_put(&client->dev); 2183 } 2184 2185 /* vflip and hflip cannot change during streaming */ 2186 __v4l2_ctrl_grab(imx319->vflip, enable); 2187 __v4l2_ctrl_grab(imx319->hflip, enable); 2188 2189 mutex_unlock(&imx319->mutex); 2190 2191 return ret; 2192 2193 err_rpm_put: 2194 pm_runtime_put(&client->dev); 2195 err_unlock: 2196 mutex_unlock(&imx319->mutex); 2197 2198 return ret; 2199 } 2200 2201 static const struct v4l2_subdev_core_ops imx319_subdev_core_ops = { 2202 .subscribe_event = v4l2_ctrl_subdev_subscribe_event, 2203 .unsubscribe_event = v4l2_event_subdev_unsubscribe, 2204 }; 2205 2206 static const struct v4l2_subdev_video_ops imx319_video_ops = { 2207 .s_stream = imx319_set_stream, 2208 }; 2209 2210 static const struct v4l2_subdev_pad_ops imx319_pad_ops = { 2211 .enum_mbus_code = imx319_enum_mbus_code, 2212 .get_fmt = imx319_get_pad_format, 2213 .set_fmt = imx319_set_pad_format, 2214 .enum_frame_size = imx319_enum_frame_size, 2215 }; 2216 2217 static const struct v4l2_subdev_ops imx319_subdev_ops = { 2218 .core = &imx319_subdev_core_ops, 2219 .video = &imx319_video_ops, 2220 .pad = &imx319_pad_ops, 2221 }; 2222 2223 static const struct media_entity_operations imx319_subdev_entity_ops = { 2224 .link_validate = v4l2_subdev_link_validate, 2225 }; 2226 2227 static const struct v4l2_subdev_internal_ops imx319_internal_ops = { 2228 .open = imx319_open, 2229 }; 2230 2231 /* Initialize control handlers */ 2232 static int imx319_init_controls(struct imx319 *imx319) 2233 { 2234 struct i2c_client *client = v4l2_get_subdevdata(&imx319->sd); 2235 struct v4l2_ctrl_handler *ctrl_hdlr; 2236 s64 exposure_max; 2237 s64 vblank_def; 2238 s64 vblank_min; 2239 s64 hblank; 2240 u64 pixel_rate; 2241 const struct imx319_mode *mode; 2242 u32 max; 2243 int ret; 2244 2245 ctrl_hdlr = &imx319->ctrl_handler; 2246 ret = v4l2_ctrl_handler_init(ctrl_hdlr, 10); 2247 if (ret) 2248 return ret; 2249 2250 ctrl_hdlr->lock = &imx319->mutex; 2251 max = ARRAY_SIZE(link_freq_menu_items) - 1; 2252 imx319->link_freq = v4l2_ctrl_new_int_menu(ctrl_hdlr, &imx319_ctrl_ops, 2253 V4L2_CID_LINK_FREQ, max, 0, 2254 link_freq_menu_items); 2255 if (imx319->link_freq) 2256 imx319->link_freq->flags |= V4L2_CTRL_FLAG_READ_ONLY; 2257 2258 /* pixel_rate = link_freq * 2 * nr_of_lanes / bits_per_sample */ 2259 pixel_rate = IMX319_LINK_FREQ_DEFAULT * 2 * 4; 2260 do_div(pixel_rate, 10); 2261 /* By default, PIXEL_RATE is read only */ 2262 imx319->pixel_rate = v4l2_ctrl_new_std(ctrl_hdlr, &imx319_ctrl_ops, 2263 V4L2_CID_PIXEL_RATE, pixel_rate, 2264 pixel_rate, 1, pixel_rate); 2265 2266 /* Initial vblank/hblank/exposure parameters based on current mode */ 2267 mode = imx319->cur_mode; 2268 vblank_def = mode->fll_def - mode->height; 2269 vblank_min = mode->fll_min - mode->height; 2270 imx319->vblank = v4l2_ctrl_new_std(ctrl_hdlr, &imx319_ctrl_ops, 2271 V4L2_CID_VBLANK, vblank_min, 2272 IMX319_FLL_MAX - mode->height, 2273 1, vblank_def); 2274 2275 hblank = mode->llp - mode->width; 2276 imx319->hblank = v4l2_ctrl_new_std(ctrl_hdlr, &imx319_ctrl_ops, 2277 V4L2_CID_HBLANK, hblank, hblank, 2278 1, hblank); 2279 if (imx319->hblank) 2280 imx319->hblank->flags |= V4L2_CTRL_FLAG_READ_ONLY; 2281 2282 /* fll >= exposure time + adjust parameter (default value is 18) */ 2283 exposure_max = mode->fll_def - 18; 2284 imx319->exposure = v4l2_ctrl_new_std(ctrl_hdlr, &imx319_ctrl_ops, 2285 V4L2_CID_EXPOSURE, 2286 IMX319_EXPOSURE_MIN, exposure_max, 2287 IMX319_EXPOSURE_STEP, 2288 IMX319_EXPOSURE_DEFAULT); 2289 2290 imx319->hflip = v4l2_ctrl_new_std(ctrl_hdlr, &imx319_ctrl_ops, 2291 V4L2_CID_HFLIP, 0, 1, 1, 0); 2292 if (imx319->hflip) 2293 imx319->hflip->flags |= V4L2_CTRL_FLAG_MODIFY_LAYOUT; 2294 imx319->vflip = v4l2_ctrl_new_std(ctrl_hdlr, &imx319_ctrl_ops, 2295 V4L2_CID_VFLIP, 0, 1, 1, 0); 2296 if (imx319->vflip) 2297 imx319->vflip->flags |= V4L2_CTRL_FLAG_MODIFY_LAYOUT; 2298 2299 v4l2_ctrl_new_std(ctrl_hdlr, &imx319_ctrl_ops, V4L2_CID_ANALOGUE_GAIN, 2300 IMX319_ANA_GAIN_MIN, IMX319_ANA_GAIN_MAX, 2301 IMX319_ANA_GAIN_STEP, IMX319_ANA_GAIN_DEFAULT); 2302 2303 /* Digital gain */ 2304 v4l2_ctrl_new_std(ctrl_hdlr, &imx319_ctrl_ops, V4L2_CID_DIGITAL_GAIN, 2305 IMX319_DGTL_GAIN_MIN, IMX319_DGTL_GAIN_MAX, 2306 IMX319_DGTL_GAIN_STEP, IMX319_DGTL_GAIN_DEFAULT); 2307 2308 v4l2_ctrl_new_std_menu_items(ctrl_hdlr, &imx319_ctrl_ops, 2309 V4L2_CID_TEST_PATTERN, 2310 ARRAY_SIZE(imx319_test_pattern_menu) - 1, 2311 0, 0, imx319_test_pattern_menu); 2312 if (ctrl_hdlr->error) { 2313 ret = ctrl_hdlr->error; 2314 dev_err(&client->dev, "control init failed: %d", ret); 2315 goto error; 2316 } 2317 2318 imx319->sd.ctrl_handler = ctrl_hdlr; 2319 2320 return 0; 2321 2322 error: 2323 v4l2_ctrl_handler_free(ctrl_hdlr); 2324 2325 return ret; 2326 } 2327 2328 static struct imx319_hwcfg *imx319_get_hwcfg(struct device *dev) 2329 { 2330 struct imx319_hwcfg *cfg; 2331 struct v4l2_fwnode_endpoint bus_cfg = { 2332 .bus_type = V4L2_MBUS_CSI2_DPHY 2333 }; 2334 struct fwnode_handle *ep; 2335 struct fwnode_handle *fwnode = dev_fwnode(dev); 2336 int ret; 2337 2338 if (!fwnode) 2339 return NULL; 2340 2341 ep = fwnode_graph_get_next_endpoint(fwnode, NULL); 2342 if (!ep) 2343 return NULL; 2344 2345 ret = v4l2_fwnode_endpoint_alloc_parse(ep, &bus_cfg); 2346 if (ret) 2347 goto out_err; 2348 2349 cfg = devm_kzalloc(dev, sizeof(*cfg), GFP_KERNEL); 2350 if (!cfg) 2351 goto out_err; 2352 2353 ret = fwnode_property_read_u32(dev_fwnode(dev), "clock-frequency", 2354 &cfg->ext_clk); 2355 if (ret) { 2356 dev_err(dev, "can't get clock frequency"); 2357 goto out_err; 2358 } 2359 2360 dev_dbg(dev, "ext clk: %d", cfg->ext_clk); 2361 if (cfg->ext_clk != IMX319_EXT_CLK) { 2362 dev_err(dev, "external clock %d is not supported", 2363 cfg->ext_clk); 2364 goto out_err; 2365 } 2366 2367 ret = v4l2_link_freq_to_bitmap(dev, bus_cfg.link_frequencies, 2368 bus_cfg.nr_of_link_frequencies, 2369 link_freq_menu_items, 2370 ARRAY_SIZE(link_freq_menu_items), 2371 &cfg->link_freq_bitmap); 2372 if (ret) 2373 goto out_err; 2374 2375 v4l2_fwnode_endpoint_free(&bus_cfg); 2376 fwnode_handle_put(ep); 2377 return cfg; 2378 2379 out_err: 2380 v4l2_fwnode_endpoint_free(&bus_cfg); 2381 fwnode_handle_put(ep); 2382 return NULL; 2383 } 2384 2385 static int imx319_probe(struct i2c_client *client) 2386 { 2387 struct imx319 *imx319; 2388 bool full_power; 2389 int ret; 2390 2391 imx319 = devm_kzalloc(&client->dev, sizeof(*imx319), GFP_KERNEL); 2392 if (!imx319) 2393 return -ENOMEM; 2394 2395 mutex_init(&imx319->mutex); 2396 2397 /* Initialize subdev */ 2398 v4l2_i2c_subdev_init(&imx319->sd, client, &imx319_subdev_ops); 2399 2400 full_power = acpi_dev_state_d0(&client->dev); 2401 if (full_power) { 2402 /* Check module identity */ 2403 ret = imx319_identify_module(imx319); 2404 if (ret) { 2405 dev_err(&client->dev, "failed to find sensor: %d", ret); 2406 goto error_probe; 2407 } 2408 } 2409 2410 imx319->hwcfg = imx319_get_hwcfg(&client->dev); 2411 if (!imx319->hwcfg) { 2412 dev_err(&client->dev, "failed to get hwcfg"); 2413 ret = -ENODEV; 2414 goto error_probe; 2415 } 2416 2417 /* Set default mode to max resolution */ 2418 imx319->cur_mode = &supported_modes[0]; 2419 2420 ret = imx319_init_controls(imx319); 2421 if (ret) { 2422 dev_err(&client->dev, "failed to init controls: %d", ret); 2423 goto error_probe; 2424 } 2425 2426 /* Initialize subdev */ 2427 imx319->sd.internal_ops = &imx319_internal_ops; 2428 imx319->sd.flags |= V4L2_SUBDEV_FL_HAS_DEVNODE | 2429 V4L2_SUBDEV_FL_HAS_EVENTS; 2430 imx319->sd.entity.ops = &imx319_subdev_entity_ops; 2431 imx319->sd.entity.function = MEDIA_ENT_F_CAM_SENSOR; 2432 2433 /* Initialize source pad */ 2434 imx319->pad.flags = MEDIA_PAD_FL_SOURCE; 2435 ret = media_entity_pads_init(&imx319->sd.entity, 1, &imx319->pad); 2436 if (ret) { 2437 dev_err(&client->dev, "failed to init entity pads: %d", ret); 2438 goto error_handler_free; 2439 } 2440 2441 /* Set the device's state to active if it's in D0 state. */ 2442 if (full_power) 2443 pm_runtime_set_active(&client->dev); 2444 pm_runtime_enable(&client->dev); 2445 pm_runtime_idle(&client->dev); 2446 2447 ret = v4l2_async_register_subdev_sensor(&imx319->sd); 2448 if (ret < 0) 2449 goto error_media_entity_pm; 2450 2451 return 0; 2452 2453 error_media_entity_pm: 2454 pm_runtime_disable(&client->dev); 2455 pm_runtime_set_suspended(&client->dev); 2456 media_entity_cleanup(&imx319->sd.entity); 2457 2458 error_handler_free: 2459 v4l2_ctrl_handler_free(imx319->sd.ctrl_handler); 2460 2461 error_probe: 2462 mutex_destroy(&imx319->mutex); 2463 2464 return ret; 2465 } 2466 2467 static void imx319_remove(struct i2c_client *client) 2468 { 2469 struct v4l2_subdev *sd = i2c_get_clientdata(client); 2470 struct imx319 *imx319 = to_imx319(sd); 2471 2472 v4l2_async_unregister_subdev(sd); 2473 media_entity_cleanup(&sd->entity); 2474 v4l2_ctrl_handler_free(sd->ctrl_handler); 2475 2476 pm_runtime_disable(&client->dev); 2477 pm_runtime_set_suspended(&client->dev); 2478 2479 mutex_destroy(&imx319->mutex); 2480 } 2481 2482 static const struct acpi_device_id imx319_acpi_ids[] __maybe_unused = { 2483 { "SONY319A" }, 2484 { /* sentinel */ } 2485 }; 2486 MODULE_DEVICE_TABLE(acpi, imx319_acpi_ids); 2487 2488 static struct i2c_driver imx319_i2c_driver = { 2489 .driver = { 2490 .name = "imx319", 2491 .acpi_match_table = ACPI_PTR(imx319_acpi_ids), 2492 }, 2493 .probe = imx319_probe, 2494 .remove = imx319_remove, 2495 .flags = I2C_DRV_ACPI_WAIVE_D0_PROBE, 2496 }; 2497 module_i2c_driver(imx319_i2c_driver); 2498 2499 MODULE_AUTHOR("Qiu, Tianshu <tian.shu.qiu@intel.com>"); 2500 MODULE_AUTHOR("Rapolu, Chiranjeevi"); 2501 MODULE_AUTHOR("Bingbu Cao <bingbu.cao@intel.com>"); 2502 MODULE_AUTHOR("Yang, Hyungwoo"); 2503 MODULE_DESCRIPTION("Sony imx319 sensor driver"); 2504 MODULE_LICENSE("GPL v2"); 2505