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