2 * vivid-vid-out.c - video output support functions.
4 * Copyright 2014 Cisco Systems, Inc. and/or its affiliates. All rights reserved.
6 * This program is free software; you may redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation; version 2 of the License.
10 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
11 * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
12 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
13 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
14 * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
15 * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
16 * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
20 #include <linux/errno.h>
21 #include <linux/kernel.h>
22 #include <linux/sched.h>
23 #include <linux/videodev2.h>
24 #include <linux/v4l2-dv-timings.h>
25 #include <media/v4l2-common.h>
26 #include <media/v4l2-event.h>
27 #include <media/v4l2-dv-timings.h>
28 #include <media/v4l2-rect.h>
30 #include "vivid-core.h"
31 #include "vivid-vid-common.h"
32 #include "vivid-kthread-out.h"
33 #include "vivid-vid-out.h"
35 static int vid_out_queue_setup(struct vb2_queue
*vq
,
36 unsigned *nbuffers
, unsigned *nplanes
,
37 unsigned sizes
[], struct device
*alloc_devs
[])
39 struct vivid_dev
*dev
= vb2_get_drv_priv(vq
);
40 const struct vivid_fmt
*vfmt
= dev
->fmt_out
;
41 unsigned planes
= vfmt
->buffers
;
42 unsigned h
= dev
->fmt_out_rect
.height
;
43 unsigned size
= dev
->bytesperline_out
[0] * h
;
46 for (p
= vfmt
->buffers
; p
< vfmt
->planes
; p
++)
47 size
+= dev
->bytesperline_out
[p
] * h
/ vfmt
->vdownsampling
[p
];
49 if (dev
->field_out
== V4L2_FIELD_ALTERNATE
) {
51 * You cannot use write() with FIELD_ALTERNATE since the field
52 * information (TOP/BOTTOM) cannot be passed to the kernel.
54 if (vb2_fileio_is_active(vq
))
58 if (dev
->queue_setup_error
) {
60 * Error injection: test what happens if queue_setup() returns
63 dev
->queue_setup_error
= false;
69 * Check if the number of requested planes match
70 * the number of planes in the current format. You can't mix that.
72 if (*nplanes
!= planes
)
76 for (p
= 1; p
< planes
; p
++) {
77 if (sizes
[p
] < dev
->bytesperline_out
[p
] * h
)
81 for (p
= 0; p
< planes
; p
++)
82 sizes
[p
] = p
? dev
->bytesperline_out
[p
] * h
: size
;
85 if (vq
->num_buffers
+ *nbuffers
< 2)
86 *nbuffers
= 2 - vq
->num_buffers
;
90 dprintk(dev
, 1, "%s: count=%d\n", __func__
, *nbuffers
);
91 for (p
= 0; p
< planes
; p
++)
92 dprintk(dev
, 1, "%s: size[%u]=%u\n", __func__
, p
, sizes
[p
]);
96 static int vid_out_buf_prepare(struct vb2_buffer
*vb
)
98 struct vb2_v4l2_buffer
*vbuf
= to_vb2_v4l2_buffer(vb
);
99 struct vivid_dev
*dev
= vb2_get_drv_priv(vb
->vb2_queue
);
104 dprintk(dev
, 1, "%s\n", __func__
);
106 if (WARN_ON(NULL
== dev
->fmt_out
))
109 planes
= dev
->fmt_out
->planes
;
111 if (dev
->buf_prepare_error
) {
113 * Error injection: test what happens if buf_prepare() returns
116 dev
->buf_prepare_error
= false;
120 if (dev
->field_out
!= V4L2_FIELD_ALTERNATE
)
121 vbuf
->field
= dev
->field_out
;
122 else if (vbuf
->field
!= V4L2_FIELD_TOP
&&
123 vbuf
->field
!= V4L2_FIELD_BOTTOM
)
126 for (p
= 0; p
< planes
; p
++) {
127 size
= dev
->bytesperline_out
[p
] * dev
->fmt_out_rect
.height
+
128 vb
->planes
[p
].data_offset
;
130 if (vb2_get_plane_payload(vb
, p
) < size
) {
131 dprintk(dev
, 1, "%s the payload is too small for plane %u (%lu < %lu)\n",
132 __func__
, p
, vb2_get_plane_payload(vb
, p
), size
);
140 static void vid_out_buf_queue(struct vb2_buffer
*vb
)
142 struct vb2_v4l2_buffer
*vbuf
= to_vb2_v4l2_buffer(vb
);
143 struct vivid_dev
*dev
= vb2_get_drv_priv(vb
->vb2_queue
);
144 struct vivid_buffer
*buf
= container_of(vbuf
, struct vivid_buffer
, vb
);
146 dprintk(dev
, 1, "%s\n", __func__
);
148 spin_lock(&dev
->slock
);
149 list_add_tail(&buf
->list
, &dev
->vid_out_active
);
150 spin_unlock(&dev
->slock
);
153 static int vid_out_start_streaming(struct vb2_queue
*vq
, unsigned count
)
155 struct vivid_dev
*dev
= vb2_get_drv_priv(vq
);
158 if (vb2_is_streaming(&dev
->vb_vid_cap_q
))
159 dev
->can_loop_video
= vivid_vid_can_loop(dev
);
161 if (dev
->kthread_vid_out
)
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;
170 err
= vivid_start_generating_vid_out(dev
, &dev
->vid_out_streaming
);
173 struct vivid_buffer
*buf
, *tmp
;
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
);
184 /* abort streaming and wait for last buffer */
185 static void vid_out_stop_streaming(struct vb2_queue
*vq
)
187 struct vivid_dev
*dev
= vb2_get_drv_priv(vq
);
189 dprintk(dev
, 1, "%s\n", __func__
);
190 vivid_stop_generating_vid_out(dev
, &dev
->vid_out_streaming
);
191 dev
->can_loop_video
= false;
194 const struct vb2_ops vivid_vid_out_qops
= {
195 .queue_setup
= vid_out_queue_setup
,
196 .buf_prepare
= vid_out_buf_prepare
,
197 .buf_queue
= vid_out_buf_queue
,
198 .start_streaming
= vid_out_start_streaming
,
199 .stop_streaming
= vid_out_stop_streaming
,
200 .wait_prepare
= vb2_ops_wait_prepare
,
201 .wait_finish
= vb2_ops_wait_finish
,
205 * Called whenever the format has to be reset which can occur when
206 * changing outputs, standard, timings, etc.
208 void vivid_update_format_out(struct vivid_dev
*dev
)
210 struct v4l2_bt_timings
*bt
= &dev
->dv_timings_out
.bt
;
214 switch (dev
->output_type
[dev
->output
]) {
217 dev
->field_out
= dev
->tv_field_out
;
218 dev
->sink_rect
.width
= 720;
219 if (dev
->std_out
& V4L2_STD_525_60
) {
220 dev
->sink_rect
.height
= 480;
221 dev
->timeperframe_vid_out
= (struct v4l2_fract
) { 1001, 30000 };
222 dev
->service_set_out
= V4L2_SLICED_CAPTION_525
;
224 dev
->sink_rect
.height
= 576;
225 dev
->timeperframe_vid_out
= (struct v4l2_fract
) { 1000, 25000 };
226 dev
->service_set_out
= V4L2_SLICED_WSS_625
| V4L2_SLICED_TELETEXT_B
;
228 dev
->colorspace_out
= V4L2_COLORSPACE_SMPTE170M
;
231 dev
->sink_rect
.width
= bt
->width
;
232 dev
->sink_rect
.height
= bt
->height
;
233 size
= V4L2_DV_BT_FRAME_WIDTH(bt
) * V4L2_DV_BT_FRAME_HEIGHT(bt
);
235 if (can_reduce_fps(bt
) && (bt
->flags
& V4L2_DV_FL_REDUCED_FPS
))
236 pixelclock
= div_u64(bt
->pixelclock
* 1000, 1001);
238 pixelclock
= bt
->pixelclock
;
240 dev
->timeperframe_vid_out
= (struct v4l2_fract
) {
241 size
/ 100, (u32
)pixelclock
/ 100
244 dev
->field_out
= V4L2_FIELD_ALTERNATE
;
246 dev
->field_out
= V4L2_FIELD_NONE
;
247 if (!dev
->dvi_d_out
&& (bt
->flags
& V4L2_DV_FL_IS_CE_VIDEO
)) {
248 if (bt
->width
== 720 && bt
->height
<= 576)
249 dev
->colorspace_out
= V4L2_COLORSPACE_SMPTE170M
;
251 dev
->colorspace_out
= V4L2_COLORSPACE_REC709
;
253 dev
->colorspace_out
= V4L2_COLORSPACE_SRGB
;
257 dev
->xfer_func_out
= V4L2_XFER_FUNC_DEFAULT
;
258 dev
->ycbcr_enc_out
= V4L2_YCBCR_ENC_DEFAULT
;
259 dev
->quantization_out
= V4L2_QUANTIZATION_DEFAULT
;
260 dev
->compose_out
= dev
->sink_rect
;
261 dev
->compose_bounds_out
= dev
->sink_rect
;
262 dev
->crop_out
= dev
->compose_out
;
263 if (V4L2_FIELD_HAS_T_OR_B(dev
->field_out
))
264 dev
->crop_out
.height
/= 2;
265 dev
->fmt_out_rect
= dev
->crop_out
;
266 for (p
= 0; p
< dev
->fmt_out
->planes
; p
++)
267 dev
->bytesperline_out
[p
] =
268 (dev
->sink_rect
.width
* dev
->fmt_out
->bit_depth
[p
]) / 8;
271 /* Map the field to something that is valid for the current output */
272 static enum v4l2_field
vivid_field_out(struct vivid_dev
*dev
, enum v4l2_field field
)
274 if (vivid_is_svid_out(dev
)) {
276 case V4L2_FIELD_INTERLACED_TB
:
277 case V4L2_FIELD_INTERLACED_BT
:
278 case V4L2_FIELD_SEQ_TB
:
279 case V4L2_FIELD_SEQ_BT
:
280 case V4L2_FIELD_ALTERNATE
:
282 case V4L2_FIELD_INTERLACED
:
284 return V4L2_FIELD_INTERLACED
;
287 if (vivid_is_hdmi_out(dev
))
288 return dev
->dv_timings_out
.bt
.interlaced
? V4L2_FIELD_ALTERNATE
:
290 return V4L2_FIELD_NONE
;
293 static enum tpg_pixel_aspect
vivid_get_pixel_aspect(const struct vivid_dev
*dev
)
295 if (vivid_is_svid_out(dev
))
296 return (dev
->std_out
& V4L2_STD_525_60
) ?
297 TPG_PIXEL_ASPECT_NTSC
: TPG_PIXEL_ASPECT_PAL
;
299 if (vivid_is_hdmi_out(dev
) &&
300 dev
->sink_rect
.width
== 720 && dev
->sink_rect
.height
<= 576)
301 return dev
->sink_rect
.height
== 480 ?
302 TPG_PIXEL_ASPECT_NTSC
: TPG_PIXEL_ASPECT_PAL
;
304 return TPG_PIXEL_ASPECT_SQUARE
;
307 int vivid_g_fmt_vid_out(struct file
*file
, void *priv
,
308 struct v4l2_format
*f
)
310 struct vivid_dev
*dev
= video_drvdata(file
);
311 struct v4l2_pix_format_mplane
*mp
= &f
->fmt
.pix_mp
;
312 const struct vivid_fmt
*fmt
= dev
->fmt_out
;
315 mp
->width
= dev
->fmt_out_rect
.width
;
316 mp
->height
= dev
->fmt_out_rect
.height
;
317 mp
->field
= dev
->field_out
;
318 mp
->pixelformat
= fmt
->fourcc
;
319 mp
->colorspace
= dev
->colorspace_out
;
320 mp
->xfer_func
= dev
->xfer_func_out
;
321 mp
->ycbcr_enc
= dev
->ycbcr_enc_out
;
322 mp
->quantization
= dev
->quantization_out
;
323 mp
->num_planes
= fmt
->buffers
;
324 for (p
= 0; p
< mp
->num_planes
; p
++) {
325 mp
->plane_fmt
[p
].bytesperline
= dev
->bytesperline_out
[p
];
326 mp
->plane_fmt
[p
].sizeimage
=
327 mp
->plane_fmt
[p
].bytesperline
* mp
->height
;
329 for (p
= fmt
->buffers
; p
< fmt
->planes
; p
++) {
330 unsigned stride
= dev
->bytesperline_out
[p
];
332 mp
->plane_fmt
[0].sizeimage
+=
333 (stride
* mp
->height
) / fmt
->vdownsampling
[p
];
338 int vivid_try_fmt_vid_out(struct file
*file
, void *priv
,
339 struct v4l2_format
*f
)
341 struct vivid_dev
*dev
= video_drvdata(file
);
342 struct v4l2_bt_timings
*bt
= &dev
->dv_timings_out
.bt
;
343 struct v4l2_pix_format_mplane
*mp
= &f
->fmt
.pix_mp
;
344 struct v4l2_plane_pix_format
*pfmt
= mp
->plane_fmt
;
345 const struct vivid_fmt
*fmt
;
346 unsigned bytesperline
, max_bpl
;
351 fmt
= vivid_get_format(dev
, mp
->pixelformat
);
353 dprintk(dev
, 1, "Fourcc format (0x%08x) unknown.\n",
355 mp
->pixelformat
= V4L2_PIX_FMT_YUYV
;
356 fmt
= vivid_get_format(dev
, mp
->pixelformat
);
359 mp
->field
= vivid_field_out(dev
, mp
->field
);
360 if (vivid_is_svid_out(dev
)) {
362 h
= (dev
->std_out
& V4L2_STD_525_60
) ? 480 : 576;
364 w
= dev
->sink_rect
.width
;
365 h
= dev
->sink_rect
.height
;
367 if (V4L2_FIELD_HAS_T_OR_B(mp
->field
))
369 if (!dev
->has_scaler_out
&& !dev
->has_crop_out
&& !dev
->has_compose_out
) {
371 mp
->height
= h
/ factor
;
373 struct v4l2_rect r
= { 0, 0, mp
->width
, mp
->height
* factor
};
375 v4l2_rect_set_min_size(&r
, &vivid_min_rect
);
376 v4l2_rect_set_max_size(&r
, &vivid_max_rect
);
377 if (dev
->has_scaler_out
&& !dev
->has_crop_out
) {
378 struct v4l2_rect max_r
= { 0, 0, MAX_ZOOM
* w
, MAX_ZOOM
* h
};
380 v4l2_rect_set_max_size(&r
, &max_r
);
381 } else if (!dev
->has_scaler_out
&& dev
->has_compose_out
&& !dev
->has_crop_out
) {
382 v4l2_rect_set_max_size(&r
, &dev
->sink_rect
);
383 } else if (!dev
->has_scaler_out
&& !dev
->has_compose_out
) {
384 v4l2_rect_set_min_size(&r
, &dev
->sink_rect
);
387 mp
->height
= r
.height
/ factor
;
390 /* This driver supports custom bytesperline values */
392 /* Calculate the minimum supported bytesperline value */
393 bytesperline
= (mp
->width
* fmt
->bit_depth
[0]) >> 3;
394 /* Calculate the maximum supported bytesperline value */
395 max_bpl
= (MAX_ZOOM
* MAX_WIDTH
* fmt
->bit_depth
[0]) >> 3;
396 mp
->num_planes
= fmt
->buffers
;
397 for (p
= 0; p
< mp
->num_planes
; p
++) {
398 if (pfmt
[p
].bytesperline
> max_bpl
)
399 pfmt
[p
].bytesperline
= max_bpl
;
400 if (pfmt
[p
].bytesperline
< bytesperline
)
401 pfmt
[p
].bytesperline
= bytesperline
;
402 pfmt
[p
].sizeimage
= pfmt
[p
].bytesperline
* mp
->height
;
403 memset(pfmt
[p
].reserved
, 0, sizeof(pfmt
[p
].reserved
));
405 for (p
= fmt
->buffers
; p
< fmt
->planes
; p
++)
406 pfmt
[0].sizeimage
+= (pfmt
[0].bytesperline
* fmt
->bit_depth
[p
]) /
407 (fmt
->bit_depth
[0] * fmt
->vdownsampling
[p
]);
408 mp
->xfer_func
= V4L2_XFER_FUNC_DEFAULT
;
409 mp
->ycbcr_enc
= V4L2_YCBCR_ENC_DEFAULT
;
410 mp
->quantization
= V4L2_QUANTIZATION_DEFAULT
;
411 if (vivid_is_svid_out(dev
)) {
412 mp
->colorspace
= V4L2_COLORSPACE_SMPTE170M
;
413 } else if (dev
->dvi_d_out
|| !(bt
->flags
& V4L2_DV_FL_IS_CE_VIDEO
)) {
414 mp
->colorspace
= V4L2_COLORSPACE_SRGB
;
416 mp
->quantization
= V4L2_QUANTIZATION_LIM_RANGE
;
417 } else if (bt
->width
== 720 && bt
->height
<= 576) {
418 mp
->colorspace
= V4L2_COLORSPACE_SMPTE170M
;
419 } else if (mp
->colorspace
!= V4L2_COLORSPACE_SMPTE170M
&&
420 mp
->colorspace
!= V4L2_COLORSPACE_REC709
&&
421 mp
->colorspace
!= V4L2_COLORSPACE_ADOBERGB
&&
422 mp
->colorspace
!= V4L2_COLORSPACE_BT2020
&&
423 mp
->colorspace
!= V4L2_COLORSPACE_SRGB
) {
424 mp
->colorspace
= V4L2_COLORSPACE_REC709
;
426 memset(mp
->reserved
, 0, sizeof(mp
->reserved
));
430 int vivid_s_fmt_vid_out(struct file
*file
, void *priv
,
431 struct v4l2_format
*f
)
433 struct v4l2_pix_format_mplane
*mp
= &f
->fmt
.pix_mp
;
434 struct vivid_dev
*dev
= video_drvdata(file
);
435 struct v4l2_rect
*crop
= &dev
->crop_out
;
436 struct v4l2_rect
*compose
= &dev
->compose_out
;
437 struct vb2_queue
*q
= &dev
->vb_vid_out_q
;
438 int ret
= vivid_try_fmt_vid_out(file
, priv
, f
);
445 if (vb2_is_busy(q
) &&
446 (vivid_is_svid_out(dev
) ||
447 mp
->width
!= dev
->fmt_out_rect
.width
||
448 mp
->height
!= dev
->fmt_out_rect
.height
||
449 mp
->pixelformat
!= dev
->fmt_out
->fourcc
||
450 mp
->field
!= dev
->field_out
)) {
451 dprintk(dev
, 1, "%s device busy\n", __func__
);
456 * Allow for changing the colorspace on the fly. Useful for testing
457 * purposes, and it is something that HDMI transmitters are able
463 dev
->fmt_out
= vivid_get_format(dev
, mp
->pixelformat
);
464 if (V4L2_FIELD_HAS_T_OR_B(mp
->field
))
467 if (dev
->has_scaler_out
|| dev
->has_crop_out
|| dev
->has_compose_out
) {
468 struct v4l2_rect r
= { 0, 0, mp
->width
, mp
->height
};
470 if (dev
->has_scaler_out
) {
471 if (dev
->has_crop_out
)
472 v4l2_rect_map_inside(crop
, &r
);
475 if (dev
->has_compose_out
&& !dev
->has_crop_out
) {
476 struct v4l2_rect min_r
= {
479 factor
* r
.height
/ MAX_ZOOM
481 struct v4l2_rect max_r
= {
484 factor
* r
.height
* MAX_ZOOM
487 v4l2_rect_set_min_size(compose
, &min_r
);
488 v4l2_rect_set_max_size(compose
, &max_r
);
489 v4l2_rect_map_inside(compose
, &dev
->compose_bounds_out
);
490 } else if (dev
->has_compose_out
) {
491 struct v4l2_rect min_r
= {
493 crop
->width
/ MAX_ZOOM
,
494 factor
* crop
->height
/ MAX_ZOOM
496 struct v4l2_rect max_r
= {
498 crop
->width
* MAX_ZOOM
,
499 factor
* crop
->height
* MAX_ZOOM
502 v4l2_rect_set_min_size(compose
, &min_r
);
503 v4l2_rect_set_max_size(compose
, &max_r
);
504 v4l2_rect_map_inside(compose
, &dev
->compose_bounds_out
);
506 } else if (dev
->has_compose_out
&& !dev
->has_crop_out
) {
507 v4l2_rect_set_size_to(crop
, &r
);
509 v4l2_rect_set_size_to(compose
, &r
);
510 v4l2_rect_map_inside(compose
, &dev
->compose_bounds_out
);
511 } else if (!dev
->has_compose_out
) {
512 v4l2_rect_map_inside(crop
, &r
);
514 v4l2_rect_set_size_to(compose
, &r
);
517 v4l2_rect_set_max_size(compose
, &r
);
518 v4l2_rect_map_inside(compose
, &dev
->compose_bounds_out
);
520 crop
->height
*= factor
;
521 v4l2_rect_set_size_to(crop
, compose
);
522 v4l2_rect_map_inside(crop
, &r
);
524 crop
->height
/= factor
;
527 struct v4l2_rect r
= { 0, 0, mp
->width
, mp
->height
};
529 v4l2_rect_set_size_to(crop
, &r
);
531 v4l2_rect_set_size_to(compose
, &r
);
534 dev
->fmt_out_rect
.width
= mp
->width
;
535 dev
->fmt_out_rect
.height
= mp
->height
;
536 for (p
= 0; p
< mp
->num_planes
; p
++)
537 dev
->bytesperline_out
[p
] = mp
->plane_fmt
[p
].bytesperline
;
538 for (p
= dev
->fmt_out
->buffers
; p
< dev
->fmt_out
->planes
; p
++)
539 dev
->bytesperline_out
[p
] =
540 (dev
->bytesperline_out
[0] * dev
->fmt_out
->bit_depth
[p
]) /
541 dev
->fmt_out
->bit_depth
[0];
542 dev
->field_out
= mp
->field
;
543 if (vivid_is_svid_out(dev
))
544 dev
->tv_field_out
= mp
->field
;
547 dev
->colorspace_out
= mp
->colorspace
;
548 dev
->xfer_func_out
= mp
->xfer_func
;
549 dev
->ycbcr_enc_out
= mp
->ycbcr_enc
;
550 dev
->quantization_out
= mp
->quantization
;
551 if (dev
->loop_video
) {
552 vivid_send_source_change(dev
, SVID
);
553 vivid_send_source_change(dev
, HDMI
);
558 int vidioc_g_fmt_vid_out_mplane(struct file
*file
, void *priv
,
559 struct v4l2_format
*f
)
561 struct vivid_dev
*dev
= video_drvdata(file
);
563 if (!dev
->multiplanar
)
565 return vivid_g_fmt_vid_out(file
, priv
, f
);
568 int vidioc_try_fmt_vid_out_mplane(struct file
*file
, void *priv
,
569 struct v4l2_format
*f
)
571 struct vivid_dev
*dev
= video_drvdata(file
);
573 if (!dev
->multiplanar
)
575 return vivid_try_fmt_vid_out(file
, priv
, f
);
578 int vidioc_s_fmt_vid_out_mplane(struct file
*file
, void *priv
,
579 struct v4l2_format
*f
)
581 struct vivid_dev
*dev
= video_drvdata(file
);
583 if (!dev
->multiplanar
)
585 return vivid_s_fmt_vid_out(file
, priv
, f
);
588 int vidioc_g_fmt_vid_out(struct file
*file
, void *priv
,
589 struct v4l2_format
*f
)
591 struct vivid_dev
*dev
= video_drvdata(file
);
593 if (dev
->multiplanar
)
595 return fmt_sp2mp_func(file
, priv
, f
, vivid_g_fmt_vid_out
);
598 int vidioc_try_fmt_vid_out(struct file
*file
, void *priv
,
599 struct v4l2_format
*f
)
601 struct vivid_dev
*dev
= video_drvdata(file
);
603 if (dev
->multiplanar
)
605 return fmt_sp2mp_func(file
, priv
, f
, vivid_try_fmt_vid_out
);
608 int vidioc_s_fmt_vid_out(struct file
*file
, void *priv
,
609 struct v4l2_format
*f
)
611 struct vivid_dev
*dev
= video_drvdata(file
);
613 if (dev
->multiplanar
)
615 return fmt_sp2mp_func(file
, priv
, f
, vivid_s_fmt_vid_out
);
618 int vivid_vid_out_g_selection(struct file
*file
, void *priv
,
619 struct v4l2_selection
*sel
)
621 struct vivid_dev
*dev
= video_drvdata(file
);
623 if (!dev
->has_crop_out
&& !dev
->has_compose_out
)
625 if (sel
->type
!= V4L2_BUF_TYPE_VIDEO_OUTPUT
)
628 sel
->r
.left
= sel
->r
.top
= 0;
629 switch (sel
->target
) {
630 case V4L2_SEL_TGT_CROP
:
631 if (!dev
->has_crop_out
)
633 sel
->r
= dev
->crop_out
;
635 case V4L2_SEL_TGT_CROP_DEFAULT
:
636 if (!dev
->has_crop_out
)
638 sel
->r
= dev
->fmt_out_rect
;
640 case V4L2_SEL_TGT_CROP_BOUNDS
:
641 if (!dev
->has_crop_out
)
643 sel
->r
= vivid_max_rect
;
645 case V4L2_SEL_TGT_COMPOSE
:
646 if (!dev
->has_compose_out
)
648 sel
->r
= dev
->compose_out
;
650 case V4L2_SEL_TGT_COMPOSE_DEFAULT
:
651 case V4L2_SEL_TGT_COMPOSE_BOUNDS
:
652 if (!dev
->has_compose_out
)
654 sel
->r
= dev
->sink_rect
;
662 int vivid_vid_out_s_selection(struct file
*file
, void *fh
, struct v4l2_selection
*s
)
664 struct vivid_dev
*dev
= video_drvdata(file
);
665 struct v4l2_rect
*crop
= &dev
->crop_out
;
666 struct v4l2_rect
*compose
= &dev
->compose_out
;
667 unsigned factor
= V4L2_FIELD_HAS_T_OR_B(dev
->field_out
) ? 2 : 1;
670 if (!dev
->has_crop_out
&& !dev
->has_compose_out
)
672 if (s
->type
!= V4L2_BUF_TYPE_VIDEO_OUTPUT
)
676 case V4L2_SEL_TGT_CROP
:
677 if (!dev
->has_crop_out
)
679 ret
= vivid_vid_adjust_sel(s
->flags
, &s
->r
);
682 v4l2_rect_set_min_size(&s
->r
, &vivid_min_rect
);
683 v4l2_rect_set_max_size(&s
->r
, &dev
->fmt_out_rect
);
684 if (dev
->has_scaler_out
) {
685 struct v4l2_rect max_rect
= {
687 dev
->sink_rect
.width
* MAX_ZOOM
,
688 (dev
->sink_rect
.height
/ factor
) * MAX_ZOOM
691 v4l2_rect_set_max_size(&s
->r
, &max_rect
);
692 if (dev
->has_compose_out
) {
693 struct v4l2_rect min_rect
= {
695 s
->r
.width
/ MAX_ZOOM
,
696 (s
->r
.height
* factor
) / MAX_ZOOM
698 struct v4l2_rect max_rect
= {
700 s
->r
.width
* MAX_ZOOM
,
701 (s
->r
.height
* factor
) * MAX_ZOOM
704 v4l2_rect_set_min_size(compose
, &min_rect
);
705 v4l2_rect_set_max_size(compose
, &max_rect
);
706 v4l2_rect_map_inside(compose
, &dev
->compose_bounds_out
);
708 } else if (dev
->has_compose_out
) {
710 s
->r
.height
*= factor
;
711 v4l2_rect_set_max_size(&s
->r
, &dev
->sink_rect
);
712 v4l2_rect_set_size_to(compose
, &s
->r
);
713 v4l2_rect_map_inside(compose
, &dev
->compose_bounds_out
);
715 s
->r
.height
/= factor
;
717 v4l2_rect_set_size_to(&s
->r
, &dev
->sink_rect
);
718 s
->r
.height
/= factor
;
720 v4l2_rect_map_inside(&s
->r
, &dev
->fmt_out_rect
);
723 case V4L2_SEL_TGT_COMPOSE
:
724 if (!dev
->has_compose_out
)
726 ret
= vivid_vid_adjust_sel(s
->flags
, &s
->r
);
729 v4l2_rect_set_min_size(&s
->r
, &vivid_min_rect
);
730 v4l2_rect_set_max_size(&s
->r
, &dev
->sink_rect
);
731 v4l2_rect_map_inside(&s
->r
, &dev
->compose_bounds_out
);
733 s
->r
.height
/= factor
;
734 if (dev
->has_scaler_out
) {
735 struct v4l2_rect fmt
= dev
->fmt_out_rect
;
736 struct v4l2_rect max_rect
= {
738 s
->r
.width
* MAX_ZOOM
,
739 s
->r
.height
* MAX_ZOOM
741 struct v4l2_rect min_rect
= {
743 s
->r
.width
/ MAX_ZOOM
,
744 s
->r
.height
/ MAX_ZOOM
747 v4l2_rect_set_min_size(&fmt
, &min_rect
);
748 if (!dev
->has_crop_out
)
749 v4l2_rect_set_max_size(&fmt
, &max_rect
);
750 if (!v4l2_rect_same_size(&dev
->fmt_out_rect
, &fmt
) &&
751 vb2_is_busy(&dev
->vb_vid_out_q
))
753 if (dev
->has_crop_out
) {
754 v4l2_rect_set_min_size(crop
, &min_rect
);
755 v4l2_rect_set_max_size(crop
, &max_rect
);
757 dev
->fmt_out_rect
= fmt
;
758 } else if (dev
->has_crop_out
) {
759 struct v4l2_rect fmt
= dev
->fmt_out_rect
;
761 v4l2_rect_set_min_size(&fmt
, &s
->r
);
762 if (!v4l2_rect_same_size(&dev
->fmt_out_rect
, &fmt
) &&
763 vb2_is_busy(&dev
->vb_vid_out_q
))
765 dev
->fmt_out_rect
= fmt
;
766 v4l2_rect_set_size_to(crop
, &s
->r
);
767 v4l2_rect_map_inside(crop
, &dev
->fmt_out_rect
);
769 if (!v4l2_rect_same_size(&s
->r
, &dev
->fmt_out_rect
) &&
770 vb2_is_busy(&dev
->vb_vid_out_q
))
772 v4l2_rect_set_size_to(&dev
->fmt_out_rect
, &s
->r
);
773 v4l2_rect_set_size_to(crop
, &s
->r
);
774 crop
->height
/= factor
;
775 v4l2_rect_map_inside(crop
, &dev
->fmt_out_rect
);
778 s
->r
.height
*= factor
;
779 if (dev
->bitmap_out
&& (compose
->width
!= s
->r
.width
||
780 compose
->height
!= s
->r
.height
)) {
781 kfree(dev
->bitmap_out
);
782 dev
->bitmap_out
= NULL
;
793 int vivid_vid_out_cropcap(struct file
*file
, void *priv
,
794 struct v4l2_cropcap
*cap
)
796 struct vivid_dev
*dev
= video_drvdata(file
);
798 if (cap
->type
!= V4L2_BUF_TYPE_VIDEO_OUTPUT
)
801 switch (vivid_get_pixel_aspect(dev
)) {
802 case TPG_PIXEL_ASPECT_NTSC
:
803 cap
->pixelaspect
.numerator
= 11;
804 cap
->pixelaspect
.denominator
= 10;
806 case TPG_PIXEL_ASPECT_PAL
:
807 cap
->pixelaspect
.numerator
= 54;
808 cap
->pixelaspect
.denominator
= 59;
810 case TPG_PIXEL_ASPECT_SQUARE
:
811 cap
->pixelaspect
.numerator
= 1;
812 cap
->pixelaspect
.denominator
= 1;
818 int vidioc_g_fmt_vid_out_overlay(struct file
*file
, void *priv
,
819 struct v4l2_format
*f
)
821 struct vivid_dev
*dev
= video_drvdata(file
);
822 const struct v4l2_rect
*compose
= &dev
->compose_out
;
823 struct v4l2_window
*win
= &f
->fmt
.win
;
824 unsigned clipcount
= win
->clipcount
;
828 win
->w
.top
= dev
->overlay_out_top
;
829 win
->w
.left
= dev
->overlay_out_left
;
830 win
->w
.width
= compose
->width
;
831 win
->w
.height
= compose
->height
;
832 win
->clipcount
= dev
->clipcount_out
;
833 win
->field
= V4L2_FIELD_ANY
;
834 win
->chromakey
= dev
->chromakey_out
;
835 win
->global_alpha
= dev
->global_alpha_out
;
836 if (clipcount
> dev
->clipcount_out
)
837 clipcount
= dev
->clipcount_out
;
838 if (dev
->bitmap_out
== NULL
)
840 else if (win
->bitmap
) {
841 if (copy_to_user(win
->bitmap
, dev
->bitmap_out
,
842 ((dev
->compose_out
.width
+ 7) / 8) * dev
->compose_out
.height
))
845 if (clipcount
&& win
->clips
) {
846 if (copy_to_user(win
->clips
, dev
->clips_out
,
847 clipcount
* sizeof(dev
->clips_out
[0])))
853 int vidioc_try_fmt_vid_out_overlay(struct file
*file
, void *priv
,
854 struct v4l2_format
*f
)
856 struct vivid_dev
*dev
= video_drvdata(file
);
857 const struct v4l2_rect
*compose
= &dev
->compose_out
;
858 struct v4l2_window
*win
= &f
->fmt
.win
;
863 win
->w
.left
= clamp_t(int, win
->w
.left
,
864 -dev
->display_width
, dev
->display_width
);
865 win
->w
.top
= clamp_t(int, win
->w
.top
,
866 -dev
->display_height
, dev
->display_height
);
867 win
->w
.width
= compose
->width
;
868 win
->w
.height
= compose
->height
;
870 * It makes no sense for an OSD to overlay only top or bottom fields,
871 * so always set this to ANY.
873 win
->field
= V4L2_FIELD_ANY
;
874 if (win
->clipcount
&& !win
->clips
)
876 if (win
->clipcount
> MAX_CLIPS
)
877 win
->clipcount
= MAX_CLIPS
;
878 if (win
->clipcount
) {
879 if (copy_from_user(dev
->try_clips_out
, win
->clips
,
880 win
->clipcount
* sizeof(dev
->clips_out
[0])))
882 for (i
= 0; i
< win
->clipcount
; i
++) {
883 struct v4l2_rect
*r
= &dev
->try_clips_out
[i
].c
;
885 r
->top
= clamp_t(s32
, r
->top
, 0, dev
->display_height
- 1);
886 r
->height
= clamp_t(s32
, r
->height
, 1, dev
->display_height
- r
->top
);
887 r
->left
= clamp_t(u32
, r
->left
, 0, dev
->display_width
- 1);
888 r
->width
= clamp_t(u32
, r
->width
, 1, dev
->display_width
- r
->left
);
891 * Yeah, so sue me, it's an O(n^2) algorithm. But n is a small
892 * number and it's typically a one-time deal.
894 for (i
= 0; i
< win
->clipcount
- 1; i
++) {
895 struct v4l2_rect
*r1
= &dev
->try_clips_out
[i
].c
;
897 for (j
= i
+ 1; j
< win
->clipcount
; j
++) {
898 struct v4l2_rect
*r2
= &dev
->try_clips_out
[j
].c
;
900 if (v4l2_rect_overlap(r1
, r2
))
904 if (copy_to_user(win
->clips
, dev
->try_clips_out
,
905 win
->clipcount
* sizeof(dev
->clips_out
[0])))
911 int vidioc_s_fmt_vid_out_overlay(struct file
*file
, void *priv
,
912 struct v4l2_format
*f
)
914 struct vivid_dev
*dev
= video_drvdata(file
);
915 const struct v4l2_rect
*compose
= &dev
->compose_out
;
916 struct v4l2_window
*win
= &f
->fmt
.win
;
917 int ret
= vidioc_try_fmt_vid_out_overlay(file
, priv
, f
);
918 unsigned bitmap_size
= ((compose
->width
+ 7) / 8) * compose
->height
;
919 unsigned clips_size
= win
->clipcount
* sizeof(dev
->clips_out
[0]);
920 void *new_bitmap
= NULL
;
926 new_bitmap
= memdup_user(win
->bitmap
, bitmap_size
);
928 if (IS_ERR(new_bitmap
))
929 return PTR_ERR(new_bitmap
);
932 dev
->overlay_out_top
= win
->w
.top
;
933 dev
->overlay_out_left
= win
->w
.left
;
934 kfree(dev
->bitmap_out
);
935 dev
->bitmap_out
= new_bitmap
;
936 dev
->clipcount_out
= win
->clipcount
;
937 if (dev
->clipcount_out
)
938 memcpy(dev
->clips_out
, dev
->try_clips_out
, clips_size
);
939 dev
->chromakey_out
= win
->chromakey
;
940 dev
->global_alpha_out
= win
->global_alpha
;
944 int vivid_vid_out_overlay(struct file
*file
, void *fh
, unsigned i
)
946 struct vivid_dev
*dev
= video_drvdata(file
);
948 if (i
&& !dev
->fmt_out
->can_do_overlay
) {
949 dprintk(dev
, 1, "unsupported output format for output overlay\n");
953 dev
->overlay_out_enabled
= i
;
957 int vivid_vid_out_g_fbuf(struct file
*file
, void *fh
,
958 struct v4l2_framebuffer
*a
)
960 struct vivid_dev
*dev
= video_drvdata(file
);
962 a
->capability
= V4L2_FBUF_CAP_EXTERNOVERLAY
|
963 V4L2_FBUF_CAP_BITMAP_CLIPPING
|
964 V4L2_FBUF_CAP_LIST_CLIPPING
|
965 V4L2_FBUF_CAP_CHROMAKEY
|
966 V4L2_FBUF_CAP_SRC_CHROMAKEY
|
967 V4L2_FBUF_CAP_GLOBAL_ALPHA
|
968 V4L2_FBUF_CAP_LOCAL_ALPHA
|
969 V4L2_FBUF_CAP_LOCAL_INV_ALPHA
;
970 a
->flags
= V4L2_FBUF_FLAG_OVERLAY
| dev
->fbuf_out_flags
;
971 a
->base
= (void *)dev
->video_pbase
;
972 a
->fmt
.width
= dev
->display_width
;
973 a
->fmt
.height
= dev
->display_height
;
974 if (dev
->fb_defined
.green
.length
== 5)
975 a
->fmt
.pixelformat
= V4L2_PIX_FMT_ARGB555
;
977 a
->fmt
.pixelformat
= V4L2_PIX_FMT_RGB565
;
978 a
->fmt
.bytesperline
= dev
->display_byte_stride
;
979 a
->fmt
.sizeimage
= a
->fmt
.height
* a
->fmt
.bytesperline
;
980 a
->fmt
.field
= V4L2_FIELD_NONE
;
981 a
->fmt
.colorspace
= V4L2_COLORSPACE_SRGB
;
986 int vivid_vid_out_s_fbuf(struct file
*file
, void *fh
,
987 const struct v4l2_framebuffer
*a
)
989 struct vivid_dev
*dev
= video_drvdata(file
);
990 const unsigned chroma_flags
= V4L2_FBUF_FLAG_CHROMAKEY
|
991 V4L2_FBUF_FLAG_SRC_CHROMAKEY
;
992 const unsigned alpha_flags
= V4L2_FBUF_FLAG_GLOBAL_ALPHA
|
993 V4L2_FBUF_FLAG_LOCAL_ALPHA
|
994 V4L2_FBUF_FLAG_LOCAL_INV_ALPHA
;
997 if ((a
->flags
& chroma_flags
) == chroma_flags
)
999 switch (a
->flags
& alpha_flags
) {
1001 case V4L2_FBUF_FLAG_GLOBAL_ALPHA
:
1002 case V4L2_FBUF_FLAG_LOCAL_ALPHA
:
1003 case V4L2_FBUF_FLAG_LOCAL_INV_ALPHA
:
1008 dev
->fbuf_out_flags
&= ~(chroma_flags
| alpha_flags
);
1009 dev
->fbuf_out_flags
= a
->flags
& (chroma_flags
| alpha_flags
);
1013 static const struct v4l2_audioout vivid_audio_outputs
[] = {
1014 { 0, "Line-Out 1" },
1015 { 1, "Line-Out 2" },
1018 int vidioc_enum_output(struct file
*file
, void *priv
,
1019 struct v4l2_output
*out
)
1021 struct vivid_dev
*dev
= video_drvdata(file
);
1023 if (out
->index
>= dev
->num_outputs
)
1026 out
->type
= V4L2_OUTPUT_TYPE_ANALOG
;
1027 switch (dev
->output_type
[out
->index
]) {
1029 snprintf(out
->name
, sizeof(out
->name
), "S-Video %u",
1030 dev
->output_name_counter
[out
->index
]);
1031 out
->std
= V4L2_STD_ALL
;
1032 if (dev
->has_audio_outputs
)
1033 out
->audioset
= (1 << ARRAY_SIZE(vivid_audio_outputs
)) - 1;
1034 out
->capabilities
= V4L2_OUT_CAP_STD
;
1037 snprintf(out
->name
, sizeof(out
->name
), "HDMI %u",
1038 dev
->output_name_counter
[out
->index
]);
1039 out
->capabilities
= V4L2_OUT_CAP_DV_TIMINGS
;
1045 int vidioc_g_output(struct file
*file
, void *priv
, unsigned *o
)
1047 struct vivid_dev
*dev
= video_drvdata(file
);
1053 int vidioc_s_output(struct file
*file
, void *priv
, unsigned o
)
1055 struct vivid_dev
*dev
= video_drvdata(file
);
1057 if (o
>= dev
->num_outputs
)
1060 if (o
== dev
->output
)
1063 if (vb2_is_busy(&dev
->vb_vid_out_q
) || vb2_is_busy(&dev
->vb_vbi_out_q
))
1067 dev
->tv_audio_output
= 0;
1068 if (dev
->output_type
[o
] == SVID
)
1069 dev
->vid_out_dev
.tvnorms
= V4L2_STD_ALL
;
1071 dev
->vid_out_dev
.tvnorms
= 0;
1073 dev
->vbi_out_dev
.tvnorms
= dev
->vid_out_dev
.tvnorms
;
1074 vivid_update_format_out(dev
);
1078 int vidioc_enumaudout(struct file
*file
, void *fh
, struct v4l2_audioout
*vout
)
1080 if (vout
->index
>= ARRAY_SIZE(vivid_audio_outputs
))
1082 *vout
= vivid_audio_outputs
[vout
->index
];
1086 int vidioc_g_audout(struct file
*file
, void *fh
, struct v4l2_audioout
*vout
)
1088 struct vivid_dev
*dev
= video_drvdata(file
);
1090 if (!vivid_is_svid_out(dev
))
1092 *vout
= vivid_audio_outputs
[dev
->tv_audio_output
];
1096 int vidioc_s_audout(struct file
*file
, void *fh
, const struct v4l2_audioout
*vout
)
1098 struct vivid_dev
*dev
= video_drvdata(file
);
1100 if (!vivid_is_svid_out(dev
))
1102 if (vout
->index
>= ARRAY_SIZE(vivid_audio_outputs
))
1104 dev
->tv_audio_output
= vout
->index
;
1108 int vivid_vid_out_s_std(struct file
*file
, void *priv
, v4l2_std_id id
)
1110 struct vivid_dev
*dev
= video_drvdata(file
);
1112 if (!vivid_is_svid_out(dev
))
1114 if (dev
->std_out
== id
)
1116 if (vb2_is_busy(&dev
->vb_vid_out_q
) || vb2_is_busy(&dev
->vb_vbi_out_q
))
1119 vivid_update_format_out(dev
);
1123 static bool valid_cvt_gtf_timings(struct v4l2_dv_timings
*timings
)
1125 struct v4l2_bt_timings
*bt
= &timings
->bt
;
1127 if ((bt
->standards
& (V4L2_DV_BT_STD_CVT
| V4L2_DV_BT_STD_GTF
)) &&
1128 v4l2_valid_dv_timings(timings
, &vivid_dv_timings_cap
, NULL
, NULL
))
1134 int vivid_vid_out_s_dv_timings(struct file
*file
, void *_fh
,
1135 struct v4l2_dv_timings
*timings
)
1137 struct vivid_dev
*dev
= video_drvdata(file
);
1138 if (!vivid_is_hdmi_out(dev
))
1140 if (!v4l2_find_dv_timings_cap(timings
, &vivid_dv_timings_cap
,
1142 !valid_cvt_gtf_timings(timings
))
1144 if (v4l2_match_dv_timings(timings
, &dev
->dv_timings_out
, 0, true))
1146 if (vb2_is_busy(&dev
->vb_vid_out_q
))
1148 dev
->dv_timings_out
= *timings
;
1149 vivid_update_format_out(dev
);
1153 int vivid_vid_out_g_parm(struct file
*file
, void *priv
,
1154 struct v4l2_streamparm
*parm
)
1156 struct vivid_dev
*dev
= video_drvdata(file
);
1158 if (parm
->type
!= (dev
->multiplanar
?
1159 V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE
:
1160 V4L2_BUF_TYPE_VIDEO_OUTPUT
))
1163 parm
->parm
.output
.capability
= V4L2_CAP_TIMEPERFRAME
;
1164 parm
->parm
.output
.timeperframe
= dev
->timeperframe_vid_out
;
1165 parm
->parm
.output
.writebuffers
= 1;
1170 int vidioc_subscribe_event(struct v4l2_fh
*fh
,
1171 const struct v4l2_event_subscription
*sub
)
1173 switch (sub
->type
) {
1174 case V4L2_EVENT_CTRL
:
1175 return v4l2_ctrl_subscribe_event(fh
, sub
);
1176 case V4L2_EVENT_SOURCE_CHANGE
:
1177 if (fh
->vdev
->vfl_dir
== VFL_DIR_RX
)
1178 return v4l2_src_change_event_subscribe(fh
, sub
);