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 46static int debug; 47module_param(debug, int, 0644); 48MODULE_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 */ 58struct 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 66static const struct vpfe_standard vpfe_standards[] = { 67 {V4L2_STD_525_60, 720, 480, {11, 10}, 1}, 68 {V4L2_STD_625_50, 720, 576, {54, 59}, 1}, 69}; 70 71struct 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 */ 87struct 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 97static 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 191static int 192__vpfe_get_format(struct vpfe_device *vpfe, 193 struct v4l2_format *format, unsigned int *bpp); 194 195static 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 209static 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 223static void 224mbus_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 249static 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) */ 268static 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 281static int 282cmp_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 294static inline u32 vpfe_reg_read(struct vpfe_ccdc *ccdc, u32 offset) 295{ 296 return ioread32(ccdc->ccdc_cfg.base_addr + offset); 297} 298 299static 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 304static inline struct vpfe_device *to_vpfe(struct vpfe_ccdc *ccdc) 305{ 306 return container_of(ccdc, struct vpfe_device, ccdc); 307} 308 309static 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 314static inline void vpfe_pcr_enable(struct vpfe_ccdc *ccdc, int flag) 315{ 316 vpfe_reg_write(ccdc, !!flag, VPFE_PCR); 317} 318 319static 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 333static 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 381static 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 403static int 404vpfe_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 426static void 427vpfe_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 */ 440static 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 455static 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 494static 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 */ 523static 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 603static void 604vpfe_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 632static void 633vpfe_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 */ 652static 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 739static inline int 740vpfe_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 751static 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 759static 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 808static 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 824static int 825vpfe_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 841static inline void 842vpfe_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 851static 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 859static inline int 860vpfe_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 871static inline enum ccdc_frmfmt 872vpfe_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 880static inline int vpfe_ccdc_getfid(struct vpfe_ccdc *ccdc) 881{ 882 return (vpfe_reg_read(ccdc, VPFE_SYNMODE) >> 15) & 1; 883} 884 885static 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 890static 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 928static 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 972static 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 */ 1008static 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 1045static 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 */ 1103static 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 1152static 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 */ 1185static int vpfe_release(struct file *file) 1186{ 1187 struct vpfe_device *vpfe = video_drvdata(file); 1188 bool fh_singular; 1189 int ret; 1190 1191 mutex_lock(&vpfe->lock); 1192 1193 /* Save the singular status before we call the clean-up helper */ 1194 fh_singular = v4l2_fh_is_singular_file(file); 1195 1196 /* the release helper will cleanup any on-going streaming */ 1197 ret = _vb2_fop_release(file, NULL); 1198 1199 /* 1200 * If this was the last open file. 1201 * Then de-initialize hw module. 1202 */ 1203 if (fh_singular) 1204 vpfe_ccdc_close(&vpfe->ccdc, vpfe->pdev); 1205 1206 mutex_unlock(&vpfe->lock); 1207 1208 return ret; 1209} 1210 1211/* 1212 * vpfe_open : This function is based on the v4l2_fh_open helper function. 1213 * It has been augmented to handle module power management, 1214 * by disabling/enabling h/w module fcntl clock when necessary. 1215 */ 1216static int vpfe_open(struct file *file) 1217{ 1218 struct vpfe_device *vpfe = video_drvdata(file); 1219 int ret; 1220 1221 mutex_lock(&vpfe->lock); 1222 1223 ret = v4l2_fh_open(file); 1224 if (ret) { 1225 vpfe_err(vpfe, "v4l2_fh_open failed\n"); 1226 goto unlock; 1227 } 1228 1229 if (!v4l2_fh_is_singular_file(file)) 1230 goto unlock; 1231 1232 if (vpfe_initialize_device(vpfe)) { 1233 v4l2_fh_release(file); 1234 ret = -ENODEV; 1235 } 1236 1237unlock: 1238 mutex_unlock(&vpfe->lock); 1239 return ret; 1240} 1241 1242/** 1243 * vpfe_schedule_next_buffer: set next buffer address for capture 1244 * @vpfe : ptr to vpfe device 1245 * 1246 * This function will get next buffer from the dma queue and 1247 * set the buffer address in the vpfe register for capture. 1248 * the buffer is marked active 1249 * 1250 * Assumes caller is holding vpfe->dma_queue_lock already 1251 */ 1252static inline void vpfe_schedule_next_buffer(struct vpfe_device *vpfe) 1253{ 1254 vpfe->next_frm = list_entry(vpfe->dma_queue.next, 1255 struct vpfe_cap_buffer, list); 1256 list_del(&vpfe->next_frm->list); 1257 1258 vpfe_set_sdr_addr(&vpfe->ccdc, 1259 vb2_dma_contig_plane_dma_addr(&vpfe->next_frm->vb, 0)); 1260} 1261 1262static inline void vpfe_schedule_bottom_field(struct vpfe_device *vpfe) 1263{ 1264 unsigned long addr; 1265 1266 addr = vb2_dma_contig_plane_dma_addr(&vpfe->next_frm->vb, 0) + 1267 vpfe->field_off; 1268 1269 vpfe_set_sdr_addr(&vpfe->ccdc, addr); 1270} 1271 1272/* 1273 * vpfe_process_buffer_complete: process a completed buffer 1274 * @vpfe : ptr to vpfe device 1275 * 1276 * This function time stamp the buffer and mark it as DONE. It also 1277 * wake up any process waiting on the QUEUE and set the next buffer 1278 * as current 1279 */ 1280static inline void vpfe_process_buffer_complete(struct vpfe_device *vpfe) 1281{ 1282 v4l2_get_timestamp(&vpfe->cur_frm->vb.v4l2_buf.timestamp); 1283 vpfe->cur_frm->vb.v4l2_buf.field = vpfe->fmt.fmt.pix.field; 1284 vpfe->cur_frm->vb.v4l2_buf.sequence = vpfe->sequence++; 1285 vb2_buffer_done(&vpfe->cur_frm->vb, VB2_BUF_STATE_DONE); 1286 vpfe->cur_frm = vpfe->next_frm; 1287} 1288 1289/* 1290 * vpfe_isr : ISR handler for vpfe capture (VINT0) 1291 * @irq: irq number 1292 * @dev_id: dev_id ptr 1293 * 1294 * It changes status of the captured buffer, takes next buffer from the queue 1295 * and sets its address in VPFE registers 1296 */ 1297static irqreturn_t vpfe_isr(int irq, void *dev) 1298{ 1299 struct vpfe_device *vpfe = (struct vpfe_device *)dev; 1300 enum v4l2_field field; 1301 int intr_status; 1302 int fid; 1303 1304 intr_status = vpfe_reg_read(&vpfe->ccdc, VPFE_IRQ_STS); 1305 1306 if (intr_status & VPFE_VDINT0) { 1307 field = vpfe->fmt.fmt.pix.field; 1308 1309 if (field == V4L2_FIELD_NONE) { 1310 /* handle progressive frame capture */ 1311 if (vpfe->cur_frm != vpfe->next_frm) 1312 vpfe_process_buffer_complete(vpfe); 1313 goto next_intr; 1314 } 1315 1316 /* interlaced or TB capture check which field 1317 we are in hardware */ 1318 fid = vpfe_ccdc_getfid(&vpfe->ccdc); 1319 1320 /* switch the software maintained field id */ 1321 vpfe->field ^= 1; 1322 if (fid == vpfe->field) { 1323 /* we are in-sync here,continue */ 1324 if (fid == 0) { 1325 /* 1326 * One frame is just being captured. If the 1327 * next frame is available, release the 1328 * current frame and move on 1329 */ 1330 if (vpfe->cur_frm != vpfe->next_frm) 1331 vpfe_process_buffer_complete(vpfe); 1332 /* 1333 * based on whether the two fields are stored 1334 * interleave or separately in memory, 1335 * reconfigure the CCDC memory address 1336 */ 1337 if (field == V4L2_FIELD_SEQ_TB) 1338 vpfe_schedule_bottom_field(vpfe); 1339 1340 goto next_intr; 1341 } 1342 /* 1343 * if one field is just being captured configure 1344 * the next frame get the next frame from the empty 1345 * queue if no frame is available hold on to the 1346 * current buffer 1347 */ 1348 spin_lock(&vpfe->dma_queue_lock); 1349 if (!list_empty(&vpfe->dma_queue) && 1350 vpfe->cur_frm == vpfe->next_frm) 1351 vpfe_schedule_next_buffer(vpfe); 1352 spin_unlock(&vpfe->dma_queue_lock); 1353 } else if (fid == 0) { 1354 /* 1355 * out of sync. Recover from any hardware out-of-sync. 1356 * May loose one frame 1357 */ 1358 vpfe->field = fid; 1359 } 1360 } 1361 1362next_intr: 1363 if (intr_status & VPFE_VDINT1) { 1364 spin_lock(&vpfe->dma_queue_lock); 1365 if (vpfe->fmt.fmt.pix.field == V4L2_FIELD_NONE && 1366 !list_empty(&vpfe->dma_queue) && 1367 vpfe->cur_frm == vpfe->next_frm) 1368 vpfe_schedule_next_buffer(vpfe); 1369 spin_unlock(&vpfe->dma_queue_lock); 1370 } 1371 1372 vpfe_clear_intr(&vpfe->ccdc, intr_status); 1373 1374 return IRQ_HANDLED; 1375} 1376 1377static inline void vpfe_detach_irq(struct vpfe_device *vpfe) 1378{ 1379 unsigned int intr = VPFE_VDINT0; 1380 enum ccdc_frmfmt frame_format; 1381 1382 frame_format = vpfe_ccdc_get_frame_format(&vpfe->ccdc); 1383 if (frame_format == CCDC_FRMFMT_PROGRESSIVE) 1384 intr |= VPFE_VDINT1; 1385 1386 vpfe_reg_write(&vpfe->ccdc, intr, VPFE_IRQ_EN_CLR); 1387} 1388 1389static inline void vpfe_attach_irq(struct vpfe_device *vpfe) 1390{ 1391 unsigned int intr = VPFE_VDINT0; 1392 enum ccdc_frmfmt frame_format; 1393 1394 frame_format = vpfe_ccdc_get_frame_format(&vpfe->ccdc); 1395 if (frame_format == CCDC_FRMFMT_PROGRESSIVE) 1396 intr |= VPFE_VDINT1; 1397 1398 vpfe_reg_write(&vpfe->ccdc, intr, VPFE_IRQ_EN_SET); 1399} 1400 1401static int vpfe_querycap(struct file *file, void *priv, 1402 struct v4l2_capability *cap) 1403{ 1404 struct vpfe_device *vpfe = video_drvdata(file); 1405 1406 vpfe_dbg(2, vpfe, "vpfe_querycap\n"); 1407 1408 strlcpy(cap->driver, VPFE_MODULE_NAME, sizeof(cap->driver)); 1409 strlcpy(cap->card, "TI AM437x VPFE", sizeof(cap->card)); 1410 snprintf(cap->bus_info, sizeof(cap->bus_info), 1411 "platform:%s", vpfe->v4l2_dev.name); 1412 cap->device_caps = V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_STREAMING | 1413 V4L2_CAP_READWRITE; 1414 cap->capabilities = cap->device_caps | V4L2_CAP_DEVICE_CAPS; 1415 1416 return 0; 1417} 1418 1419/* get the format set at output pad of the adjacent subdev */ 1420static int __vpfe_get_format(struct vpfe_device *vpfe, 1421 struct v4l2_format *format, unsigned int *bpp) 1422{ 1423 struct v4l2_mbus_framefmt mbus_fmt; 1424 struct vpfe_subdev_info *sdinfo; 1425 struct v4l2_subdev_format fmt; 1426 int ret; 1427 1428 sdinfo = vpfe->current_subdev; 1429 if (!sdinfo->sd) 1430 return -EINVAL; 1431 1432 fmt.which = V4L2_SUBDEV_FORMAT_ACTIVE; 1433 fmt.pad = 0; 1434 1435 ret = v4l2_subdev_call(sdinfo->sd, pad, get_fmt, NULL, &fmt); 1436 if (ret && ret != -ENOIOCTLCMD && ret != -ENODEV) 1437 return ret; 1438 1439 if (!ret) { 1440 v4l2_fill_pix_format(&format->fmt.pix, &fmt.format); 1441 mbus_to_pix(vpfe, &fmt.format, &format->fmt.pix, bpp); 1442 } else { 1443 ret = v4l2_device_call_until_err(&vpfe->v4l2_dev, 1444 sdinfo->grp_id, 1445 video, g_mbus_fmt, 1446 &mbus_fmt); 1447 if (ret && ret != -ENOIOCTLCMD && ret != -ENODEV) 1448 return ret; 1449 v4l2_fill_pix_format(&format->fmt.pix, &mbus_fmt); 1450 mbus_to_pix(vpfe, &mbus_fmt, &format->fmt.pix, bpp); 1451 } 1452 1453 format->type = vpfe->fmt.type; 1454 1455 vpfe_dbg(1, vpfe, 1456 "%s size %dx%d (%s) bytesperline = %d, size = %d, bpp = %d\n", 1457 __func__, format->fmt.pix.width, format->fmt.pix.height, 1458 print_fourcc(format->fmt.pix.pixelformat), 1459 format->fmt.pix.bytesperline, format->fmt.pix.sizeimage, *bpp); 1460 1461 return 0; 1462} 1463 1464/* set the format at output pad of the adjacent subdev */ 1465static int __vpfe_set_format(struct vpfe_device *vpfe, 1466 struct v4l2_format *format, unsigned int *bpp) 1467{ 1468 struct v4l2_mbus_framefmt mbus_fmt; 1469 struct vpfe_subdev_info *sdinfo; 1470 struct v4l2_subdev_format fmt; 1471 int ret; 1472 1473 vpfe_dbg(2, vpfe, "__vpfe_set_format\n"); 1474 1475 sdinfo = vpfe->current_subdev; 1476 if (!sdinfo->sd) 1477 return -EINVAL; 1478 1479 fmt.which = V4L2_SUBDEV_FORMAT_ACTIVE; 1480 fmt.pad = 0; 1481 1482 pix_to_mbus(vpfe, &format->fmt.pix, &fmt.format); 1483 1484 ret = v4l2_subdev_call(sdinfo->sd, pad, set_fmt, NULL, &fmt); 1485 if (ret && ret != -ENOIOCTLCMD && ret != -ENODEV) 1486 return ret; 1487 1488 if (!ret) { 1489 v4l2_fill_pix_format(&format->fmt.pix, &fmt.format); 1490 mbus_to_pix(vpfe, &fmt.format, &format->fmt.pix, bpp); 1491 } else { 1492 ret = v4l2_device_call_until_err(&vpfe->v4l2_dev, 1493 sdinfo->grp_id, 1494 video, s_mbus_fmt, 1495 &mbus_fmt); 1496 if (ret && ret != -ENOIOCTLCMD && ret != -ENODEV) 1497 return ret; 1498 1499 v4l2_fill_pix_format(&format->fmt.pix, &mbus_fmt); 1500 mbus_to_pix(vpfe, &mbus_fmt, &format->fmt.pix, bpp); 1501 } 1502 1503 format->type = vpfe->fmt.type; 1504 1505 vpfe_dbg(1, vpfe, 1506 "%s size %dx%d (%s) bytesperline = %d, size = %d, bpp = %d\n", 1507 __func__, format->fmt.pix.width, format->fmt.pix.height, 1508 print_fourcc(format->fmt.pix.pixelformat), 1509 format->fmt.pix.bytesperline, format->fmt.pix.sizeimage, *bpp); 1510 1511 return 0; 1512} 1513 1514static int vpfe_g_fmt(struct file *file, void *priv, 1515 struct v4l2_format *fmt) 1516{ 1517 struct vpfe_device *vpfe = video_drvdata(file); 1518 1519 vpfe_dbg(2, vpfe, "vpfe_g_fmt\n"); 1520 1521 *fmt = vpfe->fmt; 1522 1523 return 0; 1524} 1525 1526static int vpfe_enum_fmt(struct file *file, void *priv, 1527 struct v4l2_fmtdesc *f) 1528{ 1529 struct vpfe_device *vpfe = video_drvdata(file); 1530 struct vpfe_subdev_info *sdinfo; 1531 struct vpfe_fmt *fmt = NULL; 1532 unsigned int k; 1533 1534 vpfe_dbg(2, vpfe, "vpfe_enum_format index:%d\n", 1535 f->index); 1536 1537 sdinfo = vpfe->current_subdev; 1538 if (!sdinfo->sd) 1539 return -EINVAL; 1540 1541 if (f->index > ARRAY_SIZE(formats)) 1542 return -EINVAL; 1543 1544 for (k = 0; k < ARRAY_SIZE(formats); k++) { 1545 if (formats[k].index == f->index) { 1546 fmt = &formats[k]; 1547 break; 1548 } 1549 } 1550 if (!fmt) 1551 return -EINVAL; 1552 1553 strncpy(f->description, fmt->name, sizeof(f->description) - 1); 1554 f->pixelformat = fmt->fourcc; 1555 f->type = vpfe->fmt.type; 1556 1557 vpfe_dbg(1, vpfe, "vpfe_enum_format: mbus index: %d code: %x pixelformat: %s [%s]\n", 1558 f->index, fmt->code, print_fourcc(fmt->fourcc), fmt->name); 1559 1560 return 0; 1561} 1562 1563static int vpfe_try_fmt(struct file *file, void *priv, 1564 struct v4l2_format *fmt) 1565{ 1566 struct vpfe_device *vpfe = video_drvdata(file); 1567 unsigned int bpp; 1568 1569 vpfe_dbg(2, vpfe, "vpfe_try_fmt\n"); 1570 1571 return __vpfe_get_format(vpfe, fmt, &bpp); 1572} 1573 1574static int vpfe_s_fmt(struct file *file, void *priv, 1575 struct v4l2_format *fmt) 1576{ 1577 struct vpfe_device *vpfe = video_drvdata(file); 1578 struct v4l2_format format; 1579 unsigned int bpp; 1580 int ret; 1581 1582 vpfe_dbg(2, vpfe, "vpfe_s_fmt\n"); 1583 1584 /* If streaming is started, return error */ 1585 if (vb2_is_busy(&vpfe->buffer_queue)) { 1586 vpfe_err(vpfe, "%s device busy\n", __func__); 1587 return -EBUSY; 1588 } 1589 1590 ret = vpfe_try_fmt(file, priv, &format); 1591 if (ret) 1592 return ret; 1593 1594 1595 if (!cmp_v4l2_format(fmt, &format)) { 1596 /* Sensor format is different from the requested format 1597 * so we need to change it 1598 */ 1599 ret = __vpfe_set_format(vpfe, fmt, &bpp); 1600 if (ret) 1601 return ret; 1602 } else /* Just make sure all of the fields are consistent */ 1603 *fmt = format; 1604 1605 /* First detach any IRQ if currently attached */ 1606 vpfe_detach_irq(vpfe); 1607 vpfe->fmt = *fmt; 1608 vpfe->bpp = bpp; 1609 1610 /* Update the crop window based on found values */ 1611 vpfe->crop.width = fmt->fmt.pix.width; 1612 vpfe->crop.height = fmt->fmt.pix.height; 1613 1614 /* set image capture parameters in the ccdc */ 1615 return vpfe_config_ccdc_image_format(vpfe); 1616} 1617 1618static int vpfe_enum_size(struct file *file, void *priv, 1619 struct v4l2_frmsizeenum *fsize) 1620{ 1621 struct vpfe_device *vpfe = video_drvdata(file); 1622 struct v4l2_subdev_frame_size_enum fse; 1623 struct vpfe_subdev_info *sdinfo; 1624 struct v4l2_mbus_framefmt mbus; 1625 struct v4l2_pix_format pix; 1626 struct vpfe_fmt *fmt; 1627 int ret; 1628 1629 vpfe_dbg(2, vpfe, "vpfe_enum_size\n"); 1630 1631 /* check for valid format */ 1632 fmt = find_format_by_pix(fsize->pixel_format); 1633 if (!fmt) { 1634 vpfe_dbg(3, vpfe, "Invalid pixel code: %x, default used instead\n", 1635 fsize->pixel_format); 1636 return -EINVAL; 1637 } 1638 1639 memset(fsize->reserved, 0x0, sizeof(fsize->reserved)); 1640 1641 sdinfo = vpfe->current_subdev; 1642 if (!sdinfo->sd) 1643 return -EINVAL; 1644 1645 memset(&pix, 0x0, sizeof(pix)); 1646 /* Construct pix from parameter and use default for the rest */ 1647 pix.pixelformat = fsize->pixel_format; 1648 pix.width = 640; 1649 pix.height = 480; 1650 pix.colorspace = V4L2_COLORSPACE_SRGB; 1651 pix.field = V4L2_FIELD_NONE; 1652 pix_to_mbus(vpfe, &pix, &mbus); 1653 1654 memset(&fse, 0x0, sizeof(fse)); 1655 fse.index = fsize->index; 1656 fse.pad = 0; 1657 fse.code = mbus.code; 1658 fse.which = V4L2_SUBDEV_FORMAT_ACTIVE; 1659 ret = v4l2_subdev_call(sdinfo->sd, pad, enum_frame_size, NULL, &fse); 1660 if (ret) 1661 return -EINVAL; 1662 1663 vpfe_dbg(1, vpfe, "vpfe_enum_size: index: %d code: %x W:[%d,%d] H:[%d,%d]\n", 1664 fse.index, fse.code, fse.min_width, fse.max_width, 1665 fse.min_height, fse.max_height); 1666 1667 fsize->type = V4L2_FRMSIZE_TYPE_DISCRETE; 1668 fsize->discrete.width = fse.max_width; 1669 fsize->discrete.height = fse.max_height; 1670 1671 vpfe_dbg(1, vpfe, "vpfe_enum_size: index: %d pixformat: %s size: %dx%d\n", 1672 fsize->index, print_fourcc(fsize->pixel_format), 1673 fsize->discrete.width, fsize->discrete.height); 1674 1675 return 0; 1676} 1677 1678/* 1679 * vpfe_get_subdev_input_index - Get subdev index and subdev input index for a 1680 * given app input index 1681 */ 1682static int 1683vpfe_get_subdev_input_index(struct vpfe_device *vpfe, 1684 int *subdev_index, 1685 int *subdev_input_index, 1686 int app_input_index) 1687{ 1688 struct vpfe_config *cfg = vpfe->cfg; 1689 struct vpfe_subdev_info *sdinfo; 1690 int i, j = 0; 1691 1692 for (i = 0; i < ARRAY_SIZE(vpfe->cfg->asd); i++) { 1693 sdinfo = &cfg->sub_devs[i]; 1694 if (app_input_index < (j + 1)) { 1695 *subdev_index = i; 1696 *subdev_input_index = app_input_index - j; 1697 return 0; 1698 } 1699 j++; 1700 } 1701 return -EINVAL; 1702} 1703 1704/* 1705 * vpfe_get_app_input - Get app input index for a given subdev input index 1706 * driver stores the input index of the current sub device and translate it 1707 * when application request the current input 1708 */ 1709static int vpfe_get_app_input_index(struct vpfe_device *vpfe, 1710 int *app_input_index) 1711{ 1712 struct vpfe_config *cfg = vpfe->cfg; 1713 struct vpfe_subdev_info *sdinfo; 1714 struct i2c_client *client; 1715 struct i2c_client *curr_client; 1716 int i, j = 0; 1717 1718 curr_client = v4l2_get_subdevdata(vpfe->current_subdev->sd); 1719 for (i = 0; i < ARRAY_SIZE(vpfe->cfg->asd); i++) { 1720 sdinfo = &cfg->sub_devs[i]; 1721 client = v4l2_get_subdevdata(sdinfo->sd); 1722 if (client->addr == curr_client->addr && 1723 client->adapter->nr == client->adapter->nr) { 1724 if (vpfe->current_input >= 1) 1725 return -1; 1726 *app_input_index = j + vpfe->current_input; 1727 return 0; 1728 } 1729 j++; 1730 } 1731 return -EINVAL; 1732} 1733 1734static int vpfe_enum_input(struct file *file, void *priv, 1735 struct v4l2_input *inp) 1736{ 1737 struct vpfe_device *vpfe = video_drvdata(file); 1738 struct vpfe_subdev_info *sdinfo; 1739 int subdev, index; 1740 1741 vpfe_dbg(2, vpfe, "vpfe_enum_input\n"); 1742 1743 if (vpfe_get_subdev_input_index(vpfe, &subdev, &index, 1744 inp->index) < 0) { 1745 vpfe_dbg(1, vpfe, 1746 "input information not found for the subdev\n"); 1747 return -EINVAL; 1748 } 1749 sdinfo = &vpfe->cfg->sub_devs[subdev]; 1750 *inp = sdinfo->inputs[index]; 1751 1752 return 0; 1753} 1754 1755static int vpfe_g_input(struct file *file, void *priv, unsigned int *index) 1756{ 1757 struct vpfe_device *vpfe = video_drvdata(file); 1758 1759 vpfe_dbg(2, vpfe, "vpfe_g_input\n"); 1760 1761 return vpfe_get_app_input_index(vpfe, index); 1762} 1763 1764/* Assumes caller is holding vpfe_dev->lock */ 1765static int vpfe_set_input(struct vpfe_device *vpfe, unsigned int index) 1766{ 1767 int subdev_index = 0, inp_index = 0; 1768 struct vpfe_subdev_info *sdinfo; 1769 struct vpfe_route *route; 1770 u32 input, output; 1771 int ret; 1772 1773 vpfe_dbg(2, vpfe, "vpfe_set_input: index: %d\n", index); 1774 1775 /* If streaming is started, return error */ 1776 if (vb2_is_busy(&vpfe->buffer_queue)) { 1777 vpfe_err(vpfe, "%s device busy\n", __func__); 1778 return -EBUSY; 1779 } 1780 ret = vpfe_get_subdev_input_index(vpfe, 1781 &subdev_index, 1782 &inp_index, 1783 index); 1784 if (ret < 0) { 1785 vpfe_err(vpfe, "invalid input index: %d\n", index); 1786 goto get_out; 1787 } 1788 1789 sdinfo = &vpfe->cfg->sub_devs[subdev_index]; 1790 sdinfo->sd = vpfe->sd[subdev_index]; 1791 route = &sdinfo->routes[inp_index]; 1792 if (route && sdinfo->can_route) { 1793 input = route->input; 1794 output = route->output; 1795 if (sdinfo->sd) { 1796 ret = v4l2_subdev_call(sdinfo->sd, video, 1797 s_routing, input, output, 0); 1798 if (ret) { 1799 vpfe_err(vpfe, "s_routing failed\n"); 1800 ret = -EINVAL; 1801 goto get_out; 1802 } 1803 } 1804 1805 } 1806 1807 vpfe->current_subdev = sdinfo; 1808 if (sdinfo->sd) 1809 vpfe->v4l2_dev.ctrl_handler = sdinfo->sd->ctrl_handler; 1810 vpfe->current_input = index; 1811 vpfe->std_index = 0; 1812 1813 /* set the bus/interface parameter for the sub device in ccdc */ 1814 ret = vpfe_ccdc_set_hw_if_params(&vpfe->ccdc, &sdinfo->vpfe_param); 1815 if (ret) 1816 return ret; 1817 1818 /* set the default image parameters in the device */ 1819 return vpfe_config_image_format(vpfe, 1820 vpfe_standards[vpfe->std_index].std_id); 1821 1822get_out: 1823 return ret; 1824} 1825 1826static int vpfe_s_input(struct file *file, void *priv, unsigned int index) 1827{ 1828 struct vpfe_device *vpfe = video_drvdata(file); 1829 1830 vpfe_dbg(2, vpfe, 1831 "vpfe_s_input: index: %d\n", index); 1832 1833 return vpfe_set_input(vpfe, index); 1834} 1835 1836static int vpfe_querystd(struct file *file, void *priv, v4l2_std_id *std_id) 1837{ 1838 struct vpfe_device *vpfe = video_drvdata(file); 1839 struct vpfe_subdev_info *sdinfo; 1840 1841 vpfe_dbg(2, vpfe, "vpfe_querystd\n"); 1842 1843 sdinfo = vpfe->current_subdev; 1844 if (!(sdinfo->inputs[0].capabilities & V4L2_IN_CAP_STD)) 1845 return -ENODATA; 1846 1847 /* Call querystd function of decoder device */ 1848 return v4l2_device_call_until_err(&vpfe->v4l2_dev, sdinfo->grp_id, 1849 video, querystd, std_id); 1850} 1851 1852static int vpfe_s_std(struct file *file, void *priv, v4l2_std_id std_id) 1853{ 1854 struct vpfe_device *vpfe = video_drvdata(file); 1855 struct vpfe_subdev_info *sdinfo; 1856 int ret; 1857 1858 vpfe_dbg(2, vpfe, "vpfe_s_std\n"); 1859 1860 sdinfo = vpfe->current_subdev; 1861 if (!(sdinfo->inputs[0].capabilities & V4L2_IN_CAP_STD)) 1862 return -ENODATA; 1863 1864 /* If streaming is started, return error */ 1865 if (vb2_is_busy(&vpfe->buffer_queue)) { 1866 vpfe_err(vpfe, "%s device busy\n", __func__); 1867 ret = -EBUSY; 1868 return ret; 1869 } 1870 1871 ret = v4l2_device_call_until_err(&vpfe->v4l2_dev, sdinfo->grp_id, 1872 video, s_std, std_id); 1873 if (ret < 0) { 1874 vpfe_err(vpfe, "Failed to set standard\n"); 1875 return ret; 1876 } 1877 ret = vpfe_config_image_format(vpfe, std_id); 1878 1879 return ret; 1880} 1881 1882static int vpfe_g_std(struct file *file, void *priv, v4l2_std_id *std_id) 1883{ 1884 struct vpfe_device *vpfe = video_drvdata(file); 1885 struct vpfe_subdev_info *sdinfo; 1886 1887 vpfe_dbg(2, vpfe, "vpfe_g_std\n"); 1888 1889 sdinfo = vpfe->current_subdev; 1890 if (sdinfo->inputs[0].capabilities != V4L2_IN_CAP_STD) 1891 return -ENODATA; 1892 1893 *std_id = vpfe_standards[vpfe->std_index].std_id; 1894 1895 return 0; 1896} 1897 1898/* 1899 * vpfe_calculate_offsets : This function calculates buffers offset 1900 * for top and bottom field 1901 */ 1902static void vpfe_calculate_offsets(struct vpfe_device *vpfe) 1903{ 1904 struct v4l2_rect image_win; 1905 1906 vpfe_dbg(2, vpfe, "vpfe_calculate_offsets\n"); 1907 1908 vpfe_ccdc_get_image_window(&vpfe->ccdc, &image_win); 1909 vpfe->field_off = image_win.height * image_win.width; 1910} 1911 1912/* 1913 * vpfe_queue_setup - Callback function for buffer setup. 1914 * @vq: vb2_queue ptr 1915 * @fmt: v4l2 format 1916 * @nbuffers: ptr to number of buffers requested by application 1917 * @nplanes:: contains number of distinct video planes needed to hold a frame 1918 * @sizes[]: contains the size (in bytes) of each plane. 1919 * @alloc_ctxs: ptr to allocation context 1920 * 1921 * This callback function is called when reqbuf() is called to adjust 1922 * the buffer count and buffer size 1923 */ 1924static int vpfe_queue_setup(struct vb2_queue *vq, 1925 const struct v4l2_format *fmt, 1926 unsigned int *nbuffers, unsigned int *nplanes, 1927 unsigned int sizes[], void *alloc_ctxs[]) 1928{ 1929 struct vpfe_device *vpfe = vb2_get_drv_priv(vq); 1930 1931 if (fmt && fmt->fmt.pix.sizeimage < vpfe->fmt.fmt.pix.sizeimage) 1932 return -EINVAL; 1933 1934 if (vq->num_buffers + *nbuffers < 3) 1935 *nbuffers = 3 - vq->num_buffers; 1936 1937 *nplanes = 1; 1938 sizes[0] = fmt ? fmt->fmt.pix.sizeimage : vpfe->fmt.fmt.pix.sizeimage; 1939 alloc_ctxs[0] = vpfe->alloc_ctx; 1940 1941 vpfe_dbg(1, vpfe, 1942 "nbuffers=%d, size=%u\n", *nbuffers, sizes[0]); 1943 1944 /* Calculate field offset */ 1945 vpfe_calculate_offsets(vpfe); 1946 1947 return 0; 1948} 1949 1950/* 1951 * vpfe_buffer_prepare : callback function for buffer prepare 1952 * @vb: ptr to vb2_buffer 1953 * 1954 * This is the callback function for buffer prepare when vb2_qbuf() 1955 * function is called. The buffer is prepared and user space virtual address 1956 * or user address is converted into physical address 1957 */ 1958static int vpfe_buffer_prepare(struct vb2_buffer *vb) 1959{ 1960 struct vpfe_device *vpfe = vb2_get_drv_priv(vb->vb2_queue); 1961 1962 vb2_set_plane_payload(vb, 0, vpfe->fmt.fmt.pix.sizeimage); 1963 1964 if (vb2_get_plane_payload(vb, 0) > vb2_plane_size(vb, 0)) 1965 return -EINVAL; 1966 1967 vb->v4l2_buf.field = vpfe->fmt.fmt.pix.field; 1968 1969 return 0; 1970} 1971 1972/* 1973 * vpfe_buffer_queue : Callback function to add buffer to DMA queue 1974 * @vb: ptr to vb2_buffer 1975 */ 1976static void vpfe_buffer_queue(struct vb2_buffer *vb) 1977{ 1978 struct vpfe_device *vpfe = vb2_get_drv_priv(vb->vb2_queue); 1979 struct vpfe_cap_buffer *buf = to_vpfe_buffer(vb); 1980 unsigned long flags = 0; 1981 1982 /* add the buffer to the DMA queue */ 1983 spin_lock_irqsave(&vpfe->dma_queue_lock, flags); 1984 list_add_tail(&buf->list, &vpfe->dma_queue); 1985 spin_unlock_irqrestore(&vpfe->dma_queue_lock, flags); 1986} 1987 1988/* 1989 * vpfe_start_streaming : Starts the DMA engine for streaming 1990 * @vb: ptr to vb2_buffer 1991 * @count: number of buffers 1992 */ 1993static int vpfe_start_streaming(struct vb2_queue *vq, unsigned int count) 1994{ 1995 struct vpfe_device *vpfe = vb2_get_drv_priv(vq); 1996 struct vpfe_cap_buffer *buf, *tmp; 1997 struct vpfe_subdev_info *sdinfo; 1998 unsigned long flags; 1999 unsigned long addr; 2000 int ret; 2001 2002 spin_lock_irqsave(&vpfe->dma_queue_lock, flags); 2003 2004 vpfe->field = 0; 2005 vpfe->sequence = 0; 2006 2007 sdinfo = vpfe->current_subdev; 2008 2009 vpfe_attach_irq(vpfe); 2010 2011 if (vpfe->ccdc.ccdc_cfg.if_type == VPFE_RAW_BAYER) 2012 vpfe_ccdc_config_raw(&vpfe->ccdc); 2013 else 2014 vpfe_ccdc_config_ycbcr(&vpfe->ccdc); 2015 2016 /* Get the next frame from the buffer queue */ 2017 vpfe->next_frm = list_entry(vpfe->dma_queue.next, 2018 struct vpfe_cap_buffer, list); 2019 vpfe->cur_frm = vpfe->next_frm; 2020 /* Remove buffer from the buffer queue */ 2021 list_del(&vpfe->cur_frm->list); 2022 spin_unlock_irqrestore(&vpfe->dma_queue_lock, flags); 2023 2024 addr = vb2_dma_contig_plane_dma_addr(&vpfe->cur_frm->vb, 0); 2025 2026 vpfe_set_sdr_addr(&vpfe->ccdc, (unsigned long)(addr)); 2027 2028 vpfe_pcr_enable(&vpfe->ccdc, 1); 2029 2030 ret = v4l2_subdev_call(sdinfo->sd, video, s_stream, 1); 2031 if (ret < 0) { 2032 vpfe_err(vpfe, "Error in attaching interrupt handle\n"); 2033 goto err; 2034 } 2035 2036 return 0; 2037 2038err: 2039 list_for_each_entry_safe(buf, tmp, &vpfe->dma_queue, list) { 2040 list_del(&buf->list); 2041 vb2_buffer_done(&buf->vb, VB2_BUF_STATE_QUEUED); 2042 } 2043 2044 return ret; 2045} 2046 2047/* 2048 * vpfe_stop_streaming : Stop the DMA engine 2049 * @vq: ptr to vb2_queue 2050 * 2051 * This callback stops the DMA engine and any remaining buffers 2052 * in the DMA queue are released. 2053 */ 2054static void vpfe_stop_streaming(struct vb2_queue *vq) 2055{ 2056 struct vpfe_device *vpfe = vb2_get_drv_priv(vq); 2057 struct vpfe_subdev_info *sdinfo; 2058 unsigned long flags; 2059 int ret; 2060 2061 vpfe_pcr_enable(&vpfe->ccdc, 0); 2062 2063 vpfe_detach_irq(vpfe); 2064 2065 sdinfo = vpfe->current_subdev; 2066 ret = v4l2_subdev_call(sdinfo->sd, video, s_stream, 0); 2067 if (ret && ret != -ENOIOCTLCMD && ret != -ENODEV) 2068 vpfe_dbg(1, vpfe, "stream off failed in subdev\n"); 2069 2070 /* release all active buffers */ 2071 spin_lock_irqsave(&vpfe->dma_queue_lock, flags); 2072 if (vpfe->cur_frm == vpfe->next_frm) { 2073 vb2_buffer_done(&vpfe->cur_frm->vb, VB2_BUF_STATE_ERROR); 2074 } else { 2075 if (vpfe->cur_frm != NULL) 2076 vb2_buffer_done(&vpfe->cur_frm->vb, 2077 VB2_BUF_STATE_ERROR); 2078 if (vpfe->next_frm != NULL) 2079 vb2_buffer_done(&vpfe->next_frm->vb, 2080 VB2_BUF_STATE_ERROR); 2081 } 2082 2083 while (!list_empty(&vpfe->dma_queue)) { 2084 vpfe->next_frm = list_entry(vpfe->dma_queue.next, 2085 struct vpfe_cap_buffer, list); 2086 list_del(&vpfe->next_frm->list); 2087 vb2_buffer_done(&vpfe->next_frm->vb, VB2_BUF_STATE_ERROR); 2088 } 2089 spin_unlock_irqrestore(&vpfe->dma_queue_lock, flags); 2090} 2091 2092static int vpfe_cropcap(struct file *file, void *priv, 2093 struct v4l2_cropcap *crop) 2094{ 2095 struct vpfe_device *vpfe = video_drvdata(file); 2096 2097 vpfe_dbg(2, vpfe, "vpfe_cropcap\n"); 2098 2099 if (vpfe->std_index >= ARRAY_SIZE(vpfe_standards)) 2100 return -EINVAL; 2101 2102 memset(crop, 0, sizeof(struct v4l2_cropcap)); 2103 2104 crop->type = V4L2_BUF_TYPE_VIDEO_CAPTURE; 2105 crop->defrect.width = vpfe_standards[vpfe->std_index].width; 2106 crop->bounds.width = crop->defrect.width; 2107 crop->defrect.height = vpfe_standards[vpfe->std_index].height; 2108 crop->bounds.height = crop->defrect.height; 2109 crop->pixelaspect = vpfe_standards[vpfe->std_index].pixelaspect; 2110 2111 return 0; 2112} 2113 2114static int 2115vpfe_g_selection(struct file *file, void *fh, struct v4l2_selection *s) 2116{ 2117 struct vpfe_device *vpfe = video_drvdata(file); 2118 2119 switch (s->target) { 2120 case V4L2_SEL_TGT_CROP_BOUNDS: 2121 case V4L2_SEL_TGT_CROP_DEFAULT: 2122 s->r.left = s->r.top = 0; 2123 s->r.width = vpfe->crop.width; 2124 s->r.height = vpfe->crop.height; 2125 break; 2126 2127 case V4L2_SEL_TGT_CROP: 2128 s->r = vpfe->crop; 2129 break; 2130 2131 default: 2132 return -EINVAL; 2133 } 2134 2135 return 0; 2136} 2137 2138static int enclosed_rectangle(struct v4l2_rect *a, struct v4l2_rect *b) 2139{ 2140 if (a->left < b->left || a->top < b->top) 2141 return 0; 2142 2143 if (a->left + a->width > b->left + b->width) 2144 return 0; 2145 2146 if (a->top + a->height > b->top + b->height) 2147 return 0; 2148 2149 return 1; 2150} 2151 2152static int 2153vpfe_s_selection(struct file *file, void *fh, struct v4l2_selection *s) 2154{ 2155 struct vpfe_device *vpfe = video_drvdata(file); 2156 struct v4l2_rect cr = vpfe->crop; 2157 struct v4l2_rect r = s->r; 2158 2159 /* If streaming is started, return error */ 2160 if (vb2_is_busy(&vpfe->buffer_queue)) { 2161 vpfe_err(vpfe, "%s device busy\n", __func__); 2162 return -EBUSY; 2163 } 2164 2165 if (s->type != V4L2_BUF_TYPE_VIDEO_CAPTURE || 2166 s->target != V4L2_SEL_TGT_CROP) 2167 return -EINVAL; 2168 2169 v4l_bound_align_image(&r.width, 0, cr.width, 0, 2170 &r.height, 0, cr.height, 0, 0); 2171 2172 r.left = clamp_t(unsigned int, r.left, 0, cr.width - r.width); 2173 r.top = clamp_t(unsigned int, r.top, 0, cr.height - r.height); 2174 2175 if (s->flags & V4L2_SEL_FLAG_LE && !enclosed_rectangle(&r, &s->r)) 2176 return -ERANGE; 2177 2178 if (s->flags & V4L2_SEL_FLAG_GE && !enclosed_rectangle(&s->r, &r)) 2179 return -ERANGE; 2180 2181 s->r = vpfe->crop = r; 2182 2183 vpfe_ccdc_set_image_window(&vpfe->ccdc, &r, vpfe->bpp); 2184 vpfe->fmt.fmt.pix.width = r.width; 2185 vpfe->fmt.fmt.pix.height = r.height; 2186 vpfe->fmt.fmt.pix.bytesperline = vpfe_ccdc_get_line_length(&vpfe->ccdc); 2187 vpfe->fmt.fmt.pix.sizeimage = vpfe->fmt.fmt.pix.bytesperline * 2188 vpfe->fmt.fmt.pix.height; 2189 2190 vpfe_dbg(1, vpfe, "cropped (%d,%d)/%dx%d of %dx%d\n", 2191 r.left, r.top, r.width, r.height, cr.width, cr.height); 2192 2193 return 0; 2194} 2195 2196static long vpfe_ioctl_default(struct file *file, void *priv, 2197 bool valid_prio, unsigned int cmd, void *param) 2198{ 2199 struct vpfe_device *vpfe = video_drvdata(file); 2200 int ret; 2201 2202 vpfe_dbg(2, vpfe, "vpfe_ioctl_default\n"); 2203 2204 if (!valid_prio) { 2205 vpfe_err(vpfe, "%s device busy\n", __func__); 2206 return -EBUSY; 2207 } 2208 2209 /* If streaming is started, return error */ 2210 if (vb2_is_busy(&vpfe->buffer_queue)) { 2211 vpfe_err(vpfe, "%s device busy\n", __func__); 2212 return -EBUSY; 2213 } 2214 2215 switch (cmd) { 2216 case VIDIOC_AM437X_CCDC_CFG: 2217 ret = vpfe_ccdc_set_params(&vpfe->ccdc, (void __user *)param); 2218 if (ret) { 2219 vpfe_dbg(2, vpfe, 2220 "Error setting parameters in CCDC\n"); 2221 return ret; 2222 } 2223 ret = vpfe_get_ccdc_image_format(vpfe, 2224 &vpfe->fmt); 2225 if (ret < 0) { 2226 vpfe_dbg(2, vpfe, 2227 "Invalid image format at CCDC\n"); 2228 return ret; 2229 } 2230 break; 2231 2232 default: 2233 ret = -ENOTTY; 2234 break; 2235 } 2236 2237 return ret; 2238} 2239 2240static const struct vb2_ops vpfe_video_qops = { 2241 .wait_prepare = vb2_ops_wait_prepare, 2242 .wait_finish = vb2_ops_wait_finish, 2243 .queue_setup = vpfe_queue_setup, 2244 .buf_prepare = vpfe_buffer_prepare, 2245 .buf_queue = vpfe_buffer_queue, 2246 .start_streaming = vpfe_start_streaming, 2247 .stop_streaming = vpfe_stop_streaming, 2248}; 2249 2250/* vpfe capture driver file operations */ 2251static const struct v4l2_file_operations vpfe_fops = { 2252 .owner = THIS_MODULE, 2253 .open = vpfe_open, 2254 .release = vpfe_release, 2255 .read = vb2_fop_read, 2256 .poll = vb2_fop_poll, 2257 .unlocked_ioctl = video_ioctl2, 2258 .mmap = vb2_fop_mmap, 2259}; 2260 2261/* vpfe capture ioctl operations */ 2262static const struct v4l2_ioctl_ops vpfe_ioctl_ops = { 2263 .vidioc_querycap = vpfe_querycap, 2264 .vidioc_enum_fmt_vid_cap = vpfe_enum_fmt, 2265 .vidioc_g_fmt_vid_cap = vpfe_g_fmt, 2266 .vidioc_s_fmt_vid_cap = vpfe_s_fmt, 2267 .vidioc_try_fmt_vid_cap = vpfe_try_fmt, 2268 2269 .vidioc_enum_framesizes = vpfe_enum_size, 2270 2271 .vidioc_enum_input = vpfe_enum_input, 2272 .vidioc_g_input = vpfe_g_input, 2273 .vidioc_s_input = vpfe_s_input, 2274 2275 .vidioc_querystd = vpfe_querystd, 2276 .vidioc_s_std = vpfe_s_std, 2277 .vidioc_g_std = vpfe_g_std, 2278 2279 .vidioc_reqbufs = vb2_ioctl_reqbufs, 2280 .vidioc_create_bufs = vb2_ioctl_create_bufs, 2281 .vidioc_prepare_buf = vb2_ioctl_prepare_buf, 2282 .vidioc_querybuf = vb2_ioctl_querybuf, 2283 .vidioc_qbuf = vb2_ioctl_qbuf, 2284 .vidioc_dqbuf = vb2_ioctl_dqbuf, 2285 .vidioc_expbuf = vb2_ioctl_expbuf, 2286 .vidioc_streamon = vb2_ioctl_streamon, 2287 .vidioc_streamoff = vb2_ioctl_streamoff, 2288 2289 .vidioc_log_status = v4l2_ctrl_log_status, 2290 .vidioc_subscribe_event = v4l2_ctrl_subscribe_event, 2291 .vidioc_unsubscribe_event = v4l2_event_unsubscribe, 2292 2293 .vidioc_cropcap = vpfe_cropcap, 2294 .vidioc_g_selection = vpfe_g_selection, 2295 .vidioc_s_selection = vpfe_s_selection, 2296 2297 .vidioc_default = vpfe_ioctl_default, 2298}; 2299 2300static int 2301vpfe_async_bound(struct v4l2_async_notifier *notifier, 2302 struct v4l2_subdev *subdev, 2303 struct v4l2_async_subdev *asd) 2304{ 2305 struct vpfe_device *vpfe = container_of(notifier->v4l2_dev, 2306 struct vpfe_device, v4l2_dev); 2307 struct v4l2_subdev_mbus_code_enum mbus_code; 2308 struct vpfe_subdev_info *sdinfo; 2309 bool found = false; 2310 int i, j; 2311 2312 vpfe_dbg(1, vpfe, "vpfe_async_bound\n"); 2313 2314 for (i = 0; i < ARRAY_SIZE(vpfe->cfg->asd); i++) { 2315 if (vpfe->cfg->asd[i]->match.of.node == asd[i].match.of.node) { 2316 sdinfo = &vpfe->cfg->sub_devs[i]; 2317 vpfe->sd[i] = subdev; 2318 vpfe->sd[i]->grp_id = sdinfo->grp_id; 2319 found = true; 2320 break; 2321 } 2322 } 2323 2324 if (!found) { 2325 vpfe_info(vpfe, "sub device (%s) not matched\n", subdev->name); 2326 return -EINVAL; 2327 } 2328 2329 vpfe->video_dev.tvnorms |= sdinfo->inputs[0].std; 2330 2331 /* setup the supported formats & indexes */ 2332 for (j = 0, i = 0; ; ++j) { 2333 struct vpfe_fmt *fmt; 2334 int ret; 2335 2336 memset(&mbus_code, 0, sizeof(mbus_code)); 2337 mbus_code.index = j; 2338 mbus_code.which = V4L2_SUBDEV_FORMAT_ACTIVE; 2339 ret = v4l2_subdev_call(subdev, pad, enum_mbus_code, 2340 NULL, &mbus_code); 2341 if (ret) 2342 break; 2343 2344 fmt = find_format_by_code(mbus_code.code); 2345 if (!fmt) 2346 continue; 2347 2348 fmt->supported = true; 2349 fmt->index = i++; 2350 } 2351 2352 return 0; 2353} 2354 2355static int vpfe_probe_complete(struct vpfe_device *vpfe) 2356{ 2357 struct video_device *vdev; 2358 struct vb2_queue *q; 2359 int err; 2360 2361 spin_lock_init(&vpfe->dma_queue_lock); 2362 mutex_init(&vpfe->lock); 2363 2364 vpfe->fmt.type = V4L2_BUF_TYPE_VIDEO_CAPTURE; 2365 2366 /* set first sub device as current one */ 2367 vpfe->current_subdev = &vpfe->cfg->sub_devs[0]; 2368 vpfe->v4l2_dev.ctrl_handler = vpfe->sd[0]->ctrl_handler; 2369 2370 err = vpfe_set_input(vpfe, 0); 2371 if (err) 2372 goto probe_out; 2373 2374 /* Initialize videobuf2 queue as per the buffer type */ 2375 vpfe->alloc_ctx = vb2_dma_contig_init_ctx(vpfe->pdev); 2376 if (IS_ERR(vpfe->alloc_ctx)) { 2377 vpfe_err(vpfe, "Failed to get the context\n"); 2378 err = PTR_ERR(vpfe->alloc_ctx); 2379 goto probe_out; 2380 } 2381 2382 q = &vpfe->buffer_queue; 2383 q->type = V4L2_BUF_TYPE_VIDEO_CAPTURE; 2384 q->io_modes = VB2_MMAP | VB2_DMABUF | VB2_READ; 2385 q->drv_priv = vpfe; 2386 q->ops = &vpfe_video_qops; 2387 q->mem_ops = &vb2_dma_contig_memops; 2388 q->buf_struct_size = sizeof(struct vpfe_cap_buffer); 2389 q->timestamp_flags = V4L2_BUF_FLAG_TIMESTAMP_MONOTONIC; 2390 q->lock = &vpfe->lock; 2391 q->min_buffers_needed = 1; 2392 2393 err = vb2_queue_init(q); 2394 if (err) { 2395 vpfe_err(vpfe, "vb2_queue_init() failed\n"); 2396 vb2_dma_contig_cleanup_ctx(vpfe->alloc_ctx); 2397 goto probe_out; 2398 } 2399 2400 INIT_LIST_HEAD(&vpfe->dma_queue); 2401 2402 vdev = &vpfe->video_dev; 2403 strlcpy(vdev->name, VPFE_MODULE_NAME, sizeof(vdev->name)); 2404 vdev->release = video_device_release_empty; 2405 vdev->fops = &vpfe_fops; 2406 vdev->ioctl_ops = &vpfe_ioctl_ops; 2407 vdev->v4l2_dev = &vpfe->v4l2_dev; 2408 vdev->vfl_dir = VFL_DIR_RX; 2409 vdev->queue = q; 2410 vdev->lock = &vpfe->lock; 2411 video_set_drvdata(vdev, vpfe); 2412 err = video_register_device(&vpfe->video_dev, VFL_TYPE_GRABBER, -1); 2413 if (err) { 2414 vpfe_err(vpfe, 2415 "Unable to register video device.\n"); 2416 goto probe_out; 2417 } 2418 2419 return 0; 2420 2421probe_out: 2422 v4l2_device_unregister(&vpfe->v4l2_dev); 2423 return err; 2424} 2425 2426static int vpfe_async_complete(struct v4l2_async_notifier *notifier) 2427{ 2428 struct vpfe_device *vpfe = container_of(notifier->v4l2_dev, 2429 struct vpfe_device, v4l2_dev); 2430 2431 return vpfe_probe_complete(vpfe); 2432} 2433 2434static struct vpfe_config * 2435vpfe_get_pdata(struct platform_device *pdev) 2436{ 2437 struct device_node *endpoint = NULL; 2438 struct v4l2_of_endpoint bus_cfg; 2439 struct vpfe_subdev_info *sdinfo; 2440 struct vpfe_config *pdata; 2441 unsigned int flags; 2442 unsigned int i; 2443 int err; 2444 2445 dev_dbg(&pdev->dev, "vpfe_get_pdata\n"); 2446 2447 if (!IS_ENABLED(CONFIG_OF) || !pdev->dev.of_node) 2448 return pdev->dev.platform_data; 2449 2450 pdata = devm_kzalloc(&pdev->dev, sizeof(*pdata), GFP_KERNEL); 2451 if (!pdata) 2452 return NULL; 2453 2454 for (i = 0; ; i++) { 2455 struct device_node *rem; 2456 2457 endpoint = of_graph_get_next_endpoint(pdev->dev.of_node, 2458 endpoint); 2459 if (!endpoint) 2460 break; 2461 2462 sdinfo = &pdata->sub_devs[i]; 2463 sdinfo->grp_id = 0; 2464 2465 /* we only support camera */ 2466 sdinfo->inputs[0].index = i; 2467 strcpy(sdinfo->inputs[0].name, "Camera"); 2468 sdinfo->inputs[0].type = V4L2_INPUT_TYPE_CAMERA; 2469 sdinfo->inputs[0].std = V4L2_STD_ALL; 2470 sdinfo->inputs[0].capabilities = V4L2_IN_CAP_STD; 2471 2472 sdinfo->can_route = 0; 2473 sdinfo->routes = NULL; 2474 2475 of_property_read_u32(endpoint, "ti,am437x-vpfe-interface", 2476 &sdinfo->vpfe_param.if_type); 2477 if (sdinfo->vpfe_param.if_type < 0 || 2478 sdinfo->vpfe_param.if_type > 4) { 2479 sdinfo->vpfe_param.if_type = VPFE_RAW_BAYER; 2480 } 2481 2482 err = v4l2_of_parse_endpoint(endpoint, &bus_cfg); 2483 if (err) { 2484 dev_err(&pdev->dev, "Could not parse the endpoint\n"); 2485 goto done; 2486 } 2487 2488 sdinfo->vpfe_param.bus_width = bus_cfg.bus.parallel.bus_width; 2489 2490 if (sdinfo->vpfe_param.bus_width < 8 || 2491 sdinfo->vpfe_param.bus_width > 16) { 2492 dev_err(&pdev->dev, "Invalid bus width.\n"); 2493 goto done; 2494 } 2495 2496 flags = bus_cfg.bus.parallel.flags; 2497 2498 if (flags & V4L2_MBUS_HSYNC_ACTIVE_HIGH) 2499 sdinfo->vpfe_param.hdpol = 1; 2500 2501 if (flags & V4L2_MBUS_VSYNC_ACTIVE_HIGH) 2502 sdinfo->vpfe_param.vdpol = 1; 2503 2504 rem = of_graph_get_remote_port_parent(endpoint); 2505 if (!rem) { 2506 dev_err(&pdev->dev, "Remote device at %s not found\n", 2507 endpoint->full_name); 2508 goto done; 2509 } 2510 2511 pdata->asd[i] = devm_kzalloc(&pdev->dev, 2512 sizeof(struct v4l2_async_subdev), 2513 GFP_KERNEL); 2514 if (!pdata->asd[i]) { 2515 of_node_put(rem); 2516 pdata = NULL; 2517 goto done; 2518 } 2519 2520 pdata->asd[i]->match_type = V4L2_ASYNC_MATCH_OF; 2521 pdata->asd[i]->match.of.node = rem; 2522 of_node_put(rem); 2523 } 2524 2525 of_node_put(endpoint); 2526 return pdata; 2527 2528done: 2529 of_node_put(endpoint); 2530 return NULL; 2531} 2532 2533/* 2534 * vpfe_probe : This function creates device entries by register 2535 * itself to the V4L2 driver and initializes fields of each 2536 * device objects 2537 */ 2538static int vpfe_probe(struct platform_device *pdev) 2539{ 2540 struct vpfe_config *vpfe_cfg = vpfe_get_pdata(pdev); 2541 struct vpfe_device *vpfe; 2542 struct vpfe_ccdc *ccdc; 2543 struct resource *res; 2544 int ret; 2545 2546 if (!vpfe_cfg) { 2547 dev_err(&pdev->dev, "No platform data\n"); 2548 return -EINVAL; 2549 } 2550 2551 vpfe = devm_kzalloc(&pdev->dev, sizeof(*vpfe), GFP_KERNEL); 2552 if (!vpfe) 2553 return -ENOMEM; 2554 2555 vpfe->pdev = &pdev->dev; 2556 vpfe->cfg = vpfe_cfg; 2557 ccdc = &vpfe->ccdc; 2558 2559 res = platform_get_resource(pdev, IORESOURCE_MEM, 0); 2560 ccdc->ccdc_cfg.base_addr = devm_ioremap_resource(&pdev->dev, res); 2561 if (IS_ERR(ccdc->ccdc_cfg.base_addr)) 2562 return PTR_ERR(ccdc->ccdc_cfg.base_addr); 2563 2564 vpfe->irq = platform_get_irq(pdev, 0); 2565 if (vpfe->irq <= 0) { 2566 dev_err(&pdev->dev, "No IRQ resource\n"); 2567 return -ENODEV; 2568 } 2569 2570 ret = devm_request_irq(vpfe->pdev, vpfe->irq, vpfe_isr, 0, 2571 "vpfe_capture0", vpfe); 2572 if (ret) { 2573 dev_err(&pdev->dev, "Unable to request interrupt\n"); 2574 return -EINVAL; 2575 } 2576 2577 ret = v4l2_device_register(&pdev->dev, &vpfe->v4l2_dev); 2578 if (ret) { 2579 vpfe_err(vpfe, 2580 "Unable to register v4l2 device.\n"); 2581 return ret; 2582 } 2583 2584 /* set the driver data in platform device */ 2585 platform_set_drvdata(pdev, vpfe); 2586 /* Enabling module functional clock */ 2587 pm_runtime_enable(&pdev->dev); 2588 2589 /* for now just enable it here instead of waiting for the open */ 2590 pm_runtime_get_sync(&pdev->dev); 2591 2592 vpfe_ccdc_config_defaults(ccdc); 2593 2594 pm_runtime_put_sync(&pdev->dev); 2595 2596 vpfe->sd = devm_kzalloc(&pdev->dev, sizeof(struct v4l2_subdev *) * 2597 ARRAY_SIZE(vpfe->cfg->asd), GFP_KERNEL); 2598 if (!vpfe->sd) { 2599 ret = -ENOMEM; 2600 goto probe_out_v4l2_unregister; 2601 } 2602 2603 vpfe->notifier.subdevs = vpfe->cfg->asd; 2604 vpfe->notifier.num_subdevs = ARRAY_SIZE(vpfe->cfg->asd); 2605 vpfe->notifier.bound = vpfe_async_bound; 2606 vpfe->notifier.complete = vpfe_async_complete; 2607 ret = v4l2_async_notifier_register(&vpfe->v4l2_dev, 2608 &vpfe->notifier); 2609 if (ret) { 2610 vpfe_err(vpfe, "Error registering async notifier\n"); 2611 ret = -EINVAL; 2612 goto probe_out_v4l2_unregister; 2613 } 2614 2615 return 0; 2616 2617probe_out_v4l2_unregister: 2618 v4l2_device_unregister(&vpfe->v4l2_dev); 2619 return ret; 2620} 2621 2622/* 2623 * vpfe_remove : It un-register device from V4L2 driver 2624 */ 2625static 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 2642static 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 2671static 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 2700static 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 2729static 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 2757static SIMPLE_DEV_PM_OPS(vpfe_pm_ops, vpfe_suspend, vpfe_resume); 2758 2759static const struct of_device_id vpfe_of_match[] = { 2760 { .compatible = "ti,am437x-vpfe", }, 2761 { /* sentinel */ }, 2762}; 2763MODULE_DEVICE_TABLE(of, vpfe_of_match); 2764 2765static struct platform_driver vpfe_driver = { 2766 .probe = vpfe_probe, 2767 .remove = vpfe_remove, 2768 .driver = { 2769 .name = VPFE_MODULE_NAME, 2770 .pm = &vpfe_pm_ops, 2771 .of_match_table = of_match_ptr(vpfe_of_match), 2772 }, 2773}; 2774 2775module_platform_driver(vpfe_driver); 2776 2777MODULE_AUTHOR("Texas Instruments"); 2778MODULE_DESCRIPTION("TI AM437x VPFE driver"); 2779MODULE_LICENSE("GPL"); 2780MODULE_VERSION(VPFE_VERSION); 2781