2 * cx18 init/start/stop/exit stream functions
4 * Derived from ivtv-streams.c
6 * Copyright (C) 2007 Hans Verkuil <hverkuil@xs4all.nl>
7 * Copyright (C) 2008 Andy Walls <awalls@radix.net>
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.
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.
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
25 #include "cx18-driver.h"
27 #include "cx18-fileops.h"
28 #include "cx18-mailbox.h"
30 #include "cx18-queue.h"
31 #include "cx18-ioctl.h"
32 #include "cx18-streams.h"
33 #include "cx18-cards.h"
35 #include "cx18-av-core.h"
38 #define CX18_DSP0_INTERRUPT_MASK 0xd0004C
40 static struct v4l2_file_operations cx18_v4l2_enc_fops
= {
42 .read
= cx18_v4l2_read
,
43 .open
= cx18_v4l2_open
,
44 /* FIXME change to video_ioctl2 if serialization lock can be removed */
45 .ioctl
= cx18_v4l2_ioctl
,
46 .release
= cx18_v4l2_close
,
47 .poll
= cx18_v4l2_enc_poll
,
50 /* offset from 0 to register ts v4l2 minors on */
51 #define CX18_V4L2_ENC_TS_OFFSET 16
52 /* offset from 0 to register pcm v4l2 minors on */
53 #define CX18_V4L2_ENC_PCM_OFFSET 24
54 /* offset from 0 to register yuv v4l2 minors on */
55 #define CX18_V4L2_ENC_YUV_OFFSET 32
62 enum v4l2_buf_type buf_type
;
63 } cx18_stream_info
[] = {
64 { /* CX18_ENC_STREAM_TYPE_MPG */
67 PCI_DMA_FROMDEVICE
, V4L2_BUF_TYPE_VIDEO_CAPTURE
,
69 { /* CX18_ENC_STREAM_TYPE_TS */
72 PCI_DMA_FROMDEVICE
, V4L2_BUF_TYPE_VIDEO_CAPTURE
,
74 { /* CX18_ENC_STREAM_TYPE_YUV */
76 VFL_TYPE_GRABBER
, CX18_V4L2_ENC_YUV_OFFSET
,
77 PCI_DMA_FROMDEVICE
, V4L2_BUF_TYPE_VIDEO_CAPTURE
,
79 { /* CX18_ENC_STREAM_TYPE_VBI */
82 PCI_DMA_FROMDEVICE
, V4L2_BUF_TYPE_VBI_CAPTURE
,
84 { /* CX18_ENC_STREAM_TYPE_PCM */
86 VFL_TYPE_GRABBER
, CX18_V4L2_ENC_PCM_OFFSET
,
87 PCI_DMA_FROMDEVICE
, V4L2_BUF_TYPE_PRIVATE
,
89 { /* CX18_ENC_STREAM_TYPE_IDX */
92 PCI_DMA_FROMDEVICE
, V4L2_BUF_TYPE_VIDEO_CAPTURE
,
94 { /* CX18_ENC_STREAM_TYPE_RAD */
97 PCI_DMA_NONE
, V4L2_BUF_TYPE_PRIVATE
,
101 static void cx18_stream_init(struct cx18
*cx
, int type
)
103 struct cx18_stream
*s
= &cx
->streams
[type
];
104 struct video_device
*dev
= s
->v4l2dev
;
106 /* we need to keep v4l2dev, so restore it afterwards */
107 memset(s
, 0, sizeof(*s
));
110 /* initialize cx18_stream fields */
113 s
->name
= cx18_stream_info
[type
].name
;
114 s
->handle
= CX18_INVALID_TASK_HANDLE
;
116 s
->dma
= cx18_stream_info
[type
].dma
;
117 s
->buffers
= cx
->stream_buffers
[type
];
118 s
->buf_size
= cx
->stream_buf_size
[type
];
120 mutex_init(&s
->qlock
);
121 init_waitqueue_head(&s
->waitq
);
123 cx18_queue_init(&s
->q_free
);
124 cx18_queue_init(&s
->q_busy
);
125 cx18_queue_init(&s
->q_full
);
128 static int cx18_prep_dev(struct cx18
*cx
, int type
)
130 struct cx18_stream
*s
= &cx
->streams
[type
];
131 u32 cap
= cx
->v4l2_cap
;
132 int num_offset
= cx18_stream_info
[type
].num_offset
;
133 int num
= cx
->num
+ cx18_first_minor
+ num_offset
;
135 /* These four fields are always initialized. If v4l2dev == NULL, then
136 this stream is not in use. In that case no other fields but these
141 s
->name
= cx18_stream_info
[type
].name
;
143 /* Check whether the radio is supported */
144 if (type
== CX18_ENC_STREAM_TYPE_RAD
&& !(cap
& V4L2_CAP_RADIO
))
147 /* Check whether VBI is supported */
148 if (type
== CX18_ENC_STREAM_TYPE_VBI
&&
149 !(cap
& (V4L2_CAP_VBI_CAPTURE
| V4L2_CAP_SLICED_VBI_CAPTURE
)))
152 /* User explicitly selected 0 buffers for these streams, so don't
154 if (cx18_stream_info
[type
].dma
!= PCI_DMA_NONE
&&
155 cx
->stream_buffers
[type
] == 0) {
156 CX18_INFO("Disabled %s device\n", cx18_stream_info
[type
].name
);
160 cx18_stream_init(cx
, type
);
162 if (num_offset
== -1)
165 /* allocate and initialize the v4l2 video device structure */
166 s
->v4l2dev
= video_device_alloc();
167 if (s
->v4l2dev
== NULL
) {
168 CX18_ERR("Couldn't allocate v4l2 video_device for %s\n",
173 snprintf(s
->v4l2dev
->name
, sizeof(s
->v4l2dev
->name
), "cx18-%d",
176 s
->v4l2dev
->num
= num
;
177 s
->v4l2dev
->parent
= &cx
->dev
->dev
;
178 s
->v4l2dev
->fops
= &cx18_v4l2_enc_fops
;
179 s
->v4l2dev
->release
= video_device_release
;
180 s
->v4l2dev
->tvnorms
= V4L2_STD_ALL
;
181 cx18_set_funcs(s
->v4l2dev
);
185 /* Initialize v4l2 variables and register v4l2 devices */
186 int cx18_streams_setup(struct cx18
*cx
)
190 /* Setup V4L2 Devices */
191 for (type
= 0; type
< CX18_MAX_STREAMS
; type
++) {
193 ret
= cx18_prep_dev(cx
, type
);
197 /* Allocate Stream */
198 ret
= cx18_stream_alloc(&cx
->streams
[type
]);
202 if (type
== CX18_MAX_STREAMS
)
205 /* One or more streams could not be initialized. Clean 'em all up. */
206 cx18_streams_cleanup(cx
, 0);
210 static int cx18_reg_dev(struct cx18
*cx
, int type
)
212 struct cx18_stream
*s
= &cx
->streams
[type
];
213 int vfl_type
= cx18_stream_info
[type
].vfl_type
;
216 /* TODO: Shouldn't this be a VFL_TYPE_TRANSPORT or something?
217 * We need a VFL_TYPE_TS defined.
219 if (strcmp("TS", s
->name
) == 0) {
220 /* just return if no DVB is supported */
221 if ((cx
->card
->hw_all
& CX18_HW_DVB
) == 0)
223 ret
= cx18_dvb_register(s
);
225 CX18_ERR("DVB failed to register\n");
230 if (s
->v4l2dev
== NULL
)
233 num
= s
->v4l2dev
->num
;
234 /* card number + user defined offset + device offset */
235 if (type
!= CX18_ENC_STREAM_TYPE_MPG
) {
236 struct cx18_stream
*s_mpg
= &cx
->streams
[CX18_ENC_STREAM_TYPE_MPG
];
239 num
= s_mpg
->v4l2dev
->num
+ cx18_stream_info
[type
].num_offset
;
242 /* Register device. First try the desired minor, then any free one. */
243 ret
= video_register_device(s
->v4l2dev
, vfl_type
, num
);
245 CX18_ERR("Couldn't register v4l2 device for %s kernel number %d\n",
247 video_device_release(s
->v4l2dev
);
251 num
= s
->v4l2dev
->num
;
254 case VFL_TYPE_GRABBER
:
255 CX18_INFO("Registered device video%d for %s (%d x %d kB)\n",
256 num
, s
->name
, cx
->stream_buffers
[type
],
257 cx
->stream_buf_size
[type
]/1024);
261 CX18_INFO("Registered device radio%d for %s\n",
266 if (cx
->stream_buffers
[type
])
267 CX18_INFO("Registered device vbi%d for %s "
269 num
, s
->name
, cx
->stream_buffers
[type
],
270 cx
->stream_buf_size
[type
]);
272 CX18_INFO("Registered device vbi%d for %s\n",
280 /* Register v4l2 devices */
281 int cx18_streams_register(struct cx18
*cx
)
287 /* Register V4L2 devices */
288 for (type
= 0; type
< CX18_MAX_STREAMS
; type
++) {
289 err
= cx18_reg_dev(cx
, type
);
297 /* One or more streams could not be initialized. Clean 'em all up. */
298 cx18_streams_cleanup(cx
, 1);
302 /* Unregister v4l2 devices */
303 void cx18_streams_cleanup(struct cx18
*cx
, int unregister
)
305 struct video_device
*vdev
;
308 /* Teardown all streams */
309 for (type
= 0; type
< CX18_MAX_STREAMS
; type
++) {
310 if (cx
->streams
[type
].dvb
.enabled
) {
311 cx18_dvb_unregister(&cx
->streams
[type
]);
312 cx
->streams
[type
].dvb
.enabled
= false;
315 vdev
= cx
->streams
[type
].v4l2dev
;
317 cx
->streams
[type
].v4l2dev
= NULL
;
321 cx18_stream_free(&cx
->streams
[type
]);
323 /* Unregister or release device */
325 video_unregister_device(vdev
);
327 video_device_release(vdev
);
331 static void cx18_vbi_setup(struct cx18_stream
*s
)
333 struct cx18
*cx
= s
->cx
;
334 int raw
= cx18_raw_vbi(cx
);
335 u32 data
[CX2341X_MBOX_MAX_DATA
];
340 cx
->vbi
.start
[0] = 10;
341 cx
->vbi
.start
[1] = 273;
342 } else { /* PAL/SECAM */
344 cx
->vbi
.start
[0] = 6;
345 cx
->vbi
.start
[1] = 318;
348 /* setup VBI registers */
349 cx18_av_cmd(cx
, VIDIOC_S_FMT
, &cx
->vbi
.in
);
351 /* determine number of lines and total number of VBI bytes.
352 A raw line takes 1444 bytes: 4 byte SAV code + 2 * 720
353 A sliced line takes 51 bytes: 4 byte frame header, 4 byte internal
354 header, 42 data bytes + checksum (to be confirmed) */
356 lines
= cx
->vbi
.count
* 2;
358 lines
= cx
->is_60hz
? 24 : 38;
363 cx
->vbi
.enc_size
= lines
*
364 (raw
? cx
->vbi
.raw_size
: cx
->vbi
.sliced_size
);
367 /* Lines per field */
368 data
[1] = (lines
/ 2) | ((lines
/ 2) << 16);
370 data
[2] = (raw
? cx
->vbi
.raw_decoder_line_size
371 : cx
->vbi
.sliced_decoder_line_size
);
372 /* Every X number of frames a VBI interrupt arrives
373 (frames as in 25 or 30 fps) */
375 /* Setup VBI for the cx25840 digitizer */
377 data
[4] = 0x20602060;
378 data
[5] = 0x307090d0;
380 data
[4] = 0xB0F0B0F0;
381 data
[5] = 0xA0E0A0E0;
384 CX18_DEBUG_INFO("Setup VBI h: %d lines %x bpl %d fr %d %x %x\n",
385 data
[0], data
[1], data
[2], data
[3], data
[4], data
[5]);
387 if (s
->type
== CX18_ENC_STREAM_TYPE_VBI
)
388 cx18_api(cx
, CX18_CPU_SET_RAW_VBI_PARAM
, 6, data
);
391 struct cx18_queue
*cx18_stream_put_buf_fw(struct cx18_stream
*s
,
392 struct cx18_buffer
*buf
)
394 struct cx18
*cx
= s
->cx
;
395 struct cx18_queue
*q
;
397 /* Don't give it to the firmware, if we're not running a capture */
398 if (s
->handle
== CX18_INVALID_TASK_HANDLE
||
399 !test_bit(CX18_F_S_STREAMING
, &s
->s_flags
))
400 return cx18_enqueue(s
, buf
, &s
->q_free
);
402 q
= cx18_enqueue(s
, buf
, &s
->q_busy
);
404 return q
; /* The firmware has the max buffers it can handle */
406 cx18_buf_sync_for_device(s
, buf
);
407 cx18_vapi(cx
, CX18_CPU_DE_SET_MDL
, 5, s
->handle
,
408 (void __iomem
*) &cx
->scb
->cpu_mdl
[buf
->id
] - cx
->enc_mem
,
409 1, buf
->id
, s
->buf_size
);
413 void cx18_stream_load_fw_queue(struct cx18_stream
*s
)
415 struct cx18_queue
*q
;
416 struct cx18_buffer
*buf
;
418 if (atomic_read(&s
->q_free
.buffers
) == 0 ||
419 atomic_read(&s
->q_busy
.buffers
) >= CX18_MAX_FW_MDLS_PER_STREAM
)
422 /* Move from q_free to q_busy notifying the firmware, until the limit */
424 buf
= cx18_dequeue(s
, &s
->q_free
);
427 q
= cx18_stream_put_buf_fw(s
, buf
);
428 } while (atomic_read(&s
->q_busy
.buffers
) < CX18_MAX_FW_MDLS_PER_STREAM
432 int cx18_start_v4l2_encode_stream(struct cx18_stream
*s
)
434 u32 data
[MAX_MB_ARGUMENTS
];
435 struct cx18
*cx
= s
->cx
;
436 struct cx18_buffer
*buf
;
440 if (s
->v4l2dev
== NULL
&& s
->dvb
.enabled
== 0)
443 CX18_DEBUG_INFO("Start encoder stream %s\n", s
->name
);
446 case CX18_ENC_STREAM_TYPE_MPG
:
447 captype
= CAPTURE_CHANNEL_TYPE_MPEG
;
448 cx
->mpg_data_received
= cx
->vbi_data_inserted
= 0;
449 cx
->dualwatch_jiffies
= jiffies
;
450 cx
->dualwatch_stereo_mode
= cx
->params
.audio_properties
& 0x300;
451 cx
->search_pack_header
= 0;
454 case CX18_ENC_STREAM_TYPE_TS
:
455 captype
= CAPTURE_CHANNEL_TYPE_TS
;
458 case CX18_ENC_STREAM_TYPE_YUV
:
459 captype
= CAPTURE_CHANNEL_TYPE_YUV
;
461 case CX18_ENC_STREAM_TYPE_PCM
:
462 captype
= CAPTURE_CHANNEL_TYPE_PCM
;
464 case CX18_ENC_STREAM_TYPE_VBI
:
465 captype
= cx18_raw_vbi(cx
) ?
466 CAPTURE_CHANNEL_TYPE_VBI
: CAPTURE_CHANNEL_TYPE_SLICED_VBI
;
468 cx
->vbi
.inserted_frame
= 0;
469 memset(cx
->vbi
.sliced_mpeg_size
,
470 0, sizeof(cx
->vbi
.sliced_mpeg_size
));
476 /* mute/unmute video */
477 cx18_vapi(cx
, CX18_CPU_SET_VIDEO_MUTE
, 2,
478 s
->handle
, !!test_bit(CX18_F_I_RADIO_USER
, &cx
->i_flags
));
480 /* Clear Streamoff flags in case left from last capture */
481 clear_bit(CX18_F_S_STREAMOFF
, &s
->s_flags
);
483 cx18_vapi_result(cx
, data
, CX18_CREATE_TASK
, 1, CPU_CMD_MASK_CAPTURE
);
485 cx18_vapi(cx
, CX18_CPU_SET_CHANNEL_TYPE
, 2, s
->handle
, captype
);
487 if (atomic_read(&cx
->ana_capturing
) == 0 && !ts
) {
488 struct cx18_api_func_private priv
;
490 /* Stuff from Windows, we don't know what it is */
491 cx18_vapi(cx
, CX18_CPU_SET_VER_CROP_LINE
, 2, s
->handle
, 0);
492 cx18_vapi(cx
, CX18_CPU_SET_MISC_PARAMETERS
, 3, s
->handle
, 3, 1);
493 cx18_vapi(cx
, CX18_CPU_SET_MISC_PARAMETERS
, 3, s
->handle
, 8, 0);
494 cx18_vapi(cx
, CX18_CPU_SET_MISC_PARAMETERS
, 3, s
->handle
, 4, 1);
495 cx18_vapi(cx
, CX18_CPU_SET_MISC_PARAMETERS
, 2, s
->handle
, 12);
497 cx18_vapi(cx
, CX18_CPU_SET_CAPTURE_LINE_NO
, 3,
498 s
->handle
, cx
->digitizer
, cx
->digitizer
);
501 if (cx
->v4l2_cap
& V4L2_CAP_VBI_CAPTURE
)
504 /* assign program index info.
505 Mask 7: select I/P/B, Num_req: 400 max */
506 cx18_vapi_result(cx
, data
, CX18_CPU_SET_INDEXTABLE
, 1, 0);
508 /* Setup API for Stream */
511 cx2341x_update(&priv
, cx18_api_func
, NULL
, &cx
->params
);
514 if (atomic_read(&cx
->tot_capturing
) == 0) {
515 clear_bit(CX18_F_I_EOS
, &cx
->i_flags
);
516 cx18_write_reg(cx
, 7, CX18_DSP0_INTERRUPT_MASK
);
519 cx18_vapi(cx
, CX18_CPU_DE_SET_MDL_ACK
, 3, s
->handle
,
520 (void __iomem
*)&cx
->scb
->cpu_mdl_ack
[s
->type
][0] - cx
->enc_mem
,
521 (void __iomem
*)&cx
->scb
->cpu_mdl_ack
[s
->type
][1] - cx
->enc_mem
);
523 /* Init all the cpu_mdls for this stream */
524 cx18_flush_queues(s
);
525 mutex_lock(&s
->qlock
);
526 list_for_each_entry(buf
, &s
->q_free
.list
, list
) {
527 cx18_writel(cx
, buf
->dma_handle
,
528 &cx
->scb
->cpu_mdl
[buf
->id
].paddr
);
529 cx18_writel(cx
, s
->buf_size
, &cx
->scb
->cpu_mdl
[buf
->id
].length
);
531 mutex_unlock(&s
->qlock
);
532 cx18_stream_load_fw_queue(s
);
535 if (cx18_vapi(cx
, CX18_CPU_CAPTURE_START
, 1, s
->handle
)) {
536 CX18_DEBUG_WARN("Error starting capture!\n");
537 /* Ensure we're really not capturing before releasing MDLs */
538 if (s
->type
== CX18_ENC_STREAM_TYPE_MPG
)
539 cx18_vapi(cx
, CX18_CPU_CAPTURE_STOP
, 2, s
->handle
, 1);
541 cx18_vapi(cx
, CX18_CPU_CAPTURE_STOP
, 1, s
->handle
);
542 clear_bit(CX18_F_S_STREAMING
, &s
->s_flags
);
543 /* FIXME - CX18_F_S_STREAMOFF as well? */
544 cx18_vapi(cx
, CX18_CPU_DE_RELEASE_MDL
, 1, s
->handle
);
545 cx18_vapi(cx
, CX18_DESTROY_TASK
, 1, s
->handle
);
546 s
->handle
= CX18_INVALID_TASK_HANDLE
;
547 if (atomic_read(&cx
->tot_capturing
) == 0) {
548 set_bit(CX18_F_I_EOS
, &cx
->i_flags
);
549 cx18_write_reg(cx
, 5, CX18_DSP0_INTERRUPT_MASK
);
554 /* you're live! sit back and await interrupts :) */
556 atomic_inc(&cx
->ana_capturing
);
557 atomic_inc(&cx
->tot_capturing
);
561 void cx18_stop_all_captures(struct cx18
*cx
)
565 for (i
= CX18_MAX_STREAMS
- 1; i
>= 0; i
--) {
566 struct cx18_stream
*s
= &cx
->streams
[i
];
568 if (s
->v4l2dev
== NULL
&& s
->dvb
.enabled
== 0)
570 if (test_bit(CX18_F_S_STREAMING
, &s
->s_flags
))
571 cx18_stop_v4l2_encode_stream(s
, 0);
575 int cx18_stop_v4l2_encode_stream(struct cx18_stream
*s
, int gop_end
)
577 struct cx18
*cx
= s
->cx
;
580 if (s
->v4l2dev
== NULL
&& s
->dvb
.enabled
== 0)
583 /* This function assumes that you are allowed to stop the capture
584 and that we are actually capturing */
586 CX18_DEBUG_INFO("Stop Capture\n");
588 if (atomic_read(&cx
->tot_capturing
) == 0)
591 if (s
->type
== CX18_ENC_STREAM_TYPE_MPG
)
592 cx18_vapi(cx
, CX18_CPU_CAPTURE_STOP
, 2, s
->handle
, !gop_end
);
594 cx18_vapi(cx
, CX18_CPU_CAPTURE_STOP
, 1, s
->handle
);
598 if (s
->type
== CX18_ENC_STREAM_TYPE_MPG
&& gop_end
) {
599 CX18_INFO("ignoring gop_end: not (yet?) supported by the firmware\n");
602 if (s
->type
!= CX18_ENC_STREAM_TYPE_TS
)
603 atomic_dec(&cx
->ana_capturing
);
604 atomic_dec(&cx
->tot_capturing
);
606 /* Clear capture and no-read bits */
607 clear_bit(CX18_F_S_STREAMING
, &s
->s_flags
);
609 /* Tell the CX23418 it can't use our buffers anymore */
610 cx18_vapi(cx
, CX18_CPU_DE_RELEASE_MDL
, 1, s
->handle
);
612 cx18_vapi(cx
, CX18_DESTROY_TASK
, 1, s
->handle
);
613 s
->handle
= CX18_INVALID_TASK_HANDLE
;
615 if (atomic_read(&cx
->tot_capturing
) > 0)
618 cx18_write_reg(cx
, 5, CX18_DSP0_INTERRUPT_MASK
);
624 u32
cx18_find_handle(struct cx18
*cx
)
628 /* find first available handle to be used for global settings */
629 for (i
= 0; i
< CX18_MAX_STREAMS
; i
++) {
630 struct cx18_stream
*s
= &cx
->streams
[i
];
632 if (s
->v4l2dev
&& (s
->handle
!= CX18_INVALID_TASK_HANDLE
))
635 return CX18_INVALID_TASK_HANDLE
;
638 struct cx18_stream
*cx18_handle_to_stream(struct cx18
*cx
, u32 handle
)
641 struct cx18_stream
*s
;
643 if (handle
== CX18_INVALID_TASK_HANDLE
)
646 for (i
= 0; i
< CX18_MAX_STREAMS
; i
++) {
648 if (s
->handle
!= handle
)
650 if (s
->v4l2dev
|| s
->dvb
.enabled
)