123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820 |
- #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;
- unsigned int radio_mode;
- };
- 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_stereo = {
- .name = "Radio Stereo",
- .b = ( cFmRadio |
- cQSS ),
- .c = ( cDeemphasisOFF |
- cAudioGain6 ),
- .e = ( cAudioIF_5_5 |
- cRadioIF_38_90 ),
- };
- static struct tvnorm radio_mono = {
- .name = "Radio Mono",
- .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) {
- if (t->radio_mode == V4L2_TUNER_MODE_MONO)
- norm = &radio_mono;
- else
- norm = &radio_stereo;
- } 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);
- 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;
- t->radio_mode = V4L2_TUNER_MODE_STEREO;
- 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_HW_B_BT848:
- case I2C_HW_B_RIVA:
- case I2C_HW_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;
- }
- case VIDIOC_S_TUNER:
- {
- struct v4l2_tuner* tuner = arg;
- if (t->radio) {
- t->radio_mode = tuner->audmode;
- tda9887_configure (t);
- }
- 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 =
- {
- .name = "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:
- */
|