git.oblomov.eu Git - linux-2.6/blob - drivers/media/radio/radio-zoltrix.c

   1 /* zoltrix radio plus driver for Linux radio support
   2  * (c) 1998 C. van Schaik <carl@leg.uct.ac.za>
   3  *
   4  * BUGS
   5  *  Due to the inconsistency in reading from the signal flags
   6  *  it is difficult to get an accurate tuned signal.
   7  *
   8  *  It seems that the card is not linear to 0 volume. It cuts off
   9  *  at a low volume, and it is not possible (at least I have not found)
  10  *  to get fine volume control over the low volume range.
  11  *
  12  *  Some code derived from code by Romolo Manfredini
  13  *                                 romolo@bicnet.it
  14  *
  15  * 1999-05-06 - (C. van Schaik)
  16  *            - Make signal strength and stereo scans
  17  *              kinder to cpu while in delay
  18  * 1999-01-05 - (C. van Schaik)
  19  *            - Changed tuning to 1/160Mhz accuracy
  20  *            - Added stereo support
  21  *              (card defaults to stereo)
  22  *              (can explicitly force mono on the card)
  23  *              (can detect if station is in stereo)
  24  *            - Added unmute function
  25  *            - Reworked ioctl functions
  26  * 2002-07-15 - Fix Stereo typo
  27  *
  28  * 2006-07-24 - Converted to V4L2 API
  29  *              by Mauro Carvalho Chehab <mchehab@infradead.org>
  30  */
  31
  32 #include <linux/module.h>       /* Modules                        */
  33 #include <linux/init.h>         /* Initdata                       */
  34 #include <linux/ioport.h>       /* request_region                 */
  35 #include <linux/delay.h>        /* udelay, msleep                 */
  36 #include <asm/io.h>             /* outb, outb_p                   */
  37 #include <asm/uaccess.h>        /* copy to/from user              */
  38 #include <linux/videodev2.h>    /* kernel radio structs           */
  39 #include <media/v4l2-common.h>
  40 #include <media/v4l2-ioctl.h>
  41
  42 #include <linux/version.h>      /* for KERNEL_VERSION MACRO     */
  43 #define RADIO_VERSION KERNEL_VERSION(0,0,2)
  44
  45 static struct v4l2_queryctrl radio_qctrl[] = {
  46         {
  47                 .id            = V4L2_CID_AUDIO_MUTE,
  48                 .name          = "Mute",
  49                 .minimum       = 0,
  50                 .maximum       = 1,
  51                 .default_value = 1,
  52                 .type          = V4L2_CTRL_TYPE_BOOLEAN,
  53         },{
  54                 .id            = V4L2_CID_AUDIO_VOLUME,
  55                 .name          = "Volume",
  56                 .minimum       = 0,
  57                 .maximum       = 65535,
  58                 .step          = 4096,
  59                 .default_value = 0xff,
  60                 .type          = V4L2_CTRL_TYPE_INTEGER,
  61         }
  62 };
  63
  64 #ifndef CONFIG_RADIO_ZOLTRIX_PORT
  65 #define CONFIG_RADIO_ZOLTRIX_PORT -1
  66 #endif
  67
  68 static int io = CONFIG_RADIO_ZOLTRIX_PORT;
  69 static int radio_nr = -1;
  70
  71 struct zol_device {
  72         unsigned long in_use;
  73         int port;
  74         int curvol;
  75         unsigned long curfreq;
  76         int muted;
  77         unsigned int stereo;
  78         struct mutex lock;
  79 };
  80
  81 static int zol_setvol(struct zol_device *dev, int vol)
  82 {
  83         dev->curvol = vol;
  84         if (dev->muted)
  85                 return 0;
  86
  87         mutex_lock(&dev->lock);
  88         if (vol == 0) {
  89                 outb(0, io);
  90                 outb(0, io);
  91                 inb(io + 3);    /* Zoltrix needs to be read to confirm */
  92                 mutex_unlock(&dev->lock);
  93                 return 0;
  94         }
  95
  96         outb(dev->curvol-1, io);
  97         msleep(10);
  98         inb(io + 2);
  99         mutex_unlock(&dev->lock);
 100         return 0;
 101 }
 102
 103 static void zol_mute(struct zol_device *dev)
 104 {
 105         dev->muted = 1;
 106         mutex_lock(&dev->lock);
 107         outb(0, io);
 108         outb(0, io);
 109         inb(io + 3);            /* Zoltrix needs to be read to confirm */
 110         mutex_unlock(&dev->lock);
 111 }
 112
 113 static void zol_unmute(struct zol_device *dev)
 114 {
 115         dev->muted = 0;
 116         zol_setvol(dev, dev->curvol);
 117 }
 118
 119 static int zol_setfreq(struct zol_device *dev, unsigned long freq)
 120 {
 121         /* tunes the radio to the desired frequency */
 122         unsigned long long bitmask, f, m;
 123         unsigned int stereo = dev->stereo;
 124         int i;
 125
 126         if (freq == 0)
 127                 return 1;
 128         m = (freq / 160 - 8800) * 2;
 129         f = (unsigned long long) m + 0x4d1c;
 130
 131         bitmask = 0xc480402c10080000ull;
 132         i = 45;
 133
 134         mutex_lock(&dev->lock);
 135
 136         outb(0, io);
 137         outb(0, io);
 138         inb(io + 3);            /* Zoltrix needs to be read to confirm */
 139
 140         outb(0x40, io);
 141         outb(0xc0, io);
 142
 143         bitmask = (bitmask ^ ((f & 0xff) << 47) ^ ((f & 0xff00) << 30) ^ ( stereo << 31));
 144         while (i--) {
 145                 if ((bitmask & 0x8000000000000000ull) != 0) {
 146                         outb(0x80, io);
 147                         udelay(50);
 148                         outb(0x00, io);
 149                         udelay(50);
 150                         outb(0x80, io);
 151                         udelay(50);
 152                 } else {
 153                         outb(0xc0, io);
 154                         udelay(50);
 155                         outb(0x40, io);
 156                         udelay(50);
 157                         outb(0xc0, io);
 158                         udelay(50);
 159                 }
 160                 bitmask *= 2;
 161         }
 162         /* termination sequence */
 163         outb(0x80, io);
 164         outb(0xc0, io);
 165         outb(0x40, io);
 166         udelay(1000);
 167         inb(io+2);
 168
 169         udelay(1000);
 170
 171         if (dev->muted)
 172         {
 173                 outb(0, io);
 174                 outb(0, io);
 175                 inb(io + 3);
 176                 udelay(1000);
 177         }
 178
 179         mutex_unlock(&dev->lock);
 180
 181         if(!dev->muted)
 182         {
 183                 zol_setvol(dev, dev->curvol);
 184         }
 185         return 0;
 186 }
 187
 188 /* Get signal strength */
 189
 190 static int zol_getsigstr(struct zol_device *dev)
 191 {
 192         int a, b;
 193
 194         mutex_lock(&dev->lock);
 195         outb(0x00, io);         /* This stuff I found to do nothing */
 196         outb(dev->curvol, io);
 197         msleep(20);
 198
 199         a = inb(io);
 200         msleep(10);
 201         b = inb(io);
 202
 203         mutex_unlock(&dev->lock);
 204
 205         if (a != b)
 206                 return (0);
 207
 208         if ((a == 0xcf) || (a == 0xdf)  /* I found this out by playing */
 209                 || (a == 0xef))       /* with a binary scanner on the card io */
 210                 return (1);
 211         return (0);
 212 }
 213
 214 static int zol_is_stereo (struct zol_device *dev)
 215 {
 216         int x1, x2;
 217
 218         mutex_lock(&dev->lock);
 219
 220         outb(0x00, io);
 221         outb(dev->curvol, io);
 222         msleep(20);
 223
 224         x1 = inb(io);
 225         msleep(10);
 226         x2 = inb(io);
 227
 228         mutex_unlock(&dev->lock);
 229
 230         if ((x1 == x2) && (x1 == 0xcf))
 231                 return 1;
 232         return 0;
 233 }
 234
 235 static int vidioc_querycap(struct file *file, void  *priv,
 236                                         struct v4l2_capability *v)
 237 {
 238         strlcpy(v->driver, "radio-zoltrix", sizeof(v->driver));
 239         strlcpy(v->card, "Zoltrix Radio", sizeof(v->card));
 240         sprintf(v->bus_info, "ISA");
 241         v->version = RADIO_VERSION;
 242         v->capabilities = V4L2_CAP_TUNER;
 243         return 0;
 244 }
 245
 246 static int vidioc_g_tuner(struct file *file, void *priv,
 247                                         struct v4l2_tuner *v)
 248 {
 249         struct video_device *dev = video_devdata(file);
 250         struct zol_device *zol = video_get_drvdata(dev);
 251
 252         if (v->index > 0)
 253                 return -EINVAL;
 254
 255         strcpy(v->name, "FM");
 256         v->type = V4L2_TUNER_RADIO;
 257         v->rangelow = (88*16000);
 258         v->rangehigh = (108*16000);
 259         v->rxsubchans = V4L2_TUNER_SUB_MONO|V4L2_TUNER_SUB_STEREO;
 260         v->capability = V4L2_TUNER_CAP_LOW;
 261         if (zol_is_stereo(zol))
 262                 v->audmode = V4L2_TUNER_MODE_STEREO;
 263         else
 264                 v->audmode = V4L2_TUNER_MODE_MONO;
 265         v->signal = 0xFFFF*zol_getsigstr(zol);
 266         return 0;
 267 }
 268
 269 static int vidioc_s_tuner(struct file *file, void *priv,
 270                                         struct v4l2_tuner *v)
 271 {
 272         if (v->index > 0)
 273                 return -EINVAL;
 274         return 0;
 275 }
 276
 277 static int vidioc_s_frequency(struct file *file, void *priv,
 278                                         struct v4l2_frequency *f)
 279 {
 280         struct video_device *dev = video_devdata(file);
 281         struct zol_device *zol = video_get_drvdata(dev);
 282
 283         zol->curfreq = f->frequency;
 284         zol_setfreq(zol, zol->curfreq);
 285         return 0;
 286 }
 287
 288 static int vidioc_g_frequency(struct file *file, void *priv,
 289                                         struct v4l2_frequency *f)
 290 {
 291         struct video_device *dev = video_devdata(file);
 292         struct zol_device *zol = video_get_drvdata(dev);
 293
 294         f->type = V4L2_TUNER_RADIO;
 295         f->frequency = zol->curfreq;
 296         return 0;
 297 }
 298
 299 static int vidioc_queryctrl(struct file *file, void *priv,
 300                                         struct v4l2_queryctrl *qc)
 301 {
 302         int i;
 303
 304         for (i = 0; i < ARRAY_SIZE(radio_qctrl); i++) {
 305                 if (qc->id && qc->id == radio_qctrl[i].id) {
 306                         memcpy(qc, &(radio_qctrl[i]),
 307                                                 sizeof(*qc));
 308                         return 0;
 309                 }
 310         }
 311         return -EINVAL;
 312 }
 313
 314 static int vidioc_g_ctrl(struct file *file, void *priv,
 315                                 struct v4l2_control *ctrl)
 316 {
 317         struct video_device *dev = video_devdata(file);
 318         struct zol_device *zol = video_get_drvdata(dev);
 319
 320         switch (ctrl->id) {
 321         case V4L2_CID_AUDIO_MUTE:
 322                 ctrl->value = zol->muted;
 323                 return 0;
 324         case V4L2_CID_AUDIO_VOLUME:
 325                 ctrl->value = zol->curvol * 4096;
 326                 return 0;
 327         }
 328         return -EINVAL;
 329 }
 330
 331 static int vidioc_s_ctrl(struct file *file, void *priv,
 332                                 struct v4l2_control *ctrl)
 333 {
 334         struct video_device *dev = video_devdata(file);
 335         struct zol_device *zol = video_get_drvdata(dev);
 336
 337         switch (ctrl->id) {
 338         case V4L2_CID_AUDIO_MUTE:
 339                 if (ctrl->value)
 340                         zol_mute(zol);
 341                 else {
 342                         zol_unmute(zol);
 343                         zol_setvol(zol,zol->curvol);
 344                 }
 345                 return 0;
 346         case V4L2_CID_AUDIO_VOLUME:
 347                 zol_setvol(zol,ctrl->value/4096);
 348                 return 0;
 349         }
 350         zol->stereo = 1;
 351         zol_setfreq(zol, zol->curfreq);
 352 #if 0
 353 /* FIXME: Implement stereo/mono switch on V4L2 */
 354                         if (v->mode & VIDEO_SOUND_STEREO) {
 355                                 zol->stereo = 1;
 356                                 zol_setfreq(zol, zol->curfreq);
 357                         }
 358                         if (v->mode & VIDEO_SOUND_MONO) {
 359                                 zol->stereo = 0;
 360                                 zol_setfreq(zol, zol->curfreq);
 361                         }
 362 #endif
 363         return -EINVAL;
 364 }
 365
 366 static int vidioc_g_audio(struct file *file, void *priv,
 367                                         struct v4l2_audio *a)
 368 {
 369         if (a->index > 1)
 370                 return -EINVAL;
 371
 372         strcpy(a->name, "Radio");
 373         a->capability = V4L2_AUDCAP_STEREO;
 374         return 0;
 375 }
 376
 377 static int vidioc_g_input(struct file *filp, void *priv, unsigned int *i)
 378 {
 379         *i = 0;
 380         return 0;
 381 }
 382
 383 static int vidioc_s_input(struct file *filp, void *priv, unsigned int i)
 384 {
 385         if (i != 0)
 386                 return -EINVAL;
 387         return 0;
 388 }
 389
 390 static int vidioc_s_audio(struct file *file, void *priv,
 391                                         struct v4l2_audio *a)
 392 {
 393         if (a->index != 0)
 394                 return -EINVAL;
 395         return 0;
 396 }
 397
 398 static struct zol_device zoltrix_unit;
 399
 400 static int zoltrix_exclusive_open(struct inode *inode, struct file *file)
 401 {
 402         return test_and_set_bit(0, &zoltrix_unit.in_use) ? -EBUSY : 0;
 403 }
 404
 405 static int zoltrix_exclusive_release(struct inode *inode, struct file *file)
 406 {
 407         clear_bit(0, &zoltrix_unit.in_use);
 408         return 0;
 409 }
 410
 411 static const struct file_operations zoltrix_fops =
 412 {
 413         .owner          = THIS_MODULE,
 414         .open           = zoltrix_exclusive_open,
 415         .release        = zoltrix_exclusive_release,
 416         .ioctl          = video_ioctl2,
 417 #ifdef CONFIG_COMPAT
 418         .compat_ioctl   = v4l_compat_ioctl32,
 419 #endif
 420         .llseek         = no_llseek,
 421 };
 422
 423 static const struct v4l2_ioctl_ops zoltrix_ioctl_ops = {
 424         .vidioc_querycap    = vidioc_querycap,
 425         .vidioc_g_tuner     = vidioc_g_tuner,
 426         .vidioc_s_tuner     = vidioc_s_tuner,
 427         .vidioc_g_audio     = vidioc_g_audio,
 428         .vidioc_s_audio     = vidioc_s_audio,
 429         .vidioc_g_input     = vidioc_g_input,
 430         .vidioc_s_input     = vidioc_s_input,
 431         .vidioc_g_frequency = vidioc_g_frequency,
 432         .vidioc_s_frequency = vidioc_s_frequency,
 433         .vidioc_queryctrl   = vidioc_queryctrl,
 434         .vidioc_g_ctrl      = vidioc_g_ctrl,
 435         .vidioc_s_ctrl      = vidioc_s_ctrl,
 436 };
 437
 438 static struct video_device zoltrix_radio = {
 439         .name           = "Zoltrix Radio Plus",
 440         .fops           = &zoltrix_fops,
 441         .ioctl_ops      = &zoltrix_ioctl_ops,
 442         .release        = video_device_release_empty,
 443 };
 444
 445 static int __init zoltrix_init(void)
 446 {
 447         if (io == -1) {
 448                 printk(KERN_ERR "You must set an I/O address with io=0x???\n");
 449                 return -EINVAL;
 450         }
 451         if ((io != 0x20c) && (io != 0x30c)) {
 452                 printk(KERN_ERR "zoltrix: invalid port, try 0x20c or 0x30c\n");
 453                 return -ENXIO;
 454         }
 455
 456         video_set_drvdata(&zoltrix_radio, &zoltrix_unit);
 457         if (!request_region(io, 2, "zoltrix")) {
 458                 printk(KERN_ERR "zoltrix: port 0x%x already in use\n", io);
 459                 return -EBUSY;
 460         }
 461
 462         if (video_register_device(&zoltrix_radio, VFL_TYPE_RADIO, radio_nr) < 0) {
 463                 release_region(io, 2);
 464                 return -EINVAL;
 465         }
 466         printk(KERN_INFO "Zoltrix Radio Plus card driver.\n");
 467
 468         mutex_init(&zoltrix_unit.lock);
 469
 470         /* mute card - prevents noisy bootups */
 471
 472         /* this ensures that the volume is all the way down  */
 473
 474         outb(0, io);
 475         outb(0, io);
 476         msleep(20);
 477         inb(io + 3);
 478
 479         zoltrix_unit.curvol = 0;
 480         zoltrix_unit.stereo = 1;
 481
 482         return 0;
 483 }
 484
 485 MODULE_AUTHOR("C.van Schaik");
 486 MODULE_DESCRIPTION("A driver for the Zoltrix Radio Plus.");
 487 MODULE_LICENSE("GPL");
 488
 489 module_param(io, int, 0);
 490 MODULE_PARM_DESC(io, "I/O address of the Zoltrix Radio Plus (0x20c or 0x30c)");
 491 module_param(radio_nr, int, 0);
 492
 493 static void __exit zoltrix_cleanup_module(void)
 494 {
 495         video_unregister_device(&zoltrix_radio);
 496         release_region(io, 2);
 497 }
 498
 499 module_init(zoltrix_init);
 500 module_exit(zoltrix_cleanup_module);
 501