[PATCH] v4l: fix I2C detect after normal_i2c_range()
[linux-2.6.git] / drivers / media / video / tda9887.c
1 #include <linux/module.h>
2 #include <linux/moduleparam.h>
3 #include <linux/kernel.h>
4 #include <linux/i2c.h>
5 #include <linux/types.h>
6 #include <linux/videodev.h>
7 #include <linux/init.h>
8 #include <linux/errno.h>
9 #include <linux/slab.h>
10 #include <linux/delay.h>
11
12 #include <media/audiochip.h>
13 #include <media/tuner.h>
14 #include <media/id.h>
15
16 /* Chips:
17    TDA9885 (PAL, NTSC)
18    TDA9886 (PAL, SECAM, NTSC)
19    TDA9887 (PAL, SECAM, NTSC, FM Radio)
20
21    found on:
22    - Pinnacle PCTV (Jul.2002 Version with MT2032, bttv)
23       TDA9887 (world), TDA9885 (USA)
24       Note: OP2 of tda988x must be set to 1, else MT2032 is disabled!
25    - KNC One TV-Station RDS (saa7134)
26 */
27
28
29 /* Addresses to scan */
30 static unsigned short normal_i2c[] = {
31         0x84 >>1,
32         0x86 >>1,
33         0x96 >>1,
34         I2C_CLIENT_END,
35 };
36 I2C_CLIENT_INSMOD;
37
38 /* insmod options */
39 static unsigned int debug = 0;
40 module_param(debug, int, 0644);
41 MODULE_LICENSE("GPL");
42
43 /* ---------------------------------------------------------------------- */
44
45 #define UNSET       (-1U)
46 #define PREFIX      "tda9885/6/7: "
47 #define dprintk     if (debug) printk
48
49 struct tda9887 {
50         struct i2c_client  client;
51         v4l2_std_id        std;
52         unsigned int       radio;
53         unsigned int       config;
54         unsigned int       pinnacle_id;
55         unsigned int       using_v4l2;
56         unsigned int       radio_mode;
57 };
58
59 struct tvnorm {
60         v4l2_std_id       std;
61         char              *name;
62         unsigned char     b;
63         unsigned char     c;
64         unsigned char     e;
65 };
66
67 static struct i2c_driver driver;
68 static struct i2c_client client_template;
69
70 /* ---------------------------------------------------------------------- */
71
72 //
73 // TDA defines
74 //
75
76 //// first reg (b)
77 #define cVideoTrapBypassOFF     0x00    // bit b0
78 #define cVideoTrapBypassON      0x01    // bit b0
79
80 #define cAutoMuteFmInactive     0x00    // bit b1
81 #define cAutoMuteFmActive       0x02    // bit b1
82
83 #define cIntercarrier           0x00    // bit b2
84 #define cQSS                    0x04    // bit b2
85
86 #define cPositiveAmTV           0x00    // bit b3:4
87 #define cFmRadio                0x08    // bit b3:4
88 #define cNegativeFmTV           0x10    // bit b3:4
89
90
91 #define cForcedMuteAudioON      0x20    // bit b5
92 #define cForcedMuteAudioOFF     0x00    // bit b5
93
94 #define cOutputPort1Active      0x00    // bit b6
95 #define cOutputPort1Inactive    0x40    // bit b6
96
97 #define cOutputPort2Active      0x00    // bit b7
98 #define cOutputPort2Inactive    0x80    // bit b7
99
100
101 //// second reg (c)
102 #define cDeemphasisOFF          0x00    // bit c5
103 #define cDeemphasisON           0x20    // bit c5
104
105 #define cDeemphasis75           0x00    // bit c6
106 #define cDeemphasis50           0x40    // bit c6
107
108 #define cAudioGain0             0x00    // bit c7
109 #define cAudioGain6             0x80    // bit c7
110
111
112 //// third reg (e)
113 #define cAudioIF_4_5             0x00    // bit e0:1
114 #define cAudioIF_5_5             0x01    // bit e0:1
115 #define cAudioIF_6_0             0x02    // bit e0:1
116 #define cAudioIF_6_5             0x03    // bit e0:1
117
118
119 #define cVideoIF_58_75           0x00    // bit e2:4
120 #define cVideoIF_45_75           0x04    // bit e2:4
121 #define cVideoIF_38_90           0x08    // bit e2:4
122 #define cVideoIF_38_00           0x0C    // bit e2:4
123 #define cVideoIF_33_90           0x10    // bit e2:4
124 #define cVideoIF_33_40           0x14    // bit e2:4
125 #define cRadioIF_45_75           0x18    // bit e2:4
126 #define cRadioIF_38_90           0x1C    // bit e2:4
127
128
129 #define cTunerGainNormal         0x00    // bit e5
130 #define cTunerGainLow            0x20    // bit e5
131
132 #define cGating_18               0x00    // bit e6
133 #define cGating_36               0x40    // bit e6
134
135 #define cAgcOutON                0x80    // bit e7
136 #define cAgcOutOFF               0x00    // bit e7
137
138 /* ---------------------------------------------------------------------- */
139
140 static struct tvnorm tvnorms[] = {
141         {
142                 .std   = V4L2_STD_PAL_BG,
143                 .name  = "PAL-BG",
144                 .b     = ( cNegativeFmTV  |
145                            cQSS           ),
146                 .c     = ( cDeemphasisON  |
147                            cDeemphasis50  ),
148                 .e     = ( cAudioIF_5_5   |
149                            cVideoIF_38_90 ),
150         },{
151                 .std   = V4L2_STD_PAL_I,
152                 .name  = "PAL-I",
153                 .b     = ( cNegativeFmTV  |
154                            cQSS           ),
155                 .c     = ( cDeemphasisON  |
156                            cDeemphasis50  ),
157                 .e     = ( cAudioIF_6_0   |
158                            cVideoIF_38_90 ),
159         },{
160                 .std   = V4L2_STD_PAL_DK,
161                 .name  = "PAL-DK",
162                 .b     = ( cNegativeFmTV  |
163                            cQSS           ),
164                 .c     = ( cDeemphasisON  |
165                            cDeemphasis50  ),
166                 .e     = ( cAudioIF_6_5   |
167                            cVideoIF_38_00 ),
168         },{
169                 .std   = V4L2_STD_PAL_M | V4L2_STD_PAL_N,
170                 .name  = "PAL-M/N",
171                 .b     = ( cNegativeFmTV  |
172                            cQSS           ),
173                 .c     = ( cDeemphasisON  |
174                            cDeemphasis75  ),
175                 .e     = ( cAudioIF_4_5   |
176                            cVideoIF_45_75 ),
177         },{
178                 .std   = V4L2_STD_SECAM_L,
179                 .name  = "SECAM-L",
180                 .b     = ( cPositiveAmTV  |
181                            cQSS           ),
182                 .e     = ( cAudioIF_6_5   |
183                            cVideoIF_38_90 ),
184         },{
185                 .std   = V4L2_STD_SECAM_DK,
186                 .name  = "SECAM-DK",
187                 .b     = ( cNegativeFmTV  |
188                            cQSS           ),
189                 .c     = ( cDeemphasisON  |
190                            cDeemphasis50  ),
191                 .e     = ( cAudioIF_6_5   |
192                            cVideoIF_38_00 ),
193         },{
194                 .std   = V4L2_STD_NTSC_M,
195                 .name  = "NTSC-M",
196                 .b     = ( cNegativeFmTV  |
197                            cQSS           ),
198                 .c     = ( cDeemphasisON  |
199                            cDeemphasis50  ),
200                 .e     = ( cGating_36     |
201                            cAudioIF_4_5   |
202                            cVideoIF_45_75 ),
203         },{
204                 .std   = V4L2_STD_NTSC_M_JP,
205                 .name  = "NTSC-JP",
206                 .b     = ( cNegativeFmTV  |
207                            cQSS           ),
208                 .c     = ( cDeemphasisON  |
209                            cDeemphasis50  ),
210                 .e     = ( cGating_36     |
211                            cAudioIF_4_5   |
212                            cVideoIF_58_75 ),
213         }
214 };
215
216 static struct tvnorm radio_stereo = {
217         .name = "Radio Stereo",
218         .b    = ( cFmRadio       |
219                   cQSS           ),
220         .c    = ( cDeemphasisOFF |
221                   cAudioGain6 ),
222         .e    = ( cAudioIF_5_5   |
223                   cRadioIF_38_90 ),
224 };
225
226 static struct tvnorm radio_mono = {
227         .name = "Radio Mono",
228         .b    = ( cFmRadio       |
229                   cQSS           ),
230         .c    = ( cDeemphasisON  |
231                   cDeemphasis50),
232         .e    = ( cAudioIF_5_5   |
233                   cRadioIF_38_90 ),
234 };
235
236 /* ---------------------------------------------------------------------- */
237
238 static void dump_read_message(unsigned char *buf)
239 {
240         static char *afc[16] = {
241                 "- 12.5 kHz",
242                 "- 37.5 kHz",
243                 "- 62.5 kHz",
244                 "- 87.5 kHz",
245                 "-112.5 kHz",
246                 "-137.5 kHz",
247                 "-162.5 kHz",
248                 "-187.5 kHz [min]",
249                 "+187.5 kHz [max]",
250                 "+162.5 kHz",
251                 "+137.5 kHz",
252                 "+112.5 kHz",
253                 "+ 87.5 kHz",
254                 "+ 62.5 kHz",
255                 "+ 37.5 kHz",
256                 "+ 12.5 kHz",
257         };
258         printk(PREFIX "read: 0x%2x\n", buf[0]);
259         printk("  after power on : %s\n", (buf[0] & 0x01) ? "yes" : "no");
260         printk("  afc            : %s\n", afc[(buf[0] >> 1) & 0x0f]);
261         printk("  fmif level     : %s\n", (buf[0] & 0x20) ? "high" : "low");
262         printk("  afc window     : %s\n", (buf[0] & 0x40) ? "in" : "out");
263         printk("  vfi level      : %s\n", (buf[0] & 0x80) ? "high" : "low");
264 }
265
266 static void dump_write_message(unsigned char *buf)
267 {
268         static char *sound[4] = {
269                 "AM/TV",
270                 "FM/radio",
271                 "FM/TV",
272                 "FM/radio"
273         };
274         static char *adjust[32] = {
275                 "-16", "-15", "-14", "-13", "-12", "-11", "-10", "-9",
276                 "-8",  "-7",  "-6",  "-5",  "-4",  "-3",  "-2",  "-1",
277                 "0",   "+1",  "+2",  "+3",  "+4",  "+5",  "+6",  "+7",
278                 "+8",  "+9",  "+10", "+11", "+12", "+13", "+14", "+15"
279         };
280         static char *deemph[4] = {
281                 "no", "no", "75", "50"
282         };
283         static char *carrier[4] = {
284                 "4.5 MHz",
285                 "5.5 MHz",
286                 "6.0 MHz",
287                 "6.5 MHz / AM"
288         };
289         static char *vif[8] = {
290                 "58.75 MHz",
291                 "45.75 MHz",
292                 "38.9 MHz",
293                 "38.0 MHz",
294                 "33.9 MHz",
295                 "33.4 MHz",
296                 "45.75 MHz + pin13",
297                 "38.9 MHz + pin13",
298         };
299         static char *rif[4] = {
300                 "44 MHz",
301                 "52 MHz",
302                 "52 MHz",
303                 "44 MHz",
304         };
305
306         printk(PREFIX "write: byte B 0x%02x\n",buf[1]);
307         printk("  B0   video mode      : %s\n",
308                (buf[1] & 0x01) ? "video trap" : "sound trap");
309         printk("  B1   auto mute fm    : %s\n",
310                (buf[1] & 0x02) ? "yes" : "no");
311         printk("  B2   carrier mode    : %s\n",
312                (buf[1] & 0x04) ? "QSS" : "Intercarrier");
313         printk("  B3-4 tv sound/radio  : %s\n",
314                sound[(buf[1] & 0x18) >> 3]);
315         printk("  B5   force mute audio: %s\n",
316                (buf[1] & 0x20) ? "yes" : "no");
317         printk("  B6   output port 1   : %s\n",
318                (buf[1] & 0x40) ? "high (inactive)" : "low (active)");
319         printk("  B7   output port 2   : %s\n",
320                (buf[1] & 0x80) ? "high (inactive)" : "low (active)");
321
322         printk(PREFIX "write: byte C 0x%02x\n",buf[2]);
323         printk("  C0-4 top adjustment  : %s dB\n", adjust[buf[2] & 0x1f]);
324         printk("  C5-6 de-emphasis     : %s\n", deemph[(buf[2] & 0x60) >> 5]);
325         printk("  C7   audio gain      : %s\n",
326                (buf[2] & 0x80) ? "-6" : "0");
327
328         printk(PREFIX "write: byte E 0x%02x\n",buf[3]);
329         printk("  E0-1 sound carrier   : %s\n",
330                carrier[(buf[3] & 0x03)]);
331         printk("  E6   l pll ganting   : %s\n",
332                (buf[3] & 0x40) ? "36" : "13");
333
334         if (buf[1] & 0x08) {
335                 /* radio */
336                 printk("  E2-4 video if        : %s\n",
337                        rif[(buf[3] & 0x0c) >> 2]);
338                 printk("  E7   vif agc output  : %s\n",
339                        (buf[3] & 0x80)
340                        ? ((buf[3] & 0x10) ? "fm-agc radio" : "sif-agc radio")
341                        : "fm radio carrier afc");
342         } else {
343                 /* video */
344                 printk("  E2-4 video if        : %s\n",
345                        vif[(buf[3] & 0x1c) >> 2]);
346                 printk("  E5   tuner gain      : %s\n",
347                        (buf[3] & 0x80)
348                        ? ((buf[3] & 0x20) ? "external" : "normal")
349                        : ((buf[3] & 0x20) ? "minimum"  : "normal"));
350                 printk("  E7   vif agc output  : %s\n",
351                        (buf[3] & 0x80)
352                        ? ((buf[3] & 0x20)
353                           ? "pin3 port, pin22 vif agc out"
354                           : "pin22 port, pin3 vif acg ext in")
355                        : "pin3+pin22 port");
356         }
357         printk("--\n");
358 }
359
360 /* ---------------------------------------------------------------------- */
361
362 static int tda9887_set_tvnorm(struct tda9887 *t, char *buf)
363 {
364         struct tvnorm *norm = NULL;
365         int i;
366
367         if (t->radio) {
368                 if (t->radio_mode == V4L2_TUNER_MODE_MONO)
369                         norm = &radio_mono;
370                 else
371                         norm = &radio_stereo;
372         } else {
373                 for (i = 0; i < ARRAY_SIZE(tvnorms); i++) {
374                         if (tvnorms[i].std & t->std) {
375                                 norm = tvnorms+i;
376                                 break;
377                         }
378                 }
379         }
380         if (NULL == norm) {
381                 dprintk(PREFIX "Oops: no tvnorm entry found\n");
382                 return -1;
383         }
384
385         dprintk(PREFIX "configure for: %s\n",norm->name);
386         buf[1] = norm->b;
387         buf[2] = norm->c;
388         buf[3] = norm->e;
389         return 0;
390 }
391
392 static unsigned int port1  = UNSET;
393 static unsigned int port2  = UNSET;
394 static unsigned int qss    = UNSET;
395 static unsigned int adjust = 0x10;
396 module_param(port1, int, 0644);
397 module_param(port2, int, 0644);
398 module_param(qss, int, 0644);
399 module_param(adjust, int, 0644);
400
401 static int tda9887_set_insmod(struct tda9887 *t, char *buf)
402 {
403         if (UNSET != port1) {
404                 if (port1)
405                         buf[1] |= cOutputPort1Inactive;
406                 else
407                         buf[1] &= ~cOutputPort1Inactive;
408         }
409         if (UNSET != port2) {
410                 if (port2)
411                         buf[1] |= cOutputPort2Inactive;
412                 else
413                         buf[1] &= ~cOutputPort2Inactive;
414         }
415
416         if (UNSET != qss) {
417                 if (qss)
418                         buf[1] |= cQSS;
419                 else
420                         buf[1] &= ~cQSS;
421         }
422
423         if (adjust >= 0x00 && adjust < 0x20)
424                 buf[2] |= adjust;
425         return 0;
426 }
427
428 static int tda9887_set_config(struct tda9887 *t, char *buf)
429 {
430         if (t->config & TDA9887_PORT1_ACTIVE)
431                 buf[1] &= ~cOutputPort1Inactive;
432         if (t->config & TDA9887_PORT1_INACTIVE)
433                 buf[1] |= cOutputPort1Inactive;
434         if (t->config & TDA9887_PORT2_ACTIVE)
435                 buf[1] &= ~cOutputPort2Inactive;
436         if (t->config & TDA9887_PORT2_INACTIVE)
437                 buf[1] |= cOutputPort2Inactive;
438
439         if (t->config & TDA9887_QSS)
440                 buf[1] |= cQSS;
441         if (t->config & TDA9887_INTERCARRIER)
442                 buf[1] &= ~cQSS;
443
444         if (t->config & TDA9887_AUTOMUTE)
445                 buf[1] |= cAutoMuteFmActive;
446         if (t->config & TDA9887_DEEMPHASIS_MASK) {
447                 buf[2] &= ~0x60;
448                 switch (t->config & TDA9887_DEEMPHASIS_MASK) {
449                 case TDA9887_DEEMPHASIS_NONE:
450                         buf[2] |= cDeemphasisOFF;
451                         break;
452                 case TDA9887_DEEMPHASIS_50:
453                         buf[2] |= cDeemphasisON | cDeemphasis50;
454                         break;
455                 case TDA9887_DEEMPHASIS_75:
456                         buf[2] |= cDeemphasisON | cDeemphasis75;
457                         break;
458                 }
459         }
460         return 0;
461 }
462
463 /* ---------------------------------------------------------------------- */
464
465 static int tda9887_set_pinnacle(struct tda9887 *t, char *buf)
466 {
467         unsigned int bCarrierMode = UNSET;
468
469         if (t->std & V4L2_STD_625_50) {
470                 if ((1 == t->pinnacle_id) || (7 == t->pinnacle_id)) {
471                         bCarrierMode = cIntercarrier;
472                 } else {
473                         bCarrierMode = cQSS;
474                 }
475         }
476         if (t->std & V4L2_STD_525_60) {
477                 if ((5 == t->pinnacle_id) || (6 == t->pinnacle_id)) {
478                         bCarrierMode = cIntercarrier;
479                 } else {
480                         bCarrierMode = cQSS;
481                 }
482         }
483
484         if (bCarrierMode != UNSET) {
485                 buf[1] &= ~0x04;
486                 buf[1] |= bCarrierMode;
487         }
488         return 0;
489 }
490
491 /* ---------------------------------------------------------------------- */
492
493 static char pal[] = "-";
494 module_param_string(pal, pal, sizeof(pal), 0644);
495 static char secam[] = "-";
496 module_param_string(secam, secam, sizeof(secam), 0644);
497
498 static int tda9887_fixup_std(struct tda9887 *t)
499 {
500         /* get more precise norm info from insmod option */
501         if ((t->std & V4L2_STD_PAL) == V4L2_STD_PAL) {
502                 switch (pal[0]) {
503                 case 'b':
504                 case 'B':
505                 case 'g':
506                 case 'G':
507                         dprintk(PREFIX "insmod fixup: PAL => PAL-BG\n");
508                         t->std = V4L2_STD_PAL_BG;
509                         break;
510                 case 'i':
511                 case 'I':
512                         dprintk(PREFIX "insmod fixup: PAL => PAL-I\n");
513                         t->std = V4L2_STD_PAL_I;
514                         break;
515                 case 'd':
516                 case 'D':
517                 case 'k':
518                 case 'K':
519                         dprintk(PREFIX "insmod fixup: PAL => PAL-DK\n");
520                         t->std = V4L2_STD_PAL_DK;
521                         break;
522                 }
523         }
524         if ((t->std & V4L2_STD_SECAM) == V4L2_STD_SECAM) {
525                 switch (secam[0]) {
526                 case 'd':
527                 case 'D':
528                 case 'k':
529                 case 'K':
530                         dprintk(PREFIX "insmod fixup: SECAM => SECAM-DK\n");
531                         t->std = V4L2_STD_SECAM_DK;
532                         break;
533                 case 'l':
534                 case 'L':
535                         dprintk(PREFIX "insmod fixup: SECAM => SECAM-L\n");
536                         t->std = V4L2_STD_SECAM_L;
537                         break;
538                 }
539         }
540         return 0;
541 }
542
543 static int tda9887_status(struct tda9887 *t)
544 {
545         unsigned char buf[1];
546         int rc;
547
548         memset(buf,0,sizeof(buf));
549         if (1 != (rc = i2c_master_recv(&t->client,buf,1)))
550                 printk(PREFIX "i2c i/o error: rc == %d (should be 1)\n",rc);
551         dump_read_message(buf);
552         return 0;
553 }
554
555 static int tda9887_configure(struct tda9887 *t)
556 {
557         unsigned char buf[4];
558         int rc;
559
560         memset(buf,0,sizeof(buf));
561         tda9887_set_tvnorm(t,buf);
562
563         buf[1] |= cOutputPort1Inactive;
564         buf[1] |= cOutputPort2Inactive;
565
566         if (UNSET != t->pinnacle_id) {
567                 tda9887_set_pinnacle(t,buf);
568         }
569
570         tda9887_set_config(t,buf);
571         tda9887_set_insmod(t,buf);
572
573 #if 0
574         /* This as-is breaks some cards, must be fixed in a
575          * card-specific way, probably using TDA9887_SET_CONFIG to
576          * turn on/off port2 */
577         if (t->std & V4L2_STD_SECAM_L) {
578                 /* secam fixup (FIXME: move this to tvnorms array?) */
579                 buf[1] &= ~cOutputPort2Inactive;
580         }
581 #endif
582
583         dprintk(PREFIX "writing: b=0x%02x c=0x%02x e=0x%02x\n",
584                 buf[1],buf[2],buf[3]);
585         if (debug > 1)
586                 dump_write_message(buf);
587
588         if (4 != (rc = i2c_master_send(&t->client,buf,4)))
589                 printk(PREFIX "i2c i/o error: rc == %d (should be 4)\n",rc);
590
591         if (debug > 2) {
592                 msleep_interruptible(1000);
593                 tda9887_status(t);
594         }
595         return 0;
596 }
597
598 /* ---------------------------------------------------------------------- */
599
600 static int tda9887_attach(struct i2c_adapter *adap, int addr, int kind)
601 {
602         struct tda9887 *t;
603
604         client_template.adapter = adap;
605         client_template.addr    = addr;
606
607         printk(PREFIX "chip found @ 0x%x\n", addr<<1);
608
609         if (NULL == (t = kmalloc(sizeof(*t), GFP_KERNEL)))
610                 return -ENOMEM;
611         memset(t,0,sizeof(*t));
612
613         t->client      = client_template;
614         t->std         = 0;
615         t->pinnacle_id = UNSET;
616         t->radio_mode = V4L2_TUNER_MODE_STEREO;
617
618         i2c_set_clientdata(&t->client, t);
619         i2c_attach_client(&t->client);
620
621         return 0;
622 }
623
624 static int tda9887_probe(struct i2c_adapter *adap)
625 {
626 #ifdef I2C_CLASS_TV_ANALOG
627         if (adap->class & I2C_CLASS_TV_ANALOG)
628                 return i2c_probe(adap, &addr_data, tda9887_attach);
629 #else
630         switch (adap->id) {
631         case I2C_ALGO_BIT | I2C_HW_B_BT848:
632         case I2C_ALGO_BIT | I2C_HW_B_RIVA:
633         case I2C_ALGO_SAA7134:
634                 return i2c_probe(adap, &addr_data, tda9887_attach);
635                 break;
636         }
637 #endif
638         return 0;
639 }
640
641 static int tda9887_detach(struct i2c_client *client)
642 {
643         struct tda9887 *t = i2c_get_clientdata(client);
644
645         i2c_detach_client(client);
646         kfree(t);
647         return 0;
648 }
649
650 #define SWITCH_V4L2     if (!t->using_v4l2 && debug) \
651                           printk(PREFIX "switching to v4l2\n"); \
652                           t->using_v4l2 = 1;
653 #define CHECK_V4L2      if (t->using_v4l2) { if (debug) \
654                           printk(PREFIX "ignore v4l1 call\n"); \
655                           return 0; }
656
657 static int
658 tda9887_command(struct i2c_client *client, unsigned int cmd, void *arg)
659 {
660         struct tda9887 *t = i2c_get_clientdata(client);
661
662         switch (cmd) {
663
664         /* --- configuration --- */
665         case AUDC_SET_RADIO:
666                 t->radio = 1;
667                 tda9887_configure(t);
668                 break;
669
670         case AUDC_CONFIG_PINNACLE:
671         {
672                 int *i = arg;
673
674                 t->pinnacle_id = *i;
675                 tda9887_configure(t);
676                 break;
677         }
678         case TDA9887_SET_CONFIG:
679         {
680                 int *i = arg;
681
682                 t->config = *i;
683                 tda9887_configure(t);
684                 break;
685         }
686         /* --- v4l ioctls --- */
687         /* take care: bttv does userspace copying, we'll get a
688            kernel pointer here... */
689         case VIDIOCSCHAN:
690         {
691                 static const v4l2_std_id map[] = {
692                         [ VIDEO_MODE_PAL   ] = V4L2_STD_PAL,
693                         [ VIDEO_MODE_NTSC  ] = V4L2_STD_NTSC_M,
694                         [ VIDEO_MODE_SECAM ] = V4L2_STD_SECAM,
695                         [ 4 /* bttv */     ] = V4L2_STD_PAL_M,
696                         [ 5 /* bttv */     ] = V4L2_STD_PAL_N,
697                         [ 6 /* bttv */     ] = V4L2_STD_NTSC_M_JP,
698                 };
699                 struct video_channel *vc = arg;
700
701                 CHECK_V4L2;
702                 t->radio = 0;
703                 if (vc->norm < ARRAY_SIZE(map))
704                         t->std = map[vc->norm];
705                 tda9887_fixup_std(t);
706                 tda9887_configure(t);
707                 break;
708         }
709         case VIDIOC_S_STD:
710         {
711                 v4l2_std_id *id = arg;
712
713                 SWITCH_V4L2;
714                 t->radio = 0;
715                 t->std   = *id;
716                 tda9887_fixup_std(t);
717                 tda9887_configure(t);
718                 break;
719         }
720         case VIDIOC_S_FREQUENCY:
721         {
722                 struct v4l2_frequency *f = arg;
723
724                 SWITCH_V4L2;
725                 if (V4L2_TUNER_ANALOG_TV == f->type) {
726                         if (t->radio == 0)
727                                 return 0;
728                         t->radio = 0;
729                 }
730                 if (V4L2_TUNER_RADIO == f->type) {
731                         if (t->radio == 1)
732                                 return 0;
733                         t->radio = 1;
734                 }
735                 tda9887_configure(t);
736                 break;
737         }
738         case VIDIOC_G_TUNER:
739         {
740                 static int AFC_BITS_2_kHz[] = {
741                         -12500,  -37500,  -62500,  -97500,
742                         -112500, -137500, -162500, -187500,
743                         187500,  162500,  137500,  112500,
744                         97500 ,  62500,   37500 ,  12500
745                 };
746                 struct v4l2_tuner* tuner = arg;
747
748                 if (t->radio) {
749                         __u8 reg = 0;
750                         tuner->afc=0;
751                         if (1 == i2c_master_recv(&t->client,&reg,1))
752                                 tuner->afc = AFC_BITS_2_kHz[(reg>>1)&0x0f];
753                 }
754                 break;
755         }
756         case VIDIOC_S_TUNER:
757         {
758                 struct v4l2_tuner* tuner = arg;
759
760                 if (t->radio) {
761                         t->radio_mode = tuner->audmode;
762                         tda9887_configure (t);
763                 }
764                 break;
765         }
766         default:
767                 /* nothing */
768                 break;
769         }
770         return 0;
771 }
772
773 static int tda9887_suspend(struct device * dev, u32 state, u32 level)
774 {
775         dprintk("tda9887: suspend\n");
776         return 0;
777 }
778
779 static int tda9887_resume(struct device * dev, u32 level)
780 {
781         struct i2c_client *c = container_of(dev, struct i2c_client, dev);
782         struct tda9887 *t = i2c_get_clientdata(c);
783
784         dprintk("tda9887: resume\n");
785         tda9887_configure(t);
786         return 0;
787 }
788
789 /* ----------------------------------------------------------------------- */
790
791 static struct i2c_driver driver = {
792         .owner          = THIS_MODULE,
793         .name           = "i2c tda9887 driver",
794         .id             = -1, /* FIXME */
795         .flags          = I2C_DF_NOTIFY,
796         .attach_adapter = tda9887_probe,
797         .detach_client  = tda9887_detach,
798         .command        = tda9887_command,
799         .driver = {
800                 .suspend = tda9887_suspend,
801                 .resume  = tda9887_resume,
802         },
803 };
804 static struct i2c_client client_template =
805 {
806         I2C_DEVNAME("tda9887"),
807         .flags     = I2C_CLIENT_ALLOW_USE,
808         .driver    = &driver,
809 };
810
811 static int __init tda9887_init_module(void)
812 {
813         return i2c_add_driver(&driver);
814 }
815
816 static void __exit tda9887_cleanup_module(void)
817 {
818         i2c_del_driver(&driver);
819 }
820
821 module_init(tda9887_init_module);
822 module_exit(tda9887_cleanup_module);
823
824 /*
825  * Overrides for Emacs so that we follow Linus's tabbing style.
826  * ---------------------------------------------------------------------------
827  * Local variables:
828  * c-basic-offset: 8
829  * End:
830  */