/* * Zoltrix Radio Plus driver * Copyright 1998 C. van Schaik <carl@leg.uct.ac.za> * * 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 <mchehab@infradead.org> * * Converted to the radio-isa framework by Hans Verkuil <hans.verkuil@cisco.com> * * Note that this is the driver for the Zoltrix Radio Plus. * This driver does not work for the Zoltrix Radio Plus 108 or the * Zoltrix Radio Plus for Windows. * * Fully tested with the Keene USB FM Transmitter and the v4l2-compliance tool. */ #include <linux/module.h> /* Modules */ #include <linux/init.h> /* Initdata */ #include <linux/ioport.h> /* request_region */ #include <linux/delay.h> /* udelay, msleep */ #include <linux/videodev2.h> /* kernel radio structs */ #include <linux/mutex.h> #include <linux/io.h> /* outb, outb_p */ #include <linux/slab.h> #include <media/v4l2-device.h> #include <media/v4l2-ioctl.h> #include "radio-isa.h" MODULE_AUTHOR("C. van Schaik"); MODULE_DESCRIPTION("A driver for the Zoltrix Radio Plus."); MODULE_LICENSE("GPL"); MODULE_VERSION("0.1.99"); #ifndef CONFIG_RADIO_ZOLTRIX_PORT #define CONFIG_RADIO_ZOLTRIX_PORT -1 #endif #define ZOLTRIX_MAX 2 static int io[ZOLTRIX_MAX] = { [0] = CONFIG_RADIO_ZOLTRIX_PORT, [1 ... (ZOLTRIX_MAX - 1)] = -1 }; static int radio_nr[ZOLTRIX_MAX] = { [0 ... (ZOLTRIX_MAX - 1)] = -1 }; module_param_array(io, int, NULL, 0444); MODULE_PARM_DESC(io, "I/O addresses of the Zoltrix Radio Plus card (0x20c or 0x30c)"); module_param_array(radio_nr, int, NULL, 0444); MODULE_PARM_DESC(radio_nr, "Radio device numbers"); struct zoltrix { struct radio_isa_card isa; int curvol; bool muted; }; static struct radio_isa_card *zoltrix_alloc(void) { struct zoltrix *zol = kzalloc(sizeof(*zol), GFP_KERNEL); return zol ? &zol->isa : NULL; } static int zoltrix_s_mute_volume(struct radio_isa_card *isa, bool mute, int vol) { struct zoltrix *zol = container_of(isa, struct zoltrix, isa); zol->curvol = vol; zol->muted = mute; if (mute || vol == 0) { outb(0, isa->io); outb(0, isa->io); inb(isa->io + 3); /* Zoltrix needs to be read to confirm */ return 0; } outb(vol - 1, isa->io); msleep(10); inb(isa->io + 2); return 0; } /* tunes the radio to the desired frequency */ static int zoltrix_s_frequency(struct radio_isa_card *isa, u32 freq) { struct zoltrix *zol = container_of(isa, struct zoltrix, isa); struct v4l2_device *v4l2_dev = &isa->v4l2_dev; unsigned long long bitmask, f, m; bool stereo = isa->stereo; int i; if (freq == 0) { v4l2_warn(v4l2_dev, "cannot set a frequency of 0.\n"); return -EINVAL; } m = (freq / 160 - 8800) * 2; f = (unsigned long long)m + 0x4d1c; bitmask = 0xc480402c10080000ull; i = 45; outb(0, isa->io); outb(0, isa->io); inb(isa->io + 3); /* Zoltrix needs to be read to confirm */ outb(0x40, isa->io); outb(0xc0, isa->io); bitmask = (bitmask ^ ((f & 0xff) << 47) ^ ((f & 0xff00) << 30) ^ (stereo << 31)); while (i--) { if ((bitmask & 0x8000000000000000ull) != 0) { outb(0x80, isa->io); udelay(50); outb(0x00, isa->io); udelay(50); outb(0x80, isa->io); udelay(50); } else { outb(0xc0, isa->io); udelay(50); outb(0x40, isa->io); udelay(50); outb(0xc0, isa->io); udelay(50); } bitmask *= 2; } /* termination sequence */ outb(0x80, isa->io); outb(0xc0, isa->io); outb(0x40, isa->io); udelay(1000); inb(isa->io + 2); udelay(1000); return zoltrix_s_mute_volume(isa, zol->muted, zol->curvol); } /* Get signal strength */ static u32 zoltrix_g_rxsubchans(struct radio_isa_card *isa) { struct zoltrix *zol = container_of(isa, struct zoltrix, isa); int a, b; outb(0x00, isa->io); /* This stuff I found to do nothing */ outb(zol->curvol, isa->io); msleep(20); a = inb(isa->io); msleep(10); b = inb(isa->io); return (a == b && a == 0xcf) ? V4L2_TUNER_SUB_STEREO : V4L2_TUNER_SUB_MONO; } static u32 zoltrix_g_signal(struct radio_isa_card *isa) { struct zoltrix *zol = container_of(isa, struct zoltrix, isa); int a, b; outb(0x00, isa->io); /* This stuff I found to do nothing */ outb(zol->curvol, isa->io); msleep(20); a = inb(isa->io); msleep(10); b = inb(isa->io); if (a != b) return 0; /* I found this out by playing with a binary scanner on the card io */ return (a == 0xcf || a == 0xdf || a == 0xef) ? 0xffff : 0; } static int zoltrix_s_stereo(struct radio_isa_card *isa, bool stereo) { return zoltrix_s_frequency(isa, isa->freq); } static const struct radio_isa_ops zoltrix_ops = { .alloc = zoltrix_alloc, .s_mute_volume = zoltrix_s_mute_volume, .s_frequency = zoltrix_s_frequency, .s_stereo = zoltrix_s_stereo, .g_rxsubchans = zoltrix_g_rxsubchans, .g_signal = zoltrix_g_signal, }; static const int zoltrix_ioports[] = { 0x20c, 0x30c }; static struct radio_isa_driver zoltrix_driver = { .driver = { .match = radio_isa_match, .probe = radio_isa_probe, .remove = radio_isa_remove, .driver = { .name = "radio-zoltrix", }, }, .io_params = io, .radio_nr_params = radio_nr, .io_ports = zoltrix_ioports, .num_of_io_ports = ARRAY_SIZE(zoltrix_ioports), .region_size = 2, .card = "Zoltrix Radio Plus", .ops = &zoltrix_ops, .has_stereo = true, .max_volume = 15, }; static int __init zoltrix_init(void) { return isa_register_driver(&zoltrix_driver.driver, ZOLTRIX_MAX); } static void __exit zoltrix_exit(void) { isa_unregister_driver(&zoltrix_driver.driver); } module_init(zoltrix_init); module_exit(zoltrix_exit);