1 | // SPDX-License-Identifier: GPL-2.0-or-later |
2 | /* |
3 | * cx18 file operation functions |
4 | * |
5 | * Derived from ivtv-fileops.c |
6 | * |
7 | * Copyright (C) 2007 Hans Verkuil <hverkuil@xs4all.nl> |
8 | * Copyright (C) 2008 Andy Walls <awalls@md.metrocast.net> |
9 | */ |
10 | |
11 | #include "cx18-driver.h" |
12 | #include "cx18-fileops.h" |
13 | #include "cx18-i2c.h" |
14 | #include "cx18-queue.h" |
15 | #include "cx18-vbi.h" |
16 | #include "cx18-audio.h" |
17 | #include "cx18-mailbox.h" |
18 | #include "cx18-scb.h" |
19 | #include "cx18-streams.h" |
20 | #include "cx18-controls.h" |
21 | #include "cx18-ioctl.h" |
22 | #include "cx18-cards.h" |
23 | #include <media/v4l2-event.h> |
24 | |
25 | /* This function tries to claim the stream for a specific file descriptor. |
26 | If no one else is using this stream then the stream is claimed and |
27 | associated VBI and IDX streams are also automatically claimed. |
28 | Possible error returns: -EBUSY if someone else has claimed |
29 | the stream or 0 on success. */ |
30 | int cx18_claim_stream(struct cx18_open_id *id, int type) |
31 | { |
32 | struct cx18 *cx = id->cx; |
33 | struct cx18_stream *s = &cx->streams[type]; |
34 | struct cx18_stream *s_assoc; |
35 | |
36 | /* Nothing should ever try to directly claim the IDX stream */ |
37 | if (type == CX18_ENC_STREAM_TYPE_IDX) { |
38 | CX18_WARN("MPEG Index stream cannot be claimed directly, but something tried.\n" ); |
39 | return -EINVAL; |
40 | } |
41 | |
42 | if (test_and_set_bit(CX18_F_S_CLAIMED, addr: &s->s_flags)) { |
43 | /* someone already claimed this stream */ |
44 | if (s->id == id->open_id) { |
45 | /* yes, this file descriptor did. So that's OK. */ |
46 | return 0; |
47 | } |
48 | if (s->id == -1 && type == CX18_ENC_STREAM_TYPE_VBI) { |
49 | /* VBI is handled already internally, now also assign |
50 | the file descriptor to this stream for external |
51 | reading of the stream. */ |
52 | s->id = id->open_id; |
53 | CX18_DEBUG_INFO("Start Read VBI\n" ); |
54 | return 0; |
55 | } |
56 | /* someone else is using this stream already */ |
57 | CX18_DEBUG_INFO("Stream %d is busy\n" , type); |
58 | return -EBUSY; |
59 | } |
60 | s->id = id->open_id; |
61 | |
62 | /* |
63 | * CX18_ENC_STREAM_TYPE_MPG needs to claim: |
64 | * CX18_ENC_STREAM_TYPE_VBI, if VBI insertion is on for sliced VBI, or |
65 | * CX18_ENC_STREAM_TYPE_IDX, if VBI insertion is off for sliced VBI |
66 | * (We don't yet fix up MPEG Index entries for our inserted packets). |
67 | * |
68 | * For all other streams we're done. |
69 | */ |
70 | if (type != CX18_ENC_STREAM_TYPE_MPG) |
71 | return 0; |
72 | |
73 | s_assoc = &cx->streams[CX18_ENC_STREAM_TYPE_IDX]; |
74 | if (cx->vbi.insert_mpeg && !cx18_raw_vbi(cx)) |
75 | s_assoc = &cx->streams[CX18_ENC_STREAM_TYPE_VBI]; |
76 | else if (!cx18_stream_enabled(s: s_assoc)) |
77 | return 0; |
78 | |
79 | set_bit(CX18_F_S_CLAIMED, addr: &s_assoc->s_flags); |
80 | |
81 | /* mark that it is used internally */ |
82 | set_bit(CX18_F_S_INTERNAL_USE, addr: &s_assoc->s_flags); |
83 | return 0; |
84 | } |
85 | EXPORT_SYMBOL(cx18_claim_stream); |
86 | |
87 | /* This function releases a previously claimed stream. It will take into |
88 | account associated VBI streams. */ |
89 | void cx18_release_stream(struct cx18_stream *s) |
90 | { |
91 | struct cx18 *cx = s->cx; |
92 | struct cx18_stream *s_assoc; |
93 | |
94 | s->id = -1; |
95 | if (s->type == CX18_ENC_STREAM_TYPE_IDX) { |
96 | /* |
97 | * The IDX stream is only used internally, and can |
98 | * only be indirectly unclaimed by unclaiming the MPG stream. |
99 | */ |
100 | return; |
101 | } |
102 | |
103 | if (s->type == CX18_ENC_STREAM_TYPE_VBI && |
104 | test_bit(CX18_F_S_INTERNAL_USE, &s->s_flags)) { |
105 | /* this stream is still in use internally */ |
106 | return; |
107 | } |
108 | if (!test_and_clear_bit(CX18_F_S_CLAIMED, addr: &s->s_flags)) { |
109 | CX18_DEBUG_WARN("Release stream %s not in use!\n" , s->name); |
110 | return; |
111 | } |
112 | |
113 | cx18_flush_queues(s); |
114 | |
115 | /* |
116 | * CX18_ENC_STREAM_TYPE_MPG needs to release the |
117 | * CX18_ENC_STREAM_TYPE_VBI and/or CX18_ENC_STREAM_TYPE_IDX streams. |
118 | * |
119 | * For all other streams we're done. |
120 | */ |
121 | if (s->type != CX18_ENC_STREAM_TYPE_MPG) |
122 | return; |
123 | |
124 | /* Unclaim the associated MPEG Index stream */ |
125 | s_assoc = &cx->streams[CX18_ENC_STREAM_TYPE_IDX]; |
126 | if (test_and_clear_bit(CX18_F_S_INTERNAL_USE, addr: &s_assoc->s_flags)) { |
127 | clear_bit(CX18_F_S_CLAIMED, addr: &s_assoc->s_flags); |
128 | cx18_flush_queues(s: s_assoc); |
129 | } |
130 | |
131 | /* Unclaim the associated VBI stream */ |
132 | s_assoc = &cx->streams[CX18_ENC_STREAM_TYPE_VBI]; |
133 | if (test_and_clear_bit(CX18_F_S_INTERNAL_USE, addr: &s_assoc->s_flags)) { |
134 | if (s_assoc->id == -1) { |
135 | /* |
136 | * The VBI stream is not still claimed by a file |
137 | * descriptor, so completely unclaim it. |
138 | */ |
139 | clear_bit(CX18_F_S_CLAIMED, addr: &s_assoc->s_flags); |
140 | cx18_flush_queues(s: s_assoc); |
141 | } |
142 | } |
143 | } |
144 | EXPORT_SYMBOL(cx18_release_stream); |
145 | |
146 | static void cx18_dualwatch(struct cx18 *cx) |
147 | { |
148 | struct v4l2_tuner vt; |
149 | u32 new_stereo_mode; |
150 | const u32 dual = 0x0200; |
151 | |
152 | new_stereo_mode = v4l2_ctrl_g_ctrl(ctrl: cx->cxhdl.audio_mode); |
153 | memset(&vt, 0, sizeof(vt)); |
154 | cx18_call_all(cx, tuner, g_tuner, &vt); |
155 | if (vt.audmode == V4L2_TUNER_MODE_LANG1_LANG2 && |
156 | (vt.rxsubchans & V4L2_TUNER_SUB_LANG2)) |
157 | new_stereo_mode = dual; |
158 | |
159 | if (new_stereo_mode == cx->dualwatch_stereo_mode) |
160 | return; |
161 | |
162 | CX18_DEBUG_INFO("dualwatch: change stereo flag from 0x%x to 0x%x.\n" , |
163 | cx->dualwatch_stereo_mode, new_stereo_mode); |
164 | if (v4l2_ctrl_s_ctrl(ctrl: cx->cxhdl.audio_mode, val: new_stereo_mode)) |
165 | CX18_DEBUG_INFO("dualwatch: changing stereo flag failed\n" ); |
166 | } |
167 | |
168 | |
169 | static struct cx18_mdl *cx18_get_mdl(struct cx18_stream *s, int non_block, |
170 | int *err) |
171 | { |
172 | struct cx18 *cx = s->cx; |
173 | struct cx18_stream *s_vbi = &cx->streams[CX18_ENC_STREAM_TYPE_VBI]; |
174 | struct cx18_mdl *mdl; |
175 | DEFINE_WAIT(wait); |
176 | |
177 | *err = 0; |
178 | while (1) { |
179 | if (s->type == CX18_ENC_STREAM_TYPE_MPG) { |
180 | /* Process pending program updates and VBI data */ |
181 | if (time_after(jiffies, cx->dualwatch_jiffies + msecs_to_jiffies(1000))) { |
182 | cx->dualwatch_jiffies = jiffies; |
183 | cx18_dualwatch(cx); |
184 | } |
185 | if (test_bit(CX18_F_S_INTERNAL_USE, &s_vbi->s_flags) && |
186 | !test_bit(CX18_F_S_APPL_IO, &s_vbi->s_flags)) { |
187 | while ((mdl = cx18_dequeue(s: s_vbi, |
188 | q: &s_vbi->q_full))) { |
189 | /* byteswap and process VBI data */ |
190 | cx18_process_vbi_data(cx, mdl, |
191 | streamtype: s_vbi->type); |
192 | cx18_stream_put_mdl_fw(s: s_vbi, mdl); |
193 | } |
194 | } |
195 | mdl = &cx->vbi.sliced_mpeg_mdl; |
196 | if (mdl->readpos != mdl->bytesused) |
197 | return mdl; |
198 | } |
199 | |
200 | /* do we have new data? */ |
201 | mdl = cx18_dequeue(s, q: &s->q_full); |
202 | if (mdl) { |
203 | if (!test_and_clear_bit(CX18_F_M_NEED_SWAP, |
204 | addr: &mdl->m_flags)) |
205 | return mdl; |
206 | if (s->type == CX18_ENC_STREAM_TYPE_MPG) |
207 | /* byteswap MPG data */ |
208 | cx18_mdl_swap(mdl); |
209 | else { |
210 | /* byteswap and process VBI data */ |
211 | cx18_process_vbi_data(cx, mdl, streamtype: s->type); |
212 | } |
213 | return mdl; |
214 | } |
215 | |
216 | /* return if end of stream */ |
217 | if (!test_bit(CX18_F_S_STREAMING, &s->s_flags)) { |
218 | CX18_DEBUG_INFO("EOS %s\n" , s->name); |
219 | return NULL; |
220 | } |
221 | |
222 | /* return if file was opened with O_NONBLOCK */ |
223 | if (non_block) { |
224 | *err = -EAGAIN; |
225 | return NULL; |
226 | } |
227 | |
228 | /* wait for more data to arrive */ |
229 | prepare_to_wait(wq_head: &s->waitq, wq_entry: &wait, TASK_INTERRUPTIBLE); |
230 | /* New buffers might have become available before we were added |
231 | to the waitqueue */ |
232 | if (!atomic_read(v: &s->q_full.depth)) |
233 | schedule(); |
234 | finish_wait(wq_head: &s->waitq, wq_entry: &wait); |
235 | if (signal_pending(current)) { |
236 | /* return if a signal was received */ |
237 | CX18_DEBUG_INFO("User stopped %s\n" , s->name); |
238 | *err = -EINTR; |
239 | return NULL; |
240 | } |
241 | } |
242 | } |
243 | |
244 | static void cx18_setup_sliced_vbi_mdl(struct cx18 *cx) |
245 | { |
246 | struct cx18_mdl *mdl = &cx->vbi.sliced_mpeg_mdl; |
247 | struct cx18_buffer *buf = &cx->vbi.sliced_mpeg_buf; |
248 | int idx = cx->vbi.inserted_frame % CX18_VBI_FRAMES; |
249 | |
250 | buf->buf = cx->vbi.sliced_mpeg_data[idx]; |
251 | buf->bytesused = cx->vbi.sliced_mpeg_size[idx]; |
252 | buf->readpos = 0; |
253 | |
254 | mdl->curr_buf = NULL; |
255 | mdl->bytesused = cx->vbi.sliced_mpeg_size[idx]; |
256 | mdl->readpos = 0; |
257 | } |
258 | |
259 | static size_t cx18_copy_buf_to_user(struct cx18_stream *s, |
260 | struct cx18_buffer *buf, char __user *ubuf, size_t ucount, bool *stop) |
261 | { |
262 | struct cx18 *cx = s->cx; |
263 | size_t len = buf->bytesused - buf->readpos; |
264 | |
265 | *stop = false; |
266 | if (len > ucount) |
267 | len = ucount; |
268 | if (cx->vbi.insert_mpeg && s->type == CX18_ENC_STREAM_TYPE_MPG && |
269 | !cx18_raw_vbi(cx) && buf != &cx->vbi.sliced_mpeg_buf) { |
270 | /* |
271 | * Try to find a good splice point in the PS, just before |
272 | * an MPEG-2 Program Pack start code, and provide only |
273 | * up to that point to the user, so it's easy to insert VBI data |
274 | * the next time around. |
275 | * |
276 | * This will not work for an MPEG-2 TS and has only been |
277 | * verified by analysis to work for an MPEG-2 PS. Helen Buus |
278 | * pointed out this works for the CX23416 MPEG-2 DVD compatible |
279 | * stream, and research indicates both the MPEG 2 SVCD and DVD |
280 | * stream types use an MPEG-2 PS container. |
281 | */ |
282 | /* |
283 | * An MPEG-2 Program Stream (PS) is a series of |
284 | * MPEG-2 Program Packs terminated by an |
285 | * MPEG Program End Code after the last Program Pack. |
286 | * A Program Pack may hold a PS System Header packet and any |
287 | * number of Program Elementary Stream (PES) Packets |
288 | */ |
289 | const char *start = buf->buf + buf->readpos; |
290 | const char *p = start + 1; |
291 | const u8 *q; |
292 | u8 ch = cx->search_pack_header ? 0xba : 0xe0; |
293 | int stuffing, i; |
294 | |
295 | while (start + len > p) { |
296 | /* Scan for a 0 to find a potential MPEG-2 start code */ |
297 | q = memchr(p, c: 0, size: start + len - p); |
298 | if (q == NULL) |
299 | break; |
300 | p = q + 1; |
301 | /* |
302 | * Keep looking if not a |
303 | * MPEG-2 Pack header start code: 0x00 0x00 0x01 0xba |
304 | * or MPEG-2 video PES start code: 0x00 0x00 0x01 0xe0 |
305 | */ |
306 | if ((char *)q + 15 >= buf->buf + buf->bytesused || |
307 | q[1] != 0 || q[2] != 1 || q[3] != ch) |
308 | continue; |
309 | |
310 | /* If expecting the primary video PES */ |
311 | if (!cx->search_pack_header) { |
312 | /* Continue if it couldn't be a PES packet */ |
313 | if ((q[6] & 0xc0) != 0x80) |
314 | continue; |
315 | /* Check if a PTS or PTS & DTS follow */ |
316 | if (((q[7] & 0xc0) == 0x80 && /* PTS only */ |
317 | (q[9] & 0xf0) == 0x20) || /* PTS only */ |
318 | ((q[7] & 0xc0) == 0xc0 && /* PTS & DTS */ |
319 | (q[9] & 0xf0) == 0x30)) { /* DTS follows */ |
320 | /* Assume we found the video PES hdr */ |
321 | ch = 0xba; /* next want a Program Pack*/ |
322 | cx->search_pack_header = 1; |
323 | p = q + 9; /* Skip this video PES hdr */ |
324 | } |
325 | continue; |
326 | } |
327 | |
328 | /* We may have found a Program Pack start code */ |
329 | |
330 | /* Get the count of stuffing bytes & verify them */ |
331 | stuffing = q[13] & 7; |
332 | /* all stuffing bytes must be 0xff */ |
333 | for (i = 0; i < stuffing; i++) |
334 | if (q[14 + i] != 0xff) |
335 | break; |
336 | if (i == stuffing && /* right number of stuffing bytes*/ |
337 | (q[4] & 0xc4) == 0x44 && /* marker check */ |
338 | (q[12] & 3) == 3 && /* marker check */ |
339 | q[14 + stuffing] == 0 && /* PES Pack or Sys Hdr */ |
340 | q[15 + stuffing] == 0 && |
341 | q[16 + stuffing] == 1) { |
342 | /* We declare we actually found a Program Pack*/ |
343 | cx->search_pack_header = 0; /* expect vid PES */ |
344 | len = (char *)q - start; |
345 | cx18_setup_sliced_vbi_mdl(cx); |
346 | *stop = true; |
347 | break; |
348 | } |
349 | } |
350 | } |
351 | if (copy_to_user(to: ubuf, from: (u8 *)buf->buf + buf->readpos, n: len)) { |
352 | CX18_DEBUG_WARN("copy %zd bytes to user failed for %s\n" , |
353 | len, s->name); |
354 | return -EFAULT; |
355 | } |
356 | buf->readpos += len; |
357 | if (s->type == CX18_ENC_STREAM_TYPE_MPG && |
358 | buf != &cx->vbi.sliced_mpeg_buf) |
359 | cx->mpg_data_received += len; |
360 | return len; |
361 | } |
362 | |
363 | static size_t cx18_copy_mdl_to_user(struct cx18_stream *s, |
364 | struct cx18_mdl *mdl, char __user *ubuf, size_t ucount) |
365 | { |
366 | size_t tot_written = 0; |
367 | int rc; |
368 | bool stop = false; |
369 | |
370 | if (mdl->curr_buf == NULL) |
371 | mdl->curr_buf = list_first_entry(&mdl->buf_list, |
372 | struct cx18_buffer, list); |
373 | |
374 | if (list_entry_is_past_end(mdl->curr_buf, &mdl->buf_list, list)) { |
375 | /* |
376 | * For some reason we've exhausted the buffers, but the MDL |
377 | * object still said some data was unread. |
378 | * Fix that and bail out. |
379 | */ |
380 | mdl->readpos = mdl->bytesused; |
381 | return 0; |
382 | } |
383 | |
384 | list_for_each_entry_from(mdl->curr_buf, &mdl->buf_list, list) { |
385 | |
386 | if (mdl->curr_buf->readpos >= mdl->curr_buf->bytesused) |
387 | continue; |
388 | |
389 | rc = cx18_copy_buf_to_user(s, buf: mdl->curr_buf, ubuf: ubuf + tot_written, |
390 | ucount: ucount - tot_written, stop: &stop); |
391 | if (rc < 0) |
392 | return rc; |
393 | mdl->readpos += rc; |
394 | tot_written += rc; |
395 | |
396 | if (stop || /* Forced stopping point for VBI insertion */ |
397 | tot_written >= ucount || /* Reader request satisfied */ |
398 | mdl->curr_buf->readpos < mdl->curr_buf->bytesused || |
399 | mdl->readpos >= mdl->bytesused) /* MDL buffers drained */ |
400 | break; |
401 | } |
402 | return tot_written; |
403 | } |
404 | |
405 | static ssize_t cx18_read(struct cx18_stream *s, char __user *ubuf, |
406 | size_t tot_count, int non_block) |
407 | { |
408 | struct cx18 *cx = s->cx; |
409 | size_t tot_written = 0; |
410 | int single_frame = 0; |
411 | |
412 | if (atomic_read(v: &cx->ana_capturing) == 0 && s->id == -1) { |
413 | /* shouldn't happen */ |
414 | CX18_DEBUG_WARN("Stream %s not initialized before read\n" , |
415 | s->name); |
416 | return -EIO; |
417 | } |
418 | |
419 | /* Each VBI buffer is one frame, the v4l2 API says that for VBI the |
420 | frames should arrive one-by-one, so make sure we never output more |
421 | than one VBI frame at a time */ |
422 | if (s->type == CX18_ENC_STREAM_TYPE_VBI && !cx18_raw_vbi(cx)) |
423 | single_frame = 1; |
424 | |
425 | for (;;) { |
426 | struct cx18_mdl *mdl; |
427 | int rc; |
428 | |
429 | mdl = cx18_get_mdl(s, non_block, err: &rc); |
430 | /* if there is no data available... */ |
431 | if (mdl == NULL) { |
432 | /* if we got data, then return that regardless */ |
433 | if (tot_written) |
434 | break; |
435 | /* EOS condition */ |
436 | if (rc == 0) { |
437 | clear_bit(CX18_F_S_STREAMOFF, addr: &s->s_flags); |
438 | clear_bit(CX18_F_S_APPL_IO, addr: &s->s_flags); |
439 | cx18_release_stream(s); |
440 | } |
441 | /* set errno */ |
442 | return rc; |
443 | } |
444 | |
445 | rc = cx18_copy_mdl_to_user(s, mdl, ubuf: ubuf + tot_written, |
446 | ucount: tot_count - tot_written); |
447 | |
448 | if (mdl != &cx->vbi.sliced_mpeg_mdl) { |
449 | if (mdl->readpos == mdl->bytesused) |
450 | cx18_stream_put_mdl_fw(s, mdl); |
451 | else |
452 | cx18_push(s, mdl, q: &s->q_full); |
453 | } else if (mdl->readpos == mdl->bytesused) { |
454 | int idx = cx->vbi.inserted_frame % CX18_VBI_FRAMES; |
455 | |
456 | cx->vbi.sliced_mpeg_size[idx] = 0; |
457 | cx->vbi.inserted_frame++; |
458 | cx->vbi_data_inserted += mdl->bytesused; |
459 | } |
460 | if (rc < 0) |
461 | return rc; |
462 | tot_written += rc; |
463 | |
464 | if (tot_written == tot_count || single_frame) |
465 | break; |
466 | } |
467 | return tot_written; |
468 | } |
469 | |
470 | static ssize_t cx18_read_pos(struct cx18_stream *s, char __user *ubuf, |
471 | size_t count, loff_t *pos, int non_block) |
472 | { |
473 | ssize_t rc = count ? cx18_read(s, ubuf, tot_count: count, non_block) : 0; |
474 | struct cx18 *cx = s->cx; |
475 | |
476 | CX18_DEBUG_HI_FILE("read %zd from %s, got %zd\n" , count, s->name, rc); |
477 | if (rc > 0) |
478 | *pos += rc; |
479 | return rc; |
480 | } |
481 | |
482 | int cx18_start_capture(struct cx18_open_id *id) |
483 | { |
484 | struct cx18 *cx = id->cx; |
485 | struct cx18_stream *s = &cx->streams[id->type]; |
486 | struct cx18_stream *s_vbi; |
487 | struct cx18_stream *s_idx; |
488 | |
489 | if (s->type == CX18_ENC_STREAM_TYPE_RAD) { |
490 | /* you cannot read from these stream types. */ |
491 | return -EPERM; |
492 | } |
493 | |
494 | /* Try to claim this stream. */ |
495 | if (cx18_claim_stream(id, s->type)) |
496 | return -EBUSY; |
497 | |
498 | /* If capture is already in progress, then we also have to |
499 | do nothing extra. */ |
500 | if (test_bit(CX18_F_S_STREAMOFF, &s->s_flags) || |
501 | test_and_set_bit(CX18_F_S_STREAMING, addr: &s->s_flags)) { |
502 | set_bit(CX18_F_S_APPL_IO, addr: &s->s_flags); |
503 | return 0; |
504 | } |
505 | |
506 | /* Start associated VBI or IDX stream capture if required */ |
507 | s_vbi = &cx->streams[CX18_ENC_STREAM_TYPE_VBI]; |
508 | s_idx = &cx->streams[CX18_ENC_STREAM_TYPE_IDX]; |
509 | if (s->type == CX18_ENC_STREAM_TYPE_MPG) { |
510 | /* |
511 | * The VBI and IDX streams should have been claimed |
512 | * automatically, if for internal use, when the MPG stream was |
513 | * claimed. We only need to start these streams capturing. |
514 | */ |
515 | if (test_bit(CX18_F_S_INTERNAL_USE, &s_idx->s_flags) && |
516 | !test_and_set_bit(CX18_F_S_STREAMING, addr: &s_idx->s_flags)) { |
517 | if (cx18_start_v4l2_encode_stream(s: s_idx)) { |
518 | CX18_DEBUG_WARN("IDX capture start failed\n" ); |
519 | clear_bit(CX18_F_S_STREAMING, addr: &s_idx->s_flags); |
520 | goto start_failed; |
521 | } |
522 | CX18_DEBUG_INFO("IDX capture started\n" ); |
523 | } |
524 | if (test_bit(CX18_F_S_INTERNAL_USE, &s_vbi->s_flags) && |
525 | !test_and_set_bit(CX18_F_S_STREAMING, addr: &s_vbi->s_flags)) { |
526 | if (cx18_start_v4l2_encode_stream(s: s_vbi)) { |
527 | CX18_DEBUG_WARN("VBI capture start failed\n" ); |
528 | clear_bit(CX18_F_S_STREAMING, addr: &s_vbi->s_flags); |
529 | goto start_failed; |
530 | } |
531 | CX18_DEBUG_INFO("VBI insertion started\n" ); |
532 | } |
533 | } |
534 | |
535 | /* Tell the card to start capturing */ |
536 | if (!cx18_start_v4l2_encode_stream(s)) { |
537 | /* We're done */ |
538 | set_bit(CX18_F_S_APPL_IO, addr: &s->s_flags); |
539 | /* Resume a possibly paused encoder */ |
540 | if (test_and_clear_bit(CX18_F_I_ENC_PAUSED, addr: &cx->i_flags)) |
541 | cx18_vapi(cx, CX18_CPU_CAPTURE_PAUSE, args: 1, s->handle); |
542 | return 0; |
543 | } |
544 | |
545 | start_failed: |
546 | CX18_DEBUG_WARN("Failed to start capturing for stream %s\n" , s->name); |
547 | |
548 | /* |
549 | * The associated VBI and IDX streams for internal use are released |
550 | * automatically when the MPG stream is released. We only need to stop |
551 | * the associated stream. |
552 | */ |
553 | if (s->type == CX18_ENC_STREAM_TYPE_MPG) { |
554 | /* Stop the IDX stream which is always for internal use */ |
555 | if (test_bit(CX18_F_S_STREAMING, &s_idx->s_flags)) { |
556 | cx18_stop_v4l2_encode_stream(s: s_idx, gop_end: 0); |
557 | clear_bit(CX18_F_S_STREAMING, addr: &s_idx->s_flags); |
558 | } |
559 | /* Stop the VBI stream, if only running for internal use */ |
560 | if (test_bit(CX18_F_S_STREAMING, &s_vbi->s_flags) && |
561 | !test_bit(CX18_F_S_APPL_IO, &s_vbi->s_flags)) { |
562 | cx18_stop_v4l2_encode_stream(s: s_vbi, gop_end: 0); |
563 | clear_bit(CX18_F_S_STREAMING, addr: &s_vbi->s_flags); |
564 | } |
565 | } |
566 | clear_bit(CX18_F_S_STREAMING, addr: &s->s_flags); |
567 | cx18_release_stream(s); /* Also releases associated streams */ |
568 | return -EIO; |
569 | } |
570 | |
571 | ssize_t cx18_v4l2_read(struct file *filp, char __user *buf, size_t count, |
572 | loff_t *pos) |
573 | { |
574 | struct cx18_open_id *id = file2id(file: filp); |
575 | struct cx18 *cx = id->cx; |
576 | struct cx18_stream *s = &cx->streams[id->type]; |
577 | int rc; |
578 | |
579 | CX18_DEBUG_HI_FILE("read %zd bytes from %s\n" , count, s->name); |
580 | |
581 | mutex_lock(&cx->serialize_lock); |
582 | rc = cx18_start_capture(id); |
583 | mutex_unlock(lock: &cx->serialize_lock); |
584 | if (rc) |
585 | return rc; |
586 | |
587 | return cx18_read_pos(s, ubuf: buf, count, pos, non_block: filp->f_flags & O_NONBLOCK); |
588 | } |
589 | |
590 | __poll_t cx18_v4l2_enc_poll(struct file *filp, poll_table *wait) |
591 | { |
592 | __poll_t req_events = poll_requested_events(p: wait); |
593 | struct cx18_open_id *id = file2id(file: filp); |
594 | struct cx18 *cx = id->cx; |
595 | struct cx18_stream *s = &cx->streams[id->type]; |
596 | int eof = test_bit(CX18_F_S_STREAMOFF, &s->s_flags); |
597 | __poll_t res = 0; |
598 | |
599 | /* Start a capture if there is none */ |
600 | if (!eof && !test_bit(CX18_F_S_STREAMING, &s->s_flags) && |
601 | (req_events & (EPOLLIN | EPOLLRDNORM))) { |
602 | int rc; |
603 | |
604 | mutex_lock(&cx->serialize_lock); |
605 | rc = cx18_start_capture(id); |
606 | mutex_unlock(lock: &cx->serialize_lock); |
607 | if (rc) { |
608 | CX18_DEBUG_INFO("Could not start capture for %s (%d)\n" , |
609 | s->name, rc); |
610 | return EPOLLERR; |
611 | } |
612 | CX18_DEBUG_FILE("Encoder poll started capture\n" ); |
613 | } |
614 | |
615 | /* add stream's waitq to the poll list */ |
616 | CX18_DEBUG_HI_FILE("Encoder poll\n" ); |
617 | if (v4l2_event_pending(fh: &id->fh)) |
618 | res |= EPOLLPRI; |
619 | else |
620 | poll_wait(filp, wait_address: &s->waitq, p: wait); |
621 | |
622 | if (atomic_read(v: &s->q_full.depth)) |
623 | return res | EPOLLIN | EPOLLRDNORM; |
624 | if (eof) |
625 | return res | EPOLLHUP; |
626 | return res; |
627 | } |
628 | |
629 | void cx18_vb_timeout(struct timer_list *t) |
630 | { |
631 | struct cx18_stream *s = from_timer(s, t, vb_timeout); |
632 | |
633 | /* |
634 | * Return all of the buffers in error state, so the vbi/vid inode |
635 | * can return from blocking. |
636 | */ |
637 | cx18_clear_queue(s, state: VB2_BUF_STATE_ERROR); |
638 | } |
639 | |
640 | void cx18_stop_capture(struct cx18_stream *s, int gop_end) |
641 | { |
642 | struct cx18 *cx = s->cx; |
643 | struct cx18_stream *s_vbi = &cx->streams[CX18_ENC_STREAM_TYPE_VBI]; |
644 | struct cx18_stream *s_idx = &cx->streams[CX18_ENC_STREAM_TYPE_IDX]; |
645 | |
646 | CX18_DEBUG_IOCTL("close() of %s\n" , s->name); |
647 | |
648 | /* 'Unclaim' this stream */ |
649 | |
650 | /* Stop capturing */ |
651 | if (test_bit(CX18_F_S_STREAMING, &s->s_flags)) { |
652 | CX18_DEBUG_INFO("close stopping capture\n" ); |
653 | if (s->type == CX18_ENC_STREAM_TYPE_MPG) { |
654 | /* Stop internal use associated VBI and IDX streams */ |
655 | if (test_bit(CX18_F_S_STREAMING, &s_vbi->s_flags) && |
656 | !test_bit(CX18_F_S_APPL_IO, &s_vbi->s_flags)) { |
657 | CX18_DEBUG_INFO("close stopping embedded VBI capture\n" ); |
658 | cx18_stop_v4l2_encode_stream(s: s_vbi, gop_end: 0); |
659 | } |
660 | if (test_bit(CX18_F_S_STREAMING, &s_idx->s_flags)) { |
661 | CX18_DEBUG_INFO("close stopping IDX capture\n" ); |
662 | cx18_stop_v4l2_encode_stream(s: s_idx, gop_end: 0); |
663 | } |
664 | } |
665 | if (s->type == CX18_ENC_STREAM_TYPE_VBI && |
666 | test_bit(CX18_F_S_INTERNAL_USE, &s->s_flags)) |
667 | /* Also used internally, don't stop capturing */ |
668 | s->id = -1; |
669 | else |
670 | cx18_stop_v4l2_encode_stream(s, gop_end); |
671 | } |
672 | if (!gop_end) { |
673 | clear_bit(CX18_F_S_APPL_IO, addr: &s->s_flags); |
674 | clear_bit(CX18_F_S_STREAMOFF, addr: &s->s_flags); |
675 | cx18_release_stream(s); |
676 | } |
677 | } |
678 | |
679 | int cx18_v4l2_close(struct file *filp) |
680 | { |
681 | struct v4l2_fh *fh = filp->private_data; |
682 | struct cx18_open_id *id = fh2id(fh); |
683 | struct cx18 *cx = id->cx; |
684 | struct cx18_stream *s = &cx->streams[id->type]; |
685 | struct video_device *vdev = &s->video_dev; |
686 | |
687 | CX18_DEBUG_IOCTL("close() of %s\n" , s->name); |
688 | |
689 | mutex_lock(&cx->serialize_lock); |
690 | /* Stop radio */ |
691 | if (id->type == CX18_ENC_STREAM_TYPE_RAD && |
692 | v4l2_fh_is_singular_file(filp)) { |
693 | /* Closing radio device, return to TV mode */ |
694 | cx18_mute(cx); |
695 | /* Mark that the radio is no longer in use */ |
696 | clear_bit(CX18_F_I_RADIO_USER, addr: &cx->i_flags); |
697 | /* Switch tuner to TV */ |
698 | cx18_call_all(cx, video, s_std, cx->std); |
699 | /* Select correct audio input (i.e. TV tuner or Line in) */ |
700 | cx18_audio_set_io(cx); |
701 | if (atomic_read(v: &cx->ana_capturing) > 0) { |
702 | /* Undo video mute */ |
703 | cx18_vapi(cx, CX18_CPU_SET_VIDEO_MUTE, args: 2, s->handle, |
704 | (v4l2_ctrl_g_ctrl(ctrl: cx->cxhdl.video_mute) | |
705 | (v4l2_ctrl_g_ctrl(ctrl: cx->cxhdl.video_mute_yuv) << 8))); |
706 | } |
707 | /* Done! Unmute and continue. */ |
708 | cx18_unmute(cx); |
709 | } |
710 | |
711 | if (id->type == CX18_ENC_STREAM_TYPE_YUV && |
712 | filp->private_data == vdev->queue->owner) { |
713 | vb2_queue_release(q: vdev->queue); |
714 | vdev->queue->owner = NULL; |
715 | } |
716 | v4l2_fh_del(fh); |
717 | v4l2_fh_exit(fh); |
718 | |
719 | /* 'Unclaim' this stream */ |
720 | if (id->type != CX18_ENC_STREAM_TYPE_YUV && s->id == id->open_id) |
721 | cx18_stop_capture(s, gop_end: 0); |
722 | kfree(objp: id); |
723 | mutex_unlock(lock: &cx->serialize_lock); |
724 | return 0; |
725 | } |
726 | |
727 | static int cx18_serialized_open(struct cx18_stream *s, struct file *filp) |
728 | { |
729 | struct cx18 *cx = s->cx; |
730 | struct cx18_open_id *item; |
731 | |
732 | CX18_DEBUG_FILE("open %s\n" , s->name); |
733 | |
734 | /* Allocate memory */ |
735 | item = kzalloc(size: sizeof(struct cx18_open_id), GFP_KERNEL); |
736 | if (NULL == item) { |
737 | CX18_DEBUG_WARN("nomem on v4l2 open\n" ); |
738 | return -ENOMEM; |
739 | } |
740 | v4l2_fh_init(fh: &item->fh, vdev: &s->video_dev); |
741 | |
742 | item->cx = cx; |
743 | item->type = s->type; |
744 | |
745 | item->open_id = cx->open_id++; |
746 | filp->private_data = &item->fh; |
747 | v4l2_fh_add(fh: &item->fh); |
748 | |
749 | if (item->type == CX18_ENC_STREAM_TYPE_RAD && |
750 | v4l2_fh_is_singular_file(filp)) { |
751 | if (!test_bit(CX18_F_I_RADIO_USER, &cx->i_flags)) { |
752 | if (atomic_read(v: &cx->ana_capturing) > 0) { |
753 | /* switching to radio while capture is |
754 | in progress is not polite */ |
755 | v4l2_fh_del(fh: &item->fh); |
756 | v4l2_fh_exit(fh: &item->fh); |
757 | kfree(objp: item); |
758 | return -EBUSY; |
759 | } |
760 | } |
761 | |
762 | /* Mark that the radio is being used. */ |
763 | set_bit(CX18_F_I_RADIO_USER, addr: &cx->i_flags); |
764 | /* We have the radio */ |
765 | cx18_mute(cx); |
766 | /* Switch tuner to radio */ |
767 | cx18_call_all(cx, tuner, s_radio); |
768 | /* Select the correct audio input (i.e. radio tuner) */ |
769 | cx18_audio_set_io(cx); |
770 | /* Done! Unmute and continue. */ |
771 | cx18_unmute(cx); |
772 | } |
773 | return 0; |
774 | } |
775 | |
776 | int cx18_v4l2_open(struct file *filp) |
777 | { |
778 | int res; |
779 | struct video_device *video_dev = video_devdata(file: filp); |
780 | struct cx18_stream *s = video_get_drvdata(vdev: video_dev); |
781 | struct cx18 *cx = s->cx; |
782 | |
783 | mutex_lock(&cx->serialize_lock); |
784 | if (cx18_init_on_first_open(cx)) { |
785 | CX18_ERR("Failed to initialize on %s\n" , |
786 | video_device_node_name(video_dev)); |
787 | mutex_unlock(lock: &cx->serialize_lock); |
788 | return -ENXIO; |
789 | } |
790 | res = cx18_serialized_open(s, filp); |
791 | mutex_unlock(lock: &cx->serialize_lock); |
792 | return res; |
793 | } |
794 | |
795 | void cx18_mute(struct cx18 *cx) |
796 | { |
797 | u32 h; |
798 | if (atomic_read(v: &cx->ana_capturing)) { |
799 | h = cx18_find_handle(cx); |
800 | if (h != CX18_INVALID_TASK_HANDLE) |
801 | cx18_vapi(cx, CX18_CPU_SET_AUDIO_MUTE, args: 2, h, 1); |
802 | else |
803 | CX18_ERR("Can't find valid task handle for mute\n" ); |
804 | } |
805 | CX18_DEBUG_INFO("Mute\n" ); |
806 | } |
807 | |
808 | void cx18_unmute(struct cx18 *cx) |
809 | { |
810 | u32 h; |
811 | if (atomic_read(v: &cx->ana_capturing)) { |
812 | h = cx18_find_handle(cx); |
813 | if (h != CX18_INVALID_TASK_HANDLE) { |
814 | cx18_msleep_timeout(msecs: 100, intr: 0); |
815 | cx18_vapi(cx, CX18_CPU_SET_MISC_PARAMETERS, args: 2, h, 12); |
816 | cx18_vapi(cx, CX18_CPU_SET_AUDIO_MUTE, args: 2, h, 0); |
817 | } else |
818 | CX18_ERR("Can't find valid task handle for unmute\n" ); |
819 | } |
820 | CX18_DEBUG_INFO("Unmute\n" ); |
821 | } |
822 | |