drivers/media/radio/radio-cadet.c

   1 /* radio-cadet.c - A video4linux driver for the ADS Cadet AM/FM Radio Card
   2  *
   3  * by Fred Gleason <fredg@wava.com>
   4  * Version 0.3.3
   5  *
   6  * (Loosely) based on code for the Aztech radio card by
   7  *
   8  * Russell Kroll    (rkroll@exploits.org)
   9  * Quay Ly
  10  * Donald Song
  11  * Jason Lewis      (jlewis@twilight.vtc.vsc.edu)
  12  * Scott McGrath    (smcgrath@twilight.vtc.vsc.edu)
  13  * William McGrath  (wmcgrath@twilight.vtc.vsc.edu)
  14  *
  15  * History:
  16  * 2000-04-29   Russell Kroll <rkroll@exploits.org>
  17  *              Added ISAPnP detection for Linux 2.3/2.4
  18  *
  19  * 2001-01-10   Russell Kroll <rkroll@exploits.org>
  20  *              Removed dead CONFIG_RADIO_CADET_PORT code
  21  *              PnP detection on load is now default (no args necessary)
  22  *
  23  * 2002-01-17   Adam Belay <ambx1@neo.rr.com>
  24  *              Updated to latest pnp code
  25  *
  26  * 2003-01-31   Alan Cox <alan@lxorguk.ukuu.org.uk>
  27  *              Cleaned up locking, delay code, general odds and ends
  28  *
  29  * 2006-07-30   Hans J. Koch <koch@hjk-az.de>
  30  *              Changed API to V4L2
  31  */
  32
  33 #include <linux/module.h>       /* Modules                      */
  34 #include <linux/init.h>         /* Initdata                     */
  35 #include <linux/ioport.h>       /* request_region               */
  36 #include <linux/delay.h>        /* udelay                       */
  37 #include <linux/videodev2.h>    /* V4L2 API defs                */
  38 #include <linux/param.h>
  39 #include <linux/pnp.h>
  40 #include <linux/sched.h>
  41 #include <linux/io.h>           /* outb, outb_p                 */
  42 #include <media/v4l2-device.h>
  43 #include <media/v4l2-ioctl.h>
  44
  45 MODULE_AUTHOR("Fred Gleason, Russell Kroll, Quay Lu, Donald Song, Jason Lewis, Scott McGrath, William McGrath");
  46 MODULE_DESCRIPTION("A driver for the ADS Cadet AM/FM/RDS radio card.");
  47 MODULE_LICENSE("GPL");
  48 MODULE_VERSION("0.3.4");
  49
  50 static int io = -1;             /* default to isapnp activation */
  51 static int radio_nr = -1;
  52
  53 module_param(io, int, 0);
  54 MODULE_PARM_DESC(io, "I/O address of Cadet card (0x330,0x332,0x334,0x336,0x338,0x33a,0x33c,0x33e)");
  55 module_param(radio_nr, int, 0);
  56
  57 #define RDS_BUFFER 256
  58 #define RDS_RX_FLAG 1
  59 #define MBS_RX_FLAG 2
  60
  61 struct cadet {
  62         struct v4l2_device v4l2_dev;
  63         struct video_device vdev;
  64         int io;
  65         int users;
  66         int curtuner;
  67         int tunestat;
  68         int sigstrength;
  69         wait_queue_head_t read_queue;
  70         struct timer_list readtimer;
  71         __u8 rdsin, rdsout, rdsstat;
  72         unsigned char rdsbuf[RDS_BUFFER];
  73         struct mutex lock;
  74         int reading;
  75 };
  76
  77 static struct cadet cadet_card;
  78
  79 /*
  80  * Signal Strength Threshold Values
  81  * The V4L API spec does not define any particular unit for the signal
  82  * strength value.  These values are in microvolts of RF at the tuner's input.
  83  */
  84 static __u16 sigtable[2][4] = {
  85         {  5, 10, 30,  150 },
  86         { 28, 40, 63, 1000 }
  87 };
  88
  89
  90 static int cadet_getstereo(struct cadet *dev)
  91 {
  92         int ret = V4L2_TUNER_SUB_MONO;
  93
  94         if (dev->curtuner != 0) /* Only FM has stereo capability! */
  95                 return V4L2_TUNER_SUB_MONO;
  96
  97         mutex_lock(&dev->lock);
  98         outb(7, dev->io);          /* Select tuner control */
  99         if ((inb(dev->io + 1) & 0x40) == 0)
 100                 ret = V4L2_TUNER_SUB_STEREO;
 101         mutex_unlock(&dev->lock);
 102         return ret;
 103 }
 104
 105 static unsigned cadet_gettune(struct cadet *dev)
 106 {
 107         int curvol, i;
 108         unsigned fifo = 0;
 109
 110         /*
 111          * Prepare for read
 112          */
 113
 114         mutex_lock(&dev->lock);
 115
 116         outb(7, dev->io);       /* Select tuner control */
 117         curvol = inb(dev->io + 1); /* Save current volume/mute setting */
 118         outb(0x00, dev->io + 1);  /* Ensure WRITE-ENABLE is LOW */
 119         dev->tunestat = 0xffff;
 120
 121         /*
 122          * Read the shift register
 123          */
 124         for (i = 0; i < 25; i++) {
 125                 fifo = (fifo << 1) | ((inb(dev->io + 1) >> 7) & 0x01);
 126                 if (i < 24) {
 127                         outb(0x01, dev->io + 1);
 128                         dev->tunestat &= inb(dev->io + 1);
 129                         outb(0x00, dev->io + 1);
 130                 }
 131         }
 132
 133         /*
 134          * Restore volume/mute setting
 135          */
 136         outb(curvol, dev->io + 1);
 137         mutex_unlock(&dev->lock);
 138
 139         return fifo;
 140 }
 141
 142 static unsigned cadet_getfreq(struct cadet *dev)
 143 {
 144         int i;
 145         unsigned freq = 0, test, fifo = 0;
 146
 147         /*
 148          * Read current tuning
 149          */
 150         fifo = cadet_gettune(dev);
 151
 152         /*
 153          * Convert to actual frequency
 154          */
 155         if (dev->curtuner == 0) {    /* FM */
 156                 test = 12500;
 157                 for (i = 0; i < 14; i++) {
 158                         if ((fifo & 0x01) != 0)
 159                                 freq += test;
 160                         test = test << 1;
 161                         fifo = fifo >> 1;
 162                 }
 163                 freq -= 10700000;           /* IF frequency is 10.7 MHz */
 164                 freq = (freq * 16) / 1000000;   /* Make it 1/16 MHz */
 165         }
 166         if (dev->curtuner == 1)    /* AM */
 167                 freq = ((fifo & 0x7fff) - 2010) * 16;
 168
 169         return freq;
 170 }
 171
 172 static void cadet_settune(struct cadet *dev, unsigned fifo)
 173 {
 174         int i;
 175         unsigned test;
 176
 177         mutex_lock(&dev->lock);
 178
 179         outb(7, dev->io);                /* Select tuner control */
 180         /*
 181          * Write the shift register
 182          */
 183         test = 0;
 184         test = (fifo >> 23) & 0x02;      /* Align data for SDO */
 185         test |= 0x1c;                /* SDM=1, SWE=1, SEN=1, SCK=0 */
 186         outb(7, dev->io);                /* Select tuner control */
 187         outb(test, dev->io + 1);           /* Initialize for write */
 188         for (i = 0; i < 25; i++) {
 189                 test |= 0x01;              /* Toggle SCK High */
 190                 outb(test, dev->io + 1);
 191                 test &= 0xfe;              /* Toggle SCK Low */
 192                 outb(test, dev->io + 1);
 193                 fifo = fifo << 1;            /* Prepare the next bit */
 194                 test = 0x1c | ((fifo >> 23) & 0x02);
 195                 outb(test, dev->io + 1);
 196         }
 197         mutex_unlock(&dev->lock);
 198 }
 199
 200 static void cadet_setfreq(struct cadet *dev, unsigned freq)
 201 {
 202         unsigned fifo;
 203         int i, j, test;
 204         int curvol;
 205
 206         /*
 207          * Formulate a fifo command
 208          */
 209         fifo = 0;
 210         if (dev->curtuner == 0) {    /* FM */
 211                 test = 102400;
 212                 freq = (freq * 1000) / 16;       /* Make it kHz */
 213                 freq += 10700;               /* IF is 10700 kHz */
 214                 for (i = 0; i < 14; i++) {
 215                         fifo = fifo << 1;
 216                         if (freq >= test) {
 217                                 fifo |= 0x01;
 218                                 freq -= test;
 219                         }
 220                         test = test >> 1;
 221                 }
 222         }
 223         if (dev->curtuner == 1) {    /* AM */
 224                 fifo = (freq / 16) + 2010;            /* Make it kHz */
 225                 fifo |= 0x100000;            /* Select AM Band */
 226         }
 227
 228         /*
 229          * Save current volume/mute setting
 230          */
 231
 232         mutex_lock(&dev->lock);
 233         outb(7, dev->io);                /* Select tuner control */
 234         curvol = inb(dev->io + 1);
 235         mutex_unlock(&dev->lock);
 236
 237         /*
 238          * Tune the card
 239          */
 240         for (j = 3; j > -1; j--) {
 241                 cadet_settune(dev, fifo | (j << 16));
 242
 243                 mutex_lock(&dev->lock);
 244                 outb(7, dev->io);         /* Select tuner control */
 245                 outb(curvol, dev->io + 1);
 246                 mutex_unlock(&dev->lock);
 247
 248                 msleep(100);
 249
 250                 cadet_gettune(dev);
 251                 if ((dev->tunestat & 0x40) == 0) {   /* Tuned */
 252                         dev->sigstrength = sigtable[dev->curtuner][j];
 253                         return;
 254                 }
 255         }
 256         dev->sigstrength = 0;
 257 }
 258
 259
 260 static int cadet_getvol(struct cadet *dev)
 261 {
 262         int ret = 0;
 263
 264         mutex_lock(&dev->lock);
 265
 266         outb(7, dev->io);                /* Select tuner control */
 267         if ((inb(dev->io + 1) & 0x20) != 0)
 268                 ret = 0xffff;
 269
 270         mutex_unlock(&dev->lock);
 271         return ret;
 272 }
 273
 274
 275 static void cadet_setvol(struct cadet *dev, int vol)
 276 {
 277         mutex_lock(&dev->lock);
 278         outb(7, dev->io);                /* Select tuner control */
 279         if (vol > 0)
 280                 outb(0x20, dev->io + 1);
 281         else
 282                 outb(0x00, dev->io + 1);
 283         mutex_unlock(&dev->lock);
 284 }
 285
 286 static void cadet_handler(unsigned long data)
 287 {
 288         struct cadet *dev = (void *)data;
 289
 290         /* Service the RDS fifo */
 291         if (mutex_trylock(&dev->lock)) {
 292                 outb(0x3, dev->io);       /* Select RDS Decoder Control */
 293                 if ((inb(dev->io + 1) & 0x20) != 0)
 294                         printk(KERN_CRIT "cadet: RDS fifo overflow\n");
 295                 outb(0x80, dev->io);      /* Select RDS fifo */
 296                 while ((inb(dev->io) & 0x80) != 0) {
 297                         dev->rdsbuf[dev->rdsin] = inb(dev->io + 1);
 298                         if (dev->rdsin == dev->rdsout)
 299                                 printk(KERN_WARNING "cadet: RDS buffer overflow\n");
 300                         else
 301                                 dev->rdsin++;
 302                 }
 303                 mutex_unlock(&dev->lock);
 304         }
 305
 306         /*
 307          * Service pending read
 308          */
 309         if (dev->rdsin != dev->rdsout)
 310                 wake_up_interruptible(&dev->read_queue);
 311
 312         /*
 313          * Clean up and exit
 314          */
 315         init_timer(&dev->readtimer);
 316         dev->readtimer.function = cadet_handler;
 317         dev->readtimer.data = (unsigned long)0;
 318         dev->readtimer.expires = jiffies + msecs_to_jiffies(50);
 319         add_timer(&dev->readtimer);
 320 }
 321
 322
 323 static ssize_t cadet_read(struct file *file, char __user *data, size_t count, loff_t *ppos)
 324 {
 325         struct cadet *dev = video_drvdata(file);
 326         unsigned char readbuf[RDS_BUFFER];
 327         int i = 0;
 328
 329         mutex_lock(&dev->lock);
 330         if (dev->rdsstat == 0) {
 331                 dev->rdsstat = 1;
 332                 outb(0x80, dev->io);        /* Select RDS fifo */
 333                 init_timer(&dev->readtimer);
 334                 dev->readtimer.function = cadet_handler;
 335                 dev->readtimer.data = (unsigned long)dev;
 336                 dev->readtimer.expires = jiffies + msecs_to_jiffies(50);
 337                 add_timer(&dev->readtimer);
 338         }
 339         if (dev->rdsin == dev->rdsout) {
 340                 mutex_unlock(&dev->lock);
 341                 if (file->f_flags & O_NONBLOCK)
 342                         return -EWOULDBLOCK;
 343                 interruptible_sleep_on(&dev->read_queue);
 344                 mutex_lock(&dev->lock);
 345         }
 346         while (i < count && dev->rdsin != dev->rdsout)
 347                 readbuf[i++] = dev->rdsbuf[dev->rdsout++];
 348         mutex_unlock(&dev->lock);
 349
 350         if (copy_to_user(data, readbuf, i))
 351                 return -EFAULT;
 352         return i;
 353 }
 354
 355
 356 static int vidioc_querycap(struct file *file, void *priv,
 357                                 struct v4l2_capability *v)
 358 {
 359         strlcpy(v->driver, "ADS Cadet", sizeof(v->driver));
 360         strlcpy(v->card, "ADS Cadet", sizeof(v->card));
 361         strlcpy(v->bus_info, "ISA", sizeof(v->bus_info));
 362         v->capabilities = V4L2_CAP_TUNER | V4L2_CAP_RADIO |
 363                           V4L2_CAP_READWRITE | V4L2_CAP_RDS_CAPTURE;
 364         return 0;
 365 }
 366
 367 static int vidioc_g_tuner(struct file *file, void *priv,
 368                                 struct v4l2_tuner *v)
 369 {
 370         struct cadet *dev = video_drvdata(file);
 371
 372         v->type = V4L2_TUNER_RADIO;
 373         switch (v->index) {
 374         case 0:
 375                 strlcpy(v->name, "FM", sizeof(v->name));
 376                 v->capability = V4L2_TUNER_CAP_STEREO | V4L2_TUNER_CAP_RDS |
 377                         V4L2_TUNER_CAP_RDS_BLOCK_IO;
 378                 v->rangelow = 1400;     /* 87.5 MHz */
 379                 v->rangehigh = 1728;    /* 108.0 MHz */
 380                 v->rxsubchans = cadet_getstereo(dev);
 381                 switch (v->rxsubchans) {
 382                 case V4L2_TUNER_SUB_MONO:
 383                         v->audmode = V4L2_TUNER_MODE_MONO;
 384                         break;
 385                 case V4L2_TUNER_SUB_STEREO:
 386                         v->audmode = V4L2_TUNER_MODE_STEREO;
 387                         break;
 388                 default:
 389                         break;
 390                 }
 391                 v->rxsubchans |= V4L2_TUNER_SUB_RDS;
 392                 break;
 393         case 1:
 394                 strlcpy(v->name, "AM", sizeof(v->name));
 395                 v->capability = V4L2_TUNER_CAP_LOW;
 396                 v->rangelow = 8320;      /* 520 kHz */
 397                 v->rangehigh = 26400;    /* 1650 kHz */
 398                 v->rxsubchans = V4L2_TUNER_SUB_MONO;
 399                 v->audmode = V4L2_TUNER_MODE_MONO;
 400                 break;
 401         default:
 402                 return -EINVAL;
 403         }
 404         v->signal = dev->sigstrength; /* We might need to modify scaling of this */
 405         return 0;
 406 }
 407
 408 static int vidioc_s_tuner(struct file *file, void *priv,
 409                                 struct v4l2_tuner *v)
 410 {
 411         struct cadet *dev = video_drvdata(file);
 412
 413         if (v->index != 0 && v->index != 1)
 414                 return -EINVAL;
 415         dev->curtuner = v->index;
 416         return 0;
 417 }
 418
 419 static int vidioc_g_frequency(struct file *file, void *priv,
 420                                 struct v4l2_frequency *f)
 421 {
 422         struct cadet *dev = video_drvdata(file);
 423
 424         f->tuner = dev->curtuner;
 425         f->type = V4L2_TUNER_RADIO;
 426         f->frequency = cadet_getfreq(dev);
 427         return 0;
 428 }
 429
 430
 431 static int vidioc_s_frequency(struct file *file, void *priv,
 432                                 struct v4l2_frequency *f)
 433 {
 434         struct cadet *dev = video_drvdata(file);
 435
 436         if (f->type != V4L2_TUNER_RADIO)
 437                 return -EINVAL;
 438         if (dev->curtuner == 0 && (f->frequency < 1400 || f->frequency > 1728))
 439                 return -EINVAL;
 440         if (dev->curtuner == 1 && (f->frequency < 8320 || f->frequency > 26400))
 441                 return -EINVAL;
 442         cadet_setfreq(dev, f->frequency);
 443         return 0;
 444 }
 445
 446 static int vidioc_queryctrl(struct file *file, void *priv,
 447                                 struct v4l2_queryctrl *qc)
 448 {
 449         switch (qc->id) {
 450         case V4L2_CID_AUDIO_MUTE:
 451                 return v4l2_ctrl_query_fill(qc, 0, 1, 1, 1);
 452         case V4L2_CID_AUDIO_VOLUME:
 453                 return v4l2_ctrl_query_fill(qc, 0, 0xff, 1, 0xff);
 454         }
 455         return -EINVAL;
 456 }
 457
 458 static int vidioc_g_ctrl(struct file *file, void *priv,
 459                                 struct v4l2_control *ctrl)
 460 {
 461         struct cadet *dev = video_drvdata(file);
 462
 463         switch (ctrl->id) {
 464         case V4L2_CID_AUDIO_MUTE: /* TODO: Handle this correctly */
 465                 ctrl->value = (cadet_getvol(dev) == 0);
 466                 break;
 467         case V4L2_CID_AUDIO_VOLUME:
 468                 ctrl->value = cadet_getvol(dev);
 469                 break;
 470         default:
 471                 return -EINVAL;
 472         }
 473         return 0;
 474 }
 475
 476 static int vidioc_s_ctrl(struct file *file, void *priv,
 477                                 struct v4l2_control *ctrl)
 478 {
 479         struct cadet *dev = video_drvdata(file);
 480
 481         switch (ctrl->id){
 482         case V4L2_CID_AUDIO_MUTE: /* TODO: Handle this correctly */
 483                 if (ctrl->value)
 484                         cadet_setvol(dev, 0);
 485                 else
 486                         cadet_setvol(dev, 0xffff);
 487                 break;
 488         case V4L2_CID_AUDIO_VOLUME:
 489                 cadet_setvol(dev, ctrl->value);
 490                 break;
 491         default:
 492                 return -EINVAL;
 493         }
 494         return 0;
 495 }
 496
 497 static int vidioc_g_input(struct file *filp, void *priv, unsigned int *i)
 498 {
 499         *i = 0;
 500         return 0;
 501 }
 502
 503 static int vidioc_s_input(struct file *filp, void *priv, unsigned int i)
 504 {
 505         return i ? -EINVAL : 0;
 506 }
 507
 508 static int vidioc_g_audio(struct file *file, void *priv,
 509                                 struct v4l2_audio *a)
 510 {
 511         a->index = 0;
 512         strlcpy(a->name, "Radio", sizeof(a->name));
 513         a->capability = V4L2_AUDCAP_STEREO;
 514         return 0;
 515 }
 516
 517 static int vidioc_s_audio(struct file *file, void *priv,
 518                                 struct v4l2_audio *a)
 519 {
 520         return a->index ? -EINVAL : 0;
 521 }
 522
 523 static int cadet_open(struct file *file)
 524 {
 525         struct cadet *dev = video_drvdata(file);
 526
 527         mutex_lock(&dev->lock);
 528         dev->users++;
 529         if (1 == dev->users)
 530                 init_waitqueue_head(&dev->read_queue);
 531         mutex_unlock(&dev->lock);
 532         return 0;
 533 }
 534
 535 static int cadet_release(struct file *file)
 536 {
 537         struct cadet *dev = video_drvdata(file);
 538
 539         mutex_lock(&dev->lock);
 540         dev->users--;
 541         if (0 == dev->users) {
 542                 del_timer_sync(&dev->readtimer);
 543                 dev->rdsstat = 0;
 544         }
 545         mutex_unlock(&dev->lock);
 546         return 0;
 547 }
 548
 549 static unsigned int cadet_poll(struct file *file, struct poll_table_struct *wait)
 550 {
 551         struct cadet *dev = video_drvdata(file);
 552
 553         poll_wait(file, &dev->read_queue, wait);
 554         if (dev->rdsin != dev->rdsout)
 555                 return POLLIN | POLLRDNORM;
 556         return 0;
 557 }
 558
 559
 560 static const struct v4l2_file_operations cadet_fops = {
 561         .owner          = THIS_MODULE,
 562         .open           = cadet_open,
 563         .release        = cadet_release,
 564         .read           = cadet_read,
 565         .unlocked_ioctl = video_ioctl2,
 566         .poll           = cadet_poll,
 567 };
 568
 569 static const struct v4l2_ioctl_ops cadet_ioctl_ops = {
 570         .vidioc_querycap    = vidioc_querycap,
 571         .vidioc_g_tuner     = vidioc_g_tuner,
 572         .vidioc_s_tuner     = vidioc_s_tuner,
 573         .vidioc_g_frequency = vidioc_g_frequency,
 574         .vidioc_s_frequency = vidioc_s_frequency,
 575         .vidioc_queryctrl   = vidioc_queryctrl,
 576         .vidioc_g_ctrl      = vidioc_g_ctrl,
 577         .vidioc_s_ctrl      = vidioc_s_ctrl,
 578         .vidioc_g_audio     = vidioc_g_audio,
 579         .vidioc_s_audio     = vidioc_s_audio,
 580         .vidioc_g_input     = vidioc_g_input,
 581         .vidioc_s_input     = vidioc_s_input,
 582 };
 583
 584 #ifdef CONFIG_PNP
 585
 586 static struct pnp_device_id cadet_pnp_devices[] = {
 587         /* ADS Cadet AM/FM Radio Card */
 588         {.id = "MSM0c24", .driver_data = 0},
 589         {.id = ""}
 590 };
 591
 592 MODULE_DEVICE_TABLE(pnp, cadet_pnp_devices);
 593
 594 static int cadet_pnp_probe(struct pnp_dev *dev, const struct pnp_device_id *dev_id)
 595 {
 596         if (!dev)
 597                 return -ENODEV;
 598         /* only support one device */
 599         if (io > 0)
 600                 return -EBUSY;
 601
 602         if (!pnp_port_valid(dev, 0))
 603                 return -ENODEV;
 604
 605         io = pnp_port_start(dev, 0);
 606
 607         printk(KERN_INFO "radio-cadet: PnP reports device at %#x\n", io);
 608
 609         return io;
 610 }
 611
 612 static struct pnp_driver cadet_pnp_driver = {
 613         .name           = "radio-cadet",
 614         .id_table       = cadet_pnp_devices,
 615         .probe          = cadet_pnp_probe,
 616         .remove         = NULL,
 617 };
 618
 619 #else
 620 static struct pnp_driver cadet_pnp_driver;
 621 #endif
 622
 623 static void cadet_probe(struct cadet *dev)
 624 {
 625         static int iovals[8] = { 0x330, 0x332, 0x334, 0x336, 0x338, 0x33a, 0x33c, 0x33e };
 626         int i;
 627
 628         for (i = 0; i < 8; i++) {
 629                 dev->io = iovals[i];
 630                 if (request_region(dev->io, 2, "cadet-probe")) {
 631                         cadet_setfreq(dev, 1410);
 632                         if (cadet_getfreq(dev) == 1410) {
 633                                 release_region(dev->io, 2);
 634                                 return;
 635                         }
 636                         release_region(dev->io, 2);
 637                 }
 638         }
 639         dev->io = -1;
 640 }
 641
 642 /*
 643  * io should only be set if the user has used something like
 644  * isapnp (the userspace program) to initialize this card for us
 645  */
 646
 647 static int __init cadet_init(void)
 648 {
 649         struct cadet *dev = &cadet_card;
 650         struct v4l2_device *v4l2_dev = &dev->v4l2_dev;
 651         int res;
 652
 653         strlcpy(v4l2_dev->name, "cadet", sizeof(v4l2_dev->name));
 654         mutex_init(&dev->lock);
 655
 656         /* If a probe was requested then probe ISAPnP first (safest) */
 657         if (io < 0)
 658                 pnp_register_driver(&cadet_pnp_driver);
 659         dev->io = io;
 660
 661         /* If that fails then probe unsafely if probe is requested */
 662         if (dev->io < 0)
 663                 cadet_probe(dev);
 664
 665         /* Else we bail out */
 666         if (dev->io < 0) {
 667 #ifdef MODULE
 668                 v4l2_err(v4l2_dev, "you must set an I/O address with io=0x330, 0x332, 0x334,\n");
 669                 v4l2_err(v4l2_dev, "0x336, 0x338, 0x33a, 0x33c or 0x33e\n");
 670 #endif
 671                 goto fail;
 672         }
 673         if (!request_region(dev->io, 2, "cadet"))
 674                 goto fail;
 675
 676         res = v4l2_device_register(NULL, v4l2_dev);
 677         if (res < 0) {
 678                 release_region(dev->io, 2);
 679                 v4l2_err(v4l2_dev, "could not register v4l2_device\n");
 680                 goto fail;
 681         }
 682
 683         strlcpy(dev->vdev.name, v4l2_dev->name, sizeof(dev->vdev.name));
 684         dev->vdev.v4l2_dev = v4l2_dev;
 685         dev->vdev.fops = &cadet_fops;
 686         dev->vdev.ioctl_ops = &cadet_ioctl_ops;
 687         dev->vdev.release = video_device_release_empty;
 688         video_set_drvdata(&dev->vdev, dev);
 689
 690         if (video_register_device(&dev->vdev, VFL_TYPE_RADIO, radio_nr) < 0) {
 691                 v4l2_device_unregister(v4l2_dev);
 692                 release_region(dev->io, 2);
 693                 goto fail;
 694         }
 695         v4l2_info(v4l2_dev, "ADS Cadet Radio Card at 0x%x\n", dev->io);
 696         return 0;
 697 fail:
 698         pnp_unregister_driver(&cadet_pnp_driver);
 699         return -ENODEV;
 700 }
 701
 702 static void __exit cadet_exit(void)
 703 {
 704         struct cadet *dev = &cadet_card;
 705
 706         video_unregister_device(&dev->vdev);
 707         v4l2_device_unregister(&dev->v4l2_dev);
 708         release_region(dev->io, 2);
 709         pnp_unregister_driver(&cadet_pnp_driver);
 710 }
 711
 712 module_init(cadet_init);
 713 module_exit(cadet_exit);
 714