162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-or-later 262306a36Sopenharmony_ci/* 362306a36Sopenharmony_ci * cx18 file operation functions 462306a36Sopenharmony_ci * 562306a36Sopenharmony_ci * Derived from ivtv-fileops.c 662306a36Sopenharmony_ci * 762306a36Sopenharmony_ci * Copyright (C) 2007 Hans Verkuil <hverkuil@xs4all.nl> 862306a36Sopenharmony_ci * Copyright (C) 2008 Andy Walls <awalls@md.metrocast.net> 962306a36Sopenharmony_ci */ 1062306a36Sopenharmony_ci 1162306a36Sopenharmony_ci#include "cx18-driver.h" 1262306a36Sopenharmony_ci#include "cx18-fileops.h" 1362306a36Sopenharmony_ci#include "cx18-i2c.h" 1462306a36Sopenharmony_ci#include "cx18-queue.h" 1562306a36Sopenharmony_ci#include "cx18-vbi.h" 1662306a36Sopenharmony_ci#include "cx18-audio.h" 1762306a36Sopenharmony_ci#include "cx18-mailbox.h" 1862306a36Sopenharmony_ci#include "cx18-scb.h" 1962306a36Sopenharmony_ci#include "cx18-streams.h" 2062306a36Sopenharmony_ci#include "cx18-controls.h" 2162306a36Sopenharmony_ci#include "cx18-ioctl.h" 2262306a36Sopenharmony_ci#include "cx18-cards.h" 2362306a36Sopenharmony_ci#include <media/v4l2-event.h> 2462306a36Sopenharmony_ci 2562306a36Sopenharmony_ci/* This function tries to claim the stream for a specific file descriptor. 2662306a36Sopenharmony_ci If no one else is using this stream then the stream is claimed and 2762306a36Sopenharmony_ci associated VBI and IDX streams are also automatically claimed. 2862306a36Sopenharmony_ci Possible error returns: -EBUSY if someone else has claimed 2962306a36Sopenharmony_ci the stream or 0 on success. */ 3062306a36Sopenharmony_ciint cx18_claim_stream(struct cx18_open_id *id, int type) 3162306a36Sopenharmony_ci{ 3262306a36Sopenharmony_ci struct cx18 *cx = id->cx; 3362306a36Sopenharmony_ci struct cx18_stream *s = &cx->streams[type]; 3462306a36Sopenharmony_ci struct cx18_stream *s_assoc; 3562306a36Sopenharmony_ci 3662306a36Sopenharmony_ci /* Nothing should ever try to directly claim the IDX stream */ 3762306a36Sopenharmony_ci if (type == CX18_ENC_STREAM_TYPE_IDX) { 3862306a36Sopenharmony_ci CX18_WARN("MPEG Index stream cannot be claimed directly, but something tried.\n"); 3962306a36Sopenharmony_ci return -EINVAL; 4062306a36Sopenharmony_ci } 4162306a36Sopenharmony_ci 4262306a36Sopenharmony_ci if (test_and_set_bit(CX18_F_S_CLAIMED, &s->s_flags)) { 4362306a36Sopenharmony_ci /* someone already claimed this stream */ 4462306a36Sopenharmony_ci if (s->id == id->open_id) { 4562306a36Sopenharmony_ci /* yes, this file descriptor did. So that's OK. */ 4662306a36Sopenharmony_ci return 0; 4762306a36Sopenharmony_ci } 4862306a36Sopenharmony_ci if (s->id == -1 && type == CX18_ENC_STREAM_TYPE_VBI) { 4962306a36Sopenharmony_ci /* VBI is handled already internally, now also assign 5062306a36Sopenharmony_ci the file descriptor to this stream for external 5162306a36Sopenharmony_ci reading of the stream. */ 5262306a36Sopenharmony_ci s->id = id->open_id; 5362306a36Sopenharmony_ci CX18_DEBUG_INFO("Start Read VBI\n"); 5462306a36Sopenharmony_ci return 0; 5562306a36Sopenharmony_ci } 5662306a36Sopenharmony_ci /* someone else is using this stream already */ 5762306a36Sopenharmony_ci CX18_DEBUG_INFO("Stream %d is busy\n", type); 5862306a36Sopenharmony_ci return -EBUSY; 5962306a36Sopenharmony_ci } 6062306a36Sopenharmony_ci s->id = id->open_id; 6162306a36Sopenharmony_ci 6262306a36Sopenharmony_ci /* 6362306a36Sopenharmony_ci * CX18_ENC_STREAM_TYPE_MPG needs to claim: 6462306a36Sopenharmony_ci * CX18_ENC_STREAM_TYPE_VBI, if VBI insertion is on for sliced VBI, or 6562306a36Sopenharmony_ci * CX18_ENC_STREAM_TYPE_IDX, if VBI insertion is off for sliced VBI 6662306a36Sopenharmony_ci * (We don't yet fix up MPEG Index entries for our inserted packets). 6762306a36Sopenharmony_ci * 6862306a36Sopenharmony_ci * For all other streams we're done. 6962306a36Sopenharmony_ci */ 7062306a36Sopenharmony_ci if (type != CX18_ENC_STREAM_TYPE_MPG) 7162306a36Sopenharmony_ci return 0; 7262306a36Sopenharmony_ci 7362306a36Sopenharmony_ci s_assoc = &cx->streams[CX18_ENC_STREAM_TYPE_IDX]; 7462306a36Sopenharmony_ci if (cx->vbi.insert_mpeg && !cx18_raw_vbi(cx)) 7562306a36Sopenharmony_ci s_assoc = &cx->streams[CX18_ENC_STREAM_TYPE_VBI]; 7662306a36Sopenharmony_ci else if (!cx18_stream_enabled(s_assoc)) 7762306a36Sopenharmony_ci return 0; 7862306a36Sopenharmony_ci 7962306a36Sopenharmony_ci set_bit(CX18_F_S_CLAIMED, &s_assoc->s_flags); 8062306a36Sopenharmony_ci 8162306a36Sopenharmony_ci /* mark that it is used internally */ 8262306a36Sopenharmony_ci set_bit(CX18_F_S_INTERNAL_USE, &s_assoc->s_flags); 8362306a36Sopenharmony_ci return 0; 8462306a36Sopenharmony_ci} 8562306a36Sopenharmony_ciEXPORT_SYMBOL(cx18_claim_stream); 8662306a36Sopenharmony_ci 8762306a36Sopenharmony_ci/* This function releases a previously claimed stream. It will take into 8862306a36Sopenharmony_ci account associated VBI streams. */ 8962306a36Sopenharmony_civoid cx18_release_stream(struct cx18_stream *s) 9062306a36Sopenharmony_ci{ 9162306a36Sopenharmony_ci struct cx18 *cx = s->cx; 9262306a36Sopenharmony_ci struct cx18_stream *s_assoc; 9362306a36Sopenharmony_ci 9462306a36Sopenharmony_ci s->id = -1; 9562306a36Sopenharmony_ci if (s->type == CX18_ENC_STREAM_TYPE_IDX) { 9662306a36Sopenharmony_ci /* 9762306a36Sopenharmony_ci * The IDX stream is only used internally, and can 9862306a36Sopenharmony_ci * only be indirectly unclaimed by unclaiming the MPG stream. 9962306a36Sopenharmony_ci */ 10062306a36Sopenharmony_ci return; 10162306a36Sopenharmony_ci } 10262306a36Sopenharmony_ci 10362306a36Sopenharmony_ci if (s->type == CX18_ENC_STREAM_TYPE_VBI && 10462306a36Sopenharmony_ci test_bit(CX18_F_S_INTERNAL_USE, &s->s_flags)) { 10562306a36Sopenharmony_ci /* this stream is still in use internally */ 10662306a36Sopenharmony_ci return; 10762306a36Sopenharmony_ci } 10862306a36Sopenharmony_ci if (!test_and_clear_bit(CX18_F_S_CLAIMED, &s->s_flags)) { 10962306a36Sopenharmony_ci CX18_DEBUG_WARN("Release stream %s not in use!\n", s->name); 11062306a36Sopenharmony_ci return; 11162306a36Sopenharmony_ci } 11262306a36Sopenharmony_ci 11362306a36Sopenharmony_ci cx18_flush_queues(s); 11462306a36Sopenharmony_ci 11562306a36Sopenharmony_ci /* 11662306a36Sopenharmony_ci * CX18_ENC_STREAM_TYPE_MPG needs to release the 11762306a36Sopenharmony_ci * CX18_ENC_STREAM_TYPE_VBI and/or CX18_ENC_STREAM_TYPE_IDX streams. 11862306a36Sopenharmony_ci * 11962306a36Sopenharmony_ci * For all other streams we're done. 12062306a36Sopenharmony_ci */ 12162306a36Sopenharmony_ci if (s->type != CX18_ENC_STREAM_TYPE_MPG) 12262306a36Sopenharmony_ci return; 12362306a36Sopenharmony_ci 12462306a36Sopenharmony_ci /* Unclaim the associated MPEG Index stream */ 12562306a36Sopenharmony_ci s_assoc = &cx->streams[CX18_ENC_STREAM_TYPE_IDX]; 12662306a36Sopenharmony_ci if (test_and_clear_bit(CX18_F_S_INTERNAL_USE, &s_assoc->s_flags)) { 12762306a36Sopenharmony_ci clear_bit(CX18_F_S_CLAIMED, &s_assoc->s_flags); 12862306a36Sopenharmony_ci cx18_flush_queues(s_assoc); 12962306a36Sopenharmony_ci } 13062306a36Sopenharmony_ci 13162306a36Sopenharmony_ci /* Unclaim the associated VBI stream */ 13262306a36Sopenharmony_ci s_assoc = &cx->streams[CX18_ENC_STREAM_TYPE_VBI]; 13362306a36Sopenharmony_ci if (test_and_clear_bit(CX18_F_S_INTERNAL_USE, &s_assoc->s_flags)) { 13462306a36Sopenharmony_ci if (s_assoc->id == -1) { 13562306a36Sopenharmony_ci /* 13662306a36Sopenharmony_ci * The VBI stream is not still claimed by a file 13762306a36Sopenharmony_ci * descriptor, so completely unclaim it. 13862306a36Sopenharmony_ci */ 13962306a36Sopenharmony_ci clear_bit(CX18_F_S_CLAIMED, &s_assoc->s_flags); 14062306a36Sopenharmony_ci cx18_flush_queues(s_assoc); 14162306a36Sopenharmony_ci } 14262306a36Sopenharmony_ci } 14362306a36Sopenharmony_ci} 14462306a36Sopenharmony_ciEXPORT_SYMBOL(cx18_release_stream); 14562306a36Sopenharmony_ci 14662306a36Sopenharmony_cistatic void cx18_dualwatch(struct cx18 *cx) 14762306a36Sopenharmony_ci{ 14862306a36Sopenharmony_ci struct v4l2_tuner vt; 14962306a36Sopenharmony_ci u32 new_stereo_mode; 15062306a36Sopenharmony_ci const u32 dual = 0x0200; 15162306a36Sopenharmony_ci 15262306a36Sopenharmony_ci new_stereo_mode = v4l2_ctrl_g_ctrl(cx->cxhdl.audio_mode); 15362306a36Sopenharmony_ci memset(&vt, 0, sizeof(vt)); 15462306a36Sopenharmony_ci cx18_call_all(cx, tuner, g_tuner, &vt); 15562306a36Sopenharmony_ci if (vt.audmode == V4L2_TUNER_MODE_LANG1_LANG2 && 15662306a36Sopenharmony_ci (vt.rxsubchans & V4L2_TUNER_SUB_LANG2)) 15762306a36Sopenharmony_ci new_stereo_mode = dual; 15862306a36Sopenharmony_ci 15962306a36Sopenharmony_ci if (new_stereo_mode == cx->dualwatch_stereo_mode) 16062306a36Sopenharmony_ci return; 16162306a36Sopenharmony_ci 16262306a36Sopenharmony_ci CX18_DEBUG_INFO("dualwatch: change stereo flag from 0x%x to 0x%x.\n", 16362306a36Sopenharmony_ci cx->dualwatch_stereo_mode, new_stereo_mode); 16462306a36Sopenharmony_ci if (v4l2_ctrl_s_ctrl(cx->cxhdl.audio_mode, new_stereo_mode)) 16562306a36Sopenharmony_ci CX18_DEBUG_INFO("dualwatch: changing stereo flag failed\n"); 16662306a36Sopenharmony_ci} 16762306a36Sopenharmony_ci 16862306a36Sopenharmony_ci 16962306a36Sopenharmony_cistatic struct cx18_mdl *cx18_get_mdl(struct cx18_stream *s, int non_block, 17062306a36Sopenharmony_ci int *err) 17162306a36Sopenharmony_ci{ 17262306a36Sopenharmony_ci struct cx18 *cx = s->cx; 17362306a36Sopenharmony_ci struct cx18_stream *s_vbi = &cx->streams[CX18_ENC_STREAM_TYPE_VBI]; 17462306a36Sopenharmony_ci struct cx18_mdl *mdl; 17562306a36Sopenharmony_ci DEFINE_WAIT(wait); 17662306a36Sopenharmony_ci 17762306a36Sopenharmony_ci *err = 0; 17862306a36Sopenharmony_ci while (1) { 17962306a36Sopenharmony_ci if (s->type == CX18_ENC_STREAM_TYPE_MPG) { 18062306a36Sopenharmony_ci /* Process pending program updates and VBI data */ 18162306a36Sopenharmony_ci if (time_after(jiffies, cx->dualwatch_jiffies + msecs_to_jiffies(1000))) { 18262306a36Sopenharmony_ci cx->dualwatch_jiffies = jiffies; 18362306a36Sopenharmony_ci cx18_dualwatch(cx); 18462306a36Sopenharmony_ci } 18562306a36Sopenharmony_ci if (test_bit(CX18_F_S_INTERNAL_USE, &s_vbi->s_flags) && 18662306a36Sopenharmony_ci !test_bit(CX18_F_S_APPL_IO, &s_vbi->s_flags)) { 18762306a36Sopenharmony_ci while ((mdl = cx18_dequeue(s_vbi, 18862306a36Sopenharmony_ci &s_vbi->q_full))) { 18962306a36Sopenharmony_ci /* byteswap and process VBI data */ 19062306a36Sopenharmony_ci cx18_process_vbi_data(cx, mdl, 19162306a36Sopenharmony_ci s_vbi->type); 19262306a36Sopenharmony_ci cx18_stream_put_mdl_fw(s_vbi, mdl); 19362306a36Sopenharmony_ci } 19462306a36Sopenharmony_ci } 19562306a36Sopenharmony_ci mdl = &cx->vbi.sliced_mpeg_mdl; 19662306a36Sopenharmony_ci if (mdl->readpos != mdl->bytesused) 19762306a36Sopenharmony_ci return mdl; 19862306a36Sopenharmony_ci } 19962306a36Sopenharmony_ci 20062306a36Sopenharmony_ci /* do we have new data? */ 20162306a36Sopenharmony_ci mdl = cx18_dequeue(s, &s->q_full); 20262306a36Sopenharmony_ci if (mdl) { 20362306a36Sopenharmony_ci if (!test_and_clear_bit(CX18_F_M_NEED_SWAP, 20462306a36Sopenharmony_ci &mdl->m_flags)) 20562306a36Sopenharmony_ci return mdl; 20662306a36Sopenharmony_ci if (s->type == CX18_ENC_STREAM_TYPE_MPG) 20762306a36Sopenharmony_ci /* byteswap MPG data */ 20862306a36Sopenharmony_ci cx18_mdl_swap(mdl); 20962306a36Sopenharmony_ci else { 21062306a36Sopenharmony_ci /* byteswap and process VBI data */ 21162306a36Sopenharmony_ci cx18_process_vbi_data(cx, mdl, s->type); 21262306a36Sopenharmony_ci } 21362306a36Sopenharmony_ci return mdl; 21462306a36Sopenharmony_ci } 21562306a36Sopenharmony_ci 21662306a36Sopenharmony_ci /* return if end of stream */ 21762306a36Sopenharmony_ci if (!test_bit(CX18_F_S_STREAMING, &s->s_flags)) { 21862306a36Sopenharmony_ci CX18_DEBUG_INFO("EOS %s\n", s->name); 21962306a36Sopenharmony_ci return NULL; 22062306a36Sopenharmony_ci } 22162306a36Sopenharmony_ci 22262306a36Sopenharmony_ci /* return if file was opened with O_NONBLOCK */ 22362306a36Sopenharmony_ci if (non_block) { 22462306a36Sopenharmony_ci *err = -EAGAIN; 22562306a36Sopenharmony_ci return NULL; 22662306a36Sopenharmony_ci } 22762306a36Sopenharmony_ci 22862306a36Sopenharmony_ci /* wait for more data to arrive */ 22962306a36Sopenharmony_ci prepare_to_wait(&s->waitq, &wait, TASK_INTERRUPTIBLE); 23062306a36Sopenharmony_ci /* New buffers might have become available before we were added 23162306a36Sopenharmony_ci to the waitqueue */ 23262306a36Sopenharmony_ci if (!atomic_read(&s->q_full.depth)) 23362306a36Sopenharmony_ci schedule(); 23462306a36Sopenharmony_ci finish_wait(&s->waitq, &wait); 23562306a36Sopenharmony_ci if (signal_pending(current)) { 23662306a36Sopenharmony_ci /* return if a signal was received */ 23762306a36Sopenharmony_ci CX18_DEBUG_INFO("User stopped %s\n", s->name); 23862306a36Sopenharmony_ci *err = -EINTR; 23962306a36Sopenharmony_ci return NULL; 24062306a36Sopenharmony_ci } 24162306a36Sopenharmony_ci } 24262306a36Sopenharmony_ci} 24362306a36Sopenharmony_ci 24462306a36Sopenharmony_cistatic void cx18_setup_sliced_vbi_mdl(struct cx18 *cx) 24562306a36Sopenharmony_ci{ 24662306a36Sopenharmony_ci struct cx18_mdl *mdl = &cx->vbi.sliced_mpeg_mdl; 24762306a36Sopenharmony_ci struct cx18_buffer *buf = &cx->vbi.sliced_mpeg_buf; 24862306a36Sopenharmony_ci int idx = cx->vbi.inserted_frame % CX18_VBI_FRAMES; 24962306a36Sopenharmony_ci 25062306a36Sopenharmony_ci buf->buf = cx->vbi.sliced_mpeg_data[idx]; 25162306a36Sopenharmony_ci buf->bytesused = cx->vbi.sliced_mpeg_size[idx]; 25262306a36Sopenharmony_ci buf->readpos = 0; 25362306a36Sopenharmony_ci 25462306a36Sopenharmony_ci mdl->curr_buf = NULL; 25562306a36Sopenharmony_ci mdl->bytesused = cx->vbi.sliced_mpeg_size[idx]; 25662306a36Sopenharmony_ci mdl->readpos = 0; 25762306a36Sopenharmony_ci} 25862306a36Sopenharmony_ci 25962306a36Sopenharmony_cistatic size_t cx18_copy_buf_to_user(struct cx18_stream *s, 26062306a36Sopenharmony_ci struct cx18_buffer *buf, char __user *ubuf, size_t ucount, bool *stop) 26162306a36Sopenharmony_ci{ 26262306a36Sopenharmony_ci struct cx18 *cx = s->cx; 26362306a36Sopenharmony_ci size_t len = buf->bytesused - buf->readpos; 26462306a36Sopenharmony_ci 26562306a36Sopenharmony_ci *stop = false; 26662306a36Sopenharmony_ci if (len > ucount) 26762306a36Sopenharmony_ci len = ucount; 26862306a36Sopenharmony_ci if (cx->vbi.insert_mpeg && s->type == CX18_ENC_STREAM_TYPE_MPG && 26962306a36Sopenharmony_ci !cx18_raw_vbi(cx) && buf != &cx->vbi.sliced_mpeg_buf) { 27062306a36Sopenharmony_ci /* 27162306a36Sopenharmony_ci * Try to find a good splice point in the PS, just before 27262306a36Sopenharmony_ci * an MPEG-2 Program Pack start code, and provide only 27362306a36Sopenharmony_ci * up to that point to the user, so it's easy to insert VBI data 27462306a36Sopenharmony_ci * the next time around. 27562306a36Sopenharmony_ci * 27662306a36Sopenharmony_ci * This will not work for an MPEG-2 TS and has only been 27762306a36Sopenharmony_ci * verified by analysis to work for an MPEG-2 PS. Helen Buus 27862306a36Sopenharmony_ci * pointed out this works for the CX23416 MPEG-2 DVD compatible 27962306a36Sopenharmony_ci * stream, and research indicates both the MPEG 2 SVCD and DVD 28062306a36Sopenharmony_ci * stream types use an MPEG-2 PS container. 28162306a36Sopenharmony_ci */ 28262306a36Sopenharmony_ci /* 28362306a36Sopenharmony_ci * An MPEG-2 Program Stream (PS) is a series of 28462306a36Sopenharmony_ci * MPEG-2 Program Packs terminated by an 28562306a36Sopenharmony_ci * MPEG Program End Code after the last Program Pack. 28662306a36Sopenharmony_ci * A Program Pack may hold a PS System Header packet and any 28762306a36Sopenharmony_ci * number of Program Elementary Stream (PES) Packets 28862306a36Sopenharmony_ci */ 28962306a36Sopenharmony_ci const char *start = buf->buf + buf->readpos; 29062306a36Sopenharmony_ci const char *p = start + 1; 29162306a36Sopenharmony_ci const u8 *q; 29262306a36Sopenharmony_ci u8 ch = cx->search_pack_header ? 0xba : 0xe0; 29362306a36Sopenharmony_ci int stuffing, i; 29462306a36Sopenharmony_ci 29562306a36Sopenharmony_ci while (start + len > p) { 29662306a36Sopenharmony_ci /* Scan for a 0 to find a potential MPEG-2 start code */ 29762306a36Sopenharmony_ci q = memchr(p, 0, start + len - p); 29862306a36Sopenharmony_ci if (q == NULL) 29962306a36Sopenharmony_ci break; 30062306a36Sopenharmony_ci p = q + 1; 30162306a36Sopenharmony_ci /* 30262306a36Sopenharmony_ci * Keep looking if not a 30362306a36Sopenharmony_ci * MPEG-2 Pack header start code: 0x00 0x00 0x01 0xba 30462306a36Sopenharmony_ci * or MPEG-2 video PES start code: 0x00 0x00 0x01 0xe0 30562306a36Sopenharmony_ci */ 30662306a36Sopenharmony_ci if ((char *)q + 15 >= buf->buf + buf->bytesused || 30762306a36Sopenharmony_ci q[1] != 0 || q[2] != 1 || q[3] != ch) 30862306a36Sopenharmony_ci continue; 30962306a36Sopenharmony_ci 31062306a36Sopenharmony_ci /* If expecting the primary video PES */ 31162306a36Sopenharmony_ci if (!cx->search_pack_header) { 31262306a36Sopenharmony_ci /* Continue if it couldn't be a PES packet */ 31362306a36Sopenharmony_ci if ((q[6] & 0xc0) != 0x80) 31462306a36Sopenharmony_ci continue; 31562306a36Sopenharmony_ci /* Check if a PTS or PTS & DTS follow */ 31662306a36Sopenharmony_ci if (((q[7] & 0xc0) == 0x80 && /* PTS only */ 31762306a36Sopenharmony_ci (q[9] & 0xf0) == 0x20) || /* PTS only */ 31862306a36Sopenharmony_ci ((q[7] & 0xc0) == 0xc0 && /* PTS & DTS */ 31962306a36Sopenharmony_ci (q[9] & 0xf0) == 0x30)) { /* DTS follows */ 32062306a36Sopenharmony_ci /* Assume we found the video PES hdr */ 32162306a36Sopenharmony_ci ch = 0xba; /* next want a Program Pack*/ 32262306a36Sopenharmony_ci cx->search_pack_header = 1; 32362306a36Sopenharmony_ci p = q + 9; /* Skip this video PES hdr */ 32462306a36Sopenharmony_ci } 32562306a36Sopenharmony_ci continue; 32662306a36Sopenharmony_ci } 32762306a36Sopenharmony_ci 32862306a36Sopenharmony_ci /* We may have found a Program Pack start code */ 32962306a36Sopenharmony_ci 33062306a36Sopenharmony_ci /* Get the count of stuffing bytes & verify them */ 33162306a36Sopenharmony_ci stuffing = q[13] & 7; 33262306a36Sopenharmony_ci /* all stuffing bytes must be 0xff */ 33362306a36Sopenharmony_ci for (i = 0; i < stuffing; i++) 33462306a36Sopenharmony_ci if (q[14 + i] != 0xff) 33562306a36Sopenharmony_ci break; 33662306a36Sopenharmony_ci if (i == stuffing && /* right number of stuffing bytes*/ 33762306a36Sopenharmony_ci (q[4] & 0xc4) == 0x44 && /* marker check */ 33862306a36Sopenharmony_ci (q[12] & 3) == 3 && /* marker check */ 33962306a36Sopenharmony_ci q[14 + stuffing] == 0 && /* PES Pack or Sys Hdr */ 34062306a36Sopenharmony_ci q[15 + stuffing] == 0 && 34162306a36Sopenharmony_ci q[16 + stuffing] == 1) { 34262306a36Sopenharmony_ci /* We declare we actually found a Program Pack*/ 34362306a36Sopenharmony_ci cx->search_pack_header = 0; /* expect vid PES */ 34462306a36Sopenharmony_ci len = (char *)q - start; 34562306a36Sopenharmony_ci cx18_setup_sliced_vbi_mdl(cx); 34662306a36Sopenharmony_ci *stop = true; 34762306a36Sopenharmony_ci break; 34862306a36Sopenharmony_ci } 34962306a36Sopenharmony_ci } 35062306a36Sopenharmony_ci } 35162306a36Sopenharmony_ci if (copy_to_user(ubuf, (u8 *)buf->buf + buf->readpos, len)) { 35262306a36Sopenharmony_ci CX18_DEBUG_WARN("copy %zd bytes to user failed for %s\n", 35362306a36Sopenharmony_ci len, s->name); 35462306a36Sopenharmony_ci return -EFAULT; 35562306a36Sopenharmony_ci } 35662306a36Sopenharmony_ci buf->readpos += len; 35762306a36Sopenharmony_ci if (s->type == CX18_ENC_STREAM_TYPE_MPG && 35862306a36Sopenharmony_ci buf != &cx->vbi.sliced_mpeg_buf) 35962306a36Sopenharmony_ci cx->mpg_data_received += len; 36062306a36Sopenharmony_ci return len; 36162306a36Sopenharmony_ci} 36262306a36Sopenharmony_ci 36362306a36Sopenharmony_cistatic size_t cx18_copy_mdl_to_user(struct cx18_stream *s, 36462306a36Sopenharmony_ci struct cx18_mdl *mdl, char __user *ubuf, size_t ucount) 36562306a36Sopenharmony_ci{ 36662306a36Sopenharmony_ci size_t tot_written = 0; 36762306a36Sopenharmony_ci int rc; 36862306a36Sopenharmony_ci bool stop = false; 36962306a36Sopenharmony_ci 37062306a36Sopenharmony_ci if (mdl->curr_buf == NULL) 37162306a36Sopenharmony_ci mdl->curr_buf = list_first_entry(&mdl->buf_list, 37262306a36Sopenharmony_ci struct cx18_buffer, list); 37362306a36Sopenharmony_ci 37462306a36Sopenharmony_ci if (list_entry_is_past_end(mdl->curr_buf, &mdl->buf_list, list)) { 37562306a36Sopenharmony_ci /* 37662306a36Sopenharmony_ci * For some reason we've exhausted the buffers, but the MDL 37762306a36Sopenharmony_ci * object still said some data was unread. 37862306a36Sopenharmony_ci * Fix that and bail out. 37962306a36Sopenharmony_ci */ 38062306a36Sopenharmony_ci mdl->readpos = mdl->bytesused; 38162306a36Sopenharmony_ci return 0; 38262306a36Sopenharmony_ci } 38362306a36Sopenharmony_ci 38462306a36Sopenharmony_ci list_for_each_entry_from(mdl->curr_buf, &mdl->buf_list, list) { 38562306a36Sopenharmony_ci 38662306a36Sopenharmony_ci if (mdl->curr_buf->readpos >= mdl->curr_buf->bytesused) 38762306a36Sopenharmony_ci continue; 38862306a36Sopenharmony_ci 38962306a36Sopenharmony_ci rc = cx18_copy_buf_to_user(s, mdl->curr_buf, ubuf + tot_written, 39062306a36Sopenharmony_ci ucount - tot_written, &stop); 39162306a36Sopenharmony_ci if (rc < 0) 39262306a36Sopenharmony_ci return rc; 39362306a36Sopenharmony_ci mdl->readpos += rc; 39462306a36Sopenharmony_ci tot_written += rc; 39562306a36Sopenharmony_ci 39662306a36Sopenharmony_ci if (stop || /* Forced stopping point for VBI insertion */ 39762306a36Sopenharmony_ci tot_written >= ucount || /* Reader request satisfied */ 39862306a36Sopenharmony_ci mdl->curr_buf->readpos < mdl->curr_buf->bytesused || 39962306a36Sopenharmony_ci mdl->readpos >= mdl->bytesused) /* MDL buffers drained */ 40062306a36Sopenharmony_ci break; 40162306a36Sopenharmony_ci } 40262306a36Sopenharmony_ci return tot_written; 40362306a36Sopenharmony_ci} 40462306a36Sopenharmony_ci 40562306a36Sopenharmony_cistatic ssize_t cx18_read(struct cx18_stream *s, char __user *ubuf, 40662306a36Sopenharmony_ci size_t tot_count, int non_block) 40762306a36Sopenharmony_ci{ 40862306a36Sopenharmony_ci struct cx18 *cx = s->cx; 40962306a36Sopenharmony_ci size_t tot_written = 0; 41062306a36Sopenharmony_ci int single_frame = 0; 41162306a36Sopenharmony_ci 41262306a36Sopenharmony_ci if (atomic_read(&cx->ana_capturing) == 0 && s->id == -1) { 41362306a36Sopenharmony_ci /* shouldn't happen */ 41462306a36Sopenharmony_ci CX18_DEBUG_WARN("Stream %s not initialized before read\n", 41562306a36Sopenharmony_ci s->name); 41662306a36Sopenharmony_ci return -EIO; 41762306a36Sopenharmony_ci } 41862306a36Sopenharmony_ci 41962306a36Sopenharmony_ci /* Each VBI buffer is one frame, the v4l2 API says that for VBI the 42062306a36Sopenharmony_ci frames should arrive one-by-one, so make sure we never output more 42162306a36Sopenharmony_ci than one VBI frame at a time */ 42262306a36Sopenharmony_ci if (s->type == CX18_ENC_STREAM_TYPE_VBI && !cx18_raw_vbi(cx)) 42362306a36Sopenharmony_ci single_frame = 1; 42462306a36Sopenharmony_ci 42562306a36Sopenharmony_ci for (;;) { 42662306a36Sopenharmony_ci struct cx18_mdl *mdl; 42762306a36Sopenharmony_ci int rc; 42862306a36Sopenharmony_ci 42962306a36Sopenharmony_ci mdl = cx18_get_mdl(s, non_block, &rc); 43062306a36Sopenharmony_ci /* if there is no data available... */ 43162306a36Sopenharmony_ci if (mdl == NULL) { 43262306a36Sopenharmony_ci /* if we got data, then return that regardless */ 43362306a36Sopenharmony_ci if (tot_written) 43462306a36Sopenharmony_ci break; 43562306a36Sopenharmony_ci /* EOS condition */ 43662306a36Sopenharmony_ci if (rc == 0) { 43762306a36Sopenharmony_ci clear_bit(CX18_F_S_STREAMOFF, &s->s_flags); 43862306a36Sopenharmony_ci clear_bit(CX18_F_S_APPL_IO, &s->s_flags); 43962306a36Sopenharmony_ci cx18_release_stream(s); 44062306a36Sopenharmony_ci } 44162306a36Sopenharmony_ci /* set errno */ 44262306a36Sopenharmony_ci return rc; 44362306a36Sopenharmony_ci } 44462306a36Sopenharmony_ci 44562306a36Sopenharmony_ci rc = cx18_copy_mdl_to_user(s, mdl, ubuf + tot_written, 44662306a36Sopenharmony_ci tot_count - tot_written); 44762306a36Sopenharmony_ci 44862306a36Sopenharmony_ci if (mdl != &cx->vbi.sliced_mpeg_mdl) { 44962306a36Sopenharmony_ci if (mdl->readpos == mdl->bytesused) 45062306a36Sopenharmony_ci cx18_stream_put_mdl_fw(s, mdl); 45162306a36Sopenharmony_ci else 45262306a36Sopenharmony_ci cx18_push(s, mdl, &s->q_full); 45362306a36Sopenharmony_ci } else if (mdl->readpos == mdl->bytesused) { 45462306a36Sopenharmony_ci int idx = cx->vbi.inserted_frame % CX18_VBI_FRAMES; 45562306a36Sopenharmony_ci 45662306a36Sopenharmony_ci cx->vbi.sliced_mpeg_size[idx] = 0; 45762306a36Sopenharmony_ci cx->vbi.inserted_frame++; 45862306a36Sopenharmony_ci cx->vbi_data_inserted += mdl->bytesused; 45962306a36Sopenharmony_ci } 46062306a36Sopenharmony_ci if (rc < 0) 46162306a36Sopenharmony_ci return rc; 46262306a36Sopenharmony_ci tot_written += rc; 46362306a36Sopenharmony_ci 46462306a36Sopenharmony_ci if (tot_written == tot_count || single_frame) 46562306a36Sopenharmony_ci break; 46662306a36Sopenharmony_ci } 46762306a36Sopenharmony_ci return tot_written; 46862306a36Sopenharmony_ci} 46962306a36Sopenharmony_ci 47062306a36Sopenharmony_cistatic ssize_t cx18_read_pos(struct cx18_stream *s, char __user *ubuf, 47162306a36Sopenharmony_ci size_t count, loff_t *pos, int non_block) 47262306a36Sopenharmony_ci{ 47362306a36Sopenharmony_ci ssize_t rc = count ? cx18_read(s, ubuf, count, non_block) : 0; 47462306a36Sopenharmony_ci struct cx18 *cx = s->cx; 47562306a36Sopenharmony_ci 47662306a36Sopenharmony_ci CX18_DEBUG_HI_FILE("read %zd from %s, got %zd\n", count, s->name, rc); 47762306a36Sopenharmony_ci if (rc > 0) 47862306a36Sopenharmony_ci *pos += rc; 47962306a36Sopenharmony_ci return rc; 48062306a36Sopenharmony_ci} 48162306a36Sopenharmony_ci 48262306a36Sopenharmony_ciint cx18_start_capture(struct cx18_open_id *id) 48362306a36Sopenharmony_ci{ 48462306a36Sopenharmony_ci struct cx18 *cx = id->cx; 48562306a36Sopenharmony_ci struct cx18_stream *s = &cx->streams[id->type]; 48662306a36Sopenharmony_ci struct cx18_stream *s_vbi; 48762306a36Sopenharmony_ci struct cx18_stream *s_idx; 48862306a36Sopenharmony_ci 48962306a36Sopenharmony_ci if (s->type == CX18_ENC_STREAM_TYPE_RAD) { 49062306a36Sopenharmony_ci /* you cannot read from these stream types. */ 49162306a36Sopenharmony_ci return -EPERM; 49262306a36Sopenharmony_ci } 49362306a36Sopenharmony_ci 49462306a36Sopenharmony_ci /* Try to claim this stream. */ 49562306a36Sopenharmony_ci if (cx18_claim_stream(id, s->type)) 49662306a36Sopenharmony_ci return -EBUSY; 49762306a36Sopenharmony_ci 49862306a36Sopenharmony_ci /* If capture is already in progress, then we also have to 49962306a36Sopenharmony_ci do nothing extra. */ 50062306a36Sopenharmony_ci if (test_bit(CX18_F_S_STREAMOFF, &s->s_flags) || 50162306a36Sopenharmony_ci test_and_set_bit(CX18_F_S_STREAMING, &s->s_flags)) { 50262306a36Sopenharmony_ci set_bit(CX18_F_S_APPL_IO, &s->s_flags); 50362306a36Sopenharmony_ci return 0; 50462306a36Sopenharmony_ci } 50562306a36Sopenharmony_ci 50662306a36Sopenharmony_ci /* Start associated VBI or IDX stream capture if required */ 50762306a36Sopenharmony_ci s_vbi = &cx->streams[CX18_ENC_STREAM_TYPE_VBI]; 50862306a36Sopenharmony_ci s_idx = &cx->streams[CX18_ENC_STREAM_TYPE_IDX]; 50962306a36Sopenharmony_ci if (s->type == CX18_ENC_STREAM_TYPE_MPG) { 51062306a36Sopenharmony_ci /* 51162306a36Sopenharmony_ci * The VBI and IDX streams should have been claimed 51262306a36Sopenharmony_ci * automatically, if for internal use, when the MPG stream was 51362306a36Sopenharmony_ci * claimed. We only need to start these streams capturing. 51462306a36Sopenharmony_ci */ 51562306a36Sopenharmony_ci if (test_bit(CX18_F_S_INTERNAL_USE, &s_idx->s_flags) && 51662306a36Sopenharmony_ci !test_and_set_bit(CX18_F_S_STREAMING, &s_idx->s_flags)) { 51762306a36Sopenharmony_ci if (cx18_start_v4l2_encode_stream(s_idx)) { 51862306a36Sopenharmony_ci CX18_DEBUG_WARN("IDX capture start failed\n"); 51962306a36Sopenharmony_ci clear_bit(CX18_F_S_STREAMING, &s_idx->s_flags); 52062306a36Sopenharmony_ci goto start_failed; 52162306a36Sopenharmony_ci } 52262306a36Sopenharmony_ci CX18_DEBUG_INFO("IDX capture started\n"); 52362306a36Sopenharmony_ci } 52462306a36Sopenharmony_ci if (test_bit(CX18_F_S_INTERNAL_USE, &s_vbi->s_flags) && 52562306a36Sopenharmony_ci !test_and_set_bit(CX18_F_S_STREAMING, &s_vbi->s_flags)) { 52662306a36Sopenharmony_ci if (cx18_start_v4l2_encode_stream(s_vbi)) { 52762306a36Sopenharmony_ci CX18_DEBUG_WARN("VBI capture start failed\n"); 52862306a36Sopenharmony_ci clear_bit(CX18_F_S_STREAMING, &s_vbi->s_flags); 52962306a36Sopenharmony_ci goto start_failed; 53062306a36Sopenharmony_ci } 53162306a36Sopenharmony_ci CX18_DEBUG_INFO("VBI insertion started\n"); 53262306a36Sopenharmony_ci } 53362306a36Sopenharmony_ci } 53462306a36Sopenharmony_ci 53562306a36Sopenharmony_ci /* Tell the card to start capturing */ 53662306a36Sopenharmony_ci if (!cx18_start_v4l2_encode_stream(s)) { 53762306a36Sopenharmony_ci /* We're done */ 53862306a36Sopenharmony_ci set_bit(CX18_F_S_APPL_IO, &s->s_flags); 53962306a36Sopenharmony_ci /* Resume a possibly paused encoder */ 54062306a36Sopenharmony_ci if (test_and_clear_bit(CX18_F_I_ENC_PAUSED, &cx->i_flags)) 54162306a36Sopenharmony_ci cx18_vapi(cx, CX18_CPU_CAPTURE_PAUSE, 1, s->handle); 54262306a36Sopenharmony_ci return 0; 54362306a36Sopenharmony_ci } 54462306a36Sopenharmony_ci 54562306a36Sopenharmony_cistart_failed: 54662306a36Sopenharmony_ci CX18_DEBUG_WARN("Failed to start capturing for stream %s\n", s->name); 54762306a36Sopenharmony_ci 54862306a36Sopenharmony_ci /* 54962306a36Sopenharmony_ci * The associated VBI and IDX streams for internal use are released 55062306a36Sopenharmony_ci * automatically when the MPG stream is released. We only need to stop 55162306a36Sopenharmony_ci * the associated stream. 55262306a36Sopenharmony_ci */ 55362306a36Sopenharmony_ci if (s->type == CX18_ENC_STREAM_TYPE_MPG) { 55462306a36Sopenharmony_ci /* Stop the IDX stream which is always for internal use */ 55562306a36Sopenharmony_ci if (test_bit(CX18_F_S_STREAMING, &s_idx->s_flags)) { 55662306a36Sopenharmony_ci cx18_stop_v4l2_encode_stream(s_idx, 0); 55762306a36Sopenharmony_ci clear_bit(CX18_F_S_STREAMING, &s_idx->s_flags); 55862306a36Sopenharmony_ci } 55962306a36Sopenharmony_ci /* Stop the VBI stream, if only running for internal use */ 56062306a36Sopenharmony_ci if (test_bit(CX18_F_S_STREAMING, &s_vbi->s_flags) && 56162306a36Sopenharmony_ci !test_bit(CX18_F_S_APPL_IO, &s_vbi->s_flags)) { 56262306a36Sopenharmony_ci cx18_stop_v4l2_encode_stream(s_vbi, 0); 56362306a36Sopenharmony_ci clear_bit(CX18_F_S_STREAMING, &s_vbi->s_flags); 56462306a36Sopenharmony_ci } 56562306a36Sopenharmony_ci } 56662306a36Sopenharmony_ci clear_bit(CX18_F_S_STREAMING, &s->s_flags); 56762306a36Sopenharmony_ci cx18_release_stream(s); /* Also releases associated streams */ 56862306a36Sopenharmony_ci return -EIO; 56962306a36Sopenharmony_ci} 57062306a36Sopenharmony_ci 57162306a36Sopenharmony_cissize_t cx18_v4l2_read(struct file *filp, char __user *buf, size_t count, 57262306a36Sopenharmony_ci loff_t *pos) 57362306a36Sopenharmony_ci{ 57462306a36Sopenharmony_ci struct cx18_open_id *id = file2id(filp); 57562306a36Sopenharmony_ci struct cx18 *cx = id->cx; 57662306a36Sopenharmony_ci struct cx18_stream *s = &cx->streams[id->type]; 57762306a36Sopenharmony_ci int rc; 57862306a36Sopenharmony_ci 57962306a36Sopenharmony_ci CX18_DEBUG_HI_FILE("read %zd bytes from %s\n", count, s->name); 58062306a36Sopenharmony_ci 58162306a36Sopenharmony_ci mutex_lock(&cx->serialize_lock); 58262306a36Sopenharmony_ci rc = cx18_start_capture(id); 58362306a36Sopenharmony_ci mutex_unlock(&cx->serialize_lock); 58462306a36Sopenharmony_ci if (rc) 58562306a36Sopenharmony_ci return rc; 58662306a36Sopenharmony_ci 58762306a36Sopenharmony_ci return cx18_read_pos(s, buf, count, pos, filp->f_flags & O_NONBLOCK); 58862306a36Sopenharmony_ci} 58962306a36Sopenharmony_ci 59062306a36Sopenharmony_ci__poll_t cx18_v4l2_enc_poll(struct file *filp, poll_table *wait) 59162306a36Sopenharmony_ci{ 59262306a36Sopenharmony_ci __poll_t req_events = poll_requested_events(wait); 59362306a36Sopenharmony_ci struct cx18_open_id *id = file2id(filp); 59462306a36Sopenharmony_ci struct cx18 *cx = id->cx; 59562306a36Sopenharmony_ci struct cx18_stream *s = &cx->streams[id->type]; 59662306a36Sopenharmony_ci int eof = test_bit(CX18_F_S_STREAMOFF, &s->s_flags); 59762306a36Sopenharmony_ci __poll_t res = 0; 59862306a36Sopenharmony_ci 59962306a36Sopenharmony_ci /* Start a capture if there is none */ 60062306a36Sopenharmony_ci if (!eof && !test_bit(CX18_F_S_STREAMING, &s->s_flags) && 60162306a36Sopenharmony_ci (req_events & (EPOLLIN | EPOLLRDNORM))) { 60262306a36Sopenharmony_ci int rc; 60362306a36Sopenharmony_ci 60462306a36Sopenharmony_ci mutex_lock(&cx->serialize_lock); 60562306a36Sopenharmony_ci rc = cx18_start_capture(id); 60662306a36Sopenharmony_ci mutex_unlock(&cx->serialize_lock); 60762306a36Sopenharmony_ci if (rc) { 60862306a36Sopenharmony_ci CX18_DEBUG_INFO("Could not start capture for %s (%d)\n", 60962306a36Sopenharmony_ci s->name, rc); 61062306a36Sopenharmony_ci return EPOLLERR; 61162306a36Sopenharmony_ci } 61262306a36Sopenharmony_ci CX18_DEBUG_FILE("Encoder poll started capture\n"); 61362306a36Sopenharmony_ci } 61462306a36Sopenharmony_ci 61562306a36Sopenharmony_ci /* add stream's waitq to the poll list */ 61662306a36Sopenharmony_ci CX18_DEBUG_HI_FILE("Encoder poll\n"); 61762306a36Sopenharmony_ci if (v4l2_event_pending(&id->fh)) 61862306a36Sopenharmony_ci res |= EPOLLPRI; 61962306a36Sopenharmony_ci else 62062306a36Sopenharmony_ci poll_wait(filp, &s->waitq, wait); 62162306a36Sopenharmony_ci 62262306a36Sopenharmony_ci if (atomic_read(&s->q_full.depth)) 62362306a36Sopenharmony_ci return res | EPOLLIN | EPOLLRDNORM; 62462306a36Sopenharmony_ci if (eof) 62562306a36Sopenharmony_ci return res | EPOLLHUP; 62662306a36Sopenharmony_ci return res; 62762306a36Sopenharmony_ci} 62862306a36Sopenharmony_ci 62962306a36Sopenharmony_civoid cx18_vb_timeout(struct timer_list *t) 63062306a36Sopenharmony_ci{ 63162306a36Sopenharmony_ci struct cx18_stream *s = from_timer(s, t, vb_timeout); 63262306a36Sopenharmony_ci 63362306a36Sopenharmony_ci /* 63462306a36Sopenharmony_ci * Return all of the buffers in error state, so the vbi/vid inode 63562306a36Sopenharmony_ci * can return from blocking. 63662306a36Sopenharmony_ci */ 63762306a36Sopenharmony_ci cx18_clear_queue(s, VB2_BUF_STATE_ERROR); 63862306a36Sopenharmony_ci} 63962306a36Sopenharmony_ci 64062306a36Sopenharmony_civoid cx18_stop_capture(struct cx18_stream *s, int gop_end) 64162306a36Sopenharmony_ci{ 64262306a36Sopenharmony_ci struct cx18 *cx = s->cx; 64362306a36Sopenharmony_ci struct cx18_stream *s_vbi = &cx->streams[CX18_ENC_STREAM_TYPE_VBI]; 64462306a36Sopenharmony_ci struct cx18_stream *s_idx = &cx->streams[CX18_ENC_STREAM_TYPE_IDX]; 64562306a36Sopenharmony_ci 64662306a36Sopenharmony_ci CX18_DEBUG_IOCTL("close() of %s\n", s->name); 64762306a36Sopenharmony_ci 64862306a36Sopenharmony_ci /* 'Unclaim' this stream */ 64962306a36Sopenharmony_ci 65062306a36Sopenharmony_ci /* Stop capturing */ 65162306a36Sopenharmony_ci if (test_bit(CX18_F_S_STREAMING, &s->s_flags)) { 65262306a36Sopenharmony_ci CX18_DEBUG_INFO("close stopping capture\n"); 65362306a36Sopenharmony_ci if (s->type == CX18_ENC_STREAM_TYPE_MPG) { 65462306a36Sopenharmony_ci /* Stop internal use associated VBI and IDX streams */ 65562306a36Sopenharmony_ci if (test_bit(CX18_F_S_STREAMING, &s_vbi->s_flags) && 65662306a36Sopenharmony_ci !test_bit(CX18_F_S_APPL_IO, &s_vbi->s_flags)) { 65762306a36Sopenharmony_ci CX18_DEBUG_INFO("close stopping embedded VBI capture\n"); 65862306a36Sopenharmony_ci cx18_stop_v4l2_encode_stream(s_vbi, 0); 65962306a36Sopenharmony_ci } 66062306a36Sopenharmony_ci if (test_bit(CX18_F_S_STREAMING, &s_idx->s_flags)) { 66162306a36Sopenharmony_ci CX18_DEBUG_INFO("close stopping IDX capture\n"); 66262306a36Sopenharmony_ci cx18_stop_v4l2_encode_stream(s_idx, 0); 66362306a36Sopenharmony_ci } 66462306a36Sopenharmony_ci } 66562306a36Sopenharmony_ci if (s->type == CX18_ENC_STREAM_TYPE_VBI && 66662306a36Sopenharmony_ci test_bit(CX18_F_S_INTERNAL_USE, &s->s_flags)) 66762306a36Sopenharmony_ci /* Also used internally, don't stop capturing */ 66862306a36Sopenharmony_ci s->id = -1; 66962306a36Sopenharmony_ci else 67062306a36Sopenharmony_ci cx18_stop_v4l2_encode_stream(s, gop_end); 67162306a36Sopenharmony_ci } 67262306a36Sopenharmony_ci if (!gop_end) { 67362306a36Sopenharmony_ci clear_bit(CX18_F_S_APPL_IO, &s->s_flags); 67462306a36Sopenharmony_ci clear_bit(CX18_F_S_STREAMOFF, &s->s_flags); 67562306a36Sopenharmony_ci cx18_release_stream(s); 67662306a36Sopenharmony_ci } 67762306a36Sopenharmony_ci} 67862306a36Sopenharmony_ci 67962306a36Sopenharmony_ciint cx18_v4l2_close(struct file *filp) 68062306a36Sopenharmony_ci{ 68162306a36Sopenharmony_ci struct v4l2_fh *fh = filp->private_data; 68262306a36Sopenharmony_ci struct cx18_open_id *id = fh2id(fh); 68362306a36Sopenharmony_ci struct cx18 *cx = id->cx; 68462306a36Sopenharmony_ci struct cx18_stream *s = &cx->streams[id->type]; 68562306a36Sopenharmony_ci struct video_device *vdev = &s->video_dev; 68662306a36Sopenharmony_ci 68762306a36Sopenharmony_ci CX18_DEBUG_IOCTL("close() of %s\n", s->name); 68862306a36Sopenharmony_ci 68962306a36Sopenharmony_ci mutex_lock(&cx->serialize_lock); 69062306a36Sopenharmony_ci /* Stop radio */ 69162306a36Sopenharmony_ci if (id->type == CX18_ENC_STREAM_TYPE_RAD && 69262306a36Sopenharmony_ci v4l2_fh_is_singular_file(filp)) { 69362306a36Sopenharmony_ci /* Closing radio device, return to TV mode */ 69462306a36Sopenharmony_ci cx18_mute(cx); 69562306a36Sopenharmony_ci /* Mark that the radio is no longer in use */ 69662306a36Sopenharmony_ci clear_bit(CX18_F_I_RADIO_USER, &cx->i_flags); 69762306a36Sopenharmony_ci /* Switch tuner to TV */ 69862306a36Sopenharmony_ci cx18_call_all(cx, video, s_std, cx->std); 69962306a36Sopenharmony_ci /* Select correct audio input (i.e. TV tuner or Line in) */ 70062306a36Sopenharmony_ci cx18_audio_set_io(cx); 70162306a36Sopenharmony_ci if (atomic_read(&cx->ana_capturing) > 0) { 70262306a36Sopenharmony_ci /* Undo video mute */ 70362306a36Sopenharmony_ci cx18_vapi(cx, CX18_CPU_SET_VIDEO_MUTE, 2, s->handle, 70462306a36Sopenharmony_ci (v4l2_ctrl_g_ctrl(cx->cxhdl.video_mute) | 70562306a36Sopenharmony_ci (v4l2_ctrl_g_ctrl(cx->cxhdl.video_mute_yuv) << 8))); 70662306a36Sopenharmony_ci } 70762306a36Sopenharmony_ci /* Done! Unmute and continue. */ 70862306a36Sopenharmony_ci cx18_unmute(cx); 70962306a36Sopenharmony_ci } 71062306a36Sopenharmony_ci 71162306a36Sopenharmony_ci if (id->type == CX18_ENC_STREAM_TYPE_YUV && 71262306a36Sopenharmony_ci filp->private_data == vdev->queue->owner) { 71362306a36Sopenharmony_ci vb2_queue_release(vdev->queue); 71462306a36Sopenharmony_ci vdev->queue->owner = NULL; 71562306a36Sopenharmony_ci } 71662306a36Sopenharmony_ci v4l2_fh_del(fh); 71762306a36Sopenharmony_ci v4l2_fh_exit(fh); 71862306a36Sopenharmony_ci 71962306a36Sopenharmony_ci /* 'Unclaim' this stream */ 72062306a36Sopenharmony_ci if (id->type != CX18_ENC_STREAM_TYPE_YUV && s->id == id->open_id) 72162306a36Sopenharmony_ci cx18_stop_capture(s, 0); 72262306a36Sopenharmony_ci kfree(id); 72362306a36Sopenharmony_ci mutex_unlock(&cx->serialize_lock); 72462306a36Sopenharmony_ci return 0; 72562306a36Sopenharmony_ci} 72662306a36Sopenharmony_ci 72762306a36Sopenharmony_cistatic int cx18_serialized_open(struct cx18_stream *s, struct file *filp) 72862306a36Sopenharmony_ci{ 72962306a36Sopenharmony_ci struct cx18 *cx = s->cx; 73062306a36Sopenharmony_ci struct cx18_open_id *item; 73162306a36Sopenharmony_ci 73262306a36Sopenharmony_ci CX18_DEBUG_FILE("open %s\n", s->name); 73362306a36Sopenharmony_ci 73462306a36Sopenharmony_ci /* Allocate memory */ 73562306a36Sopenharmony_ci item = kzalloc(sizeof(struct cx18_open_id), GFP_KERNEL); 73662306a36Sopenharmony_ci if (NULL == item) { 73762306a36Sopenharmony_ci CX18_DEBUG_WARN("nomem on v4l2 open\n"); 73862306a36Sopenharmony_ci return -ENOMEM; 73962306a36Sopenharmony_ci } 74062306a36Sopenharmony_ci v4l2_fh_init(&item->fh, &s->video_dev); 74162306a36Sopenharmony_ci 74262306a36Sopenharmony_ci item->cx = cx; 74362306a36Sopenharmony_ci item->type = s->type; 74462306a36Sopenharmony_ci 74562306a36Sopenharmony_ci item->open_id = cx->open_id++; 74662306a36Sopenharmony_ci filp->private_data = &item->fh; 74762306a36Sopenharmony_ci v4l2_fh_add(&item->fh); 74862306a36Sopenharmony_ci 74962306a36Sopenharmony_ci if (item->type == CX18_ENC_STREAM_TYPE_RAD && 75062306a36Sopenharmony_ci v4l2_fh_is_singular_file(filp)) { 75162306a36Sopenharmony_ci if (!test_bit(CX18_F_I_RADIO_USER, &cx->i_flags)) { 75262306a36Sopenharmony_ci if (atomic_read(&cx->ana_capturing) > 0) { 75362306a36Sopenharmony_ci /* switching to radio while capture is 75462306a36Sopenharmony_ci in progress is not polite */ 75562306a36Sopenharmony_ci v4l2_fh_del(&item->fh); 75662306a36Sopenharmony_ci v4l2_fh_exit(&item->fh); 75762306a36Sopenharmony_ci kfree(item); 75862306a36Sopenharmony_ci return -EBUSY; 75962306a36Sopenharmony_ci } 76062306a36Sopenharmony_ci } 76162306a36Sopenharmony_ci 76262306a36Sopenharmony_ci /* Mark that the radio is being used. */ 76362306a36Sopenharmony_ci set_bit(CX18_F_I_RADIO_USER, &cx->i_flags); 76462306a36Sopenharmony_ci /* We have the radio */ 76562306a36Sopenharmony_ci cx18_mute(cx); 76662306a36Sopenharmony_ci /* Switch tuner to radio */ 76762306a36Sopenharmony_ci cx18_call_all(cx, tuner, s_radio); 76862306a36Sopenharmony_ci /* Select the correct audio input (i.e. radio tuner) */ 76962306a36Sopenharmony_ci cx18_audio_set_io(cx); 77062306a36Sopenharmony_ci /* Done! Unmute and continue. */ 77162306a36Sopenharmony_ci cx18_unmute(cx); 77262306a36Sopenharmony_ci } 77362306a36Sopenharmony_ci return 0; 77462306a36Sopenharmony_ci} 77562306a36Sopenharmony_ci 77662306a36Sopenharmony_ciint cx18_v4l2_open(struct file *filp) 77762306a36Sopenharmony_ci{ 77862306a36Sopenharmony_ci int res; 77962306a36Sopenharmony_ci struct video_device *video_dev = video_devdata(filp); 78062306a36Sopenharmony_ci struct cx18_stream *s = video_get_drvdata(video_dev); 78162306a36Sopenharmony_ci struct cx18 *cx = s->cx; 78262306a36Sopenharmony_ci 78362306a36Sopenharmony_ci mutex_lock(&cx->serialize_lock); 78462306a36Sopenharmony_ci if (cx18_init_on_first_open(cx)) { 78562306a36Sopenharmony_ci CX18_ERR("Failed to initialize on %s\n", 78662306a36Sopenharmony_ci video_device_node_name(video_dev)); 78762306a36Sopenharmony_ci mutex_unlock(&cx->serialize_lock); 78862306a36Sopenharmony_ci return -ENXIO; 78962306a36Sopenharmony_ci } 79062306a36Sopenharmony_ci res = cx18_serialized_open(s, filp); 79162306a36Sopenharmony_ci mutex_unlock(&cx->serialize_lock); 79262306a36Sopenharmony_ci return res; 79362306a36Sopenharmony_ci} 79462306a36Sopenharmony_ci 79562306a36Sopenharmony_civoid cx18_mute(struct cx18 *cx) 79662306a36Sopenharmony_ci{ 79762306a36Sopenharmony_ci u32 h; 79862306a36Sopenharmony_ci if (atomic_read(&cx->ana_capturing)) { 79962306a36Sopenharmony_ci h = cx18_find_handle(cx); 80062306a36Sopenharmony_ci if (h != CX18_INVALID_TASK_HANDLE) 80162306a36Sopenharmony_ci cx18_vapi(cx, CX18_CPU_SET_AUDIO_MUTE, 2, h, 1); 80262306a36Sopenharmony_ci else 80362306a36Sopenharmony_ci CX18_ERR("Can't find valid task handle for mute\n"); 80462306a36Sopenharmony_ci } 80562306a36Sopenharmony_ci CX18_DEBUG_INFO("Mute\n"); 80662306a36Sopenharmony_ci} 80762306a36Sopenharmony_ci 80862306a36Sopenharmony_civoid cx18_unmute(struct cx18 *cx) 80962306a36Sopenharmony_ci{ 81062306a36Sopenharmony_ci u32 h; 81162306a36Sopenharmony_ci if (atomic_read(&cx->ana_capturing)) { 81262306a36Sopenharmony_ci h = cx18_find_handle(cx); 81362306a36Sopenharmony_ci if (h != CX18_INVALID_TASK_HANDLE) { 81462306a36Sopenharmony_ci cx18_msleep_timeout(100, 0); 81562306a36Sopenharmony_ci cx18_vapi(cx, CX18_CPU_SET_MISC_PARAMETERS, 2, h, 12); 81662306a36Sopenharmony_ci cx18_vapi(cx, CX18_CPU_SET_AUDIO_MUTE, 2, h, 0); 81762306a36Sopenharmony_ci } else 81862306a36Sopenharmony_ci CX18_ERR("Can't find valid task handle for unmute\n"); 81962306a36Sopenharmony_ci } 82062306a36Sopenharmony_ci CX18_DEBUG_INFO("Unmute\n"); 82162306a36Sopenharmony_ci} 822