V4L/DVB (4355): V4L2 conversion: radio-sf16fmr2
Driver conversion to V4L2 API. Require some testing, since this obsolete hardware is not common those days. Signed-off-by: Mauro Carvalho Chehab <mchehab@infradead.org>
This commit is contained in:
parent
fa38ad6592
commit
acda0e7185
2 changed files with 140 additions and 84 deletions
|
@ -225,7 +225,7 @@ config RADIO_SF16FMI
|
||||||
|
|
||||||
config RADIO_SF16FMR2
|
config RADIO_SF16FMR2
|
||||||
tristate "SF16FMR2 Radio"
|
tristate "SF16FMR2 Radio"
|
||||||
depends on ISA && VIDEO_V4L1
|
depends on ISA && VIDEO_V4L2
|
||||||
---help---
|
---help---
|
||||||
Choose Y here if you have one of these FM radio cards.
|
Choose Y here if you have one of these FM radio cards.
|
||||||
|
|
||||||
|
|
|
@ -10,6 +10,8 @@
|
||||||
* For read stereo/mono you must wait 0.1 sec after set frequency and
|
* For read stereo/mono you must wait 0.1 sec after set frequency and
|
||||||
* card unmuted so I set frequency on unmute
|
* card unmuted so I set frequency on unmute
|
||||||
* Signal handling seem to work only on autoscanning (not implemented)
|
* Signal handling seem to work only on autoscanning (not implemented)
|
||||||
|
*
|
||||||
|
* Converted to V4L2 API by Mauro Carvalho Chehab <mchehab@infradead.org>
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#include <linux/module.h> /* Modules */
|
#include <linux/module.h> /* Modules */
|
||||||
|
@ -18,10 +20,31 @@
|
||||||
#include <linux/delay.h> /* udelay */
|
#include <linux/delay.h> /* udelay */
|
||||||
#include <asm/io.h> /* outb, outb_p */
|
#include <asm/io.h> /* outb, outb_p */
|
||||||
#include <asm/uaccess.h> /* copy to/from user */
|
#include <asm/uaccess.h> /* copy to/from user */
|
||||||
#include <linux/videodev.h> /* kernel radio structs */
|
#include <linux/videodev2.h> /* kernel radio structs */
|
||||||
#include <media/v4l2-common.h>
|
#include <media/v4l2-common.h>
|
||||||
#include <linux/mutex.h>
|
#include <linux/mutex.h>
|
||||||
|
|
||||||
|
#define RADIO_VERSION KERNEL_VERSION(0,0,2)
|
||||||
|
|
||||||
|
static struct v4l2_queryctrl radio_qctrl[] = {
|
||||||
|
{
|
||||||
|
.id = V4L2_CID_AUDIO_MUTE,
|
||||||
|
.name = "Mute",
|
||||||
|
.minimum = 0,
|
||||||
|
.maximum = 1,
|
||||||
|
.default_value = 1,
|
||||||
|
.type = V4L2_CTRL_TYPE_BOOLEAN,
|
||||||
|
},{
|
||||||
|
.id = V4L2_CID_AUDIO_VOLUME,
|
||||||
|
.name = "Volume",
|
||||||
|
.minimum = 0,
|
||||||
|
.maximum = 65535,
|
||||||
|
.step = 1<<12,
|
||||||
|
.default_value = 0xff,
|
||||||
|
.type = V4L2_CTRL_TYPE_INTEGER,
|
||||||
|
}
|
||||||
|
};
|
||||||
|
|
||||||
static struct mutex lock;
|
static struct mutex lock;
|
||||||
|
|
||||||
#undef DEBUG
|
#undef DEBUG
|
||||||
|
@ -214,63 +237,65 @@ static int fmr2_do_ioctl(struct inode *inode, struct file *file,
|
||||||
|
|
||||||
switch(cmd)
|
switch(cmd)
|
||||||
{
|
{
|
||||||
case VIDIOCGCAP:
|
case VIDIOC_QUERYCAP:
|
||||||
{
|
{
|
||||||
struct video_capability *v = arg;
|
struct v4l2_capability *v = arg;
|
||||||
memset(v,0,sizeof(*v));
|
memset(v,0,sizeof(*v));
|
||||||
strcpy(v->name, "SF16-FMR2 radio");
|
strlcpy(v->driver, "radio-sf16fmr2", sizeof (v->driver));
|
||||||
v->type=VID_TYPE_TUNER;
|
strlcpy(v->card, "SF16-FMR2 radio", sizeof (v->card));
|
||||||
v->channels=1;
|
sprintf(v->bus_info,"ISA");
|
||||||
v->audios=1;
|
v->version = RADIO_VERSION;
|
||||||
|
v->capabilities = V4L2_CAP_TUNER;
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
case VIDIOCGTUNER:
|
case VIDIOC_G_TUNER:
|
||||||
{
|
{
|
||||||
struct video_tuner *v = arg;
|
struct v4l2_tuner *v = arg;
|
||||||
int mult;
|
int mult;
|
||||||
|
|
||||||
if(v->tuner) /* Only 1 tuner */
|
if (v->index > 0)
|
||||||
return -EINVAL;
|
return -EINVAL;
|
||||||
|
|
||||||
|
memset(v,0,sizeof(*v));
|
||||||
strcpy(v->name, "FM");
|
strcpy(v->name, "FM");
|
||||||
mult = (fmr2->flags & VIDEO_TUNER_LOW) ? 1 : 1000;
|
v->type = V4L2_TUNER_RADIO;
|
||||||
|
|
||||||
|
mult = (fmr2->flags & V4L2_TUNER_CAP_LOW) ? 1 : 1000;
|
||||||
v->rangelow = RSF16_MINFREQ/mult;
|
v->rangelow = RSF16_MINFREQ/mult;
|
||||||
v->rangehigh = RSF16_MAXFREQ/mult;
|
v->rangehigh = RSF16_MAXFREQ/mult;
|
||||||
v->flags = fmr2->flags | VIDEO_AUDIO_MUTABLE;
|
v->rxsubchans =V4L2_TUNER_SUB_MONO | V4L2_TUNER_MODE_STEREO;
|
||||||
if (fmr2->mute)
|
v->capability=fmr2->flags&V4L2_TUNER_CAP_LOW;
|
||||||
v->flags |= VIDEO_AUDIO_MUTE;
|
|
||||||
v->mode=VIDEO_MODE_AUTO;
|
v->audmode = fmr2->stereo ? V4L2_TUNER_MODE_STEREO:
|
||||||
|
V4L2_TUNER_MODE_MONO;
|
||||||
mutex_lock(&lock);
|
mutex_lock(&lock);
|
||||||
v->signal = fmr2_getsigstr(fmr2);
|
v->signal = fmr2_getsigstr(fmr2);
|
||||||
mutex_unlock(&lock);
|
mutex_unlock(&lock);
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
case VIDIOCSTUNER:
|
case VIDIOC_S_TUNER:
|
||||||
{
|
{
|
||||||
struct video_tuner *v = arg;
|
struct v4l2_tuner *v = arg;
|
||||||
if (v->tuner!=0)
|
|
||||||
|
if (v->index > 0)
|
||||||
return -EINVAL;
|
return -EINVAL;
|
||||||
fmr2->flags = v->flags & VIDEO_TUNER_LOW;
|
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
case VIDIOCGFREQ:
|
case VIDIOC_S_FREQUENCY:
|
||||||
{
|
{
|
||||||
unsigned long *freq = arg;
|
struct v4l2_frequency *f = arg;
|
||||||
*freq = fmr2->curfreq;
|
|
||||||
if (!(fmr2->flags & VIDEO_TUNER_LOW))
|
if (!(fmr2->flags & V4L2_TUNER_CAP_LOW))
|
||||||
*freq /= 1000;
|
f->frequency *= 1000;
|
||||||
return 0;
|
if (f->frequency < RSF16_MINFREQ ||
|
||||||
}
|
f->frequency > RSF16_MAXFREQ )
|
||||||
case VIDIOCSFREQ:
|
|
||||||
{
|
|
||||||
unsigned long *freq = arg;
|
|
||||||
if (!(fmr2->flags & VIDEO_TUNER_LOW))
|
|
||||||
*freq *= 1000;
|
|
||||||
if ( *freq < RSF16_MINFREQ || *freq > RSF16_MAXFREQ )
|
|
||||||
return -EINVAL;
|
return -EINVAL;
|
||||||
/* rounding in steps of 200 to match th freq
|
/*rounding in steps of 200 to match th freq
|
||||||
* that will be used
|
that will be used */
|
||||||
*/
|
fmr2->curfreq = (f->frequency/200)*200;
|
||||||
fmr2->curfreq = (*freq/200)*200;
|
|
||||||
|
|
||||||
/* set card freq (if not muted) */
|
/* set card freq (if not muted) */
|
||||||
if (fmr2->curvol && !fmr2->mute)
|
if (fmr2->curvol && !fmr2->mute)
|
||||||
|
@ -279,40 +304,81 @@ static int fmr2_do_ioctl(struct inode *inode, struct file *file,
|
||||||
fmr2_setfreq(fmr2);
|
fmr2_setfreq(fmr2);
|
||||||
mutex_unlock(&lock);
|
mutex_unlock(&lock);
|
||||||
}
|
}
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
case VIDIOCGAUDIO:
|
case VIDIOC_G_FREQUENCY:
|
||||||
{
|
{
|
||||||
struct video_audio *v = arg;
|
struct v4l2_frequency *f = arg;
|
||||||
memset(v,0,sizeof(*v));
|
|
||||||
/* !!! do not return VIDEO_AUDIO_MUTE */
|
f->type = V4L2_TUNER_RADIO;
|
||||||
v->flags = VIDEO_AUDIO_MUTABLE;
|
f->frequency = fmr2->curfreq;
|
||||||
strcpy(v->name, "Radio");
|
if (!(fmr2->flags & V4L2_TUNER_CAP_LOW))
|
||||||
/* get current stereo mode */
|
f->frequency /= 1000;
|
||||||
v->mode = fmr2->stereo ? VIDEO_SOUND_STEREO: VIDEO_SOUND_MONO;
|
|
||||||
/* volume supported ? */
|
return 0;
|
||||||
if (fmr2->card_type == 11)
|
}
|
||||||
{
|
case VIDIOC_QUERYCTRL:
|
||||||
v->flags |= VIDEO_AUDIO_VOLUME;
|
{
|
||||||
v->step = 1 << 12;
|
struct v4l2_queryctrl *qc = arg;
|
||||||
v->volume = fmr2->curvol;
|
int i;
|
||||||
|
|
||||||
|
for (i = 0; i < ARRAY_SIZE(radio_qctrl); i++) {
|
||||||
|
if ((fmr2->card_type != 11)
|
||||||
|
&& V4L2_CID_AUDIO_VOLUME)
|
||||||
|
radio_qctrl[i].step=65535;
|
||||||
|
if (qc->id && qc->id == radio_qctrl[i].id) {
|
||||||
|
memcpy(qc, &(radio_qctrl[i]),
|
||||||
|
sizeof(*qc));
|
||||||
|
return (0);
|
||||||
|
}
|
||||||
}
|
}
|
||||||
debug_print((KERN_DEBUG "Get flags %d vol %d\n", v->flags, v->volume));
|
return -EINVAL;
|
||||||
return 0;
|
|
||||||
}
|
}
|
||||||
case VIDIOCSAUDIO:
|
case VIDIOC_G_CTRL:
|
||||||
{
|
{
|
||||||
struct video_audio *v = arg;
|
struct v4l2_control *ctrl= arg;
|
||||||
if(v->audio)
|
|
||||||
return -EINVAL;
|
switch (ctrl->id) {
|
||||||
debug_print((KERN_DEBUG "Set flags %d vol %d\n", v->flags, v->volume));
|
case V4L2_CID_AUDIO_MUTE:
|
||||||
/* set volume */
|
ctrl->value=fmr2->mute;
|
||||||
if (v->flags & VIDEO_AUDIO_VOLUME)
|
return (0);
|
||||||
fmr2->curvol = v->volume; /* !!! set with precision */
|
case V4L2_CID_AUDIO_VOLUME:
|
||||||
if (fmr2->card_type != 11) fmr2->curvol = 65535;
|
ctrl->value=fmr2->curvol;
|
||||||
fmr2->mute = 0;
|
return (0);
|
||||||
if (v->flags & VIDEO_AUDIO_MUTE)
|
}
|
||||||
fmr2->mute = 1;
|
return -EINVAL;
|
||||||
|
}
|
||||||
|
case VIDIOC_S_CTRL:
|
||||||
|
{
|
||||||
|
struct v4l2_control *ctrl= arg;
|
||||||
|
|
||||||
|
switch (ctrl->id) {
|
||||||
|
case V4L2_CID_AUDIO_MUTE:
|
||||||
|
fmr2->mute=ctrl->value;
|
||||||
|
if (fmr2->card_type != 11) {
|
||||||
|
if (!fmr2->mute) {
|
||||||
|
fmr2->curvol = 65535;
|
||||||
|
} else {
|
||||||
|
fmr2->curvol = 0;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
break;
|
||||||
|
case V4L2_CID_AUDIO_VOLUME:
|
||||||
|
fmr2->curvol = ctrl->value;
|
||||||
|
if (fmr2->card_type != 11) {
|
||||||
|
if (fmr2->curvol) {
|
||||||
|
fmr2->curvol = 65535;
|
||||||
|
fmr2->mute = 0;
|
||||||
|
} else {
|
||||||
|
fmr2->curvol = 0;
|
||||||
|
fmr2->mute = 1;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
break;
|
||||||
|
default:
|
||||||
|
return -EINVAL;
|
||||||
|
}
|
||||||
#ifdef DEBUG
|
#ifdef DEBUG
|
||||||
if (fmr2->curvol && !fmr2->mute)
|
if (fmr2->curvol && !fmr2->mute)
|
||||||
printk(KERN_DEBUG "unmute\n");
|
printk(KERN_DEBUG "unmute\n");
|
||||||
|
@ -320,27 +386,18 @@ static int fmr2_do_ioctl(struct inode *inode, struct file *file,
|
||||||
printk(KERN_DEBUG "mute\n");
|
printk(KERN_DEBUG "mute\n");
|
||||||
#endif
|
#endif
|
||||||
mutex_lock(&lock);
|
mutex_lock(&lock);
|
||||||
if (fmr2->curvol && !fmr2->mute)
|
if (fmr2->curvol && !fmr2->mute) {
|
||||||
{
|
|
||||||
fmr2_setvolume(fmr2);
|
fmr2_setvolume(fmr2);
|
||||||
fmr2_setfreq(fmr2);
|
fmr2_setfreq(fmr2);
|
||||||
}
|
} else
|
||||||
else fmr2_mute(fmr2->port);
|
fmr2_mute(fmr2->port);
|
||||||
mutex_unlock(&lock);
|
mutex_unlock(&lock);
|
||||||
return 0;
|
return (0);
|
||||||
}
|
|
||||||
case VIDIOCGUNIT:
|
|
||||||
{
|
|
||||||
struct video_unit *v = arg;
|
|
||||||
v->video=VIDEO_NO_UNIT;
|
|
||||||
v->vbi=VIDEO_NO_UNIT;
|
|
||||||
v->radio=dev->minor;
|
|
||||||
v->audio=0; /* How do we find out this??? */
|
|
||||||
v->teletext=VIDEO_NO_UNIT;
|
|
||||||
return 0;
|
|
||||||
}
|
}
|
||||||
default:
|
default:
|
||||||
return -ENOIOCTLCMD;
|
return v4l_compat_translate_ioctl(inode,file,cmd,arg,
|
||||||
|
az_do_ioctl);
|
||||||
|
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -366,7 +423,7 @@ static struct video_device fmr2_radio=
|
||||||
.owner = THIS_MODULE,
|
.owner = THIS_MODULE,
|
||||||
.name = "SF16FMR2 radio",
|
.name = "SF16FMR2 radio",
|
||||||
. type = VID_TYPE_TUNER,
|
. type = VID_TYPE_TUNER,
|
||||||
.hardware = VID_HARDWARE_SF16FMR2,
|
.hardware = 0,
|
||||||
.fops = &fmr2_fops,
|
.fops = &fmr2_fops,
|
||||||
};
|
};
|
||||||
|
|
||||||
|
@ -377,7 +434,7 @@ static int __init fmr2_init(void)
|
||||||
fmr2_unit.mute = 0;
|
fmr2_unit.mute = 0;
|
||||||
fmr2_unit.curfreq = 0;
|
fmr2_unit.curfreq = 0;
|
||||||
fmr2_unit.stereo = 1;
|
fmr2_unit.stereo = 1;
|
||||||
fmr2_unit.flags = VIDEO_TUNER_LOW;
|
fmr2_unit.flags = V4L2_TUNER_CAP_LOW;
|
||||||
fmr2_unit.card_type = 0;
|
fmr2_unit.card_type = 0;
|
||||||
fmr2_radio.priv = &fmr2_unit;
|
fmr2_radio.priv = &fmr2_unit;
|
||||||
|
|
||||||
|
@ -396,7 +453,6 @@ static int __init fmr2_init(void)
|
||||||
}
|
}
|
||||||
|
|
||||||
printk(KERN_INFO "SF16FMR2 radio card driver at 0x%x.\n", io);
|
printk(KERN_INFO "SF16FMR2 radio card driver at 0x%x.\n", io);
|
||||||
debug_print((KERN_DEBUG "Mute %d Low %d\n",VIDEO_AUDIO_MUTE,VIDEO_TUNER_LOW));
|
|
||||||
/* mute card - prevents noisy bootups */
|
/* mute card - prevents noisy bootups */
|
||||||
mutex_lock(&lock);
|
mutex_lock(&lock);
|
||||||
fmr2_mute(io);
|
fmr2_mute(io);
|
||||||
|
|
Reference in a new issue