[mirror_ubuntu-artful-kernel.git] / drivers / media / radio / wl128x / fmdrv_tx.c

/*
 *  FM Driver for Connectivity chip of Texas Instruments.
 *  This sub-module of FM driver implements FM TX functionality.
 *
 *  Copyright (C) 2011 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.
 *
 */

#include <linux/delay.h>
#include "fmdrv.h"
#include "fmdrv_common.h"
#include "fmdrv_tx.h"

int fm_tx_set_stereo_mono(struct fmdev *fmdev, u16 mode)
{
	u16 payload;
	int ret;

	if (fmdev->tx_data.aud_mode == mode)
		return 0;

	fmdbg("stereo mode: %d\n", mode);

	/* Set Stereo/Mono mode */
	payload = (1 - mode);
	ret = fmc_send_cmd(fmdev, MONO_SET, REG_WR, &payload,
			sizeof(payload), NULL, NULL);
	if (ret < 0)
		return ret;

	fmdev->tx_data.aud_mode = mode;

	return ret;
}

static int set_rds_text(struct fmdev *fmdev, u8 *rds_text)
{
	u16 payload;
	int ret;

	ret = fmc_send_cmd(fmdev, RDS_DATA_SET, REG_WR, rds_text,
			strlen(rds_text), NULL, NULL);
	if (ret < 0)
		return ret;

	/* Scroll mode */
	payload = (u16)0x1;
	ret = fmc_send_cmd(fmdev, DISPLAY_MODE, REG_WR, &payload,
			sizeof(payload), NULL, NULL);
	if (ret < 0)
		return ret;

	return 0;
}

static int set_rds_data_mode(struct fmdev *fmdev, u8 mode)
{
	u16 payload;
	int ret;

	/* Setting unique PI TODO: how unique? */
	payload = (u16)0xcafe;
	ret = fmc_send_cmd(fmdev, PI_SET, REG_WR, &payload,
			sizeof(payload), NULL, NULL);
	if (ret < 0)
		return ret;

	/* Set decoder id */
	payload = (u16)0xa;
	ret = fmc_send_cmd(fmdev, DI_SET, REG_WR, &payload,
			sizeof(payload), NULL, NULL);
	if (ret < 0)
		return ret;

	/* TODO: RDS_MODE_GET? */
	return 0;
}

static int set_rds_len(struct fmdev *fmdev, u8 type, u16 len)
{
	u16 payload;
	int ret;

	len |= type << 8;
	payload = len;
	ret = fmc_send_cmd(fmdev, RDS_CONFIG_DATA_SET, REG_WR, &payload,
			sizeof(payload), NULL, NULL);
	if (ret < 0)
		return ret;

	/* TODO: LENGTH_GET? */
	return 0;
}

int fm_tx_set_rds_mode(struct fmdev *fmdev, u8 rds_en_dis)
{
	u16 payload;
	int ret;
	u8 rds_text[] = "Zoom2\n";

	fmdbg("rds_en_dis:%d(E:%d, D:%d)\n", rds_en_dis,
		   FM_RDS_ENABLE, FM_RDS_DISABLE);

	if (rds_en_dis == FM_RDS_ENABLE) {
		/* Set RDS length */
		set_rds_len(fmdev, 0, strlen(rds_text));

		/* Set RDS text */
		set_rds_text(fmdev, rds_text);

		/* Set RDS mode */
		set_rds_data_mode(fmdev, 0x0);
	}

	/* Send command to enable RDS */
	if (rds_en_dis == FM_RDS_ENABLE)
		payload = 0x01;
	else
		payload = 0x00;

	ret = fmc_send_cmd(fmdev, RDS_DATA_ENB, REG_WR, &payload,
			sizeof(payload), NULL, NULL);
	if (ret < 0)
		return ret;

	if (rds_en_dis == FM_RDS_ENABLE) {
		/* Set RDS length */
		set_rds_len(fmdev, 0, strlen(rds_text));

		/* Set RDS text */
		set_rds_text(fmdev, rds_text);
	}
	fmdev->tx_data.rds.flag = rds_en_dis;

	return 0;
}

int fm_tx_set_radio_text(struct fmdev *fmdev, u8 *rds_text, u8 rds_type)
{
	u16 payload;
	int ret;

	if (fmdev->curr_fmmode != FM_MODE_TX)
		return -EPERM;

	fm_tx_set_rds_mode(fmdev, 0);

	/* Set RDS length */
	set_rds_len(fmdev, rds_type, strlen(rds_text));

	/* Set RDS text */
	set_rds_text(fmdev, rds_text);

	/* Set RDS mode */
	set_rds_data_mode(fmdev, 0x0);

	payload = 1;
	ret = fmc_send_cmd(fmdev, RDS_DATA_ENB, REG_WR, &payload,
			sizeof(payload), NULL, NULL);
	if (ret < 0)
		return ret;

	return 0;
}

int fm_tx_set_af(struct fmdev *fmdev, u32 af)
{
	u16 payload;
	int ret;

	if (fmdev->curr_fmmode != FM_MODE_TX)
		return -EPERM;

	fmdbg("AF: %d\n", af);

	af = (af - 87500) / 100;
	payload = (u16)af;
	ret = fmc_send_cmd(fmdev, TA_SET, REG_WR, &payload,
			sizeof(payload), NULL, NULL);
	if (ret < 0)
		return ret;

	return 0;
}

int fm_tx_set_region(struct fmdev *fmdev, u8 region)
{
	u16 payload;
	int ret;

	if (region != FM_BAND_EUROPE_US && region != FM_BAND_JAPAN) {
		fmerr("Invalid band\n");
		return -EINVAL;
	}

	/* Send command to set the band */
	payload = (u16)region;
	ret = fmc_send_cmd(fmdev, TX_BAND_SET, REG_WR, &payload,
			sizeof(payload), NULL, NULL);
	if (ret < 0)
		return ret;

	return 0;
}

int fm_tx_set_mute_mode(struct fmdev *fmdev, u8 mute_mode_toset)
{
	u16 payload;
	int ret;

	fmdbg("tx: mute mode %d\n", mute_mode_toset);

	payload = mute_mode_toset;
	ret = fmc_send_cmd(fmdev, MUTE, REG_WR, &payload,
			sizeof(payload), NULL, NULL);
	if (ret < 0)
		return ret;

	return 0;
}

/* Set TX Audio I/O */
static int set_audio_io(struct fmdev *fmdev)
{
	struct fmtx_data *tx = &fmdev->tx_data;
	u16 payload;
	int ret;

	/* Set Audio I/O Enable */
	payload = tx->audio_io;
	ret = fmc_send_cmd(fmdev, AUDIO_IO_SET, REG_WR, &payload,
			sizeof(payload), NULL, NULL);
	if (ret < 0)
		return ret;

	/* TODO: is audio set? */
	return 0;
}

/* Start TX Transmission */
static int enable_xmit(struct fmdev *fmdev, u8 new_xmit_state)
{
	struct fmtx_data *tx = &fmdev->tx_data;
	unsigned long timeleft;
	u16 payload;
	int ret;

	/* Enable POWER_ENB interrupts */
	payload = FM_POW_ENB_EVENT;
	ret = fmc_send_cmd(fmdev, INT_MASK_SET, REG_WR, &payload,
			sizeof(payload), NULL, NULL);
	if (ret < 0)
		return ret;

	/* Set Power Enable */
	payload = new_xmit_state;
	ret = fmc_send_cmd(fmdev, POWER_ENB_SET, REG_WR, &payload,
			sizeof(payload), NULL, NULL);
	if (ret < 0)
		return ret;

	/* Wait for Power Enabled */
	init_completion(&fmdev->maintask_comp);
	timeleft = wait_for_completion_timeout(&fmdev->maintask_comp,
			FM_DRV_TX_TIMEOUT);
	if (!timeleft) {
		fmerr("Timeout(%d sec),didn't get tune ended interrupt\n",
			   jiffies_to_msecs(FM_DRV_TX_TIMEOUT) / 1000);
		return -ETIMEDOUT;
	}

	set_bit(FM_CORE_TX_XMITING, &fmdev->flag);
	tx->xmit_state = new_xmit_state;

	return 0;
}

/* Set TX power level */
int fm_tx_set_pwr_lvl(struct fmdev *fmdev, u8 new_pwr_lvl)
{
	u16 payload;
	struct fmtx_data *tx = &fmdev->tx_data;
	int ret;

	if (fmdev->curr_fmmode != FM_MODE_TX)
		return -EPERM;
	fmdbg("tx: pwr_level_to_set %ld\n", (long int)new_pwr_lvl);

	/* If the core isn't ready update global variable */
	if (!test_bit(FM_CORE_READY, &fmdev->flag)) {
		tx->pwr_lvl = new_pwr_lvl;
		return 0;
	}

	/* Set power level: Application will specify power level value in
	 * units of dB/uV, whereas range and step are specific to FM chip.
	 * For TI's WL chips, convert application specified power level value
	 * to chip specific value by subtracting 122 from it. Refer to TI FM
	 * data sheet for details.
	 * */

	payload = (FM_PWR_LVL_HIGH - new_pwr_lvl);
	ret = fmc_send_cmd(fmdev, POWER_LEV_SET, REG_WR, &payload,
			sizeof(payload), NULL, NULL);
	if (ret < 0)
		return ret;

	/* TODO: is the power level set? */
	tx->pwr_lvl = new_pwr_lvl;

	return 0;
}

/*
 * Sets FM TX pre-emphasis filter value (OFF, 50us, or 75us)
 * Convert V4L2 specified filter values to chip specific filter values.
 */
int fm_tx_set_preemph_filter(struct fmdev *fmdev, u32 preemphasis)
{
	struct fmtx_data *tx = &fmdev->tx_data;
	u16 payload;
	int ret;

	if (fmdev->curr_fmmode != FM_MODE_TX)
		return -EPERM;

	switch (preemphasis) {
	case V4L2_PREEMPHASIS_DISABLED:
		payload = FM_TX_PREEMPH_OFF;
		break;
	case V4L2_PREEMPHASIS_50_uS:
		payload = FM_TX_PREEMPH_50US;
		break;
	case V4L2_PREEMPHASIS_75_uS:
		payload = FM_TX_PREEMPH_75US;
		break;
	}

	ret = fmc_send_cmd(fmdev, PREMPH_SET, REG_WR, &payload,
			sizeof(payload), NULL, NULL);
	if (ret < 0)
		return ret;

	tx->preemph = payload;

	return ret;
}

/* Get the TX tuning capacitor value.*/
int fm_tx_get_tune_cap_val(struct fmdev *fmdev)
{
	u16 curr_val;
	u32 resp_len;
	int ret;

	if (fmdev->curr_fmmode != FM_MODE_TX)
		return -EPERM;

	ret = fmc_send_cmd(fmdev, READ_FMANT_TUNE_VALUE, REG_RD,
			NULL, sizeof(curr_val), &curr_val, &resp_len);
	if (ret < 0)
		return ret;

	curr_val = be16_to_cpu((__force __be16)curr_val);

	return curr_val;
}

/* Set TX Frequency */
int fm_tx_set_freq(struct fmdev *fmdev, u32 freq_to_set)
{
	struct fmtx_data *tx = &fmdev->tx_data;
	u16 payload, chanl_index;
	int ret;

	if (test_bit(FM_CORE_TX_XMITING, &fmdev->flag)) {
		enable_xmit(fmdev, 0);
		clear_bit(FM_CORE_TX_XMITING, &fmdev->flag);
	}

	/* Enable FR, BL interrupts */
	payload = (FM_FR_EVENT | FM_BL_EVENT);
	ret = fmc_send_cmd(fmdev, INT_MASK_SET, REG_WR, &payload,
			sizeof(payload), NULL, NULL);
	if (ret < 0)
		return ret;

	tx->tx_frq = (unsigned long)freq_to_set;
	fmdbg("tx: freq_to_set %ld\n", (long int)tx->tx_frq);

	chanl_index = freq_to_set / 10;

	/* Set current tuner channel */
	payload = chanl_index;
	ret = fmc_send_cmd(fmdev, CHANL_SET, REG_WR, &payload,
			sizeof(payload), NULL, NULL);
	if (ret < 0)
		return ret;

	fm_tx_set_pwr_lvl(fmdev, tx->pwr_lvl);
	fm_tx_set_preemph_filter(fmdev, tx->preemph);

	tx->audio_io = 0x01;	/* I2S */
	set_audio_io(fmdev);

	enable_xmit(fmdev, 0x01);	/* Enable transmission */

	tx->aud_mode = FM_STEREO_MODE;
	tx->rds.flag = FM_RDS_DISABLE;

	return 0;
}
Commit	Line	Data
8b7a186c MH	1	/*
	2	* FM Driver for Connectivity chip of Texas Instruments.
	3	* This sub-module of FM driver implements FM TX functionality.
	4	*
	5	* Copyright (C) 2011 Texas Instruments
	6	*
	7	* This program is free software; you can redistribute it and/or modify
	8	* it under the terms of the GNU General Public License version 2 as
	9	* published by the Free Software Foundation.
	10	*
	11	* This program is distributed in the hope that it will be useful,
	12	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	13	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	14	* GNU General Public License for more details.
	15	*
8b7a186c MH	16	*/
	17
	18	#include <linux/delay.h>
	19	#include "fmdrv.h"
	20	#include "fmdrv_common.h"
	21	#include "fmdrv_tx.h"
	22
8cc20dd8	23	int fm_tx_set_stereo_mono(struct fmdev *fmdev, u16 mode)
8b7a186c MH	24	{
8b7a186c MH	25	u16 payload;
8cc20dd8	26	int ret;
8b7a186c MH	27
	28	if (fmdev->tx_data.aud_mode == mode)
	29	return 0;
	30
	31	fmdbg("stereo mode: %d\n", mode);
	32
	33	/* Set Stereo/Mono mode */
	34	payload = (1 - mode);
	35	ret = fmc_send_cmd(fmdev, MONO_SET, REG_WR, &payload,
	36	sizeof(payload), NULL, NULL);
	37	if (ret < 0)
	38	return ret;
	39
	40	fmdev->tx_data.aud_mode = mode;
	41
	42	return ret;
	43	}
	44
8cc20dd8	45	static int set_rds_text(struct fmdev fmdev, u8 rds_text)
8b7a186c MH	46	{
8b7a186c MH	47	u16 payload;
8cc20dd8	48	int ret;
8b7a186c MH	49
	50	ret = fmc_send_cmd(fmdev, RDS_DATA_SET, REG_WR, rds_text,
	51	strlen(rds_text), NULL, NULL);
	52	if (ret < 0)
	53	return ret;
	54
	55	/* Scroll mode */
	56	payload = (u16)0x1;
	57	ret = fmc_send_cmd(fmdev, DISPLAY_MODE, REG_WR, &payload,
	58	sizeof(payload), NULL, NULL);
	59	if (ret < 0)
	60	return ret;
	61
	62	return 0;
	63	}
	64
8cc20dd8	65	static int set_rds_data_mode(struct fmdev *fmdev, u8 mode)
8b7a186c MH	66	{
8b7a186c MH	67	u16 payload;
8cc20dd8	68	int ret;
8b7a186c MH	69
	70	/* Setting unique PI TODO: how unique? */
	71	payload = (u16)0xcafe;
	72	ret = fmc_send_cmd(fmdev, PI_SET, REG_WR, &payload,
	73	sizeof(payload), NULL, NULL);
	74	if (ret < 0)
	75	return ret;
	76
	77	/* Set decoder id */
	78	payload = (u16)0xa;
	79	ret = fmc_send_cmd(fmdev, DI_SET, REG_WR, &payload,
	80	sizeof(payload), NULL, NULL);
	81	if (ret < 0)
	82	return ret;
	83
	84	/* TODO: RDS_MODE_GET? */
	85	return 0;
	86	}
	87
8cc20dd8	88	static int set_rds_len(struct fmdev *fmdev, u8 type, u16 len)
8b7a186c MH	89	{
8b7a186c MH	90	u16 payload;
8cc20dd8	91	int ret;
8b7a186c MH	92
	93	len \|= type << 8;
	94	payload = len;
	95	ret = fmc_send_cmd(fmdev, RDS_CONFIG_DATA_SET, REG_WR, &payload,
	96	sizeof(payload), NULL, NULL);
	97	if (ret < 0)
	98	return ret;
	99
	100	/* TODO: LENGTH_GET? */
	101	return 0;
	102	}
	103
8cc20dd8	104	int fm_tx_set_rds_mode(struct fmdev *fmdev, u8 rds_en_dis)
8b7a186c MH	105	{
8b7a186c MH	106	u16 payload;
8cc20dd8	107	int ret;
8b7a186c MH	108	u8 rds_text[] = "Zoom2\n";
	109
	110	fmdbg("rds_en_dis:%d(E:%d, D:%d)\n", rds_en_dis,
	111	FM_RDS_ENABLE, FM_RDS_DISABLE);
	112
	113	if (rds_en_dis == FM_RDS_ENABLE) {
	114	/* Set RDS length */
	115	set_rds_len(fmdev, 0, strlen(rds_text));
	116
	117	/* Set RDS text */
	118	set_rds_text(fmdev, rds_text);
	119
	120	/* Set RDS mode */
	121	set_rds_data_mode(fmdev, 0x0);
	122	}
	123
	124	/* Send command to enable RDS */
	125	if (rds_en_dis == FM_RDS_ENABLE)
	126	payload = 0x01;
	127	else
	128	payload = 0x00;
	129
	130	ret = fmc_send_cmd(fmdev, RDS_DATA_ENB, REG_WR, &payload,
	131	sizeof(payload), NULL, NULL);
	132	if (ret < 0)
	133	return ret;
	134
	135	if (rds_en_dis == FM_RDS_ENABLE) {
	136	/* Set RDS length */
	137	set_rds_len(fmdev, 0, strlen(rds_text));
	138
	139	/* Set RDS text */
	140	set_rds_text(fmdev, rds_text);
	141	}
	142	fmdev->tx_data.rds.flag = rds_en_dis;
	143
	144	return 0;
	145	}
	146
8cc20dd8	147	int fm_tx_set_radio_text(struct fmdev fmdev, u8 rds_text, u8 rds_type)
8b7a186c MH	148	{
8b7a186c MH	149	u16 payload;
8cc20dd8	150	int ret;
8b7a186c MH	151
	152	if (fmdev->curr_fmmode != FM_MODE_TX)
	153	return -EPERM;
	154
	155	fm_tx_set_rds_mode(fmdev, 0);
	156
	157	/* Set RDS length */
	158	set_rds_len(fmdev, rds_type, strlen(rds_text));
	159
	160	/* Set RDS text */
	161	set_rds_text(fmdev, rds_text);
	162
	163	/* Set RDS mode */
	164	set_rds_data_mode(fmdev, 0x0);
	165
	166	payload = 1;
	167	ret = fmc_send_cmd(fmdev, RDS_DATA_ENB, REG_WR, &payload,
	168	sizeof(payload), NULL, NULL);
	169	if (ret < 0)
	170	return ret;
	171
	172	return 0;
	173	}
	174
8cc20dd8	175	int fm_tx_set_af(struct fmdev *fmdev, u32 af)
8b7a186c MH	176	{
8b7a186c MH	177	u16 payload;
8cc20dd8	178	int ret;
8b7a186c MH	179
	180	if (fmdev->curr_fmmode != FM_MODE_TX)
	181	return -EPERM;
	182
	183	fmdbg("AF: %d\n", af);
	184
	185	af = (af - 87500) / 100;
	186	payload = (u16)af;
	187	ret = fmc_send_cmd(fmdev, TA_SET, REG_WR, &payload,
	188	sizeof(payload), NULL, NULL);
	189	if (ret < 0)
	190	return ret;
	191
	192	return 0;
	193	}
	194
8cc20dd8	195	int fm_tx_set_region(struct fmdev *fmdev, u8 region)
8b7a186c MH	196	{
8b7a186c MH	197	u16 payload;
8cc20dd8	198	int ret;
8b7a186c MH	199
	200	if (region != FM_BAND_EUROPE_US && region != FM_BAND_JAPAN) {
	201	fmerr("Invalid band\n");
	202	return -EINVAL;
	203	}
	204
	205	/* Send command to set the band */
	206	payload = (u16)region;
	207	ret = fmc_send_cmd(fmdev, TX_BAND_SET, REG_WR, &payload,
	208	sizeof(payload), NULL, NULL);
	209	if (ret < 0)
	210	return ret;
	211
	212	return 0;
	213	}
	214
8cc20dd8	215	int fm_tx_set_mute_mode(struct fmdev *fmdev, u8 mute_mode_toset)
8b7a186c MH	216	{
8b7a186c MH	217	u16 payload;
8cc20dd8	218	int ret;
8b7a186c MH	219
	220	fmdbg("tx: mute mode %d\n", mute_mode_toset);
	221
	222	payload = mute_mode_toset;
	223	ret = fmc_send_cmd(fmdev, MUTE, REG_WR, &payload,
	224	sizeof(payload), NULL, NULL);
	225	if (ret < 0)
	226	return ret;
	227
	228	return 0;
	229	}
	230
	231	/* Set TX Audio I/O */
8cc20dd8	232	static int set_audio_io(struct fmdev *fmdev)
8b7a186c MH	233	{
	234	struct fmtx_data *tx = &fmdev->tx_data;
	235	u16 payload;
8cc20dd8	236	int ret;
8b7a186c MH	237
	238	/* Set Audio I/O Enable */
	239	payload = tx->audio_io;
	240	ret = fmc_send_cmd(fmdev, AUDIO_IO_SET, REG_WR, &payload,
	241	sizeof(payload), NULL, NULL);
	242	if (ret < 0)
	243	return ret;
	244
	245	/* TODO: is audio set? */
	246	return 0;
	247	}
	248
	249	/* Start TX Transmission */
8cc20dd8	250	static int enable_xmit(struct fmdev *fmdev, u8 new_xmit_state)
8b7a186c MH	251	{
	252	struct fmtx_data *tx = &fmdev->tx_data;
	253	unsigned long timeleft;
	254	u16 payload;
8cc20dd8	255	int ret;
8b7a186c MH	256
	257	/* Enable POWER_ENB interrupts */
	258	payload = FM_POW_ENB_EVENT;
	259	ret = fmc_send_cmd(fmdev, INT_MASK_SET, REG_WR, &payload,
	260	sizeof(payload), NULL, NULL);
	261	if (ret < 0)
	262	return ret;
	263
	264	/* Set Power Enable */
	265	payload = new_xmit_state;
	266	ret = fmc_send_cmd(fmdev, POWER_ENB_SET, REG_WR, &payload,
	267	sizeof(payload), NULL, NULL);
	268	if (ret < 0)
	269	return ret;
	270
	271	/* Wait for Power Enabled */
	272	init_completion(&fmdev->maintask_comp);
	273	timeleft = wait_for_completion_timeout(&fmdev->maintask_comp,
	274	FM_DRV_TX_TIMEOUT);
	275	if (!timeleft) {
	276	fmerr("Timeout(%d sec),didn't get tune ended interrupt\n",
	277	jiffies_to_msecs(FM_DRV_TX_TIMEOUT) / 1000);
	278	return -ETIMEDOUT;
	279	}
	280
	281	set_bit(FM_CORE_TX_XMITING, &fmdev->flag);
	282	tx->xmit_state = new_xmit_state;
	283
	284	return 0;
	285	}
	286
	287	/* Set TX power level */
8cc20dd8	288	int fm_tx_set_pwr_lvl(struct fmdev *fmdev, u8 new_pwr_lvl)
8b7a186c MH	289	{
	290	u16 payload;
	291	struct fmtx_data *tx = &fmdev->tx_data;
8cc20dd8	292	int ret;
8b7a186c MH	293
	294	if (fmdev->curr_fmmode != FM_MODE_TX)
	295	return -EPERM;
	296	fmdbg("tx: pwr_level_to_set %ld\n", (long int)new_pwr_lvl);
	297
	298	/* If the core isn't ready update global variable */
	299	if (!test_bit(FM_CORE_READY, &fmdev->flag)) {
	300	tx->pwr_lvl = new_pwr_lvl;
	301	return 0;
	302	}
	303
	304	/* Set power level: Application will specify power level value in
	305	* units of dB/uV, whereas range and step are specific to FM chip.
	306	* For TI's WL chips, convert application specified power level value
	307	* to chip specific value by subtracting 122 from it. Refer to TI FM
	308	* data sheet for details.
	309	* */
	310
	311	payload = (FM_PWR_LVL_HIGH - new_pwr_lvl);
	312	ret = fmc_send_cmd(fmdev, POWER_LEV_SET, REG_WR, &payload,
	313	sizeof(payload), NULL, NULL);
	314	if (ret < 0)
	315	return ret;
	316
	317	/* TODO: is the power level set? */
	318	tx->pwr_lvl = new_pwr_lvl;
	319
	320	return 0;
	321	}
	322
	323	/*
	324	* Sets FM TX pre-emphasis filter value (OFF, 50us, or 75us)
	325	* Convert V4L2 specified filter values to chip specific filter values.
	326	*/
8cc20dd8	327	int fm_tx_set_preemph_filter(struct fmdev *fmdev, u32 preemphasis)
8b7a186c MH	328	{
	329	struct fmtx_data *tx = &fmdev->tx_data;
	330	u16 payload;
8cc20dd8	331	int ret;
8b7a186c MH	332
	333	if (fmdev->curr_fmmode != FM_MODE_TX)
	334	return -EPERM;
	335
	336	switch (preemphasis) {
	337	case V4L2_PREEMPHASIS_DISABLED:
	338	payload = FM_TX_PREEMPH_OFF;
	339	break;
	340	case V4L2_PREEMPHASIS_50_uS:
	341	payload = FM_TX_PREEMPH_50US;
	342	break;
	343	case V4L2_PREEMPHASIS_75_uS:
	344	payload = FM_TX_PREEMPH_75US;
	345	break;
	346	}
	347
	348	ret = fmc_send_cmd(fmdev, PREMPH_SET, REG_WR, &payload,
	349	sizeof(payload), NULL, NULL);
	350	if (ret < 0)
	351	return ret;
	352
	353	tx->preemph = payload;
	354
	355	return ret;
	356	}
	357
	358	/* Get the TX tuning capacitor value.*/
8cc20dd8	359	int fm_tx_get_tune_cap_val(struct fmdev *fmdev)
8b7a186c MH	360	{
8b7a186c MH	361	u16 curr_val;
8cc20dd8 XW	362	u32 resp_len;
8cc20dd8 XW	363	int ret;
8b7a186c MH	364
	365	if (fmdev->curr_fmmode != FM_MODE_TX)
	366	return -EPERM;
	367
	368	ret = fmc_send_cmd(fmdev, READ_FMANT_TUNE_VALUE, REG_RD,
	369	NULL, sizeof(curr_val), &curr_val, &resp_len);
	370	if (ret < 0)
	371	return ret;
	372
2a8b7e58	373	curr_val = be16_to_cpu((__force __be16)curr_val);
8b7a186c MH	374
	375	return curr_val;
	376	}
	377
	378	/* Set TX Frequency */
8cc20dd8	379	int fm_tx_set_freq(struct fmdev *fmdev, u32 freq_to_set)
8b7a186c MH	380	{
	381	struct fmtx_data *tx = &fmdev->tx_data;
	382	u16 payload, chanl_index;
8cc20dd8	383	int ret;
8b7a186c MH	384
	385	if (test_bit(FM_CORE_TX_XMITING, &fmdev->flag)) {
	386	enable_xmit(fmdev, 0);
	387	clear_bit(FM_CORE_TX_XMITING, &fmdev->flag);
	388	}
	389
	390	/* Enable FR, BL interrupts */
	391	payload = (FM_FR_EVENT \| FM_BL_EVENT);
	392	ret = fmc_send_cmd(fmdev, INT_MASK_SET, REG_WR, &payload,
	393	sizeof(payload), NULL, NULL);
	394	if (ret < 0)
	395	return ret;
	396
	397	tx->tx_frq = (unsigned long)freq_to_set;
	398	fmdbg("tx: freq_to_set %ld\n", (long int)tx->tx_frq);
	399
	400	chanl_index = freq_to_set / 10;
	401
	402	/* Set current tuner channel */
	403	payload = chanl_index;
	404	ret = fmc_send_cmd(fmdev, CHANL_SET, REG_WR, &payload,
	405	sizeof(payload), NULL, NULL);
	406	if (ret < 0)
	407	return ret;
	408
	409	fm_tx_set_pwr_lvl(fmdev, tx->pwr_lvl);
	410	fm_tx_set_preemph_filter(fmdev, tx->preemph);
	411
	412	tx->audio_io = 0x01; /* I2S */
	413	set_audio_io(fmdev);
	414
	415	enable_xmit(fmdev, 0x01); /* Enable transmission */
	416
	417	tx->aud_mode = FM_STEREO_MODE;
	418	tx->rds.flag = FM_RDS_DISABLE;
	419
	420	return 0;
	421	}
	422