cx18-fileops.c 20 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719
  1. /*
  2. * cx18 file operation functions
  3. *
  4. * Derived from ivtv-fileops.c
  5. *
  6. * Copyright (C) 2007 Hans Verkuil <hverkuil@xs4all.nl>
  7. * Copyright (C) 2008 Andy Walls <awalls@radix.net>
  8. *
  9. * This program is free software; you can redistribute it and/or modify
  10. * it under the terms of the GNU General Public License as published by
  11. * the Free Software Foundation; either version 2 of the License, or
  12. * (at your option) any later version.
  13. *
  14. * This program is distributed in the hope that it will be useful,
  15. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  16. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  17. * GNU General Public License for more details.
  18. *
  19. * You should have received a copy of the GNU General Public License
  20. * along with this program; if not, write to the Free Software
  21. * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA
  22. * 02111-1307 USA
  23. */
  24. #include "cx18-driver.h"
  25. #include "cx18-fileops.h"
  26. #include "cx18-i2c.h"
  27. #include "cx18-queue.h"
  28. #include "cx18-vbi.h"
  29. #include "cx18-audio.h"
  30. #include "cx18-mailbox.h"
  31. #include "cx18-scb.h"
  32. #include "cx18-streams.h"
  33. #include "cx18-controls.h"
  34. #include "cx18-ioctl.h"
  35. #include "cx18-cards.h"
  36. /* This function tries to claim the stream for a specific file descriptor.
  37. If no one else is using this stream then the stream is claimed and
  38. associated VBI streams are also automatically claimed.
  39. Possible error returns: -EBUSY if someone else has claimed
  40. the stream or 0 on success. */
  41. static int cx18_claim_stream(struct cx18_open_id *id, int type)
  42. {
  43. struct cx18 *cx = id->cx;
  44. struct cx18_stream *s = &cx->streams[type];
  45. struct cx18_stream *s_vbi;
  46. int vbi_type;
  47. if (test_and_set_bit(CX18_F_S_CLAIMED, &s->s_flags)) {
  48. /* someone already claimed this stream */
  49. if (s->id == id->open_id) {
  50. /* yes, this file descriptor did. So that's OK. */
  51. return 0;
  52. }
  53. if (s->id == -1 && type == CX18_ENC_STREAM_TYPE_VBI) {
  54. /* VBI is handled already internally, now also assign
  55. the file descriptor to this stream for external
  56. reading of the stream. */
  57. s->id = id->open_id;
  58. CX18_DEBUG_INFO("Start Read VBI\n");
  59. return 0;
  60. }
  61. /* someone else is using this stream already */
  62. CX18_DEBUG_INFO("Stream %d is busy\n", type);
  63. return -EBUSY;
  64. }
  65. s->id = id->open_id;
  66. /* CX18_ENC_STREAM_TYPE_MPG needs to claim CX18_ENC_STREAM_TYPE_VBI
  67. (provided VBI insertion is on and sliced VBI is selected), for all
  68. other streams we're done */
  69. if (type == CX18_ENC_STREAM_TYPE_MPG &&
  70. cx->vbi.insert_mpeg && !cx18_raw_vbi(cx)) {
  71. vbi_type = CX18_ENC_STREAM_TYPE_VBI;
  72. } else {
  73. return 0;
  74. }
  75. s_vbi = &cx->streams[vbi_type];
  76. set_bit(CX18_F_S_CLAIMED, &s_vbi->s_flags);
  77. /* mark that it is used internally */
  78. set_bit(CX18_F_S_INTERNAL_USE, &s_vbi->s_flags);
  79. return 0;
  80. }
  81. /* This function releases a previously claimed stream. It will take into
  82. account associated VBI streams. */
  83. static void cx18_release_stream(struct cx18_stream *s)
  84. {
  85. struct cx18 *cx = s->cx;
  86. struct cx18_stream *s_vbi;
  87. s->id = -1;
  88. if (s->type == CX18_ENC_STREAM_TYPE_VBI &&
  89. test_bit(CX18_F_S_INTERNAL_USE, &s->s_flags)) {
  90. /* this stream is still in use internally */
  91. return;
  92. }
  93. if (!test_and_clear_bit(CX18_F_S_CLAIMED, &s->s_flags)) {
  94. CX18_DEBUG_WARN("Release stream %s not in use!\n", s->name);
  95. return;
  96. }
  97. cx18_flush_queues(s);
  98. /* CX18_ENC_STREAM_TYPE_MPG needs to release CX18_ENC_STREAM_TYPE_VBI,
  99. for all other streams we're done */
  100. if (s->type == CX18_ENC_STREAM_TYPE_MPG)
  101. s_vbi = &cx->streams[CX18_ENC_STREAM_TYPE_VBI];
  102. else
  103. return;
  104. /* clear internal use flag */
  105. if (!test_and_clear_bit(CX18_F_S_INTERNAL_USE, &s_vbi->s_flags)) {
  106. /* was already cleared */
  107. return;
  108. }
  109. if (s_vbi->id != -1) {
  110. /* VBI stream still claimed by a file descriptor */
  111. return;
  112. }
  113. clear_bit(CX18_F_S_CLAIMED, &s_vbi->s_flags);
  114. cx18_flush_queues(s_vbi);
  115. }
  116. static void cx18_dualwatch(struct cx18 *cx)
  117. {
  118. struct v4l2_tuner vt;
  119. u16 new_bitmap;
  120. u16 new_stereo_mode;
  121. const u16 stereo_mask = 0x0300;
  122. const u16 dual = 0x0200;
  123. u32 h;
  124. new_stereo_mode = cx->params.audio_properties & stereo_mask;
  125. memset(&vt, 0, sizeof(vt));
  126. cx18_call_i2c_clients(cx, VIDIOC_G_TUNER, &vt);
  127. if (vt.audmode == V4L2_TUNER_MODE_LANG1_LANG2 &&
  128. (vt.rxsubchans & V4L2_TUNER_SUB_LANG2))
  129. new_stereo_mode = dual;
  130. if (new_stereo_mode == cx->dualwatch_stereo_mode)
  131. return;
  132. new_bitmap = new_stereo_mode
  133. | (cx->params.audio_properties & ~stereo_mask);
  134. CX18_DEBUG_INFO("dualwatch: change stereo flag from 0x%x to 0x%x. "
  135. "new audio_bitmask=0x%ux\n",
  136. cx->dualwatch_stereo_mode, new_stereo_mode, new_bitmap);
  137. h = cx18_find_handle(cx);
  138. if (h == CX18_INVALID_TASK_HANDLE) {
  139. CX18_DEBUG_INFO("dualwatch: can't find valid task handle\n");
  140. return;
  141. }
  142. if (cx18_vapi(cx,
  143. CX18_CPU_SET_AUDIO_PARAMETERS, 2, h, new_bitmap) == 0) {
  144. cx->dualwatch_stereo_mode = new_stereo_mode;
  145. return;
  146. }
  147. CX18_DEBUG_INFO("dualwatch: changing stereo flag failed\n");
  148. }
  149. static struct cx18_buffer *cx18_get_buffer(struct cx18_stream *s, int non_block, int *err)
  150. {
  151. struct cx18 *cx = s->cx;
  152. struct cx18_stream *s_vbi = &cx->streams[CX18_ENC_STREAM_TYPE_VBI];
  153. struct cx18_buffer *buf;
  154. DEFINE_WAIT(wait);
  155. *err = 0;
  156. while (1) {
  157. if (s->type == CX18_ENC_STREAM_TYPE_MPG) {
  158. if (time_after(jiffies, cx->dualwatch_jiffies + msecs_to_jiffies(1000))) {
  159. cx->dualwatch_jiffies = jiffies;
  160. cx18_dualwatch(cx);
  161. }
  162. if (test_bit(CX18_F_S_INTERNAL_USE, &s_vbi->s_flags) &&
  163. !test_bit(CX18_F_S_APPL_IO, &s_vbi->s_flags)) {
  164. while ((buf = cx18_dequeue(s_vbi, &s_vbi->q_full))) {
  165. /* byteswap and process VBI data */
  166. /* cx18_process_vbi_data(cx, buf, s_vbi->dma_pts, s_vbi->type); */
  167. cx18_stream_put_buf_fw(s_vbi, buf);
  168. }
  169. }
  170. buf = &cx->vbi.sliced_mpeg_buf;
  171. if (buf->readpos != buf->bytesused)
  172. return buf;
  173. }
  174. /* do we have new data? */
  175. buf = cx18_dequeue(s, &s->q_full);
  176. if (buf) {
  177. if (!test_and_clear_bit(CX18_F_B_NEED_BUF_SWAP,
  178. &buf->b_flags))
  179. return buf;
  180. if (s->type == CX18_ENC_STREAM_TYPE_MPG)
  181. /* byteswap MPG data */
  182. cx18_buf_swap(buf);
  183. else {
  184. /* byteswap and process VBI data */
  185. cx18_process_vbi_data(cx, buf,
  186. s->dma_pts, s->type);
  187. }
  188. return buf;
  189. }
  190. /* return if end of stream */
  191. if (!test_bit(CX18_F_S_STREAMING, &s->s_flags)) {
  192. CX18_DEBUG_INFO("EOS %s\n", s->name);
  193. return NULL;
  194. }
  195. /* return if file was opened with O_NONBLOCK */
  196. if (non_block) {
  197. *err = -EAGAIN;
  198. return NULL;
  199. }
  200. /* wait for more data to arrive */
  201. prepare_to_wait(&s->waitq, &wait, TASK_INTERRUPTIBLE);
  202. /* New buffers might have become available before we were added
  203. to the waitqueue */
  204. if (!atomic_read(&s->q_full.buffers))
  205. schedule();
  206. finish_wait(&s->waitq, &wait);
  207. if (signal_pending(current)) {
  208. /* return if a signal was received */
  209. CX18_DEBUG_INFO("User stopped %s\n", s->name);
  210. *err = -EINTR;
  211. return NULL;
  212. }
  213. }
  214. }
  215. static void cx18_setup_sliced_vbi_buf(struct cx18 *cx)
  216. {
  217. int idx = cx->vbi.inserted_frame % CX18_VBI_FRAMES;
  218. cx->vbi.sliced_mpeg_buf.buf = cx->vbi.sliced_mpeg_data[idx];
  219. cx->vbi.sliced_mpeg_buf.bytesused = cx->vbi.sliced_mpeg_size[idx];
  220. cx->vbi.sliced_mpeg_buf.readpos = 0;
  221. }
  222. static size_t cx18_copy_buf_to_user(struct cx18_stream *s,
  223. struct cx18_buffer *buf, char __user *ubuf, size_t ucount)
  224. {
  225. struct cx18 *cx = s->cx;
  226. size_t len = buf->bytesused - buf->readpos;
  227. if (len > ucount)
  228. len = ucount;
  229. if (cx->vbi.insert_mpeg && s->type == CX18_ENC_STREAM_TYPE_MPG &&
  230. !cx18_raw_vbi(cx) && buf != &cx->vbi.sliced_mpeg_buf) {
  231. const char *start = buf->buf + buf->readpos;
  232. const char *p = start + 1;
  233. const u8 *q;
  234. u8 ch = cx->search_pack_header ? 0xba : 0xe0;
  235. int stuffing, i;
  236. while (start + len > p) {
  237. q = memchr(p, 0, start + len - p);
  238. if (q == NULL)
  239. break;
  240. p = q + 1;
  241. if ((char *)q + 15 >= buf->buf + buf->bytesused ||
  242. q[1] != 0 || q[2] != 1 || q[3] != ch)
  243. continue;
  244. if (!cx->search_pack_header) {
  245. if ((q[6] & 0xc0) != 0x80)
  246. continue;
  247. if (((q[7] & 0xc0) == 0x80 &&
  248. (q[9] & 0xf0) == 0x20) ||
  249. ((q[7] & 0xc0) == 0xc0 &&
  250. (q[9] & 0xf0) == 0x30)) {
  251. ch = 0xba;
  252. cx->search_pack_header = 1;
  253. p = q + 9;
  254. }
  255. continue;
  256. }
  257. stuffing = q[13] & 7;
  258. /* all stuffing bytes must be 0xff */
  259. for (i = 0; i < stuffing; i++)
  260. if (q[14 + i] != 0xff)
  261. break;
  262. if (i == stuffing &&
  263. (q[4] & 0xc4) == 0x44 &&
  264. (q[12] & 3) == 3 &&
  265. q[14 + stuffing] == 0 &&
  266. q[15 + stuffing] == 0 &&
  267. q[16 + stuffing] == 1) {
  268. cx->search_pack_header = 0;
  269. len = (char *)q - start;
  270. cx18_setup_sliced_vbi_buf(cx);
  271. break;
  272. }
  273. }
  274. }
  275. if (copy_to_user(ubuf, (u8 *)buf->buf + buf->readpos, len)) {
  276. CX18_DEBUG_WARN("copy %zd bytes to user failed for %s\n",
  277. len, s->name);
  278. return -EFAULT;
  279. }
  280. buf->readpos += len;
  281. if (s->type == CX18_ENC_STREAM_TYPE_MPG &&
  282. buf != &cx->vbi.sliced_mpeg_buf)
  283. cx->mpg_data_received += len;
  284. return len;
  285. }
  286. static ssize_t cx18_read(struct cx18_stream *s, char __user *ubuf,
  287. size_t tot_count, int non_block)
  288. {
  289. struct cx18 *cx = s->cx;
  290. size_t tot_written = 0;
  291. int single_frame = 0;
  292. if (atomic_read(&cx->ana_capturing) == 0 && s->id == -1) {
  293. /* shouldn't happen */
  294. CX18_DEBUG_WARN("Stream %s not initialized before read\n",
  295. s->name);
  296. return -EIO;
  297. }
  298. /* Each VBI buffer is one frame, the v4l2 API says that for VBI the
  299. frames should arrive one-by-one, so make sure we never output more
  300. than one VBI frame at a time */
  301. if (s->type == CX18_ENC_STREAM_TYPE_VBI && !cx18_raw_vbi(cx))
  302. single_frame = 1;
  303. for (;;) {
  304. struct cx18_buffer *buf;
  305. int rc;
  306. buf = cx18_get_buffer(s, non_block, &rc);
  307. /* if there is no data available... */
  308. if (buf == NULL) {
  309. /* if we got data, then return that regardless */
  310. if (tot_written)
  311. break;
  312. /* EOS condition */
  313. if (rc == 0) {
  314. clear_bit(CX18_F_S_STREAMOFF, &s->s_flags);
  315. clear_bit(CX18_F_S_APPL_IO, &s->s_flags);
  316. cx18_release_stream(s);
  317. }
  318. /* set errno */
  319. return rc;
  320. }
  321. rc = cx18_copy_buf_to_user(s, buf, ubuf + tot_written,
  322. tot_count - tot_written);
  323. if (buf != &cx->vbi.sliced_mpeg_buf) {
  324. if (buf->readpos == buf->bytesused)
  325. cx18_stream_put_buf_fw(s, buf);
  326. else
  327. cx18_push(s, buf, &s->q_full);
  328. } else if (buf->readpos == buf->bytesused) {
  329. int idx = cx->vbi.inserted_frame % CX18_VBI_FRAMES;
  330. cx->vbi.sliced_mpeg_size[idx] = 0;
  331. cx->vbi.inserted_frame++;
  332. cx->vbi_data_inserted += buf->bytesused;
  333. }
  334. if (rc < 0)
  335. return rc;
  336. tot_written += rc;
  337. if (tot_written == tot_count || single_frame)
  338. break;
  339. }
  340. return tot_written;
  341. }
  342. static ssize_t cx18_read_pos(struct cx18_stream *s, char __user *ubuf,
  343. size_t count, loff_t *pos, int non_block)
  344. {
  345. ssize_t rc = count ? cx18_read(s, ubuf, count, non_block) : 0;
  346. struct cx18 *cx = s->cx;
  347. CX18_DEBUG_HI_FILE("read %zd from %s, got %zd\n", count, s->name, rc);
  348. if (rc > 0)
  349. pos += rc;
  350. return rc;
  351. }
  352. int cx18_start_capture(struct cx18_open_id *id)
  353. {
  354. struct cx18 *cx = id->cx;
  355. struct cx18_stream *s = &cx->streams[id->type];
  356. struct cx18_stream *s_vbi;
  357. if (s->type == CX18_ENC_STREAM_TYPE_RAD) {
  358. /* you cannot read from these stream types. */
  359. return -EPERM;
  360. }
  361. /* Try to claim this stream. */
  362. if (cx18_claim_stream(id, s->type))
  363. return -EBUSY;
  364. /* If capture is already in progress, then we also have to
  365. do nothing extra. */
  366. if (test_bit(CX18_F_S_STREAMOFF, &s->s_flags) ||
  367. test_and_set_bit(CX18_F_S_STREAMING, &s->s_flags)) {
  368. set_bit(CX18_F_S_APPL_IO, &s->s_flags);
  369. return 0;
  370. }
  371. /* Start VBI capture if required */
  372. s_vbi = &cx->streams[CX18_ENC_STREAM_TYPE_VBI];
  373. if (s->type == CX18_ENC_STREAM_TYPE_MPG &&
  374. test_bit(CX18_F_S_INTERNAL_USE, &s_vbi->s_flags) &&
  375. !test_and_set_bit(CX18_F_S_STREAMING, &s_vbi->s_flags)) {
  376. /* Note: the CX18_ENC_STREAM_TYPE_VBI is claimed
  377. automatically when the MPG stream is claimed.
  378. We only need to start the VBI capturing. */
  379. if (cx18_start_v4l2_encode_stream(s_vbi)) {
  380. CX18_DEBUG_WARN("VBI capture start failed\n");
  381. /* Failure, clean up and return an error */
  382. clear_bit(CX18_F_S_STREAMING, &s_vbi->s_flags);
  383. clear_bit(CX18_F_S_STREAMING, &s->s_flags);
  384. /* also releases the associated VBI stream */
  385. cx18_release_stream(s);
  386. return -EIO;
  387. }
  388. CX18_DEBUG_INFO("VBI insertion started\n");
  389. }
  390. /* Tell the card to start capturing */
  391. if (!cx18_start_v4l2_encode_stream(s)) {
  392. /* We're done */
  393. set_bit(CX18_F_S_APPL_IO, &s->s_flags);
  394. /* Resume a possibly paused encoder */
  395. if (test_and_clear_bit(CX18_F_I_ENC_PAUSED, &cx->i_flags))
  396. cx18_vapi(cx, CX18_CPU_CAPTURE_PAUSE, 1, s->handle);
  397. return 0;
  398. }
  399. /* failure, clean up */
  400. CX18_DEBUG_WARN("Failed to start capturing for stream %s\n", s->name);
  401. /* Note: the CX18_ENC_STREAM_TYPE_VBI is released
  402. automatically when the MPG stream is released.
  403. We only need to stop the VBI capturing. */
  404. if (s->type == CX18_ENC_STREAM_TYPE_MPG &&
  405. test_bit(CX18_F_S_STREAMING, &s_vbi->s_flags)) {
  406. cx18_stop_v4l2_encode_stream(s_vbi, 0);
  407. clear_bit(CX18_F_S_STREAMING, &s_vbi->s_flags);
  408. }
  409. clear_bit(CX18_F_S_STREAMING, &s->s_flags);
  410. cx18_release_stream(s);
  411. return -EIO;
  412. }
  413. ssize_t cx18_v4l2_read(struct file *filp, char __user *buf, size_t count,
  414. loff_t *pos)
  415. {
  416. struct cx18_open_id *id = filp->private_data;
  417. struct cx18 *cx = id->cx;
  418. struct cx18_stream *s = &cx->streams[id->type];
  419. int rc;
  420. CX18_DEBUG_HI_FILE("read %zd bytes from %s\n", count, s->name);
  421. mutex_lock(&cx->serialize_lock);
  422. rc = cx18_start_capture(id);
  423. mutex_unlock(&cx->serialize_lock);
  424. if (rc)
  425. return rc;
  426. return cx18_read_pos(s, buf, count, pos, filp->f_flags & O_NONBLOCK);
  427. }
  428. unsigned int cx18_v4l2_enc_poll(struct file *filp, poll_table *wait)
  429. {
  430. struct cx18_open_id *id = filp->private_data;
  431. struct cx18 *cx = id->cx;
  432. struct cx18_stream *s = &cx->streams[id->type];
  433. int eof = test_bit(CX18_F_S_STREAMOFF, &s->s_flags);
  434. /* Start a capture if there is none */
  435. if (!eof && !test_bit(CX18_F_S_STREAMING, &s->s_flags)) {
  436. int rc;
  437. mutex_lock(&cx->serialize_lock);
  438. rc = cx18_start_capture(id);
  439. mutex_unlock(&cx->serialize_lock);
  440. if (rc) {
  441. CX18_DEBUG_INFO("Could not start capture for %s (%d)\n",
  442. s->name, rc);
  443. return POLLERR;
  444. }
  445. CX18_DEBUG_FILE("Encoder poll started capture\n");
  446. }
  447. /* add stream's waitq to the poll list */
  448. CX18_DEBUG_HI_FILE("Encoder poll\n");
  449. poll_wait(filp, &s->waitq, wait);
  450. if (atomic_read(&s->q_full.buffers))
  451. return POLLIN | POLLRDNORM;
  452. if (eof)
  453. return POLLHUP;
  454. return 0;
  455. }
  456. void cx18_stop_capture(struct cx18_open_id *id, int gop_end)
  457. {
  458. struct cx18 *cx = id->cx;
  459. struct cx18_stream *s = &cx->streams[id->type];
  460. CX18_DEBUG_IOCTL("close() of %s\n", s->name);
  461. /* 'Unclaim' this stream */
  462. /* Stop capturing */
  463. if (test_bit(CX18_F_S_STREAMING, &s->s_flags)) {
  464. struct cx18_stream *s_vbi =
  465. &cx->streams[CX18_ENC_STREAM_TYPE_VBI];
  466. CX18_DEBUG_INFO("close stopping capture\n");
  467. /* Special case: a running VBI capture for VBI insertion
  468. in the mpeg stream. Need to stop that too. */
  469. if (id->type == CX18_ENC_STREAM_TYPE_MPG &&
  470. test_bit(CX18_F_S_STREAMING, &s_vbi->s_flags) &&
  471. !test_bit(CX18_F_S_APPL_IO, &s_vbi->s_flags)) {
  472. CX18_DEBUG_INFO("close stopping embedded VBI capture\n");
  473. cx18_stop_v4l2_encode_stream(s_vbi, 0);
  474. }
  475. if (id->type == CX18_ENC_STREAM_TYPE_VBI &&
  476. test_bit(CX18_F_S_INTERNAL_USE, &s->s_flags))
  477. /* Also used internally, don't stop capturing */
  478. s->id = -1;
  479. else
  480. cx18_stop_v4l2_encode_stream(s, gop_end);
  481. }
  482. if (!gop_end) {
  483. clear_bit(CX18_F_S_APPL_IO, &s->s_flags);
  484. clear_bit(CX18_F_S_STREAMOFF, &s->s_flags);
  485. cx18_release_stream(s);
  486. }
  487. }
  488. int cx18_v4l2_close(struct inode *inode, struct file *filp)
  489. {
  490. struct cx18_open_id *id = filp->private_data;
  491. struct cx18 *cx = id->cx;
  492. struct cx18_stream *s = &cx->streams[id->type];
  493. CX18_DEBUG_IOCTL("close() of %s\n", s->name);
  494. v4l2_prio_close(&cx->prio, &id->prio);
  495. /* Easy case first: this stream was never claimed by us */
  496. if (s->id != id->open_id) {
  497. kfree(id);
  498. return 0;
  499. }
  500. /* 'Unclaim' this stream */
  501. /* Stop radio */
  502. mutex_lock(&cx->serialize_lock);
  503. if (id->type == CX18_ENC_STREAM_TYPE_RAD) {
  504. /* Closing radio device, return to TV mode */
  505. cx18_mute(cx);
  506. /* Mark that the radio is no longer in use */
  507. clear_bit(CX18_F_I_RADIO_USER, &cx->i_flags);
  508. /* Switch tuner to TV */
  509. cx18_call_i2c_clients(cx, VIDIOC_S_STD, &cx->std);
  510. /* Select correct audio input (i.e. TV tuner or Line in) */
  511. cx18_audio_set_io(cx);
  512. if (atomic_read(&cx->ana_capturing) > 0) {
  513. /* Undo video mute */
  514. cx18_vapi(cx, CX18_CPU_SET_VIDEO_MUTE, 2, s->handle,
  515. cx->params.video_mute |
  516. (cx->params.video_mute_yuv << 8));
  517. }
  518. /* Done! Unmute and continue. */
  519. cx18_unmute(cx);
  520. cx18_release_stream(s);
  521. } else {
  522. cx18_stop_capture(id, 0);
  523. }
  524. kfree(id);
  525. mutex_unlock(&cx->serialize_lock);
  526. return 0;
  527. }
  528. static int cx18_serialized_open(struct cx18_stream *s, struct file *filp)
  529. {
  530. struct cx18 *cx = s->cx;
  531. struct cx18_open_id *item;
  532. CX18_DEBUG_FILE("open %s\n", s->name);
  533. /* Allocate memory */
  534. item = kmalloc(sizeof(struct cx18_open_id), GFP_KERNEL);
  535. if (NULL == item) {
  536. CX18_DEBUG_WARN("nomem on v4l2 open\n");
  537. return -ENOMEM;
  538. }
  539. item->cx = cx;
  540. item->type = s->type;
  541. v4l2_prio_open(&cx->prio, &item->prio);
  542. item->open_id = cx->open_id++;
  543. filp->private_data = item;
  544. if (item->type == CX18_ENC_STREAM_TYPE_RAD) {
  545. /* Try to claim this stream */
  546. if (cx18_claim_stream(item, item->type)) {
  547. /* No, it's already in use */
  548. kfree(item);
  549. return -EBUSY;
  550. }
  551. if (!test_bit(CX18_F_I_RADIO_USER, &cx->i_flags)) {
  552. if (atomic_read(&cx->ana_capturing) > 0) {
  553. /* switching to radio while capture is
  554. in progress is not polite */
  555. cx18_release_stream(s);
  556. kfree(item);
  557. return -EBUSY;
  558. }
  559. }
  560. /* Mark that the radio is being used. */
  561. set_bit(CX18_F_I_RADIO_USER, &cx->i_flags);
  562. /* We have the radio */
  563. cx18_mute(cx);
  564. /* Switch tuner to radio */
  565. cx18_call_i2c_clients(cx, AUDC_SET_RADIO, NULL);
  566. /* Select the correct audio input (i.e. radio tuner) */
  567. cx18_audio_set_io(cx);
  568. /* Done! Unmute and continue. */
  569. cx18_unmute(cx);
  570. }
  571. return 0;
  572. }
  573. int cx18_v4l2_open(struct inode *inode, struct file *filp)
  574. {
  575. int res, x, y = 0;
  576. struct cx18 *cx = NULL;
  577. struct cx18_stream *s = NULL;
  578. int minor = iminor(inode);
  579. /* Find which card this open was on */
  580. spin_lock(&cx18_cards_lock);
  581. for (x = 0; cx == NULL && x < cx18_cards_active; x++) {
  582. /* find out which stream this open was on */
  583. for (y = 0; y < CX18_MAX_STREAMS; y++) {
  584. if (cx18_cards[x] == NULL)
  585. continue;
  586. s = &cx18_cards[x]->streams[y];
  587. if (s->v4l2dev && s->v4l2dev->minor == minor) {
  588. cx = cx18_cards[x];
  589. break;
  590. }
  591. }
  592. }
  593. spin_unlock(&cx18_cards_lock);
  594. if (cx == NULL) {
  595. /* Couldn't find a device registered
  596. on that minor, shouldn't happen! */
  597. printk(KERN_WARNING "No cx18 device found on minor %d\n",
  598. minor);
  599. return -ENXIO;
  600. }
  601. mutex_lock(&cx->serialize_lock);
  602. if (cx18_init_on_first_open(cx)) {
  603. CX18_ERR("Failed to initialize on minor %d\n", minor);
  604. mutex_unlock(&cx->serialize_lock);
  605. return -ENXIO;
  606. }
  607. res = cx18_serialized_open(s, filp);
  608. mutex_unlock(&cx->serialize_lock);
  609. return res;
  610. }
  611. void cx18_mute(struct cx18 *cx)
  612. {
  613. u32 h;
  614. if (atomic_read(&cx->ana_capturing)) {
  615. h = cx18_find_handle(cx);
  616. if (h != CX18_INVALID_TASK_HANDLE)
  617. cx18_vapi(cx, CX18_CPU_SET_AUDIO_MUTE, 2, h, 1);
  618. else
  619. CX18_ERR("Can't find valid task handle for mute\n");
  620. }
  621. CX18_DEBUG_INFO("Mute\n");
  622. }
  623. void cx18_unmute(struct cx18 *cx)
  624. {
  625. u32 h;
  626. if (atomic_read(&cx->ana_capturing)) {
  627. h = cx18_find_handle(cx);
  628. if (h != CX18_INVALID_TASK_HANDLE) {
  629. cx18_msleep_timeout(100, 0);
  630. cx18_vapi(cx, CX18_CPU_SET_MISC_PARAMETERS, 2, h, 12);
  631. cx18_vapi(cx, CX18_CPU_SET_AUDIO_MUTE, 2, h, 0);
  632. } else
  633. CX18_ERR("Can't find valid task handle for unmute\n");
  634. }
  635. CX18_DEBUG_INFO("Unmute\n");
  636. }