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, &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_assoc)) 77 return 0; 78 79 set_bit(CX18_F_S_CLAIMED, &s_assoc->s_flags); 80 81 /* mark that it is used internally */ 82 set_bit(CX18_F_S_INTERNAL_USE, &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, &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, &s_assoc->s_flags)) { 127 clear_bit(CX18_F_S_CLAIMED, &s_assoc->s_flags); 128 cx18_flush_queues(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, &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, &s_assoc->s_flags); 140 cx18_flush_queues(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(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(cx->cxhdl.audio_mode, 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_vbi, 188 &s_vbi->q_full))) { 189 /* byteswap and process VBI data */ 190 cx18_process_vbi_data(cx, mdl, 191 s_vbi->type); 192 cx18_stream_put_mdl_fw(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, &s->q_full); 202 if (mdl) { 203 if (!test_and_clear_bit(CX18_F_M_NEED_SWAP, 204 &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, 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(&s->waitq, &wait, TASK_INTERRUPTIBLE); 230 /* New buffers might have become available before we were added 231 to the waitqueue */ 232 if (!atomic_read(&s->q_full.depth)) 233 schedule(); 234 finish_wait(&s->waitq, &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, 0, 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(ubuf, (u8 *)buf->buf + buf->readpos, 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, mdl->curr_buf, ubuf + tot_written, 390 ucount - tot_written, &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(&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, &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, &s->s_flags); 438 clear_bit(CX18_F_S_APPL_IO, &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 + tot_written, 446 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, &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, 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, &s->s_flags)) { 502 set_bit(CX18_F_S_APPL_IO, &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, &s_idx->s_flags)) { 517 if (cx18_start_v4l2_encode_stream(s_idx)) { 518 CX18_DEBUG_WARN("IDX capture start failed\n"); 519 clear_bit(CX18_F_S_STREAMING, &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, &s_vbi->s_flags)) { 526 if (cx18_start_v4l2_encode_stream(s_vbi)) { 527 CX18_DEBUG_WARN("VBI capture start failed\n"); 528 clear_bit(CX18_F_S_STREAMING, &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, &s->s_flags); 539 /* Resume a possibly paused encoder */ 540 if (test_and_clear_bit(CX18_F_I_ENC_PAUSED, &cx->i_flags)) 541 cx18_vapi(cx, CX18_CPU_CAPTURE_PAUSE, 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_idx, 0); 557 clear_bit(CX18_F_S_STREAMING, &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_vbi, 0); 563 clear_bit(CX18_F_S_STREAMING, &s_vbi->s_flags); 564 } 565 } 566 clear_bit(CX18_F_S_STREAMING, &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(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(&cx->serialize_lock); 584 if (rc) 585 return rc; 586 587 if ((s->vb_type == V4L2_BUF_TYPE_VIDEO_CAPTURE) && 588 (id->type == CX18_ENC_STREAM_TYPE_YUV)) { 589 return videobuf_read_stream(&s->vbuf_q, buf, count, pos, 0, 590 filp->f_flags & O_NONBLOCK); 591 } 592 593 return cx18_read_pos(s, buf, count, pos, filp->f_flags & O_NONBLOCK); 594 } 595 596 __poll_t cx18_v4l2_enc_poll(struct file *filp, poll_table *wait) 597 { 598 __poll_t req_events = poll_requested_events(wait); 599 struct cx18_open_id *id = file2id(filp); 600 struct cx18 *cx = id->cx; 601 struct cx18_stream *s = &cx->streams[id->type]; 602 int eof = test_bit(CX18_F_S_STREAMOFF, &s->s_flags); 603 __poll_t res = 0; 604 605 /* Start a capture if there is none */ 606 if (!eof && !test_bit(CX18_F_S_STREAMING, &s->s_flags) && 607 (req_events & (EPOLLIN | EPOLLRDNORM))) { 608 int rc; 609 610 mutex_lock(&cx->serialize_lock); 611 rc = cx18_start_capture(id); 612 mutex_unlock(&cx->serialize_lock); 613 if (rc) { 614 CX18_DEBUG_INFO("Could not start capture for %s (%d)\n", 615 s->name, rc); 616 return EPOLLERR; 617 } 618 CX18_DEBUG_FILE("Encoder poll started capture\n"); 619 } 620 621 if ((s->vb_type == V4L2_BUF_TYPE_VIDEO_CAPTURE) && 622 (id->type == CX18_ENC_STREAM_TYPE_YUV)) { 623 __poll_t videobuf_poll = videobuf_poll_stream(filp, &s->vbuf_q, wait); 624 625 if (v4l2_event_pending(&id->fh)) 626 res |= EPOLLPRI; 627 if (eof && videobuf_poll == EPOLLERR) 628 return res | EPOLLHUP; 629 return res | videobuf_poll; 630 } 631 632 /* add stream's waitq to the poll list */ 633 CX18_DEBUG_HI_FILE("Encoder poll\n"); 634 if (v4l2_event_pending(&id->fh)) 635 res |= EPOLLPRI; 636 else 637 poll_wait(filp, &s->waitq, wait); 638 639 if (atomic_read(&s->q_full.depth)) 640 return res | EPOLLIN | EPOLLRDNORM; 641 if (eof) 642 return res | EPOLLHUP; 643 return res; 644 } 645 646 int cx18_v4l2_mmap(struct file *file, struct vm_area_struct *vma) 647 { 648 struct cx18_open_id *id = file->private_data; 649 struct cx18 *cx = id->cx; 650 struct cx18_stream *s = &cx->streams[id->type]; 651 int eof = test_bit(CX18_F_S_STREAMOFF, &s->s_flags); 652 653 if ((s->vb_type == V4L2_BUF_TYPE_VIDEO_CAPTURE) && 654 (id->type == CX18_ENC_STREAM_TYPE_YUV)) { 655 656 /* Start a capture if there is none */ 657 if (!eof && !test_bit(CX18_F_S_STREAMING, &s->s_flags)) { 658 int rc; 659 660 mutex_lock(&cx->serialize_lock); 661 rc = cx18_start_capture(id); 662 mutex_unlock(&cx->serialize_lock); 663 if (rc) { 664 CX18_DEBUG_INFO( 665 "Could not start capture for %s (%d)\n", 666 s->name, rc); 667 return -EINVAL; 668 } 669 CX18_DEBUG_FILE("Encoder mmap started capture\n"); 670 } 671 672 return videobuf_mmap_mapper(&s->vbuf_q, vma); 673 } 674 675 return -EINVAL; 676 } 677 678 void cx18_vb_timeout(struct timer_list *t) 679 { 680 struct cx18_stream *s = from_timer(s, t, vb_timeout); 681 struct cx18_videobuf_buffer *buf; 682 unsigned long flags; 683 684 /* Return all of the buffers in error state, so the vbi/vid inode 685 * can return from blocking. 686 */ 687 spin_lock_irqsave(&s->vb_lock, flags); 688 while (!list_empty(&s->vb_capture)) { 689 buf = list_entry(s->vb_capture.next, 690 struct cx18_videobuf_buffer, vb.queue); 691 list_del(&buf->vb.queue); 692 buf->vb.state = VIDEOBUF_ERROR; 693 wake_up(&buf->vb.done); 694 } 695 spin_unlock_irqrestore(&s->vb_lock, flags); 696 } 697 698 void cx18_stop_capture(struct cx18_open_id *id, int gop_end) 699 { 700 struct cx18 *cx = id->cx; 701 struct cx18_stream *s = &cx->streams[id->type]; 702 struct cx18_stream *s_vbi = &cx->streams[CX18_ENC_STREAM_TYPE_VBI]; 703 struct cx18_stream *s_idx = &cx->streams[CX18_ENC_STREAM_TYPE_IDX]; 704 705 CX18_DEBUG_IOCTL("close() of %s\n", s->name); 706 707 /* 'Unclaim' this stream */ 708 709 /* Stop capturing */ 710 if (test_bit(CX18_F_S_STREAMING, &s->s_flags)) { 711 CX18_DEBUG_INFO("close stopping capture\n"); 712 if (id->type == CX18_ENC_STREAM_TYPE_MPG) { 713 /* Stop internal use associated VBI and IDX streams */ 714 if (test_bit(CX18_F_S_STREAMING, &s_vbi->s_flags) && 715 !test_bit(CX18_F_S_APPL_IO, &s_vbi->s_flags)) { 716 CX18_DEBUG_INFO("close stopping embedded VBI capture\n"); 717 cx18_stop_v4l2_encode_stream(s_vbi, 0); 718 } 719 if (test_bit(CX18_F_S_STREAMING, &s_idx->s_flags)) { 720 CX18_DEBUG_INFO("close stopping IDX capture\n"); 721 cx18_stop_v4l2_encode_stream(s_idx, 0); 722 } 723 } 724 if (id->type == CX18_ENC_STREAM_TYPE_VBI && 725 test_bit(CX18_F_S_INTERNAL_USE, &s->s_flags)) 726 /* Also used internally, don't stop capturing */ 727 s->id = -1; 728 else 729 cx18_stop_v4l2_encode_stream(s, gop_end); 730 } 731 if (!gop_end) { 732 clear_bit(CX18_F_S_APPL_IO, &s->s_flags); 733 clear_bit(CX18_F_S_STREAMOFF, &s->s_flags); 734 cx18_release_stream(s); 735 } 736 } 737 738 int cx18_v4l2_close(struct file *filp) 739 { 740 struct v4l2_fh *fh = filp->private_data; 741 struct cx18_open_id *id = fh2id(fh); 742 struct cx18 *cx = id->cx; 743 struct cx18_stream *s = &cx->streams[id->type]; 744 745 CX18_DEBUG_IOCTL("close() of %s\n", s->name); 746 747 mutex_lock(&cx->serialize_lock); 748 /* Stop radio */ 749 if (id->type == CX18_ENC_STREAM_TYPE_RAD && 750 v4l2_fh_is_singular_file(filp)) { 751 /* Closing radio device, return to TV mode */ 752 cx18_mute(cx); 753 /* Mark that the radio is no longer in use */ 754 clear_bit(CX18_F_I_RADIO_USER, &cx->i_flags); 755 /* Switch tuner to TV */ 756 cx18_call_all(cx, video, s_std, cx->std); 757 /* Select correct audio input (i.e. TV tuner or Line in) */ 758 cx18_audio_set_io(cx); 759 if (atomic_read(&cx->ana_capturing) > 0) { 760 /* Undo video mute */ 761 cx18_vapi(cx, CX18_CPU_SET_VIDEO_MUTE, 2, s->handle, 762 (v4l2_ctrl_g_ctrl(cx->cxhdl.video_mute) | 763 (v4l2_ctrl_g_ctrl(cx->cxhdl.video_mute_yuv) << 8))); 764 } 765 /* Done! Unmute and continue. */ 766 cx18_unmute(cx); 767 } 768 769 v4l2_fh_del(fh); 770 v4l2_fh_exit(fh); 771 772 /* 'Unclaim' this stream */ 773 if (s->id == id->open_id) 774 cx18_stop_capture(id, 0); 775 kfree(id); 776 mutex_unlock(&cx->serialize_lock); 777 return 0; 778 } 779 780 static int cx18_serialized_open(struct cx18_stream *s, struct file *filp) 781 { 782 struct cx18 *cx = s->cx; 783 struct cx18_open_id *item; 784 785 CX18_DEBUG_FILE("open %s\n", s->name); 786 787 /* Allocate memory */ 788 item = kzalloc(sizeof(struct cx18_open_id), GFP_KERNEL); 789 if (NULL == item) { 790 CX18_DEBUG_WARN("nomem on v4l2 open\n"); 791 return -ENOMEM; 792 } 793 v4l2_fh_init(&item->fh, &s->video_dev); 794 795 item->cx = cx; 796 item->type = s->type; 797 798 item->open_id = cx->open_id++; 799 filp->private_data = &item->fh; 800 v4l2_fh_add(&item->fh); 801 802 if (item->type == CX18_ENC_STREAM_TYPE_RAD && 803 v4l2_fh_is_singular_file(filp)) { 804 if (!test_bit(CX18_F_I_RADIO_USER, &cx->i_flags)) { 805 if (atomic_read(&cx->ana_capturing) > 0) { 806 /* switching to radio while capture is 807 in progress is not polite */ 808 v4l2_fh_del(&item->fh); 809 v4l2_fh_exit(&item->fh); 810 kfree(item); 811 return -EBUSY; 812 } 813 } 814 815 /* Mark that the radio is being used. */ 816 set_bit(CX18_F_I_RADIO_USER, &cx->i_flags); 817 /* We have the radio */ 818 cx18_mute(cx); 819 /* Switch tuner to radio */ 820 cx18_call_all(cx, tuner, s_radio); 821 /* Select the correct audio input (i.e. radio tuner) */ 822 cx18_audio_set_io(cx); 823 /* Done! Unmute and continue. */ 824 cx18_unmute(cx); 825 } 826 return 0; 827 } 828 829 int cx18_v4l2_open(struct file *filp) 830 { 831 int res; 832 struct video_device *video_dev = video_devdata(filp); 833 struct cx18_stream *s = video_get_drvdata(video_dev); 834 struct cx18 *cx = s->cx; 835 836 mutex_lock(&cx->serialize_lock); 837 if (cx18_init_on_first_open(cx)) { 838 CX18_ERR("Failed to initialize on %s\n", 839 video_device_node_name(video_dev)); 840 mutex_unlock(&cx->serialize_lock); 841 return -ENXIO; 842 } 843 res = cx18_serialized_open(s, filp); 844 mutex_unlock(&cx->serialize_lock); 845 return res; 846 } 847 848 void cx18_mute(struct cx18 *cx) 849 { 850 u32 h; 851 if (atomic_read(&cx->ana_capturing)) { 852 h = cx18_find_handle(cx); 853 if (h != CX18_INVALID_TASK_HANDLE) 854 cx18_vapi(cx, CX18_CPU_SET_AUDIO_MUTE, 2, h, 1); 855 else 856 CX18_ERR("Can't find valid task handle for mute\n"); 857 } 858 CX18_DEBUG_INFO("Mute\n"); 859 } 860 861 void cx18_unmute(struct cx18 *cx) 862 { 863 u32 h; 864 if (atomic_read(&cx->ana_capturing)) { 865 h = cx18_find_handle(cx); 866 if (h != CX18_INVALID_TASK_HANDLE) { 867 cx18_msleep_timeout(100, 0); 868 cx18_vapi(cx, CX18_CPU_SET_MISC_PARAMETERS, 2, h, 12); 869 cx18_vapi(cx, CX18_CPU_SET_AUDIO_MUTE, 2, h, 0); 870 } else 871 CX18_ERR("Can't find valid task handle for unmute\n"); 872 } 873 CX18_DEBUG_INFO("Unmute\n"); 874 } 875