1 // SPDX-License-Identifier: GPL-2.0-only 2 /* 3 * vivid-vid-out.c - video output support functions. 4 * 5 * Copyright 2014 Cisco Systems, Inc. and/or its affiliates. All rights reserved. 6 */ 7 8 #include <linux/errno.h> 9 #include <linux/kernel.h> 10 #include <linux/sched.h> 11 #include <linux/videodev2.h> 12 #include <linux/v4l2-dv-timings.h> 13 #include <media/v4l2-common.h> 14 #include <media/v4l2-event.h> 15 #include <media/v4l2-dv-timings.h> 16 #include <media/v4l2-rect.h> 17 18 #include "vivid-core.h" 19 #include "vivid-vid-common.h" 20 #include "vivid-kthread-out.h" 21 #include "vivid-vid-out.h" 22 23 static int vid_out_queue_setup(struct vb2_queue *vq, 24 unsigned *nbuffers, unsigned *nplanes, 25 unsigned sizes[], struct device *alloc_devs[]) 26 { 27 struct vivid_dev *dev = vb2_get_drv_priv(vq); 28 const struct vivid_fmt *vfmt = dev->fmt_out; 29 unsigned planes = vfmt->buffers; 30 unsigned h = dev->fmt_out_rect.height; 31 unsigned int size = dev->bytesperline_out[0] * h + vfmt->data_offset[0]; 32 unsigned p; 33 34 for (p = vfmt->buffers; p < vfmt->planes; p++) 35 size += dev->bytesperline_out[p] * h / vfmt->vdownsampling[p] + 36 vfmt->data_offset[p]; 37 38 if (dev->field_out == V4L2_FIELD_ALTERNATE) { 39 /* 40 * You cannot use write() with FIELD_ALTERNATE since the field 41 * information (TOP/BOTTOM) cannot be passed to the kernel. 42 */ 43 if (vb2_fileio_is_active(vq)) 44 return -EINVAL; 45 } 46 47 if (dev->queue_setup_error) { 48 /* 49 * Error injection: test what happens if queue_setup() returns 50 * an error. 51 */ 52 dev->queue_setup_error = false; 53 return -EINVAL; 54 } 55 56 if (*nplanes) { 57 /* 58 * Check if the number of requested planes match 59 * the number of planes in the current format. You can't mix that. 60 */ 61 if (*nplanes != planes) 62 return -EINVAL; 63 if (sizes[0] < size) 64 return -EINVAL; 65 for (p = 1; p < planes; p++) { 66 if (sizes[p] < dev->bytesperline_out[p] * h + 67 vfmt->data_offset[p]) 68 return -EINVAL; 69 } 70 } else { 71 for (p = 0; p < planes; p++) 72 sizes[p] = p ? dev->bytesperline_out[p] * h + 73 vfmt->data_offset[p] : size; 74 } 75 76 if (vq->num_buffers + *nbuffers < 2) 77 *nbuffers = 2 - vq->num_buffers; 78 79 *nplanes = planes; 80 81 dprintk(dev, 1, "%s: count=%d\n", __func__, *nbuffers); 82 for (p = 0; p < planes; p++) 83 dprintk(dev, 1, "%s: size[%u]=%u\n", __func__, p, sizes[p]); 84 return 0; 85 } 86 87 static int vid_out_buf_out_validate(struct vb2_buffer *vb) 88 { 89 struct vb2_v4l2_buffer *vbuf = to_vb2_v4l2_buffer(vb); 90 struct vivid_dev *dev = vb2_get_drv_priv(vb->vb2_queue); 91 92 dprintk(dev, 1, "%s\n", __func__); 93 94 if (dev->field_out != V4L2_FIELD_ALTERNATE) 95 vbuf->field = dev->field_out; 96 else if (vbuf->field != V4L2_FIELD_TOP && 97 vbuf->field != V4L2_FIELD_BOTTOM) 98 return -EINVAL; 99 return 0; 100 } 101 102 static int vid_out_buf_prepare(struct vb2_buffer *vb) 103 { 104 struct vivid_dev *dev = vb2_get_drv_priv(vb->vb2_queue); 105 const struct vivid_fmt *vfmt = dev->fmt_out; 106 unsigned int planes = vfmt->buffers; 107 unsigned int h = dev->fmt_out_rect.height; 108 unsigned int size = dev->bytesperline_out[0] * h; 109 unsigned p; 110 111 for (p = vfmt->buffers; p < vfmt->planes; p++) 112 size += dev->bytesperline_out[p] * h / vfmt->vdownsampling[p]; 113 114 dprintk(dev, 1, "%s\n", __func__); 115 116 if (WARN_ON(NULL == dev->fmt_out)) 117 return -EINVAL; 118 119 if (dev->buf_prepare_error) { 120 /* 121 * Error injection: test what happens if buf_prepare() returns 122 * an error. 123 */ 124 dev->buf_prepare_error = false; 125 return -EINVAL; 126 } 127 128 for (p = 0; p < planes; p++) { 129 if (p) 130 size = dev->bytesperline_out[p] * h; 131 size += vb->planes[p].data_offset; 132 133 if (vb2_get_plane_payload(vb, p) < size) { 134 dprintk(dev, 1, "%s the payload is too small for plane %u (%lu < %u)\n", 135 __func__, p, vb2_get_plane_payload(vb, p), size); 136 return -EINVAL; 137 } 138 } 139 140 return 0; 141 } 142 143 static void vid_out_buf_queue(struct vb2_buffer *vb) 144 { 145 struct vb2_v4l2_buffer *vbuf = to_vb2_v4l2_buffer(vb); 146 struct vivid_dev *dev = vb2_get_drv_priv(vb->vb2_queue); 147 struct vivid_buffer *buf = container_of(vbuf, struct vivid_buffer, vb); 148 149 dprintk(dev, 1, "%s\n", __func__); 150 151 spin_lock(&dev->slock); 152 list_add_tail(&buf->list, &dev->vid_out_active); 153 spin_unlock(&dev->slock); 154 } 155 156 static int vid_out_start_streaming(struct vb2_queue *vq, unsigned count) 157 { 158 struct vivid_dev *dev = vb2_get_drv_priv(vq); 159 int err; 160 161 if (vb2_is_streaming(&dev->vb_vid_cap_q)) 162 dev->can_loop_video = vivid_vid_can_loop(dev); 163 164 dev->vid_out_seq_count = 0; 165 dprintk(dev, 1, "%s\n", __func__); 166 if (dev->start_streaming_error) { 167 dev->start_streaming_error = false; 168 err = -EINVAL; 169 } else { 170 err = vivid_start_generating_vid_out(dev, &dev->vid_out_streaming); 171 } 172 if (err) { 173 struct vivid_buffer *buf, *tmp; 174 175 list_for_each_entry_safe(buf, tmp, &dev->vid_out_active, list) { 176 list_del(&buf->list); 177 vb2_buffer_done(&buf->vb.vb2_buf, 178 VB2_BUF_STATE_QUEUED); 179 } 180 } 181 return err; 182 } 183 184 /* abort streaming and wait for last buffer */ 185 static void vid_out_stop_streaming(struct vb2_queue *vq) 186 { 187 struct vivid_dev *dev = vb2_get_drv_priv(vq); 188 189 dprintk(dev, 1, "%s\n", __func__); 190 vivid_stop_generating_vid_out(dev, &dev->vid_out_streaming); 191 dev->can_loop_video = false; 192 } 193 194 static void vid_out_buf_request_complete(struct vb2_buffer *vb) 195 { 196 struct vivid_dev *dev = vb2_get_drv_priv(vb->vb2_queue); 197 198 v4l2_ctrl_request_complete(vb->req_obj.req, &dev->ctrl_hdl_vid_out); 199 } 200 201 const struct vb2_ops vivid_vid_out_qops = { 202 .queue_setup = vid_out_queue_setup, 203 .buf_out_validate = vid_out_buf_out_validate, 204 .buf_prepare = vid_out_buf_prepare, 205 .buf_queue = vid_out_buf_queue, 206 .start_streaming = vid_out_start_streaming, 207 .stop_streaming = vid_out_stop_streaming, 208 .buf_request_complete = vid_out_buf_request_complete, 209 .wait_prepare = vb2_ops_wait_prepare, 210 .wait_finish = vb2_ops_wait_finish, 211 }; 212 213 /* 214 * Called whenever the format has to be reset which can occur when 215 * changing outputs, standard, timings, etc. 216 */ 217 void vivid_update_format_out(struct vivid_dev *dev) 218 { 219 struct v4l2_bt_timings *bt = &dev->dv_timings_out.bt; 220 unsigned size, p; 221 u64 pixelclock; 222 223 switch (dev->output_type[dev->output]) { 224 case SVID: 225 default: 226 dev->field_out = dev->tv_field_out; 227 dev->sink_rect.width = 720; 228 if (dev->std_out & V4L2_STD_525_60) { 229 dev->sink_rect.height = 480; 230 dev->timeperframe_vid_out = (struct v4l2_fract) { 1001, 30000 }; 231 dev->service_set_out = V4L2_SLICED_CAPTION_525; 232 } else { 233 dev->sink_rect.height = 576; 234 dev->timeperframe_vid_out = (struct v4l2_fract) { 1000, 25000 }; 235 dev->service_set_out = V4L2_SLICED_WSS_625 | V4L2_SLICED_TELETEXT_B; 236 } 237 dev->colorspace_out = V4L2_COLORSPACE_SMPTE170M; 238 break; 239 case HDMI: 240 dev->sink_rect.width = bt->width; 241 dev->sink_rect.height = bt->height; 242 size = V4L2_DV_BT_FRAME_WIDTH(bt) * V4L2_DV_BT_FRAME_HEIGHT(bt); 243 244 if (can_reduce_fps(bt) && (bt->flags & V4L2_DV_FL_REDUCED_FPS)) 245 pixelclock = div_u64(bt->pixelclock * 1000, 1001); 246 else 247 pixelclock = bt->pixelclock; 248 249 dev->timeperframe_vid_out = (struct v4l2_fract) { 250 size / 100, (u32)pixelclock / 100 251 }; 252 if (bt->interlaced) 253 dev->field_out = V4L2_FIELD_ALTERNATE; 254 else 255 dev->field_out = V4L2_FIELD_NONE; 256 if (!dev->dvi_d_out && (bt->flags & V4L2_DV_FL_IS_CE_VIDEO)) { 257 if (bt->width == 720 && bt->height <= 576) 258 dev->colorspace_out = V4L2_COLORSPACE_SMPTE170M; 259 else 260 dev->colorspace_out = V4L2_COLORSPACE_REC709; 261 } else { 262 dev->colorspace_out = V4L2_COLORSPACE_SRGB; 263 } 264 break; 265 } 266 dev->xfer_func_out = V4L2_XFER_FUNC_DEFAULT; 267 dev->ycbcr_enc_out = V4L2_YCBCR_ENC_DEFAULT; 268 dev->hsv_enc_out = V4L2_HSV_ENC_180; 269 dev->quantization_out = V4L2_QUANTIZATION_DEFAULT; 270 dev->compose_out = dev->sink_rect; 271 dev->compose_bounds_out = dev->sink_rect; 272 dev->crop_out = dev->compose_out; 273 if (V4L2_FIELD_HAS_T_OR_B(dev->field_out)) 274 dev->crop_out.height /= 2; 275 dev->fmt_out_rect = dev->crop_out; 276 for (p = 0; p < dev->fmt_out->planes; p++) 277 dev->bytesperline_out[p] = 278 (dev->sink_rect.width * dev->fmt_out->bit_depth[p]) / 8; 279 } 280 281 /* Map the field to something that is valid for the current output */ 282 static enum v4l2_field vivid_field_out(struct vivid_dev *dev, enum v4l2_field field) 283 { 284 if (vivid_is_svid_out(dev)) { 285 switch (field) { 286 case V4L2_FIELD_INTERLACED_TB: 287 case V4L2_FIELD_INTERLACED_BT: 288 case V4L2_FIELD_SEQ_TB: 289 case V4L2_FIELD_SEQ_BT: 290 case V4L2_FIELD_ALTERNATE: 291 return field; 292 case V4L2_FIELD_INTERLACED: 293 default: 294 return V4L2_FIELD_INTERLACED; 295 } 296 } 297 if (vivid_is_hdmi_out(dev)) 298 return dev->dv_timings_out.bt.interlaced ? V4L2_FIELD_ALTERNATE : 299 V4L2_FIELD_NONE; 300 return V4L2_FIELD_NONE; 301 } 302 303 static enum tpg_pixel_aspect vivid_get_pixel_aspect(const struct vivid_dev *dev) 304 { 305 if (vivid_is_svid_out(dev)) 306 return (dev->std_out & V4L2_STD_525_60) ? 307 TPG_PIXEL_ASPECT_NTSC : TPG_PIXEL_ASPECT_PAL; 308 309 if (vivid_is_hdmi_out(dev) && 310 dev->sink_rect.width == 720 && dev->sink_rect.height <= 576) 311 return dev->sink_rect.height == 480 ? 312 TPG_PIXEL_ASPECT_NTSC : TPG_PIXEL_ASPECT_PAL; 313 314 return TPG_PIXEL_ASPECT_SQUARE; 315 } 316 317 int vivid_g_fmt_vid_out(struct file *file, void *priv, 318 struct v4l2_format *f) 319 { 320 struct vivid_dev *dev = video_drvdata(file); 321 struct v4l2_pix_format_mplane *mp = &f->fmt.pix_mp; 322 const struct vivid_fmt *fmt = dev->fmt_out; 323 unsigned p; 324 325 mp->width = dev->fmt_out_rect.width; 326 mp->height = dev->fmt_out_rect.height; 327 mp->field = dev->field_out; 328 mp->pixelformat = fmt->fourcc; 329 mp->colorspace = dev->colorspace_out; 330 mp->xfer_func = dev->xfer_func_out; 331 mp->ycbcr_enc = dev->ycbcr_enc_out; 332 mp->quantization = dev->quantization_out; 333 mp->num_planes = fmt->buffers; 334 for (p = 0; p < mp->num_planes; p++) { 335 mp->plane_fmt[p].bytesperline = dev->bytesperline_out[p]; 336 mp->plane_fmt[p].sizeimage = 337 mp->plane_fmt[p].bytesperline * mp->height + 338 fmt->data_offset[p]; 339 } 340 for (p = fmt->buffers; p < fmt->planes; p++) { 341 unsigned stride = dev->bytesperline_out[p]; 342 343 mp->plane_fmt[0].sizeimage += 344 (stride * mp->height) / fmt->vdownsampling[p]; 345 } 346 return 0; 347 } 348 349 int vivid_try_fmt_vid_out(struct file *file, void *priv, 350 struct v4l2_format *f) 351 { 352 struct vivid_dev *dev = video_drvdata(file); 353 struct v4l2_bt_timings *bt = &dev->dv_timings_out.bt; 354 struct v4l2_pix_format_mplane *mp = &f->fmt.pix_mp; 355 struct v4l2_plane_pix_format *pfmt = mp->plane_fmt; 356 const struct vivid_fmt *fmt; 357 unsigned bytesperline, max_bpl; 358 unsigned factor = 1; 359 unsigned w, h; 360 unsigned p; 361 362 fmt = vivid_get_format(dev, mp->pixelformat); 363 if (!fmt) { 364 dprintk(dev, 1, "Fourcc format (0x%08x) unknown.\n", 365 mp->pixelformat); 366 mp->pixelformat = V4L2_PIX_FMT_YUYV; 367 fmt = vivid_get_format(dev, mp->pixelformat); 368 } 369 370 mp->field = vivid_field_out(dev, mp->field); 371 if (vivid_is_svid_out(dev)) { 372 w = 720; 373 h = (dev->std_out & V4L2_STD_525_60) ? 480 : 576; 374 } else { 375 w = dev->sink_rect.width; 376 h = dev->sink_rect.height; 377 } 378 if (V4L2_FIELD_HAS_T_OR_B(mp->field)) 379 factor = 2; 380 if (!dev->has_scaler_out && !dev->has_crop_out && !dev->has_compose_out) { 381 mp->width = w; 382 mp->height = h / factor; 383 } else { 384 struct v4l2_rect r = { 0, 0, mp->width, mp->height * factor }; 385 386 v4l2_rect_set_min_size(&r, &vivid_min_rect); 387 v4l2_rect_set_max_size(&r, &vivid_max_rect); 388 if (dev->has_scaler_out && !dev->has_crop_out) { 389 struct v4l2_rect max_r = { 0, 0, MAX_ZOOM * w, MAX_ZOOM * h }; 390 391 v4l2_rect_set_max_size(&r, &max_r); 392 } else if (!dev->has_scaler_out && dev->has_compose_out && !dev->has_crop_out) { 393 v4l2_rect_set_max_size(&r, &dev->sink_rect); 394 } else if (!dev->has_scaler_out && !dev->has_compose_out) { 395 v4l2_rect_set_min_size(&r, &dev->sink_rect); 396 } 397 mp->width = r.width; 398 mp->height = r.height / factor; 399 } 400 401 /* This driver supports custom bytesperline values */ 402 403 mp->num_planes = fmt->buffers; 404 for (p = 0; p < fmt->buffers; p++) { 405 /* Calculate the minimum supported bytesperline value */ 406 bytesperline = (mp->width * fmt->bit_depth[p]) >> 3; 407 /* Calculate the maximum supported bytesperline value */ 408 max_bpl = (MAX_ZOOM * MAX_WIDTH * fmt->bit_depth[p]) >> 3; 409 410 if (pfmt[p].bytesperline > max_bpl) 411 pfmt[p].bytesperline = max_bpl; 412 if (pfmt[p].bytesperline < bytesperline) 413 pfmt[p].bytesperline = bytesperline; 414 415 pfmt[p].sizeimage = (pfmt[p].bytesperline * mp->height) / 416 fmt->vdownsampling[p] + fmt->data_offset[p]; 417 418 memset(pfmt[p].reserved, 0, sizeof(pfmt[p].reserved)); 419 } 420 for (p = fmt->buffers; p < fmt->planes; p++) 421 pfmt[0].sizeimage += (pfmt[0].bytesperline * mp->height * 422 (fmt->bit_depth[p] / fmt->vdownsampling[p])) / 423 (fmt->bit_depth[0] / fmt->vdownsampling[0]); 424 425 mp->xfer_func = V4L2_XFER_FUNC_DEFAULT; 426 mp->ycbcr_enc = V4L2_YCBCR_ENC_DEFAULT; 427 mp->quantization = V4L2_QUANTIZATION_DEFAULT; 428 if (vivid_is_svid_out(dev)) { 429 mp->colorspace = V4L2_COLORSPACE_SMPTE170M; 430 } else if (dev->dvi_d_out || !(bt->flags & V4L2_DV_FL_IS_CE_VIDEO)) { 431 mp->colorspace = V4L2_COLORSPACE_SRGB; 432 if (dev->dvi_d_out) 433 mp->quantization = V4L2_QUANTIZATION_LIM_RANGE; 434 } else if (bt->width == 720 && bt->height <= 576) { 435 mp->colorspace = V4L2_COLORSPACE_SMPTE170M; 436 } else if (mp->colorspace != V4L2_COLORSPACE_SMPTE170M && 437 mp->colorspace != V4L2_COLORSPACE_REC709 && 438 mp->colorspace != V4L2_COLORSPACE_OPRGB && 439 mp->colorspace != V4L2_COLORSPACE_BT2020 && 440 mp->colorspace != V4L2_COLORSPACE_SRGB) { 441 mp->colorspace = V4L2_COLORSPACE_REC709; 442 } 443 memset(mp->reserved, 0, sizeof(mp->reserved)); 444 return 0; 445 } 446 447 int vivid_s_fmt_vid_out(struct file *file, void *priv, 448 struct v4l2_format *f) 449 { 450 struct v4l2_pix_format_mplane *mp = &f->fmt.pix_mp; 451 struct vivid_dev *dev = video_drvdata(file); 452 struct v4l2_rect *crop = &dev->crop_out; 453 struct v4l2_rect *compose = &dev->compose_out; 454 struct vb2_queue *q = &dev->vb_vid_out_q; 455 int ret = vivid_try_fmt_vid_out(file, priv, f); 456 unsigned factor = 1; 457 unsigned p; 458 459 if (ret < 0) 460 return ret; 461 462 if (vb2_is_busy(q) && 463 (vivid_is_svid_out(dev) || 464 mp->width != dev->fmt_out_rect.width || 465 mp->height != dev->fmt_out_rect.height || 466 mp->pixelformat != dev->fmt_out->fourcc || 467 mp->field != dev->field_out)) { 468 dprintk(dev, 1, "%s device busy\n", __func__); 469 return -EBUSY; 470 } 471 472 /* 473 * Allow for changing the colorspace on the fly. Useful for testing 474 * purposes, and it is something that HDMI transmitters are able 475 * to do. 476 */ 477 if (vb2_is_busy(q)) 478 goto set_colorspace; 479 480 dev->fmt_out = vivid_get_format(dev, mp->pixelformat); 481 if (V4L2_FIELD_HAS_T_OR_B(mp->field)) 482 factor = 2; 483 484 if (dev->has_scaler_out || dev->has_crop_out || dev->has_compose_out) { 485 struct v4l2_rect r = { 0, 0, mp->width, mp->height }; 486 487 if (dev->has_scaler_out) { 488 if (dev->has_crop_out) 489 v4l2_rect_map_inside(crop, &r); 490 else 491 *crop = r; 492 if (dev->has_compose_out && !dev->has_crop_out) { 493 struct v4l2_rect min_r = { 494 0, 0, 495 r.width / MAX_ZOOM, 496 factor * r.height / MAX_ZOOM 497 }; 498 struct v4l2_rect max_r = { 499 0, 0, 500 r.width * MAX_ZOOM, 501 factor * r.height * MAX_ZOOM 502 }; 503 504 v4l2_rect_set_min_size(compose, &min_r); 505 v4l2_rect_set_max_size(compose, &max_r); 506 v4l2_rect_map_inside(compose, &dev->compose_bounds_out); 507 } else if (dev->has_compose_out) { 508 struct v4l2_rect min_r = { 509 0, 0, 510 crop->width / MAX_ZOOM, 511 factor * crop->height / MAX_ZOOM 512 }; 513 struct v4l2_rect max_r = { 514 0, 0, 515 crop->width * MAX_ZOOM, 516 factor * crop->height * MAX_ZOOM 517 }; 518 519 v4l2_rect_set_min_size(compose, &min_r); 520 v4l2_rect_set_max_size(compose, &max_r); 521 v4l2_rect_map_inside(compose, &dev->compose_bounds_out); 522 } 523 } else if (dev->has_compose_out && !dev->has_crop_out) { 524 v4l2_rect_set_size_to(crop, &r); 525 r.height *= factor; 526 v4l2_rect_set_size_to(compose, &r); 527 v4l2_rect_map_inside(compose, &dev->compose_bounds_out); 528 } else if (!dev->has_compose_out) { 529 v4l2_rect_map_inside(crop, &r); 530 r.height /= factor; 531 v4l2_rect_set_size_to(compose, &r); 532 } else { 533 r.height *= factor; 534 v4l2_rect_set_max_size(compose, &r); 535 v4l2_rect_map_inside(compose, &dev->compose_bounds_out); 536 crop->top *= factor; 537 crop->height *= factor; 538 v4l2_rect_set_size_to(crop, compose); 539 v4l2_rect_map_inside(crop, &r); 540 crop->top /= factor; 541 crop->height /= factor; 542 } 543 } else { 544 struct v4l2_rect r = { 0, 0, mp->width, mp->height }; 545 546 v4l2_rect_set_size_to(crop, &r); 547 r.height /= factor; 548 v4l2_rect_set_size_to(compose, &r); 549 } 550 551 dev->fmt_out_rect.width = mp->width; 552 dev->fmt_out_rect.height = mp->height; 553 for (p = 0; p < mp->num_planes; p++) 554 dev->bytesperline_out[p] = mp->plane_fmt[p].bytesperline; 555 for (p = dev->fmt_out->buffers; p < dev->fmt_out->planes; p++) 556 dev->bytesperline_out[p] = 557 (dev->bytesperline_out[0] * dev->fmt_out->bit_depth[p]) / 558 dev->fmt_out->bit_depth[0]; 559 dev->field_out = mp->field; 560 if (vivid_is_svid_out(dev)) 561 dev->tv_field_out = mp->field; 562 563 set_colorspace: 564 dev->colorspace_out = mp->colorspace; 565 dev->xfer_func_out = mp->xfer_func; 566 dev->ycbcr_enc_out = mp->ycbcr_enc; 567 dev->quantization_out = mp->quantization; 568 if (dev->loop_video) { 569 vivid_send_source_change(dev, SVID); 570 vivid_send_source_change(dev, HDMI); 571 } 572 return 0; 573 } 574 575 int vidioc_g_fmt_vid_out_mplane(struct file *file, void *priv, 576 struct v4l2_format *f) 577 { 578 struct vivid_dev *dev = video_drvdata(file); 579 580 if (!dev->multiplanar) 581 return -ENOTTY; 582 return vivid_g_fmt_vid_out(file, priv, f); 583 } 584 585 int vidioc_try_fmt_vid_out_mplane(struct file *file, void *priv, 586 struct v4l2_format *f) 587 { 588 struct vivid_dev *dev = video_drvdata(file); 589 590 if (!dev->multiplanar) 591 return -ENOTTY; 592 return vivid_try_fmt_vid_out(file, priv, f); 593 } 594 595 int vidioc_s_fmt_vid_out_mplane(struct file *file, void *priv, 596 struct v4l2_format *f) 597 { 598 struct vivid_dev *dev = video_drvdata(file); 599 600 if (!dev->multiplanar) 601 return -ENOTTY; 602 return vivid_s_fmt_vid_out(file, priv, f); 603 } 604 605 int vidioc_g_fmt_vid_out(struct file *file, void *priv, 606 struct v4l2_format *f) 607 { 608 struct vivid_dev *dev = video_drvdata(file); 609 610 if (dev->multiplanar) 611 return -ENOTTY; 612 return fmt_sp2mp_func(file, priv, f, vivid_g_fmt_vid_out); 613 } 614 615 int vidioc_try_fmt_vid_out(struct file *file, void *priv, 616 struct v4l2_format *f) 617 { 618 struct vivid_dev *dev = video_drvdata(file); 619 620 if (dev->multiplanar) 621 return -ENOTTY; 622 return fmt_sp2mp_func(file, priv, f, vivid_try_fmt_vid_out); 623 } 624 625 int vidioc_s_fmt_vid_out(struct file *file, void *priv, 626 struct v4l2_format *f) 627 { 628 struct vivid_dev *dev = video_drvdata(file); 629 630 if (dev->multiplanar) 631 return -ENOTTY; 632 return fmt_sp2mp_func(file, priv, f, vivid_s_fmt_vid_out); 633 } 634 635 int vivid_vid_out_g_selection(struct file *file, void *priv, 636 struct v4l2_selection *sel) 637 { 638 struct vivid_dev *dev = video_drvdata(file); 639 640 if (!dev->has_crop_out && !dev->has_compose_out) 641 return -ENOTTY; 642 if (sel->type != V4L2_BUF_TYPE_VIDEO_OUTPUT) 643 return -EINVAL; 644 645 sel->r.left = sel->r.top = 0; 646 switch (sel->target) { 647 case V4L2_SEL_TGT_CROP: 648 if (!dev->has_crop_out) 649 return -EINVAL; 650 sel->r = dev->crop_out; 651 break; 652 case V4L2_SEL_TGT_CROP_DEFAULT: 653 if (!dev->has_crop_out) 654 return -EINVAL; 655 sel->r = dev->fmt_out_rect; 656 break; 657 case V4L2_SEL_TGT_CROP_BOUNDS: 658 if (!dev->has_crop_out) 659 return -EINVAL; 660 sel->r = vivid_max_rect; 661 break; 662 case V4L2_SEL_TGT_COMPOSE: 663 if (!dev->has_compose_out) 664 return -EINVAL; 665 sel->r = dev->compose_out; 666 break; 667 case V4L2_SEL_TGT_COMPOSE_DEFAULT: 668 case V4L2_SEL_TGT_COMPOSE_BOUNDS: 669 if (!dev->has_compose_out) 670 return -EINVAL; 671 sel->r = dev->sink_rect; 672 break; 673 default: 674 return -EINVAL; 675 } 676 return 0; 677 } 678 679 int vivid_vid_out_s_selection(struct file *file, void *fh, struct v4l2_selection *s) 680 { 681 struct vivid_dev *dev = video_drvdata(file); 682 struct v4l2_rect *crop = &dev->crop_out; 683 struct v4l2_rect *compose = &dev->compose_out; 684 unsigned factor = V4L2_FIELD_HAS_T_OR_B(dev->field_out) ? 2 : 1; 685 int ret; 686 687 if (!dev->has_crop_out && !dev->has_compose_out) 688 return -ENOTTY; 689 if (s->type != V4L2_BUF_TYPE_VIDEO_OUTPUT) 690 return -EINVAL; 691 692 switch (s->target) { 693 case V4L2_SEL_TGT_CROP: 694 if (!dev->has_crop_out) 695 return -EINVAL; 696 ret = vivid_vid_adjust_sel(s->flags, &s->r); 697 if (ret) 698 return ret; 699 v4l2_rect_set_min_size(&s->r, &vivid_min_rect); 700 v4l2_rect_set_max_size(&s->r, &dev->fmt_out_rect); 701 if (dev->has_scaler_out) { 702 struct v4l2_rect max_rect = { 703 0, 0, 704 dev->sink_rect.width * MAX_ZOOM, 705 (dev->sink_rect.height / factor) * MAX_ZOOM 706 }; 707 708 v4l2_rect_set_max_size(&s->r, &max_rect); 709 if (dev->has_compose_out) { 710 struct v4l2_rect min_rect = { 711 0, 0, 712 s->r.width / MAX_ZOOM, 713 (s->r.height * factor) / MAX_ZOOM 714 }; 715 struct v4l2_rect max_rect = { 716 0, 0, 717 s->r.width * MAX_ZOOM, 718 (s->r.height * factor) * MAX_ZOOM 719 }; 720 721 v4l2_rect_set_min_size(compose, &min_rect); 722 v4l2_rect_set_max_size(compose, &max_rect); 723 v4l2_rect_map_inside(compose, &dev->compose_bounds_out); 724 } 725 } else if (dev->has_compose_out) { 726 s->r.top *= factor; 727 s->r.height *= factor; 728 v4l2_rect_set_max_size(&s->r, &dev->sink_rect); 729 v4l2_rect_set_size_to(compose, &s->r); 730 v4l2_rect_map_inside(compose, &dev->compose_bounds_out); 731 s->r.top /= factor; 732 s->r.height /= factor; 733 } else { 734 v4l2_rect_set_size_to(&s->r, &dev->sink_rect); 735 s->r.height /= factor; 736 } 737 v4l2_rect_map_inside(&s->r, &dev->fmt_out_rect); 738 *crop = s->r; 739 break; 740 case V4L2_SEL_TGT_COMPOSE: 741 if (!dev->has_compose_out) 742 return -EINVAL; 743 ret = vivid_vid_adjust_sel(s->flags, &s->r); 744 if (ret) 745 return ret; 746 v4l2_rect_set_min_size(&s->r, &vivid_min_rect); 747 v4l2_rect_set_max_size(&s->r, &dev->sink_rect); 748 v4l2_rect_map_inside(&s->r, &dev->compose_bounds_out); 749 s->r.top /= factor; 750 s->r.height /= factor; 751 if (dev->has_scaler_out) { 752 struct v4l2_rect fmt = dev->fmt_out_rect; 753 struct v4l2_rect max_rect = { 754 0, 0, 755 s->r.width * MAX_ZOOM, 756 s->r.height * MAX_ZOOM 757 }; 758 struct v4l2_rect min_rect = { 759 0, 0, 760 s->r.width / MAX_ZOOM, 761 s->r.height / MAX_ZOOM 762 }; 763 764 v4l2_rect_set_min_size(&fmt, &min_rect); 765 if (!dev->has_crop_out) 766 v4l2_rect_set_max_size(&fmt, &max_rect); 767 if (!v4l2_rect_same_size(&dev->fmt_out_rect, &fmt) && 768 vb2_is_busy(&dev->vb_vid_out_q)) 769 return -EBUSY; 770 if (dev->has_crop_out) { 771 v4l2_rect_set_min_size(crop, &min_rect); 772 v4l2_rect_set_max_size(crop, &max_rect); 773 } 774 dev->fmt_out_rect = fmt; 775 } else if (dev->has_crop_out) { 776 struct v4l2_rect fmt = dev->fmt_out_rect; 777 778 v4l2_rect_set_min_size(&fmt, &s->r); 779 if (!v4l2_rect_same_size(&dev->fmt_out_rect, &fmt) && 780 vb2_is_busy(&dev->vb_vid_out_q)) 781 return -EBUSY; 782 dev->fmt_out_rect = fmt; 783 v4l2_rect_set_size_to(crop, &s->r); 784 v4l2_rect_map_inside(crop, &dev->fmt_out_rect); 785 } else { 786 if (!v4l2_rect_same_size(&s->r, &dev->fmt_out_rect) && 787 vb2_is_busy(&dev->vb_vid_out_q)) 788 return -EBUSY; 789 v4l2_rect_set_size_to(&dev->fmt_out_rect, &s->r); 790 v4l2_rect_set_size_to(crop, &s->r); 791 crop->height /= factor; 792 v4l2_rect_map_inside(crop, &dev->fmt_out_rect); 793 } 794 s->r.top *= factor; 795 s->r.height *= factor; 796 if (dev->bitmap_out && (compose->width != s->r.width || 797 compose->height != s->r.height)) { 798 vfree(dev->bitmap_out); 799 dev->bitmap_out = NULL; 800 } 801 *compose = s->r; 802 break; 803 default: 804 return -EINVAL; 805 } 806 807 return 0; 808 } 809 810 int vivid_vid_out_g_pixelaspect(struct file *file, void *priv, 811 int type, struct v4l2_fract *f) 812 { 813 struct vivid_dev *dev = video_drvdata(file); 814 815 if (type != V4L2_BUF_TYPE_VIDEO_OUTPUT) 816 return -EINVAL; 817 818 switch (vivid_get_pixel_aspect(dev)) { 819 case TPG_PIXEL_ASPECT_NTSC: 820 f->numerator = 11; 821 f->denominator = 10; 822 break; 823 case TPG_PIXEL_ASPECT_PAL: 824 f->numerator = 54; 825 f->denominator = 59; 826 break; 827 default: 828 break; 829 } 830 return 0; 831 } 832 833 int vidioc_g_fmt_vid_out_overlay(struct file *file, void *priv, 834 struct v4l2_format *f) 835 { 836 struct vivid_dev *dev = video_drvdata(file); 837 const struct v4l2_rect *compose = &dev->compose_out; 838 struct v4l2_window *win = &f->fmt.win; 839 unsigned clipcount = win->clipcount; 840 841 if (!dev->has_fb) 842 return -EINVAL; 843 win->w.top = dev->overlay_out_top; 844 win->w.left = dev->overlay_out_left; 845 win->w.width = compose->width; 846 win->w.height = compose->height; 847 win->clipcount = dev->clipcount_out; 848 win->field = V4L2_FIELD_ANY; 849 win->chromakey = dev->chromakey_out; 850 win->global_alpha = dev->global_alpha_out; 851 if (clipcount > dev->clipcount_out) 852 clipcount = dev->clipcount_out; 853 if (dev->bitmap_out == NULL) 854 win->bitmap = NULL; 855 else if (win->bitmap) { 856 if (copy_to_user(win->bitmap, dev->bitmap_out, 857 ((dev->compose_out.width + 7) / 8) * dev->compose_out.height)) 858 return -EFAULT; 859 } 860 if (clipcount && win->clips) 861 memcpy(win->clips, dev->clips_out, 862 clipcount * sizeof(dev->clips_out[0])); 863 return 0; 864 } 865 866 int vidioc_try_fmt_vid_out_overlay(struct file *file, void *priv, 867 struct v4l2_format *f) 868 { 869 struct vivid_dev *dev = video_drvdata(file); 870 const struct v4l2_rect *compose = &dev->compose_out; 871 struct v4l2_window *win = &f->fmt.win; 872 int i, j; 873 874 if (!dev->has_fb) 875 return -EINVAL; 876 win->w.left = clamp_t(int, win->w.left, 877 -dev->display_width, dev->display_width); 878 win->w.top = clamp_t(int, win->w.top, 879 -dev->display_height, dev->display_height); 880 win->w.width = compose->width; 881 win->w.height = compose->height; 882 /* 883 * It makes no sense for an OSD to overlay only top or bottom fields, 884 * so always set this to ANY. 885 */ 886 win->field = V4L2_FIELD_ANY; 887 if (win->clipcount && !win->clips) 888 win->clipcount = 0; 889 if (win->clipcount > MAX_CLIPS) 890 win->clipcount = MAX_CLIPS; 891 if (win->clipcount) { 892 memcpy(dev->try_clips_out, win->clips, 893 win->clipcount * sizeof(dev->clips_out[0])); 894 for (i = 0; i < win->clipcount; i++) { 895 struct v4l2_rect *r = &dev->try_clips_out[i].c; 896 897 r->top = clamp_t(s32, r->top, 0, dev->display_height - 1); 898 r->height = clamp_t(s32, r->height, 1, dev->display_height - r->top); 899 r->left = clamp_t(u32, r->left, 0, dev->display_width - 1); 900 r->width = clamp_t(u32, r->width, 1, dev->display_width - r->left); 901 } 902 /* 903 * Yeah, so sue me, it's an O(n^2) algorithm. But n is a small 904 * number and it's typically a one-time deal. 905 */ 906 for (i = 0; i < win->clipcount - 1; i++) { 907 struct v4l2_rect *r1 = &dev->try_clips_out[i].c; 908 909 for (j = i + 1; j < win->clipcount; j++) { 910 struct v4l2_rect *r2 = &dev->try_clips_out[j].c; 911 912 if (v4l2_rect_overlap(r1, r2)) 913 return -EINVAL; 914 } 915 } 916 memcpy(win->clips, dev->try_clips_out, 917 win->clipcount * sizeof(dev->clips_out[0])); 918 } 919 return 0; 920 } 921 922 int vidioc_s_fmt_vid_out_overlay(struct file *file, void *priv, 923 struct v4l2_format *f) 924 { 925 struct vivid_dev *dev = video_drvdata(file); 926 const struct v4l2_rect *compose = &dev->compose_out; 927 struct v4l2_window *win = &f->fmt.win; 928 int ret = vidioc_try_fmt_vid_out_overlay(file, priv, f); 929 unsigned bitmap_size = ((compose->width + 7) / 8) * compose->height; 930 unsigned clips_size = win->clipcount * sizeof(dev->clips_out[0]); 931 void *new_bitmap = NULL; 932 933 if (ret) 934 return ret; 935 936 if (win->bitmap) { 937 new_bitmap = vzalloc(bitmap_size); 938 939 if (!new_bitmap) 940 return -ENOMEM; 941 if (copy_from_user(new_bitmap, win->bitmap, bitmap_size)) { 942 vfree(new_bitmap); 943 return -EFAULT; 944 } 945 } 946 947 dev->overlay_out_top = win->w.top; 948 dev->overlay_out_left = win->w.left; 949 vfree(dev->bitmap_out); 950 dev->bitmap_out = new_bitmap; 951 dev->clipcount_out = win->clipcount; 952 if (dev->clipcount_out) 953 memcpy(dev->clips_out, dev->try_clips_out, clips_size); 954 dev->chromakey_out = win->chromakey; 955 dev->global_alpha_out = win->global_alpha; 956 return ret; 957 } 958 959 int vivid_vid_out_overlay(struct file *file, void *fh, unsigned i) 960 { 961 struct vivid_dev *dev = video_drvdata(file); 962 963 if (i && !dev->fmt_out->can_do_overlay) { 964 dprintk(dev, 1, "unsupported output format for output overlay\n"); 965 return -EINVAL; 966 } 967 968 dev->overlay_out_enabled = i; 969 return 0; 970 } 971 972 int vivid_vid_out_g_fbuf(struct file *file, void *fh, 973 struct v4l2_framebuffer *a) 974 { 975 struct vivid_dev *dev = video_drvdata(file); 976 977 a->capability = V4L2_FBUF_CAP_EXTERNOVERLAY | 978 V4L2_FBUF_CAP_BITMAP_CLIPPING | 979 V4L2_FBUF_CAP_LIST_CLIPPING | 980 V4L2_FBUF_CAP_CHROMAKEY | 981 V4L2_FBUF_CAP_SRC_CHROMAKEY | 982 V4L2_FBUF_CAP_GLOBAL_ALPHA | 983 V4L2_FBUF_CAP_LOCAL_ALPHA | 984 V4L2_FBUF_CAP_LOCAL_INV_ALPHA; 985 a->flags = V4L2_FBUF_FLAG_OVERLAY | dev->fbuf_out_flags; 986 a->base = (void *)dev->video_pbase; 987 a->fmt.width = dev->display_width; 988 a->fmt.height = dev->display_height; 989 if (dev->fb_defined.green.length == 5) 990 a->fmt.pixelformat = V4L2_PIX_FMT_ARGB555; 991 else 992 a->fmt.pixelformat = V4L2_PIX_FMT_RGB565; 993 a->fmt.bytesperline = dev->display_byte_stride; 994 a->fmt.sizeimage = a->fmt.height * a->fmt.bytesperline; 995 a->fmt.field = V4L2_FIELD_NONE; 996 a->fmt.colorspace = V4L2_COLORSPACE_SRGB; 997 a->fmt.priv = 0; 998 return 0; 999 } 1000 1001 int vivid_vid_out_s_fbuf(struct file *file, void *fh, 1002 const struct v4l2_framebuffer *a) 1003 { 1004 struct vivid_dev *dev = video_drvdata(file); 1005 const unsigned chroma_flags = V4L2_FBUF_FLAG_CHROMAKEY | 1006 V4L2_FBUF_FLAG_SRC_CHROMAKEY; 1007 const unsigned alpha_flags = V4L2_FBUF_FLAG_GLOBAL_ALPHA | 1008 V4L2_FBUF_FLAG_LOCAL_ALPHA | 1009 V4L2_FBUF_FLAG_LOCAL_INV_ALPHA; 1010 1011 1012 if ((a->flags & chroma_flags) == chroma_flags) 1013 return -EINVAL; 1014 switch (a->flags & alpha_flags) { 1015 case 0: 1016 case V4L2_FBUF_FLAG_GLOBAL_ALPHA: 1017 case V4L2_FBUF_FLAG_LOCAL_ALPHA: 1018 case V4L2_FBUF_FLAG_LOCAL_INV_ALPHA: 1019 break; 1020 default: 1021 return -EINVAL; 1022 } 1023 dev->fbuf_out_flags &= ~(chroma_flags | alpha_flags); 1024 dev->fbuf_out_flags |= a->flags & (chroma_flags | alpha_flags); 1025 return 0; 1026 } 1027 1028 static const struct v4l2_audioout vivid_audio_outputs[] = { 1029 { 0, "Line-Out 1" }, 1030 { 1, "Line-Out 2" }, 1031 }; 1032 1033 int vidioc_enum_output(struct file *file, void *priv, 1034 struct v4l2_output *out) 1035 { 1036 struct vivid_dev *dev = video_drvdata(file); 1037 1038 if (out->index >= dev->num_outputs) 1039 return -EINVAL; 1040 1041 out->type = V4L2_OUTPUT_TYPE_ANALOG; 1042 switch (dev->output_type[out->index]) { 1043 case SVID: 1044 snprintf(out->name, sizeof(out->name), "S-Video %u", 1045 dev->output_name_counter[out->index]); 1046 out->std = V4L2_STD_ALL; 1047 if (dev->has_audio_outputs) 1048 out->audioset = (1 << ARRAY_SIZE(vivid_audio_outputs)) - 1; 1049 out->capabilities = V4L2_OUT_CAP_STD; 1050 break; 1051 case HDMI: 1052 snprintf(out->name, sizeof(out->name), "HDMI %u", 1053 dev->output_name_counter[out->index]); 1054 out->capabilities = V4L2_OUT_CAP_DV_TIMINGS; 1055 break; 1056 } 1057 return 0; 1058 } 1059 1060 int vidioc_g_output(struct file *file, void *priv, unsigned *o) 1061 { 1062 struct vivid_dev *dev = video_drvdata(file); 1063 1064 *o = dev->output; 1065 return 0; 1066 } 1067 1068 int vidioc_s_output(struct file *file, void *priv, unsigned o) 1069 { 1070 struct vivid_dev *dev = video_drvdata(file); 1071 1072 if (o >= dev->num_outputs) 1073 return -EINVAL; 1074 1075 if (o == dev->output) 1076 return 0; 1077 1078 if (vb2_is_busy(&dev->vb_vid_out_q) || 1079 vb2_is_busy(&dev->vb_vbi_out_q) || 1080 vb2_is_busy(&dev->vb_meta_out_q)) 1081 return -EBUSY; 1082 1083 dev->output = o; 1084 dev->tv_audio_output = 0; 1085 if (dev->output_type[o] == SVID) 1086 dev->vid_out_dev.tvnorms = V4L2_STD_ALL; 1087 else 1088 dev->vid_out_dev.tvnorms = 0; 1089 1090 dev->vbi_out_dev.tvnorms = dev->vid_out_dev.tvnorms; 1091 dev->meta_out_dev.tvnorms = dev->vid_out_dev.tvnorms; 1092 vivid_update_format_out(dev); 1093 1094 v4l2_ctrl_activate(dev->ctrl_display_present, vivid_is_hdmi_out(dev)); 1095 if (vivid_is_hdmi_out(dev)) 1096 v4l2_ctrl_s_ctrl(dev->ctrl_display_present, 1097 dev->display_present[dev->output]); 1098 1099 return 0; 1100 } 1101 1102 int vidioc_enumaudout(struct file *file, void *fh, struct v4l2_audioout *vout) 1103 { 1104 if (vout->index >= ARRAY_SIZE(vivid_audio_outputs)) 1105 return -EINVAL; 1106 *vout = vivid_audio_outputs[vout->index]; 1107 return 0; 1108 } 1109 1110 int vidioc_g_audout(struct file *file, void *fh, struct v4l2_audioout *vout) 1111 { 1112 struct vivid_dev *dev = video_drvdata(file); 1113 1114 if (!vivid_is_svid_out(dev)) 1115 return -EINVAL; 1116 *vout = vivid_audio_outputs[dev->tv_audio_output]; 1117 return 0; 1118 } 1119 1120 int vidioc_s_audout(struct file *file, void *fh, const struct v4l2_audioout *vout) 1121 { 1122 struct vivid_dev *dev = video_drvdata(file); 1123 1124 if (!vivid_is_svid_out(dev)) 1125 return -EINVAL; 1126 if (vout->index >= ARRAY_SIZE(vivid_audio_outputs)) 1127 return -EINVAL; 1128 dev->tv_audio_output = vout->index; 1129 return 0; 1130 } 1131 1132 int vivid_vid_out_s_std(struct file *file, void *priv, v4l2_std_id id) 1133 { 1134 struct vivid_dev *dev = video_drvdata(file); 1135 1136 if (!vivid_is_svid_out(dev)) 1137 return -ENODATA; 1138 if (dev->std_out == id) 1139 return 0; 1140 if (vb2_is_busy(&dev->vb_vid_out_q) || vb2_is_busy(&dev->vb_vbi_out_q)) 1141 return -EBUSY; 1142 dev->std_out = id; 1143 vivid_update_format_out(dev); 1144 return 0; 1145 } 1146 1147 static bool valid_cvt_gtf_timings(struct v4l2_dv_timings *timings) 1148 { 1149 struct v4l2_bt_timings *bt = &timings->bt; 1150 1151 if ((bt->standards & (V4L2_DV_BT_STD_CVT | V4L2_DV_BT_STD_GTF)) && 1152 v4l2_valid_dv_timings(timings, &vivid_dv_timings_cap, NULL, NULL)) 1153 return true; 1154 1155 return false; 1156 } 1157 1158 int vivid_vid_out_s_dv_timings(struct file *file, void *_fh, 1159 struct v4l2_dv_timings *timings) 1160 { 1161 struct vivid_dev *dev = video_drvdata(file); 1162 if (!vivid_is_hdmi_out(dev)) 1163 return -ENODATA; 1164 if (!v4l2_find_dv_timings_cap(timings, &vivid_dv_timings_cap, 1165 0, NULL, NULL) && 1166 !valid_cvt_gtf_timings(timings)) 1167 return -EINVAL; 1168 if (v4l2_match_dv_timings(timings, &dev->dv_timings_out, 0, true)) 1169 return 0; 1170 if (vb2_is_busy(&dev->vb_vid_out_q)) 1171 return -EBUSY; 1172 dev->dv_timings_out = *timings; 1173 vivid_update_format_out(dev); 1174 return 0; 1175 } 1176 1177 int vivid_vid_out_g_parm(struct file *file, void *priv, 1178 struct v4l2_streamparm *parm) 1179 { 1180 struct vivid_dev *dev = video_drvdata(file); 1181 1182 if (parm->type != (dev->multiplanar ? 1183 V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE : 1184 V4L2_BUF_TYPE_VIDEO_OUTPUT)) 1185 return -EINVAL; 1186 1187 parm->parm.output.capability = V4L2_CAP_TIMEPERFRAME; 1188 parm->parm.output.timeperframe = dev->timeperframe_vid_out; 1189 parm->parm.output.writebuffers = 1; 1190 1191 return 0; 1192 } 1193 1194 int vidioc_subscribe_event(struct v4l2_fh *fh, 1195 const struct v4l2_event_subscription *sub) 1196 { 1197 switch (sub->type) { 1198 case V4L2_EVENT_SOURCE_CHANGE: 1199 if (fh->vdev->vfl_dir == VFL_DIR_RX) 1200 return v4l2_src_change_event_subscribe(fh, sub); 1201 break; 1202 default: 1203 return v4l2_ctrl_subscribe_event(fh, sub); 1204 } 1205 return -EINVAL; 1206 } 1207