bttv-driver.c 115.1 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3 4 5
/*

    bttv - Bt848 frame grabber driver

    Copyright (C) 1996,97,98 Ralph  Metzler <rjkm@thp.uni-koeln.de>
6
			   & Marcus Metzler <mocm@thp.uni-koeln.de>
L
Linus Torvalds 已提交
7 8 9 10 11
    (c) 1999-2002 Gerd Knorr <kraxel@bytesex.org>

    some v4l2 code lines are taken from Justin's bttv2 driver which is
    (c) 2000 Justin Schoeman <justin@suntiger.ee.up.ac.za>

12 13 14
    V4L1 removal from:
    (c) 2005-2006 Nickolay V. Shmyrev <nshmyrev@yandex.ru>

15 16 17
    Fixes to be fully V4L2 compliant by
    (c) 2006 Mauro Carvalho Chehab <mchehab@infradead.org>

18 19 20 21
    Cropping and overscan support
    Copyright (C) 2005, 2006 Michael H. Schimek <mschimek@gmx.at>
    Sponsored by OPQ Systems AB

L
Linus Torvalds 已提交
22 23 24 25 26 27 28 29 30 31 32 33 34 35 36
    This program is free software; you can redistribute it and/or modify
    it under the terms of the GNU General Public License as published by
    the Free Software Foundation; either version 2 of the License, or
    (at your option) any later version.

    This program is distributed in the hope that it will be useful,
    but WITHOUT ANY WARRANTY; without even the implied warranty of
    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
    GNU General Public License for more details.

    You should have received a copy of the GNU General Public License
    along with this program; if not, write to the Free Software
    Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
*/

37 38
#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt

L
Linus Torvalds 已提交
39 40 41
#include <linux/init.h>
#include <linux/module.h>
#include <linux/delay.h>
42
#include <linux/slab.h>
L
Linus Torvalds 已提交
43 44 45 46 47 48
#include <linux/errno.h>
#include <linux/fs.h>
#include <linux/kernel.h>
#include <linux/sched.h>
#include <linux/interrupt.h>
#include <linux/kdev_t.h>
49
#include "bttvp.h"
50
#include <media/v4l2-common.h>
51
#include <media/v4l2-ioctl.h>
52
#include <media/v4l2-chip-ident.h>
53
#include <media/tvaudio.h>
54
#include <media/msp3400.h>
55

M
Mauro Carvalho Chehab 已提交
56
#include <linux/dma-mapping.h>
L
Linus Torvalds 已提交
57 58 59 60

#include <asm/io.h>
#include <asm/byteorder.h>

61
#include <media/saa6588.h>
62

63
#define BTTV_VERSION "0.9.19"
64

L
Linus Torvalds 已提交
65
unsigned int bttv_num;			/* number of Bt848s in use */
66
struct bttv *bttvs[BTTV_MAX];
L
Linus Torvalds 已提交
67

68
unsigned int bttv_debug;
L
Linus Torvalds 已提交
69
unsigned int bttv_verbose = 1;
70
unsigned int bttv_gpio;
L
Linus Torvalds 已提交
71 72 73 74 75

/* config variables */
#ifdef __BIG_ENDIAN
static unsigned int bigendian=1;
#else
76
static unsigned int bigendian;
L
Linus Torvalds 已提交
77 78
#endif
static unsigned int radio[BTTV_MAX];
79
static unsigned int irq_debug;
L
Linus Torvalds 已提交
80 81
static unsigned int gbuffers = 8;
static unsigned int gbufsize = 0x208000;
82
static unsigned int reset_crop = 1;
L
Linus Torvalds 已提交
83

84 85 86
static int video_nr[BTTV_MAX] = { [0 ... (BTTV_MAX-1)] = -1 };
static int radio_nr[BTTV_MAX] = { [0 ... (BTTV_MAX-1)] = -1 };
static int vbi_nr[BTTV_MAX] = { [0 ... (BTTV_MAX-1)] = -1 };
87
static int debug_latency;
88
static int disable_ir;
L
Linus Torvalds 已提交
89

90
static unsigned int fdsr;
L
Linus Torvalds 已提交
91 92

/* options */
93 94
static unsigned int combfilter;
static unsigned int lumafilter;
L
Linus Torvalds 已提交
95
static unsigned int automute    = 1;
96
static unsigned int chroma_agc;
97
static unsigned int agc_crush   = 1;
L
Linus Torvalds 已提交
98 99
static unsigned int whitecrush_upper = 0xCF;
static unsigned int whitecrush_lower = 0x7F;
100 101
static unsigned int vcr_hack;
static unsigned int irq_iswitch;
102
static unsigned int uv_ratio    = 50;
103 104
static unsigned int full_luma_range;
static unsigned int coring;
L
Linus Torvalds 已提交
105 106 107 108 109 110 111 112 113 114

/* API features (turn on/off stuff for testing) */
static unsigned int v4l2        = 1;

/* insmod args */
module_param(bttv_verbose,      int, 0644);
module_param(bttv_gpio,         int, 0644);
module_param(bttv_debug,        int, 0644);
module_param(irq_debug,         int, 0644);
module_param(debug_latency,     int, 0644);
115
module_param(disable_ir,        int, 0444);
L
Linus Torvalds 已提交
116 117 118 119

module_param(fdsr,              int, 0444);
module_param(gbuffers,          int, 0444);
module_param(gbufsize,          int, 0444);
120
module_param(reset_crop,        int, 0444);
L
Linus Torvalds 已提交
121 122 123 124 125 126 127 128

module_param(v4l2,              int, 0644);
module_param(bigendian,         int, 0644);
module_param(irq_iswitch,       int, 0644);
module_param(combfilter,        int, 0444);
module_param(lumafilter,        int, 0444);
module_param(automute,          int, 0444);
module_param(chroma_agc,        int, 0444);
129
module_param(agc_crush,         int, 0444);
L
Linus Torvalds 已提交
130 131 132
module_param(whitecrush_upper,  int, 0444);
module_param(whitecrush_lower,  int, 0444);
module_param(vcr_hack,          int, 0444);
133 134 135
module_param(uv_ratio,          int, 0444);
module_param(full_luma_range,   int, 0444);
module_param(coring,            int, 0444);
L
Linus Torvalds 已提交
136

137 138 139 140
module_param_array(radio,       int, NULL, 0444);
module_param_array(video_nr,    int, NULL, 0444);
module_param_array(radio_nr,    int, NULL, 0444);
module_param_array(vbi_nr,      int, NULL, 0444);
L
Linus Torvalds 已提交
141

142 143 144 145 146 147
MODULE_PARM_DESC(radio, "The TV card supports radio, default is 0 (no)");
MODULE_PARM_DESC(bigendian, "byte order of the framebuffer, default is native endian");
MODULE_PARM_DESC(bttv_verbose, "verbose startup messages, default is 1 (yes)");
MODULE_PARM_DESC(bttv_gpio, "log gpio changes, default is 0 (no)");
MODULE_PARM_DESC(bttv_debug, "debug messages, default is 0 (no)");
MODULE_PARM_DESC(irq_debug, "irq handler debug messages, default is 0 (no)");
148
MODULE_PARM_DESC(disable_ir, "disable infrared remote support");
149 150 151
MODULE_PARM_DESC(gbuffers, "number of capture buffers. range 2-32, default 8");
MODULE_PARM_DESC(gbufsize, "size of the capture buffers, default is 0x208000");
MODULE_PARM_DESC(reset_crop, "reset cropping parameters at open(), default "
152
		 "is 1 (yes) for compatibility with older applications");
153 154 155 156 157 158 159 160 161 162
MODULE_PARM_DESC(automute, "mute audio on bad/missing video signal, default is 1 (yes)");
MODULE_PARM_DESC(chroma_agc, "enables the AGC of chroma signal, default is 0 (no)");
MODULE_PARM_DESC(agc_crush, "enables the luminance AGC crush, default is 1 (yes)");
MODULE_PARM_DESC(whitecrush_upper, "sets the white crush upper value, default is 207");
MODULE_PARM_DESC(whitecrush_lower, "sets the white crush lower value, default is 127");
MODULE_PARM_DESC(vcr_hack, "enables the VCR hack (improves synch on poor VCR tapes), default is 0 (no)");
MODULE_PARM_DESC(irq_iswitch, "switch inputs in irq handler");
MODULE_PARM_DESC(uv_ratio, "ratio between u and v gains, default is 50");
MODULE_PARM_DESC(full_luma_range, "use the full luma range, default is 0 (no)");
MODULE_PARM_DESC(coring, "set the luma coring level, default is 0 (no)");
163 164 165
MODULE_PARM_DESC(video_nr, "video device numbers");
MODULE_PARM_DESC(vbi_nr, "vbi device numbers");
MODULE_PARM_DESC(radio_nr, "radio device numbers");
L
Linus Torvalds 已提交
166 167 168 169

MODULE_DESCRIPTION("bttv - v4l/v4l2 driver module for bt848/878 based cards");
MODULE_AUTHOR("Ralph Metzler & Marcus Metzler & Gerd Knorr");
MODULE_LICENSE("GPL");
170
MODULE_VERSION(BTTV_VERSION);
L
Linus Torvalds 已提交
171

172 173 174 175 176 177 178 179 180 181 182
#define V4L2_CID_PRIVATE_COMBFILTER		(V4L2_CID_USER_BTTV_BASE + 0)
#define V4L2_CID_PRIVATE_AUTOMUTE		(V4L2_CID_USER_BTTV_BASE + 1)
#define V4L2_CID_PRIVATE_LUMAFILTER		(V4L2_CID_USER_BTTV_BASE + 2)
#define V4L2_CID_PRIVATE_AGC_CRUSH		(V4L2_CID_USER_BTTV_BASE + 3)
#define V4L2_CID_PRIVATE_VCR_HACK		(V4L2_CID_USER_BTTV_BASE + 4)
#define V4L2_CID_PRIVATE_WHITECRUSH_LOWER	(V4L2_CID_USER_BTTV_BASE + 5)
#define V4L2_CID_PRIVATE_WHITECRUSH_UPPER	(V4L2_CID_USER_BTTV_BASE + 6)
#define V4L2_CID_PRIVATE_UV_RATIO		(V4L2_CID_USER_BTTV_BASE + 7)
#define V4L2_CID_PRIVATE_FULL_LUMA_RANGE	(V4L2_CID_USER_BTTV_BASE + 8)
#define V4L2_CID_PRIVATE_CORING			(V4L2_CID_USER_BTTV_BASE + 9)

L
Linus Torvalds 已提交
183 184 185
/* ----------------------------------------------------------------------- */
/* sysfs                                                                   */

186 187
static ssize_t show_card(struct device *cd,
			 struct device_attribute *attr, char *buf)
L
Linus Torvalds 已提交
188
{
189
	struct video_device *vfd = container_of(cd, struct video_device, dev);
190
	struct bttv *btv = video_get_drvdata(vfd);
L
Linus Torvalds 已提交
191 192
	return sprintf(buf, "%d\n", btv ? btv->c.type : UNSET);
}
193
static DEVICE_ATTR(card, S_IRUGO, show_card, NULL);
L
Linus Torvalds 已提交
194

195 196 197 198 199 200 201 202 203 204 205 206 207
/* ----------------------------------------------------------------------- */
/* dvb auto-load setup                                                     */
#if defined(CONFIG_MODULES) && defined(MODULE)
static void request_module_async(struct work_struct *work)
{
	request_module("dvb-bt8xx");
}

static void request_modules(struct bttv *dev)
{
	INIT_WORK(&dev->request_module_wk, request_module_async);
	schedule_work(&dev->request_module_wk);
}
208 209 210

static void flush_request_modules(struct bttv *dev)
{
211
	flush_work(&dev->request_module_wk);
212
}
213 214
#else
#define request_modules(dev)
215
#define flush_request_modules(dev) do {} while(0)
216 217 218
#endif /* CONFIG_MODULES */


L
Linus Torvalds 已提交
219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250 251 252 253 254 255
/* ----------------------------------------------------------------------- */
/* static data                                                             */

/* special timing tables from conexant... */
static u8 SRAM_Table[][60] =
{
	/* PAL digital input over GPIO[7:0] */
	{
		45, // 45 bytes following
		0x36,0x11,0x01,0x00,0x90,0x02,0x05,0x10,0x04,0x16,
		0x12,0x05,0x11,0x00,0x04,0x12,0xC0,0x00,0x31,0x00,
		0x06,0x51,0x08,0x03,0x89,0x08,0x07,0xC0,0x44,0x00,
		0x81,0x01,0x01,0xA9,0x0D,0x02,0x02,0x50,0x03,0x37,
		0x37,0x00,0xAF,0x21,0x00
	},
	/* NTSC digital input over GPIO[7:0] */
	{
		51, // 51 bytes following
		0x0C,0xC0,0x00,0x00,0x90,0x02,0x03,0x10,0x03,0x06,
		0x10,0x04,0x12,0x12,0x05,0x02,0x13,0x04,0x19,0x00,
		0x04,0x39,0x00,0x06,0x59,0x08,0x03,0x83,0x08,0x07,
		0x03,0x50,0x00,0xC0,0x40,0x00,0x86,0x01,0x01,0xA6,
		0x0D,0x02,0x03,0x11,0x01,0x05,0x37,0x00,0xAC,0x21,
		0x00,
	},
	// TGB_NTSC392 // quartzsight
	// This table has been modified to be used for Fusion Rev D
	{
		0x2A, // size of table = 42
		0x06, 0x08, 0x04, 0x0a, 0xc0, 0x00, 0x18, 0x08, 0x03, 0x24,
		0x08, 0x07, 0x02, 0x90, 0x02, 0x08, 0x10, 0x04, 0x0c, 0x10,
		0x05, 0x2c, 0x11, 0x04, 0x55, 0x48, 0x00, 0x05, 0x50, 0x00,
		0xbf, 0x0c, 0x02, 0x2f, 0x3d, 0x00, 0x2f, 0x3f, 0x00, 0xc3,
		0x20, 0x00
	}
};

256 257 258 259 260 261 262 263 264 265 266 267 268 269 270 271 272 273 274 275 276 277 278 279 280 281 282
/* minhdelayx1	first video pixel we can capture on a line and
   hdelayx1	start of active video, both relative to rising edge of
		/HRESET pulse (0H) in 1 / fCLKx1.
   swidth	width of active video and
   totalwidth	total line width, both in 1 / fCLKx1.
   sqwidth	total line width in square pixels.
   vdelay	start of active video in 2 * field lines relative to
		trailing edge of /VRESET pulse (VDELAY register).
   sheight	height of active video in 2 * field lines.
   videostart0	ITU-R frame line number of the line corresponding
		to vdelay in the first field. */
#define CROPCAP(minhdelayx1, hdelayx1, swidth, totalwidth, sqwidth,	 \
		vdelay, sheight, videostart0)				 \
	.cropcap.bounds.left = minhdelayx1,				 \
	/* * 2 because vertically we count field lines times two, */	 \
	/* e.g. 23 * 2 to 23 * 2 + 576 in PAL-BGHI defrect. */		 \
	.cropcap.bounds.top = (videostart0) * 2 - (vdelay) + MIN_VDELAY, \
	/* 4 is a safety margin at the end of the line. */		 \
	.cropcap.bounds.width = (totalwidth) - (minhdelayx1) - 4,	 \
	.cropcap.bounds.height = (sheight) + (vdelay) - MIN_VDELAY,	 \
	.cropcap.defrect.left = hdelayx1,				 \
	.cropcap.defrect.top = (videostart0) * 2,			 \
	.cropcap.defrect.width = swidth,				 \
	.cropcap.defrect.height = sheight,				 \
	.cropcap.pixelaspect.numerator = totalwidth,			 \
	.cropcap.pixelaspect.denominator = sqwidth,

L
Linus Torvalds 已提交
283 284
const struct bttv_tvnorm bttv_tvnorms[] = {
	/* PAL-BDGHI */
285 286
	/* max. active video is actually 922, but 924 is divisible by 4 and 3! */
	/* actually, max active PAL with HSCALE=0 is 948, NTSC is 768 - nil */
L
Linus Torvalds 已提交
287 288 289 290 291 292 293 294 295 296 297 298 299 300
	{
		.v4l2_id        = V4L2_STD_PAL,
		.name           = "PAL",
		.Fsc            = 35468950,
		.swidth         = 924,
		.sheight        = 576,
		.totalwidth     = 1135,
		.adelay         = 0x7f,
		.bdelay         = 0x72,
		.iform          = (BT848_IFORM_PAL_BDGHI|BT848_IFORM_XT1),
		.scaledtwidth   = 1135,
		.hdelayx1       = 186,
		.hactivex1      = 924,
		.vdelay         = 0x20,
301
		.vbipack        = 255, /* min (2048 / 4, 0x1ff) & 0xff */
L
Linus Torvalds 已提交
302
		.sram           = 0,
303
		/* ITU-R frame line number of the first VBI line
304 305 306 307 308 309 310 311 312 313 314 315 316 317
		   we can capture, of the first and second field.
		   The last line is determined by cropcap.bounds. */
		.vbistart       = { 7, 320 },
		CROPCAP(/* minhdelayx1 */ 68,
			/* hdelayx1 */ 186,
			/* Should be (768 * 1135 + 944 / 2) / 944.
			   cropcap.defrect is used for image width
			   checks, so we keep the old value 924. */
			/* swidth */ 924,
			/* totalwidth */ 1135,
			/* sqwidth */ 944,
			/* vdelay */ 0x20,
		/* bt878 (and bt848?) can capture another
		   line below active video. */
318 319
			/* sheight */ (576 + 2) + 0x20 - 2,
			/* videostart0 */ 23)
L
Linus Torvalds 已提交
320
	},{
321
		.v4l2_id        = V4L2_STD_NTSC_M | V4L2_STD_NTSC_M_KR,
L
Linus Torvalds 已提交
322 323 324 325 326 327 328 329 330 331 332 333
		.name           = "NTSC",
		.Fsc            = 28636363,
		.swidth         = 768,
		.sheight        = 480,
		.totalwidth     = 910,
		.adelay         = 0x68,
		.bdelay         = 0x5d,
		.iform          = (BT848_IFORM_NTSC|BT848_IFORM_XT0),
		.scaledtwidth   = 910,
		.hdelayx1       = 128,
		.hactivex1      = 910,
		.vdelay         = 0x1a,
334
		.vbipack        = 144, /* min (1600 / 4, 0x1ff) & 0xff */
L
Linus Torvalds 已提交
335
		.sram           = 1,
336
		.vbistart	= { 10, 273 },
337 338 339 340 341 342 343 344 345
		CROPCAP(/* minhdelayx1 */ 68,
			/* hdelayx1 */ 128,
			/* Should be (640 * 910 + 780 / 2) / 780? */
			/* swidth */ 768,
			/* totalwidth */ 910,
			/* sqwidth */ 780,
			/* vdelay */ 0x1a,
			/* sheight */ 480,
			/* videostart0 */ 23)
L
Linus Torvalds 已提交
346 347 348 349 350 351 352 353 354 355 356 357 358 359 360 361
	},{
		.v4l2_id        = V4L2_STD_SECAM,
		.name           = "SECAM",
		.Fsc            = 35468950,
		.swidth         = 924,
		.sheight        = 576,
		.totalwidth     = 1135,
		.adelay         = 0x7f,
		.bdelay         = 0xb0,
		.iform          = (BT848_IFORM_SECAM|BT848_IFORM_XT1),
		.scaledtwidth   = 1135,
		.hdelayx1       = 186,
		.hactivex1      = 922,
		.vdelay         = 0x20,
		.vbipack        = 255,
		.sram           = 0, /* like PAL, correct? */
362
		.vbistart	= { 7, 320 },
363 364 365 366 367 368 369 370
		CROPCAP(/* minhdelayx1 */ 68,
			/* hdelayx1 */ 186,
			/* swidth */ 924,
			/* totalwidth */ 1135,
			/* sqwidth */ 944,
			/* vdelay */ 0x20,
			/* sheight */ 576,
			/* videostart0 */ 23)
L
Linus Torvalds 已提交
371 372 373 374 375 376 377 378 379 380 381 382 383 384 385 386
	},{
		.v4l2_id        = V4L2_STD_PAL_Nc,
		.name           = "PAL-Nc",
		.Fsc            = 28636363,
		.swidth         = 640,
		.sheight        = 576,
		.totalwidth     = 910,
		.adelay         = 0x68,
		.bdelay         = 0x5d,
		.iform          = (BT848_IFORM_PAL_NC|BT848_IFORM_XT0),
		.scaledtwidth   = 780,
		.hdelayx1       = 130,
		.hactivex1      = 734,
		.vdelay         = 0x1a,
		.vbipack        = 144,
		.sram           = -1,
387
		.vbistart	= { 7, 320 },
388 389 390 391 392 393 394 395
		CROPCAP(/* minhdelayx1 */ 68,
			/* hdelayx1 */ 130,
			/* swidth */ (640 * 910 + 780 / 2) / 780,
			/* totalwidth */ 910,
			/* sqwidth */ 780,
			/* vdelay */ 0x1a,
			/* sheight */ 576,
			/* videostart0 */ 23)
L
Linus Torvalds 已提交
396 397 398 399 400 401 402 403 404 405 406 407 408 409 410 411
	},{
		.v4l2_id        = V4L2_STD_PAL_M,
		.name           = "PAL-M",
		.Fsc            = 28636363,
		.swidth         = 640,
		.sheight        = 480,
		.totalwidth     = 910,
		.adelay         = 0x68,
		.bdelay         = 0x5d,
		.iform          = (BT848_IFORM_PAL_M|BT848_IFORM_XT0),
		.scaledtwidth   = 780,
		.hdelayx1       = 135,
		.hactivex1      = 754,
		.vdelay         = 0x1a,
		.vbipack        = 144,
		.sram           = -1,
412
		.vbistart	= { 10, 273 },
413 414 415 416 417 418 419 420
		CROPCAP(/* minhdelayx1 */ 68,
			/* hdelayx1 */ 135,
			/* swidth */ (640 * 910 + 780 / 2) / 780,
			/* totalwidth */ 910,
			/* sqwidth */ 780,
			/* vdelay */ 0x1a,
			/* sheight */ 480,
			/* videostart0 */ 23)
L
Linus Torvalds 已提交
421 422 423 424 425 426 427 428 429 430 431 432 433 434 435 436
	},{
		.v4l2_id        = V4L2_STD_PAL_N,
		.name           = "PAL-N",
		.Fsc            = 35468950,
		.swidth         = 768,
		.sheight        = 576,
		.totalwidth     = 1135,
		.adelay         = 0x7f,
		.bdelay         = 0x72,
		.iform          = (BT848_IFORM_PAL_N|BT848_IFORM_XT1),
		.scaledtwidth   = 944,
		.hdelayx1       = 186,
		.hactivex1      = 922,
		.vdelay         = 0x20,
		.vbipack        = 144,
		.sram           = -1,
437 438 439 440 441 442 443 444 445
		.vbistart       = { 7, 320 },
		CROPCAP(/* minhdelayx1 */ 68,
			/* hdelayx1 */ 186,
			/* swidth */ (768 * 1135 + 944 / 2) / 944,
			/* totalwidth */ 1135,
			/* sqwidth */ 944,
			/* vdelay */ 0x20,
			/* sheight */ 576,
			/* videostart0 */ 23)
L
Linus Torvalds 已提交
446 447 448 449 450 451 452 453 454 455 456 457 458 459 460 461
	},{
		.v4l2_id        = V4L2_STD_NTSC_M_JP,
		.name           = "NTSC-JP",
		.Fsc            = 28636363,
		.swidth         = 640,
		.sheight        = 480,
		.totalwidth     = 910,
		.adelay         = 0x68,
		.bdelay         = 0x5d,
		.iform          = (BT848_IFORM_NTSC_J|BT848_IFORM_XT0),
		.scaledtwidth   = 780,
		.hdelayx1       = 135,
		.hactivex1      = 754,
		.vdelay         = 0x16,
		.vbipack        = 144,
		.sram           = -1,
462 463 464 465 466 467 468 469 470
		.vbistart       = { 10, 273 },
		CROPCAP(/* minhdelayx1 */ 68,
			/* hdelayx1 */ 135,
			/* swidth */ (640 * 910 + 780 / 2) / 780,
			/* totalwidth */ 910,
			/* sqwidth */ 780,
			/* vdelay */ 0x16,
			/* sheight */ 480,
			/* videostart0 */ 23)
L
Linus Torvalds 已提交
471 472 473 474 475 476 477 478 479 480 481 482 483 484 485 486 487 488 489 490
	},{
		/* that one hopefully works with the strange timing
		 * which video recorders produce when playing a NTSC
		 * tape on a PAL TV ... */
		.v4l2_id        = V4L2_STD_PAL_60,
		.name           = "PAL-60",
		.Fsc            = 35468950,
		.swidth         = 924,
		.sheight        = 480,
		.totalwidth     = 1135,
		.adelay         = 0x7f,
		.bdelay         = 0x72,
		.iform          = (BT848_IFORM_PAL_BDGHI|BT848_IFORM_XT1),
		.scaledtwidth   = 1135,
		.hdelayx1       = 186,
		.hactivex1      = 924,
		.vdelay         = 0x1a,
		.vbipack        = 255,
		.vtotal         = 524,
		.sram           = -1,
491
		.vbistart	= { 10, 273 },
492 493 494 495 496 497 498 499
		CROPCAP(/* minhdelayx1 */ 68,
			/* hdelayx1 */ 186,
			/* swidth */ 924,
			/* totalwidth */ 1135,
			/* sqwidth */ 944,
			/* vdelay */ 0x1a,
			/* sheight */ 480,
			/* videostart0 */ 23)
L
Linus Torvalds 已提交
500 501 502 503 504 505 506
	}
};
static const unsigned int BTTV_TVNORMS = ARRAY_SIZE(bttv_tvnorms);

/* ----------------------------------------------------------------------- */
/* bttv format list
   packed pixel formats must come first */
507
static const struct bttv_format formats[] = {
L
Linus Torvalds 已提交
508 509 510 511 512 513 514 515 516 517 518 519 520 521 522 523 524 525 526 527 528 529 530 531 532 533 534 535 536 537 538 539 540 541 542 543 544 545 546 547 548 549 550 551 552 553 554 555 556 557 558 559 560 561 562 563 564 565 566 567 568 569 570 571 572 573 574 575 576 577 578 579 580 581 582 583 584 585 586 587 588 589 590 591 592 593 594 595 596 597 598 599 600 601 602 603 604 605 606 607 608 609 610 611 612 613 614 615 616 617 618 619 620 621 622 623 624 625 626 627 628 629 630 631 632 633
	{
		.name     = "8 bpp, gray",
		.fourcc   = V4L2_PIX_FMT_GREY,
		.btformat = BT848_COLOR_FMT_Y8,
		.depth    = 8,
		.flags    = FORMAT_FLAGS_PACKED,
	},{
		.name     = "8 bpp, dithered color",
		.fourcc   = V4L2_PIX_FMT_HI240,
		.btformat = BT848_COLOR_FMT_RGB8,
		.depth    = 8,
		.flags    = FORMAT_FLAGS_PACKED | FORMAT_FLAGS_DITHER,
	},{
		.name     = "15 bpp RGB, le",
		.fourcc   = V4L2_PIX_FMT_RGB555,
		.btformat = BT848_COLOR_FMT_RGB15,
		.depth    = 16,
		.flags    = FORMAT_FLAGS_PACKED,
	},{
		.name     = "15 bpp RGB, be",
		.fourcc   = V4L2_PIX_FMT_RGB555X,
		.btformat = BT848_COLOR_FMT_RGB15,
		.btswap   = 0x03, /* byteswap */
		.depth    = 16,
		.flags    = FORMAT_FLAGS_PACKED,
	},{
		.name     = "16 bpp RGB, le",
		.fourcc   = V4L2_PIX_FMT_RGB565,
		.btformat = BT848_COLOR_FMT_RGB16,
		.depth    = 16,
		.flags    = FORMAT_FLAGS_PACKED,
	},{
		.name     = "16 bpp RGB, be",
		.fourcc   = V4L2_PIX_FMT_RGB565X,
		.btformat = BT848_COLOR_FMT_RGB16,
		.btswap   = 0x03, /* byteswap */
		.depth    = 16,
		.flags    = FORMAT_FLAGS_PACKED,
	},{
		.name     = "24 bpp RGB, le",
		.fourcc   = V4L2_PIX_FMT_BGR24,
		.btformat = BT848_COLOR_FMT_RGB24,
		.depth    = 24,
		.flags    = FORMAT_FLAGS_PACKED,
	},{
		.name     = "32 bpp RGB, le",
		.fourcc   = V4L2_PIX_FMT_BGR32,
		.btformat = BT848_COLOR_FMT_RGB32,
		.depth    = 32,
		.flags    = FORMAT_FLAGS_PACKED,
	},{
		.name     = "32 bpp RGB, be",
		.fourcc   = V4L2_PIX_FMT_RGB32,
		.btformat = BT848_COLOR_FMT_RGB32,
		.btswap   = 0x0f, /* byte+word swap */
		.depth    = 32,
		.flags    = FORMAT_FLAGS_PACKED,
	},{
		.name     = "4:2:2, packed, YUYV",
		.fourcc   = V4L2_PIX_FMT_YUYV,
		.btformat = BT848_COLOR_FMT_YUY2,
		.depth    = 16,
		.flags    = FORMAT_FLAGS_PACKED,
	},{
		.name     = "4:2:2, packed, UYVY",
		.fourcc   = V4L2_PIX_FMT_UYVY,
		.btformat = BT848_COLOR_FMT_YUY2,
		.btswap   = 0x03, /* byteswap */
		.depth    = 16,
		.flags    = FORMAT_FLAGS_PACKED,
	},{
		.name     = "4:2:2, planar, Y-Cb-Cr",
		.fourcc   = V4L2_PIX_FMT_YUV422P,
		.btformat = BT848_COLOR_FMT_YCrCb422,
		.depth    = 16,
		.flags    = FORMAT_FLAGS_PLANAR,
		.hshift   = 1,
		.vshift   = 0,
	},{
		.name     = "4:2:0, planar, Y-Cb-Cr",
		.fourcc   = V4L2_PIX_FMT_YUV420,
		.btformat = BT848_COLOR_FMT_YCrCb422,
		.depth    = 12,
		.flags    = FORMAT_FLAGS_PLANAR,
		.hshift   = 1,
		.vshift   = 1,
	},{
		.name     = "4:2:0, planar, Y-Cr-Cb",
		.fourcc   = V4L2_PIX_FMT_YVU420,
		.btformat = BT848_COLOR_FMT_YCrCb422,
		.depth    = 12,
		.flags    = FORMAT_FLAGS_PLANAR | FORMAT_FLAGS_CrCb,
		.hshift   = 1,
		.vshift   = 1,
	},{
		.name     = "4:1:1, planar, Y-Cb-Cr",
		.fourcc   = V4L2_PIX_FMT_YUV411P,
		.btformat = BT848_COLOR_FMT_YCrCb411,
		.depth    = 12,
		.flags    = FORMAT_FLAGS_PLANAR,
		.hshift   = 2,
		.vshift   = 0,
	},{
		.name     = "4:1:0, planar, Y-Cb-Cr",
		.fourcc   = V4L2_PIX_FMT_YUV410,
		.btformat = BT848_COLOR_FMT_YCrCb411,
		.depth    = 9,
		.flags    = FORMAT_FLAGS_PLANAR,
		.hshift   = 2,
		.vshift   = 2,
	},{
		.name     = "4:1:0, planar, Y-Cr-Cb",
		.fourcc   = V4L2_PIX_FMT_YVU410,
		.btformat = BT848_COLOR_FMT_YCrCb411,
		.depth    = 9,
		.flags    = FORMAT_FLAGS_PLANAR | FORMAT_FLAGS_CrCb,
		.hshift   = 2,
		.vshift   = 2,
	},{
		.name     = "raw scanlines",
		.fourcc   = -1,
		.btformat = BT848_COLOR_FMT_RAW,
		.depth    = 8,
		.flags    = FORMAT_FLAGS_RAW,
	}
};
634
static const unsigned int FORMATS = ARRAY_SIZE(formats);
L
Linus Torvalds 已提交
635 636 637 638

/* ----------------------------------------------------------------------- */
/* resource management                                                     */

639 640 641 642 643 644 645 646 647 648 649 650 651 652 653 654 655 656 657 658 659 660 661 662 663 664 665 666 667 668 669 670 671
/*
   RESOURCE_    allocated by                freed by

   VIDEO_READ   bttv_read 1)                bttv_read 2)

   VIDEO_STREAM VIDIOC_STREAMON             VIDIOC_STREAMOFF
		 VIDIOC_QBUF 1)              bttv_release
		 VIDIOCMCAPTURE 1)

   OVERLAY	 VIDIOCCAPTURE on            VIDIOCCAPTURE off
		 VIDIOC_OVERLAY on           VIDIOC_OVERLAY off
		 3)                          bttv_release

   VBI		 VIDIOC_STREAMON             VIDIOC_STREAMOFF
		 VIDIOC_QBUF 1)              bttv_release
		 bttv_read, bttv_poll 1) 4)

   1) The resource must be allocated when we enter buffer prepare functions
      and remain allocated while buffers are in the DMA queue.
   2) This is a single frame read.
   3) VIDIOC_S_FBUF and VIDIOC_S_FMT (OVERLAY) still work when
      RESOURCE_OVERLAY is allocated.
   4) This is a continuous read, implies VIDIOC_STREAMON.

   Note this driver permits video input and standard changes regardless if
   resources are allocated.
*/

#define VBI_RESOURCES (RESOURCE_VBI)
#define VIDEO_RESOURCES (RESOURCE_VIDEO_READ | \
			 RESOURCE_VIDEO_STREAM | \
			 RESOURCE_OVERLAY)

L
Linus Torvalds 已提交
672
static
673
int check_alloc_btres_lock(struct bttv *btv, struct bttv_fh *fh, int bit)
L
Linus Torvalds 已提交
674
{
675 676
	int xbits; /* mutual exclusive resources */

L
Linus Torvalds 已提交
677 678 679 680
	if (fh->resources & bit)
		/* have it already allocated */
		return 1;

681 682 683 684
	xbits = bit;
	if (bit & (RESOURCE_VIDEO_READ | RESOURCE_VIDEO_STREAM))
		xbits |= RESOURCE_VIDEO_READ | RESOURCE_VIDEO_STREAM;

L
Linus Torvalds 已提交
685
	/* is it free? */
686
	if (btv->resources & xbits) {
L
Linus Torvalds 已提交
687
		/* no, someone else uses it */
688 689 690 691 692 693 694 695 696 697 698 699 700 701 702 703 704 705 706 707 708 709
		goto fail;
	}

	if ((bit & VIDEO_RESOURCES)
	    && 0 == (btv->resources & VIDEO_RESOURCES)) {
		/* Do crop - use current, don't - use default parameters. */
		__s32 top = btv->crop[!!fh->do_crop].rect.top;

		if (btv->vbi_end > top)
			goto fail;

		/* We cannot capture the same line as video and VBI data.
		   Claim scan lines crop[].rect.top to bottom. */
		btv->crop_start = top;
	} else if (bit & VBI_RESOURCES) {
		__s32 end = fh->vbi_fmt.end;

		if (end > btv->crop_start)
			goto fail;

		/* Claim scan lines above fh->vbi_fmt.end. */
		btv->vbi_end = end;
L
Linus Torvalds 已提交
710
	}
711

L
Linus Torvalds 已提交
712 713 714 715
	/* it's free, grab it */
	fh->resources  |= bit;
	btv->resources |= bit;
	return 1;
716 717 718

 fail:
	return 0;
L
Linus Torvalds 已提交
719 720 721 722 723 724 725 726 727 728 729 730 731 732
}

static
int check_btres(struct bttv_fh *fh, int bit)
{
	return (fh->resources & bit);
}

static
int locked_btres(struct bttv *btv, int bit)
{
	return (btv->resources & bit);
}

733 734 735 736 737 738 739 740 741 742 743 744 745 746 747 748 749 750 751 752 753 754 755 756 757 758 759 760 761
/* Call with btv->lock down. */
static void
disclaim_vbi_lines(struct bttv *btv)
{
	btv->vbi_end = 0;
}

/* Call with btv->lock down. */
static void
disclaim_video_lines(struct bttv *btv)
{
	const struct bttv_tvnorm *tvnorm;
	u8 crop;

	tvnorm = &bttv_tvnorms[btv->tvnorm];
	btv->crop_start = tvnorm->cropcap.bounds.top
		+ tvnorm->cropcap.bounds.height;

	/* VBI capturing ends at VDELAY, start of video capturing, no
	   matter how many lines the VBI RISC program expects. When video
	   capturing is off, it shall no longer "preempt" VBI capturing,
	   so we set VDELAY to maximum. */
	crop = btread(BT848_E_CROP) | 0xc0;
	btwrite(crop, BT848_E_CROP);
	btwrite(0xfe, BT848_E_VDELAY_LO);
	btwrite(crop, BT848_O_CROP);
	btwrite(0xfe, BT848_O_VDELAY_LO);
}

L
Linus Torvalds 已提交
762
static
763
void free_btres_lock(struct bttv *btv, struct bttv_fh *fh, int bits)
L
Linus Torvalds 已提交
764 765
{
	if ((fh->resources & bits) != bits) {
766 767
		/* trying to free resources not allocated by us ... */
		pr_err("BUG! (btres)\n");
L
Linus Torvalds 已提交
768 769 770
	}
	fh->resources  &= ~bits;
	btv->resources &= ~bits;
771 772 773 774 775 776 777 778

	bits = btv->resources;

	if (0 == (bits & VIDEO_RESOURCES))
		disclaim_video_lines(btv);

	if (0 == (bits & VBI_RESOURCES))
		disclaim_vbi_lines(btv);
L
Linus Torvalds 已提交
779 780 781 782 783 784 785 786 787 788 789 790 791 792 793 794 795
}

/* ----------------------------------------------------------------------- */
/* If Bt848a or Bt849, use PLL for PAL/SECAM and crystal for NTSC          */

/* Frequency = (F_input / PLL_X) * PLL_I.PLL_F/PLL_C
   PLL_X = Reference pre-divider (0=1, 1=2)
   PLL_C = Post divider (0=6, 1=4)
   PLL_I = Integer input
   PLL_F = Fractional input

   F_input = 28.636363 MHz:
   PAL (CLKx2 = 35.46895 MHz): PLL_X = 1, PLL_I = 0x0E, PLL_F = 0xDCF9, PLL_C = 0
*/

static void set_pll_freq(struct bttv *btv, unsigned int fin, unsigned int fout)
{
796
	unsigned char fl, fh, fi;
L
Linus Torvalds 已提交
797

798 799 800
	/* prevent overflows */
	fin/=4;
	fout/=4;
L
Linus Torvalds 已提交
801

802 803
	fout*=12;
	fi=fout/fin;
L
Linus Torvalds 已提交
804

805 806
	fout=(fout%fin)*256;
	fh=fout/fin;
L
Linus Torvalds 已提交
807

808 809
	fout=(fout%fin)*256;
	fl=fout/fin;
L
Linus Torvalds 已提交
810

811 812 813
	btwrite(fl, BT848_PLL_F_LO);
	btwrite(fh, BT848_PLL_F_HI);
	btwrite(fi|BT848_PLL_X, BT848_PLL_XCI);
L
Linus Torvalds 已提交
814 815 816 817
}

static void set_pll(struct bttv *btv)
{
818
	int i;
L
Linus Torvalds 已提交
819

820 821
	if (!btv->pll.pll_crystal)
		return;
L
Linus Torvalds 已提交
822 823

	if (btv->pll.pll_ofreq == btv->pll.pll_current) {
824
		dprintk("%d: PLL: no change required\n", btv->c.nr);
825 826
		return;
	}
L
Linus Torvalds 已提交
827

828 829 830
	if (btv->pll.pll_ifreq == btv->pll.pll_ofreq) {
		/* no PLL needed */
		if (btv->pll.pll_current == 0)
831
			return;
832 833 834
		if (bttv_verbose)
			pr_info("%d: PLL can sleep, using XTAL (%d)\n",
				btv->c.nr, btv->pll.pll_ifreq);
835 836 837 838 839
		btwrite(0x00,BT848_TGCTRL);
		btwrite(0x00,BT848_PLL_XCI);
		btv->pll.pll_current = 0;
		return;
	}
L
Linus Torvalds 已提交
840

841 842 843 844
	if (bttv_verbose)
		pr_info("%d: Setting PLL: %d => %d (needs up to 100ms)\n",
			btv->c.nr,
			btv->pll.pll_ifreq, btv->pll.pll_ofreq);
L
Linus Torvalds 已提交
845 846
	set_pll_freq(btv, btv->pll.pll_ifreq, btv->pll.pll_ofreq);

847
	for (i=0; i<10; i++) {
L
Linus Torvalds 已提交
848 849 850
		/*  Let other people run while the PLL stabilizes */
		msleep(10);

851
		if (btread(BT848_DSTATUS) & BT848_DSTATUS_PLOCK) {
L
Linus Torvalds 已提交
852
			btwrite(0,BT848_DSTATUS);
853
		} else {
854 855
			btwrite(0x08,BT848_TGCTRL);
			btv->pll.pll_current = btv->pll.pll_ofreq;
856 857
			if (bttv_verbose)
				pr_info("PLL set ok\n");
858
			return;
859 860 861
		}
	}
	btv->pll.pll_current = -1;
862 863
	if (bttv_verbose)
		pr_info("Setting PLL failed\n");
864
	return;
L
Linus Torvalds 已提交
865 866 867 868 869 870 871 872 873
}

/* used to switch between the bt848's analog/digital video capture modes */
static void bt848A_set_timing(struct bttv *btv)
{
	int i, len;
	int table_idx = bttv_tvnorms[btv->tvnorm].sram;
	int fsc       = bttv_tvnorms[btv->tvnorm].Fsc;

874
	if (btv->input == btv->dig) {
875
		dprintk("%d: load digital timing table (table_idx=%d)\n",
L
Linus Torvalds 已提交
876 877 878
			btv->c.nr,table_idx);

		/* timing change...reset timing generator address */
879 880 881
		btwrite(0x00, BT848_TGCTRL);
		btwrite(0x02, BT848_TGCTRL);
		btwrite(0x00, BT848_TGCTRL);
L
Linus Torvalds 已提交
882 883 884 885 886 887 888 889 890 891 892 893 894 895 896 897 898 899 900 901 902 903

		len=SRAM_Table[table_idx][0];
		for(i = 1; i <= len; i++)
			btwrite(SRAM_Table[table_idx][i],BT848_TGLB);
		btv->pll.pll_ofreq = 27000000;

		set_pll(btv);
		btwrite(0x11, BT848_TGCTRL);
		btwrite(0x41, BT848_DVSIF);
	} else {
		btv->pll.pll_ofreq = fsc;
		set_pll(btv);
		btwrite(0x0, BT848_DVSIF);
	}
}

/* ----------------------------------------------------------------------- */

static void bt848_bright(struct bttv *btv, int bright)
{
	int value;

904
	// printk("set bright: %d\n", bright); // DEBUG
L
Linus Torvalds 已提交
905 906 907 908 909 910 911 912 913 914 915 916 917 918 919
	btv->bright = bright;

	/* We want -128 to 127 we get 0-65535 */
	value = (bright >> 8) - 128;
	btwrite(value & 0xff, BT848_BRIGHT);
}

static void bt848_hue(struct bttv *btv, int hue)
{
	int value;

	btv->hue = hue;

	/* -128 to 127 */
	value = (hue >> 8) - 128;
920
	btwrite(value & 0xff, BT848_HUE);
L
Linus Torvalds 已提交
921 922 923 924 925 926 927 928 929 930 931
}

static void bt848_contrast(struct bttv *btv, int cont)
{
	int value,hibit;

	btv->contrast = cont;

	/* 0-511 */
	value = (cont  >> 7);
	hibit = (value >> 6) & 4;
932 933 934
	btwrite(value & 0xff, BT848_CONTRAST_LO);
	btaor(hibit, ~4, BT848_E_CONTROL);
	btaor(hibit, ~4, BT848_O_CONTROL);
L
Linus Torvalds 已提交
935 936 937 938 939 940 941 942 943
}

static void bt848_sat(struct bttv *btv, int color)
{
	int val_u,val_v,hibits;

	btv->saturation = color;

	/* 0-511 for the color */
944 945
	val_u   = ((color * btv->opt_uv_ratio) / 50) >> 7;
	val_v   = (((color * (100 - btv->opt_uv_ratio) / 50) >>7)*180L)/254;
946
	hibits  = (val_u >> 7) & 2;
L
Linus Torvalds 已提交
947
	hibits |= (val_v >> 8) & 1;
948 949 950 951
	btwrite(val_u & 0xff, BT848_SAT_U_LO);
	btwrite(val_v & 0xff, BT848_SAT_V_LO);
	btaor(hibits, ~3, BT848_E_CONTROL);
	btaor(hibits, ~3, BT848_O_CONTROL);
L
Linus Torvalds 已提交
952 953 954 955 956 957 958 959 960 961 962 963
}

/* ----------------------------------------------------------------------- */

static int
video_mux(struct bttv *btv, unsigned int input)
{
	int mux,mask2;

	if (input >= bttv_tvcards[btv->c.type].video_inputs)
		return -EINVAL;

964
	/* needed by RemoteVideo MX */
L
Linus Torvalds 已提交
965 966 967 968 969 970 971 972 973 974 975
	mask2 = bttv_tvcards[btv->c.type].gpiomask2;
	if (mask2)
		gpio_inout(mask2,mask2);

	if (input == btv->svhs)  {
		btor(BT848_CONTROL_COMP, BT848_E_CONTROL);
		btor(BT848_CONTROL_COMP, BT848_O_CONTROL);
	} else {
		btand(~BT848_CONTROL_COMP, BT848_E_CONTROL);
		btand(~BT848_CONTROL_COMP, BT848_O_CONTROL);
	}
976
	mux = bttv_muxsel(btv, input);
L
Linus Torvalds 已提交
977
	btaor(mux<<5, ~(3<<5), BT848_IFORM);
978
	dprintk("%d: video mux: input=%d mux=%d\n", btv->c.nr, input, mux);
L
Linus Torvalds 已提交
979 980 981 982 983 984 985 986 987

	/* card specific hook */
	if(bttv_tvcards[btv->c.type].muxsel_hook)
		bttv_tvcards[btv->c.type].muxsel_hook (btv, input);
	return 0;
}

static char *audio_modes[] = {
	"audio: tuner", "audio: radio", "audio: extern",
988
	"audio: intern", "audio: mute"
L
Linus Torvalds 已提交
989 990 991
};

static int
992
audio_mux(struct bttv *btv, int input, int mute)
L
Linus Torvalds 已提交
993
{
994
	int gpio_val, signal;
995
	struct v4l2_ctrl *ctrl;
L
Linus Torvalds 已提交
996 997 998 999 1000

	gpio_inout(bttv_tvcards[btv->c.type].gpiomask,
		   bttv_tvcards[btv->c.type].gpiomask);
	signal = btread(BT848_DSTATUS) & BT848_DSTATUS_HLOC;

1001 1002 1003 1004
	btv->mute = mute;
	btv->audio = input;

	/* automute */
1005 1006
	mute = mute || (btv->opt_automute && (!signal || !btv->users)
				&& !btv->radio_user);
1007 1008 1009 1010 1011 1012

	if (mute)
		gpio_val = bttv_tvcards[btv->c.type].gpiomute;
	else
		gpio_val = bttv_tvcards[btv->c.type].gpiomux[input];

1013 1014 1015 1016 1017 1018 1019 1020 1021 1022
	switch (btv->c.type) {
	case BTTV_BOARD_VOODOOTV_FM:
	case BTTV_BOARD_VOODOOTV_200:
		gpio_val = bttv_tda9880_setnorm(btv, gpio_val);
		break;

	default:
		gpio_bits(bttv_tvcards[btv->c.type].gpiomask, gpio_val);
	}

L
Linus Torvalds 已提交
1023
	if (bttv_gpio)
1024 1025 1026 1027
		bttv_gpio_tracking(btv, audio_modes[mute ? 4 : input]);
	if (in_interrupt())
		return 0;

1028
	if (btv->sd_msp34xx) {
1029
		u32 in;
1030

1031 1032 1033 1034
		ctrl = v4l2_ctrl_find(btv->sd_msp34xx->ctrl_handler, V4L2_CID_AUDIO_MUTE);
		if (ctrl)
			v4l2_ctrl_s_ctrl(ctrl, btv->mute);

1035 1036 1037 1038 1039 1040 1041
		/* Note: the inputs tuner/radio/extern/intern are translated
		   to msp routings. This assumes common behavior for all msp3400
		   based TV cards. When this assumption fails, then the
		   specific MSP routing must be added to the card table.
		   For now this is sufficient. */
		switch (input) {
		case TVAUDIO_INPUT_RADIO:
1042 1043 1044 1045 1046
			/* Some boards need the msp do to the radio demod */
			if (btv->radio_uses_msp_demodulator) {
				in = MSP_INPUT_DEFAULT;
				break;
			}
1047
			in = MSP_INPUT(MSP_IN_SCART2, MSP_IN_TUNER1,
1048
				    MSP_DSP_IN_SCART, MSP_DSP_IN_SCART);
1049 1050
			break;
		case TVAUDIO_INPUT_EXTERN:
1051
			in = MSP_INPUT(MSP_IN_SCART1, MSP_IN_TUNER1,
1052
				    MSP_DSP_IN_SCART, MSP_DSP_IN_SCART);
1053 1054 1055 1056 1057 1058 1059
			break;
		case TVAUDIO_INPUT_INTERN:
			/* Yes, this is the same input as for RADIO. I doubt
			   if this is ever used. The only board with an INTERN
			   input is the BTTV_BOARD_AVERMEDIA98. I wonder how
			   that was tested. My guess is that the whole INTERN
			   input does not work. */
1060
			in = MSP_INPUT(MSP_IN_SCART2, MSP_IN_TUNER1,
1061
				    MSP_DSP_IN_SCART, MSP_DSP_IN_SCART);
1062 1063 1064
			break;
		case TVAUDIO_INPUT_TUNER:
		default:
1065 1066 1067 1068
			/* This is the only card that uses TUNER2, and afaik,
			   is the only difference between the VOODOOTV_FM
			   and VOODOOTV_200 */
			if (btv->c.type == BTTV_BOARD_VOODOOTV_200)
1069
				in = MSP_INPUT(MSP_IN_SCART1, MSP_IN_TUNER2, \
1070 1071
					MSP_DSP_IN_TUNER, MSP_DSP_IN_TUNER);
			else
1072
				in = MSP_INPUT_DEFAULT;
1073 1074
			break;
		}
1075 1076
		v4l2_subdev_call(btv->sd_msp34xx, audio, s_routing,
			       in, MSP_OUTPUT_DEFAULT, 0);
1077
	}
1078
	if (btv->sd_tvaudio) {
1079 1080 1081 1082
		ctrl = v4l2_ctrl_find(btv->sd_tvaudio->ctrl_handler, V4L2_CID_AUDIO_MUTE);

		if (ctrl)
			v4l2_ctrl_s_ctrl(ctrl, btv->mute);
1083 1084
		v4l2_subdev_call(btv->sd_tvaudio, audio, s_routing,
				input, 0, 0);
1085
	}
1086 1087 1088 1089 1090 1091
	if (btv->sd_tda7432) {
		ctrl = v4l2_ctrl_find(btv->sd_tda7432->ctrl_handler, V4L2_CID_AUDIO_MUTE);

		if (ctrl)
			v4l2_ctrl_s_ctrl(ctrl, btv->mute);
	}
L
Linus Torvalds 已提交
1092 1093 1094
	return 0;
}

1095 1096 1097 1098 1099 1100 1101 1102 1103 1104 1105 1106
static inline int
audio_mute(struct bttv *btv, int mute)
{
	return audio_mux(btv, btv->audio, mute);
}

static inline int
audio_input(struct bttv *btv, int input)
{
	return audio_mux(btv, input, btv->mute);
}

1107 1108 1109 1110 1111 1112 1113 1114 1115 1116 1117 1118 1119 1120 1121 1122 1123 1124 1125 1126 1127 1128 1129
static void
bttv_crop_calc_limits(struct bttv_crop *c)
{
	/* Scale factor min. 1:1, max. 16:1. Min. image size
	   48 x 32. Scaled width must be a multiple of 4. */

	if (1) {
		/* For bug compatibility with VIDIOCGCAP and image
		   size checks in earlier driver versions. */
		c->min_scaled_width = 48;
		c->min_scaled_height = 32;
	} else {
		c->min_scaled_width =
			(max(48, c->rect.width >> 4) + 3) & ~3;
		c->min_scaled_height =
			max(32, c->rect.height >> 4);
	}

	c->max_scaled_width  = c->rect.width & ~3;
	c->max_scaled_height = c->rect.height;
}

static void
1130
bttv_crop_reset(struct bttv_crop *c, unsigned int norm)
1131 1132 1133 1134 1135 1136
{
	c->rect = bttv_tvnorms[norm].cropcap.defrect;
	bttv_crop_calc_limits(c);
}

/* Call with btv->lock down. */
L
Linus Torvalds 已提交
1137 1138 1139 1140
static int
set_tvnorm(struct bttv *btv, unsigned int norm)
{
	const struct bttv_tvnorm *tvnorm;
1141
	v4l2_std_id id;
L
Linus Torvalds 已提交
1142

1143 1144
	BUG_ON(norm >= BTTV_TVNORMS);
	BUG_ON(btv->tvnorm >= BTTV_TVNORMS);
L
Linus Torvalds 已提交
1145 1146 1147

	tvnorm = &bttv_tvnorms[norm];

1148
	if (memcmp(&bttv_tvnorms[btv->tvnorm].cropcap, &tvnorm->cropcap,
1149
		    sizeof (tvnorm->cropcap))) {
1150 1151 1152 1153 1154 1155 1156 1157 1158 1159 1160
		bttv_crop_reset(&btv->crop[0], norm);
		btv->crop[1] = btv->crop[0]; /* current = default */

		if (0 == (btv->resources & VIDEO_RESOURCES)) {
			btv->crop_start = tvnorm->cropcap.bounds.top
				+ tvnorm->cropcap.bounds.height;
		}
	}

	btv->tvnorm = norm;

L
Linus Torvalds 已提交
1161 1162 1163 1164 1165 1166 1167 1168 1169
	btwrite(tvnorm->adelay, BT848_ADELAY);
	btwrite(tvnorm->bdelay, BT848_BDELAY);
	btaor(tvnorm->iform,~(BT848_IFORM_NORM|BT848_IFORM_XTBOTH),
	      BT848_IFORM);
	btwrite(tvnorm->vbipack, BT848_VBI_PACK_SIZE);
	btwrite(1, BT848_VBI_PACK_DEL);
	bt848A_set_timing(btv);

	switch (btv->c.type) {
1170
	case BTTV_BOARD_VOODOOTV_FM:
1171
	case BTTV_BOARD_VOODOOTV_200:
1172
		bttv_tda9880_setnorm(btv, gpio_read());
L
Linus Torvalds 已提交
1173 1174
		break;
	}
1175
	id = tvnorm->v4l2_id;
1176
	bttv_call_all(btv, core, s_std, id);
1177

L
Linus Torvalds 已提交
1178 1179 1180
	return 0;
}

1181
/* Call with btv->lock down. */
L
Linus Torvalds 已提交
1182
static void
1183
set_input(struct bttv *btv, unsigned int input, unsigned int norm)
L
Linus Torvalds 已提交
1184 1185 1186 1187 1188 1189 1190 1191 1192 1193 1194 1195 1196 1197 1198 1199
{
	unsigned long flags;

	btv->input = input;
	if (irq_iswitch) {
		spin_lock_irqsave(&btv->s_lock,flags);
		if (btv->curr.frame_irq) {
			/* active capture -> delayed input switch */
			btv->new_input = input;
		} else {
			video_mux(btv,input);
		}
		spin_unlock_irqrestore(&btv->s_lock,flags);
	} else {
		video_mux(btv,input);
	}
1200 1201
	audio_input(btv, (btv->tuner_type != TUNER_ABSENT && input == 0) ?
			 TVAUDIO_INPUT_TUNER : TVAUDIO_INPUT_EXTERN);
1202
	set_tvnorm(btv, norm);
L
Linus Torvalds 已提交
1203 1204 1205 1206 1207 1208 1209 1210 1211 1212 1213 1214 1215 1216 1217 1218 1219
}

static void init_irqreg(struct bttv *btv)
{
	/* clear status */
	btwrite(0xfffffUL, BT848_INT_STAT);

	if (bttv_tvcards[btv->c.type].no_video) {
		/* i2c only */
		btwrite(BT848_INT_I2CDONE,
			BT848_INT_MASK);
	} else {
		/* full video */
		btwrite((btv->triton1)  |
			(btv->gpioirq ? BT848_INT_GPINT : 0) |
			BT848_INT_SCERR |
			(fdsr ? BT848_INT_FDSR : 0) |
1220
			BT848_INT_RISCI | BT848_INT_OCERR |
L
Linus Torvalds 已提交
1221 1222 1223 1224 1225 1226 1227 1228 1229 1230 1231 1232 1233 1234 1235 1236 1237 1238
			BT848_INT_FMTCHG|BT848_INT_HLOCK|
			BT848_INT_I2CDONE,
			BT848_INT_MASK);
	}
}

static void init_bt848(struct bttv *btv)
{
	if (bttv_tvcards[btv->c.type].no_video) {
		/* very basic init only */
		init_irqreg(btv);
		return;
	}

	btwrite(0x00, BT848_CAP_CTL);
	btwrite(BT848_COLOR_CTL_GAMMA, BT848_COLOR_CTL);
	btwrite(BT848_IFORM_XTAUTO | BT848_IFORM_AUTO, BT848_IFORM);

1239 1240 1241 1242 1243 1244 1245 1246
	/* set planar and packed mode trigger points and         */
	/* set rising edge of inverted GPINTR pin as irq trigger */
	btwrite(BT848_GPIO_DMA_CTL_PKTP_32|
		BT848_GPIO_DMA_CTL_PLTP1_16|
		BT848_GPIO_DMA_CTL_PLTP23_16|
		BT848_GPIO_DMA_CTL_GPINTC|
		BT848_GPIO_DMA_CTL_GPINTI,
		BT848_GPIO_DMA_CTL);
L
Linus Torvalds 已提交
1247

1248 1249
	btwrite(0x20, BT848_E_VSCALE_HI);
	btwrite(0x20, BT848_O_VSCALE_HI);
L
Linus Torvalds 已提交
1250

1251
	v4l2_ctrl_handler_setup(&btv->ctrl_handler);
L
Linus Torvalds 已提交
1252

1253
	/* interrupt */
L
Linus Torvalds 已提交
1254 1255 1256 1257 1258 1259 1260 1261
	init_irqreg(btv);
}

static void bttv_reinit_bt848(struct bttv *btv)
{
	unsigned long flags;

	if (bttv_verbose)
1262
		pr_info("%d: reset, reinitialize\n", btv->c.nr);
L
Linus Torvalds 已提交
1263 1264 1265 1266 1267 1268
	spin_lock_irqsave(&btv->s_lock,flags);
	btv->errors=0;
	bttv_set_dma(btv,0);
	spin_unlock_irqrestore(&btv->s_lock,flags);

	init_bt848(btv);
1269
	btv->pll.pll_current = -1;
1270
	set_input(btv, btv->input, btv->tvnorm);
L
Linus Torvalds 已提交
1271 1272
}

1273
static int bttv_s_ctrl(struct v4l2_ctrl *c)
1274
{
1275 1276
	struct bttv *btv = container_of(c->handler, struct bttv, ctrl_handler);
	int val;
1277 1278 1279

	switch (c->id) {
	case V4L2_CID_BRIGHTNESS:
1280
		bt848_bright(btv, c->val);
1281 1282
		break;
	case V4L2_CID_HUE:
1283
		bt848_hue(btv, c->val);
1284 1285
		break;
	case V4L2_CID_CONTRAST:
1286
		bt848_contrast(btv, c->val);
1287 1288
		break;
	case V4L2_CID_SATURATION:
1289
		bt848_sat(btv, c->val);
1290
		break;
1291
	case V4L2_CID_COLOR_KILLER:
1292
		if (c->val) {
1293 1294 1295 1296 1297 1298 1299
			btor(BT848_SCLOOP_CKILL, BT848_E_SCLOOP);
			btor(BT848_SCLOOP_CKILL, BT848_O_SCLOOP);
		} else {
			btand(~BT848_SCLOOP_CKILL, BT848_E_SCLOOP);
			btand(~BT848_SCLOOP_CKILL, BT848_O_SCLOOP);
		}
		break;
1300
	case V4L2_CID_AUDIO_MUTE:
1301
		audio_mute(btv, c->val);
1302
		break;
1303 1304
	case V4L2_CID_AUDIO_VOLUME:
		btv->volume_gpio(btv, c->val);
1305 1306
		break;

1307 1308 1309 1310
	case V4L2_CID_CHROMA_AGC:
		val = c->val ? BT848_SCLOOP_CAGC : 0;
		btwrite(val, BT848_E_SCLOOP);
		btwrite(val, BT848_O_SCLOOP);
1311 1312
		break;
	case V4L2_CID_PRIVATE_COMBFILTER:
1313
		btv->opt_combfilter = c->val;
1314 1315
		break;
	case V4L2_CID_PRIVATE_LUMAFILTER:
1316
		if (c->val) {
1317 1318 1319 1320 1321 1322 1323 1324
			btand(~BT848_CONTROL_LDEC, BT848_E_CONTROL);
			btand(~BT848_CONTROL_LDEC, BT848_O_CONTROL);
		} else {
			btor(BT848_CONTROL_LDEC, BT848_E_CONTROL);
			btor(BT848_CONTROL_LDEC, BT848_O_CONTROL);
		}
		break;
	case V4L2_CID_PRIVATE_AUTOMUTE:
1325
		btv->opt_automute = c->val;
1326 1327 1328
		break;
	case V4L2_CID_PRIVATE_AGC_CRUSH:
		btwrite(BT848_ADC_RESERVED |
1329
				(c->val ? BT848_ADC_CRUSH : 0),
1330 1331 1332
				BT848_ADC);
		break;
	case V4L2_CID_PRIVATE_VCR_HACK:
1333
		btv->opt_vcr_hack = c->val;
1334 1335
		break;
	case V4L2_CID_PRIVATE_WHITECRUSH_UPPER:
1336
		btwrite(c->val, BT848_WC_UP);
1337 1338
		break;
	case V4L2_CID_PRIVATE_WHITECRUSH_LOWER:
1339
		btwrite(c->val, BT848_WC_DOWN);
1340 1341
		break;
	case V4L2_CID_PRIVATE_UV_RATIO:
1342
		btv->opt_uv_ratio = c->val;
1343 1344 1345
		bt848_sat(btv, btv->saturation);
		break;
	case V4L2_CID_PRIVATE_FULL_LUMA_RANGE:
1346
		btaor((c->val << 7), ~BT848_OFORM_RANGE, BT848_OFORM);
1347 1348
		break;
	case V4L2_CID_PRIVATE_CORING:
1349
		btaor((c->val << 5), ~BT848_OFORM_CORE32, BT848_OFORM);
1350 1351 1352 1353 1354 1355 1356
		break;
	default:
		return -EINVAL;
	}
	return 0;
}

1357 1358 1359 1360 1361 1362 1363 1364 1365 1366 1367 1368 1369 1370 1371 1372 1373 1374 1375 1376 1377 1378 1379 1380 1381 1382 1383 1384 1385 1386 1387 1388 1389 1390 1391 1392 1393 1394 1395 1396 1397 1398 1399 1400 1401 1402 1403 1404 1405 1406 1407 1408 1409 1410 1411 1412 1413 1414 1415 1416 1417 1418 1419 1420 1421 1422 1423 1424 1425 1426 1427 1428 1429 1430 1431 1432 1433 1434 1435 1436 1437 1438 1439 1440 1441 1442 1443 1444 1445 1446 1447 1448 1449 1450 1451 1452 1453 1454 1455 1456 1457 1458 1459 1460 1461 1462 1463 1464 1465 1466 1467 1468 1469 1470 1471
/* ----------------------------------------------------------------------- */

static const struct v4l2_ctrl_ops bttv_ctrl_ops = {
	.s_ctrl = bttv_s_ctrl,
};

static struct v4l2_ctrl_config bttv_ctrl_combfilter = {
	.ops = &bttv_ctrl_ops,
	.id = V4L2_CID_PRIVATE_COMBFILTER,
	.name = "Comb Filter",
	.type = V4L2_CTRL_TYPE_BOOLEAN,
	.min = 0,
	.max = 1,
	.step = 1,
	.def = 1,
};

static struct v4l2_ctrl_config bttv_ctrl_automute = {
	.ops = &bttv_ctrl_ops,
	.id = V4L2_CID_PRIVATE_AUTOMUTE,
	.name = "Auto Mute",
	.type = V4L2_CTRL_TYPE_BOOLEAN,
	.min = 0,
	.max = 1,
	.step = 1,
	.def = 1,
};

static struct v4l2_ctrl_config bttv_ctrl_lumafilter = {
	.ops = &bttv_ctrl_ops,
	.id = V4L2_CID_PRIVATE_LUMAFILTER,
	.name = "Luma Decimation Filter",
	.type = V4L2_CTRL_TYPE_BOOLEAN,
	.min = 0,
	.max = 1,
	.step = 1,
	.def = 1,
};

static struct v4l2_ctrl_config bttv_ctrl_agc_crush = {
	.ops = &bttv_ctrl_ops,
	.id = V4L2_CID_PRIVATE_AGC_CRUSH,
	.name = "AGC Crush",
	.type = V4L2_CTRL_TYPE_BOOLEAN,
	.min = 0,
	.max = 1,
	.step = 1,
	.def = 1,
};

static struct v4l2_ctrl_config bttv_ctrl_vcr_hack = {
	.ops = &bttv_ctrl_ops,
	.id = V4L2_CID_PRIVATE_VCR_HACK,
	.name = "VCR Hack",
	.type = V4L2_CTRL_TYPE_BOOLEAN,
	.min = 0,
	.max = 1,
	.step = 1,
	.def = 1,
};

static struct v4l2_ctrl_config bttv_ctrl_whitecrush_lower = {
	.ops = &bttv_ctrl_ops,
	.id = V4L2_CID_PRIVATE_WHITECRUSH_LOWER,
	.name = "Whitecrush Lower",
	.type = V4L2_CTRL_TYPE_INTEGER,
	.min = 0,
	.max = 255,
	.step = 1,
	.def = 0x7f,
};

static struct v4l2_ctrl_config bttv_ctrl_whitecrush_upper = {
	.ops = &bttv_ctrl_ops,
	.id = V4L2_CID_PRIVATE_WHITECRUSH_UPPER,
	.name = "Whitecrush Upper",
	.type = V4L2_CTRL_TYPE_INTEGER,
	.min = 0,
	.max = 255,
	.step = 1,
	.def = 0xcf,
};

static struct v4l2_ctrl_config bttv_ctrl_uv_ratio = {
	.ops = &bttv_ctrl_ops,
	.id = V4L2_CID_PRIVATE_UV_RATIO,
	.name = "UV Ratio",
	.type = V4L2_CTRL_TYPE_INTEGER,
	.min = 0,
	.max = 100,
	.step = 1,
	.def = 50,
};

static struct v4l2_ctrl_config bttv_ctrl_full_luma = {
	.ops = &bttv_ctrl_ops,
	.id = V4L2_CID_PRIVATE_FULL_LUMA_RANGE,
	.name = "Full Luma Range",
	.type = V4L2_CTRL_TYPE_BOOLEAN,
	.min = 0,
	.max = 1,
	.step = 1,
};

static struct v4l2_ctrl_config bttv_ctrl_coring = {
	.ops = &bttv_ctrl_ops,
	.id = V4L2_CID_PRIVATE_CORING,
	.name = "Coring",
	.type = V4L2_CTRL_TYPE_INTEGER,
	.min = 0,
	.max = 3,
	.step = 1,
};


L
Linus Torvalds 已提交
1472 1473 1474 1475 1476 1477 1478
/* ----------------------------------------------------------------------- */

void bttv_gpio_tracking(struct bttv *btv, char *comment)
{
	unsigned int outbits, data;
	outbits = btread(BT848_GPIO_OUT_EN);
	data    = btread(BT848_GPIO_DATA);
1479 1480
	pr_debug("%d: gpio: en=%08x, out=%08x in=%08x [%s]\n",
		 btv->c.nr, outbits, data & outbits, data & ~outbits, comment);
L
Linus Torvalds 已提交
1481 1482 1483 1484 1485 1486 1487 1488 1489 1490 1491 1492 1493 1494 1495 1496 1497 1498 1499 1500 1501 1502 1503 1504
}

static void bttv_field_count(struct bttv *btv)
{
	int need_count = 0;

	if (btv->users)
		need_count++;

	if (need_count) {
		/* start field counter */
		btor(BT848_INT_VSYNC,BT848_INT_MASK);
	} else {
		/* stop field counter */
		btand(~BT848_INT_VSYNC,BT848_INT_MASK);
		btv->field_count = 0;
	}
}

static const struct bttv_format*
format_by_fourcc(int fourcc)
{
	unsigned int i;

1505 1506
	for (i = 0; i < FORMATS; i++) {
		if (-1 == formats[i].fourcc)
L
Linus Torvalds 已提交
1507
			continue;
1508 1509
		if (formats[i].fourcc == fourcc)
			return formats+i;
L
Linus Torvalds 已提交
1510 1511 1512 1513 1514 1515 1516 1517 1518 1519 1520 1521 1522 1523 1524
	}
	return NULL;
}

/* ----------------------------------------------------------------------- */
/* misc helpers                                                            */

static int
bttv_switch_overlay(struct bttv *btv, struct bttv_fh *fh,
		    struct bttv_buffer *new)
{
	struct bttv_buffer *old;
	unsigned long flags;
	int retval = 0;

1525
	dprintk("switch_overlay: enter [new=%p]\n", new);
L
Linus Torvalds 已提交
1526
	if (new)
1527
		new->vb.state = VIDEOBUF_DONE;
L
Linus Torvalds 已提交
1528 1529 1530 1531 1532 1533 1534
	spin_lock_irqsave(&btv->s_lock,flags);
	old = btv->screen;
	btv->screen = new;
	btv->loop_irq |= 1;
	bttv_set_dma(btv, 0x03);
	spin_unlock_irqrestore(&btv->s_lock,flags);
	if (NULL != old) {
1535 1536
		dprintk("switch_overlay: old=%p state is %d\n",
			old, old->vb.state);
1537
		bttv_dma_free(&fh->cap,btv, old);
L
Linus Torvalds 已提交
1538 1539
		kfree(old);
	}
1540
	if (NULL == new)
1541
		free_btres_lock(btv,fh,RESOURCE_OVERLAY);
L
Linus Torvalds 已提交
1542 1543 1544 1545 1546 1547 1548
	dprintk("switch_overlay: done\n");
	return retval;
}

/* ----------------------------------------------------------------------- */
/* video4linux (1) interface                                               */

1549 1550
static int bttv_prepare_buffer(struct videobuf_queue *q,struct bttv *btv,
			       struct bttv_buffer *buf,
1551
			       const struct bttv_format *fmt,
L
Linus Torvalds 已提交
1552 1553 1554
			       unsigned int width, unsigned int height,
			       enum v4l2_field field)
{
1555
	struct bttv_fh *fh = q->priv_data;
L
Linus Torvalds 已提交
1556
	int redo_dma_risc = 0;
1557 1558
	struct bttv_crop c;
	int norm;
L
Linus Torvalds 已提交
1559 1560 1561 1562 1563 1564 1565 1566 1567 1568 1569
	int rc;

	/* check settings */
	if (NULL == fmt)
		return -EINVAL;
	if (fmt->btformat == BT848_COLOR_FMT_RAW) {
		width  = RAW_BPL;
		height = RAW_LINES*2;
		if (width*height > buf->vb.bsize)
			return -EINVAL;
		buf->vb.size = buf->vb.bsize;
1570 1571 1572 1573 1574 1575 1576 1577 1578 1579 1580 1581 1582

		/* Make sure tvnorm and vbi_end remain consistent
		   until we're done. */

		norm = btv->tvnorm;

		/* In this mode capturing always starts at defrect.top
		   (default VDELAY), ignoring cropping parameters. */
		if (btv->vbi_end > bttv_tvnorms[norm].cropcap.defrect.top) {
			return -EINVAL;
		}

		c.rect = bttv_tvnorms[norm].cropcap.defrect;
L
Linus Torvalds 已提交
1583
	} else {
1584 1585 1586 1587 1588 1589
		norm = btv->tvnorm;
		c = btv->crop[!!fh->do_crop];

		if (width < c.min_scaled_width ||
		    width > c.max_scaled_width ||
		    height < c.min_scaled_height)
L
Linus Torvalds 已提交
1590
			return -EINVAL;
1591 1592 1593 1594 1595 1596 1597 1598 1599 1600 1601 1602 1603 1604 1605 1606 1607

		switch (field) {
		case V4L2_FIELD_TOP:
		case V4L2_FIELD_BOTTOM:
		case V4L2_FIELD_ALTERNATE:
			/* btv->crop counts frame lines. Max. scale
			   factor is 16:1 for frames, 8:1 for fields. */
			if (height * 2 > c.max_scaled_height)
				return -EINVAL;
			break;

		default:
			if (height > c.max_scaled_height)
				return -EINVAL;
			break;
		}

L
Linus Torvalds 已提交
1608 1609 1610 1611 1612 1613 1614 1615
		buf->vb.size = (width * height * fmt->depth) >> 3;
		if (0 != buf->vb.baddr  &&  buf->vb.bsize < buf->vb.size)
			return -EINVAL;
	}

	/* alloc + fill struct bttv_buffer (if changed) */
	if (buf->vb.width != width || buf->vb.height != height ||
	    buf->vb.field != field ||
1616 1617 1618 1619 1620
	    buf->tvnorm != norm || buf->fmt != fmt ||
	    buf->crop.top != c.rect.top ||
	    buf->crop.left != c.rect.left ||
	    buf->crop.width != c.rect.width ||
	    buf->crop.height != c.rect.height) {
L
Linus Torvalds 已提交
1621 1622 1623
		buf->vb.width  = width;
		buf->vb.height = height;
		buf->vb.field  = field;
1624
		buf->tvnorm    = norm;
L
Linus Torvalds 已提交
1625
		buf->fmt       = fmt;
1626
		buf->crop      = c.rect;
L
Linus Torvalds 已提交
1627 1628 1629 1630
		redo_dma_risc = 1;
	}

	/* alloc risc memory */
1631
	if (VIDEOBUF_NEEDS_INIT == buf->vb.state) {
L
Linus Torvalds 已提交
1632
		redo_dma_risc = 1;
1633
		if (0 != (rc = videobuf_iolock(q,&buf->vb,&btv->fbuf)))
L
Linus Torvalds 已提交
1634 1635 1636 1637 1638 1639 1640
			goto fail;
	}

	if (redo_dma_risc)
		if (0 != (rc = bttv_buffer_risc(btv,buf)))
			goto fail;

1641
	buf->vb.state = VIDEOBUF_PREPARED;
L
Linus Torvalds 已提交
1642 1643 1644
	return 0;

 fail:
1645
	bttv_dma_free(q,btv,buf);
L
Linus Torvalds 已提交
1646 1647 1648 1649 1650 1651 1652 1653 1654 1655 1656
	return rc;
}

static int
buffer_setup(struct videobuf_queue *q, unsigned int *count, unsigned int *size)
{
	struct bttv_fh *fh = q->priv_data;

	*size = fh->fmt->depth*fh->width*fh->height >> 3;
	if (0 == *count)
		*count = gbuffers;
1657 1658
	if (*size * *count > gbuffers * gbufsize)
		*count = (gbuffers * gbufsize) / *size;
L
Linus Torvalds 已提交
1659 1660 1661 1662 1663 1664 1665 1666 1667 1668
	return 0;
}

static int
buffer_prepare(struct videobuf_queue *q, struct videobuf_buffer *vb,
	       enum v4l2_field field)
{
	struct bttv_buffer *buf = container_of(vb,struct bttv_buffer,vb);
	struct bttv_fh *fh = q->priv_data;

1669
	return bttv_prepare_buffer(q,fh->btv, buf, fh->fmt,
L
Linus Torvalds 已提交
1670 1671 1672 1673 1674 1675 1676 1677 1678 1679
				   fh->width, fh->height, field);
}

static void
buffer_queue(struct videobuf_queue *q, struct videobuf_buffer *vb)
{
	struct bttv_buffer *buf = container_of(vb,struct bttv_buffer,vb);
	struct bttv_fh *fh = q->priv_data;
	struct bttv    *btv = fh->btv;

1680
	buf->vb.state = VIDEOBUF_QUEUED;
L
Linus Torvalds 已提交
1681 1682 1683 1684 1685 1686 1687 1688 1689 1690 1691 1692
	list_add_tail(&buf->vb.queue,&btv->capture);
	if (!btv->curr.frame_irq) {
		btv->loop_irq |= 1;
		bttv_set_dma(btv, 0x03);
	}
}

static void buffer_release(struct videobuf_queue *q, struct videobuf_buffer *vb)
{
	struct bttv_buffer *buf = container_of(vb,struct bttv_buffer,vb);
	struct bttv_fh *fh = q->priv_data;

1693
	bttv_dma_free(q,fh->btv,buf);
L
Linus Torvalds 已提交
1694 1695 1696 1697 1698 1699 1700 1701 1702
}

static struct videobuf_queue_ops bttv_video_qops = {
	.buf_setup    = buffer_setup,
	.buf_prepare  = buffer_prepare,
	.buf_queue    = buffer_queue,
	.buf_release  = buffer_release,
};

1703
static int bttv_s_std(struct file *file, void *priv, v4l2_std_id *id)
L
Linus Torvalds 已提交
1704
{
1705 1706 1707 1708
	struct bttv_fh *fh  = priv;
	struct bttv *btv = fh->btv;
	unsigned int i;
	int err;
L
Linus Torvalds 已提交
1709

1710
	err = v4l2_prio_check(&btv->prio, fh->prio);
1711 1712
	if (err)
		goto err;
L
Linus Torvalds 已提交
1713

1714 1715 1716
	for (i = 0; i < BTTV_TVNORMS; i++)
		if (*id & bttv_tvnorms[i].v4l2_id)
			break;
1717 1718 1719 1720
	if (i == BTTV_TVNORMS) {
		err = -EINVAL;
		goto err;
	}
L
Linus Torvalds 已提交
1721

1722
	set_tvnorm(btv, i);
1723 1724

err:
L
Linus Torvalds 已提交
1725

1726
	return err;
1727
}
L
Linus Torvalds 已提交
1728

1729
static int bttv_querystd(struct file *file, void *f, v4l2_std_id *id)
1730 1731 1732
{
	struct bttv_fh *fh = f;
	struct bttv *btv = fh->btv;
L
Linus Torvalds 已提交
1733

1734 1735 1736 1737 1738 1739
	if (btread(BT848_DSTATUS) & BT848_DSTATUS_NUML)
		*id = V4L2_STD_625_50;
	else
		*id = V4L2_STD_525_60;
	return 0;
}
L
Linus Torvalds 已提交
1740

1741
static int bttv_enum_input(struct file *file, void *priv,
1742 1743 1744 1745
					struct v4l2_input *i)
{
	struct bttv_fh *fh = priv;
	struct bttv *btv = fh->btv;
1746
	int rc = 0;
L
Linus Torvalds 已提交
1747

1748 1749 1750 1751
	if (i->index >= bttv_tvcards[btv->c.type].video_inputs) {
		rc = -EINVAL;
		goto err;
	}
1752

1753
	i->type     = V4L2_INPUT_TYPE_CAMERA;
1754
	i->audioset = 0;
L
Linus Torvalds 已提交
1755

1756
	if (btv->tuner_type != TUNER_ABSENT && i->index == 0) {
1757 1758 1759 1760 1761 1762 1763
		sprintf(i->name, "Television");
		i->type  = V4L2_INPUT_TYPE_TUNER;
		i->tuner = 0;
	} else if (i->index == btv->svhs) {
		sprintf(i->name, "S-Video");
	} else {
		sprintf(i->name, "Composite%d", i->index);
L
Linus Torvalds 已提交
1764 1765
	}

1766 1767 1768 1769 1770 1771
	if (i->index == btv->input) {
		__u32 dstatus = btread(BT848_DSTATUS);
		if (0 == (dstatus & BT848_DSTATUS_PRES))
			i->status |= V4L2_IN_ST_NO_SIGNAL;
		if (0 == (dstatus & BT848_DSTATUS_HLOC))
			i->status |= V4L2_IN_ST_NO_H_LOCK;
1772
	}
L
Linus Torvalds 已提交
1773

1774
	i->std = BTTV_NORMS;
L
Linus Torvalds 已提交
1775

1776 1777 1778
err:

	return rc;
L
Linus Torvalds 已提交
1779 1780
}

1781
static int bttv_g_input(struct file *file, void *priv, unsigned int *i)
1782
{
1783 1784
	struct bttv_fh *fh = priv;
	struct bttv *btv = fh->btv;
1785

1786
	*i = btv->input;
1787

1788 1789
	return 0;
}
1790

1791
static int bttv_s_input(struct file *file, void *priv, unsigned int i)
1792 1793 1794 1795
{
	struct bttv_fh *fh  = priv;
	struct bttv *btv = fh->btv;
	int err;
1796

1797
	err = v4l2_prio_check(&btv->prio, fh->prio);
1798 1799
	if (err)
		return err;
1800

1801 1802
	if (i >= bttv_tvcards[btv->c.type].video_inputs)
		return -EINVAL;
1803 1804 1805 1806 1807

	set_input(btv, i, btv->tvnorm);
	return 0;
}

1808
static int bttv_s_tuner(struct file *file, void *priv,
1809 1810 1811 1812 1813 1814
					struct v4l2_tuner *t)
{
	struct bttv_fh *fh  = priv;
	struct bttv *btv = fh->btv;
	int err;

1815
	if (t->index)
1816 1817
		return -EINVAL;

1818
	err = v4l2_prio_check(&btv->prio, fh->prio);
1819 1820
	if (err)
		return err;
1821

1822
	bttv_call_all(btv, tuner, s_tuner, t);
1823 1824 1825 1826 1827 1828

	if (btv->audio_mode_gpio)
		btv->audio_mode_gpio(btv, t, 1);
	return 0;
}

1829
static int bttv_g_frequency(struct file *file, void *priv,
1830 1831 1832 1833 1834
					struct v4l2_frequency *f)
{
	struct bttv_fh *fh  = priv;
	struct bttv *btv = fh->btv;

1835 1836
	if (f->tuner)
		return -EINVAL;
1837

1838 1839 1840
	f->frequency = f->type == V4L2_TUNER_RADIO ?
				btv->radio_freq : btv->tv_freq;

1841 1842 1843
	return 0;
}

1844 1845 1846 1847 1848 1849 1850 1851 1852 1853 1854 1855 1856 1857 1858
static void bttv_set_frequency(struct bttv *btv, struct v4l2_frequency *f)
{
	bttv_call_all(btv, tuner, s_frequency, f);
	/* s_frequency may clamp the frequency, so get the actual
	   frequency before assigning radio/tv_freq. */
	bttv_call_all(btv, tuner, g_frequency, f);
	if (f->type == V4L2_TUNER_RADIO) {
		btv->radio_freq = f->frequency;
		if (btv->has_matchbox)
			tea5757_set_freq(btv, btv->radio_freq);
	} else {
		btv->tv_freq = f->frequency;
	}
}

1859
static int bttv_s_frequency(struct file *file, void *priv,
1860 1861 1862 1863 1864 1865
					struct v4l2_frequency *f)
{
	struct bttv_fh *fh  = priv;
	struct bttv *btv = fh->btv;
	int err;

1866
	if (f->tuner)
1867
		return -EINVAL;
1868 1869

	err = v4l2_prio_check(&btv->prio, fh->prio);
1870 1871
	if (err)
		return err;
1872
	bttv_set_frequency(btv, f);
1873 1874 1875
	return 0;
}

1876
static int bttv_log_status(struct file *file, void *f)
1877
{
1878
	struct video_device *vdev = video_devdata(file);
1879 1880 1881
	struct bttv_fh *fh  = f;
	struct bttv *btv = fh->btv;

1882
	v4l2_ctrl_handler_log_status(vdev->ctrl_handler, btv->c.v4l2_dev.name);
1883
	bttv_call_all(btv, core, log_status);
1884 1885 1886
	return 0;
}

1887 1888 1889 1890 1891 1892 1893 1894 1895 1896 1897 1898 1899 1900 1901 1902 1903 1904 1905 1906 1907 1908
static int bttv_g_chip_ident(struct file *file, void *f, struct v4l2_dbg_chip_ident *chip)
{
	struct bttv_fh *fh  = f;
	struct bttv *btv = fh->btv;

	chip->ident = V4L2_IDENT_NONE;
	chip->revision = 0;
	if (chip->match.type == V4L2_CHIP_MATCH_HOST) {
		if (v4l2_chip_match_host(&chip->match)) {
			chip->ident = btv->id;
			if (chip->ident == PCI_DEVICE_ID_FUSION879)
				chip->ident = V4L2_IDENT_BT879;
		}
		return 0;
	}
	if (chip->match.type != V4L2_CHIP_MATCH_I2C_DRIVER &&
	    chip->match.type != V4L2_CHIP_MATCH_I2C_ADDR)
		return -EINVAL;
	/* TODO: is this correct? */
	return bttv_call_all_err(btv, core, g_chip_ident, chip);
}

1909
#ifdef CONFIG_VIDEO_ADV_DEBUG
1910
static int bttv_g_register(struct file *file, void *f,
1911
					struct v4l2_dbg_register *reg)
1912 1913 1914 1915 1916 1917 1918
{
	struct bttv_fh *fh = f;
	struct bttv *btv = fh->btv;

	if (!capable(CAP_SYS_ADMIN))
		return -EPERM;

1919 1920 1921 1922 1923 1924
	if (!v4l2_chip_match_host(&reg->match)) {
		/* TODO: subdev errors should not be ignored, this should become a
		   subdev helper function. */
		bttv_call_all(btv, core, g_register, reg);
		return 0;
	}
1925 1926 1927 1928

	/* bt848 has a 12-bit register space */
	reg->reg &= 0xfff;
	reg->val = btread(reg->reg);
1929
	reg->size = 1;
1930 1931 1932 1933

	return 0;
}

1934
static int bttv_s_register(struct file *file, void *f,
1935
					struct v4l2_dbg_register *reg)
1936 1937 1938 1939 1940 1941 1942
{
	struct bttv_fh *fh = f;
	struct bttv *btv = fh->btv;

	if (!capable(CAP_SYS_ADMIN))
		return -EPERM;

1943 1944 1945 1946 1947 1948
	if (!v4l2_chip_match_host(&reg->match)) {
		/* TODO: subdev errors should not be ignored, this should become a
		   subdev helper function. */
		bttv_call_all(btv, core, s_register, reg);
		return 0;
	}
1949 1950 1951 1952 1953 1954 1955 1956 1957 1958 1959 1960 1961 1962 1963 1964 1965 1966 1967 1968 1969 1970 1971 1972 1973 1974 1975 1976 1977 1978 1979 1980 1981 1982 1983 1984 1985 1986 1987 1988 1989 1990 1991 1992 1993

	/* bt848 has a 12-bit register space */
	reg->reg &= 0xfff;
	btwrite(reg->val, reg->reg);

	return 0;
}
#endif

/* Given cropping boundaries b and the scaled width and height of a
   single field or frame, which must not exceed hardware limits, this
   function adjusts the cropping parameters c. */
static void
bttv_crop_adjust	(struct bttv_crop *             c,
			 const struct v4l2_rect *	b,
			 __s32                          width,
			 __s32                          height,
			 enum v4l2_field                field)
{
	__s32 frame_height = height << !V4L2_FIELD_HAS_BOTH(field);
	__s32 max_left;
	__s32 max_top;

	if (width < c->min_scaled_width) {
		/* Max. hor. scale factor 16:1. */
		c->rect.width = width * 16;
	} else if (width > c->max_scaled_width) {
		/* Min. hor. scale factor 1:1. */
		c->rect.width = width;

		max_left = b->left + b->width - width;
		max_left = min(max_left, (__s32) MAX_HDELAY);
		if (c->rect.left > max_left)
			c->rect.left = max_left;
	}

	if (height < c->min_scaled_height) {
		/* Max. vert. scale factor 16:1, single fields 8:1. */
		c->rect.height = height * 16;
	} else if (frame_height > c->max_scaled_height) {
		/* Min. vert. scale factor 1:1.
		   Top and height count field lines times two. */
		c->rect.height = (frame_height + 1) & ~1;

		max_top = b->top + b->height - c->rect.height;
1994 1995 1996 1997 1998 1999 2000 2001 2002 2003 2004 2005 2006 2007 2008
		if (c->rect.top > max_top)
			c->rect.top = max_top;
	}

	bttv_crop_calc_limits(c);
}

/* Returns an error if scaling to a frame or single field with the given
   width and height is not possible with the current cropping parameters
   and width aligned according to width_mask. If adjust_size is TRUE the
   function may adjust the width and/or height instead, rounding width
   to (width + width_bias) & width_mask. If adjust_crop is TRUE it may
   also adjust the current cropping parameters to get closer to the
   desired image size. */
static int
2009
limit_scaled_size_lock       (struct bttv_fh *               fh,
2010 2011 2012 2013 2014 2015 2016 2017 2018 2019 2020 2021 2022 2023 2024 2025 2026 2027 2028 2029 2030 2031 2032 2033 2034 2035 2036 2037 2038 2039 2040 2041 2042 2043 2044 2045 2046 2047 2048 2049 2050 2051 2052 2053 2054 2055 2056 2057 2058 2059 2060 2061 2062 2063 2064 2065 2066 2067 2068 2069 2070 2071 2072 2073 2074 2075 2076 2077 2078 2079 2080 2081 2082 2083 2084 2085 2086 2087 2088 2089 2090 2091 2092 2093 2094 2095 2096 2097 2098 2099 2100 2101 2102 2103 2104 2105 2106 2107 2108 2109 2110 2111 2112 2113 2114 2115 2116 2117 2118 2119 2120
			 __s32 *                        width,
			 __s32 *                        height,
			 enum v4l2_field                field,
			 unsigned int			width_mask,
			 unsigned int			width_bias,
			 int                            adjust_size,
			 int                            adjust_crop)
{
	struct bttv *btv = fh->btv;
	const struct v4l2_rect *b;
	struct bttv_crop *c;
	__s32 min_width;
	__s32 min_height;
	__s32 max_width;
	__s32 max_height;
	int rc;

	BUG_ON((int) width_mask >= 0 ||
	       width_bias >= (unsigned int) -width_mask);

	/* Make sure tvnorm, vbi_end and the current cropping parameters
	   remain consistent until we're done. */

	b = &bttv_tvnorms[btv->tvnorm].cropcap.bounds;

	/* Do crop - use current, don't - use default parameters. */
	c = &btv->crop[!!fh->do_crop];

	if (fh->do_crop
	    && adjust_size
	    && adjust_crop
	    && !locked_btres(btv, VIDEO_RESOURCES)) {
		min_width = 48;
		min_height = 32;

		/* We cannot scale up. When the scaled image is larger
		   than crop.rect we adjust the crop.rect as required
		   by the V4L2 spec, hence cropcap.bounds are our limit. */
		max_width = min(b->width, (__s32) MAX_HACTIVE);
		max_height = b->height;

		/* We cannot capture the same line as video and VBI data.
		   Note btv->vbi_end is really a minimum, see
		   bttv_vbi_try_fmt(). */
		if (btv->vbi_end > b->top) {
			max_height -= btv->vbi_end - b->top;
			rc = -EBUSY;
			if (min_height > max_height)
				goto fail;
		}
	} else {
		rc = -EBUSY;
		if (btv->vbi_end > c->rect.top)
			goto fail;

		min_width  = c->min_scaled_width;
		min_height = c->min_scaled_height;
		max_width  = c->max_scaled_width;
		max_height = c->max_scaled_height;

		adjust_crop = 0;
	}

	min_width = (min_width - width_mask - 1) & width_mask;
	max_width = max_width & width_mask;

	/* Max. scale factor is 16:1 for frames, 8:1 for fields. */
	min_height = min_height;
	/* Min. scale factor is 1:1. */
	max_height >>= !V4L2_FIELD_HAS_BOTH(field);

	if (adjust_size) {
		*width = clamp(*width, min_width, max_width);
		*height = clamp(*height, min_height, max_height);

		/* Round after clamping to avoid overflow. */
		*width = (*width + width_bias) & width_mask;

		if (adjust_crop) {
			bttv_crop_adjust(c, b, *width, *height, field);

			if (btv->vbi_end > c->rect.top) {
				/* Move the crop window out of the way. */
				c->rect.top = btv->vbi_end;
			}
		}
	} else {
		rc = -EINVAL;
		if (*width  < min_width ||
		    *height < min_height ||
		    *width  > max_width ||
		    *height > max_height ||
		    0 != (*width & ~width_mask))
			goto fail;
	}

	rc = 0; /* success */

 fail:

	return rc;
}

/* Returns an error if the given overlay window dimensions are not
   possible with the current cropping parameters. If adjust_size is
   TRUE the function may adjust the window width and/or height
   instead, however it always rounds the horizontal position and
   width as btcx_align() does. If adjust_crop is TRUE the function
   may also adjust the current cropping parameters to get closer
   to the desired window size. */
static int
2121
verify_window_lock		(struct bttv_fh *               fh,
2122 2123 2124
			 struct v4l2_window *           win,
			 int                            adjust_size,
			 int                            adjust_crop)
L
Linus Torvalds 已提交
2125 2126
{
	enum v4l2_field field;
2127 2128
	unsigned int width_mask;
	int rc;
L
Linus Torvalds 已提交
2129 2130 2131 2132 2133 2134 2135 2136 2137

	if (win->w.width  < 48 || win->w.height < 32)
		return -EINVAL;
	if (win->clipcount > 2048)
		return -EINVAL;

	field = win->field;

	if (V4L2_FIELD_ANY == field) {
2138 2139 2140 2141
		__s32 height2;

		height2 = fh->btv->crop[!!fh->do_crop].rect.height >> 1;
		field = (win->w.height > height2)
L
Linus Torvalds 已提交
2142 2143 2144 2145 2146 2147 2148 2149 2150 2151 2152 2153
			? V4L2_FIELD_INTERLACED
			: V4L2_FIELD_TOP;
	}
	switch (field) {
	case V4L2_FIELD_TOP:
	case V4L2_FIELD_BOTTOM:
	case V4L2_FIELD_INTERLACED:
		break;
	default:
		return -EINVAL;
	}

2154 2155
	/* 4-byte alignment. */
	if (NULL == fh->ovfmt)
L
Linus Torvalds 已提交
2156
		return -EINVAL;
2157 2158 2159 2160 2161 2162 2163 2164 2165 2166 2167 2168 2169 2170 2171 2172 2173 2174
	width_mask = ~0;
	switch (fh->ovfmt->depth) {
	case 8:
	case 24:
		width_mask = ~3;
		break;
	case 16:
		width_mask = ~1;
		break;
	case 32:
		break;
	default:
		BUG();
	}

	win->w.width -= win->w.left & ~width_mask;
	win->w.left = (win->w.left - width_mask - 1) & width_mask;

2175
	rc = limit_scaled_size_lock(fh, &win->w.width, &win->w.height,
2176 2177 2178 2179 2180
			       field, width_mask,
			       /* width_bias: round down */ 0,
			       adjust_size, adjust_crop);
	if (0 != rc)
		return rc;
L
Linus Torvalds 已提交
2181 2182 2183 2184 2185

	win->field = field;
	return 0;
}

2186
static int setup_window_lock(struct bttv_fh *fh, struct bttv *btv,
L
Linus Torvalds 已提交
2187 2188 2189 2190 2191 2192 2193 2194 2195
			struct v4l2_window *win, int fixup)
{
	struct v4l2_clip *clips = NULL;
	int n,size,retval = 0;

	if (NULL == fh->ovfmt)
		return -EINVAL;
	if (!(fh->ovfmt->flags & FORMAT_FLAGS_PACKED))
		return -EINVAL;
2196
	retval = verify_window_lock(fh, win,
2197 2198
			       /* adjust_size */ fixup,
			       /* adjust_crop */ fixup);
L
Linus Torvalds 已提交
2199 2200 2201 2202 2203 2204 2205 2206 2207 2208 2209 2210 2211 2212 2213 2214
	if (0 != retval)
		return retval;

	/* copy clips  --  luckily v4l1 + v4l2 are binary
	   compatible here ...*/
	n = win->clipcount;
	size = sizeof(*clips)*(n+4);
	clips = kmalloc(size,GFP_KERNEL);
	if (NULL == clips)
		return -ENOMEM;
	if (n > 0) {
		if (copy_from_user(clips,win->clips,sizeof(struct v4l2_clip)*n)) {
			kfree(clips);
			return -EFAULT;
		}
	}
2215

L
Linus Torvalds 已提交
2216 2217 2218 2219 2220 2221 2222 2223 2224 2225 2226 2227 2228 2229 2230 2231 2232 2233 2234 2235 2236 2237
	/* clip against screen */
	if (NULL != btv->fbuf.base)
		n = btcx_screen_clips(btv->fbuf.fmt.width, btv->fbuf.fmt.height,
				      &win->w, clips, n);
	btcx_sort_clips(clips,n);

	/* 4-byte alignments */
	switch (fh->ovfmt->depth) {
	case 8:
	case 24:
		btcx_align(&win->w, clips, n, 3);
		break;
	case 16:
		btcx_align(&win->w, clips, n, 1);
		break;
	case 32:
		/* no alignment fixups needed */
		break;
	default:
		BUG();
	}

2238
	kfree(fh->ov.clips);
L
Linus Torvalds 已提交
2239 2240 2241 2242 2243 2244
	fh->ov.clips    = clips;
	fh->ov.nclips   = n;

	fh->ov.w        = win->w;
	fh->ov.field    = win->field;
	fh->ov.setup_ok = 1;
2245

L
Linus Torvalds 已提交
2246 2247 2248 2249 2250 2251 2252 2253 2254
	btv->init.ov.w.width   = win->w.width;
	btv->init.ov.w.height  = win->w.height;
	btv->init.ov.field     = win->field;

	/* update overlay if needed */
	retval = 0;
	if (check_btres(fh, RESOURCE_OVERLAY)) {
		struct bttv_buffer *new;

2255
		new = videobuf_sg_alloc(sizeof(*new));
2256
		new->crop = btv->crop[!!fh->do_crop].rect;
L
Linus Torvalds 已提交
2257 2258 2259 2260 2261 2262 2263 2264 2265 2266 2267 2268 2269 2270 2271 2272 2273 2274 2275 2276 2277 2278 2279 2280 2281 2282 2283 2284 2285 2286 2287
		bttv_overlay_risc(btv, &fh->ov, fh->ovfmt, new);
		retval = bttv_switch_overlay(btv,fh,new);
	}
	return retval;
}

/* ----------------------------------------------------------------------- */

static struct videobuf_queue* bttv_queue(struct bttv_fh *fh)
{
	struct videobuf_queue* q = NULL;

	switch (fh->type) {
	case V4L2_BUF_TYPE_VIDEO_CAPTURE:
		q = &fh->cap;
		break;
	case V4L2_BUF_TYPE_VBI_CAPTURE:
		q = &fh->vbi;
		break;
	default:
		BUG();
	}
	return q;
}

static int bttv_resource(struct bttv_fh *fh)
{
	int res = 0;

	switch (fh->type) {
	case V4L2_BUF_TYPE_VIDEO_CAPTURE:
2288
		res = RESOURCE_VIDEO_STREAM;
L
Linus Torvalds 已提交
2289 2290 2291 2292 2293 2294 2295 2296 2297 2298 2299 2300 2301 2302 2303 2304 2305 2306 2307 2308 2309 2310 2311
		break;
	case V4L2_BUF_TYPE_VBI_CAPTURE:
		res = RESOURCE_VBI;
		break;
	default:
		BUG();
	}
	return res;
}

static int bttv_switch_type(struct bttv_fh *fh, enum v4l2_buf_type type)
{
	struct videobuf_queue *q = bttv_queue(fh);
	int res = bttv_resource(fh);

	if (check_btres(fh,res))
		return -EBUSY;
	if (videobuf_queue_is_busy(q))
		return -EBUSY;
	fh->type = type;
	return 0;
}

2312 2313 2314 2315 2316 2317 2318 2319 2320 2321 2322 2323 2324 2325 2326 2327 2328 2329
static void
pix_format_set_size     (struct v4l2_pix_format *       f,
			 const struct bttv_format *     fmt,
			 unsigned int                   width,
			 unsigned int                   height)
{
	f->width = width;
	f->height = height;

	if (fmt->flags & FORMAT_FLAGS_PLANAR) {
		f->bytesperline = width; /* Y plane */
		f->sizeimage = (width * height * fmt->depth) >> 3;
	} else {
		f->bytesperline = (width * fmt->depth) >> 3;
		f->sizeimage = height * f->bytesperline;
	}
}

2330
static int bttv_g_fmt_vid_cap(struct file *file, void *priv,
2331
					struct v4l2_format *f)
L
Linus Torvalds 已提交
2332
{
2333 2334 2335 2336 2337 2338
	struct bttv_fh *fh  = priv;

	pix_format_set_size(&f->fmt.pix, fh->fmt,
				fh->width, fh->height);
	f->fmt.pix.field        = fh->cap.field;
	f->fmt.pix.pixelformat  = fh->fmt->fourcc;
H
Hans Verkuil 已提交
2339
	f->fmt.pix.colorspace   = V4L2_COLORSPACE_SMPTE170M;
2340 2341

	return 0;
L
Linus Torvalds 已提交
2342 2343
}

2344
static int bttv_g_fmt_vid_overlay(struct file *file, void *priv,
2345
					struct v4l2_format *f)
L
Linus Torvalds 已提交
2346
{
2347
	struct bttv_fh *fh  = priv;
L
Linus Torvalds 已提交
2348

2349 2350
	f->fmt.win.w     = fh->ov.w;
	f->fmt.win.field = fh->ov.field;
L
Linus Torvalds 已提交
2351

2352 2353
	return 0;
}
2354

2355
static int bttv_try_fmt_vid_cap(struct file *file, void *priv,
2356 2357 2358 2359 2360 2361 2362
						struct v4l2_format *f)
{
	const struct bttv_format *fmt;
	struct bttv_fh *fh = priv;
	struct bttv *btv = fh->btv;
	enum v4l2_field field;
	__s32 width, height;
2363
	__s32 height2;
2364
	int rc;
L
Linus Torvalds 已提交
2365

2366 2367 2368
	fmt = format_by_fourcc(f->fmt.pix.pixelformat);
	if (NULL == fmt)
		return -EINVAL;
2369

2370
	field = f->fmt.pix.field;
2371

2372 2373 2374 2375 2376 2377
	switch (field) {
	case V4L2_FIELD_TOP:
	case V4L2_FIELD_BOTTOM:
	case V4L2_FIELD_ALTERNATE:
	case V4L2_FIELD_INTERLACED:
		break;
2378
	case V4L2_FIELD_SEQ_BT:
2379
	case V4L2_FIELD_SEQ_TB:
2380 2381 2382 2383 2384 2385 2386 2387 2388 2389
		if (!(fmt->flags & FORMAT_FLAGS_PLANAR)) {
			field = V4L2_FIELD_SEQ_TB;
			break;
		}
		/* fall through */
	default: /* FIELD_ANY case */
		height2 = btv->crop[!!fh->do_crop].rect.height >> 1;
		field = (f->fmt.pix.height > height2)
			? V4L2_FIELD_INTERLACED
			: V4L2_FIELD_BOTTOM;
2390
		break;
L
Linus Torvalds 已提交
2391
	}
2392 2393 2394 2395

	width = f->fmt.pix.width;
	height = f->fmt.pix.height;

2396
	rc = limit_scaled_size_lock(fh, &width, &height, field,
2397 2398 2399 2400 2401 2402 2403
			       /* width_mask: 4 pixels */ ~3,
			       /* width_bias: nearest */ 2,
			       /* adjust_size */ 1,
			       /* adjust_crop */ 0);
	if (0 != rc)
		return rc;

2404 2405 2406
	/* update data for the application */
	f->fmt.pix.field = field;
	pix_format_set_size(&f->fmt.pix, fmt, width, height);
H
Hans Verkuil 已提交
2407
	f->fmt.pix.colorspace = V4L2_COLORSPACE_SMPTE170M;
2408 2409 2410 2411

	return 0;
}

2412
static int bttv_try_fmt_vid_overlay(struct file *file, void *priv,
2413 2414 2415 2416
						struct v4l2_format *f)
{
	struct bttv_fh *fh = priv;

2417
	return verify_window_lock(fh, &f->fmt.win,
2418 2419
			/* adjust_size */ 1,
			/* adjust_crop */ 0);
L
Linus Torvalds 已提交
2420 2421
}

2422
static int bttv_s_fmt_vid_cap(struct file *file, void *priv,
2423
				struct v4l2_format *f)
L
Linus Torvalds 已提交
2424 2425
{
	int retval;
2426 2427 2428
	const struct bttv_format *fmt;
	struct bttv_fh *fh = priv;
	struct bttv *btv = fh->btv;
2429 2430
	__s32 width, height;
	enum v4l2_field field;
L
Linus Torvalds 已提交
2431

2432 2433 2434
	retval = bttv_switch_type(fh, f->type);
	if (0 != retval)
		return retval;
L
Linus Torvalds 已提交
2435

2436
	retval = bttv_try_fmt_vid_cap(file, priv, f);
2437 2438
	if (0 != retval)
		return retval;
L
Linus Torvalds 已提交
2439

2440 2441 2442 2443
	width = f->fmt.pix.width;
	height = f->fmt.pix.height;
	field = f->fmt.pix.field;

2444
	retval = limit_scaled_size_lock(fh, &width, &height, f->fmt.pix.field,
2445 2446 2447 2448 2449 2450 2451 2452 2453
			       /* width_mask: 4 pixels */ ~3,
			       /* width_bias: nearest */ 2,
			       /* adjust_size */ 1,
			       /* adjust_crop */ 1);
	if (0 != retval)
		return retval;

	f->fmt.pix.field = field;

2454
	fmt = format_by_fourcc(f->fmt.pix.pixelformat);
L
Linus Torvalds 已提交
2455

2456 2457 2458 2459 2460 2461 2462 2463 2464 2465 2466 2467 2468
	/* update our state informations */
	fh->fmt              = fmt;
	fh->cap.field        = f->fmt.pix.field;
	fh->cap.last         = V4L2_FIELD_NONE;
	fh->width            = f->fmt.pix.width;
	fh->height           = f->fmt.pix.height;
	btv->init.fmt        = fmt;
	btv->init.width      = f->fmt.pix.width;
	btv->init.height     = f->fmt.pix.height;

	return 0;
}

2469
static int bttv_s_fmt_vid_overlay(struct file *file, void *priv,
2470 2471 2472 2473 2474
				struct v4l2_format *f)
{
	struct bttv_fh *fh = priv;
	struct bttv *btv = fh->btv;

2475
	if (no_overlay > 0) {
2476
		pr_err("V4L2_BUF_TYPE_VIDEO_OVERLAY: no_overlay\n");
L
Linus Torvalds 已提交
2477
		return -EINVAL;
2478
	}
2479

2480
	return setup_window_lock(fh, btv, &f->fmt.win, 1);
2481 2482
}

2483
static int bttv_querycap(struct file *file, void  *priv,
2484
				struct v4l2_capability *cap)
L
Linus Torvalds 已提交
2485
{
2486
	struct video_device *vdev = video_devdata(file);
2487 2488
	struct bttv_fh *fh = priv;
	struct bttv *btv = fh->btv;
L
Linus Torvalds 已提交
2489

2490 2491
	if (0 == v4l2)
		return -EINVAL;
2492

2493 2494 2495 2496 2497 2498 2499
	strlcpy(cap->driver, "bttv", sizeof(cap->driver));
	strlcpy(cap->card, btv->video_dev->name, sizeof(cap->card));
	snprintf(cap->bus_info, sizeof(cap->bus_info),
		 "PCI:%s", pci_name(btv->c.pci));
	cap->capabilities =
		V4L2_CAP_VIDEO_CAPTURE |
		V4L2_CAP_READWRITE |
2500 2501
		V4L2_CAP_STREAMING |
		V4L2_CAP_DEVICE_CAPS;
2502 2503
	if (no_overlay <= 0)
		cap->capabilities |= V4L2_CAP_VIDEO_OVERLAY;
2504 2505 2506 2507
	if (btv->vbi_dev)
		cap->capabilities |= V4L2_CAP_VBI_CAPTURE;
	if (btv->radio_dev)
		cap->capabilities |= V4L2_CAP_RADIO;
2508

2509 2510 2511 2512 2513 2514
	/*
	 * No need to lock here: those vars are initialized during board
	 * probe and remains untouched during the rest of the driver lifecycle
	 */
	if (btv->has_saa6588)
		cap->capabilities |= V4L2_CAP_RDS_CAPTURE;
2515
	if (btv->tuner_type != TUNER_ABSENT)
2516
		cap->capabilities |= V4L2_CAP_TUNER;
2517 2518 2519 2520 2521 2522 2523 2524 2525 2526 2527 2528 2529 2530 2531 2532 2533 2534 2535
	if (vdev->vfl_type == VFL_TYPE_GRABBER)
		cap->device_caps = cap->capabilities &
			(V4L2_CAP_VIDEO_CAPTURE |
			 V4L2_CAP_READWRITE |
			 V4L2_CAP_STREAMING |
			 V4L2_CAP_VIDEO_OVERLAY |
			 V4L2_CAP_TUNER);
	else if (vdev->vfl_type == VFL_TYPE_VBI)
		cap->device_caps = cap->capabilities &
			(V4L2_CAP_VBI_CAPTURE |
			 V4L2_CAP_READWRITE |
			 V4L2_CAP_STREAMING |
			 V4L2_CAP_TUNER);
	else {
		cap->device_caps = V4L2_CAP_RADIO | V4L2_CAP_TUNER;
		if (btv->has_saa6588)
			cap->device_caps |= V4L2_CAP_READWRITE |
						V4L2_CAP_RDS_CAPTURE;
	}
2536 2537
	return 0;
}
L
Linus Torvalds 已提交
2538

2539 2540 2541 2542 2543 2544 2545 2546 2547 2548 2549 2550 2551 2552 2553 2554 2555 2556 2557
static int bttv_enum_fmt_cap_ovr(struct v4l2_fmtdesc *f)
{
	int index = -1, i;

	for (i = 0; i < FORMATS; i++) {
		if (formats[i].fourcc != -1)
			index++;
		if ((unsigned int)index == f->index)
			break;
	}
	if (FORMATS == i)
		return -EINVAL;

	f->pixelformat = formats[i].fourcc;
	strlcpy(f->description, formats[i].name, sizeof(f->description));

	return i;
}

2558
static int bttv_enum_fmt_vid_cap(struct file *file, void  *priv,
2559 2560
				struct v4l2_fmtdesc *f)
{
2561
	int rc = bttv_enum_fmt_cap_ovr(f);
L
Linus Torvalds 已提交
2562

2563 2564
	if (rc < 0)
		return rc;
L
Linus Torvalds 已提交
2565

2566 2567
	return 0;
}
2568

2569
static int bttv_enum_fmt_vid_overlay(struct file *file, void  *priv,
2570 2571
					struct v4l2_fmtdesc *f)
{
2572 2573
	int rc;

2574
	if (no_overlay > 0) {
2575
		pr_err("V4L2_BUF_TYPE_VIDEO_OVERLAY: no_overlay\n");
2576
		return -EINVAL;
L
Linus Torvalds 已提交
2577 2578
	}

2579
	rc = bttv_enum_fmt_cap_ovr(f);
L
Linus Torvalds 已提交
2580

2581 2582
	if (rc < 0)
		return rc;
L
Linus Torvalds 已提交
2583

2584 2585
	if (!(formats[rc].flags & FORMAT_FLAGS_PACKED))
		return -EINVAL;
L
Linus Torvalds 已提交
2586

2587 2588 2589
	return 0;
}

2590
static int bttv_g_fbuf(struct file *file, void *f,
2591 2592 2593 2594 2595 2596 2597
				struct v4l2_framebuffer *fb)
{
	struct bttv_fh *fh = f;
	struct bttv *btv = fh->btv;

	*fb = btv->fbuf;
	fb->capability = V4L2_FBUF_CAP_LIST_CLIPPING;
2598
	fb->flags = V4L2_FBUF_FLAG_PRIMARY;
2599 2600 2601 2602 2603
	if (fh->ovfmt)
		fb->fmt.pixelformat  = fh->ovfmt->fourcc;
	return 0;
}

2604
static int bttv_overlay(struct file *file, void *f, unsigned int on)
2605 2606 2607 2608
{
	struct bttv_fh *fh = f;
	struct bttv *btv = fh->btv;
	struct bttv_buffer *new;
2609
	int retval = 0;
2610 2611 2612

	if (on) {
		/* verify args */
2613
		if (unlikely(!btv->fbuf.base)) {
2614
			return -EINVAL;
2615 2616
		}
		if (unlikely(!fh->ov.setup_ok)) {
2617
			dprintk("%d: overlay: !setup_ok\n", btv->c.nr);
2618
			retval = -EINVAL;
L
Linus Torvalds 已提交
2619
		}
2620 2621
		if (retval)
			return retval;
L
Linus Torvalds 已提交
2622
	}
2623

2624
	if (!check_alloc_btres_lock(btv, fh, RESOURCE_OVERLAY))
2625 2626 2627 2628
		return -EBUSY;

	if (on) {
		fh->ov.tvnorm = btv->tvnorm;
2629
		new = videobuf_sg_alloc(sizeof(*new));
2630
		new->crop = btv->crop[!!fh->do_crop].rect;
2631 2632 2633
		bttv_overlay_risc(btv, &fh->ov, fh->ovfmt, new);
	} else {
		new = NULL;
L
Linus Torvalds 已提交
2634 2635
	}

2636 2637 2638 2639 2640
	/* switch over */
	retval = bttv_switch_overlay(btv, fh, new);
	return retval;
}

2641
static int bttv_s_fbuf(struct file *file, void *f,
2642
				const struct v4l2_framebuffer *fb)
2643 2644 2645 2646 2647 2648 2649 2650 2651
{
	struct bttv_fh *fh = f;
	struct bttv *btv = fh->btv;
	const struct bttv_format *fmt;
	int retval;

	if (!capable(CAP_SYS_ADMIN) &&
		!capable(CAP_SYS_RAWIO))
		return -EPERM;
L
Linus Torvalds 已提交
2652

2653 2654 2655 2656 2657 2658 2659 2660 2661 2662 2663 2664
	/* check args */
	fmt = format_by_fourcc(fb->fmt.pixelformat);
	if (NULL == fmt)
		return -EINVAL;
	if (0 == (fmt->flags & FORMAT_FLAGS_PACKED))
		return -EINVAL;

	retval = -EINVAL;
	if (fb->flags & V4L2_FBUF_FLAG_OVERLAY) {
		__s32 width = fb->fmt.width;
		__s32 height = fb->fmt.height;

2665
		retval = limit_scaled_size_lock(fh, &width, &height,
2666 2667 2668 2669 2670 2671 2672
					   V4L2_FIELD_INTERLACED,
					   /* width_mask */ ~3,
					   /* width_bias */ 2,
					   /* adjust_size */ 0,
					   /* adjust_crop */ 0);
		if (0 != retval)
			return retval;
L
Linus Torvalds 已提交
2673
	}
2674

2675 2676 2677 2678 2679 2680 2681 2682
	/* ok, accept it */
	btv->fbuf.base       = fb->base;
	btv->fbuf.fmt.width  = fb->fmt.width;
	btv->fbuf.fmt.height = fb->fmt.height;
	if (0 != fb->fmt.bytesperline)
		btv->fbuf.fmt.bytesperline = fb->fmt.bytesperline;
	else
		btv->fbuf.fmt.bytesperline = btv->fbuf.fmt.width*fmt->depth/8;
2683

2684 2685 2686 2687 2688 2689 2690 2691 2692 2693 2694 2695 2696 2697 2698 2699
	retval = 0;
	fh->ovfmt = fmt;
	btv->init.ovfmt = fmt;
	if (fb->flags & V4L2_FBUF_FLAG_OVERLAY) {
		fh->ov.w.left   = 0;
		fh->ov.w.top    = 0;
		fh->ov.w.width  = fb->fmt.width;
		fh->ov.w.height = fb->fmt.height;
		btv->init.ov.w.width  = fb->fmt.width;
		btv->init.ov.w.height = fb->fmt.height;
			kfree(fh->ov.clips);
		fh->ov.clips = NULL;
		fh->ov.nclips = 0;

		if (check_btres(fh, RESOURCE_OVERLAY)) {
			struct bttv_buffer *new;
2700

2701
			new = videobuf_sg_alloc(sizeof(*new));
2702
			new->crop = btv->crop[!!fh->do_crop].rect;
2703
			bttv_overlay_risc(btv, &fh->ov, fh->ovfmt, new);
2704
			retval = bttv_switch_overlay(btv, fh, new);
2705 2706
		}
	}
2707 2708
	return retval;
}
L
Linus Torvalds 已提交
2709

2710
static int bttv_reqbufs(struct file *file, void *priv,
2711 2712 2713 2714 2715
				struct v4l2_requestbuffers *p)
{
	struct bttv_fh *fh = priv;
	return videobuf_reqbufs(bttv_queue(fh), p);
}
L
Linus Torvalds 已提交
2716

2717
static int bttv_querybuf(struct file *file, void *priv,
2718 2719 2720 2721 2722
				struct v4l2_buffer *b)
{
	struct bttv_fh *fh = priv;
	return videobuf_querybuf(bttv_queue(fh), b);
}
L
Linus Torvalds 已提交
2723

2724
static int bttv_qbuf(struct file *file, void *priv, struct v4l2_buffer *b)
2725 2726 2727 2728
{
	struct bttv_fh *fh = priv;
	struct bttv *btv = fh->btv;
	int res = bttv_resource(fh);
L
Linus Torvalds 已提交
2729

2730
	if (!check_alloc_btres_lock(btv, fh, res))
2731
		return -EBUSY;
2732

2733 2734
	return videobuf_qbuf(bttv_queue(fh), b);
}
L
Linus Torvalds 已提交
2735

2736
static int bttv_dqbuf(struct file *file, void *priv, struct v4l2_buffer *b)
2737 2738 2739 2740 2741
{
	struct bttv_fh *fh = priv;
	return videobuf_dqbuf(bttv_queue(fh), b,
			file->f_flags & O_NONBLOCK);
}
L
Linus Torvalds 已提交
2742

2743
static int bttv_streamon(struct file *file, void *priv,
2744 2745 2746 2747 2748
					enum v4l2_buf_type type)
{
	struct bttv_fh *fh = priv;
	struct bttv *btv = fh->btv;
	int res = bttv_resource(fh);
L
Linus Torvalds 已提交
2749

2750
	if (!check_alloc_btres_lock(btv, fh, res))
2751 2752 2753
		return -EBUSY;
	return videobuf_streamon(bttv_queue(fh));
}
L
Linus Torvalds 已提交
2754

2755

2756
static int bttv_streamoff(struct file *file, void *priv,
2757 2758 2759 2760 2761 2762
					enum v4l2_buf_type type)
{
	struct bttv_fh *fh = priv;
	struct bttv *btv = fh->btv;
	int retval;
	int res = bttv_resource(fh);
2763

2764

2765 2766 2767
	retval = videobuf_streamoff(bttv_queue(fh));
	if (retval < 0)
		return retval;
2768
	free_btres_lock(btv, fh, res);
2769 2770
	return 0;
}
2771

2772
static int bttv_g_parm(struct file *file, void *f,
2773 2774 2775 2776
				struct v4l2_streamparm *parm)
{
	struct bttv_fh *fh = f;
	struct bttv *btv = fh->btv;
2777

2778 2779 2780
	if (parm->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
		return -EINVAL;
	parm->parm.capture.readbuffers = gbuffers;
2781 2782
	v4l2_video_std_frame_period(bttv_tvnorms[btv->tvnorm].v4l2_id,
				    &parm->parm.capture.timeperframe);
2783

2784 2785
	return 0;
}
2786

2787
static int bttv_g_tuner(struct file *file, void *priv,
2788 2789 2790 2791
				struct v4l2_tuner *t)
{
	struct bttv_fh *fh = priv;
	struct bttv *btv = fh->btv;
2792

2793 2794
	if (0 != t->index)
		return -EINVAL;
2795

2796
	t->rxsubchans = V4L2_TUNER_SUB_MONO;
2797
	bttv_call_all(btv, tuner, g_tuner, t);
2798 2799 2800 2801 2802 2803 2804 2805
	strcpy(t->name, "Television");
	t->capability = V4L2_TUNER_CAP_NORM;
	t->type       = V4L2_TUNER_ANALOG_TV;
	if (btread(BT848_DSTATUS)&BT848_DSTATUS_HLOC)
		t->signal = 0xffff;

	if (btv->audio_mode_gpio)
		btv->audio_mode_gpio(btv, t, 0);
2806

2807 2808
	return 0;
}
2809

2810
static int bttv_g_priority(struct file *file, void *f, enum v4l2_priority *p)
2811 2812 2813
{
	struct bttv_fh *fh = f;
	struct bttv *btv = fh->btv;
2814

2815
	*p = v4l2_prio_max(&btv->prio);
2816

2817 2818
	return 0;
}
2819

2820
static int bttv_s_priority(struct file *file, void *f,
2821 2822 2823 2824
					enum v4l2_priority prio)
{
	struct bttv_fh *fh = f;
	struct bttv *btv = fh->btv;
2825 2826 2827
	int	rc;

	rc = v4l2_prio_change(&btv->prio, &fh->prio, prio);
2828

2829
	return rc;
2830 2831
}

2832
static int bttv_cropcap(struct file *file, void *priv,
2833 2834 2835 2836 2837 2838 2839 2840 2841 2842 2843 2844 2845
				struct v4l2_cropcap *cap)
{
	struct bttv_fh *fh = priv;
	struct bttv *btv = fh->btv;

	if (cap->type != V4L2_BUF_TYPE_VIDEO_CAPTURE &&
	    cap->type != V4L2_BUF_TYPE_VIDEO_OVERLAY)
		return -EINVAL;

	*cap = bttv_tvnorms[btv->tvnorm].cropcap;

	return 0;
}
2846

2847
static int bttv_g_crop(struct file *file, void *f, struct v4l2_crop *crop)
2848 2849 2850 2851 2852 2853 2854
{
	struct bttv_fh *fh = f;
	struct bttv *btv = fh->btv;

	if (crop->type != V4L2_BUF_TYPE_VIDEO_CAPTURE &&
	    crop->type != V4L2_BUF_TYPE_VIDEO_OVERLAY)
		return -EINVAL;
2855

2856 2857 2858
	/* No fh->do_crop = 1; because btv->crop[1] may be
	   inconsistent with fh->width or fh->height and apps
	   do not expect a change here. */
2859

2860
	crop->c = btv->crop[!!fh->do_crop].rect;
2861

2862 2863 2864
	return 0;
}

2865
static int bttv_s_crop(struct file *file, void *f, const struct v4l2_crop *crop)
2866 2867 2868 2869 2870 2871 2872 2873 2874 2875
{
	struct bttv_fh *fh = f;
	struct bttv *btv = fh->btv;
	const struct v4l2_rect *b;
	int retval;
	struct bttv_crop c;
	__s32 b_left;
	__s32 b_top;
	__s32 b_right;
	__s32 b_bottom;
2876

2877 2878 2879
	if (crop->type != V4L2_BUF_TYPE_VIDEO_CAPTURE &&
	    crop->type != V4L2_BUF_TYPE_VIDEO_OVERLAY)
		return -EINVAL;
2880

2881 2882
	/* Make sure tvnorm, vbi_end and the current cropping
	   parameters remain consistent until we're done. Note
2883
	   read() may change vbi_end in check_alloc_btres_lock(). */
2884 2885 2886 2887
	retval = v4l2_prio_check(&btv->prio, fh->prio);
	if (0 != retval) {
		return retval;
	}
2888

2889
	retval = -EBUSY;
2890

2891 2892 2893
	if (locked_btres(fh->btv, VIDEO_RESOURCES)) {
		return retval;
	}
2894

2895
	b = &bttv_tvnorms[btv->tvnorm].cropcap.bounds;
2896

2897 2898 2899
	b_left = b->left;
	b_right = b_left + b->width;
	b_bottom = b->top + b->height;
2900

2901 2902 2903 2904
	b_top = max(b->top, btv->vbi_end);
	if (b_top + 32 >= b_bottom) {
		return retval;
	}
2905

2906
	/* Min. scaled size 48 x 32. */
2907
	c.rect.left = clamp_t(s32, crop->c.left, b_left, b_right - 48);
2908
	c.rect.left = min(c.rect.left, (__s32) MAX_HDELAY);
2909

2910
	c.rect.width = clamp_t(s32, crop->c.width,
2911
			     48, b_right - c.rect.left);
2912

2913
	c.rect.top = clamp_t(s32, crop->c.top, b_top, b_bottom - 32);
2914 2915
	/* Top and height must be a multiple of two. */
	c.rect.top = (c.rect.top + 1) & ~1;
2916

2917
	c.rect.height = clamp_t(s32, crop->c.height,
2918 2919
			      32, b_bottom - c.rect.top);
	c.rect.height = (c.rect.height + 1) & ~1;
2920

2921
	bttv_crop_calc_limits(&c);
2922

2923 2924 2925 2926 2927 2928 2929 2930 2931 2932
	btv->crop[1] = c;

	fh->do_crop = 1;

	if (fh->width < c.min_scaled_width) {
		fh->width = c.min_scaled_width;
		btv->init.width = c.min_scaled_width;
	} else if (fh->width > c.max_scaled_width) {
		fh->width = c.max_scaled_width;
		btv->init.width = c.max_scaled_width;
2933 2934
	}

2935 2936 2937 2938 2939 2940
	if (fh->height < c.min_scaled_height) {
		fh->height = c.min_scaled_height;
		btv->init.height = c.min_scaled_height;
	} else if (fh->height > c.max_scaled_height) {
		fh->height = c.max_scaled_height;
		btv->init.height = c.max_scaled_height;
L
Linus Torvalds 已提交
2941 2942
	}

2943 2944 2945
	return 0;
}

2946
static int bttv_g_audio(struct file *file, void *priv, struct v4l2_audio *a)
2947
{
2948 2949 2950
	if (unlikely(a->index))
		return -EINVAL;

2951 2952
	strcpy(a->name, "audio");
	return 0;
L
Linus Torvalds 已提交
2953 2954
}

2955
static int bttv_s_audio(struct file *file, void *priv, const struct v4l2_audio *a)
L
Linus Torvalds 已提交
2956
{
2957 2958 2959
	if (unlikely(a->index))
		return -EINVAL;

2960
	return 0;
L
Linus Torvalds 已提交
2961 2962 2963 2964 2965 2966 2967 2968 2969 2970
}

static ssize_t bttv_read(struct file *file, char __user *data,
			 size_t count, loff_t *ppos)
{
	struct bttv_fh *fh = file->private_data;
	int retval = 0;

	if (fh->btv->errors)
		bttv_reinit_bt848(fh->btv);
2971 2972
	dprintk("%d: read count=%d type=%s\n",
		fh->btv->c.nr, (int)count, v4l2_type_names[fh->type]);
L
Linus Torvalds 已提交
2973 2974 2975

	switch (fh->type) {
	case V4L2_BUF_TYPE_VIDEO_CAPTURE:
2976
		if (!check_alloc_btres_lock(fh->btv, fh, RESOURCE_VIDEO_READ)) {
2977 2978
			/* VIDEO_READ in use by another fh,
			   or VIDEO_STREAM by any fh. */
L
Linus Torvalds 已提交
2979
			return -EBUSY;
2980
		}
L
Linus Torvalds 已提交
2981 2982
		retval = videobuf_read_one(&fh->cap, data, count, ppos,
					   file->f_flags & O_NONBLOCK);
2983
		free_btres_lock(fh->btv, fh, RESOURCE_VIDEO_READ);
L
Linus Torvalds 已提交
2984 2985
		break;
	case V4L2_BUF_TYPE_VBI_CAPTURE:
2986
		if (!check_alloc_btres_lock(fh->btv,fh,RESOURCE_VBI))
L
Linus Torvalds 已提交
2987 2988 2989 2990 2991 2992 2993 2994 2995 2996 2997 2998 2999 3000 3001
			return -EBUSY;
		retval = videobuf_read_stream(&fh->vbi, data, count, ppos, 1,
					      file->f_flags & O_NONBLOCK);
		break;
	default:
		BUG();
	}
	return retval;
}

static unsigned int bttv_poll(struct file *file, poll_table *wait)
{
	struct bttv_fh *fh = file->private_data;
	struct bttv_buffer *buf;
	enum v4l2_field field;
3002
	unsigned int rc = POLLERR;
L
Linus Torvalds 已提交
3003 3004

	if (V4L2_BUF_TYPE_VBI_CAPTURE == fh->type) {
3005
		if (!check_alloc_btres_lock(fh->btv,fh,RESOURCE_VBI))
L
Linus Torvalds 已提交
3006 3007 3008 3009
			return POLLERR;
		return videobuf_poll_stream(file, &fh->vbi, wait);
	}

3010
	if (check_btres(fh,RESOURCE_VIDEO_STREAM)) {
L
Linus Torvalds 已提交
3011 3012
		/* streaming capture */
		if (list_empty(&fh->cap.stream))
3013
			goto err;
L
Linus Torvalds 已提交
3014 3015 3016 3017 3018
		buf = list_entry(fh->cap.stream.next,struct bttv_buffer,vb.stream);
	} else {
		/* read() capture */
		if (NULL == fh->cap.read_buf) {
			/* need to capture a new frame */
3019 3020
			if (locked_btres(fh->btv,RESOURCE_VIDEO_STREAM))
				goto err;
3021
			fh->cap.read_buf = videobuf_sg_alloc(fh->cap.msize);
3022 3023
			if (NULL == fh->cap.read_buf)
				goto err;
L
Linus Torvalds 已提交
3024 3025 3026
			fh->cap.read_buf->memory = V4L2_MEMORY_USERPTR;
			field = videobuf_next_field(&fh->cap);
			if (0 != fh->cap.ops->buf_prepare(&fh->cap,fh->cap.read_buf,field)) {
3027 3028
				kfree (fh->cap.read_buf);
				fh->cap.read_buf = NULL;
3029
				goto err;
L
Linus Torvalds 已提交
3030 3031 3032 3033 3034 3035 3036 3037
			}
			fh->cap.ops->buf_queue(&fh->cap,fh->cap.read_buf);
			fh->cap.read_off = 0;
		}
		buf = (struct bttv_buffer*)fh->cap.read_buf;
	}

	poll_wait(file, &buf->vb.done, wait);
3038 3039
	if (buf->vb.state == VIDEOBUF_DONE ||
	    buf->vb.state == VIDEOBUF_ERROR)
3040 3041 3042
		rc =  POLLIN|POLLRDNORM;
	else
		rc = 0;
3043
err:
3044
	return rc;
L
Linus Torvalds 已提交
3045 3046
}

3047
static int bttv_open(struct file *file)
L
Linus Torvalds 已提交
3048
{
3049
	struct video_device *vdev = video_devdata(file);
3050
	struct bttv *btv = video_drvdata(file);
L
Linus Torvalds 已提交
3051 3052 3053
	struct bttv_fh *fh;
	enum v4l2_buf_type type = 0;

3054
	dprintk("open dev=%s\n", video_device_node_name(vdev));
L
Linus Torvalds 已提交
3055

3056
	if (vdev->vfl_type == VFL_TYPE_GRABBER) {
3057
		type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
3058
	} else if (vdev->vfl_type == VFL_TYPE_VBI) {
3059 3060 3061
		type = V4L2_BUF_TYPE_VBI_CAPTURE;
	} else {
		WARN_ON(1);
L
Linus Torvalds 已提交
3062
		return -ENODEV;
3063
	}
L
Linus Torvalds 已提交
3064

3065 3066
	dprintk("%d: open called (type=%s)\n",
		btv->c.nr, v4l2_type_names[type]);
L
Linus Torvalds 已提交
3067 3068

	/* allocate per filehandle data */
3069 3070
	fh = kmalloc(sizeof(*fh), GFP_KERNEL);
	if (unlikely(!fh))
L
Linus Torvalds 已提交
3071
		return -ENOMEM;
3072
	btv->users++;
L
Linus Torvalds 已提交
3073
	file->private_data = fh;
3074

L
Linus Torvalds 已提交
3075
	*fh = btv->init;
3076

L
Linus Torvalds 已提交
3077 3078
	fh->type = type;
	fh->ov.setup_ok = 0;
3079

3080
	v4l2_prio_open(&btv->prio, &fh->prio);
L
Linus Torvalds 已提交
3081

3082 3083
	videobuf_queue_sg_init(&fh->cap, &bttv_video_qops,
			    &btv->c.pci->dev, &btv->s_lock,
L
Linus Torvalds 已提交
3084 3085 3086
			    V4L2_BUF_TYPE_VIDEO_CAPTURE,
			    V4L2_FIELD_INTERLACED,
			    sizeof(struct bttv_buffer),
3087
			    fh, &btv->lock);
3088 3089
	videobuf_queue_sg_init(&fh->vbi, &bttv_vbi_qops,
			    &btv->c.pci->dev, &btv->s_lock,
L
Linus Torvalds 已提交
3090 3091 3092
			    V4L2_BUF_TYPE_VBI_CAPTURE,
			    V4L2_FIELD_SEQ_TB,
			    sizeof(struct bttv_buffer),
3093
			    fh, &btv->lock);
3094
	set_tvnorm(btv,btv->tvnorm);
3095
	set_input(btv, btv->input, btv->tvnorm);
L
Linus Torvalds 已提交
3096

3097 3098 3099 3100 3101 3102 3103 3104 3105 3106 3107 3108 3109 3110 3111 3112 3113

	/* The V4L2 spec requires one global set of cropping parameters
	   which only change on request. These are stored in btv->crop[1].
	   However for compatibility with V4L apps and cropping unaware
	   V4L2 apps we now reset the cropping parameters as seen through
	   this fh, which is to say VIDIOC_G_CROP and scaling limit checks
	   will use btv->crop[0], the default cropping parameters for the
	   current video standard, and VIDIOC_S_FMT will not implicitely
	   change the cropping parameters until VIDIOC_S_CROP has been
	   called. */
	fh->do_crop = !reset_crop; /* module parameter */

	/* Likewise there should be one global set of VBI capture
	   parameters, but for compatibility with V4L apps and earlier
	   driver versions each fh has its own parameters. */
	bttv_vbi_fmt_reset(&fh->vbi_fmt, btv->tvnorm);

L
Linus Torvalds 已提交
3114 3115 3116 3117
	bttv_field_count(btv);
	return 0;
}

3118
static int bttv_release(struct file *file)
L
Linus Torvalds 已提交
3119 3120 3121 3122 3123 3124 3125 3126 3127
{
	struct bttv_fh *fh = file->private_data;
	struct bttv *btv = fh->btv;

	/* turn off overlay */
	if (check_btres(fh, RESOURCE_OVERLAY))
		bttv_switch_overlay(btv,fh,NULL);

	/* stop video capture */
3128
	if (check_btres(fh, RESOURCE_VIDEO_STREAM)) {
L
Linus Torvalds 已提交
3129
		videobuf_streamoff(&fh->cap);
3130
		free_btres_lock(btv,fh,RESOURCE_VIDEO_STREAM);
L
Linus Torvalds 已提交
3131 3132 3133 3134 3135
	}
	if (fh->cap.read_buf) {
		buffer_release(&fh->cap,fh->cap.read_buf);
		kfree(fh->cap.read_buf);
	}
3136
	if (check_btres(fh, RESOURCE_VIDEO_READ)) {
3137
		free_btres_lock(btv, fh, RESOURCE_VIDEO_READ);
3138
	}
L
Linus Torvalds 已提交
3139 3140 3141

	/* stop vbi capture */
	if (check_btres(fh, RESOURCE_VBI)) {
3142
		videobuf_stop(&fh->vbi);
3143
		free_btres_lock(btv,fh,RESOURCE_VBI);
L
Linus Torvalds 已提交
3144 3145 3146
	}

	/* free stuff */
3147

L
Linus Torvalds 已提交
3148 3149
	videobuf_mmap_free(&fh->cap);
	videobuf_mmap_free(&fh->vbi);
3150
	v4l2_prio_close(&btv->prio, fh->prio);
L
Linus Torvalds 已提交
3151 3152 3153 3154 3155
	file->private_data = NULL;
	kfree(fh);

	btv->users--;
	bttv_field_count(btv);
3156 3157

	if (!btv->users)
3158
		audio_mute(btv, btv->mute);
3159

L
Linus Torvalds 已提交
3160 3161 3162 3163 3164 3165 3166 3167
	return 0;
}

static int
bttv_mmap(struct file *file, struct vm_area_struct *vma)
{
	struct bttv_fh *fh = file->private_data;

3168
	dprintk("%d: mmap type=%s 0x%lx+%ld\n",
L
Linus Torvalds 已提交
3169 3170 3171 3172 3173
		fh->btv->c.nr, v4l2_type_names[fh->type],
		vma->vm_start, vma->vm_end - vma->vm_start);
	return videobuf_mmap_mapper(bttv_queue(fh),vma);
}

3174
static const struct v4l2_file_operations bttv_fops =
L
Linus Torvalds 已提交
3175
{
3176 3177 3178 3179 3180 3181 3182
	.owner		  = THIS_MODULE,
	.open		  = bttv_open,
	.release	  = bttv_release,
	.unlocked_ioctl	  = video_ioctl2,
	.read		  = bttv_read,
	.mmap		  = bttv_mmap,
	.poll		  = bttv_poll,
L
Linus Torvalds 已提交
3183 3184
};

3185
static const struct v4l2_ioctl_ops bttv_ioctl_ops = {
3186
	.vidioc_querycap                = bttv_querycap,
3187 3188 3189 3190 3191 3192 3193 3194 3195 3196 3197
	.vidioc_enum_fmt_vid_cap        = bttv_enum_fmt_vid_cap,
	.vidioc_g_fmt_vid_cap           = bttv_g_fmt_vid_cap,
	.vidioc_try_fmt_vid_cap         = bttv_try_fmt_vid_cap,
	.vidioc_s_fmt_vid_cap           = bttv_s_fmt_vid_cap,
	.vidioc_enum_fmt_vid_overlay    = bttv_enum_fmt_vid_overlay,
	.vidioc_g_fmt_vid_overlay       = bttv_g_fmt_vid_overlay,
	.vidioc_try_fmt_vid_overlay     = bttv_try_fmt_vid_overlay,
	.vidioc_s_fmt_vid_overlay       = bttv_s_fmt_vid_overlay,
	.vidioc_g_fmt_vbi_cap           = bttv_g_fmt_vbi_cap,
	.vidioc_try_fmt_vbi_cap         = bttv_try_fmt_vbi_cap,
	.vidioc_s_fmt_vbi_cap           = bttv_s_fmt_vbi_cap,
3198 3199 3200 3201 3202 3203 3204 3205 3206 3207 3208 3209 3210 3211 3212 3213 3214 3215 3216 3217 3218 3219 3220 3221 3222 3223 3224
	.vidioc_g_audio                 = bttv_g_audio,
	.vidioc_s_audio                 = bttv_s_audio,
	.vidioc_cropcap                 = bttv_cropcap,
	.vidioc_reqbufs                 = bttv_reqbufs,
	.vidioc_querybuf                = bttv_querybuf,
	.vidioc_qbuf                    = bttv_qbuf,
	.vidioc_dqbuf                   = bttv_dqbuf,
	.vidioc_s_std                   = bttv_s_std,
	.vidioc_enum_input              = bttv_enum_input,
	.vidioc_g_input                 = bttv_g_input,
	.vidioc_s_input                 = bttv_s_input,
	.vidioc_streamon                = bttv_streamon,
	.vidioc_streamoff               = bttv_streamoff,
	.vidioc_g_tuner                 = bttv_g_tuner,
	.vidioc_s_tuner                 = bttv_s_tuner,
	.vidioc_g_crop                  = bttv_g_crop,
	.vidioc_s_crop                  = bttv_s_crop,
	.vidioc_g_fbuf                  = bttv_g_fbuf,
	.vidioc_s_fbuf                  = bttv_s_fbuf,
	.vidioc_overlay                 = bttv_overlay,
	.vidioc_g_priority              = bttv_g_priority,
	.vidioc_s_priority              = bttv_s_priority,
	.vidioc_g_parm                  = bttv_g_parm,
	.vidioc_g_frequency             = bttv_g_frequency,
	.vidioc_s_frequency             = bttv_s_frequency,
	.vidioc_log_status		= bttv_log_status,
	.vidioc_querystd		= bttv_querystd,
3225
	.vidioc_g_chip_ident		= bttv_g_chip_ident,
3226
#ifdef CONFIG_VIDEO_ADV_DEBUG
3227 3228
	.vidioc_g_register		= bttv_g_register,
	.vidioc_s_register		= bttv_s_register,
3229
#endif
3230 3231 3232 3233 3234 3235 3236
};

static struct video_device bttv_video_template = {
	.fops         = &bttv_fops,
	.ioctl_ops    = &bttv_ioctl_ops,
	.tvnorms      = BTTV_NORMS,
	.current_norm = V4L2_STD_PAL,
L
Linus Torvalds 已提交
3237 3238 3239 3240 3241
};

/* ----------------------------------------------------------------------- */
/* radio interface                                                         */

3242
static int radio_open(struct file *file)
L
Linus Torvalds 已提交
3243
{
3244
	struct video_device *vdev = video_devdata(file);
3245
	struct bttv *btv = video_drvdata(file);
3246
	struct bttv_fh *fh;
L
Linus Torvalds 已提交
3247

3248
	dprintk("open dev=%s\n", video_device_node_name(vdev));
L
Linus Torvalds 已提交
3249

3250
	dprintk("%d: open called (radio)\n", btv->c.nr);
3251 3252 3253

	/* allocate per filehandle data */
	fh = kmalloc(sizeof(*fh), GFP_KERNEL);
3254
	if (unlikely(!fh))
3255 3256 3257 3258
		return -ENOMEM;
	file->private_data = fh;
	*fh = btv->init;

3259
	v4l2_prio_open(&btv->prio, &fh->prio);
3260

L
Linus Torvalds 已提交
3261
	btv->radio_user++;
3262

3263
	bttv_call_all(btv, tuner, s_radio);
3264
	audio_input(btv,TVAUDIO_INPUT_RADIO);
L
Linus Torvalds 已提交
3265

3266
	return 0;
L
Linus Torvalds 已提交
3267 3268
}

3269
static int radio_release(struct file *file)
L
Linus Torvalds 已提交
3270
{
3271 3272
	struct bttv_fh *fh = file->private_data;
	struct bttv *btv = fh->btv;
3273
	struct saa6588_command cmd;
L
Linus Torvalds 已提交
3274

3275
	v4l2_prio_close(&btv->prio, fh->prio);
3276 3277 3278
	file->private_data = NULL;
	kfree(fh);

L
Linus Torvalds 已提交
3279
	btv->radio_user--;
3280

3281
	bttv_call_all(btv, core, ioctl, SAA6588_CMD_CLOSE, &cmd);
3282

L
Linus Torvalds 已提交
3283 3284 3285
	return 0;
}

3286 3287 3288 3289
static int radio_g_tuner(struct file *file, void *priv, struct v4l2_tuner *t)
{
	struct bttv_fh *fh = priv;
	struct bttv *btv = fh->btv;
3290

3291 3292 3293 3294
	if (0 != t->index)
		return -EINVAL;
	strcpy(t->name, "Radio");
	t->type = V4L2_TUNER_RADIO;
3295

3296
	bttv_call_all(btv, tuner, g_tuner, t);
3297 3298 3299 3300 3301 3302 3303 3304 3305 3306 3307 3308 3309 3310 3311 3312

	if (btv->audio_mode_gpio)
		btv->audio_mode_gpio(btv, t, 0);

	return 0;
}

static int radio_s_tuner(struct file *file, void *priv,
					struct v4l2_tuner *t)
{
	struct bttv_fh *fh = priv;
	struct bttv *btv = fh->btv;

	if (0 != t->index)
		return -EINVAL;

3313
	bttv_call_all(btv, tuner, s_tuner, t);
3314 3315 3316
	return 0;
}

3317 3318 3319
static ssize_t radio_read(struct file *file, char __user *data,
			 size_t count, loff_t *ppos)
{
3320 3321
	struct bttv_fh *fh = file->private_data;
	struct bttv *btv = fh->btv;
3322
	struct saa6588_command cmd;
3323 3324 3325 3326 3327
	cmd.block_count = count/3;
	cmd.buffer = data;
	cmd.instance = file;
	cmd.result = -ENODEV;

3328
	bttv_call_all(btv, core, ioctl, SAA6588_CMD_READ, &cmd);
3329 3330 3331 3332 3333 3334

	return cmd.result;
}

static unsigned int radio_poll(struct file *file, poll_table *wait)
{
3335 3336
	struct bttv_fh *fh = file->private_data;
	struct bttv *btv = fh->btv;
3337
	struct saa6588_command cmd;
3338 3339 3340
	cmd.instance = file;
	cmd.event_list = wait;
	cmd.result = -ENODEV;
3341
	bttv_call_all(btv, core, ioctl, SAA6588_CMD_POLL, &cmd);
3342 3343 3344 3345

	return cmd.result;
}

3346
static const struct v4l2_file_operations radio_fops =
L
Linus Torvalds 已提交
3347 3348 3349
{
	.owner	  = THIS_MODULE,
	.open	  = radio_open,
3350
	.read     = radio_read,
L
Linus Torvalds 已提交
3351
	.release  = radio_release,
3352
	.unlocked_ioctl = video_ioctl2,
3353
	.poll     = radio_poll,
L
Linus Torvalds 已提交
3354 3355
};

3356
static const struct v4l2_ioctl_ops radio_ioctl_ops = {
3357
	.vidioc_querycap        = bttv_querycap,
3358
	.vidioc_log_status	= bttv_log_status,
3359 3360
	.vidioc_g_tuner         = radio_g_tuner,
	.vidioc_s_tuner         = radio_s_tuner,
3361 3362
	.vidioc_g_frequency     = bttv_g_frequency,
	.vidioc_s_frequency     = bttv_s_frequency,
L
Linus Torvalds 已提交
3363 3364
};

3365 3366 3367 3368 3369
static struct video_device radio_template = {
	.fops      = &radio_fops,
	.ioctl_ops = &radio_ioctl_ops,
};

L
Linus Torvalds 已提交
3370 3371 3372
/* ----------------------------------------------------------------------- */
/* some debug code                                                         */

A
Adrian Bunk 已提交
3373
static int bttv_risc_decode(u32 risc)
L
Linus Torvalds 已提交
3374 3375 3376 3377 3378 3379 3380 3381 3382 3383 3384 3385 3386 3387 3388 3389 3390 3391 3392 3393 3394 3395 3396 3397 3398 3399 3400
{
	static char *instr[16] = {
		[ BT848_RISC_WRITE     >> 28 ] = "write",
		[ BT848_RISC_SKIP      >> 28 ] = "skip",
		[ BT848_RISC_WRITEC    >> 28 ] = "writec",
		[ BT848_RISC_JUMP      >> 28 ] = "jump",
		[ BT848_RISC_SYNC      >> 28 ] = "sync",
		[ BT848_RISC_WRITE123  >> 28 ] = "write123",
		[ BT848_RISC_SKIP123   >> 28 ] = "skip123",
		[ BT848_RISC_WRITE1S23 >> 28 ] = "write1s23",
	};
	static int incr[16] = {
		[ BT848_RISC_WRITE     >> 28 ] = 2,
		[ BT848_RISC_JUMP      >> 28 ] = 2,
		[ BT848_RISC_SYNC      >> 28 ] = 2,
		[ BT848_RISC_WRITE123  >> 28 ] = 5,
		[ BT848_RISC_SKIP123   >> 28 ] = 2,
		[ BT848_RISC_WRITE1S23 >> 28 ] = 3,
	};
	static char *bits[] = {
		"be0",  "be1",  "be2",  "be3/resync",
		"set0", "set1", "set2", "set3",
		"clr0", "clr1", "clr2", "clr3",
		"irq",  "res",  "eol",  "sol",
	};
	int i;

3401
	pr_cont("0x%08x [ %s", risc,
L
Linus Torvalds 已提交
3402 3403 3404
	       instr[risc >> 28] ? instr[risc >> 28] : "INVALID");
	for (i = ARRAY_SIZE(bits)-1; i >= 0; i--)
		if (risc & (1 << (i + 12)))
3405 3406
			pr_cont(" %s", bits[i]);
	pr_cont(" count=%d ]\n", risc & 0xfff);
L
Linus Torvalds 已提交
3407 3408 3409
	return incr[risc >> 28] ? incr[risc >> 28] : 1;
}

A
Adrian Bunk 已提交
3410 3411
static void bttv_risc_disasm(struct bttv *btv,
			     struct btcx_riscmem *risc)
L
Linus Torvalds 已提交
3412 3413 3414
{
	unsigned int i,j,n;

3415 3416
	pr_info("%s: risc disasm: %p [dma=0x%08lx]\n",
		btv->c.v4l2_dev.name, risc->cpu, (unsigned long)risc->dma);
L
Linus Torvalds 已提交
3417
	for (i = 0; i < (risc->size >> 2); i += n) {
3418 3419 3420
		pr_info("%s:   0x%lx: ",
			btv->c.v4l2_dev.name,
			(unsigned long)(risc->dma + (i<<2)));
3421
		n = bttv_risc_decode(le32_to_cpu(risc->cpu[i]));
L
Linus Torvalds 已提交
3422
		for (j = 1; j < n; j++)
3423 3424 3425 3426
			pr_info("%s:   0x%lx: 0x%08x [ arg #%d ]\n",
				btv->c.v4l2_dev.name,
				(unsigned long)(risc->dma + ((i+j)<<2)),
				risc->cpu[i+j], j);
L
Linus Torvalds 已提交
3427 3428 3429 3430 3431 3432 3433
		if (0 == risc->cpu[i])
			break;
	}
}

static void bttv_print_riscaddr(struct bttv *btv)
{
3434 3435 3436 3437 3438 3439 3440 3441 3442 3443 3444 3445
	pr_info("  main: %08llx\n", (unsigned long long)btv->main.dma);
	pr_info("  vbi : o=%08llx e=%08llx\n",
		btv->cvbi ? (unsigned long long)btv->cvbi->top.dma : 0,
		btv->cvbi ? (unsigned long long)btv->cvbi->bottom.dma : 0);
	pr_info("  cap : o=%08llx e=%08llx\n",
		btv->curr.top
		? (unsigned long long)btv->curr.top->top.dma : 0,
		btv->curr.bottom
		? (unsigned long long)btv->curr.bottom->bottom.dma : 0);
	pr_info("  scr : o=%08llx e=%08llx\n",
		btv->screen ? (unsigned long long)btv->screen->top.dma : 0,
		btv->screen ? (unsigned long long)btv->screen->bottom.dma : 0);
L
Linus Torvalds 已提交
3446 3447 3448 3449 3450 3451 3452 3453 3454 3455 3456 3457 3458 3459 3460 3461 3462 3463 3464 3465 3466 3467 3468 3469 3470 3471 3472 3473 3474 3475 3476 3477
	bttv_risc_disasm(btv, &btv->main);
}

/* ----------------------------------------------------------------------- */
/* irq handler                                                             */

static char *irq_name[] = {
	"FMTCHG",  // format change detected (525 vs. 625)
	"VSYNC",   // vertical sync (new field)
	"HSYNC",   // horizontal sync
	"OFLOW",   // chroma/luma AGC overflow
	"HLOCK",   // horizontal lock changed
	"VPRES",   // video presence changed
	"6", "7",
	"I2CDONE", // hw irc operation finished
	"GPINT",   // gpio port triggered irq
	"10",
	"RISCI",   // risc instruction triggered irq
	"FBUS",    // pixel data fifo dropped data (high pci bus latencies)
	"FTRGT",   // pixel data fifo overrun
	"FDSR",    // fifo data stream resyncronisation
	"PPERR",   // parity error (data transfer)
	"RIPERR",  // parity error (read risc instructions)
	"PABORT",  // pci abort
	"OCERR",   // risc instruction error
	"SCERR",   // syncronisation error
};

static void bttv_print_irqbits(u32 print, u32 mark)
{
	unsigned int i;

3478
	pr_cont("bits:");
L
Linus Torvalds 已提交
3479 3480
	for (i = 0; i < ARRAY_SIZE(irq_name); i++) {
		if (print & (1 << i))
3481
			pr_cont(" %s", irq_name[i]);
L
Linus Torvalds 已提交
3482
		if (mark & (1 << i))
3483
			pr_cont("*");
L
Linus Torvalds 已提交
3484 3485 3486 3487 3488
	}
}

static void bttv_irq_debug_low_latency(struct bttv *btv, u32 rc)
{
3489 3490 3491 3492 3493 3494
	pr_warn("%d: irq: skipped frame [main=%lx,o_vbi=%lx,o_field=%lx,rc=%lx]\n",
		btv->c.nr,
		(unsigned long)btv->main.dma,
		(unsigned long)le32_to_cpu(btv->main.cpu[RISC_SLOT_O_VBI+1]),
		(unsigned long)le32_to_cpu(btv->main.cpu[RISC_SLOT_O_FIELD+1]),
		(unsigned long)rc);
L
Linus Torvalds 已提交
3495 3496

	if (0 == (btread(BT848_DSTATUS) & BT848_DSTATUS_HLOC)) {
3497 3498 3499
		pr_notice("%d: Oh, there (temporarily?) is no input signal. "
			  "Ok, then this is harmless, don't worry ;)\n",
			  btv->c.nr);
L
Linus Torvalds 已提交
3500 3501
		return;
	}
3502 3503 3504 3505
	pr_notice("%d: Uhm. Looks like we have unusual high IRQ latencies\n",
		  btv->c.nr);
	pr_notice("%d: Lets try to catch the culpit red-handed ...\n",
		  btv->c.nr);
L
Linus Torvalds 已提交
3506 3507 3508 3509 3510 3511 3512 3513 3514 3515 3516 3517 3518 3519 3520 3521 3522 3523 3524 3525 3526 3527 3528
	dump_stack();
}

static int
bttv_irq_next_video(struct bttv *btv, struct bttv_buffer_set *set)
{
	struct bttv_buffer *item;

	memset(set,0,sizeof(*set));

	/* capture request ? */
	if (!list_empty(&btv->capture)) {
		set->frame_irq = 1;
		item = list_entry(btv->capture.next, struct bttv_buffer, vb.queue);
		if (V4L2_FIELD_HAS_TOP(item->vb.field))
			set->top    = item;
		if (V4L2_FIELD_HAS_BOTTOM(item->vb.field))
			set->bottom = item;

		/* capture request for other field ? */
		if (!V4L2_FIELD_HAS_BOTH(item->vb.field) &&
		    (item->vb.queue.next != &btv->capture)) {
			item = list_entry(item->vb.queue.next, struct bttv_buffer, vb.queue);
3529 3530 3531 3532 3533 3534 3535 3536 3537 3538 3539 3540 3541 3542 3543 3544 3545 3546 3547 3548 3549 3550 3551 3552 3553 3554 3555
			/* Mike Isely <isely@pobox.com> - Only check
			 * and set up the bottom field in the logic
			 * below.  Don't ever do the top field.  This
			 * of course means that if we set up the
			 * bottom field in the above code that we'll
			 * actually skip a field.  But that's OK.
			 * Having processed only a single buffer this
			 * time, then the next time around the first
			 * available buffer should be for a top field.
			 * That will then cause us here to set up a
			 * top then a bottom field in the normal way.
			 * The alternative to this understanding is
			 * that we set up the second available buffer
			 * as a top field, but that's out of order
			 * since this driver always processes the top
			 * field first - the effect will be the two
			 * buffers being returned in the wrong order,
			 * with the second buffer also being delayed
			 * by one field time (owing to the fifo nature
			 * of videobuf).  Worse still, we'll be stuck
			 * doing fields out of order now every time
			 * until something else causes a field to be
			 * dropped.  By effectively forcing a field to
			 * drop this way then we always get back into
			 * sync within a single frame time.  (Out of
			 * order fields can screw up deinterlacing
			 * algorithms.) */
L
Linus Torvalds 已提交
3556 3557 3558 3559 3560 3561 3562 3563 3564 3565 3566 3567 3568 3569 3570 3571 3572 3573 3574 3575 3576 3577 3578 3579 3580 3581 3582 3583 3584 3585
			if (!V4L2_FIELD_HAS_BOTH(item->vb.field)) {
				if (NULL == set->bottom &&
				    V4L2_FIELD_BOTTOM == item->vb.field) {
					set->bottom = item;
				}
				if (NULL != set->top  &&  NULL != set->bottom)
					set->top_irq = 2;
			}
		}
	}

	/* screen overlay ? */
	if (NULL != btv->screen) {
		if (V4L2_FIELD_HAS_BOTH(btv->screen->vb.field)) {
			if (NULL == set->top && NULL == set->bottom) {
				set->top    = btv->screen;
				set->bottom = btv->screen;
			}
		} else {
			if (V4L2_FIELD_TOP == btv->screen->vb.field &&
			    NULL == set->top) {
				set->top = btv->screen;
			}
			if (V4L2_FIELD_BOTTOM == btv->screen->vb.field &&
			    NULL == set->bottom) {
				set->bottom = btv->screen;
			}
		}
	}

3586 3587 3588
	dprintk("%d: next set: top=%p bottom=%p [screen=%p,irq=%d,%d]\n",
		btv->c.nr, set->top, set->bottom,
		btv->screen, set->frame_irq, set->top_irq);
L
Linus Torvalds 已提交
3589 3590 3591 3592 3593 3594 3595 3596 3597
	return 0;
}

static void
bttv_irq_wakeup_video(struct bttv *btv, struct bttv_buffer_set *wakeup,
		      struct bttv_buffer_set *curr, unsigned int state)
{
	struct timeval ts;

3598
	v4l2_get_timestamp(&ts);
L
Linus Torvalds 已提交
3599 3600 3601 3602

	if (wakeup->top == wakeup->bottom) {
		if (NULL != wakeup->top && curr->top != wakeup->top) {
			if (irq_debug > 1)
3603 3604
				pr_debug("%d: wakeup: both=%p\n",
					 btv->c.nr, wakeup->top);
L
Linus Torvalds 已提交
3605 3606 3607 3608 3609 3610 3611 3612
			wakeup->top->vb.ts = ts;
			wakeup->top->vb.field_count = btv->field_count;
			wakeup->top->vb.state = state;
			wake_up(&wakeup->top->vb.done);
		}
	} else {
		if (NULL != wakeup->top && curr->top != wakeup->top) {
			if (irq_debug > 1)
3613 3614
				pr_debug("%d: wakeup: top=%p\n",
					 btv->c.nr, wakeup->top);
L
Linus Torvalds 已提交
3615 3616 3617 3618 3619 3620 3621
			wakeup->top->vb.ts = ts;
			wakeup->top->vb.field_count = btv->field_count;
			wakeup->top->vb.state = state;
			wake_up(&wakeup->top->vb.done);
		}
		if (NULL != wakeup->bottom && curr->bottom != wakeup->bottom) {
			if (irq_debug > 1)
3622 3623
				pr_debug("%d: wakeup: bottom=%p\n",
					 btv->c.nr, wakeup->bottom);
L
Linus Torvalds 已提交
3624 3625 3626 3627 3628 3629 3630 3631 3632 3633 3634 3635 3636 3637 3638 3639 3640
			wakeup->bottom->vb.ts = ts;
			wakeup->bottom->vb.field_count = btv->field_count;
			wakeup->bottom->vb.state = state;
			wake_up(&wakeup->bottom->vb.done);
		}
	}
}

static void
bttv_irq_wakeup_vbi(struct bttv *btv, struct bttv_buffer *wakeup,
		    unsigned int state)
{
	struct timeval ts;

	if (NULL == wakeup)
		return;

3641
	v4l2_get_timestamp(&ts);
L
Linus Torvalds 已提交
3642 3643 3644 3645 3646 3647 3648 3649 3650 3651 3652 3653 3654 3655 3656
	wakeup->vb.ts = ts;
	wakeup->vb.field_count = btv->field_count;
	wakeup->vb.state = state;
	wake_up(&wakeup->vb.done);
}

static void bttv_irq_timeout(unsigned long data)
{
	struct bttv *btv = (struct bttv *)data;
	struct bttv_buffer_set old,new;
	struct bttv_buffer *ovbi;
	struct bttv_buffer *item;
	unsigned long flags;

	if (bttv_verbose) {
3657 3658 3659
		pr_info("%d: timeout: drop=%d irq=%d/%d, risc=%08x, ",
			btv->c.nr, btv->framedrop, btv->irq_me, btv->irq_total,
			btread(BT848_RISC_COUNT));
L
Linus Torvalds 已提交
3660
		bttv_print_irqbits(btread(BT848_INT_STAT),0);
3661
		pr_cont("\n");
L
Linus Torvalds 已提交
3662 3663 3664 3665 3666 3667 3668 3669 3670 3671 3672 3673 3674 3675 3676 3677
	}

	spin_lock_irqsave(&btv->s_lock,flags);

	/* deactivate stuff */
	memset(&new,0,sizeof(new));
	old  = btv->curr;
	ovbi = btv->cvbi;
	btv->curr = new;
	btv->cvbi = NULL;
	btv->loop_irq = 0;
	bttv_buffer_activate_video(btv, &new);
	bttv_buffer_activate_vbi(btv,   NULL);
	bttv_set_dma(btv, 0);

	/* wake up */
3678 3679
	bttv_irq_wakeup_video(btv, &old, &new, VIDEOBUF_ERROR);
	bttv_irq_wakeup_vbi(btv, ovbi, VIDEOBUF_ERROR);
L
Linus Torvalds 已提交
3680 3681 3682 3683 3684

	/* cancel all outstanding capture / vbi requests */
	while (!list_empty(&btv->capture)) {
		item = list_entry(btv->capture.next, struct bttv_buffer, vb.queue);
		list_del(&item->vb.queue);
3685
		item->vb.state = VIDEOBUF_ERROR;
L
Linus Torvalds 已提交
3686 3687 3688 3689 3690
		wake_up(&item->vb.done);
	}
	while (!list_empty(&btv->vcapture)) {
		item = list_entry(btv->vcapture.next, struct bttv_buffer, vb.queue);
		list_del(&item->vb.queue);
3691
		item->vb.state = VIDEOBUF_ERROR;
L
Linus Torvalds 已提交
3692 3693 3694 3695 3696 3697 3698 3699 3700 3701 3702 3703 3704 3705 3706 3707 3708 3709 3710 3711
		wake_up(&item->vb.done);
	}

	btv->errors++;
	spin_unlock_irqrestore(&btv->s_lock,flags);
}

static void
bttv_irq_wakeup_top(struct bttv *btv)
{
	struct bttv_buffer *wakeup = btv->curr.top;

	if (NULL == wakeup)
		return;

	spin_lock(&btv->s_lock);
	btv->curr.top_irq = 0;
	btv->curr.top = NULL;
	bttv_risc_hook(btv, RISC_SLOT_O_FIELD, NULL, 0);

3712
	v4l2_get_timestamp(&wakeup->vb.ts);
L
Linus Torvalds 已提交
3713
	wakeup->vb.field_count = btv->field_count;
3714
	wakeup->vb.state = VIDEOBUF_DONE;
L
Linus Torvalds 已提交
3715 3716 3717 3718 3719 3720 3721 3722 3723 3724 3725 3726 3727 3728 3729 3730 3731 3732 3733 3734 3735 3736 3737 3738 3739 3740 3741 3742 3743 3744 3745 3746 3747 3748 3749 3750 3751 3752 3753 3754 3755 3756 3757 3758 3759 3760 3761 3762
	wake_up(&wakeup->vb.done);
	spin_unlock(&btv->s_lock);
}

static inline int is_active(struct btcx_riscmem *risc, u32 rc)
{
	if (rc < risc->dma)
		return 0;
	if (rc > risc->dma + risc->size)
		return 0;
	return 1;
}

static void
bttv_irq_switch_video(struct bttv *btv)
{
	struct bttv_buffer_set new;
	struct bttv_buffer_set old;
	dma_addr_t rc;

	spin_lock(&btv->s_lock);

	/* new buffer set */
	bttv_irq_next_video(btv, &new);
	rc = btread(BT848_RISC_COUNT);
	if ((btv->curr.top    && is_active(&btv->curr.top->top,       rc)) ||
	    (btv->curr.bottom && is_active(&btv->curr.bottom->bottom, rc))) {
		btv->framedrop++;
		if (debug_latency)
			bttv_irq_debug_low_latency(btv, rc);
		spin_unlock(&btv->s_lock);
		return;
	}

	/* switch over */
	old = btv->curr;
	btv->curr = new;
	btv->loop_irq &= ~1;
	bttv_buffer_activate_video(btv, &new);
	bttv_set_dma(btv, 0);

	/* switch input */
	if (UNSET != btv->new_input) {
		video_mux(btv,btv->new_input);
		btv->new_input = UNSET;
	}

	/* wake up finished buffers */
3763
	bttv_irq_wakeup_video(btv, &old, &new, VIDEOBUF_DONE);
L
Linus Torvalds 已提交
3764 3765 3766 3767 3768 3769 3770 3771 3772 3773 3774 3775 3776 3777 3778 3779 3780 3781 3782 3783 3784 3785 3786 3787 3788 3789 3790 3791 3792 3793 3794 3795
	spin_unlock(&btv->s_lock);
}

static void
bttv_irq_switch_vbi(struct bttv *btv)
{
	struct bttv_buffer *new = NULL;
	struct bttv_buffer *old;
	u32 rc;

	spin_lock(&btv->s_lock);

	if (!list_empty(&btv->vcapture))
		new = list_entry(btv->vcapture.next, struct bttv_buffer, vb.queue);
	old = btv->cvbi;

	rc = btread(BT848_RISC_COUNT);
	if (NULL != old && (is_active(&old->top,    rc) ||
			    is_active(&old->bottom, rc))) {
		btv->framedrop++;
		if (debug_latency)
			bttv_irq_debug_low_latency(btv, rc);
		spin_unlock(&btv->s_lock);
		return;
	}

	/* switch */
	btv->cvbi = new;
	btv->loop_irq &= ~4;
	bttv_buffer_activate_vbi(btv, new);
	bttv_set_dma(btv, 0);

3796
	bttv_irq_wakeup_vbi(btv, old, VIDEOBUF_DONE);
L
Linus Torvalds 已提交
3797 3798 3799
	spin_unlock(&btv->s_lock);
}

3800
static irqreturn_t bttv_irq(int irq, void *dev_id)
L
Linus Torvalds 已提交
3801 3802 3803 3804 3805 3806 3807 3808
{
	u32 stat,astat;
	u32 dstat;
	int count;
	struct bttv *btv;
	int handled = 0;

	btv=(struct bttv *)dev_id;
3809

L
Linus Torvalds 已提交
3810 3811 3812 3813 3814 3815 3816 3817 3818 3819 3820 3821 3822 3823
	count=0;
	while (1) {
		/* get/clear interrupt status bits */
		stat=btread(BT848_INT_STAT);
		astat=stat&btread(BT848_INT_MASK);
		if (!astat)
			break;
		handled = 1;
		btwrite(stat,BT848_INT_STAT);

		/* get device status bits */
		dstat=btread(BT848_DSTATUS);

		if (irq_debug) {
3824 3825 3826
			pr_debug("%d: irq loop=%d fc=%d riscs=%x, riscc=%08x, ",
				 btv->c.nr, count, btv->field_count,
				 stat>>28, btread(BT848_RISC_COUNT));
L
Linus Torvalds 已提交
3827 3828
			bttv_print_irqbits(stat,astat);
			if (stat & BT848_INT_HLOCK)
3829 3830 3831
				pr_cont("   HLOC => %s",
					dstat & BT848_DSTATUS_HLOC
					? "yes" : "no");
L
Linus Torvalds 已提交
3832
			if (stat & BT848_INT_VPRES)
3833 3834 3835
				pr_cont("   PRES => %s",
					dstat & BT848_DSTATUS_PRES
					? "yes" : "no");
L
Linus Torvalds 已提交
3836
			if (stat & BT848_INT_FMTCHG)
3837 3838 3839 3840
				pr_cont("   NUML => %s",
					dstat & BT848_DSTATUS_NUML
					? "625" : "525");
			pr_cont("\n");
L
Linus Torvalds 已提交
3841 3842 3843
		}

		if (astat&BT848_INT_VSYNC)
3844
			btv->field_count++;
L
Linus Torvalds 已提交
3845

3846 3847
		if ((astat & BT848_INT_GPINT) && btv->remote) {
			bttv_input_irq(btv);
L
Linus Torvalds 已提交
3848 3849 3850 3851 3852 3853 3854
		}

		if (astat & BT848_INT_I2CDONE) {
			btv->i2c_done = stat;
			wake_up(&btv->i2c_queue);
		}

3855
		if ((astat & BT848_INT_RISCI)  &&  (stat & (4<<28)))
L
Linus Torvalds 已提交
3856 3857
			bttv_irq_switch_vbi(btv);

3858
		if ((astat & BT848_INT_RISCI)  &&  (stat & (2<<28)))
L
Linus Torvalds 已提交
3859 3860
			bttv_irq_wakeup_top(btv);

3861
		if ((astat & BT848_INT_RISCI)  &&  (stat & (1<<28)))
L
Linus Torvalds 已提交
3862 3863 3864
			bttv_irq_switch_video(btv);

		if ((astat & BT848_INT_HLOCK)  &&  btv->opt_automute)
3865
			audio_mute(btv, btv->mute);  /* trigger automute */
L
Linus Torvalds 已提交
3866 3867

		if (astat & (BT848_INT_SCERR|BT848_INT_OCERR)) {
3868 3869 3870 3871 3872
			pr_info("%d: %s%s @ %08x,",
				btv->c.nr,
				(astat & BT848_INT_SCERR) ? "SCERR" : "",
				(astat & BT848_INT_OCERR) ? "OCERR" : "",
				btread(BT848_RISC_COUNT));
L
Linus Torvalds 已提交
3873
			bttv_print_irqbits(stat,astat);
3874
			pr_cont("\n");
L
Linus Torvalds 已提交
3875 3876 3877 3878
			if (bttv_debug)
				bttv_print_riscaddr(btv);
		}
		if (fdsr && astat & BT848_INT_FDSR) {
3879 3880
			pr_info("%d: FDSR @ %08x\n",
				btv->c.nr, btread(BT848_RISC_COUNT));
L
Linus Torvalds 已提交
3881 3882 3883 3884 3885 3886
			if (bttv_debug)
				bttv_print_riscaddr(btv);
		}

		count++;
		if (count > 4) {
3887 3888

			if (count > 8 || !(astat & BT848_INT_GPINT)) {
3889
				btwrite(0, BT848_INT_MASK);
3890

3891 3892
				pr_err("%d: IRQ lockup, cleared int mask [",
				       btv->c.nr);
3893
			} else {
3894 3895
				pr_err("%d: IRQ lockup, clearing GPINT from int mask [",
				       btv->c.nr);
3896 3897 3898 3899 3900

				btwrite(btread(BT848_INT_MASK) & (-1 ^ BT848_INT_GPINT),
						BT848_INT_MASK);
			};

L
Linus Torvalds 已提交
3901
			bttv_print_irqbits(stat,astat);
3902

3903
			pr_cont("]\n");
L
Linus Torvalds 已提交
3904 3905 3906 3907 3908 3909 3910 3911 3912 3913
		}
	}
	btv->irq_total++;
	if (handled)
		btv->irq_me++;
	return IRQ_RETVAL(handled);
}


/* ----------------------------------------------------------------------- */
3914
/* initialization                                                          */
L
Linus Torvalds 已提交
3915 3916

static struct video_device *vdev_init(struct bttv *btv,
3917
				      const struct video_device *template,
3918
				      const char *type_name)
L
Linus Torvalds 已提交
3919 3920 3921 3922 3923 3924 3925
{
	struct video_device *vfd;

	vfd = video_device_alloc();
	if (NULL == vfd)
		return NULL;
	*vfd = *template;
3926
	vfd->v4l2_dev = &btv->c.v4l2_dev;
L
Linus Torvalds 已提交
3927
	vfd->release = video_device_release;
3928
	vfd->debug   = bttv_debug;
3929
	video_set_drvdata(vfd, btv);
L
Linus Torvalds 已提交
3930 3931
	snprintf(vfd->name, sizeof(vfd->name), "BT%d%s %s (%s)",
		 btv->id, (btv->id==848 && btv->revision==0x12) ? "A" : "",
3932
		 type_name, bttv_tvcards[btv->c.type].name);
3933 3934 3935 3936 3937 3938
	if (btv->tuner_type == TUNER_ABSENT) {
		v4l2_disable_ioctl(vfd, VIDIOC_G_FREQUENCY);
		v4l2_disable_ioctl(vfd, VIDIOC_S_FREQUENCY);
		v4l2_disable_ioctl(vfd, VIDIOC_G_TUNER);
		v4l2_disable_ioctl(vfd, VIDIOC_S_TUNER);
	}
L
Linus Torvalds 已提交
3939 3940 3941 3942 3943 3944
	return vfd;
}

static void bttv_unregister_video(struct bttv *btv)
{
	if (btv->video_dev) {
3945
		if (video_is_registered(btv->video_dev))
L
Linus Torvalds 已提交
3946 3947 3948 3949 3950 3951
			video_unregister_device(btv->video_dev);
		else
			video_device_release(btv->video_dev);
		btv->video_dev = NULL;
	}
	if (btv->vbi_dev) {
3952
		if (video_is_registered(btv->vbi_dev))
L
Linus Torvalds 已提交
3953 3954 3955 3956 3957 3958
			video_unregister_device(btv->vbi_dev);
		else
			video_device_release(btv->vbi_dev);
		btv->vbi_dev = NULL;
	}
	if (btv->radio_dev) {
3959
		if (video_is_registered(btv->radio_dev))
L
Linus Torvalds 已提交
3960 3961 3962 3963 3964 3965 3966 3967
			video_unregister_device(btv->radio_dev);
		else
			video_device_release(btv->radio_dev);
		btv->radio_dev = NULL;
	}
}

/* register video4linux devices */
3968
static int bttv_register_video(struct bttv *btv)
L
Linus Torvalds 已提交
3969
{
3970
	if (no_overlay > 0)
3971
		pr_notice("Overlay support disabled\n");
3972

L
Linus Torvalds 已提交
3973
	/* video */
3974
	btv->video_dev = vdev_init(btv, &bttv_video_template, "video");
3975

3976
	if (NULL == btv->video_dev)
L
Linus Torvalds 已提交
3977
		goto err;
3978 3979
	if (video_register_device(btv->video_dev, VFL_TYPE_GRABBER,
				  video_nr[btv->c.nr]) < 0)
L
Linus Torvalds 已提交
3980
		goto err;
3981 3982
	pr_info("%d: registered device %s\n",
		btv->c.nr, video_device_node_name(btv->video_dev));
3983
	if (device_create_file(&btv->video_dev->dev,
3984
				     &dev_attr_card)<0) {
3985
		pr_err("%d: device_create_file 'card' failed\n", btv->c.nr);
3986 3987
		goto err;
	}
L
Linus Torvalds 已提交
3988 3989

	/* vbi */
3990
	btv->vbi_dev = vdev_init(btv, &bttv_video_template, "vbi");
3991

3992
	if (NULL == btv->vbi_dev)
L
Linus Torvalds 已提交
3993
		goto err;
3994 3995
	if (video_register_device(btv->vbi_dev, VFL_TYPE_VBI,
				  vbi_nr[btv->c.nr]) < 0)
L
Linus Torvalds 已提交
3996
		goto err;
3997 3998
	pr_info("%d: registered device %s\n",
		btv->c.nr, video_device_node_name(btv->vbi_dev));
L
Linus Torvalds 已提交
3999

4000
	if (!btv->has_radio)
L
Linus Torvalds 已提交
4001 4002
		return 0;
	/* radio */
4003
	btv->radio_dev = vdev_init(btv, &radio_template, "radio");
4004
	if (NULL == btv->radio_dev)
L
Linus Torvalds 已提交
4005
		goto err;
4006
	btv->radio_dev->ctrl_handler = &btv->radio_ctrl_handler;
4007 4008
	if (video_register_device(btv->radio_dev, VFL_TYPE_RADIO,
				  radio_nr[btv->c.nr]) < 0)
L
Linus Torvalds 已提交
4009
		goto err;
4010 4011
	pr_info("%d: registered device %s\n",
		btv->c.nr, video_device_node_name(btv->radio_dev));
L
Linus Torvalds 已提交
4012 4013 4014 4015 4016 4017 4018 4019 4020 4021 4022 4023 4024 4025 4026

	/* all done */
	return 0;

 err:
	bttv_unregister_video(btv);
	return -1;
}


/* on OpenFirmware machines (PowerMac at least), PCI memory cycle */
/* response on cards with no firmware is not enabled by OF */
static void pci_set_command(struct pci_dev *dev)
{
#if defined(__powerpc__)
4027
	unsigned int cmd;
L
Linus Torvalds 已提交
4028

4029 4030 4031
	pci_read_config_dword(dev, PCI_COMMAND, &cmd);
	cmd = (cmd | PCI_COMMAND_MEMORY );
	pci_write_config_dword(dev, PCI_COMMAND, cmd);
L
Linus Torvalds 已提交
4032 4033 4034
#endif
}

4035
static int bttv_probe(struct pci_dev *dev, const struct pci_device_id *pci_id)
L
Linus Torvalds 已提交
4036
{
4037 4038 4039 4040 4041
	struct v4l2_frequency init_freq = {
		.tuner = 0,
		.type = V4L2_TUNER_ANALOG_TV,
		.frequency = 980,
	};
L
Linus Torvalds 已提交
4042 4043 4044
	int result;
	unsigned char lat;
	struct bttv *btv;
4045
	struct v4l2_ctrl_handler *hdl;
L
Linus Torvalds 已提交
4046 4047 4048

	if (bttv_num == BTTV_MAX)
		return -ENOMEM;
4049
	pr_info("Bt8xx card found (%d)\n", bttv_num);
4050
	bttvs[bttv_num] = btv = kzalloc(sizeof(*btv), GFP_KERNEL);
4051
	if (btv == NULL) {
4052
		pr_err("out of memory\n");
4053 4054
		return -ENOMEM;
	}
L
Linus Torvalds 已提交
4055
	btv->c.nr  = bttv_num;
4056 4057
	snprintf(btv->c.v4l2_dev.name, sizeof(btv->c.v4l2_dev.name),
			"bttv%d", btv->c.nr);
L
Linus Torvalds 已提交
4058 4059

	/* initialize structs / fill in defaults */
4060
	mutex_init(&btv->lock);
4061 4062 4063 4064 4065 4066
	spin_lock_init(&btv->s_lock);
	spin_lock_init(&btv->gpio_lock);
	init_waitqueue_head(&btv->i2c_queue);
	INIT_LIST_HEAD(&btv->c.subs);
	INIT_LIST_HEAD(&btv->capture);
	INIT_LIST_HEAD(&btv->vcapture);
L
Linus Torvalds 已提交
4067 4068 4069 4070 4071 4072
	v4l2_prio_init(&btv->prio);

	init_timer(&btv->timeout);
	btv->timeout.function = bttv_irq_timeout;
	btv->timeout.data     = (unsigned long)btv;

4073 4074
	btv->i2c_rc = -1;
	btv->tuner_type  = UNSET;
L
Linus Torvalds 已提交
4075 4076 4077 4078 4079
	btv->new_input   = UNSET;
	btv->has_radio=radio[btv->c.nr];

	/* pci stuff (init, get irq/mmio, ... */
	btv->c.pci = dev;
4080
	btv->id  = dev->device;
L
Linus Torvalds 已提交
4081
	if (pci_enable_device(dev)) {
4082
		pr_warn("%d: Can't enable device\n", btv->c.nr);
L
Linus Torvalds 已提交
4083 4084
		return -EIO;
	}
4085
	if (pci_set_dma_mask(dev, DMA_BIT_MASK(32))) {
4086
		pr_warn("%d: No suitable DMA available\n", btv->c.nr);
L
Linus Torvalds 已提交
4087
		return -EIO;
4088
	}
L
Linus Torvalds 已提交
4089 4090
	if (!request_mem_region(pci_resource_start(dev,0),
				pci_resource_len(dev,0),
4091
				btv->c.v4l2_dev.name)) {
4092 4093 4094
		pr_warn("%d: can't request iomem (0x%llx)\n",
			btv->c.nr,
			(unsigned long long)pci_resource_start(dev, 0));
L
Linus Torvalds 已提交
4095 4096
		return -EBUSY;
	}
4097
	pci_set_master(dev);
L
Linus Torvalds 已提交
4098
	pci_set_command(dev);
4099 4100 4101

	result = v4l2_device_register(&dev->dev, &btv->c.v4l2_dev);
	if (result < 0) {
4102
		pr_warn("%d: v4l2_device_register() failed\n", btv->c.nr);
4103 4104
		goto fail0;
	}
4105 4106 4107 4108
	hdl = &btv->ctrl_handler;
	v4l2_ctrl_handler_init(hdl, 20);
	btv->c.v4l2_dev.ctrl_handler = hdl;
	v4l2_ctrl_handler_init(&btv->radio_ctrl_handler, 6);
L
Linus Torvalds 已提交
4109

B
Bjørn Mork 已提交
4110
	btv->revision = dev->revision;
4111
	pci_read_config_byte(dev, PCI_LATENCY_TIMER, &lat);
4112 4113 4114 4115
	pr_info("%d: Bt%d (rev %d) at %s, irq: %d, latency: %d, mmio: 0x%llx\n",
		bttv_num, btv->id, btv->revision, pci_name(dev),
		btv->c.pci->irq, lat,
		(unsigned long long)pci_resource_start(dev, 0));
L
Linus Torvalds 已提交
4116 4117
	schedule();

4118 4119
	btv->bt848_mmio = ioremap(pci_resource_start(dev, 0), 0x1000);
	if (NULL == btv->bt848_mmio) {
4120
		pr_err("%d: ioremap() failed\n", btv->c.nr);
L
Linus Torvalds 已提交
4121 4122 4123 4124
		result = -EIO;
		goto fail1;
	}

4125
	/* identify card */
L
Linus Torvalds 已提交
4126 4127
	bttv_idcard(btv);

4128
	/* disable irqs, register irq handler */
L
Linus Torvalds 已提交
4129
	btwrite(0, BT848_INT_MASK);
4130
	result = request_irq(btv->c.pci->irq, bttv_irq,
4131
	    IRQF_SHARED | IRQF_DISABLED, btv->c.v4l2_dev.name, (void *)btv);
4132
	if (result < 0) {
4133 4134
		pr_err("%d: can't get IRQ %d\n",
		       bttv_num, btv->c.pci->irq);
L
Linus Torvalds 已提交
4135
		goto fail1;
4136
	}
L
Linus Torvalds 已提交
4137 4138 4139 4140

	if (0 != bttv_handle_chipset(btv)) {
		result = -EIO;
		goto fail2;
4141
	}
L
Linus Torvalds 已提交
4142 4143 4144

	/* init options from insmod args */
	btv->opt_combfilter = combfilter;
4145 4146
	bttv_ctrl_combfilter.def = combfilter;
	bttv_ctrl_lumafilter.def = lumafilter;
L
Linus Torvalds 已提交
4147
	btv->opt_automute   = automute;
4148 4149
	bttv_ctrl_automute.def = automute;
	bttv_ctrl_agc_crush.def = agc_crush;
L
Linus Torvalds 已提交
4150
	btv->opt_vcr_hack   = vcr_hack;
4151 4152 4153
	bttv_ctrl_vcr_hack.def = vcr_hack;
	bttv_ctrl_whitecrush_upper.def = whitecrush_upper;
	bttv_ctrl_whitecrush_lower.def = whitecrush_lower;
4154
	btv->opt_uv_ratio   = uv_ratio;
4155 4156 4157
	bttv_ctrl_uv_ratio.def = uv_ratio;
	bttv_ctrl_full_luma.def = full_luma_range;
	bttv_ctrl_coring.def = coring;
L
Linus Torvalds 已提交
4158 4159 4160 4161 4162

	/* fill struct bttv with some useful defaults */
	btv->init.btv         = btv;
	btv->init.ov.w.width  = 320;
	btv->init.ov.w.height = 240;
4163
	btv->init.fmt         = format_by_fourcc(V4L2_PIX_FMT_BGR24);
L
Linus Torvalds 已提交
4164 4165 4166 4167
	btv->init.width       = 320;
	btv->init.height      = 240;
	btv->input = 0;

4168 4169 4170 4171 4172 4173 4174 4175 4176 4177 4178 4179 4180 4181 4182 4183 4184 4185 4186 4187 4188 4189 4190 4191 4192 4193 4194 4195
	v4l2_ctrl_new_std(hdl, &bttv_ctrl_ops,
			V4L2_CID_BRIGHTNESS, 0, 0xff00, 0x100, 32768);
	v4l2_ctrl_new_std(hdl, &bttv_ctrl_ops,
			V4L2_CID_CONTRAST, 0, 0xff80, 0x80, 0x6c00);
	v4l2_ctrl_new_std(hdl, &bttv_ctrl_ops,
			V4L2_CID_SATURATION, 0, 0xff80, 0x80, 32768);
	v4l2_ctrl_new_std(hdl, &bttv_ctrl_ops,
			V4L2_CID_COLOR_KILLER, 0, 1, 1, 0);
	v4l2_ctrl_new_std(hdl, &bttv_ctrl_ops,
			V4L2_CID_HUE, 0, 0xff00, 0x100, 32768);
	v4l2_ctrl_new_std(hdl, &bttv_ctrl_ops,
			V4L2_CID_CHROMA_AGC, 0, 1, 1, !!chroma_agc);
	v4l2_ctrl_new_std(hdl, &bttv_ctrl_ops,
		V4L2_CID_AUDIO_MUTE, 0, 1, 1, 0);
	if (btv->volume_gpio)
		v4l2_ctrl_new_std(hdl, &bttv_ctrl_ops,
			V4L2_CID_AUDIO_VOLUME, 0, 0xff00, 0x100, 0xff00);
	v4l2_ctrl_new_custom(hdl, &bttv_ctrl_combfilter, NULL);
	v4l2_ctrl_new_custom(hdl, &bttv_ctrl_automute, NULL);
	v4l2_ctrl_new_custom(hdl, &bttv_ctrl_lumafilter, NULL);
	v4l2_ctrl_new_custom(hdl, &bttv_ctrl_agc_crush, NULL);
	v4l2_ctrl_new_custom(hdl, &bttv_ctrl_vcr_hack, NULL);
	v4l2_ctrl_new_custom(hdl, &bttv_ctrl_whitecrush_lower, NULL);
	v4l2_ctrl_new_custom(hdl, &bttv_ctrl_whitecrush_upper, NULL);
	v4l2_ctrl_new_custom(hdl, &bttv_ctrl_uv_ratio, NULL);
	v4l2_ctrl_new_custom(hdl, &bttv_ctrl_full_luma, NULL);
	v4l2_ctrl_new_custom(hdl, &bttv_ctrl_coring, NULL);

L
Linus Torvalds 已提交
4196
	/* initialize hardware */
4197 4198
	if (bttv_gpio)
		bttv_gpio_tracking(btv,"pre-init");
L
Linus Torvalds 已提交
4199 4200 4201 4202 4203

	bttv_risc_init_main(btv);
	init_bt848(btv);

	/* gpio */
4204 4205 4206 4207
	btwrite(0x00, BT848_GPIO_REG_INP);
	btwrite(0x00, BT848_GPIO_OUT_EN);
	if (bttv_verbose)
		bttv_gpio_tracking(btv,"init");
L
Linus Torvalds 已提交
4208

4209 4210
	/* needs to be done before i2c is registered */
	bttv_init_card1(btv);
L
Linus Torvalds 已提交
4211

4212 4213
	/* register i2c + gpio */
	init_bttv_i2c(btv);
L
Linus Torvalds 已提交
4214

4215 4216
	/* some card-specific stuff (needs working i2c) */
	bttv_init_card2(btv);
4217
	bttv_init_tuner(btv);
4218 4219 4220 4221
	if (btv->tuner_type != TUNER_ABSENT) {
		bttv_set_frequency(btv, &init_freq);
		btv->radio_freq = 90500 * 16; /* 90.5Mhz default */
	}
L
Linus Torvalds 已提交
4222
	init_irqreg(btv);
4223
	v4l2_ctrl_handler_setup(hdl);
L
Linus Torvalds 已提交
4224

4225 4226 4227 4228
	if (hdl->error) {
		result = hdl->error;
		goto fail2;
	}
4229
	/* register video4linux + input */
L
Linus Torvalds 已提交
4230
	if (!bttv_tvcards[btv->c.type].no_video) {
4231 4232 4233 4234 4235 4236
		v4l2_ctrl_add_handler(&btv->radio_ctrl_handler, hdl,
				v4l2_ctrl_radio_filter);
		if (btv->radio_ctrl_handler.error) {
			result = btv->radio_ctrl_handler.error;
			goto fail2;
		}
4237
		set_input(btv, 0, btv->tvnorm);
4238 4239 4240 4241
		bttv_crop_reset(&btv->crop[0], btv->tvnorm);
		btv->crop[1] = btv->crop[0]; /* current = default */
		disclaim_vbi_lines(btv);
		disclaim_video_lines(btv);
4242
		bttv_register_video(btv);
L
Linus Torvalds 已提交
4243 4244
	}

4245 4246
	/* add subdevices and autoload dvb-bt8xx if needed */
	if (bttv_tvcards[btv->c.type].has_dvb) {
L
Linus Torvalds 已提交
4247
		bttv_sub_add_device(&btv->c, "dvb");
4248 4249
		request_modules(btv);
	}
L
Linus Torvalds 已提交
4250

4251 4252 4253 4254
	if (!disable_ir) {
		init_bttv_i2c_ir(btv);
		bttv_input_init(btv);
	}
4255

L
Linus Torvalds 已提交
4256 4257
	/* everything is fine */
	bttv_num++;
4258
	return 0;
L
Linus Torvalds 已提交
4259

4260
fail2:
4261
	free_irq(btv->c.pci->irq,btv);
L
Linus Torvalds 已提交
4262

4263
fail1:
4264 4265
	v4l2_ctrl_handler_free(&btv->ctrl_handler);
	v4l2_ctrl_handler_free(&btv->radio_ctrl_handler);
4266 4267 4268
	v4l2_device_unregister(&btv->c.v4l2_dev);

fail0:
L
Linus Torvalds 已提交
4269 4270 4271 4272 4273 4274 4275
	if (btv->bt848_mmio)
		iounmap(btv->bt848_mmio);
	release_mem_region(pci_resource_start(btv->c.pci,0),
			   pci_resource_len(btv->c.pci,0));
	return result;
}

4276
static void bttv_remove(struct pci_dev *pci_dev)
L
Linus Torvalds 已提交
4277
{
4278 4279
	struct v4l2_device *v4l2_dev = pci_get_drvdata(pci_dev);
	struct bttv *btv = to_bttv(v4l2_dev);
L
Linus Torvalds 已提交
4280 4281

	if (bttv_verbose)
4282
		pr_info("%d: unloading\n", btv->c.nr);
L
Linus Torvalds 已提交
4283

4284 4285 4286
	if (bttv_tvcards[btv->c.type].has_dvb)
		flush_request_modules(btv);

4287
	/* shutdown everything (DMA+IRQs) */
L
Linus Torvalds 已提交
4288 4289 4290 4291 4292 4293 4294 4295 4296
	btand(~15, BT848_GPIO_DMA_CTL);
	btwrite(0, BT848_INT_MASK);
	btwrite(~0x0, BT848_INT_STAT);
	btwrite(0x0, BT848_GPIO_OUT_EN);
	if (bttv_gpio)
		bttv_gpio_tracking(btv,"cleanup");

	/* tell gpio modules we are leaving ... */
	btv->shutdown=1;
4297
	bttv_input_fini(btv);
4298
	bttv_sub_del_devices(&btv->c);
L
Linus Torvalds 已提交
4299

4300
	/* unregister i2c_bus + input */
L
Linus Torvalds 已提交
4301 4302 4303 4304 4305 4306
	fini_bttv_i2c(btv);

	/* unregister video4linux */
	bttv_unregister_video(btv);

	/* free allocated memory */
4307 4308
	v4l2_ctrl_handler_free(&btv->ctrl_handler);
	v4l2_ctrl_handler_free(&btv->radio_ctrl_handler);
L
Linus Torvalds 已提交
4309 4310
	btcx_riscmem_free(btv->c.pci,&btv->main);

4311
	/* free resources */
4312
	free_irq(btv->c.pci->irq,btv);
L
Linus Torvalds 已提交
4313
	iounmap(btv->bt848_mmio);
4314 4315
	release_mem_region(pci_resource_start(btv->c.pci,0),
			   pci_resource_len(btv->c.pci,0));
L
Linus Torvalds 已提交
4316

4317
	v4l2_device_unregister(&btv->c.v4l2_dev);
4318 4319 4320
	bttvs[btv->c.nr] = NULL;
	kfree(btv);

4321
	return;
L
Linus Torvalds 已提交
4322 4323
}

4324
#ifdef CONFIG_PM
L
Linus Torvalds 已提交
4325 4326
static int bttv_suspend(struct pci_dev *pci_dev, pm_message_t state)
{
4327 4328
	struct v4l2_device *v4l2_dev = pci_get_drvdata(pci_dev);
	struct bttv *btv = to_bttv(v4l2_dev);
L
Linus Torvalds 已提交
4329 4330 4331
	struct bttv_buffer_set idle;
	unsigned long flags;

4332
	dprintk("%d: suspend %d\n", btv->c.nr, state.event);
L
Linus Torvalds 已提交
4333 4334 4335 4336 4337 4338 4339 4340 4341 4342 4343 4344 4345 4346 4347 4348 4349 4350 4351 4352 4353 4354 4355 4356 4357 4358 4359 4360 4361 4362

	/* stop dma + irqs */
	spin_lock_irqsave(&btv->s_lock,flags);
	memset(&idle, 0, sizeof(idle));
	btv->state.video = btv->curr;
	btv->state.vbi   = btv->cvbi;
	btv->state.loop_irq = btv->loop_irq;
	btv->curr = idle;
	btv->loop_irq = 0;
	bttv_buffer_activate_video(btv, &idle);
	bttv_buffer_activate_vbi(btv, NULL);
	bttv_set_dma(btv, 0);
	btwrite(0, BT848_INT_MASK);
	spin_unlock_irqrestore(&btv->s_lock,flags);

	/* save bt878 state */
	btv->state.gpio_enable = btread(BT848_GPIO_OUT_EN);
	btv->state.gpio_data   = gpio_read();

	/* save pci state */
	pci_save_state(pci_dev);
	if (0 != pci_set_power_state(pci_dev, pci_choose_state(pci_dev, state))) {
		pci_disable_device(pci_dev);
		btv->state.disabled = 1;
	}
	return 0;
}

static int bttv_resume(struct pci_dev *pci_dev)
{
4363 4364
	struct v4l2_device *v4l2_dev = pci_get_drvdata(pci_dev);
	struct bttv *btv = to_bttv(v4l2_dev);
L
Linus Torvalds 已提交
4365
	unsigned long flags;
4366
	int err;
L
Linus Torvalds 已提交
4367

4368
	dprintk("%d: resume\n", btv->c.nr);
L
Linus Torvalds 已提交
4369 4370 4371

	/* restore pci state */
	if (btv->state.disabled) {
4372 4373
		err=pci_enable_device(pci_dev);
		if (err) {
4374
			pr_warn("%d: Can't enable device\n", btv->c.nr);
4375 4376
			return err;
		}
L
Linus Torvalds 已提交
4377 4378
		btv->state.disabled = 0;
	}
4379 4380 4381
	err=pci_set_power_state(pci_dev, PCI_D0);
	if (err) {
		pci_disable_device(pci_dev);
4382
		pr_warn("%d: Can't enable device\n", btv->c.nr);
4383 4384 4385 4386
		btv->state.disabled = 1;
		return err;
	}

L
Linus Torvalds 已提交
4387 4388 4389 4390 4391 4392 4393 4394 4395 4396 4397 4398 4399 4400 4401 4402 4403 4404
	pci_restore_state(pci_dev);

	/* restore bt878 state */
	bttv_reinit_bt848(btv);
	gpio_inout(0xffffff, btv->state.gpio_enable);
	gpio_write(btv->state.gpio_data);

	/* restart dma */
	spin_lock_irqsave(&btv->s_lock,flags);
	btv->curr = btv->state.video;
	btv->cvbi = btv->state.vbi;
	btv->loop_irq = btv->state.loop_irq;
	bttv_buffer_activate_video(btv, &btv->curr);
	bttv_buffer_activate_vbi(btv, btv->cvbi);
	bttv_set_dma(btv, 0);
	spin_unlock_irqrestore(&btv->s_lock,flags);
	return 0;
}
4405
#endif
L
Linus Torvalds 已提交
4406 4407

static struct pci_device_id bttv_pci_tbl[] = {
4408 4409 4410 4411
	{PCI_VDEVICE(BROOKTREE, PCI_DEVICE_ID_BT848), 0},
	{PCI_VDEVICE(BROOKTREE, PCI_DEVICE_ID_BT849), 0},
	{PCI_VDEVICE(BROOKTREE, PCI_DEVICE_ID_BT878), 0},
	{PCI_VDEVICE(BROOKTREE, PCI_DEVICE_ID_BT879), 0},
4412
	{PCI_VDEVICE(BROOKTREE, PCI_DEVICE_ID_FUSION879), 0},
4413
	{0,}
L
Linus Torvalds 已提交
4414 4415 4416 4417 4418
};

MODULE_DEVICE_TABLE(pci, bttv_pci_tbl);

static struct pci_driver bttv_pci_driver = {
4419 4420 4421
	.name     = "bttv",
	.id_table = bttv_pci_tbl,
	.probe    = bttv_probe,
4422
	.remove   = bttv_remove,
4423
#ifdef CONFIG_PM
L
Linus Torvalds 已提交
4424 4425
	.suspend  = bttv_suspend,
	.resume   = bttv_resume,
4426
#endif
L
Linus Torvalds 已提交
4427 4428
};

A
Adrian Bunk 已提交
4429
static int __init bttv_init_module(void)
L
Linus Torvalds 已提交
4430
{
4431 4432
	int ret;

L
Linus Torvalds 已提交
4433 4434
	bttv_num = 0;

4435
	pr_info("driver version %s loaded\n", BTTV_VERSION);
L
Linus Torvalds 已提交
4436 4437
	if (gbuffers < 2 || gbuffers > VIDEO_MAX_FRAME)
		gbuffers = 2;
4438
	if (gbufsize > BTTV_MAX_FBUF)
L
Linus Torvalds 已提交
4439 4440 4441
		gbufsize = BTTV_MAX_FBUF;
	gbufsize = (gbufsize + PAGE_SIZE - 1) & PAGE_MASK;
	if (bttv_verbose)
4442 4443
		pr_info("using %d buffers with %dk (%d pages) each for capture\n",
			gbuffers, gbufsize >> 10, gbufsize >> PAGE_SHIFT);
L
Linus Torvalds 已提交
4444 4445 4446

	bttv_check_chipset();

4447 4448
	ret = bus_register(&bttv_sub_bus_type);
	if (ret < 0) {
4449
		pr_warn("bus_register error: %d\n", ret);
4450 4451
		return ret;
	}
4452 4453 4454 4455 4456
	ret = pci_register_driver(&bttv_pci_driver);
	if (ret < 0)
		bus_unregister(&bttv_sub_bus_type);

	return ret;
L
Linus Torvalds 已提交
4457 4458
}

A
Adrian Bunk 已提交
4459
static void __exit bttv_cleanup_module(void)
L
Linus Torvalds 已提交
4460 4461 4462 4463 4464 4465 4466 4467 4468 4469 4470 4471 4472
{
	pci_unregister_driver(&bttv_pci_driver);
	bus_unregister(&bttv_sub_bus_type);
}

module_init(bttv_init_module);
module_exit(bttv_cleanup_module);

/*
 * Local variables:
 * c-basic-offset: 8
 * End:
 */