![Jean Delvare](/assets/img/avatar_default.png)
Some months ago, you killed the address ranges mechanism from all sensors i2c chip drivers (both the module parameters and the in-code address lists). I think it was a very good move, as the ranges can easily be replaced by individual addresses, and this allowed for significant cleanups in the i2c core (let alone the impressive size shrink for all these drivers). Unfortunately you did not do the same for non-sensors i2c chip drivers. These need the address ranges even less, so we could get rid of the ranges here as well for another significant i2c core cleanup. Here comes a patch which does just that. Since the process is exactly the same as what you did for the other drivers set already, I did not split this one in parts. A documentation update is included. The change saves 308 bytes in the i2c core, and an average 1382 bytes for chip drivers which use I2C_CLIENT_INSMOD, 126 bytes for those which do not. This change is required if we want to merge the sensors and non-sensors i2c code (and we want to do this). Signed-off-by: Jean Delvare <khali@linux-fr.org> Signed-off-by: Greg Kroah-Hartman <gregkh@suse.de> Index: gregkh-2.6/Documentation/i2c/writing-clients ===================================================================
423 lines
12 KiB
C
423 lines
12 KiB
C
/*
|
|
* For the TDA9875 chip
|
|
* (The TDA9875 is used on the Diamond DTV2000 french version
|
|
* Other cards probably use these chips as well.)
|
|
* This driver will not complain if used with any
|
|
* other i2c device with the same address.
|
|
*
|
|
* Copyright (c) 2000 Guillaume Delvit based on Gerd Knorr source and
|
|
* Eric Sandeen
|
|
* This code is placed under the terms of the GNU General Public License
|
|
* Based on tda9855.c by Steve VanDeBogart (vandebo@uclink.berkeley.edu)
|
|
* Which was based on tda8425.c by Greg Alexander (c) 1998
|
|
*
|
|
* OPTIONS:
|
|
* debug - set to 1 if you'd like to see debug messages
|
|
*
|
|
* Revision: 0.1 - original version
|
|
*/
|
|
|
|
#include <linux/module.h>
|
|
#include <linux/kernel.h>
|
|
#include <linux/sched.h>
|
|
#include <linux/string.h>
|
|
#include <linux/timer.h>
|
|
#include <linux/delay.h>
|
|
#include <linux/errno.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/videodev.h>
|
|
#include <linux/i2c.h>
|
|
#include <linux/i2c-algo-bit.h>
|
|
#include <linux/init.h>
|
|
|
|
#include "bttv.h"
|
|
#include <media/audiochip.h>
|
|
#include <media/id.h>
|
|
|
|
static int debug; /* insmod parameter */
|
|
module_param(debug, int, S_IRUGO | S_IWUSR);
|
|
MODULE_LICENSE("GPL");
|
|
|
|
|
|
/* Addresses to scan */
|
|
static unsigned short normal_i2c[] = {
|
|
I2C_TDA9875 >> 1,
|
|
I2C_CLIENT_END
|
|
};
|
|
I2C_CLIENT_INSMOD;
|
|
|
|
/* This is a superset of the TDA9875 */
|
|
struct tda9875 {
|
|
int mode;
|
|
int rvol, lvol;
|
|
int bass, treble;
|
|
struct i2c_client c;
|
|
};
|
|
|
|
static struct i2c_driver driver;
|
|
static struct i2c_client client_template;
|
|
|
|
#define dprintk if (debug) printk
|
|
|
|
/* The TDA9875 is made by Philips Semiconductor
|
|
* http://www.semiconductors.philips.com
|
|
* TDA9875: I2C-bus controlled DSP audio processor, FM demodulator
|
|
*
|
|
*/
|
|
|
|
/* subaddresses for TDA9875 */
|
|
#define TDA9875_MUT 0x12 /*General mute (value --> 0b11001100*/
|
|
#define TDA9875_CFG 0x01 /* Config register (value --> 0b00000000 */
|
|
#define TDA9875_DACOS 0x13 /*DAC i/o select (ADC) 0b0000100*/
|
|
#define TDA9875_LOSR 0x16 /*Line output select regirter 0b0100 0001*/
|
|
|
|
#define TDA9875_CH1V 0x0c /*Channel 1 volume (mute)*/
|
|
#define TDA9875_CH2V 0x0d /*Channel 2 volume (mute)*/
|
|
#define TDA9875_SC1 0x14 /*SCART 1 in (mono)*/
|
|
#define TDA9875_SC2 0x15 /*SCART 2 in (mono)*/
|
|
|
|
#define TDA9875_ADCIS 0x17 /*ADC input select (mono) 0b0110 000*/
|
|
#define TDA9875_AER 0x19 /*Audio effect (AVL+Pseudo) 0b0000 0110*/
|
|
#define TDA9875_MCS 0x18 /*Main channel select (DAC) 0b0000100*/
|
|
#define TDA9875_MVL 0x1a /* Main volume gauche */
|
|
#define TDA9875_MVR 0x1b /* Main volume droite */
|
|
#define TDA9875_MBA 0x1d /* Main Basse */
|
|
#define TDA9875_MTR 0x1e /* Main treble */
|
|
#define TDA9875_ACS 0x1f /* Auxilary channel select (FM) 0b0000000*/
|
|
#define TDA9875_AVL 0x20 /* Auxilary volume gauche */
|
|
#define TDA9875_AVR 0x21 /* Auxilary volume droite */
|
|
#define TDA9875_ABA 0x22 /* Auxilary Basse */
|
|
#define TDA9875_ATR 0x23 /* Auxilary treble */
|
|
|
|
#define TDA9875_MSR 0x02 /* Monitor select register */
|
|
#define TDA9875_C1MSB 0x03 /* Carrier 1 (FM) frequency register MSB */
|
|
#define TDA9875_C1MIB 0x04 /* Carrier 1 (FM) frequency register (16-8]b */
|
|
#define TDA9875_C1LSB 0x05 /* Carrier 1 (FM) frequency register LSB */
|
|
#define TDA9875_C2MSB 0x06 /* Carrier 2 (nicam) frequency register MSB */
|
|
#define TDA9875_C2MIB 0x07 /* Carrier 2 (nicam) frequency register (16-8]b */
|
|
#define TDA9875_C2LSB 0x08 /* Carrier 2 (nicam) frequency register LSB */
|
|
#define TDA9875_DCR 0x09 /* Demodulateur configuration regirter*/
|
|
#define TDA9875_DEEM 0x0a /* FM de-emphasis regirter*/
|
|
#define TDA9875_FMAT 0x0b /* FM Matrix regirter*/
|
|
|
|
/* values */
|
|
#define TDA9875_MUTE_ON 0xff /* general mute */
|
|
#define TDA9875_MUTE_OFF 0xcc /* general no mute */
|
|
|
|
|
|
|
|
/* Begin code */
|
|
|
|
static int tda9875_write(struct i2c_client *client, int subaddr, unsigned char val)
|
|
{
|
|
unsigned char buffer[2];
|
|
dprintk("In tda9875_write\n");
|
|
dprintk("Writing %d 0x%x\n", subaddr, val);
|
|
buffer[0] = subaddr;
|
|
buffer[1] = val;
|
|
if (2 != i2c_master_send(client,buffer,2)) {
|
|
printk(KERN_WARNING "tda9875: I/O error, trying (write %d 0x%x)\n",
|
|
subaddr, val);
|
|
return -1;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
#if 0
|
|
static int tda9875_read(struct i2c_client *client)
|
|
{
|
|
unsigned char buffer;
|
|
dprintk("In tda9875_read\n");
|
|
if (1 != i2c_master_recv(client,&buffer,1)) {
|
|
printk(KERN_WARNING "tda9875: I/O error, trying (read)\n");
|
|
return -1;
|
|
}
|
|
dprintk("Read 0x%02x\n", buffer);
|
|
return buffer;
|
|
}
|
|
#endif
|
|
|
|
static int i2c_read_register(struct i2c_adapter *adap, int addr, int reg)
|
|
{
|
|
unsigned char write[1];
|
|
unsigned char read[1];
|
|
struct i2c_msg msgs[2] = {
|
|
{ addr, 0, 1, write },
|
|
{ addr, I2C_M_RD, 1, read }
|
|
};
|
|
write[0] = reg;
|
|
|
|
if (2 != i2c_transfer(adap,msgs,2)) {
|
|
printk(KERN_WARNING "tda9875: I/O error (read2)\n");
|
|
return -1;
|
|
}
|
|
dprintk("tda9875: chip_read2: reg%d=0x%x\n",reg,read[0]);
|
|
return read[0];
|
|
}
|
|
|
|
static void tda9875_set(struct i2c_client *client)
|
|
{
|
|
struct tda9875 *tda = i2c_get_clientdata(client);
|
|
unsigned char a;
|
|
|
|
dprintk(KERN_DEBUG "tda9875_set(%04x,%04x,%04x,%04x)\n",
|
|
tda->lvol,tda->rvol,tda->bass,tda->treble);
|
|
|
|
|
|
a = tda->lvol & 0xff;
|
|
tda9875_write(client, TDA9875_MVL, a);
|
|
a =tda->rvol & 0xff;
|
|
tda9875_write(client, TDA9875_MVR, a);
|
|
a =tda->bass & 0xff;
|
|
tda9875_write(client, TDA9875_MBA, a);
|
|
a =tda->treble & 0xff;
|
|
tda9875_write(client, TDA9875_MTR, a);
|
|
}
|
|
|
|
static void do_tda9875_init(struct i2c_client *client)
|
|
{
|
|
struct tda9875 *t = i2c_get_clientdata(client);
|
|
dprintk("In tda9875_init\n");
|
|
tda9875_write(client, TDA9875_CFG, 0xd0 ); /*reg de config 0 (reset)*/
|
|
tda9875_write(client, TDA9875_MSR, 0x03 ); /* Monitor 0b00000XXX*/
|
|
tda9875_write(client, TDA9875_C1MSB, 0x00 ); /*Car1(FM) MSB XMHz*/
|
|
tda9875_write(client, TDA9875_C1MIB, 0x00 ); /*Car1(FM) MIB XMHz*/
|
|
tda9875_write(client, TDA9875_C1LSB, 0x00 ); /*Car1(FM) LSB XMHz*/
|
|
tda9875_write(client, TDA9875_C2MSB, 0x00 ); /*Car2(NICAM) MSB XMHz*/
|
|
tda9875_write(client, TDA9875_C2MIB, 0x00 ); /*Car2(NICAM) MIB XMHz*/
|
|
tda9875_write(client, TDA9875_C2LSB, 0x00 ); /*Car2(NICAM) LSB XMHz*/
|
|
tda9875_write(client, TDA9875_DCR, 0x00 ); /*Demod config 0x00*/
|
|
tda9875_write(client, TDA9875_DEEM, 0x44 ); /*DE-Emph 0b0100 0100*/
|
|
tda9875_write(client, TDA9875_FMAT, 0x00 ); /*FM Matrix reg 0x00*/
|
|
tda9875_write(client, TDA9875_SC1, 0x00 ); /* SCART 1 (SC1)*/
|
|
tda9875_write(client, TDA9875_SC2, 0x01 ); /* SCART 2 (sc2)*/
|
|
|
|
tda9875_write(client, TDA9875_CH1V, 0x10 ); /* Channel volume 1 mute*/
|
|
tda9875_write(client, TDA9875_CH2V, 0x10 ); /* Channel volume 2 mute */
|
|
tda9875_write(client, TDA9875_DACOS, 0x02 ); /* sig DAC i/o(in:nicam)*/
|
|
tda9875_write(client, TDA9875_ADCIS, 0x6f ); /* sig ADC input(in:mono)*/
|
|
tda9875_write(client, TDA9875_LOSR, 0x00 ); /* line out (in:mono)*/
|
|
tda9875_write(client, TDA9875_AER, 0x00 ); /*06 Effect (AVL+PSEUDO) */
|
|
tda9875_write(client, TDA9875_MCS, 0x44 ); /* Main ch select (DAC) */
|
|
tda9875_write(client, TDA9875_MVL, 0x03 ); /* Vol Main left 10dB */
|
|
tda9875_write(client, TDA9875_MVR, 0x03 ); /* Vol Main right 10dB*/
|
|
tda9875_write(client, TDA9875_MBA, 0x00 ); /* Main Bass Main 0dB*/
|
|
tda9875_write(client, TDA9875_MTR, 0x00 ); /* Main Treble Main 0dB*/
|
|
tda9875_write(client, TDA9875_ACS, 0x44 ); /* Aux chan select (dac)*/
|
|
tda9875_write(client, TDA9875_AVL, 0x00 ); /* Vol Aux left 0dB*/
|
|
tda9875_write(client, TDA9875_AVR, 0x00 ); /* Vol Aux right 0dB*/
|
|
tda9875_write(client, TDA9875_ABA, 0x00 ); /* Aux Bass Main 0dB*/
|
|
tda9875_write(client, TDA9875_ATR, 0x00 ); /* Aux Aigus Main 0dB*/
|
|
|
|
tda9875_write(client, TDA9875_MUT, 0xcc ); /* General mute */
|
|
|
|
t->mode=AUDIO_UNMUTE;
|
|
t->lvol=t->rvol =0; /* 0dB */
|
|
t->bass=0; /* 0dB */
|
|
t->treble=0; /* 0dB */
|
|
tda9875_set(client);
|
|
|
|
}
|
|
|
|
|
|
/* *********************** *
|
|
* i2c interface functions *
|
|
* *********************** */
|
|
|
|
static int tda9875_checkit(struct i2c_adapter *adap, int addr)
|
|
{
|
|
int dic,rev;
|
|
|
|
dic=i2c_read_register(adap,addr,254);
|
|
rev=i2c_read_register(adap,addr,255);
|
|
|
|
if(dic==0 || dic==2) { // tda9875 and tda9875A
|
|
printk("tda9875: TDA9875%s Rev.%d detected at 0x%x\n",
|
|
dic==0?"":"A", rev,addr<<1);
|
|
return 1;
|
|
}
|
|
printk("tda9875: no such chip at 0x%x (dic=0x%x rev=0x%x)\n",addr<<1,dic,rev);
|
|
return(0);
|
|
}
|
|
|
|
static int tda9875_attach(struct i2c_adapter *adap, int addr, int kind)
|
|
{
|
|
struct tda9875 *t;
|
|
struct i2c_client *client;
|
|
dprintk("In tda9875_attach\n");
|
|
|
|
t = kmalloc(sizeof *t,GFP_KERNEL);
|
|
if (!t)
|
|
return -ENOMEM;
|
|
memset(t,0,sizeof *t);
|
|
|
|
client = &t->c;
|
|
memcpy(client,&client_template,sizeof(struct i2c_client));
|
|
client->adapter = adap;
|
|
client->addr = addr;
|
|
i2c_set_clientdata(client, t);
|
|
|
|
if(!tda9875_checkit(adap,addr)) {
|
|
kfree(t);
|
|
return 1;
|
|
}
|
|
|
|
do_tda9875_init(client);
|
|
printk(KERN_INFO "tda9875: init\n");
|
|
|
|
i2c_attach_client(client);
|
|
return 0;
|
|
}
|
|
|
|
static int tda9875_probe(struct i2c_adapter *adap)
|
|
{
|
|
#ifdef I2C_CLASS_TV_ANALOG
|
|
if (adap->class & I2C_CLASS_TV_ANALOG)
|
|
return i2c_probe(adap, &addr_data, tda9875_attach);
|
|
#else
|
|
if (adap->id == (I2C_ALGO_BIT | I2C_HW_B_BT848))
|
|
return i2c_probe(adap, &addr_data, tda9875_attach);
|
|
#endif
|
|
return 0;
|
|
}
|
|
|
|
static int tda9875_detach(struct i2c_client *client)
|
|
{
|
|
struct tda9875 *t = i2c_get_clientdata(client);
|
|
|
|
do_tda9875_init(client);
|
|
i2c_detach_client(client);
|
|
|
|
kfree(t);
|
|
return 0;
|
|
}
|
|
|
|
static int tda9875_command(struct i2c_client *client,
|
|
unsigned int cmd, void *arg)
|
|
{
|
|
struct tda9875 *t = i2c_get_clientdata(client);
|
|
|
|
dprintk("In tda9875_command...\n");
|
|
|
|
switch (cmd) {
|
|
/* --- v4l ioctls --- */
|
|
/* take care: bttv does userspace copying, we'll get a
|
|
kernel pointer here... */
|
|
case VIDIOCGAUDIO:
|
|
{
|
|
struct video_audio *va = arg;
|
|
int left,right;
|
|
|
|
dprintk("VIDIOCGAUDIO\n");
|
|
|
|
va->flags |= VIDEO_AUDIO_VOLUME |
|
|
VIDEO_AUDIO_BASS |
|
|
VIDEO_AUDIO_TREBLE;
|
|
|
|
/* min is -84 max is 24 */
|
|
left = (t->lvol+84)*606;
|
|
right = (t->rvol+84)*606;
|
|
va->volume=max(left,right);
|
|
va->balance=(32768*min(left,right))/
|
|
(va->volume ? va->volume : 1);
|
|
va->balance=(left<right)?
|
|
(65535-va->balance) : va->balance;
|
|
va->bass = (t->bass+12)*2427; /* min -12 max +15 */
|
|
va->treble = (t->treble+12)*2730;/* min -12 max +12 */
|
|
va->mode |= VIDEO_SOUND_MONO;
|
|
|
|
break; /* VIDIOCGAUDIO case */
|
|
}
|
|
|
|
case VIDIOCSAUDIO:
|
|
{
|
|
struct video_audio *va = arg;
|
|
int left,right;
|
|
|
|
dprintk("VIDEOCSAUDIO...\n");
|
|
left = (min(65536 - va->balance,32768) *
|
|
va->volume) / 32768;
|
|
right = (min(va->balance,(__u16)32768) *
|
|
va->volume) / 32768;
|
|
t->lvol = ((left/606)-84) & 0xff;
|
|
if (t->lvol > 24)
|
|
t->lvol = 24;
|
|
if (t->lvol < -84)
|
|
t->lvol = -84 & 0xff;
|
|
|
|
t->rvol = ((right/606)-84) & 0xff;
|
|
if (t->rvol > 24)
|
|
t->rvol = 24;
|
|
if (t->rvol < -84)
|
|
t->rvol = -84 & 0xff;
|
|
|
|
t->bass = ((va->bass/2400)-12) & 0xff;
|
|
if (t->bass > 15)
|
|
t->bass = 15;
|
|
if (t->bass < -12)
|
|
t->bass = -12 & 0xff;
|
|
|
|
t->treble = ((va->treble/2700)-12) & 0xff;
|
|
if (t->treble > 12)
|
|
t->treble = 12;
|
|
if (t->treble < -12)
|
|
t->treble = -12 & 0xff;
|
|
|
|
|
|
|
|
//printk("tda9875 bal:%04x vol:%04x bass:%04x treble:%04x\n",va->balance,va->volume,va->bass,va->treble);
|
|
|
|
|
|
tda9875_set(client);
|
|
|
|
break;
|
|
|
|
} /* end of VIDEOCSAUDIO case */
|
|
|
|
default: /* Not VIDEOCGAUDIO or VIDEOCSAUDIO */
|
|
|
|
/* nothing */
|
|
dprintk("Default\n");
|
|
|
|
} /* end of (cmd) switch */
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
static struct i2c_driver driver = {
|
|
.owner = THIS_MODULE,
|
|
.name = "i2c tda9875 driver",
|
|
.id = I2C_DRIVERID_TDA9875,
|
|
.flags = I2C_DF_NOTIFY,
|
|
.attach_adapter = tda9875_probe,
|
|
.detach_client = tda9875_detach,
|
|
.command = tda9875_command,
|
|
};
|
|
|
|
static struct i2c_client client_template =
|
|
{
|
|
I2C_DEVNAME("tda9875"),
|
|
.driver = &driver,
|
|
};
|
|
|
|
static int __init tda9875_init(void)
|
|
{
|
|
return i2c_add_driver(&driver);
|
|
}
|
|
|
|
static void __exit tda9875_fini(void)
|
|
{
|
|
i2c_del_driver(&driver);
|
|
}
|
|
|
|
module_init(tda9875_init);
|
|
module_exit(tda9875_fini);
|
|
|
|
/*
|
|
* Local variables:
|
|
* c-basic-offset: 8
|
|
* End:
|
|
*/
|
|
|