[alsa-devel] [PATCH v5] [resend] radio-sf16fmr2: convert to generic TEA575x interface
Convert radio-sf16fmr2 to use generic TEA575x implementation. Most of the driver code goes away as SF16-FMR2 is basically just a TEA5757 tuner connected to ISA bus. The card can optionally be equipped with PT2254A volume control (equivalent of TC9154AP) - the volume setting is completely reworked (with balance control added) and tested.
Signed-off-by: Ondrej Zary linux@rainbow-software.org
--- linux-2.6.39-rc2-/sound/pci/Kconfig 2011-05-15 18:50:18.000000000 +0200 +++ linux-2.6.39-rc2/sound/pci/Kconfig 2011-05-17 23:35:30.000000000 +0200 @@ -565,8 +565,8 @@ config SND_FM801_TEA575X_BOOL
config SND_TEA575X tristate - depends on SND_FM801_TEA575X_BOOL || SND_ES1968_RADIO - default SND_FM801 || SND_ES1968 + depends on SND_FM801_TEA575X_BOOL || SND_ES1968_RADIO || RADIO_SF16FMR2 + default SND_FM801 || SND_ES1968 || RADIO_SF16FMR2
source "sound/pci/hda/Kconfig"
--- linux-2.6.39-rc2-/drivers/media/radio/radio-sf16fmr2.c 2011-04-06 03:30:43.000000000 +0200 +++ linux-2.6.39-rc2/drivers/media/radio/radio-sf16fmr2.c 2011-05-19 17:56:08.000000000 +0200 @@ -1,441 +1,209 @@ -/* SF16FMR2 radio driver for Linux radio support - * heavily based on fmi driver... - * (c) 2000-2002 Ziglio Frediano, freddy77@angelfire.com +/* SF16-FMR2 radio driver for Linux + * Copyright (c) 2011 Ondrej Zary * - * Notes on the hardware - * - * Frequency control is done digitally -- ie out(port,encodefreq(95.8)); - * No volume control - only mute/unmute - you have to use line volume - * - * For read stereo/mono you must wait 0.1 sec after set frequency and - * card unmuted so I set frequency on unmute - * Signal handling seem to work only on autoscanning (not implemented) - * - * Converted to V4L2 API by Mauro Carvalho Chehab mchehab@infradead.org + * Original driver was (c) 2000-2002 Ziglio Frediano, freddy77@angelfire.com + * but almost nothing remained here after conversion to generic TEA575x + * implementation */
+#include <linux/delay.h> #include <linux/module.h> /* Modules */ #include <linux/init.h> /* Initdata */ #include <linux/ioport.h> /* request_region */ -#include <linux/delay.h> /* udelay */ -#include <linux/videodev2.h> /* kernel radio structs */ -#include <linux/mutex.h> -#include <linux/version.h> /* for KERNEL_VERSION MACRO */ #include <linux/io.h> /* outb, outb_p */ -#include <media/v4l2-device.h> -#include <media/v4l2-ioctl.h> +#include <sound/tea575x-tuner.h>
-MODULE_AUTHOR("Ziglio Frediano, freddy77@angelfire.com"); -MODULE_DESCRIPTION("A driver for the SF16FMR2 radio."); +MODULE_AUTHOR("Ondrej Zary"); +MODULE_DESCRIPTION("MediaForte SF16-FMR2 FM radio card driver"); MODULE_LICENSE("GPL");
-static int io = 0x384; -static int radio_nr = -1; - -module_param(io, int, 0); -MODULE_PARM_DESC(io, "I/O address of the SF16FMR2 card (should be 0x384, if do not work try 0x284)"); -module_param(radio_nr, int, 0); - -#define RADIO_VERSION KERNEL_VERSION(0,0,2) - -#define AUD_VOL_INDEX 1 - -#undef DEBUG -//#define DEBUG 1 - -#ifdef DEBUG -# define debug_print(s) printk s -#else -# define debug_print(s) -#endif - -/* this should be static vars for module size */ -struct fmr2 -{ - struct v4l2_device v4l2_dev; - struct video_device vdev; - struct mutex lock; +struct fmr2 { int io; - int curvol; /* 0-15 */ - int mute; - int stereo; /* card is producing stereo audio */ - unsigned long curfreq; /* freq in kHz */ - int card_type; + struct snd_tea575x tea; + struct v4l2_ctrl *volume; + struct v4l2_ctrl *balance; };
+/* the port is hardwired so no need to support multiple cards */ +#define FMR2_PORT 0x384 static struct fmr2 fmr2_card;
-/* hw precision is 12.5 kHz - * It is only useful to give freq in interval of 200 (=0.0125Mhz), - * other bits will be truncated - */ -#define RSF16_ENCODE(x) ((x) / 200 + 856) -#define RSF16_MINFREQ (87 * 16000) -#define RSF16_MAXFREQ (108 * 16000) - -static inline void wait(int n, int io) -{ - for (; n; --n) - inb(io); -} - -static void outbits(int bits, unsigned int data, int nWait, int io) -{ - int bit; - - for (; --bits >= 0;) { - bit = (data >> bits) & 1; - outb(bit, io); - wait(nWait, io); - outb(bit | 2, io); - wait(nWait, io); - outb(bit, io); - wait(nWait, io); - } -} - -static inline void fmr2_mute(int io) -{ - outb(0x00, io); - wait(4, io); -} - -static inline void fmr2_unmute(int io) -{ - outb(0x04, io); - wait(4, io); -} - -static inline int fmr2_stereo_mode(int io) -{ - int n = inb(io); - - outb(6, io); - inb(io); - n = ((n >> 3) & 1) ^ 1; - debug_print((KERN_DEBUG "stereo: %d\n", n)); - return n; -} - -static int fmr2_product_info(struct fmr2 *dev) -{ - int n = inb(dev->io); - - n &= 0xC1; - if (n == 0) { - /* this should support volume set */ - dev->card_type = 12; - return 0; - } - /* not volume (mine is 11) */ - dev->card_type = (n == 128) ? 11 : 0; - return n; -} - -static inline int fmr2_getsigstr(struct fmr2 *dev) -{ - /* !!! works only if scanning freq */ - int res = 0xffff; - - outb(5, dev->io); - wait(4, dev->io); - if (!(inb(dev->io) & 1)) - res = 0; - debug_print((KERN_DEBUG "signal: %d\n", res)); - return res; -} - -/* set frequency and unmute card */ -static int fmr2_setfreq(struct fmr2 *dev) -{ - unsigned long freq = dev->curfreq; - - fmr2_mute(dev->io); - - /* 0x42 for mono output - * 0x102 forward scanning - * 0x182 scansione avanti - */ - outbits(9, 0x2, 3, dev->io); - outbits(16, RSF16_ENCODE(freq), 2, dev->io); - - fmr2_unmute(dev->io); - - /* wait 0.11 sec */ - msleep(110); - - /* NOTE if mute this stop radio - you must set freq on unmute */ - dev->stereo = fmr2_stereo_mode(dev->io); - return 0; -} - -/* !!! not tested, in my card this does't work !!! */ -static int fmr2_setvolume(struct fmr2 *dev) -{ - int vol[16] = { 0x021, 0x084, 0x090, 0x104, - 0x110, 0x204, 0x210, 0x402, - 0x404, 0x408, 0x410, 0x801, - 0x802, 0x804, 0x808, 0x810 }; - int i, a; - int n = vol[dev->curvol & 0x0f]; - - if (dev->card_type != 11) - return 1; - - for (i = 12; --i >= 0; ) { - a = ((n >> i) & 1) << 6; /* if (a==0) a = 0; else a = 0x40; */ - outb(a | 4, dev->io); - wait(4, dev->io); - outb(a | 0x24, dev->io); - wait(4, dev->io); - outb(a | 4, dev->io); - wait(4, dev->io); - } - for (i = 6; --i >= 0; ) { - a = ((0x18 >> i) & 1) << 6; - outb(a | 4, dev->io); - wait(4, dev->io); - outb(a | 0x24, dev->io); - wait(4, dev->io); - outb(a | 4, dev->io); - wait(4, dev->io); - } - wait(4, dev->io); - outb(0x14, dev->io); - return 0; -} - -static int vidioc_querycap(struct file *file, void *priv, - struct v4l2_capability *v) -{ - strlcpy(v->driver, "radio-sf16fmr2", sizeof(v->driver)); - strlcpy(v->card, "SF16-FMR2 radio", sizeof(v->card)); - strlcpy(v->bus_info, "ISA", sizeof(v->bus_info)); - v->version = RADIO_VERSION; - v->capabilities = V4L2_CAP_TUNER | V4L2_CAP_RADIO; - return 0; -} +/* TEA575x tuner pins */ +#define STR_DATA (1 << 0) +#define STR_CLK (1 << 1) +#define STR_WREN (1 << 2) +#define STR_MOST (1 << 3) +/* PT2254A/TC9154A volume control pins */ +#define PT_ST (1 << 4) +#define PT_CK (1 << 5) +#define PT_DATA (1 << 6) +/* volume control presence pin */ +#define FMR2_HASVOL (1 << 7)
-static int vidioc_g_tuner(struct file *file, void *priv, - struct v4l2_tuner *v) +static void fmr2_tea575x_set_pins(struct snd_tea575x *tea, u8 pins) { - struct fmr2 *fmr2 = video_drvdata(file); - - if (v->index > 0) - return -EINVAL; + struct fmr2 *fmr2 = tea->private_data; + u8 bits = 0;
- strlcpy(v->name, "FM", sizeof(v->name)); - v->type = V4L2_TUNER_RADIO; - - v->rangelow = RSF16_MINFREQ; - v->rangehigh = RSF16_MAXFREQ; - v->rxsubchans = fmr2->stereo ? V4L2_TUNER_SUB_STEREO : - V4L2_TUNER_SUB_MONO; - v->capability = V4L2_TUNER_CAP_STEREO | V4L2_TUNER_CAP_LOW; - v->audmode = V4L2_TUNER_MODE_STEREO; - mutex_lock(&fmr2->lock); - v->signal = fmr2_getsigstr(fmr2); - mutex_unlock(&fmr2->lock); - return 0; -} + bits |= (pins & TEA575X_DATA) ? STR_DATA : 0; + bits |= (pins & TEA575X_CLK) ? STR_CLK : 0; + /* WRITE_ENABLE is inverted, DATA must be high during read */ + bits |= (pins & TEA575X_WREN) ? 0 : STR_WREN | STR_DATA;
-static int vidioc_s_tuner(struct file *file, void *priv, - struct v4l2_tuner *v) -{ - return v->index ? -EINVAL : 0; + outb(bits, fmr2->io); }
-static int vidioc_s_frequency(struct file *file, void *priv, - struct v4l2_frequency *f) +static u8 fmr2_tea575x_get_pins(struct snd_tea575x *tea) { - struct fmr2 *fmr2 = video_drvdata(file); + struct fmr2 *fmr2 = tea->private_data; + u8 bits = inb(fmr2->io);
- if (f->tuner != 0 || f->type != V4L2_TUNER_RADIO) - return -EINVAL; - if (f->frequency < RSF16_MINFREQ || - f->frequency > RSF16_MAXFREQ) - return -EINVAL; - /* rounding in steps of 200 to match the freq - that will be used */ - fmr2->curfreq = (f->frequency / 200) * 200; - - /* set card freq (if not muted) */ - if (fmr2->curvol && !fmr2->mute) { - mutex_lock(&fmr2->lock); - fmr2_setfreq(fmr2); - mutex_unlock(&fmr2->lock); - } - return 0; + return (bits & STR_DATA) ? TEA575X_DATA : 0 | + (bits & STR_MOST) ? TEA575X_MOST : 0; }
-static int vidioc_g_frequency(struct file *file, void *priv, - struct v4l2_frequency *f) +static void fmr2_tea575x_set_direction(struct snd_tea575x *tea, bool output) { - struct fmr2 *fmr2 = video_drvdata(file); - - if (f->tuner != 0) - return -EINVAL; - f->type = V4L2_TUNER_RADIO; - f->frequency = fmr2->curfreq; - return 0; }
-static int vidioc_queryctrl(struct file *file, void *priv, - struct v4l2_queryctrl *qc) -{ - struct fmr2 *fmr2 = video_drvdata(file); +static struct snd_tea575x_ops fmr2_tea_ops = { + .set_pins = fmr2_tea575x_set_pins, + .get_pins = fmr2_tea575x_get_pins, + .set_direction = fmr2_tea575x_set_direction, +};
- switch (qc->id) { - case V4L2_CID_AUDIO_MUTE: - return v4l2_ctrl_query_fill(qc, 0, 1, 1, 1); - case V4L2_CID_AUDIO_VOLUME: - /* Only card_type == 11 implements volume */ - if (fmr2->card_type == 11) - return v4l2_ctrl_query_fill(qc, 0, 15, 1, 0); - return v4l2_ctrl_query_fill(qc, 0, 1, 1, 0); - } - return -EINVAL; -} +/* TC9154A/PT2254A volume control */
-static int vidioc_g_ctrl(struct file *file, void *priv, - struct v4l2_control *ctrl) -{ - struct fmr2 *fmr2 = video_drvdata(file); +/* 18-bit shift register bit definitions */ +#define TC9154A_ATT_MAJ_0DB (1 << 0) +#define TC9154A_ATT_MAJ_10DB (1 << 1) +#define TC9154A_ATT_MAJ_20DB (1 << 2) +#define TC9154A_ATT_MAJ_30DB (1 << 3) +#define TC9154A_ATT_MAJ_40DB (1 << 4) +#define TC9154A_ATT_MAJ_50DB (1 << 5) +#define TC9154A_ATT_MAJ_60DB (1 << 6) + +#define TC9154A_ATT_MIN_0DB (1 << 7) +#define TC9154A_ATT_MIN_2DB (1 << 8) +#define TC9154A_ATT_MIN_4DB (1 << 9) +#define TC9154A_ATT_MIN_6DB (1 << 10) +#define TC9154A_ATT_MIN_8DB (1 << 11) +/* bit 12 is ignored */ +#define TC9154A_CHANNEL_LEFT (1 << 13) +#define TC9154A_CHANNEL_RIGHT (1 << 14) +/* bits 15, 16, 17 must be 0 */ + +#define TC9154A_ATT_MAJ(x) (1 << x) +#define TC9154A_ATT_MIN(x) (1 << (7 + x)) + +static void tc9154a_set_pins(struct fmr2 *fmr2, u8 pins) +{ + if (!fmr2->tea.mute) + pins |= STR_WREN; + + outb(pins, fmr2->io); +} + +static void tc9154a_set_attenuation(struct fmr2 *fmr2, int att, u32 channel) +{ + int i; + u32 reg; + u8 bit; + + reg = TC9154A_ATT_MAJ(att / 10) | TC9154A_ATT_MIN((att % 10) / 2); + reg |= channel; + /* write 18-bit shift register, LSB first */ + for (i = 0; i < 18; i++) { + bit = reg & (1 << i) ? PT_DATA : 0; + tc9154a_set_pins(fmr2, bit); + udelay(5); + tc9154a_set_pins(fmr2, bit | PT_CK); + udelay(5); + tc9154a_set_pins(fmr2, bit); + } + + /* latch register data */ + udelay(5); + tc9154a_set_pins(fmr2, PT_ST); + udelay(5); + tc9154a_set_pins(fmr2, 0); +} + +static int fmr2_s_ctrl(struct v4l2_ctrl *ctrl) +{ + struct snd_tea575x *tea = container_of(ctrl->handler, struct snd_tea575x, ctrl_handler); + struct fmr2 *fmr2 = tea->private_data; + int volume, balance, left, right;
switch (ctrl->id) { - case V4L2_CID_AUDIO_MUTE: - ctrl->value = fmr2->mute; - return 0; case V4L2_CID_AUDIO_VOLUME: - ctrl->value = fmr2->curvol; - return 0; - } - return -EINVAL; -} - -static int vidioc_s_ctrl(struct file *file, void *priv, - struct v4l2_control *ctrl) -{ - struct fmr2 *fmr2 = video_drvdata(file); - - switch (ctrl->id) { - case V4L2_CID_AUDIO_MUTE: - fmr2->mute = ctrl->value; + volume = ctrl->val; + balance = fmr2->balance->cur.val; break; - case V4L2_CID_AUDIO_VOLUME: - fmr2->curvol = ctrl->value; + case V4L2_CID_AUDIO_BALANCE: + balance = ctrl->val; + volume = fmr2->volume->cur.val; break; default: return -EINVAL; }
-#ifdef DEBUG - if (fmr2->curvol && !fmr2->mute) - printk(KERN_DEBUG "unmute\n"); - else - printk(KERN_DEBUG "mute\n"); -#endif - - mutex_lock(&fmr2->lock); - if (fmr2->curvol && !fmr2->mute) { - fmr2_setvolume(fmr2); - /* Set frequency and unmute card */ - fmr2_setfreq(fmr2); - } else - fmr2_mute(fmr2->io); - mutex_unlock(&fmr2->lock); - return 0; -} + left = right = volume; + if (balance < 0) + right = max(0, right + balance); + if (balance > 0) + left = max(0, left - balance);
-static int vidioc_g_input(struct file *filp, void *priv, unsigned int *i) -{ - *i = 0; - return 0; -} - -static int vidioc_s_input(struct file *filp, void *priv, unsigned int i) -{ - return i ? -EINVAL : 0; -} + tc9154a_set_attenuation(fmr2, abs(left - 68), TC9154A_CHANNEL_LEFT); + tc9154a_set_attenuation(fmr2, abs(right - 68), TC9154A_CHANNEL_RIGHT);
-static int vidioc_g_audio(struct file *file, void *priv, - struct v4l2_audio *a) -{ - a->index = 0; - strlcpy(a->name, "Radio", sizeof(a->name)); - a->capability = V4L2_AUDCAP_STEREO; return 0; }
-static int vidioc_s_audio(struct file *file, void *priv, - struct v4l2_audio *a) +static const struct v4l2_ctrl_ops fmr2_ctrl_ops = { + .s_ctrl = fmr2_s_ctrl, +}; + +static int fmr2_tea_ext_init(struct snd_tea575x *tea) { - return a->index ? -EINVAL : 0; -} + struct fmr2 *fmr2 = tea->private_data;
-static const struct v4l2_file_operations fmr2_fops = { - .owner = THIS_MODULE, - .unlocked_ioctl = video_ioctl2, -}; + if (inb(fmr2->io) & FMR2_HASVOL) { + fmr2->volume = v4l2_ctrl_new_std(&tea->ctrl_handler, &fmr2_ctrl_ops, V4L2_CID_AUDIO_VOLUME, 0, 68, 2, 56); + fmr2->balance = v4l2_ctrl_new_std(&tea->ctrl_handler, &fmr2_ctrl_ops, V4L2_CID_AUDIO_BALANCE, -68, 68, 2, 0); + if (tea->ctrl_handler.error) { + printk(KERN_ERR "radio-sf16fmr2: can't initialize controls\n"); + return tea->ctrl_handler.error; + } + }
-static const struct v4l2_ioctl_ops fmr2_ioctl_ops = { - .vidioc_querycap = vidioc_querycap, - .vidioc_g_tuner = vidioc_g_tuner, - .vidioc_s_tuner = vidioc_s_tuner, - .vidioc_g_audio = vidioc_g_audio, - .vidioc_s_audio = vidioc_s_audio, - .vidioc_g_input = vidioc_g_input, - .vidioc_s_input = vidioc_s_input, - .vidioc_g_frequency = vidioc_g_frequency, - .vidioc_s_frequency = vidioc_s_frequency, - .vidioc_queryctrl = vidioc_queryctrl, - .vidioc_g_ctrl = vidioc_g_ctrl, - .vidioc_s_ctrl = vidioc_s_ctrl, -}; + return 0; +}
static int __init fmr2_init(void) { struct fmr2 *fmr2 = &fmr2_card; - struct v4l2_device *v4l2_dev = &fmr2->v4l2_dev; - int res;
- strlcpy(v4l2_dev->name, "sf16fmr2", sizeof(v4l2_dev->name)); - fmr2->io = io; - fmr2->stereo = 1; - mutex_init(&fmr2->lock); + fmr2->io = FMR2_PORT;
- if (!request_region(fmr2->io, 2, "sf16fmr2")) { - v4l2_err(v4l2_dev, "request_region failed!\n"); + if (!request_region(fmr2->io, 2, "SF16-FMR2")) { + printk(KERN_ERR "radio-sf16fmr2: I/O port 0x%x already in use\n", fmr2->io); return -EBUSY; }
- res = v4l2_device_register(NULL, v4l2_dev); - if (res < 0) { - release_region(fmr2->io, 2); - v4l2_err(v4l2_dev, "Could not register v4l2_device\n"); - return res; - } - - strlcpy(fmr2->vdev.name, v4l2_dev->name, sizeof(fmr2->vdev.name)); - fmr2->vdev.v4l2_dev = v4l2_dev; - fmr2->vdev.fops = &fmr2_fops; - fmr2->vdev.ioctl_ops = &fmr2_ioctl_ops; - fmr2->vdev.release = video_device_release_empty; - video_set_drvdata(&fmr2->vdev, fmr2); - - /* mute card - prevents noisy bootups */ - fmr2_mute(fmr2->io); - fmr2_product_info(fmr2); + fmr2->tea.private_data = fmr2; + fmr2->tea.ops = &fmr2_tea_ops; + fmr2->tea.ext_init = fmr2_tea_ext_init; + strlcpy(fmr2->tea.card, "SF16-FMR2", sizeof(fmr2->tea.card)); + strcpy(fmr2->tea.bus_info, "ISA");
- if (video_register_device(&fmr2->vdev, VFL_TYPE_RADIO, radio_nr) < 0) { - v4l2_device_unregister(v4l2_dev); + if (snd_tea575x_init(&fmr2->tea)) { + printk(KERN_ERR "radio-sf16fmr2: Unable to detect TEA575x tuner\n"); release_region(fmr2->io, 2); - return -EINVAL; + return -ENODEV; }
- v4l2_info(v4l2_dev, "SF16FMR2 radio card driver at 0x%x.\n", fmr2->io); - debug_print((KERN_DEBUG "card_type %d\n", fmr2->card_type)); + printk(KERN_INFO "radio-sf16fmr2: SF16-FMR2 radio card at 0x%x.\n", fmr2->io); return 0; }
@@ -443,22 +211,9 @@ static void __exit fmr2_exit(void) { struct fmr2 *fmr2 = &fmr2_card;
- video_unregister_device(&fmr2->vdev); - v4l2_device_unregister(&fmr2->v4l2_dev); + snd_tea575x_exit(&fmr2->tea); release_region(fmr2->io, 2); }
module_init(fmr2_init); module_exit(fmr2_exit); - -#ifndef MODULE - -static int __init fmr2_setup_io(char *str) -{ - get_option(&str, &io); - return 1; -} - -__setup("sf16fmr2=", fmr2_setup_io); - -#endif
Em 23-05-2011 09:17, Ondrej Zary escreveu:
Convert radio-sf16fmr2 to use generic TEA575x implementation. Most of the driver code goes away as SF16-FMR2 is basically just a TEA5757 tuner connected to ISA bus. The card can optionally be equipped with PT2254A volume control (equivalent of TC9154AP) - the volume setting is completely reworked (with balance control added) and tested.
Ondrej,
As your first series went via alsa tree, and we are close to the end of the merge window, and assuming that Takashi didn't apply those patches on his tree, as you're re-sending it, I think that the better is to wait for the end of the merge window, in order to allow us to sync our development tree with 2.6.40-rc1, and then review and apply it on the top of it.
Thanks, Mauro.
Signed-off-by: Ondrej Zary linux@rainbow-software.org
--- linux-2.6.39-rc2-/sound/pci/Kconfig 2011-05-15 18:50:18.000000000 +0200 +++ linux-2.6.39-rc2/sound/pci/Kconfig 2011-05-17 23:35:30.000000000 +0200 @@ -565,8 +565,8 @@ config SND_FM801_TEA575X_BOOL
config SND_TEA575X tristate
- depends on SND_FM801_TEA575X_BOOL || SND_ES1968_RADIO
- default SND_FM801 || SND_ES1968
- depends on SND_FM801_TEA575X_BOOL || SND_ES1968_RADIO || RADIO_SF16FMR2
- default SND_FM801 || SND_ES1968 || RADIO_SF16FMR2
source "sound/pci/hda/Kconfig"
--- linux-2.6.39-rc2-/drivers/media/radio/radio-sf16fmr2.c 2011-04-06 03:30:43.000000000 +0200 +++ linux-2.6.39-rc2/drivers/media/radio/radio-sf16fmr2.c 2011-05-19 17:56:08.000000000 +0200 @@ -1,441 +1,209 @@ -/* SF16FMR2 radio driver for Linux radio support
- heavily based on fmi driver...
- (c) 2000-2002 Ziglio Frediano, freddy77@angelfire.com
+/* SF16-FMR2 radio driver for Linux
- Copyright (c) 2011 Ondrej Zary
- Notes on the hardware
- Frequency control is done digitally -- ie out(port,encodefreq(95.8));
- No volume control - only mute/unmute - you have to use line volume
- For read stereo/mono you must wait 0.1 sec after set frequency and
- card unmuted so I set frequency on unmute
- Signal handling seem to work only on autoscanning (not implemented)
- Converted to V4L2 API by Mauro Carvalho Chehab mchehab@infradead.org
- Original driver was (c) 2000-2002 Ziglio Frediano, freddy77@angelfire.com
- but almost nothing remained here after conversion to generic TEA575x
*/
- implementation
+#include <linux/delay.h> #include <linux/module.h> /* Modules */ #include <linux/init.h> /* Initdata */ #include <linux/ioport.h> /* request_region */ -#include <linux/delay.h> /* udelay */ -#include <linux/videodev2.h> /* kernel radio structs */ -#include <linux/mutex.h> -#include <linux/version.h> /* for KERNEL_VERSION MACRO */ #include <linux/io.h> /* outb, outb_p */ -#include <media/v4l2-device.h> -#include <media/v4l2-ioctl.h> +#include <sound/tea575x-tuner.h>
-MODULE_AUTHOR("Ziglio Frediano, freddy77@angelfire.com"); -MODULE_DESCRIPTION("A driver for the SF16FMR2 radio."); +MODULE_AUTHOR("Ondrej Zary"); +MODULE_DESCRIPTION("MediaForte SF16-FMR2 FM radio card driver"); MODULE_LICENSE("GPL");
-static int io = 0x384; -static int radio_nr = -1;
-module_param(io, int, 0); -MODULE_PARM_DESC(io, "I/O address of the SF16FMR2 card (should be 0x384, if do not work try 0x284)"); -module_param(radio_nr, int, 0);
-#define RADIO_VERSION KERNEL_VERSION(0,0,2)
-#define AUD_VOL_INDEX 1
-#undef DEBUG -//#define DEBUG 1
-#ifdef DEBUG -# define debug_print(s) printk s -#else -# define debug_print(s) -#endif
-/* this should be static vars for module size */ -struct fmr2 -{
- struct v4l2_device v4l2_dev;
- struct video_device vdev;
- struct mutex lock;
+struct fmr2 { int io;
- int curvol; /* 0-15 */
- int mute;
- int stereo; /* card is producing stereo audio */
- unsigned long curfreq; /* freq in kHz */
- int card_type;
- struct snd_tea575x tea;
- struct v4l2_ctrl *volume;
- struct v4l2_ctrl *balance;
};
+/* the port is hardwired so no need to support multiple cards */ +#define FMR2_PORT 0x384 static struct fmr2 fmr2_card;
-/* hw precision is 12.5 kHz
- It is only useful to give freq in interval of 200 (=0.0125Mhz),
- other bits will be truncated
- */
-#define RSF16_ENCODE(x) ((x) / 200 + 856) -#define RSF16_MINFREQ (87 * 16000) -#define RSF16_MAXFREQ (108 * 16000)
-static inline void wait(int n, int io) -{
- for (; n; --n)
inb(io);-}
-static void outbits(int bits, unsigned int data, int nWait, int io) -{
- int bit;
- for (; --bits >= 0;) {
bit = (data >> bits) & 1;outb(bit, io);wait(nWait, io);outb(bit | 2, io);wait(nWait, io);outb(bit, io);wait(nWait, io);- }
-}
-static inline void fmr2_mute(int io) -{
- outb(0x00, io);
- wait(4, io);
-}
-static inline void fmr2_unmute(int io) -{
- outb(0x04, io);
- wait(4, io);
-}
-static inline int fmr2_stereo_mode(int io) -{
- int n = inb(io);
- outb(6, io);
- inb(io);
- n = ((n >> 3) & 1) ^ 1;
- debug_print((KERN_DEBUG "stereo: %d\n", n));
- return n;
-}
-static int fmr2_product_info(struct fmr2 *dev) -{
- int n = inb(dev->io);
- n &= 0xC1;
- if (n == 0) {
/* this should support volume set */dev->card_type = 12;return 0;- }
- /* not volume (mine is 11) */
- dev->card_type = (n == 128) ? 11 : 0;
- return n;
-}
-static inline int fmr2_getsigstr(struct fmr2 *dev) -{
- /* !!! works only if scanning freq */
- int res = 0xffff;
- outb(5, dev->io);
- wait(4, dev->io);
- if (!(inb(dev->io) & 1))
res = 0;- debug_print((KERN_DEBUG "signal: %d\n", res));
- return res;
-}
-/* set frequency and unmute card */ -static int fmr2_setfreq(struct fmr2 *dev) -{
- unsigned long freq = dev->curfreq;
- fmr2_mute(dev->io);
- /* 0x42 for mono output
* 0x102 forward scanning* 0x182 scansione avanti*/- outbits(9, 0x2, 3, dev->io);
- outbits(16, RSF16_ENCODE(freq), 2, dev->io);
- fmr2_unmute(dev->io);
- /* wait 0.11 sec */
- msleep(110);
- /* NOTE if mute this stop radio
you must set freq on unmute */- dev->stereo = fmr2_stereo_mode(dev->io);
- return 0;
-}
-/* !!! not tested, in my card this does't work !!! */ -static int fmr2_setvolume(struct fmr2 *dev) -{
- int vol[16] = { 0x021, 0x084, 0x090, 0x104,
0x110, 0x204, 0x210, 0x402,0x404, 0x408, 0x410, 0x801,0x802, 0x804, 0x808, 0x810 };- int i, a;
- int n = vol[dev->curvol & 0x0f];
- if (dev->card_type != 11)
return 1;- for (i = 12; --i >= 0; ) {
a = ((n >> i) & 1) << 6; /* if (a==0) a = 0; else a = 0x40; */outb(a | 4, dev->io);wait(4, dev->io);outb(a | 0x24, dev->io);wait(4, dev->io);outb(a | 4, dev->io);wait(4, dev->io);- }
- for (i = 6; --i >= 0; ) {
a = ((0x18 >> i) & 1) << 6;outb(a | 4, dev->io);wait(4, dev->io);outb(a | 0x24, dev->io);wait(4, dev->io);outb(a | 4, dev->io);wait(4, dev->io);- }
- wait(4, dev->io);
- outb(0x14, dev->io);
- return 0;
-}
-static int vidioc_querycap(struct file *file, void *priv,
struct v4l2_capability *v)-{
- strlcpy(v->driver, "radio-sf16fmr2", sizeof(v->driver));
- strlcpy(v->card, "SF16-FMR2 radio", sizeof(v->card));
- strlcpy(v->bus_info, "ISA", sizeof(v->bus_info));
- v->version = RADIO_VERSION;
- v->capabilities = V4L2_CAP_TUNER | V4L2_CAP_RADIO;
- return 0;
-} +/* TEA575x tuner pins */ +#define STR_DATA (1 << 0) +#define STR_CLK (1 << 1) +#define STR_WREN (1 << 2) +#define STR_MOST (1 << 3) +/* PT2254A/TC9154A volume control pins */ +#define PT_ST (1 << 4) +#define PT_CK (1 << 5) +#define PT_DATA (1 << 6) +/* volume control presence pin */ +#define FMR2_HASVOL (1 << 7)
-static int vidioc_g_tuner(struct file *file, void *priv,
struct v4l2_tuner *v)+static void fmr2_tea575x_set_pins(struct snd_tea575x *tea, u8 pins) {
- struct fmr2 *fmr2 = video_drvdata(file);
- if (v->index > 0)
return -EINVAL;
- struct fmr2 *fmr2 = tea->private_data;
- u8 bits = 0;
- strlcpy(v->name, "FM", sizeof(v->name));
- v->type = V4L2_TUNER_RADIO;
- v->rangelow = RSF16_MINFREQ;
- v->rangehigh = RSF16_MAXFREQ;
- v->rxsubchans = fmr2->stereo ? V4L2_TUNER_SUB_STEREO :
V4L2_TUNER_SUB_MONO;- v->capability = V4L2_TUNER_CAP_STEREO | V4L2_TUNER_CAP_LOW;
- v->audmode = V4L2_TUNER_MODE_STEREO;
- mutex_lock(&fmr2->lock);
- v->signal = fmr2_getsigstr(fmr2);
- mutex_unlock(&fmr2->lock);
- return 0;
-}
- bits |= (pins & TEA575X_DATA) ? STR_DATA : 0;
- bits |= (pins & TEA575X_CLK) ? STR_CLK : 0;
- /* WRITE_ENABLE is inverted, DATA must be high during read */
- bits |= (pins & TEA575X_WREN) ? 0 : STR_WREN | STR_DATA;
-static int vidioc_s_tuner(struct file *file, void *priv,
struct v4l2_tuner *v)-{
- return v->index ? -EINVAL : 0;
- outb(bits, fmr2->io);
}
-static int vidioc_s_frequency(struct file *file, void *priv,
struct v4l2_frequency *f)+static u8 fmr2_tea575x_get_pins(struct snd_tea575x *tea) {
- struct fmr2 *fmr2 = video_drvdata(file);
- struct fmr2 *fmr2 = tea->private_data;
- u8 bits = inb(fmr2->io);
- if (f->tuner != 0 || f->type != V4L2_TUNER_RADIO)
return -EINVAL;- if (f->frequency < RSF16_MINFREQ ||
f->frequency > RSF16_MAXFREQ)return -EINVAL;- /* rounding in steps of 200 to match the freq
that will be used */- fmr2->curfreq = (f->frequency / 200) * 200;
- /* set card freq (if not muted) */
- if (fmr2->curvol && !fmr2->mute) {
mutex_lock(&fmr2->lock);fmr2_setfreq(fmr2);mutex_unlock(&fmr2->lock);- }
- return 0;
- return (bits & STR_DATA) ? TEA575X_DATA : 0 |
(bits & STR_MOST) ? TEA575X_MOST : 0;}
-static int vidioc_g_frequency(struct file *file, void *priv,
struct v4l2_frequency *f)+static void fmr2_tea575x_set_direction(struct snd_tea575x *tea, bool output) {
- struct fmr2 *fmr2 = video_drvdata(file);
- if (f->tuner != 0)
return -EINVAL;- f->type = V4L2_TUNER_RADIO;
- f->frequency = fmr2->curfreq;
- return 0;
}
-static int vidioc_queryctrl(struct file *file, void *priv,
struct v4l2_queryctrl *qc)-{
- struct fmr2 *fmr2 = video_drvdata(file);
+static struct snd_tea575x_ops fmr2_tea_ops = {
- .set_pins = fmr2_tea575x_set_pins,
- .get_pins = fmr2_tea575x_get_pins,
- .set_direction = fmr2_tea575x_set_direction,
+};
- switch (qc->id) {
- case V4L2_CID_AUDIO_MUTE:
return v4l2_ctrl_query_fill(qc, 0, 1, 1, 1);- case V4L2_CID_AUDIO_VOLUME:
/* Only card_type == 11 implements volume */if (fmr2->card_type == 11)return v4l2_ctrl_query_fill(qc, 0, 15, 1, 0);return v4l2_ctrl_query_fill(qc, 0, 1, 1, 0);- }
- return -EINVAL;
-} +/* TC9154A/PT2254A volume control */
-static int vidioc_g_ctrl(struct file *file, void *priv,
struct v4l2_control *ctrl)-{
- struct fmr2 *fmr2 = video_drvdata(file);
+/* 18-bit shift register bit definitions */ +#define TC9154A_ATT_MAJ_0DB (1 << 0) +#define TC9154A_ATT_MAJ_10DB (1 << 1) +#define TC9154A_ATT_MAJ_20DB (1 << 2) +#define TC9154A_ATT_MAJ_30DB (1 << 3) +#define TC9154A_ATT_MAJ_40DB (1 << 4) +#define TC9154A_ATT_MAJ_50DB (1 << 5) +#define TC9154A_ATT_MAJ_60DB (1 << 6)
+#define TC9154A_ATT_MIN_0DB (1 << 7) +#define TC9154A_ATT_MIN_2DB (1 << 8) +#define TC9154A_ATT_MIN_4DB (1 << 9) +#define TC9154A_ATT_MIN_6DB (1 << 10) +#define TC9154A_ATT_MIN_8DB (1 << 11) +/* bit 12 is ignored */ +#define TC9154A_CHANNEL_LEFT (1 << 13) +#define TC9154A_CHANNEL_RIGHT (1 << 14) +/* bits 15, 16, 17 must be 0 */
+#define TC9154A_ATT_MAJ(x) (1 << x) +#define TC9154A_ATT_MIN(x) (1 << (7 + x))
+static void tc9154a_set_pins(struct fmr2 *fmr2, u8 pins) +{
- if (!fmr2->tea.mute)
pins |= STR_WREN;- outb(pins, fmr2->io);
+}
+static void tc9154a_set_attenuation(struct fmr2 *fmr2, int att, u32 channel) +{
- int i;
- u32 reg;
- u8 bit;
- reg = TC9154A_ATT_MAJ(att / 10) | TC9154A_ATT_MIN((att % 10) / 2);
- reg |= channel;
- /* write 18-bit shift register, LSB first */
- for (i = 0; i < 18; i++) {
bit = reg & (1 << i) ? PT_DATA : 0;tc9154a_set_pins(fmr2, bit);udelay(5);tc9154a_set_pins(fmr2, bit | PT_CK);udelay(5);tc9154a_set_pins(fmr2, bit);- }
- /* latch register data */
- udelay(5);
- tc9154a_set_pins(fmr2, PT_ST);
- udelay(5);
- tc9154a_set_pins(fmr2, 0);
+}
+static int fmr2_s_ctrl(struct v4l2_ctrl *ctrl) +{
struct snd_tea575x *tea = container_of(ctrl->handler, struct snd_tea575x, ctrl_handler);
struct fmr2 *fmr2 = tea->private_data;
int volume, balance, left, right;
switch (ctrl->id) {
- case V4L2_CID_AUDIO_MUTE:
ctrl->value = fmr2->mute;return 0;ctrl->value = fmr2->curvol;return 0;- }
- return -EINVAL;
-}
-static int vidioc_s_ctrl(struct file *file, void *priv,
struct v4l2_control *ctrl)-{
- struct fmr2 *fmr2 = video_drvdata(file);
- switch (ctrl->id) {
- case V4L2_CID_AUDIO_MUTE:
fmr2->mute = ctrl->value;
volume = ctrl->val;balance = fmr2->balance->cur.val;
- case V4L2_CID_AUDIO_VOLUME:
fmr2->curvol = ctrl->value;
- case V4L2_CID_AUDIO_BALANCE:
balance = ctrl->val;volume = fmr2->volume->cur.val;-#ifdef DEBUG
- if (fmr2->curvol && !fmr2->mute)
printk(KERN_DEBUG "unmute\n");- else
printk(KERN_DEBUG "mute\n");-#endif
- mutex_lock(&fmr2->lock);
- if (fmr2->curvol && !fmr2->mute) {
fmr2_setvolume(fmr2);/* Set frequency and unmute card */fmr2_setfreq(fmr2);- } else
fmr2_mute(fmr2->io);- mutex_unlock(&fmr2->lock);
- return 0;
-}
- left = right = volume;
- if (balance < 0)
right = max(0, right + balance);- if (balance > 0)
left = max(0, left - balance);-static int vidioc_g_input(struct file *filp, void *priv, unsigned int *i) -{
- *i = 0;
- return 0;
-}
-static int vidioc_s_input(struct file *filp, void *priv, unsigned int i) -{
- return i ? -EINVAL : 0;
-}
- tc9154a_set_attenuation(fmr2, abs(left - 68), TC9154A_CHANNEL_LEFT);
- tc9154a_set_attenuation(fmr2, abs(right - 68), TC9154A_CHANNEL_RIGHT);
-static int vidioc_g_audio(struct file *file, void *priv,
struct v4l2_audio *a)-{
- a->index = 0;
- strlcpy(a->name, "Radio", sizeof(a->name));
- a->capability = V4L2_AUDCAP_STEREO; return 0;
}
-static int vidioc_s_audio(struct file *file, void *priv,
struct v4l2_audio *a)+static const struct v4l2_ctrl_ops fmr2_ctrl_ops = {
- .s_ctrl = fmr2_s_ctrl,
+};
+static int fmr2_tea_ext_init(struct snd_tea575x *tea) {
- return a->index ? -EINVAL : 0;
-}
- struct fmr2 *fmr2 = tea->private_data;
-static const struct v4l2_file_operations fmr2_fops = {
- .owner = THIS_MODULE,
- .unlocked_ioctl = video_ioctl2,
-};
- if (inb(fmr2->io) & FMR2_HASVOL) {
fmr2->volume = v4l2_ctrl_new_std(&tea->ctrl_handler, &fmr2_ctrl_ops, V4L2_CID_AUDIO_VOLUME, 0, 68, 2, 56);fmr2->balance = v4l2_ctrl_new_std(&tea->ctrl_handler, &fmr2_ctrl_ops, V4L2_CID_AUDIO_BALANCE, -68, 68, 2, 0);if (tea->ctrl_handler.error) {printk(KERN_ERR "radio-sf16fmr2: can't initialize controls\n");return tea->ctrl_handler.error;}- }
-static const struct v4l2_ioctl_ops fmr2_ioctl_ops = {
- .vidioc_querycap = vidioc_querycap,
- .vidioc_g_tuner = vidioc_g_tuner,
- .vidioc_s_tuner = vidioc_s_tuner,
- .vidioc_g_audio = vidioc_g_audio,
- .vidioc_s_audio = vidioc_s_audio,
- .vidioc_g_input = vidioc_g_input,
- .vidioc_s_input = vidioc_s_input,
- .vidioc_g_frequency = vidioc_g_frequency,
- .vidioc_s_frequency = vidioc_s_frequency,
- .vidioc_queryctrl = vidioc_queryctrl,
- .vidioc_g_ctrl = vidioc_g_ctrl,
- .vidioc_s_ctrl = vidioc_s_ctrl,
-};
- return 0;
+}
static int __init fmr2_init(void) { struct fmr2 *fmr2 = &fmr2_card;
struct v4l2_device *v4l2_dev = &fmr2->v4l2_dev;
int res;
strlcpy(v4l2_dev->name, "sf16fmr2", sizeof(v4l2_dev->name));
fmr2->io = io;
fmr2->stereo = 1;
mutex_init(&fmr2->lock);
- fmr2->io = FMR2_PORT;
- if (!request_region(fmr2->io, 2, "sf16fmr2")) {
v4l2_err(v4l2_dev, "request_region failed!\n");
- if (!request_region(fmr2->io, 2, "SF16-FMR2")) {
printk(KERN_ERR "radio-sf16fmr2: I/O port 0x%x already in use\n", fmr2->io);
- res = v4l2_device_register(NULL, v4l2_dev);
- if (res < 0) {
release_region(fmr2->io, 2);v4l2_err(v4l2_dev, "Could not register v4l2_device\n");return res;- }
- strlcpy(fmr2->vdev.name, v4l2_dev->name, sizeof(fmr2->vdev.name));
- fmr2->vdev.v4l2_dev = v4l2_dev;
- fmr2->vdev.fops = &fmr2_fops;
- fmr2->vdev.ioctl_ops = &fmr2_ioctl_ops;
- fmr2->vdev.release = video_device_release_empty;
- video_set_drvdata(&fmr2->vdev, fmr2);
- /* mute card - prevents noisy bootups */
- fmr2_mute(fmr2->io);
- fmr2_product_info(fmr2);
- fmr2->tea.private_data = fmr2;
- fmr2->tea.ops = &fmr2_tea_ops;
- fmr2->tea.ext_init = fmr2_tea_ext_init;
- strlcpy(fmr2->tea.card, "SF16-FMR2", sizeof(fmr2->tea.card));
- strcpy(fmr2->tea.bus_info, "ISA");
- if (video_register_device(&fmr2->vdev, VFL_TYPE_RADIO, radio_nr) < 0) {
v4l2_device_unregister(v4l2_dev);
- if (snd_tea575x_init(&fmr2->tea)) {
printk(KERN_ERR "radio-sf16fmr2: Unable to detect TEA575x tuner\n");
return -EINVAL;
return -ENODEV;
- v4l2_info(v4l2_dev, "SF16FMR2 radio card driver at 0x%x.\n", fmr2->io);
- debug_print((KERN_DEBUG "card_type %d\n", fmr2->card_type));
- printk(KERN_INFO "radio-sf16fmr2: SF16-FMR2 radio card at 0x%x.\n", fmr2->io); return 0;
}
@@ -443,22 +211,9 @@ static void __exit fmr2_exit(void) { struct fmr2 *fmr2 = &fmr2_card;
- video_unregister_device(&fmr2->vdev);
- v4l2_device_unregister(&fmr2->v4l2_dev);
- snd_tea575x_exit(&fmr2->tea); release_region(fmr2->io, 2);
}
module_init(fmr2_init); module_exit(fmr2_exit);
-#ifndef MODULE
-static int __init fmr2_setup_io(char *str) -{
- get_option(&str, &io);
- return 1;
-}
-__setup("sf16fmr2=", fmr2_setup_io);
-#endif
At Wed, 25 May 2011 21:21:30 -0300, Mauro Carvalho Chehab wrote:
Em 23-05-2011 09:17, Ondrej Zary escreveu:
Convert radio-sf16fmr2 to use generic TEA575x implementation. Most of the driver code goes away as SF16-FMR2 is basically just a TEA5757 tuner connected to ISA bus. The card can optionally be equipped with PT2254A volume control (equivalent of TC9154AP) - the volume setting is completely reworked (with balance control added) and tested.
Ondrej,
As your first series went via alsa tree, and we are close to the end of the merge window, and assuming that Takashi didn't apply those patches on his tree, as you're re-sending it, I think that the better is to wait for the end of the merge window, in order to allow us to sync our development tree with 2.6.40-rc1, and then review and apply it on the top of it.
Yeah, I didn't pick it up as the patches are rather V4L-side changes (although tea575x.c is in sound sub-directory). And I agree with Mauro - let's merge it after rc1, so that we stand on the same ground. This sort of cross-tree change is better done at the fixed point than in flux like during merge window.
That being said, I don't mind that Mauro or Hans applies these through V4L tree. In that case, you can take my acks for both patches.
Acked-by: Takashi Iwai tiwai@suse.de
Of if it's preferred through sound tree, I can take them later.
thanks,
Takashi
Thanks, Mauro.
Signed-off-by: Ondrej Zary linux@rainbow-software.org
--- linux-2.6.39-rc2-/sound/pci/Kconfig 2011-05-15 18:50:18.000000000 +0200 +++ linux-2.6.39-rc2/sound/pci/Kconfig 2011-05-17 23:35:30.000000000 +0200 @@ -565,8 +565,8 @@ config SND_FM801_TEA575X_BOOL
config SND_TEA575X tristate
- depends on SND_FM801_TEA575X_BOOL || SND_ES1968_RADIO
- default SND_FM801 || SND_ES1968
- depends on SND_FM801_TEA575X_BOOL || SND_ES1968_RADIO || RADIO_SF16FMR2
- default SND_FM801 || SND_ES1968 || RADIO_SF16FMR2
source "sound/pci/hda/Kconfig"
--- linux-2.6.39-rc2-/drivers/media/radio/radio-sf16fmr2.c 2011-04-06 03:30:43.000000000 +0200 +++ linux-2.6.39-rc2/drivers/media/radio/radio-sf16fmr2.c 2011-05-19 17:56:08.000000000 +0200 @@ -1,441 +1,209 @@ -/* SF16FMR2 radio driver for Linux radio support
- heavily based on fmi driver...
- (c) 2000-2002 Ziglio Frediano, freddy77@angelfire.com
+/* SF16-FMR2 radio driver for Linux
- Copyright (c) 2011 Ondrej Zary
- Notes on the hardware
- Frequency control is done digitally -- ie out(port,encodefreq(95.8));
- No volume control - only mute/unmute - you have to use line volume
- For read stereo/mono you must wait 0.1 sec after set frequency and
- card unmuted so I set frequency on unmute
- Signal handling seem to work only on autoscanning (not implemented)
- Converted to V4L2 API by Mauro Carvalho Chehab mchehab@infradead.org
- Original driver was (c) 2000-2002 Ziglio Frediano, freddy77@angelfire.com
- but almost nothing remained here after conversion to generic TEA575x
*/
- implementation
+#include <linux/delay.h> #include <linux/module.h> /* Modules */ #include <linux/init.h> /* Initdata */ #include <linux/ioport.h> /* request_region */ -#include <linux/delay.h> /* udelay */ -#include <linux/videodev2.h> /* kernel radio structs */ -#include <linux/mutex.h> -#include <linux/version.h> /* for KERNEL_VERSION MACRO */ #include <linux/io.h> /* outb, outb_p */ -#include <media/v4l2-device.h> -#include <media/v4l2-ioctl.h> +#include <sound/tea575x-tuner.h>
-MODULE_AUTHOR("Ziglio Frediano, freddy77@angelfire.com"); -MODULE_DESCRIPTION("A driver for the SF16FMR2 radio."); +MODULE_AUTHOR("Ondrej Zary"); +MODULE_DESCRIPTION("MediaForte SF16-FMR2 FM radio card driver"); MODULE_LICENSE("GPL");
-static int io = 0x384; -static int radio_nr = -1;
-module_param(io, int, 0); -MODULE_PARM_DESC(io, "I/O address of the SF16FMR2 card (should be 0x384, if do not work try 0x284)"); -module_param(radio_nr, int, 0);
-#define RADIO_VERSION KERNEL_VERSION(0,0,2)
-#define AUD_VOL_INDEX 1
-#undef DEBUG -//#define DEBUG 1
-#ifdef DEBUG -# define debug_print(s) printk s -#else -# define debug_print(s) -#endif
-/* this should be static vars for module size */ -struct fmr2 -{
- struct v4l2_device v4l2_dev;
- struct video_device vdev;
- struct mutex lock;
+struct fmr2 { int io;
- int curvol; /* 0-15 */
- int mute;
- int stereo; /* card is producing stereo audio */
- unsigned long curfreq; /* freq in kHz */
- int card_type;
- struct snd_tea575x tea;
- struct v4l2_ctrl *volume;
- struct v4l2_ctrl *balance;
};
+/* the port is hardwired so no need to support multiple cards */ +#define FMR2_PORT 0x384 static struct fmr2 fmr2_card;
-/* hw precision is 12.5 kHz
- It is only useful to give freq in interval of 200 (=0.0125Mhz),
- other bits will be truncated
- */
-#define RSF16_ENCODE(x) ((x) / 200 + 856) -#define RSF16_MINFREQ (87 * 16000) -#define RSF16_MAXFREQ (108 * 16000)
-static inline void wait(int n, int io) -{
- for (; n; --n)
inb(io);-}
-static void outbits(int bits, unsigned int data, int nWait, int io) -{
- int bit;
- for (; --bits >= 0;) {
bit = (data >> bits) & 1;outb(bit, io);wait(nWait, io);outb(bit | 2, io);wait(nWait, io);outb(bit, io);wait(nWait, io);- }
-}
-static inline void fmr2_mute(int io) -{
- outb(0x00, io);
- wait(4, io);
-}
-static inline void fmr2_unmute(int io) -{
- outb(0x04, io);
- wait(4, io);
-}
-static inline int fmr2_stereo_mode(int io) -{
- int n = inb(io);
- outb(6, io);
- inb(io);
- n = ((n >> 3) & 1) ^ 1;
- debug_print((KERN_DEBUG "stereo: %d\n", n));
- return n;
-}
-static int fmr2_product_info(struct fmr2 *dev) -{
- int n = inb(dev->io);
- n &= 0xC1;
- if (n == 0) {
/* this should support volume set */dev->card_type = 12;return 0;- }
- /* not volume (mine is 11) */
- dev->card_type = (n == 128) ? 11 : 0;
- return n;
-}
-static inline int fmr2_getsigstr(struct fmr2 *dev) -{
- /* !!! works only if scanning freq */
- int res = 0xffff;
- outb(5, dev->io);
- wait(4, dev->io);
- if (!(inb(dev->io) & 1))
res = 0;- debug_print((KERN_DEBUG "signal: %d\n", res));
- return res;
-}
-/* set frequency and unmute card */ -static int fmr2_setfreq(struct fmr2 *dev) -{
- unsigned long freq = dev->curfreq;
- fmr2_mute(dev->io);
- /* 0x42 for mono output
* 0x102 forward scanning* 0x182 scansione avanti*/- outbits(9, 0x2, 3, dev->io);
- outbits(16, RSF16_ENCODE(freq), 2, dev->io);
- fmr2_unmute(dev->io);
- /* wait 0.11 sec */
- msleep(110);
- /* NOTE if mute this stop radio
you must set freq on unmute */- dev->stereo = fmr2_stereo_mode(dev->io);
- return 0;
-}
-/* !!! not tested, in my card this does't work !!! */ -static int fmr2_setvolume(struct fmr2 *dev) -{
- int vol[16] = { 0x021, 0x084, 0x090, 0x104,
0x110, 0x204, 0x210, 0x402,0x404, 0x408, 0x410, 0x801,0x802, 0x804, 0x808, 0x810 };- int i, a;
- int n = vol[dev->curvol & 0x0f];
- if (dev->card_type != 11)
return 1;- for (i = 12; --i >= 0; ) {
a = ((n >> i) & 1) << 6; /* if (a==0) a = 0; else a = 0x40; */outb(a | 4, dev->io);wait(4, dev->io);outb(a | 0x24, dev->io);wait(4, dev->io);outb(a | 4, dev->io);wait(4, dev->io);- }
- for (i = 6; --i >= 0; ) {
a = ((0x18 >> i) & 1) << 6;outb(a | 4, dev->io);wait(4, dev->io);outb(a | 0x24, dev->io);wait(4, dev->io);outb(a | 4, dev->io);wait(4, dev->io);- }
- wait(4, dev->io);
- outb(0x14, dev->io);
- return 0;
-}
-static int vidioc_querycap(struct file *file, void *priv,
struct v4l2_capability *v)-{
- strlcpy(v->driver, "radio-sf16fmr2", sizeof(v->driver));
- strlcpy(v->card, "SF16-FMR2 radio", sizeof(v->card));
- strlcpy(v->bus_info, "ISA", sizeof(v->bus_info));
- v->version = RADIO_VERSION;
- v->capabilities = V4L2_CAP_TUNER | V4L2_CAP_RADIO;
- return 0;
-} +/* TEA575x tuner pins */ +#define STR_DATA (1 << 0) +#define STR_CLK (1 << 1) +#define STR_WREN (1 << 2) +#define STR_MOST (1 << 3) +/* PT2254A/TC9154A volume control pins */ +#define PT_ST (1 << 4) +#define PT_CK (1 << 5) +#define PT_DATA (1 << 6) +/* volume control presence pin */ +#define FMR2_HASVOL (1 << 7)
-static int vidioc_g_tuner(struct file *file, void *priv,
struct v4l2_tuner *v)+static void fmr2_tea575x_set_pins(struct snd_tea575x *tea, u8 pins) {
- struct fmr2 *fmr2 = video_drvdata(file);
- if (v->index > 0)
return -EINVAL;
- struct fmr2 *fmr2 = tea->private_data;
- u8 bits = 0;
- strlcpy(v->name, "FM", sizeof(v->name));
- v->type = V4L2_TUNER_RADIO;
- v->rangelow = RSF16_MINFREQ;
- v->rangehigh = RSF16_MAXFREQ;
- v->rxsubchans = fmr2->stereo ? V4L2_TUNER_SUB_STEREO :
V4L2_TUNER_SUB_MONO;- v->capability = V4L2_TUNER_CAP_STEREO | V4L2_TUNER_CAP_LOW;
- v->audmode = V4L2_TUNER_MODE_STEREO;
- mutex_lock(&fmr2->lock);
- v->signal = fmr2_getsigstr(fmr2);
- mutex_unlock(&fmr2->lock);
- return 0;
-}
- bits |= (pins & TEA575X_DATA) ? STR_DATA : 0;
- bits |= (pins & TEA575X_CLK) ? STR_CLK : 0;
- /* WRITE_ENABLE is inverted, DATA must be high during read */
- bits |= (pins & TEA575X_WREN) ? 0 : STR_WREN | STR_DATA;
-static int vidioc_s_tuner(struct file *file, void *priv,
struct v4l2_tuner *v)-{
- return v->index ? -EINVAL : 0;
- outb(bits, fmr2->io);
}
-static int vidioc_s_frequency(struct file *file, void *priv,
struct v4l2_frequency *f)+static u8 fmr2_tea575x_get_pins(struct snd_tea575x *tea) {
- struct fmr2 *fmr2 = video_drvdata(file);
- struct fmr2 *fmr2 = tea->private_data;
- u8 bits = inb(fmr2->io);
- if (f->tuner != 0 || f->type != V4L2_TUNER_RADIO)
return -EINVAL;- if (f->frequency < RSF16_MINFREQ ||
f->frequency > RSF16_MAXFREQ)return -EINVAL;- /* rounding in steps of 200 to match the freq
that will be used */- fmr2->curfreq = (f->frequency / 200) * 200;
- /* set card freq (if not muted) */
- if (fmr2->curvol && !fmr2->mute) {
mutex_lock(&fmr2->lock);fmr2_setfreq(fmr2);mutex_unlock(&fmr2->lock);- }
- return 0;
- return (bits & STR_DATA) ? TEA575X_DATA : 0 |
(bits & STR_MOST) ? TEA575X_MOST : 0;}
-static int vidioc_g_frequency(struct file *file, void *priv,
struct v4l2_frequency *f)+static void fmr2_tea575x_set_direction(struct snd_tea575x *tea, bool output) {
- struct fmr2 *fmr2 = video_drvdata(file);
- if (f->tuner != 0)
return -EINVAL;- f->type = V4L2_TUNER_RADIO;
- f->frequency = fmr2->curfreq;
- return 0;
}
-static int vidioc_queryctrl(struct file *file, void *priv,
struct v4l2_queryctrl *qc)-{
- struct fmr2 *fmr2 = video_drvdata(file);
+static struct snd_tea575x_ops fmr2_tea_ops = {
- .set_pins = fmr2_tea575x_set_pins,
- .get_pins = fmr2_tea575x_get_pins,
- .set_direction = fmr2_tea575x_set_direction,
+};
- switch (qc->id) {
- case V4L2_CID_AUDIO_MUTE:
return v4l2_ctrl_query_fill(qc, 0, 1, 1, 1);- case V4L2_CID_AUDIO_VOLUME:
/* Only card_type == 11 implements volume */if (fmr2->card_type == 11)return v4l2_ctrl_query_fill(qc, 0, 15, 1, 0);return v4l2_ctrl_query_fill(qc, 0, 1, 1, 0);- }
- return -EINVAL;
-} +/* TC9154A/PT2254A volume control */
-static int vidioc_g_ctrl(struct file *file, void *priv,
struct v4l2_control *ctrl)-{
- struct fmr2 *fmr2 = video_drvdata(file);
+/* 18-bit shift register bit definitions */ +#define TC9154A_ATT_MAJ_0DB (1 << 0) +#define TC9154A_ATT_MAJ_10DB (1 << 1) +#define TC9154A_ATT_MAJ_20DB (1 << 2) +#define TC9154A_ATT_MAJ_30DB (1 << 3) +#define TC9154A_ATT_MAJ_40DB (1 << 4) +#define TC9154A_ATT_MAJ_50DB (1 << 5) +#define TC9154A_ATT_MAJ_60DB (1 << 6)
+#define TC9154A_ATT_MIN_0DB (1 << 7) +#define TC9154A_ATT_MIN_2DB (1 << 8) +#define TC9154A_ATT_MIN_4DB (1 << 9) +#define TC9154A_ATT_MIN_6DB (1 << 10) +#define TC9154A_ATT_MIN_8DB (1 << 11) +/* bit 12 is ignored */ +#define TC9154A_CHANNEL_LEFT (1 << 13) +#define TC9154A_CHANNEL_RIGHT (1 << 14) +/* bits 15, 16, 17 must be 0 */
+#define TC9154A_ATT_MAJ(x) (1 << x) +#define TC9154A_ATT_MIN(x) (1 << (7 + x))
+static void tc9154a_set_pins(struct fmr2 *fmr2, u8 pins) +{
- if (!fmr2->tea.mute)
pins |= STR_WREN;- outb(pins, fmr2->io);
+}
+static void tc9154a_set_attenuation(struct fmr2 *fmr2, int att, u32 channel) +{
- int i;
- u32 reg;
- u8 bit;
- reg = TC9154A_ATT_MAJ(att / 10) | TC9154A_ATT_MIN((att % 10) / 2);
- reg |= channel;
- /* write 18-bit shift register, LSB first */
- for (i = 0; i < 18; i++) {
bit = reg & (1 << i) ? PT_DATA : 0;tc9154a_set_pins(fmr2, bit);udelay(5);tc9154a_set_pins(fmr2, bit | PT_CK);udelay(5);tc9154a_set_pins(fmr2, bit);- }
- /* latch register data */
- udelay(5);
- tc9154a_set_pins(fmr2, PT_ST);
- udelay(5);
- tc9154a_set_pins(fmr2, 0);
+}
+static int fmr2_s_ctrl(struct v4l2_ctrl *ctrl) +{
struct snd_tea575x *tea = container_of(ctrl->handler, struct snd_tea575x, ctrl_handler);
struct fmr2 *fmr2 = tea->private_data;
int volume, balance, left, right;
switch (ctrl->id) {
- case V4L2_CID_AUDIO_MUTE:
ctrl->value = fmr2->mute;return 0;ctrl->value = fmr2->curvol;return 0;- }
- return -EINVAL;
-}
-static int vidioc_s_ctrl(struct file *file, void *priv,
struct v4l2_control *ctrl)-{
- struct fmr2 *fmr2 = video_drvdata(file);
- switch (ctrl->id) {
- case V4L2_CID_AUDIO_MUTE:
fmr2->mute = ctrl->value;
volume = ctrl->val;balance = fmr2->balance->cur.val;
- case V4L2_CID_AUDIO_VOLUME:
fmr2->curvol = ctrl->value;
- case V4L2_CID_AUDIO_BALANCE:
balance = ctrl->val;volume = fmr2->volume->cur.val;-#ifdef DEBUG
- if (fmr2->curvol && !fmr2->mute)
printk(KERN_DEBUG "unmute\n");- else
printk(KERN_DEBUG "mute\n");-#endif
- mutex_lock(&fmr2->lock);
- if (fmr2->curvol && !fmr2->mute) {
fmr2_setvolume(fmr2);/* Set frequency and unmute card */fmr2_setfreq(fmr2);- } else
fmr2_mute(fmr2->io);- mutex_unlock(&fmr2->lock);
- return 0;
-}
- left = right = volume;
- if (balance < 0)
right = max(0, right + balance);- if (balance > 0)
left = max(0, left - balance);-static int vidioc_g_input(struct file *filp, void *priv, unsigned int *i) -{
- *i = 0;
- return 0;
-}
-static int vidioc_s_input(struct file *filp, void *priv, unsigned int i) -{
- return i ? -EINVAL : 0;
-}
- tc9154a_set_attenuation(fmr2, abs(left - 68), TC9154A_CHANNEL_LEFT);
- tc9154a_set_attenuation(fmr2, abs(right - 68), TC9154A_CHANNEL_RIGHT);
-static int vidioc_g_audio(struct file *file, void *priv,
struct v4l2_audio *a)-{
- a->index = 0;
- strlcpy(a->name, "Radio", sizeof(a->name));
- a->capability = V4L2_AUDCAP_STEREO; return 0;
}
-static int vidioc_s_audio(struct file *file, void *priv,
struct v4l2_audio *a)+static const struct v4l2_ctrl_ops fmr2_ctrl_ops = {
- .s_ctrl = fmr2_s_ctrl,
+};
+static int fmr2_tea_ext_init(struct snd_tea575x *tea) {
- return a->index ? -EINVAL : 0;
-}
- struct fmr2 *fmr2 = tea->private_data;
-static const struct v4l2_file_operations fmr2_fops = {
- .owner = THIS_MODULE,
- .unlocked_ioctl = video_ioctl2,
-};
- if (inb(fmr2->io) & FMR2_HASVOL) {
fmr2->volume = v4l2_ctrl_new_std(&tea->ctrl_handler, &fmr2_ctrl_ops, V4L2_CID_AUDIO_VOLUME, 0, 68, 2, 56);fmr2->balance = v4l2_ctrl_new_std(&tea->ctrl_handler, &fmr2_ctrl_ops, V4L2_CID_AUDIO_BALANCE, -68, 68, 2, 0);if (tea->ctrl_handler.error) {printk(KERN_ERR "radio-sf16fmr2: can't initialize controls\n");return tea->ctrl_handler.error;}- }
-static const struct v4l2_ioctl_ops fmr2_ioctl_ops = {
- .vidioc_querycap = vidioc_querycap,
- .vidioc_g_tuner = vidioc_g_tuner,
- .vidioc_s_tuner = vidioc_s_tuner,
- .vidioc_g_audio = vidioc_g_audio,
- .vidioc_s_audio = vidioc_s_audio,
- .vidioc_g_input = vidioc_g_input,
- .vidioc_s_input = vidioc_s_input,
- .vidioc_g_frequency = vidioc_g_frequency,
- .vidioc_s_frequency = vidioc_s_frequency,
- .vidioc_queryctrl = vidioc_queryctrl,
- .vidioc_g_ctrl = vidioc_g_ctrl,
- .vidioc_s_ctrl = vidioc_s_ctrl,
-};
- return 0;
+}
static int __init fmr2_init(void) { struct fmr2 *fmr2 = &fmr2_card;
struct v4l2_device *v4l2_dev = &fmr2->v4l2_dev;
int res;
strlcpy(v4l2_dev->name, "sf16fmr2", sizeof(v4l2_dev->name));
fmr2->io = io;
fmr2->stereo = 1;
mutex_init(&fmr2->lock);
- fmr2->io = FMR2_PORT;
- if (!request_region(fmr2->io, 2, "sf16fmr2")) {
v4l2_err(v4l2_dev, "request_region failed!\n");
- if (!request_region(fmr2->io, 2, "SF16-FMR2")) {
printk(KERN_ERR "radio-sf16fmr2: I/O port 0x%x already in use\n", fmr2->io);
- res = v4l2_device_register(NULL, v4l2_dev);
- if (res < 0) {
release_region(fmr2->io, 2);v4l2_err(v4l2_dev, "Could not register v4l2_device\n");return res;- }
- strlcpy(fmr2->vdev.name, v4l2_dev->name, sizeof(fmr2->vdev.name));
- fmr2->vdev.v4l2_dev = v4l2_dev;
- fmr2->vdev.fops = &fmr2_fops;
- fmr2->vdev.ioctl_ops = &fmr2_ioctl_ops;
- fmr2->vdev.release = video_device_release_empty;
- video_set_drvdata(&fmr2->vdev, fmr2);
- /* mute card - prevents noisy bootups */
- fmr2_mute(fmr2->io);
- fmr2_product_info(fmr2);
- fmr2->tea.private_data = fmr2;
- fmr2->tea.ops = &fmr2_tea_ops;
- fmr2->tea.ext_init = fmr2_tea_ext_init;
- strlcpy(fmr2->tea.card, "SF16-FMR2", sizeof(fmr2->tea.card));
- strcpy(fmr2->tea.bus_info, "ISA");
- if (video_register_device(&fmr2->vdev, VFL_TYPE_RADIO, radio_nr) < 0) {
v4l2_device_unregister(v4l2_dev);
- if (snd_tea575x_init(&fmr2->tea)) {
printk(KERN_ERR "radio-sf16fmr2: Unable to detect TEA575x tuner\n");
return -EINVAL;
return -ENODEV;
- v4l2_info(v4l2_dev, "SF16FMR2 radio card driver at 0x%x.\n", fmr2->io);
- debug_print((KERN_DEBUG "card_type %d\n", fmr2->card_type));
- printk(KERN_INFO "radio-sf16fmr2: SF16-FMR2 radio card at 0x%x.\n", fmr2->io); return 0;
}
@@ -443,22 +211,9 @@ static void __exit fmr2_exit(void) { struct fmr2 *fmr2 = &fmr2_card;
- video_unregister_device(&fmr2->vdev);
- v4l2_device_unregister(&fmr2->v4l2_dev);
- snd_tea575x_exit(&fmr2->tea); release_region(fmr2->io, 2);
}
module_init(fmr2_init); module_exit(fmr2_exit);
-#ifndef MODULE
-static int __init fmr2_setup_io(char *str) -{
- get_option(&str, &io);
- return 1;
-}
-__setup("sf16fmr2=", fmr2_setup_io);
-#endif
Alsa-devel mailing list Alsa-devel@alsa-project.org http://mailman.alsa-project.org/mailman/listinfo/alsa-devel
Em 26-05-2011 04:45, Takashi Iwai escreveu:
At Wed, 25 May 2011 21:21:30 -0300, Mauro Carvalho Chehab wrote:
Em 23-05-2011 09:17, Ondrej Zary escreveu:
Convert radio-sf16fmr2 to use generic TEA575x implementation. Most of the driver code goes away as SF16-FMR2 is basically just a TEA5757 tuner connected to ISA bus. The card can optionally be equipped with PT2254A volume control (equivalent of TC9154AP) - the volume setting is completely reworked (with balance control added) and tested.
Ondrej,
As your first series went via alsa tree, and we are close to the end of the merge window, and assuming that Takashi didn't apply those patches on his tree, as you're re-sending it, I think that the better is to wait for the end of the merge window, in order to allow us to sync our development tree with 2.6.40-rc1, and then review and apply it on the top of it.
Yeah, I didn't pick it up as the patches are rather V4L-side changes (although tea575x.c is in sound sub-directory). And I agree with Mauro - let's merge it after rc1, so that we stand on the same ground. This sort of cross-tree change is better done at the fixed point than in flux like during merge window.
Hmm.. I tried to apply it after -rc1. It didn't apply:
Applying patch patches/lmml_808552_v5_resend_radio_sf16fmr2_convert_to_generic_tea575x_interface.patch patching file sound/pci/Kconfig patching file drivers/media/radio/radio-sf16fmr2.c Hunk #1 FAILED at 1. 1 out of 2 hunks FAILED -- rejects in file drivers/media/radio/radio-sf16fmr2.c Patch patches/lmml_808552_v5_resend_radio_sf16fmr2_convert_to_generic_tea575x_interface.patch does not apply (enforce with -f)
Is there any missing patches, or is it just due to some other changes from the alsa tree?
Ondrej,
Could you please rebase this patch on the top of staging/for_v3.0 branch at git://linuxtv.org/media_tree.git tree?
The other patch applied ok (tea575x: convert to control framework), so I've already applied it here.
That being said, I don't mind that Mauro or Hans applies these through V4L tree. In that case, you can take my acks for both patches.
Acked-by: Takashi Iwai tiwai@suse.de
Of if it's preferred through sound tree, I can take them later.
thanks,
Takashi
Thanks, Mauro.
Signed-off-by: Ondrej Zary linux@rainbow-software.org
--- linux-2.6.39-rc2-/sound/pci/Kconfig 2011-05-15 18:50:18.000000000 +0200 +++ linux-2.6.39-rc2/sound/pci/Kconfig 2011-05-17 23:35:30.000000000 +0200 @@ -565,8 +565,8 @@ config SND_FM801_TEA575X_BOOL
config SND_TEA575X tristate
- depends on SND_FM801_TEA575X_BOOL || SND_ES1968_RADIO
- default SND_FM801 || SND_ES1968
- depends on SND_FM801_TEA575X_BOOL || SND_ES1968_RADIO || RADIO_SF16FMR2
- default SND_FM801 || SND_ES1968 || RADIO_SF16FMR2
source "sound/pci/hda/Kconfig"
--- linux-2.6.39-rc2-/drivers/media/radio/radio-sf16fmr2.c 2011-04-06 03:30:43.000000000 +0200 +++ linux-2.6.39-rc2/drivers/media/radio/radio-sf16fmr2.c 2011-05-19 17:56:08.000000000 +0200 @@ -1,441 +1,209 @@ -/* SF16FMR2 radio driver for Linux radio support
- heavily based on fmi driver...
- (c) 2000-2002 Ziglio Frediano, freddy77@angelfire.com
+/* SF16-FMR2 radio driver for Linux
- Copyright (c) 2011 Ondrej Zary
- Notes on the hardware
- Frequency control is done digitally -- ie out(port,encodefreq(95.8));
- No volume control - only mute/unmute - you have to use line volume
- For read stereo/mono you must wait 0.1 sec after set frequency and
- card unmuted so I set frequency on unmute
- Signal handling seem to work only on autoscanning (not implemented)
- Converted to V4L2 API by Mauro Carvalho Chehab mchehab@infradead.org
- Original driver was (c) 2000-2002 Ziglio Frediano, freddy77@angelfire.com
- but almost nothing remained here after conversion to generic TEA575x
*/
- implementation
+#include <linux/delay.h> #include <linux/module.h> /* Modules */ #include <linux/init.h> /* Initdata */ #include <linux/ioport.h> /* request_region */ -#include <linux/delay.h> /* udelay */ -#include <linux/videodev2.h> /* kernel radio structs */ -#include <linux/mutex.h> -#include <linux/version.h> /* for KERNEL_VERSION MACRO */ #include <linux/io.h> /* outb, outb_p */ -#include <media/v4l2-device.h> -#include <media/v4l2-ioctl.h> +#include <sound/tea575x-tuner.h>
-MODULE_AUTHOR("Ziglio Frediano, freddy77@angelfire.com"); -MODULE_DESCRIPTION("A driver for the SF16FMR2 radio."); +MODULE_AUTHOR("Ondrej Zary"); +MODULE_DESCRIPTION("MediaForte SF16-FMR2 FM radio card driver"); MODULE_LICENSE("GPL");
-static int io = 0x384; -static int radio_nr = -1;
-module_param(io, int, 0); -MODULE_PARM_DESC(io, "I/O address of the SF16FMR2 card (should be 0x384, if do not work try 0x284)"); -module_param(radio_nr, int, 0);
-#define RADIO_VERSION KERNEL_VERSION(0,0,2)
-#define AUD_VOL_INDEX 1
-#undef DEBUG -//#define DEBUG 1
-#ifdef DEBUG -# define debug_print(s) printk s -#else -# define debug_print(s) -#endif
-/* this should be static vars for module size */ -struct fmr2 -{
- struct v4l2_device v4l2_dev;
- struct video_device vdev;
- struct mutex lock;
+struct fmr2 { int io;
- int curvol; /* 0-15 */
- int mute;
- int stereo; /* card is producing stereo audio */
- unsigned long curfreq; /* freq in kHz */
- int card_type;
- struct snd_tea575x tea;
- struct v4l2_ctrl *volume;
- struct v4l2_ctrl *balance;
};
+/* the port is hardwired so no need to support multiple cards */ +#define FMR2_PORT 0x384 static struct fmr2 fmr2_card;
-/* hw precision is 12.5 kHz
- It is only useful to give freq in interval of 200 (=0.0125Mhz),
- other bits will be truncated
- */
-#define RSF16_ENCODE(x) ((x) / 200 + 856) -#define RSF16_MINFREQ (87 * 16000) -#define RSF16_MAXFREQ (108 * 16000)
-static inline void wait(int n, int io) -{
- for (; n; --n)
inb(io);-}
-static void outbits(int bits, unsigned int data, int nWait, int io) -{
- int bit;
- for (; --bits >= 0;) {
bit = (data >> bits) & 1;outb(bit, io);wait(nWait, io);outb(bit | 2, io);wait(nWait, io);outb(bit, io);wait(nWait, io);- }
-}
-static inline void fmr2_mute(int io) -{
- outb(0x00, io);
- wait(4, io);
-}
-static inline void fmr2_unmute(int io) -{
- outb(0x04, io);
- wait(4, io);
-}
-static inline int fmr2_stereo_mode(int io) -{
- int n = inb(io);
- outb(6, io);
- inb(io);
- n = ((n >> 3) & 1) ^ 1;
- debug_print((KERN_DEBUG "stereo: %d\n", n));
- return n;
-}
-static int fmr2_product_info(struct fmr2 *dev) -{
- int n = inb(dev->io);
- n &= 0xC1;
- if (n == 0) {
/* this should support volume set */dev->card_type = 12;return 0;- }
- /* not volume (mine is 11) */
- dev->card_type = (n == 128) ? 11 : 0;
- return n;
-}
-static inline int fmr2_getsigstr(struct fmr2 *dev) -{
- /* !!! works only if scanning freq */
- int res = 0xffff;
- outb(5, dev->io);
- wait(4, dev->io);
- if (!(inb(dev->io) & 1))
res = 0;- debug_print((KERN_DEBUG "signal: %d\n", res));
- return res;
-}
-/* set frequency and unmute card */ -static int fmr2_setfreq(struct fmr2 *dev) -{
- unsigned long freq = dev->curfreq;
- fmr2_mute(dev->io);
- /* 0x42 for mono output
* 0x102 forward scanning* 0x182 scansione avanti*/- outbits(9, 0x2, 3, dev->io);
- outbits(16, RSF16_ENCODE(freq), 2, dev->io);
- fmr2_unmute(dev->io);
- /* wait 0.11 sec */
- msleep(110);
- /* NOTE if mute this stop radio
you must set freq on unmute */- dev->stereo = fmr2_stereo_mode(dev->io);
- return 0;
-}
-/* !!! not tested, in my card this does't work !!! */ -static int fmr2_setvolume(struct fmr2 *dev) -{
- int vol[16] = { 0x021, 0x084, 0x090, 0x104,
0x110, 0x204, 0x210, 0x402,0x404, 0x408, 0x410, 0x801,0x802, 0x804, 0x808, 0x810 };- int i, a;
- int n = vol[dev->curvol & 0x0f];
- if (dev->card_type != 11)
return 1;- for (i = 12; --i >= 0; ) {
a = ((n >> i) & 1) << 6; /* if (a==0) a = 0; else a = 0x40; */outb(a | 4, dev->io);wait(4, dev->io);outb(a | 0x24, dev->io);wait(4, dev->io);outb(a | 4, dev->io);wait(4, dev->io);- }
- for (i = 6; --i >= 0; ) {
a = ((0x18 >> i) & 1) << 6;outb(a | 4, dev->io);wait(4, dev->io);outb(a | 0x24, dev->io);wait(4, dev->io);outb(a | 4, dev->io);wait(4, dev->io);- }
- wait(4, dev->io);
- outb(0x14, dev->io);
- return 0;
-}
-static int vidioc_querycap(struct file *file, void *priv,
struct v4l2_capability *v)-{
- strlcpy(v->driver, "radio-sf16fmr2", sizeof(v->driver));
- strlcpy(v->card, "SF16-FMR2 radio", sizeof(v->card));
- strlcpy(v->bus_info, "ISA", sizeof(v->bus_info));
- v->version = RADIO_VERSION;
- v->capabilities = V4L2_CAP_TUNER | V4L2_CAP_RADIO;
- return 0;
-} +/* TEA575x tuner pins */ +#define STR_DATA (1 << 0) +#define STR_CLK (1 << 1) +#define STR_WREN (1 << 2) +#define STR_MOST (1 << 3) +/* PT2254A/TC9154A volume control pins */ +#define PT_ST (1 << 4) +#define PT_CK (1 << 5) +#define PT_DATA (1 << 6) +/* volume control presence pin */ +#define FMR2_HASVOL (1 << 7)
-static int vidioc_g_tuner(struct file *file, void *priv,
struct v4l2_tuner *v)+static void fmr2_tea575x_set_pins(struct snd_tea575x *tea, u8 pins) {
- struct fmr2 *fmr2 = video_drvdata(file);
- if (v->index > 0)
return -EINVAL;
- struct fmr2 *fmr2 = tea->private_data;
- u8 bits = 0;
- strlcpy(v->name, "FM", sizeof(v->name));
- v->type = V4L2_TUNER_RADIO;
- v->rangelow = RSF16_MINFREQ;
- v->rangehigh = RSF16_MAXFREQ;
- v->rxsubchans = fmr2->stereo ? V4L2_TUNER_SUB_STEREO :
V4L2_TUNER_SUB_MONO;- v->capability = V4L2_TUNER_CAP_STEREO | V4L2_TUNER_CAP_LOW;
- v->audmode = V4L2_TUNER_MODE_STEREO;
- mutex_lock(&fmr2->lock);
- v->signal = fmr2_getsigstr(fmr2);
- mutex_unlock(&fmr2->lock);
- return 0;
-}
- bits |= (pins & TEA575X_DATA) ? STR_DATA : 0;
- bits |= (pins & TEA575X_CLK) ? STR_CLK : 0;
- /* WRITE_ENABLE is inverted, DATA must be high during read */
- bits |= (pins & TEA575X_WREN) ? 0 : STR_WREN | STR_DATA;
-static int vidioc_s_tuner(struct file *file, void *priv,
struct v4l2_tuner *v)-{
- return v->index ? -EINVAL : 0;
- outb(bits, fmr2->io);
}
-static int vidioc_s_frequency(struct file *file, void *priv,
struct v4l2_frequency *f)+static u8 fmr2_tea575x_get_pins(struct snd_tea575x *tea) {
- struct fmr2 *fmr2 = video_drvdata(file);
- struct fmr2 *fmr2 = tea->private_data;
- u8 bits = inb(fmr2->io);
- if (f->tuner != 0 || f->type != V4L2_TUNER_RADIO)
return -EINVAL;- if (f->frequency < RSF16_MINFREQ ||
f->frequency > RSF16_MAXFREQ)return -EINVAL;- /* rounding in steps of 200 to match the freq
that will be used */- fmr2->curfreq = (f->frequency / 200) * 200;
- /* set card freq (if not muted) */
- if (fmr2->curvol && !fmr2->mute) {
mutex_lock(&fmr2->lock);fmr2_setfreq(fmr2);mutex_unlock(&fmr2->lock);- }
- return 0;
- return (bits & STR_DATA) ? TEA575X_DATA : 0 |
(bits & STR_MOST) ? TEA575X_MOST : 0;}
-static int vidioc_g_frequency(struct file *file, void *priv,
struct v4l2_frequency *f)+static void fmr2_tea575x_set_direction(struct snd_tea575x *tea, bool output) {
- struct fmr2 *fmr2 = video_drvdata(file);
- if (f->tuner != 0)
return -EINVAL;- f->type = V4L2_TUNER_RADIO;
- f->frequency = fmr2->curfreq;
- return 0;
}
-static int vidioc_queryctrl(struct file *file, void *priv,
struct v4l2_queryctrl *qc)-{
- struct fmr2 *fmr2 = video_drvdata(file);
+static struct snd_tea575x_ops fmr2_tea_ops = {
- .set_pins = fmr2_tea575x_set_pins,
- .get_pins = fmr2_tea575x_get_pins,
- .set_direction = fmr2_tea575x_set_direction,
+};
- switch (qc->id) {
- case V4L2_CID_AUDIO_MUTE:
return v4l2_ctrl_query_fill(qc, 0, 1, 1, 1);- case V4L2_CID_AUDIO_VOLUME:
/* Only card_type == 11 implements volume */if (fmr2->card_type == 11)return v4l2_ctrl_query_fill(qc, 0, 15, 1, 0);return v4l2_ctrl_query_fill(qc, 0, 1, 1, 0);- }
- return -EINVAL;
-} +/* TC9154A/PT2254A volume control */
-static int vidioc_g_ctrl(struct file *file, void *priv,
struct v4l2_control *ctrl)-{
- struct fmr2 *fmr2 = video_drvdata(file);
+/* 18-bit shift register bit definitions */ +#define TC9154A_ATT_MAJ_0DB (1 << 0) +#define TC9154A_ATT_MAJ_10DB (1 << 1) +#define TC9154A_ATT_MAJ_20DB (1 << 2) +#define TC9154A_ATT_MAJ_30DB (1 << 3) +#define TC9154A_ATT_MAJ_40DB (1 << 4) +#define TC9154A_ATT_MAJ_50DB (1 << 5) +#define TC9154A_ATT_MAJ_60DB (1 << 6)
+#define TC9154A_ATT_MIN_0DB (1 << 7) +#define TC9154A_ATT_MIN_2DB (1 << 8) +#define TC9154A_ATT_MIN_4DB (1 << 9) +#define TC9154A_ATT_MIN_6DB (1 << 10) +#define TC9154A_ATT_MIN_8DB (1 << 11) +/* bit 12 is ignored */ +#define TC9154A_CHANNEL_LEFT (1 << 13) +#define TC9154A_CHANNEL_RIGHT (1 << 14) +/* bits 15, 16, 17 must be 0 */
+#define TC9154A_ATT_MAJ(x) (1 << x) +#define TC9154A_ATT_MIN(x) (1 << (7 + x))
+static void tc9154a_set_pins(struct fmr2 *fmr2, u8 pins) +{
- if (!fmr2->tea.mute)
pins |= STR_WREN;- outb(pins, fmr2->io);
+}
+static void tc9154a_set_attenuation(struct fmr2 *fmr2, int att, u32 channel) +{
- int i;
- u32 reg;
- u8 bit;
- reg = TC9154A_ATT_MAJ(att / 10) | TC9154A_ATT_MIN((att % 10) / 2);
- reg |= channel;
- /* write 18-bit shift register, LSB first */
- for (i = 0; i < 18; i++) {
bit = reg & (1 << i) ? PT_DATA : 0;tc9154a_set_pins(fmr2, bit);udelay(5);tc9154a_set_pins(fmr2, bit | PT_CK);udelay(5);tc9154a_set_pins(fmr2, bit);- }
- /* latch register data */
- udelay(5);
- tc9154a_set_pins(fmr2, PT_ST);
- udelay(5);
- tc9154a_set_pins(fmr2, 0);
+}
+static int fmr2_s_ctrl(struct v4l2_ctrl *ctrl) +{
struct snd_tea575x *tea = container_of(ctrl->handler, struct snd_tea575x, ctrl_handler);
struct fmr2 *fmr2 = tea->private_data;
int volume, balance, left, right;
switch (ctrl->id) {
- case V4L2_CID_AUDIO_MUTE:
ctrl->value = fmr2->mute;return 0;ctrl->value = fmr2->curvol;return 0;- }
- return -EINVAL;
-}
-static int vidioc_s_ctrl(struct file *file, void *priv,
struct v4l2_control *ctrl)-{
- struct fmr2 *fmr2 = video_drvdata(file);
- switch (ctrl->id) {
- case V4L2_CID_AUDIO_MUTE:
fmr2->mute = ctrl->value;
volume = ctrl->val;balance = fmr2->balance->cur.val;
- case V4L2_CID_AUDIO_VOLUME:
fmr2->curvol = ctrl->value;
- case V4L2_CID_AUDIO_BALANCE:
balance = ctrl->val;volume = fmr2->volume->cur.val;-#ifdef DEBUG
- if (fmr2->curvol && !fmr2->mute)
printk(KERN_DEBUG "unmute\n");- else
printk(KERN_DEBUG "mute\n");-#endif
- mutex_lock(&fmr2->lock);
- if (fmr2->curvol && !fmr2->mute) {
fmr2_setvolume(fmr2);/* Set frequency and unmute card */fmr2_setfreq(fmr2);- } else
fmr2_mute(fmr2->io);- mutex_unlock(&fmr2->lock);
- return 0;
-}
- left = right = volume;
- if (balance < 0)
right = max(0, right + balance);- if (balance > 0)
left = max(0, left - balance);-static int vidioc_g_input(struct file *filp, void *priv, unsigned int *i) -{
- *i = 0;
- return 0;
-}
-static int vidioc_s_input(struct file *filp, void *priv, unsigned int i) -{
- return i ? -EINVAL : 0;
-}
- tc9154a_set_attenuation(fmr2, abs(left - 68), TC9154A_CHANNEL_LEFT);
- tc9154a_set_attenuation(fmr2, abs(right - 68), TC9154A_CHANNEL_RIGHT);
-static int vidioc_g_audio(struct file *file, void *priv,
struct v4l2_audio *a)-{
- a->index = 0;
- strlcpy(a->name, "Radio", sizeof(a->name));
- a->capability = V4L2_AUDCAP_STEREO; return 0;
}
-static int vidioc_s_audio(struct file *file, void *priv,
struct v4l2_audio *a)+static const struct v4l2_ctrl_ops fmr2_ctrl_ops = {
- .s_ctrl = fmr2_s_ctrl,
+};
+static int fmr2_tea_ext_init(struct snd_tea575x *tea) {
- return a->index ? -EINVAL : 0;
-}
- struct fmr2 *fmr2 = tea->private_data;
-static const struct v4l2_file_operations fmr2_fops = {
- .owner = THIS_MODULE,
- .unlocked_ioctl = video_ioctl2,
-};
- if (inb(fmr2->io) & FMR2_HASVOL) {
fmr2->volume = v4l2_ctrl_new_std(&tea->ctrl_handler, &fmr2_ctrl_ops, V4L2_CID_AUDIO_VOLUME, 0, 68, 2, 56);fmr2->balance = v4l2_ctrl_new_std(&tea->ctrl_handler, &fmr2_ctrl_ops, V4L2_CID_AUDIO_BALANCE, -68, 68, 2, 0);if (tea->ctrl_handler.error) {printk(KERN_ERR "radio-sf16fmr2: can't initialize controls\n");return tea->ctrl_handler.error;}- }
-static const struct v4l2_ioctl_ops fmr2_ioctl_ops = {
- .vidioc_querycap = vidioc_querycap,
- .vidioc_g_tuner = vidioc_g_tuner,
- .vidioc_s_tuner = vidioc_s_tuner,
- .vidioc_g_audio = vidioc_g_audio,
- .vidioc_s_audio = vidioc_s_audio,
- .vidioc_g_input = vidioc_g_input,
- .vidioc_s_input = vidioc_s_input,
- .vidioc_g_frequency = vidioc_g_frequency,
- .vidioc_s_frequency = vidioc_s_frequency,
- .vidioc_queryctrl = vidioc_queryctrl,
- .vidioc_g_ctrl = vidioc_g_ctrl,
- .vidioc_s_ctrl = vidioc_s_ctrl,
-};
- return 0;
+}
static int __init fmr2_init(void) { struct fmr2 *fmr2 = &fmr2_card;
struct v4l2_device *v4l2_dev = &fmr2->v4l2_dev;
int res;
strlcpy(v4l2_dev->name, "sf16fmr2", sizeof(v4l2_dev->name));
fmr2->io = io;
fmr2->stereo = 1;
mutex_init(&fmr2->lock);
- fmr2->io = FMR2_PORT;
- if (!request_region(fmr2->io, 2, "sf16fmr2")) {
v4l2_err(v4l2_dev, "request_region failed!\n");
- if (!request_region(fmr2->io, 2, "SF16-FMR2")) {
printk(KERN_ERR "radio-sf16fmr2: I/O port 0x%x already in use\n", fmr2->io);
- res = v4l2_device_register(NULL, v4l2_dev);
- if (res < 0) {
release_region(fmr2->io, 2);v4l2_err(v4l2_dev, "Could not register v4l2_device\n");return res;- }
- strlcpy(fmr2->vdev.name, v4l2_dev->name, sizeof(fmr2->vdev.name));
- fmr2->vdev.v4l2_dev = v4l2_dev;
- fmr2->vdev.fops = &fmr2_fops;
- fmr2->vdev.ioctl_ops = &fmr2_ioctl_ops;
- fmr2->vdev.release = video_device_release_empty;
- video_set_drvdata(&fmr2->vdev, fmr2);
- /* mute card - prevents noisy bootups */
- fmr2_mute(fmr2->io);
- fmr2_product_info(fmr2);
- fmr2->tea.private_data = fmr2;
- fmr2->tea.ops = &fmr2_tea_ops;
- fmr2->tea.ext_init = fmr2_tea_ext_init;
- strlcpy(fmr2->tea.card, "SF16-FMR2", sizeof(fmr2->tea.card));
- strcpy(fmr2->tea.bus_info, "ISA");
- if (video_register_device(&fmr2->vdev, VFL_TYPE_RADIO, radio_nr) < 0) {
v4l2_device_unregister(v4l2_dev);
- if (snd_tea575x_init(&fmr2->tea)) {
printk(KERN_ERR "radio-sf16fmr2: Unable to detect TEA575x tuner\n");
return -EINVAL;
return -ENODEV;
- v4l2_info(v4l2_dev, "SF16FMR2 radio card driver at 0x%x.\n", fmr2->io);
- debug_print((KERN_DEBUG "card_type %d\n", fmr2->card_type));
- printk(KERN_INFO "radio-sf16fmr2: SF16-FMR2 radio card at 0x%x.\n", fmr2->io); return 0;
}
@@ -443,22 +211,9 @@ static void __exit fmr2_exit(void) { struct fmr2 *fmr2 = &fmr2_card;
- video_unregister_device(&fmr2->vdev);
- v4l2_device_unregister(&fmr2->v4l2_dev);
- snd_tea575x_exit(&fmr2->tea); release_region(fmr2->io, 2);
}
module_init(fmr2_init); module_exit(fmr2_exit);
-#ifndef MODULE
-static int __init fmr2_setup_io(char *str) -{
- get_option(&str, &io);
- return 1;
-}
-__setup("sf16fmr2=", fmr2_setup_io);
-#endif
Alsa-devel mailing list Alsa-devel@alsa-project.org http://mailman.alsa-project.org/mailman/listinfo/alsa-devel
-- To unsubscribe from this list: send the line "unsubscribe linux-media" in the body of a message to majordomo@vger.kernel.org More majordomo info at http://vger.kernel.org/majordomo-info.html
On Wednesday 01 June 2011 17:45:31 Mauro Carvalho Chehab wrote:
Em 26-05-2011 04:45, Takashi Iwai escreveu:
At Wed, 25 May 2011 21:21:30 -0300,
Mauro Carvalho Chehab wrote:
Em 23-05-2011 09:17, Ondrej Zary escreveu:
Convert radio-sf16fmr2 to use generic TEA575x implementation. Most of the driver code goes away as SF16-FMR2 is basically just a TEA5757 tuner connected to ISA bus. The card can optionally be equipped with PT2254A volume control (equivalent of TC9154AP) - the volume setting is completely reworked (with balance control added) and tested.
Ondrej,
As your first series went via alsa tree, and we are close to the end of the merge window, and assuming that Takashi didn't apply those patches on his tree, as you're re-sending it, I think that the better is to wait for the end of the merge window, in order to allow us to sync our development tree with 2.6.40-rc1, and then review and apply it on the top of it.
Yeah, I didn't pick it up as the patches are rather V4L-side changes (although tea575x.c is in sound sub-directory). And I agree with Mauro - let's merge it after rc1, so that we stand on the same ground. This sort of cross-tree change is better done at the fixed point than in flux like during merge window.
Hmm.. I tried to apply it after -rc1. It didn't apply:
Applying patch patches/lmml_808552_v5_resend_radio_sf16fmr2_convert_to_generic_tea575x_int erface.patch patching file sound/pci/Kconfig patching file drivers/media/radio/radio-sf16fmr2.c Hunk #1 FAILED at 1. 1 out of 2 hunks FAILED -- rejects in file drivers/media/radio/radio-sf16fmr2.c Patch patches/lmml_808552_v5_resend_radio_sf16fmr2_convert_to_generic_tea575x_int erface.patch does not apply (enforce with -f)
Is there any missing patches, or is it just due to some other changes from the alsa tree?
It fails because of a stupid typo comment fix: -/* !!! not tested, in my card this does't work !!! */ +/* !!! not tested, in my card this doesn't work !!! */
Convert radio-sf16fmr2 to use generic TEA575x implementation. Most of the driver code goes away as SF16-FMR2 is basically just a TEA5757 tuner connected to ISA bus. The card can optionally be equipped with PT2254A volume control (equivalent of TC9154AP) - the volume setting is completely reworked (with balance control added) and tested.
Signed-off-by: Ondrej Zary linux@rainbow-software.org
--- a/sound/pci/Kconfig 2011-05-15 18:50:18.000000000 +0200 +++ b/sound/pci/Kconfig 2011-05-17 23:35:30.000000000 +0200 @@ -565,8 +565,8 @@ config SND_FM801_TEA575X_BOOL
config SND_TEA575X tristate - depends on SND_FM801_TEA575X_BOOL || SND_ES1968_RADIO - default SND_FM801 || SND_ES1968 + depends on SND_FM801_TEA575X_BOOL || SND_ES1968_RADIO || RADIO_SF16FMR2 + default SND_FM801 || SND_ES1968 || RADIO_SF16FMR2
source "sound/pci/hda/Kconfig"
--- a/drivers/media/radio/radio-sf16fmr2.c 2011-04-06 03:30:43.000000000 +0200 +++ b/drivers/media/radio/radio-sf16fmr2.c 2011-05-19 17:56:08.000000000 +0200 @@ -1,441 +1,209 @@ -/* SF16FMR2 radio driver for Linux radio support - * heavily based on fmi driver... - * (c) 2000-2002 Ziglio Frediano, freddy77@angelfire.com +/* SF16-FMR2 radio driver for Linux + * Copyright (c) 2011 Ondrej Zary * - * Notes on the hardware - * - * Frequency control is done digitally -- ie out(port,encodefreq(95.8)); - * No volume control - only mute/unmute - you have to use line volume - * - * For read stereo/mono you must wait 0.1 sec after set frequency and - * card unmuted so I set frequency on unmute - * Signal handling seem to work only on autoscanning (not implemented) - * - * Converted to V4L2 API by Mauro Carvalho Chehab mchehab@infradead.org + * Original driver was (c) 2000-2002 Ziglio Frediano, freddy77@angelfire.com + * but almost nothing remained here after conversion to generic TEA575x + * implementation */
+#include <linux/delay.h> #include <linux/module.h> /* Modules */ #include <linux/init.h> /* Initdata */ #include <linux/ioport.h> /* request_region */ -#include <linux/delay.h> /* udelay */ -#include <linux/videodev2.h> /* kernel radio structs */ -#include <linux/mutex.h> -#include <linux/version.h> /* for KERNEL_VERSION MACRO */ #include <linux/io.h> /* outb, outb_p */ -#include <media/v4l2-device.h> -#include <media/v4l2-ioctl.h> +#include <sound/tea575x-tuner.h>
-MODULE_AUTHOR("Ziglio Frediano, freddy77@angelfire.com"); -MODULE_DESCRIPTION("A driver for the SF16FMR2 radio."); +MODULE_AUTHOR("Ondrej Zary"); +MODULE_DESCRIPTION("MediaForte SF16-FMR2 FM radio card driver"); MODULE_LICENSE("GPL");
-static int io = 0x384; -static int radio_nr = -1; - -module_param(io, int, 0); -MODULE_PARM_DESC(io, "I/O address of the SF16FMR2 card (should be 0x384, if do not work try 0x284)"); -module_param(radio_nr, int, 0); - -#define RADIO_VERSION KERNEL_VERSION(0,0,2) - -#define AUD_VOL_INDEX 1 - -#undef DEBUG -//#define DEBUG 1 - -#ifdef DEBUG -# define debug_print(s) printk s -#else -# define debug_print(s) -#endif - -/* this should be static vars for module size */ -struct fmr2 -{ - struct v4l2_device v4l2_dev; - struct video_device vdev; - struct mutex lock; +struct fmr2 { int io; - int curvol; /* 0-15 */ - int mute; - int stereo; /* card is producing stereo audio */ - unsigned long curfreq; /* freq in kHz */ - int card_type; + struct snd_tea575x tea; + struct v4l2_ctrl *volume; + struct v4l2_ctrl *balance; };
+/* the port is hardwired so no need to support multiple cards */ +#define FMR2_PORT 0x384 static struct fmr2 fmr2_card;
-/* hw precision is 12.5 kHz - * It is only useful to give freq in interval of 200 (=0.0125Mhz), - * other bits will be truncated - */ -#define RSF16_ENCODE(x) ((x) / 200 + 856) -#define RSF16_MINFREQ (87 * 16000) -#define RSF16_MAXFREQ (108 * 16000) - -static inline void wait(int n, int io) -{ - for (; n; --n) - inb(io); -} - -static void outbits(int bits, unsigned int data, int nWait, int io) -{ - int bit; - - for (; --bits >= 0;) { - bit = (data >> bits) & 1; - outb(bit, io); - wait(nWait, io); - outb(bit | 2, io); - wait(nWait, io); - outb(bit, io); - wait(nWait, io); - } -} - -static inline void fmr2_mute(int io) -{ - outb(0x00, io); - wait(4, io); -} - -static inline void fmr2_unmute(int io) -{ - outb(0x04, io); - wait(4, io); -} - -static inline int fmr2_stereo_mode(int io) -{ - int n = inb(io); - - outb(6, io); - inb(io); - n = ((n >> 3) & 1) ^ 1; - debug_print((KERN_DEBUG "stereo: %d\n", n)); - return n; -} - -static int fmr2_product_info(struct fmr2 *dev) -{ - int n = inb(dev->io); - - n &= 0xC1; - if (n == 0) { - /* this should support volume set */ - dev->card_type = 12; - return 0; - } - /* not volume (mine is 11) */ - dev->card_type = (n == 128) ? 11 : 0; - return n; -} - -static inline int fmr2_getsigstr(struct fmr2 *dev) -{ - /* !!! works only if scanning freq */ - int res = 0xffff; - - outb(5, dev->io); - wait(4, dev->io); - if (!(inb(dev->io) & 1)) - res = 0; - debug_print((KERN_DEBUG "signal: %d\n", res)); - return res; -} - -/* set frequency and unmute card */ -static int fmr2_setfreq(struct fmr2 *dev) -{ - unsigned long freq = dev->curfreq; - - fmr2_mute(dev->io); - - /* 0x42 for mono output - * 0x102 forward scanning - * 0x182 scansione avanti - */ - outbits(9, 0x2, 3, dev->io); - outbits(16, RSF16_ENCODE(freq), 2, dev->io); - - fmr2_unmute(dev->io); - - /* wait 0.11 sec */ - msleep(110); - - /* NOTE if mute this stop radio - you must set freq on unmute */ - dev->stereo = fmr2_stereo_mode(dev->io); - return 0; -} - -/* !!! not tested, in my card this doesn't work !!! */ -static int fmr2_setvolume(struct fmr2 *dev) -{ - int vol[16] = { 0x021, 0x084, 0x090, 0x104, - 0x110, 0x204, 0x210, 0x402, - 0x404, 0x408, 0x410, 0x801, - 0x802, 0x804, 0x808, 0x810 }; - int i, a; - int n = vol[dev->curvol & 0x0f]; - - if (dev->card_type != 11) - return 1; - - for (i = 12; --i >= 0; ) { - a = ((n >> i) & 1) << 6; /* if (a==0) a = 0; else a = 0x40; */ - outb(a | 4, dev->io); - wait(4, dev->io); - outb(a | 0x24, dev->io); - wait(4, dev->io); - outb(a | 4, dev->io); - wait(4, dev->io); - } - for (i = 6; --i >= 0; ) { - a = ((0x18 >> i) & 1) << 6; - outb(a | 4, dev->io); - wait(4, dev->io); - outb(a | 0x24, dev->io); - wait(4, dev->io); - outb(a | 4, dev->io); - wait(4, dev->io); - } - wait(4, dev->io); - outb(0x14, dev->io); - return 0; -} - -static int vidioc_querycap(struct file *file, void *priv, - struct v4l2_capability *v) -{ - strlcpy(v->driver, "radio-sf16fmr2", sizeof(v->driver)); - strlcpy(v->card, "SF16-FMR2 radio", sizeof(v->card)); - strlcpy(v->bus_info, "ISA", sizeof(v->bus_info)); - v->version = RADIO_VERSION; - v->capabilities = V4L2_CAP_TUNER | V4L2_CAP_RADIO; - return 0; -} +/* TEA575x tuner pins */ +#define STR_DATA (1 << 0) +#define STR_CLK (1 << 1) +#define STR_WREN (1 << 2) +#define STR_MOST (1 << 3) +/* PT2254A/TC9154A volume control pins */ +#define PT_ST (1 << 4) +#define PT_CK (1 << 5) +#define PT_DATA (1 << 6) +/* volume control presence pin */ +#define FMR2_HASVOL (1 << 7)
-static int vidioc_g_tuner(struct file *file, void *priv, - struct v4l2_tuner *v) +static void fmr2_tea575x_set_pins(struct snd_tea575x *tea, u8 pins) { - struct fmr2 *fmr2 = video_drvdata(file); - - if (v->index > 0) - return -EINVAL; + struct fmr2 *fmr2 = tea->private_data; + u8 bits = 0;
- strlcpy(v->name, "FM", sizeof(v->name)); - v->type = V4L2_TUNER_RADIO; - - v->rangelow = RSF16_MINFREQ; - v->rangehigh = RSF16_MAXFREQ; - v->rxsubchans = fmr2->stereo ? V4L2_TUNER_SUB_STEREO : - V4L2_TUNER_SUB_MONO; - v->capability = V4L2_TUNER_CAP_STEREO | V4L2_TUNER_CAP_LOW; - v->audmode = V4L2_TUNER_MODE_STEREO; - mutex_lock(&fmr2->lock); - v->signal = fmr2_getsigstr(fmr2); - mutex_unlock(&fmr2->lock); - return 0; -} + bits |= (pins & TEA575X_DATA) ? STR_DATA : 0; + bits |= (pins & TEA575X_CLK) ? STR_CLK : 0; + /* WRITE_ENABLE is inverted, DATA must be high during read */ + bits |= (pins & TEA575X_WREN) ? 0 : STR_WREN | STR_DATA;
-static int vidioc_s_tuner(struct file *file, void *priv, - struct v4l2_tuner *v) -{ - return v->index ? -EINVAL : 0; + outb(bits, fmr2->io); }
-static int vidioc_s_frequency(struct file *file, void *priv, - struct v4l2_frequency *f) +static u8 fmr2_tea575x_get_pins(struct snd_tea575x *tea) { - struct fmr2 *fmr2 = video_drvdata(file); + struct fmr2 *fmr2 = tea->private_data; + u8 bits = inb(fmr2->io);
- if (f->tuner != 0 || f->type != V4L2_TUNER_RADIO) - return -EINVAL; - if (f->frequency < RSF16_MINFREQ || - f->frequency > RSF16_MAXFREQ) - return -EINVAL; - /* rounding in steps of 200 to match the freq - that will be used */ - fmr2->curfreq = (f->frequency / 200) * 200; - - /* set card freq (if not muted) */ - if (fmr2->curvol && !fmr2->mute) { - mutex_lock(&fmr2->lock); - fmr2_setfreq(fmr2); - mutex_unlock(&fmr2->lock); - } - return 0; + return (bits & STR_DATA) ? TEA575X_DATA : 0 | + (bits & STR_MOST) ? TEA575X_MOST : 0; }
-static int vidioc_g_frequency(struct file *file, void *priv, - struct v4l2_frequency *f) +static void fmr2_tea575x_set_direction(struct snd_tea575x *tea, bool output) { - struct fmr2 *fmr2 = video_drvdata(file); - - if (f->tuner != 0) - return -EINVAL; - f->type = V4L2_TUNER_RADIO; - f->frequency = fmr2->curfreq; - return 0; }
-static int vidioc_queryctrl(struct file *file, void *priv, - struct v4l2_queryctrl *qc) -{ - struct fmr2 *fmr2 = video_drvdata(file); +static struct snd_tea575x_ops fmr2_tea_ops = { + .set_pins = fmr2_tea575x_set_pins, + .get_pins = fmr2_tea575x_get_pins, + .set_direction = fmr2_tea575x_set_direction, +};
- switch (qc->id) { - case V4L2_CID_AUDIO_MUTE: - return v4l2_ctrl_query_fill(qc, 0, 1, 1, 1); - case V4L2_CID_AUDIO_VOLUME: - /* Only card_type == 11 implements volume */ - if (fmr2->card_type == 11) - return v4l2_ctrl_query_fill(qc, 0, 15, 1, 0); - return v4l2_ctrl_query_fill(qc, 0, 1, 1, 0); - } - return -EINVAL; -} +/* TC9154A/PT2254A volume control */
-static int vidioc_g_ctrl(struct file *file, void *priv, - struct v4l2_control *ctrl) -{ - struct fmr2 *fmr2 = video_drvdata(file); +/* 18-bit shift register bit definitions */ +#define TC9154A_ATT_MAJ_0DB (1 << 0) +#define TC9154A_ATT_MAJ_10DB (1 << 1) +#define TC9154A_ATT_MAJ_20DB (1 << 2) +#define TC9154A_ATT_MAJ_30DB (1 << 3) +#define TC9154A_ATT_MAJ_40DB (1 << 4) +#define TC9154A_ATT_MAJ_50DB (1 << 5) +#define TC9154A_ATT_MAJ_60DB (1 << 6) + +#define TC9154A_ATT_MIN_0DB (1 << 7) +#define TC9154A_ATT_MIN_2DB (1 << 8) +#define TC9154A_ATT_MIN_4DB (1 << 9) +#define TC9154A_ATT_MIN_6DB (1 << 10) +#define TC9154A_ATT_MIN_8DB (1 << 11) +/* bit 12 is ignored */ +#define TC9154A_CHANNEL_LEFT (1 << 13) +#define TC9154A_CHANNEL_RIGHT (1 << 14) +/* bits 15, 16, 17 must be 0 */ + +#define TC9154A_ATT_MAJ(x) (1 << x) +#define TC9154A_ATT_MIN(x) (1 << (7 + x)) + +static void tc9154a_set_pins(struct fmr2 *fmr2, u8 pins) +{ + if (!fmr2->tea.mute) + pins |= STR_WREN; + + outb(pins, fmr2->io); +} + +static void tc9154a_set_attenuation(struct fmr2 *fmr2, int att, u32 channel) +{ + int i; + u32 reg; + u8 bit; + + reg = TC9154A_ATT_MAJ(att / 10) | TC9154A_ATT_MIN((att % 10) / 2); + reg |= channel; + /* write 18-bit shift register, LSB first */ + for (i = 0; i < 18; i++) { + bit = reg & (1 << i) ? PT_DATA : 0; + tc9154a_set_pins(fmr2, bit); + udelay(5); + tc9154a_set_pins(fmr2, bit | PT_CK); + udelay(5); + tc9154a_set_pins(fmr2, bit); + } + + /* latch register data */ + udelay(5); + tc9154a_set_pins(fmr2, PT_ST); + udelay(5); + tc9154a_set_pins(fmr2, 0); +} + +static int fmr2_s_ctrl(struct v4l2_ctrl *ctrl) +{ + struct snd_tea575x *tea = container_of(ctrl->handler, struct snd_tea575x, ctrl_handler); + struct fmr2 *fmr2 = tea->private_data; + int volume, balance, left, right;
switch (ctrl->id) { - case V4L2_CID_AUDIO_MUTE: - ctrl->value = fmr2->mute; - return 0; case V4L2_CID_AUDIO_VOLUME: - ctrl->value = fmr2->curvol; - return 0; - } - return -EINVAL; -} - -static int vidioc_s_ctrl(struct file *file, void *priv, - struct v4l2_control *ctrl) -{ - struct fmr2 *fmr2 = video_drvdata(file); - - switch (ctrl->id) { - case V4L2_CID_AUDIO_MUTE: - fmr2->mute = ctrl->value; + volume = ctrl->val; + balance = fmr2->balance->cur.val; break; - case V4L2_CID_AUDIO_VOLUME: - fmr2->curvol = ctrl->value; + case V4L2_CID_AUDIO_BALANCE: + balance = ctrl->val; + volume = fmr2->volume->cur.val; break; default: return -EINVAL; }
-#ifdef DEBUG - if (fmr2->curvol && !fmr2->mute) - printk(KERN_DEBUG "unmute\n"); - else - printk(KERN_DEBUG "mute\n"); -#endif - - mutex_lock(&fmr2->lock); - if (fmr2->curvol && !fmr2->mute) { - fmr2_setvolume(fmr2); - /* Set frequency and unmute card */ - fmr2_setfreq(fmr2); - } else - fmr2_mute(fmr2->io); - mutex_unlock(&fmr2->lock); - return 0; -} + left = right = volume; + if (balance < 0) + right = max(0, right + balance); + if (balance > 0) + left = max(0, left - balance);
-static int vidioc_g_input(struct file *filp, void *priv, unsigned int *i) -{ - *i = 0; - return 0; -} - -static int vidioc_s_input(struct file *filp, void *priv, unsigned int i) -{ - return i ? -EINVAL : 0; -} + tc9154a_set_attenuation(fmr2, abs(left - 68), TC9154A_CHANNEL_LEFT); + tc9154a_set_attenuation(fmr2, abs(right - 68), TC9154A_CHANNEL_RIGHT);
-static int vidioc_g_audio(struct file *file, void *priv, - struct v4l2_audio *a) -{ - a->index = 0; - strlcpy(a->name, "Radio", sizeof(a->name)); - a->capability = V4L2_AUDCAP_STEREO; return 0; }
-static int vidioc_s_audio(struct file *file, void *priv, - struct v4l2_audio *a) +static const struct v4l2_ctrl_ops fmr2_ctrl_ops = { + .s_ctrl = fmr2_s_ctrl, +}; + +static int fmr2_tea_ext_init(struct snd_tea575x *tea) { - return a->index ? -EINVAL : 0; -} + struct fmr2 *fmr2 = tea->private_data;
-static const struct v4l2_file_operations fmr2_fops = { - .owner = THIS_MODULE, - .unlocked_ioctl = video_ioctl2, -}; + if (inb(fmr2->io) & FMR2_HASVOL) { + fmr2->volume = v4l2_ctrl_new_std(&tea->ctrl_handler, &fmr2_ctrl_ops, V4L2_CID_AUDIO_VOLUME, 0, 68, 2, 56); + fmr2->balance = v4l2_ctrl_new_std(&tea->ctrl_handler, &fmr2_ctrl_ops, V4L2_CID_AUDIO_BALANCE, -68, 68, 2, 0); + if (tea->ctrl_handler.error) { + printk(KERN_ERR "radio-sf16fmr2: can't initialize contrls\n"); + return tea->ctrl_handler.error; + } + }
-static const struct v4l2_ioctl_ops fmr2_ioctl_ops = { - .vidioc_querycap = vidioc_querycap, - .vidioc_g_tuner = vidioc_g_tuner, - .vidioc_s_tuner = vidioc_s_tuner, - .vidioc_g_audio = vidioc_g_audio, - .vidioc_s_audio = vidioc_s_audio, - .vidioc_g_input = vidioc_g_input, - .vidioc_s_input = vidioc_s_input, - .vidioc_g_frequency = vidioc_g_frequency, - .vidioc_s_frequency = vidioc_s_frequency, - .vidioc_queryctrl = vidioc_queryctrl, - .vidioc_g_ctrl = vidioc_g_ctrl, - .vidioc_s_ctrl = vidioc_s_ctrl, -}; + return 0; +}
static int __init fmr2_init(void) { struct fmr2 *fmr2 = &fmr2_card; - struct v4l2_device *v4l2_dev = &fmr2->v4l2_dev; - int res;
- strlcpy(v4l2_dev->name, "sf16fmr2", sizeof(v4l2_dev->name)); - fmr2->io = io; - fmr2->stereo = 1; - mutex_init(&fmr2->lock); + fmr2->io = FMR2_PORT;
- if (!request_region(fmr2->io, 2, "sf16fmr2")) { - v4l2_err(v4l2_dev, "request_region failed!\n"); + if (!request_region(fmr2->io, 2, "SF16-FMR2")) { + printk(KERN_ERR "radio-sf16fmr2: I/O port 0x%x already in use\n", fmr2->io); return -EBUSY; }
- res = v4l2_device_register(NULL, v4l2_dev); - if (res < 0) { - release_region(fmr2->io, 2); - v4l2_err(v4l2_dev, "Could not register v4l2_device\n"); - return res; - } - - strlcpy(fmr2->vdev.name, v4l2_dev->name, sizeof(fmr2->vdev.name)); - fmr2->vdev.v4l2_dev = v4l2_dev; - fmr2->vdev.fops = &fmr2_fops; - fmr2->vdev.ioctl_ops = &fmr2_ioctl_ops; - fmr2->vdev.release = video_device_release_empty; - video_set_drvdata(&fmr2->vdev, fmr2); - - /* mute card - prevents noisy bootups */ - fmr2_mute(fmr2->io); - fmr2_product_info(fmr2); + fmr2->tea.private_data = fmr2; + fmr2->tea.ops = &fmr2_tea_ops; + fmr2->tea.ext_init = fmr2_tea_ext_init; + strlcpy(fmr2->tea.card, "SF16-FMR2", sizeof(fmr2->tea.card)); + strcpy(fmr2->tea.bus_info, "ISA");
- if (video_register_device(&fmr2->vdev, VFL_TYPE_RADIO, radio_nr) < 0) { - v4l2_device_unregister(v4l2_dev); + if (snd_tea575x_init(&fmr2->tea)) { + printk(KERN_ERR "radio-sf16fmr2: Unable to detect TEA575x tuner\n"); release_region(fmr2->io, 2); - return -EINVAL; + return -ENODEV; }
- v4l2_info(v4l2_dev, "SF16FMR2 radio card driver at 0x%x.\n", fmr2->io); - debug_print((KERN_DEBUG "card_type %d\n", fmr2->card_type)); + printk(KERN_INFO "radio-sf16fmr2: SF16-FMR2 radio card at 0x%x.\n", fmr2->io); return 0; }
@@ -443,22 +211,9 @@ static void __exit fmr2_exit(void) { struct fmr2 *fmr2 = &fmr2_card;
- video_unregister_device(&fmr2->vdev); - v4l2_device_unregister(&fmr2->v4l2_dev); + snd_tea575x_exit(&fmr2->tea); release_region(fmr2->io, 2); }
module_init(fmr2_init); module_exit(fmr2_exit); - -#ifndef MODULE - -static int __init fmr2_setup_io(char *str) -{ - get_option(&str, &io); - return 1; -} - -__setup("sf16fmr2=", fmr2_setup_io); - -#endif
participants (3)
-
Mauro Carvalho Chehab -
Ondrej Zary -
Takashi Iwai