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;
1181 mutex_lock(&dev
->lock
);
1183 ctrl
= ctrl_by_id(c
->id
);
1187 dprintk("set_control name=%s val=%d\n",ctrl
->name
,c
->value
);
1188 switch (ctrl
->type
) {
1189 case V4L2_CTRL_TYPE_BOOLEAN
:
1190 case V4L2_CTRL_TYPE_MENU
:
1191 case V4L2_CTRL_TYPE_INTEGER
:
1192 if (c
->value
< ctrl
->minimum
)
1193 c
->value
= ctrl
->minimum
;
1194 if (c
->value
> ctrl
->maximum
)
1195 c
->value
= ctrl
->maximum
;
1201 case V4L2_CID_BRIGHTNESS
:
1202 dev
->ctl_bright
= c
->value
;
1203 saa_writeb(SAA7134_DEC_LUMA_BRIGHT
, dev
->ctl_bright
);
1206 dev
->ctl_hue
= c
->value
;
1207 saa_writeb(SAA7134_DEC_CHROMA_HUE
, dev
->ctl_hue
);
1209 case V4L2_CID_CONTRAST
:
1210 dev
->ctl_contrast
= c
->value
;
1211 saa_writeb(SAA7134_DEC_LUMA_CONTRAST
,
1212 dev
->ctl_invert
? -dev
->ctl_contrast
: dev
->ctl_contrast
);
1214 case V4L2_CID_SATURATION
:
1215 dev
->ctl_saturation
= c
->value
;
1216 saa_writeb(SAA7134_DEC_CHROMA_SATURATION
,
1217 dev
->ctl_invert
? -dev
->ctl_saturation
: dev
->ctl_saturation
);
1219 case V4L2_CID_AUDIO_MUTE
:
1220 dev
->ctl_mute
= c
->value
;
1221 saa7134_tvaudio_setmute(dev
);
1223 case V4L2_CID_AUDIO_VOLUME
:
1224 dev
->ctl_volume
= c
->value
;
1225 saa7134_tvaudio_setvolume(dev
,dev
->ctl_volume
);
1227 case V4L2_CID_PRIVATE_INVERT
:
1228 dev
->ctl_invert
= c
->value
;
1229 saa_writeb(SAA7134_DEC_LUMA_CONTRAST
,
1230 dev
->ctl_invert
? -dev
->ctl_contrast
: dev
->ctl_contrast
);
1231 saa_writeb(SAA7134_DEC_CHROMA_SATURATION
,
1232 dev
->ctl_invert
? -dev
->ctl_saturation
: dev
->ctl_saturation
);
1234 case V4L2_CID_HFLIP
:
1235 dev
->ctl_mirror
= c
->value
;
1236 restart_overlay
= 1;
1238 case V4L2_CID_PRIVATE_Y_EVEN
:
1239 dev
->ctl_y_even
= c
->value
;
1240 restart_overlay
= 1;
1242 case V4L2_CID_PRIVATE_Y_ODD
:
1243 dev
->ctl_y_odd
= c
->value
;
1244 restart_overlay
= 1;
1246 case V4L2_CID_PRIVATE_AUTOMUTE
:
1248 struct v4l2_priv_tun_config tda9887_cfg
;
1250 tda9887_cfg
.tuner
= TUNER_TDA9887
;
1251 tda9887_cfg
.priv
= &dev
->tda9887_conf
;
1253 dev
->ctl_automute
= c
->value
;
1254 if (dev
->tda9887_conf
) {
1255 if (dev
->ctl_automute
)
1256 dev
->tda9887_conf
|= TDA9887_AUTOMUTE
;
1258 dev
->tda9887_conf
&= ~TDA9887_AUTOMUTE
;
1260 saa_call_all(dev
, tuner
, s_config
, &tda9887_cfg
);
1267 if (restart_overlay
&& fh
&& res_check(fh
, RESOURCE_OVERLAY
)) {
1268 spin_lock_irqsave(&dev
->slock
,flags
);
1269 stop_preview(dev
,fh
);
1270 start_preview(dev
,fh
);
1271 spin_unlock_irqrestore(&dev
->slock
,flags
);
1276 mutex_unlock(&dev
->lock
);
1279 EXPORT_SYMBOL_GPL(saa7134_s_ctrl_internal
);
1281 static int saa7134_s_ctrl(struct file
*file
, void *f
, struct v4l2_control
*c
)
1283 struct saa7134_fh
*fh
= f
;
1285 return saa7134_s_ctrl_internal(fh
->dev
, fh
, c
);
1288 /* ------------------------------------------------------------------ */
1290 static struct videobuf_queue
* saa7134_queue(struct saa7134_fh
*fh
)
1292 struct videobuf_queue
* q
= NULL
;
1295 case V4L2_BUF_TYPE_VIDEO_CAPTURE
:
1298 case V4L2_BUF_TYPE_VBI_CAPTURE
:
1307 static int saa7134_resource(struct saa7134_fh
*fh
)
1309 if (fh
->type
== V4L2_BUF_TYPE_VIDEO_CAPTURE
)
1310 return RESOURCE_VIDEO
;
1312 if (fh
->type
== V4L2_BUF_TYPE_VBI_CAPTURE
)
1313 return RESOURCE_VBI
;
1319 static int video_open(struct file
*file
)
1321 struct video_device
*vdev
= video_devdata(file
);
1322 struct saa7134_dev
*dev
= video_drvdata(file
);
1323 struct saa7134_fh
*fh
;
1324 enum v4l2_buf_type type
= 0;
1327 switch (vdev
->vfl_type
) {
1328 case VFL_TYPE_GRABBER
:
1329 type
= V4L2_BUF_TYPE_VIDEO_CAPTURE
;
1332 type
= V4L2_BUF_TYPE_VBI_CAPTURE
;
1334 case VFL_TYPE_RADIO
:
1339 dprintk("open dev=%s radio=%d type=%s\n", video_device_node_name(vdev
),
1340 radio
, v4l2_type_names
[type
]);
1342 /* allocate + initialize per filehandle data */
1343 fh
= kzalloc(sizeof(*fh
),GFP_KERNEL
);
1347 v4l2_fh_init(&fh
->fh
, vdev
);
1348 file
->private_data
= fh
;
1352 fh
->fmt
= format_by_fourcc(V4L2_PIX_FMT_BGR24
);
1356 videobuf_queue_sg_init(&fh
->cap
, &video_qops
,
1357 &dev
->pci
->dev
, &dev
->slock
,
1358 V4L2_BUF_TYPE_VIDEO_CAPTURE
,
1359 V4L2_FIELD_INTERLACED
,
1360 sizeof(struct saa7134_buf
),
1362 videobuf_queue_sg_init(&fh
->vbi
, &saa7134_vbi_qops
,
1363 &dev
->pci
->dev
, &dev
->slock
,
1364 V4L2_BUF_TYPE_VBI_CAPTURE
,
1366 sizeof(struct saa7134_buf
),
1368 saa7134_pgtable_alloc(dev
->pci
,&fh
->pt_cap
);
1369 saa7134_pgtable_alloc(dev
->pci
,&fh
->pt_vbi
);
1372 /* switch to radio mode */
1373 saa7134_tvaudio_setinput(dev
,&card(dev
).radio
);
1374 saa_call_all(dev
, tuner
, s_radio
);
1376 /* switch to video/vbi mode */
1377 video_mux(dev
,dev
->ctl_input
);
1379 v4l2_fh_add(&fh
->fh
);
1385 video_read(struct file
*file
, char __user
*data
, size_t count
, loff_t
*ppos
)
1387 struct saa7134_fh
*fh
= file
->private_data
;
1390 case V4L2_BUF_TYPE_VIDEO_CAPTURE
:
1391 if (res_locked(fh
->dev
,RESOURCE_VIDEO
))
1393 return videobuf_read_one(saa7134_queue(fh
),
1395 file
->f_flags
& O_NONBLOCK
);
1396 case V4L2_BUF_TYPE_VBI_CAPTURE
:
1397 if (!res_get(fh
->dev
,fh
,RESOURCE_VBI
))
1399 return videobuf_read_stream(saa7134_queue(fh
),
1400 data
, count
, ppos
, 1,
1401 file
->f_flags
& O_NONBLOCK
);
1410 video_poll(struct file
*file
, struct poll_table_struct
*wait
)
1412 struct saa7134_fh
*fh
= file
->private_data
;
1413 struct videobuf_buffer
*buf
= NULL
;
1414 unsigned int rc
= 0;
1416 if (V4L2_BUF_TYPE_VBI_CAPTURE
== fh
->type
)
1417 return videobuf_poll_stream(file
, &fh
->vbi
, wait
);
1419 if (res_check(fh
,RESOURCE_VIDEO
)) {
1420 mutex_lock(&fh
->cap
.vb_lock
);
1421 if (!list_empty(&fh
->cap
.stream
))
1422 buf
= list_entry(fh
->cap
.stream
.next
, struct videobuf_buffer
, stream
);
1424 mutex_lock(&fh
->cap
.vb_lock
);
1425 if (UNSET
== fh
->cap
.read_off
) {
1426 /* need to capture a new frame */
1427 if (res_locked(fh
->dev
,RESOURCE_VIDEO
))
1429 if (0 != fh
->cap
.ops
->buf_prepare(&fh
->cap
,fh
->cap
.read_buf
,fh
->cap
.field
))
1431 fh
->cap
.ops
->buf_queue(&fh
->cap
,fh
->cap
.read_buf
);
1432 fh
->cap
.read_off
= 0;
1434 buf
= fh
->cap
.read_buf
;
1440 poll_wait(file
, &buf
->done
, wait
);
1441 if (buf
->state
== VIDEOBUF_DONE
||
1442 buf
->state
== VIDEOBUF_ERROR
)
1443 rc
= POLLIN
|POLLRDNORM
;
1444 mutex_unlock(&fh
->cap
.vb_lock
);
1448 mutex_unlock(&fh
->cap
.vb_lock
);
1452 static int video_release(struct file
*file
)
1454 struct saa7134_fh
*fh
= file
->private_data
;
1455 struct saa7134_dev
*dev
= fh
->dev
;
1456 struct saa6588_command cmd
;
1457 unsigned long flags
;
1459 saa7134_tvaudio_close(dev
);
1461 /* turn off overlay */
1462 if (res_check(fh
, RESOURCE_OVERLAY
)) {
1463 spin_lock_irqsave(&dev
->slock
,flags
);
1464 stop_preview(dev
,fh
);
1465 spin_unlock_irqrestore(&dev
->slock
,flags
);
1466 res_free(dev
,fh
,RESOURCE_OVERLAY
);
1469 /* stop video capture */
1470 if (res_check(fh
, RESOURCE_VIDEO
)) {
1471 videobuf_streamoff(&fh
->cap
);
1472 res_free(dev
,fh
,RESOURCE_VIDEO
);
1474 if (fh
->cap
.read_buf
) {
1475 buffer_release(&fh
->cap
,fh
->cap
.read_buf
);
1476 kfree(fh
->cap
.read_buf
);
1479 /* stop vbi capture */
1480 if (res_check(fh
, RESOURCE_VBI
)) {
1481 videobuf_stop(&fh
->vbi
);
1482 res_free(dev
,fh
,RESOURCE_VBI
);
1485 /* ts-capture will not work in planar mode, so turn it off Hac: 04.05*/
1486 saa_andorb(SAA7134_OFMT_VIDEO_A
, 0x1f, 0);
1487 saa_andorb(SAA7134_OFMT_VIDEO_B
, 0x1f, 0);
1488 saa_andorb(SAA7134_OFMT_DATA_A
, 0x1f, 0);
1489 saa_andorb(SAA7134_OFMT_DATA_B
, 0x1f, 0);
1491 saa_call_all(dev
, core
, s_power
, 0);
1493 saa_call_all(dev
, core
, ioctl
, SAA6588_CMD_CLOSE
, &cmd
);
1496 videobuf_mmap_free(&fh
->cap
);
1497 videobuf_mmap_free(&fh
->vbi
);
1498 saa7134_pgtable_free(dev
->pci
,&fh
->pt_cap
);
1499 saa7134_pgtable_free(dev
->pci
,&fh
->pt_vbi
);
1501 v4l2_fh_del(&fh
->fh
);
1502 v4l2_fh_exit(&fh
->fh
);
1503 file
->private_data
= NULL
;
1508 static int video_mmap(struct file
*file
, struct vm_area_struct
* vma
)
1510 struct saa7134_fh
*fh
= file
->private_data
;
1512 return videobuf_mmap_mapper(saa7134_queue(fh
), vma
);
1515 static ssize_t
radio_read(struct file
*file
, char __user
*data
,
1516 size_t count
, loff_t
*ppos
)
1518 struct saa7134_fh
*fh
= file
->private_data
;
1519 struct saa7134_dev
*dev
= fh
->dev
;
1520 struct saa6588_command cmd
;
1522 cmd
.block_count
= count
/3;
1524 cmd
.instance
= file
;
1525 cmd
.result
= -ENODEV
;
1527 saa_call_all(dev
, core
, ioctl
, SAA6588_CMD_READ
, &cmd
);
1532 static unsigned int radio_poll(struct file
*file
, poll_table
*wait
)
1534 struct saa7134_fh
*fh
= file
->private_data
;
1535 struct saa7134_dev
*dev
= fh
->dev
;
1536 struct saa6588_command cmd
;
1538 cmd
.instance
= file
;
1539 cmd
.event_list
= wait
;
1540 cmd
.result
= -ENODEV
;
1541 saa_call_all(dev
, core
, ioctl
, SAA6588_CMD_POLL
, &cmd
);
1546 /* ------------------------------------------------------------------ */
1548 static int saa7134_try_get_set_fmt_vbi_cap(struct file
*file
, void *priv
,
1549 struct v4l2_format
*f
)
1551 struct saa7134_fh
*fh
= priv
;
1552 struct saa7134_dev
*dev
= fh
->dev
;
1553 struct saa7134_tvnorm
*norm
= dev
->tvnorm
;
1555 f
->fmt
.vbi
.sampling_rate
= 6750000 * 4;
1556 f
->fmt
.vbi
.samples_per_line
= 2048 /* VBI_LINE_LENGTH */;
1557 f
->fmt
.vbi
.sample_format
= V4L2_PIX_FMT_GREY
;
1558 f
->fmt
.vbi
.offset
= 64 * 4;
1559 f
->fmt
.vbi
.start
[0] = norm
->vbi_v_start_0
;
1560 f
->fmt
.vbi
.count
[0] = norm
->vbi_v_stop_0
- norm
->vbi_v_start_0
+1;
1561 f
->fmt
.vbi
.start
[1] = norm
->vbi_v_start_1
;
1562 f
->fmt
.vbi
.count
[1] = f
->fmt
.vbi
.count
[0];
1563 f
->fmt
.vbi
.flags
= 0; /* VBI_UNSYNC VBI_INTERLACED */
1568 static int saa7134_g_fmt_vid_cap(struct file
*file
, void *priv
,
1569 struct v4l2_format
*f
)
1571 struct saa7134_fh
*fh
= priv
;
1573 f
->fmt
.pix
.width
= fh
->width
;
1574 f
->fmt
.pix
.height
= fh
->height
;
1575 f
->fmt
.pix
.field
= fh
->cap
.field
;
1576 f
->fmt
.pix
.pixelformat
= fh
->fmt
->fourcc
;
1577 f
->fmt
.pix
.bytesperline
=
1578 (f
->fmt
.pix
.width
* fh
->fmt
->depth
) >> 3;
1579 f
->fmt
.pix
.sizeimage
=
1580 f
->fmt
.pix
.height
* f
->fmt
.pix
.bytesperline
;
1584 static int saa7134_g_fmt_vid_overlay(struct file
*file
, void *priv
,
1585 struct v4l2_format
*f
)
1587 struct saa7134_fh
*fh
= priv
;
1589 if (saa7134_no_overlay
> 0) {
1590 printk(KERN_ERR
"V4L2_BUF_TYPE_VIDEO_OVERLAY: no_overlay\n");
1593 f
->fmt
.win
= fh
->win
;
1598 static int saa7134_try_fmt_vid_cap(struct file
*file
, void *priv
,
1599 struct v4l2_format
*f
)
1601 struct saa7134_fh
*fh
= priv
;
1602 struct saa7134_dev
*dev
= fh
->dev
;
1603 struct saa7134_format
*fmt
;
1604 enum v4l2_field field
;
1605 unsigned int maxw
, maxh
;
1607 fmt
= format_by_fourcc(f
->fmt
.pix
.pixelformat
);
1611 field
= f
->fmt
.pix
.field
;
1612 maxw
= min(dev
->crop_current
.width
*4, dev
->crop_bounds
.width
);
1613 maxh
= min(dev
->crop_current
.height
*4, dev
->crop_bounds
.height
);
1615 if (V4L2_FIELD_ANY
== field
) {
1616 field
= (f
->fmt
.pix
.height
> maxh
/2)
1617 ? V4L2_FIELD_INTERLACED
1618 : V4L2_FIELD_BOTTOM
;
1621 case V4L2_FIELD_TOP
:
1622 case V4L2_FIELD_BOTTOM
:
1625 case V4L2_FIELD_INTERLACED
:
1631 f
->fmt
.pix
.field
= field
;
1632 if (f
->fmt
.pix
.width
< 48)
1633 f
->fmt
.pix
.width
= 48;
1634 if (f
->fmt
.pix
.height
< 32)
1635 f
->fmt
.pix
.height
= 32;
1636 if (f
->fmt
.pix
.width
> maxw
)
1637 f
->fmt
.pix
.width
= maxw
;
1638 if (f
->fmt
.pix
.height
> maxh
)
1639 f
->fmt
.pix
.height
= maxh
;
1640 f
->fmt
.pix
.width
&= ~0x03;
1641 f
->fmt
.pix
.bytesperline
=
1642 (f
->fmt
.pix
.width
* fmt
->depth
) >> 3;
1643 f
->fmt
.pix
.sizeimage
=
1644 f
->fmt
.pix
.height
* f
->fmt
.pix
.bytesperline
;
1649 static int saa7134_try_fmt_vid_overlay(struct file
*file
, void *priv
,
1650 struct v4l2_format
*f
)
1652 struct saa7134_fh
*fh
= priv
;
1653 struct saa7134_dev
*dev
= fh
->dev
;
1655 if (saa7134_no_overlay
> 0) {
1656 printk(KERN_ERR
"V4L2_BUF_TYPE_VIDEO_OVERLAY: no_overlay\n");
1660 return verify_preview(dev
, &f
->fmt
.win
);
1663 static int saa7134_s_fmt_vid_cap(struct file
*file
, void *priv
,
1664 struct v4l2_format
*f
)
1666 struct saa7134_fh
*fh
= priv
;
1669 err
= saa7134_try_fmt_vid_cap(file
, priv
, f
);
1673 fh
->fmt
= format_by_fourcc(f
->fmt
.pix
.pixelformat
);
1674 fh
->width
= f
->fmt
.pix
.width
;
1675 fh
->height
= f
->fmt
.pix
.height
;
1676 fh
->cap
.field
= f
->fmt
.pix
.field
;
1680 static int saa7134_s_fmt_vid_overlay(struct file
*file
, void *priv
,
1681 struct v4l2_format
*f
)
1683 struct saa7134_fh
*fh
= priv
;
1684 struct saa7134_dev
*dev
= fh
->dev
;
1686 unsigned long flags
;
1688 if (saa7134_no_overlay
> 0) {
1689 printk(KERN_ERR
"V4L2_BUF_TYPE_VIDEO_OVERLAY: no_overlay\n");
1692 err
= verify_preview(dev
, &f
->fmt
.win
);
1696 mutex_lock(&dev
->lock
);
1698 fh
->win
= f
->fmt
.win
;
1699 fh
->nclips
= f
->fmt
.win
.clipcount
;
1704 if (copy_from_user(fh
->clips
, f
->fmt
.win
.clips
,
1705 sizeof(struct v4l2_clip
)*fh
->nclips
)) {
1706 mutex_unlock(&dev
->lock
);
1710 if (res_check(fh
, RESOURCE_OVERLAY
)) {
1711 spin_lock_irqsave(&dev
->slock
, flags
);
1712 stop_preview(dev
, fh
);
1713 start_preview(dev
, fh
);
1714 spin_unlock_irqrestore(&dev
->slock
, flags
);
1717 mutex_unlock(&dev
->lock
);
1721 int saa7134_queryctrl(struct file
*file
, void *priv
, struct v4l2_queryctrl
*c
)
1723 const struct v4l2_queryctrl
*ctrl
;
1725 if ((c
->id
< V4L2_CID_BASE
||
1726 c
->id
>= V4L2_CID_LASTP1
) &&
1727 (c
->id
< V4L2_CID_PRIVATE_BASE
||
1728 c
->id
>= V4L2_CID_PRIVATE_LASTP1
))
1730 ctrl
= ctrl_by_id(c
->id
);
1731 *c
= (NULL
!= ctrl
) ? *ctrl
: no_ctrl
;
1734 EXPORT_SYMBOL_GPL(saa7134_queryctrl
);
1736 static int saa7134_enum_input(struct file
*file
, void *priv
,
1737 struct v4l2_input
*i
)
1739 struct saa7134_fh
*fh
= priv
;
1740 struct saa7134_dev
*dev
= fh
->dev
;
1744 if (n
>= SAA7134_INPUT_MAX
)
1746 if (NULL
== card_in(dev
, i
->index
).name
)
1749 i
->type
= V4L2_INPUT_TYPE_CAMERA
;
1750 strcpy(i
->name
, card_in(dev
, n
).name
);
1751 if (card_in(dev
, n
).tv
)
1752 i
->type
= V4L2_INPUT_TYPE_TUNER
;
1754 if (n
== dev
->ctl_input
) {
1755 int v1
= saa_readb(SAA7134_STATUS_VIDEO1
);
1756 int v2
= saa_readb(SAA7134_STATUS_VIDEO2
);
1758 if (0 != (v1
& 0x40))
1759 i
->status
|= V4L2_IN_ST_NO_H_LOCK
;
1760 if (0 != (v2
& 0x40))
1761 i
->status
|= V4L2_IN_ST_NO_SYNC
;
1762 if (0 != (v2
& 0x0e))
1763 i
->status
|= V4L2_IN_ST_MACROVISION
;
1765 i
->std
= SAA7134_NORMS
;
1769 static int saa7134_g_input(struct file
*file
, void *priv
, unsigned int *i
)
1771 struct saa7134_fh
*fh
= priv
;
1772 struct saa7134_dev
*dev
= fh
->dev
;
1774 *i
= dev
->ctl_input
;
1778 static int saa7134_s_input(struct file
*file
, void *priv
, unsigned int i
)
1780 struct saa7134_fh
*fh
= priv
;
1781 struct saa7134_dev
*dev
= fh
->dev
;
1783 if (i
>= SAA7134_INPUT_MAX
)
1785 if (NULL
== card_in(dev
, i
).name
)
1787 mutex_lock(&dev
->lock
);
1789 mutex_unlock(&dev
->lock
);
1793 static int saa7134_querycap(struct file
*file
, void *priv
,
1794 struct v4l2_capability
*cap
)
1796 struct saa7134_fh
*fh
= priv
;
1797 struct saa7134_dev
*dev
= fh
->dev
;
1798 struct video_device
*vdev
= video_devdata(file
);
1799 u32 radio_caps
, video_caps
, vbi_caps
;
1801 unsigned int tuner_type
= dev
->tuner_type
;
1803 strcpy(cap
->driver
, "saa7134");
1804 strlcpy(cap
->card
, saa7134_boards
[dev
->board
].name
,
1806 sprintf(cap
->bus_info
, "PCI:%s", pci_name(dev
->pci
));
1808 cap
->device_caps
= V4L2_CAP_READWRITE
| V4L2_CAP_STREAMING
;
1809 if ((tuner_type
!= TUNER_ABSENT
) && (tuner_type
!= UNSET
))
1810 cap
->device_caps
|= V4L2_CAP_TUNER
;
1812 radio_caps
= V4L2_CAP_RADIO
;
1814 radio_caps
|= V4L2_CAP_RDS_CAPTURE
;
1816 video_caps
= V4L2_CAP_VIDEO_CAPTURE
;
1817 if (saa7134_no_overlay
<= 0)
1818 video_caps
|= V4L2_CAP_VIDEO_OVERLAY
;
1820 vbi_caps
= V4L2_CAP_VBI_CAPTURE
;
1822 switch (vdev
->vfl_type
) {
1823 case VFL_TYPE_RADIO
:
1824 cap
->device_caps
|= radio_caps
;
1826 case VFL_TYPE_GRABBER
:
1827 cap
->device_caps
|= video_caps
;
1830 cap
->device_caps
|= vbi_caps
;
1833 cap
->capabilities
= radio_caps
| video_caps
| vbi_caps
|
1834 cap
->device_caps
| V4L2_CAP_DEVICE_CAPS
;
1835 if (vdev
->vfl_type
== VFL_TYPE_RADIO
) {
1836 cap
->device_caps
&= ~V4L2_CAP_STREAMING
;
1838 cap
->device_caps
&= ~V4L2_CAP_READWRITE
;
1844 int saa7134_s_std_internal(struct saa7134_dev
*dev
, struct saa7134_fh
*fh
, v4l2_std_id id
)
1846 unsigned long flags
;
1850 if (!fh
&& res_locked(dev
, RESOURCE_OVERLAY
)) {
1851 /* Don't change the std from the mpeg device
1852 if overlay is active. */
1856 for (i
= 0; i
< TVNORMS
; i
++)
1857 if (id
== tvnorms
[i
].id
)
1861 for (i
= 0; i
< TVNORMS
; i
++)
1862 if (id
& tvnorms
[i
].id
)
1867 if ((id
& V4L2_STD_SECAM
) && (secam
[0] != '-')) {
1868 if (secam
[0] == 'L' || secam
[0] == 'l') {
1869 if (secam
[1] == 'C' || secam
[1] == 'c')
1870 fixup
= V4L2_STD_SECAM_LC
;
1872 fixup
= V4L2_STD_SECAM_L
;
1874 if (secam
[0] == 'D' || secam
[0] == 'd')
1875 fixup
= V4L2_STD_SECAM_DK
;
1877 fixup
= V4L2_STD_SECAM
;
1879 for (i
= 0; i
< TVNORMS
; i
++) {
1880 if (fixup
== tvnorms
[i
].id
)
1889 mutex_lock(&dev
->lock
);
1890 if (fh
&& res_check(fh
, RESOURCE_OVERLAY
)) {
1891 spin_lock_irqsave(&dev
->slock
, flags
);
1892 stop_preview(dev
, fh
);
1893 spin_unlock_irqrestore(&dev
->slock
, flags
);
1895 set_tvnorm(dev
, &tvnorms
[i
]);
1897 spin_lock_irqsave(&dev
->slock
, flags
);
1898 start_preview(dev
, fh
);
1899 spin_unlock_irqrestore(&dev
->slock
, flags
);
1901 set_tvnorm(dev
, &tvnorms
[i
]);
1903 saa7134_tvaudio_do_scan(dev
);
1904 mutex_unlock(&dev
->lock
);
1907 EXPORT_SYMBOL_GPL(saa7134_s_std_internal
);
1909 static int saa7134_s_std(struct file
*file
, void *priv
, v4l2_std_id id
)
1911 struct saa7134_fh
*fh
= priv
;
1913 return saa7134_s_std_internal(fh
->dev
, fh
, id
);
1916 static int saa7134_g_std(struct file
*file
, void *priv
, v4l2_std_id
*id
)
1918 struct saa7134_fh
*fh
= priv
;
1919 struct saa7134_dev
*dev
= fh
->dev
;
1921 *id
= dev
->tvnorm
->id
;
1925 static int saa7134_cropcap(struct file
*file
, void *priv
,
1926 struct v4l2_cropcap
*cap
)
1928 struct saa7134_fh
*fh
= priv
;
1929 struct saa7134_dev
*dev
= fh
->dev
;
1931 if (cap
->type
!= V4L2_BUF_TYPE_VIDEO_CAPTURE
&&
1932 cap
->type
!= V4L2_BUF_TYPE_VIDEO_OVERLAY
)
1934 cap
->bounds
= dev
->crop_bounds
;
1935 cap
->defrect
= dev
->crop_defrect
;
1936 cap
->pixelaspect
.numerator
= 1;
1937 cap
->pixelaspect
.denominator
= 1;
1938 if (dev
->tvnorm
->id
& V4L2_STD_525_60
) {
1939 cap
->pixelaspect
.numerator
= 11;
1940 cap
->pixelaspect
.denominator
= 10;
1942 if (dev
->tvnorm
->id
& V4L2_STD_625_50
) {
1943 cap
->pixelaspect
.numerator
= 54;
1944 cap
->pixelaspect
.denominator
= 59;
1949 static int saa7134_g_crop(struct file
*file
, void *f
, struct v4l2_crop
*crop
)
1951 struct saa7134_fh
*fh
= f
;
1952 struct saa7134_dev
*dev
= fh
->dev
;
1954 if (crop
->type
!= V4L2_BUF_TYPE_VIDEO_CAPTURE
&&
1955 crop
->type
!= V4L2_BUF_TYPE_VIDEO_OVERLAY
)
1957 crop
->c
= dev
->crop_current
;
1961 static int saa7134_s_crop(struct file
*file
, void *f
, const struct v4l2_crop
*crop
)
1963 struct saa7134_fh
*fh
= f
;
1964 struct saa7134_dev
*dev
= fh
->dev
;
1965 struct v4l2_rect
*b
= &dev
->crop_bounds
;
1966 struct v4l2_rect
*c
= &dev
->crop_current
;
1968 if (crop
->type
!= V4L2_BUF_TYPE_VIDEO_CAPTURE
&&
1969 crop
->type
!= V4L2_BUF_TYPE_VIDEO_OVERLAY
)
1971 if (crop
->c
.height
< 0)
1973 if (crop
->c
.width
< 0)
1976 if (res_locked(fh
->dev
, RESOURCE_OVERLAY
))
1978 if (res_locked(fh
->dev
, RESOURCE_VIDEO
))
1982 if (c
->top
< b
->top
)
1984 if (c
->top
> b
->top
+ b
->height
)
1985 c
->top
= b
->top
+ b
->height
;
1986 if (c
->height
> b
->top
- c
->top
+ b
->height
)
1987 c
->height
= b
->top
- c
->top
+ b
->height
;
1989 if (c
->left
< b
->left
)
1991 if (c
->left
> b
->left
+ b
->width
)
1992 c
->left
= b
->left
+ b
->width
;
1993 if (c
->width
> b
->left
- c
->left
+ b
->width
)
1994 c
->width
= b
->left
- c
->left
+ b
->width
;
1998 static int saa7134_g_tuner(struct file
*file
, void *priv
,
1999 struct v4l2_tuner
*t
)
2001 struct saa7134_fh
*fh
= priv
;
2002 struct saa7134_dev
*dev
= fh
->dev
;
2007 memset(t
, 0, sizeof(*t
));
2008 for (n
= 0; n
< SAA7134_INPUT_MAX
; n
++) {
2009 if (card_in(dev
, n
).tv
)
2012 if (n
== SAA7134_INPUT_MAX
)
2014 if (NULL
!= card_in(dev
, n
).name
) {
2015 strcpy(t
->name
, "Television");
2016 t
->type
= V4L2_TUNER_ANALOG_TV
;
2017 saa_call_all(dev
, tuner
, g_tuner
, t
);
2018 t
->capability
= V4L2_TUNER_CAP_NORM
|
2019 V4L2_TUNER_CAP_STEREO
|
2020 V4L2_TUNER_CAP_LANG1
|
2021 V4L2_TUNER_CAP_LANG2
;
2022 t
->rxsubchans
= saa7134_tvaudio_getstereo(dev
);
2023 t
->audmode
= saa7134_tvaudio_rx2mode(t
->rxsubchans
);
2025 if (0 != (saa_readb(SAA7134_STATUS_VIDEO1
) & 0x03))
2030 static int saa7134_s_tuner(struct file
*file
, void *priv
,
2031 const struct v4l2_tuner
*t
)
2033 struct saa7134_fh
*fh
= priv
;
2034 struct saa7134_dev
*dev
= fh
->dev
;
2040 mode
= dev
->thread
.mode
;
2041 if (UNSET
== mode
) {
2042 rx
= saa7134_tvaudio_getstereo(dev
);
2043 mode
= saa7134_tvaudio_rx2mode(rx
);
2045 if (mode
!= t
->audmode
)
2046 dev
->thread
.mode
= t
->audmode
;
2051 static int saa7134_g_frequency(struct file
*file
, void *priv
,
2052 struct v4l2_frequency
*f
)
2054 struct saa7134_fh
*fh
= priv
;
2055 struct saa7134_dev
*dev
= fh
->dev
;
2060 f
->type
= fh
->radio
? V4L2_TUNER_RADIO
: V4L2_TUNER_ANALOG_TV
;
2061 saa_call_all(dev
, tuner
, g_frequency
, f
);
2066 static int saa7134_s_frequency(struct file
*file
, void *priv
,
2067 const struct v4l2_frequency
*f
)
2069 struct saa7134_fh
*fh
= priv
;
2070 struct saa7134_dev
*dev
= fh
->dev
;
2074 if (0 == fh
->radio
&& V4L2_TUNER_ANALOG_TV
!= f
->type
)
2076 if (1 == fh
->radio
&& V4L2_TUNER_RADIO
!= f
->type
)
2078 mutex_lock(&dev
->lock
);
2080 saa_call_all(dev
, tuner
, s_frequency
, f
);
2082 saa7134_tvaudio_do_scan(dev
);
2083 mutex_unlock(&dev
->lock
);
2087 static int saa7134_g_audio(struct file
*file
, void *priv
, struct v4l2_audio
*a
)
2089 strcpy(a
->name
, "audio");
2093 static int saa7134_s_audio(struct file
*file
, void *priv
, const struct v4l2_audio
*a
)
2098 static int saa7134_enum_fmt_vid_cap(struct file
*file
, void *priv
,
2099 struct v4l2_fmtdesc
*f
)
2101 if (f
->index
>= FORMATS
)
2104 strlcpy(f
->description
, formats
[f
->index
].name
,
2105 sizeof(f
->description
));
2107 f
->pixelformat
= formats
[f
->index
].fourcc
;
2112 static int saa7134_enum_fmt_vid_overlay(struct file
*file
, void *priv
,
2113 struct v4l2_fmtdesc
*f
)
2115 if (saa7134_no_overlay
> 0) {
2116 printk(KERN_ERR
"V4L2_BUF_TYPE_VIDEO_OVERLAY: no_overlay\n");
2120 if ((f
->index
>= FORMATS
) || formats
[f
->index
].planar
)
2123 strlcpy(f
->description
, formats
[f
->index
].name
,
2124 sizeof(f
->description
));
2126 f
->pixelformat
= formats
[f
->index
].fourcc
;
2131 static int saa7134_g_fbuf(struct file
*file
, void *f
,
2132 struct v4l2_framebuffer
*fb
)
2134 struct saa7134_fh
*fh
= f
;
2135 struct saa7134_dev
*dev
= fh
->dev
;
2138 fb
->capability
= V4L2_FBUF_CAP_LIST_CLIPPING
;
2143 static int saa7134_s_fbuf(struct file
*file
, void *f
,
2144 const struct v4l2_framebuffer
*fb
)
2146 struct saa7134_fh
*fh
= f
;
2147 struct saa7134_dev
*dev
= fh
->dev
;
2148 struct saa7134_format
*fmt
;
2150 if (!capable(CAP_SYS_ADMIN
) &&
2151 !capable(CAP_SYS_RAWIO
))
2155 fmt
= format_by_fourcc(fb
->fmt
.pixelformat
);
2162 if (0 == dev
->ovbuf
.fmt
.bytesperline
)
2163 dev
->ovbuf
.fmt
.bytesperline
=
2164 dev
->ovbuf
.fmt
.width
*fmt
->depth
/8;
2168 static int saa7134_overlay(struct file
*file
, void *f
, unsigned int on
)
2170 struct saa7134_fh
*fh
= f
;
2171 struct saa7134_dev
*dev
= fh
->dev
;
2172 unsigned long flags
;
2175 if (saa7134_no_overlay
> 0) {
2176 dprintk("no_overlay\n");
2180 if (!res_get(dev
, fh
, RESOURCE_OVERLAY
))
2182 spin_lock_irqsave(&dev
->slock
, flags
);
2183 start_preview(dev
, fh
);
2184 spin_unlock_irqrestore(&dev
->slock
, flags
);
2187 if (!res_check(fh
, RESOURCE_OVERLAY
))
2189 spin_lock_irqsave(&dev
->slock
, flags
);
2190 stop_preview(dev
, fh
);
2191 spin_unlock_irqrestore(&dev
->slock
, flags
);
2192 res_free(dev
, fh
, RESOURCE_OVERLAY
);
2197 static int saa7134_reqbufs(struct file
*file
, void *priv
,
2198 struct v4l2_requestbuffers
*p
)
2200 struct saa7134_fh
*fh
= priv
;
2201 return videobuf_reqbufs(saa7134_queue(fh
), p
);
2204 static int saa7134_querybuf(struct file
*file
, void *priv
,
2205 struct v4l2_buffer
*b
)
2207 struct saa7134_fh
*fh
= priv
;
2208 return videobuf_querybuf(saa7134_queue(fh
), b
);
2211 static int saa7134_qbuf(struct file
*file
, void *priv
, struct v4l2_buffer
*b
)
2213 struct saa7134_fh
*fh
= priv
;
2214 return videobuf_qbuf(saa7134_queue(fh
), b
);
2217 static int saa7134_dqbuf(struct file
*file
, void *priv
, struct v4l2_buffer
*b
)
2219 struct saa7134_fh
*fh
= priv
;
2220 return videobuf_dqbuf(saa7134_queue(fh
), b
,
2221 file
->f_flags
& O_NONBLOCK
);
2224 static int saa7134_streamon(struct file
*file
, void *priv
,
2225 enum v4l2_buf_type type
)
2227 struct saa7134_fh
*fh
= priv
;
2228 struct saa7134_dev
*dev
= fh
->dev
;
2229 int res
= saa7134_resource(fh
);
2231 if (!res_get(dev
, fh
, res
))
2234 /* The SAA7134 has a 1K FIFO; the datasheet suggests that when
2235 * configured conservatively, there's 22 usec of buffering for video.
2236 * We therefore request a DMA latency of 20 usec, giving us 2 usec of
2237 * margin in case the FIFO is configured differently to the datasheet.
2238 * Unfortunately, I lack register-level documentation to check the
2239 * Linux FIFO setup and confirm the perfect value.
2241 pm_qos_add_request(&fh
->qos_request
,
2242 PM_QOS_CPU_DMA_LATENCY
,
2245 return videobuf_streamon(saa7134_queue(fh
));
2248 static int saa7134_streamoff(struct file
*file
, void *priv
,
2249 enum v4l2_buf_type type
)
2252 struct saa7134_fh
*fh
= priv
;
2253 struct saa7134_dev
*dev
= fh
->dev
;
2254 int res
= saa7134_resource(fh
);
2256 pm_qos_remove_request(&fh
->qos_request
);
2258 err
= videobuf_streamoff(saa7134_queue(fh
));
2261 res_free(dev
, fh
, res
);
2265 static int saa7134_g_parm(struct file
*file
, void *fh
,
2266 struct v4l2_streamparm
*parm
)
2271 #ifdef CONFIG_VIDEO_ADV_DEBUG
2272 static int vidioc_g_register (struct file
*file
, void *priv
,
2273 struct v4l2_dbg_register
*reg
)
2275 struct saa7134_fh
*fh
= priv
;
2276 struct saa7134_dev
*dev
= fh
->dev
;
2278 if (!v4l2_chip_match_host(®
->match
))
2280 reg
->val
= saa_readb(reg
->reg
);
2285 static int vidioc_s_register (struct file
*file
, void *priv
,
2286 const struct v4l2_dbg_register
*reg
)
2288 struct saa7134_fh
*fh
= priv
;
2289 struct saa7134_dev
*dev
= fh
->dev
;
2291 if (!v4l2_chip_match_host(®
->match
))
2293 saa_writeb(reg
->reg
&0xffffff, reg
->val
);
2298 static int radio_g_tuner(struct file
*file
, void *priv
,
2299 struct v4l2_tuner
*t
)
2301 struct saa7134_fh
*fh
= file
->private_data
;
2302 struct saa7134_dev
*dev
= fh
->dev
;
2307 memset(t
, 0, sizeof(*t
));
2308 strcpy(t
->name
, "Radio");
2309 t
->type
= V4L2_TUNER_RADIO
;
2311 saa_call_all(dev
, tuner
, g_tuner
, t
);
2312 t
->audmode
&= V4L2_TUNER_MODE_MONO
| V4L2_TUNER_MODE_STEREO
;
2313 if (dev
->input
->amux
== TV
) {
2314 t
->signal
= 0xf800 - ((saa_readb(0x581) & 0x1f) << 11);
2315 t
->rxsubchans
= (saa_readb(0x529) & 0x08) ?
2316 V4L2_TUNER_SUB_STEREO
: V4L2_TUNER_SUB_MONO
;
2320 static int radio_s_tuner(struct file
*file
, void *priv
,
2321 const struct v4l2_tuner
*t
)
2323 struct saa7134_fh
*fh
= file
->private_data
;
2324 struct saa7134_dev
*dev
= fh
->dev
;
2329 saa_call_all(dev
, tuner
, s_tuner
, t
);
2333 static int radio_enum_input(struct file
*file
, void *priv
,
2334 struct v4l2_input
*i
)
2339 strcpy(i
->name
, "Radio");
2340 i
->type
= V4L2_INPUT_TYPE_TUNER
;
2345 static int radio_g_input(struct file
*filp
, void *priv
, unsigned int *i
)
2351 static int radio_g_audio(struct file
*file
, void *priv
,
2352 struct v4l2_audio
*a
)
2354 memset(a
, 0, sizeof(*a
));
2355 strcpy(a
->name
, "Radio");
2359 static int radio_s_audio(struct file
*file
, void *priv
,
2360 const struct v4l2_audio
*a
)
2365 static int radio_s_input(struct file
*filp
, void *priv
, unsigned int i
)
2370 static int radio_s_std(struct file
*file
, void *fh
, v4l2_std_id norm
)
2375 static int radio_queryctrl(struct file
*file
, void *priv
,
2376 struct v4l2_queryctrl
*c
)
2378 const struct v4l2_queryctrl
*ctrl
;
2380 if (c
->id
< V4L2_CID_BASE
||
2381 c
->id
>= V4L2_CID_LASTP1
)
2383 if (c
->id
== V4L2_CID_AUDIO_MUTE
) {
2384 ctrl
= ctrl_by_id(c
->id
);
2391 static const struct v4l2_file_operations video_fops
=
2393 .owner
= THIS_MODULE
,
2395 .release
= video_release
,
2399 .ioctl
= video_ioctl2
,
2402 static const struct v4l2_ioctl_ops video_ioctl_ops
= {
2403 .vidioc_querycap
= saa7134_querycap
,
2404 .vidioc_enum_fmt_vid_cap
= saa7134_enum_fmt_vid_cap
,
2405 .vidioc_g_fmt_vid_cap
= saa7134_g_fmt_vid_cap
,
2406 .vidioc_try_fmt_vid_cap
= saa7134_try_fmt_vid_cap
,
2407 .vidioc_s_fmt_vid_cap
= saa7134_s_fmt_vid_cap
,
2408 .vidioc_enum_fmt_vid_overlay
= saa7134_enum_fmt_vid_overlay
,
2409 .vidioc_g_fmt_vid_overlay
= saa7134_g_fmt_vid_overlay
,
2410 .vidioc_try_fmt_vid_overlay
= saa7134_try_fmt_vid_overlay
,
2411 .vidioc_s_fmt_vid_overlay
= saa7134_s_fmt_vid_overlay
,
2412 .vidioc_g_fmt_vbi_cap
= saa7134_try_get_set_fmt_vbi_cap
,
2413 .vidioc_try_fmt_vbi_cap
= saa7134_try_get_set_fmt_vbi_cap
,
2414 .vidioc_s_fmt_vbi_cap
= saa7134_try_get_set_fmt_vbi_cap
,
2415 .vidioc_g_audio
= saa7134_g_audio
,
2416 .vidioc_s_audio
= saa7134_s_audio
,
2417 .vidioc_cropcap
= saa7134_cropcap
,
2418 .vidioc_reqbufs
= saa7134_reqbufs
,
2419 .vidioc_querybuf
= saa7134_querybuf
,
2420 .vidioc_qbuf
= saa7134_qbuf
,
2421 .vidioc_dqbuf
= saa7134_dqbuf
,
2422 .vidioc_s_std
= saa7134_s_std
,
2423 .vidioc_g_std
= saa7134_g_std
,
2424 .vidioc_enum_input
= saa7134_enum_input
,
2425 .vidioc_g_input
= saa7134_g_input
,
2426 .vidioc_s_input
= saa7134_s_input
,
2427 .vidioc_queryctrl
= saa7134_queryctrl
,
2428 .vidioc_g_ctrl
= saa7134_g_ctrl
,
2429 .vidioc_s_ctrl
= saa7134_s_ctrl
,
2430 .vidioc_streamon
= saa7134_streamon
,
2431 .vidioc_streamoff
= saa7134_streamoff
,
2432 .vidioc_g_tuner
= saa7134_g_tuner
,
2433 .vidioc_s_tuner
= saa7134_s_tuner
,
2434 .vidioc_g_crop
= saa7134_g_crop
,
2435 .vidioc_s_crop
= saa7134_s_crop
,
2436 .vidioc_g_fbuf
= saa7134_g_fbuf
,
2437 .vidioc_s_fbuf
= saa7134_s_fbuf
,
2438 .vidioc_overlay
= saa7134_overlay
,
2439 .vidioc_g_parm
= saa7134_g_parm
,
2440 .vidioc_g_frequency
= saa7134_g_frequency
,
2441 .vidioc_s_frequency
= saa7134_s_frequency
,
2442 #ifdef CONFIG_VIDEO_ADV_DEBUG
2443 .vidioc_g_register
= vidioc_g_register
,
2444 .vidioc_s_register
= vidioc_s_register
,
2448 static const struct v4l2_file_operations radio_fops
= {
2449 .owner
= THIS_MODULE
,
2452 .release
= video_release
,
2453 .ioctl
= video_ioctl2
,
2457 static const struct v4l2_ioctl_ops radio_ioctl_ops
= {
2458 .vidioc_querycap
= saa7134_querycap
,
2459 .vidioc_g_tuner
= radio_g_tuner
,
2460 .vidioc_enum_input
= radio_enum_input
,
2461 .vidioc_g_audio
= radio_g_audio
,
2462 .vidioc_s_tuner
= radio_s_tuner
,
2463 .vidioc_s_audio
= radio_s_audio
,
2464 .vidioc_s_input
= radio_s_input
,
2465 .vidioc_s_std
= radio_s_std
,
2466 .vidioc_queryctrl
= radio_queryctrl
,
2467 .vidioc_g_input
= radio_g_input
,
2468 .vidioc_g_ctrl
= saa7134_g_ctrl
,
2469 .vidioc_s_ctrl
= saa7134_s_ctrl
,
2470 .vidioc_g_frequency
= saa7134_g_frequency
,
2471 .vidioc_s_frequency
= saa7134_s_frequency
,
2474 /* ----------------------------------------------------------- */
2475 /* exported stuff */
2477 struct video_device saa7134_video_template
= {
2478 .name
= "saa7134-video",
2479 .fops
= &video_fops
,
2480 .ioctl_ops
= &video_ioctl_ops
,
2481 .tvnorms
= SAA7134_NORMS
,
2482 .current_norm
= V4L2_STD_PAL
,
2485 struct video_device saa7134_radio_template
= {
2486 .name
= "saa7134-radio",
2487 .fops
= &radio_fops
,
2488 .ioctl_ops
= &radio_ioctl_ops
,
2491 int saa7134_video_init1(struct saa7134_dev
*dev
)
2493 /* sanitycheck insmod options */
2494 if (gbuffers
< 2 || gbuffers
> VIDEO_MAX_FRAME
)
2496 if (gbufsize
> gbufsize_max
)
2497 gbufsize
= gbufsize_max
;
2498 gbufsize
= (gbufsize
+ PAGE_SIZE
- 1) & PAGE_MASK
;
2500 /* put some sensible defaults into the data structures ... */
2501 dev
->ctl_bright
= ctrl_by_id(V4L2_CID_BRIGHTNESS
)->default_value
;
2502 dev
->ctl_contrast
= ctrl_by_id(V4L2_CID_CONTRAST
)->default_value
;
2503 dev
->ctl_hue
= ctrl_by_id(V4L2_CID_HUE
)->default_value
;
2504 dev
->ctl_saturation
= ctrl_by_id(V4L2_CID_SATURATION
)->default_value
;
2505 dev
->ctl_volume
= ctrl_by_id(V4L2_CID_AUDIO_VOLUME
)->default_value
;
2506 dev
->ctl_mute
= 1; // ctrl_by_id(V4L2_CID_AUDIO_MUTE)->default_value;
2507 dev
->ctl_invert
= ctrl_by_id(V4L2_CID_PRIVATE_INVERT
)->default_value
;
2508 dev
->ctl_automute
= ctrl_by_id(V4L2_CID_PRIVATE_AUTOMUTE
)->default_value
;
2510 if (dev
->tda9887_conf
&& dev
->ctl_automute
)
2511 dev
->tda9887_conf
|= TDA9887_AUTOMUTE
;
2514 INIT_LIST_HEAD(&dev
->video_q
.queue
);
2515 init_timer(&dev
->video_q
.timeout
);
2516 dev
->video_q
.timeout
.function
= saa7134_buffer_timeout
;
2517 dev
->video_q
.timeout
.data
= (unsigned long)(&dev
->video_q
);
2518 dev
->video_q
.dev
= dev
;
2520 if (saa7134_boards
[dev
->board
].video_out
)
2521 saa7134_videoport_init(dev
);
2526 int saa7134_videoport_init(struct saa7134_dev
*dev
)
2528 /* enable video output */
2529 int vo
= saa7134_boards
[dev
->board
].video_out
;
2531 unsigned int vid_port_opts
= saa7134_boards
[dev
->board
].vid_port_opts
;
2533 /* Configure videoport */
2534 saa_writeb(SAA7134_VIDEO_PORT_CTRL0
, video_out
[vo
][0]);
2535 video_reg
= video_out
[vo
][1];
2536 if (vid_port_opts
& SET_T_CODE_POLARITY_NON_INVERTED
)
2537 video_reg
&= ~VP_T_CODE_P_INVERTED
;
2538 saa_writeb(SAA7134_VIDEO_PORT_CTRL1
, video_reg
);
2539 saa_writeb(SAA7134_VIDEO_PORT_CTRL2
, video_out
[vo
][2]);
2540 saa_writeb(SAA7134_VIDEO_PORT_CTRL4
, video_out
[vo
][4]);
2541 video_reg
= video_out
[vo
][5];
2542 if (vid_port_opts
& SET_CLOCK_NOT_DELAYED
)
2543 video_reg
&= ~VP_CLK_CTRL2_DELAYED
;
2544 if (vid_port_opts
& SET_CLOCK_INVERTED
)
2545 video_reg
|= VP_CLK_CTRL1_INVERTED
;
2546 saa_writeb(SAA7134_VIDEO_PORT_CTRL5
, video_reg
);
2547 video_reg
= video_out
[vo
][6];
2548 if (vid_port_opts
& SET_VSYNC_OFF
) {
2549 video_reg
&= ~VP_VS_TYPE_MASK
;
2550 video_reg
|= VP_VS_TYPE_OFF
;
2552 saa_writeb(SAA7134_VIDEO_PORT_CTRL6
, video_reg
);
2553 saa_writeb(SAA7134_VIDEO_PORT_CTRL7
, video_out
[vo
][7]);
2554 saa_writeb(SAA7134_VIDEO_PORT_CTRL8
, video_out
[vo
][8]);
2556 /* Start videoport */
2557 saa_writeb(SAA7134_VIDEO_PORT_CTRL3
, video_out
[vo
][3]);
2562 int saa7134_video_init2(struct saa7134_dev
*dev
)
2565 set_tvnorm(dev
,&tvnorms
[0]);
2567 saa7134_tvaudio_setmute(dev
);
2568 saa7134_tvaudio_setvolume(dev
,dev
->ctl_volume
);
2572 void saa7134_irq_video_signalchange(struct saa7134_dev
*dev
)
2574 static const char *st
[] = {
2575 "(no signal)", "NTSC", "PAL", "SECAM" };
2578 st1
= saa_readb(SAA7134_STATUS_VIDEO1
);
2579 st2
= saa_readb(SAA7134_STATUS_VIDEO2
);
2580 dprintk("DCSDT: pll: %s, sync: %s, norm: %s\n",
2581 (st1
& 0x40) ? "not locked" : "locked",
2582 (st2
& 0x40) ? "no" : "yes",
2584 dev
->nosignal
= (st1
& 0x40) || (st2
& 0x40) || !(st2
& 0x1);
2586 if (dev
->nosignal
) {
2587 /* no video signal -> mute audio */
2588 if (dev
->ctl_automute
)
2590 saa7134_tvaudio_setmute(dev
);
2592 /* wake up tvaudio audio carrier scan thread */
2593 saa7134_tvaudio_do_scan(dev
);
2596 if ((st2
& 0x80) && !noninterlaced
&& !dev
->nosignal
)
2597 saa_clearb(SAA7134_SYNC_CTRL
, 0x20);
2599 saa_setb(SAA7134_SYNC_CTRL
, 0x20);
2601 if (dev
->mops
&& dev
->mops
->signal_change
)
2602 dev
->mops
->signal_change(dev
);
2606 void saa7134_irq_video_done(struct saa7134_dev
*dev
, unsigned long status
)
2608 enum v4l2_field field
;
2610 spin_lock(&dev
->slock
);
2611 if (dev
->video_q
.curr
) {
2612 dev
->video_fieldcount
++;
2613 field
= dev
->video_q
.curr
->vb
.field
;
2614 if (V4L2_FIELD_HAS_BOTH(field
)) {
2615 /* make sure we have seen both fields */
2616 if ((status
& 0x10) == 0x00) {
2617 dev
->video_q
.curr
->top_seen
= 1;
2620 if (!dev
->video_q
.curr
->top_seen
)
2622 } else if (field
== V4L2_FIELD_TOP
) {
2623 if ((status
& 0x10) != 0x10)
2625 } else if (field
== V4L2_FIELD_BOTTOM
) {
2626 if ((status
& 0x10) != 0x00)
2629 dev
->video_q
.curr
->vb
.field_count
= dev
->video_fieldcount
;
2630 saa7134_buffer_finish(dev
,&dev
->video_q
,VIDEOBUF_DONE
);
2632 saa7134_buffer_next(dev
,&dev
->video_q
);
2635 spin_unlock(&dev
->slock
);
2638 /* ----------------------------------------------------------- */