]>
Commit | Line | Data |
---|---|---|
417d2e50 BP |
1 | /* |
2 | * TI VPFE capture Driver | |
3 | * | |
4 | * Copyright (C) 2013 - 2014 Texas Instruments, Inc. | |
5 | * | |
6 | * Benoit Parrot <bparrot@ti.com> | |
7 | * Lad, Prabhakar <prabhakar.csengg@gmail.com> | |
8 | * | |
9 | * This program is free software; you may redistribute it and/or modify | |
10 | * it under the terms of the GNU General Public License as published by | |
11 | * the Free Software Foundation; version 2 of the License. | |
12 | * | |
13 | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, | |
14 | * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF | |
15 | * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND | |
16 | * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS | |
17 | * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN | |
18 | * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN | |
19 | * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE | |
20 | * SOFTWARE. | |
21 | */ | |
22 | ||
23 | #include <linux/delay.h> | |
24 | #include <linux/err.h> | |
25 | #include <linux/init.h> | |
26 | #include <linux/interrupt.h> | |
27 | #include <linux/io.h> | |
28 | #include <linux/module.h> | |
29 | #include <linux/pinctrl/consumer.h> | |
30 | #include <linux/platform_device.h> | |
31 | #include <linux/pm_runtime.h> | |
32 | #include <linux/slab.h> | |
33 | #include <linux/uaccess.h> | |
34 | #include <linux/videodev2.h> | |
35 | ||
36 | #include <media/v4l2-common.h> | |
37 | #include <media/v4l2-ctrls.h> | |
38 | #include <media/v4l2-event.h> | |
39 | #include <media/v4l2-of.h> | |
40 | ||
41 | #include "am437x-vpfe.h" | |
42 | ||
43 | #define VPFE_MODULE_NAME "vpfe" | |
44 | #define VPFE_VERSION "0.1.0" | |
45 | ||
46 | static int debug; | |
47 | module_param(debug, int, 0644); | |
48 | MODULE_PARM_DESC(debug, "Debug level 0-8"); | |
49 | ||
50 | #define vpfe_dbg(level, dev, fmt, arg...) \ | |
51 | v4l2_dbg(level, debug, &dev->v4l2_dev, fmt, ##arg) | |
52 | #define vpfe_info(dev, fmt, arg...) \ | |
53 | v4l2_info(&dev->v4l2_dev, fmt, ##arg) | |
54 | #define vpfe_err(dev, fmt, arg...) \ | |
55 | v4l2_err(&dev->v4l2_dev, fmt, ##arg) | |
56 | ||
57 | /* standard information */ | |
58 | struct vpfe_standard { | |
59 | v4l2_std_id std_id; | |
60 | unsigned int width; | |
61 | unsigned int height; | |
62 | struct v4l2_fract pixelaspect; | |
63 | int frame_format; | |
64 | }; | |
65 | ||
42fd3638 | 66 | static const struct vpfe_standard vpfe_standards[] = { |
417d2e50 BP |
67 | {V4L2_STD_525_60, 720, 480, {11, 10}, 1}, |
68 | {V4L2_STD_625_50, 720, 576, {54, 59}, 1}, | |
69 | }; | |
70 | ||
71 | struct bus_format { | |
72 | unsigned int width; | |
73 | unsigned int bpp; | |
74 | }; | |
75 | ||
76 | /* | |
77 | * struct vpfe_fmt - VPFE media bus format information | |
78 | * @name: V4L2 format description | |
79 | * @code: V4L2 media bus format code | |
80 | * @shifted: V4L2 media bus format code for the same pixel layout but | |
81 | * shifted to be 8 bits per pixel. =0 if format is not shiftable. | |
82 | * @pixelformat: V4L2 pixel format FCC identifier | |
83 | * @width: Bits per pixel (when transferred over a bus) | |
84 | * @bpp: Bytes per pixel (when stored in memory) | |
85 | * @supported: Indicates format supported by subdev | |
86 | */ | |
87 | struct vpfe_fmt { | |
88 | const char *name; | |
89 | u32 fourcc; | |
90 | u32 code; | |
91 | struct bus_format l; | |
92 | struct bus_format s; | |
93 | bool supported; | |
94 | u32 index; | |
95 | }; | |
96 | ||
97 | static struct vpfe_fmt formats[] = { | |
98 | { | |
99 | .name = "YUV 4:2:2 packed, YCbYCr", | |
100 | .fourcc = V4L2_PIX_FMT_YUYV, | |
101 | .code = MEDIA_BUS_FMT_YUYV8_2X8, | |
102 | .l.width = 10, | |
103 | .l.bpp = 4, | |
104 | .s.width = 8, | |
105 | .s.bpp = 2, | |
106 | .supported = false, | |
107 | }, { | |
108 | .name = "YUV 4:2:2 packed, CbYCrY", | |
109 | .fourcc = V4L2_PIX_FMT_UYVY, | |
110 | .code = MEDIA_BUS_FMT_UYVY8_2X8, | |
111 | .l.width = 10, | |
112 | .l.bpp = 4, | |
113 | .s.width = 8, | |
114 | .s.bpp = 2, | |
115 | .supported = false, | |
116 | }, { | |
117 | .name = "YUV 4:2:2 packed, YCrYCb", | |
118 | .fourcc = V4L2_PIX_FMT_YVYU, | |
119 | .code = MEDIA_BUS_FMT_YVYU8_2X8, | |
120 | .l.width = 10, | |
121 | .l.bpp = 4, | |
122 | .s.width = 8, | |
123 | .s.bpp = 2, | |
124 | .supported = false, | |
125 | }, { | |
126 | .name = "YUV 4:2:2 packed, CrYCbY", | |
127 | .fourcc = V4L2_PIX_FMT_VYUY, | |
128 | .code = MEDIA_BUS_FMT_VYUY8_2X8, | |
129 | .l.width = 10, | |
130 | .l.bpp = 4, | |
131 | .s.width = 8, | |
132 | .s.bpp = 2, | |
133 | .supported = false, | |
134 | }, { | |
135 | .name = "RAW8 BGGR", | |
136 | .fourcc = V4L2_PIX_FMT_SBGGR8, | |
137 | .code = MEDIA_BUS_FMT_SBGGR8_1X8, | |
138 | .l.width = 10, | |
139 | .l.bpp = 2, | |
140 | .s.width = 8, | |
141 | .s.bpp = 1, | |
142 | .supported = false, | |
143 | }, { | |
144 | .name = "RAW8 GBRG", | |
145 | .fourcc = V4L2_PIX_FMT_SGBRG8, | |
146 | .code = MEDIA_BUS_FMT_SGBRG8_1X8, | |
147 | .l.width = 10, | |
148 | .l.bpp = 2, | |
149 | .s.width = 8, | |
150 | .s.bpp = 1, | |
151 | .supported = false, | |
152 | }, { | |
153 | .name = "RAW8 GRBG", | |
154 | .fourcc = V4L2_PIX_FMT_SGRBG8, | |
155 | .code = MEDIA_BUS_FMT_SGRBG8_1X8, | |
156 | .l.width = 10, | |
157 | .l.bpp = 2, | |
158 | .s.width = 8, | |
159 | .s.bpp = 1, | |
160 | .supported = false, | |
161 | }, { | |
162 | .name = "RAW8 RGGB", | |
163 | .fourcc = V4L2_PIX_FMT_SRGGB8, | |
164 | .code = MEDIA_BUS_FMT_SRGGB8_1X8, | |
165 | .l.width = 10, | |
166 | .l.bpp = 2, | |
167 | .s.width = 8, | |
168 | .s.bpp = 1, | |
169 | .supported = false, | |
170 | }, { | |
171 | .name = "RGB565 (LE)", | |
172 | .fourcc = V4L2_PIX_FMT_RGB565, | |
173 | .code = MEDIA_BUS_FMT_RGB565_2X8_LE, | |
174 | .l.width = 10, | |
175 | .l.bpp = 4, | |
176 | .s.width = 8, | |
177 | .s.bpp = 2, | |
178 | .supported = false, | |
179 | }, { | |
180 | .name = "RGB565 (BE)", | |
181 | .fourcc = V4L2_PIX_FMT_RGB565X, | |
182 | .code = MEDIA_BUS_FMT_RGB565_2X8_BE, | |
183 | .l.width = 10, | |
184 | .l.bpp = 4, | |
185 | .s.width = 8, | |
186 | .s.bpp = 2, | |
187 | .supported = false, | |
188 | }, | |
189 | }; | |
190 | ||
191 | static int | |
192 | __vpfe_get_format(struct vpfe_device *vpfe, | |
193 | struct v4l2_format *format, unsigned int *bpp); | |
194 | ||
195 | static struct vpfe_fmt *find_format_by_code(unsigned int code) | |
196 | { | |
197 | struct vpfe_fmt *fmt; | |
198 | unsigned int k; | |
199 | ||
200 | for (k = 0; k < ARRAY_SIZE(formats); k++) { | |
201 | fmt = &formats[k]; | |
202 | if (fmt->code == code) | |
203 | return fmt; | |
204 | } | |
205 | ||
206 | return NULL; | |
207 | } | |
208 | ||
209 | static struct vpfe_fmt *find_format_by_pix(unsigned int pixelformat) | |
210 | { | |
211 | struct vpfe_fmt *fmt; | |
212 | unsigned int k; | |
213 | ||
214 | for (k = 0; k < ARRAY_SIZE(formats); k++) { | |
215 | fmt = &formats[k]; | |
216 | if (fmt->fourcc == pixelformat) | |
217 | return fmt; | |
218 | } | |
219 | ||
220 | return NULL; | |
221 | } | |
222 | ||
223 | static void | |
224 | mbus_to_pix(struct vpfe_device *vpfe, | |
225 | const struct v4l2_mbus_framefmt *mbus, | |
226 | struct v4l2_pix_format *pix, unsigned int *bpp) | |
227 | { | |
228 | struct vpfe_subdev_info *sdinfo = vpfe->current_subdev; | |
229 | unsigned int bus_width = sdinfo->vpfe_param.bus_width; | |
230 | struct vpfe_fmt *fmt; | |
231 | ||
232 | fmt = find_format_by_code(mbus->code); | |
233 | if (WARN_ON(fmt == NULL)) { | |
234 | pr_err("Invalid mbus code set\n"); | |
235 | *bpp = 1; | |
236 | return; | |
237 | } | |
238 | ||
239 | memset(pix, 0, sizeof(*pix)); | |
240 | v4l2_fill_pix_format(pix, mbus); | |
241 | pix->pixelformat = fmt->fourcc; | |
242 | *bpp = (bus_width == 10) ? fmt->l.bpp : fmt->s.bpp; | |
243 | ||
244 | /* pitch should be 32 bytes aligned */ | |
245 | pix->bytesperline = ALIGN(pix->width * *bpp, 32); | |
246 | pix->sizeimage = pix->bytesperline * pix->height; | |
247 | } | |
248 | ||
249 | static void pix_to_mbus(struct vpfe_device *vpfe, | |
250 | struct v4l2_pix_format *pix_fmt, | |
251 | struct v4l2_mbus_framefmt *mbus_fmt) | |
252 | { | |
253 | struct vpfe_fmt *fmt; | |
254 | ||
255 | fmt = find_format_by_pix(pix_fmt->pixelformat); | |
256 | if (!fmt) { | |
257 | /* default to first entry */ | |
258 | vpfe_dbg(3, vpfe, "Invalid pixel code: %x, default used instead\n", | |
259 | pix_fmt->pixelformat); | |
260 | fmt = &formats[0]; | |
261 | } | |
262 | ||
263 | memset(mbus_fmt, 0, sizeof(*mbus_fmt)); | |
264 | v4l2_fill_mbus_format(mbus_fmt, pix_fmt, fmt->code); | |
265 | } | |
266 | ||
267 | /* Print Four-character-code (FOURCC) */ | |
268 | static char *print_fourcc(u32 fmt) | |
269 | { | |
270 | static char code[5]; | |
271 | ||
272 | code[0] = (unsigned char)(fmt & 0xff); | |
273 | code[1] = (unsigned char)((fmt >> 8) & 0xff); | |
274 | code[2] = (unsigned char)((fmt >> 16) & 0xff); | |
275 | code[3] = (unsigned char)((fmt >> 24) & 0xff); | |
276 | code[4] = '\0'; | |
277 | ||
278 | return code; | |
279 | } | |
280 | ||
281 | static int | |
282 | cmp_v4l2_format(const struct v4l2_format *lhs, const struct v4l2_format *rhs) | |
283 | { | |
284 | return lhs->type == rhs->type && | |
285 | lhs->fmt.pix.width == rhs->fmt.pix.width && | |
286 | lhs->fmt.pix.height == rhs->fmt.pix.height && | |
287 | lhs->fmt.pix.pixelformat == rhs->fmt.pix.pixelformat && | |
288 | lhs->fmt.pix.field == rhs->fmt.pix.field && | |
289 | lhs->fmt.pix.colorspace == rhs->fmt.pix.colorspace && | |
290 | lhs->fmt.pix.ycbcr_enc == rhs->fmt.pix.ycbcr_enc && | |
291 | lhs->fmt.pix.quantization == rhs->fmt.pix.quantization; | |
292 | } | |
293 | ||
294 | static inline u32 vpfe_reg_read(struct vpfe_ccdc *ccdc, u32 offset) | |
295 | { | |
296 | return ioread32(ccdc->ccdc_cfg.base_addr + offset); | |
297 | } | |
298 | ||
299 | static inline void vpfe_reg_write(struct vpfe_ccdc *ccdc, u32 val, u32 offset) | |
300 | { | |
301 | iowrite32(val, ccdc->ccdc_cfg.base_addr + offset); | |
302 | } | |
303 | ||
304 | static inline struct vpfe_device *to_vpfe(struct vpfe_ccdc *ccdc) | |
305 | { | |
306 | return container_of(ccdc, struct vpfe_device, ccdc); | |
307 | } | |
308 | ||
309 | static inline struct vpfe_cap_buffer *to_vpfe_buffer(struct vb2_buffer *vb) | |
310 | { | |
311 | return container_of(vb, struct vpfe_cap_buffer, vb); | |
312 | } | |
313 | ||
314 | static inline void vpfe_pcr_enable(struct vpfe_ccdc *ccdc, int flag) | |
315 | { | |
316 | vpfe_reg_write(ccdc, !!flag, VPFE_PCR); | |
317 | } | |
318 | ||
319 | static void vpfe_config_enable(struct vpfe_ccdc *ccdc, int flag) | |
320 | { | |
321 | unsigned int cfg; | |
322 | ||
323 | if (!flag) { | |
324 | cfg = vpfe_reg_read(ccdc, VPFE_CONFIG); | |
325 | cfg &= ~(VPFE_CONFIG_EN_ENABLE << VPFE_CONFIG_EN_SHIFT); | |
326 | } else { | |
327 | cfg = VPFE_CONFIG_EN_ENABLE << VPFE_CONFIG_EN_SHIFT; | |
328 | } | |
329 | ||
330 | vpfe_reg_write(ccdc, cfg, VPFE_CONFIG); | |
331 | } | |
332 | ||
333 | static void vpfe_ccdc_setwin(struct vpfe_ccdc *ccdc, | |
334 | struct v4l2_rect *image_win, | |
335 | enum ccdc_frmfmt frm_fmt, | |
336 | int bpp) | |
337 | { | |
338 | int horz_start, horz_nr_pixels; | |
339 | int vert_start, vert_nr_lines; | |
340 | int val, mid_img; | |
341 | ||
342 | /* | |
343 | * ppc - per pixel count. indicates how many pixels per cell | |
344 | * output to SDRAM. example, for ycbcr, it is one y and one c, so 2. | |
345 | * raw capture this is 1 | |
346 | */ | |
347 | horz_start = image_win->left * bpp; | |
348 | horz_nr_pixels = (image_win->width * bpp) - 1; | |
349 | vpfe_reg_write(ccdc, (horz_start << VPFE_HORZ_INFO_SPH_SHIFT) | | |
350 | horz_nr_pixels, VPFE_HORZ_INFO); | |
351 | ||
352 | vert_start = image_win->top; | |
353 | ||
354 | if (frm_fmt == CCDC_FRMFMT_INTERLACED) { | |
355 | vert_nr_lines = (image_win->height >> 1) - 1; | |
356 | vert_start >>= 1; | |
357 | /* Since first line doesn't have any data */ | |
358 | vert_start += 1; | |
359 | /* configure VDINT0 */ | |
360 | val = (vert_start << VPFE_VDINT_VDINT0_SHIFT); | |
361 | } else { | |
362 | /* Since first line doesn't have any data */ | |
363 | vert_start += 1; | |
364 | vert_nr_lines = image_win->height - 1; | |
365 | /* | |
366 | * configure VDINT0 and VDINT1. VDINT1 will be at half | |
367 | * of image height | |
368 | */ | |
369 | mid_img = vert_start + (image_win->height / 2); | |
370 | val = (vert_start << VPFE_VDINT_VDINT0_SHIFT) | | |
371 | (mid_img & VPFE_VDINT_VDINT1_MASK); | |
372 | } | |
373 | ||
374 | vpfe_reg_write(ccdc, val, VPFE_VDINT); | |
375 | ||
376 | vpfe_reg_write(ccdc, (vert_start << VPFE_VERT_START_SLV0_SHIFT) | | |
377 | vert_start, VPFE_VERT_START); | |
378 | vpfe_reg_write(ccdc, vert_nr_lines, VPFE_VERT_LINES); | |
379 | } | |
380 | ||
381 | static void vpfe_reg_dump(struct vpfe_ccdc *ccdc) | |
382 | { | |
383 | struct vpfe_device *vpfe = to_vpfe(ccdc); | |
384 | ||
385 | vpfe_dbg(3, vpfe, "ALAW: 0x%x\n", vpfe_reg_read(ccdc, VPFE_ALAW)); | |
386 | vpfe_dbg(3, vpfe, "CLAMP: 0x%x\n", vpfe_reg_read(ccdc, VPFE_CLAMP)); | |
387 | vpfe_dbg(3, vpfe, "DCSUB: 0x%x\n", vpfe_reg_read(ccdc, VPFE_DCSUB)); | |
388 | vpfe_dbg(3, vpfe, "BLKCMP: 0x%x\n", vpfe_reg_read(ccdc, VPFE_BLKCMP)); | |
389 | vpfe_dbg(3, vpfe, "COLPTN: 0x%x\n", vpfe_reg_read(ccdc, VPFE_COLPTN)); | |
390 | vpfe_dbg(3, vpfe, "SDOFST: 0x%x\n", vpfe_reg_read(ccdc, VPFE_SDOFST)); | |
391 | vpfe_dbg(3, vpfe, "SYN_MODE: 0x%x\n", | |
392 | vpfe_reg_read(ccdc, VPFE_SYNMODE)); | |
393 | vpfe_dbg(3, vpfe, "HSIZE_OFF: 0x%x\n", | |
394 | vpfe_reg_read(ccdc, VPFE_HSIZE_OFF)); | |
395 | vpfe_dbg(3, vpfe, "HORZ_INFO: 0x%x\n", | |
396 | vpfe_reg_read(ccdc, VPFE_HORZ_INFO)); | |
397 | vpfe_dbg(3, vpfe, "VERT_START: 0x%x\n", | |
398 | vpfe_reg_read(ccdc, VPFE_VERT_START)); | |
399 | vpfe_dbg(3, vpfe, "VERT_LINES: 0x%x\n", | |
400 | vpfe_reg_read(ccdc, VPFE_VERT_LINES)); | |
401 | } | |
402 | ||
403 | static int | |
404 | vpfe_ccdc_validate_param(struct vpfe_ccdc *ccdc, | |
405 | struct vpfe_ccdc_config_params_raw *ccdcparam) | |
406 | { | |
407 | struct vpfe_device *vpfe = to_vpfe(ccdc); | |
408 | u8 max_gamma, max_data; | |
409 | ||
410 | if (!ccdcparam->alaw.enable) | |
411 | return 0; | |
412 | ||
413 | max_gamma = ccdc_gamma_width_max_bit(ccdcparam->alaw.gamma_wd); | |
414 | max_data = ccdc_data_size_max_bit(ccdcparam->data_sz); | |
415 | ||
416 | if (ccdcparam->alaw.gamma_wd > VPFE_CCDC_GAMMA_BITS_09_0 || | |
417 | ccdcparam->alaw.gamma_wd < VPFE_CCDC_GAMMA_BITS_15_6 || | |
418 | max_gamma > max_data) { | |
419 | vpfe_dbg(1, vpfe, "Invalid data line select\n"); | |
420 | return -EINVAL; | |
421 | } | |
422 | ||
423 | return 0; | |
424 | } | |
425 | ||
426 | static void | |
427 | vpfe_ccdc_update_raw_params(struct vpfe_ccdc *ccdc, | |
428 | struct vpfe_ccdc_config_params_raw *raw_params) | |
429 | { | |
430 | struct vpfe_ccdc_config_params_raw *config_params = | |
431 | &ccdc->ccdc_cfg.bayer.config_params; | |
432 | ||
433 | config_params = raw_params; | |
434 | } | |
435 | ||
436 | /* | |
437 | * vpfe_ccdc_restore_defaults() | |
438 | * This function will write defaults to all CCDC registers | |
439 | */ | |
440 | static void vpfe_ccdc_restore_defaults(struct vpfe_ccdc *ccdc) | |
441 | { | |
442 | int i; | |
443 | ||
444 | /* Disable CCDC */ | |
445 | vpfe_pcr_enable(ccdc, 0); | |
446 | ||
447 | /* set all registers to default value */ | |
448 | for (i = 4; i <= 0x94; i += 4) | |
449 | vpfe_reg_write(ccdc, 0, i); | |
450 | ||
451 | vpfe_reg_write(ccdc, VPFE_NO_CULLING, VPFE_CULLING); | |
452 | vpfe_reg_write(ccdc, VPFE_CCDC_GAMMA_BITS_11_2, VPFE_ALAW); | |
453 | } | |
454 | ||
455 | static int vpfe_ccdc_close(struct vpfe_ccdc *ccdc, struct device *dev) | |
456 | { | |
457 | int dma_cntl, i, pcr; | |
458 | ||
459 | /* If the CCDC module is still busy wait for it to be done */ | |
460 | for (i = 0; i < 10; i++) { | |
461 | usleep_range(5000, 6000); | |
462 | pcr = vpfe_reg_read(ccdc, VPFE_PCR); | |
463 | if (!pcr) | |
464 | break; | |
465 | ||
466 | /* make sure it it is disabled */ | |
467 | vpfe_pcr_enable(ccdc, 0); | |
468 | } | |
469 | ||
470 | /* Disable CCDC by resetting all register to default POR values */ | |
471 | vpfe_ccdc_restore_defaults(ccdc); | |
472 | ||
473 | /* if DMA_CNTL overflow bit is set. Clear it | |
474 | * It appears to take a while for this to become quiescent ~20ms | |
475 | */ | |
476 | for (i = 0; i < 10; i++) { | |
477 | dma_cntl = vpfe_reg_read(ccdc, VPFE_DMA_CNTL); | |
478 | if (!(dma_cntl & VPFE_DMA_CNTL_OVERFLOW)) | |
479 | break; | |
480 | ||
481 | /* Clear the overflow bit */ | |
482 | vpfe_reg_write(ccdc, dma_cntl, VPFE_DMA_CNTL); | |
483 | usleep_range(5000, 6000); | |
484 | } | |
485 | ||
486 | /* Disabled the module at the CONFIG level */ | |
487 | vpfe_config_enable(ccdc, 0); | |
488 | ||
489 | pm_runtime_put_sync(dev); | |
490 | ||
491 | return 0; | |
492 | } | |
493 | ||
494 | static int vpfe_ccdc_set_params(struct vpfe_ccdc *ccdc, void __user *params) | |
495 | { | |
496 | struct vpfe_device *vpfe = container_of(ccdc, struct vpfe_device, ccdc); | |
497 | struct vpfe_ccdc_config_params_raw raw_params; | |
498 | int x; | |
499 | ||
500 | if (ccdc->ccdc_cfg.if_type != VPFE_RAW_BAYER) | |
501 | return -EINVAL; | |
502 | ||
503 | x = copy_from_user(&raw_params, params, sizeof(raw_params)); | |
504 | if (x) { | |
505 | vpfe_dbg(1, vpfe, | |
506 | "vpfe_ccdc_set_params: error in copying ccdc params, %d\n", | |
507 | x); | |
508 | return -EFAULT; | |
509 | } | |
510 | ||
511 | if (!vpfe_ccdc_validate_param(ccdc, &raw_params)) { | |
512 | vpfe_ccdc_update_raw_params(ccdc, &raw_params); | |
513 | return 0; | |
514 | } | |
515 | ||
516 | return -EINVAL; | |
517 | } | |
518 | ||
519 | /* | |
520 | * vpfe_ccdc_config_ycbcr() | |
521 | * This function will configure CCDC for YCbCr video capture | |
522 | */ | |
523 | static void vpfe_ccdc_config_ycbcr(struct vpfe_ccdc *ccdc) | |
524 | { | |
525 | struct vpfe_device *vpfe = container_of(ccdc, struct vpfe_device, ccdc); | |
526 | struct ccdc_params_ycbcr *params = &ccdc->ccdc_cfg.ycbcr; | |
527 | u32 syn_mode; | |
528 | ||
529 | vpfe_dbg(3, vpfe, "vpfe_ccdc_config_ycbcr:\n"); | |
530 | /* | |
531 | * first restore the CCDC registers to default values | |
532 | * This is important since we assume default values to be set in | |
533 | * a lot of registers that we didn't touch | |
534 | */ | |
535 | vpfe_ccdc_restore_defaults(ccdc); | |
536 | ||
537 | /* | |
538 | * configure pixel format, frame format, configure video frame | |
539 | * format, enable output to SDRAM, enable internal timing generator | |
540 | * and 8bit pack mode | |
541 | */ | |
542 | syn_mode = (((params->pix_fmt & VPFE_SYN_MODE_INPMOD_MASK) << | |
543 | VPFE_SYN_MODE_INPMOD_SHIFT) | | |
544 | ((params->frm_fmt & VPFE_SYN_FLDMODE_MASK) << | |
545 | VPFE_SYN_FLDMODE_SHIFT) | VPFE_VDHDEN_ENABLE | | |
546 | VPFE_WEN_ENABLE | VPFE_DATA_PACK_ENABLE); | |
547 | ||
548 | /* setup BT.656 sync mode */ | |
549 | if (params->bt656_enable) { | |
550 | vpfe_reg_write(ccdc, VPFE_REC656IF_BT656_EN, VPFE_REC656IF); | |
551 | ||
552 | /* | |
553 | * configure the FID, VD, HD pin polarity, | |
554 | * fld,hd pol positive, vd negative, 8-bit data | |
555 | */ | |
556 | syn_mode |= VPFE_SYN_MODE_VD_POL_NEGATIVE; | |
557 | if (ccdc->ccdc_cfg.if_type == VPFE_BT656_10BIT) | |
558 | syn_mode |= VPFE_SYN_MODE_10BITS; | |
559 | else | |
560 | syn_mode |= VPFE_SYN_MODE_8BITS; | |
561 | } else { | |
562 | /* y/c external sync mode */ | |
563 | syn_mode |= (((params->fid_pol & VPFE_FID_POL_MASK) << | |
564 | VPFE_FID_POL_SHIFT) | | |
565 | ((params->hd_pol & VPFE_HD_POL_MASK) << | |
566 | VPFE_HD_POL_SHIFT) | | |
567 | ((params->vd_pol & VPFE_VD_POL_MASK) << | |
568 | VPFE_VD_POL_SHIFT)); | |
569 | } | |
570 | vpfe_reg_write(ccdc, syn_mode, VPFE_SYNMODE); | |
571 | ||
572 | /* configure video window */ | |
573 | vpfe_ccdc_setwin(ccdc, ¶ms->win, | |
574 | params->frm_fmt, params->bytesperpixel); | |
575 | ||
576 | /* | |
577 | * configure the order of y cb cr in SDRAM, and disable latch | |
578 | * internal register on vsync | |
579 | */ | |
580 | if (ccdc->ccdc_cfg.if_type == VPFE_BT656_10BIT) | |
581 | vpfe_reg_write(ccdc, | |
582 | (params->pix_order << VPFE_CCDCFG_Y8POS_SHIFT) | | |
583 | VPFE_LATCH_ON_VSYNC_DISABLE | | |
584 | VPFE_CCDCFG_BW656_10BIT, VPFE_CCDCFG); | |
585 | else | |
586 | vpfe_reg_write(ccdc, | |
587 | (params->pix_order << VPFE_CCDCFG_Y8POS_SHIFT) | | |
588 | VPFE_LATCH_ON_VSYNC_DISABLE, VPFE_CCDCFG); | |
589 | ||
590 | /* | |
591 | * configure the horizontal line offset. This should be a | |
592 | * on 32 byte boundary. So clear LSB 5 bits | |
593 | */ | |
594 | vpfe_reg_write(ccdc, params->bytesperline, VPFE_HSIZE_OFF); | |
595 | ||
596 | /* configure the memory line offset */ | |
597 | if (params->buf_type == CCDC_BUFTYPE_FLD_INTERLEAVED) | |
598 | /* two fields are interleaved in memory */ | |
599 | vpfe_reg_write(ccdc, VPFE_SDOFST_FIELD_INTERLEAVED, | |
600 | VPFE_SDOFST); | |
601 | } | |
602 | ||
603 | static void | |
604 | vpfe_ccdc_config_black_clamp(struct vpfe_ccdc *ccdc, | |
605 | struct vpfe_ccdc_black_clamp *bclamp) | |
606 | { | |
607 | u32 val; | |
608 | ||
609 | if (!bclamp->enable) { | |
610 | /* configure DCSub */ | |
611 | val = (bclamp->dc_sub) & VPFE_BLK_DC_SUB_MASK; | |
612 | vpfe_reg_write(ccdc, val, VPFE_DCSUB); | |
613 | vpfe_reg_write(ccdc, VPFE_CLAMP_DEFAULT_VAL, VPFE_CLAMP); | |
614 | return; | |
615 | } | |
616 | /* | |
617 | * Configure gain, Start pixel, No of line to be avg, | |
618 | * No of pixel/line to be avg, & Enable the Black clamping | |
619 | */ | |
620 | val = ((bclamp->sgain & VPFE_BLK_SGAIN_MASK) | | |
621 | ((bclamp->start_pixel & VPFE_BLK_ST_PXL_MASK) << | |
622 | VPFE_BLK_ST_PXL_SHIFT) | | |
623 | ((bclamp->sample_ln & VPFE_BLK_SAMPLE_LINE_MASK) << | |
624 | VPFE_BLK_SAMPLE_LINE_SHIFT) | | |
625 | ((bclamp->sample_pixel & VPFE_BLK_SAMPLE_LN_MASK) << | |
626 | VPFE_BLK_SAMPLE_LN_SHIFT) | VPFE_BLK_CLAMP_ENABLE); | |
627 | vpfe_reg_write(ccdc, val, VPFE_CLAMP); | |
628 | /* If Black clamping is enable then make dcsub 0 */ | |
629 | vpfe_reg_write(ccdc, VPFE_DCSUB_DEFAULT_VAL, VPFE_DCSUB); | |
630 | } | |
631 | ||
632 | static void | |
633 | vpfe_ccdc_config_black_compense(struct vpfe_ccdc *ccdc, | |
634 | struct vpfe_ccdc_black_compensation *bcomp) | |
635 | { | |
636 | u32 val; | |
637 | ||
638 | val = ((bcomp->b & VPFE_BLK_COMP_MASK) | | |
639 | ((bcomp->gb & VPFE_BLK_COMP_MASK) << | |
640 | VPFE_BLK_COMP_GB_COMP_SHIFT) | | |
641 | ((bcomp->gr & VPFE_BLK_COMP_MASK) << | |
642 | VPFE_BLK_COMP_GR_COMP_SHIFT) | | |
643 | ((bcomp->r & VPFE_BLK_COMP_MASK) << | |
644 | VPFE_BLK_COMP_R_COMP_SHIFT)); | |
645 | vpfe_reg_write(ccdc, val, VPFE_BLKCMP); | |
646 | } | |
647 | ||
648 | /* | |
649 | * vpfe_ccdc_config_raw() | |
650 | * This function will configure CCDC for Raw capture mode | |
651 | */ | |
652 | static void vpfe_ccdc_config_raw(struct vpfe_ccdc *ccdc) | |
653 | { | |
654 | struct vpfe_device *vpfe = container_of(ccdc, struct vpfe_device, ccdc); | |
655 | struct vpfe_ccdc_config_params_raw *config_params = | |
656 | &ccdc->ccdc_cfg.bayer.config_params; | |
657 | struct ccdc_params_raw *params = &ccdc->ccdc_cfg.bayer; | |
658 | unsigned int syn_mode; | |
659 | unsigned int val; | |
660 | ||
661 | vpfe_dbg(3, vpfe, "vpfe_ccdc_config_raw:\n"); | |
662 | ||
663 | /* Reset CCDC */ | |
664 | vpfe_ccdc_restore_defaults(ccdc); | |
665 | ||
666 | /* Disable latching function registers on VSYNC */ | |
667 | vpfe_reg_write(ccdc, VPFE_LATCH_ON_VSYNC_DISABLE, VPFE_CCDCFG); | |
668 | ||
669 | /* | |
670 | * Configure the vertical sync polarity(SYN_MODE.VDPOL), | |
671 | * horizontal sync polarity (SYN_MODE.HDPOL), frame id polarity | |
672 | * (SYN_MODE.FLDPOL), frame format(progressive or interlace), | |
673 | * data size(SYNMODE.DATSIZ), &pixel format (Input mode), output | |
674 | * SDRAM, enable internal timing generator | |
675 | */ | |
676 | syn_mode = (((params->vd_pol & VPFE_VD_POL_MASK) << VPFE_VD_POL_SHIFT) | | |
677 | ((params->hd_pol & VPFE_HD_POL_MASK) << VPFE_HD_POL_SHIFT) | | |
678 | ((params->fid_pol & VPFE_FID_POL_MASK) << | |
679 | VPFE_FID_POL_SHIFT) | ((params->frm_fmt & | |
680 | VPFE_FRM_FMT_MASK) << VPFE_FRM_FMT_SHIFT) | | |
681 | ((config_params->data_sz & VPFE_DATA_SZ_MASK) << | |
682 | VPFE_DATA_SZ_SHIFT) | ((params->pix_fmt & | |
683 | VPFE_PIX_FMT_MASK) << VPFE_PIX_FMT_SHIFT) | | |
684 | VPFE_WEN_ENABLE | VPFE_VDHDEN_ENABLE); | |
685 | ||
686 | /* Enable and configure aLaw register if needed */ | |
687 | if (config_params->alaw.enable) { | |
688 | val = ((config_params->alaw.gamma_wd & | |
689 | VPFE_ALAW_GAMMA_WD_MASK) | VPFE_ALAW_ENABLE); | |
690 | vpfe_reg_write(ccdc, val, VPFE_ALAW); | |
691 | vpfe_dbg(3, vpfe, "\nWriting 0x%x to ALAW...\n", val); | |
692 | } | |
693 | ||
694 | /* Configure video window */ | |
695 | vpfe_ccdc_setwin(ccdc, ¶ms->win, params->frm_fmt, | |
696 | params->bytesperpixel); | |
697 | ||
698 | /* Configure Black Clamp */ | |
699 | vpfe_ccdc_config_black_clamp(ccdc, &config_params->blk_clamp); | |
700 | ||
701 | /* Configure Black level compensation */ | |
702 | vpfe_ccdc_config_black_compense(ccdc, &config_params->blk_comp); | |
703 | ||
704 | /* If data size is 8 bit then pack the data */ | |
705 | if ((config_params->data_sz == VPFE_CCDC_DATA_8BITS) || | |
706 | config_params->alaw.enable) | |
707 | syn_mode |= VPFE_DATA_PACK_ENABLE; | |
708 | ||
709 | /* | |
710 | * Configure Horizontal offset register. If pack 8 is enabled then | |
711 | * 1 pixel will take 1 byte | |
712 | */ | |
713 | vpfe_reg_write(ccdc, params->bytesperline, VPFE_HSIZE_OFF); | |
714 | ||
715 | vpfe_dbg(3, vpfe, "Writing %d (%x) to HSIZE_OFF\n", | |
716 | params->bytesperline, params->bytesperline); | |
717 | ||
718 | /* Set value for SDOFST */ | |
719 | if (params->frm_fmt == CCDC_FRMFMT_INTERLACED) { | |
720 | if (params->image_invert_enable) { | |
721 | /* For interlace inverse mode */ | |
722 | vpfe_reg_write(ccdc, VPFE_INTERLACED_IMAGE_INVERT, | |
723 | VPFE_SDOFST); | |
724 | } else { | |
725 | /* For interlace non inverse mode */ | |
726 | vpfe_reg_write(ccdc, VPFE_INTERLACED_NO_IMAGE_INVERT, | |
727 | VPFE_SDOFST); | |
728 | } | |
729 | } else if (params->frm_fmt == CCDC_FRMFMT_PROGRESSIVE) { | |
730 | vpfe_reg_write(ccdc, VPFE_PROGRESSIVE_NO_IMAGE_INVERT, | |
731 | VPFE_SDOFST); | |
732 | } | |
733 | ||
734 | vpfe_reg_write(ccdc, syn_mode, VPFE_SYNMODE); | |
735 | ||
736 | vpfe_reg_dump(ccdc); | |
737 | } | |
738 | ||
739 | static inline int | |
740 | vpfe_ccdc_set_buftype(struct vpfe_ccdc *ccdc, | |
741 | enum ccdc_buftype buf_type) | |
742 | { | |
743 | if (ccdc->ccdc_cfg.if_type == VPFE_RAW_BAYER) | |
744 | ccdc->ccdc_cfg.bayer.buf_type = buf_type; | |
745 | else | |
746 | ccdc->ccdc_cfg.ycbcr.buf_type = buf_type; | |
747 | ||
748 | return 0; | |
749 | } | |
750 | ||
751 | static inline enum ccdc_buftype vpfe_ccdc_get_buftype(struct vpfe_ccdc *ccdc) | |
752 | { | |
753 | if (ccdc->ccdc_cfg.if_type == VPFE_RAW_BAYER) | |
754 | return ccdc->ccdc_cfg.bayer.buf_type; | |
755 | ||
756 | return ccdc->ccdc_cfg.ycbcr.buf_type; | |
757 | } | |
758 | ||
759 | static int vpfe_ccdc_set_pixel_format(struct vpfe_ccdc *ccdc, u32 pixfmt) | |
760 | { | |
761 | struct vpfe_device *vpfe = container_of(ccdc, struct vpfe_device, ccdc); | |
762 | ||
763 | vpfe_dbg(1, vpfe, "vpfe_ccdc_set_pixel_format: if_type: %d, pixfmt:%s\n", | |
764 | ccdc->ccdc_cfg.if_type, print_fourcc(pixfmt)); | |
765 | ||
766 | if (ccdc->ccdc_cfg.if_type == VPFE_RAW_BAYER) { | |
767 | ccdc->ccdc_cfg.bayer.pix_fmt = CCDC_PIXFMT_RAW; | |
768 | /* | |
769 | * Need to clear it in case it was left on | |
770 | * after the last capture. | |
771 | */ | |
772 | ccdc->ccdc_cfg.bayer.config_params.alaw.enable = 0; | |
773 | ||
774 | switch (pixfmt) { | |
775 | case V4L2_PIX_FMT_SBGGR8: | |
776 | ccdc->ccdc_cfg.bayer.config_params.alaw.enable = 1; | |
777 | break; | |
778 | ||
779 | case V4L2_PIX_FMT_YUYV: | |
780 | case V4L2_PIX_FMT_UYVY: | |
781 | case V4L2_PIX_FMT_YUV420: | |
782 | case V4L2_PIX_FMT_NV12: | |
783 | case V4L2_PIX_FMT_RGB565X: | |
784 | break; | |
785 | ||
786 | case V4L2_PIX_FMT_SBGGR16: | |
787 | default: | |
788 | return -EINVAL; | |
789 | } | |
790 | } else { | |
791 | switch (pixfmt) { | |
792 | case V4L2_PIX_FMT_YUYV: | |
793 | ccdc->ccdc_cfg.ycbcr.pix_order = CCDC_PIXORDER_YCBYCR; | |
794 | break; | |
795 | ||
796 | case V4L2_PIX_FMT_UYVY: | |
797 | ccdc->ccdc_cfg.ycbcr.pix_order = CCDC_PIXORDER_CBYCRY; | |
798 | break; | |
799 | ||
800 | default: | |
801 | return -EINVAL; | |
802 | } | |
803 | } | |
804 | ||
805 | return 0; | |
806 | } | |
807 | ||
808 | static u32 vpfe_ccdc_get_pixel_format(struct vpfe_ccdc *ccdc) | |
809 | { | |
810 | u32 pixfmt; | |
811 | ||
812 | if (ccdc->ccdc_cfg.if_type == VPFE_RAW_BAYER) { | |
813 | pixfmt = V4L2_PIX_FMT_YUYV; | |
814 | } else { | |
815 | if (ccdc->ccdc_cfg.ycbcr.pix_order == CCDC_PIXORDER_YCBYCR) | |
816 | pixfmt = V4L2_PIX_FMT_YUYV; | |
817 | else | |
818 | pixfmt = V4L2_PIX_FMT_UYVY; | |
819 | } | |
820 | ||
821 | return pixfmt; | |
822 | } | |
823 | ||
824 | static int | |
825 | vpfe_ccdc_set_image_window(struct vpfe_ccdc *ccdc, | |
826 | struct v4l2_rect *win, unsigned int bpp) | |
827 | { | |
828 | if (ccdc->ccdc_cfg.if_type == VPFE_RAW_BAYER) { | |
829 | ccdc->ccdc_cfg.bayer.win = *win; | |
830 | ccdc->ccdc_cfg.bayer.bytesperpixel = bpp; | |
831 | ccdc->ccdc_cfg.bayer.bytesperline = ALIGN(win->width * bpp, 32); | |
832 | } else { | |
833 | ccdc->ccdc_cfg.ycbcr.win = *win; | |
834 | ccdc->ccdc_cfg.ycbcr.bytesperpixel = bpp; | |
835 | ccdc->ccdc_cfg.ycbcr.bytesperline = ALIGN(win->width * bpp, 32); | |
836 | } | |
837 | ||
838 | return 0; | |
839 | } | |
840 | ||
841 | static inline void | |
842 | vpfe_ccdc_get_image_window(struct vpfe_ccdc *ccdc, | |
843 | struct v4l2_rect *win) | |
844 | { | |
845 | if (ccdc->ccdc_cfg.if_type == VPFE_RAW_BAYER) | |
846 | *win = ccdc->ccdc_cfg.bayer.win; | |
847 | else | |
848 | *win = ccdc->ccdc_cfg.ycbcr.win; | |
849 | } | |
850 | ||
851 | static inline unsigned int vpfe_ccdc_get_line_length(struct vpfe_ccdc *ccdc) | |
852 | { | |
853 | if (ccdc->ccdc_cfg.if_type == VPFE_RAW_BAYER) | |
854 | return ccdc->ccdc_cfg.bayer.bytesperline; | |
855 | ||
856 | return ccdc->ccdc_cfg.ycbcr.bytesperline; | |
857 | } | |
858 | ||
859 | static inline int | |
860 | vpfe_ccdc_set_frame_format(struct vpfe_ccdc *ccdc, | |
861 | enum ccdc_frmfmt frm_fmt) | |
862 | { | |
863 | if (ccdc->ccdc_cfg.if_type == VPFE_RAW_BAYER) | |
864 | ccdc->ccdc_cfg.bayer.frm_fmt = frm_fmt; | |
865 | else | |
866 | ccdc->ccdc_cfg.ycbcr.frm_fmt = frm_fmt; | |
867 | ||
868 | return 0; | |
869 | } | |
870 | ||
871 | static inline enum ccdc_frmfmt | |
872 | vpfe_ccdc_get_frame_format(struct vpfe_ccdc *ccdc) | |
873 | { | |
874 | if (ccdc->ccdc_cfg.if_type == VPFE_RAW_BAYER) | |
875 | return ccdc->ccdc_cfg.bayer.frm_fmt; | |
876 | ||
877 | return ccdc->ccdc_cfg.ycbcr.frm_fmt; | |
878 | } | |
879 | ||
880 | static inline int vpfe_ccdc_getfid(struct vpfe_ccdc *ccdc) | |
881 | { | |
882 | return (vpfe_reg_read(ccdc, VPFE_SYNMODE) >> 15) & 1; | |
883 | } | |
884 | ||
885 | static inline void vpfe_set_sdr_addr(struct vpfe_ccdc *ccdc, unsigned long addr) | |
886 | { | |
887 | vpfe_reg_write(ccdc, addr & 0xffffffe0, VPFE_SDR_ADDR); | |
888 | } | |
889 | ||
890 | static int vpfe_ccdc_set_hw_if_params(struct vpfe_ccdc *ccdc, | |
891 | struct vpfe_hw_if_param *params) | |
892 | { | |
893 | struct vpfe_device *vpfe = container_of(ccdc, struct vpfe_device, ccdc); | |
894 | ||
895 | ccdc->ccdc_cfg.if_type = params->if_type; | |
896 | ||
897 | switch (params->if_type) { | |
898 | case VPFE_BT656: | |
899 | case VPFE_YCBCR_SYNC_16: | |
900 | case VPFE_YCBCR_SYNC_8: | |
901 | case VPFE_BT656_10BIT: | |
902 | ccdc->ccdc_cfg.ycbcr.vd_pol = params->vdpol; | |
903 | ccdc->ccdc_cfg.ycbcr.hd_pol = params->hdpol; | |
904 | break; | |
905 | ||
906 | case VPFE_RAW_BAYER: | |
907 | ccdc->ccdc_cfg.bayer.vd_pol = params->vdpol; | |
908 | ccdc->ccdc_cfg.bayer.hd_pol = params->hdpol; | |
909 | if (params->bus_width == 10) | |
910 | ccdc->ccdc_cfg.bayer.config_params.data_sz = | |
911 | VPFE_CCDC_DATA_10BITS; | |
912 | else | |
913 | ccdc->ccdc_cfg.bayer.config_params.data_sz = | |
914 | VPFE_CCDC_DATA_8BITS; | |
915 | vpfe_dbg(1, vpfe, "params.bus_width: %d\n", | |
916 | params->bus_width); | |
917 | vpfe_dbg(1, vpfe, "config_params.data_sz: %d\n", | |
918 | ccdc->ccdc_cfg.bayer.config_params.data_sz); | |
919 | break; | |
920 | ||
921 | default: | |
922 | return -EINVAL; | |
923 | } | |
924 | ||
925 | return 0; | |
926 | } | |
927 | ||
928 | static void vpfe_clear_intr(struct vpfe_ccdc *ccdc, int vdint) | |
929 | { | |
930 | unsigned int vpfe_int_status; | |
931 | ||
932 | vpfe_int_status = vpfe_reg_read(ccdc, VPFE_IRQ_STS); | |
933 | ||
934 | switch (vdint) { | |
935 | /* VD0 interrupt */ | |
936 | case VPFE_VDINT0: | |
937 | vpfe_int_status &= ~VPFE_VDINT0; | |
938 | vpfe_int_status |= VPFE_VDINT0; | |
939 | break; | |
940 | ||
941 | /* VD1 interrupt */ | |
942 | case VPFE_VDINT1: | |
943 | vpfe_int_status &= ~VPFE_VDINT1; | |
944 | vpfe_int_status |= VPFE_VDINT1; | |
945 | break; | |
946 | ||
947 | /* VD2 interrupt */ | |
948 | case VPFE_VDINT2: | |
949 | vpfe_int_status &= ~VPFE_VDINT2; | |
950 | vpfe_int_status |= VPFE_VDINT2; | |
951 | break; | |
952 | ||
953 | /* Clear all interrupts */ | |
954 | default: | |
955 | vpfe_int_status &= ~(VPFE_VDINT0 | | |
956 | VPFE_VDINT1 | | |
957 | VPFE_VDINT2); | |
958 | vpfe_int_status |= (VPFE_VDINT0 | | |
959 | VPFE_VDINT1 | | |
960 | VPFE_VDINT2); | |
961 | break; | |
962 | } | |
963 | /* Clear specific VDINT from the status register */ | |
964 | vpfe_reg_write(ccdc, vpfe_int_status, VPFE_IRQ_STS); | |
965 | ||
966 | vpfe_int_status = vpfe_reg_read(ccdc, VPFE_IRQ_STS); | |
967 | ||
968 | /* Acknowledge that we are done with all interrupts */ | |
969 | vpfe_reg_write(ccdc, 1, VPFE_IRQ_EOI); | |
970 | } | |
971 | ||
972 | static void vpfe_ccdc_config_defaults(struct vpfe_ccdc *ccdc) | |
973 | { | |
974 | ccdc->ccdc_cfg.if_type = VPFE_RAW_BAYER; | |
975 | ||
976 | ccdc->ccdc_cfg.ycbcr.pix_fmt = CCDC_PIXFMT_YCBCR_8BIT; | |
977 | ccdc->ccdc_cfg.ycbcr.frm_fmt = CCDC_FRMFMT_INTERLACED; | |
978 | ccdc->ccdc_cfg.ycbcr.fid_pol = VPFE_PINPOL_POSITIVE; | |
979 | ccdc->ccdc_cfg.ycbcr.vd_pol = VPFE_PINPOL_POSITIVE; | |
980 | ccdc->ccdc_cfg.ycbcr.hd_pol = VPFE_PINPOL_POSITIVE; | |
981 | ccdc->ccdc_cfg.ycbcr.pix_order = CCDC_PIXORDER_CBYCRY; | |
982 | ccdc->ccdc_cfg.ycbcr.buf_type = CCDC_BUFTYPE_FLD_INTERLEAVED; | |
983 | ||
984 | ccdc->ccdc_cfg.ycbcr.win.left = 0; | |
985 | ccdc->ccdc_cfg.ycbcr.win.top = 0; | |
986 | ccdc->ccdc_cfg.ycbcr.win.width = 720; | |
987 | ccdc->ccdc_cfg.ycbcr.win.height = 576; | |
988 | ccdc->ccdc_cfg.ycbcr.bt656_enable = 1; | |
989 | ||
990 | ccdc->ccdc_cfg.bayer.pix_fmt = CCDC_PIXFMT_RAW; | |
991 | ccdc->ccdc_cfg.bayer.frm_fmt = CCDC_FRMFMT_PROGRESSIVE; | |
992 | ccdc->ccdc_cfg.bayer.fid_pol = VPFE_PINPOL_POSITIVE; | |
993 | ccdc->ccdc_cfg.bayer.vd_pol = VPFE_PINPOL_POSITIVE; | |
994 | ccdc->ccdc_cfg.bayer.hd_pol = VPFE_PINPOL_POSITIVE; | |
995 | ||
996 | ccdc->ccdc_cfg.bayer.win.left = 0; | |
997 | ccdc->ccdc_cfg.bayer.win.top = 0; | |
998 | ccdc->ccdc_cfg.bayer.win.width = 800; | |
999 | ccdc->ccdc_cfg.bayer.win.height = 600; | |
1000 | ccdc->ccdc_cfg.bayer.config_params.data_sz = VPFE_CCDC_DATA_8BITS; | |
1001 | ccdc->ccdc_cfg.bayer.config_params.alaw.gamma_wd = | |
1002 | VPFE_CCDC_GAMMA_BITS_09_0; | |
1003 | } | |
1004 | ||
1005 | /* | |
1006 | * vpfe_get_ccdc_image_format - Get image parameters based on CCDC settings | |
1007 | */ | |
1008 | static int vpfe_get_ccdc_image_format(struct vpfe_device *vpfe, | |
1009 | struct v4l2_format *f) | |
1010 | { | |
1011 | struct v4l2_rect image_win; | |
1012 | enum ccdc_buftype buf_type; | |
1013 | enum ccdc_frmfmt frm_fmt; | |
1014 | ||
1015 | memset(f, 0, sizeof(*f)); | |
1016 | f->type = V4L2_BUF_TYPE_VIDEO_CAPTURE; | |
1017 | vpfe_ccdc_get_image_window(&vpfe->ccdc, &image_win); | |
1018 | f->fmt.pix.width = image_win.width; | |
1019 | f->fmt.pix.height = image_win.height; | |
1020 | f->fmt.pix.bytesperline = vpfe_ccdc_get_line_length(&vpfe->ccdc); | |
1021 | f->fmt.pix.sizeimage = f->fmt.pix.bytesperline * | |
1022 | f->fmt.pix.height; | |
1023 | buf_type = vpfe_ccdc_get_buftype(&vpfe->ccdc); | |
1024 | f->fmt.pix.pixelformat = vpfe_ccdc_get_pixel_format(&vpfe->ccdc); | |
1025 | frm_fmt = vpfe_ccdc_get_frame_format(&vpfe->ccdc); | |
1026 | ||
1027 | if (frm_fmt == CCDC_FRMFMT_PROGRESSIVE) { | |
1028 | f->fmt.pix.field = V4L2_FIELD_NONE; | |
1029 | } else if (frm_fmt == CCDC_FRMFMT_INTERLACED) { | |
1030 | if (buf_type == CCDC_BUFTYPE_FLD_INTERLEAVED) { | |
1031 | f->fmt.pix.field = V4L2_FIELD_INTERLACED; | |
1032 | } else if (buf_type == CCDC_BUFTYPE_FLD_SEPARATED) { | |
1033 | f->fmt.pix.field = V4L2_FIELD_SEQ_TB; | |
1034 | } else { | |
1035 | vpfe_err(vpfe, "Invalid buf_type\n"); | |
1036 | return -EINVAL; | |
1037 | } | |
1038 | } else { | |
1039 | vpfe_err(vpfe, "Invalid frm_fmt\n"); | |
1040 | return -EINVAL; | |
1041 | } | |
1042 | return 0; | |
1043 | } | |
1044 | ||
1045 | static int vpfe_config_ccdc_image_format(struct vpfe_device *vpfe) | |
1046 | { | |
1047 | enum ccdc_frmfmt frm_fmt = CCDC_FRMFMT_INTERLACED; | |
1048 | int ret; | |
1049 | ||
1050 | vpfe_dbg(2, vpfe, "vpfe_config_ccdc_image_format\n"); | |
1051 | ||
1052 | vpfe_dbg(1, vpfe, "pixelformat: %s\n", | |
1053 | print_fourcc(vpfe->fmt.fmt.pix.pixelformat)); | |
1054 | ||
1055 | if (vpfe_ccdc_set_pixel_format(&vpfe->ccdc, | |
1056 | vpfe->fmt.fmt.pix.pixelformat) < 0) { | |
1057 | vpfe_err(vpfe, "couldn't set pix format in ccdc\n"); | |
1058 | return -EINVAL; | |
1059 | } | |
1060 | ||
1061 | /* configure the image window */ | |
1062 | vpfe_ccdc_set_image_window(&vpfe->ccdc, &vpfe->crop, vpfe->bpp); | |
1063 | ||
1064 | switch (vpfe->fmt.fmt.pix.field) { | |
1065 | case V4L2_FIELD_INTERLACED: | |
1066 | /* do nothing, since it is default */ | |
1067 | ret = vpfe_ccdc_set_buftype( | |
1068 | &vpfe->ccdc, | |
1069 | CCDC_BUFTYPE_FLD_INTERLEAVED); | |
1070 | break; | |
1071 | ||
1072 | case V4L2_FIELD_NONE: | |
1073 | frm_fmt = CCDC_FRMFMT_PROGRESSIVE; | |
1074 | /* buffer type only applicable for interlaced scan */ | |
1075 | break; | |
1076 | ||
1077 | case V4L2_FIELD_SEQ_TB: | |
1078 | ret = vpfe_ccdc_set_buftype( | |
1079 | &vpfe->ccdc, | |
1080 | CCDC_BUFTYPE_FLD_SEPARATED); | |
1081 | break; | |
1082 | ||
1083 | default: | |
1084 | return -EINVAL; | |
1085 | } | |
1086 | ||
1087 | if (ret) | |
1088 | return ret; | |
1089 | ||
1090 | return vpfe_ccdc_set_frame_format(&vpfe->ccdc, frm_fmt); | |
1091 | } | |
1092 | ||
1093 | /* | |
1094 | * vpfe_config_image_format() | |
1095 | * For a given standard, this functions sets up the default | |
1096 | * pix format & crop values in the vpfe device and ccdc. It first | |
1097 | * starts with defaults based values from the standard table. | |
1098 | * It then checks if sub device support g_mbus_fmt and then override the | |
1099 | * values based on that.Sets crop values to match with scan resolution | |
1100 | * starting at 0,0. It calls vpfe_config_ccdc_image_format() set the | |
1101 | * values in ccdc | |
1102 | */ | |
1103 | static int vpfe_config_image_format(struct vpfe_device *vpfe, | |
1104 | v4l2_std_id std_id) | |
1105 | { | |
1106 | struct v4l2_pix_format *pix = &vpfe->fmt.fmt.pix; | |
1107 | int i, ret; | |
1108 | ||
1109 | for (i = 0; i < ARRAY_SIZE(vpfe_standards); i++) { | |
1110 | if (vpfe_standards[i].std_id & std_id) { | |
1111 | vpfe->std_info.active_pixels = | |
1112 | vpfe_standards[i].width; | |
1113 | vpfe->std_info.active_lines = | |
1114 | vpfe_standards[i].height; | |
1115 | vpfe->std_info.frame_format = | |
1116 | vpfe_standards[i].frame_format; | |
1117 | vpfe->std_index = i; | |
1118 | ||
1119 | break; | |
1120 | } | |
1121 | } | |
1122 | ||
1123 | if (i == ARRAY_SIZE(vpfe_standards)) { | |
1124 | vpfe_err(vpfe, "standard not supported\n"); | |
1125 | return -EINVAL; | |
1126 | } | |
1127 | ||
1128 | vpfe->crop.top = vpfe->crop.left = 0; | |
1129 | vpfe->crop.width = vpfe->std_info.active_pixels; | |
1130 | vpfe->crop.height = vpfe->std_info.active_lines; | |
1131 | pix->width = vpfe->crop.width; | |
1132 | pix->height = vpfe->crop.height; | |
1133 | pix->pixelformat = V4L2_PIX_FMT_YUYV; | |
1134 | ||
1135 | /* first field and frame format based on standard frame format */ | |
1136 | if (vpfe->std_info.frame_format) | |
1137 | pix->field = V4L2_FIELD_INTERLACED; | |
1138 | else | |
1139 | pix->field = V4L2_FIELD_NONE; | |
1140 | ||
1141 | ret = __vpfe_get_format(vpfe, &vpfe->fmt, &vpfe->bpp); | |
1142 | if (ret) | |
1143 | return ret; | |
1144 | ||
1145 | /* Update the crop window based on found values */ | |
1146 | vpfe->crop.width = pix->width; | |
1147 | vpfe->crop.height = pix->height; | |
1148 | ||
1149 | return vpfe_config_ccdc_image_format(vpfe); | |
1150 | } | |
1151 | ||
1152 | static int vpfe_initialize_device(struct vpfe_device *vpfe) | |
1153 | { | |
1154 | struct vpfe_subdev_info *sdinfo; | |
1155 | int ret; | |
1156 | ||
1157 | sdinfo = &vpfe->cfg->sub_devs[0]; | |
1158 | sdinfo->sd = vpfe->sd[0]; | |
1159 | vpfe->current_input = 0; | |
1160 | vpfe->std_index = 0; | |
1161 | /* Configure the default format information */ | |
1162 | ret = vpfe_config_image_format(vpfe, | |
1163 | vpfe_standards[vpfe->std_index].std_id); | |
1164 | if (ret) | |
1165 | return ret; | |
1166 | ||
1167 | pm_runtime_get_sync(vpfe->pdev); | |
1168 | ||
1169 | vpfe_config_enable(&vpfe->ccdc, 1); | |
1170 | ||
1171 | vpfe_ccdc_restore_defaults(&vpfe->ccdc); | |
1172 | ||
1173 | /* Clear all VPFE interrupts */ | |
1174 | vpfe_clear_intr(&vpfe->ccdc, -1); | |
1175 | ||
1176 | return ret; | |
1177 | } | |
1178 | ||
1179 | /* | |
1180 | * vpfe_release : This function is based on the vb2_fop_release | |
1181 | * helper function. | |
1182 | * It has been augmented to handle module power management, | |
1183 | * by disabling/enabling h/w module fcntl clock when necessary. | |
1184 | */ | |
1185 | static int vpfe_release(struct file *file) | |
1186 | { | |
1187 | struct vpfe_device *vpfe = video_drvdata(file); | |
1188 | int ret; | |
1189 | ||
1190 | mutex_lock(&vpfe->lock); | |
1191 | ||
1192 | if (v4l2_fh_is_singular_file(file)) | |
1193 | vpfe_ccdc_close(&vpfe->ccdc, vpfe->pdev); | |
1194 | ret = _vb2_fop_release(file, NULL); | |
1195 | ||
1196 | mutex_unlock(&vpfe->lock); | |
1197 | ||
1198 | return ret; | |
1199 | } | |
1200 | ||
1201 | /* | |
1202 | * vpfe_open : This function is based on the v4l2_fh_open helper function. | |
1203 | * It has been augmented to handle module power management, | |
1204 | * by disabling/enabling h/w module fcntl clock when necessary. | |
1205 | */ | |
1206 | static int vpfe_open(struct file *file) | |
1207 | { | |
1208 | struct vpfe_device *vpfe = video_drvdata(file); | |
1209 | int ret; | |
1210 | ||
1211 | mutex_lock(&vpfe->lock); | |
1212 | ||
1213 | ret = v4l2_fh_open(file); | |
1214 | if (ret) { | |
1215 | vpfe_err(vpfe, "v4l2_fh_open failed\n"); | |
1216 | goto unlock; | |
1217 | } | |
1218 | ||
1219 | if (!v4l2_fh_is_singular_file(file)) | |
1220 | goto unlock; | |
1221 | ||
1222 | if (vpfe_initialize_device(vpfe)) { | |
1223 | v4l2_fh_release(file); | |
1224 | ret = -ENODEV; | |
1225 | } | |
1226 | ||
1227 | unlock: | |
1228 | mutex_unlock(&vpfe->lock); | |
1229 | return ret; | |
1230 | } | |
1231 | ||
1232 | /** | |
1233 | * vpfe_schedule_next_buffer: set next buffer address for capture | |
1234 | * @vpfe : ptr to vpfe device | |
1235 | * | |
1236 | * This function will get next buffer from the dma queue and | |
1237 | * set the buffer address in the vpfe register for capture. | |
1238 | * the buffer is marked active | |
1239 | * | |
1240 | * Assumes caller is holding vpfe->dma_queue_lock already | |
1241 | */ | |
1242 | static inline void vpfe_schedule_next_buffer(struct vpfe_device *vpfe) | |
1243 | { | |
1244 | vpfe->next_frm = list_entry(vpfe->dma_queue.next, | |
1245 | struct vpfe_cap_buffer, list); | |
1246 | list_del(&vpfe->next_frm->list); | |
1247 | ||
1248 | vpfe_set_sdr_addr(&vpfe->ccdc, | |
1249 | vb2_dma_contig_plane_dma_addr(&vpfe->next_frm->vb, 0)); | |
1250 | } | |
1251 | ||
1252 | static inline void vpfe_schedule_bottom_field(struct vpfe_device *vpfe) | |
1253 | { | |
1254 | unsigned long addr; | |
1255 | ||
1256 | addr = vb2_dma_contig_plane_dma_addr(&vpfe->next_frm->vb, 0) + | |
1257 | vpfe->field_off; | |
1258 | ||
1259 | vpfe_set_sdr_addr(&vpfe->ccdc, addr); | |
1260 | } | |
1261 | ||
1262 | /* | |
1263 | * vpfe_process_buffer_complete: process a completed buffer | |
1264 | * @vpfe : ptr to vpfe device | |
1265 | * | |
1266 | * This function time stamp the buffer and mark it as DONE. It also | |
1267 | * wake up any process waiting on the QUEUE and set the next buffer | |
1268 | * as current | |
1269 | */ | |
1270 | static inline void vpfe_process_buffer_complete(struct vpfe_device *vpfe) | |
1271 | { | |
1272 | v4l2_get_timestamp(&vpfe->cur_frm->vb.v4l2_buf.timestamp); | |
1273 | vpfe->cur_frm->vb.v4l2_buf.field = vpfe->fmt.fmt.pix.field; | |
1274 | vpfe->cur_frm->vb.v4l2_buf.sequence = vpfe->sequence++; | |
1275 | vb2_buffer_done(&vpfe->cur_frm->vb, VB2_BUF_STATE_DONE); | |
1276 | vpfe->cur_frm = vpfe->next_frm; | |
1277 | } | |
1278 | ||
1279 | /* | |
1280 | * vpfe_isr : ISR handler for vpfe capture (VINT0) | |
1281 | * @irq: irq number | |
1282 | * @dev_id: dev_id ptr | |
1283 | * | |
1284 | * It changes status of the captured buffer, takes next buffer from the queue | |
1285 | * and sets its address in VPFE registers | |
1286 | */ | |
1287 | static irqreturn_t vpfe_isr(int irq, void *dev) | |
1288 | { | |
1289 | struct vpfe_device *vpfe = (struct vpfe_device *)dev; | |
1290 | enum v4l2_field field; | |
1291 | int intr_status; | |
1292 | int fid; | |
1293 | ||
1294 | intr_status = vpfe_reg_read(&vpfe->ccdc, VPFE_IRQ_STS); | |
1295 | ||
1296 | if (intr_status & VPFE_VDINT0) { | |
1297 | field = vpfe->fmt.fmt.pix.field; | |
1298 | ||
1299 | if (field == V4L2_FIELD_NONE) { | |
1300 | /* handle progressive frame capture */ | |
1301 | if (vpfe->cur_frm != vpfe->next_frm) | |
1302 | vpfe_process_buffer_complete(vpfe); | |
1303 | goto next_intr; | |
1304 | } | |
1305 | ||
1306 | /* interlaced or TB capture check which field | |
1307 | we are in hardware */ | |
1308 | fid = vpfe_ccdc_getfid(&vpfe->ccdc); | |
1309 | ||
1310 | /* switch the software maintained field id */ | |
1311 | vpfe->field ^= 1; | |
1312 | if (fid == vpfe->field) { | |
1313 | /* we are in-sync here,continue */ | |
1314 | if (fid == 0) { | |
1315 | /* | |
1316 | * One frame is just being captured. If the | |
1317 | * next frame is available, release the | |
1318 | * current frame and move on | |
1319 | */ | |
1320 | if (vpfe->cur_frm != vpfe->next_frm) | |
1321 | vpfe_process_buffer_complete(vpfe); | |
1322 | /* | |
1323 | * based on whether the two fields are stored | |
1324 | * interleave or separately in memory, | |
1325 | * reconfigure the CCDC memory address | |
1326 | */ | |
1327 | if (field == V4L2_FIELD_SEQ_TB) | |
1328 | vpfe_schedule_bottom_field(vpfe); | |
1329 | ||
1330 | goto next_intr; | |
1331 | } | |
1332 | /* | |
1333 | * if one field is just being captured configure | |
1334 | * the next frame get the next frame from the empty | |
1335 | * queue if no frame is available hold on to the | |
1336 | * current buffer | |
1337 | */ | |
1338 | spin_lock(&vpfe->dma_queue_lock); | |
1339 | if (!list_empty(&vpfe->dma_queue) && | |
1340 | vpfe->cur_frm == vpfe->next_frm) | |
1341 | vpfe_schedule_next_buffer(vpfe); | |
1342 | spin_unlock(&vpfe->dma_queue_lock); | |
1343 | } else if (fid == 0) { | |
1344 | /* | |
1345 | * out of sync. Recover from any hardware out-of-sync. | |
1346 | * May loose one frame | |
1347 | */ | |
1348 | vpfe->field = fid; | |
1349 | } | |
1350 | } | |
1351 | ||
1352 | next_intr: | |
1353 | if (intr_status & VPFE_VDINT1) { | |
1354 | spin_lock(&vpfe->dma_queue_lock); | |
1355 | if (vpfe->fmt.fmt.pix.field == V4L2_FIELD_NONE && | |
1356 | !list_empty(&vpfe->dma_queue) && | |
1357 | vpfe->cur_frm == vpfe->next_frm) | |
1358 | vpfe_schedule_next_buffer(vpfe); | |
1359 | spin_unlock(&vpfe->dma_queue_lock); | |
1360 | } | |
1361 | ||
1362 | vpfe_clear_intr(&vpfe->ccdc, intr_status); | |
1363 | ||
1364 | return IRQ_HANDLED; | |
1365 | } | |
1366 | ||
1367 | static inline void vpfe_detach_irq(struct vpfe_device *vpfe) | |
1368 | { | |
1369 | unsigned int intr = VPFE_VDINT0; | |
1370 | enum ccdc_frmfmt frame_format; | |
1371 | ||
1372 | frame_format = vpfe_ccdc_get_frame_format(&vpfe->ccdc); | |
1373 | if (frame_format == CCDC_FRMFMT_PROGRESSIVE) | |
1374 | intr |= VPFE_VDINT1; | |
1375 | ||
1376 | vpfe_reg_write(&vpfe->ccdc, intr, VPFE_IRQ_EN_CLR); | |
1377 | } | |
1378 | ||
1379 | static inline void vpfe_attach_irq(struct vpfe_device *vpfe) | |
1380 | { | |
1381 | unsigned int intr = VPFE_VDINT0; | |
1382 | enum ccdc_frmfmt frame_format; | |
1383 | ||
1384 | frame_format = vpfe_ccdc_get_frame_format(&vpfe->ccdc); | |
1385 | if (frame_format == CCDC_FRMFMT_PROGRESSIVE) | |
1386 | intr |= VPFE_VDINT1; | |
1387 | ||
1388 | vpfe_reg_write(&vpfe->ccdc, intr, VPFE_IRQ_EN_SET); | |
1389 | } | |
1390 | ||
1391 | static int vpfe_querycap(struct file *file, void *priv, | |
1392 | struct v4l2_capability *cap) | |
1393 | { | |
1394 | struct vpfe_device *vpfe = video_drvdata(file); | |
1395 | ||
1396 | vpfe_dbg(2, vpfe, "vpfe_querycap\n"); | |
1397 | ||
1398 | strlcpy(cap->driver, VPFE_MODULE_NAME, sizeof(cap->driver)); | |
1399 | strlcpy(cap->card, "TI AM437x VPFE", sizeof(cap->card)); | |
1400 | snprintf(cap->bus_info, sizeof(cap->bus_info), | |
1401 | "platform:%s", vpfe->v4l2_dev.name); | |
1402 | cap->device_caps = V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_STREAMING | | |
1403 | V4L2_CAP_READWRITE; | |
1404 | cap->capabilities = cap->device_caps | V4L2_CAP_DEVICE_CAPS; | |
1405 | ||
1406 | return 0; | |
1407 | } | |
1408 | ||
1409 | /* get the format set at output pad of the adjacent subdev */ | |
1410 | static int __vpfe_get_format(struct vpfe_device *vpfe, | |
1411 | struct v4l2_format *format, unsigned int *bpp) | |
1412 | { | |
1413 | struct v4l2_mbus_framefmt mbus_fmt; | |
1414 | struct vpfe_subdev_info *sdinfo; | |
1415 | struct v4l2_subdev_format fmt; | |
1416 | int ret; | |
1417 | ||
1418 | sdinfo = vpfe->current_subdev; | |
1419 | if (!sdinfo->sd) | |
1420 | return -EINVAL; | |
1421 | ||
1422 | fmt.which = V4L2_SUBDEV_FORMAT_ACTIVE; | |
1423 | fmt.pad = 0; | |
1424 | ||
1425 | ret = v4l2_subdev_call(sdinfo->sd, pad, get_fmt, NULL, &fmt); | |
1426 | if (ret && ret != -ENOIOCTLCMD && ret != -ENODEV) | |
1427 | return ret; | |
1428 | ||
1429 | if (!ret) { | |
1430 | v4l2_fill_pix_format(&format->fmt.pix, &fmt.format); | |
1431 | mbus_to_pix(vpfe, &fmt.format, &format->fmt.pix, bpp); | |
1432 | } else { | |
1433 | ret = v4l2_device_call_until_err(&vpfe->v4l2_dev, | |
1434 | sdinfo->grp_id, | |
1435 | video, g_mbus_fmt, | |
1436 | &mbus_fmt); | |
1437 | if (ret && ret != -ENOIOCTLCMD && ret != -ENODEV) | |
1438 | return ret; | |
1439 | v4l2_fill_pix_format(&format->fmt.pix, &mbus_fmt); | |
1440 | mbus_to_pix(vpfe, &mbus_fmt, &format->fmt.pix, bpp); | |
1441 | } | |
1442 | ||
1443 | format->type = vpfe->fmt.type; | |
1444 | ||
1445 | vpfe_dbg(1, vpfe, | |
1446 | "%s size %dx%d (%s) bytesperline = %d, size = %d, bpp = %d\n", | |
1447 | __func__, format->fmt.pix.width, format->fmt.pix.height, | |
1448 | print_fourcc(format->fmt.pix.pixelformat), | |
1449 | format->fmt.pix.bytesperline, format->fmt.pix.sizeimage, *bpp); | |
1450 | ||
1451 | return 0; | |
1452 | } | |
1453 | ||
1454 | /* set the format at output pad of the adjacent subdev */ | |
1455 | static int __vpfe_set_format(struct vpfe_device *vpfe, | |
1456 | struct v4l2_format *format, unsigned int *bpp) | |
1457 | { | |
1458 | struct v4l2_mbus_framefmt mbus_fmt; | |
1459 | struct vpfe_subdev_info *sdinfo; | |
1460 | struct v4l2_subdev_format fmt; | |
1461 | int ret; | |
1462 | ||
1463 | vpfe_dbg(2, vpfe, "__vpfe_set_format\n"); | |
1464 | ||
1465 | sdinfo = vpfe->current_subdev; | |
1466 | if (!sdinfo->sd) | |
1467 | return -EINVAL; | |
1468 | ||
1469 | fmt.which = V4L2_SUBDEV_FORMAT_ACTIVE; | |
1470 | fmt.pad = 0; | |
1471 | ||
1472 | pix_to_mbus(vpfe, &format->fmt.pix, &fmt.format); | |
1473 | ||
1474 | ret = v4l2_subdev_call(sdinfo->sd, pad, set_fmt, NULL, &fmt); | |
1475 | if (ret && ret != -ENOIOCTLCMD && ret != -ENODEV) | |
1476 | return ret; | |
1477 | ||
1478 | if (!ret) { | |
1479 | v4l2_fill_pix_format(&format->fmt.pix, &fmt.format); | |
1480 | mbus_to_pix(vpfe, &fmt.format, &format->fmt.pix, bpp); | |
1481 | } else { | |
1482 | ret = v4l2_device_call_until_err(&vpfe->v4l2_dev, | |
1483 | sdinfo->grp_id, | |
1484 | video, s_mbus_fmt, | |
1485 | &mbus_fmt); | |
1486 | if (ret && ret != -ENOIOCTLCMD && ret != -ENODEV) | |
1487 | return ret; | |
1488 | ||
1489 | v4l2_fill_pix_format(&format->fmt.pix, &mbus_fmt); | |
1490 | mbus_to_pix(vpfe, &mbus_fmt, &format->fmt.pix, bpp); | |
1491 | } | |
1492 | ||
1493 | format->type = vpfe->fmt.type; | |
1494 | ||
1495 | vpfe_dbg(1, vpfe, | |
1496 | "%s size %dx%d (%s) bytesperline = %d, size = %d, bpp = %d\n", | |
1497 | __func__, format->fmt.pix.width, format->fmt.pix.height, | |
1498 | print_fourcc(format->fmt.pix.pixelformat), | |
1499 | format->fmt.pix.bytesperline, format->fmt.pix.sizeimage, *bpp); | |
1500 | ||
1501 | return 0; | |
1502 | } | |
1503 | ||
1504 | static int vpfe_g_fmt(struct file *file, void *priv, | |
1505 | struct v4l2_format *fmt) | |
1506 | { | |
1507 | struct vpfe_device *vpfe = video_drvdata(file); | |
1508 | ||
1509 | vpfe_dbg(2, vpfe, "vpfe_g_fmt\n"); | |
1510 | ||
1511 | *fmt = vpfe->fmt; | |
1512 | ||
1513 | return 0; | |
1514 | } | |
1515 | ||
1516 | static int vpfe_enum_fmt(struct file *file, void *priv, | |
1517 | struct v4l2_fmtdesc *f) | |
1518 | { | |
1519 | struct vpfe_device *vpfe = video_drvdata(file); | |
1520 | struct vpfe_subdev_info *sdinfo; | |
1521 | struct vpfe_fmt *fmt = NULL; | |
1522 | unsigned int k; | |
1523 | ||
1524 | vpfe_dbg(2, vpfe, "vpfe_enum_format index:%d\n", | |
1525 | f->index); | |
1526 | ||
1527 | sdinfo = vpfe->current_subdev; | |
1528 | if (!sdinfo->sd) | |
1529 | return -EINVAL; | |
1530 | ||
1531 | if (f->index > ARRAY_SIZE(formats)) | |
1532 | return -EINVAL; | |
1533 | ||
1534 | for (k = 0; k < ARRAY_SIZE(formats); k++) { | |
1535 | if (formats[k].index == f->index) { | |
1536 | fmt = &formats[k]; | |
1537 | break; | |
1538 | } | |
1539 | } | |
1540 | if (!fmt) | |
1541 | return -EINVAL; | |
1542 | ||
1543 | strncpy(f->description, fmt->name, sizeof(f->description) - 1); | |
1544 | f->pixelformat = fmt->fourcc; | |
1545 | f->type = vpfe->fmt.type; | |
1546 | ||
1547 | vpfe_dbg(1, vpfe, "vpfe_enum_format: mbus index: %d code: %x pixelformat: %s [%s]\n", | |
1548 | f->index, fmt->code, print_fourcc(fmt->fourcc), fmt->name); | |
1549 | ||
1550 | return 0; | |
1551 | } | |
1552 | ||
1553 | static int vpfe_try_fmt(struct file *file, void *priv, | |
1554 | struct v4l2_format *fmt) | |
1555 | { | |
1556 | struct vpfe_device *vpfe = video_drvdata(file); | |
1557 | unsigned int bpp; | |
1558 | ||
1559 | vpfe_dbg(2, vpfe, "vpfe_try_fmt\n"); | |
1560 | ||
1561 | return __vpfe_get_format(vpfe, fmt, &bpp); | |
1562 | } | |
1563 | ||
1564 | static int vpfe_s_fmt(struct file *file, void *priv, | |
1565 | struct v4l2_format *fmt) | |
1566 | { | |
1567 | struct vpfe_device *vpfe = video_drvdata(file); | |
1568 | struct v4l2_format format; | |
1569 | unsigned int bpp; | |
1570 | int ret; | |
1571 | ||
1572 | vpfe_dbg(2, vpfe, "vpfe_s_fmt\n"); | |
1573 | ||
1574 | /* If streaming is started, return error */ | |
1575 | if (vb2_is_busy(&vpfe->buffer_queue)) { | |
1576 | vpfe_err(vpfe, "%s device busy\n", __func__); | |
1577 | return -EBUSY; | |
1578 | } | |
1579 | ||
1580 | ret = vpfe_try_fmt(file, priv, fmt); | |
1581 | if (ret) | |
1582 | return ret; | |
1583 | ||
1584 | ||
1585 | if (!cmp_v4l2_format(fmt, &format)) { | |
1586 | /* Sensor format is different from the requested format | |
1587 | * so we need to change it | |
1588 | */ | |
1589 | ret = __vpfe_set_format(vpfe, fmt, &bpp); | |
1590 | if (ret) | |
1591 | return ret; | |
1592 | } else /* Just make sure all of the fields are consistent */ | |
1593 | *fmt = format; | |
1594 | ||
1595 | /* First detach any IRQ if currently attached */ | |
1596 | vpfe_detach_irq(vpfe); | |
1597 | vpfe->fmt = *fmt; | |
1598 | vpfe->bpp = bpp; | |
1599 | ||
1600 | /* Update the crop window based on found values */ | |
1601 | vpfe->crop.width = fmt->fmt.pix.width; | |
1602 | vpfe->crop.height = fmt->fmt.pix.height; | |
1603 | ||
1604 | /* set image capture parameters in the ccdc */ | |
1605 | return vpfe_config_ccdc_image_format(vpfe); | |
1606 | } | |
1607 | ||
1608 | static int vpfe_enum_size(struct file *file, void *priv, | |
1609 | struct v4l2_frmsizeenum *fsize) | |
1610 | { | |
1611 | struct vpfe_device *vpfe = video_drvdata(file); | |
1612 | struct v4l2_subdev_frame_size_enum fse; | |
1613 | struct vpfe_subdev_info *sdinfo; | |
1614 | struct v4l2_mbus_framefmt mbus; | |
1615 | struct v4l2_pix_format pix; | |
1616 | struct vpfe_fmt *fmt; | |
1617 | int ret; | |
1618 | ||
1619 | vpfe_dbg(2, vpfe, "vpfe_enum_size\n"); | |
1620 | ||
1621 | /* check for valid format */ | |
1622 | fmt = find_format_by_pix(fsize->pixel_format); | |
1623 | if (!fmt) { | |
1624 | vpfe_dbg(3, vpfe, "Invalid pixel code: %x, default used instead\n", | |
1625 | fsize->pixel_format); | |
1626 | return -EINVAL; | |
1627 | } | |
1628 | ||
1629 | memset(fsize->reserved, 0x0, sizeof(fsize->reserved)); | |
1630 | ||
1631 | sdinfo = vpfe->current_subdev; | |
1632 | if (!sdinfo->sd) | |
1633 | return -EINVAL; | |
1634 | ||
1635 | memset(&pix, 0x0, sizeof(pix)); | |
1636 | /* Construct pix from parameter and use default for the rest */ | |
1637 | pix.pixelformat = fsize->pixel_format; | |
1638 | pix.width = 640; | |
1639 | pix.height = 480; | |
1640 | pix.colorspace = V4L2_COLORSPACE_SRGB; | |
1641 | pix.field = V4L2_FIELD_NONE; | |
1642 | pix_to_mbus(vpfe, &pix, &mbus); | |
1643 | ||
1644 | memset(&fse, 0x0, sizeof(fse)); | |
1645 | fse.index = fsize->index; | |
1646 | fse.pad = 0; | |
1647 | fse.code = mbus.code; | |
5778e749 | 1648 | fse.which = V4L2_SUBDEV_FORMAT_ACTIVE; |
417d2e50 BP |
1649 | ret = v4l2_subdev_call(sdinfo->sd, pad, enum_frame_size, NULL, &fse); |
1650 | if (ret) | |
1651 | return -EINVAL; | |
1652 | ||
1653 | vpfe_dbg(1, vpfe, "vpfe_enum_size: index: %d code: %x W:[%d,%d] H:[%d,%d]\n", | |
1654 | fse.index, fse.code, fse.min_width, fse.max_width, | |
1655 | fse.min_height, fse.max_height); | |
1656 | ||
1657 | fsize->type = V4L2_FRMSIZE_TYPE_DISCRETE; | |
1658 | fsize->discrete.width = fse.max_width; | |
1659 | fsize->discrete.height = fse.max_height; | |
1660 | ||
1661 | vpfe_dbg(1, vpfe, "vpfe_enum_size: index: %d pixformat: %s size: %dx%d\n", | |
1662 | fsize->index, print_fourcc(fsize->pixel_format), | |
1663 | fsize->discrete.width, fsize->discrete.height); | |
1664 | ||
1665 | return 0; | |
1666 | } | |
1667 | ||
1668 | /* | |
1669 | * vpfe_get_subdev_input_index - Get subdev index and subdev input index for a | |
1670 | * given app input index | |
1671 | */ | |
1672 | static int | |
1673 | vpfe_get_subdev_input_index(struct vpfe_device *vpfe, | |
1674 | int *subdev_index, | |
1675 | int *subdev_input_index, | |
1676 | int app_input_index) | |
1677 | { | |
1678 | struct vpfe_config *cfg = vpfe->cfg; | |
1679 | struct vpfe_subdev_info *sdinfo; | |
1680 | int i, j = 0; | |
1681 | ||
1682 | for (i = 0; i < ARRAY_SIZE(vpfe->cfg->asd); i++) { | |
1683 | sdinfo = &cfg->sub_devs[i]; | |
1684 | if (app_input_index < (j + 1)) { | |
1685 | *subdev_index = i; | |
1686 | *subdev_input_index = app_input_index - j; | |
1687 | return 0; | |
1688 | } | |
1689 | j++; | |
1690 | } | |
1691 | return -EINVAL; | |
1692 | } | |
1693 | ||
1694 | /* | |
1695 | * vpfe_get_app_input - Get app input index for a given subdev input index | |
1696 | * driver stores the input index of the current sub device and translate it | |
1697 | * when application request the current input | |
1698 | */ | |
1699 | static int vpfe_get_app_input_index(struct vpfe_device *vpfe, | |
1700 | int *app_input_index) | |
1701 | { | |
1702 | struct vpfe_config *cfg = vpfe->cfg; | |
1703 | struct vpfe_subdev_info *sdinfo; | |
d3723239 LP |
1704 | struct i2c_client *client; |
1705 | struct i2c_client *curr_client; | |
417d2e50 BP |
1706 | int i, j = 0; |
1707 | ||
d3723239 | 1708 | curr_client = v4l2_get_subdevdata(vpfe->current_subdev->sd); |
417d2e50 BP |
1709 | for (i = 0; i < ARRAY_SIZE(vpfe->cfg->asd); i++) { |
1710 | sdinfo = &cfg->sub_devs[i]; | |
d3723239 LP |
1711 | client = v4l2_get_subdevdata(sdinfo->sd); |
1712 | if (client->addr == curr_client->addr && | |
1713 | client->adapter->nr == client->adapter->nr) { | |
417d2e50 BP |
1714 | if (vpfe->current_input >= 1) |
1715 | return -1; | |
1716 | *app_input_index = j + vpfe->current_input; | |
1717 | return 0; | |
1718 | } | |
1719 | j++; | |
1720 | } | |
1721 | return -EINVAL; | |
1722 | } | |
1723 | ||
1724 | static int vpfe_enum_input(struct file *file, void *priv, | |
1725 | struct v4l2_input *inp) | |
1726 | { | |
1727 | struct vpfe_device *vpfe = video_drvdata(file); | |
1728 | struct vpfe_subdev_info *sdinfo; | |
1729 | int subdev, index; | |
1730 | ||
1731 | vpfe_dbg(2, vpfe, "vpfe_enum_input\n"); | |
1732 | ||
1733 | if (vpfe_get_subdev_input_index(vpfe, &subdev, &index, | |
1734 | inp->index) < 0) { | |
1735 | vpfe_dbg(1, vpfe, | |
1736 | "input information not found for the subdev\n"); | |
1737 | return -EINVAL; | |
1738 | } | |
1739 | sdinfo = &vpfe->cfg->sub_devs[subdev]; | |
1740 | *inp = sdinfo->inputs[index]; | |
1741 | ||
1742 | return 0; | |
1743 | } | |
1744 | ||
1745 | static int vpfe_g_input(struct file *file, void *priv, unsigned int *index) | |
1746 | { | |
1747 | struct vpfe_device *vpfe = video_drvdata(file); | |
1748 | ||
1749 | vpfe_dbg(2, vpfe, "vpfe_g_input\n"); | |
1750 | ||
1751 | return vpfe_get_app_input_index(vpfe, index); | |
1752 | } | |
1753 | ||
1754 | /* Assumes caller is holding vpfe_dev->lock */ | |
1755 | static int vpfe_set_input(struct vpfe_device *vpfe, unsigned int index) | |
1756 | { | |
1757 | int subdev_index = 0, inp_index = 0; | |
1758 | struct vpfe_subdev_info *sdinfo; | |
1759 | struct vpfe_route *route; | |
1760 | u32 input, output; | |
1761 | int ret; | |
1762 | ||
1763 | vpfe_dbg(2, vpfe, "vpfe_set_input: index: %d\n", index); | |
1764 | ||
1765 | /* If streaming is started, return error */ | |
1766 | if (vb2_is_busy(&vpfe->buffer_queue)) { | |
1767 | vpfe_err(vpfe, "%s device busy\n", __func__); | |
1768 | return -EBUSY; | |
1769 | } | |
1770 | ret = vpfe_get_subdev_input_index(vpfe, | |
1771 | &subdev_index, | |
1772 | &inp_index, | |
1773 | index); | |
1774 | if (ret < 0) { | |
1775 | vpfe_err(vpfe, "invalid input index: %d\n", index); | |
1776 | goto get_out; | |
1777 | } | |
1778 | ||
1779 | sdinfo = &vpfe->cfg->sub_devs[subdev_index]; | |
1780 | sdinfo->sd = vpfe->sd[subdev_index]; | |
1781 | route = &sdinfo->routes[inp_index]; | |
1782 | if (route && sdinfo->can_route) { | |
1783 | input = route->input; | |
1784 | output = route->output; | |
1785 | if (sdinfo->sd) { | |
1786 | ret = v4l2_subdev_call(sdinfo->sd, video, | |
1787 | s_routing, input, output, 0); | |
1788 | if (ret) { | |
1789 | vpfe_err(vpfe, "s_routing failed\n"); | |
1790 | ret = -EINVAL; | |
1791 | goto get_out; | |
1792 | } | |
1793 | } | |
1794 | ||
1795 | } | |
1796 | ||
1797 | vpfe->current_subdev = sdinfo; | |
1798 | if (sdinfo->sd) | |
1799 | vpfe->v4l2_dev.ctrl_handler = sdinfo->sd->ctrl_handler; | |
1800 | vpfe->current_input = index; | |
1801 | vpfe->std_index = 0; | |
1802 | ||
1803 | /* set the bus/interface parameter for the sub device in ccdc */ | |
1804 | ret = vpfe_ccdc_set_hw_if_params(&vpfe->ccdc, &sdinfo->vpfe_param); | |
1805 | if (ret) | |
1806 | return ret; | |
1807 | ||
1808 | /* set the default image parameters in the device */ | |
1809 | return vpfe_config_image_format(vpfe, | |
1810 | vpfe_standards[vpfe->std_index].std_id); | |
1811 | ||
1812 | get_out: | |
1813 | return ret; | |
1814 | } | |
1815 | ||
1816 | static int vpfe_s_input(struct file *file, void *priv, unsigned int index) | |
1817 | { | |
1818 | struct vpfe_device *vpfe = video_drvdata(file); | |
1819 | ||
1820 | vpfe_dbg(2, vpfe, | |
1821 | "vpfe_s_input: index: %d\n", index); | |
1822 | ||
1823 | return vpfe_set_input(vpfe, index); | |
1824 | } | |
1825 | ||
1826 | static int vpfe_querystd(struct file *file, void *priv, v4l2_std_id *std_id) | |
1827 | { | |
1828 | struct vpfe_device *vpfe = video_drvdata(file); | |
1829 | struct vpfe_subdev_info *sdinfo; | |
1830 | ||
1831 | vpfe_dbg(2, vpfe, "vpfe_querystd\n"); | |
1832 | ||
1833 | sdinfo = vpfe->current_subdev; | |
1834 | if (!(sdinfo->inputs[0].capabilities & V4L2_IN_CAP_STD)) | |
1835 | return -ENODATA; | |
1836 | ||
1837 | /* Call querystd function of decoder device */ | |
1838 | return v4l2_device_call_until_err(&vpfe->v4l2_dev, sdinfo->grp_id, | |
1839 | video, querystd, std_id); | |
1840 | } | |
1841 | ||
1842 | static int vpfe_s_std(struct file *file, void *priv, v4l2_std_id std_id) | |
1843 | { | |
1844 | struct vpfe_device *vpfe = video_drvdata(file); | |
1845 | struct vpfe_subdev_info *sdinfo; | |
1846 | int ret; | |
1847 | ||
1848 | vpfe_dbg(2, vpfe, "vpfe_s_std\n"); | |
1849 | ||
1850 | sdinfo = vpfe->current_subdev; | |
1851 | if (!(sdinfo->inputs[0].capabilities & V4L2_IN_CAP_STD)) | |
1852 | return -ENODATA; | |
1853 | ||
1854 | /* If streaming is started, return error */ | |
1855 | if (vb2_is_busy(&vpfe->buffer_queue)) { | |
1856 | vpfe_err(vpfe, "%s device busy\n", __func__); | |
1857 | ret = -EBUSY; | |
1858 | return ret; | |
1859 | } | |
1860 | ||
1861 | ret = v4l2_device_call_until_err(&vpfe->v4l2_dev, sdinfo->grp_id, | |
1862 | video, s_std, std_id); | |
1863 | if (ret < 0) { | |
1864 | vpfe_err(vpfe, "Failed to set standard\n"); | |
1865 | return ret; | |
1866 | } | |
1867 | ret = vpfe_config_image_format(vpfe, std_id); | |
1868 | ||
1869 | return ret; | |
1870 | } | |
1871 | ||
1872 | static int vpfe_g_std(struct file *file, void *priv, v4l2_std_id *std_id) | |
1873 | { | |
1874 | struct vpfe_device *vpfe = video_drvdata(file); | |
1875 | struct vpfe_subdev_info *sdinfo; | |
1876 | ||
1877 | vpfe_dbg(2, vpfe, "vpfe_g_std\n"); | |
1878 | ||
1879 | sdinfo = vpfe->current_subdev; | |
1880 | if (sdinfo->inputs[0].capabilities != V4L2_IN_CAP_STD) | |
1881 | return -ENODATA; | |
1882 | ||
1883 | *std_id = vpfe_standards[vpfe->std_index].std_id; | |
1884 | ||
1885 | return 0; | |
1886 | } | |
1887 | ||
1888 | /* | |
1889 | * vpfe_calculate_offsets : This function calculates buffers offset | |
1890 | * for top and bottom field | |
1891 | */ | |
1892 | static void vpfe_calculate_offsets(struct vpfe_device *vpfe) | |
1893 | { | |
1894 | struct v4l2_rect image_win; | |
1895 | ||
1896 | vpfe_dbg(2, vpfe, "vpfe_calculate_offsets\n"); | |
1897 | ||
1898 | vpfe_ccdc_get_image_window(&vpfe->ccdc, &image_win); | |
1899 | vpfe->field_off = image_win.height * image_win.width; | |
1900 | } | |
1901 | ||
1902 | /* | |
1903 | * vpfe_queue_setup - Callback function for buffer setup. | |
1904 | * @vq: vb2_queue ptr | |
1905 | * @fmt: v4l2 format | |
1906 | * @nbuffers: ptr to number of buffers requested by application | |
1907 | * @nplanes:: contains number of distinct video planes needed to hold a frame | |
1908 | * @sizes[]: contains the size (in bytes) of each plane. | |
1909 | * @alloc_ctxs: ptr to allocation context | |
1910 | * | |
1911 | * This callback function is called when reqbuf() is called to adjust | |
1912 | * the buffer count and buffer size | |
1913 | */ | |
1914 | static int vpfe_queue_setup(struct vb2_queue *vq, | |
1915 | const struct v4l2_format *fmt, | |
1916 | unsigned int *nbuffers, unsigned int *nplanes, | |
1917 | unsigned int sizes[], void *alloc_ctxs[]) | |
1918 | { | |
1919 | struct vpfe_device *vpfe = vb2_get_drv_priv(vq); | |
1920 | ||
1921 | if (fmt && fmt->fmt.pix.sizeimage < vpfe->fmt.fmt.pix.sizeimage) | |
1922 | return -EINVAL; | |
1923 | ||
1924 | if (vq->num_buffers + *nbuffers < 3) | |
1925 | *nbuffers = 3 - vq->num_buffers; | |
1926 | ||
1927 | *nplanes = 1; | |
1928 | sizes[0] = fmt ? fmt->fmt.pix.sizeimage : vpfe->fmt.fmt.pix.sizeimage; | |
1929 | alloc_ctxs[0] = vpfe->alloc_ctx; | |
1930 | ||
1931 | vpfe_dbg(1, vpfe, | |
1932 | "nbuffers=%d, size=%u\n", *nbuffers, sizes[0]); | |
1933 | ||
1934 | /* Calculate field offset */ | |
1935 | vpfe_calculate_offsets(vpfe); | |
1936 | ||
1937 | return 0; | |
1938 | } | |
1939 | ||
1940 | /* | |
1941 | * vpfe_buffer_prepare : callback function for buffer prepare | |
1942 | * @vb: ptr to vb2_buffer | |
1943 | * | |
1944 | * This is the callback function for buffer prepare when vb2_qbuf() | |
1945 | * function is called. The buffer is prepared and user space virtual address | |
1946 | * or user address is converted into physical address | |
1947 | */ | |
1948 | static int vpfe_buffer_prepare(struct vb2_buffer *vb) | |
1949 | { | |
1950 | struct vpfe_device *vpfe = vb2_get_drv_priv(vb->vb2_queue); | |
1951 | ||
1952 | vb2_set_plane_payload(vb, 0, vpfe->fmt.fmt.pix.sizeimage); | |
1953 | ||
1954 | if (vb2_get_plane_payload(vb, 0) > vb2_plane_size(vb, 0)) | |
1955 | return -EINVAL; | |
1956 | ||
1957 | vb->v4l2_buf.field = vpfe->fmt.fmt.pix.field; | |
1958 | ||
1959 | return 0; | |
1960 | } | |
1961 | ||
1962 | /* | |
1963 | * vpfe_buffer_queue : Callback function to add buffer to DMA queue | |
1964 | * @vb: ptr to vb2_buffer | |
1965 | */ | |
1966 | static void vpfe_buffer_queue(struct vb2_buffer *vb) | |
1967 | { | |
1968 | struct vpfe_device *vpfe = vb2_get_drv_priv(vb->vb2_queue); | |
1969 | struct vpfe_cap_buffer *buf = to_vpfe_buffer(vb); | |
1970 | unsigned long flags = 0; | |
1971 | ||
1972 | /* add the buffer to the DMA queue */ | |
1973 | spin_lock_irqsave(&vpfe->dma_queue_lock, flags); | |
1974 | list_add_tail(&buf->list, &vpfe->dma_queue); | |
1975 | spin_unlock_irqrestore(&vpfe->dma_queue_lock, flags); | |
1976 | } | |
1977 | ||
1978 | /* | |
1979 | * vpfe_start_streaming : Starts the DMA engine for streaming | |
1980 | * @vb: ptr to vb2_buffer | |
1981 | * @count: number of buffers | |
1982 | */ | |
1983 | static int vpfe_start_streaming(struct vb2_queue *vq, unsigned int count) | |
1984 | { | |
1985 | struct vpfe_device *vpfe = vb2_get_drv_priv(vq); | |
1986 | struct vpfe_cap_buffer *buf, *tmp; | |
1987 | struct vpfe_subdev_info *sdinfo; | |
1988 | unsigned long flags; | |
1989 | unsigned long addr; | |
1990 | int ret; | |
1991 | ||
1992 | spin_lock_irqsave(&vpfe->dma_queue_lock, flags); | |
1993 | ||
1994 | vpfe->field = 0; | |
1995 | vpfe->sequence = 0; | |
1996 | ||
1997 | sdinfo = vpfe->current_subdev; | |
1998 | ||
1999 | vpfe_attach_irq(vpfe); | |
2000 | ||
2001 | if (vpfe->ccdc.ccdc_cfg.if_type == VPFE_RAW_BAYER) | |
2002 | vpfe_ccdc_config_raw(&vpfe->ccdc); | |
2003 | else | |
2004 | vpfe_ccdc_config_ycbcr(&vpfe->ccdc); | |
2005 | ||
2006 | /* Get the next frame from the buffer queue */ | |
2007 | vpfe->next_frm = list_entry(vpfe->dma_queue.next, | |
2008 | struct vpfe_cap_buffer, list); | |
2009 | vpfe->cur_frm = vpfe->next_frm; | |
2010 | /* Remove buffer from the buffer queue */ | |
2011 | list_del(&vpfe->cur_frm->list); | |
2012 | spin_unlock_irqrestore(&vpfe->dma_queue_lock, flags); | |
2013 | ||
2014 | addr = vb2_dma_contig_plane_dma_addr(&vpfe->cur_frm->vb, 0); | |
2015 | ||
2016 | vpfe_set_sdr_addr(&vpfe->ccdc, (unsigned long)(addr)); | |
2017 | ||
2018 | vpfe_pcr_enable(&vpfe->ccdc, 1); | |
2019 | ||
2020 | ret = v4l2_subdev_call(sdinfo->sd, video, s_stream, 1); | |
2021 | if (ret < 0) { | |
2022 | vpfe_err(vpfe, "Error in attaching interrupt handle\n"); | |
2023 | goto err; | |
2024 | } | |
2025 | ||
2026 | return 0; | |
2027 | ||
2028 | err: | |
2029 | list_for_each_entry_safe(buf, tmp, &vpfe->dma_queue, list) { | |
2030 | list_del(&buf->list); | |
2031 | vb2_buffer_done(&buf->vb, VB2_BUF_STATE_QUEUED); | |
2032 | } | |
417d2e50 BP |
2033 | |
2034 | return ret; | |
2035 | } | |
2036 | ||
2037 | /* | |
2038 | * vpfe_stop_streaming : Stop the DMA engine | |
2039 | * @vq: ptr to vb2_queue | |
2040 | * | |
2041 | * This callback stops the DMA engine and any remaining buffers | |
2042 | * in the DMA queue are released. | |
2043 | */ | |
2044 | static void vpfe_stop_streaming(struct vb2_queue *vq) | |
2045 | { | |
2046 | struct vpfe_device *vpfe = vb2_get_drv_priv(vq); | |
2047 | struct vpfe_subdev_info *sdinfo; | |
2048 | unsigned long flags; | |
2049 | int ret; | |
2050 | ||
2051 | vpfe_pcr_enable(&vpfe->ccdc, 0); | |
2052 | ||
2053 | vpfe_detach_irq(vpfe); | |
2054 | ||
2055 | sdinfo = vpfe->current_subdev; | |
2056 | ret = v4l2_subdev_call(sdinfo->sd, video, s_stream, 0); | |
2057 | if (ret && ret != -ENOIOCTLCMD && ret != -ENODEV) | |
2058 | vpfe_dbg(1, vpfe, "stream off failed in subdev\n"); | |
2059 | ||
2060 | /* release all active buffers */ | |
2061 | spin_lock_irqsave(&vpfe->dma_queue_lock, flags); | |
2062 | if (vpfe->cur_frm == vpfe->next_frm) { | |
2063 | vb2_buffer_done(&vpfe->cur_frm->vb, VB2_BUF_STATE_ERROR); | |
2064 | } else { | |
2065 | if (vpfe->cur_frm != NULL) | |
2066 | vb2_buffer_done(&vpfe->cur_frm->vb, | |
2067 | VB2_BUF_STATE_ERROR); | |
2068 | if (vpfe->next_frm != NULL) | |
2069 | vb2_buffer_done(&vpfe->next_frm->vb, | |
2070 | VB2_BUF_STATE_ERROR); | |
2071 | } | |
2072 | ||
2073 | while (!list_empty(&vpfe->dma_queue)) { | |
2074 | vpfe->next_frm = list_entry(vpfe->dma_queue.next, | |
2075 | struct vpfe_cap_buffer, list); | |
2076 | list_del(&vpfe->next_frm->list); | |
2077 | vb2_buffer_done(&vpfe->next_frm->vb, VB2_BUF_STATE_ERROR); | |
2078 | } | |
2079 | spin_unlock_irqrestore(&vpfe->dma_queue_lock, flags); | |
2080 | } | |
2081 | ||
2082 | static int vpfe_cropcap(struct file *file, void *priv, | |
2083 | struct v4l2_cropcap *crop) | |
2084 | { | |
2085 | struct vpfe_device *vpfe = video_drvdata(file); | |
2086 | ||
2087 | vpfe_dbg(2, vpfe, "vpfe_cropcap\n"); | |
2088 | ||
2089 | if (vpfe->std_index >= ARRAY_SIZE(vpfe_standards)) | |
2090 | return -EINVAL; | |
2091 | ||
2092 | memset(crop, 0, sizeof(struct v4l2_cropcap)); | |
2093 | ||
2094 | crop->type = V4L2_BUF_TYPE_VIDEO_CAPTURE; | |
2095 | crop->defrect.width = vpfe_standards[vpfe->std_index].width; | |
2096 | crop->bounds.width = crop->defrect.width; | |
2097 | crop->defrect.height = vpfe_standards[vpfe->std_index].height; | |
2098 | crop->bounds.height = crop->defrect.height; | |
2099 | crop->pixelaspect = vpfe_standards[vpfe->std_index].pixelaspect; | |
2100 | ||
2101 | return 0; | |
2102 | } | |
2103 | ||
2104 | static int | |
2105 | vpfe_g_selection(struct file *file, void *fh, struct v4l2_selection *s) | |
2106 | { | |
2107 | struct vpfe_device *vpfe = video_drvdata(file); | |
2108 | ||
2109 | switch (s->target) { | |
2110 | case V4L2_SEL_TGT_CROP_BOUNDS: | |
2111 | case V4L2_SEL_TGT_CROP_DEFAULT: | |
2112 | s->r.left = s->r.top = 0; | |
2113 | s->r.width = vpfe->crop.width; | |
2114 | s->r.height = vpfe->crop.height; | |
2115 | break; | |
2116 | ||
2117 | case V4L2_SEL_TGT_CROP: | |
2118 | s->r = vpfe->crop; | |
2119 | break; | |
2120 | ||
2121 | default: | |
2122 | return -EINVAL; | |
2123 | } | |
2124 | ||
2125 | return 0; | |
2126 | } | |
2127 | ||
2128 | static int enclosed_rectangle(struct v4l2_rect *a, struct v4l2_rect *b) | |
2129 | { | |
2130 | if (a->left < b->left || a->top < b->top) | |
2131 | return 0; | |
2132 | ||
2133 | if (a->left + a->width > b->left + b->width) | |
2134 | return 0; | |
2135 | ||
2136 | if (a->top + a->height > b->top + b->height) | |
2137 | return 0; | |
2138 | ||
2139 | return 1; | |
2140 | } | |
2141 | ||
2142 | static int | |
2143 | vpfe_s_selection(struct file *file, void *fh, struct v4l2_selection *s) | |
2144 | { | |
2145 | struct vpfe_device *vpfe = video_drvdata(file); | |
2146 | struct v4l2_rect cr = vpfe->crop; | |
2147 | struct v4l2_rect r = s->r; | |
2148 | ||
2149 | /* If streaming is started, return error */ | |
2150 | if (vb2_is_busy(&vpfe->buffer_queue)) { | |
2151 | vpfe_err(vpfe, "%s device busy\n", __func__); | |
2152 | return -EBUSY; | |
2153 | } | |
2154 | ||
2155 | if (s->type != V4L2_BUF_TYPE_VIDEO_CAPTURE || | |
2156 | s->target != V4L2_SEL_TGT_CROP) | |
2157 | return -EINVAL; | |
2158 | ||
2159 | v4l_bound_align_image(&r.width, 0, cr.width, 0, | |
2160 | &r.height, 0, cr.height, 0, 0); | |
2161 | ||
2162 | r.left = clamp_t(unsigned int, r.left, 0, cr.width - r.width); | |
2163 | r.top = clamp_t(unsigned int, r.top, 0, cr.height - r.height); | |
2164 | ||
2165 | if (s->flags & V4L2_SEL_FLAG_LE && !enclosed_rectangle(&r, &s->r)) | |
2166 | return -ERANGE; | |
2167 | ||
2168 | if (s->flags & V4L2_SEL_FLAG_GE && !enclosed_rectangle(&s->r, &r)) | |
2169 | return -ERANGE; | |
2170 | ||
2171 | s->r = vpfe->crop = r; | |
2172 | ||
2173 | vpfe_ccdc_set_image_window(&vpfe->ccdc, &r, vpfe->bpp); | |
2174 | vpfe->fmt.fmt.pix.width = r.width; | |
2175 | vpfe->fmt.fmt.pix.height = r.height; | |
2176 | vpfe->fmt.fmt.pix.bytesperline = vpfe_ccdc_get_line_length(&vpfe->ccdc); | |
2177 | vpfe->fmt.fmt.pix.sizeimage = vpfe->fmt.fmt.pix.bytesperline * | |
2178 | vpfe->fmt.fmt.pix.height; | |
2179 | ||
2180 | vpfe_dbg(1, vpfe, "cropped (%d,%d)/%dx%d of %dx%d\n", | |
2181 | r.left, r.top, r.width, r.height, cr.width, cr.height); | |
2182 | ||
2183 | return 0; | |
2184 | } | |
2185 | ||
2186 | static long vpfe_ioctl_default(struct file *file, void *priv, | |
2187 | bool valid_prio, unsigned int cmd, void *param) | |
2188 | { | |
2189 | struct vpfe_device *vpfe = video_drvdata(file); | |
2190 | int ret; | |
2191 | ||
2192 | vpfe_dbg(2, vpfe, "vpfe_ioctl_default\n"); | |
2193 | ||
2194 | if (!valid_prio) { | |
2195 | vpfe_err(vpfe, "%s device busy\n", __func__); | |
2196 | return -EBUSY; | |
2197 | } | |
2198 | ||
2199 | /* If streaming is started, return error */ | |
2200 | if (vb2_is_busy(&vpfe->buffer_queue)) { | |
2201 | vpfe_err(vpfe, "%s device busy\n", __func__); | |
2202 | return -EBUSY; | |
2203 | } | |
2204 | ||
2205 | switch (cmd) { | |
2206 | case VIDIOC_AM437X_CCDC_CFG: | |
42fd3638 | 2207 | ret = vpfe_ccdc_set_params(&vpfe->ccdc, (void __user *)param); |
417d2e50 BP |
2208 | if (ret) { |
2209 | vpfe_dbg(2, vpfe, | |
2210 | "Error setting parameters in CCDC\n"); | |
2211 | return ret; | |
2212 | } | |
2213 | ret = vpfe_get_ccdc_image_format(vpfe, | |
2214 | &vpfe->fmt); | |
2215 | if (ret < 0) { | |
2216 | vpfe_dbg(2, vpfe, | |
2217 | "Invalid image format at CCDC\n"); | |
2218 | return ret; | |
2219 | } | |
2220 | break; | |
2221 | ||
2222 | default: | |
2223 | ret = -ENOTTY; | |
2224 | break; | |
2225 | } | |
2226 | ||
2227 | return ret; | |
2228 | } | |
2229 | ||
2230 | static const struct vb2_ops vpfe_video_qops = { | |
2231 | .wait_prepare = vb2_ops_wait_prepare, | |
2232 | .wait_finish = vb2_ops_wait_finish, | |
2233 | .queue_setup = vpfe_queue_setup, | |
2234 | .buf_prepare = vpfe_buffer_prepare, | |
2235 | .buf_queue = vpfe_buffer_queue, | |
2236 | .start_streaming = vpfe_start_streaming, | |
2237 | .stop_streaming = vpfe_stop_streaming, | |
2238 | }; | |
2239 | ||
2240 | /* vpfe capture driver file operations */ | |
2241 | static const struct v4l2_file_operations vpfe_fops = { | |
2242 | .owner = THIS_MODULE, | |
2243 | .open = vpfe_open, | |
2244 | .release = vpfe_release, | |
2245 | .read = vb2_fop_read, | |
2246 | .poll = vb2_fop_poll, | |
2247 | .unlocked_ioctl = video_ioctl2, | |
2248 | .mmap = vb2_fop_mmap, | |
2249 | }; | |
2250 | ||
2251 | /* vpfe capture ioctl operations */ | |
2252 | static const struct v4l2_ioctl_ops vpfe_ioctl_ops = { | |
2253 | .vidioc_querycap = vpfe_querycap, | |
2254 | .vidioc_enum_fmt_vid_cap = vpfe_enum_fmt, | |
2255 | .vidioc_g_fmt_vid_cap = vpfe_g_fmt, | |
2256 | .vidioc_s_fmt_vid_cap = vpfe_s_fmt, | |
2257 | .vidioc_try_fmt_vid_cap = vpfe_try_fmt, | |
2258 | ||
2259 | .vidioc_enum_framesizes = vpfe_enum_size, | |
2260 | ||
2261 | .vidioc_enum_input = vpfe_enum_input, | |
2262 | .vidioc_g_input = vpfe_g_input, | |
2263 | .vidioc_s_input = vpfe_s_input, | |
2264 | ||
2265 | .vidioc_querystd = vpfe_querystd, | |
2266 | .vidioc_s_std = vpfe_s_std, | |
2267 | .vidioc_g_std = vpfe_g_std, | |
2268 | ||
2269 | .vidioc_reqbufs = vb2_ioctl_reqbufs, | |
2270 | .vidioc_create_bufs = vb2_ioctl_create_bufs, | |
2271 | .vidioc_prepare_buf = vb2_ioctl_prepare_buf, | |
2272 | .vidioc_querybuf = vb2_ioctl_querybuf, | |
2273 | .vidioc_qbuf = vb2_ioctl_qbuf, | |
2274 | .vidioc_dqbuf = vb2_ioctl_dqbuf, | |
2275 | .vidioc_expbuf = vb2_ioctl_expbuf, | |
2276 | .vidioc_streamon = vb2_ioctl_streamon, | |
2277 | .vidioc_streamoff = vb2_ioctl_streamoff, | |
2278 | ||
2279 | .vidioc_log_status = v4l2_ctrl_log_status, | |
2280 | .vidioc_subscribe_event = v4l2_ctrl_subscribe_event, | |
2281 | .vidioc_unsubscribe_event = v4l2_event_unsubscribe, | |
2282 | ||
2283 | .vidioc_cropcap = vpfe_cropcap, | |
2284 | .vidioc_g_selection = vpfe_g_selection, | |
2285 | .vidioc_s_selection = vpfe_s_selection, | |
2286 | ||
2287 | .vidioc_default = vpfe_ioctl_default, | |
2288 | }; | |
2289 | ||
2290 | static int | |
2291 | vpfe_async_bound(struct v4l2_async_notifier *notifier, | |
2292 | struct v4l2_subdev *subdev, | |
2293 | struct v4l2_async_subdev *asd) | |
2294 | { | |
2295 | struct vpfe_device *vpfe = container_of(notifier->v4l2_dev, | |
2296 | struct vpfe_device, v4l2_dev); | |
2297 | struct v4l2_subdev_mbus_code_enum mbus_code; | |
2298 | struct vpfe_subdev_info *sdinfo; | |
2299 | bool found = false; | |
2300 | int i, j; | |
2301 | ||
2302 | vpfe_dbg(1, vpfe, "vpfe_async_bound\n"); | |
2303 | ||
2304 | for (i = 0; i < ARRAY_SIZE(vpfe->cfg->asd); i++) { | |
d3723239 LP |
2305 | if (vpfe->cfg->asd[i]->match.of.node == asd[i].match.of.node) { |
2306 | sdinfo = &vpfe->cfg->sub_devs[i]; | |
417d2e50 | 2307 | vpfe->sd[i] = subdev; |
d3723239 | 2308 | vpfe->sd[i]->grp_id = sdinfo->grp_id; |
417d2e50 BP |
2309 | found = true; |
2310 | break; | |
2311 | } | |
2312 | } | |
2313 | ||
2314 | if (!found) { | |
2315 | vpfe_info(vpfe, "sub device (%s) not matched\n", subdev->name); | |
2316 | return -EINVAL; | |
2317 | } | |
2318 | ||
d3723239 LP |
2319 | vpfe->video_dev->tvnorms |= sdinfo->inputs[0].std; |
2320 | ||
417d2e50 BP |
2321 | /* setup the supported formats & indexes */ |
2322 | for (j = 0, i = 0; ; ++j) { | |
2323 | struct vpfe_fmt *fmt; | |
2324 | int ret; | |
2325 | ||
2326 | memset(&mbus_code, 0, sizeof(mbus_code)); | |
2327 | mbus_code.index = j; | |
3f1ccf16 | 2328 | mbus_code.which = V4L2_SUBDEV_FORMAT_ACTIVE; |
417d2e50 BP |
2329 | ret = v4l2_subdev_call(subdev, pad, enum_mbus_code, |
2330 | NULL, &mbus_code); | |
2331 | if (ret) | |
2332 | break; | |
2333 | ||
2334 | fmt = find_format_by_code(mbus_code.code); | |
2335 | if (!fmt) | |
2336 | continue; | |
2337 | ||
2338 | fmt->supported = true; | |
2339 | fmt->index = i++; | |
2340 | } | |
2341 | ||
2342 | return 0; | |
2343 | } | |
2344 | ||
2345 | static int vpfe_probe_complete(struct vpfe_device *vpfe) | |
2346 | { | |
2347 | struct video_device *vdev; | |
2348 | struct vb2_queue *q; | |
2349 | int err; | |
2350 | ||
2351 | spin_lock_init(&vpfe->dma_queue_lock); | |
2352 | mutex_init(&vpfe->lock); | |
2353 | ||
2354 | vpfe->fmt.type = V4L2_BUF_TYPE_VIDEO_CAPTURE; | |
2355 | ||
2356 | /* set first sub device as current one */ | |
2357 | vpfe->current_subdev = &vpfe->cfg->sub_devs[0]; | |
2358 | vpfe->v4l2_dev.ctrl_handler = vpfe->sd[0]->ctrl_handler; | |
2359 | ||
2360 | err = vpfe_set_input(vpfe, 0); | |
2361 | if (err) | |
2362 | goto probe_out; | |
2363 | ||
2364 | /* Initialize videobuf2 queue as per the buffer type */ | |
2365 | vpfe->alloc_ctx = vb2_dma_contig_init_ctx(vpfe->pdev); | |
2366 | if (IS_ERR(vpfe->alloc_ctx)) { | |
2367 | vpfe_err(vpfe, "Failed to get the context\n"); | |
2368 | err = PTR_ERR(vpfe->alloc_ctx); | |
2369 | goto probe_out; | |
2370 | } | |
2371 | ||
2372 | q = &vpfe->buffer_queue; | |
2373 | q->type = V4L2_BUF_TYPE_VIDEO_CAPTURE; | |
2374 | q->io_modes = VB2_MMAP | VB2_DMABUF | VB2_READ; | |
2375 | q->drv_priv = vpfe; | |
2376 | q->ops = &vpfe_video_qops; | |
2377 | q->mem_ops = &vb2_dma_contig_memops; | |
2378 | q->buf_struct_size = sizeof(struct vpfe_cap_buffer); | |
2379 | q->timestamp_flags = V4L2_BUF_FLAG_TIMESTAMP_MONOTONIC; | |
2380 | q->lock = &vpfe->lock; | |
2381 | q->min_buffers_needed = 1; | |
2382 | ||
2383 | err = vb2_queue_init(q); | |
2384 | if (err) { | |
2385 | vpfe_err(vpfe, "vb2_queue_init() failed\n"); | |
2386 | vb2_dma_contig_cleanup_ctx(vpfe->alloc_ctx); | |
2387 | goto probe_out; | |
2388 | } | |
2389 | ||
2390 | INIT_LIST_HEAD(&vpfe->dma_queue); | |
2391 | ||
2392 | vdev = vpfe->video_dev; | |
2393 | strlcpy(vdev->name, VPFE_MODULE_NAME, sizeof(vdev->name)); | |
2394 | vdev->release = video_device_release; | |
2395 | vdev->fops = &vpfe_fops; | |
2396 | vdev->ioctl_ops = &vpfe_ioctl_ops; | |
2397 | vdev->v4l2_dev = &vpfe->v4l2_dev; | |
2398 | vdev->vfl_dir = VFL_DIR_RX; | |
2399 | vdev->queue = q; | |
2400 | vdev->lock = &vpfe->lock; | |
2401 | video_set_drvdata(vdev, vpfe); | |
2402 | err = video_register_device(vpfe->video_dev, VFL_TYPE_GRABBER, -1); | |
2403 | if (err) { | |
2404 | vpfe_err(vpfe, | |
2405 | "Unable to register video device.\n"); | |
2406 | goto probe_out; | |
2407 | } | |
2408 | ||
2409 | return 0; | |
2410 | ||
2411 | probe_out: | |
2412 | v4l2_device_unregister(&vpfe->v4l2_dev); | |
2413 | return err; | |
2414 | } | |
2415 | ||
2416 | static int vpfe_async_complete(struct v4l2_async_notifier *notifier) | |
2417 | { | |
2418 | struct vpfe_device *vpfe = container_of(notifier->v4l2_dev, | |
2419 | struct vpfe_device, v4l2_dev); | |
2420 | ||
2421 | return vpfe_probe_complete(vpfe); | |
2422 | } | |
2423 | ||
2424 | static struct vpfe_config * | |
2425 | vpfe_get_pdata(struct platform_device *pdev) | |
2426 | { | |
ee662d44 | 2427 | struct device_node *endpoint = NULL; |
417d2e50 BP |
2428 | struct v4l2_of_endpoint bus_cfg; |
2429 | struct vpfe_subdev_info *sdinfo; | |
2430 | struct vpfe_config *pdata; | |
2431 | unsigned int flags; | |
2432 | unsigned int i; | |
2433 | int err; | |
2434 | ||
2435 | dev_dbg(&pdev->dev, "vpfe_get_pdata\n"); | |
2436 | ||
2437 | if (!IS_ENABLED(CONFIG_OF) || !pdev->dev.of_node) | |
2438 | return pdev->dev.platform_data; | |
2439 | ||
2440 | pdata = devm_kzalloc(&pdev->dev, sizeof(*pdata), GFP_KERNEL); | |
2441 | if (!pdata) | |
2442 | return NULL; | |
2443 | ||
2444 | for (i = 0; ; i++) { | |
ee662d44 LP |
2445 | struct device_node *rem; |
2446 | ||
417d2e50 BP |
2447 | endpoint = of_graph_get_next_endpoint(pdev->dev.of_node, |
2448 | endpoint); | |
2449 | if (!endpoint) | |
2450 | break; | |
2451 | ||
2452 | sdinfo = &pdata->sub_devs[i]; | |
2453 | sdinfo->grp_id = 0; | |
2454 | ||
2455 | /* we only support camera */ | |
2456 | sdinfo->inputs[0].index = i; | |
2457 | strcpy(sdinfo->inputs[0].name, "Camera"); | |
2458 | sdinfo->inputs[0].type = V4L2_INPUT_TYPE_CAMERA; | |
2459 | sdinfo->inputs[0].std = V4L2_STD_ALL; | |
2460 | sdinfo->inputs[0].capabilities = V4L2_IN_CAP_STD; | |
2461 | ||
2462 | sdinfo->can_route = 0; | |
2463 | sdinfo->routes = NULL; | |
2464 | ||
2465 | of_property_read_u32(endpoint, "ti,am437x-vpfe-interface", | |
2466 | &sdinfo->vpfe_param.if_type); | |
2467 | if (sdinfo->vpfe_param.if_type < 0 || | |
2468 | sdinfo->vpfe_param.if_type > 4) { | |
2469 | sdinfo->vpfe_param.if_type = VPFE_RAW_BAYER; | |
2470 | } | |
2471 | ||
2472 | err = v4l2_of_parse_endpoint(endpoint, &bus_cfg); | |
2473 | if (err) { | |
2474 | dev_err(&pdev->dev, "Could not parse the endpoint\n"); | |
2475 | goto done; | |
2476 | } | |
2477 | ||
2478 | sdinfo->vpfe_param.bus_width = bus_cfg.bus.parallel.bus_width; | |
2479 | ||
2480 | if (sdinfo->vpfe_param.bus_width < 8 || | |
2481 | sdinfo->vpfe_param.bus_width > 16) { | |
2482 | dev_err(&pdev->dev, "Invalid bus width.\n"); | |
2483 | goto done; | |
2484 | } | |
2485 | ||
2486 | flags = bus_cfg.bus.parallel.flags; | |
2487 | ||
2488 | if (flags & V4L2_MBUS_HSYNC_ACTIVE_HIGH) | |
2489 | sdinfo->vpfe_param.hdpol = 1; | |
2490 | ||
2491 | if (flags & V4L2_MBUS_VSYNC_ACTIVE_HIGH) | |
2492 | sdinfo->vpfe_param.vdpol = 1; | |
2493 | ||
2494 | rem = of_graph_get_remote_port_parent(endpoint); | |
2495 | if (!rem) { | |
2496 | dev_err(&pdev->dev, "Remote device at %s not found\n", | |
2497 | endpoint->full_name); | |
2498 | goto done; | |
2499 | } | |
2500 | ||
417d2e50 BP |
2501 | pdata->asd[i] = devm_kzalloc(&pdev->dev, |
2502 | sizeof(struct v4l2_async_subdev), | |
2503 | GFP_KERNEL); | |
7d87db3d LP |
2504 | if (!pdata->asd[i]) { |
2505 | of_node_put(rem); | |
2506 | pdata = NULL; | |
2507 | goto done; | |
2508 | } | |
2509 | ||
417d2e50 BP |
2510 | pdata->asd[i]->match_type = V4L2_ASYNC_MATCH_OF; |
2511 | pdata->asd[i]->match.of.node = rem; | |
2512 | of_node_put(endpoint); | |
2513 | of_node_put(rem); | |
2514 | } | |
2515 | ||
2516 | of_node_put(endpoint); | |
2517 | return pdata; | |
2518 | ||
2519 | done: | |
2520 | of_node_put(endpoint); | |
417d2e50 BP |
2521 | return NULL; |
2522 | } | |
2523 | ||
2524 | /* | |
2525 | * vpfe_probe : This function creates device entries by register | |
2526 | * itself to the V4L2 driver and initializes fields of each | |
2527 | * device objects | |
2528 | */ | |
2529 | static int vpfe_probe(struct platform_device *pdev) | |
2530 | { | |
2531 | struct vpfe_config *vpfe_cfg = vpfe_get_pdata(pdev); | |
2532 | struct vpfe_device *vpfe; | |
2533 | struct vpfe_ccdc *ccdc; | |
2534 | struct resource *res; | |
2535 | int ret; | |
2536 | ||
2537 | if (!vpfe_cfg) { | |
2538 | dev_err(&pdev->dev, "No platform data\n"); | |
2539 | return -EINVAL; | |
2540 | } | |
2541 | ||
2542 | vpfe = devm_kzalloc(&pdev->dev, sizeof(*vpfe), GFP_KERNEL); | |
2543 | if (!vpfe) | |
2544 | return -ENOMEM; | |
2545 | ||
2546 | vpfe->pdev = &pdev->dev; | |
2547 | vpfe->cfg = vpfe_cfg; | |
2548 | ccdc = &vpfe->ccdc; | |
2549 | ||
2550 | res = platform_get_resource(pdev, IORESOURCE_MEM, 0); | |
2551 | ccdc->ccdc_cfg.base_addr = devm_ioremap_resource(&pdev->dev, res); | |
2552 | if (IS_ERR(ccdc->ccdc_cfg.base_addr)) | |
2553 | return PTR_ERR(ccdc->ccdc_cfg.base_addr); | |
2554 | ||
2555 | vpfe->irq = platform_get_irq(pdev, 0); | |
2556 | if (vpfe->irq <= 0) { | |
2557 | dev_err(&pdev->dev, "No IRQ resource\n"); | |
2558 | return -ENODEV; | |
2559 | } | |
2560 | ||
2561 | ret = devm_request_irq(vpfe->pdev, vpfe->irq, vpfe_isr, 0, | |
2562 | "vpfe_capture0", vpfe); | |
2563 | if (ret) { | |
2564 | dev_err(&pdev->dev, "Unable to request interrupt\n"); | |
2565 | return -EINVAL; | |
2566 | } | |
2567 | ||
2568 | vpfe->video_dev = video_device_alloc(); | |
2569 | if (!vpfe->video_dev) { | |
2570 | dev_err(&pdev->dev, "Unable to allocate video device\n"); | |
2571 | return -ENOMEM; | |
2572 | } | |
2573 | ||
2574 | ret = v4l2_device_register(&pdev->dev, &vpfe->v4l2_dev); | |
2575 | if (ret) { | |
2576 | vpfe_err(vpfe, | |
2577 | "Unable to register v4l2 device.\n"); | |
2578 | goto probe_out_video_release; | |
2579 | } | |
2580 | ||
2581 | /* set the driver data in platform device */ | |
2582 | platform_set_drvdata(pdev, vpfe); | |
2583 | /* Enabling module functional clock */ | |
2584 | pm_runtime_enable(&pdev->dev); | |
2585 | ||
2586 | /* for now just enable it here instead of waiting for the open */ | |
2587 | pm_runtime_get_sync(&pdev->dev); | |
2588 | ||
2589 | vpfe_ccdc_config_defaults(ccdc); | |
2590 | ||
2591 | pm_runtime_put_sync(&pdev->dev); | |
2592 | ||
2593 | vpfe->sd = devm_kzalloc(&pdev->dev, sizeof(struct v4l2_subdev *) * | |
2594 | ARRAY_SIZE(vpfe->cfg->asd), GFP_KERNEL); | |
2595 | if (!vpfe->sd) { | |
2596 | ret = -ENOMEM; | |
2597 | goto probe_out_v4l2_unregister; | |
2598 | } | |
2599 | ||
2600 | vpfe->notifier.subdevs = vpfe->cfg->asd; | |
2601 | vpfe->notifier.num_subdevs = ARRAY_SIZE(vpfe->cfg->asd); | |
2602 | vpfe->notifier.bound = vpfe_async_bound; | |
2603 | vpfe->notifier.complete = vpfe_async_complete; | |
2604 | ret = v4l2_async_notifier_register(&vpfe->v4l2_dev, | |
2605 | &vpfe->notifier); | |
2606 | if (ret) { | |
2607 | vpfe_err(vpfe, "Error registering async notifier\n"); | |
2608 | ret = -EINVAL; | |
2609 | goto probe_out_v4l2_unregister; | |
2610 | } | |
2611 | ||
2612 | return 0; | |
2613 | ||
2614 | probe_out_v4l2_unregister: | |
2615 | v4l2_device_unregister(&vpfe->v4l2_dev); | |
2616 | probe_out_video_release: | |
2617 | if (!video_is_registered(vpfe->video_dev)) | |
2618 | video_device_release(vpfe->video_dev); | |
2619 | return ret; | |
2620 | } | |
2621 | ||
2622 | /* | |
2623 | * vpfe_remove : It un-register device from V4L2 driver | |
2624 | */ | |
2625 | static int vpfe_remove(struct platform_device *pdev) | |
2626 | { | |
2627 | struct vpfe_device *vpfe = platform_get_drvdata(pdev); | |
2628 | ||
2629 | vpfe_dbg(2, vpfe, "vpfe_remove\n"); | |
2630 | ||
2631 | pm_runtime_disable(&pdev->dev); | |
2632 | ||
2633 | v4l2_async_notifier_unregister(&vpfe->notifier); | |
2634 | v4l2_device_unregister(&vpfe->v4l2_dev); | |
2635 | video_unregister_device(vpfe->video_dev); | |
2636 | ||
2637 | return 0; | |
2638 | } | |
2639 | ||
2640 | #ifdef CONFIG_PM_SLEEP | |
2641 | ||
2642 | static void vpfe_save_context(struct vpfe_ccdc *ccdc) | |
2643 | { | |
2644 | ccdc->ccdc_ctx[VPFE_PCR >> 2] = vpfe_reg_read(ccdc, VPFE_PCR); | |
2645 | ccdc->ccdc_ctx[VPFE_SYNMODE >> 2] = vpfe_reg_read(ccdc, VPFE_SYNMODE); | |
2646 | ccdc->ccdc_ctx[VPFE_SDOFST >> 2] = vpfe_reg_read(ccdc, VPFE_SDOFST); | |
2647 | ccdc->ccdc_ctx[VPFE_SDR_ADDR >> 2] = vpfe_reg_read(ccdc, VPFE_SDR_ADDR); | |
2648 | ccdc->ccdc_ctx[VPFE_CLAMP >> 2] = vpfe_reg_read(ccdc, VPFE_CLAMP); | |
2649 | ccdc->ccdc_ctx[VPFE_DCSUB >> 2] = vpfe_reg_read(ccdc, VPFE_DCSUB); | |
2650 | ccdc->ccdc_ctx[VPFE_COLPTN >> 2] = vpfe_reg_read(ccdc, VPFE_COLPTN); | |
2651 | ccdc->ccdc_ctx[VPFE_BLKCMP >> 2] = vpfe_reg_read(ccdc, VPFE_BLKCMP); | |
2652 | ccdc->ccdc_ctx[VPFE_VDINT >> 2] = vpfe_reg_read(ccdc, VPFE_VDINT); | |
2653 | ccdc->ccdc_ctx[VPFE_ALAW >> 2] = vpfe_reg_read(ccdc, VPFE_ALAW); | |
2654 | ccdc->ccdc_ctx[VPFE_REC656IF >> 2] = vpfe_reg_read(ccdc, VPFE_REC656IF); | |
2655 | ccdc->ccdc_ctx[VPFE_CCDCFG >> 2] = vpfe_reg_read(ccdc, VPFE_CCDCFG); | |
2656 | ccdc->ccdc_ctx[VPFE_CULLING >> 2] = vpfe_reg_read(ccdc, VPFE_CULLING); | |
2657 | ccdc->ccdc_ctx[VPFE_HD_VD_WID >> 2] = vpfe_reg_read(ccdc, | |
2658 | VPFE_HD_VD_WID); | |
2659 | ccdc->ccdc_ctx[VPFE_PIX_LINES >> 2] = vpfe_reg_read(ccdc, | |
2660 | VPFE_PIX_LINES); | |
2661 | ccdc->ccdc_ctx[VPFE_HORZ_INFO >> 2] = vpfe_reg_read(ccdc, | |
2662 | VPFE_HORZ_INFO); | |
2663 | ccdc->ccdc_ctx[VPFE_VERT_START >> 2] = vpfe_reg_read(ccdc, | |
2664 | VPFE_VERT_START); | |
2665 | ccdc->ccdc_ctx[VPFE_VERT_LINES >> 2] = vpfe_reg_read(ccdc, | |
2666 | VPFE_VERT_LINES); | |
2667 | ccdc->ccdc_ctx[VPFE_HSIZE_OFF >> 2] = vpfe_reg_read(ccdc, | |
2668 | VPFE_HSIZE_OFF); | |
2669 | } | |
2670 | ||
2671 | static int vpfe_suspend(struct device *dev) | |
2672 | { | |
2673 | struct platform_device *pdev = to_platform_device(dev); | |
2674 | struct vpfe_device *vpfe = platform_get_drvdata(pdev); | |
2675 | struct vpfe_ccdc *ccdc = &vpfe->ccdc; | |
2676 | ||
2677 | /* if streaming has not started we don't care */ | |
2678 | if (!vb2_start_streaming_called(&vpfe->buffer_queue)) | |
2679 | return 0; | |
2680 | ||
2681 | pm_runtime_get_sync(dev); | |
2682 | vpfe_config_enable(ccdc, 1); | |
2683 | ||
2684 | /* Save VPFE context */ | |
2685 | vpfe_save_context(ccdc); | |
2686 | ||
2687 | /* Disable CCDC */ | |
2688 | vpfe_pcr_enable(ccdc, 0); | |
2689 | vpfe_config_enable(ccdc, 0); | |
2690 | ||
2691 | /* Disable both master and slave clock */ | |
2692 | pm_runtime_put_sync(dev); | |
2693 | ||
2694 | /* Select sleep pin state */ | |
2695 | pinctrl_pm_select_sleep_state(dev); | |
2696 | ||
2697 | return 0; | |
2698 | } | |
2699 | ||
2700 | static void vpfe_restore_context(struct vpfe_ccdc *ccdc) | |
2701 | { | |
2702 | vpfe_reg_write(ccdc, ccdc->ccdc_ctx[VPFE_SYNMODE >> 2], VPFE_SYNMODE); | |
2703 | vpfe_reg_write(ccdc, ccdc->ccdc_ctx[VPFE_CULLING >> 2], VPFE_CULLING); | |
2704 | vpfe_reg_write(ccdc, ccdc->ccdc_ctx[VPFE_SDOFST >> 2], VPFE_SDOFST); | |
2705 | vpfe_reg_write(ccdc, ccdc->ccdc_ctx[VPFE_SDR_ADDR >> 2], VPFE_SDR_ADDR); | |
2706 | vpfe_reg_write(ccdc, ccdc->ccdc_ctx[VPFE_CLAMP >> 2], VPFE_CLAMP); | |
2707 | vpfe_reg_write(ccdc, ccdc->ccdc_ctx[VPFE_DCSUB >> 2], VPFE_DCSUB); | |
2708 | vpfe_reg_write(ccdc, ccdc->ccdc_ctx[VPFE_COLPTN >> 2], VPFE_COLPTN); | |
2709 | vpfe_reg_write(ccdc, ccdc->ccdc_ctx[VPFE_BLKCMP >> 2], VPFE_BLKCMP); | |
2710 | vpfe_reg_write(ccdc, ccdc->ccdc_ctx[VPFE_VDINT >> 2], VPFE_VDINT); | |
2711 | vpfe_reg_write(ccdc, ccdc->ccdc_ctx[VPFE_ALAW >> 2], VPFE_ALAW); | |
2712 | vpfe_reg_write(ccdc, ccdc->ccdc_ctx[VPFE_REC656IF >> 2], VPFE_REC656IF); | |
2713 | vpfe_reg_write(ccdc, ccdc->ccdc_ctx[VPFE_CCDCFG >> 2], VPFE_CCDCFG); | |
2714 | vpfe_reg_write(ccdc, ccdc->ccdc_ctx[VPFE_PCR >> 2], VPFE_PCR); | |
2715 | vpfe_reg_write(ccdc, ccdc->ccdc_ctx[VPFE_HD_VD_WID >> 2], | |
2716 | VPFE_HD_VD_WID); | |
2717 | vpfe_reg_write(ccdc, ccdc->ccdc_ctx[VPFE_PIX_LINES >> 2], | |
2718 | VPFE_PIX_LINES); | |
2719 | vpfe_reg_write(ccdc, ccdc->ccdc_ctx[VPFE_HORZ_INFO >> 2], | |
2720 | VPFE_HORZ_INFO); | |
2721 | vpfe_reg_write(ccdc, ccdc->ccdc_ctx[VPFE_VERT_START >> 2], | |
2722 | VPFE_VERT_START); | |
2723 | vpfe_reg_write(ccdc, ccdc->ccdc_ctx[VPFE_VERT_LINES >> 2], | |
2724 | VPFE_VERT_LINES); | |
2725 | vpfe_reg_write(ccdc, ccdc->ccdc_ctx[VPFE_HSIZE_OFF >> 2], | |
2726 | VPFE_HSIZE_OFF); | |
2727 | } | |
2728 | ||
2729 | static int vpfe_resume(struct device *dev) | |
2730 | { | |
2731 | struct platform_device *pdev = to_platform_device(dev); | |
2732 | struct vpfe_device *vpfe = platform_get_drvdata(pdev); | |
2733 | struct vpfe_ccdc *ccdc = &vpfe->ccdc; | |
2734 | ||
2735 | /* if streaming has not started we don't care */ | |
2736 | if (!vb2_start_streaming_called(&vpfe->buffer_queue)) | |
2737 | return 0; | |
2738 | ||
2739 | /* Enable both master and slave clock */ | |
2740 | pm_runtime_get_sync(dev); | |
2741 | vpfe_config_enable(ccdc, 1); | |
2742 | ||
2743 | /* Restore VPFE context */ | |
2744 | vpfe_restore_context(ccdc); | |
2745 | ||
2746 | vpfe_config_enable(ccdc, 0); | |
2747 | pm_runtime_put_sync(dev); | |
2748 | ||
2749 | /* Select default pin state */ | |
2750 | pinctrl_pm_select_default_state(dev); | |
2751 | ||
2752 | return 0; | |
2753 | } | |
2754 | ||
2755 | #endif | |
2756 | ||
2757 | static SIMPLE_DEV_PM_OPS(vpfe_pm_ops, vpfe_suspend, vpfe_resume); | |
2758 | ||
2759 | static const struct of_device_id vpfe_of_match[] = { | |
2760 | { .compatible = "ti,am437x-vpfe", }, | |
2761 | { /* sentinel */ }, | |
2762 | }; | |
2763 | MODULE_DEVICE_TABLE(of, vpfe_of_match); | |
2764 | ||
2765 | static struct platform_driver vpfe_driver = { | |
2766 | .probe = vpfe_probe, | |
2767 | .remove = vpfe_remove, | |
2768 | .driver = { | |
2769 | .name = VPFE_MODULE_NAME, | |
417d2e50 BP |
2770 | .pm = &vpfe_pm_ops, |
2771 | .of_match_table = of_match_ptr(vpfe_of_match), | |
2772 | }, | |
2773 | }; | |
2774 | ||
2775 | module_platform_driver(vpfe_driver); | |
2776 | ||
2777 | MODULE_AUTHOR("Texas Instruments"); | |
2778 | MODULE_DESCRIPTION("TI AM437x VPFE driver"); | |
2779 | MODULE_LICENSE("GPL"); | |
2780 | MODULE_VERSION(VPFE_VERSION); |