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