3 * device driver for philips saa7134 based TV cards
4 * video4linux video interface
6 * (c) 2001-03 Gerd Knorr <kraxel@bytesex.org> [SuSE Labs]
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License as published by
10 * the Free Software Foundation; either version 2 of the License, or
11 * (at your option) any later version.
13 * This program is distributed in the hope that it will be useful,
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16 * GNU General Public License for more details.
18 * You should have received a copy of the GNU General Public License
19 * along with this program; if not, write to the Free Software
20 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
23 #include <linux/init.h>
24 #include <linux/list.h>
25 #include <linux/module.h>
26 #include <linux/kernel.h>
27 #include <linux/slab.h>
28 #include <linux/sort.h>
30 #include "saa7134-reg.h"
32 #include <media/v4l2-common.h>
33 #include <media/saa6588.h>
35 /* ------------------------------------------------------------------ */
37 unsigned int video_debug
;
38 static unsigned int gbuffers
= 8;
39 static unsigned int noninterlaced
; /* 0 */
40 static unsigned int gbufsize
= 720*576*4;
41 static unsigned int gbufsize_max
= 720*576*4;
42 static char secam
[] = "--";
43 module_param(video_debug
, int, 0644);
44 MODULE_PARM_DESC(video_debug
,"enable debug messages [video]");
45 module_param(gbuffers
, int, 0444);
46 MODULE_PARM_DESC(gbuffers
,"number of capture buffers, range 2-32");
47 module_param(noninterlaced
, int, 0644);
48 MODULE_PARM_DESC(noninterlaced
,"capture non interlaced video");
49 module_param_string(secam
, secam
, sizeof(secam
), 0644);
50 MODULE_PARM_DESC(secam
, "force SECAM variant, either DK,L or Lc");
53 #define dprintk(fmt, arg...) if (video_debug&0x04) \
54 printk(KERN_DEBUG "%s/video: " fmt, dev->name , ## arg)
56 /* ------------------------------------------------------------------ */
57 /* Defines for Video Output Port Register at address 0x191 */
59 /* Bit 0: VIP code T bit polarity */
61 #define VP_T_CODE_P_NON_INVERTED 0x00
62 #define VP_T_CODE_P_INVERTED 0x01
64 /* ------------------------------------------------------------------ */
65 /* Defines for Video Output Port Register at address 0x195 */
67 /* Bit 2: Video output clock delay control */
69 #define VP_CLK_CTRL2_NOT_DELAYED 0x00
70 #define VP_CLK_CTRL2_DELAYED 0x04
72 /* Bit 1: Video output clock invert control */
74 #define VP_CLK_CTRL1_NON_INVERTED 0x00
75 #define VP_CLK_CTRL1_INVERTED 0x02
77 /* ------------------------------------------------------------------ */
78 /* Defines for Video Output Port Register at address 0x196 */
80 /* Bits 2 to 0: VSYNC pin video vertical sync type */
82 #define VP_VS_TYPE_MASK 0x07
84 #define VP_VS_TYPE_OFF 0x00
85 #define VP_VS_TYPE_V123 0x01
86 #define VP_VS_TYPE_V_ITU 0x02
87 #define VP_VS_TYPE_VGATE_L 0x03
88 #define VP_VS_TYPE_RESERVED1 0x04
89 #define VP_VS_TYPE_RESERVED2 0x05
90 #define VP_VS_TYPE_F_ITU 0x06
91 #define VP_VS_TYPE_SC_FID 0x07
93 /* ------------------------------------------------------------------ */
94 /* data structs for video */
96 static int video_out
[][9] = {
97 [CCIR656
] = { 0x00, 0xb1, 0x00, 0xa1, 0x00, 0x04, 0x06, 0x00, 0x00 },
100 static struct saa7134_format formats
[] = {
102 .name
= "8 bpp gray",
103 .fourcc
= V4L2_PIX_FMT_GREY
,
107 .name
= "15 bpp RGB, le",
108 .fourcc
= V4L2_PIX_FMT_RGB555
,
112 .name
= "15 bpp RGB, be",
113 .fourcc
= V4L2_PIX_FMT_RGB555X
,
118 .name
= "16 bpp RGB, le",
119 .fourcc
= V4L2_PIX_FMT_RGB565
,
123 .name
= "16 bpp RGB, be",
124 .fourcc
= V4L2_PIX_FMT_RGB565X
,
129 .name
= "24 bpp RGB, le",
130 .fourcc
= V4L2_PIX_FMT_BGR24
,
134 .name
= "24 bpp RGB, be",
135 .fourcc
= V4L2_PIX_FMT_RGB24
,
140 .name
= "32 bpp RGB, le",
141 .fourcc
= V4L2_PIX_FMT_BGR32
,
145 .name
= "32 bpp RGB, be",
146 .fourcc
= V4L2_PIX_FMT_RGB32
,
152 .name
= "4:2:2 packed, YUYV",
153 .fourcc
= V4L2_PIX_FMT_YUYV
,
159 .name
= "4:2:2 packed, UYVY",
160 .fourcc
= V4L2_PIX_FMT_UYVY
,
165 .name
= "4:2:2 planar, Y-Cb-Cr",
166 .fourcc
= V4L2_PIX_FMT_YUV422P
,
174 .name
= "4:2:0 planar, Y-Cb-Cr",
175 .fourcc
= V4L2_PIX_FMT_YUV420
,
183 .name
= "4:2:0 planar, Y-Cb-Cr",
184 .fourcc
= V4L2_PIX_FMT_YVU420
,
194 #define FORMATS ARRAY_SIZE(formats)
196 #define NORM_625_50 \
199 .video_v_start = 24, \
200 .video_v_stop = 311, \
201 .vbi_v_start_0 = 7, \
202 .vbi_v_stop_0 = 22, \
203 .vbi_v_start_1 = 319, \
206 #define NORM_525_60 \
209 .video_v_start = 23, \
210 .video_v_stop = 262, \
211 .vbi_v_start_0 = 10, \
212 .vbi_v_stop_0 = 21, \
213 .vbi_v_start_1 = 273, \
216 static struct saa7134_tvnorm tvnorms
[] = {
218 .name
= "PAL", /* autodetect */
222 .sync_control
= 0x18,
223 .luma_control
= 0x40,
224 .chroma_ctrl1
= 0x81,
226 .chroma_ctrl2
= 0x06,
231 .id
= V4L2_STD_PAL_BG
,
234 .sync_control
= 0x18,
235 .luma_control
= 0x40,
236 .chroma_ctrl1
= 0x81,
238 .chroma_ctrl2
= 0x06,
243 .id
= V4L2_STD_PAL_I
,
246 .sync_control
= 0x18,
247 .luma_control
= 0x40,
248 .chroma_ctrl1
= 0x81,
250 .chroma_ctrl2
= 0x06,
255 .id
= V4L2_STD_PAL_DK
,
258 .sync_control
= 0x18,
259 .luma_control
= 0x40,
260 .chroma_ctrl1
= 0x81,
262 .chroma_ctrl2
= 0x06,
270 .sync_control
= 0x59,
271 .luma_control
= 0x40,
272 .chroma_ctrl1
= 0x89,
274 .chroma_ctrl2
= 0x0e,
279 .id
= V4L2_STD_SECAM
,
282 .sync_control
= 0x18,
283 .luma_control
= 0x1b,
284 .chroma_ctrl1
= 0xd1,
286 .chroma_ctrl2
= 0x00,
291 .id
= V4L2_STD_SECAM_DK
,
294 .sync_control
= 0x18,
295 .luma_control
= 0x1b,
296 .chroma_ctrl1
= 0xd1,
298 .chroma_ctrl2
= 0x00,
303 .id
= V4L2_STD_SECAM_L
,
306 .sync_control
= 0x18,
307 .luma_control
= 0x1b,
308 .chroma_ctrl1
= 0xd1,
310 .chroma_ctrl2
= 0x00,
315 .id
= V4L2_STD_SECAM_LC
,
318 .sync_control
= 0x18,
319 .luma_control
= 0x1b,
320 .chroma_ctrl1
= 0xd1,
322 .chroma_ctrl2
= 0x00,
327 .id
= V4L2_STD_PAL_M
,
330 .sync_control
= 0x59,
331 .luma_control
= 0x40,
332 .chroma_ctrl1
= 0xb9,
334 .chroma_ctrl2
= 0x0e,
339 .id
= V4L2_STD_PAL_Nc
,
342 .sync_control
= 0x18,
343 .luma_control
= 0x40,
344 .chroma_ctrl1
= 0xa1,
346 .chroma_ctrl2
= 0x06,
351 .id
= V4L2_STD_PAL_60
,
359 .vbi_v_start_1
= 273,
362 .sync_control
= 0x18,
363 .luma_control
= 0x40,
364 .chroma_ctrl1
= 0x81,
366 .chroma_ctrl2
= 0x06,
370 #define TVNORMS ARRAY_SIZE(tvnorms)
372 #define V4L2_CID_PRIVATE_INVERT (V4L2_CID_PRIVATE_BASE + 0)
373 #define V4L2_CID_PRIVATE_Y_ODD (V4L2_CID_PRIVATE_BASE + 1)
374 #define V4L2_CID_PRIVATE_Y_EVEN (V4L2_CID_PRIVATE_BASE + 2)
375 #define V4L2_CID_PRIVATE_AUTOMUTE (V4L2_CID_PRIVATE_BASE + 3)
376 #define V4L2_CID_PRIVATE_LASTP1 (V4L2_CID_PRIVATE_BASE + 4)
378 static const struct v4l2_queryctrl no_ctrl
= {
380 .flags
= V4L2_CTRL_FLAG_DISABLED
,
382 static const struct v4l2_queryctrl video_ctrls
[] = {
385 .id
= V4L2_CID_BRIGHTNESS
,
386 .name
= "Brightness",
390 .default_value
= 128,
391 .type
= V4L2_CTRL_TYPE_INTEGER
,
393 .id
= V4L2_CID_CONTRAST
,
399 .type
= V4L2_CTRL_TYPE_INTEGER
,
401 .id
= V4L2_CID_SATURATION
,
402 .name
= "Saturation",
407 .type
= V4L2_CTRL_TYPE_INTEGER
,
415 .type
= V4L2_CTRL_TYPE_INTEGER
,
417 .id
= V4L2_CID_HFLIP
,
421 .type
= V4L2_CTRL_TYPE_BOOLEAN
,
425 .id
= V4L2_CID_AUDIO_MUTE
,
429 .type
= V4L2_CTRL_TYPE_BOOLEAN
,
431 .id
= V4L2_CID_AUDIO_VOLUME
,
437 .type
= V4L2_CTRL_TYPE_INTEGER
,
439 /* --- private --- */
441 .id
= V4L2_CID_PRIVATE_INVERT
,
445 .type
= V4L2_CTRL_TYPE_BOOLEAN
,
447 .id
= V4L2_CID_PRIVATE_Y_ODD
,
448 .name
= "y offset odd field",
453 .type
= V4L2_CTRL_TYPE_INTEGER
,
455 .id
= V4L2_CID_PRIVATE_Y_EVEN
,
456 .name
= "y offset even field",
461 .type
= V4L2_CTRL_TYPE_INTEGER
,
463 .id
= V4L2_CID_PRIVATE_AUTOMUTE
,
468 .type
= V4L2_CTRL_TYPE_BOOLEAN
,
471 static const unsigned int CTRLS
= ARRAY_SIZE(video_ctrls
);
473 static const struct v4l2_queryctrl
* ctrl_by_id(unsigned int id
)
477 for (i
= 0; i
< CTRLS
; i
++)
478 if (video_ctrls
[i
].id
== id
)
479 return video_ctrls
+i
;
483 static struct saa7134_format
* format_by_fourcc(unsigned int fourcc
)
487 for (i
= 0; i
< FORMATS
; i
++)
488 if (formats
[i
].fourcc
== fourcc
)
493 /* ----------------------------------------------------------------------- */
494 /* resource management */
496 static int res_get(struct saa7134_dev
*dev
, struct saa7134_fh
*fh
, unsigned int bit
)
498 if (fh
->resources
& bit
)
499 /* have it already allocated */
503 mutex_lock(&dev
->lock
);
504 if (dev
->resources
& bit
) {
505 /* no, someone else uses it */
506 mutex_unlock(&dev
->lock
);
509 /* it's free, grab it */
510 fh
->resources
|= bit
;
511 dev
->resources
|= bit
;
512 dprintk("res: get %d\n",bit
);
513 mutex_unlock(&dev
->lock
);
517 static int res_check(struct saa7134_fh
*fh
, unsigned int bit
)
519 return (fh
->resources
& bit
);
522 static int res_locked(struct saa7134_dev
*dev
, unsigned int bit
)
524 return (dev
->resources
& bit
);
528 void res_free(struct saa7134_dev
*dev
, struct saa7134_fh
*fh
, unsigned int bits
)
530 BUG_ON((fh
->resources
& bits
) != bits
);
532 mutex_lock(&dev
->lock
);
533 fh
->resources
&= ~bits
;
534 dev
->resources
&= ~bits
;
535 dprintk("res: put %d\n",bits
);
536 mutex_unlock(&dev
->lock
);
539 /* ------------------------------------------------------------------ */
541 static void set_tvnorm(struct saa7134_dev
*dev
, struct saa7134_tvnorm
*norm
)
543 dprintk("set tv norm = %s\n",norm
->name
);
547 dev
->crop_bounds
.left
= norm
->h_start
;
548 dev
->crop_defrect
.left
= norm
->h_start
;
549 dev
->crop_bounds
.width
= norm
->h_stop
- norm
->h_start
+1;
550 dev
->crop_defrect
.width
= norm
->h_stop
- norm
->h_start
+1;
552 dev
->crop_bounds
.top
= (norm
->vbi_v_stop_0
+1)*2;
553 dev
->crop_defrect
.top
= norm
->video_v_start
*2;
554 dev
->crop_bounds
.height
= ((norm
->id
& V4L2_STD_525_60
) ? 524 : 624)
555 - dev
->crop_bounds
.top
;
556 dev
->crop_defrect
.height
= (norm
->video_v_stop
- norm
->video_v_start
+1)*2;
558 dev
->crop_current
= dev
->crop_defrect
;
560 saa7134_set_tvnorm_hw(dev
);
563 static void video_mux(struct saa7134_dev
*dev
, int input
)
565 dprintk("video input = %d [%s]\n", input
, card_in(dev
, input
).name
);
566 dev
->ctl_input
= input
;
567 set_tvnorm(dev
, dev
->tvnorm
);
568 saa7134_tvaudio_setinput(dev
, &card_in(dev
, input
));
572 static void saa7134_set_decoder(struct saa7134_dev
*dev
)
574 int luma_control
, sync_control
, mux
;
576 struct saa7134_tvnorm
*norm
= dev
->tvnorm
;
577 mux
= card_in(dev
, dev
->ctl_input
).vmux
;
579 luma_control
= norm
->luma_control
;
580 sync_control
= norm
->sync_control
;
583 luma_control
|= 0x80; /* svideo */
584 if (noninterlaced
|| dev
->nosignal
)
585 sync_control
|= 0x20;
587 /* setup video decoder */
588 saa_writeb(SAA7134_INCR_DELAY
, 0x08);
589 saa_writeb(SAA7134_ANALOG_IN_CTRL1
, 0xc0 | mux
);
590 saa_writeb(SAA7134_ANALOG_IN_CTRL2
, 0x00);
592 saa_writeb(SAA7134_ANALOG_IN_CTRL3
, 0x90);
593 saa_writeb(SAA7134_ANALOG_IN_CTRL4
, 0x90);
594 saa_writeb(SAA7134_HSYNC_START
, 0xeb);
595 saa_writeb(SAA7134_HSYNC_STOP
, 0xe0);
596 saa_writeb(SAA7134_SOURCE_TIMING1
, norm
->src_timing
);
598 saa_writeb(SAA7134_SYNC_CTRL
, sync_control
);
599 saa_writeb(SAA7134_LUMA_CTRL
, luma_control
);
600 saa_writeb(SAA7134_DEC_LUMA_BRIGHT
, dev
->ctl_bright
);
602 saa_writeb(SAA7134_DEC_LUMA_CONTRAST
,
603 dev
->ctl_invert
? -dev
->ctl_contrast
: dev
->ctl_contrast
);
605 saa_writeb(SAA7134_DEC_CHROMA_SATURATION
,
606 dev
->ctl_invert
? -dev
->ctl_saturation
: dev
->ctl_saturation
);
608 saa_writeb(SAA7134_DEC_CHROMA_HUE
, dev
->ctl_hue
);
609 saa_writeb(SAA7134_CHROMA_CTRL1
, norm
->chroma_ctrl1
);
610 saa_writeb(SAA7134_CHROMA_GAIN
, norm
->chroma_gain
);
612 saa_writeb(SAA7134_CHROMA_CTRL2
, norm
->chroma_ctrl2
);
613 saa_writeb(SAA7134_MODE_DELAY_CTRL
, 0x00);
615 saa_writeb(SAA7134_ANALOG_ADC
, 0x01);
616 saa_writeb(SAA7134_VGATE_START
, 0x11);
617 saa_writeb(SAA7134_VGATE_STOP
, 0xfe);
618 saa_writeb(SAA7134_MISC_VGATE_MSB
, norm
->vgate_misc
);
619 saa_writeb(SAA7134_RAW_DATA_GAIN
, 0x40);
620 saa_writeb(SAA7134_RAW_DATA_OFFSET
, 0x80);
623 void saa7134_set_tvnorm_hw(struct saa7134_dev
*dev
)
625 saa7134_set_decoder(dev
);
627 if (card_in(dev
, dev
->ctl_input
).tv
)
628 saa_call_all(dev
, core
, s_std
, dev
->tvnorm
->id
);
629 /* Set the correct norm for the saa6752hs. This function
630 does nothing if there is no saa6752hs. */
631 saa_call_empress(dev
, core
, s_std
, dev
->tvnorm
->id
);
634 static void set_h_prescale(struct saa7134_dev
*dev
, int task
, int prescale
)
636 static const struct {
643 /* XPSC XACL XC2_1 XDCG VPFY */
655 static const int count
= ARRAY_SIZE(vals
);
658 for (i
= 0; i
< count
; i
++)
659 if (vals
[i
].xpsc
== prescale
)
664 saa_writeb(SAA7134_H_PRESCALE(task
), vals
[i
].xpsc
);
665 saa_writeb(SAA7134_ACC_LENGTH(task
), vals
[i
].xacl
);
666 saa_writeb(SAA7134_LEVEL_CTRL(task
),
667 (vals
[i
].xc2_1
<< 3) | (vals
[i
].xdcg
));
668 saa_andorb(SAA7134_FIR_PREFILTER_CTRL(task
), 0x0f,
669 (vals
[i
].vpfy
<< 2) | vals
[i
].vpfy
);
672 static void set_v_scale(struct saa7134_dev
*dev
, int task
, int yscale
)
676 saa_writeb(SAA7134_V_SCALE_RATIO1(task
), yscale
& 0xff);
677 saa_writeb(SAA7134_V_SCALE_RATIO2(task
), yscale
>> 8);
679 mirror
= (dev
->ctl_mirror
) ? 0x02 : 0x00;
682 dprintk("yscale LPI yscale=%d\n",yscale
);
683 saa_writeb(SAA7134_V_FILTER(task
), 0x00 | mirror
);
684 saa_writeb(SAA7134_LUMA_CONTRAST(task
), 0x40);
685 saa_writeb(SAA7134_CHROMA_SATURATION(task
), 0x40);
688 val
= 0x40 * 1024 / yscale
;
689 dprintk("yscale ACM yscale=%d val=0x%x\n",yscale
,val
);
690 saa_writeb(SAA7134_V_FILTER(task
), 0x01 | mirror
);
691 saa_writeb(SAA7134_LUMA_CONTRAST(task
), val
);
692 saa_writeb(SAA7134_CHROMA_SATURATION(task
), val
);
694 saa_writeb(SAA7134_LUMA_BRIGHT(task
), 0x80);
697 static void set_size(struct saa7134_dev
*dev
, int task
,
698 int width
, int height
, int interlace
)
700 int prescale
,xscale
,yscale
,y_even
,y_odd
;
701 int h_start
, h_stop
, v_start
, v_stop
;
702 int div
= interlace
? 2 : 1;
704 /* setup video scaler */
705 h_start
= dev
->crop_current
.left
;
706 v_start
= dev
->crop_current
.top
/2;
707 h_stop
= (dev
->crop_current
.left
+ dev
->crop_current
.width
-1);
708 v_stop
= (dev
->crop_current
.top
+ dev
->crop_current
.height
-1)/2;
710 saa_writeb(SAA7134_VIDEO_H_START1(task
), h_start
& 0xff);
711 saa_writeb(SAA7134_VIDEO_H_START2(task
), h_start
>> 8);
712 saa_writeb(SAA7134_VIDEO_H_STOP1(task
), h_stop
& 0xff);
713 saa_writeb(SAA7134_VIDEO_H_STOP2(task
), h_stop
>> 8);
714 saa_writeb(SAA7134_VIDEO_V_START1(task
), v_start
& 0xff);
715 saa_writeb(SAA7134_VIDEO_V_START2(task
), v_start
>> 8);
716 saa_writeb(SAA7134_VIDEO_V_STOP1(task
), v_stop
& 0xff);
717 saa_writeb(SAA7134_VIDEO_V_STOP2(task
), v_stop
>> 8);
719 prescale
= dev
->crop_current
.width
/ width
;
722 xscale
= 1024 * dev
->crop_current
.width
/ prescale
/ width
;
723 yscale
= 512 * div
* dev
->crop_current
.height
/ height
;
724 dprintk("prescale=%d xscale=%d yscale=%d\n",prescale
,xscale
,yscale
);
725 set_h_prescale(dev
,task
,prescale
);
726 saa_writeb(SAA7134_H_SCALE_INC1(task
), xscale
& 0xff);
727 saa_writeb(SAA7134_H_SCALE_INC2(task
), xscale
>> 8);
728 set_v_scale(dev
,task
,yscale
);
730 saa_writeb(SAA7134_VIDEO_PIXELS1(task
), width
& 0xff);
731 saa_writeb(SAA7134_VIDEO_PIXELS2(task
), width
>> 8);
732 saa_writeb(SAA7134_VIDEO_LINES1(task
), height
/div
& 0xff);
733 saa_writeb(SAA7134_VIDEO_LINES2(task
), height
/div
>> 8);
735 /* deinterlace y offsets */
736 y_odd
= dev
->ctl_y_odd
;
737 y_even
= dev
->ctl_y_even
;
738 saa_writeb(SAA7134_V_PHASE_OFFSET0(task
), y_odd
);
739 saa_writeb(SAA7134_V_PHASE_OFFSET1(task
), y_even
);
740 saa_writeb(SAA7134_V_PHASE_OFFSET2(task
), y_odd
);
741 saa_writeb(SAA7134_V_PHASE_OFFSET3(task
), y_even
);
744 /* ------------------------------------------------------------------ */
752 static void set_cliplist(struct saa7134_dev
*dev
, int reg
,
753 struct cliplist
*cl
, int entries
, char *name
)
758 for (i
= 0; i
< entries
; i
++) {
759 winbits
|= cl
[i
].enable
;
760 winbits
&= ~cl
[i
].disable
;
761 if (i
< 15 && cl
[i
].position
== cl
[i
+1].position
)
763 saa_writeb(reg
+ 0, winbits
);
764 saa_writeb(reg
+ 2, cl
[i
].position
& 0xff);
765 saa_writeb(reg
+ 3, cl
[i
].position
>> 8);
766 dprintk("clip: %s winbits=%02x pos=%d\n",
767 name
,winbits
,cl
[i
].position
);
770 for (; reg
< 0x400; reg
+= 8) {
771 saa_writeb(reg
+ 0, 0);
772 saa_writeb(reg
+ 1, 0);
773 saa_writeb(reg
+ 2, 0);
774 saa_writeb(reg
+ 3, 0);
778 static int clip_range(int val
)
785 /* Sort into smallest position first order */
786 static int cliplist_cmp(const void *a
, const void *b
)
788 const struct cliplist
*cla
= a
;
789 const struct cliplist
*clb
= b
;
790 if (cla
->position
< clb
->position
)
792 if (cla
->position
> clb
->position
)
797 static int setup_clipping(struct saa7134_dev
*dev
, struct v4l2_clip
*clips
,
798 int nclips
, int interlace
)
800 struct cliplist col
[16], row
[16];
801 int cols
= 0, rows
= 0, i
;
802 int div
= interlace
? 2 : 1;
804 memset(col
, 0, sizeof(col
));
805 memset(row
, 0, sizeof(row
));
806 for (i
= 0; i
< nclips
&& i
< 8; i
++) {
807 col
[cols
].position
= clip_range(clips
[i
].c
.left
);
808 col
[cols
].enable
= (1 << i
);
810 col
[cols
].position
= clip_range(clips
[i
].c
.left
+clips
[i
].c
.width
);
811 col
[cols
].disable
= (1 << i
);
813 row
[rows
].position
= clip_range(clips
[i
].c
.top
/ div
);
814 row
[rows
].enable
= (1 << i
);
816 row
[rows
].position
= clip_range((clips
[i
].c
.top
+ clips
[i
].c
.height
)
818 row
[rows
].disable
= (1 << i
);
821 sort(col
, cols
, sizeof col
[0], cliplist_cmp
, NULL
);
822 sort(row
, rows
, sizeof row
[0], cliplist_cmp
, NULL
);
823 set_cliplist(dev
,0x380,col
,cols
,"cols");
824 set_cliplist(dev
,0x384,row
,rows
,"rows");
828 static int verify_preview(struct saa7134_dev
*dev
, struct v4l2_window
*win
)
830 enum v4l2_field field
;
833 if (NULL
== dev
->ovbuf
.base
)
835 if (NULL
== dev
->ovfmt
)
837 if (win
->w
.width
< 48 || win
->w
.height
< 32)
839 if (win
->clipcount
> 2048)
843 maxw
= dev
->crop_current
.width
;
844 maxh
= dev
->crop_current
.height
;
846 if (V4L2_FIELD_ANY
== field
) {
847 field
= (win
->w
.height
> maxh
/2)
848 ? V4L2_FIELD_INTERLACED
853 case V4L2_FIELD_BOTTOM
:
856 case V4L2_FIELD_INTERLACED
:
863 if (win
->w
.width
> maxw
)
865 if (win
->w
.height
> maxh
)
866 win
->w
.height
= maxh
;
870 static int start_preview(struct saa7134_dev
*dev
, struct saa7134_fh
*fh
)
872 unsigned long base
,control
,bpl
;
875 err
= verify_preview(dev
,&fh
->win
);
879 dev
->ovfield
= fh
->win
.field
;
880 dprintk("start_preview %dx%d+%d+%d %s field=%s\n",
881 fh
->win
.w
.width
,fh
->win
.w
.height
,
882 fh
->win
.w
.left
,fh
->win
.w
.top
,
883 dev
->ovfmt
->name
,v4l2_field_names
[dev
->ovfield
]);
885 /* setup window + clipping */
886 set_size(dev
,TASK_B
,fh
->win
.w
.width
,fh
->win
.w
.height
,
887 V4L2_FIELD_HAS_BOTH(dev
->ovfield
));
888 setup_clipping(dev
,fh
->clips
,fh
->nclips
,
889 V4L2_FIELD_HAS_BOTH(dev
->ovfield
));
891 saa_andorb(SAA7134_DATA_PATH(TASK_B
), 0x3f, 0x03);
893 saa_andorb(SAA7134_DATA_PATH(TASK_B
), 0x3f, 0x01);
894 saa_writeb(SAA7134_OFMT_VIDEO_B
, dev
->ovfmt
->pm
| 0x20);
896 /* dma: setup channel 1 (= Video Task B) */
897 base
= (unsigned long)dev
->ovbuf
.base
;
898 base
+= dev
->ovbuf
.fmt
.bytesperline
* fh
->win
.w
.top
;
899 base
+= dev
->ovfmt
->depth
/8 * fh
->win
.w
.left
;
900 bpl
= dev
->ovbuf
.fmt
.bytesperline
;
901 control
= SAA7134_RS_CONTROL_BURST_16
;
902 if (dev
->ovfmt
->bswap
)
903 control
|= SAA7134_RS_CONTROL_BSWAP
;
904 if (dev
->ovfmt
->wswap
)
905 control
|= SAA7134_RS_CONTROL_WSWAP
;
906 if (V4L2_FIELD_HAS_BOTH(dev
->ovfield
)) {
907 saa_writel(SAA7134_RS_BA1(1),base
);
908 saa_writel(SAA7134_RS_BA2(1),base
+bpl
);
909 saa_writel(SAA7134_RS_PITCH(1),bpl
*2);
910 saa_writel(SAA7134_RS_CONTROL(1),control
);
912 saa_writel(SAA7134_RS_BA1(1),base
);
913 saa_writel(SAA7134_RS_BA2(1),base
);
914 saa_writel(SAA7134_RS_PITCH(1),bpl
);
915 saa_writel(SAA7134_RS_CONTROL(1),control
);
920 saa7134_set_dmabits(dev
);
925 static int stop_preview(struct saa7134_dev
*dev
, struct saa7134_fh
*fh
)
928 saa7134_set_dmabits(dev
);
932 /* ------------------------------------------------------------------ */
934 static int buffer_activate(struct saa7134_dev
*dev
,
935 struct saa7134_buf
*buf
,
936 struct saa7134_buf
*next
)
938 unsigned long base
,control
,bpl
;
939 unsigned long bpl_uv
,lines_uv
,base2
,base3
,tmp
; /* planar */
941 dprintk("buffer_activate buf=%p\n",buf
);
942 buf
->vb
.state
= VIDEOBUF_ACTIVE
;
945 set_size(dev
,TASK_A
,buf
->vb
.width
,buf
->vb
.height
,
946 V4L2_FIELD_HAS_BOTH(buf
->vb
.field
));
948 saa_andorb(SAA7134_DATA_PATH(TASK_A
), 0x3f, 0x03);
950 saa_andorb(SAA7134_DATA_PATH(TASK_A
), 0x3f, 0x01);
951 saa_writeb(SAA7134_OFMT_VIDEO_A
, buf
->fmt
->pm
);
953 /* DMA: setup channel 0 (= Video Task A0) */
954 base
= saa7134_buffer_base(buf
);
955 if (buf
->fmt
->planar
)
958 bpl
= (buf
->vb
.width
* buf
->fmt
->depth
) / 8;
959 control
= SAA7134_RS_CONTROL_BURST_16
|
960 SAA7134_RS_CONTROL_ME
|
961 (buf
->pt
->dma
>> 12);
963 control
|= SAA7134_RS_CONTROL_BSWAP
;
965 control
|= SAA7134_RS_CONTROL_WSWAP
;
966 if (V4L2_FIELD_HAS_BOTH(buf
->vb
.field
)) {
968 saa_writel(SAA7134_RS_BA1(0),base
);
969 saa_writel(SAA7134_RS_BA2(0),base
+bpl
);
970 saa_writel(SAA7134_RS_PITCH(0),bpl
*2);
973 saa_writel(SAA7134_RS_BA1(0),base
);
974 saa_writel(SAA7134_RS_BA2(0),base
);
975 saa_writel(SAA7134_RS_PITCH(0),bpl
);
977 saa_writel(SAA7134_RS_CONTROL(0),control
);
979 if (buf
->fmt
->planar
) {
980 /* DMA: setup channel 4+5 (= planar task A) */
981 bpl_uv
= bpl
>> buf
->fmt
->hshift
;
982 lines_uv
= buf
->vb
.height
>> buf
->fmt
->vshift
;
983 base2
= base
+ bpl
* buf
->vb
.height
;
984 base3
= base2
+ bpl_uv
* lines_uv
;
985 if (buf
->fmt
->uvswap
)
986 tmp
= base2
, base2
= base3
, base3
= tmp
;
987 dprintk("uv: bpl=%ld lines=%ld base2/3=%ld/%ld\n",
988 bpl_uv
,lines_uv
,base2
,base3
);
989 if (V4L2_FIELD_HAS_BOTH(buf
->vb
.field
)) {
991 saa_writel(SAA7134_RS_BA1(4),base2
);
992 saa_writel(SAA7134_RS_BA2(4),base2
+bpl_uv
);
993 saa_writel(SAA7134_RS_PITCH(4),bpl_uv
*2);
994 saa_writel(SAA7134_RS_BA1(5),base3
);
995 saa_writel(SAA7134_RS_BA2(5),base3
+bpl_uv
);
996 saa_writel(SAA7134_RS_PITCH(5),bpl_uv
*2);
999 saa_writel(SAA7134_RS_BA1(4),base2
);
1000 saa_writel(SAA7134_RS_BA2(4),base2
);
1001 saa_writel(SAA7134_RS_PITCH(4),bpl_uv
);
1002 saa_writel(SAA7134_RS_BA1(5),base3
);
1003 saa_writel(SAA7134_RS_BA2(5),base3
);
1004 saa_writel(SAA7134_RS_PITCH(5),bpl_uv
);
1006 saa_writel(SAA7134_RS_CONTROL(4),control
);
1007 saa_writel(SAA7134_RS_CONTROL(5),control
);
1011 saa7134_set_dmabits(dev
);
1012 mod_timer(&dev
->video_q
.timeout
, jiffies
+BUFFER_TIMEOUT
);
1016 static int buffer_prepare(struct videobuf_queue
*q
,
1017 struct videobuf_buffer
*vb
,
1018 enum v4l2_field field
)
1020 struct saa7134_fh
*fh
= q
->priv_data
;
1021 struct saa7134_dev
*dev
= fh
->dev
;
1022 struct saa7134_buf
*buf
= container_of(vb
,struct saa7134_buf
,vb
);
1027 if (NULL
== fh
->fmt
)
1029 if (fh
->width
< 48 ||
1031 fh
->width
/4 > dev
->crop_current
.width
||
1032 fh
->height
/4 > dev
->crop_current
.height
||
1033 fh
->width
> dev
->crop_bounds
.width
||
1034 fh
->height
> dev
->crop_bounds
.height
)
1036 size
= (fh
->width
* fh
->height
* fh
->fmt
->depth
) >> 3;
1037 if (0 != buf
->vb
.baddr
&& buf
->vb
.bsize
< size
)
1040 dprintk("buffer_prepare [%d,size=%dx%d,bytes=%d,fields=%s,%s]\n",
1041 vb
->i
,fh
->width
,fh
->height
,size
,v4l2_field_names
[field
],
1043 if (buf
->vb
.width
!= fh
->width
||
1044 buf
->vb
.height
!= fh
->height
||
1045 buf
->vb
.size
!= size
||
1046 buf
->vb
.field
!= field
||
1047 buf
->fmt
!= fh
->fmt
) {
1048 saa7134_dma_free(q
,buf
);
1051 if (VIDEOBUF_NEEDS_INIT
== buf
->vb
.state
) {
1052 struct videobuf_dmabuf
*dma
=videobuf_to_dma(&buf
->vb
);
1054 buf
->vb
.width
= fh
->width
;
1055 buf
->vb
.height
= fh
->height
;
1056 buf
->vb
.size
= size
;
1057 buf
->vb
.field
= field
;
1059 buf
->pt
= &fh
->pt_cap
;
1060 dev
->video_q
.curr
= NULL
;
1062 err
= videobuf_iolock(q
,&buf
->vb
,&dev
->ovbuf
);
1065 err
= saa7134_pgtable_build(dev
->pci
,buf
->pt
,
1068 saa7134_buffer_startpage(buf
));
1072 buf
->vb
.state
= VIDEOBUF_PREPARED
;
1073 buf
->activate
= buffer_activate
;
1077 saa7134_dma_free(q
,buf
);
1082 buffer_setup(struct videobuf_queue
*q
, unsigned int *count
, unsigned int *size
)
1084 struct saa7134_fh
*fh
= q
->priv_data
;
1086 *size
= fh
->fmt
->depth
* fh
->width
* fh
->height
>> 3;
1089 *count
= saa7134_buffer_count(*size
,*count
);
1093 static void buffer_queue(struct videobuf_queue
*q
, struct videobuf_buffer
*vb
)
1095 struct saa7134_fh
*fh
= q
->priv_data
;
1096 struct saa7134_buf
*buf
= container_of(vb
,struct saa7134_buf
,vb
);
1098 saa7134_buffer_queue(fh
->dev
,&fh
->dev
->video_q
,buf
);
1101 static void buffer_release(struct videobuf_queue
*q
, struct videobuf_buffer
*vb
)
1103 struct saa7134_buf
*buf
= container_of(vb
,struct saa7134_buf
,vb
);
1105 saa7134_dma_free(q
,buf
);
1108 static struct videobuf_queue_ops video_qops
= {
1109 .buf_setup
= buffer_setup
,
1110 .buf_prepare
= buffer_prepare
,
1111 .buf_queue
= buffer_queue
,
1112 .buf_release
= buffer_release
,
1115 /* ------------------------------------------------------------------ */
1117 int saa7134_g_ctrl_internal(struct saa7134_dev
*dev
, struct saa7134_fh
*fh
, struct v4l2_control
*c
)
1119 const struct v4l2_queryctrl
* ctrl
;
1121 ctrl
= ctrl_by_id(c
->id
);
1125 case V4L2_CID_BRIGHTNESS
:
1126 c
->value
= dev
->ctl_bright
;
1129 c
->value
= dev
->ctl_hue
;
1131 case V4L2_CID_CONTRAST
:
1132 c
->value
= dev
->ctl_contrast
;
1134 case V4L2_CID_SATURATION
:
1135 c
->value
= dev
->ctl_saturation
;
1137 case V4L2_CID_AUDIO_MUTE
:
1138 c
->value
= dev
->ctl_mute
;
1140 case V4L2_CID_AUDIO_VOLUME
:
1141 c
->value
= dev
->ctl_volume
;
1143 case V4L2_CID_PRIVATE_INVERT
:
1144 c
->value
= dev
->ctl_invert
;
1146 case V4L2_CID_HFLIP
:
1147 c
->value
= dev
->ctl_mirror
;
1149 case V4L2_CID_PRIVATE_Y_EVEN
:
1150 c
->value
= dev
->ctl_y_even
;
1152 case V4L2_CID_PRIVATE_Y_ODD
:
1153 c
->value
= dev
->ctl_y_odd
;
1155 case V4L2_CID_PRIVATE_AUTOMUTE
:
1156 c
->value
= dev
->ctl_automute
;
1163 EXPORT_SYMBOL_GPL(saa7134_g_ctrl_internal
);
1165 static int saa7134_g_ctrl(struct file
*file
, void *priv
, struct v4l2_control
*c
)
1167 struct saa7134_fh
*fh
= priv
;
1169 return saa7134_g_ctrl_internal(fh
->dev
, fh
, c
);
1172 int saa7134_s_ctrl_internal(struct saa7134_dev
*dev
, struct saa7134_fh
*fh
, struct v4l2_control
*c
)
1174 const struct v4l2_queryctrl
* ctrl
;
1175 unsigned long flags
;
1176 int restart_overlay
= 0;
1179 /* When called from the empress code fh == NULL.
1180 That needs to be fixed somehow, but for now this is
1183 err
= v4l2_prio_check(&dev
->prio
, fh
->prio
);
1189 mutex_lock(&dev
->lock
);
1191 ctrl
= ctrl_by_id(c
->id
);
1195 dprintk("set_control name=%s val=%d\n",ctrl
->name
,c
->value
);
1196 switch (ctrl
->type
) {
1197 case V4L2_CTRL_TYPE_BOOLEAN
:
1198 case V4L2_CTRL_TYPE_MENU
:
1199 case V4L2_CTRL_TYPE_INTEGER
:
1200 if (c
->value
< ctrl
->minimum
)
1201 c
->value
= ctrl
->minimum
;
1202 if (c
->value
> ctrl
->maximum
)
1203 c
->value
= ctrl
->maximum
;
1209 case V4L2_CID_BRIGHTNESS
:
1210 dev
->ctl_bright
= c
->value
;
1211 saa_writeb(SAA7134_DEC_LUMA_BRIGHT
, dev
->ctl_bright
);
1214 dev
->ctl_hue
= c
->value
;
1215 saa_writeb(SAA7134_DEC_CHROMA_HUE
, dev
->ctl_hue
);
1217 case V4L2_CID_CONTRAST
:
1218 dev
->ctl_contrast
= c
->value
;
1219 saa_writeb(SAA7134_DEC_LUMA_CONTRAST
,
1220 dev
->ctl_invert
? -dev
->ctl_contrast
: dev
->ctl_contrast
);
1222 case V4L2_CID_SATURATION
:
1223 dev
->ctl_saturation
= c
->value
;
1224 saa_writeb(SAA7134_DEC_CHROMA_SATURATION
,
1225 dev
->ctl_invert
? -dev
->ctl_saturation
: dev
->ctl_saturation
);
1227 case V4L2_CID_AUDIO_MUTE
:
1228 dev
->ctl_mute
= c
->value
;
1229 saa7134_tvaudio_setmute(dev
);
1231 case V4L2_CID_AUDIO_VOLUME
:
1232 dev
->ctl_volume
= c
->value
;
1233 saa7134_tvaudio_setvolume(dev
,dev
->ctl_volume
);
1235 case V4L2_CID_PRIVATE_INVERT
:
1236 dev
->ctl_invert
= c
->value
;
1237 saa_writeb(SAA7134_DEC_LUMA_CONTRAST
,
1238 dev
->ctl_invert
? -dev
->ctl_contrast
: dev
->ctl_contrast
);
1239 saa_writeb(SAA7134_DEC_CHROMA_SATURATION
,
1240 dev
->ctl_invert
? -dev
->ctl_saturation
: dev
->ctl_saturation
);
1242 case V4L2_CID_HFLIP
:
1243 dev
->ctl_mirror
= c
->value
;
1244 restart_overlay
= 1;
1246 case V4L2_CID_PRIVATE_Y_EVEN
:
1247 dev
->ctl_y_even
= c
->value
;
1248 restart_overlay
= 1;
1250 case V4L2_CID_PRIVATE_Y_ODD
:
1251 dev
->ctl_y_odd
= c
->value
;
1252 restart_overlay
= 1;
1254 case V4L2_CID_PRIVATE_AUTOMUTE
:
1256 struct v4l2_priv_tun_config tda9887_cfg
;
1258 tda9887_cfg
.tuner
= TUNER_TDA9887
;
1259 tda9887_cfg
.priv
= &dev
->tda9887_conf
;
1261 dev
->ctl_automute
= c
->value
;
1262 if (dev
->tda9887_conf
) {
1263 if (dev
->ctl_automute
)
1264 dev
->tda9887_conf
|= TDA9887_AUTOMUTE
;
1266 dev
->tda9887_conf
&= ~TDA9887_AUTOMUTE
;
1268 saa_call_all(dev
, tuner
, s_config
, &tda9887_cfg
);
1275 if (restart_overlay
&& fh
&& res_check(fh
, RESOURCE_OVERLAY
)) {
1276 spin_lock_irqsave(&dev
->slock
,flags
);
1277 stop_preview(dev
,fh
);
1278 start_preview(dev
,fh
);
1279 spin_unlock_irqrestore(&dev
->slock
,flags
);
1284 mutex_unlock(&dev
->lock
);
1287 EXPORT_SYMBOL_GPL(saa7134_s_ctrl_internal
);
1289 static int saa7134_s_ctrl(struct file
*file
, void *f
, struct v4l2_control
*c
)
1291 struct saa7134_fh
*fh
= f
;
1293 return saa7134_s_ctrl_internal(fh
->dev
, fh
, c
);
1296 /* ------------------------------------------------------------------ */
1298 static struct videobuf_queue
* saa7134_queue(struct saa7134_fh
*fh
)
1300 struct videobuf_queue
* q
= NULL
;
1303 case V4L2_BUF_TYPE_VIDEO_CAPTURE
:
1306 case V4L2_BUF_TYPE_VBI_CAPTURE
:
1315 static int saa7134_resource(struct saa7134_fh
*fh
)
1317 if (fh
->type
== V4L2_BUF_TYPE_VIDEO_CAPTURE
)
1318 return RESOURCE_VIDEO
;
1320 if (fh
->type
== V4L2_BUF_TYPE_VBI_CAPTURE
)
1321 return RESOURCE_VBI
;
1327 static int video_open(struct file
*file
)
1329 struct video_device
*vdev
= video_devdata(file
);
1330 struct saa7134_dev
*dev
= video_drvdata(file
);
1331 struct saa7134_fh
*fh
;
1332 enum v4l2_buf_type type
= 0;
1335 switch (vdev
->vfl_type
) {
1336 case VFL_TYPE_GRABBER
:
1337 type
= V4L2_BUF_TYPE_VIDEO_CAPTURE
;
1340 type
= V4L2_BUF_TYPE_VBI_CAPTURE
;
1342 case VFL_TYPE_RADIO
:
1347 dprintk("open dev=%s radio=%d type=%s\n", video_device_node_name(vdev
),
1348 radio
, v4l2_type_names
[type
]);
1350 /* allocate + initialize per filehandle data */
1351 fh
= kzalloc(sizeof(*fh
),GFP_KERNEL
);
1355 file
->private_data
= fh
;
1359 fh
->fmt
= format_by_fourcc(V4L2_PIX_FMT_BGR24
);
1362 v4l2_prio_open(&dev
->prio
, &fh
->prio
);
1364 videobuf_queue_sg_init(&fh
->cap
, &video_qops
,
1365 &dev
->pci
->dev
, &dev
->slock
,
1366 V4L2_BUF_TYPE_VIDEO_CAPTURE
,
1367 V4L2_FIELD_INTERLACED
,
1368 sizeof(struct saa7134_buf
),
1370 videobuf_queue_sg_init(&fh
->vbi
, &saa7134_vbi_qops
,
1371 &dev
->pci
->dev
, &dev
->slock
,
1372 V4L2_BUF_TYPE_VBI_CAPTURE
,
1374 sizeof(struct saa7134_buf
),
1376 saa7134_pgtable_alloc(dev
->pci
,&fh
->pt_cap
);
1377 saa7134_pgtable_alloc(dev
->pci
,&fh
->pt_vbi
);
1380 /* switch to radio mode */
1381 saa7134_tvaudio_setinput(dev
,&card(dev
).radio
);
1382 saa_call_all(dev
, tuner
, s_radio
);
1384 /* switch to video/vbi mode */
1385 video_mux(dev
,dev
->ctl_input
);
1391 video_read(struct file
*file
, char __user
*data
, size_t count
, loff_t
*ppos
)
1393 struct saa7134_fh
*fh
= file
->private_data
;
1396 case V4L2_BUF_TYPE_VIDEO_CAPTURE
:
1397 if (res_locked(fh
->dev
,RESOURCE_VIDEO
))
1399 return videobuf_read_one(saa7134_queue(fh
),
1401 file
->f_flags
& O_NONBLOCK
);
1402 case V4L2_BUF_TYPE_VBI_CAPTURE
:
1403 if (!res_get(fh
->dev
,fh
,RESOURCE_VBI
))
1405 return videobuf_read_stream(saa7134_queue(fh
),
1406 data
, count
, ppos
, 1,
1407 file
->f_flags
& O_NONBLOCK
);
1416 video_poll(struct file
*file
, struct poll_table_struct
*wait
)
1418 struct saa7134_fh
*fh
= file
->private_data
;
1419 struct videobuf_buffer
*buf
= NULL
;
1420 unsigned int rc
= 0;
1422 if (V4L2_BUF_TYPE_VBI_CAPTURE
== fh
->type
)
1423 return videobuf_poll_stream(file
, &fh
->vbi
, wait
);
1425 if (res_check(fh
,RESOURCE_VIDEO
)) {
1426 mutex_lock(&fh
->cap
.vb_lock
);
1427 if (!list_empty(&fh
->cap
.stream
))
1428 buf
= list_entry(fh
->cap
.stream
.next
, struct videobuf_buffer
, stream
);
1430 mutex_lock(&fh
->cap
.vb_lock
);
1431 if (UNSET
== fh
->cap
.read_off
) {
1432 /* need to capture a new frame */
1433 if (res_locked(fh
->dev
,RESOURCE_VIDEO
))
1435 if (0 != fh
->cap
.ops
->buf_prepare(&fh
->cap
,fh
->cap
.read_buf
,fh
->cap
.field
))
1437 fh
->cap
.ops
->buf_queue(&fh
->cap
,fh
->cap
.read_buf
);
1438 fh
->cap
.read_off
= 0;
1440 buf
= fh
->cap
.read_buf
;
1446 poll_wait(file
, &buf
->done
, wait
);
1447 if (buf
->state
== VIDEOBUF_DONE
||
1448 buf
->state
== VIDEOBUF_ERROR
)
1449 rc
= POLLIN
|POLLRDNORM
;
1450 mutex_unlock(&fh
->cap
.vb_lock
);
1454 mutex_unlock(&fh
->cap
.vb_lock
);
1458 static int video_release(struct file
*file
)
1460 struct saa7134_fh
*fh
= file
->private_data
;
1461 struct saa7134_dev
*dev
= fh
->dev
;
1462 struct saa6588_command cmd
;
1463 unsigned long flags
;
1465 /* turn off overlay */
1466 if (res_check(fh
, RESOURCE_OVERLAY
)) {
1467 spin_lock_irqsave(&dev
->slock
,flags
);
1468 stop_preview(dev
,fh
);
1469 spin_unlock_irqrestore(&dev
->slock
,flags
);
1470 res_free(dev
,fh
,RESOURCE_OVERLAY
);
1473 /* stop video capture */
1474 if (res_check(fh
, RESOURCE_VIDEO
)) {
1475 videobuf_streamoff(&fh
->cap
);
1476 res_free(dev
,fh
,RESOURCE_VIDEO
);
1478 if (fh
->cap
.read_buf
) {
1479 buffer_release(&fh
->cap
,fh
->cap
.read_buf
);
1480 kfree(fh
->cap
.read_buf
);
1483 /* stop vbi capture */
1484 if (res_check(fh
, RESOURCE_VBI
)) {
1485 videobuf_stop(&fh
->vbi
);
1486 res_free(dev
,fh
,RESOURCE_VBI
);
1489 /* ts-capture will not work in planar mode, so turn it off Hac: 04.05*/
1490 saa_andorb(SAA7134_OFMT_VIDEO_A
, 0x1f, 0);
1491 saa_andorb(SAA7134_OFMT_VIDEO_B
, 0x1f, 0);
1492 saa_andorb(SAA7134_OFMT_DATA_A
, 0x1f, 0);
1493 saa_andorb(SAA7134_OFMT_DATA_B
, 0x1f, 0);
1495 saa_call_all(dev
, core
, s_power
, 0);
1497 saa_call_all(dev
, core
, ioctl
, SAA6588_CMD_CLOSE
, &cmd
);
1500 videobuf_mmap_free(&fh
->cap
);
1501 videobuf_mmap_free(&fh
->vbi
);
1502 saa7134_pgtable_free(dev
->pci
,&fh
->pt_cap
);
1503 saa7134_pgtable_free(dev
->pci
,&fh
->pt_vbi
);
1505 v4l2_prio_close(&dev
->prio
, fh
->prio
);
1506 file
->private_data
= NULL
;
1511 static int video_mmap(struct file
*file
, struct vm_area_struct
* vma
)
1513 struct saa7134_fh
*fh
= file
->private_data
;
1515 return videobuf_mmap_mapper(saa7134_queue(fh
), vma
);
1518 static ssize_t
radio_read(struct file
*file
, char __user
*data
,
1519 size_t count
, loff_t
*ppos
)
1521 struct saa7134_fh
*fh
= file
->private_data
;
1522 struct saa7134_dev
*dev
= fh
->dev
;
1523 struct saa6588_command cmd
;
1525 cmd
.block_count
= count
/3;
1527 cmd
.instance
= file
;
1528 cmd
.result
= -ENODEV
;
1530 saa_call_all(dev
, core
, ioctl
, SAA6588_CMD_READ
, &cmd
);
1535 static unsigned int radio_poll(struct file
*file
, poll_table
*wait
)
1537 struct saa7134_fh
*fh
= file
->private_data
;
1538 struct saa7134_dev
*dev
= fh
->dev
;
1539 struct saa6588_command cmd
;
1541 cmd
.instance
= file
;
1542 cmd
.event_list
= wait
;
1543 cmd
.result
= -ENODEV
;
1544 saa_call_all(dev
, core
, ioctl
, SAA6588_CMD_POLL
, &cmd
);
1549 /* ------------------------------------------------------------------ */
1551 static int saa7134_try_get_set_fmt_vbi_cap(struct file
*file
, void *priv
,
1552 struct v4l2_format
*f
)
1554 struct saa7134_fh
*fh
= priv
;
1555 struct saa7134_dev
*dev
= fh
->dev
;
1556 struct saa7134_tvnorm
*norm
= dev
->tvnorm
;
1558 f
->fmt
.vbi
.sampling_rate
= 6750000 * 4;
1559 f
->fmt
.vbi
.samples_per_line
= 2048 /* VBI_LINE_LENGTH */;
1560 f
->fmt
.vbi
.sample_format
= V4L2_PIX_FMT_GREY
;
1561 f
->fmt
.vbi
.offset
= 64 * 4;
1562 f
->fmt
.vbi
.start
[0] = norm
->vbi_v_start_0
;
1563 f
->fmt
.vbi
.count
[0] = norm
->vbi_v_stop_0
- norm
->vbi_v_start_0
+1;
1564 f
->fmt
.vbi
.start
[1] = norm
->vbi_v_start_1
;
1565 f
->fmt
.vbi
.count
[1] = f
->fmt
.vbi
.count
[0];
1566 f
->fmt
.vbi
.flags
= 0; /* VBI_UNSYNC VBI_INTERLACED */
1571 static int saa7134_g_fmt_vid_cap(struct file
*file
, void *priv
,
1572 struct v4l2_format
*f
)
1574 struct saa7134_fh
*fh
= priv
;
1576 f
->fmt
.pix
.width
= fh
->width
;
1577 f
->fmt
.pix
.height
= fh
->height
;
1578 f
->fmt
.pix
.field
= fh
->cap
.field
;
1579 f
->fmt
.pix
.pixelformat
= fh
->fmt
->fourcc
;
1580 f
->fmt
.pix
.bytesperline
=
1581 (f
->fmt
.pix
.width
* fh
->fmt
->depth
) >> 3;
1582 f
->fmt
.pix
.sizeimage
=
1583 f
->fmt
.pix
.height
* f
->fmt
.pix
.bytesperline
;
1587 static int saa7134_g_fmt_vid_overlay(struct file
*file
, void *priv
,
1588 struct v4l2_format
*f
)
1590 struct saa7134_fh
*fh
= priv
;
1592 if (saa7134_no_overlay
> 0) {
1593 printk(KERN_ERR
"V4L2_BUF_TYPE_VIDEO_OVERLAY: no_overlay\n");
1596 f
->fmt
.win
= fh
->win
;
1601 static int saa7134_try_fmt_vid_cap(struct file
*file
, void *priv
,
1602 struct v4l2_format
*f
)
1604 struct saa7134_fh
*fh
= priv
;
1605 struct saa7134_dev
*dev
= fh
->dev
;
1606 struct saa7134_format
*fmt
;
1607 enum v4l2_field field
;
1608 unsigned int maxw
, maxh
;
1610 fmt
= format_by_fourcc(f
->fmt
.pix
.pixelformat
);
1614 field
= f
->fmt
.pix
.field
;
1615 maxw
= min(dev
->crop_current
.width
*4, dev
->crop_bounds
.width
);
1616 maxh
= min(dev
->crop_current
.height
*4, dev
->crop_bounds
.height
);
1618 if (V4L2_FIELD_ANY
== field
) {
1619 field
= (f
->fmt
.pix
.height
> maxh
/2)
1620 ? V4L2_FIELD_INTERLACED
1621 : V4L2_FIELD_BOTTOM
;
1624 case V4L2_FIELD_TOP
:
1625 case V4L2_FIELD_BOTTOM
:
1628 case V4L2_FIELD_INTERLACED
:
1634 f
->fmt
.pix
.field
= field
;
1635 if (f
->fmt
.pix
.width
< 48)
1636 f
->fmt
.pix
.width
= 48;
1637 if (f
->fmt
.pix
.height
< 32)
1638 f
->fmt
.pix
.height
= 32;
1639 if (f
->fmt
.pix
.width
> maxw
)
1640 f
->fmt
.pix
.width
= maxw
;
1641 if (f
->fmt
.pix
.height
> maxh
)
1642 f
->fmt
.pix
.height
= maxh
;
1643 f
->fmt
.pix
.width
&= ~0x03;
1644 f
->fmt
.pix
.bytesperline
=
1645 (f
->fmt
.pix
.width
* fmt
->depth
) >> 3;
1646 f
->fmt
.pix
.sizeimage
=
1647 f
->fmt
.pix
.height
* f
->fmt
.pix
.bytesperline
;
1652 static int saa7134_try_fmt_vid_overlay(struct file
*file
, void *priv
,
1653 struct v4l2_format
*f
)
1655 struct saa7134_fh
*fh
= priv
;
1656 struct saa7134_dev
*dev
= fh
->dev
;
1658 if (saa7134_no_overlay
> 0) {
1659 printk(KERN_ERR
"V4L2_BUF_TYPE_VIDEO_OVERLAY: no_overlay\n");
1663 return verify_preview(dev
, &f
->fmt
.win
);
1666 static int saa7134_s_fmt_vid_cap(struct file
*file
, void *priv
,
1667 struct v4l2_format
*f
)
1669 struct saa7134_fh
*fh
= priv
;
1672 err
= saa7134_try_fmt_vid_cap(file
, priv
, f
);
1676 fh
->fmt
= format_by_fourcc(f
->fmt
.pix
.pixelformat
);
1677 fh
->width
= f
->fmt
.pix
.width
;
1678 fh
->height
= f
->fmt
.pix
.height
;
1679 fh
->cap
.field
= f
->fmt
.pix
.field
;
1683 static int saa7134_s_fmt_vid_overlay(struct file
*file
, void *priv
,
1684 struct v4l2_format
*f
)
1686 struct saa7134_fh
*fh
= priv
;
1687 struct saa7134_dev
*dev
= fh
->dev
;
1689 unsigned long flags
;
1691 if (saa7134_no_overlay
> 0) {
1692 printk(KERN_ERR
"V4L2_BUF_TYPE_VIDEO_OVERLAY: no_overlay\n");
1695 err
= verify_preview(dev
, &f
->fmt
.win
);
1699 mutex_lock(&dev
->lock
);
1701 fh
->win
= f
->fmt
.win
;
1702 fh
->nclips
= f
->fmt
.win
.clipcount
;
1707 if (copy_from_user(fh
->clips
, f
->fmt
.win
.clips
,
1708 sizeof(struct v4l2_clip
)*fh
->nclips
)) {
1709 mutex_unlock(&dev
->lock
);
1713 if (res_check(fh
, RESOURCE_OVERLAY
)) {
1714 spin_lock_irqsave(&dev
->slock
, flags
);
1715 stop_preview(dev
, fh
);
1716 start_preview(dev
, fh
);
1717 spin_unlock_irqrestore(&dev
->slock
, flags
);
1720 mutex_unlock(&dev
->lock
);
1724 int saa7134_queryctrl(struct file
*file
, void *priv
, struct v4l2_queryctrl
*c
)
1726 const struct v4l2_queryctrl
*ctrl
;
1728 if ((c
->id
< V4L2_CID_BASE
||
1729 c
->id
>= V4L2_CID_LASTP1
) &&
1730 (c
->id
< V4L2_CID_PRIVATE_BASE
||
1731 c
->id
>= V4L2_CID_PRIVATE_LASTP1
))
1733 ctrl
= ctrl_by_id(c
->id
);
1734 *c
= (NULL
!= ctrl
) ? *ctrl
: no_ctrl
;
1737 EXPORT_SYMBOL_GPL(saa7134_queryctrl
);
1739 static int saa7134_enum_input(struct file
*file
, void *priv
,
1740 struct v4l2_input
*i
)
1742 struct saa7134_fh
*fh
= priv
;
1743 struct saa7134_dev
*dev
= fh
->dev
;
1747 if (n
>= SAA7134_INPUT_MAX
)
1749 if (NULL
== card_in(dev
, i
->index
).name
)
1752 i
->type
= V4L2_INPUT_TYPE_CAMERA
;
1753 strcpy(i
->name
, card_in(dev
, n
).name
);
1754 if (card_in(dev
, n
).tv
)
1755 i
->type
= V4L2_INPUT_TYPE_TUNER
;
1757 if (n
== dev
->ctl_input
) {
1758 int v1
= saa_readb(SAA7134_STATUS_VIDEO1
);
1759 int v2
= saa_readb(SAA7134_STATUS_VIDEO2
);
1761 if (0 != (v1
& 0x40))
1762 i
->status
|= V4L2_IN_ST_NO_H_LOCK
;
1763 if (0 != (v2
& 0x40))
1764 i
->status
|= V4L2_IN_ST_NO_SYNC
;
1765 if (0 != (v2
& 0x0e))
1766 i
->status
|= V4L2_IN_ST_MACROVISION
;
1768 i
->std
= SAA7134_NORMS
;
1772 static int saa7134_g_input(struct file
*file
, void *priv
, unsigned int *i
)
1774 struct saa7134_fh
*fh
= priv
;
1775 struct saa7134_dev
*dev
= fh
->dev
;
1777 *i
= dev
->ctl_input
;
1781 static int saa7134_s_input(struct file
*file
, void *priv
, unsigned int i
)
1783 struct saa7134_fh
*fh
= priv
;
1784 struct saa7134_dev
*dev
= fh
->dev
;
1787 err
= v4l2_prio_check(&dev
->prio
, fh
->prio
);
1791 if (i
>= SAA7134_INPUT_MAX
)
1793 if (NULL
== card_in(dev
, i
).name
)
1795 mutex_lock(&dev
->lock
);
1797 mutex_unlock(&dev
->lock
);
1801 static int saa7134_querycap(struct file
*file
, void *priv
,
1802 struct v4l2_capability
*cap
)
1804 struct saa7134_fh
*fh
= priv
;
1805 struct saa7134_dev
*dev
= fh
->dev
;
1807 unsigned int tuner_type
= dev
->tuner_type
;
1809 strcpy(cap
->driver
, "saa7134");
1810 strlcpy(cap
->card
, saa7134_boards
[dev
->board
].name
,
1812 sprintf(cap
->bus_info
, "PCI:%s", pci_name(dev
->pci
));
1814 V4L2_CAP_VIDEO_CAPTURE
|
1815 V4L2_CAP_VBI_CAPTURE
|
1816 V4L2_CAP_READWRITE
|
1817 V4L2_CAP_STREAMING
|
1820 cap
->capabilities
|= V4L2_CAP_RDS_CAPTURE
;
1821 if (saa7134_no_overlay
<= 0)
1822 cap
->capabilities
|= V4L2_CAP_VIDEO_OVERLAY
;
1824 if ((tuner_type
== TUNER_ABSENT
) || (tuner_type
== UNSET
))
1825 cap
->capabilities
&= ~V4L2_CAP_TUNER
;
1829 int saa7134_s_std_internal(struct saa7134_dev
*dev
, struct saa7134_fh
*fh
, v4l2_std_id
*id
)
1831 unsigned long flags
;
1836 /* When called from the empress code fh == NULL.
1837 That needs to be fixed somehow, but for now this is
1840 err
= v4l2_prio_check(&dev
->prio
, fh
->prio
);
1843 } else if (res_locked(dev
, RESOURCE_OVERLAY
)) {
1844 /* Don't change the std from the mpeg device
1845 if overlay is active. */
1849 for (i
= 0; i
< TVNORMS
; i
++)
1850 if (*id
== tvnorms
[i
].id
)
1854 for (i
= 0; i
< TVNORMS
; i
++)
1855 if (*id
& tvnorms
[i
].id
)
1860 if ((*id
& V4L2_STD_SECAM
) && (secam
[0] != '-')) {
1861 if (secam
[0] == 'L' || secam
[0] == 'l') {
1862 if (secam
[1] == 'C' || secam
[1] == 'c')
1863 fixup
= V4L2_STD_SECAM_LC
;
1865 fixup
= V4L2_STD_SECAM_L
;
1867 if (secam
[0] == 'D' || secam
[0] == 'd')
1868 fixup
= V4L2_STD_SECAM_DK
;
1870 fixup
= V4L2_STD_SECAM
;
1872 for (i
= 0; i
< TVNORMS
; i
++) {
1873 if (fixup
== tvnorms
[i
].id
)
1880 *id
= tvnorms
[i
].id
;
1882 mutex_lock(&dev
->lock
);
1883 if (fh
&& res_check(fh
, RESOURCE_OVERLAY
)) {
1884 spin_lock_irqsave(&dev
->slock
, flags
);
1885 stop_preview(dev
, fh
);
1886 spin_unlock_irqrestore(&dev
->slock
, flags
);
1888 set_tvnorm(dev
, &tvnorms
[i
]);
1890 spin_lock_irqsave(&dev
->slock
, flags
);
1891 start_preview(dev
, fh
);
1892 spin_unlock_irqrestore(&dev
->slock
, flags
);
1894 set_tvnorm(dev
, &tvnorms
[i
]);
1896 saa7134_tvaudio_do_scan(dev
);
1897 mutex_unlock(&dev
->lock
);
1900 EXPORT_SYMBOL_GPL(saa7134_s_std_internal
);
1902 static int saa7134_s_std(struct file
*file
, void *priv
, v4l2_std_id
*id
)
1904 struct saa7134_fh
*fh
= priv
;
1906 return saa7134_s_std_internal(fh
->dev
, fh
, id
);
1909 static int saa7134_g_std(struct file
*file
, void *priv
, v4l2_std_id
*id
)
1911 struct saa7134_fh
*fh
= priv
;
1912 struct saa7134_dev
*dev
= fh
->dev
;
1914 *id
= dev
->tvnorm
->id
;
1918 static int saa7134_cropcap(struct file
*file
, void *priv
,
1919 struct v4l2_cropcap
*cap
)
1921 struct saa7134_fh
*fh
= priv
;
1922 struct saa7134_dev
*dev
= fh
->dev
;
1924 if (cap
->type
!= V4L2_BUF_TYPE_VIDEO_CAPTURE
&&
1925 cap
->type
!= V4L2_BUF_TYPE_VIDEO_OVERLAY
)
1927 cap
->bounds
= dev
->crop_bounds
;
1928 cap
->defrect
= dev
->crop_defrect
;
1929 cap
->pixelaspect
.numerator
= 1;
1930 cap
->pixelaspect
.denominator
= 1;
1931 if (dev
->tvnorm
->id
& V4L2_STD_525_60
) {
1932 cap
->pixelaspect
.numerator
= 11;
1933 cap
->pixelaspect
.denominator
= 10;
1935 if (dev
->tvnorm
->id
& V4L2_STD_625_50
) {
1936 cap
->pixelaspect
.numerator
= 54;
1937 cap
->pixelaspect
.denominator
= 59;
1942 static int saa7134_g_crop(struct file
*file
, void *f
, struct v4l2_crop
*crop
)
1944 struct saa7134_fh
*fh
= f
;
1945 struct saa7134_dev
*dev
= fh
->dev
;
1947 if (crop
->type
!= V4L2_BUF_TYPE_VIDEO_CAPTURE
&&
1948 crop
->type
!= V4L2_BUF_TYPE_VIDEO_OVERLAY
)
1950 crop
->c
= dev
->crop_current
;
1954 static int saa7134_s_crop(struct file
*file
, void *f
, struct v4l2_crop
*crop
)
1956 struct saa7134_fh
*fh
= f
;
1957 struct saa7134_dev
*dev
= fh
->dev
;
1958 struct v4l2_rect
*b
= &dev
->crop_bounds
;
1960 if (crop
->type
!= V4L2_BUF_TYPE_VIDEO_CAPTURE
&&
1961 crop
->type
!= V4L2_BUF_TYPE_VIDEO_OVERLAY
)
1963 if (crop
->c
.height
< 0)
1965 if (crop
->c
.width
< 0)
1968 if (res_locked(fh
->dev
, RESOURCE_OVERLAY
))
1970 if (res_locked(fh
->dev
, RESOURCE_VIDEO
))
1973 if (crop
->c
.top
< b
->top
)
1974 crop
->c
.top
= b
->top
;
1975 if (crop
->c
.top
> b
->top
+ b
->height
)
1976 crop
->c
.top
= b
->top
+ b
->height
;
1977 if (crop
->c
.height
> b
->top
- crop
->c
.top
+ b
->height
)
1978 crop
->c
.height
= b
->top
- crop
->c
.top
+ b
->height
;
1980 if (crop
->c
.left
< b
->left
)
1981 crop
->c
.left
= b
->left
;
1982 if (crop
->c
.left
> b
->left
+ b
->width
)
1983 crop
->c
.left
= b
->left
+ b
->width
;
1984 if (crop
->c
.width
> b
->left
- crop
->c
.left
+ b
->width
)
1985 crop
->c
.width
= b
->left
- crop
->c
.left
+ b
->width
;
1987 dev
->crop_current
= crop
->c
;
1991 static int saa7134_g_tuner(struct file
*file
, void *priv
,
1992 struct v4l2_tuner
*t
)
1994 struct saa7134_fh
*fh
= priv
;
1995 struct saa7134_dev
*dev
= fh
->dev
;
2000 memset(t
, 0, sizeof(*t
));
2001 for (n
= 0; n
< SAA7134_INPUT_MAX
; n
++) {
2002 if (card_in(dev
, n
).tv
)
2005 if (n
== SAA7134_INPUT_MAX
)
2007 if (NULL
!= card_in(dev
, n
).name
) {
2008 strcpy(t
->name
, "Television");
2009 t
->type
= V4L2_TUNER_ANALOG_TV
;
2010 t
->capability
= V4L2_TUNER_CAP_NORM
|
2011 V4L2_TUNER_CAP_STEREO
|
2012 V4L2_TUNER_CAP_LANG1
|
2013 V4L2_TUNER_CAP_LANG2
;
2014 t
->rangehigh
= 0xffffffffUL
;
2015 t
->rxsubchans
= saa7134_tvaudio_getstereo(dev
);
2016 t
->audmode
= saa7134_tvaudio_rx2mode(t
->rxsubchans
);
2018 if (0 != (saa_readb(SAA7134_STATUS_VIDEO1
) & 0x03))
2023 static int saa7134_s_tuner(struct file
*file
, void *priv
,
2024 struct v4l2_tuner
*t
)
2026 struct saa7134_fh
*fh
= priv
;
2027 struct saa7134_dev
*dev
= fh
->dev
;
2030 err
= v4l2_prio_check(&dev
->prio
, fh
->prio
);
2034 mode
= dev
->thread
.mode
;
2035 if (UNSET
== mode
) {
2036 rx
= saa7134_tvaudio_getstereo(dev
);
2037 mode
= saa7134_tvaudio_rx2mode(t
->rxsubchans
);
2039 if (mode
!= t
->audmode
)
2040 dev
->thread
.mode
= t
->audmode
;
2045 static int saa7134_g_frequency(struct file
*file
, void *priv
,
2046 struct v4l2_frequency
*f
)
2048 struct saa7134_fh
*fh
= priv
;
2049 struct saa7134_dev
*dev
= fh
->dev
;
2051 f
->type
= fh
->radio
? V4L2_TUNER_RADIO
: V4L2_TUNER_ANALOG_TV
;
2052 f
->frequency
= dev
->ctl_freq
;
2057 static int saa7134_s_frequency(struct file
*file
, void *priv
,
2058 struct v4l2_frequency
*f
)
2060 struct saa7134_fh
*fh
= priv
;
2061 struct saa7134_dev
*dev
= fh
->dev
;
2064 err
= v4l2_prio_check(&dev
->prio
, fh
->prio
);
2070 if (0 == fh
->radio
&& V4L2_TUNER_ANALOG_TV
!= f
->type
)
2072 if (1 == fh
->radio
&& V4L2_TUNER_RADIO
!= f
->type
)
2074 mutex_lock(&dev
->lock
);
2075 dev
->ctl_freq
= f
->frequency
;
2077 saa_call_all(dev
, tuner
, s_frequency
, f
);
2079 saa7134_tvaudio_do_scan(dev
);
2080 mutex_unlock(&dev
->lock
);
2084 static int saa7134_g_audio(struct file
*file
, void *priv
, struct v4l2_audio
*a
)
2086 strcpy(a
->name
, "audio");
2090 static int saa7134_s_audio(struct file
*file
, void *priv
, struct v4l2_audio
*a
)
2095 static int saa7134_g_priority(struct file
*file
, void *f
, enum v4l2_priority
*p
)
2097 struct saa7134_fh
*fh
= f
;
2098 struct saa7134_dev
*dev
= fh
->dev
;
2100 *p
= v4l2_prio_max(&dev
->prio
);
2104 static int saa7134_s_priority(struct file
*file
, void *f
,
2105 enum v4l2_priority prio
)
2107 struct saa7134_fh
*fh
= f
;
2108 struct saa7134_dev
*dev
= fh
->dev
;
2110 return v4l2_prio_change(&dev
->prio
, &fh
->prio
, prio
);
2113 static int saa7134_enum_fmt_vid_cap(struct file
*file
, void *priv
,
2114 struct v4l2_fmtdesc
*f
)
2116 if (f
->index
>= FORMATS
)
2119 strlcpy(f
->description
, formats
[f
->index
].name
,
2120 sizeof(f
->description
));
2122 f
->pixelformat
= formats
[f
->index
].fourcc
;
2127 static int saa7134_enum_fmt_vid_overlay(struct file
*file
, void *priv
,
2128 struct v4l2_fmtdesc
*f
)
2130 if (saa7134_no_overlay
> 0) {
2131 printk(KERN_ERR
"V4L2_BUF_TYPE_VIDEO_OVERLAY: no_overlay\n");
2135 if ((f
->index
>= FORMATS
) || formats
[f
->index
].planar
)
2138 strlcpy(f
->description
, formats
[f
->index
].name
,
2139 sizeof(f
->description
));
2141 f
->pixelformat
= formats
[f
->index
].fourcc
;
2146 static int saa7134_g_fbuf(struct file
*file
, void *f
,
2147 struct v4l2_framebuffer
*fb
)
2149 struct saa7134_fh
*fh
= f
;
2150 struct saa7134_dev
*dev
= fh
->dev
;
2153 fb
->capability
= V4L2_FBUF_CAP_LIST_CLIPPING
;
2158 static int saa7134_s_fbuf(struct file
*file
, void *f
,
2159 struct v4l2_framebuffer
*fb
)
2161 struct saa7134_fh
*fh
= f
;
2162 struct saa7134_dev
*dev
= fh
->dev
;
2163 struct saa7134_format
*fmt
;
2165 if (!capable(CAP_SYS_ADMIN
) &&
2166 !capable(CAP_SYS_RAWIO
))
2170 fmt
= format_by_fourcc(fb
->fmt
.pixelformat
);
2177 if (0 == dev
->ovbuf
.fmt
.bytesperline
)
2178 dev
->ovbuf
.fmt
.bytesperline
=
2179 dev
->ovbuf
.fmt
.width
*fmt
->depth
/8;
2183 static int saa7134_overlay(struct file
*file
, void *f
, unsigned int on
)
2185 struct saa7134_fh
*fh
= f
;
2186 struct saa7134_dev
*dev
= fh
->dev
;
2187 unsigned long flags
;
2190 if (saa7134_no_overlay
> 0) {
2191 dprintk("no_overlay\n");
2195 if (!res_get(dev
, fh
, RESOURCE_OVERLAY
))
2197 spin_lock_irqsave(&dev
->slock
, flags
);
2198 start_preview(dev
, fh
);
2199 spin_unlock_irqrestore(&dev
->slock
, flags
);
2202 if (!res_check(fh
, RESOURCE_OVERLAY
))
2204 spin_lock_irqsave(&dev
->slock
, flags
);
2205 stop_preview(dev
, fh
);
2206 spin_unlock_irqrestore(&dev
->slock
, flags
);
2207 res_free(dev
, fh
, RESOURCE_OVERLAY
);
2212 static int saa7134_reqbufs(struct file
*file
, void *priv
,
2213 struct v4l2_requestbuffers
*p
)
2215 struct saa7134_fh
*fh
= priv
;
2216 return videobuf_reqbufs(saa7134_queue(fh
), p
);
2219 static int saa7134_querybuf(struct file
*file
, void *priv
,
2220 struct v4l2_buffer
*b
)
2222 struct saa7134_fh
*fh
= priv
;
2223 return videobuf_querybuf(saa7134_queue(fh
), b
);
2226 static int saa7134_qbuf(struct file
*file
, void *priv
, struct v4l2_buffer
*b
)
2228 struct saa7134_fh
*fh
= priv
;
2229 return videobuf_qbuf(saa7134_queue(fh
), b
);
2232 static int saa7134_dqbuf(struct file
*file
, void *priv
, struct v4l2_buffer
*b
)
2234 struct saa7134_fh
*fh
= priv
;
2235 return videobuf_dqbuf(saa7134_queue(fh
), b
,
2236 file
->f_flags
& O_NONBLOCK
);
2239 static int saa7134_streamon(struct file
*file
, void *priv
,
2240 enum v4l2_buf_type type
)
2242 struct saa7134_fh
*fh
= priv
;
2243 struct saa7134_dev
*dev
= fh
->dev
;
2244 int res
= saa7134_resource(fh
);
2246 if (!res_get(dev
, fh
, res
))
2249 return videobuf_streamon(saa7134_queue(fh
));
2252 static int saa7134_streamoff(struct file
*file
, void *priv
,
2253 enum v4l2_buf_type type
)
2256 struct saa7134_fh
*fh
= priv
;
2257 struct saa7134_dev
*dev
= fh
->dev
;
2258 int res
= saa7134_resource(fh
);
2260 err
= videobuf_streamoff(saa7134_queue(fh
));
2263 res_free(dev
, fh
, res
);
2267 static int saa7134_g_parm(struct file
*file
, void *fh
,
2268 struct v4l2_streamparm
*parm
)
2273 #ifdef CONFIG_VIDEO_ADV_DEBUG
2274 static int vidioc_g_register (struct file
*file
, void *priv
,
2275 struct v4l2_dbg_register
*reg
)
2277 struct saa7134_fh
*fh
= priv
;
2278 struct saa7134_dev
*dev
= fh
->dev
;
2280 if (!v4l2_chip_match_host(®
->match
))
2282 reg
->val
= saa_readb(reg
->reg
);
2287 static int vidioc_s_register (struct file
*file
, void *priv
,
2288 struct v4l2_dbg_register
*reg
)
2290 struct saa7134_fh
*fh
= priv
;
2291 struct saa7134_dev
*dev
= fh
->dev
;
2293 if (!v4l2_chip_match_host(®
->match
))
2295 saa_writeb(reg
->reg
&0xffffff, reg
->val
);
2300 static int radio_querycap(struct file
*file
, void *priv
,
2301 struct v4l2_capability
*cap
)
2303 struct saa7134_fh
*fh
= file
->private_data
;
2304 struct saa7134_dev
*dev
= fh
->dev
;
2306 strcpy(cap
->driver
, "saa7134");
2307 strlcpy(cap
->card
, saa7134_boards
[dev
->board
].name
, sizeof(cap
->card
));
2308 sprintf(cap
->bus_info
, "PCI:%s", pci_name(dev
->pci
));
2309 cap
->capabilities
= V4L2_CAP_TUNER
;
2313 static int radio_g_tuner(struct file
*file
, void *priv
,
2314 struct v4l2_tuner
*t
)
2316 struct saa7134_fh
*fh
= file
->private_data
;
2317 struct saa7134_dev
*dev
= fh
->dev
;
2322 memset(t
, 0, sizeof(*t
));
2323 strcpy(t
->name
, "Radio");
2324 t
->type
= V4L2_TUNER_RADIO
;
2326 saa_call_all(dev
, tuner
, g_tuner
, t
);
2327 if (dev
->input
->amux
== TV
) {
2328 t
->signal
= 0xf800 - ((saa_readb(0x581) & 0x1f) << 11);
2329 t
->rxsubchans
= (saa_readb(0x529) & 0x08) ?
2330 V4L2_TUNER_SUB_STEREO
: V4L2_TUNER_SUB_MONO
;
2334 static int radio_s_tuner(struct file
*file
, void *priv
,
2335 struct v4l2_tuner
*t
)
2337 struct saa7134_fh
*fh
= file
->private_data
;
2338 struct saa7134_dev
*dev
= fh
->dev
;
2343 saa_call_all(dev
, tuner
, s_tuner
, t
);
2347 static int radio_enum_input(struct file
*file
, void *priv
,
2348 struct v4l2_input
*i
)
2353 strcpy(i
->name
, "Radio");
2354 i
->type
= V4L2_INPUT_TYPE_TUNER
;
2359 static int radio_g_input(struct file
*filp
, void *priv
, unsigned int *i
)
2365 static int radio_g_audio(struct file
*file
, void *priv
,
2366 struct v4l2_audio
*a
)
2368 memset(a
, 0, sizeof(*a
));
2369 strcpy(a
->name
, "Radio");
2373 static int radio_s_audio(struct file
*file
, void *priv
,
2374 struct v4l2_audio
*a
)
2379 static int radio_s_input(struct file
*filp
, void *priv
, unsigned int i
)
2384 static int radio_s_std(struct file
*file
, void *fh
, v4l2_std_id
*norm
)
2389 static int radio_queryctrl(struct file
*file
, void *priv
,
2390 struct v4l2_queryctrl
*c
)
2392 const struct v4l2_queryctrl
*ctrl
;
2394 if (c
->id
< V4L2_CID_BASE
||
2395 c
->id
>= V4L2_CID_LASTP1
)
2397 if (c
->id
== V4L2_CID_AUDIO_MUTE
) {
2398 ctrl
= ctrl_by_id(c
->id
);
2405 static const struct v4l2_file_operations video_fops
=
2407 .owner
= THIS_MODULE
,
2409 .release
= video_release
,
2413 .ioctl
= video_ioctl2
,
2416 static const struct v4l2_ioctl_ops video_ioctl_ops
= {
2417 .vidioc_querycap
= saa7134_querycap
,
2418 .vidioc_enum_fmt_vid_cap
= saa7134_enum_fmt_vid_cap
,
2419 .vidioc_g_fmt_vid_cap
= saa7134_g_fmt_vid_cap
,
2420 .vidioc_try_fmt_vid_cap
= saa7134_try_fmt_vid_cap
,
2421 .vidioc_s_fmt_vid_cap
= saa7134_s_fmt_vid_cap
,
2422 .vidioc_enum_fmt_vid_overlay
= saa7134_enum_fmt_vid_overlay
,
2423 .vidioc_g_fmt_vid_overlay
= saa7134_g_fmt_vid_overlay
,
2424 .vidioc_try_fmt_vid_overlay
= saa7134_try_fmt_vid_overlay
,
2425 .vidioc_s_fmt_vid_overlay
= saa7134_s_fmt_vid_overlay
,
2426 .vidioc_g_fmt_vbi_cap
= saa7134_try_get_set_fmt_vbi_cap
,
2427 .vidioc_try_fmt_vbi_cap
= saa7134_try_get_set_fmt_vbi_cap
,
2428 .vidioc_s_fmt_vbi_cap
= saa7134_try_get_set_fmt_vbi_cap
,
2429 .vidioc_g_audio
= saa7134_g_audio
,
2430 .vidioc_s_audio
= saa7134_s_audio
,
2431 .vidioc_cropcap
= saa7134_cropcap
,
2432 .vidioc_reqbufs
= saa7134_reqbufs
,
2433 .vidioc_querybuf
= saa7134_querybuf
,
2434 .vidioc_qbuf
= saa7134_qbuf
,
2435 .vidioc_dqbuf
= saa7134_dqbuf
,
2436 .vidioc_s_std
= saa7134_s_std
,
2437 .vidioc_g_std
= saa7134_g_std
,
2438 .vidioc_enum_input
= saa7134_enum_input
,
2439 .vidioc_g_input
= saa7134_g_input
,
2440 .vidioc_s_input
= saa7134_s_input
,
2441 .vidioc_queryctrl
= saa7134_queryctrl
,
2442 .vidioc_g_ctrl
= saa7134_g_ctrl
,
2443 .vidioc_s_ctrl
= saa7134_s_ctrl
,
2444 .vidioc_streamon
= saa7134_streamon
,
2445 .vidioc_streamoff
= saa7134_streamoff
,
2446 .vidioc_g_tuner
= saa7134_g_tuner
,
2447 .vidioc_s_tuner
= saa7134_s_tuner
,
2448 .vidioc_g_crop
= saa7134_g_crop
,
2449 .vidioc_s_crop
= saa7134_s_crop
,
2450 .vidioc_g_fbuf
= saa7134_g_fbuf
,
2451 .vidioc_s_fbuf
= saa7134_s_fbuf
,
2452 .vidioc_overlay
= saa7134_overlay
,
2453 .vidioc_g_priority
= saa7134_g_priority
,
2454 .vidioc_s_priority
= saa7134_s_priority
,
2455 .vidioc_g_parm
= saa7134_g_parm
,
2456 .vidioc_g_frequency
= saa7134_g_frequency
,
2457 .vidioc_s_frequency
= saa7134_s_frequency
,
2458 #ifdef CONFIG_VIDEO_ADV_DEBUG
2459 .vidioc_g_register
= vidioc_g_register
,
2460 .vidioc_s_register
= vidioc_s_register
,
2464 static const struct v4l2_file_operations radio_fops
= {
2465 .owner
= THIS_MODULE
,
2468 .release
= video_release
,
2469 .ioctl
= video_ioctl2
,
2473 static const struct v4l2_ioctl_ops radio_ioctl_ops
= {
2474 .vidioc_querycap
= radio_querycap
,
2475 .vidioc_g_tuner
= radio_g_tuner
,
2476 .vidioc_enum_input
= radio_enum_input
,
2477 .vidioc_g_audio
= radio_g_audio
,
2478 .vidioc_s_tuner
= radio_s_tuner
,
2479 .vidioc_s_audio
= radio_s_audio
,
2480 .vidioc_s_input
= radio_s_input
,
2481 .vidioc_s_std
= radio_s_std
,
2482 .vidioc_queryctrl
= radio_queryctrl
,
2483 .vidioc_g_input
= radio_g_input
,
2484 .vidioc_g_ctrl
= saa7134_g_ctrl
,
2485 .vidioc_s_ctrl
= saa7134_s_ctrl
,
2486 .vidioc_g_frequency
= saa7134_g_frequency
,
2487 .vidioc_s_frequency
= saa7134_s_frequency
,
2490 /* ----------------------------------------------------------- */
2491 /* exported stuff */
2493 struct video_device saa7134_video_template
= {
2494 .name
= "saa7134-video",
2495 .fops
= &video_fops
,
2496 .ioctl_ops
= &video_ioctl_ops
,
2497 .tvnorms
= SAA7134_NORMS
,
2498 .current_norm
= V4L2_STD_PAL
,
2501 struct video_device saa7134_radio_template
= {
2502 .name
= "saa7134-radio",
2503 .fops
= &radio_fops
,
2504 .ioctl_ops
= &radio_ioctl_ops
,
2507 int saa7134_video_init1(struct saa7134_dev
*dev
)
2509 /* sanitycheck insmod options */
2510 if (gbuffers
< 2 || gbuffers
> VIDEO_MAX_FRAME
)
2512 if (gbufsize
< 0 || gbufsize
> gbufsize_max
)
2513 gbufsize
= gbufsize_max
;
2514 gbufsize
= (gbufsize
+ PAGE_SIZE
- 1) & PAGE_MASK
;
2516 /* put some sensible defaults into the data structures ... */
2517 dev
->ctl_bright
= ctrl_by_id(V4L2_CID_BRIGHTNESS
)->default_value
;
2518 dev
->ctl_contrast
= ctrl_by_id(V4L2_CID_CONTRAST
)->default_value
;
2519 dev
->ctl_hue
= ctrl_by_id(V4L2_CID_HUE
)->default_value
;
2520 dev
->ctl_saturation
= ctrl_by_id(V4L2_CID_SATURATION
)->default_value
;
2521 dev
->ctl_volume
= ctrl_by_id(V4L2_CID_AUDIO_VOLUME
)->default_value
;
2522 dev
->ctl_mute
= 1; // ctrl_by_id(V4L2_CID_AUDIO_MUTE)->default_value;
2523 dev
->ctl_invert
= ctrl_by_id(V4L2_CID_PRIVATE_INVERT
)->default_value
;
2524 dev
->ctl_automute
= ctrl_by_id(V4L2_CID_PRIVATE_AUTOMUTE
)->default_value
;
2526 if (dev
->tda9887_conf
&& dev
->ctl_automute
)
2527 dev
->tda9887_conf
|= TDA9887_AUTOMUTE
;
2530 INIT_LIST_HEAD(&dev
->video_q
.queue
);
2531 init_timer(&dev
->video_q
.timeout
);
2532 dev
->video_q
.timeout
.function
= saa7134_buffer_timeout
;
2533 dev
->video_q
.timeout
.data
= (unsigned long)(&dev
->video_q
);
2534 dev
->video_q
.dev
= dev
;
2536 if (saa7134_boards
[dev
->board
].video_out
)
2537 saa7134_videoport_init(dev
);
2542 int saa7134_videoport_init(struct saa7134_dev
*dev
)
2544 /* enable video output */
2545 int vo
= saa7134_boards
[dev
->board
].video_out
;
2547 unsigned int vid_port_opts
= saa7134_boards
[dev
->board
].vid_port_opts
;
2549 /* Configure videoport */
2550 saa_writeb(SAA7134_VIDEO_PORT_CTRL0
, video_out
[vo
][0]);
2551 video_reg
= video_out
[vo
][1];
2552 if (vid_port_opts
& SET_T_CODE_POLARITY_NON_INVERTED
)
2553 video_reg
&= ~VP_T_CODE_P_INVERTED
;
2554 saa_writeb(SAA7134_VIDEO_PORT_CTRL1
, video_reg
);
2555 saa_writeb(SAA7134_VIDEO_PORT_CTRL2
, video_out
[vo
][2]);
2556 saa_writeb(SAA7134_VIDEO_PORT_CTRL4
, video_out
[vo
][4]);
2557 video_reg
= video_out
[vo
][5];
2558 if (vid_port_opts
& SET_CLOCK_NOT_DELAYED
)
2559 video_reg
&= ~VP_CLK_CTRL2_DELAYED
;
2560 if (vid_port_opts
& SET_CLOCK_INVERTED
)
2561 video_reg
|= VP_CLK_CTRL1_INVERTED
;
2562 saa_writeb(SAA7134_VIDEO_PORT_CTRL5
, video_reg
);
2563 video_reg
= video_out
[vo
][6];
2564 if (vid_port_opts
& SET_VSYNC_OFF
) {
2565 video_reg
&= ~VP_VS_TYPE_MASK
;
2566 video_reg
|= VP_VS_TYPE_OFF
;
2568 saa_writeb(SAA7134_VIDEO_PORT_CTRL6
, video_reg
);
2569 saa_writeb(SAA7134_VIDEO_PORT_CTRL7
, video_out
[vo
][7]);
2570 saa_writeb(SAA7134_VIDEO_PORT_CTRL8
, video_out
[vo
][8]);
2572 /* Start videoport */
2573 saa_writeb(SAA7134_VIDEO_PORT_CTRL3
, video_out
[vo
][3]);
2578 int saa7134_video_init2(struct saa7134_dev
*dev
)
2581 set_tvnorm(dev
,&tvnorms
[0]);
2583 saa7134_tvaudio_setmute(dev
);
2584 saa7134_tvaudio_setvolume(dev
,dev
->ctl_volume
);
2588 void saa7134_irq_video_signalchange(struct saa7134_dev
*dev
)
2590 static const char *st
[] = {
2591 "(no signal)", "NTSC", "PAL", "SECAM" };
2594 st1
= saa_readb(SAA7134_STATUS_VIDEO1
);
2595 st2
= saa_readb(SAA7134_STATUS_VIDEO2
);
2596 dprintk("DCSDT: pll: %s, sync: %s, norm: %s\n",
2597 (st1
& 0x40) ? "not locked" : "locked",
2598 (st2
& 0x40) ? "no" : "yes",
2600 dev
->nosignal
= (st1
& 0x40) || (st2
& 0x40) || !(st2
& 0x1);
2602 if (dev
->nosignal
) {
2603 /* no video signal -> mute audio */
2604 if (dev
->ctl_automute
)
2606 saa7134_tvaudio_setmute(dev
);
2608 /* wake up tvaudio audio carrier scan thread */
2609 saa7134_tvaudio_do_scan(dev
);
2612 if ((st2
& 0x80) && !noninterlaced
&& !dev
->nosignal
)
2613 saa_clearb(SAA7134_SYNC_CTRL
, 0x20);
2615 saa_setb(SAA7134_SYNC_CTRL
, 0x20);
2617 if (dev
->mops
&& dev
->mops
->signal_change
)
2618 dev
->mops
->signal_change(dev
);
2622 void saa7134_irq_video_done(struct saa7134_dev
*dev
, unsigned long status
)
2624 enum v4l2_field field
;
2626 spin_lock(&dev
->slock
);
2627 if (dev
->video_q
.curr
) {
2628 dev
->video_fieldcount
++;
2629 field
= dev
->video_q
.curr
->vb
.field
;
2630 if (V4L2_FIELD_HAS_BOTH(field
)) {
2631 /* make sure we have seen both fields */
2632 if ((status
& 0x10) == 0x00) {
2633 dev
->video_q
.curr
->top_seen
= 1;
2636 if (!dev
->video_q
.curr
->top_seen
)
2638 } else if (field
== V4L2_FIELD_TOP
) {
2639 if ((status
& 0x10) != 0x10)
2641 } else if (field
== V4L2_FIELD_BOTTOM
) {
2642 if ((status
& 0x10) != 0x00)
2645 dev
->video_q
.curr
->vb
.field_count
= dev
->video_fieldcount
;
2646 saa7134_buffer_finish(dev
,&dev
->video_q
,VIDEOBUF_DONE
);
2648 saa7134_buffer_next(dev
,&dev
->video_q
);
2651 spin_unlock(&dev
->slock
);
2654 /* ----------------------------------------------------------- */