V4L/DVB (4355): V4L2 conversion: radio-sf16fmr2 (acda0e71) · Commits · jan.koester / Linux

drivers/media/radio/Kconfig

+1 −1

Original line number	Diff line number	Diff line
		@@ -225,7 +225,7 @@ config RADIO_SF16FMI

		config RADIO_SF16FMR2
		tristate "SF16FMR2 Radio"
		depends on ISA && VIDEO_V4L1
		depends on ISA && VIDEO_V4L2
		---help---
		Choose Y here if you have one of these FM radio cards.

drivers/media/radio/radio-sf16fmr2.c

+139 −83

Original line number	Diff line number	Diff line
		@@ -10,6 +10,8 @@
		* 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>
		*/

		#include <linux/module.h> /* Modules */
		@@ -18,10 +20,31 @@
		#include <linux/delay.h> /* udelay */
		#include <asm/io.h> /* outb, outb_p */
		#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 <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;

		#undef DEBUG
		@@ -214,63 +237,65 @@ static int fmr2_do_ioctl(struct inode inode, struct file file,

		switch(cmd)
		{
		case VIDIOCGCAP:
		case VIDIOC_QUERYCAP:
		{
		struct video_capability *v = arg;
		struct v4l2_capability *v = arg;
		memset(v,0,sizeof(*v));
		strcpy(v->name, "SF16-FMR2 radio");
		v->type=VID_TYPE_TUNER;
		v->channels=1;
		v->audios=1;
		strlcpy(v->driver, "radio-sf16fmr2", sizeof (v->driver));
		strlcpy(v->card, "SF16-FMR2 radio", sizeof (v->card));
		sprintf(v->bus_info,"ISA");
		v->version = RADIO_VERSION;
		v->capabilities = V4L2_CAP_TUNER;

		return 0;
		}
		case VIDIOCGTUNER:
		case VIDIOC_G_TUNER:
		{
		struct video_tuner *v = arg;
		struct v4l2_tuner *v = arg;
		int mult;

		if(v->tuner) /* Only 1 tuner */
		if (v->index > 0)
		return -EINVAL;

		memset(v,0,sizeof(*v));
		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->rangehigh = RSF16_MAXFREQ/mult;
		v->flags = fmr2->flags \| VIDEO_AUDIO_MUTABLE;
		if (fmr2->mute)
		v->flags \|= VIDEO_AUDIO_MUTE;
		v->mode=VIDEO_MODE_AUTO;
		v->rxsubchans =V4L2_TUNER_SUB_MONO \| V4L2_TUNER_MODE_STEREO;
		v->capability=fmr2->flags&V4L2_TUNER_CAP_LOW;

		v->audmode = fmr2->stereo ? V4L2_TUNER_MODE_STEREO:
		V4L2_TUNER_MODE_MONO;
		mutex_lock(&lock);
		v->signal = fmr2_getsigstr(fmr2);
		mutex_unlock(&lock);

		return 0;
		}
		case VIDIOCSTUNER:
		case VIDIOC_S_TUNER:
		{
		struct video_tuner *v = arg;
		if (v->tuner!=0)
		struct v4l2_tuner *v = arg;

		if (v->index > 0)
		return -EINVAL;
		fmr2->flags = v->flags & VIDEO_TUNER_LOW;
		return 0;
		}
		case VIDIOCGFREQ:
		{
		unsigned long *freq = arg;
		*freq = fmr2->curfreq;
		if (!(fmr2->flags & VIDEO_TUNER_LOW))
		*freq /= 1000;

		return 0;
		}
		case VIDIOCSFREQ:
		case VIDIOC_S_FREQUENCY:
		{
		unsigned long *freq = arg;
		if (!(fmr2->flags & VIDEO_TUNER_LOW))
		freq = 1000;
		if ( freq < RSF16_MINFREQ \|\| freq > RSF16_MAXFREQ )
		struct v4l2_frequency *f = arg;

		if (!(fmr2->flags & V4L2_TUNER_CAP_LOW))
		f->frequency *= 1000;
		if (f->frequency < RSF16_MINFREQ \|\|
		f->frequency > RSF16_MAXFREQ )
		return -EINVAL;
		/*rounding in steps of 200 to match th freq
		* that will be used
		*/
		fmr2->curfreq = (freq/200)200;
		that will be used */
		fmr2->curfreq = (f->frequency/200)*200;

		/* set card freq (if not muted) */
		if (fmr2->curvol && !fmr2->mute)
		@@ -279,40 +304,81 @@ static int fmr2_do_ioctl(struct inode inode, struct file file,
		fmr2_setfreq(fmr2);
		mutex_unlock(&lock);
		}

		return 0;
		}
		case VIDIOCGAUDIO:
		case VIDIOC_G_FREQUENCY:
		{
		struct video_audio *v = arg;
		memset(v,0,sizeof(*v));
		/* !!! do not return VIDEO_AUDIO_MUTE */
		v->flags = VIDEO_AUDIO_MUTABLE;
		strcpy(v->name, "Radio");
		/* get current stereo mode */
		v->mode = fmr2->stereo ? VIDEO_SOUND_STEREO: VIDEO_SOUND_MONO;
		/* volume supported ? */
		if (fmr2->card_type == 11)
		{
		v->flags \|= VIDEO_AUDIO_VOLUME;
		v->step = 1 << 12;
		v->volume = fmr2->curvol;
		}
		debug_print((KERN_DEBUG "Get flags %d vol %d\n", v->flags, v->volume));
		struct v4l2_frequency *f = arg;

		f->type = V4L2_TUNER_RADIO;
		f->frequency = fmr2->curfreq;
		if (!(fmr2->flags & V4L2_TUNER_CAP_LOW))
		f->frequency /= 1000;

		return 0;
		}
		case VIDIOCSAUDIO:
		case VIDIOC_QUERYCTRL:
		{
		struct video_audio *v = arg;
		if(v->audio)
		struct v4l2_queryctrl *qc = arg;
		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);
		}
		}
		return -EINVAL;
		debug_print((KERN_DEBUG "Set flags %d vol %d\n", v->flags, v->volume));
		/* set volume */
		if (v->flags & VIDEO_AUDIO_VOLUME)
		fmr2->curvol = v->volume; /* !!! set with precision */
		if (fmr2->card_type != 11) fmr2->curvol = 65535;
		}
		case VIDIOC_G_CTRL:
		{
		struct v4l2_control *ctrl= arg;

		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;
		}
		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;
		if (v->flags & VIDEO_AUDIO_MUTE)
		} else {
		fmr2->curvol = 0;
		fmr2->mute = 1;
		}
		}
		break;
		default:
		return -EINVAL;
		}
		#ifdef DEBUG
		if (fmr2->curvol && !fmr2->mute)
		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");
		#endif
		mutex_lock(&lock);
		if (fmr2->curvol && !fmr2->mute)
		{
		if (fmr2->curvol && !fmr2->mute) {
		fmr2_setvolume(fmr2);
		fmr2_setfreq(fmr2);
		}
		else fmr2_mute(fmr2->port);
		} else
		fmr2_mute(fmr2->port);
		mutex_unlock(&lock);
		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;
		return (0);
		}
		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,
		.name = "SF16FMR2 radio",
		. type = VID_TYPE_TUNER,
		.hardware = VID_HARDWARE_SF16FMR2,
		.hardware = 0,
		.fops = &fmr2_fops,
		};

		@@ -377,7 +434,7 @@ static int __init fmr2_init(void)
		fmr2_unit.mute = 0;
		fmr2_unit.curfreq = 0;
		fmr2_unit.stereo = 1;
		fmr2_unit.flags = VIDEO_TUNER_LOW;
		fmr2_unit.flags = V4L2_TUNER_CAP_LOW;
		fmr2_unit.card_type = 0;
		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);
		debug_print((KERN_DEBUG "Mute %d Low %d\n",VIDEO_AUDIO_MUTE,VIDEO_TUNER_LOW));
		/* mute card - prevents noisy bootups */
		mutex_lock(&lock);
		fmr2_mute(io);