?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
manpage: Remove "MPlayer only" notes
[mplayer/glamo.git] / stream / tvi_v4l.c
blobbbf290eeaf0bc916e87f9479bfe7873a4a2e954d
1 /*
2 * Video 4 Linux input
3 *
4 * Copyright (C) 2001 Alex Beregszaszi
5 *
6 * Some ideas are based on xawtv/libng's grab-v4l.c written by
7 * Gerd Knorr <kraxel@bytesex.org>
8 *
9 * Multithreading, a/v sync and native ALSA support by
10 * Jindrich Makovicka <makovick@gmail.com>
11 *
12 * MJPEG hardware encoding support by
13 * Ivan Szanto <szivan@freemail.hu>
14 *
15 * CODE IS UNDER DEVELOPMENT, NO FEATURE REQUESTS PLEASE!
16 *
17 * This file is part of MPlayer.
18 *
19 * MPlayer is free software; you can redistribute it and/or modify
20 * it under the terms of the GNU General Public License as published by
21 * the Free Software Foundation; either version 2 of the License, or
22 * (at your option) any later version.
23 *
24 * MPlayer is distributed in the hope that it will be useful,
25 * but WITHOUT ANY WARRANTY; without even the implied warranty of
26 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
27 * GNU General Public License for more details.
28 *
29 * You should have received a copy of the GNU General Public License along
30 * with MPlayer; if not, write to the Free Software Foundation, Inc.,
31 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
32 */
33
34 #include "config.h"
35
36 #include <stdio.h>
37 #include <errno.h>
38 #include <fcntl.h>
39 #include <sys/ioctl.h>
40 #include <sys/types.h>
41 #include <sys/time.h>
42
43 /* Necessary to prevent collisions between <linux/time.h> and <sys/time.h> when V4L2 is installed. */
44 #define _LINUX_TIME_H
45
46 #include <linux/videodev.h>
47 #include <unistd.h>
48 #include <sys/mman.h>
49 #include <stdlib.h>
50 #include <string.h>
51 #include <pthread.h>
52 #ifdef HAVE_SYS_SYSINFO_H
53 #include <sys/sysinfo.h>
54 #endif
55
56 #include "mp_msg.h"
57 #include "libaf/af_format.h"
58 #include "libmpcodecs/img_format.h"
59 #include "libmpcodecs/dec_teletext.h"
60 #include "libvo/fastmemcpy.h"
61 #include "libvo/videodev_mjpeg.h"
62
63 #include "tv.h"
64
65 #include "audio_in.h"
66
67 static tvi_handle_t *tvi_init_v4l(tv_param_t* tv_param);
68
69 const tvi_info_t tvi_info_v4l = {
70 tvi_init_v4l,
71 "Video 4 Linux input",
72 "v4l",
73 "Alex Beregszaszi",
74 "under development"
75 };
76
77 #define PAL_WIDTH 768
78 #define PAL_HEIGHT 576
79 #define PAL_FPS 25
80
81 #define NTSC_WIDTH 640
82 #define NTSC_HEIGHT 480
83 #define NTSC_FPS (30000.0/1001.0)
84
85 #define MAX_AUDIO_CHANNELS 10
86
87 #define VID_BUF_SIZE_IMMEDIATE 2
88 #define VIDEO_AVG_BUFFER_SIZE 600
89
90 typedef struct priv {
91 /* general */
92 char *video_device;
93 int video_fd;
94 struct video_capability capability;
95 struct video_channel *channels;
96 int act_channel;
97 struct video_tuner tuner;
98
99 /* video */
100 struct video_picture picture;
101 int format; /* output format */
102 int width;
103 int height;
104 int bytesperline;
105 float fps;
106
107 struct video_mbuf mbuf;
108 unsigned char *mmap;
109 struct video_mmap *buf;
110 int nbuf;
111
112 /* audio */
113 char *audio_device;
114 audio_in_t audio_in;
115
116 int audio_id;
117 struct video_audio audio[MAX_AUDIO_CHANNELS];
118 int audio_channels[MAX_AUDIO_CHANNELS];
119
120 /* buffering stuff */
121 int immediate_mode;
122
123 int audio_buffer_size;
124 int aud_skew_cnt;
125 unsigned char *audio_ringbuffer;
126 long long *audio_skew_buffer;
127 volatile int audio_head;
128 volatile int audio_tail;
129 volatile int audio_cnt;
130 volatile long long audio_skew;
131 volatile double audio_skew_factor;
132 volatile long long audio_skew_measure_time;
133 volatile int audio_drop;
134
135 int first;
136 int video_buffer_size_max;
137 volatile int video_buffer_size_current;
138 unsigned char **video_ringbuffer;
139 long long *video_timebuffer;
140 long long *video_avg_buffer;
141 int video_avg_ptr;
142 int video_interval_sum;
143 volatile int video_head;
144 volatile int video_tail;
145 volatile int video_cnt;
146
147 volatile int shutdown;
148
149 pthread_t audio_grabber_thread;
150 pthread_t video_grabber_thread;
151 pthread_mutex_t audio_starter;
152 pthread_mutex_t skew_mutex;
153 pthread_mutex_t video_buffer_mutex;
154
155 long long starttime;
156 double audio_secs_per_block;
157 long long audio_skew_total;
158 long audio_recv_blocks_total;
159 long audio_sent_blocks_total;
160 long mjpeg_bufsize;
161 char *vbi_dev;
162 int vbi_fd;
163 int vbi_bufsize;
164 int vbi_shutdown;
165 pthread_t vbi_grabber_thread;
166 void *priv_vbi;
167
168 tv_param_t *tv_param;
169 } priv_t;
170
171 #include "tvi_def.h"
172
173 static const char *device_cap2name[] = {
174 "capture", "tuner", "teletext", "overlay", "chromakey", "clipping",
175 "frameram", "scales", "monochrome", "subcapture", "mpeg-decoder",
176 "mpeg-encoder", "mjpeg-decoder", "mjpeg-encoder", NULL
177 };
178
179 static const char *device_palette2name[] = {
180 "-", "grey", "hi240", "rgb16", "rgb24", "rgb32", "rgb15", "yuv422",
181 "yuyv", "uyvy", "yuv420", "yuv411", "raw", "yuv422p", "yuv411p",
182 "yuv420p", "yuv410p"
183 };
184 #define PALETTE(x) ((x < sizeof(device_palette2name)/sizeof(char*)) ? device_palette2name[x] : "UNKNOWN")
185
186 static const struct {
187 char* name;
188 int normid;
189 int tuner_flags;
190 int tuner_mode;
191 int input_norm;
192 float fps;
193 } supported_norms[]={
194 {"pal", TV_NORM_PAL, VIDEO_TUNER_PAL, VIDEO_MODE_PAL, VIDEO_MODE_PAL, PAL_FPS },
195 {"ntsc", TV_NORM_NTSC, VIDEO_TUNER_NTSC, VIDEO_MODE_NTSC, VIDEO_MODE_NTSC, NTSC_FPS},
196 {"secam", TV_NORM_SECAM, VIDEO_TUNER_SECAM, VIDEO_MODE_SECAM,VIDEO_MODE_SECAM,PAL_FPS },
197 {"palnc", TV_NORM_PALNC, VIDEO_TUNER_PAL, VIDEO_MODE_PAL, 3, PAL_FPS },
198 {"palm", TV_NORM_PALM, VIDEO_TUNER_NTSC, VIDEO_MODE_NTSC, 4, NTSC_FPS},
199 {"paln", TV_NORM_PALN, VIDEO_TUNER_PAL, VIDEO_MODE_PAL, 5, PAL_FPS },
200 {"ntscjp",TV_NORM_NTSCJP, VIDEO_TUNER_NTSC, VIDEO_MODE_NTSC, 6, NTSC_FPS},
201 {"auto", -1, -1, -1, VIDEO_MODE_AUTO, -1 },
202 {NULL, -1, -1, -1, -1 }
203 };
204
205 static const char *norm2name(int mode)
206 {
207 int i;
208 for(i=0;supported_norms[i].name; i++)
209 if(supported_norms[i].input_norm==mode)
210 return supported_norms[i].name;
211 return "unknown";
212 };
213
214 static const char *audio_mode2name(int mode)
215 {
216 switch (mode) {
217 case VIDEO_SOUND_MONO:
218 return "mono";
219 case VIDEO_SOUND_STEREO:
220 return "stereo";
221 case VIDEO_SOUND_LANG1:
222 return "language1";
223 case VIDEO_SOUND_LANG2:
224 return "language2";
225 default:
226 return "unknown";
227 }
228 };
229
230 static void *audio_grabber(void *data);
231 static void *video_grabber(void *data);
232
233 static int palette2depth(int palette)
234 {
235 switch(palette)
236 {
237 /* component */
238 case VIDEO_PALETTE_RGB555:
239 return 15;
240 case VIDEO_PALETTE_RGB565:
241 return 16;
242 case VIDEO_PALETTE_RGB24:
243 return 24;
244 case VIDEO_PALETTE_RGB32:
245 return 32;
246 /* planar */
247 case VIDEO_PALETTE_YUV411P:
248 case VIDEO_PALETTE_YUV420P:
249 case VIDEO_PALETTE_YUV410P:
250 return 12;
251 /* packed */
252 case VIDEO_PALETTE_YUV422P:
253 case VIDEO_PALETTE_YUV422:
254 case VIDEO_PALETTE_YUYV:
255 case VIDEO_PALETTE_UYVY:
256 case VIDEO_PALETTE_YUV420:
257 case VIDEO_PALETTE_YUV411:
258 return 16;
259 }
260 return -1;
261 }
262
263 static int format2palette(int format)
264 {
265 switch(format)
266 {
267 case IMGFMT_BGR15:
268 return VIDEO_PALETTE_RGB555;
269 case IMGFMT_BGR16:
270 return VIDEO_PALETTE_RGB565;
271 case IMGFMT_BGR24:
272 return VIDEO_PALETTE_RGB24;
273 case IMGFMT_BGR32:
274 return VIDEO_PALETTE_RGB32;
275 case IMGFMT_YV12:
276 case IMGFMT_I420:
277 return VIDEO_PALETTE_YUV420P;
278 case IMGFMT_YUY2:
279 return VIDEO_PALETTE_YUV422;
280 case IMGFMT_UYVY:
281 return VIDEO_PALETTE_UYVY;
282 }
283 return -1;
284 }
285
286 // sets and sanitizes audio buffer/block sizes
287 static void setup_audio_buffer_sizes(priv_t *priv)
288 {
289 int bytes_per_sample = priv->audio_in.bytes_per_sample;
290
291 // make the audio buffer at least 5 seconds long
292 priv->audio_buffer_size = 1 + 5*priv->audio_in.samplerate
293 *priv->audio_in.channels
294 *bytes_per_sample/priv->audio_in.blocksize;
295 if (priv->audio_buffer_size < 256) priv->audio_buffer_size = 256;
296
297 // make the skew buffer at least 1 second long
298 priv->aud_skew_cnt = 1 + 1*priv->audio_in.samplerate
299 *priv->audio_in.channels
300 *bytes_per_sample/priv->audio_in.blocksize;
301 if (priv->aud_skew_cnt < 16) priv->aud_skew_cnt = 16;
302
303 mp_msg(MSGT_TV, MSGL_V, "Audio capture - buffer %d blocks of %d bytes, skew average from %d meas.\n",
304 priv->audio_buffer_size, priv->audio_in.blocksize, priv->aud_skew_cnt);
305 }
306
307 static tvi_handle_t *tvi_init_v4l(tv_param_t* tv_param)
308 {
309 tvi_handle_t *h;
310 priv_t *priv;
311
312 h = tv_new_handle(sizeof(priv_t), &functions);
313 if (!h)
314 return NULL;
315
316 priv = h->priv;
317
318 /* set video device name */
319 if (!tv_param->device)
320 priv->video_device = strdup("/dev/video0");
321 else
322 priv->video_device = strdup(tv_param->device);
323
324 /* set video device name */
325 if (!tv_param->adevice)
326 priv->audio_device = NULL;
327 else {
328 priv->audio_device = strdup(tv_param->adevice);
329 }
330
331 /* allocation failed */
332 if (!priv->video_device) {
333 tv_free_handle(h);
334 return NULL;
335 }
336
337 priv->tv_param=tv_param;
338 return h;
339 }
340
341 /* retrieves info about audio channels from the BTTV */
342 static void init_v4l_audio(priv_t *priv)
343 {
344 int i;
345 int reqmode;
346
347 if (!priv->capability.audios) return;
348
349 /* audio chanlist */
350
351 mp_msg(MSGT_TV, MSGL_V, " Audio devices: %d\n", priv->capability.audios);
352
353 mp_msg(MSGT_TV, MSGL_V, "Video capture card reports the audio setup as follows:\n");
354 for (i = 0; i < priv->capability.audios; i++)
355 {
356 if (i >= MAX_AUDIO_CHANNELS)
357 {
358 mp_msg(MSGT_TV, MSGL_ERR, "no space for more audio channels (increase in source!) (%d > %d)\n",
359 i, MAX_AUDIO_CHANNELS);
360 i = priv->capability.audios;
361 break;
362 }
363
364 priv->audio[i].audio = i;
365 if (ioctl(priv->video_fd, VIDIOCGAUDIO, &priv->audio[i]) == -1)
366 {
367 mp_msg(MSGT_TV, MSGL_ERR, "ioctl get audio failed: %s\n", strerror(errno));
368 break;
369 }
370
371 /* mute all channels */
372 priv->audio[i].flags |= VIDEO_AUDIO_MUTE;
373 reqmode = -1;
374 if (priv->tv_param->amode >= 0) {
375 switch (priv->tv_param->amode) {
376 case 0:
377 reqmode = VIDEO_SOUND_MONO;
378 break;
379 case 1:
380 reqmode = VIDEO_SOUND_STEREO;
381 break;
382 case 2:
383 reqmode = VIDEO_SOUND_LANG1;
384 break;
385 case 3:
386 reqmode = VIDEO_SOUND_LANG2;
387 break;
388 default:
389 mp_msg(MSGT_TV, MSGL_ERR, "Unknown audio mode requested.\n");
390 break;
391 }
392 if (reqmode >= 0) priv->audio[i].mode = reqmode;
393 }
394 ioctl(priv->video_fd, VIDIOCSAUDIO, &priv->audio[i]);
395
396 // get the parameters back
397 if (ioctl(priv->video_fd, VIDIOCGAUDIO, &priv->audio[i]) == -1)
398 {
399 mp_msg(MSGT_TV, MSGL_ERR, "ioctl get audio failed: %s\n", strerror(errno));
400 break;
401 }
402
403 switch(priv->audio[i].mode)
404 {
405 case VIDEO_SOUND_MONO:
406 case VIDEO_SOUND_LANG1:
407 case VIDEO_SOUND_LANG2:
408 priv->audio_channels[i] = 1;
409 break;
410 case VIDEO_SOUND_STEREO:
411 priv->audio_channels[i] = 2;
412 break;
413 default:
414 mp_msg(MSGT_TV, MSGL_ERR, "Card reports an unknown audio mode !\n");
415 mp_msg(MSGT_TV, MSGL_ERR, "Trying two channel audio. Use forcechan to override.\n");
416 priv->audio_channels[i] = 2;
417 break;
418 }
419
420 if (reqmode >= 0 && priv->audio[i].mode != reqmode) {
421 mp_msg(MSGT_TV, MSGL_ERR, "Audio mode setup warning!\n");
422 mp_msg(MSGT_TV, MSGL_ERR, "Requested mode was %s, but v4l still reports %s.\n",
423 audio_mode2name(reqmode), audio_mode2name(priv->audio[i].mode));
424 mp_msg(MSGT_TV, MSGL_ERR, "You may need \"forcechan\" option to force stereo/mono audio recording.\n");
425 }
426
427 /* display stuff */
428 mp_msg(MSGT_TV, MSGL_V, " %d: %s: ", priv->audio[i].audio,
429 priv->audio[i].name);
430 if (priv->audio[i].flags & VIDEO_AUDIO_MUTABLE) {
431 mp_msg(MSGT_TV, MSGL_V, "muted=%s ",
432 (priv->audio[i].flags & VIDEO_AUDIO_MUTE) ? "yes" : "no");
433 }
434 mp_msg(MSGT_TV, MSGL_V, "vol=%d bass=%d treble=%d balance=%d mode=%s",
435 priv->audio[i].volume, priv->audio[i].bass, priv->audio[i].treble,
436 priv->audio[i].balance, audio_mode2name(priv->audio[i].mode));
437 mp_msg(MSGT_TV, MSGL_V, " chan=%d\n", priv->audio_channels[i]);
438
439 if (priv->tv_param->forcechan >= 0)
440 priv->audio_channels[i] = priv->tv_param->forcechan;
441
442 // we'll call VIDIOCSAUDIO again when starting capture
443 // let's set audio mode to requested mode again for the case
444 // when VIDIOCGAUDIO just cannot report the mode correctly
445 if (reqmode >= 0) priv->audio[i].mode = reqmode;
446 }
447 }
448
449 #if !defined(__LINUX_VIDEODEV2_H) && !defined(VIDIOC_QUERYCAP)
450 struct v4l2_capability
451 {
452 __u8 driver[16]; /* i.e. "bttv" */
453 __u8 card[32]; /* i.e. "Hauppauge WinTV" */
454 __u8 bus_info[32]; /* "PCI:" + pci_dev->slot_name */
455 __u32 version; /* should use KERNEL_VERSION() */
456 __u32 capabilities; /* Device capabilities */
457 __u32 reserved[4];
458 };
459
460 #define VIDIOC_QUERYCAP _IOR ('V', 0, struct v4l2_capability)
461 #endif
462
463 static int init(priv_t *priv)
464 {
465 int i;
466
467 if (priv->tv_param->immediate == 1)
468 priv->tv_param->noaudio = 1;
469
470 priv->video_ringbuffer = NULL;
471 priv->video_timebuffer = NULL;
472 priv->video_avg_buffer = NULL;
473 priv->audio_ringbuffer = NULL;
474 priv->audio_skew_buffer = NULL;
475
476 priv->video_fd = open(priv->video_device, O_RDWR);
477 mp_msg(MSGT_TV, MSGL_DBG2, "Video fd: %d, %p\n", priv->video_fd,
478 priv->video_device);
479 if (priv->video_fd == -1)
480 {
481 mp_msg(MSGT_TV, MSGL_ERR, "unable to open '%s': %s\n",
482 priv->video_device, strerror(errno));
483 goto err;
484 }
485
486 /* check for v4l2 */
487 if (ioctl(priv->video_fd, VIDIOC_QUERYCAP, &priv->capability) == 0) {
488 mp_msg(MSGT_TV, MSGL_ERR, "=================================================================\n");
489 mp_msg(MSGT_TV, MSGL_ERR, " WARNING: YOU ARE USING V4L DEMUXER WITH V4L2 DRIVERS!!!\n");
490 mp_msg(MSGT_TV, MSGL_ERR, " As the V4L1 compatibility layer is broken, this may not work.\n");
491 mp_msg(MSGT_TV, MSGL_ERR, " If you encounter any problems, use driver=v4l2 instead.\n");
492 mp_msg(MSGT_TV, MSGL_ERR, " Bugreports on driver=v4l with v4l2 drivers will be ignored.\n");
493 mp_msg(MSGT_TV, MSGL_ERR, "=================================================================\n");
494 }
495
496 /* get capabilities (priv->capability is needed!) */
497 if (ioctl(priv->video_fd, VIDIOCGCAP, &priv->capability) == -1)
498 {
499 mp_msg(MSGT_TV, MSGL_ERR, "ioctl get capabilities failed: %s\n", strerror(errno));
500 goto err;
501 }
502
503 fcntl(priv->video_fd, F_SETFD, FD_CLOEXEC);
504
505 mp_msg(MSGT_TV, MSGL_INFO, "Selected device: %s\n", priv->capability.name);
506 mp_msg(MSGT_TV, MSGL_INFO, " Capabilities: ");
507 for (i = 0; device_cap2name[i] != NULL; i++)
508 if (priv->capability.type & (1 << i))
509 mp_msg(MSGT_TV, MSGL_INFO, "%s ", device_cap2name[i]);
510 mp_msg(MSGT_TV, MSGL_INFO, "\n");
511 mp_msg(MSGT_TV, MSGL_INFO, " Device type: %d\n", priv->capability.type);
512 mp_msg(MSGT_TV, MSGL_INFO, " Supported sizes: %dx%d => %dx%d\n",
513 priv->capability.minwidth, priv->capability.minheight,
514 priv->capability.maxwidth, priv->capability.maxheight);
515 priv->width = priv->capability.minwidth;
516 priv->height = priv->capability.minheight;
517
518 /* somewhere here could disable priv->tv_param->mjpeg, if it is not a capability */
519
520 /* initialize if necessary */
521 if ( priv->tv_param->mjpeg )
522 {
523 struct mjpeg_params bparm;
524 struct mjpeg_requestbuffers breq; /* buffer requests */
525
526 if (ioctl(priv->video_fd, MJPIOC_G_PARAMS, &bparm) < 0)
527 {
528 mp_msg(MSGT_TV, MSGL_ERR,
529 " MJP: Error getting video parameters: %s\n", strerror(errno));
530 goto err;
531 }
532
533 mp_msg(MSGT_TV, MSGL_INFO,
534 " MJP: previous params: x: %d, y: %d, w: %d, h: %d, decim: %d, fields: %d,\n",
535 bparm.img_x, bparm.img_y, bparm.img_width, bparm.img_height,
536 bparm.decimation, bparm.field_per_buff);
537
538 mp_msg(MSGT_TV, MSGL_INFO,
539 " MJP: HorDcm: %d, VerDcm: %d, TmpDcm: %d\n",
540 bparm.HorDcm, bparm.VerDcm, bparm.TmpDcm);
541
542 bparm.input = priv->tv_param->input; /* tv */
543 if (!strcasecmp(priv->tv_param->norm, "pal"))
544 bparm.norm = 0; /* PAL */
545 else if (!strcasecmp(priv->tv_param->norm, "ntsc"))
546 bparm.norm = 1; /* NTSC */
547 else if (!strcasecmp(priv->tv_param->norm, "secam"))
548 bparm.norm = 2; /* SECAM */
549 bparm.quality = priv->tv_param->quality;
550 bparm.decimation = priv->tv_param->decimation;
551
552 mp_msg(MSGT_TV, MSGL_INFO, " MJP: setting params to decimation: %d, quality: %d\n",
553 bparm.decimation, bparm.quality);
554
555 if (ioctl(priv->video_fd, MJPIOC_S_PARAMS, &bparm) < 0)
556 {
557 mp_msg(MSGT_TV, MSGL_ERR,
558 " MJP: Error setting video parameters: %s\n", strerror(errno));
559 goto err;
560 }
561
562 if (ioctl(priv->video_fd, MJPIOC_G_PARAMS, &bparm) < 0)
563 {
564 mp_msg(MSGT_TV, MSGL_ERR,
565 " MJP: Error getting video parameters: %s\n", strerror(errno));
566 goto err;
567 }
568
569 mp_msg(MSGT_TV, MSGL_INFO,
570 " MJP: current params: x: %d, y: %d, w: %d, h: %d, decim: %d, fields: %d,\n",
571 bparm.img_x, bparm.img_y, bparm.img_width, bparm.img_height,
572 bparm.decimation, bparm.field_per_buff);
573
574 mp_msg(MSGT_TV, MSGL_INFO,
575 " MJP: HorDcm: %d, VerDcm: %d, TmpDcm: %d\n",
576 bparm.HorDcm, bparm.VerDcm, bparm.TmpDcm);
577
578
579 breq.count = 64;
580 priv -> nbuf = breq.count;
581 priv->mbuf.frames = priv -> nbuf;
582 priv->mjpeg_bufsize = 256*1024;
583 if (priv->tv_param->buffer_size >= 0)
584 priv->mjpeg_bufsize = priv->tv_param->buffer_size*1024;
585 breq.size = priv -> mjpeg_bufsize;
586 if (ioctl(priv->video_fd, MJPIOC_REQBUFS,&(breq)) < 0)
587 {
588 mp_msg (MSGT_TV, MSGL_ERR,
589 " MJP: Error requesting video buffers: %s\n", strerror(errno));
590 goto err;
591 }
592 mp_msg(MSGT_TV, MSGL_INFO,
593 " MJP: Got %ld buffers of size %ld KB\n",
594 breq.count, breq.size/1024);
595
596 priv -> mmap = mmap(0, breq.count * breq.size,
597 PROT_READ|PROT_WRITE, MAP_SHARED, priv->video_fd, 0);
598 if (priv -> mmap == MAP_FAILED)
599 {
600 mp_msg(MSGT_TV, MSGL_INFO,
601 " MJP: Error mapping video buffers: %s\n", strerror(errno));
602 goto err;
603 }
604 }
605
606 mp_msg(MSGT_TV, MSGL_INFO, " Inputs: %d\n", priv->capability.channels);
607 priv->channels = calloc(priv->capability.channels, sizeof(struct video_channel));
608 if (!priv->channels)
609 goto malloc_failed;
610 memset(priv->channels, 0, sizeof(struct video_channel)*priv->capability.channels);
611 for (i = 0; i < priv->capability.channels; i++)
612 {
613 priv->channels[i].channel = i;
614 if (ioctl(priv->video_fd, VIDIOCGCHAN, &priv->channels[i]) == -1)
615 {
616 mp_msg(MSGT_TV, MSGL_ERR, "ioctl get channel failed: %s\n", strerror(errno));
617 break;
618 }
619 mp_msg(MSGT_TV, MSGL_INFO, " %d: %s: %s%s%s%s (tuner:%d, norm:%s)\n", i,
620 priv->channels[i].name,
621 (priv->channels[i].flags & VIDEO_VC_TUNER) ? "tuner " : "",
622 (priv->channels[i].flags & VIDEO_VC_AUDIO) ? "audio " : "",
623 (priv->channels[i].flags & VIDEO_TYPE_TV) ? "tv " : "",
624 (priv->channels[i].flags & VIDEO_TYPE_CAMERA) ? "camera " : "",
625 priv->channels[i].tuners,
626 norm2name(priv->channels[i].norm));
627 }
628 priv->act_channel = 0;
629
630 if (!(priv->capability.type & VID_TYPE_CAPTURE))
631 {
632 mp_msg(MSGT_TV, MSGL_ERR, "Only grabbing supported (for overlay use another program)\n");
633 goto err;
634 }
635
636
637 /* init v4l audio even when we don't capture */
638 init_v4l_audio(priv);
639
640 if (!priv->capability.audios && !priv->tv_param->force_audio) priv->tv_param->noaudio = 1;
641
642 /* audio init */
643 if (!priv->tv_param->noaudio) {
644
645 #ifdef CONFIG_ALSA
646 if (priv->tv_param->alsa)
647 audio_in_init(&priv->audio_in, AUDIO_IN_ALSA);
648 else
649 audio_in_init(&priv->audio_in, AUDIO_IN_OSS);
650 #else
651 audio_in_init(&priv->audio_in, AUDIO_IN_OSS);
652 #endif
653
654 if (priv->audio_device) {
655 audio_in_set_device(&priv->audio_in, priv->audio_device);
656 }
657
658 if (priv->tv_param->audio_id < priv->capability.audios)
659 priv->audio_id = priv->tv_param->audio_id;
660 else
661 priv->audio_id = 0;
662 audio_in_set_samplerate(&priv->audio_in, 44100);
663 if (priv->capability.audios) {
664 audio_in_set_channels(&priv->audio_in, priv->audio_channels[priv->audio_id]);
665 } else {
666 if (priv->tv_param->forcechan >= 0) {
667 audio_in_set_channels(&priv->audio_in, priv->tv_param->forcechan);
668 } else {
669 audio_in_set_channels(&priv->audio_in, 2);
670 }
671 }
672 if (audio_in_setup(&priv->audio_in) < 0) return 0;
673 setup_audio_buffer_sizes(priv);
674 }
675
676 return 1;
677
678 malloc_failed:
679 free(priv->channels);
680 free(priv->buf);
681 err:
682 if (priv->video_fd != -1)
683 close(priv->video_fd);
684 return 0;
685 }
686
687 static int uninit(priv_t *priv)
688 {
689 unsigned long num;
690
691 priv->vbi_shutdown=1;
692 if(priv->vbi_grabber_thread)
693 pthread_join(priv->vbi_grabber_thread, NULL);
694
695 teletext_control(priv->priv_vbi,TV_VBI_CONTROL_STOP,(void*)1);
696 priv->priv_vbi=NULL;
697
698 if(priv->vbi_fd){
699 close(priv->vbi_fd);
700 priv->vbi_fd=0;
701 }
702
703 free(priv->vbi_dev);
704 priv->vbi_dev = NULL;
705
706 priv->shutdown = 1;
707
708 mp_msg(MSGT_TV, MSGL_V, "Waiting for threads to finish... ");
709 if (!priv->tv_param->noaudio) {
710 pthread_join(priv->audio_grabber_thread, NULL);
711 pthread_mutex_destroy(&priv->audio_starter);
712 pthread_mutex_destroy(&priv->skew_mutex);
713 }
714 pthread_mutex_destroy(&priv->video_buffer_mutex);
715 if(priv->video_grabber_thread)
716 pthread_join(priv->video_grabber_thread, NULL);
717
718 mp_msg(MSGT_TV, MSGL_V, "done\n");
719
720 if (priv->capability.audios) {
721 priv->audio[priv->audio_id].flags |= VIDEO_AUDIO_MUTE;
722 ioctl(priv->video_fd, VIDIOCSAUDIO, &priv->audio[priv->audio_id]);
723 }
724
725 if ( priv->tv_param->mjpeg )
726 {
727 num = -1;
728 if (ioctl(priv->video_fd, MJPIOC_QBUF_CAPT, &num) < 0)
729 mp_msg(MSGT_TV, MSGL_ERR, "\n MJP: ioctl MJPIOC_QBUF_CAPT failed: %s\n", strerror(errno));
730 }
731 else
732 {
733 // We need to munmap as close don't close mem mappings
734 if(munmap(priv->mmap,priv->mbuf.size))
735 mp_msg(MSGT_TV, MSGL_ERR, "Munmap failed: %s\n",strerror(errno));
736 }
737
738 if(close(priv->video_fd))
739 mp_msg(MSGT_TV, MSGL_ERR, "Close tv failed: %s\n",strerror(errno));
740
741 audio_in_uninit(&priv->audio_in);
742
743 if (priv->video_ringbuffer) {
744 int i;
745 for (i = 0; i < priv->video_buffer_size_current; i++) {
746 free(priv->video_ringbuffer[i]);
747 }
748 free(priv->video_ringbuffer);
749 }
750
751 free(priv->video_timebuffer);
752 free(priv->video_avg_buffer);
753 if (!priv->tv_param->noaudio) {
754 free(priv->audio_ringbuffer);
755 free(priv->audio_skew_buffer);
756 }
757
758 return 1;
759 }
760
761 static int get_capture_buffer_size(priv_t *priv)
762 {
763 int bufsize, cnt;
764
765 if (priv->tv_param->buffer_size >= 0) {
766 bufsize = priv->tv_param->buffer_size*1024*1024;
767 } else {
768 #ifdef HAVE_SYS_SYSINFO_H
769 struct sysinfo si;
770
771 sysinfo(&si);
772 if (si.totalram<2*1024*1024) {
773 bufsize = 1024*1024;
774 } else {
775 bufsize = si.totalram/2;
776 }
777 #else
778 bufsize = 16*1024*1024;
779 #endif
780 }
781
782 cnt = bufsize/(priv->height*priv->bytesperline);
783 if (cnt < 2) cnt = 2;
784
785 return cnt;
786 }
787
788 static int vbi_init(priv_t* priv,char* device)
789 {
790 int vbi_fd=0;
791 struct video_capability cap;
792
793 if(!device)
794 return TVI_CONTROL_FALSE;
795
796 priv->vbi_dev=strdup(device);
797
798 vbi_fd=open(priv->vbi_dev,O_RDWR);
799 if(vbi_fd<0){
800 mp_msg(MSGT_TV,MSGL_ERR,"vbi: could not open device %s\n",priv->vbi_dev);
801 return TVI_CONTROL_FALSE;
802 }
803
804 if(ioctl(vbi_fd,VIDIOCGCAP,&cap)<0){
805 mp_msg(MSGT_TV,MSGL_ERR,"vbi: Query capabilities failed for %s\n",priv->vbi_dev);
806 close(vbi_fd);
807 return TVI_CONTROL_FALSE;
808 }
809 if(!cap.type & VID_TYPE_CAPTURE){
810 mp_msg(MSGT_TV,MSGL_ERR,"vbi: %s is not capture device\n",priv->vbi_dev);
811 close(vbi_fd);
812 return TVI_CONTROL_FALSE;
813 }
814
815 priv->vbi_fd=vbi_fd;
816 mp_msg(MSGT_TV,MSGL_DBG3,"vbi: init ok\n");
817 return TVI_CONTROL_TRUE;
818 }
819
820 static int vbi_get_props(priv_t* priv,tt_stream_props* ptsp)
821 {
822 struct vbi_format fmt;
823 int res;
824 if(!priv || !ptsp)
825 return TVI_CONTROL_FALSE;
826
827 memset(&fmt,0,sizeof(struct vbi_format));
828 if((res=ioctl(priv->vbi_fd,VIDIOCGVBIFMT,&fmt))<0){
829 mp_msg(MSGT_TV,MSGL_ERR,"vbi_get_props: Query format failed: %x\n",res);
830 return TVI_CONTROL_FALSE;
831 }
832
833 ptsp->interlaced=(fmt.flags& VBI_INTERLACED?1:0);
834 if(fmt.start[1]>0 && fmt.count[1]){
835 if(fmt.start[1]>=286)
836 //625
837 ptsp->offset=10.2e-6*fmt.sampling_rate;
838 else
839 //525
840 ptsp->offset=9.2e-6*fmt.sampling_rate;
841 }else
842 ptsp->offset=9.7e-6*fmt.sampling_rate;
843
844 ptsp->sampling_rate=fmt.sampling_rate;
845 ptsp->samples_per_line=fmt.samples_per_line,
846
847 ptsp->count[0]=fmt.count[0];
848 ptsp->count[1]=fmt.count[1];
849 ptsp->bufsize = ptsp->samples_per_line * (ptsp->count[0] + ptsp->count[1]);
850
851 mp_msg(MSGT_TV,MSGL_V,"vbi_get_props: sampling_rate=%d,offset:%d,samples_per_line: %d\n interlaced:%s, count=[%d,%d]\n",
852 ptsp->sampling_rate,
853 ptsp->offset,
854 ptsp->samples_per_line,
855 ptsp->interlaced?"Yes":"No",
856 ptsp->count[0],
857 ptsp->count[1]);
858
859 return TVI_CONTROL_TRUE;
860 }
861
862 static void *vbi_grabber(void *data)
863 {
864 priv_t *priv = (priv_t *) data;
865 int bytes,seq,prev_seq;
866 unsigned char* buf;
867 tt_stream_props tsp;
868
869 if(!priv->priv_vbi){
870 mp_msg(MSGT_TV,MSGL_WARN,"vbi: vbi not initialized. stopping thread.\n");
871 return NULL;
872 }
873
874 if(vbi_get_props(priv,&tsp)!=TVI_CONTROL_TRUE)
875 return NULL;
876
877 buf=malloc(tsp.bufsize);
878 seq=0;
879 prev_seq=0;
880 mp_msg(MSGT_TV,MSGL_V,"vbi: vbi capture thread started.\n");
881
882 while (!priv->vbi_shutdown){
883 bytes=read(priv->vbi_fd,buf,tsp.bufsize);
884 if(bytes<0 && errno==EINTR)
885 continue;
886 if (bytes!=tsp.bufsize){
887 mp_msg(MSGT_TV,MSGL_WARN,"vbi: expecting bytes: %d, got: %d",tsp.bufsize,bytes);
888 break;
889 }
890 seq=*(int*)(buf+bytes-4);
891 if(seq<=1) continue;
892 if (prev_seq && seq!=prev_seq+1){
893 prev_seq=0;
894 seq=0;
895 }
896 prev_seq=seq;
897 teletext_control(priv->priv_vbi,TV_VBI_CONTROL_DECODE_PAGE,&buf);
898 mp_msg(MSGT_TV,MSGL_DBG3,"grabber: seq:%d\n",seq);
899 }
900 free(buf);
901 return NULL;
902 }
903
904 static int start(priv_t *priv)
905 {
906 int i;
907 int bytes_per_sample;
908 struct video_window win;
909
910 if (ioctl(priv->video_fd, VIDIOCGPICT, &priv->picture) == -1)
911 {
912 mp_msg(MSGT_TV, MSGL_ERR, "ioctl get picture failed: %s\n", strerror(errno));
913 return 0;
914 }
915
916 priv->picture.palette = format2palette(priv->format);
917 priv->picture.depth = palette2depth(priv->picture.palette);
918
919 if (priv->format != IMGFMT_BGR15) {
920 priv->bytesperline = priv->width * priv->picture.depth / 8;
921 } else {
922 priv->bytesperline = priv->width * 2;
923 }
924
925 mp_msg(MSGT_TV, MSGL_V, "Picture values:\n");
926 mp_msg(MSGT_TV, MSGL_V, " Depth: %d, Palette: %s (Format: %s)\n", priv->picture.depth,
927 PALETTE(priv->picture.palette), vo_format_name(priv->format));
928 mp_msg(MSGT_TV, MSGL_V, " Brightness: %d, Hue: %d, Colour: %d, Contrast: %d\n",
929 priv->picture.brightness, priv->picture.hue,
930 priv->picture.colour, priv->picture.contrast);
931
932 if (ioctl(priv->video_fd, VIDIOCSPICT, &priv->picture) == -1)
933 {
934 mp_msg(MSGT_TV, MSGL_ERR, "ioctl set picture failed: %s\n", strerror(errno));
935 mp_msg(MSGT_TV, MSGL_ERR, "The 'outfmt' of '%s' is likely not supported by your card\n",
936 vo_format_name(priv->format));
937 return 0;
938 }
939
940 /* Set capture size */
941 win.x = 0;
942 win.y = 0;
943 win.width = priv->width;
944 win.height = priv->height;
945 win.chromakey = -1;
946 win.flags = 0;
947 win.clipcount = 0;
948 if (ioctl(priv->video_fd, VIDIOCSWIN, &win) == -1)
949 mp_msg(MSGT_TV, MSGL_ERR, "ioctl set window failed: %s\n", strerror(errno));
950
951 if ( !priv->tv_param->mjpeg )
952 {
953 /* map grab buffer */
954 if (ioctl(priv->video_fd, VIDIOCGMBUF, &priv->mbuf) == -1)
955 {
956 mp_msg(MSGT_TV, MSGL_ERR, "ioctl get mbuf failed: %s\n", strerror(errno));
957 return 0;
958 }
959
960 mp_msg(MSGT_TV, MSGL_V, "mbuf: size=%d, frames=%d\n",
961 priv->mbuf.size, priv->mbuf.frames);
962 priv->mmap = mmap(0, priv->mbuf.size, PROT_READ|PROT_WRITE,
963 MAP_SHARED, priv->video_fd, 0);
964 if (priv->mmap == (unsigned char *)-1)
965 {
966 mp_msg(MSGT_TV, MSGL_ERR, "Unable to map memory for buffers: %s\n", strerror(errno));
967 return 0;
968 }
969 mp_msg(MSGT_TV, MSGL_DBG2, "our buffer: %p\n", priv->mmap);
970
971 /* num of buffers */
972 priv->nbuf = priv->mbuf.frames;
973
974 /* video buffers */
975 priv->buf = calloc(priv->nbuf, sizeof(struct video_mmap));
976 if (!priv->buf)
977 return 0;
978 memset(priv->buf, 0, priv->nbuf * sizeof(struct video_mmap));
979 }
980
981 if ( !priv->tv_param->mjpeg )
982 {
983 priv->nbuf = priv->mbuf.frames;
984 for (i=0; i < priv->nbuf; i++)
985 {
986 priv->buf[i].format = priv->picture.palette;
987 priv->buf[i].frame = i;
988 priv->buf[i].width = priv->width;
989 priv->buf[i].height = priv->height;
990 mp_msg(MSGT_TV, MSGL_DBG2, "buffer: %d => %p\n", i, &priv->buf[i]);
991 }
992 }
993
994 #if 0
995 {
996 struct video_play_mode pmode;
997
998 pmode.mode = VID_PLAY_NORMAL;
999 pmode.p1 = 1;
1000 pmode.p2 = 0;
1001 if (ioctl(priv->video_fd, VIDIOCSPLAYMODE, &pmode) == -1)
1002 {
1003 mp_msg(MSGT_TV, MSGL_ERR, "ioctl set play mode failed: %s\n", strerror(errno));
1004 // return 0;
1005 }
1006 }
1007 #endif
1008
1009 #if 0
1010 // initialize video capture
1011 if (ioctl(priv->video_fd, VIDIOCCAPTURE, &one) == -1)
1012 {
1013 mp_msg(MSGT_TV, MSGL_ERR, "FATAL: ioctl ccapture failed: %s\n", strerror(errno));
1014 return 0;
1015 }
1016 #endif
1017
1018 /* setup audio parameters */
1019 if (!priv->tv_param->noaudio) {
1020 setup_audio_buffer_sizes(priv);
1021 bytes_per_sample = priv->audio_in.bytes_per_sample;
1022 priv->audio_skew_buffer = calloc(priv->aud_skew_cnt, sizeof(long long));
1023 if (!priv->audio_skew_buffer) {
1024 mp_msg(MSGT_TV, MSGL_ERR, "cannot allocate skew buffer: %s\n", strerror(errno));
1025 return 0;
1026 }
1027
1028 priv->audio_ringbuffer = calloc(priv->audio_in.blocksize, priv->audio_buffer_size);
1029 if (!priv->audio_ringbuffer) {
1030 mp_msg(MSGT_TV, MSGL_ERR, "cannot allocate audio buffer: %s\n", strerror(errno));
1031 return 0;
1032 }
1033
1034 priv->audio_secs_per_block = (double)priv->audio_in.blocksize/(priv->audio_in.samplerate
1035 *priv->audio_in.channels
1036 *bytes_per_sample);
1037 priv->audio_head = 0;
1038 priv->audio_tail = 0;
1039 priv->audio_cnt = 0;
1040 priv->audio_drop = 0;
1041 priv->audio_skew = 0;
1042 priv->audio_skew_total = 0;
1043 priv->audio_recv_blocks_total = 0;
1044 priv->audio_sent_blocks_total = 0;
1045 }
1046
1047 /* setup video parameters */
1048 if (priv->immediate_mode) {
1049 priv->video_buffer_size_max = VID_BUF_SIZE_IMMEDIATE;
1050 } else {
1051 priv->video_buffer_size_max = get_capture_buffer_size(priv);
1052 }
1053 priv->video_buffer_size_current = 0;
1054
1055 if (!priv->tv_param->noaudio) {
1056 if (priv->video_buffer_size_max < 3.0*priv->fps*priv->audio_secs_per_block) {
1057 mp_msg(MSGT_TV, MSGL_ERR, "Video buffer shorter than 3 times audio frame duration.\n"
1058 "You will probably experience heavy framedrops.\n");
1059 }
1060 }
1061
1062 mp_msg(MSGT_TV, MSGL_V, "Using a ring buffer for maximum %d frames, %d MB total size.\n",
1063 priv->video_buffer_size_max,
1064 priv->video_buffer_size_max*priv->height*priv->bytesperline/(1024*1024));
1065
1066 priv->video_ringbuffer = calloc(priv->video_buffer_size_max, sizeof(unsigned char*));
1067 if (!priv->video_ringbuffer) {
1068 mp_msg(MSGT_TV, MSGL_ERR, "cannot allocate video buffer: %s\n", strerror(errno));
1069 return 0;
1070 }
1071 for (i = 0; i < priv->video_buffer_size_max; i++)
1072 priv->video_ringbuffer[i] = NULL;
1073
1074 priv->video_timebuffer = calloc(priv->video_buffer_size_max, sizeof(long long));
1075 if (!priv->video_timebuffer) {
1076 mp_msg(MSGT_TV, MSGL_ERR, "cannot allocate time buffer: %s\n", strerror(errno));
1077 return 0;
1078 }
1079 priv->video_avg_buffer = malloc(sizeof(long long) * VIDEO_AVG_BUFFER_SIZE);
1080 if (!priv->video_avg_buffer) {
1081 mp_msg(MSGT_TV, MSGL_ERR, "cannot allocate period buffer: %s\n", strerror(errno));
1082 return 0;
1083 }
1084 priv->video_interval_sum = (1e6/priv->fps)*VIDEO_AVG_BUFFER_SIZE;
1085 for (i = 0; i < VIDEO_AVG_BUFFER_SIZE; i++) {
1086 priv->video_avg_buffer[i] = 1e6/priv->fps;
1087 }
1088
1089 priv->video_avg_ptr = 0;
1090
1091 priv->video_head = 0;
1092 priv->video_tail = 0;
1093 priv->video_cnt = 0;
1094 priv->first = 1;
1095
1096 if (priv->capability.audios) {
1097 /* enable audio */
1098 if (priv->tv_param->volume >= 0)
1099 priv->audio[priv->audio_id].volume = priv->tv_param->volume;
1100 if (priv->tv_param->bass >= 0)
1101 priv->audio[priv->audio_id].bass = priv->tv_param->bass;
1102 if (priv->tv_param->treble >= 0)
1103 priv->audio[priv->audio_id].treble = priv->tv_param->treble;
1104 if (priv->tv_param->balance >= 0)
1105 priv->audio[priv->audio_id].balance = priv->tv_param->balance;
1106 priv->audio[priv->audio_id].flags &= ~VIDEO_AUDIO_MUTE;
1107 mp_msg(MSGT_TV, MSGL_V, "Enabling tv audio. Requested setup is:\n");
1108 mp_msg(MSGT_TV, MSGL_V, "id=%d vol=%d bass=%d treble=%d balance=%d mode=%s",
1109 priv->audio_id,
1110 priv->audio[priv->audio_id].volume, priv->audio[priv->audio_id].bass, priv->audio[priv->audio_id].treble,
1111 priv->audio[priv->audio_id].balance, audio_mode2name(priv->audio[priv->audio_id].mode));
1112 mp_msg(MSGT_TV, MSGL_V, " chan=%d\n", priv->audio_channels[priv->audio_id]);
1113 ioctl(priv->video_fd, VIDIOCSAUDIO, &priv->audio[priv->audio_id]);
1114 }
1115
1116 /* start vbi thread */
1117 if(priv->priv_vbi){
1118 priv->vbi_shutdown = 0;
1119 pthread_create(&priv->vbi_grabber_thread, NULL, vbi_grabber, priv);
1120 }
1121
1122 /* launch capture threads */
1123 priv->shutdown = 0;
1124 if (!priv->tv_param->noaudio) {
1125 pthread_mutex_init(&priv->audio_starter, NULL);
1126 pthread_mutex_init(&priv->skew_mutex, NULL);
1127 pthread_mutex_lock(&priv->audio_starter);
1128 pthread_create(&priv->audio_grabber_thread, NULL, audio_grabber, priv);
1129 }
1130 pthread_mutex_init(&priv->video_buffer_mutex, NULL);
1131 /* we'll launch the video capture later, when a first request for a frame arrives */
1132
1133 return 1;
1134 }
1135
1136
1137 static int control(priv_t *priv, int cmd, void *arg)
1138 {
1139 mp_msg(MSGT_TV, MSGL_DBG2, "\ndebug: control(priv=%p, cmd=%d, arg=%p)\n",
1140 priv, cmd, arg);
1141 switch(cmd)
1142 {
1143 /* ========== GENERIC controls =========== */
1144 case TVI_CONTROL_IS_VIDEO:
1145 {
1146 if (priv->capability.type & VID_TYPE_CAPTURE)
1147 return TVI_CONTROL_TRUE;
1148 return TVI_CONTROL_FALSE;
1149 }
1150 case TVI_CONTROL_IS_AUDIO:
1151 if (priv->tv_param->force_audio) return TVI_CONTROL_TRUE;
1152 if (priv->channels[priv->act_channel].flags & VIDEO_VC_AUDIO)
1153 {
1154 return TVI_CONTROL_TRUE;
1155 }
1156 return TVI_CONTROL_FALSE;
1157 case TVI_CONTROL_IS_TUNER:
1158 {
1159 // if (priv->capability.type & VID_TYPE_TUNER)
1160 if (priv->channels[priv->act_channel].flags & VIDEO_VC_TUNER)
1161 return TVI_CONTROL_TRUE;
1162 return TVI_CONTROL_FALSE;
1163 }
1164
1165 /* ========== VIDEO controls =========== */
1166 case TVI_CONTROL_VID_GET_FORMAT:
1167 {
1168 int output_fmt = -1;
1169
1170 output_fmt = priv->format;
1171 if ( priv->tv_param->mjpeg )
1172 {
1173 mp_msg(MSGT_TV, MSGL_INFO, " MJP: setting sh_video->format to mjpg\n");
1174 output_fmt = 0x47504a4d;
1175 output_fmt = 0x67706a6d;
1176 *(int *)arg = output_fmt;
1177 mp_msg(MSGT_TV, MSGL_V, "Output format: %s\n", "mjpg");
1178 }
1179 else
1180 {
1181 *(int *)arg = output_fmt;
1182 mp_msg(MSGT_TV, MSGL_V, "Output format: %s\n", vo_format_name(output_fmt));
1183 }
1184 return TVI_CONTROL_TRUE;
1185 }
1186 case TVI_CONTROL_VID_SET_FORMAT:
1187 priv->format = *(int *)arg;
1188 // !HACK! v4l uses BGR format instead of RGB
1189 // and we have to correct this. Fortunately,
1190 // tv.c reads later the format back so we
1191 // can persuade it to use what we want.
1192 if (IMGFMT_IS_RGB(priv->format)) {
1193 priv->format &= ~IMGFMT_RGB_MASK;
1194 priv->format |= IMGFMT_BGR;
1195 }
1196 return TVI_CONTROL_TRUE;
1197 case TVI_CONTROL_VID_GET_PLANES:
1198 *(int *)arg = 1; /* FIXME, also not needed at this time */
1199 return TVI_CONTROL_TRUE;
1200 case TVI_CONTROL_VID_GET_BITS:
1201 *(int *)arg = palette2depth(format2palette(priv->format));
1202 return TVI_CONTROL_TRUE;
1203 case TVI_CONTROL_VID_GET_WIDTH:
1204 *(int *)arg = priv->width;
1205 return TVI_CONTROL_TRUE;
1206 case TVI_CONTROL_VID_CHK_WIDTH:
1207 {
1208 int req_width = *(int *)arg;
1209
1210 mp_msg(MSGT_TV, MSGL_V, "Requested width: %d\n", req_width);
1211 if ((req_width >= priv->capability.minwidth) &&
1212 (req_width <= priv->capability.maxwidth))
1213 return TVI_CONTROL_TRUE;
1214 return TVI_CONTROL_FALSE;
1215 }
1216 case TVI_CONTROL_VID_SET_WIDTH:
1217 priv->width = *(int *)arg;
1218 return TVI_CONTROL_TRUE;
1219 case TVI_CONTROL_VID_GET_HEIGHT:
1220 *(int *)arg = priv->height;
1221 return TVI_CONTROL_TRUE;
1222 case TVI_CONTROL_VID_CHK_HEIGHT:
1223 {
1224 int req_height = *(int *)arg;
1225
1226 mp_msg(MSGT_TV, MSGL_V, "Requested height: %d\n", req_height);
1227 if ((req_height >= priv->capability.minheight) &&
1228 (req_height <= priv->capability.maxheight))
1229 return TVI_CONTROL_TRUE;
1230 return TVI_CONTROL_FALSE;
1231 }
1232 case TVI_CONTROL_VID_SET_HEIGHT:
1233 priv->height = *(int *)arg;
1234 return TVI_CONTROL_TRUE;
1235 case TVI_CONTROL_VID_GET_PICTURE:
1236 if (ioctl(priv->video_fd, VIDIOCGPICT, &priv->picture) == -1)
1237 {
1238 mp_msg(MSGT_TV, MSGL_ERR, "ioctl get picture failed: %s\n", strerror(errno));
1239 return TVI_CONTROL_FALSE;
1240 }
1241 return TVI_CONTROL_TRUE;
1242 case TVI_CONTROL_VID_SET_PICTURE:
1243 if (ioctl(priv->video_fd, VIDIOCSPICT, &priv->picture) == -1)
1244 {
1245 mp_msg(MSGT_TV, MSGL_ERR, "ioctl set picture failed: %s\n", strerror(errno));
1246 return TVI_CONTROL_FALSE;
1247 }
1248 return TVI_CONTROL_TRUE;
1249 case TVI_CONTROL_VID_SET_BRIGHTNESS:
1250 priv->picture.brightness = (327*(*(int *)arg+100)) + 68;
1251 return control(priv, TVI_CONTROL_VID_SET_PICTURE, 0);
1252 case TVI_CONTROL_VID_SET_HUE:
1253 priv->picture.hue = (327*(*(int *)arg+100)) + 68;
1254 return control(priv, TVI_CONTROL_VID_SET_PICTURE, 0);
1255 case TVI_CONTROL_VID_SET_SATURATION:
1256 priv->picture.colour = (327*(*(int *)arg+100)) + 68;
1257 return control(priv, TVI_CONTROL_VID_SET_PICTURE, 0);
1258 case TVI_CONTROL_VID_SET_CONTRAST:
1259 priv->picture.contrast = (327*(*(int *)arg+100)) + 68;
1260 return control(priv, TVI_CONTROL_VID_SET_PICTURE, 0);
1261 case TVI_CONTROL_VID_GET_BRIGHTNESS:
1262 if(!control(priv, TVI_CONTROL_VID_GET_PICTURE, 0)) return 0;
1263 *(int*)arg = ((int)priv->picture.brightness-68)/327-100;
1264 return 1;
1265 case TVI_CONTROL_VID_GET_HUE:
1266 if(!control(priv, TVI_CONTROL_VID_GET_PICTURE, 0)) return 0;
1267 *(int*)arg = ((int)priv->picture.hue-68)/327-100;
1268 return 1;
1269 case TVI_CONTROL_VID_GET_SATURATION:
1270 if(!control(priv, TVI_CONTROL_VID_GET_PICTURE, 0)) return 0;
1271 *(int*)arg = ((int)priv->picture.colour-68)/327-100;
1272 return 1;
1273 case TVI_CONTROL_VID_GET_CONTRAST:
1274 if(!control(priv, TVI_CONTROL_VID_GET_PICTURE, 0)) return 0;
1275 *(int*)arg = ((int)priv->picture.contrast-68)/327-100;
1276 return 1;
1277 case TVI_CONTROL_VID_GET_FPS:
1278 *(float *)arg=priv->fps;
1279 return TVI_CONTROL_TRUE;
1280
1281 /* ========== TUNER controls =========== */
1282 case TVI_CONTROL_TUN_GET_FREQ:
1283 {
1284 unsigned long freq;
1285
1286 if (ioctl(priv->video_fd, VIDIOCGFREQ, &freq) == -1)
1287 {
1288 mp_msg(MSGT_TV, MSGL_ERR, "ioctl get freq failed: %s\n", strerror(errno));
1289 return TVI_CONTROL_FALSE;
1290 }
1291
1292 /* tuner uses khz not mhz ! */
1293 // if (priv->tuner.flags & VIDEO_TUNER_LOW)
1294 // freq /= 1000;
1295 *(unsigned long *)arg = freq;
1296 return TVI_CONTROL_TRUE;
1297 }
1298 case TVI_CONTROL_TUN_SET_FREQ:
1299 {
1300 /* argument is in MHz ! */
1301 unsigned long freq = *(unsigned long *)arg;
1302
1303 if (priv->capability.audios) {
1304 priv->audio[priv->audio_id].flags |= VIDEO_AUDIO_MUTE;
1305 ioctl(priv->video_fd, VIDIOCSAUDIO, &priv->audio[priv->audio_id]);
1306 }
1307
1308 mp_msg(MSGT_TV, MSGL_V, "requested frequency: %.3f\n", (float)freq/16);
1309
1310 /* tuner uses khz not mhz ! */
1311 // if (priv->tuner.flags & VIDEO_TUNER_LOW)
1312 // freq *= 1000;
1313 // mp_msg(MSGT_TV, MSGL_V, " requesting from driver: freq=%.3f\n", (float)freq/16);
1314 if (ioctl(priv->video_fd, VIDIOCSFREQ, &freq) == -1)
1315 {
1316 mp_msg(MSGT_TV, MSGL_ERR, "ioctl set freq failed: %s\n", strerror(errno));
1317 return TVI_CONTROL_FALSE;
1318 }
1319 usleep(100000); // wait to suppress noise during switching
1320
1321 if (priv->capability.audios) {
1322 priv->audio[priv->audio_id].flags &= ~VIDEO_AUDIO_MUTE;
1323 ioctl(priv->video_fd, VIDIOCSAUDIO, &priv->audio[priv->audio_id]);
1324 }
1325
1326 return TVI_CONTROL_TRUE;
1327 }
1328 case TVI_CONTROL_TUN_GET_TUNER:
1329 {
1330 if (ioctl(priv->video_fd, VIDIOCGTUNER, &priv->tuner) == -1)
1331 {
1332 mp_msg(MSGT_TV, MSGL_ERR, "ioctl get tuner failed: %s\n", strerror(errno));
1333 return TVI_CONTROL_FALSE;
1334 }
1335
1336 mp_msg(MSGT_TV, MSGL_V, "Tuner (%s) range: %lu -> %lu\n", priv->tuner.name,
1337 priv->tuner.rangelow, priv->tuner.rangehigh);
1338 return TVI_CONTROL_TRUE;
1339 }
1340 case TVI_CONTROL_TUN_SET_TUNER:
1341 {
1342 if (ioctl(priv->video_fd, VIDIOCSTUNER, &priv->tuner) == -1)
1343 {
1344 mp_msg(MSGT_TV, MSGL_ERR, "ioctl set tuner failed: %s\n", strerror(errno));
1345 return TVI_CONTROL_FALSE;
1346 }
1347 return TVI_CONTROL_TRUE;
1348 }
1349 case TVI_CONTROL_TUN_SET_NORM:
1350 {
1351 int req_mode = *(int *)arg;
1352 int norm_index;
1353 for(norm_index=0;supported_norms[norm_index].name; norm_index++)
1354 if(req_mode==supported_norms[norm_index].normid)
1355 break;
1356
1357 if(!supported_norms[norm_index].name) {
1358 mp_msg(MSGT_TV, MSGL_ERR, "Unknown norm!\n");
1359 return TVI_CONTROL_FALSE;
1360 }
1361
1362 if (priv->channels[priv->act_channel].flags & VIDEO_VC_TUNER) {
1363 int prev_mode;
1364
1365 control(priv, TVI_CONTROL_TUN_GET_TUNER, 0);
1366 if(!(priv->tuner.flags & supported_norms[norm_index].tuner_flags))
1367 {
1368 mp_msg(MSGT_TV, MSGL_ERR, "Tuner isn't capable to set norm!\n");
1369 return TVI_CONTROL_FALSE;
1370 }
1371
1372 prev_mode = priv->tuner.mode;
1373
1374 priv->tuner.mode = supported_norms[norm_index].tuner_mode;
1375
1376 if (control(priv, TVI_CONTROL_TUN_SET_TUNER, &priv->tuner) != TVI_CONTROL_TRUE) {
1377 // norm setting failed, but maybe it's only because it's fixed
1378 if (priv->tuner.mode != prev_mode) return TVI_CONTROL_FALSE; // no it really failed
1379 }
1380
1381 }
1382
1383 priv->channels[priv->act_channel].norm = supported_norms[norm_index].input_norm;
1384
1385 if (ioctl(priv->video_fd, VIDIOCSCHAN, &priv->channels[priv->act_channel]) == -1)
1386 {
1387 mp_msg(MSGT_TV, MSGL_ERR, "ioctl set chan failed: %s\n", strerror(errno));
1388 return TVI_CONTROL_FALSE;
1389 }
1390
1391 if (ioctl(priv->video_fd, VIDIOCGCAP, &priv->capability) == -1) {
1392 mp_msg(MSGT_TV, MSGL_ERR, "ioctl get capabilities failed: %s\n", strerror(errno));
1393 return TVI_CONTROL_FALSE;
1394 }
1395
1396 priv->fps = supported_norms[norm_index].fps;
1397
1398 if(priv->height > priv->capability.maxheight) {
1399 priv->height = priv->capability.maxheight;
1400 }
1401
1402 if(priv->width > priv->capability.maxwidth) {
1403 priv->width = priv->capability.maxwidth;
1404 }
1405
1406 return TVI_CONTROL_TRUE;
1407 }
1408 case TVI_CONTROL_TUN_GET_NORM:
1409 {
1410 *(int *)arg = priv->tuner.mode;
1411
1412 return TVI_CONTROL_TRUE;
1413 }
1414 case TVI_CONTROL_TUN_GET_SIGNAL:
1415 {
1416 if (ioctl(priv->video_fd, VIDIOCGTUNER, &priv->tuner) == -1)
1417 {
1418 mp_msg(MSGT_TV, MSGL_ERR, "ioctl get tuner failed: %s\n", strerror(errno));
1419 return TVI_CONTROL_FALSE;
1420 }
1421 *(int*)arg=100*(priv->tuner.signal>>8)/255;
1422 return TVI_CONTROL_TRUE;
1423 }
1424
1425 /* ========== AUDIO controls =========== */
1426 case TVI_CONTROL_AUD_GET_FORMAT:
1427 {
1428 *(int *)arg = AF_FORMAT_S16_LE;
1429 return TVI_CONTROL_TRUE;
1430 }
1431 case TVI_CONTROL_AUD_GET_CHANNELS:
1432 {
1433 *(int *)arg = priv->audio_in.channels;
1434 return TVI_CONTROL_TRUE;
1435 }
1436 case TVI_CONTROL_AUD_GET_SAMPLERATE:
1437 {
1438 *(int *)arg = priv->audio_in.samplerate;
1439 return TVI_CONTROL_TRUE;
1440 }
1441 case TVI_CONTROL_AUD_GET_SAMPLESIZE:
1442 {
1443 *(int *)arg = priv->audio_in.bytes_per_sample;
1444 return TVI_CONTROL_TRUE;
1445 }
1446 case TVI_CONTROL_AUD_SET_SAMPLERATE:
1447 {
1448 if (audio_in_set_samplerate(&priv->audio_in, *(int *)arg) < 0) return TVI_CONTROL_FALSE;
1449 setup_audio_buffer_sizes(priv);
1450 return TVI_CONTROL_TRUE;
1451 }
1452 /* ========== SPECIFIC controls =========== */
1453 case TVI_CONTROL_SPC_GET_INPUT:
1454 {
1455 int req_chan = *(int *)arg;
1456 int i;
1457
1458 for (i = 0; i < priv->capability.channels; i++)
1459 {
1460 if (priv->channels[i].channel == req_chan)
1461 break;
1462 }
1463
1464 priv->act_channel = i;
1465
1466 if (ioctl(priv->video_fd, VIDIOCGCHAN, &priv->channels[i]) == -1)
1467 {
1468 mp_msg(MSGT_TV, MSGL_ERR, "ioctl get channel failed: %s\n", strerror(errno));
1469 return TVI_CONTROL_FALSE;
1470 }
1471 return TVI_CONTROL_TRUE;
1472 }
1473
1474 case TVI_CONTROL_SPC_SET_INPUT:
1475 {
1476 struct video_channel chan;
1477 int req_chan = *(int *)arg;
1478 int i;
1479
1480 if (req_chan >= priv->capability.channels)
1481 {
1482 mp_msg(MSGT_TV, MSGL_ERR, "Invalid input requested: %d, valid: 0-%d\n",
1483 req_chan, priv->capability.channels - 1);
1484 return TVI_CONTROL_FALSE;
1485 }
1486
1487 for (i = 0; i < priv->capability.channels; i++)
1488 {
1489 if (priv->channels[i].channel == req_chan)
1490 chan = priv->channels[i];
1491 }
1492
1493 if (ioctl(priv->video_fd, VIDIOCSCHAN, &chan) == -1)
1494 {
1495 mp_msg(MSGT_TV, MSGL_ERR, "ioctl set chan failed: %s\n", strerror(errno));
1496 return TVI_CONTROL_FALSE;
1497 }
1498 mp_msg(MSGT_TV, MSGL_INFO, "Using input '%s'\n", chan.name);
1499
1500 priv->act_channel = i;
1501
1502 /* update tuner state */
1503 // if (priv->capability.type & VID_TYPE_TUNER)
1504 if (priv->channels[priv->act_channel].flags & VIDEO_VC_TUNER)
1505 control(priv, TVI_CONTROL_TUN_GET_TUNER, 0);
1506
1507 /* update local channel list */
1508 control(priv, TVI_CONTROL_SPC_GET_INPUT, &req_chan);
1509 return TVI_CONTROL_TRUE;
1510 case TVI_CONTROL_IMMEDIATE:
1511 priv->immediate_mode = 1;
1512 return TVI_CONTROL_TRUE;
1513 }
1514 case TVI_CONTROL_VBI_INIT:
1515 {
1516 void* ptr;
1517 tt_stream_props tsp;
1518
1519 if (vbi_init(priv,*(char**)arg)!=TVI_CONTROL_TRUE)
1520 return TVI_CONTROL_FALSE;
1521 if(vbi_get_props(priv,&tsp)==TVI_CONTROL_TRUE)
1522 {
1523 ptr=&tsp;
1524 if(teletext_control(NULL,TV_VBI_CONTROL_START,&ptr)==VBI_CONTROL_TRUE)
1525 priv->priv_vbi=ptr;
1526 else
1527 priv->priv_vbi=NULL;
1528 }
1529 return TVI_CONTROL_TRUE;
1530 }
1531 case TVI_CONTROL_GET_VBI_PTR:
1532 *(void **)arg=priv->priv_vbi;
1533 return TVI_CONTROL_TRUE;
1534 }
1535
1536 return TVI_CONTROL_UNKNOWN;
1537 }
1538
1539 static int set_mute(priv_t* priv,int value)
1540 {
1541 if (!priv->capability.audios) {
1542 return 0;
1543
1544 if(value)
1545 priv->audio[priv->audio_id].flags |=VIDEO_AUDIO_MUTE;
1546 else
1547 priv->audio[priv->audio_id].flags &= ~VIDEO_AUDIO_MUTE;
1548 }
1549 if(ioctl(priv->video_fd, VIDIOCSAUDIO, &priv->audio[priv->audio_id])<0)
1550 return 0;
1551 return 1;
1552 }
1553
1554 // copies a video frame
1555 // for YV12 swaps the 2nd and 3rd plane
1556 static inline void copy_frame(priv_t *priv, unsigned char *dest, unsigned char *source)
1557 {
1558 if(priv->tv_param->automute>0){
1559 if (ioctl(priv->video_fd, VIDIOCGTUNER, &priv->tuner) >= 0) {
1560 if(priv->tv_param->automute<<8>priv->tuner.signal){
1561 fill_blank_frame(dest,priv->bytesperline * priv->height,priv->format);
1562 set_mute(priv,1);
1563 return;
1564 }
1565 }
1566 set_mute(priv,0);
1567 }
1568 // YV12 uses VIDEO_PALETTE_YUV420P, but the planes are swapped
1569 if (priv->format == IMGFMT_YV12) {
1570 fast_memcpy(dest, source, priv->width * priv->height);
1571 fast_memcpy(dest+priv->width * priv->height*5/4, source+priv->width * priv->height, priv->width * priv->height/4);
1572 fast_memcpy(dest+priv->width * priv->height, source+priv->width * priv->height*5/4, priv->width * priv->height/4);
1573 return;
1574 }
1575
1576 fast_memcpy(dest, source, priv->bytesperline * priv->height);
1577 }
1578
1579 // maximum skew change, in frames
1580 #define MAX_SKEW_DELTA 0.6
1581 static void *video_grabber(void *data)
1582 {
1583 #define MAXTOL (priv->nbuf)
1584 priv_t *priv = (priv_t*)data;
1585 struct timeval curtime;
1586 long long skew, prev_skew, xskew, interval, prev_interval;
1587 int frame;
1588 int i;
1589 int framecount;
1590 int tolerance;
1591 unsigned long num;
1592
1593 /* start the capture process */
1594
1595 if ( priv->tv_param->mjpeg )
1596 {
1597 mp_msg(MSGT_TV, MSGL_INFO, " MJP: gonna capture ! \n");
1598 for (i=0; i < priv->nbuf; i++) {
1599 num = i;
1600 if (ioctl(priv->video_fd, MJPIOC_QBUF_CAPT, &num) < 0)
1601 mp_msg(MSGT_TV, MSGL_ERR,
1602 "\n MJP: ioctl MJPIOC_QBUF_CAPT b failed: %s\n", strerror(errno));
1603 }
1604 }
1605 else
1606 {
1607 for (i=0; i < priv->nbuf; i++) {
1608 if (ioctl(priv->video_fd, VIDIOCMCAPTURE, &priv->buf[i]) == -1)
1609 mp_msg(MSGT_TV, MSGL_ERR, "\nioctl mcapture failed: %s\n", strerror(errno));
1610 }
1611 }
1612
1613 gettimeofday(&curtime, NULL);
1614 priv->starttime = (long long)1e6*curtime.tv_sec + curtime.tv_usec;
1615 priv->audio_skew_measure_time = 0;
1616 pthread_mutex_unlock(&priv->audio_starter);
1617 xskew = 0;
1618 skew = 0;
1619 interval = 0;
1620
1621 prev_interval = 0;
1622 prev_skew = 0;
1623
1624 tolerance = MAXTOL;
1625
1626 for (framecount = 0; !priv->shutdown;)
1627 {
1628 for (i = 0; i < priv->nbuf && !priv->shutdown; i++, framecount++) {
1629
1630 if (priv->immediate_mode) {
1631 while (priv->video_cnt == priv->video_buffer_size_max) {
1632 usleep(10000);
1633 if (priv->shutdown) {
1634 return NULL;
1635 }
1636 }
1637 }
1638
1639 frame = i;
1640
1641 if ( priv->tv_param->mjpeg )
1642 {
1643 while (ioctl(priv->video_fd, MJPIOC_SYNC, &priv->buf[frame].frame) < 0 &&
1644 (errno == EAGAIN || errno == EINTR));
1645 }
1646 else
1647 {
1648 while (ioctl(priv->video_fd, VIDIOCSYNC, &priv->buf[frame].frame) < 0 &&
1649 (errno == EAGAIN || errno == EINTR));
1650 }
1651 mp_dbg(MSGT_TV, MSGL_DBG3, "\npicture sync failed\n");
1652
1653 gettimeofday(&curtime, NULL);
1654 if (!priv->immediate_mode) {
1655 interval = (long long)1e6*curtime.tv_sec + curtime.tv_usec - priv->starttime;
1656 } else {
1657 interval = (long long)1e6*framecount/priv->fps;
1658 }
1659
1660 if (!priv->immediate_mode) {
1661 long long period, orig_interval;
1662
1663 if (tolerance == 0) {
1664 if (interval - prev_interval == 0) {
1665 mp_msg(MSGT_TV, MSGL_V, "\nvideo capture thread: frame delta = 0\n");
1666 } else if ((interval - prev_interval < (long long)0.85e6/priv->fps)
1667 || (interval - prev_interval > (long long)1.15e6/priv->fps) ) {
1668 mp_msg(MSGT_TV, MSGL_V, "\nvideo capture thread: frame delta ~ %.1f fps\n",
1669 (double)1e6/(interval - prev_interval));
1670 }
1671 }
1672
1673 // correct the rate fluctuations on a small scale
1674 orig_interval = interval;
1675 period = priv->video_interval_sum/VIDEO_AVG_BUFFER_SIZE;
1676 if (interval - prev_interval > 105*period/100) {
1677 if (tolerance > 0) {
1678 mp_msg(MSGT_TV, MSGL_DBG3, "correcting timestamp\n");
1679 interval = prev_interval + priv->video_interval_sum/VIDEO_AVG_BUFFER_SIZE;
1680 tolerance--;
1681 } else {
1682 mp_msg(MSGT_TV, MSGL_DBG3, "bad - frames were dropped\n");
1683 tolerance = MAXTOL;
1684 }
1685 } else {
1686 if (tolerance < MAXTOL) {
1687 mp_msg(MSGT_TV, MSGL_DBG3, "fluctuation overcome\n");
1688 }
1689 tolerance = MAXTOL;
1690 }
1691
1692 priv->video_interval_sum -= priv->video_avg_buffer[priv->video_avg_ptr];
1693 priv->video_avg_buffer[priv->video_avg_ptr++] = orig_interval-prev_interval;
1694 priv->video_interval_sum += orig_interval-prev_interval;
1695 if (priv->video_avg_ptr >= VIDEO_AVG_BUFFER_SIZE) priv->video_avg_ptr = 0;
1696
1697 // fprintf(stderr, "fps: %f\n", (double)1e6*VIDEO_AVG_BUFFER_SIZE/priv->video_interval_sum);
1698
1699 // interpolate the skew in time
1700 pthread_mutex_lock(&priv->skew_mutex);
1701 xskew = priv->audio_skew + (interval - priv->audio_skew_measure_time)*priv->audio_skew_factor;
1702 pthread_mutex_unlock(&priv->skew_mutex);
1703 // correct extreme skew changes to avoid (especially) moving backwards in time
1704 if (xskew - prev_skew > (interval - prev_interval)*MAX_SKEW_DELTA) {
1705 skew = prev_skew + (interval - prev_interval)*MAX_SKEW_DELTA;
1706 } else if (xskew - prev_skew < -(interval - prev_interval)*MAX_SKEW_DELTA) {
1707 skew = prev_skew - (interval - prev_interval)*MAX_SKEW_DELTA;
1708 } else {
1709 skew = xskew;
1710 }
1711 }
1712
1713 mp_msg(MSGT_TV, MSGL_DBG3, "\nfps = %f, interval = %f, a_skew = %f, corr_skew = %f\n",
1714 (interval != prev_interval) ? (double)1e6/(interval - prev_interval) : -1,
1715 (double)1e-6*interval, (double)1e-6*xskew, (double)1e-6*skew);
1716 mp_msg(MSGT_TV, MSGL_DBG3, "vcnt = %d, acnt = %d\n", priv->video_cnt, priv->audio_cnt);
1717
1718 prev_skew = skew;
1719 prev_interval = interval;
1720
1721 /* allocate a new buffer, if needed */
1722 pthread_mutex_lock(&priv->video_buffer_mutex);
1723 if (priv->video_buffer_size_current < priv->video_buffer_size_max) {
1724 if (priv->video_cnt == priv->video_buffer_size_current) {
1725 unsigned char *newbuf = calloc(priv->bytesperline, priv->height);
1726 if (newbuf) {
1727 memmove(priv->video_ringbuffer+priv->video_tail+1, priv->video_ringbuffer+priv->video_tail,
1728 (priv->video_buffer_size_current-priv->video_tail)*sizeof(unsigned char *));
1729 memmove(priv->video_timebuffer+priv->video_tail+1, priv->video_timebuffer+priv->video_tail,
1730 (priv->video_buffer_size_current-priv->video_tail)*sizeof(long long));
1731 priv->video_ringbuffer[priv->video_tail] = newbuf;
1732 if ((priv->video_head >= priv->video_tail) && (priv->video_cnt > 0)) priv->video_head++;
1733 priv->video_buffer_size_current++;
1734 }
1735 }
1736 }
1737 pthread_mutex_unlock(&priv->video_buffer_mutex);
1738
1739 if (priv->video_cnt == priv->video_buffer_size_current) {
1740 if (!priv->immediate_mode) {
1741 mp_msg(MSGT_TV, MSGL_ERR, "\nvideo buffer full - dropping frame\n");
1742 }
1743 } else {
1744 if (priv->immediate_mode) {
1745 priv->video_timebuffer[priv->video_tail] = interval;
1746 } else {
1747 // compensate for audio skew
1748 // negative skew => there are more audio samples, increase interval
1749 // positive skew => less samples, shorten the interval
1750 priv->video_timebuffer[priv->video_tail] = interval - skew;
1751 }
1752
1753 if ( priv->tv_param->mjpeg )
1754 copy_frame(priv, priv->video_ringbuffer[priv->video_tail],
1755 priv->mmap+(priv->mjpeg_bufsize)*i);
1756 else
1757 copy_frame(priv, priv->video_ringbuffer[priv->video_tail],
1758 priv->mmap+priv->mbuf.offsets[frame]);
1759 priv->video_tail = (priv->video_tail+1)%priv->video_buffer_size_current;
1760 priv->video_cnt++;
1761 }
1762
1763 if ( priv->tv_param->mjpeg )
1764 {
1765 num = frame;
1766 if (ioctl(priv->video_fd, MJPIOC_QBUF_CAPT, &num) < 0)
1767 {
1768 mp_msg(MSGT_TV, MSGL_ERR, "\n MJP: ioctl MJPIOC_QBUF_CAPT end failed: %s\n",
1769 strerror(errno));
1770 continue;
1771 }
1772 }
1773 else
1774 {
1775 if (ioctl(priv->video_fd, VIDIOCMCAPTURE, &priv->buf[frame]) == -1)
1776 {
1777 mp_msg(MSGT_TV, MSGL_ERR, "\nioctl mcapture failed: %s\n", strerror(errno));
1778 continue;
1779 }
1780 }
1781 }
1782 }
1783 mp_msg(MSGT_TV, MSGL_INFO, " MJP: returning! \n");
1784 return NULL;
1785 }
1786
1787 static double grab_video_frame(priv_t *priv, char *buffer, int len)
1788 {
1789 double interval;
1790
1791 if (priv->first) {
1792 pthread_create(&priv->video_grabber_thread, NULL, video_grabber, priv);
1793 priv->first = 0;
1794 }
1795
1796 while (priv->video_cnt == 0) {
1797 usleep(10000);
1798 }
1799
1800 pthread_mutex_lock(&priv->video_buffer_mutex);
1801 interval = (double)priv->video_timebuffer[priv->video_head]*1e-6;
1802 fast_memcpy(buffer, priv->video_ringbuffer[priv->video_head], len);
1803 priv->video_cnt--;
1804 priv->video_head = (priv->video_head+1)%priv->video_buffer_size_current;
1805 pthread_mutex_unlock(&priv->video_buffer_mutex);
1806
1807 return interval;
1808 }
1809
1810 static int get_video_framesize(priv_t *priv)
1811 {
1812 return priv->bytesperline * priv->height;
1813 }
1814
1815 static void *audio_grabber(void *data)
1816 {
1817 priv_t *priv = (priv_t*)data;
1818 struct timeval tv;
1819 int i, audio_skew_ptr = 0;
1820 long long current_time, prev_skew = 0;
1821
1822 pthread_mutex_lock(&priv->audio_starter);
1823
1824 audio_in_start_capture(&priv->audio_in);
1825 for (i = 0; i < priv->aud_skew_cnt; i++)
1826 priv->audio_skew_buffer[i] = 0;
1827
1828 for (; !priv->shutdown;)
1829 {
1830 if (audio_in_read_chunk(&priv->audio_in, priv->audio_ringbuffer+priv->audio_tail*priv->audio_in.blocksize) < 0)
1831 continue;
1832
1833 gettimeofday(&tv, NULL);
1834
1835 priv->audio_recv_blocks_total++;
1836 current_time = (long long)1e6*tv.tv_sec + tv.tv_usec - priv->starttime;
1837
1838 priv->audio_skew_total -= priv->audio_skew_buffer[audio_skew_ptr];
1839 priv->audio_skew_buffer[audio_skew_ptr] = current_time
1840 - 1e6*priv->audio_secs_per_block*priv->audio_recv_blocks_total;
1841 priv->audio_skew_total += priv->audio_skew_buffer[audio_skew_ptr];
1842 audio_skew_ptr = (audio_skew_ptr+1) % priv->aud_skew_cnt;
1843
1844 pthread_mutex_lock(&priv->skew_mutex);
1845 // linear interpolation - here we interpolate current skew value
1846 // from the moving average, which we expect to be in the middle
1847 // of the interval
1848 if (priv->audio_recv_blocks_total > priv->aud_skew_cnt) {
1849 priv->audio_skew = priv->audio_skew_total/priv->aud_skew_cnt;
1850 priv->audio_skew += (priv->audio_skew*priv->aud_skew_cnt)/(2*priv->audio_recv_blocks_total-priv->aud_skew_cnt);
1851 } else {
1852 // this smoothes the evolution of audio_skew at startup a bit
1853 priv->audio_skew = ((priv->aud_skew_cnt+priv->audio_recv_blocks_total)*priv->audio_skew_total)/(priv->aud_skew_cnt*priv->audio_recv_blocks_total);
1854 }
1855 // current skew factor (assuming linearity)
1856 // used for further interpolation in video_grabber
1857 // probably overkill but seems to be necessary for
1858 // stress testing by dropping half of the audio frames ;)
1859 // especially when using ALSA with large block sizes
1860 // where audio_skew remains a long while behind
1861 if ((priv->audio_skew_measure_time != 0) && (current_time - priv->audio_skew_measure_time != 0)) {
1862 priv->audio_skew_factor = (double)(priv->audio_skew-prev_skew)/(current_time - priv->audio_skew_measure_time);
1863 } else {
1864 priv->audio_skew_factor = 0.0;
1865 }
1866
1867 priv->audio_skew_measure_time = current_time;
1868 prev_skew = priv->audio_skew;
1869 pthread_mutex_unlock(&priv->skew_mutex);
1870
1871 if ((priv->audio_tail+1) % priv->audio_buffer_size == priv->audio_head) {
1872 mp_msg(MSGT_TV, MSGL_ERR, "\ntoo bad - dropping audio frame !\n");
1873 priv->audio_drop++;
1874 } else {
1875 priv->audio_tail = (priv->audio_tail+1) % priv->audio_buffer_size;
1876 priv->audio_cnt++;
1877 }
1878 }
1879 return NULL;
1880 }
1881
1882 static double grab_audio_frame(priv_t *priv, char *buffer, int len)
1883 {
1884 mp_dbg(MSGT_TV, MSGL_DBG2, "grab_audio_frame(priv=%p, buffer=%p, len=%d)\n",
1885 priv, buffer, len);
1886
1887 if (priv->first) {
1888 pthread_create(&priv->video_grabber_thread, NULL, video_grabber, priv);
1889 priv->first = 0;
1890 }
1891
1892 // compensate for dropped audio frames
1893 if (priv->audio_drop && (priv->audio_head == priv->audio_tail)) {
1894 priv->audio_drop--;
1895 priv->audio_sent_blocks_total++;
1896 memset(buffer, 0, len);
1897 return (double)priv->audio_sent_blocks_total*priv->audio_secs_per_block;
1898 }
1899
1900 while (priv->audio_head == priv->audio_tail) {
1901 usleep(10000);
1902 }
1903 fast_memcpy(buffer, priv->audio_ringbuffer+priv->audio_head*priv->audio_in.blocksize, len);
1904 priv->audio_head = (priv->audio_head+1) % priv->audio_buffer_size;
1905 priv->audio_cnt--;
1906 priv->audio_sent_blocks_total++;
1907 return (double)priv->audio_sent_blocks_total*priv->audio_secs_per_block;
1908 }
1909
1910 static int get_audio_framesize(priv_t *priv)
1911 {
1912 return priv->audio_in.blocksize;
1913 }
mplayer with SMedia Glamo drivers