/* zoltrix radio plus driver for Linux radio support * (c) 1998 C. van Schaik * * BUGS * Due to the inconsistency in reading from the signal flags * it is difficult to get an accurate tuned signal. * * It seems that the card is not linear to 0 volume. It cuts off * at a low volume, and it is not possible (at least I have not found) * to get fine volume control over the low volume range. * * Some code derived from code by Romolo Manfredini * romolo@bicnet.it * * 1999-05-06 - (C. van Schaik) * - Make signal strength and stereo scans * kinder to cpu while in delay * 1999-01-05 - (C. van Schaik) * - Changed tuning to 1/160Mhz accuracy * - Added stereo support * (card defaults to stereo) * (can explicitly force mono on the card) * (can detect if station is in stereo) * - Added unmute function * - Reworked ioctl functions * 2002-07-15 - Fix Stereo typo * * 2006-07-24 - Converted to V4L2 API * by Mauro Carvalho Chehab */ #include /* Modules */ #include /* Initdata */ #include /* request_region */ #include /* udelay, msleep */ #include /* outb, outb_p */ #include /* copy to/from user */ #include /* kernel radio structs */ #include #include /* for KERNEL_VERSION MACRO */ #define RADIO_VERSION KERNEL_VERSION(0,0,2) static struct v4l2_queryctrl radio_qctrl[] = { { .id = V4L2_CID_AUDIO_MUTE, .name = "Mute", .minimum = 0, .maximum = 1, .default_value = 1, .type = V4L2_CTRL_TYPE_BOOLEAN, },{ .id = V4L2_CID_AUDIO_VOLUME, .name = "Volume", .minimum = 0, .maximum = 65535, .step = 4096, .default_value = 0xff, .type = V4L2_CTRL_TYPE_INTEGER, } }; #ifndef CONFIG_RADIO_ZOLTRIX_PORT #define CONFIG_RADIO_ZOLTRIX_PORT -1 #endif static int io = CONFIG_RADIO_ZOLTRIX_PORT; static int radio_nr = -1; struct zol_device { int port; int curvol; unsigned long curfreq; int muted; unsigned int stereo; struct mutex lock; }; static int zol_setvol(struct zol_device *dev, int vol) { dev->curvol = vol; if (dev->muted) return 0; mutex_lock(&dev->lock); if (vol == 0) { outb(0, io); outb(0, io); inb(io + 3); /* Zoltrix needs to be read to confirm */ mutex_unlock(&dev->lock); return 0; } outb(dev->curvol-1, io); msleep(10); inb(io + 2); mutex_unlock(&dev->lock); return 0; } static void zol_mute(struct zol_device *dev) { dev->muted = 1; mutex_lock(&dev->lock); outb(0, io); outb(0, io); inb(io + 3); /* Zoltrix needs to be read to confirm */ mutex_unlock(&dev->lock); } static void zol_unmute(struct zol_device *dev) { dev->muted = 0; zol_setvol(dev, dev->curvol); } static int zol_setfreq(struct zol_device *dev, unsigned long freq) { /* tunes the radio to the desired frequency */ unsigned long long bitmask, f, m; unsigned int stereo = dev->stereo; int i; if (freq == 0) return 1; m = (freq / 160 - 8800) * 2; f = (unsigned long long) m + 0x4d1c; bitmask = 0xc480402c10080000ull; i = 45; mutex_lock(&dev->lock); outb(0, io); outb(0, io); inb(io + 3); /* Zoltrix needs to be read to confirm */ outb(0x40, io); outb(0xc0, io); bitmask = (bitmask ^ ((f & 0xff) << 47) ^ ((f & 0xff00) << 30) ^ ( stereo << 31)); while (i--) { if ((bitmask & 0x8000000000000000ull) != 0) { outb(0x80, io); udelay(50); outb(0x00, io); udelay(50); outb(0x80, io); udelay(50); } else { outb(0xc0, io); udelay(50); outb(0x40, io); udelay(50); outb(0xc0, io); udelay(50); } bitmask *= 2; } /* termination sequence */ outb(0x80, io); outb(0xc0, io); outb(0x40, io); udelay(1000); inb(io+2); udelay(1000); if (dev->muted) { outb(0, io); outb(0, io); inb(io + 3); udelay(1000); } mutex_unlock(&dev->lock); if(!dev->muted) { zol_setvol(dev, dev->curvol); } return 0; } /* Get signal strength */ static int zol_getsigstr(struct zol_device *dev) { int a, b; mutex_lock(&dev->lock); outb(0x00, io); /* This stuff I found to do nothing */ outb(dev->curvol, io); msleep(20); a = inb(io); msleep(10); b = inb(io); mutex_unlock(&dev->lock); if (a != b) return (0); if ((a == 0xcf) || (a == 0xdf) /* I found this out by playing */ || (a == 0xef)) /* with a binary scanner on the card io */ return (1); return (0); } static int zol_is_stereo (struct zol_device *dev) { int x1, x2; mutex_lock(&dev->lock); outb(0x00, io); outb(dev->curvol, io); msleep(20); x1 = inb(io); msleep(10); x2 = inb(io); mutex_unlock(&dev->lock); if ((x1 == x2) && (x1 == 0xcf)) return 1; return 0; } static int zol_do_ioctl(struct inode *inode, struct file *file, unsigned int cmd, void *arg) { struct video_device *dev = video_devdata(file); struct zol_device *zol = dev->priv; switch (cmd) { case VIDIOC_QUERYCAP: { struct v4l2_capability *v = arg; memset(v,0,sizeof(*v)); strlcpy(v->driver, "radio-zoltrix", sizeof (v->driver)); strlcpy(v->card, "Zoltrix Radio", sizeof (v->card)); sprintf(v->bus_info,"ISA"); v->version = RADIO_VERSION; v->capabilities = V4L2_CAP_TUNER; return 0; } case VIDIOC_G_TUNER: { struct v4l2_tuner *v = arg; if (v->index > 0) return -EINVAL; memset(v,0,sizeof(*v)); strcpy(v->name, "FM"); v->type = V4L2_TUNER_RADIO; v->rangelow=(88*16000); v->rangehigh=(108*16000); v->rxsubchans =V4L2_TUNER_SUB_MONO|V4L2_TUNER_SUB_STEREO; v->capability=V4L2_TUNER_CAP_LOW; if(zol_is_stereo(zol)) v->audmode = V4L2_TUNER_MODE_STEREO; else v->audmode = V4L2_TUNER_MODE_MONO; v->signal=0xFFFF*zol_getsigstr(zol); return 0; } case VIDIOC_S_TUNER: { struct v4l2_tuner *v = arg; if (v->index > 0) return -EINVAL; return 0; } case VIDIOC_S_FREQUENCY: { struct v4l2_frequency *f = arg; zol->curfreq = f->frequency; zol_setfreq(zol, zol->curfreq); return 0; } case VIDIOC_G_FREQUENCY: { struct v4l2_frequency *f = arg; f->type = V4L2_TUNER_RADIO; f->frequency = zol->curfreq; return 0; } case VIDIOC_QUERYCTRL: { struct v4l2_queryctrl *qc = arg; int i; for (i = 0; i < ARRAY_SIZE(radio_qctrl); i++) { if (qc->id && qc->id == radio_qctrl[i].id) { memcpy(qc, &(radio_qctrl[i]), sizeof(*qc)); return (0); } } return -EINVAL; } case VIDIOC_G_CTRL: { struct v4l2_control *ctrl= arg; switch (ctrl->id) { case V4L2_CID_AUDIO_MUTE: ctrl->value=zol->muted; return (0); case V4L2_CID_AUDIO_VOLUME: ctrl->value=zol->curvol * 4096; return (0); } return -EINVAL; } case VIDIOC_S_CTRL: { struct v4l2_control *ctrl= arg; switch (ctrl->id) { case V4L2_CID_AUDIO_MUTE: if (ctrl->value) { zol_mute(zol); } else { zol_unmute(zol); zol_setvol(zol,zol->curvol); } return (0); case V4L2_CID_AUDIO_VOLUME: zol_setvol(zol,ctrl->value/4096); return (0); } zol->stereo = 1; zol_setfreq(zol, zol->curfreq); #if 0 /* FIXME: Implement stereo/mono switch on V4L2 */ if (v->mode & VIDEO_SOUND_STEREO) { zol->stereo = 1; zol_setfreq(zol, zol->curfreq); } if (v->mode & VIDEO_SOUND_MONO) { zol->stereo = 0; zol_setfreq(zol, zol->curfreq); } #endif return -EINVAL; } default: return v4l_compat_translate_ioctl(inode,file,cmd,arg, zol_do_ioctl); } } static int zol_ioctl(struct inode *inode, struct file *file, unsigned int cmd, unsigned long arg) { return video_usercopy(inode, file, cmd, arg, zol_do_ioctl); } static struct zol_device zoltrix_unit; static struct file_operations zoltrix_fops = { .owner = THIS_MODULE, .open = video_exclusive_open, .release = video_exclusive_release, .ioctl = zol_ioctl, .compat_ioctl = v4l_compat_ioctl32, .llseek = no_llseek, }; static struct video_device zoltrix_radio = { .owner = THIS_MODULE, .name = "Zoltrix Radio Plus", .type = VID_TYPE_TUNER, .hardware = 0, .fops = &zoltrix_fops, }; static int __init zoltrix_init(void) { if (io == -1) { printk(KERN_ERR "You must set an I/O address with io=0x???\n"); return -EINVAL; } if ((io != 0x20c) && (io != 0x30c)) { printk(KERN_ERR "zoltrix: invalid port, try 0x20c or 0x30c\n"); return -ENXIO; } zoltrix_radio.priv = &zoltrix_unit; if (!request_region(io, 2, "zoltrix")) { printk(KERN_ERR "zoltrix: port 0x%x already in use\n", io); return -EBUSY; } if (video_register_device(&zoltrix_radio, VFL_TYPE_RADIO, radio_nr) == -1) { release_region(io, 2); return -EINVAL; } printk(KERN_INFO "Zoltrix Radio Plus card driver.\n"); mutex_init(&zoltrix_unit.lock); /* mute card - prevents noisy bootups */ /* this ensures that the volume is all the way down */ outb(0, io); outb(0, io); msleep(20); inb(io + 3); zoltrix_unit.curvol = 0; zoltrix_unit.stereo = 1; return 0; } MODULE_AUTHOR("C.van Schaik"); MODULE_DESCRIPTION("A driver for the Zoltrix Radio Plus."); MODULE_LICENSE("GPL"); module_param(io, int, 0); MODULE_PARM_DESC(io, "I/O address of the Zoltrix Radio Plus (0x20c or 0x30c)"); module_param(radio_nr, int, 0); static void __exit zoltrix_cleanup_module(void) { video_unregister_device(&zoltrix_radio); release_region(io, 2); } module_init(zoltrix_init); module_exit(zoltrix_cleanup_module);