Re: [PATCH v4 4/6] drivers:staging: ti-st: fmdrv_rx sources

[Date Prev][Date Next][Thread Prev][Thread Next][Date Index][Thread Index]

 



On Tuesday, November 16, 2010 14:18:12 manjunatha_halli@xxxxxx wrote:
> From: Manjunatha Halli <manjunatha_halli@xxxxxx>
> 
> This has implementation for FM RX functionality.
> It communicates with FM V4l2 module and FM common module.
> 
> Signed-off-by: Manjunatha Halli <manjunatha_halli@xxxxxx>
> ---
>  drivers/staging/ti-st/fmdrv_rx.c |  979 ++++++++++++++++++++++++++++++++++++++
>  drivers/staging/ti-st/fmdrv_rx.h |   59 +++
>  2 files changed, 1038 insertions(+), 0 deletions(-)
>  create mode 100644 drivers/staging/ti-st/fmdrv_rx.c
>  create mode 100644 drivers/staging/ti-st/fmdrv_rx.h
> 
> diff --git a/drivers/staging/ti-st/fmdrv_rx.c b/drivers/staging/ti-st/fmdrv_rx.c
> new file mode 100644
> index 0000000..5f802da
> --- /dev/null
> +++ b/drivers/staging/ti-st/fmdrv_rx.c
> @@ -0,0 +1,979 @@
> +/*
> + *  FM Driver for Connectivity chip of Texas Instruments.
> + *  This sub-module of FM driver implements FM RX functionality.
> + *
> + *  Copyright (C) 2010 Texas Instruments
> + *  Author: Raja Mani <raja_mani@xxxxxx>
> + *
> + *  This program is free software; you can redistribute it and/or modify
> + *  it under the terms of the GNU General Public License version 2 as
> + *  published by the Free Software Foundation.
> + *
> + *  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 "fmdrv.h"
> +#include "fmdrv_common.h"
> +#include "fmdrv_rx.h"
> +
> +void fm_rx_reset_rds_cache(struct fmdrv_ops *fmdev)
> +{
> +	fmdev->rx.rds.flag = FM_RDS_DISABLE;
> +	fmdev->rx.rds.last_block_index = 0;
> +	fmdev->rx.rds.wr_index = 0;
> +	fmdev->rx.rds.rd_index = 0;
> +
> +	if (fmdev->rx.af_mode == FM_RX_RDS_AF_SWITCH_MODE_ON)
> +		fmdev->irq_info.mask |= FM_LEV_EVENT;
> +}
> +
> +void fm_rx_reset_curr_station_info(struct fmdrv_ops *fmdev)
> +{
> +	fmdev->rx.cur_station_info.picode = FM_NO_PI_CODE;
> +	fmdev->rx.cur_station_info.no_of_items_in_afcache = 0;
> +	fmdev->rx.cur_station_info.af_list_max = 0;
> +}
> +
> +int fm_rx_set_frequency(struct fmdrv_ops *fmdev, unsigned int freq_to_set)
> +{
> +	unsigned long timeleft;
> +	unsigned short payload, curr_frq, frq_index;
> +	unsigned int curr_frq_in_khz;
> +	int ret, resp_len;
> +
> +	if (fmdev->curr_fmmode != FM_MODE_RX)
> +		return -EPERM;
> +
> +	if (freq_to_set < fmdev->rx.region.bottom_frequency ||
> +		freq_to_set > fmdev->rx.region.top_frequency) {
> +		pr_err("(fmdrv): Invalid frequency %d\n", freq_to_set);
> +		return -EINVAL;
> +	}
> +
> +	/* Set audio enable */
> +	FM_STORE_LE16_TO_BE16(payload, FM_RX_FM_AUDIO_ENABLE_I2S_AND_ANALOG);

Why do this? You should use the cpu_to_be16 function instead. This code makes
the incorrect assumption that this will always run on a little-endian machine.
That's not necessarily true. The kernel macros do the right thing.

> +	ret = fmc_send_cmd(fmdev, AUDIO_ENABLE_SET, &payload, sizeof(payload),
> +				&fmdev->maintask_completion, NULL, NULL);

Actually, shouldn't fmc_send_cmd do this conversion instead of requiring all
callers to do it?

For that matter, is fmc_send_cmd ever called with a different completion pointer?
If it always uses maintask_completion, then that argument can be omitted.

> +	if (ret < 0) {
> +		pr_err("(fmdrv): Failed to set RX audio enable path - %d\n",
> +			ret);

Is it possible to move this error into fmc_send_cmd? That will again save a
lot of repetitive code. Something like: pr_err("(fmdrv): Command %d failed\n", cmd);

By and large I find that this driver seems to be bigger than it really needs
to be. Some tightening of the code is definitely required. It will look better
for it.

> +		return ret;
> +	}
> +
> +	/* Set hilo to automatic selection */
> +	FM_STORE_LE16_TO_BE16(payload, FM_RX_IFFREQ_HILO_AUTOMATIC);
> +	ret = fmc_send_cmd(fmdev, HILO_SET, &payload, sizeof(payload),
> +				&fmdev->maintask_completion, NULL, NULL);
> +	if (ret < 0) {
> +		pr_err("(fmdrv): Failed to set HILO to automatic selection "
> +			"- %d\n", ret);
> +		return ret;
> +	}
> +
> +	/* Calculate frequency index to write */
> +	frq_index = (freq_to_set - fmdev->rx.region.bottom_frequency) /
> +				FM_FREQ_MUL;
> +
> +	/* Set frequency index */
> +	FM_STORE_LE16_TO_BE16(payload, frq_index);
> +	ret = fmc_send_cmd(fmdev, FREQ_SET, &payload, sizeof(payload),
> +				&fmdev->maintask_completion, NULL, NULL);
> +	if (ret < 0) {
> +		pr_err("(fmdrv): Failed to set frequency index - %d\n", ret);
> +		return ret;
> +	}
> +
> +	/* Read flags - just to clear any pending interrupts if we had */
> +	ret = fmc_send_cmd(fmdev, FLAG_GET, NULL, 2,
> +				&fmdev->maintask_completion, NULL, NULL);
> +	if (ret < 0) {
> +		pr_err("(fmdrv): Failed to read interrupt flag - %d\n", ret);
> +		return ret;
> +	}
> +
> +	/* Enable FR, BL interrupts */
> +	fmdev->irq_info.mask |= (FM_FR_EVENT | FM_BL_EVENT);
> +	FM_STORE_LE16_TO_BE16(payload, fmdev->irq_info.mask);
> +	ret = fmc_send_cmd(fmdev, INT_MASK_SET, &payload, sizeof(payload),
> +				&fmdev->maintask_completion, NULL, NULL);
> +	if (ret < 0) {
> +		pr_err("(fmdrv): Failed to set interrupt mask - %d\n", ret);
> +		return ret;
> +	}
> +
> +	/* Start tune */
> +	FM_STORE_LE16_TO_BE16(payload, FM_TUNER_PRESET_MODE);
> +	ret = fmc_send_cmd(fmdev, TUNER_MODE_SET, &payload, sizeof(payload),
> +			       &fmdev->maintask_completion, NULL, NULL);
> +	if (ret < 0) {
> +		pr_err("(fmdrv): Failed to start tune operation - %d\n", ret);
> +		return ret;
> +	}
> +
> +	/* Wait for tune ended interrupt */
> +	init_completion(&fmdev->maintask_completion);
> +	timeleft = wait_for_completion_timeout(&fmdev->maintask_completion,
> +					       FM_DRV_TX_TIMEOUT);
> +	if (!timeleft) {
> +		pr_err("(fmdrv): Timeout(%d sec),didn't get tune ended int\n",
> +			   jiffies_to_msecs(FM_DRV_TX_TIMEOUT) / 1000);
> +		return -ETIMEDOUT;
> +	}
> +
> +	/* Read freq back to confirm */
> +	ret = fmc_send_cmd(fmdev, FREQ_GET, NULL, 2,
> +		&fmdev->maintask_completion, &curr_frq, &resp_len);
> +	if (ret < 0) {
> +		pr_err("(fmdrv): Failed to read current frequency - %d\n",
> +			ret);
> +		return ret;
> +	}
> +
> +	curr_frq = FM_BE16_TO_LE16(curr_frq);
> +	curr_frq_in_khz = (fmdev->rx.region.bottom_frequency
> +		+ ((unsigned int)curr_frq * FM_FREQ_MUL));
> +
> +	/* Re-enable default FM interrupts */
> +	fmdev->irq_info.mask &= ~(FM_FR_EVENT | FM_BL_EVENT);
> +	FM_STORE_LE16_TO_BE16(payload, fmdev->irq_info.mask);
> +	ret = fmc_send_cmd(fmdev, INT_MASK_SET, &payload, sizeof(payload),
> +				&fmdev->maintask_completion, NULL, NULL);
> +	if (ret < 0) {
> +		pr_err("(fmdrv): Failed to set interrupt mask - %d\n", ret);
> +		return ret;
> +	}
> +
> +	if (curr_frq_in_khz != freq_to_set) {
> +		pr_info("(fmdrv): Frequency is set to (%d) but"
> +			   " requested frequency is (%d)\n", curr_frq_in_khz,
> +			   freq_to_set);
> +	}
> +
> +	/* Update local cache  */
> +	fmdev->rx.curr_freq = curr_frq_in_khz;
> +
> +	/* Reset RDS cache and current station pointers */
> +	fm_rx_reset_rds_cache(fmdev);
> +	fm_rx_reset_curr_station_info(fmdev);
> +
> +	/* Do we need to reset anything else? */
> +
> +	return ret;
> +}
> +
> +int fm_rx_seek(struct fmdrv_ops *fmdev, unsigned int seek_upward,
> +			unsigned int wrap_around)
> +{
> +	int resp_len;
> +	unsigned short curr_frq, next_frq, last_frq;
> +	unsigned short payload, int_reason;
> +	char offset, spacing;
> +	unsigned long timeleft;
> +	int ret;
> +
> +	if (fmdev->curr_fmmode != FM_MODE_RX)
> +		return -EPERM;
> +
> +	/* Read the current frequency from chip */
> +	ret = fmc_send_cmd(fmdev, FREQ_GET, NULL, sizeof(curr_frq),
> +			&fmdev->maintask_completion, &curr_frq, &resp_len);
> +	if (ret < 0) {
> +		pr_err("(fmdrv): Failed to read current frequency - %d\n",
> +			ret);
> +		return ret;
> +	}
> +
> +	curr_frq = FM_BE16_TO_LE16(curr_frq);
> +	last_frq = (fmdev->rx.region.top_frequency -
> +	   fmdev->rx.region.bottom_frequency) / FM_FREQ_MUL;
> +
> +	/* Check the offset in order to be aligned to the channel spacing*/
> +	spacing = fmdev->rx.region.channel_spacing / FM_FREQ_MUL;
> +	offset = curr_frq % spacing;
> +
> +	next_frq = seek_upward ? curr_frq + spacing /* Seek Up */ :
> +		curr_frq - spacing /* Seek Down */ ;
> +
> +	/*
> +	 * Add or subtract offset in order to stay aligned to the channel
> +	 * spacing.
> +	 */
> +	if ((short)next_frq < 0)
> +		next_frq = last_frq - offset;
> +	else if (next_frq > last_frq)
> +		next_frq = 0 + offset;
> +
> +again:
> +	/* Set calculated next frequency to perform seek */
> +	FM_STORE_LE16_TO_BE16(payload, next_frq);
> +	ret = fmc_send_cmd(fmdev, FREQ_SET, &payload, sizeof(payload),
> +				&fmdev->maintask_completion, NULL, NULL);
> +	if (ret < 0) {
> +		pr_err("(fmdrv): Failed to set new frequency - %d\n", ret);
> +		return ret;
> +	}
> +
> +	/* Set search direction (0:Seek Down, 1:Seek Up) */
> +	FM_STORE_LE16_TO_BE16(payload, (seek_upward ? FM_SEARCH_DIRECTION_UP :
> +					FM_SEARCH_DIRECTION_DOWN));
> +	ret = fmc_send_cmd(fmdev, SEARCH_DIR_SET, &payload, sizeof(payload),
> +				&fmdev->maintask_completion, NULL, NULL);
> +	if (ret < 0) {
> +		pr_err("(fmdrv): Failed to set seek direction - %d\n", ret);
> +		return ret;
> +	}
> +
> +	/* Read flags - just to clear any pending interrupts if we had */
> +	ret = fmc_send_cmd(fmdev, FLAG_GET, NULL, 2,
> +				&fmdev->maintask_completion, NULL, NULL);
> +	if (ret < 0) {
> +		pr_err("(fmdrv): Failed to read interrupt flag - %d\n", ret);
> +		return ret;
> +	}
> +
> +	/* Enable FR, BL interrupts */
> +	fmdev->irq_info.mask |= (FM_FR_EVENT | FM_BL_EVENT);
> +	FM_STORE_LE16_TO_BE16(payload, fmdev->irq_info.mask);
> +	ret = fmc_send_cmd(fmdev, INT_MASK_SET, &payload, sizeof(payload),
> +				&fmdev->maintask_completion, NULL, NULL);
> +	if (ret < 0) {
> +		pr_err("(fmdrv): Failed to set interrupt mask - %d\n", ret);
> +		return ret;
> +	}
> +
> +	/* Start seek */
> +	FM_STORE_LE16_TO_BE16(payload, FM_TUNER_AUTONOMOUS_SEARCH_MODE);
> +	ret = fmc_send_cmd(fmdev, TUNER_MODE_SET, &payload, sizeof(payload),
> +				&fmdev->maintask_completion, NULL, NULL);
> +	if (ret < 0) {
> +		pr_err("(fmdrv): Failed to start seek operation - %d\n", ret);
> +		return ret;
> +	}
> +
> +	/* Wait for tune ended/band limit reached interrupt */
> +	init_completion(&fmdev->maintask_completion);
> +	timeleft = wait_for_completion_timeout(&fmdev->maintask_completion,
> +					       FM_DRV_RX_SEEK_TIMEOUT);
> +	if (!timeleft) {
> +		pr_err("(fmdrv): Timeout(%d sec),didn't get tune ended int\n",
> +			   jiffies_to_msecs(FM_DRV_RX_SEEK_TIMEOUT) / 1000);
> +		return -ETIMEDOUT;
> +	}
> +
> +	int_reason = fmdev->irq_info.flag & (FM_TUNE_COMPLETE | FM_BAND_LIMIT);
> +
> +	/* Re-enable default FM interrupts */
> +	fmdev->irq_info.mask &= ~(FM_FR_EVENT | FM_BL_EVENT);
> +	FM_STORE_LE16_TO_BE16(payload, fmdev->irq_info.mask);
> +	ret = fmc_send_cmd(fmdev, INT_MASK_SET, &payload, sizeof(payload),
> +				&fmdev->maintask_completion, NULL, NULL);
> +	if (ret < 0) {
> +		pr_err("(fmdrv): Failed to set interrupt mask - %d\n", ret);
> +		return ret;
> +	}
> +
> +	/* Read freq to know where operation tune operation stopped */
> +	ret = fmc_send_cmd(fmdev, FREQ_GET, NULL, 2,
> +		&fmdev->maintask_completion, &curr_frq, &resp_len);
> +	if (ret < 0) {
> +		pr_err("(fmdrv): Failed to read current frequency - %d\n",
> +			ret);
> +		return ret;
> +	}
> +
> +	curr_frq = FM_BE16_TO_LE16(curr_frq);
> +	fmdev->rx.curr_freq = (fmdev->rx.region.bottom_frequency +
> +			       ((unsigned int)curr_frq * FM_FREQ_MUL));
> +
> +	/* Reset RDS cache and current station pointers */
> +	fm_rx_reset_rds_cache(fmdev);
> +	fm_rx_reset_curr_station_info(fmdev);
> +
> +	/* Return error if band limit is reached */
> +	if (int_reason & FM_BL_EVENT) {
> +		if (!wrap_around) {
> +			ret = fmdev->rx.region.top_frequency;
> +		} else {
> +			next_frq = 1;
> +			goto again;
> +		}
> +	}
> +
> +	return ret;
> +}
> +
> +int fm_rx_set_volume(struct fmdrv_ops *fmdev, unsigned short vol_to_set)
> +{
> +	unsigned short payload;
> +	int ret;
> +
> +	if (fmdev->curr_fmmode != FM_MODE_RX)
> +		return -EPERM;
> +
> +	if (vol_to_set < FM_RX_VOLUME_MIN || vol_to_set > FM_RX_VOLUME_MAX) {
> +		pr_err("(fmdrv): Volume is not within(%d-%d) range\n",
> +			   FM_RX_VOLUME_MIN, FM_RX_VOLUME_MAX);
> +		return -EINVAL;
> +	}
> +	vol_to_set *= FM_RX_VOLUME_GAIN_STEP;
> +
> +	FM_STORE_LE16_TO_BE16(payload, vol_to_set);
> +	ret = fmc_send_cmd(fmdev, VOLUME_SET, &payload, sizeof(payload),
> +				&fmdev->maintask_completion, NULL, NULL);
> +	if (ret < 0) {
> +		pr_err("(fmdrv): Failed to set RX volume level - %d\n", ret);
> +		return ret;
> +	}
> +
> +	fmdev->rx.curr_volume = vol_to_set;
> +	return ret;
> +}
> +
> +/* Get volume */
> +int fm_rx_get_volume(struct fmdrv_ops *fmdev, unsigned short *curr_vol)
> +{
> +	if (fmdev->curr_fmmode != FM_MODE_RX)
> +		return -EPERM;
> +
> +	if (curr_vol == NULL) {
> +		pr_err("(fmdrv): Invalid memory\n");
> +		return -ENOMEM;
> +	}
> +
> +	*curr_vol = fmdev->rx.curr_volume / FM_RX_VOLUME_GAIN_STEP;
> +
> +	return 0;
> +}
> +
> +/* To get current band's bottom and top frequency */
> +int fm_rx_get_currband_freq_range(struct fmdrv_ops *fmdev,
> +					unsigned int *bottom_frequency,
> +					unsigned int *top_frequency)
> +{
> +	if (bottom_frequency != NULL)
> +		*bottom_frequency = fmdev->rx.region.bottom_frequency;
> +
> +	if (top_frequency != NULL)
> +		*top_frequency = fmdev->rx.region.top_frequency;
> +
> +	return 0;
> +}
> +
> +/* Returns current band index (0-Europe/US; 1-Japan) */
> +void fm_rx_get_region(struct fmdrv_ops *fmdev, unsigned char *region)
> +{
> +	*region = fmdev->rx.region.region_index;
> +}
> +
> +/* Sets band (0-Europe/US; 1-Japan) */
> +int fm_rx_set_region(struct fmdrv_ops *fmdev,
> +			unsigned char region_to_set)
> +{
> +	unsigned short payload;
> +	unsigned int new_frq = 0;
> +	int ret = -EPERM;
> +
> +	if (fmdev->curr_fmmode != FM_MODE_RX)
> +		return ret;
> +
> +	if (region_to_set != FM_BAND_EUROPE_US &&
> +	    region_to_set != FM_BAND_JAPAN) {
> +		pr_err("(fmdrv): Invalid band\n");
> +		return -EINVAL;
> +	}
> +
> +	if (fmdev->rx.region.region_index == region_to_set) {
> +		pr_err("(fmdrv): Requested band is already configured\n");
> +		return ret;
> +	}
> +
> +	/* Send cmd to set the band  */
> +	FM_STORE_LE16_TO_BE16(payload, (unsigned short)region_to_set);
> +	ret = fmc_send_cmd(fmdev, RX_BAND_SET, &payload, sizeof(payload),
> +				&fmdev->maintask_completion, NULL, NULL);
> +	if (ret < 0) {
> +		pr_err("(fmdrv): Failed to set FM RX band - %d\n", ret);
> +		return ret;
> +	}
> +
> +	fmc_update_region_info(fmdev, region_to_set);
> +
> +	/* Check whether current RX frequency is within band boundary */
> +	if (fmdev->rx.curr_freq < fmdev->rx.region.bottom_frequency)
> +		new_frq = fmdev->rx.region.bottom_frequency;
> +	else if (fmdev->rx.curr_freq > fmdev->rx.region.top_frequency)
> +		new_frq = fmdev->rx.region.top_frequency;
> +
> +	if (new_frq) {
> +		pr_debug("(fmdrv): "
> +		     "Current freq is not within band limit boundary,"
> +		     "switching to %d KHz\n", new_frq);
> +		/*
> +		 * Current RX frequency is not within boundary. So,
> +		 * update it.
> +		 */
> +		ret = fm_rx_set_frequency(fmdev, new_frq);
> +	}
> +
> +	return ret;
> +}
> +
> +/* Reads current mute mode (Mute Off/On/Attenuate)*/
> +int fm_rx_get_mute_mode(struct fmdrv_ops *fmdev,
> +			unsigned char *curr_mute_mode)
> +{
> +	if (fmdev->curr_fmmode != FM_MODE_RX)
> +		return -EPERM;
> +
> +	if (curr_mute_mode == NULL) {
> +		pr_err("(fmdrv): Invalid memory\n");
> +		return -ENOMEM;
> +	}
> +
> +	*curr_mute_mode = fmdev->rx.curr_mute_mode;
> +
> +	return 0;
> +}
> +
> +static int __fm_config_rx_mute_reg(struct fmdrv_ops *fmdev)
> +{
> +	unsigned short payload, muteval;
> +	int ret;
> +
> +	muteval = 0;
> +	switch (fmdev->rx.curr_mute_mode) {
> +	case FM_MUTE_ON:
> +		muteval = FM_RX_MUTE_AC_MUTE_MODE;
> +		break;
> +
> +	case FM_MUTE_OFF:
> +		muteval = FM_RX_MUTE_UNMUTE_MODE;
> +		break;
> +
> +	case FM_MUTE_ATTENUATE:
> +		muteval = FM_RX_MUTE_SOFT_MUTE_FORCE_MODE;
> +		break;
> +	}
> +	if (fmdev->rx.curr_rf_depend_mute == FM_RX_RF_DEPENDENT_MUTE_ON)
> +		muteval |= FM_RX_MUTE_RF_DEP_MODE;
> +	else
> +		muteval &= ~FM_RX_MUTE_RF_DEP_MODE;
> +
> +	FM_STORE_LE16_TO_BE16(payload, muteval);
> +	ret = fmc_send_cmd(fmdev, MUTE_STATUS_SET, &payload, sizeof(payload),
> +				&fmdev->maintask_completion, NULL, NULL);
> +	if (ret < 0) {
> +		pr_err("(fmdrv): Failed to set RX mute state - %d\n", ret);
> +		return ret;
> +	}
> +
> +	return 0;
> +}
> +
> +/* Configures mute mode (Mute Off/On/Attenuate) */
> +int fm_rx_set_mute_mode(struct fmdrv_ops *fmdev,
> +			unsigned char mute_mode_toset)
> +{
> +	unsigned char org_state;
> +	int ret;
> +
> +	if (fmdev->curr_fmmode != FM_MODE_RX)
> +		return -EPERM;
> +
> +	if (fmdev->rx.curr_mute_mode == mute_mode_toset)
> +		return 0;
> +
> +	org_state = fmdev->rx.curr_mute_mode;
> +	fmdev->rx.curr_mute_mode = mute_mode_toset;
> +
> +	ret = __fm_config_rx_mute_reg(fmdev);
> +	if (ret < 0) {
> +		fmdev->rx.curr_mute_mode = org_state;
> +		return ret;
> +	}
> +
> +	return 0;
> +}
> +
> +/* Gets RF dependent soft mute mode enable/disable status */
> +int fm_rx_get_rfdepend_softmute(struct fmdrv_ops *fmdev,
> +				unsigned char *curr_mute_mode)
> +{
> +	if (fmdev->curr_fmmode != FM_MODE_RX)
> +		return -EPERM;
> +
> +	if (curr_mute_mode == NULL) {
> +		pr_err("(fmdrv): Invalid memory\n");
> +		return -ENOMEM;
> +	}
> +
> +	*curr_mute_mode = fmdev->rx.curr_rf_depend_mute;
> +
> +	return 0;
> +}
> +
> +/* Sets RF dependent soft mute mode */
> +int fm_rx_set_rfdepend_softmute(struct fmdrv_ops *fmdev,
> +				unsigned char rfdepend_mute)
> +{
> +	unsigned char org_state;
> +	int ret;
> +
> +	if (fmdev->curr_fmmode != FM_MODE_RX)
> +		return -EPERM;
> +
> +	if (rfdepend_mute != FM_RX_RF_DEPENDENT_MUTE_ON &&
> +	    rfdepend_mute != FM_RX_RF_DEPENDENT_MUTE_OFF) {
> +		pr_err("(fmdrv): Invalid RF dependent soft mute\n");
> +		return -EINVAL;
> +	}
> +	if (fmdev->rx.curr_rf_depend_mute == rfdepend_mute)
> +		return 0;
> +
> +	org_state = fmdev->rx.curr_rf_depend_mute;
> +	fmdev->rx.curr_rf_depend_mute = rfdepend_mute;
> +
> +	ret = __fm_config_rx_mute_reg(fmdev);
> +	if (ret < 0) {
> +		fmdev->rx.curr_rf_depend_mute = org_state;
> +		return ret;
> +	}
> +
> +	return 0;
> +}
> +
> +/* Returns the signal strength level of current channel */
> +int fm_rx_get_rssi_level(struct fmdrv_ops *fmdev,
> +				unsigned short *rssilvl)
> +{
> +	unsigned short curr_rssi_lel;
> +	int resp_len;
> +	int ret;
> +
> +	if (fmdev->curr_fmmode != FM_MODE_RX)
> +		return -EPERM;
> +
> +	if (rssilvl == NULL) {
> +		pr_err("(fmdrv): Invalid memory\n");
> +		return -ENOMEM;
> +	}
> +	/* Read current RSSI level */
> +	ret = fmc_send_cmd(fmdev, RSSI_LVL_GET, NULL, 2,
> +		&fmdev->maintask_completion, &curr_rssi_lel, &resp_len);
> +	if (ret < 0) {
> +		pr_err("(fmdrv): Failed to get RSSI level - %d\n", ret);
> +		return ret;
> +	}
> +
> +	*rssilvl = FM_BE16_TO_LE16(curr_rssi_lel);
> +
> +	return 0;
> +}
> +
> +/*
> + * Sets the signal strength level that once reached
> + * will stop the auto search process
> + */
> +int fm_rx_set_rssi_threshold(struct fmdrv_ops *fmdev,
> +				short rssi_lvl_toset)
> +{
> +	unsigned short payload;
> +	int ret;
> +
> +	if (fmdev->curr_fmmode != FM_MODE_RX)
> +		return -EPERM;
> +
> +	if (rssi_lvl_toset < FM_RX_RSSI_THRESHOLD_MIN ||
> +	    rssi_lvl_toset > FM_RX_RSSI_THRESHOLD_MAX) {
> +		pr_err("(fmdrv): Invalid RSSI threshold level\n");
> +		return -EINVAL;
> +	}
> +	FM_STORE_LE16_TO_BE16(payload, (unsigned short)rssi_lvl_toset);
> +	ret = fmc_send_cmd(fmdev, SEARCH_LVL_SET, &payload, sizeof(payload),
> +				&fmdev->maintask_completion, NULL, NULL);
> +	if (ret < 0) {
> +		pr_err("(fmdrv): Failed to set RSSI level - %d\n", ret);
> +		return ret;
> +	}
> +
> +	fmdev->rx.curr_rssi_threshold = rssi_lvl_toset;
> +	return 0;
> +}
> +
> +/* Returns current RX RSSI threshold value */
> +int fm_rx_get_rssi_threshold(struct fmdrv_ops *fmdev, short *curr_rssi_lvl)
> +{
> +	if (fmdev->curr_fmmode != FM_MODE_RX)
> +		return -EPERM;
> +
> +	if (curr_rssi_lvl == NULL) {
> +		pr_err("(fmdrv): Invalid memory\n");
> +		return -ENOMEM;
> +	}
> +
> +	*curr_rssi_lvl = fmdev->rx.curr_rssi_threshold;
> +
> +	return 0;
> +}
> +
> +/* Sets RX stereo/mono modes */
> +int fm_rx_set_stereo_mono(struct fmdrv_ops *fmdev, unsigned short mode)
> +{
> +	unsigned short payload;
> +	int ret;
> +
> +	if (fmdev->curr_fmmode != FM_MODE_RX)
> +		return -EPERM;
> +
> +	if (mode != FM_STEREO_MODE && mode != FM_MONO_MODE) {
> +		pr_err("(fmdrv): Invalid mode\n");
> +		return -EINVAL;
> +	}
> +
> +	/* Set stereo/mono mode */
> +	FM_STORE_LE16_TO_BE16(payload, (unsigned short)mode);
> +	ret = fmc_send_cmd(fmdev, MOST_MODE_SET, &payload, sizeof(payload),
> +				&fmdev->maintask_completion, NULL, NULL);
> +	if (ret < 0) {
> +		pr_err("(fmdrv): Failed to set RX stereo/mono mode - %d\n",
> +			ret);
> +		return ret;
> +	}
> +
> +	/* Set stereo blending mode */
> +	FM_STORE_LE16_TO_BE16(payload, FM_STEREO_SOFT_BLEND);
> +	ret = fmc_send_cmd(fmdev, MOST_BLEND_SET, &payload, sizeof(payload),
> +				&fmdev->maintask_completion, NULL, NULL);
> +	if (ret < 0) {
> +		pr_err("(fmdrv): Failed to set RX stereo blend - %d\n", ret);
> +		return ret;
> +	}
> +
> +	return 0;
> +}
> +
> +/* Gets current RX stereo/mono mode */
> +int fm_rx_get_stereo_mono(struct fmdrv_ops *fmdev, unsigned short *mode)
> +{
> +	unsigned short curr_mode;
> +	int ret, resp_len;
> +
> +	if (fmdev->curr_fmmode != FM_MODE_RX)
> +		return -EPERM;
> +
> +	if (mode == NULL) {
> +		pr_err("(fmdrv): Invalid memory\n");
> +		return -ENOMEM;
> +	}
> +
> +	ret = fmc_send_cmd(fmdev, MOST_MODE_GET, NULL, 2,
> +			&fmdev->maintask_completion, &curr_mode, &resp_len);
> +	if (ret < 0) {
> +		pr_err("(fmdrv): Failed to get stereo/mono mode - %d\n", ret);
> +		return ret;
> +	}
> +
> +	*mode = FM_BE16_TO_LE16(curr_mode);
> +
> +	return 0;
> +}
> +
> +/* Choose RX de-emphasis filter mode (50us/75us) */
> +int fm_rx_set_deemphasis_mode(struct fmdrv_ops *fmdev, unsigned short mode)
> +{
> +	unsigned short payload;
> +	int ret;
> +
> +	if (fmdev->curr_fmmode != FM_MODE_RX)
> +		return -EPERM;
> +
> +	if (mode != FM_RX_EMPHASIS_FILTER_50_USEC &&
> +	    mode != FM_RX_EMPHASIS_FILTER_75_USEC) {
> +		pr_err("(fmdrv): Invalid rx de-emphasis mode (%d)\n", mode);
> +		return -EINVAL;
> +	}
> +
> +	FM_STORE_LE16_TO_BE16(payload, mode);
> +	ret = fmc_send_cmd(fmdev, DEMPH_MODE_SET, &payload, sizeof(payload),
> +				&fmdev->maintask_completion, NULL, NULL);
> +	if (ret < 0) {
> +		pr_err("(fmdrv): Failed to set RX deemphasis filter value - "
> +			"%d\n", ret);
> +		return ret;
> +	}
> +	fmdev->rx.curr_deemphasis_mode = mode;
> +	return 0;
> +}
> +
> +/* Gets current RX de-emphasis filter mode */
> +int fm_rx_get_deemphasis_mode(struct fmdrv_ops *fmdev,
> +				unsigned short *curr_deemphasis_mode)
> +{
> +	if (fmdev->curr_fmmode != FM_MODE_RX)
> +		return -EPERM;
> +
> +	if (curr_deemphasis_mode == NULL) {
> +		pr_err("(fmdrv): Invalid memory\n");
> +		return -ENOMEM;
> +	}
> +
> +	*curr_deemphasis_mode = fmdev->rx.curr_deemphasis_mode;
> +
> +	return 0;
> +}
> +
> +/* Enable/Disable RX RDS */
> +int fm_rx_set_rds_mode(struct fmdrv_ops *fmdev, unsigned char rds_en_dis)
> +{
> +	unsigned short payload;
> +	int ret;
> +
> +	if (fmdev->curr_fmmode != FM_MODE_RX)
> +		return -EPERM;
> +
> +	if (rds_en_dis != FM_RDS_ENABLE && rds_en_dis != FM_RDS_DISABLE) {
> +		pr_err("(fmdrv): Invalid rds option\n");
> +		return -EINVAL;
> +	}
> +
> +	if (rds_en_dis == FM_RDS_ENABLE
> +	    && fmdev->rx.rds.flag == FM_RDS_DISABLE) {
> +		/* Turn on RX RDS and RDS circuit */
> +		FM_STORE_LE16_TO_BE16(payload,
> +				      FM_RX_POWET_SET_FM_AND_RDS_BLK_ON);
> +		ret = fmc_send_cmd(fmdev, POWER_SET, &payload, sizeof(payload),
> +				&fmdev->maintask_completion, NULL, NULL);
> +		if (ret < 0) {
> +			pr_err("(fmdrv): Failed to enable RX RDS - %d\n", ret);
> +			return ret;
> +		}
> +
> +		/* Clear and reset RDS FIFO */
> +		FM_STORE_LE16_TO_BE16(payload, FM_RX_RDS_FLUSH_FIFO);
> +		ret = fmc_send_cmd(fmdev, RDS_CNTRL_SET, &payload,
> +		sizeof(payload), &fmdev->maintask_completion, NULL, NULL);
> +		if (ret < 0) {
> +			pr_err("(fmdrv): Failed to flush RX RDS fifo - %d\n",
> +				ret);
> +			return ret;
> +		}
> +
> +		/* Read flags - just to clear any pending interrupts. */
> +		ret = fmc_send_cmd(fmdev, FLAG_GET, NULL, 2,
> +				&fmdev->maintask_completion, NULL, NULL);
> +		if (ret < 0) {
> +			pr_err("(fmdrv): Failed to read interrupt flag - %d\n",
> +				ret);
> +			return ret;
> +		}
> +
> +		/* Set RDS FIFO threshold value */
> +		FM_STORE_LE16_TO_BE16(payload, FM_RX_RDS_FIFO_THRESHOLD);
> +		ret = fmc_send_cmd(fmdev, RDS_MEM_SET, &payload,
> +		sizeof(payload), &fmdev->maintask_completion, NULL, NULL);
> +		if (ret < 0) {
> +			pr_err("(fmdrv): Failed to set RX RDS fifo threshold -"
> +				" %d\n", ret);
> +			return ret;
> +		}
> +
> +		/* Enable RDS interrupt */
> +		fmdev->irq_info.mask |= FM_RDS_EVENT;
> +		FM_STORE_LE16_TO_BE16(payload, fmdev->irq_info.mask);
> +		ret = fmc_send_cmd(fmdev, INT_MASK_SET, &payload,
> +		sizeof(payload), &fmdev->maintask_completion, NULL, NULL);
> +		if (ret < 0) {
> +			pr_err("(fmdrv): Failed to set interrupt mask- %d\n",
> +				ret);
> +			fmdev->irq_info.mask &= ~FM_RDS_EVENT;
> +			return ret;
> +		}
> +
> +		/* Update our local flag */
> +		fmdev->rx.rds.flag = FM_RDS_ENABLE;
> +	} else if (rds_en_dis == FM_RDS_DISABLE
> +		   && fmdev->rx.rds.flag == FM_RDS_ENABLE) {
> +		/* Turn off RX RDS */
> +		/* Turn off RDS circuit */
> +		FM_STORE_LE16_TO_BE16(payload, FM_RX_POWER_SET_FM_ON_RDS_OFF);
> +		ret = fmc_send_cmd(fmdev, POWER_SET, &payload, sizeof(payload),
> +				&fmdev->maintask_completion, NULL, NULL);
> +		if (ret < 0) {
> +			pr_err("(fmdrv): Failed to disable RX RDS - %d\n",
> +				ret);
> +			return ret;
> +		}
> +
> +		/* Reset RDS pointers */
> +		fmdev->rx.rds.last_block_index = 0;
> +		fmdev->rx.rds.wr_index = 0;
> +		fmdev->rx.rds.rd_index = 0;
> +		fm_rx_reset_curr_station_info(fmdev);
> +
> +		/* Update RDS local cache */
> +		fmdev->irq_info.mask &= ~(FM_RDS_EVENT);
> +		fmdev->rx.rds.flag = FM_RDS_DISABLE;
> +	}
> +
> +	return 0;
> +}
> +
> +/* Returns current RX RDS enable/disable status */
> +int fm_rx_get_rds_mode(struct fmdrv_ops *fmdev,
> +			unsigned char *curr_rds_en_dis)
> +{
> +	if (fmdev->curr_fmmode != FM_MODE_RX)
> +		return -EPERM;
> +
> +	if (curr_rds_en_dis == NULL) {
> +		pr_err("(fmdrv): Invalid memory\n");
> +		return -ENOMEM;
> +	}
> +
> +	*curr_rds_en_dis = fmdev->rx.rds.flag;
> +
> +	return 0;
> +}
> +
> +/* Sets RDS operation mode (RDS/RDBS) */
> +int fm_rx_set_rds_system(struct fmdrv_ops *fmdev, unsigned char rds_mode)
> +{
> +	unsigned short payload;
> +	int ret;
> +
> +	if (fmdev->curr_fmmode != FM_MODE_RX)
> +		return -EPERM;
> +
> +	if (rds_mode != FM_RDS_SYSTEM_RDS && rds_mode != FM_RDS_SYSTEM_RBDS) {
> +		pr_err("(fmdrv): Invalid rds mode\n");
> +		return -EINVAL;
> +	}
> +	/* Set RDS operation mode */
> +	FM_STORE_LE16_TO_BE16(payload, (unsigned short)rds_mode);
> +	ret = fmc_send_cmd(fmdev, RDS_SYSTEM_SET, &payload, sizeof(payload),
> +				&fmdev->maintask_completion, NULL, NULL);
> +	if (ret < 0) {
> +		pr_err("(fmdrv): Failed to set RX RDS system - %d\n", ret);
> +		return ret;
> +	}
> +
> +	fmdev->rx.rds_mode = rds_mode;
> +
> +	return 0;
> +}
> +
> +/* Returns current RDS operation mode */
> +int fm_rx_get_rds_system(struct fmdrv_ops *fmdev,
> +				unsigned char *rds_mode)
> +{
> +	if (fmdev->curr_fmmode != FM_MODE_RX)
> +		return -EPERM;
> +
> +	if (rds_mode == NULL) {
> +		pr_err("(fmdrv): Invalid memory\n");
> +		return -ENOMEM;
> +	}
> +
> +	*rds_mode = fmdev->rx.rds_mode;
> +
> +	return 0;
> +}
> +
> +/* Configures Alternate Frequency switch mode */
> +int fm_rx_set_af_switch(struct fmdrv_ops *fmdev, unsigned char af_mode)
> +{
> +	unsigned short payload;
> +	int ret;
> +
> +	if (fmdev->curr_fmmode != FM_MODE_RX)
> +		return -EPERM;
> +
> +	if (af_mode != FM_RX_RDS_AF_SWITCH_MODE_ON &&
> +	    af_mode != FM_RX_RDS_AF_SWITCH_MODE_OFF) {
> +		pr_err("(fmdrv): Invalid af mode\n");
> +		return -EINVAL;
> +	}
> +	/* Enable/disable low RSSI interrupt based on af_mode */
> +	if (af_mode == FM_RX_RDS_AF_SWITCH_MODE_ON)
> +		fmdev->irq_info.mask |= FM_LEV_EVENT;
> +	else
> +		fmdev->irq_info.mask &= ~FM_LEV_EVENT;
> +
> +	FM_STORE_LE16_TO_BE16(payload, fmdev->irq_info.mask);
> +	ret = fmc_send_cmd(fmdev, INT_MASK_SET, &payload, sizeof(payload),
> +				&fmdev->maintask_completion, NULL, NULL);
> +	if (ret < 0) {
> +		pr_err("(fmdrv): Failed to set interrupt mask - %d\n", ret);
> +		return ret;
> +	}
> +
> +	fmdev->rx.af_mode = af_mode;
> +
> +	return 0;
> +}
> +
> +/* Returns Alternate Frequency switch status */
> +int fm_rx_get_af_switch(struct fmdrv_ops *fmdev, unsigned char *af_mode)
> +{
> +	if (fmdev->curr_fmmode != FM_MODE_RX)
> +		return -EPERM;
> +
> +	if (af_mode == NULL) {
> +		pr_err("(fmdrv): Invalid memory\n");
> +		return -ENOMEM;
> +	}
> +
> +	*af_mode = fmdev->rx.af_mode;
> +
> +	return 0;
> +}
> +
> +/* Set desired channel spacing */
> +int fm_rx_set_chanl_spacing(struct fmdrv_ops *fmdev, unsigned char spacing)
> +{
> +	unsigned short payload;
> +	int ret;
> +
> +	if (spacing != FM_CHANNEL_SPACING_50KHZ &&
> +		spacing != FM_CHANNEL_SPACING_100KHZ &&
> +		spacing != FM_CHANNEL_SPACING_200KHZ) {
> +		pr_err("Invalid channel spacing");
> +		return -EINVAL;
> +	}
> +
> +	/* set channel spacing */
> +	FM_STORE_LE16_TO_BE16(payload, spacing);
> +
> +	ret = fmc_send_cmd(fmdev, CHANL_BW_SET, &payload, sizeof(payload),
> +		&fmdev->maintask_completion, NULL, NULL);
> +	if (ret < 0)
> +		return ret;
> +
> +	fmdev->rx.region.channel_spacing = spacing * FM_FREQ_MUL;
> +
> +	return 0;
> +}
> +
> +/* Get channel spacing */
> +int fm_rx_get_chanl_spacing(struct fmdrv_ops *fmdev, unsigned char *spacing)
> +{
> +	if (fmdev->curr_fmmode != FM_MODE_RX)
> +		return -EPERM;
> +
> +	if (spacing == NULL) {
> +		pr_err("Invalid memory");
> +		return -ENOMEM;
> +	}
> +
> +	*spacing = fmdev->rx.region.channel_spacing / FM_FREQ_MUL;
> +
> +	return 0;
> +}
> diff --git a/drivers/staging/ti-st/fmdrv_rx.h b/drivers/staging/ti-st/fmdrv_rx.h
> new file mode 100644
> index 0000000..3d1490a
> --- /dev/null
> +++ b/drivers/staging/ti-st/fmdrv_rx.h
> @@ -0,0 +1,59 @@
> +/*
> + *  FM Driver for Connectivity chip of Texas Instruments.
> + *  FM RX module header.
> + *
> + *  Copyright (C) 2010 Texas Instruments
> + *
> + *  This program is free software; you can redistribute it and/or modify
> + *  it under the terms of the GNU General Public License version 2 as
> + *  published by the Free Software Foundation.
> + *
> + *  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
> + *
> + */
> +
> +#ifndef _FMDRV_RX_H
> +#define _FMDRV_RX_H
> +
> +int fm_rx_set_frequency(struct fmdrv_ops*, unsigned int);

Coding style: space before '*'

> +int fm_rx_set_mute_mode(struct fmdrv_ops*, unsigned char);
> +int fm_rx_set_stereo_mono(struct fmdrv_ops*, unsigned short);
> +int fm_rx_set_rds_mode(struct fmdrv_ops*, unsigned char);
> +int fm_rx_set_rds_system(struct fmdrv_ops *, unsigned char);
> +int fm_rx_set_volume(struct fmdrv_ops*, unsigned short);
> +int fm_rx_set_rssi_threshold(struct fmdrv_ops*, short);
> +int fm_rx_set_region(struct fmdrv_ops*, unsigned char);
> +int fm_rx_set_rfdepend_softmute(struct fmdrv_ops *, unsigned char);
> +int fm_rx_set_deemphasis_mode(struct fmdrv_ops *, unsigned short);
> +int fm_rx_set_af_switch(struct fmdrv_ops *, unsigned char);
> +
> +void fm_rx_reset_rds_cache(struct fmdrv_ops *);
> +void fm_rx_reset_curr_station_info(struct fmdrv_ops *);
> +
> +int fm_rx_seek(struct fmdrv_ops*, unsigned int, unsigned int);
> +
> +int fm_rx_get_rds_mode(struct fmdrv_ops*, unsigned char*);
> +int fm_rx_get_rds_system(struct fmdrv_ops *, unsigned char*);
> +int fm_rx_get_mute_mode(struct fmdrv_ops*, unsigned char*);
> +int fm_rx_get_volume(struct fmdrv_ops*, unsigned short*);
> +int fm_rx_get_currband_freq_range(struct fmdrv_ops*,
> +					unsigned int*, unsigned int*);
> +int fm_rx_get_stereo_mono(struct fmdrv_ops *, unsigned short*);
> +int fm_rx_get_rssi_level(struct fmdrv_ops *, unsigned short*);
> +int fm_rx_get_rssi_threshold(struct fmdrv_ops *, short*);
> +int fm_rx_get_rfdepend_softmute(struct fmdrv_ops *, unsigned char*);
> +int fm_rx_get_deemphasis_mode(struct fmdrv_ops *, unsigned short*);
> +int fm_rx_get_af_switch(struct fmdrv_ops *, unsigned char *);
> +void fm_rx_get_region(struct fmdrv_ops*, unsigned char*);
> +
> +int fm_rx_set_chanl_spacing(struct fmdrv_ops*, unsigned char);
> +int fm_rx_get_chanl_spacing(struct fmdrv_ops*, unsigned char*);
> +#endif
> +
> 

-- 
Hans Verkuil - video4linux developer - sponsored by Cisco
--
To unsubscribe from this list: send the line "unsubscribe linux-media" in
the body of a message to majordomo@xxxxxxxxxxxxxxx
More majordomo info at  http://vger.kernel.org/majordomo-info.html


[Index of Archives]     [Linux Input]     [Video for Linux]     [Gstreamer Embedded]     [Mplayer Users]     [Linux USB Devel]     [Linux Audio Users]     [Linux Kernel]     [Linux SCSI]     [Yosemite Backpacking]
  Powered by Linux