/* * saa7185 - Philips SAA7185B video encoder driver version 0.0.3 * * Copyright (C) 1998 Dave Perks * * Slight changes for video timing and attachment output by * Wolfgang Scherr * * Changes by Ronald Bultje * - moved over to linux>=2.4.x i2c protocol (1/1/2003) * * 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. */ #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include MODULE_DESCRIPTION("Philips SAA7185 video encoder driver"); MODULE_AUTHOR("Dave Perks"); MODULE_LICENSE("GPL"); #include #define I2C_NAME(s) (s)->name #include static int debug = 0; module_param(debug, int, 0); MODULE_PARM_DESC(debug, "Debug level (0-1)"); #define dprintk(num, format, args...) \ do { \ if (debug >= num) \ printk(format, ##args); \ } while (0) /* ----------------------------------------------------------------------- */ struct saa7185 { unsigned char reg[128]; int norm; int enable; int bright; int contrast; int hue; int sat; }; #define I2C_SAA7185 0x88 /* ----------------------------------------------------------------------- */ static inline int saa7185_read (struct i2c_client *client) { return i2c_smbus_read_byte(client); } static int saa7185_write (struct i2c_client *client, u8 reg, u8 value) { struct saa7185 *encoder = i2c_get_clientdata(client); dprintk(1, KERN_DEBUG "SAA7185: %02x set to %02x\n", reg, value); encoder->reg[reg] = value; return i2c_smbus_write_byte_data(client, reg, value); } static int saa7185_write_block (struct i2c_client *client, const u8 *data, unsigned int len) { int ret = -1; u8 reg; /* the adv7175 has an autoincrement function, use it if * the adapter understands raw I2C */ if (i2c_check_functionality(client->adapter, I2C_FUNC_I2C)) { /* do raw I2C, not smbus compatible */ struct saa7185 *encoder = i2c_get_clientdata(client); u8 block_data[32]; int block_len; while (len >= 2) { block_len = 0; block_data[block_len++] = reg = data[0]; do { block_data[block_len++] = encoder->reg[reg++] = data[1]; len -= 2; data += 2; } while (len >= 2 && data[0] == reg && block_len < 32); if ((ret = i2c_master_send(client, block_data, block_len)) < 0) break; } } else { /* do some slow I2C emulation kind of thing */ while (len >= 2) { reg = *data++; if ((ret = saa7185_write(client, reg, *data++)) < 0) break; len -= 2; } } return ret; } /* ----------------------------------------------------------------------- */ static const unsigned char init_common[] = { 0x3a, 0x0f, /* CBENB=0, V656=0, VY2C=1, * YUV2C=1, MY2C=1, MUV2C=1 */ 0x42, 0x6b, /* OVLY0=107 */ 0x43, 0x00, /* OVLU0=0 white */ 0x44, 0x00, /* OVLV0=0 */ 0x45, 0x22, /* OVLY1=34 */ 0x46, 0xac, /* OVLU1=172 yellow */ 0x47, 0x0e, /* OVLV1=14 */ 0x48, 0x03, /* OVLY2=3 */ 0x49, 0x1d, /* OVLU2=29 cyan */ 0x4a, 0xac, /* OVLV2=172 */ 0x4b, 0xf0, /* OVLY3=240 */ 0x4c, 0xc8, /* OVLU3=200 green */ 0x4d, 0xb9, /* OVLV3=185 */ 0x4e, 0xd4, /* OVLY4=212 */ 0x4f, 0x38, /* OVLU4=56 magenta */ 0x50, 0x47, /* OVLV4=71 */ 0x51, 0xc1, /* OVLY5=193 */ 0x52, 0xe3, /* OVLU5=227 red */ 0x53, 0x54, /* OVLV5=84 */ 0x54, 0xa3, /* OVLY6=163 */ 0x55, 0x54, /* OVLU6=84 blue */ 0x56, 0xf2, /* OVLV6=242 */ 0x57, 0x90, /* OVLY7=144 */ 0x58, 0x00, /* OVLU7=0 black */ 0x59, 0x00, /* OVLV7=0 */ 0x5a, 0x00, /* CHPS=0 */ 0x5b, 0x76, /* GAINU=118 */ 0x5c, 0xa5, /* GAINV=165 */ 0x5d, 0x3c, /* BLCKL=60 */ 0x5e, 0x3a, /* BLNNL=58 */ 0x5f, 0x3a, /* CCRS=0, BLNVB=58 */ 0x60, 0x00, /* NULL */ /* 0x61 - 0x66 set according to norm */ 0x67, 0x00, /* 0 : caption 1st byte odd field */ 0x68, 0x00, /* 0 : caption 2nd byte odd field */ 0x69, 0x00, /* 0 : caption 1st byte even field */ 0x6a, 0x00, /* 0 : caption 2nd byte even field */ 0x6b, 0x91, /* MODIN=2, PCREF=0, SCCLN=17 */ 0x6c, 0x20, /* SRCV1=0, TRCV2=1, ORCV1=0, PRCV1=0, * CBLF=0, ORCV2=0, PRCV2=0 */ 0x6d, 0x00, /* SRCM1=0, CCEN=0 */ 0x6e, 0x0e, /* HTRIG=0x005, approx. centered, at * least for PAL */ 0x6f, 0x00, /* HTRIG upper bits */ 0x70, 0x20, /* PHRES=0, SBLN=1, VTRIG=0 */ /* The following should not be needed */ 0x71, 0x15, /* BMRQ=0x115 */ 0x72, 0x90, /* EMRQ=0x690 */ 0x73, 0x61, /* EMRQ=0x690, BMRQ=0x115 */ 0x74, 0x00, /* NULL */ 0x75, 0x00, /* NULL */ 0x76, 0x00, /* NULL */ 0x77, 0x15, /* BRCV=0x115 */ 0x78, 0x90, /* ERCV=0x690 */ 0x79, 0x61, /* ERCV=0x690, BRCV=0x115 */ /* Field length controls */ 0x7a, 0x70, /* FLC=0 */ /* The following should not be needed if SBLN = 1 */ 0x7b, 0x16, /* FAL=22 */ 0x7c, 0x35, /* LAL=244 */ 0x7d, 0x20, /* LAL=244, FAL=22 */ }; static const unsigned char init_pal[] = { 0x61, 0x1e, /* FISE=0, PAL=1, SCBW=1, RTCE=1, * YGS=1, INPI=0, DOWN=0 */ 0x62, 0xc8, /* DECTYP=1, BSTA=72 */ 0x63, 0xcb, /* FSC0 */ 0x64, 0x8a, /* FSC1 */ 0x65, 0x09, /* FSC2 */ 0x66, 0x2a, /* FSC3 */ }; static const unsigned char init_ntsc[] = { 0x61, 0x1d, /* FISE=1, PAL=0, SCBW=1, RTCE=1, * YGS=1, INPI=0, DOWN=0 */ 0x62, 0xe6, /* DECTYP=1, BSTA=102 */ 0x63, 0x1f, /* FSC0 */ 0x64, 0x7c, /* FSC1 */ 0x65, 0xf0, /* FSC2 */ 0x66, 0x21, /* FSC3 */ }; static int saa7185_command (struct i2c_client *client, unsigned int cmd, void *arg) { struct saa7185 *encoder = i2c_get_clientdata(client); switch (cmd) { case 0: saa7185_write_block(client, init_common, sizeof(init_common)); switch (encoder->norm) { case VIDEO_MODE_NTSC: saa7185_write_block(client, init_ntsc, sizeof(init_ntsc)); break; case VIDEO_MODE_PAL: saa7185_write_block(client, init_pal, sizeof(init_pal)); break; } break; case ENCODER_GET_CAPABILITIES: { struct video_encoder_capability *cap = arg; cap->flags = VIDEO_ENCODER_PAL | VIDEO_ENCODER_NTSC | VIDEO_ENCODER_SECAM | VIDEO_ENCODER_CCIR; cap->inputs = 1; cap->outputs = 1; } break; case ENCODER_SET_NORM: { int *iarg = arg; //saa7185_write_block(client, init_common, sizeof(init_common)); switch (*iarg) { case VIDEO_MODE_NTSC: saa7185_write_block(client, init_ntsc, sizeof(init_ntsc)); break; case VIDEO_MODE_PAL: saa7185_write_block(client, init_pal, sizeof(init_pal)); break; case VIDEO_MODE_SECAM: default: return -EINVAL; } encoder->norm = *iarg; } break; case ENCODER_SET_INPUT: { int *iarg = arg; /* RJ: *iarg = 0: input is from SA7111 *iarg = 1: input is from ZR36060 */ switch (*iarg) { case 0: /* Switch RTCE to 1 */ saa7185_write(client, 0x61, (encoder->reg[0x61] & 0xf7) | 0x08); saa7185_write(client, 0x6e, 0x01); break; case 1: /* Switch RTCE to 0 */ saa7185_write(client, 0x61, (encoder->reg[0x61] & 0xf7) | 0x00); /* SW: a slight sync problem... */ saa7185_write(client, 0x6e, 0x00); break; default: return -EINVAL; } } break; case ENCODER_SET_OUTPUT: { int *iarg = arg; /* not much choice of outputs */ if (*iarg != 0) { return -EINVAL; } } break; case ENCODER_ENABLE_OUTPUT: { int *iarg = arg; encoder->enable = !!*iarg; saa7185_write(client, 0x61, (encoder->reg[0x61] & 0xbf) | (encoder->enable ? 0x00 : 0x40)); } break; default: return -EINVAL; } return 0; } /* ----------------------------------------------------------------------- */ /* * Generic i2c probe * concerning the addresses: i2c wants 7 bit (without the r/w bit), so '>>1' */ static unsigned short normal_i2c[] = { I2C_SAA7185 >> 1, I2C_CLIENT_END }; static unsigned short ignore = I2C_CLIENT_END; static struct i2c_client_address_data addr_data = { .normal_i2c = normal_i2c, .probe = &ignore, .ignore = &ignore, }; static struct i2c_driver i2c_driver_saa7185; static int saa7185_detect_client (struct i2c_adapter *adapter, int address, int kind) { int i; struct i2c_client *client; struct saa7185 *encoder; dprintk(1, KERN_INFO "saa7185.c: detecting saa7185 client on address 0x%x\n", address << 1); /* Check if the adapter supports the needed features */ if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA)) return 0; client = kzalloc(sizeof(struct i2c_client), GFP_KERNEL); if (client == 0) return -ENOMEM; client->addr = address; client->adapter = adapter; client->driver = &i2c_driver_saa7185; strlcpy(I2C_NAME(client), "saa7185", sizeof(I2C_NAME(client))); encoder = kzalloc(sizeof(struct saa7185), GFP_KERNEL); if (encoder == NULL) { kfree(client); return -ENOMEM; } encoder->norm = VIDEO_MODE_NTSC; encoder->enable = 1; i2c_set_clientdata(client, encoder); i = i2c_attach_client(client); if (i) { kfree(client); kfree(encoder); return i; } i = saa7185_write_block(client, init_common, sizeof(init_common)); if (i >= 0) { i = saa7185_write_block(client, init_ntsc, sizeof(init_ntsc)); } if (i < 0) { dprintk(1, KERN_ERR "%s_attach: init error %d\n", I2C_NAME(client), i); } else { dprintk(1, KERN_INFO "%s_attach: chip version %d at address 0x%x\n", I2C_NAME(client), saa7185_read(client) >> 5, client->addr << 1); } return 0; } static int saa7185_attach_adapter (struct i2c_adapter *adapter) { dprintk(1, KERN_INFO "saa7185.c: starting probe for adapter %s (0x%x)\n", I2C_NAME(adapter), adapter->id); return i2c_probe(adapter, &addr_data, &saa7185_detect_client); } static int saa7185_detach_client (struct i2c_client *client) { struct saa7185 *encoder = i2c_get_clientdata(client); int err; err = i2c_detach_client(client); if (err) { return err; } saa7185_write(client, 0x61, (encoder->reg[0x61]) | 0x40); /* SW: output off is active */ //saa7185_write(client, 0x3a, (encoder->reg[0x3a]) | 0x80); /* SW: color bar */ kfree(encoder); kfree(client); return 0; } /* ----------------------------------------------------------------------- */ static struct i2c_driver i2c_driver_saa7185 = { .driver = { .name = "saa7185", /* name */ }, .id = I2C_DRIVERID_SAA7185B, .attach_adapter = saa7185_attach_adapter, .detach_client = saa7185_detach_client, .command = saa7185_command, }; static int __init saa7185_init (void) { return i2c_add_driver(&i2c_driver_saa7185); } static void __exit saa7185_exit (void) { i2c_del_driver(&i2c_driver_saa7185); } module_init(saa7185_init); module_exit(saa7185_exit);