SAFE public projects git trees. - safe/jmp/linux-2.6/blob - drivers/media/video/tuner-core.c

   1 /*
   2  *
   3  * i2c tv tuner chip device driver
   4  * core core, i.e. kernel interfaces, registering and so on
   5  */
   6
   7 #include <linux/module.h>
   8 #include <linux/moduleparam.h>
   9 #include <linux/kernel.h>
  10 #include <linux/sched.h>
  11 #include <linux/string.h>
  12 #include <linux/timer.h>
  13 #include <linux/delay.h>
  14 #include <linux/errno.h>
  15 #include <linux/slab.h>
  16 #include <linux/poll.h>
  17 #include <linux/i2c.h>
  18 #include <linux/types.h>
  19 #include <linux/videodev.h>
  20 #include <linux/init.h>
  21
  22 #include <media/tuner.h>
  23 #include <media/v4l2-common.h>
  24 #include <media/audiochip.h>
  25
  26 #define UNSET (-1U)
  27
  28 /* standard i2c insmod options */
  29 static unsigned short normal_i2c[] = {
  30         0x42, 0x43, 0x4a, 0x4b,                 /* tda8290 */
  31         0x60, 0x61, 0x62, 0x63, 0x64, 0x65, 0x66, 0x67,
  32         0x68, 0x69, 0x6a, 0x6b, 0x6c, 0x6d, 0x6e, 0x6f,
  33         I2C_CLIENT_END
  34 };
  35
  36 I2C_CLIENT_INSMOD;
  37
  38 /* insmod options used at init time => read/only */
  39 static unsigned int addr = 0;
  40 static unsigned int no_autodetect = 0;
  41 static unsigned int show_i2c = 0;
  42
  43 /* insmod options used at runtime => read/write */
  44 static unsigned int tuner_debug_old = 0;
  45 int tuner_debug = 0;
  46
  47 static unsigned int tv_range[2] = { 44, 958 };
  48 static unsigned int radio_range[2] = { 65, 108 };
  49
  50 static char pal[] = "--";
  51 static char secam[] = "--";
  52 static char ntsc[] = "-";
  53
  54
  55 module_param(addr, int, 0444);
  56 module_param(no_autodetect, int, 0444);
  57 module_param(show_i2c, int, 0444);
  58 /* Note: tuner_debug is deprecated and will be removed in 2.6.17 */
  59 module_param_named(tuner_debug,tuner_debug_old, int, 0444);
  60 module_param_named(debug,tuner_debug, int, 0644);
  61 module_param_string(pal, pal, sizeof(pal), 0644);
  62 module_param_string(secam, secam, sizeof(secam), 0644);
  63 module_param_string(ntsc, ntsc, sizeof(ntsc), 0644);
  64 module_param_array(tv_range, int, NULL, 0644);
  65 module_param_array(radio_range, int, NULL, 0644);
  66
  67 MODULE_DESCRIPTION("device driver for various TV and TV+FM radio tuners");
  68 MODULE_AUTHOR("Ralph Metzler, Gerd Knorr, Gunther Mayer");
  69 MODULE_LICENSE("GPL");
  70
  71 static struct i2c_driver driver;
  72 static struct i2c_client client_template;
  73
  74 /* ---------------------------------------------------------------------- */
  75
  76 /* Set tuner frequency,  freq in Units of 62.5kHz = 1/16MHz */
  77 static void set_tv_freq(struct i2c_client *c, unsigned int freq)
  78 {
  79         struct tuner *t = i2c_get_clientdata(c);
  80
  81         if (t->type == UNSET) {
  82                 tuner_warn ("tuner type not set\n");
  83                 return;
  84         }
  85         if (NULL == t->set_tv_freq) {
  86                 tuner_warn ("Tuner has no way to set tv freq\n");
  87                 return;
  88         }
  89         if (freq < tv_range[0] * 16 || freq > tv_range[1] * 16) {
  90                 tuner_dbg ("TV freq (%d.%02d) out of range (%d-%d)\n",
  91                            freq / 16, freq % 16 * 100 / 16, tv_range[0],
  92                            tv_range[1]);
  93                 /* V4L2 spec: if the freq is not possible then the closest
  94                    possible value should be selected */
  95                 if (freq < tv_range[0] * 16)
  96                         freq = tv_range[0] * 16;
  97                 else
  98                         freq = tv_range[1] * 16;
  99         }
 100         t->set_tv_freq(c, freq);
 101 }
 102
 103 static void set_radio_freq(struct i2c_client *c, unsigned int freq)
 104 {
 105         struct tuner *t = i2c_get_clientdata(c);
 106
 107         if (t->type == UNSET) {
 108                 tuner_warn ("tuner type not set\n");
 109                 return;
 110         }
 111         if (NULL == t->set_radio_freq) {
 112                 tuner_warn ("tuner has no way to set radio frequency\n");
 113                 return;
 114         }
 115         if (freq < radio_range[0] * 16000 || freq > radio_range[1] * 16000) {
 116                 tuner_dbg ("radio freq (%d.%02d) out of range (%d-%d)\n",
 117                            freq / 16000, freq % 16000 * 100 / 16000,
 118                            radio_range[0], radio_range[1]);
 119                 /* V4L2 spec: if the freq is not possible then the closest
 120                    possible value should be selected */
 121                 if (freq < radio_range[0] * 16000)
 122                         freq = radio_range[0] * 16000;
 123                 else
 124                         freq = radio_range[1] * 16000;
 125         }
 126
 127         t->set_radio_freq(c, freq);
 128 }
 129
 130 static void set_freq(struct i2c_client *c, unsigned long freq)
 131 {
 132         struct tuner *t = i2c_get_clientdata(c);
 133
 134         switch (t->mode) {
 135         case V4L2_TUNER_RADIO:
 136                 tuner_dbg("radio freq set to %lu.%02lu\n",
 137                           freq / 16000, freq % 16000 * 100 / 16000);
 138                 set_radio_freq(c, freq);
 139                 t->radio_freq = freq;
 140                 break;
 141         case V4L2_TUNER_ANALOG_TV:
 142         case V4L2_TUNER_DIGITAL_TV:
 143                 tuner_dbg("tv freq set to %lu.%02lu\n",
 144                           freq / 16, freq % 16 * 100 / 16);
 145                 set_tv_freq(c, freq);
 146                 t->tv_freq = freq;
 147                 break;
 148         }
 149 }
 150
 151 static void set_type(struct i2c_client *c, unsigned int type,
 152                      unsigned int new_mode_mask)
 153 {
 154         struct tuner *t = i2c_get_clientdata(c);
 155         unsigned char buffer[4];
 156
 157         if (type == UNSET || type == TUNER_ABSENT) {
 158                 tuner_dbg ("tuner 0x%02x: Tuner type absent\n",c->addr);
 159                 return;
 160         }
 161
 162         if (type >= tuner_count) {
 163                 tuner_warn ("tuner 0x%02x: Tuner count greater than %d\n",c->addr,tuner_count);
 164                 return;
 165         }
 166
 167         /* This code detects calls by card attach_inform */
 168         if (NULL == t->i2c.dev.driver) {
 169                 tuner_dbg ("tuner 0x%02x: called during i2c_client register by adapter's attach_inform\n", c->addr);
 170
 171                 t->type=type;
 172                 return;
 173         }
 174
 175         t->type = type;
 176
 177         switch (t->type) {
 178         case TUNER_MT2032:
 179                 microtune_init(c);
 180                 break;
 181         case TUNER_PHILIPS_TDA8290:
 182                 tda8290_init(c);
 183                 break;
 184         case TUNER_TEA5767:
 185                 if (tea5767_tuner_init(c) == EINVAL) {
 186                         t->type = TUNER_ABSENT;
 187                         t->mode_mask = T_UNINITIALIZED;
 188                         return;
 189                 }
 190                 t->mode_mask = T_RADIO;
 191                 break;
 192         case TUNER_PHILIPS_FMD1216ME_MK3:
 193                 buffer[0] = 0x0b;
 194                 buffer[1] = 0xdc;
 195                 buffer[2] = 0x9c;
 196                 buffer[3] = 0x60;
 197                 i2c_master_send(c, buffer, 4);
 198                 mdelay(1);
 199                 buffer[2] = 0x86;
 200                 buffer[3] = 0x54;
 201                 i2c_master_send(c, buffer, 4);
 202                 default_tuner_init(c);
 203                 break;
 204         case TUNER_LG_TDVS_H062F:
 205                 /* Set the Auxiliary Byte. */
 206                 buffer[2] &= ~0x20;
 207                 buffer[2] |= 0x18;
 208                 buffer[3] = 0x20;
 209                 i2c_master_send(c, buffer, 4);
 210                 default_tuner_init(c);
 211                 break;
 212         case TUNER_PHILIPS_TD1316:
 213                 buffer[0] = 0x0b;
 214                 buffer[1] = 0xdc;
 215                 buffer[2] = 0x86;
 216                 buffer[3] = 0xa4;
 217                 i2c_master_send(c,buffer,4);
 218                 default_tuner_init(c);
 219                 break;
 220         default:
 221                 default_tuner_init(c);
 222                 break;
 223         }
 224
 225         if (t->mode_mask == T_UNINITIALIZED)
 226                 t->mode_mask = new_mode_mask;
 227
 228         set_freq(c, (V4L2_TUNER_RADIO == t->mode) ? t->radio_freq : t->tv_freq);
 229         tuner_dbg("%s %s I2C addr 0x%02x with type %d used for 0x%02x\n",
 230                   c->adapter->name, c->driver->driver.name, c->addr << 1, type,
 231                   t->mode_mask);
 232 }
 233
 234 /*
 235  * This function apply tuner config to tuner specified
 236  * by tun_setup structure. I addr is unset, then admin status
 237  * and tun addr status is more precise then current status,
 238  * it's applied. Otherwise status and type are applied only to
 239  * tuner with exactly the same addr.
 240 */
 241
 242 static void set_addr(struct i2c_client *c, struct tuner_setup *tun_setup)
 243 {
 244         struct tuner *t = i2c_get_clientdata(c);
 245
 246         if ( t->type == UNSET && ((tun_setup->addr == ADDR_UNSET &&
 247                 (t->mode_mask & tun_setup->mode_mask)) ||
 248                 tun_setup->addr == c->addr)) {
 249                         set_type(c, tun_setup->type, tun_setup->mode_mask);
 250         }
 251 }
 252
 253 static inline int check_mode(struct tuner *t, char *cmd)
 254 {
 255         if ((1 << t->mode & t->mode_mask) == 0) {
 256                 return EINVAL;
 257         }
 258
 259         switch (t->mode) {
 260         case V4L2_TUNER_RADIO:
 261                 tuner_dbg("Cmd %s accepted for radio\n", cmd);
 262                 break;
 263         case V4L2_TUNER_ANALOG_TV:
 264                 tuner_dbg("Cmd %s accepted for analog TV\n", cmd);
 265                 break;
 266         case V4L2_TUNER_DIGITAL_TV:
 267                 tuner_dbg("Cmd %s accepted for digital TV\n", cmd);
 268                 break;
 269         }
 270         return 0;
 271 }
 272
 273 /* get more precise norm info from insmod option */
 274 static int tuner_fixup_std(struct tuner *t)
 275 {
 276         if ((t->std & V4L2_STD_PAL) == V4L2_STD_PAL) {
 277                 switch (pal[0]) {
 278                 case 'b':
 279                 case 'B':
 280                 case 'g':
 281                 case 'G':
 282                         tuner_dbg ("insmod fixup: PAL => PAL-BG\n");
 283                         t->std = V4L2_STD_PAL_BG;
 284                         break;
 285                 case 'i':
 286                 case 'I':
 287                         tuner_dbg ("insmod fixup: PAL => PAL-I\n");
 288                         t->std = V4L2_STD_PAL_I;
 289                         break;
 290                 case 'd':
 291                 case 'D':
 292                 case 'k':
 293                 case 'K':
 294                         tuner_dbg ("insmod fixup: PAL => PAL-DK\n");
 295                         t->std = V4L2_STD_PAL_DK;
 296                         break;
 297                 case 'M':
 298                 case 'm':
 299                         tuner_dbg ("insmod fixup: PAL => PAL-M\n");
 300                         t->std = V4L2_STD_PAL_M;
 301                         break;
 302                 case 'N':
 303                 case 'n':
 304                         if (pal[1] == 'c' || pal[1] == 'C') {
 305                                 tuner_dbg("insmod fixup: PAL => PAL-Nc\n");
 306                                 t->std = V4L2_STD_PAL_Nc;
 307                         } else {
 308                                 tuner_dbg ("insmod fixup: PAL => PAL-N\n");
 309                                 t->std = V4L2_STD_PAL_N;
 310                         }
 311                         break;
 312                 case '-':
 313                         /* default parameter, do nothing */
 314                         break;
 315                 default:
 316                         tuner_warn ("pal= argument not recognised\n");
 317                         break;
 318                 }
 319         }
 320         if ((t->std & V4L2_STD_SECAM) == V4L2_STD_SECAM) {
 321                 switch (secam[0]) {
 322                 case 'b':
 323                 case 'B':
 324                 case 'g':
 325                 case 'G':
 326                 case 'h':
 327                 case 'H':
 328                         tuner_dbg("insmod fixup: SECAM => SECAM-BGH\n");
 329                         t->std = V4L2_STD_SECAM_B | V4L2_STD_SECAM_G | V4L2_STD_SECAM_H;
 330                         break;
 331                 case 'd':
 332                 case 'D':
 333                 case 'k':
 334                 case 'K':
 335                         tuner_dbg ("insmod fixup: SECAM => SECAM-DK\n");
 336                         t->std = V4L2_STD_SECAM_DK;
 337                         break;
 338                 case 'l':
 339                 case 'L':
 340                         if ((secam[1]=='C')||(secam[1]=='c')) {
 341                                 tuner_dbg ("insmod fixup: SECAM => SECAM-L'\n");
 342                                 t->std = V4L2_STD_SECAM_LC;
 343                         } else {
 344                                 tuner_dbg ("insmod fixup: SECAM => SECAM-L\n");
 345                                 t->std = V4L2_STD_SECAM_L;
 346                         }
 347                         break;
 348                 case '-':
 349                         /* default parameter, do nothing */
 350                         break;
 351                 default:
 352                         tuner_warn ("secam= argument not recognised\n");
 353                         break;
 354                 }
 355         }
 356
 357         if ((t->std & V4L2_STD_NTSC) == V4L2_STD_NTSC) {
 358                 switch (ntsc[0]) {
 359                 case 'm':
 360                 case 'M':
 361                         tuner_dbg("insmod fixup: NTSC => NTSC-M\n");
 362                         t->std = V4L2_STD_NTSC_M;
 363                         break;
 364                 case 'j':
 365                 case 'J':
 366                         tuner_dbg("insmod fixup: NTSC => NTSC_M_JP\n");
 367                         t->std = V4L2_STD_NTSC_M_JP;
 368                         break;
 369                 case '-':
 370                         /* default parameter, do nothing */
 371                         break;
 372                 default:
 373                         tuner_info("ntsc= argument not recognised\n");
 374                         break;
 375                 }
 376         }
 377         return 0;
 378 }
 379
 380 static void tuner_status(struct i2c_client *client)
 381 {
 382         struct tuner *t = i2c_get_clientdata(client);
 383         unsigned long freq, freq_fraction;
 384         const char *p;
 385
 386         switch (t->mode) {
 387                 case V4L2_TUNER_RADIO:      p = "radio"; break;
 388                 case V4L2_TUNER_ANALOG_TV:  p = "analog TV"; break;
 389                 case V4L2_TUNER_DIGITAL_TV: p = "digital TV"; break;
 390                 default: p = "undefined"; break;
 391         }
 392         if (t->mode == V4L2_TUNER_RADIO) {
 393                 freq = t->radio_freq / 16000;
 394                 freq_fraction = (t->radio_freq % 16000) * 100 / 16000;
 395         } else {
 396                 freq = t->tv_freq / 16;
 397                 freq_fraction = (t->tv_freq % 16) * 100 / 16;
 398         }
 399         tuner_info("Tuner mode:      %s\n", p);
 400         tuner_info("Frequency:       %lu.%02lu MHz\n", freq, freq_fraction);
 401         tuner_info("Standard:        0x%08llx\n", t->std);
 402         if (t->mode != V4L2_TUNER_RADIO)
 403                return;
 404         if (t->has_signal) {
 405                 tuner_info("Signal strength: %d\n", t->has_signal(client));
 406         }
 407         if (t->is_stereo) {
 408                 tuner_info("Stereo:          %s\n", t->is_stereo(client) ? "yes" : "no");
 409         }
 410 }
 411
 412 /* ---------------------------------------------------------------------- */
 413
 414 /* static var Used only in tuner_attach and tuner_probe */
 415 static unsigned default_mode_mask;
 416
 417 /* During client attach, set_type is called by adapter's attach_inform callback.
 418    set_type must then be completed by tuner_attach.
 419  */
 420 static int tuner_attach(struct i2c_adapter *adap, int addr, int kind)
 421 {
 422         struct tuner *t;
 423
 424         client_template.adapter = adap;
 425         client_template.addr = addr;
 426
 427         t = kzalloc(sizeof(struct tuner), GFP_KERNEL);
 428         if (NULL == t)
 429                 return -ENOMEM;
 430         memcpy(&t->i2c, &client_template, sizeof(struct i2c_client));
 431         i2c_set_clientdata(&t->i2c, t);
 432         t->type = UNSET;
 433         t->radio_if2 = 10700 * 1000;    /* 10.7MHz - FM radio */
 434         t->audmode = V4L2_TUNER_MODE_STEREO;
 435         t->mode_mask = T_UNINITIALIZED;
 436         if (tuner_debug_old) {
 437                 tuner_debug = tuner_debug_old;
 438                 printk(KERN_ERR "tuner: tuner_debug is deprecated and will be removed in 2.6.17.\n");
 439                 printk(KERN_ERR "tuner: use the debug option instead.\n");
 440         }
 441
 442         if (show_i2c) {
 443                 unsigned char buffer[16];
 444                 int i,rc;
 445
 446                 memset(buffer, 0, sizeof(buffer));
 447                 rc = i2c_master_recv(&t->i2c, buffer, sizeof(buffer));
 448                 tuner_info("I2C RECV = ");
 449                 for (i=0;i<rc;i++)
 450                         printk("%02x ",buffer[i]);
 451                 printk("\n");
 452         }
 453         /* autodetection code based on the i2c addr */
 454         if (!no_autodetect) {
 455                 switch (addr) {
 456                 case 0x42:
 457                 case 0x43:
 458                 case 0x4a:
 459                 case 0x4b:
 460                         /* If chip is not tda8290, don't register.
 461                            since it can be tda9887*/
 462                         if (tda8290_probe(&t->i2c) != 0) {
 463                                 tuner_dbg("chip at addr %x is not a tda8290\n", addr);
 464                                 kfree(t);
 465                                 return 0;
 466                         }
 467                         break;
 468                 case 0x60:
 469                         if (tea5767_autodetection(&t->i2c) != EINVAL) {
 470                                 t->type = TUNER_TEA5767;
 471                                 t->mode_mask = T_RADIO;
 472                                 t->mode = T_STANDBY;
 473                                 t->radio_freq = 87.5 * 16000; /* Sets freq to FM range */
 474                                 default_mode_mask &= ~T_RADIO;
 475
 476                                 goto register_client;
 477                         }
 478                         break;
 479                 }
 480         }
 481
 482         /* Initializes only the first adapter found */
 483         if (default_mode_mask != T_UNINITIALIZED) {
 484                 tuner_dbg ("Setting mode_mask to 0x%02x\n", default_mode_mask);
 485                 t->mode_mask = default_mode_mask;
 486                 t->tv_freq = 400 * 16; /* Sets freq to VHF High */
 487                 t->radio_freq = 87.5 * 16000; /* Sets freq to FM range */
 488                 default_mode_mask = T_UNINITIALIZED;
 489         }
 490
 491         /* Should be just before return */
 492 register_client:
 493         tuner_info("chip found @ 0x%x (%s)\n", addr << 1, adap->name);
 494         i2c_attach_client (&t->i2c);
 495         set_type (&t->i2c,t->type, t->mode_mask);
 496         return 0;
 497 }
 498
 499 static int tuner_probe(struct i2c_adapter *adap)
 500 {
 501         if (0 != addr) {
 502                 normal_i2c[0] = addr;
 503                 normal_i2c[1] = I2C_CLIENT_END;
 504         }
 505
 506         default_mode_mask = T_RADIO | T_ANALOG_TV | T_DIGITAL_TV;
 507
 508         if (adap->class & I2C_CLASS_TV_ANALOG)
 509                 return i2c_probe(adap, &addr_data, tuner_attach);
 510         return 0;
 511 }
 512
 513 static int tuner_detach(struct i2c_client *client)
 514 {
 515         struct tuner *t = i2c_get_clientdata(client);
 516         int err;
 517
 518         err = i2c_detach_client(&t->i2c);
 519         if (err) {
 520                 tuner_warn
 521                     ("Client deregistration failed, client not detached.\n");
 522                 return err;
 523         }
 524
 525         kfree(t);
 526         return 0;
 527 }
 528
 529 /*
 530  * Switch tuner to other mode. If tuner support both tv and radio,
 531  * set another frequency to some value (This is needed for some pal
 532  * tuners to avoid locking). Otherwise, just put second tuner in
 533  * standby mode.
 534  */
 535
 536 static inline int set_mode(struct i2c_client *client, struct tuner *t, int mode, char *cmd)
 537 {
 538         if (mode == t->mode)
 539                 return 0;
 540
 541         t->mode = mode;
 542
 543         if (check_mode(t, cmd) == EINVAL) {
 544                 t->mode = T_STANDBY;
 545                 if (t->standby)
 546                         t->standby (client);
 547                 return EINVAL;
 548         }
 549         return 0;
 550 }
 551
 552 #define switch_v4l2()   if (!t->using_v4l2) \
 553                             tuner_dbg("switching to v4l2\n"); \
 554                         t->using_v4l2 = 1;
 555
 556 static inline int check_v4l2(struct tuner *t)
 557 {
 558         if (t->using_v4l2) {
 559                 tuner_dbg ("ignore v4l1 call\n");
 560                 return EINVAL;
 561         }
 562         return 0;
 563 }
 564
 565 static int tuner_command(struct i2c_client *client, unsigned int cmd, void *arg)
 566 {
 567         struct tuner *t = i2c_get_clientdata(client);
 568
 569         if (tuner_debug>1)
 570                 v4l_i2c_print_ioctl(&(t->i2c),cmd);
 571
 572         switch (cmd) {
 573         /* --- configuration --- */
 574         case TUNER_SET_TYPE_ADDR:
 575                 tuner_dbg ("Calling set_type_addr for type=%d, addr=0x%02x, mode=0x%02x\n",
 576                                 ((struct tuner_setup *)arg)->type,
 577                                 ((struct tuner_setup *)arg)->addr,
 578                                 ((struct tuner_setup *)arg)->mode_mask);
 579
 580                 set_addr(client, (struct tuner_setup *)arg);
 581                 break;
 582         case AUDC_SET_RADIO:
 583                 if (set_mode(client, t, V4L2_TUNER_RADIO, "AUDC_SET_RADIO")
 584                                 == EINVAL)
 585                         return 0;
 586                 if (t->radio_freq)
 587                         set_freq(client, t->radio_freq);
 588                 break;
 589         case TUNER_SET_STANDBY:
 590                 if (check_mode(t, "TUNER_SET_STANDBY") == EINVAL)
 591                         return 0;
 592                 if (t->standby)
 593                         t->standby (client);
 594                 break;
 595         case VIDIOCSAUDIO:
 596                 if (check_mode(t, "VIDIOCSAUDIO") == EINVAL)
 597                         return 0;
 598                 if (check_v4l2(t) == EINVAL)
 599                         return 0;
 600
 601                 /* Should be implemented, since bttv calls it */
 602                 tuner_dbg("VIDIOCSAUDIO not implemented.\n");
 603                 break;
 604         /* --- v4l ioctls --- */
 605         /* take care: bttv does userspace copying, we'll get a
 606            kernel pointer here... */
 607         case VIDIOCSCHAN:
 608                 {
 609                         static const v4l2_std_id map[] = {
 610                                 [VIDEO_MODE_PAL] = V4L2_STD_PAL,
 611                                 [VIDEO_MODE_NTSC] = V4L2_STD_NTSC_M,
 612                                 [VIDEO_MODE_SECAM] = V4L2_STD_SECAM,
 613                                 [4 /* bttv */ ] = V4L2_STD_PAL_M,
 614                                 [5 /* bttv */ ] = V4L2_STD_PAL_N,
 615                                 [6 /* bttv */ ] = V4L2_STD_NTSC_M_JP,
 616                         };
 617                         struct video_channel *vc = arg;
 618
 619                         if (check_v4l2(t) == EINVAL)
 620                                 return 0;
 621
 622                         if (set_mode(client,t,V4L2_TUNER_ANALOG_TV, "VIDIOCSCHAN")==EINVAL)
 623                                 return 0;
 624
 625                         if (vc->norm < ARRAY_SIZE(map))
 626                                 t->std = map[vc->norm];
 627                         tuner_fixup_std(t);
 628                         if (t->tv_freq)
 629                                 set_tv_freq(client, t->tv_freq);
 630                         return 0;
 631                 }
 632         case VIDIOCSFREQ:
 633                 {
 634                         unsigned long *v = arg;
 635
 636                         if (check_mode(t, "VIDIOCSFREQ") == EINVAL)
 637                                 return 0;
 638                         if (check_v4l2(t) == EINVAL)
 639                                 return 0;
 640
 641                         set_freq(client, *v);
 642                         return 0;
 643                 }
 644         case VIDIOCGTUNER:
 645                 {
 646                         struct video_tuner *vt = arg;
 647
 648                         if (check_mode(t, "VIDIOCGTUNER") == EINVAL)
 649                                 return 0;
 650                         if (check_v4l2(t) == EINVAL)
 651                                 return 0;
 652
 653                         if (V4L2_TUNER_RADIO == t->mode) {
 654                                 if (t->has_signal)
 655                                         vt->signal = t->has_signal(client);
 656                                 if (t->is_stereo) {
 657                                         if (t->is_stereo(client))
 658                                                 vt->flags |=
 659                                                     VIDEO_TUNER_STEREO_ON;
 660                                         else
 661                                                 vt->flags &=
 662                                                     ~VIDEO_TUNER_STEREO_ON;
 663                                 }
 664                                 vt->flags |= VIDEO_TUNER_LOW;   /* Allow freqs at 62.5 Hz */
 665
 666                                 vt->rangelow = radio_range[0] * 16000;
 667                                 vt->rangehigh = radio_range[1] * 16000;
 668
 669                         } else {
 670                                 vt->rangelow = tv_range[0] * 16;
 671                                 vt->rangehigh = tv_range[1] * 16;
 672                         }
 673
 674                         return 0;
 675                 }
 676         case VIDIOCGAUDIO:
 677                 {
 678                         struct video_audio *va = arg;
 679
 680                         if (check_mode(t, "VIDIOCGAUDIO") == EINVAL)
 681                                 return 0;
 682                         if (check_v4l2(t) == EINVAL)
 683                                 return 0;
 684
 685                         if (V4L2_TUNER_RADIO == t->mode && t->is_stereo)
 686                                 va->mode = t->is_stereo(client)
 687                                     ? VIDEO_SOUND_STEREO : VIDEO_SOUND_MONO;
 688                         return 0;
 689                 }
 690
 691         case VIDIOC_S_STD:
 692                 {
 693                         v4l2_std_id *id = arg;
 694
 695                         if (set_mode (client, t, V4L2_TUNER_ANALOG_TV, "VIDIOC_S_STD")
 696                                         == EINVAL)
 697                                 return 0;
 698
 699                         switch_v4l2();
 700
 701                         t->std = *id;
 702                         tuner_fixup_std(t);
 703                         if (t->tv_freq)
 704                                 set_freq(client, t->tv_freq);
 705                         break;
 706                 }
 707         case VIDIOC_S_FREQUENCY:
 708                 {
 709                         struct v4l2_frequency *f = arg;
 710
 711                         switch_v4l2();
 712                         if (V4L2_TUNER_RADIO == f->type &&
 713                             V4L2_TUNER_RADIO != t->mode) {
 714                                 if (set_mode (client, t, f->type, "VIDIOC_S_FREQUENCY")
 715                                             == EINVAL)
 716                                         return 0;
 717                         }
 718                         set_freq(client,f->frequency);
 719
 720                         break;
 721                 }
 722         case VIDIOC_G_FREQUENCY:
 723                 {
 724                         struct v4l2_frequency *f = arg;
 725
 726                         if (check_mode(t, "VIDIOC_G_FREQUENCY") == EINVAL)
 727                                 return 0;
 728                         switch_v4l2();
 729                         f->type = t->mode;
 730                         f->frequency = (V4L2_TUNER_RADIO == t->mode) ?
 731                                 t->radio_freq : t->tv_freq;
 732                         break;
 733                 }
 734         case VIDIOC_G_TUNER:
 735                 {
 736                         struct v4l2_tuner *tuner = arg;
 737
 738                         if (check_mode(t, "VIDIOC_G_TUNER") == EINVAL)
 739                                 return 0;
 740                         switch_v4l2();
 741
 742                         tuner->type = t->mode;
 743                         if (t->mode != V4L2_TUNER_RADIO) {
 744                                 tuner->rangelow = tv_range[0] * 16;
 745                                 tuner->rangehigh = tv_range[1] * 16;
 746                                 break;
 747                         }
 748
 749                         /* radio mode */
 750                         if (t->has_signal)
 751                                 tuner->signal = t->has_signal(client);
 752
 753                         tuner->rxsubchans =
 754                                 V4L2_TUNER_SUB_MONO | V4L2_TUNER_SUB_STEREO;
 755                         if (t->is_stereo) {
 756                                 tuner->rxsubchans = t->is_stereo(client) ?
 757                                         V4L2_TUNER_SUB_STEREO : V4L2_TUNER_SUB_MONO;
 758                         }
 759
 760                         tuner->capability |=
 761                             V4L2_TUNER_CAP_LOW | V4L2_TUNER_CAP_STEREO;
 762                         tuner->audmode = t->audmode;
 763                         tuner->rangelow = radio_range[0] * 16000;
 764                         tuner->rangehigh = radio_range[1] * 16000;
 765                         break;
 766                 }
 767         case VIDIOC_S_TUNER:
 768                 {
 769                         struct v4l2_tuner *tuner = arg;
 770
 771                         if (check_mode(t, "VIDIOC_S_TUNER") == EINVAL)
 772                                 return 0;
 773
 774                         switch_v4l2();
 775
 776                         /* do nothing unless we're a radio tuner */
 777                         if (t->mode != V4L2_TUNER_RADIO)
 778                                 break;
 779                         t->audmode = tuner->audmode;
 780                         set_radio_freq(client, t->radio_freq);
 781                         break;
 782                 }
 783         case VIDIOC_LOG_STATUS:
 784                 tuner_status(client);
 785                 break;
 786         }
 787
 788         return 0;
 789 }
 790
 791 static int tuner_suspend(struct device *dev, pm_message_t state)
 792 {
 793         struct i2c_client *c = container_of (dev, struct i2c_client, dev);
 794         struct tuner *t = i2c_get_clientdata (c);
 795
 796         tuner_dbg ("suspend\n");
 797         /* FIXME: power down ??? */
 798         return 0;
 799 }
 800
 801 static int tuner_resume(struct device *dev)
 802 {
 803         struct i2c_client *c = container_of (dev, struct i2c_client, dev);
 804         struct tuner *t = i2c_get_clientdata (c);
 805
 806         tuner_dbg ("resume\n");
 807         if (V4L2_TUNER_RADIO == t->mode) {
 808                 if (t->radio_freq)
 809                         set_freq(c, t->radio_freq);
 810         } else {
 811                 if (t->tv_freq)
 812                         set_freq(c, t->tv_freq);
 813         }
 814         return 0;
 815 }
 816
 817 /* ----------------------------------------------------------------------- */
 818
 819 static struct i2c_driver driver = {
 820         .id = I2C_DRIVERID_TUNER,
 821         .attach_adapter = tuner_probe,
 822         .detach_client = tuner_detach,
 823         .command = tuner_command,
 824         .driver = {
 825                 .name    = "tuner",
 826                 .suspend = tuner_suspend,
 827                 .resume  = tuner_resume,
 828         },
 829 };
 830 static struct i2c_client client_template = {
 831         .name = "(tuner unset)",
 832         .driver = &driver,
 833 };
 834
 835 static int __init tuner_init_module(void)
 836 {
 837         return i2c_add_driver(&driver);
 838 }
 839
 840 static void __exit tuner_cleanup_module(void)
 841 {
 842         i2c_del_driver(&driver);
 843 }
 844
 845 module_init(tuner_init_module);
 846 module_exit(tuner_cleanup_module);
 847
 848 /*
 849  * Overrides for Emacs so that we follow Linus's tabbing style.
 850  * ---------------------------------------------------------------------------
 851  * Local variables:
 852  * c-basic-offset: 8
 853  * End:
 854  */