![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 ===================================================================
801 lines
19 KiB
C
801 lines
19 KiB
C
#include <linux/module.h>
|
|
#include <linux/moduleparam.h>
|
|
#include <linux/kernel.h>
|
|
#include <linux/i2c.h>
|
|
#include <linux/types.h>
|
|
#include <linux/videodev.h>
|
|
#include <linux/init.h>
|
|
#include <linux/errno.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/delay.h>
|
|
|
|
#include <media/audiochip.h>
|
|
#include <media/tuner.h>
|
|
#include <media/id.h>
|
|
|
|
/* Chips:
|
|
TDA9885 (PAL, NTSC)
|
|
TDA9886 (PAL, SECAM, NTSC)
|
|
TDA9887 (PAL, SECAM, NTSC, FM Radio)
|
|
|
|
found on:
|
|
- Pinnacle PCTV (Jul.2002 Version with MT2032, bttv)
|
|
TDA9887 (world), TDA9885 (USA)
|
|
Note: OP2 of tda988x must be set to 1, else MT2032 is disabled!
|
|
- KNC One TV-Station RDS (saa7134)
|
|
*/
|
|
|
|
|
|
/* Addresses to scan */
|
|
static unsigned short normal_i2c[] = {
|
|
0x84 >>1,
|
|
0x86 >>1,
|
|
0x96 >>1,
|
|
I2C_CLIENT_END,
|
|
};
|
|
I2C_CLIENT_INSMOD;
|
|
|
|
/* insmod options */
|
|
static unsigned int debug = 0;
|
|
module_param(debug, int, 0644);
|
|
MODULE_LICENSE("GPL");
|
|
|
|
/* ---------------------------------------------------------------------- */
|
|
|
|
#define UNSET (-1U)
|
|
#define PREFIX "tda9885/6/7: "
|
|
#define dprintk if (debug) printk
|
|
|
|
struct tda9887 {
|
|
struct i2c_client client;
|
|
v4l2_std_id std;
|
|
unsigned int radio;
|
|
unsigned int config;
|
|
unsigned int pinnacle_id;
|
|
unsigned int using_v4l2;
|
|
};
|
|
|
|
struct tvnorm {
|
|
v4l2_std_id std;
|
|
char *name;
|
|
unsigned char b;
|
|
unsigned char c;
|
|
unsigned char e;
|
|
};
|
|
|
|
static struct i2c_driver driver;
|
|
static struct i2c_client client_template;
|
|
|
|
/* ---------------------------------------------------------------------- */
|
|
|
|
//
|
|
// TDA defines
|
|
//
|
|
|
|
//// first reg (b)
|
|
#define cVideoTrapBypassOFF 0x00 // bit b0
|
|
#define cVideoTrapBypassON 0x01 // bit b0
|
|
|
|
#define cAutoMuteFmInactive 0x00 // bit b1
|
|
#define cAutoMuteFmActive 0x02 // bit b1
|
|
|
|
#define cIntercarrier 0x00 // bit b2
|
|
#define cQSS 0x04 // bit b2
|
|
|
|
#define cPositiveAmTV 0x00 // bit b3:4
|
|
#define cFmRadio 0x08 // bit b3:4
|
|
#define cNegativeFmTV 0x10 // bit b3:4
|
|
|
|
|
|
#define cForcedMuteAudioON 0x20 // bit b5
|
|
#define cForcedMuteAudioOFF 0x00 // bit b5
|
|
|
|
#define cOutputPort1Active 0x00 // bit b6
|
|
#define cOutputPort1Inactive 0x40 // bit b6
|
|
|
|
#define cOutputPort2Active 0x00 // bit b7
|
|
#define cOutputPort2Inactive 0x80 // bit b7
|
|
|
|
|
|
//// second reg (c)
|
|
#define cDeemphasisOFF 0x00 // bit c5
|
|
#define cDeemphasisON 0x20 // bit c5
|
|
|
|
#define cDeemphasis75 0x00 // bit c6
|
|
#define cDeemphasis50 0x40 // bit c6
|
|
|
|
#define cAudioGain0 0x00 // bit c7
|
|
#define cAudioGain6 0x80 // bit c7
|
|
|
|
|
|
//// third reg (e)
|
|
#define cAudioIF_4_5 0x00 // bit e0:1
|
|
#define cAudioIF_5_5 0x01 // bit e0:1
|
|
#define cAudioIF_6_0 0x02 // bit e0:1
|
|
#define cAudioIF_6_5 0x03 // bit e0:1
|
|
|
|
|
|
#define cVideoIF_58_75 0x00 // bit e2:4
|
|
#define cVideoIF_45_75 0x04 // bit e2:4
|
|
#define cVideoIF_38_90 0x08 // bit e2:4
|
|
#define cVideoIF_38_00 0x0C // bit e2:4
|
|
#define cVideoIF_33_90 0x10 // bit e2:4
|
|
#define cVideoIF_33_40 0x14 // bit e2:4
|
|
#define cRadioIF_45_75 0x18 // bit e2:4
|
|
#define cRadioIF_38_90 0x1C // bit e2:4
|
|
|
|
|
|
#define cTunerGainNormal 0x00 // bit e5
|
|
#define cTunerGainLow 0x20 // bit e5
|
|
|
|
#define cGating_18 0x00 // bit e6
|
|
#define cGating_36 0x40 // bit e6
|
|
|
|
#define cAgcOutON 0x80 // bit e7
|
|
#define cAgcOutOFF 0x00 // bit e7
|
|
|
|
/* ---------------------------------------------------------------------- */
|
|
|
|
static struct tvnorm tvnorms[] = {
|
|
{
|
|
.std = V4L2_STD_PAL_BG,
|
|
.name = "PAL-BG",
|
|
.b = ( cNegativeFmTV |
|
|
cQSS ),
|
|
.c = ( cDeemphasisON |
|
|
cDeemphasis50 ),
|
|
.e = ( cAudioIF_5_5 |
|
|
cVideoIF_38_90 ),
|
|
},{
|
|
.std = V4L2_STD_PAL_I,
|
|
.name = "PAL-I",
|
|
.b = ( cNegativeFmTV |
|
|
cQSS ),
|
|
.c = ( cDeemphasisON |
|
|
cDeemphasis50 ),
|
|
.e = ( cAudioIF_6_0 |
|
|
cVideoIF_38_90 ),
|
|
},{
|
|
.std = V4L2_STD_PAL_DK,
|
|
.name = "PAL-DK",
|
|
.b = ( cNegativeFmTV |
|
|
cQSS ),
|
|
.c = ( cDeemphasisON |
|
|
cDeemphasis50 ),
|
|
.e = ( cAudioIF_6_5 |
|
|
cVideoIF_38_00 ),
|
|
},{
|
|
.std = V4L2_STD_PAL_M | V4L2_STD_PAL_N,
|
|
.name = "PAL-M/N",
|
|
.b = ( cNegativeFmTV |
|
|
cQSS ),
|
|
.c = ( cDeemphasisON |
|
|
cDeemphasis75 ),
|
|
.e = ( cAudioIF_4_5 |
|
|
cVideoIF_45_75 ),
|
|
},{
|
|
.std = V4L2_STD_SECAM_L,
|
|
.name = "SECAM-L",
|
|
.b = ( cPositiveAmTV |
|
|
cQSS ),
|
|
.e = ( cAudioIF_6_5 |
|
|
cVideoIF_38_90 ),
|
|
},{
|
|
.std = V4L2_STD_SECAM_DK,
|
|
.name = "SECAM-DK",
|
|
.b = ( cNegativeFmTV |
|
|
cQSS ),
|
|
.c = ( cDeemphasisON |
|
|
cDeemphasis50 ),
|
|
.e = ( cAudioIF_6_5 |
|
|
cVideoIF_38_00 ),
|
|
},{
|
|
.std = V4L2_STD_NTSC_M,
|
|
.name = "NTSC-M",
|
|
.b = ( cNegativeFmTV |
|
|
cQSS ),
|
|
.c = ( cDeemphasisON |
|
|
cDeemphasis50 ),
|
|
.e = ( cGating_36 |
|
|
cAudioIF_4_5 |
|
|
cVideoIF_45_75 ),
|
|
},{
|
|
.std = V4L2_STD_NTSC_M_JP,
|
|
.name = "NTSC-JP",
|
|
.b = ( cNegativeFmTV |
|
|
cQSS ),
|
|
.c = ( cDeemphasisON |
|
|
cDeemphasis50 ),
|
|
.e = ( cGating_36 |
|
|
cAudioIF_4_5 |
|
|
cVideoIF_58_75 ),
|
|
}
|
|
};
|
|
|
|
static struct tvnorm radio = {
|
|
.name = "radio",
|
|
.b = ( cFmRadio |
|
|
cQSS ),
|
|
.c = ( cDeemphasisON |
|
|
cDeemphasis50 ),
|
|
.e = ( cAudioIF_5_5 |
|
|
cRadioIF_38_90 ),
|
|
};
|
|
|
|
/* ---------------------------------------------------------------------- */
|
|
|
|
static void dump_read_message(unsigned char *buf)
|
|
{
|
|
static char *afc[16] = {
|
|
"- 12.5 kHz",
|
|
"- 37.5 kHz",
|
|
"- 62.5 kHz",
|
|
"- 87.5 kHz",
|
|
"-112.5 kHz",
|
|
"-137.5 kHz",
|
|
"-162.5 kHz",
|
|
"-187.5 kHz [min]",
|
|
"+187.5 kHz [max]",
|
|
"+162.5 kHz",
|
|
"+137.5 kHz",
|
|
"+112.5 kHz",
|
|
"+ 87.5 kHz",
|
|
"+ 62.5 kHz",
|
|
"+ 37.5 kHz",
|
|
"+ 12.5 kHz",
|
|
};
|
|
printk(PREFIX "read: 0x%2x\n", buf[0]);
|
|
printk(" after power on : %s\n", (buf[0] & 0x01) ? "yes" : "no");
|
|
printk(" afc : %s\n", afc[(buf[0] >> 1) & 0x0f]);
|
|
printk(" fmif level : %s\n", (buf[0] & 0x20) ? "high" : "low");
|
|
printk(" afc window : %s\n", (buf[0] & 0x40) ? "in" : "out");
|
|
printk(" vfi level : %s\n", (buf[0] & 0x80) ? "high" : "low");
|
|
}
|
|
|
|
static void dump_write_message(unsigned char *buf)
|
|
{
|
|
static char *sound[4] = {
|
|
"AM/TV",
|
|
"FM/radio",
|
|
"FM/TV",
|
|
"FM/radio"
|
|
};
|
|
static char *adjust[32] = {
|
|
"-16", "-15", "-14", "-13", "-12", "-11", "-10", "-9",
|
|
"-8", "-7", "-6", "-5", "-4", "-3", "-2", "-1",
|
|
"0", "+1", "+2", "+3", "+4", "+5", "+6", "+7",
|
|
"+8", "+9", "+10", "+11", "+12", "+13", "+14", "+15"
|
|
};
|
|
static char *deemph[4] = {
|
|
"no", "no", "75", "50"
|
|
};
|
|
static char *carrier[4] = {
|
|
"4.5 MHz",
|
|
"5.5 MHz",
|
|
"6.0 MHz",
|
|
"6.5 MHz / AM"
|
|
};
|
|
static char *vif[8] = {
|
|
"58.75 MHz",
|
|
"45.75 MHz",
|
|
"38.9 MHz",
|
|
"38.0 MHz",
|
|
"33.9 MHz",
|
|
"33.4 MHz",
|
|
"45.75 MHz + pin13",
|
|
"38.9 MHz + pin13",
|
|
};
|
|
static char *rif[4] = {
|
|
"44 MHz",
|
|
"52 MHz",
|
|
"52 MHz",
|
|
"44 MHz",
|
|
};
|
|
|
|
printk(PREFIX "write: byte B 0x%02x\n",buf[1]);
|
|
printk(" B0 video mode : %s\n",
|
|
(buf[1] & 0x01) ? "video trap" : "sound trap");
|
|
printk(" B1 auto mute fm : %s\n",
|
|
(buf[1] & 0x02) ? "yes" : "no");
|
|
printk(" B2 carrier mode : %s\n",
|
|
(buf[1] & 0x04) ? "QSS" : "Intercarrier");
|
|
printk(" B3-4 tv sound/radio : %s\n",
|
|
sound[(buf[1] & 0x18) >> 3]);
|
|
printk(" B5 force mute audio: %s\n",
|
|
(buf[1] & 0x20) ? "yes" : "no");
|
|
printk(" B6 output port 1 : %s\n",
|
|
(buf[1] & 0x40) ? "high (inactive)" : "low (active)");
|
|
printk(" B7 output port 2 : %s\n",
|
|
(buf[1] & 0x80) ? "high (inactive)" : "low (active)");
|
|
|
|
printk(PREFIX "write: byte C 0x%02x\n",buf[2]);
|
|
printk(" C0-4 top adjustment : %s dB\n", adjust[buf[2] & 0x1f]);
|
|
printk(" C5-6 de-emphasis : %s\n", deemph[(buf[2] & 0x60) >> 5]);
|
|
printk(" C7 audio gain : %s\n",
|
|
(buf[2] & 0x80) ? "-6" : "0");
|
|
|
|
printk(PREFIX "write: byte E 0x%02x\n",buf[3]);
|
|
printk(" E0-1 sound carrier : %s\n",
|
|
carrier[(buf[3] & 0x03)]);
|
|
printk(" E6 l pll ganting : %s\n",
|
|
(buf[3] & 0x40) ? "36" : "13");
|
|
|
|
if (buf[1] & 0x08) {
|
|
/* radio */
|
|
printk(" E2-4 video if : %s\n",
|
|
rif[(buf[3] & 0x0c) >> 2]);
|
|
printk(" E7 vif agc output : %s\n",
|
|
(buf[3] & 0x80)
|
|
? ((buf[3] & 0x10) ? "fm-agc radio" : "sif-agc radio")
|
|
: "fm radio carrier afc");
|
|
} else {
|
|
/* video */
|
|
printk(" E2-4 video if : %s\n",
|
|
vif[(buf[3] & 0x1c) >> 2]);
|
|
printk(" E5 tuner gain : %s\n",
|
|
(buf[3] & 0x80)
|
|
? ((buf[3] & 0x20) ? "external" : "normal")
|
|
: ((buf[3] & 0x20) ? "minimum" : "normal"));
|
|
printk(" E7 vif agc output : %s\n",
|
|
(buf[3] & 0x80)
|
|
? ((buf[3] & 0x20)
|
|
? "pin3 port, pin22 vif agc out"
|
|
: "pin22 port, pin3 vif acg ext in")
|
|
: "pin3+pin22 port");
|
|
}
|
|
printk("--\n");
|
|
}
|
|
|
|
/* ---------------------------------------------------------------------- */
|
|
|
|
static int tda9887_set_tvnorm(struct tda9887 *t, char *buf)
|
|
{
|
|
struct tvnorm *norm = NULL;
|
|
int i;
|
|
|
|
if (t->radio) {
|
|
norm = &radio;
|
|
} else {
|
|
for (i = 0; i < ARRAY_SIZE(tvnorms); i++) {
|
|
if (tvnorms[i].std & t->std) {
|
|
norm = tvnorms+i;
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
if (NULL == norm) {
|
|
dprintk(PREFIX "Oops: no tvnorm entry found\n");
|
|
return -1;
|
|
}
|
|
|
|
dprintk(PREFIX "configure for: %s\n",norm->name);
|
|
buf[1] = norm->b;
|
|
buf[2] = norm->c;
|
|
buf[3] = norm->e;
|
|
return 0;
|
|
}
|
|
|
|
static unsigned int port1 = UNSET;
|
|
static unsigned int port2 = UNSET;
|
|
static unsigned int qss = UNSET;
|
|
static unsigned int adjust = 0x10;
|
|
module_param(port1, int, 0644);
|
|
module_param(port2, int, 0644);
|
|
module_param(qss, int, 0644);
|
|
module_param(adjust, int, 0644);
|
|
|
|
static int tda9887_set_insmod(struct tda9887 *t, char *buf)
|
|
{
|
|
if (UNSET != port1) {
|
|
if (port1)
|
|
buf[1] |= cOutputPort1Inactive;
|
|
else
|
|
buf[1] &= ~cOutputPort1Inactive;
|
|
}
|
|
if (UNSET != port2) {
|
|
if (port2)
|
|
buf[1] |= cOutputPort2Inactive;
|
|
else
|
|
buf[1] &= ~cOutputPort2Inactive;
|
|
}
|
|
|
|
if (UNSET != qss) {
|
|
if (qss)
|
|
buf[1] |= cQSS;
|
|
else
|
|
buf[1] &= ~cQSS;
|
|
}
|
|
|
|
if (adjust >= 0x00 && adjust < 0x20)
|
|
buf[2] |= adjust;
|
|
return 0;
|
|
}
|
|
|
|
static int tda9887_set_config(struct tda9887 *t, char *buf)
|
|
{
|
|
if (t->config & TDA9887_PORT1_ACTIVE)
|
|
buf[1] &= ~cOutputPort1Inactive;
|
|
if (t->config & TDA9887_PORT1_INACTIVE)
|
|
buf[1] |= cOutputPort1Inactive;
|
|
if (t->config & TDA9887_PORT2_ACTIVE)
|
|
buf[1] &= ~cOutputPort2Inactive;
|
|
if (t->config & TDA9887_PORT2_INACTIVE)
|
|
buf[1] |= cOutputPort2Inactive;
|
|
|
|
if (t->config & TDA9887_QSS)
|
|
buf[1] |= cQSS;
|
|
if (t->config & TDA9887_INTERCARRIER)
|
|
buf[1] &= ~cQSS;
|
|
|
|
if (t->config & TDA9887_AUTOMUTE)
|
|
buf[1] |= cAutoMuteFmActive;
|
|
if (t->config & TDA9887_DEEMPHASIS_MASK) {
|
|
buf[2] &= ~0x60;
|
|
switch (t->config & TDA9887_DEEMPHASIS_MASK) {
|
|
case TDA9887_DEEMPHASIS_NONE:
|
|
buf[2] |= cDeemphasisOFF;
|
|
break;
|
|
case TDA9887_DEEMPHASIS_50:
|
|
buf[2] |= cDeemphasisON | cDeemphasis50;
|
|
break;
|
|
case TDA9887_DEEMPHASIS_75:
|
|
buf[2] |= cDeemphasisON | cDeemphasis75;
|
|
break;
|
|
}
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
/* ---------------------------------------------------------------------- */
|
|
|
|
static int tda9887_set_pinnacle(struct tda9887 *t, char *buf)
|
|
{
|
|
unsigned int bCarrierMode = UNSET;
|
|
|
|
if (t->std & V4L2_STD_625_50) {
|
|
if ((1 == t->pinnacle_id) || (7 == t->pinnacle_id)) {
|
|
bCarrierMode = cIntercarrier;
|
|
} else {
|
|
bCarrierMode = cQSS;
|
|
}
|
|
}
|
|
if (t->std & V4L2_STD_525_60) {
|
|
if ((5 == t->pinnacle_id) || (6 == t->pinnacle_id)) {
|
|
bCarrierMode = cIntercarrier;
|
|
} else {
|
|
bCarrierMode = cQSS;
|
|
}
|
|
}
|
|
|
|
if (bCarrierMode != UNSET) {
|
|
buf[1] &= ~0x04;
|
|
buf[1] |= bCarrierMode;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
/* ---------------------------------------------------------------------- */
|
|
|
|
static char pal[] = "-";
|
|
module_param_string(pal, pal, sizeof(pal), 0644);
|
|
static char secam[] = "-";
|
|
module_param_string(secam, secam, sizeof(secam), 0644);
|
|
|
|
static int tda9887_fixup_std(struct tda9887 *t)
|
|
{
|
|
/* get more precise norm info from insmod option */
|
|
if ((t->std & V4L2_STD_PAL) == V4L2_STD_PAL) {
|
|
switch (pal[0]) {
|
|
case 'b':
|
|
case 'B':
|
|
case 'g':
|
|
case 'G':
|
|
dprintk(PREFIX "insmod fixup: PAL => PAL-BG\n");
|
|
t->std = V4L2_STD_PAL_BG;
|
|
break;
|
|
case 'i':
|
|
case 'I':
|
|
dprintk(PREFIX "insmod fixup: PAL => PAL-I\n");
|
|
t->std = V4L2_STD_PAL_I;
|
|
break;
|
|
case 'd':
|
|
case 'D':
|
|
case 'k':
|
|
case 'K':
|
|
dprintk(PREFIX "insmod fixup: PAL => PAL-DK\n");
|
|
t->std = V4L2_STD_PAL_DK;
|
|
break;
|
|
}
|
|
}
|
|
if ((t->std & V4L2_STD_SECAM) == V4L2_STD_SECAM) {
|
|
switch (secam[0]) {
|
|
case 'd':
|
|
case 'D':
|
|
case 'k':
|
|
case 'K':
|
|
dprintk(PREFIX "insmod fixup: SECAM => SECAM-DK\n");
|
|
t->std = V4L2_STD_SECAM_DK;
|
|
break;
|
|
case 'l':
|
|
case 'L':
|
|
dprintk(PREFIX "insmod fixup: SECAM => SECAM-L\n");
|
|
t->std = V4L2_STD_SECAM_L;
|
|
break;
|
|
}
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static int tda9887_status(struct tda9887 *t)
|
|
{
|
|
unsigned char buf[1];
|
|
int rc;
|
|
|
|
memset(buf,0,sizeof(buf));
|
|
if (1 != (rc = i2c_master_recv(&t->client,buf,1)))
|
|
printk(PREFIX "i2c i/o error: rc == %d (should be 1)\n",rc);
|
|
dump_read_message(buf);
|
|
return 0;
|
|
}
|
|
|
|
static int tda9887_configure(struct tda9887 *t)
|
|
{
|
|
unsigned char buf[4];
|
|
int rc;
|
|
|
|
memset(buf,0,sizeof(buf));
|
|
tda9887_set_tvnorm(t,buf);
|
|
buf[1] |= cOutputPort1Inactive;
|
|
buf[1] |= cOutputPort2Inactive;
|
|
if (UNSET != t->pinnacle_id) {
|
|
tda9887_set_pinnacle(t,buf);
|
|
}
|
|
tda9887_set_config(t,buf);
|
|
tda9887_set_insmod(t,buf);
|
|
|
|
#if 0
|
|
/* This as-is breaks some cards, must be fixed in a
|
|
* card-specific way, probably using TDA9887_SET_CONFIG to
|
|
* turn on/off port2 */
|
|
if (t->std & V4L2_STD_SECAM_L) {
|
|
/* secam fixup (FIXME: move this to tvnorms array?) */
|
|
buf[1] &= ~cOutputPort2Inactive;
|
|
}
|
|
#endif
|
|
|
|
dprintk(PREFIX "writing: b=0x%02x c=0x%02x e=0x%02x\n",
|
|
buf[1],buf[2],buf[3]);
|
|
if (debug > 1)
|
|
dump_write_message(buf);
|
|
|
|
if (4 != (rc = i2c_master_send(&t->client,buf,4)))
|
|
printk(PREFIX "i2c i/o error: rc == %d (should be 4)\n",rc);
|
|
|
|
if (debug > 2) {
|
|
msleep_interruptible(1000);
|
|
tda9887_status(t);
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
/* ---------------------------------------------------------------------- */
|
|
|
|
static int tda9887_attach(struct i2c_adapter *adap, int addr, int kind)
|
|
{
|
|
struct tda9887 *t;
|
|
|
|
client_template.adapter = adap;
|
|
client_template.addr = addr;
|
|
|
|
printk(PREFIX "chip found @ 0x%x\n", addr<<1);
|
|
|
|
if (NULL == (t = kmalloc(sizeof(*t), GFP_KERNEL)))
|
|
return -ENOMEM;
|
|
memset(t,0,sizeof(*t));
|
|
t->client = client_template;
|
|
t->std = 0;
|
|
t->pinnacle_id = UNSET;
|
|
i2c_set_clientdata(&t->client, t);
|
|
i2c_attach_client(&t->client);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int tda9887_probe(struct i2c_adapter *adap)
|
|
{
|
|
#ifdef I2C_CLASS_TV_ANALOG
|
|
if (adap->class & I2C_CLASS_TV_ANALOG)
|
|
return i2c_probe(adap, &addr_data, tda9887_attach);
|
|
#else
|
|
switch (adap->id) {
|
|
case I2C_ALGO_BIT | I2C_HW_B_BT848:
|
|
case I2C_ALGO_BIT | I2C_HW_B_RIVA:
|
|
case I2C_ALGO_SAA7134:
|
|
return i2c_probe(adap, &addr_data, tda9887_attach);
|
|
break;
|
|
}
|
|
#endif
|
|
return 0;
|
|
}
|
|
|
|
static int tda9887_detach(struct i2c_client *client)
|
|
{
|
|
struct tda9887 *t = i2c_get_clientdata(client);
|
|
|
|
i2c_detach_client(client);
|
|
kfree(t);
|
|
return 0;
|
|
}
|
|
|
|
#define SWITCH_V4L2 if (!t->using_v4l2 && debug) \
|
|
printk(PREFIX "switching to v4l2\n"); \
|
|
t->using_v4l2 = 1;
|
|
#define CHECK_V4L2 if (t->using_v4l2) { if (debug) \
|
|
printk(PREFIX "ignore v4l1 call\n"); \
|
|
return 0; }
|
|
|
|
static int
|
|
tda9887_command(struct i2c_client *client, unsigned int cmd, void *arg)
|
|
{
|
|
struct tda9887 *t = i2c_get_clientdata(client);
|
|
|
|
switch (cmd) {
|
|
|
|
/* --- configuration --- */
|
|
case AUDC_SET_RADIO:
|
|
t->radio = 1;
|
|
tda9887_configure(t);
|
|
break;
|
|
|
|
case AUDC_CONFIG_PINNACLE:
|
|
{
|
|
int *i = arg;
|
|
|
|
t->pinnacle_id = *i;
|
|
tda9887_configure(t);
|
|
break;
|
|
}
|
|
case TDA9887_SET_CONFIG:
|
|
{
|
|
int *i = arg;
|
|
|
|
t->config = *i;
|
|
tda9887_configure(t);
|
|
break;
|
|
}
|
|
/* --- v4l ioctls --- */
|
|
/* take care: bttv does userspace copying, we'll get a
|
|
kernel pointer here... */
|
|
case VIDIOCSCHAN:
|
|
{
|
|
static const v4l2_std_id map[] = {
|
|
[ VIDEO_MODE_PAL ] = V4L2_STD_PAL,
|
|
[ VIDEO_MODE_NTSC ] = V4L2_STD_NTSC_M,
|
|
[ VIDEO_MODE_SECAM ] = V4L2_STD_SECAM,
|
|
[ 4 /* bttv */ ] = V4L2_STD_PAL_M,
|
|
[ 5 /* bttv */ ] = V4L2_STD_PAL_N,
|
|
[ 6 /* bttv */ ] = V4L2_STD_NTSC_M_JP,
|
|
};
|
|
struct video_channel *vc = arg;
|
|
|
|
CHECK_V4L2;
|
|
t->radio = 0;
|
|
if (vc->norm < ARRAY_SIZE(map))
|
|
t->std = map[vc->norm];
|
|
tda9887_fixup_std(t);
|
|
tda9887_configure(t);
|
|
break;
|
|
}
|
|
case VIDIOC_S_STD:
|
|
{
|
|
v4l2_std_id *id = arg;
|
|
|
|
SWITCH_V4L2;
|
|
t->radio = 0;
|
|
t->std = *id;
|
|
tda9887_fixup_std(t);
|
|
tda9887_configure(t);
|
|
break;
|
|
}
|
|
case VIDIOC_S_FREQUENCY:
|
|
{
|
|
struct v4l2_frequency *f = arg;
|
|
|
|
SWITCH_V4L2;
|
|
if (V4L2_TUNER_ANALOG_TV == f->type) {
|
|
if (t->radio == 0)
|
|
return 0;
|
|
t->radio = 0;
|
|
}
|
|
if (V4L2_TUNER_RADIO == f->type) {
|
|
if (t->radio == 1)
|
|
return 0;
|
|
t->radio = 1;
|
|
}
|
|
tda9887_configure(t);
|
|
break;
|
|
}
|
|
case VIDIOC_G_TUNER:
|
|
{
|
|
static int AFC_BITS_2_kHz[] = {
|
|
-12500, -37500, -62500, -97500,
|
|
-112500, -137500, -162500, -187500,
|
|
187500, 162500, 137500, 112500,
|
|
97500 , 62500, 37500 , 12500
|
|
};
|
|
struct v4l2_tuner* tuner = arg;
|
|
|
|
if (t->radio) {
|
|
__u8 reg = 0;
|
|
tuner->afc=0;
|
|
if (1 == i2c_master_recv(&t->client,®,1))
|
|
tuner->afc = AFC_BITS_2_kHz[(reg>>1)&0x0f];
|
|
}
|
|
break;
|
|
}
|
|
default:
|
|
/* nothing */
|
|
break;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static int tda9887_suspend(struct device * dev, pm_message_t state, u32 level)
|
|
{
|
|
dprintk("tda9887: suspend\n");
|
|
return 0;
|
|
}
|
|
|
|
static int tda9887_resume(struct device * dev, u32 level)
|
|
{
|
|
struct i2c_client *c = container_of(dev, struct i2c_client, dev);
|
|
struct tda9887 *t = i2c_get_clientdata(c);
|
|
|
|
dprintk("tda9887: resume\n");
|
|
tda9887_configure(t);
|
|
return 0;
|
|
}
|
|
|
|
/* ----------------------------------------------------------------------- */
|
|
|
|
static struct i2c_driver driver = {
|
|
.owner = THIS_MODULE,
|
|
.name = "i2c tda9887 driver",
|
|
.id = -1, /* FIXME */
|
|
.flags = I2C_DF_NOTIFY,
|
|
.attach_adapter = tda9887_probe,
|
|
.detach_client = tda9887_detach,
|
|
.command = tda9887_command,
|
|
.driver = {
|
|
.suspend = tda9887_suspend,
|
|
.resume = tda9887_resume,
|
|
},
|
|
};
|
|
static struct i2c_client client_template =
|
|
{
|
|
I2C_DEVNAME("tda9887"),
|
|
.flags = I2C_CLIENT_ALLOW_USE,
|
|
.driver = &driver,
|
|
};
|
|
|
|
static int __init tda9887_init_module(void)
|
|
{
|
|
return i2c_add_driver(&driver);
|
|
}
|
|
|
|
static void __exit tda9887_cleanup_module(void)
|
|
{
|
|
i2c_del_driver(&driver);
|
|
}
|
|
|
|
module_init(tda9887_init_module);
|
|
module_exit(tda9887_cleanup_module);
|
|
|
|
/*
|
|
* Overrides for Emacs so that we follow Linus's tabbing style.
|
|
* ---------------------------------------------------------------------------
|
|
* Local variables:
|
|
* c-basic-offset: 8
|
|
* End:
|
|
*/
|