Linux 2.6.17.7
[linux/fpc-iii.git] / drivers / media / video / adv7175.c
blob68e7d7aff5e6423b4bf51386473fe6c6d2c62663
1 /*
2 * adv7175 - adv7175a video encoder driver version 0.0.3
4 * Copyright (C) 1998 Dave Perks <dperks@ibm.net>
5 * Copyright (C) 1999 Wolfgang Scherr <scherr@net4you.net>
6 * Copyright (C) 2000 Serguei Miridonov <mirsev@cicese.mx>
7 * - some corrections for Pinnacle Systems Inc. DC10plus card.
9 * Changes by Ronald Bultje <rbultje@ronald.bitfreak.net>
10 * - moved over to linux>=2.4.x i2c protocol (9/9/2002)
12 * This program is free software; you can redistribute it and/or modify
13 * it under the terms of the GNU General Public License as published by
14 * the Free Software Foundation; either version 2 of the License, or
15 * (at your option) any later version.
17 * This program is distributed in the hope that it will be useful,
18 * but WITHOUT ANY WARRANTY; without even the implied warranty of
19 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
20 * GNU General Public License for more details.
22 * You should have received a copy of the GNU General Public License
23 * along with this program; if not, write to the Free Software
24 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
27 #include <linux/module.h>
28 #include <linux/init.h>
29 #include <linux/delay.h>
30 #include <linux/errno.h>
31 #include <linux/fs.h>
32 #include <linux/kernel.h>
33 #include <linux/major.h>
34 #include <linux/slab.h>
35 #include <linux/mm.h>
36 #include <linux/pci.h>
37 #include <linux/signal.h>
38 #include <asm/io.h>
39 #include <asm/pgtable.h>
40 #include <asm/page.h>
41 #include <linux/sched.h>
42 #include <linux/types.h>
44 #include <linux/videodev.h>
45 #include <asm/uaccess.h>
47 MODULE_DESCRIPTION("Analog Devices ADV7175 video encoder driver");
48 MODULE_AUTHOR("Dave Perks");
49 MODULE_LICENSE("GPL");
51 #include <linux/i2c.h>
53 #define I2C_NAME(s) (s)->name
55 #include <linux/video_encoder.h>
57 static int debug = 0;
58 module_param(debug, int, 0);
59 MODULE_PARM_DESC(debug, "Debug level (0-1)");
61 #define dprintk(num, format, args...) \
62 do { \
63 if (debug >= num) \
64 printk(format, ##args); \
65 } while (0)
67 /* ----------------------------------------------------------------------- */
69 struct adv7175 {
70 int norm;
71 int input;
72 int enable;
73 int bright;
74 int contrast;
75 int hue;
76 int sat;
79 #define I2C_ADV7175 0xd4
80 #define I2C_ADV7176 0x54
82 static char adv7175_name[] = "adv7175";
83 static char adv7176_name[] = "adv7176";
85 static char *inputs[] = { "pass_through", "play_back", "color_bar" };
86 static char *norms[] = { "PAL", "NTSC", "SECAM->PAL (may not work!)" };
88 /* ----------------------------------------------------------------------- */
90 static inline int
91 adv7175_write (struct i2c_client *client,
92 u8 reg,
93 u8 value)
95 return i2c_smbus_write_byte_data(client, reg, value);
98 static inline int
99 adv7175_read (struct i2c_client *client,
100 u8 reg)
102 return i2c_smbus_read_byte_data(client, reg);
105 static int
106 adv7175_write_block (struct i2c_client *client,
107 const u8 *data,
108 unsigned int len)
110 int ret = -1;
111 u8 reg;
113 /* the adv7175 has an autoincrement function, use it if
114 * the adapter understands raw I2C */
115 if (i2c_check_functionality(client->adapter, I2C_FUNC_I2C)) {
116 /* do raw I2C, not smbus compatible */
117 u8 block_data[32];
118 int block_len;
120 while (len >= 2) {
121 block_len = 0;
122 block_data[block_len++] = reg = data[0];
123 do {
124 block_data[block_len++] = data[1];
125 reg++;
126 len -= 2;
127 data += 2;
128 } while (len >= 2 && data[0] == reg &&
129 block_len < 32);
130 if ((ret = i2c_master_send(client, block_data,
131 block_len)) < 0)
132 break;
134 } else {
135 /* do some slow I2C emulation kind of thing */
136 while (len >= 2) {
137 reg = *data++;
138 if ((ret = adv7175_write(client, reg,
139 *data++)) < 0)
140 break;
141 len -= 2;
145 return ret;
148 static void
149 set_subcarrier_freq (struct i2c_client *client,
150 int pass_through)
152 /* for some reason pass_through NTSC needs
153 * a different sub-carrier freq to remain stable. */
154 if(pass_through)
155 adv7175_write(client, 0x02, 0x00);
156 else
157 adv7175_write(client, 0x02, 0x55);
159 adv7175_write(client, 0x03, 0x55);
160 adv7175_write(client, 0x04, 0x55);
161 adv7175_write(client, 0x05, 0x25);
164 /* ----------------------------------------------------------------------- */
165 // Output filter: S-Video Composite
167 #define MR050 0x11 //0x09
168 #define MR060 0x14 //0x0c
170 //---------------------------------------------------------------------------
172 #define TR0MODE 0x46
173 #define TR0RST 0x80
175 #define TR1CAPT 0x80
176 #define TR1PLAY 0x00
178 static const unsigned char init_common[] = {
180 0x00, MR050, /* MR0, PAL enabled */
181 0x01, 0x00, /* MR1 */
182 0x02, 0x0c, /* subc. freq. */
183 0x03, 0x8c, /* subc. freq. */
184 0x04, 0x79, /* subc. freq. */
185 0x05, 0x26, /* subc. freq. */
186 0x06, 0x40, /* subc. phase */
188 0x07, TR0MODE, /* TR0, 16bit */
189 0x08, 0x21, /* */
190 0x09, 0x00, /* */
191 0x0a, 0x00, /* */
192 0x0b, 0x00, /* */
193 0x0c, TR1CAPT, /* TR1 */
194 0x0d, 0x4f, /* MR2 */
195 0x0e, 0x00, /* */
196 0x0f, 0x00, /* */
197 0x10, 0x00, /* */
198 0x11, 0x00, /* */
201 static const unsigned char init_pal[] = {
202 0x00, MR050, /* MR0, PAL enabled */
203 0x01, 0x00, /* MR1 */
204 0x02, 0x0c, /* subc. freq. */
205 0x03, 0x8c, /* subc. freq. */
206 0x04, 0x79, /* subc. freq. */
207 0x05, 0x26, /* subc. freq. */
208 0x06, 0x40, /* subc. phase */
211 static const unsigned char init_ntsc[] = {
212 0x00, MR060, /* MR0, NTSC enabled */
213 0x01, 0x00, /* MR1 */
214 0x02, 0x55, /* subc. freq. */
215 0x03, 0x55, /* subc. freq. */
216 0x04, 0x55, /* subc. freq. */
217 0x05, 0x25, /* subc. freq. */
218 0x06, 0x1a, /* subc. phase */
221 static int
222 adv7175_command (struct i2c_client *client,
223 unsigned int cmd,
224 void *arg)
226 struct adv7175 *encoder = i2c_get_clientdata(client);
228 switch (cmd) {
230 case 0:
231 /* This is just for testing!!! */
232 adv7175_write_block(client, init_common,
233 sizeof(init_common));
234 adv7175_write(client, 0x07, TR0MODE | TR0RST);
235 adv7175_write(client, 0x07, TR0MODE);
236 break;
238 case ENCODER_GET_CAPABILITIES:
240 struct video_encoder_capability *cap = arg;
242 cap->flags = VIDEO_ENCODER_PAL |
243 VIDEO_ENCODER_NTSC |
244 VIDEO_ENCODER_SECAM; /* well, hacky */
245 cap->inputs = 2;
246 cap->outputs = 1;
248 break;
250 case ENCODER_SET_NORM:
252 int iarg = *(int *) arg;
254 switch (iarg) {
256 case VIDEO_MODE_NTSC:
257 adv7175_write_block(client, init_ntsc,
258 sizeof(init_ntsc));
259 if (encoder->input == 0)
260 adv7175_write(client, 0x0d, 0x4f); // Enable genlock
261 adv7175_write(client, 0x07, TR0MODE | TR0RST);
262 adv7175_write(client, 0x07, TR0MODE);
263 break;
265 case VIDEO_MODE_PAL:
266 adv7175_write_block(client, init_pal,
267 sizeof(init_pal));
268 if (encoder->input == 0)
269 adv7175_write(client, 0x0d, 0x4f); // Enable genlock
270 adv7175_write(client, 0x07, TR0MODE | TR0RST);
271 adv7175_write(client, 0x07, TR0MODE);
272 break;
274 case VIDEO_MODE_SECAM: // WARNING! ADV7176 does not support SECAM.
275 /* This is an attempt to convert
276 * SECAM->PAL (typically it does not work
277 * due to genlock: when decoder is in SECAM
278 * and encoder in in PAL the subcarrier can
279 * not be syncronized with horizontal
280 * quency) */
281 adv7175_write_block(client, init_pal,
282 sizeof(init_pal));
283 if (encoder->input == 0)
284 adv7175_write(client, 0x0d, 0x49); // Disable genlock
285 adv7175_write(client, 0x07, TR0MODE | TR0RST);
286 adv7175_write(client, 0x07, TR0MODE);
287 break;
288 default:
289 dprintk(1, KERN_ERR "%s: illegal norm: %d\n",
290 I2C_NAME(client), iarg);
291 return -EINVAL;
294 dprintk(1, KERN_INFO "%s: switched to %s\n", I2C_NAME(client),
295 norms[iarg]);
296 encoder->norm = iarg;
298 break;
300 case ENCODER_SET_INPUT:
302 int iarg = *(int *) arg;
304 /* RJ: *iarg = 0: input is from SAA7110
305 *iarg = 1: input is from ZR36060
306 *iarg = 2: color bar */
308 switch (iarg) {
310 case 0:
311 adv7175_write(client, 0x01, 0x00);
313 if (encoder->norm == VIDEO_MODE_NTSC)
314 set_subcarrier_freq(client, 1);
316 adv7175_write(client, 0x0c, TR1CAPT); /* TR1 */
317 if (encoder->norm == VIDEO_MODE_SECAM)
318 adv7175_write(client, 0x0d, 0x49); // Disable genlock
319 else
320 adv7175_write(client, 0x0d, 0x4f); // Enable genlock
321 adv7175_write(client, 0x07, TR0MODE | TR0RST);
322 adv7175_write(client, 0x07, TR0MODE);
323 //udelay(10);
324 break;
326 case 1:
327 adv7175_write(client, 0x01, 0x00);
329 if (encoder->norm == VIDEO_MODE_NTSC)
330 set_subcarrier_freq(client, 0);
332 adv7175_write(client, 0x0c, TR1PLAY); /* TR1 */
333 adv7175_write(client, 0x0d, 0x49);
334 adv7175_write(client, 0x07, TR0MODE | TR0RST);
335 adv7175_write(client, 0x07, TR0MODE);
336 //udelay(10);
337 break;
339 case 2:
340 adv7175_write(client, 0x01, 0x80);
342 if (encoder->norm == VIDEO_MODE_NTSC)
343 set_subcarrier_freq(client, 0);
345 adv7175_write(client, 0x0d, 0x49);
346 adv7175_write(client, 0x07, TR0MODE | TR0RST);
347 adv7175_write(client, 0x07, TR0MODE);
348 //udelay(10);
349 break;
351 default:
352 dprintk(1, KERN_ERR "%s: illegal input: %d\n",
353 I2C_NAME(client), iarg);
354 return -EINVAL;
357 dprintk(1, KERN_INFO "%s: switched to %s\n", I2C_NAME(client),
358 inputs[iarg]);
359 encoder->input = iarg;
361 break;
363 case ENCODER_SET_OUTPUT:
365 int *iarg = arg;
367 /* not much choice of outputs */
368 if (*iarg != 0) {
369 return -EINVAL;
372 break;
374 case ENCODER_ENABLE_OUTPUT:
376 int *iarg = arg;
378 encoder->enable = !!*iarg;
380 break;
382 default:
383 return -EINVAL;
386 return 0;
389 /* ----------------------------------------------------------------------- */
392 * Generic i2c probe
393 * concerning the addresses: i2c wants 7 bit (without the r/w bit), so '>>1'
395 static unsigned short normal_i2c[] =
396 { I2C_ADV7175 >> 1, (I2C_ADV7175 >> 1) + 1,
397 I2C_ADV7176 >> 1, (I2C_ADV7176 >> 1) + 1,
398 I2C_CLIENT_END
401 static unsigned short ignore = I2C_CLIENT_END;
403 static struct i2c_client_address_data addr_data = {
404 .normal_i2c = normal_i2c,
405 .probe = &ignore,
406 .ignore = &ignore,
409 static struct i2c_driver i2c_driver_adv7175;
411 static int
412 adv7175_detect_client (struct i2c_adapter *adapter,
413 int address,
414 int kind)
416 int i;
417 struct i2c_client *client;
418 struct adv7175 *encoder;
419 char *dname;
421 dprintk(1,
422 KERN_INFO
423 "adv7175.c: detecting adv7175 client on address 0x%x\n",
424 address << 1);
426 /* Check if the adapter supports the needed features */
427 if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA))
428 return 0;
430 client = kzalloc(sizeof(struct i2c_client), GFP_KERNEL);
431 if (client == 0)
432 return -ENOMEM;
433 client->addr = address;
434 client->adapter = adapter;
435 client->driver = &i2c_driver_adv7175;
436 if ((client->addr == I2C_ADV7175 >> 1) ||
437 (client->addr == (I2C_ADV7175 >> 1) + 1)) {
438 dname = adv7175_name;
439 } else if ((client->addr == I2C_ADV7176 >> 1) ||
440 (client->addr == (I2C_ADV7176 >> 1) + 1)) {
441 dname = adv7176_name;
442 } else {
443 /* We should never get here!!! */
444 kfree(client);
445 return 0;
447 strlcpy(I2C_NAME(client), dname, sizeof(I2C_NAME(client)));
449 encoder = kzalloc(sizeof(struct adv7175), GFP_KERNEL);
450 if (encoder == NULL) {
451 kfree(client);
452 return -ENOMEM;
454 encoder->norm = VIDEO_MODE_PAL;
455 encoder->input = 0;
456 encoder->enable = 1;
457 i2c_set_clientdata(client, encoder);
459 i = i2c_attach_client(client);
460 if (i) {
461 kfree(client);
462 kfree(encoder);
463 return i;
466 i = adv7175_write_block(client, init_common, sizeof(init_common));
467 if (i >= 0) {
468 i = adv7175_write(client, 0x07, TR0MODE | TR0RST);
469 i = adv7175_write(client, 0x07, TR0MODE);
470 i = adv7175_read(client, 0x12);
471 dprintk(1, KERN_INFO "%s_attach: rev. %d at 0x%x\n",
472 I2C_NAME(client), i & 1, client->addr << 1);
474 if (i < 0) {
475 dprintk(1, KERN_ERR "%s_attach: init error 0x%x\n",
476 I2C_NAME(client), i);
479 return 0;
482 static int
483 adv7175_attach_adapter (struct i2c_adapter *adapter)
485 dprintk(1,
486 KERN_INFO
487 "adv7175.c: starting probe for adapter %s (0x%x)\n",
488 I2C_NAME(adapter), adapter->id);
489 return i2c_probe(adapter, &addr_data, &adv7175_detect_client);
492 static int
493 adv7175_detach_client (struct i2c_client *client)
495 struct adv7175 *encoder = i2c_get_clientdata(client);
496 int err;
498 err = i2c_detach_client(client);
499 if (err) {
500 return err;
503 kfree(encoder);
504 kfree(client);
506 return 0;
509 /* ----------------------------------------------------------------------- */
511 static struct i2c_driver i2c_driver_adv7175 = {
512 .driver = {
513 .name = "adv7175", /* name */
516 .id = I2C_DRIVERID_ADV7175,
518 .attach_adapter = adv7175_attach_adapter,
519 .detach_client = adv7175_detach_client,
520 .command = adv7175_command,
523 static int __init
524 adv7175_init (void)
526 return i2c_add_driver(&i2c_driver_adv7175);
529 static void __exit
530 adv7175_exit (void)
532 i2c_del_driver(&i2c_driver_adv7175);
535 module_init(adv7175_init);
536 module_exit(adv7175_exit);