2 * vpx3220a, vpx3216b & vpx3214c video decoder driver version 0.0.1
4 * Copyright (C) 2001 Laurent Pinchart <lpinchart@freegates.be>
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation; either version 2 of the License, or
9 * (at your option) any later version.
11 * This program is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 * GNU General Public License for more details.
16 * You should have received a copy of the GNU General Public License
17 * along with this program; if not, write to the Free Software
18 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
21 #include <linux/module.h>
22 #include <linux/init.h>
23 #include <linux/delay.h>
24 #include <linux/types.h>
25 #include <linux/slab.h>
27 #include <linux/byteorder/swab.h>
30 #include <asm/uaccess.h>
32 #include <linux/i2c.h>
33 #include <linux/i2c-dev.h>
35 #define I2C_NAME(x) (x)->name
37 #include <linux/videodev.h>
38 #include <linux/video_decoder.h>
40 #define I2C_VPX3220 0x86
41 #define VPX3220_DEBUG KERN_DEBUG "vpx3220: "
44 MODULE_PARM(debug
, "i");
45 MODULE_PARM_DESC(debug
, "Debug level (0-1)");
47 #define dprintk(num, format, args...) \
50 printk(format, ##args); \
53 #define VPX_TIMEOUT_COUNT 10
55 /* ----------------------------------------------------------------------- */
58 unsigned char reg
[255];
69 static char *inputs
[] = { "internal", "composite", "svideo" };
71 /* ----------------------------------------------------------------------- */
73 vpx3220_write (struct i2c_client
*client
,
77 struct vpx3220
*decoder
= i2c_get_clientdata(client
);
79 decoder
->reg
[reg
] = value
;
80 return i2c_smbus_write_byte_data(client
, reg
, value
);
84 vpx3220_read (struct i2c_client
*client
,
87 return i2c_smbus_read_byte_data(client
, reg
);
91 vpx3220_fp_status (struct i2c_client
*client
)
96 for (i
= 0; i
< VPX_TIMEOUT_COUNT
; i
++) {
97 status
= vpx3220_read(client
, 0x29);
112 vpx3220_fp_write (struct i2c_client
*client
,
116 /* Write the 16-bit address to the FPWR register */
117 if (i2c_smbus_write_word_data(client
, 0x27, swab16(fpaddr
)) == -1) {
118 dprintk(1, VPX3220_DEBUG
"%s: failed\n", __func__
);
122 if (vpx3220_fp_status(client
) < 0)
125 /* Write the 16-bit data to the FPDAT register */
126 if (i2c_smbus_write_word_data(client
, 0x28, swab16(data
)) == -1) {
127 dprintk(1, VPX3220_DEBUG
"%s: failed\n", __func__
);
135 vpx3220_fp_read (struct i2c_client
*client
,
140 /* Write the 16-bit address to the FPRD register */
141 if (i2c_smbus_write_word_data(client
, 0x26, swab16(fpaddr
)) == -1) {
142 dprintk(1, VPX3220_DEBUG
"%s: failed\n", __func__
);
146 if (vpx3220_fp_status(client
) < 0)
149 /* Read the 16-bit data from the FPDAT register */
150 data
= i2c_smbus_read_word_data(client
, 0x28);
152 dprintk(1, VPX3220_DEBUG
"%s: failed\n", __func__
);
160 vpx3220_write_block (struct i2c_client
*client
,
170 vpx3220_write(client
, reg
, *data
++)) < 0)
179 vpx3220_write_fp_block (struct i2c_client
*client
,
188 ret
|= vpx3220_fp_write(client
, reg
, *data
++);
195 /* ---------------------------------------------------------------------- */
197 static const unsigned short init_ntsc
[] = {
198 0x1c, 0x00, /* NTSC tint angle */
199 0x88, 17, /* Window 1 vertical */
200 0x89, 240, /* Vertical lines in */
201 0x8a, 240, /* Vertical lines out */
202 0x8b, 000, /* Horizontal begin */
203 0x8c, 640, /* Horizontal length */
204 0x8d, 640, /* Number of pixels */
205 0x8f, 0xc00, /* Disable window 2 */
206 0xf0, 0x173, /* 13.5 MHz transport, Forced
207 * mode, latch windows */
208 0xf2, 0x13, /* NTSC M, composite input */
209 0xe7, 0x1e1, /* Enable vertical standard
210 * locking @ 240 lines */
213 static const unsigned short init_pal
[] = {
214 0x88, 23, /* Window 1 vertical begin */
215 0x89, 288 + 16, /* Vertical lines in (16 lines
216 * skipped by the VFE) */
217 0x8a, 288 + 16, /* Vertical lines out (16 lines
218 * skipped by the VFE) */
219 0x8b, 16, /* Horizontal begin */
220 0x8c, 768, /* Horizontal length */
221 0x8d, 784, /* Number of pixels
222 * Must be >= Horizontal begin + Horizontal length */
223 0x8f, 0xc00, /* Disable window 2 */
224 0xf0, 0x177, /* 13.5 MHz transport, Forced
225 * mode, latch windows */
226 0xf2, 0x3d1, /* PAL B,G,H,I, composite input */
227 0xe7, 0x261, /* PAL/SECAM set to 288 + 16 lines
228 * change to 0x241 for 288 lines */
231 static const unsigned short init_secam
[] = {
232 0x88, 23 - 16, /* Window 1 vertical begin */
233 0x89, 288 + 16, /* Vertical lines in (16 lines
234 * skipped by the VFE) */
235 0x8a, 288 + 16, /* Vertical lines out (16 lines
236 * skipped by the VFE) */
237 0x8b, 16, /* Horizontal begin */
238 0x8c, 768, /* Horizontal length */
239 0x8d, 784, /* Number of pixels
240 * Must be >= Horizontal begin + Horizontal length */
241 0x8f, 0xc00, /* Disable window 2 */
242 0xf0, 0x177, /* 13.5 MHz transport, Forced
243 * mode, latch windows */
244 0xf2, 0x3d5, /* SECAM, composite input */
245 0xe7, 0x261, /* PAL/SECAM set to 288 + 16 lines
246 * change to 0x241 for 288 lines */
249 static const unsigned char init_common
[] = {
250 0xf2, 0x00, /* Disable all outputs */
251 0x33, 0x0d, /* Luma : VIN2, Chroma : CIN
253 0xd8, 0xa8, /* HREF/VREF active high, VREF
254 * pulse = 2, Odd/Even flag */
255 0x20, 0x03, /* IF compensation 0dB/oct */
256 0xe0, 0xff, /* Open up all comparators */
262 0xe6, 0x00, /* Brightness set to 0 */
263 0xe7, 0xe0, /* Contrast to 1.0, noise shaping
264 * 10 to 8 2-bit error diffusion */
265 0xe8, 0xf8, /* YUV422, CbCr binary offset,
267 0xea, 0x18, /* LLC2 connected, output FIFO
268 * reset with VACTintern */
269 0xf0, 0x8a, /* Half full level to 10, bus
270 * shuffler [7:0, 23:16, 15:8] */
271 0xf1, 0x18, /* Single clock, sync mode, no
272 * FE delay, no HLEN counter */
273 0xf8, 0x12, /* Port A, PIXCLK, HF# & FE#
275 0xf9, 0x24, /* Port B, HREF, VREF, PREF &
276 * ALPHA strength to 4 */
279 static const unsigned short init_fp
[] = {
281 0xa0, 2070, /* ACC reference */
289 0x4b, 0x298, /* PLL gain */
293 vpx3220_dump_i2c (struct i2c_client
*client
)
295 int len
= sizeof(init_common
);
296 const unsigned char *data
= init_common
;
300 KERN_DEBUG
"vpx3216b i2c reg 0x%02x data 0x%02x\n",
301 *data
, vpx3220_read(client
, *data
));
308 vpx3220_command (struct i2c_client
*client
,
312 struct vpx3220
*decoder
= i2c_get_clientdata(client
);
317 vpx3220_write_block(client
, init_common
,
318 sizeof(init_common
));
319 vpx3220_write_fp_block(client
, init_fp
,
320 sizeof(init_fp
) >> 1);
321 switch (decoder
->norm
) {
323 case VIDEO_MODE_NTSC
:
324 vpx3220_write_fp_block(client
, init_ntsc
,
325 sizeof(init_ntsc
) >> 1);
329 vpx3220_write_fp_block(client
, init_pal
,
330 sizeof(init_pal
) >> 1);
332 case VIDEO_MODE_SECAM
:
333 vpx3220_write_fp_block(client
, init_secam
,
334 sizeof(init_secam
) >> 1);
337 vpx3220_write_fp_block(client
, init_pal
,
338 sizeof(init_pal
) >> 1);
346 vpx3220_dump_i2c(client
);
350 case DECODER_GET_CAPABILITIES
:
352 struct video_decoder_capability
*cap
= arg
;
354 dprintk(1, KERN_DEBUG
"%s: DECODER_GET_CAPABILITIES\n",
357 cap
->flags
= VIDEO_DECODER_PAL
|
359 VIDEO_DECODER_SECAM
|
367 case DECODER_GET_STATUS
:
371 dprintk(1, KERN_INFO
"%s: DECODER_GET_STATUS\n",
374 status
= vpx3220_fp_read(client
, 0x0f3);
376 dprintk(1, KERN_INFO
"%s: status: 0x%04x\n", I2C_NAME(client
),
382 if ((status
& 0x20) == 0) {
383 res
|= DECODER_STATUS_GOOD
| DECODER_STATUS_COLOR
;
385 switch (status
& 0x18) {
391 res
|= DECODER_STATUS_PAL
;
395 res
|= DECODER_STATUS_SECAM
;
401 res
|= DECODER_STATUS_NTSC
;
410 case DECODER_SET_NORM
:
412 int *iarg
= arg
, data
;
414 dprintk(1, KERN_DEBUG
"%s: DECODER_SET_NORM %d\n",
415 I2C_NAME(client
), *iarg
);
418 case VIDEO_MODE_NTSC
:
419 vpx3220_write_fp_block(client
, init_ntsc
,
420 sizeof(init_ntsc
) >> 1);
421 dprintk(1, KERN_INFO
"%s: norm switched to NTSC\n",
426 vpx3220_write_fp_block(client
, init_pal
,
427 sizeof(init_pal
) >> 1);
428 dprintk(1, KERN_INFO
"%s: norm switched to PAL\n",
432 case VIDEO_MODE_SECAM
:
433 vpx3220_write_fp_block(client
, init_secam
,
434 sizeof(init_secam
) >> 1);
435 dprintk(1, KERN_INFO
"%s: norm switched to SECAM\n",
439 case VIDEO_MODE_AUTO
:
440 /* FIXME This is only preliminary support */
441 data
= vpx3220_fp_read(client
, 0xf2) & 0x20;
442 vpx3220_fp_write(client
, 0xf2, 0x00c0 | data
);
443 dprintk(1, KERN_INFO
"%s: norm switched to Auto\n",
451 decoder
->norm
= *iarg
;
455 case DECODER_SET_INPUT
:
457 int *iarg
= arg
, data
;
459 /* RJ: *iarg = 0: ST8 (PCTV) input
460 *iarg = 1: COMPOSITE input
461 *iarg = 2: SVHS input */
463 const int input
[3][2] = {
469 if (*iarg
< 0 || *iarg
> 2)
472 dprintk(1, KERN_INFO
"%s: input switched to %s\n",
473 I2C_NAME(client
), inputs
[*iarg
]);
475 vpx3220_write(client
, 0x33, input
[*iarg
][0]);
477 data
= vpx3220_fp_read(client
, 0xf2) & ~(0x0020);
480 /* 0x0010 is required to latch the setting */
481 vpx3220_fp_write(client
, 0xf2,
482 data
| (input
[*iarg
][1] << 5) | 0x0010);
488 case DECODER_SET_OUTPUT
:
492 /* not much choice of outputs */
499 case DECODER_ENABLE_OUTPUT
:
503 dprintk(1, KERN_DEBUG
"%s: DECODER_ENABLE_OUTPUT %d\n",
504 I2C_NAME(client
), *iarg
);
506 vpx3220_write(client
, 0xf2, (*iarg
? 0x1b : 0x00));
510 case DECODER_SET_PICTURE
:
512 struct video_picture
*pic
= arg
;
514 if (decoder
->bright
!= pic
->brightness
) {
515 /* We want -128 to 128 we get 0-65535 */
516 decoder
->bright
= pic
->brightness
;
517 vpx3220_write(client
, 0xe6,
518 (decoder
->bright
- 32768) >> 8);
520 if (decoder
->contrast
!= pic
->contrast
) {
521 /* We want 0 to 64 we get 0-65535 */
522 /* Bit 7 and 8 is for noise shaping */
523 decoder
->contrast
= pic
->contrast
;
524 vpx3220_write(client
, 0xe7,
525 (decoder
->contrast
>> 10) + 192);
527 if (decoder
->sat
!= pic
->colour
) {
528 /* We want 0 to 4096 we get 0-65535 */
529 decoder
->sat
= pic
->colour
;
530 vpx3220_fp_write(client
, 0xa0,
533 if (decoder
->hue
!= pic
->hue
) {
534 /* We want -512 to 512 we get 0-65535 */
535 decoder
->hue
= pic
->hue
;
536 vpx3220_fp_write(client
, 0x1c,
537 ((decoder
->hue
- 32768) >> 6) & 0xFFF);
550 vpx3220_init_client (struct i2c_client
*client
)
552 vpx3220_write_block(client
, init_common
, sizeof(init_common
));
553 vpx3220_write_fp_block(client
, init_fp
, sizeof(init_fp
) >> 1);
555 vpx3220_write_fp_block(client
, init_pal
, sizeof(init_pal
) >> 1);
560 /* -----------------------------------------------------------------------
561 * Client managment code
566 * concerning the addresses: i2c wants 7 bit (without the r/w bit), so '>>1'
568 static unsigned short normal_i2c
[] =
569 { I2C_VPX3220
>> 1, (I2C_VPX3220
>> 1) + 4,
572 static unsigned short normal_i2c_range
[] = { I2C_CLIENT_END
};
574 static unsigned short probe
[2] = { I2C_CLIENT_END
, I2C_CLIENT_END
};
575 static unsigned short probe_range
[2] = { I2C_CLIENT_END
, I2C_CLIENT_END
};
576 static unsigned short ignore
[2] = { I2C_CLIENT_END
, I2C_CLIENT_END
};
577 static unsigned short ignore_range
[2] = { I2C_CLIENT_END
, I2C_CLIENT_END
};
578 static unsigned short force
[2] = { I2C_CLIENT_END
, I2C_CLIENT_END
};
580 static struct i2c_client_address_data addr_data
= {
581 .normal_i2c
= normal_i2c
,
582 .normal_i2c_range
= normal_i2c_range
,
584 .probe_range
= probe_range
,
586 .ignore_range
= ignore_range
,
590 static int vpx3220_i2c_id
= 0;
591 static struct i2c_driver vpx3220_i2c_driver
;
594 vpx3220_detach_client (struct i2c_client
*client
)
596 struct vpx3220
*decoder
= i2c_get_clientdata(client
);
599 err
= i2c_detach_client(client
);
611 vpx3220_detect_client (struct i2c_adapter
*adapter
,
616 struct i2c_client
*client
;
617 struct vpx3220
*decoder
;
619 dprintk(1, VPX3220_DEBUG
"%s\n", __func__
);
621 /* Check if the adapter supports the needed features */
622 if (!i2c_check_functionality
623 (adapter
, I2C_FUNC_SMBUS_BYTE_DATA
| I2C_FUNC_SMBUS_WORD_DATA
))
626 client
= kmalloc(sizeof(struct i2c_client
), GFP_KERNEL
);
627 if (client
== NULL
) {
631 memset(client
, 0, sizeof(struct i2c_client
));
633 client
->addr
= address
;
634 client
->adapter
= adapter
;
635 client
->driver
= &vpx3220_i2c_driver
;
636 client
->flags
= I2C_CLIENT_ALLOW_USE
;
637 client
->id
= vpx3220_i2c_id
++;
639 /* Check for manufacture ID and part number */
644 id
= vpx3220_read(client
, 0x00);
648 "vpx3220_attach: Wrong manufacturer ID (0x%02x)\n",
654 pn
= (vpx3220_read(client
, 0x02) << 8) +
655 vpx3220_read(client
, 0x01);
658 snprintf(I2C_NAME(client
), sizeof(I2C_NAME(client
)) - 1,
659 "vpx3220a[%d]", client
->id
);
662 snprintf(I2C_NAME(client
), sizeof(I2C_NAME(client
)) - 1,
663 "vpx3216b[%d]", client
->id
);
666 snprintf(I2C_NAME(client
), sizeof(I2C_NAME(client
)) - 1,
667 "vpx3214c[%d]", client
->id
);
672 "%s: Wrong part number (0x%04x)\n",
678 snprintf(I2C_NAME(client
), sizeof(I2C_NAME(client
)) - 1,
679 "forced vpx32xx[%d]",
683 decoder
= kmalloc(sizeof(struct vpx3220
), GFP_KERNEL
);
684 if (decoder
== NULL
) {
688 memset(decoder
, 0, sizeof(struct vpx3220
));
689 decoder
->norm
= VIDEO_MODE_PAL
;
692 decoder
->bright
= 32768;
693 decoder
->contrast
= 32768;
694 decoder
->hue
= 32768;
695 decoder
->sat
= 32768;
696 i2c_set_clientdata(client
, decoder
);
698 err
= i2c_attach_client(client
);
705 dprintk(1, KERN_INFO
"%s: vpx32xx client found at address 0x%02x\n",
706 I2C_NAME(client
), client
->addr
<< 1);
708 vpx3220_init_client(client
);
714 vpx3220_attach_adapter (struct i2c_adapter
*adapter
)
718 ret
= i2c_probe(adapter
, &addr_data
, &vpx3220_detect_client
);
719 dprintk(1, VPX3220_DEBUG
"%s: i2c_probe returned %d\n",
724 /* -----------------------------------------------------------------------
725 * Driver initialization and cleanup code
728 static struct i2c_driver vpx3220_i2c_driver
= {
729 .owner
= THIS_MODULE
,
732 .id
= I2C_DRIVERID_VPX3220
,
733 .flags
= I2C_DF_NOTIFY
,
735 .attach_adapter
= vpx3220_attach_adapter
,
736 .detach_client
= vpx3220_detach_client
,
737 .command
= vpx3220_command
,
743 return i2c_add_driver(&vpx3220_i2c_driver
);
747 vpx3220_cleanup (void)
749 i2c_del_driver(&vpx3220_i2c_driver
);
752 module_init(vpx3220_init
);
753 module_exit(vpx3220_cleanup
);
755 MODULE_DESCRIPTION("vpx3220a/vpx3216b/vpx3214c video encoder driver");
756 MODULE_AUTHOR("Laurent Pinchart");
757 MODULE_LICENSE("GPL");