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