[deliverable/linux.git] / drivers / media / radio / radio-tea5777.c

/*
 *   v4l2 driver for TEA5777 Philips AM/FM radio tuner chips
 *
 *	Copyright (c) 2012 Hans de Goede <hdegoede@redhat.com>
 *
 *   Based on the ALSA driver for TEA5757/5759 Philips AM/FM radio tuner chips:
 *
 *	Copyright (c) 2004 Jaroslav Kysela <perex@perex.cz>
 *
 *   This program is free software; you can redistribute it and/or modify
 *   it under the terms of the GNU General Public License as published by
 *   the Free Software Foundation; either version 2 of the License, or
 *   (at your option) any later version.
 *
 *   This program is distributed in the hope that it will be useful,
 *   but WITHOUT ANY WARRANTY; without even the implied warranty of
 *   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 *   GNU General Public License for more details.
 *
 *   You should have received a copy of the GNU General Public License
 *   along with this program; if not, write to the Free Software
 *   Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307 USA
 *
 */

#include <linux/delay.h>
#include <linux/init.h>
#include <linux/module.h>
#include <linux/sched.h>
#include <linux/slab.h>
#include <media/v4l2-device.h>
#include <media/v4l2-dev.h>
#include <media/v4l2-fh.h>
#include <media/v4l2-ioctl.h>
#include <media/v4l2-event.h>
#include "radio-tea5777.h"

MODULE_AUTHOR("Hans de Goede <perex@perex.cz>");
MODULE_DESCRIPTION("Routines for control of TEA5777 Philips AM/FM radio tuner chips");
MODULE_LICENSE("GPL");

#define TEA5777_FM_IF			150 /* kHz */
#define TEA5777_FM_FREQ_STEP		50  /* kHz */

#define TEA5777_AM_IF			21  /* kHz */
#define TEA5777_AM_FREQ_STEP		1   /* kHz */

/* Write reg, common bits */
#define TEA5777_W_MUTE_MASK		(1LL << 47)
#define TEA5777_W_MUTE_SHIFT		47
#define TEA5777_W_AM_FM_MASK		(1LL << 46)
#define TEA5777_W_AM_FM_SHIFT		46
#define TEA5777_W_STB_MASK		(1LL << 45)
#define TEA5777_W_STB_SHIFT		45

#define TEA5777_W_IFCE_MASK		(1LL << 29)
#define TEA5777_W_IFCE_SHIFT		29
#define TEA5777_W_IFW_MASK		(1LL << 28)
#define TEA5777_W_IFW_SHIFT		28
#define TEA5777_W_HILO_MASK		(1LL << 27)
#define TEA5777_W_HILO_SHIFT		27
#define TEA5777_W_DBUS_MASK		(1LL << 26)
#define TEA5777_W_DBUS_SHIFT		26

#define TEA5777_W_INTEXT_MASK		(1LL << 24)
#define TEA5777_W_INTEXT_SHIFT		24
#define TEA5777_W_P1_MASK		(1LL << 23)
#define TEA5777_W_P1_SHIFT		23
#define TEA5777_W_P0_MASK		(1LL << 22)
#define TEA5777_W_P0_SHIFT		22
#define TEA5777_W_PEN1_MASK		(1LL << 21)
#define TEA5777_W_PEN1_SHIFT		21
#define TEA5777_W_PEN0_MASK		(1LL << 20)
#define TEA5777_W_PEN0_SHIFT		20

#define TEA5777_W_CHP0_MASK		(1LL << 18)
#define TEA5777_W_CHP0_SHIFT		18
#define TEA5777_W_DEEM_MASK		(1LL << 17)
#define TEA5777_W_DEEM_SHIFT		17

#define TEA5777_W_SEARCH_MASK		(1LL << 7)
#define TEA5777_W_SEARCH_SHIFT		7
#define TEA5777_W_PROGBLIM_MASK		(1LL << 6)
#define TEA5777_W_PROGBLIM_SHIFT	6
#define TEA5777_W_UPDWN_MASK		(1LL << 5)
#define TEA5777_W_UPDWN_SHIFT		5
#define TEA5777_W_SLEV_MASK		(3LL << 3)
#define TEA5777_W_SLEV_SHIFT		3

/* Write reg, FM specific bits */
#define TEA5777_W_FM_PLL_MASK		(0x1fffLL << 32)
#define TEA5777_W_FM_PLL_SHIFT		32
#define TEA5777_W_FM_FREF_MASK		(0x03LL << 30)
#define TEA5777_W_FM_FREF_SHIFT		30
#define TEA5777_W_FM_FREF_VALUE		0LL /* 50k steps, 150k IF */

#define TEA5777_W_FM_FORCEMONO_MASK	(1LL << 15)
#define TEA5777_W_FM_FORCEMONO_SHIFT	15
#define TEA5777_W_FM_SDSOFF_MASK	(1LL << 14)
#define TEA5777_W_FM_SDSOFF_SHIFT	14
#define TEA5777_W_FM_DOFF_MASK		(1LL << 13)
#define TEA5777_W_FM_DOFF_SHIFT		13

#define TEA5777_W_FM_STEP_MASK		(3LL << 1)
#define TEA5777_W_FM_STEP_SHIFT		1

/* Write reg, AM specific bits */
#define TEA5777_W_AM_PLL_MASK		(0x7ffLL << 34)
#define TEA5777_W_AM_PLL_SHIFT		34
#define TEA5777_W_AM_AGCRF_MASK		(1LL << 33)
#define TEA5777_W_AM_AGCRF_SHIFT	33
#define TEA5777_W_AM_AGCIF_MASK		(1LL << 32)
#define TEA5777_W_AM_AGCIF_SHIFT	32
#define TEA5777_W_AM_MWLW_MASK		(1LL << 31)
#define TEA5777_W_AM_MWLW_SHIFT		31
#define TEA5777_W_AM_LW			0LL
#define TEA5777_W_AM_MW			1LL
#define TEA5777_W_AM_LNA_MASK		(1LL << 30)
#define TEA5777_W_AM_LNA_SHIFT		30

#define TEA5777_W_AM_PEAK_MASK		(1LL << 25)
#define TEA5777_W_AM_PEAK_SHIFT		25

#define TEA5777_W_AM_RFB_MASK		(1LL << 16)
#define TEA5777_W_AM_RFB_SHIFT		16
#define TEA5777_W_AM_CALLIGN_MASK	(1LL << 15)
#define TEA5777_W_AM_CALLIGN_SHIFT	15
#define TEA5777_W_AM_CBANK_MASK		(0x7fLL << 8)
#define TEA5777_W_AM_CBANK_SHIFT	8

#define TEA5777_W_AM_DELAY_MASK		(1LL << 2)
#define TEA5777_W_AM_DELAY_SHIFT	2
#define TEA5777_W_AM_STEP_MASK		(1LL << 1)
#define TEA5777_W_AM_STEP_SHIFT		1

/* Read reg, common bits */
#define TEA5777_R_LEVEL_MASK		(0x0f << 17)
#define TEA5777_R_LEVEL_SHIFT		17
#define TEA5777_R_SFOUND_MASK		(0x01 << 16)
#define TEA5777_R_SFOUND_SHIFT		16
#define TEA5777_R_BLIM_MASK		(0x01 << 15)
#define TEA5777_R_BLIM_SHIFT		15

/* Read reg, FM specific bits */
#define TEA5777_R_FM_STEREO_MASK	(0x01 << 21)
#define TEA5777_R_FM_STEREO_SHIFT	21
#define TEA5777_R_FM_PLL_MASK		0x1fff
#define TEA5777_R_FM_PLL_SHIFT		0

enum { BAND_FM, BAND_AM };

static const struct v4l2_frequency_band bands[] = {
	{
		.type = V4L2_TUNER_RADIO,
		.index = 0,
		.capability = V4L2_TUNER_CAP_LOW | V4L2_TUNER_CAP_STEREO |
			      V4L2_TUNER_CAP_FREQ_BANDS |
			      V4L2_TUNER_CAP_HWSEEK_BOUNDED |
			      V4L2_TUNER_CAP_HWSEEK_PROG_LIM,
		.rangelow   =  76000 * 16,
		.rangehigh  = 108000 * 16,
		.modulation = V4L2_BAND_MODULATION_FM,
	},
	{
		.type = V4L2_TUNER_RADIO,
		.index = 1,
		.capability = V4L2_TUNER_CAP_LOW | V4L2_TUNER_CAP_FREQ_BANDS |
			      V4L2_TUNER_CAP_HWSEEK_BOUNDED |
			      V4L2_TUNER_CAP_HWSEEK_PROG_LIM,
		.rangelow   =  530 * 16,
		.rangehigh  = 1710 * 16,
		.modulation = V4L2_BAND_MODULATION_AM,
	},
};

static u32 tea5777_freq_to_v4l2_freq(struct radio_tea5777 *tea, u32 freq)
{
	switch (tea->band) {
	case BAND_FM:
		return (freq * TEA5777_FM_FREQ_STEP + TEA5777_FM_IF) * 16;
	case BAND_AM:
		return (freq * TEA5777_AM_FREQ_STEP + TEA5777_AM_IF) * 16;
	}
	return 0; /* Never reached */
}

int radio_tea5777_set_freq(struct radio_tea5777 *tea)
{
	u32 freq;
	int res;

	freq = clamp(tea->freq, bands[tea->band].rangelow,
				bands[tea->band].rangehigh);
	freq = (freq + 8) / 16; /* to kHz */

	switch (tea->band) {
	case BAND_FM:
		tea->write_reg &= ~TEA5777_W_AM_FM_MASK;
		freq = (freq - TEA5777_FM_IF) / TEA5777_FM_FREQ_STEP;
		tea->write_reg &= ~TEA5777_W_FM_PLL_MASK;
		tea->write_reg |= (u64)freq << TEA5777_W_FM_PLL_SHIFT;
		tea->write_reg &= ~TEA5777_W_FM_FREF_MASK;
		tea->write_reg |= TEA5777_W_FM_FREF_VALUE <<
				  TEA5777_W_FM_FREF_SHIFT;
		tea->write_reg &= ~TEA5777_W_FM_FORCEMONO_MASK;
		if (tea->audmode == V4L2_TUNER_MODE_MONO)
			tea->write_reg |= 1LL << TEA5777_W_FM_FORCEMONO_SHIFT;
		break;
	case BAND_AM:
		tea->write_reg &= ~TEA5777_W_AM_FM_MASK;
		tea->write_reg |= (1LL << TEA5777_W_AM_FM_SHIFT);
		freq = (freq - TEA5777_AM_IF) / TEA5777_AM_FREQ_STEP;
		tea->write_reg &= ~TEA5777_W_AM_PLL_MASK;
		tea->write_reg |= (u64)freq << TEA5777_W_AM_PLL_SHIFT;
		tea->write_reg &= ~TEA5777_W_AM_AGCRF_MASK;
		tea->write_reg &= ~TEA5777_W_AM_AGCRF_MASK;
		tea->write_reg &= ~TEA5777_W_AM_MWLW_MASK;
		tea->write_reg |= TEA5777_W_AM_MW << TEA5777_W_AM_MWLW_SHIFT;
		tea->write_reg &= ~TEA5777_W_AM_LNA_MASK;
		tea->write_reg |= 1LL << TEA5777_W_AM_LNA_SHIFT;
		tea->write_reg &= ~TEA5777_W_AM_PEAK_MASK;
		tea->write_reg |= 1LL << TEA5777_W_AM_PEAK_SHIFT;
		tea->write_reg &= ~TEA5777_W_AM_CALLIGN_MASK;
		break;
	}

	res = tea->ops->write_reg(tea, tea->write_reg);
	if (res)
		return res;

	tea->needs_write = false;
	tea->read_reg = -1;
	tea->freq = tea5777_freq_to_v4l2_freq(tea, freq);

	return 0;
}

static int radio_tea5777_update_read_reg(struct radio_tea5777 *tea, int wait)
{
	int res;

	if (tea->read_reg != -1)
		return 0;

	if (tea->write_before_read && tea->needs_write) {
		res = radio_tea5777_set_freq(tea);
		if (res)
			return res;
	}

	if (wait) {
		if (schedule_timeout_interruptible(msecs_to_jiffies(wait)))
			return -ERESTARTSYS;
	}

	res = tea->ops->read_reg(tea, &tea->read_reg);
	if (res)
		return res;

	tea->needs_write = true;
	return 0;
}

/*
 * Linux Video interface
 */

static int vidioc_querycap(struct file *file, void  *priv,
					struct v4l2_capability *v)
{
	struct radio_tea5777 *tea = video_drvdata(file);

	strlcpy(v->driver, tea->v4l2_dev->name, sizeof(v->driver));
	strlcpy(v->card, tea->card, sizeof(v->card));
	strlcat(v->card, " TEA5777", sizeof(v->card));
	strlcpy(v->bus_info, tea->bus_info, sizeof(v->bus_info));
	v->device_caps = V4L2_CAP_TUNER | V4L2_CAP_RADIO;
	v->device_caps |= V4L2_CAP_HW_FREQ_SEEK;
	v->capabilities = v->device_caps | V4L2_CAP_DEVICE_CAPS;
	return 0;
}

static int vidioc_enum_freq_bands(struct file *file, void *priv,
					 struct v4l2_frequency_band *band)
{
	struct radio_tea5777 *tea = video_drvdata(file);

	if (band->tuner != 0 || band->index >= ARRAY_SIZE(bands) ||
	    (!tea->has_am && band->index == BAND_AM))
		return -EINVAL;

	*band = bands[band->index];
	return 0;
}

static int vidioc_g_tuner(struct file *file, void *priv,
					struct v4l2_tuner *v)
{
	struct radio_tea5777 *tea = video_drvdata(file);
	int res;

	if (v->index > 0)
		return -EINVAL;

	res = radio_tea5777_update_read_reg(tea, 0);
	if (res)
		return res;

	memset(v, 0, sizeof(*v));
	if (tea->has_am)
		strlcpy(v->name, "AM/FM", sizeof(v->name));
	else
		strlcpy(v->name, "FM", sizeof(v->name));
	v->type = V4L2_TUNER_RADIO;
	v->capability = V4L2_TUNER_CAP_LOW | V4L2_TUNER_CAP_STEREO |
			V4L2_TUNER_CAP_FREQ_BANDS |
			V4L2_TUNER_CAP_HWSEEK_BOUNDED |
			V4L2_TUNER_CAP_HWSEEK_PROG_LIM;
	v->rangelow   = tea->has_am ? bands[BAND_AM].rangelow :
				      bands[BAND_FM].rangelow;
	v->rangehigh  = bands[BAND_FM].rangehigh;
	if (tea->band == BAND_FM &&
			(tea->read_reg & TEA5777_R_FM_STEREO_MASK))
		v->rxsubchans = V4L2_TUNER_SUB_STEREO;
	else
		v->rxsubchans = V4L2_TUNER_SUB_MONO;
	v->audmode = tea->audmode;
	/* shift - 12 to convert 4-bits (0-15) scale to 16-bits (0-65535) */
	v->signal = (tea->read_reg & TEA5777_R_LEVEL_MASK) >>
		    (TEA5777_R_LEVEL_SHIFT - 12);

	/* Invalidate read_reg, so that next call we return up2date signal */
	tea->read_reg = -1;

	return 0;
}

static int vidioc_s_tuner(struct file *file, void *priv,
					const struct v4l2_tuner *v)
{
	struct radio_tea5777 *tea = video_drvdata(file);
	u32 orig_audmode = tea->audmode;

	if (v->index)
		return -EINVAL;

	tea->audmode = v->audmode;
	if (tea->audmode > V4L2_TUNER_MODE_STEREO)
		tea->audmode = V4L2_TUNER_MODE_STEREO;

	if (tea->audmode != orig_audmode && tea->band == BAND_FM)
		return radio_tea5777_set_freq(tea);

	return 0;
}

static int vidioc_g_frequency(struct file *file, void *priv,
					struct v4l2_frequency *f)
{
	struct radio_tea5777 *tea = video_drvdata(file);

	if (f->tuner != 0)
		return -EINVAL;
	f->type = V4L2_TUNER_RADIO;
	f->frequency = tea->freq;
	return 0;
}

static int vidioc_s_frequency(struct file *file, void *priv,
					const struct v4l2_frequency *f)
{
	struct radio_tea5777 *tea = video_drvdata(file);

	if (f->tuner != 0 || f->type != V4L2_TUNER_RADIO)
		return -EINVAL;

	if (tea->has_am && f->frequency < (20000 * 16))
		tea->band = BAND_AM;
	else
		tea->band = BAND_FM;

	tea->freq = f->frequency;
	return radio_tea5777_set_freq(tea);
}

static int vidioc_s_hw_freq_seek(struct file *file, void *fh,
					const struct v4l2_hw_freq_seek *a)
{
	struct radio_tea5777 *tea = video_drvdata(file);
	unsigned long timeout;
	u32 rangelow = a->rangelow;
	u32 rangehigh = a->rangehigh;
	int i, res, spacing;
	u32 orig_freq;

	if (a->tuner || a->wrap_around)
		return -EINVAL;

	if (file->f_flags & O_NONBLOCK)
		return -EWOULDBLOCK;

	if (rangelow || rangehigh) {
		for (i = 0; i < ARRAY_SIZE(bands); i++) {
			if (i == BAND_AM && !tea->has_am)
				continue;
			if (bands[i].rangelow  >= rangelow &&
			    bands[i].rangehigh <= rangehigh)
				break;
		}
		if (i == ARRAY_SIZE(bands))
			return -EINVAL; /* No matching band found */

		tea->band = i;
		if (tea->freq < rangelow || tea->freq > rangehigh) {
			tea->freq = clamp(tea->freq, rangelow,
						     rangehigh);
			res = radio_tea5777_set_freq(tea);
			if (res)
				return res;
		}
	} else {
		rangelow  = bands[tea->band].rangelow;
		rangehigh = bands[tea->band].rangehigh;
	}

	spacing   = (tea->band == BAND_AM) ? (5 * 16) : (200 * 16); /* kHz */
	orig_freq = tea->freq;

	tea->write_reg |= TEA5777_W_PROGBLIM_MASK;
	if (tea->seek_rangelow != rangelow) {
		tea->write_reg &= ~TEA5777_W_UPDWN_MASK;
		tea->freq = rangelow;
		res = radio_tea5777_set_freq(tea);
		if (res)
			goto leave;
		tea->seek_rangelow = rangelow;
	}
	if (tea->seek_rangehigh != rangehigh) {
		tea->write_reg |= TEA5777_W_UPDWN_MASK;
		tea->freq = rangehigh;
		res = radio_tea5777_set_freq(tea);
		if (res)
			goto leave;
		tea->seek_rangehigh = rangehigh;
	}
	tea->write_reg &= ~TEA5777_W_PROGBLIM_MASK;

	tea->write_reg |= TEA5777_W_SEARCH_MASK;
	if (a->seek_upward) {
		tea->write_reg |= TEA5777_W_UPDWN_MASK;
		tea->freq = orig_freq + spacing;
	} else {
		tea->write_reg &= ~TEA5777_W_UPDWN_MASK;
		tea->freq = orig_freq - spacing;
	}
	res = radio_tea5777_set_freq(tea);
	if (res)
		goto leave;

	timeout = jiffies + msecs_to_jiffies(5000);
	for (;;) {
		if (time_after(jiffies, timeout)) {
			res = -ENODATA;
			break;
		}

		res = radio_tea5777_update_read_reg(tea, 100);
		if (res)
			break;

		/*
		 * Note we use tea->freq to track how far we've searched sofar
		 * this is necessary to ensure we continue seeking at the right
		 * point, in the write_before_read case.
		 */
		tea->freq = (tea->read_reg & TEA5777_R_FM_PLL_MASK);
		tea->freq = tea5777_freq_to_v4l2_freq(tea, tea->freq);

		if ((tea->read_reg & TEA5777_R_SFOUND_MASK)) {
			tea->write_reg &= ~TEA5777_W_SEARCH_MASK;
			return 0;
		}

		if (tea->read_reg & TEA5777_R_BLIM_MASK) {
			res = -ENODATA;
			break;
		}

		/* Force read_reg update */
		tea->read_reg = -1;
	}
leave:
	tea->write_reg &= ~TEA5777_W_PROGBLIM_MASK;
	tea->write_reg &= ~TEA5777_W_SEARCH_MASK;
	tea->freq = orig_freq;
	radio_tea5777_set_freq(tea);
	return res;
}

static int tea575x_s_ctrl(struct v4l2_ctrl *c)
{
	struct radio_tea5777 *tea =
		container_of(c->handler, struct radio_tea5777, ctrl_handler);

	switch (c->id) {
	case V4L2_CID_AUDIO_MUTE:
		if (c->val)
			tea->write_reg |= TEA5777_W_MUTE_MASK;
		else
			tea->write_reg &= ~TEA5777_W_MUTE_MASK;

		return radio_tea5777_set_freq(tea);
	}

	return -EINVAL;
}

static const struct v4l2_file_operations tea575x_fops = {
	.unlocked_ioctl	= video_ioctl2,
	.open		= v4l2_fh_open,
	.release	= v4l2_fh_release,
	.poll		= v4l2_ctrl_poll,
};

static const struct v4l2_ioctl_ops tea575x_ioctl_ops = {
	.vidioc_querycap    = vidioc_querycap,
	.vidioc_g_tuner     = vidioc_g_tuner,
	.vidioc_s_tuner     = vidioc_s_tuner,
	.vidioc_g_frequency = vidioc_g_frequency,
	.vidioc_s_frequency = vidioc_s_frequency,
	.vidioc_s_hw_freq_seek = vidioc_s_hw_freq_seek,
	.vidioc_enum_freq_bands = vidioc_enum_freq_bands,
	.vidioc_log_status  = v4l2_ctrl_log_status,
	.vidioc_subscribe_event = v4l2_ctrl_subscribe_event,
	.vidioc_unsubscribe_event = v4l2_event_unsubscribe,
};

static const struct video_device tea575x_radio = {
	.ioctl_ops	= &tea575x_ioctl_ops,
	.release	= video_device_release_empty,
};

static const struct v4l2_ctrl_ops tea575x_ctrl_ops = {
	.s_ctrl = tea575x_s_ctrl,
};

int radio_tea5777_init(struct radio_tea5777 *tea, struct module *owner)
{
	int res;

	tea->write_reg = (1LL << TEA5777_W_IFCE_SHIFT) |
			 (1LL << TEA5777_W_IFW_SHIFT) |
			 (1LL << TEA5777_W_INTEXT_SHIFT) |
			 (1LL << TEA5777_W_CHP0_SHIFT) |
			 (1LL << TEA5777_W_SLEV_SHIFT);
	tea->freq = 90500 * 16;	/* 90.5Mhz default */
	tea->audmode = V4L2_TUNER_MODE_STEREO;
	res = radio_tea5777_set_freq(tea);
	if (res) {
		v4l2_err(tea->v4l2_dev, "can't set initial freq (%d)\n", res);
		return res;
	}

	tea->vd = tea575x_radio;
	video_set_drvdata(&tea->vd, tea);
	mutex_init(&tea->mutex);
	strlcpy(tea->vd.name, tea->v4l2_dev->name, sizeof(tea->vd.name));
	tea->vd.lock = &tea->mutex;
	tea->vd.v4l2_dev = tea->v4l2_dev;
	tea->fops = tea575x_fops;
	tea->fops.owner = owner;
	tea->vd.fops = &tea->fops;

	tea->vd.ctrl_handler = &tea->ctrl_handler;
	v4l2_ctrl_handler_init(&tea->ctrl_handler, 1);
	v4l2_ctrl_new_std(&tea->ctrl_handler, &tea575x_ctrl_ops,
			  V4L2_CID_AUDIO_MUTE, 0, 1, 1, 1);
	res = tea->ctrl_handler.error;
	if (res) {
		v4l2_err(tea->v4l2_dev, "can't initialize controls\n");
		v4l2_ctrl_handler_free(&tea->ctrl_handler);
		return res;
	}
	v4l2_ctrl_handler_setup(&tea->ctrl_handler);

	res = video_register_device(&tea->vd, VFL_TYPE_RADIO, -1);
	if (res) {
		v4l2_err(tea->v4l2_dev, "can't register video device!\n");
		v4l2_ctrl_handler_free(tea->vd.ctrl_handler);
		return res;
	}

	return 0;
}
EXPORT_SYMBOL_GPL(radio_tea5777_init);

void radio_tea5777_exit(struct radio_tea5777 *tea)
{
	video_unregister_device(&tea->vd);
	v4l2_ctrl_handler_free(tea->vd.ctrl_handler);
}
EXPORT_SYMBOL_GPL(radio_tea5777_exit);
Commit	Line	Data
4faba767 HG	1	/*
	2	* v4l2 driver for TEA5777 Philips AM/FM radio tuner chips
	3	*
	4	* Copyright (c) 2012 Hans de Goede <hdegoede@redhat.com>
	5	*
	6	* Based on the ALSA driver for TEA5757/5759 Philips AM/FM radio tuner chips:
	7	*
	8	* Copyright (c) 2004 Jaroslav Kysela <perex@perex.cz>
	9	*
	10	* This program is free software; you can redistribute it and/or modify
	11	* it under the terms of the GNU General Public License as published by
	12	* the Free Software Foundation; either version 2 of the License, or
	13	* (at your option) any later version.
	14	*
	15	* This program is distributed in the hope that it will be useful,
	16	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	17	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	18	* GNU General Public License for more details.
	19	*
	20	* You should have received a copy of the GNU General Public License
	21	* along with this program; if not, write to the Free Software
	22	* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
	23	*
	24	*/
	25
	26	#include <linux/delay.h>
	27	#include <linux/init.h>
	28	#include <linux/module.h>
	29	#include <linux/sched.h>
	30	#include <linux/slab.h>
	31	#include <media/v4l2-device.h>
	32	#include <media/v4l2-dev.h>
	33	#include <media/v4l2-fh.h>
	34	#include <media/v4l2-ioctl.h>
	35	#include <media/v4l2-event.h>
	36	#include "radio-tea5777.h"
	37
	38	MODULE_AUTHOR("Hans de Goede <perex@perex.cz>");
	39	MODULE_DESCRIPTION("Routines for control of TEA5777 Philips AM/FM radio tuner chips");
	40	MODULE_LICENSE("GPL");
	41
4faba767	42	#define TEA5777_FM_IF 150 /* kHz */
d7aab0bf HG	43	#define TEA5777_FM_FREQ_STEP 50 /* kHz */
	44
	45	#define TEA5777_AM_IF 21 /* kHz */
	46	#define TEA5777_AM_FREQ_STEP 1 /* kHz */
4faba767 HG	47
	48	/* Write reg, common bits */
	49	#define TEA5777_W_MUTE_MASK (1LL << 47)
	50	#define TEA5777_W_MUTE_SHIFT 47
	51	#define TEA5777_W_AM_FM_MASK (1LL << 46)
	52	#define TEA5777_W_AM_FM_SHIFT 46
	53	#define TEA5777_W_STB_MASK (1LL << 45)
	54	#define TEA5777_W_STB_SHIFT 45
	55
	56	#define TEA5777_W_IFCE_MASK (1LL << 29)
	57	#define TEA5777_W_IFCE_SHIFT 29
	58	#define TEA5777_W_IFW_MASK (1LL << 28)
	59	#define TEA5777_W_IFW_SHIFT 28
	60	#define TEA5777_W_HILO_MASK (1LL << 27)
	61	#define TEA5777_W_HILO_SHIFT 27
	62	#define TEA5777_W_DBUS_MASK (1LL << 26)
	63	#define TEA5777_W_DBUS_SHIFT 26
	64
	65	#define TEA5777_W_INTEXT_MASK (1LL << 24)
	66	#define TEA5777_W_INTEXT_SHIFT 24
	67	#define TEA5777_W_P1_MASK (1LL << 23)
	68	#define TEA5777_W_P1_SHIFT 23
	69	#define TEA5777_W_P0_MASK (1LL << 22)
	70	#define TEA5777_W_P0_SHIFT 22
	71	#define TEA5777_W_PEN1_MASK (1LL << 21)
	72	#define TEA5777_W_PEN1_SHIFT 21
	73	#define TEA5777_W_PEN0_MASK (1LL << 20)
	74	#define TEA5777_W_PEN0_SHIFT 20
	75
	76	#define TEA5777_W_CHP0_MASK (1LL << 18)
	77	#define TEA5777_W_CHP0_SHIFT 18
	78	#define TEA5777_W_DEEM_MASK (1LL << 17)
	79	#define TEA5777_W_DEEM_SHIFT 17
	80
	81	#define TEA5777_W_SEARCH_MASK (1LL << 7)
	82	#define TEA5777_W_SEARCH_SHIFT 7
	83	#define TEA5777_W_PROGBLIM_MASK (1LL << 6)
	84	#define TEA5777_W_PROGBLIM_SHIFT 6
	85	#define TEA5777_W_UPDWN_MASK (1LL << 5)
	86	#define TEA5777_W_UPDWN_SHIFT 5
	87	#define TEA5777_W_SLEV_MASK (3LL << 3)
	88	#define TEA5777_W_SLEV_SHIFT 3
	89
	90	/* Write reg, FM specific bits */
	91	#define TEA5777_W_FM_PLL_MASK (0x1fffLL << 32)
	92	#define TEA5777_W_FM_PLL_SHIFT 32
	93	#define TEA5777_W_FM_FREF_MASK (0x03LL << 30)
	94	#define TEA5777_W_FM_FREF_SHIFT 30
d7aab0bf	95	#define TEA5777_W_FM_FREF_VALUE 0LL /* 50k steps, 150k IF */
4faba767 HG	96
	97	#define TEA5777_W_FM_FORCEMONO_MASK (1LL << 15)
	98	#define TEA5777_W_FM_FORCEMONO_SHIFT 15
	99	#define TEA5777_W_FM_SDSOFF_MASK (1LL << 14)
	100	#define TEA5777_W_FM_SDSOFF_SHIFT 14
	101	#define TEA5777_W_FM_DOFF_MASK (1LL << 13)
	102	#define TEA5777_W_FM_DOFF_SHIFT 13
	103
	104	#define TEA5777_W_FM_STEP_MASK (3LL << 1)
	105	#define TEA5777_W_FM_STEP_SHIFT 1
	106
	107	/* Write reg, AM specific bits */
	108	#define TEA5777_W_AM_PLL_MASK (0x7ffLL << 34)
	109	#define TEA5777_W_AM_PLL_SHIFT 34
	110	#define TEA5777_W_AM_AGCRF_MASK (1LL << 33)
	111	#define TEA5777_W_AM_AGCRF_SHIFT 33
	112	#define TEA5777_W_AM_AGCIF_MASK (1LL << 32)
	113	#define TEA5777_W_AM_AGCIF_SHIFT 32
	114	#define TEA5777_W_AM_MWLW_MASK (1LL << 31)
	115	#define TEA5777_W_AM_MWLW_SHIFT 31
d7aab0bf HG	116	#define TEA5777_W_AM_LW 0LL
d7aab0bf HG	117	#define TEA5777_W_AM_MW 1LL
4faba767 HG	118	#define TEA5777_W_AM_LNA_MASK (1LL << 30)
	119	#define TEA5777_W_AM_LNA_SHIFT 30
	120
	121	#define TEA5777_W_AM_PEAK_MASK (1LL << 25)
	122	#define TEA5777_W_AM_PEAK_SHIFT 25
	123
	124	#define TEA5777_W_AM_RFB_MASK (1LL << 16)
	125	#define TEA5777_W_AM_RFB_SHIFT 16
	126	#define TEA5777_W_AM_CALLIGN_MASK (1LL << 15)
	127	#define TEA5777_W_AM_CALLIGN_SHIFT 15
	128	#define TEA5777_W_AM_CBANK_MASK (0x7fLL << 8)
	129	#define TEA5777_W_AM_CBANK_SHIFT 8
	130
	131	#define TEA5777_W_AM_DELAY_MASK (1LL << 2)
	132	#define TEA5777_W_AM_DELAY_SHIFT 2
	133	#define TEA5777_W_AM_STEP_MASK (1LL << 1)
	134	#define TEA5777_W_AM_STEP_SHIFT 1
	135
	136	/* Read reg, common bits */
	137	#define TEA5777_R_LEVEL_MASK (0x0f << 17)
	138	#define TEA5777_R_LEVEL_SHIFT 17
	139	#define TEA5777_R_SFOUND_MASK (0x01 << 16)
	140	#define TEA5777_R_SFOUND_SHIFT 16
	141	#define TEA5777_R_BLIM_MASK (0x01 << 15)
	142	#define TEA5777_R_BLIM_SHIFT 15
	143
	144	/* Read reg, FM specific bits */
	145	#define TEA5777_R_FM_STEREO_MASK (0x01 << 21)
	146	#define TEA5777_R_FM_STEREO_SHIFT 21
	147	#define TEA5777_R_FM_PLL_MASK 0x1fff
	148	#define TEA5777_R_FM_PLL_SHIFT 0
	149
d7aab0bf HG	150	enum { BAND_FM, BAND_AM };
	151
	152	static const struct v4l2_frequency_band bands[] = {
	153	{
	154	.type = V4L2_TUNER_RADIO,
	155	.index = 0,
	156	.capability = V4L2_TUNER_CAP_LOW \| V4L2_TUNER_CAP_STEREO \|
	157	V4L2_TUNER_CAP_FREQ_BANDS \|
	158	V4L2_TUNER_CAP_HWSEEK_BOUNDED \|
	159	V4L2_TUNER_CAP_HWSEEK_PROG_LIM,
	160	.rangelow = 76000 * 16,
	161	.rangehigh = 108000 * 16,
	162	.modulation = V4L2_BAND_MODULATION_FM,
	163	},
	164	{
	165	.type = V4L2_TUNER_RADIO,
	166	.index = 1,
	167	.capability = V4L2_TUNER_CAP_LOW \| V4L2_TUNER_CAP_FREQ_BANDS \|
	168	V4L2_TUNER_CAP_HWSEEK_BOUNDED \|
	169	V4L2_TUNER_CAP_HWSEEK_PROG_LIM,
	170	.rangelow = 530 * 16,
	171	.rangehigh = 1710 * 16,
	172	.modulation = V4L2_BAND_MODULATION_AM,
	173	},
	174	};
	175
4faba767 HG	176	static u32 tea5777_freq_to_v4l2_freq(struct radio_tea5777 *tea, u32 freq)
4faba767 HG	177	{
d7aab0bf HG	178	switch (tea->band) {
	179	case BAND_FM:
	180	return (freq * TEA5777_FM_FREQ_STEP + TEA5777_FM_IF) * 16;
	181	case BAND_AM:
	182	return (freq * TEA5777_AM_FREQ_STEP + TEA5777_AM_IF) * 16;
	183	}
	184	return 0; /* Never reached */
4faba767 HG	185	}
4faba767 HG	186
d1f280d6	187	int radio_tea5777_set_freq(struct radio_tea5777 *tea)
4faba767	188	{
4fad5c47	189	u32 freq;
4faba767 HG	190	int res;
4faba767 HG	191
d7aab0bf HG	192	freq = clamp(tea->freq, bands[tea->band].rangelow,
d7aab0bf HG	193	bands[tea->band].rangehigh);
4fad5c47	194	freq = (freq + 8) / 16; /* to kHz */
4faba767	195
d7aab0bf HG	196	switch (tea->band) {
	197	case BAND_FM:
	198	tea->write_reg &= ~TEA5777_W_AM_FM_MASK;
	199	freq = (freq - TEA5777_FM_IF) / TEA5777_FM_FREQ_STEP;
	200	tea->write_reg &= ~TEA5777_W_FM_PLL_MASK;
	201	tea->write_reg \|= (u64)freq << TEA5777_W_FM_PLL_SHIFT;
	202	tea->write_reg &= ~TEA5777_W_FM_FREF_MASK;
	203	tea->write_reg \|= TEA5777_W_FM_FREF_VALUE <<
	204	TEA5777_W_FM_FREF_SHIFT;
	205	tea->write_reg &= ~TEA5777_W_FM_FORCEMONO_MASK;
	206	if (tea->audmode == V4L2_TUNER_MODE_MONO)
	207	tea->write_reg \|= 1LL << TEA5777_W_FM_FORCEMONO_SHIFT;
	208	break;
	209	case BAND_AM:
	210	tea->write_reg &= ~TEA5777_W_AM_FM_MASK;
	211	tea->write_reg \|= (1LL << TEA5777_W_AM_FM_SHIFT);
	212	freq = (freq - TEA5777_AM_IF) / TEA5777_AM_FREQ_STEP;
	213	tea->write_reg &= ~TEA5777_W_AM_PLL_MASK;
	214	tea->write_reg \|= (u64)freq << TEA5777_W_AM_PLL_SHIFT;
	215	tea->write_reg &= ~TEA5777_W_AM_AGCRF_MASK;
	216	tea->write_reg &= ~TEA5777_W_AM_AGCRF_MASK;
	217	tea->write_reg &= ~TEA5777_W_AM_MWLW_MASK;
	218	tea->write_reg \|= TEA5777_W_AM_MW << TEA5777_W_AM_MWLW_SHIFT;
	219	tea->write_reg &= ~TEA5777_W_AM_LNA_MASK;
	220	tea->write_reg \|= 1LL << TEA5777_W_AM_LNA_SHIFT;
	221	tea->write_reg &= ~TEA5777_W_AM_PEAK_MASK;
	222	tea->write_reg \|= 1LL << TEA5777_W_AM_PEAK_SHIFT;
	223	tea->write_reg &= ~TEA5777_W_AM_CALLIGN_MASK;
	224	break;
	225	}
4faba767 HG	226
	227	res = tea->ops->write_reg(tea, tea->write_reg);
	228	if (res)
	229	return res;
	230
	231	tea->needs_write = false;
	232	tea->read_reg = -1;
	233	tea->freq = tea5777_freq_to_v4l2_freq(tea, freq);
	234
	235	return 0;
	236	}
	237
	238	static int radio_tea5777_update_read_reg(struct radio_tea5777 *tea, int wait)
	239	{
	240	int res;
	241
	242	if (tea->read_reg != -1)
	243	return 0;
	244
	245	if (tea->write_before_read && tea->needs_write) {
	246	res = radio_tea5777_set_freq(tea);
	247	if (res)
	248	return res;
	249	}
	250
	251	if (wait) {
	252	if (schedule_timeout_interruptible(msecs_to_jiffies(wait)))
	253	return -ERESTARTSYS;
	254	}
	255
	256	res = tea->ops->read_reg(tea, &tea->read_reg);
	257	if (res)
	258	return res;
	259
	260	tea->needs_write = true;
	261	return 0;
	262	}
	263
	264	/*
	265	* Linux Video interface
	266	*/
	267
	268	static int vidioc_querycap(struct file file, void priv,
	269	struct v4l2_capability *v)
	270	{
	271	struct radio_tea5777 *tea = video_drvdata(file);
	272
	273	strlcpy(v->driver, tea->v4l2_dev->name, sizeof(v->driver));
	274	strlcpy(v->card, tea->card, sizeof(v->card));
	275	strlcat(v->card, " TEA5777", sizeof(v->card));
	276	strlcpy(v->bus_info, tea->bus_info, sizeof(v->bus_info));
	277	v->device_caps = V4L2_CAP_TUNER \| V4L2_CAP_RADIO;
	278	v->device_caps \|= V4L2_CAP_HW_FREQ_SEEK;
	279	v->capabilities = v->device_caps \| V4L2_CAP_DEVICE_CAPS;
	280	return 0;
	281	}
	282
d7aab0bf HG	283	static int vidioc_enum_freq_bands(struct file file, void priv,
	284	struct v4l2_frequency_band *band)
	285	{
	286	struct radio_tea5777 *tea = video_drvdata(file);
	287
	288	if (band->tuner != 0 \|\| band->index >= ARRAY_SIZE(bands) \|\|
	289	(!tea->has_am && band->index == BAND_AM))
	290	return -EINVAL;
	291
	292	*band = bands[band->index];
	293	return 0;
	294	}
	295
4faba767 HG	296	static int vidioc_g_tuner(struct file file, void priv,
	297	struct v4l2_tuner *v)
	298	{
	299	struct radio_tea5777 *tea = video_drvdata(file);
	300	int res;
	301
	302	if (v->index > 0)
	303	return -EINVAL;
	304
	305	res = radio_tea5777_update_read_reg(tea, 0);
	306	if (res)
	307	return res;
	308
	309	memset(v, 0, sizeof(*v));
	310	if (tea->has_am)
	311	strlcpy(v->name, "AM/FM", sizeof(v->name));
	312	else
	313	strlcpy(v->name, "FM", sizeof(v->name));
	314	v->type = V4L2_TUNER_RADIO;
	315	v->capability = V4L2_TUNER_CAP_LOW \| V4L2_TUNER_CAP_STEREO \|
d7aab0bf HG	316	V4L2_TUNER_CAP_FREQ_BANDS \|
	317	V4L2_TUNER_CAP_HWSEEK_BOUNDED \|
	318	V4L2_TUNER_CAP_HWSEEK_PROG_LIM;
	319	v->rangelow = tea->has_am ? bands[BAND_AM].rangelow :
	320	bands[BAND_FM].rangelow;
	321	v->rangehigh = bands[BAND_FM].rangehigh;
	322	if (tea->band == BAND_FM &&
	323	(tea->read_reg & TEA5777_R_FM_STEREO_MASK))
	324	v->rxsubchans = V4L2_TUNER_SUB_STEREO;
	325	else
	326	v->rxsubchans = V4L2_TUNER_SUB_MONO;
	327	v->audmode = tea->audmode;
4faba767 HG	328	/* shift - 12 to convert 4-bits (0-15) scale to 16-bits (0-65535) */
	329	v->signal = (tea->read_reg & TEA5777_R_LEVEL_MASK) >>
	330	(TEA5777_R_LEVEL_SHIFT - 12);
	331
	332	/* Invalidate read_reg, so that next call we return up2date signal */
	333	tea->read_reg = -1;
	334
	335	return 0;
	336	}
	337
	338	static int vidioc_s_tuner(struct file file, void priv,
2f73c7c5	339	const struct v4l2_tuner *v)
4faba767 HG	340	{
4faba767 HG	341	struct radio_tea5777 *tea = video_drvdata(file);
d7aab0bf	342	u32 orig_audmode = tea->audmode;
4faba767 HG	343
	344	if (v->index)
	345	return -EINVAL;
	346
d7aab0bf	347	tea->audmode = v->audmode;
2f73c7c5 HV	348	if (tea->audmode > V4L2_TUNER_MODE_STEREO)
2f73c7c5 HV	349	tea->audmode = V4L2_TUNER_MODE_STEREO;
d7aab0bf HG	350
	351	if (tea->audmode != orig_audmode && tea->band == BAND_FM)
	352	return radio_tea5777_set_freq(tea);
	353
	354	return 0;
4faba767 HG	355	}
	356
	357	static int vidioc_g_frequency(struct file file, void priv,
	358	struct v4l2_frequency *f)
	359	{
	360	struct radio_tea5777 *tea = video_drvdata(file);
	361
	362	if (f->tuner != 0)
	363	return -EINVAL;
	364	f->type = V4L2_TUNER_RADIO;
	365	f->frequency = tea->freq;
	366	return 0;
	367	}
	368
	369	static int vidioc_s_frequency(struct file file, void priv,
b530a447	370	const struct v4l2_frequency *f)
4faba767 HG	371	{
	372	struct radio_tea5777 *tea = video_drvdata(file);
	373
	374	if (f->tuner != 0 \|\| f->type != V4L2_TUNER_RADIO)
	375	return -EINVAL;
	376
d7aab0bf HG	377	if (tea->has_am && f->frequency < (20000 * 16))
	378	tea->band = BAND_AM;
	379	else
	380	tea->band = BAND_FM;
	381
4faba767 HG	382	tea->freq = f->frequency;
	383	return radio_tea5777_set_freq(tea);
	384	}
	385
	386	static int vidioc_s_hw_freq_seek(struct file file, void fh,
ec6f4328	387	const struct v4l2_hw_freq_seek *a)
4faba767 HG	388	{
4faba767 HG	389	struct radio_tea5777 *tea = video_drvdata(file);
4faba767	390	unsigned long timeout;
ec6f4328 HV	391	u32 rangelow = a->rangelow;
ec6f4328 HV	392	u32 rangehigh = a->rangehigh;
d7aab0bf HG	393	int i, res, spacing;
d7aab0bf HG	394	u32 orig_freq;
4faba767 HG	395
	396	if (a->tuner \|\| a->wrap_around)
	397	return -EINVAL;
	398
617ade61 HV	399	if (file->f_flags & O_NONBLOCK)
	400	return -EWOULDBLOCK;
	401
ec6f4328	402	if (rangelow \|\| rangehigh) {
d7aab0bf HG	403	for (i = 0; i < ARRAY_SIZE(bands); i++) {
	404	if (i == BAND_AM && !tea->has_am)
	405	continue;
ec6f4328 HV	406	if (bands[i].rangelow >= rangelow &&
ec6f4328 HV	407	bands[i].rangehigh <= rangehigh)
d7aab0bf HG	408	break;
	409	}
	410	if (i == ARRAY_SIZE(bands))
	411	return -EINVAL; /* No matching band found */
	412
	413	tea->band = i;
ec6f4328 HV	414	if (tea->freq < rangelow \|\| tea->freq > rangehigh) {
	415	tea->freq = clamp(tea->freq, rangelow,
	416	rangehigh);
d7aab0bf HG	417	res = radio_tea5777_set_freq(tea);
	418	if (res)
	419	return res;
	420	}
	421	} else {
ec6f4328 HV	422	rangelow = bands[tea->band].rangelow;
ec6f4328 HV	423	rangehigh = bands[tea->band].rangehigh;
d7aab0bf HG	424	}
	425
	426	spacing = (tea->band == BAND_AM) ? (5 * 16) : (200 * 16); /* kHz */
	427	orig_freq = tea->freq;
	428
4faba767	429	tea->write_reg \|= TEA5777_W_PROGBLIM_MASK;
ec6f4328	430	if (tea->seek_rangelow != rangelow) {
4faba767	431	tea->write_reg &= ~TEA5777_W_UPDWN_MASK;
ec6f4328	432	tea->freq = rangelow;
4faba767 HG	433	res = radio_tea5777_set_freq(tea);
	434	if (res)
	435	goto leave;
ec6f4328	436	tea->seek_rangelow = rangelow;
4faba767	437	}
ec6f4328	438	if (tea->seek_rangehigh != rangehigh) {
4faba767	439	tea->write_reg \|= TEA5777_W_UPDWN_MASK;
ec6f4328	440	tea->freq = rangehigh;
4faba767 HG	441	res = radio_tea5777_set_freq(tea);
	442	if (res)
	443	goto leave;
ec6f4328	444	tea->seek_rangehigh = rangehigh;
4faba767 HG	445	}
	446	tea->write_reg &= ~TEA5777_W_PROGBLIM_MASK;
	447
	448	tea->write_reg \|= TEA5777_W_SEARCH_MASK;
	449	if (a->seek_upward) {
	450	tea->write_reg \|= TEA5777_W_UPDWN_MASK;
	451	tea->freq = orig_freq + spacing;
	452	} else {
	453	tea->write_reg &= ~TEA5777_W_UPDWN_MASK;
	454	tea->freq = orig_freq - spacing;
	455	}
	456	res = radio_tea5777_set_freq(tea);
	457	if (res)
	458	goto leave;
	459
	460	timeout = jiffies + msecs_to_jiffies(5000);
	461	for (;;) {
	462	if (time_after(jiffies, timeout)) {
	463	res = -ENODATA;
	464	break;
	465	}
	466
	467	res = radio_tea5777_update_read_reg(tea, 100);
	468	if (res)
	469	break;
	470
	471	/*
	472	* Note we use tea->freq to track how far we've searched sofar
	473	* this is necessary to ensure we continue seeking at the right
	474	* point, in the write_before_read case.
	475	*/
	476	tea->freq = (tea->read_reg & TEA5777_R_FM_PLL_MASK);
	477	tea->freq = tea5777_freq_to_v4l2_freq(tea, tea->freq);
	478
	479	if ((tea->read_reg & TEA5777_R_SFOUND_MASK)) {
	480	tea->write_reg &= ~TEA5777_W_SEARCH_MASK;
	481	return 0;
	482	}
	483
	484	if (tea->read_reg & TEA5777_R_BLIM_MASK) {
	485	res = -ENODATA;
	486	break;
	487	}
	488
	489	/* Force read_reg update */
	490	tea->read_reg = -1;
	491	}
	492	leave:
	493	tea->write_reg &= ~TEA5777_W_PROGBLIM_MASK;
	494	tea->write_reg &= ~TEA5777_W_SEARCH_MASK;
	495	tea->freq = orig_freq;
	496	radio_tea5777_set_freq(tea);
	497	return res;
	498	}
	499
	500	static int tea575x_s_ctrl(struct v4l2_ctrl *c)
	501	{
	502	struct radio_tea5777 *tea =
	503	container_of(c->handler, struct radio_tea5777, ctrl_handler);
	504
	505	switch (c->id) {
	506	case V4L2_CID_AUDIO_MUTE:
	507	if (c->val)
	508	tea->write_reg \|= TEA5777_W_MUTE_MASK;
509	else
510	tea->write_reg &= ~TEA5777_W_MUTE_MASK;
511
512	return radio_tea5777_set_freq(tea);
513	}
514
515	return -EINVAL;
516	}
517
518	static const struct v4l2_file_operations tea575x_fops = {
519	.unlocked_ioctl = video_ioctl2,
520	.open = v4l2_fh_open,
521	.release = v4l2_fh_release,
522	.poll = v4l2_ctrl_poll,
523	};
524
525	static const struct v4l2_ioctl_ops tea575x_ioctl_ops = {
526	.vidioc_querycap = vidioc_querycap,
527	.vidioc_g_tuner = vidioc_g_tuner,
528	.vidioc_s_tuner = vidioc_s_tuner,
529	.vidioc_g_frequency = vidioc_g_frequency,
530	.vidioc_s_frequency = vidioc_s_frequency,
531	.vidioc_s_hw_freq_seek = vidioc_s_hw_freq_seek,
d7aab0bf	532	.vidioc_enum_freq_bands = vidioc_enum_freq_bands,
4faba767 HG	533	.vidioc_log_status = v4l2_ctrl_log_status,
	534	.vidioc_subscribe_event = v4l2_ctrl_subscribe_event,
	535	.vidioc_unsubscribe_event = v4l2_event_unsubscribe,
	536	};
	537
	538	static const struct video_device tea575x_radio = {
	539	.ioctl_ops = &tea575x_ioctl_ops,
	540	.release = video_device_release_empty,
	541	};
	542
	543	static const struct v4l2_ctrl_ops tea575x_ctrl_ops = {
	544	.s_ctrl = tea575x_s_ctrl,
	545	};
	546
	547	int radio_tea5777_init(struct radio_tea5777 tea, struct module owner)
	548	{
	549	int res;
	550
	551	tea->write_reg = (1LL << TEA5777_W_IFCE_SHIFT) \|
	552	(1LL << TEA5777_W_IFW_SHIFT) \|
	553	(1LL << TEA5777_W_INTEXT_SHIFT) \|
	554	(1LL << TEA5777_W_CHP0_SHIFT) \|
d7aab0bf	555	(1LL << TEA5777_W_SLEV_SHIFT);
4faba767	556	tea->freq = 90500 * 16; /* 90.5Mhz default */
d7aab0bf	557	tea->audmode = V4L2_TUNER_MODE_STEREO;
4faba767 HG	558	res = radio_tea5777_set_freq(tea);
	559	if (res) {
	560	v4l2_err(tea->v4l2_dev, "can't set initial freq (%d)\n", res);
	561	return res;
	562	}
	563
	564	tea->vd = tea575x_radio;
	565	video_set_drvdata(&tea->vd, tea);
	566	mutex_init(&tea->mutex);
	567	strlcpy(tea->vd.name, tea->v4l2_dev->name, sizeof(tea->vd.name));
	568	tea->vd.lock = &tea->mutex;
	569	tea->vd.v4l2_dev = tea->v4l2_dev;
	570	tea->fops = tea575x_fops;
	571	tea->fops.owner = owner;
	572	tea->vd.fops = &tea->fops;
4faba767 HG	573
	574	tea->vd.ctrl_handler = &tea->ctrl_handler;
	575	v4l2_ctrl_handler_init(&tea->ctrl_handler, 1);
	576	v4l2_ctrl_new_std(&tea->ctrl_handler, &tea575x_ctrl_ops,
	577	V4L2_CID_AUDIO_MUTE, 0, 1, 1, 1);
	578	res = tea->ctrl_handler.error;
	579	if (res) {
	580	v4l2_err(tea->v4l2_dev, "can't initialize controls\n");
	581	v4l2_ctrl_handler_free(&tea->ctrl_handler);
	582	return res;
	583	}
	584	v4l2_ctrl_handler_setup(&tea->ctrl_handler);
	585
	586	res = video_register_device(&tea->vd, VFL_TYPE_RADIO, -1);
	587	if (res) {
	588	v4l2_err(tea->v4l2_dev, "can't register video device!\n");
	589	v4l2_ctrl_handler_free(tea->vd.ctrl_handler);
	590	return res;
	591	}
	592
	593	return 0;
	594	}
	595	EXPORT_SYMBOL_GPL(radio_tea5777_init);
	596
	597	void radio_tea5777_exit(struct radio_tea5777 *tea)
	598	{
	599	video_unregister_device(&tea->vd);
	600	v4l2_ctrl_handler_free(tea->vd.ctrl_handler);
	601	}
	602	EXPORT_SYMBOL_GPL(radio_tea5777_exit);