Commit | Line | Data |
---|---|---|
3f682ffc HV |
1 | /* |
2 | * vivid-kthread-cap.h - video/vbi capture thread support functions. | |
3 | * | |
4 | * Copyright 2014 Cisco Systems, Inc. and/or its affiliates. All rights reserved. | |
5 | * | |
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. | |
9 | * | |
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 | |
17 | * SOFTWARE. | |
18 | */ | |
19 | ||
20 | #include <linux/module.h> | |
21 | #include <linux/errno.h> | |
22 | #include <linux/kernel.h> | |
23 | #include <linux/init.h> | |
24 | #include <linux/sched.h> | |
25 | #include <linux/slab.h> | |
26 | #include <linux/font.h> | |
27 | #include <linux/mutex.h> | |
28 | #include <linux/videodev2.h> | |
29 | #include <linux/kthread.h> | |
30 | #include <linux/freezer.h> | |
31 | #include <linux/random.h> | |
32 | #include <linux/v4l2-dv-timings.h> | |
33 | #include <asm/div64.h> | |
34 | #include <media/videobuf2-vmalloc.h> | |
35 | #include <media/v4l2-dv-timings.h> | |
36 | #include <media/v4l2-ioctl.h> | |
37 | #include <media/v4l2-fh.h> | |
38 | #include <media/v4l2-event.h> | |
d1e5d8bd | 39 | #include <media/v4l2-rect.h> |
3f682ffc HV |
40 | |
41 | #include "vivid-core.h" | |
42 | #include "vivid-vid-common.h" | |
43 | #include "vivid-vid-cap.h" | |
44 | #include "vivid-vid-out.h" | |
45 | #include "vivid-radio-common.h" | |
46 | #include "vivid-radio-rx.h" | |
47 | #include "vivid-radio-tx.h" | |
48 | #include "vivid-sdr-cap.h" | |
49 | #include "vivid-vbi-cap.h" | |
50 | #include "vivid-vbi-out.h" | |
51 | #include "vivid-osd.h" | |
52 | #include "vivid-ctrls.h" | |
96ec7d2a | 53 | #include "vivid-kthread-cap.h" |
3f682ffc HV |
54 | |
55 | static inline v4l2_std_id vivid_get_std_cap(const struct vivid_dev *dev) | |
56 | { | |
57 | if (vivid_is_sdtv_cap(dev)) | |
58 | return dev->std_cap; | |
59 | return 0; | |
60 | } | |
61 | ||
62 | static void copy_pix(struct vivid_dev *dev, int win_y, int win_x, | |
63 | u16 *cap, const u16 *osd) | |
64 | { | |
65 | u16 out; | |
66 | int left = dev->overlay_out_left; | |
67 | int top = dev->overlay_out_top; | |
68 | int fb_x = win_x + left; | |
69 | int fb_y = win_y + top; | |
70 | int i; | |
71 | ||
72 | out = *cap; | |
73 | *cap = *osd; | |
74 | if (dev->bitmap_out) { | |
75 | const u8 *p = dev->bitmap_out; | |
76 | unsigned stride = (dev->compose_out.width + 7) / 8; | |
77 | ||
78 | win_x -= dev->compose_out.left; | |
79 | win_y -= dev->compose_out.top; | |
80 | if (!(p[stride * win_y + win_x / 8] & (1 << (win_x & 7)))) | |
81 | return; | |
82 | } | |
83 | ||
84 | for (i = 0; i < dev->clipcount_out; i++) { | |
85 | struct v4l2_rect *r = &dev->clips_out[i].c; | |
86 | ||
87 | if (fb_y >= r->top && fb_y < r->top + r->height && | |
88 | fb_x >= r->left && fb_x < r->left + r->width) | |
89 | return; | |
90 | } | |
91 | if ((dev->fbuf_out_flags & V4L2_FBUF_FLAG_CHROMAKEY) && | |
92 | *osd != dev->chromakey_out) | |
93 | return; | |
94 | if ((dev->fbuf_out_flags & V4L2_FBUF_FLAG_SRC_CHROMAKEY) && | |
95 | out == dev->chromakey_out) | |
96 | return; | |
97 | if (dev->fmt_cap->alpha_mask) { | |
98 | if ((dev->fbuf_out_flags & V4L2_FBUF_FLAG_GLOBAL_ALPHA) && | |
99 | dev->global_alpha_out) | |
100 | return; | |
101 | if ((dev->fbuf_out_flags & V4L2_FBUF_FLAG_LOCAL_ALPHA) && | |
102 | *cap & dev->fmt_cap->alpha_mask) | |
103 | return; | |
104 | if ((dev->fbuf_out_flags & V4L2_FBUF_FLAG_LOCAL_INV_ALPHA) && | |
105 | !(*cap & dev->fmt_cap->alpha_mask)) | |
106 | return; | |
107 | } | |
108 | *cap = out; | |
109 | } | |
110 | ||
111 | static void blend_line(struct vivid_dev *dev, unsigned y_offset, unsigned x_offset, | |
112 | u8 *vcapbuf, const u8 *vosdbuf, | |
113 | unsigned width, unsigned pixsize) | |
114 | { | |
115 | unsigned x; | |
116 | ||
117 | for (x = 0; x < width; x++, vcapbuf += pixsize, vosdbuf += pixsize) { | |
118 | copy_pix(dev, y_offset, x_offset + x, | |
119 | (u16 *)vcapbuf, (const u16 *)vosdbuf); | |
120 | } | |
121 | } | |
122 | ||
123 | static void scale_line(const u8 *src, u8 *dst, unsigned srcw, unsigned dstw, unsigned twopixsize) | |
124 | { | |
125 | /* Coarse scaling with Bresenham */ | |
126 | unsigned int_part; | |
127 | unsigned fract_part; | |
128 | unsigned src_x = 0; | |
129 | unsigned error = 0; | |
130 | unsigned x; | |
131 | ||
132 | /* | |
133 | * We always combine two pixels to prevent color bleed in the packed | |
134 | * yuv case. | |
135 | */ | |
136 | srcw /= 2; | |
137 | dstw /= 2; | |
138 | int_part = srcw / dstw; | |
139 | fract_part = srcw % dstw; | |
140 | for (x = 0; x < dstw; x++, dst += twopixsize) { | |
141 | memcpy(dst, src + src_x * twopixsize, twopixsize); | |
142 | src_x += int_part; | |
143 | error += fract_part; | |
144 | if (error >= dstw) { | |
145 | error -= dstw; | |
146 | src_x++; | |
147 | } | |
148 | } | |
149 | } | |
150 | ||
151 | /* | |
152 | * Precalculate the rectangles needed to perform video looping: | |
153 | * | |
154 | * The nominal pipeline is that the video output buffer is cropped by | |
155 | * crop_out, scaled to compose_out, overlaid with the output overlay, | |
156 | * cropped on the capture side by crop_cap and scaled again to the video | |
157 | * capture buffer using compose_cap. | |
158 | * | |
159 | * To keep things efficient we calculate the intersection of compose_out | |
160 | * and crop_cap (since that's the only part of the video that will | |
161 | * actually end up in the capture buffer), determine which part of the | |
162 | * video output buffer that is and which part of the video capture buffer | |
163 | * so we can scale the video straight from the output buffer to the capture | |
164 | * buffer without any intermediate steps. | |
165 | * | |
166 | * If we need to deal with an output overlay, then there is no choice and | |
167 | * that intermediate step still has to be taken. For the output overlay | |
168 | * support we calculate the intersection of the framebuffer and the overlay | |
169 | * window (which may be partially or wholly outside of the framebuffer | |
170 | * itself) and the intersection of that with loop_vid_copy (i.e. the part of | |
171 | * the actual looped video that will be overlaid). The result is calculated | |
172 | * both in framebuffer coordinates (loop_fb_copy) and compose_out coordinates | |
173 | * (loop_vid_overlay). Finally calculate the part of the capture buffer that | |
174 | * will receive that overlaid video. | |
175 | */ | |
176 | static void vivid_precalc_copy_rects(struct vivid_dev *dev) | |
177 | { | |
178 | /* Framebuffer rectangle */ | |
179 | struct v4l2_rect r_fb = { | |
180 | 0, 0, dev->display_width, dev->display_height | |
181 | }; | |
182 | /* Overlay window rectangle in framebuffer coordinates */ | |
183 | struct v4l2_rect r_overlay = { | |
184 | dev->overlay_out_left, dev->overlay_out_top, | |
185 | dev->compose_out.width, dev->compose_out.height | |
186 | }; | |
187 | ||
d1e5d8bd | 188 | v4l2_rect_intersect(&dev->loop_vid_copy, &dev->crop_cap, &dev->compose_out); |
3f682ffc HV |
189 | |
190 | dev->loop_vid_out = dev->loop_vid_copy; | |
d1e5d8bd | 191 | v4l2_rect_scale(&dev->loop_vid_out, &dev->compose_out, &dev->crop_out); |
3f682ffc HV |
192 | dev->loop_vid_out.left += dev->crop_out.left; |
193 | dev->loop_vid_out.top += dev->crop_out.top; | |
194 | ||
195 | dev->loop_vid_cap = dev->loop_vid_copy; | |
d1e5d8bd | 196 | v4l2_rect_scale(&dev->loop_vid_cap, &dev->crop_cap, &dev->compose_cap); |
3f682ffc HV |
197 | |
198 | dprintk(dev, 1, | |
199 | "loop_vid_copy: %dx%d@%dx%d loop_vid_out: %dx%d@%dx%d loop_vid_cap: %dx%d@%dx%d\n", | |
200 | dev->loop_vid_copy.width, dev->loop_vid_copy.height, | |
201 | dev->loop_vid_copy.left, dev->loop_vid_copy.top, | |
202 | dev->loop_vid_out.width, dev->loop_vid_out.height, | |
203 | dev->loop_vid_out.left, dev->loop_vid_out.top, | |
204 | dev->loop_vid_cap.width, dev->loop_vid_cap.height, | |
205 | dev->loop_vid_cap.left, dev->loop_vid_cap.top); | |
206 | ||
d1e5d8bd | 207 | v4l2_rect_intersect(&r_overlay, &r_fb, &r_overlay); |
3f682ffc HV |
208 | |
209 | /* shift r_overlay to the same origin as compose_out */ | |
210 | r_overlay.left += dev->compose_out.left - dev->overlay_out_left; | |
211 | r_overlay.top += dev->compose_out.top - dev->overlay_out_top; | |
212 | ||
d1e5d8bd | 213 | v4l2_rect_intersect(&dev->loop_vid_overlay, &r_overlay, &dev->loop_vid_copy); |
3f682ffc HV |
214 | dev->loop_fb_copy = dev->loop_vid_overlay; |
215 | ||
216 | /* shift dev->loop_fb_copy back again to the fb origin */ | |
217 | dev->loop_fb_copy.left -= dev->compose_out.left - dev->overlay_out_left; | |
218 | dev->loop_fb_copy.top -= dev->compose_out.top - dev->overlay_out_top; | |
219 | ||
220 | dev->loop_vid_overlay_cap = dev->loop_vid_overlay; | |
d1e5d8bd | 221 | v4l2_rect_scale(&dev->loop_vid_overlay_cap, &dev->crop_cap, &dev->compose_cap); |
3f682ffc HV |
222 | |
223 | dprintk(dev, 1, | |
224 | "loop_fb_copy: %dx%d@%dx%d loop_vid_overlay: %dx%d@%dx%d loop_vid_overlay_cap: %dx%d@%dx%d\n", | |
225 | dev->loop_fb_copy.width, dev->loop_fb_copy.height, | |
226 | dev->loop_fb_copy.left, dev->loop_fb_copy.top, | |
227 | dev->loop_vid_overlay.width, dev->loop_vid_overlay.height, | |
228 | dev->loop_vid_overlay.left, dev->loop_vid_overlay.top, | |
229 | dev->loop_vid_overlay_cap.width, dev->loop_vid_overlay_cap.height, | |
230 | dev->loop_vid_overlay_cap.left, dev->loop_vid_overlay_cap.top); | |
231 | } | |
232 | ||
ddcaee9d HV |
233 | static void *plane_vaddr(struct tpg_data *tpg, struct vivid_buffer *buf, |
234 | unsigned p, unsigned bpl[TPG_MAX_PLANES], unsigned h) | |
235 | { | |
236 | unsigned i; | |
237 | void *vbuf; | |
238 | ||
239 | if (p == 0 || tpg_g_buffers(tpg) > 1) | |
2d700715 JS |
240 | return vb2_plane_vaddr(&buf->vb.vb2_buf, p); |
241 | vbuf = vb2_plane_vaddr(&buf->vb.vb2_buf, 0); | |
ddcaee9d HV |
242 | for (i = 0; i < p; i++) |
243 | vbuf += bpl[i] * h / tpg->vdownsampling[i]; | |
244 | return vbuf; | |
245 | } | |
246 | ||
3f682ffc HV |
247 | static int vivid_copy_buffer(struct vivid_dev *dev, unsigned p, u8 *vcapbuf, |
248 | struct vivid_buffer *vid_cap_buf) | |
249 | { | |
2d700715 | 250 | bool blank = dev->must_blank[vid_cap_buf->vb.vb2_buf.index]; |
3f682ffc HV |
251 | struct tpg_data *tpg = &dev->tpg; |
252 | struct vivid_buffer *vid_out_buf = NULL; | |
1f9f23f6 HV |
253 | unsigned vdiv = dev->fmt_out->vdownsampling[p]; |
254 | unsigned twopixsize = tpg_g_twopixelsize(tpg, p); | |
255 | unsigned img_width = tpg_hdiv(tpg, p, dev->compose_cap.width); | |
3f682ffc HV |
256 | unsigned img_height = dev->compose_cap.height; |
257 | unsigned stride_cap = tpg->bytesperline[p]; | |
258 | unsigned stride_out = dev->bytesperline_out[p]; | |
259 | unsigned stride_osd = dev->display_byte_stride; | |
260 | unsigned hmax = (img_height * tpg->perc_fill) / 100; | |
261 | u8 *voutbuf; | |
262 | u8 *vosdbuf = NULL; | |
263 | unsigned y; | |
264 | bool blend = dev->bitmap_out || dev->clipcount_out || dev->fbuf_out_flags; | |
265 | /* Coarse scaling with Bresenham */ | |
266 | unsigned vid_out_int_part; | |
267 | unsigned vid_out_fract_part; | |
268 | unsigned vid_out_y = 0; | |
269 | unsigned vid_out_error = 0; | |
270 | unsigned vid_overlay_int_part = 0; | |
271 | unsigned vid_overlay_fract_part = 0; | |
272 | unsigned vid_overlay_y = 0; | |
273 | unsigned vid_overlay_error = 0; | |
1f9f23f6 | 274 | unsigned vid_cap_left = tpg_hdiv(tpg, p, dev->loop_vid_cap.left); |
3f682ffc HV |
275 | unsigned vid_cap_right; |
276 | bool quick; | |
277 | ||
278 | vid_out_int_part = dev->loop_vid_out.height / dev->loop_vid_cap.height; | |
279 | vid_out_fract_part = dev->loop_vid_out.height % dev->loop_vid_cap.height; | |
280 | ||
281 | if (!list_empty(&dev->vid_out_active)) | |
282 | vid_out_buf = list_entry(dev->vid_out_active.next, | |
283 | struct vivid_buffer, list); | |
284 | if (vid_out_buf == NULL) | |
285 | return -ENODATA; | |
286 | ||
2d700715 | 287 | vid_cap_buf->vb.field = vid_out_buf->vb.field; |
3f682ffc | 288 | |
ddcaee9d HV |
289 | voutbuf = plane_vaddr(tpg, vid_out_buf, p, |
290 | dev->bytesperline_out, dev->fmt_out_rect.height); | |
291 | if (p < dev->fmt_out->buffers) | |
2d700715 | 292 | voutbuf += vid_out_buf->vb.vb2_buf.planes[p].data_offset; |
1f9f23f6 HV |
293 | voutbuf += tpg_hdiv(tpg, p, dev->loop_vid_out.left) + |
294 | (dev->loop_vid_out.top / vdiv) * stride_out; | |
295 | vcapbuf += tpg_hdiv(tpg, p, dev->compose_cap.left) + | |
296 | (dev->compose_cap.top / vdiv) * stride_cap; | |
3f682ffc HV |
297 | |
298 | if (dev->loop_vid_copy.width == 0 || dev->loop_vid_copy.height == 0) { | |
299 | /* | |
300 | * If there is nothing to copy, then just fill the capture window | |
301 | * with black. | |
302 | */ | |
1f9f23f6 HV |
303 | for (y = 0; y < hmax / vdiv; y++, vcapbuf += stride_cap) |
304 | memcpy(vcapbuf, tpg->black_line[p], img_width); | |
3f682ffc HV |
305 | return 0; |
306 | } | |
307 | ||
308 | if (dev->overlay_out_enabled && | |
309 | dev->loop_vid_overlay.width && dev->loop_vid_overlay.height) { | |
310 | vosdbuf = dev->video_vbase; | |
1f9f23f6 | 311 | vosdbuf += (dev->loop_fb_copy.left * twopixsize) / 2 + |
3f682ffc HV |
312 | dev->loop_fb_copy.top * stride_osd; |
313 | vid_overlay_int_part = dev->loop_vid_overlay.height / | |
314 | dev->loop_vid_overlay_cap.height; | |
315 | vid_overlay_fract_part = dev->loop_vid_overlay.height % | |
316 | dev->loop_vid_overlay_cap.height; | |
317 | } | |
318 | ||
1f9f23f6 | 319 | vid_cap_right = tpg_hdiv(tpg, p, dev->loop_vid_cap.left + dev->loop_vid_cap.width); |
3f682ffc HV |
320 | /* quick is true if no video scaling is needed */ |
321 | quick = dev->loop_vid_out.width == dev->loop_vid_cap.width; | |
322 | ||
323 | dev->cur_scaled_line = dev->loop_vid_out.height; | |
1f9f23f6 | 324 | for (y = 0; y < hmax; y += vdiv, vcapbuf += stride_cap) { |
3f682ffc HV |
325 | /* osdline is true if this line requires overlay blending */ |
326 | bool osdline = vosdbuf && y >= dev->loop_vid_overlay_cap.top && | |
327 | y < dev->loop_vid_overlay_cap.top + dev->loop_vid_overlay_cap.height; | |
328 | ||
329 | /* | |
330 | * If this line of the capture buffer doesn't get any video, then | |
331 | * just fill with black. | |
332 | */ | |
333 | if (y < dev->loop_vid_cap.top || | |
334 | y >= dev->loop_vid_cap.top + dev->loop_vid_cap.height) { | |
1f9f23f6 | 335 | memcpy(vcapbuf, tpg->black_line[p], img_width); |
3f682ffc HV |
336 | continue; |
337 | } | |
338 | ||
339 | /* fill the left border with black */ | |
340 | if (dev->loop_vid_cap.left) | |
1f9f23f6 | 341 | memcpy(vcapbuf, tpg->black_line[p], vid_cap_left); |
3f682ffc HV |
342 | |
343 | /* fill the right border with black */ | |
344 | if (vid_cap_right < img_width) | |
1f9f23f6 HV |
345 | memcpy(vcapbuf + vid_cap_right, tpg->black_line[p], |
346 | img_width - vid_cap_right); | |
3f682ffc HV |
347 | |
348 | if (quick && !osdline) { | |
1f9f23f6 | 349 | memcpy(vcapbuf + vid_cap_left, |
3f682ffc | 350 | voutbuf + vid_out_y * stride_out, |
1f9f23f6 | 351 | tpg_hdiv(tpg, p, dev->loop_vid_cap.width)); |
3f682ffc HV |
352 | goto update_vid_out_y; |
353 | } | |
354 | if (dev->cur_scaled_line == vid_out_y) { | |
1f9f23f6 HV |
355 | memcpy(vcapbuf + vid_cap_left, dev->scaled_line, |
356 | tpg_hdiv(tpg, p, dev->loop_vid_cap.width)); | |
3f682ffc HV |
357 | goto update_vid_out_y; |
358 | } | |
359 | if (!osdline) { | |
360 | scale_line(voutbuf + vid_out_y * stride_out, dev->scaled_line, | |
1f9f23f6 HV |
361 | tpg_hdiv(tpg, p, dev->loop_vid_out.width), |
362 | tpg_hdiv(tpg, p, dev->loop_vid_cap.width), | |
3f682ffc HV |
363 | tpg_g_twopixelsize(tpg, p)); |
364 | } else { | |
365 | /* | |
366 | * Offset in bytes within loop_vid_copy to the start of the | |
367 | * loop_vid_overlay rectangle. | |
368 | */ | |
369 | unsigned offset = | |
1f9f23f6 HV |
370 | ((dev->loop_vid_overlay.left - dev->loop_vid_copy.left) * |
371 | twopixsize) / 2; | |
3f682ffc HV |
372 | u8 *osd = vosdbuf + vid_overlay_y * stride_osd; |
373 | ||
374 | scale_line(voutbuf + vid_out_y * stride_out, dev->blended_line, | |
375 | dev->loop_vid_out.width, dev->loop_vid_copy.width, | |
376 | tpg_g_twopixelsize(tpg, p)); | |
377 | if (blend) | |
378 | blend_line(dev, vid_overlay_y + dev->loop_vid_overlay.top, | |
379 | dev->loop_vid_overlay.left, | |
380 | dev->blended_line + offset, osd, | |
1f9f23f6 | 381 | dev->loop_vid_overlay.width, twopixsize / 2); |
3f682ffc HV |
382 | else |
383 | memcpy(dev->blended_line + offset, | |
1f9f23f6 | 384 | osd, (dev->loop_vid_overlay.width * twopixsize) / 2); |
3f682ffc HV |
385 | scale_line(dev->blended_line, dev->scaled_line, |
386 | dev->loop_vid_copy.width, dev->loop_vid_cap.width, | |
387 | tpg_g_twopixelsize(tpg, p)); | |
388 | } | |
389 | dev->cur_scaled_line = vid_out_y; | |
1f9f23f6 HV |
390 | memcpy(vcapbuf + vid_cap_left, dev->scaled_line, |
391 | tpg_hdiv(tpg, p, dev->loop_vid_cap.width)); | |
3f682ffc HV |
392 | |
393 | update_vid_out_y: | |
394 | if (osdline) { | |
395 | vid_overlay_y += vid_overlay_int_part; | |
396 | vid_overlay_error += vid_overlay_fract_part; | |
397 | if (vid_overlay_error >= dev->loop_vid_overlay_cap.height) { | |
398 | vid_overlay_error -= dev->loop_vid_overlay_cap.height; | |
399 | vid_overlay_y++; | |
400 | } | |
401 | } | |
402 | vid_out_y += vid_out_int_part; | |
403 | vid_out_error += vid_out_fract_part; | |
1f9f23f6 HV |
404 | if (vid_out_error >= dev->loop_vid_cap.height / vdiv) { |
405 | vid_out_error -= dev->loop_vid_cap.height / vdiv; | |
3f682ffc HV |
406 | vid_out_y++; |
407 | } | |
408 | } | |
409 | ||
410 | if (!blank) | |
411 | return 0; | |
1f9f23f6 HV |
412 | for (; y < img_height; y += vdiv, vcapbuf += stride_cap) |
413 | memcpy(vcapbuf, tpg->contrast_line[p], img_width); | |
3f682ffc HV |
414 | return 0; |
415 | } | |
416 | ||
417 | static void vivid_fillbuff(struct vivid_dev *dev, struct vivid_buffer *buf) | |
418 | { | |
ddcaee9d | 419 | struct tpg_data *tpg = &dev->tpg; |
3f682ffc HV |
420 | unsigned factor = V4L2_FIELD_HAS_T_OR_B(dev->field_cap) ? 2 : 1; |
421 | unsigned line_height = 16 / factor; | |
422 | bool is_tv = vivid_is_sdtv_cap(dev); | |
423 | bool is_60hz = is_tv && (dev->std_cap & V4L2_STD_525_60); | |
424 | unsigned p; | |
425 | int line = 1; | |
426 | u8 *basep[TPG_MAX_PLANES][2]; | |
427 | unsigned ms; | |
428 | char str[100]; | |
429 | s32 gain; | |
430 | bool is_loop = false; | |
431 | ||
432 | if (dev->loop_video && dev->can_loop_video && | |
2d700715 JS |
433 | ((vivid_is_svid_cap(dev) && |
434 | !VIVID_INVALID_SIGNAL(dev->std_signal_mode)) || | |
435 | (vivid_is_hdmi_cap(dev) && | |
436 | !VIVID_INVALID_SIGNAL(dev->dv_timings_signal_mode)))) | |
3f682ffc HV |
437 | is_loop = true; |
438 | ||
2d700715 | 439 | buf->vb.sequence = dev->vid_cap_seq_count; |
3f682ffc HV |
440 | /* |
441 | * Take the timestamp now if the timestamp source is set to | |
442 | * "Start of Exposure". | |
443 | */ | |
444 | if (dev->tstamp_src_is_soe) | |
d6dd645e | 445 | buf->vb.vb2_buf.timestamp = ktime_get_ns(); |
3f682ffc HV |
446 | if (dev->field_cap == V4L2_FIELD_ALTERNATE) { |
447 | /* | |
448 | * 60 Hz standards start with the bottom field, 50 Hz standards | |
449 | * with the top field. So if the 0-based seq_count is even, | |
450 | * then the field is TOP for 50 Hz and BOTTOM for 60 Hz | |
451 | * standards. | |
452 | */ | |
2d700715 | 453 | buf->vb.field = ((dev->vid_cap_seq_count & 1) ^ is_60hz) ? |
a94e7d6e | 454 | V4L2_FIELD_BOTTOM : V4L2_FIELD_TOP; |
3f682ffc HV |
455 | /* |
456 | * The sequence counter counts frames, not fields. So divide | |
457 | * by two. | |
458 | */ | |
2d700715 | 459 | buf->vb.sequence /= 2; |
3f682ffc | 460 | } else { |
2d700715 | 461 | buf->vb.field = dev->field_cap; |
3f682ffc | 462 | } |
2d700715 | 463 | tpg_s_field(tpg, buf->vb.field, |
43047f6b | 464 | dev->field_cap == V4L2_FIELD_ALTERNATE); |
2d700715 | 465 | tpg_s_perc_fill_blank(tpg, dev->must_blank[buf->vb.vb2_buf.index]); |
3f682ffc HV |
466 | |
467 | vivid_precalc_copy_rects(dev); | |
468 | ||
ddcaee9d HV |
469 | for (p = 0; p < tpg_g_planes(tpg); p++) { |
470 | void *vbuf = plane_vaddr(tpg, buf, p, | |
471 | tpg->bytesperline, tpg->buf_height); | |
3f682ffc HV |
472 | |
473 | /* | |
474 | * The first plane of a multiplanar format has a non-zero | |
475 | * data_offset. This helps testing whether the application | |
476 | * correctly supports non-zero data offsets. | |
477 | */ | |
ddcaee9d | 478 | if (p < tpg_g_buffers(tpg) && dev->fmt_cap->data_offset[p]) { |
3f682ffc HV |
479 | memset(vbuf, dev->fmt_cap->data_offset[p] & 0xff, |
480 | dev->fmt_cap->data_offset[p]); | |
481 | vbuf += dev->fmt_cap->data_offset[p]; | |
482 | } | |
ddcaee9d | 483 | tpg_calc_text_basep(tpg, basep, p, vbuf); |
3f682ffc | 484 | if (!is_loop || vivid_copy_buffer(dev, p, vbuf, buf)) |
2d700715 JS |
485 | tpg_fill_plane_buffer(tpg, vivid_get_std_cap(dev), |
486 | p, vbuf); | |
3f682ffc | 487 | } |
2d700715 | 488 | dev->must_blank[buf->vb.vb2_buf.index] = false; |
3f682ffc HV |
489 | |
490 | /* Updates stream time, only update at the start of a new frame. */ | |
2d700715 JS |
491 | if (dev->field_cap != V4L2_FIELD_ALTERNATE || |
492 | (buf->vb.sequence & 1) == 0) | |
493 | dev->ms_vid_cap = | |
494 | jiffies_to_msecs(jiffies - dev->jiffies_vid_cap); | |
3f682ffc HV |
495 | |
496 | ms = dev->ms_vid_cap; | |
497 | if (dev->osd_mode <= 1) { | |
498 | snprintf(str, sizeof(str), " %02d:%02d:%02d:%03d %u%s", | |
499 | (ms / (60 * 60 * 1000)) % 24, | |
500 | (ms / (60 * 1000)) % 60, | |
501 | (ms / 1000) % 60, | |
502 | ms % 1000, | |
2d700715 | 503 | buf->vb.sequence, |
3f682ffc | 504 | (dev->field_cap == V4L2_FIELD_ALTERNATE) ? |
2d700715 | 505 | (buf->vb.field == V4L2_FIELD_TOP ? |
3f682ffc | 506 | " top" : " bottom") : ""); |
ddcaee9d | 507 | tpg_gen_text(tpg, basep, line++ * line_height, 16, str); |
3f682ffc HV |
508 | } |
509 | if (dev->osd_mode == 0) { | |
510 | snprintf(str, sizeof(str), " %dx%d, input %d ", | |
511 | dev->src_rect.width, dev->src_rect.height, dev->input); | |
ddcaee9d | 512 | tpg_gen_text(tpg, basep, line++ * line_height, 16, str); |
3f682ffc HV |
513 | |
514 | gain = v4l2_ctrl_g_ctrl(dev->gain); | |
515 | mutex_lock(dev->ctrl_hdl_user_vid.lock); | |
516 | snprintf(str, sizeof(str), | |
517 | " brightness %3d, contrast %3d, saturation %3d, hue %d ", | |
518 | dev->brightness->cur.val, | |
519 | dev->contrast->cur.val, | |
520 | dev->saturation->cur.val, | |
521 | dev->hue->cur.val); | |
ddcaee9d | 522 | tpg_gen_text(tpg, basep, line++ * line_height, 16, str); |
3f682ffc HV |
523 | snprintf(str, sizeof(str), |
524 | " autogain %d, gain %3d, alpha 0x%02x ", | |
525 | dev->autogain->cur.val, gain, dev->alpha->cur.val); | |
526 | mutex_unlock(dev->ctrl_hdl_user_vid.lock); | |
ddcaee9d | 527 | tpg_gen_text(tpg, basep, line++ * line_height, 16, str); |
3f682ffc HV |
528 | mutex_lock(dev->ctrl_hdl_user_aud.lock); |
529 | snprintf(str, sizeof(str), | |
530 | " volume %3d, mute %d ", | |
531 | dev->volume->cur.val, dev->mute->cur.val); | |
532 | mutex_unlock(dev->ctrl_hdl_user_aud.lock); | |
ddcaee9d | 533 | tpg_gen_text(tpg, basep, line++ * line_height, 16, str); |
3f682ffc HV |
534 | mutex_lock(dev->ctrl_hdl_user_gen.lock); |
535 | snprintf(str, sizeof(str), " int32 %d, int64 %lld, bitmask %08x ", | |
536 | dev->int32->cur.val, | |
537 | *dev->int64->p_cur.p_s64, | |
538 | dev->bitmask->cur.val); | |
ddcaee9d | 539 | tpg_gen_text(tpg, basep, line++ * line_height, 16, str); |
3f682ffc HV |
540 | snprintf(str, sizeof(str), " boolean %d, menu %s, string \"%s\" ", |
541 | dev->boolean->cur.val, | |
542 | dev->menu->qmenu[dev->menu->cur.val], | |
543 | dev->string->p_cur.p_char); | |
ddcaee9d | 544 | tpg_gen_text(tpg, basep, line++ * line_height, 16, str); |
3f682ffc HV |
545 | snprintf(str, sizeof(str), " integer_menu %lld, value %d ", |
546 | dev->int_menu->qmenu_int[dev->int_menu->cur.val], | |
547 | dev->int_menu->cur.val); | |
548 | mutex_unlock(dev->ctrl_hdl_user_gen.lock); | |
ddcaee9d | 549 | tpg_gen_text(tpg, basep, line++ * line_height, 16, str); |
3f682ffc HV |
550 | if (dev->button_pressed) { |
551 | dev->button_pressed--; | |
552 | snprintf(str, sizeof(str), " button pressed!"); | |
ddcaee9d | 553 | tpg_gen_text(tpg, basep, line++ * line_height, 16, str); |
3f682ffc HV |
554 | } |
555 | } | |
556 | ||
557 | /* | |
558 | * If "End of Frame" is specified at the timestamp source, then take | |
559 | * the timestamp now. | |
560 | */ | |
561 | if (!dev->tstamp_src_is_soe) | |
d6dd645e JS |
562 | buf->vb.vb2_buf.timestamp = ktime_get_ns(); |
563 | buf->vb.vb2_buf.timestamp += dev->time_wrap_offset; | |
3f682ffc HV |
564 | } |
565 | ||
566 | /* | |
567 | * Return true if this pixel coordinate is a valid video pixel. | |
568 | */ | |
569 | static bool valid_pix(struct vivid_dev *dev, int win_y, int win_x, int fb_y, int fb_x) | |
570 | { | |
571 | int i; | |
572 | ||
573 | if (dev->bitmap_cap) { | |
574 | /* | |
575 | * Only if the corresponding bit in the bitmap is set can | |
576 | * the video pixel be shown. Coordinates are relative to | |
577 | * the overlay window set by VIDIOC_S_FMT. | |
578 | */ | |
579 | const u8 *p = dev->bitmap_cap; | |
580 | unsigned stride = (dev->compose_cap.width + 7) / 8; | |
581 | ||
582 | if (!(p[stride * win_y + win_x / 8] & (1 << (win_x & 7)))) | |
583 | return false; | |
584 | } | |
585 | ||
586 | for (i = 0; i < dev->clipcount_cap; i++) { | |
587 | /* | |
588 | * Only if the framebuffer coordinate is not in any of the | |
589 | * clip rectangles will be video pixel be shown. | |
590 | */ | |
591 | struct v4l2_rect *r = &dev->clips_cap[i].c; | |
592 | ||
593 | if (fb_y >= r->top && fb_y < r->top + r->height && | |
594 | fb_x >= r->left && fb_x < r->left + r->width) | |
595 | return false; | |
596 | } | |
597 | return true; | |
598 | } | |
599 | ||
600 | /* | |
601 | * Draw the image into the overlay buffer. | |
602 | * Note that the combination of overlay and multiplanar is not supported. | |
603 | */ | |
604 | static void vivid_overlay(struct vivid_dev *dev, struct vivid_buffer *buf) | |
605 | { | |
606 | struct tpg_data *tpg = &dev->tpg; | |
607 | unsigned pixsize = tpg_g_twopixelsize(tpg, 0) / 2; | |
608 | void *vbase = dev->fb_vbase_cap; | |
2d700715 | 609 | void *vbuf = vb2_plane_vaddr(&buf->vb.vb2_buf, 0); |
3f682ffc HV |
610 | unsigned img_width = dev->compose_cap.width; |
611 | unsigned img_height = dev->compose_cap.height; | |
612 | unsigned stride = tpg->bytesperline[0]; | |
613 | /* if quick is true, then valid_pix() doesn't have to be called */ | |
614 | bool quick = dev->bitmap_cap == NULL && dev->clipcount_cap == 0; | |
615 | int x, y, w, out_x = 0; | |
616 | ||
1f9f23f6 HV |
617 | /* |
618 | * Overlay support is only supported for formats that have a twopixelsize | |
619 | * that's >= 2. Warn and bail out if that's not the case. | |
620 | */ | |
621 | if (WARN_ON(pixsize == 0)) | |
622 | return; | |
3f682ffc HV |
623 | if ((dev->overlay_cap_field == V4L2_FIELD_TOP || |
624 | dev->overlay_cap_field == V4L2_FIELD_BOTTOM) && | |
2d700715 | 625 | dev->overlay_cap_field != buf->vb.field) |
3f682ffc HV |
626 | return; |
627 | ||
628 | vbuf += dev->compose_cap.left * pixsize + dev->compose_cap.top * stride; | |
629 | x = dev->overlay_cap_left; | |
630 | w = img_width; | |
631 | if (x < 0) { | |
632 | out_x = -x; | |
633 | w = w - out_x; | |
634 | x = 0; | |
635 | } else { | |
636 | w = dev->fb_cap.fmt.width - x; | |
637 | if (w > img_width) | |
638 | w = img_width; | |
639 | } | |
640 | if (w <= 0) | |
641 | return; | |
642 | if (dev->overlay_cap_top >= 0) | |
643 | vbase += dev->overlay_cap_top * dev->fb_cap.fmt.bytesperline; | |
644 | for (y = dev->overlay_cap_top; | |
645 | y < dev->overlay_cap_top + (int)img_height; | |
646 | y++, vbuf += stride) { | |
647 | int px; | |
648 | ||
649 | if (y < 0 || y > dev->fb_cap.fmt.height) | |
650 | continue; | |
651 | if (quick) { | |
652 | memcpy(vbase + x * pixsize, | |
653 | vbuf + out_x * pixsize, w * pixsize); | |
654 | vbase += dev->fb_cap.fmt.bytesperline; | |
655 | continue; | |
656 | } | |
657 | for (px = 0; px < w; px++) { | |
658 | if (!valid_pix(dev, y - dev->overlay_cap_top, | |
659 | px + out_x, y, px + x)) | |
660 | continue; | |
661 | memcpy(vbase + (px + x) * pixsize, | |
662 | vbuf + (px + out_x) * pixsize, | |
663 | pixsize); | |
664 | } | |
665 | vbase += dev->fb_cap.fmt.bytesperline; | |
666 | } | |
667 | } | |
668 | ||
669 | static void vivid_thread_vid_cap_tick(struct vivid_dev *dev, int dropped_bufs) | |
670 | { | |
671 | struct vivid_buffer *vid_cap_buf = NULL; | |
672 | struct vivid_buffer *vbi_cap_buf = NULL; | |
673 | ||
674 | dprintk(dev, 1, "Video Capture Thread Tick\n"); | |
675 | ||
676 | while (dropped_bufs-- > 1) | |
677 | tpg_update_mv_count(&dev->tpg, | |
678 | dev->field_cap == V4L2_FIELD_NONE || | |
679 | dev->field_cap == V4L2_FIELD_ALTERNATE); | |
680 | ||
681 | /* Drop a certain percentage of buffers. */ | |
682 | if (dev->perc_dropped_buffers && | |
683 | prandom_u32_max(100) < dev->perc_dropped_buffers) | |
684 | goto update_mv; | |
685 | ||
686 | spin_lock(&dev->slock); | |
687 | if (!list_empty(&dev->vid_cap_active)) { | |
688 | vid_cap_buf = list_entry(dev->vid_cap_active.next, struct vivid_buffer, list); | |
689 | list_del(&vid_cap_buf->list); | |
690 | } | |
691 | if (!list_empty(&dev->vbi_cap_active)) { | |
692 | if (dev->field_cap != V4L2_FIELD_ALTERNATE || | |
693 | (dev->vbi_cap_seq_count & 1)) { | |
694 | vbi_cap_buf = list_entry(dev->vbi_cap_active.next, | |
695 | struct vivid_buffer, list); | |
696 | list_del(&vbi_cap_buf->list); | |
697 | } | |
698 | } | |
699 | spin_unlock(&dev->slock); | |
700 | ||
701 | if (!vid_cap_buf && !vbi_cap_buf) | |
702 | goto update_mv; | |
703 | ||
704 | if (vid_cap_buf) { | |
705 | /* Fill buffer */ | |
706 | vivid_fillbuff(dev, vid_cap_buf); | |
707 | dprintk(dev, 1, "filled buffer %d\n", | |
2d700715 | 708 | vid_cap_buf->vb.vb2_buf.index); |
3f682ffc HV |
709 | |
710 | /* Handle overlay */ | |
711 | if (dev->overlay_cap_owner && dev->fb_cap.base && | |
2d700715 | 712 | dev->fb_cap.fmt.pixelformat == dev->fmt_cap->fourcc) |
3f682ffc HV |
713 | vivid_overlay(dev, vid_cap_buf); |
714 | ||
2d700715 | 715 | vb2_buffer_done(&vid_cap_buf->vb.vb2_buf, dev->dqbuf_error ? |
3f682ffc HV |
716 | VB2_BUF_STATE_ERROR : VB2_BUF_STATE_DONE); |
717 | dprintk(dev, 2, "vid_cap buffer %d done\n", | |
2d700715 | 718 | vid_cap_buf->vb.vb2_buf.index); |
3f682ffc HV |
719 | } |
720 | ||
721 | if (vbi_cap_buf) { | |
722 | if (dev->stream_sliced_vbi_cap) | |
723 | vivid_sliced_vbi_cap_process(dev, vbi_cap_buf); | |
724 | else | |
725 | vivid_raw_vbi_cap_process(dev, vbi_cap_buf); | |
2d700715 | 726 | vb2_buffer_done(&vbi_cap_buf->vb.vb2_buf, dev->dqbuf_error ? |
3f682ffc HV |
727 | VB2_BUF_STATE_ERROR : VB2_BUF_STATE_DONE); |
728 | dprintk(dev, 2, "vbi_cap %d done\n", | |
2d700715 | 729 | vbi_cap_buf->vb.vb2_buf.index); |
3f682ffc HV |
730 | } |
731 | dev->dqbuf_error = false; | |
732 | ||
733 | update_mv: | |
734 | /* Update the test pattern movement counters */ | |
735 | tpg_update_mv_count(&dev->tpg, dev->field_cap == V4L2_FIELD_NONE || | |
736 | dev->field_cap == V4L2_FIELD_ALTERNATE); | |
737 | } | |
738 | ||
739 | static int vivid_thread_vid_cap(void *data) | |
740 | { | |
741 | struct vivid_dev *dev = data; | |
742 | u64 numerators_since_start; | |
743 | u64 buffers_since_start; | |
744 | u64 next_jiffies_since_start; | |
745 | unsigned long jiffies_since_start; | |
746 | unsigned long cur_jiffies; | |
747 | unsigned wait_jiffies; | |
748 | unsigned numerator; | |
749 | unsigned denominator; | |
750 | int dropped_bufs; | |
751 | ||
752 | dprintk(dev, 1, "Video Capture Thread Start\n"); | |
753 | ||
754 | set_freezable(); | |
755 | ||
756 | /* Resets frame counters */ | |
757 | dev->cap_seq_offset = 0; | |
758 | dev->cap_seq_count = 0; | |
759 | dev->cap_seq_resync = false; | |
760 | dev->jiffies_vid_cap = jiffies; | |
761 | ||
762 | for (;;) { | |
763 | try_to_freeze(); | |
764 | if (kthread_should_stop()) | |
765 | break; | |
766 | ||
767 | mutex_lock(&dev->mutex); | |
768 | cur_jiffies = jiffies; | |
769 | if (dev->cap_seq_resync) { | |
770 | dev->jiffies_vid_cap = cur_jiffies; | |
771 | dev->cap_seq_offset = dev->cap_seq_count + 1; | |
772 | dev->cap_seq_count = 0; | |
773 | dev->cap_seq_resync = false; | |
774 | } | |
775 | numerator = dev->timeperframe_vid_cap.numerator; | |
776 | denominator = dev->timeperframe_vid_cap.denominator; | |
777 | ||
778 | if (dev->field_cap == V4L2_FIELD_ALTERNATE) | |
779 | denominator *= 2; | |
780 | ||
781 | /* Calculate the number of jiffies since we started streaming */ | |
782 | jiffies_since_start = cur_jiffies - dev->jiffies_vid_cap; | |
783 | /* Get the number of buffers streamed since the start */ | |
784 | buffers_since_start = (u64)jiffies_since_start * denominator + | |
785 | (HZ * numerator) / 2; | |
786 | do_div(buffers_since_start, HZ * numerator); | |
787 | ||
788 | /* | |
789 | * After more than 0xf0000000 (rounded down to a multiple of | |
790 | * 'jiffies-per-day' to ease jiffies_to_msecs calculation) | |
791 | * jiffies have passed since we started streaming reset the | |
792 | * counters and keep track of the sequence offset. | |
793 | */ | |
794 | if (jiffies_since_start > JIFFIES_RESYNC) { | |
795 | dev->jiffies_vid_cap = cur_jiffies; | |
796 | dev->cap_seq_offset = buffers_since_start; | |
797 | buffers_since_start = 0; | |
798 | } | |
799 | dropped_bufs = buffers_since_start + dev->cap_seq_offset - dev->cap_seq_count; | |
800 | dev->cap_seq_count = buffers_since_start + dev->cap_seq_offset; | |
801 | dev->vid_cap_seq_count = dev->cap_seq_count - dev->vid_cap_seq_start; | |
802 | dev->vbi_cap_seq_count = dev->cap_seq_count - dev->vbi_cap_seq_start; | |
803 | ||
804 | vivid_thread_vid_cap_tick(dev, dropped_bufs); | |
805 | ||
806 | /* | |
807 | * Calculate the number of 'numerators' streamed since we started, | |
808 | * including the current buffer. | |
809 | */ | |
810 | numerators_since_start = ++buffers_since_start * numerator; | |
811 | ||
812 | /* And the number of jiffies since we started */ | |
813 | jiffies_since_start = jiffies - dev->jiffies_vid_cap; | |
814 | ||
815 | mutex_unlock(&dev->mutex); | |
816 | ||
817 | /* | |
818 | * Calculate when that next buffer is supposed to start | |
819 | * in jiffies since we started streaming. | |
820 | */ | |
821 | next_jiffies_since_start = numerators_since_start * HZ + | |
822 | denominator / 2; | |
823 | do_div(next_jiffies_since_start, denominator); | |
824 | /* If it is in the past, then just schedule asap */ | |
825 | if (next_jiffies_since_start < jiffies_since_start) | |
826 | next_jiffies_since_start = jiffies_since_start; | |
827 | ||
828 | wait_jiffies = next_jiffies_since_start - jiffies_since_start; | |
829 | schedule_timeout_interruptible(wait_jiffies ? wait_jiffies : 1); | |
830 | } | |
831 | dprintk(dev, 1, "Video Capture Thread End\n"); | |
832 | return 0; | |
833 | } | |
834 | ||
835 | static void vivid_grab_controls(struct vivid_dev *dev, bool grab) | |
836 | { | |
837 | v4l2_ctrl_grab(dev->ctrl_has_crop_cap, grab); | |
838 | v4l2_ctrl_grab(dev->ctrl_has_compose_cap, grab); | |
839 | v4l2_ctrl_grab(dev->ctrl_has_scaler_cap, grab); | |
840 | } | |
841 | ||
842 | int vivid_start_generating_vid_cap(struct vivid_dev *dev, bool *pstreaming) | |
843 | { | |
844 | dprintk(dev, 1, "%s\n", __func__); | |
845 | ||
846 | if (dev->kthread_vid_cap) { | |
847 | u32 seq_count = dev->cap_seq_count + dev->seq_wrap * 128; | |
848 | ||
849 | if (pstreaming == &dev->vid_cap_streaming) | |
850 | dev->vid_cap_seq_start = seq_count; | |
851 | else | |
852 | dev->vbi_cap_seq_start = seq_count; | |
853 | *pstreaming = true; | |
854 | return 0; | |
855 | } | |
856 | ||
857 | /* Resets frame counters */ | |
858 | tpg_init_mv_count(&dev->tpg); | |
859 | ||
860 | dev->vid_cap_seq_start = dev->seq_wrap * 128; | |
861 | dev->vbi_cap_seq_start = dev->seq_wrap * 128; | |
862 | ||
863 | dev->kthread_vid_cap = kthread_run(vivid_thread_vid_cap, dev, | |
864 | "%s-vid-cap", dev->v4l2_dev.name); | |
865 | ||
866 | if (IS_ERR(dev->kthread_vid_cap)) { | |
867 | v4l2_err(&dev->v4l2_dev, "kernel_thread() failed\n"); | |
868 | return PTR_ERR(dev->kthread_vid_cap); | |
869 | } | |
870 | *pstreaming = true; | |
871 | vivid_grab_controls(dev, true); | |
872 | ||
873 | dprintk(dev, 1, "returning from %s\n", __func__); | |
874 | return 0; | |
875 | } | |
876 | ||
877 | void vivid_stop_generating_vid_cap(struct vivid_dev *dev, bool *pstreaming) | |
878 | { | |
879 | dprintk(dev, 1, "%s\n", __func__); | |
880 | ||
881 | if (dev->kthread_vid_cap == NULL) | |
882 | return; | |
883 | ||
884 | *pstreaming = false; | |
885 | if (pstreaming == &dev->vid_cap_streaming) { | |
886 | /* Release all active buffers */ | |
887 | while (!list_empty(&dev->vid_cap_active)) { | |
888 | struct vivid_buffer *buf; | |
889 | ||
890 | buf = list_entry(dev->vid_cap_active.next, | |
891 | struct vivid_buffer, list); | |
892 | list_del(&buf->list); | |
2d700715 | 893 | vb2_buffer_done(&buf->vb.vb2_buf, VB2_BUF_STATE_ERROR); |
3f682ffc | 894 | dprintk(dev, 2, "vid_cap buffer %d done\n", |
2d700715 | 895 | buf->vb.vb2_buf.index); |
3f682ffc HV |
896 | } |
897 | } | |
898 | ||
899 | if (pstreaming == &dev->vbi_cap_streaming) { | |
900 | while (!list_empty(&dev->vbi_cap_active)) { | |
901 | struct vivid_buffer *buf; | |
902 | ||
903 | buf = list_entry(dev->vbi_cap_active.next, | |
904 | struct vivid_buffer, list); | |
905 | list_del(&buf->list); | |
2d700715 | 906 | vb2_buffer_done(&buf->vb.vb2_buf, VB2_BUF_STATE_ERROR); |
3f682ffc | 907 | dprintk(dev, 2, "vbi_cap buffer %d done\n", |
2d700715 | 908 | buf->vb.vb2_buf.index); |
3f682ffc HV |
909 | } |
910 | } | |
911 | ||
912 | if (dev->vid_cap_streaming || dev->vbi_cap_streaming) | |
913 | return; | |
914 | ||
915 | /* shutdown control thread */ | |
916 | vivid_grab_controls(dev, false); | |
917 | mutex_unlock(&dev->mutex); | |
918 | kthread_stop(dev->kthread_vid_cap); | |
919 | dev->kthread_vid_cap = NULL; | |
920 | mutex_lock(&dev->mutex); | |
921 | } |