Linux 2.6.17.7
[linux/fpc-iii.git] / drivers / media / video / saa7111.c
blob686fd4746205385c23c8b6b53731e37df5de7287
1 /*
2 * saa7111 - Philips SAA7111A video decoder driver version 0.0.3
4 * Copyright (C) 1998 Dave Perks <dperks@ibm.net>
6 * Slight changes for video timing and attachment output by
7 * Wolfgang Scherr <scherr@net4you.net>
9 * Changes by Ronald Bultje <rbultje@ronald.bitfreak.net>
10 * - moved over to linux>=2.4.x i2c protocol (1/1/2003)
12 * Changes by Michael Hunold <michael@mihu.de>
13 * - implemented DECODER_SET_GPIO, DECODER_INIT, DECODER_SET_VBI_BYPASS
15 * This program is free software; you can redistribute it and/or modify
16 * it under the terms of the GNU General Public License as published by
17 * the Free Software Foundation; either version 2 of the License, or
18 * (at your option) any later version.
20 * This program is distributed in the hope that it will be useful,
21 * but WITHOUT ANY WARRANTY; without even the implied warranty of
22 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
23 * GNU General Public License for more details.
25 * You should have received a copy of the GNU General Public License
26 * along with this program; if not, write to the Free Software
27 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
30 #include <linux/module.h>
31 #include <linux/init.h>
32 #include <linux/delay.h>
33 #include <linux/errno.h>
34 #include <linux/fs.h>
35 #include <linux/kernel.h>
36 #include <linux/major.h>
37 #include <linux/slab.h>
38 #include <linux/mm.h>
39 #include <linux/pci.h>
40 #include <linux/signal.h>
41 #include <asm/io.h>
42 #include <asm/pgtable.h>
43 #include <asm/page.h>
44 #include <linux/sched.h>
45 #include <linux/types.h>
47 #include <linux/videodev.h>
48 #include <asm/uaccess.h>
50 MODULE_DESCRIPTION("Philips SAA7111 video decoder driver");
51 MODULE_AUTHOR("Dave Perks");
52 MODULE_LICENSE("GPL");
54 #include <linux/i2c.h>
56 #define I2C_NAME(s) (s)->name
58 #include <linux/video_decoder.h>
60 static int debug = 0;
61 module_param(debug, int, 0644);
62 MODULE_PARM_DESC(debug, "Debug level (0-1)");
64 #define dprintk(num, format, args...) \
65 do { \
66 if (debug >= num) \
67 printk(format, ##args); \
68 } while (0)
70 /* ----------------------------------------------------------------------- */
72 #define SAA7111_NR_REG 0x18
74 struct saa7111 {
75 unsigned char reg[SAA7111_NR_REG];
77 int norm;
78 int input;
79 int enable;
80 int bright;
81 int contrast;
82 int hue;
83 int sat;
86 #define I2C_SAA7111 0x48
88 /* ----------------------------------------------------------------------- */
90 static inline int
91 saa7111_write (struct i2c_client *client,
92 u8 reg,
93 u8 value)
95 struct saa7111 *decoder = i2c_get_clientdata(client);
97 decoder->reg[reg] = value;
98 return i2c_smbus_write_byte_data(client, reg, value);
101 static int
102 saa7111_write_block (struct i2c_client *client,
103 const u8 *data,
104 unsigned int len)
106 int ret = -1;
107 u8 reg;
109 /* the saa7111 has an autoincrement function, use it if
110 * the adapter understands raw I2C */
111 if (i2c_check_functionality(client->adapter, I2C_FUNC_I2C)) {
112 /* do raw I2C, not smbus compatible */
113 struct saa7111 *decoder = i2c_get_clientdata(client);
114 u8 block_data[32];
115 int block_len;
117 while (len >= 2) {
118 block_len = 0;
119 block_data[block_len++] = reg = data[0];
120 do {
121 block_data[block_len++] =
122 decoder->reg[reg++] = data[1];
123 len -= 2;
124 data += 2;
125 } while (len >= 2 && data[0] == reg &&
126 block_len < 32);
127 if ((ret = i2c_master_send(client, block_data,
128 block_len)) < 0)
129 break;
131 } else {
132 /* do some slow I2C emulation kind of thing */
133 while (len >= 2) {
134 reg = *data++;
135 if ((ret = saa7111_write(client, reg,
136 *data++)) < 0)
137 break;
138 len -= 2;
142 return ret;
145 static int
146 saa7111_init_decoder (struct i2c_client *client,
147 struct video_decoder_init *init)
149 return saa7111_write_block(client, init->data, init->len);
152 static inline int
153 saa7111_read (struct i2c_client *client,
154 u8 reg)
156 return i2c_smbus_read_byte_data(client, reg);
159 /* ----------------------------------------------------------------------- */
161 static const unsigned char saa7111_i2c_init[] = {
162 0x00, 0x00, /* 00 - ID byte */
163 0x01, 0x00, /* 01 - reserved */
165 /*front end */
166 0x02, 0xd0, /* 02 - FUSE=3, GUDL=2, MODE=0 */
167 0x03, 0x23, /* 03 - HLNRS=0, VBSL=1, WPOFF=0,
168 * HOLDG=0, GAFIX=0, GAI1=256, GAI2=256 */
169 0x04, 0x00, /* 04 - GAI1=256 */
170 0x05, 0x00, /* 05 - GAI2=256 */
172 /* decoder */
173 0x06, 0xf3, /* 06 - HSB at 13(50Hz) / 17(60Hz)
174 * pixels after end of last line */
175 /*0x07, 0x13, * 07 - HSS at 113(50Hz) / 117(60Hz) pixels
176 * after end of last line */
177 0x07, 0xe8, /* 07 - HSS seems to be needed to
178 * work with NTSC, too */
179 0x08, 0xc8, /* 08 - AUFD=1, FSEL=1, EXFIL=0,
180 * VTRC=1, HPLL=0, VNOI=0 */
181 0x09, 0x01, /* 09 - BYPS=0, PREF=0, BPSS=0,
182 * VBLB=0, UPTCV=0, APER=1 */
183 0x0a, 0x80, /* 0a - BRIG=128 */
184 0x0b, 0x47, /* 0b - CONT=1.109 */
185 0x0c, 0x40, /* 0c - SATN=1.0 */
186 0x0d, 0x00, /* 0d - HUE=0 */
187 0x0e, 0x01, /* 0e - CDTO=0, CSTD=0, DCCF=0,
188 * FCTC=0, CHBW=1 */
189 0x0f, 0x00, /* 0f - reserved */
190 0x10, 0x48, /* 10 - OFTS=1, HDEL=0, VRLN=1, YDEL=0 */
191 0x11, 0x1c, /* 11 - GPSW=0, CM99=0, FECO=0, COMPO=1,
192 * OEYC=1, OEHV=1, VIPB=0, COLO=0 */
193 0x12, 0x00, /* 12 - output control 2 */
194 0x13, 0x00, /* 13 - output control 3 */
195 0x14, 0x00, /* 14 - reserved */
196 0x15, 0x00, /* 15 - VBI */
197 0x16, 0x00, /* 16 - VBI */
198 0x17, 0x00, /* 17 - VBI */
201 static int
202 saa7111_command (struct i2c_client *client,
203 unsigned int cmd,
204 void *arg)
206 struct saa7111 *decoder = i2c_get_clientdata(client);
208 switch (cmd) {
210 case 0:
211 break;
212 case DECODER_INIT:
214 struct video_decoder_init *init = arg;
215 if (NULL != init)
216 return saa7111_init_decoder(client, init);
217 else {
218 struct video_decoder_init vdi;
219 vdi.data = saa7111_i2c_init;
220 vdi.len = sizeof(saa7111_i2c_init);
221 return saa7111_init_decoder(client, &vdi);
225 case DECODER_DUMP:
227 int i;
229 for (i = 0; i < SAA7111_NR_REG; i += 16) {
230 int j;
232 printk(KERN_DEBUG "%s: %03x", I2C_NAME(client), i);
233 for (j = 0; j < 16 && i + j < SAA7111_NR_REG; ++j) {
234 printk(" %02x",
235 saa7111_read(client, i + j));
237 printk("\n");
240 break;
242 case DECODER_GET_CAPABILITIES:
244 struct video_decoder_capability *cap = arg;
246 cap->flags = VIDEO_DECODER_PAL |
247 VIDEO_DECODER_NTSC |
248 VIDEO_DECODER_SECAM |
249 VIDEO_DECODER_AUTO |
250 VIDEO_DECODER_CCIR;
251 cap->inputs = 8;
252 cap->outputs = 1;
254 break;
256 case DECODER_GET_STATUS:
258 int *iarg = arg;
259 int status;
260 int res;
262 status = saa7111_read(client, 0x1f);
263 dprintk(1, KERN_DEBUG "%s status: 0x%02x\n", I2C_NAME(client),
264 status);
265 res = 0;
266 if ((status & (1 << 6)) == 0) {
267 res |= DECODER_STATUS_GOOD;
269 switch (decoder->norm) {
270 case VIDEO_MODE_NTSC:
271 res |= DECODER_STATUS_NTSC;
272 break;
273 case VIDEO_MODE_PAL:
274 res |= DECODER_STATUS_PAL;
275 break;
276 case VIDEO_MODE_SECAM:
277 res |= DECODER_STATUS_SECAM;
278 break;
279 default:
280 case VIDEO_MODE_AUTO:
281 if ((status & (1 << 5)) != 0) {
282 res |= DECODER_STATUS_NTSC;
283 } else {
284 res |= DECODER_STATUS_PAL;
286 break;
288 if ((status & (1 << 0)) != 0) {
289 res |= DECODER_STATUS_COLOR;
291 *iarg = res;
293 break;
295 case DECODER_SET_GPIO:
297 int *iarg = arg;
298 if (0 != *iarg) {
299 saa7111_write(client, 0x11,
300 (decoder->reg[0x11] | 0x80));
301 } else {
302 saa7111_write(client, 0x11,
303 (decoder->reg[0x11] & 0x7f));
305 break;
308 case DECODER_SET_VBI_BYPASS:
310 int *iarg = arg;
311 if (0 != *iarg) {
312 saa7111_write(client, 0x13,
313 (decoder->reg[0x13] & 0xf0) | 0x0a);
314 } else {
315 saa7111_write(client, 0x13,
316 (decoder->reg[0x13] & 0xf0));
318 break;
321 case DECODER_SET_NORM:
323 int *iarg = arg;
325 switch (*iarg) {
327 case VIDEO_MODE_NTSC:
328 saa7111_write(client, 0x08,
329 (decoder->reg[0x08] & 0x3f) | 0x40);
330 saa7111_write(client, 0x0e,
331 (decoder->reg[0x0e] & 0x8f));
332 break;
334 case VIDEO_MODE_PAL:
335 saa7111_write(client, 0x08,
336 (decoder->reg[0x08] & 0x3f) | 0x00);
337 saa7111_write(client, 0x0e,
338 (decoder->reg[0x0e] & 0x8f));
339 break;
341 case VIDEO_MODE_SECAM:
342 saa7111_write(client, 0x08,
343 (decoder->reg[0x08] & 0x3f) | 0x00);
344 saa7111_write(client, 0x0e,
345 (decoder->reg[0x0e] & 0x8f) | 0x50);
346 break;
348 case VIDEO_MODE_AUTO:
349 saa7111_write(client, 0x08,
350 (decoder->reg[0x08] & 0x3f) | 0x80);
351 saa7111_write(client, 0x0e,
352 (decoder->reg[0x0e] & 0x8f));
353 break;
355 default:
356 return -EINVAL;
359 decoder->norm = *iarg;
361 break;
363 case DECODER_SET_INPUT:
365 int *iarg = arg;
367 if (*iarg < 0 || *iarg > 7) {
368 return -EINVAL;
371 if (decoder->input != *iarg) {
372 decoder->input = *iarg;
373 /* select mode */
374 saa7111_write(client, 0x02,
375 (decoder->
376 reg[0x02] & 0xf8) | decoder->input);
377 /* bypass chrominance trap for modes 4..7 */
378 saa7111_write(client, 0x09,
379 (decoder->
380 reg[0x09] & 0x7f) | ((decoder->
381 input >
382 3) ? 0x80 :
383 0));
386 break;
388 case DECODER_SET_OUTPUT:
390 int *iarg = arg;
392 /* not much choice of outputs */
393 if (*iarg != 0) {
394 return -EINVAL;
397 break;
399 case DECODER_ENABLE_OUTPUT:
401 int *iarg = arg;
402 int enable = (*iarg != 0);
404 if (decoder->enable != enable) {
405 decoder->enable = enable;
407 /* RJ: If output should be disabled (for
408 * playing videos), we also need a open PLL.
409 * The input is set to 0 (where no input
410 * source is connected), although this
411 * is not necessary.
413 * If output should be enabled, we have to
414 * reverse the above.
417 if (decoder->enable) {
418 saa7111_write(client, 0x02,
419 (decoder->
420 reg[0x02] & 0xf8) |
421 decoder->input);
422 saa7111_write(client, 0x08,
423 (decoder->reg[0x08] & 0xfb));
424 saa7111_write(client, 0x11,
425 (decoder->
426 reg[0x11] & 0xf3) | 0x0c);
427 } else {
428 saa7111_write(client, 0x02,
429 (decoder->reg[0x02] & 0xf8));
430 saa7111_write(client, 0x08,
431 (decoder->
432 reg[0x08] & 0xfb) | 0x04);
433 saa7111_write(client, 0x11,
434 (decoder->reg[0x11] & 0xf3));
438 break;
440 case DECODER_SET_PICTURE:
442 struct video_picture *pic = arg;
444 if (decoder->bright != pic->brightness) {
445 /* We want 0 to 255 we get 0-65535 */
446 decoder->bright = pic->brightness;
447 saa7111_write(client, 0x0a, decoder->bright >> 8);
449 if (decoder->contrast != pic->contrast) {
450 /* We want 0 to 127 we get 0-65535 */
451 decoder->contrast = pic->contrast;
452 saa7111_write(client, 0x0b,
453 decoder->contrast >> 9);
455 if (decoder->sat != pic->colour) {
456 /* We want 0 to 127 we get 0-65535 */
457 decoder->sat = pic->colour;
458 saa7111_write(client, 0x0c, decoder->sat >> 9);
460 if (decoder->hue != pic->hue) {
461 /* We want -128 to 127 we get 0-65535 */
462 decoder->hue = pic->hue;
463 saa7111_write(client, 0x0d,
464 (decoder->hue - 32768) >> 8);
467 break;
469 default:
470 return -EINVAL;
473 return 0;
476 /* ----------------------------------------------------------------------- */
479 * Generic i2c probe
480 * concerning the addresses: i2c wants 7 bit (without the r/w bit), so '>>1'
482 static unsigned short normal_i2c[] = { I2C_SAA7111 >> 1, I2C_CLIENT_END };
484 static unsigned short ignore = I2C_CLIENT_END;
486 static struct i2c_client_address_data addr_data = {
487 .normal_i2c = normal_i2c,
488 .probe = &ignore,
489 .ignore = &ignore,
492 static struct i2c_driver i2c_driver_saa7111;
494 static int
495 saa7111_detect_client (struct i2c_adapter *adapter,
496 int address,
497 int kind)
499 int i;
500 struct i2c_client *client;
501 struct saa7111 *decoder;
502 struct video_decoder_init vdi;
504 dprintk(1,
505 KERN_INFO
506 "saa7111.c: detecting saa7111 client on address 0x%x\n",
507 address << 1);
509 /* Check if the adapter supports the needed features */
510 if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA))
511 return 0;
513 client = kzalloc(sizeof(struct i2c_client), GFP_KERNEL);
514 if (client == 0)
515 return -ENOMEM;
516 client->addr = address;
517 client->adapter = adapter;
518 client->driver = &i2c_driver_saa7111;
519 strlcpy(I2C_NAME(client), "saa7111", sizeof(I2C_NAME(client)));
521 decoder = kzalloc(sizeof(struct saa7111), GFP_KERNEL);
522 if (decoder == NULL) {
523 kfree(client);
524 return -ENOMEM;
526 decoder->norm = VIDEO_MODE_NTSC;
527 decoder->input = 0;
528 decoder->enable = 1;
529 decoder->bright = 32768;
530 decoder->contrast = 32768;
531 decoder->hue = 32768;
532 decoder->sat = 32768;
533 i2c_set_clientdata(client, decoder);
535 i = i2c_attach_client(client);
536 if (i) {
537 kfree(client);
538 kfree(decoder);
539 return i;
542 vdi.data = saa7111_i2c_init;
543 vdi.len = sizeof(saa7111_i2c_init);
544 i = saa7111_init_decoder(client, &vdi);
545 if (i < 0) {
546 dprintk(1, KERN_ERR "%s_attach error: init status %d\n",
547 I2C_NAME(client), i);
548 } else {
549 dprintk(1,
550 KERN_INFO
551 "%s_attach: chip version %x at address 0x%x\n",
552 I2C_NAME(client), saa7111_read(client, 0x00) >> 4,
553 client->addr << 1);
556 return 0;
559 static int
560 saa7111_attach_adapter (struct i2c_adapter *adapter)
562 dprintk(1,
563 KERN_INFO
564 "saa7111.c: starting probe for adapter %s (0x%x)\n",
565 I2C_NAME(adapter), adapter->id);
566 return i2c_probe(adapter, &addr_data, &saa7111_detect_client);
569 static int
570 saa7111_detach_client (struct i2c_client *client)
572 struct saa7111 *decoder = i2c_get_clientdata(client);
573 int err;
575 err = i2c_detach_client(client);
576 if (err) {
577 return err;
580 kfree(decoder);
581 kfree(client);
583 return 0;
586 /* ----------------------------------------------------------------------- */
588 static struct i2c_driver i2c_driver_saa7111 = {
589 .driver = {
590 .name = "saa7111",
593 .id = I2C_DRIVERID_SAA7111A,
595 .attach_adapter = saa7111_attach_adapter,
596 .detach_client = saa7111_detach_client,
597 .command = saa7111_command,
600 static int __init
601 saa7111_init (void)
603 return i2c_add_driver(&i2c_driver_saa7111);
606 static void __exit
607 saa7111_exit (void)
609 i2c_del_driver(&i2c_driver_saa7111);
612 module_init(saa7111_init);
613 module_exit(saa7111_exit);