Committer: Michael Beasley <mike@snafu.setup>
[mikesnafu-overlay.git] / drivers / media / video / adv7175.c
blob10d4d89623f15431080c3fda94b37164c4dc67fd
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/signal.h>
37 #include <linux/types.h>
38 #include <linux/i2c.h>
39 #include <asm/io.h>
40 #include <asm/pgtable.h>
41 #include <asm/page.h>
42 #include <asm/uaccess.h>
44 #include <linux/videodev.h>
45 #include <linux/video_encoder.h>
47 MODULE_DESCRIPTION("Analog Devices ADV7175 video encoder driver");
48 MODULE_AUTHOR("Dave Perks");
49 MODULE_LICENSE("GPL");
52 #define I2C_NAME(s) (s)->name
55 static int debug = 0;
56 module_param(debug, int, 0);
57 MODULE_PARM_DESC(debug, "Debug level (0-1)");
59 #define dprintk(num, format, args...) \
60 do { \
61 if (debug >= num) \
62 printk(format, ##args); \
63 } while (0)
65 /* ----------------------------------------------------------------------- */
67 struct adv7175 {
68 int norm;
69 int input;
70 int enable;
71 int bright;
72 int contrast;
73 int hue;
74 int sat;
77 #define I2C_ADV7175 0xd4
78 #define I2C_ADV7176 0x54
80 static char adv7175_name[] = "adv7175";
81 static char adv7176_name[] = "adv7176";
83 static char *inputs[] = { "pass_through", "play_back", "color_bar" };
84 static char *norms[] = { "PAL", "NTSC", "SECAM->PAL (may not work!)" };
86 /* ----------------------------------------------------------------------- */
88 static inline int
89 adv7175_write (struct i2c_client *client,
90 u8 reg,
91 u8 value)
93 return i2c_smbus_write_byte_data(client, reg, value);
96 static inline int
97 adv7175_read (struct i2c_client *client,
98 u8 reg)
100 return i2c_smbus_read_byte_data(client, reg);
103 static int
104 adv7175_write_block (struct i2c_client *client,
105 const u8 *data,
106 unsigned int len)
108 int ret = -1;
109 u8 reg;
111 /* the adv7175 has an autoincrement function, use it if
112 * the adapter understands raw I2C */
113 if (i2c_check_functionality(client->adapter, I2C_FUNC_I2C)) {
114 /* do raw I2C, not smbus compatible */
115 u8 block_data[32];
116 int block_len;
118 while (len >= 2) {
119 block_len = 0;
120 block_data[block_len++] = reg = data[0];
121 do {
122 block_data[block_len++] = data[1];
123 reg++;
124 len -= 2;
125 data += 2;
126 } while (len >= 2 && data[0] == reg &&
127 block_len < 32);
128 if ((ret = i2c_master_send(client, block_data,
129 block_len)) < 0)
130 break;
132 } else {
133 /* do some slow I2C emulation kind of thing */
134 while (len >= 2) {
135 reg = *data++;
136 if ((ret = adv7175_write(client, reg,
137 *data++)) < 0)
138 break;
139 len -= 2;
143 return ret;
146 static void
147 set_subcarrier_freq (struct i2c_client *client,
148 int pass_through)
150 /* for some reason pass_through NTSC needs
151 * a different sub-carrier freq to remain stable. */
152 if(pass_through)
153 adv7175_write(client, 0x02, 0x00);
154 else
155 adv7175_write(client, 0x02, 0x55);
157 adv7175_write(client, 0x03, 0x55);
158 adv7175_write(client, 0x04, 0x55);
159 adv7175_write(client, 0x05, 0x25);
162 /* ----------------------------------------------------------------------- */
163 // Output filter: S-Video Composite
165 #define MR050 0x11 //0x09
166 #define MR060 0x14 //0x0c
168 //---------------------------------------------------------------------------
170 #define TR0MODE 0x46
171 #define TR0RST 0x80
173 #define TR1CAPT 0x80
174 #define TR1PLAY 0x00
176 static const unsigned char init_common[] = {
178 0x00, MR050, /* MR0, PAL enabled */
179 0x01, 0x00, /* MR1 */
180 0x02, 0x0c, /* subc. freq. */
181 0x03, 0x8c, /* subc. freq. */
182 0x04, 0x79, /* subc. freq. */
183 0x05, 0x26, /* subc. freq. */
184 0x06, 0x40, /* subc. phase */
186 0x07, TR0MODE, /* TR0, 16bit */
187 0x08, 0x21, /* */
188 0x09, 0x00, /* */
189 0x0a, 0x00, /* */
190 0x0b, 0x00, /* */
191 0x0c, TR1CAPT, /* TR1 */
192 0x0d, 0x4f, /* MR2 */
193 0x0e, 0x00, /* */
194 0x0f, 0x00, /* */
195 0x10, 0x00, /* */
196 0x11, 0x00, /* */
199 static const unsigned char init_pal[] = {
200 0x00, MR050, /* MR0, PAL enabled */
201 0x01, 0x00, /* MR1 */
202 0x02, 0x0c, /* subc. freq. */
203 0x03, 0x8c, /* subc. freq. */
204 0x04, 0x79, /* subc. freq. */
205 0x05, 0x26, /* subc. freq. */
206 0x06, 0x40, /* subc. phase */
209 static const unsigned char init_ntsc[] = {
210 0x00, MR060, /* MR0, NTSC enabled */
211 0x01, 0x00, /* MR1 */
212 0x02, 0x55, /* subc. freq. */
213 0x03, 0x55, /* subc. freq. */
214 0x04, 0x55, /* subc. freq. */
215 0x05, 0x25, /* subc. freq. */
216 0x06, 0x1a, /* subc. phase */
219 static int
220 adv7175_command (struct i2c_client *client,
221 unsigned int cmd,
222 void *arg)
224 struct adv7175 *encoder = i2c_get_clientdata(client);
226 switch (cmd) {
228 case 0:
229 /* This is just for testing!!! */
230 adv7175_write_block(client, init_common,
231 sizeof(init_common));
232 adv7175_write(client, 0x07, TR0MODE | TR0RST);
233 adv7175_write(client, 0x07, TR0MODE);
234 break;
236 case ENCODER_GET_CAPABILITIES:
238 struct video_encoder_capability *cap = arg;
240 cap->flags = VIDEO_ENCODER_PAL |
241 VIDEO_ENCODER_NTSC |
242 VIDEO_ENCODER_SECAM; /* well, hacky */
243 cap->inputs = 2;
244 cap->outputs = 1;
246 break;
248 case ENCODER_SET_NORM:
250 int iarg = *(int *) arg;
252 switch (iarg) {
254 case VIDEO_MODE_NTSC:
255 adv7175_write_block(client, init_ntsc,
256 sizeof(init_ntsc));
257 if (encoder->input == 0)
258 adv7175_write(client, 0x0d, 0x4f); // Enable genlock
259 adv7175_write(client, 0x07, TR0MODE | TR0RST);
260 adv7175_write(client, 0x07, TR0MODE);
261 break;
263 case VIDEO_MODE_PAL:
264 adv7175_write_block(client, init_pal,
265 sizeof(init_pal));
266 if (encoder->input == 0)
267 adv7175_write(client, 0x0d, 0x4f); // Enable genlock
268 adv7175_write(client, 0x07, TR0MODE | TR0RST);
269 adv7175_write(client, 0x07, TR0MODE);
270 break;
272 case VIDEO_MODE_SECAM: // WARNING! ADV7176 does not support SECAM.
273 /* This is an attempt to convert
274 * SECAM->PAL (typically it does not work
275 * due to genlock: when decoder is in SECAM
276 * and encoder in in PAL the subcarrier can
277 * not be syncronized with horizontal
278 * quency) */
279 adv7175_write_block(client, init_pal,
280 sizeof(init_pal));
281 if (encoder->input == 0)
282 adv7175_write(client, 0x0d, 0x49); // Disable genlock
283 adv7175_write(client, 0x07, TR0MODE | TR0RST);
284 adv7175_write(client, 0x07, TR0MODE);
285 break;
286 default:
287 dprintk(1, KERN_ERR "%s: illegal norm: %d\n",
288 I2C_NAME(client), iarg);
289 return -EINVAL;
292 dprintk(1, KERN_INFO "%s: switched to %s\n", I2C_NAME(client),
293 norms[iarg]);
294 encoder->norm = iarg;
296 break;
298 case ENCODER_SET_INPUT:
300 int iarg = *(int *) arg;
302 /* RJ: *iarg = 0: input is from SAA7110
303 *iarg = 1: input is from ZR36060
304 *iarg = 2: color bar */
306 switch (iarg) {
308 case 0:
309 adv7175_write(client, 0x01, 0x00);
311 if (encoder->norm == VIDEO_MODE_NTSC)
312 set_subcarrier_freq(client, 1);
314 adv7175_write(client, 0x0c, TR1CAPT); /* TR1 */
315 if (encoder->norm == VIDEO_MODE_SECAM)
316 adv7175_write(client, 0x0d, 0x49); // Disable genlock
317 else
318 adv7175_write(client, 0x0d, 0x4f); // Enable genlock
319 adv7175_write(client, 0x07, TR0MODE | TR0RST);
320 adv7175_write(client, 0x07, TR0MODE);
321 //udelay(10);
322 break;
324 case 1:
325 adv7175_write(client, 0x01, 0x00);
327 if (encoder->norm == VIDEO_MODE_NTSC)
328 set_subcarrier_freq(client, 0);
330 adv7175_write(client, 0x0c, TR1PLAY); /* TR1 */
331 adv7175_write(client, 0x0d, 0x49);
332 adv7175_write(client, 0x07, TR0MODE | TR0RST);
333 adv7175_write(client, 0x07, TR0MODE);
334 //udelay(10);
335 break;
337 case 2:
338 adv7175_write(client, 0x01, 0x80);
340 if (encoder->norm == VIDEO_MODE_NTSC)
341 set_subcarrier_freq(client, 0);
343 adv7175_write(client, 0x0d, 0x49);
344 adv7175_write(client, 0x07, TR0MODE | TR0RST);
345 adv7175_write(client, 0x07, TR0MODE);
346 //udelay(10);
347 break;
349 default:
350 dprintk(1, KERN_ERR "%s: illegal input: %d\n",
351 I2C_NAME(client), iarg);
352 return -EINVAL;
355 dprintk(1, KERN_INFO "%s: switched to %s\n", I2C_NAME(client),
356 inputs[iarg]);
357 encoder->input = iarg;
359 break;
361 case ENCODER_SET_OUTPUT:
363 int *iarg = arg;
365 /* not much choice of outputs */
366 if (*iarg != 0) {
367 return -EINVAL;
370 break;
372 case ENCODER_ENABLE_OUTPUT:
374 int *iarg = arg;
376 encoder->enable = !!*iarg;
378 break;
380 default:
381 return -EINVAL;
384 return 0;
387 /* ----------------------------------------------------------------------- */
390 * Generic i2c probe
391 * concerning the addresses: i2c wants 7 bit (without the r/w bit), so '>>1'
393 static unsigned short normal_i2c[] =
394 { I2C_ADV7175 >> 1, (I2C_ADV7175 >> 1) + 1,
395 I2C_ADV7176 >> 1, (I2C_ADV7176 >> 1) + 1,
396 I2C_CLIENT_END
399 static unsigned short ignore = I2C_CLIENT_END;
401 static struct i2c_client_address_data addr_data = {
402 .normal_i2c = normal_i2c,
403 .probe = &ignore,
404 .ignore = &ignore,
407 static struct i2c_driver i2c_driver_adv7175;
409 static int
410 adv7175_detect_client (struct i2c_adapter *adapter,
411 int address,
412 int kind)
414 int i;
415 struct i2c_client *client;
416 struct adv7175 *encoder;
417 char *dname;
419 dprintk(1,
420 KERN_INFO
421 "adv7175.c: detecting adv7175 client on address 0x%x\n",
422 address << 1);
424 /* Check if the adapter supports the needed features */
425 if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA))
426 return 0;
428 client = kzalloc(sizeof(struct i2c_client), GFP_KERNEL);
429 if (!client)
430 return -ENOMEM;
431 client->addr = address;
432 client->adapter = adapter;
433 client->driver = &i2c_driver_adv7175;
434 if ((client->addr == I2C_ADV7175 >> 1) ||
435 (client->addr == (I2C_ADV7175 >> 1) + 1)) {
436 dname = adv7175_name;
437 } else if ((client->addr == I2C_ADV7176 >> 1) ||
438 (client->addr == (I2C_ADV7176 >> 1) + 1)) {
439 dname = adv7176_name;
440 } else {
441 /* We should never get here!!! */
442 kfree(client);
443 return 0;
445 strlcpy(I2C_NAME(client), dname, sizeof(I2C_NAME(client)));
447 encoder = kzalloc(sizeof(struct adv7175), GFP_KERNEL);
448 if (encoder == NULL) {
449 kfree(client);
450 return -ENOMEM;
452 encoder->norm = VIDEO_MODE_PAL;
453 encoder->input = 0;
454 encoder->enable = 1;
455 i2c_set_clientdata(client, encoder);
457 i = i2c_attach_client(client);
458 if (i) {
459 kfree(client);
460 kfree(encoder);
461 return i;
464 i = adv7175_write_block(client, init_common, sizeof(init_common));
465 if (i >= 0) {
466 i = adv7175_write(client, 0x07, TR0MODE | TR0RST);
467 i = adv7175_write(client, 0x07, TR0MODE);
468 i = adv7175_read(client, 0x12);
469 dprintk(1, KERN_INFO "%s_attach: rev. %d at 0x%x\n",
470 I2C_NAME(client), i & 1, client->addr << 1);
472 if (i < 0) {
473 dprintk(1, KERN_ERR "%s_attach: init error 0x%x\n",
474 I2C_NAME(client), i);
477 return 0;
480 static int
481 adv7175_attach_adapter (struct i2c_adapter *adapter)
483 dprintk(1,
484 KERN_INFO
485 "adv7175.c: starting probe for adapter %s (0x%x)\n",
486 I2C_NAME(adapter), adapter->id);
487 return i2c_probe(adapter, &addr_data, &adv7175_detect_client);
490 static int
491 adv7175_detach_client (struct i2c_client *client)
493 struct adv7175 *encoder = i2c_get_clientdata(client);
494 int err;
496 err = i2c_detach_client(client);
497 if (err) {
498 return err;
501 kfree(encoder);
502 kfree(client);
504 return 0;
507 /* ----------------------------------------------------------------------- */
509 static struct i2c_driver i2c_driver_adv7175 = {
510 .driver = {
511 .name = "adv7175", /* name */
514 .id = I2C_DRIVERID_ADV7175,
516 .attach_adapter = adv7175_attach_adapter,
517 .detach_client = adv7175_detach_client,
518 .command = adv7175_command,
521 static int __init
522 adv7175_init (void)
524 return i2c_add_driver(&i2c_driver_adv7175);
527 static void __exit
528 adv7175_exit (void)
530 i2c_del_driver(&i2c_driver_adv7175);
533 module_init(adv7175_init);
534 module_exit(adv7175_exit);