mirror of
https://github.com/edk2-porting/linux-next.git
synced 2024-12-27 22:53:55 +08:00
68cc9d0b71
On top of my previous patch which removes the use of address ranges in video i2c drivers, this one can save an additional few bytes of memory. Most of these drivers which do not use I2C_CLIENT_INSMOD initialize the unused address lists in a less than optimal way. This patch simply optimizes this, by using a single one-element list instead of 3 different lists with two elements each. This saves an average 63 bytes on these drivers. Signed-off-by: Jean Delvare <khali@linux-fr.org> Signed-off-by: Greg Kroah-Hartman <gregkh@suse.de> diff -ruN linux-2.6.12-rc1-bk5.orig/drivers/media/video/adv7170.c linux-2.6.12-rc1-bk5/drivers/media/video/adv7170.c
517 lines
12 KiB
C
517 lines
12 KiB
C
/*
|
|
* saa7185 - Philips SAA7185B video encoder driver version 0.0.3
|
|
*
|
|
* Copyright (C) 1998 Dave Perks <dperks@ibm.net>
|
|
*
|
|
* Slight changes for video timing and attachment output by
|
|
* Wolfgang Scherr <scherr@net4you.net>
|
|
*
|
|
* Changes by Ronald Bultje <rbultje@ronald.bitfreak.net>
|
|
* - 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 <linux/module.h>
|
|
#include <linux/init.h>
|
|
#include <linux/delay.h>
|
|
#include <linux/errno.h>
|
|
#include <linux/fs.h>
|
|
#include <linux/kernel.h>
|
|
#include <linux/major.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/mm.h>
|
|
#include <linux/pci.h>
|
|
#include <linux/signal.h>
|
|
#include <asm/io.h>
|
|
#include <asm/pgtable.h>
|
|
#include <asm/page.h>
|
|
#include <linux/sched.h>
|
|
#include <asm/segment.h>
|
|
#include <linux/types.h>
|
|
|
|
#include <linux/videodev.h>
|
|
#include <asm/uaccess.h>
|
|
|
|
MODULE_DESCRIPTION("Philips SAA7185 video encoder driver");
|
|
MODULE_AUTHOR("Dave Perks");
|
|
MODULE_LICENSE("GPL");
|
|
|
|
#include <linux/i2c.h>
|
|
#include <linux/i2c-dev.h>
|
|
|
|
#define I2C_NAME(s) (s)->name
|
|
|
|
#include <linux/video_encoder.h>
|
|
|
|
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);
|
|
struct i2c_msg msg;
|
|
u8 block_data[32];
|
|
|
|
msg.addr = client->addr;
|
|
msg.flags = 0;
|
|
while (len >= 2) {
|
|
msg.buf = (char *) block_data;
|
|
msg.len = 0;
|
|
block_data[msg.len++] = reg = data[0];
|
|
do {
|
|
block_data[msg.len++] =
|
|
encoder->reg[reg++] = data[1];
|
|
len -= 2;
|
|
data += 2;
|
|
} while (len >= 2 && data[0] == reg &&
|
|
msg.len < 32);
|
|
if ((ret = i2c_transfer(client->adapter,
|
|
&msg, 1)) < 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,
|
|
.force = &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 = kmalloc(sizeof(struct i2c_client), GFP_KERNEL);
|
|
if (client == 0)
|
|
return -ENOMEM;
|
|
memset(client, 0, sizeof(struct i2c_client));
|
|
client->addr = address;
|
|
client->adapter = adapter;
|
|
client->driver = &i2c_driver_saa7185;
|
|
client->flags = I2C_CLIENT_ALLOW_USE;
|
|
strlcpy(I2C_NAME(client), "saa7185", sizeof(I2C_NAME(client)));
|
|
|
|
encoder = kmalloc(sizeof(struct saa7185), GFP_KERNEL);
|
|
if (encoder == NULL) {
|
|
kfree(client);
|
|
return -ENOMEM;
|
|
}
|
|
memset(encoder, 0, sizeof(struct saa7185));
|
|
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 = {
|
|
.owner = THIS_MODULE,
|
|
.name = "saa7185", /* name */
|
|
|
|
.id = I2C_DRIVERID_SAA7185B,
|
|
.flags = I2C_DF_NOTIFY,
|
|
|
|
.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);
|