android_kernel_samsung_heroqlte/drivers/media/radio/radio-iris.c

/* Copyright (c) 2011-2015, The Linux Foundation. All rights reserved
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License version 2 and
 * only 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.
 */

#define DRIVER_NAME "radio-iris"
#define DRIVER_CARD "QTI FM Radio Transceiver"
#define DRIVER_DESC "Driver for QTI FM Radio Transceiver "

#include <linux/version.h>
#include <linux/init.h>
#include <linux/delay.h>
#include <linux/uaccess.h>
#include <linux/kfifo.h>
#include <linux/param.h>
#include <linux/interrupt.h>
#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/sched.h>
#include <linux/version.h>
#include <linux/videodev2.h>
#include <linux/mutex.h>
#include <linux/unistd.h>
#include <linux/atomic.h>
#include <linux/platform_device.h>
#include <linux/workqueue.h>
#include <linux/slab.h>
#include <media/v4l2-common.h>
#include <media/v4l2-device.h>
#include <media/v4l2-ioctl.h>
#include <media/radio-iris.h>
#include <asm/unaligned.h>

static unsigned int rds_buf = 100;
static int oda_agt;
static int grp_mask;
static int rt_plus_carrier = -1;
static int ert_carrier = -1;
static unsigned char ert_buf[256];
static unsigned char ert_len;
static unsigned char c_byt_pair_index;
static char utf_8_flag;
static char rt_ert_flag;
static char formatting_dir;
static unsigned char sig_blend = CTRL_ON;
static DEFINE_MUTEX(iris_fm);

module_param(rds_buf, uint, 0);
MODULE_PARM_DESC(rds_buf, "RDS buffer entries: *100*");

module_param(sig_blend, byte, S_IWUSR | S_IRUGO);
MODULE_PARM_DESC(sig_blend, "signal blending switch: 0:OFF 1:ON");

static void radio_hci_cmd_task(unsigned long arg);
static void radio_hci_rx_task(unsigned long arg);
static struct video_device *video_get_dev(void);
static DEFINE_RWLOCK(hci_task_lock);

struct iris_device {
	struct device *dev;
	struct kfifo data_buf[IRIS_BUF_MAX];

	int pending_xfrs[IRIS_XFR_MAX];
	int xfr_bytes_left;
	int xfr_in_progress;
	struct completion sync_xfr_start;
	int tune_req;
	unsigned int mode;

	__u16 pi;
	__u8 pty;
	__u8 ps_repeatcount;
	__u8 prev_trans_rds;
	__u8 af_jump_bit;
	struct video_device *videodev;
	struct v4l2_device v4l2_dev;

	struct mutex lock;
	spinlock_t buf_lock[IRIS_BUF_MAX];
	wait_queue_head_t event_queue;
	wait_queue_head_t read_queue;

	struct radio_hci_dev *fm_hdev;

	struct v4l2_capability g_cap;
	struct v4l2_control *g_ctl;

	struct hci_fm_mute_mode_req mute_mode;
	struct hci_fm_stereo_mode_req stereo_mode;
	struct hci_fm_station_rsp fm_st_rsp;
	struct hci_fm_search_station_req srch_st;
	struct hci_fm_search_rds_station_req srch_rds;
	struct hci_fm_search_station_list_req srch_st_list;
	struct hci_fm_recv_conf_req recv_conf;
	struct hci_fm_trans_conf_req_struct trans_conf;
	struct hci_fm_rds_grp_req rds_grp;
	unsigned char g_search_mode;
	unsigned char power_mode;
	int search_on;
	unsigned int tone_freq;
	unsigned char spur_table_size;
	unsigned char g_scan_time;
	unsigned int g_antenna;
	unsigned int g_rds_grp_proc_ps;
	unsigned char event_mask;
	enum iris_region_t region;
	struct hci_fm_dbg_param_rsp st_dbg_param;
	struct hci_ev_srch_list_compl srch_st_result;
	struct hci_fm_riva_poke   riva_data_req;
	struct hci_fm_ssbi_req    ssbi_data_accs;
	struct hci_fm_ssbi_peek   ssbi_peek_reg;
	struct hci_fm_sig_threshold_rsp sig_th;
	struct hci_fm_ch_det_threshold ch_det_threshold;
	struct hci_fm_data_rd_rsp default_data;
	struct hci_fm_spur_data spur_data;
	unsigned char is_station_valid;
	struct hci_fm_blend_table blend_tbl;
};

static struct video_device *priv_videodev;
static int iris_do_calibration(struct iris_device *radio);
static void hci_buff_ert(struct iris_device *radio,
		struct rds_grp_data *rds_buf);
static void hci_ev_rt_plus(struct iris_device *radio,
		struct rds_grp_data rds_buf);
static void hci_ev_ert(struct iris_device *radio);
static int update_spur_table(struct iris_device *radio);
static int initialise_recv(struct iris_device *radio);
static int initialise_trans(struct iris_device *radio);
static int is_enable_rx_possible(struct iris_device *radio);
static int is_enable_tx_possible(struct iris_device *radio);

static struct v4l2_queryctrl iris_v4l2_queryctrl[] = {
	{
	.id	= V4L2_CID_AUDIO_VOLUME,
	.type	= V4L2_CTRL_TYPE_INTEGER,
	.name	= "Volume",
	.minimum	= 0,
	.maximum	= 15,
	.step	=	1,
	.default_value	=	15,
	},
	{
	.id	=	V4L2_CID_AUDIO_BALANCE,
	.flags	= V4L2_CTRL_FLAG_DISABLED,
	},
	{
	.id	=	V4L2_CID_AUDIO_BASS,
	.flags	=	V4L2_CTRL_FLAG_DISABLED,
	},
	{
	.id	=	V4L2_CID_AUDIO_TREBLE,
	.flags	=	V4L2_CTRL_FLAG_DISABLED,
	},
	{
	.id	=	V4L2_CID_AUDIO_MUTE,
	.type	=	V4L2_CTRL_TYPE_BOOLEAN,
	.name	=	"Mute",
	.minimum	=	0,
	.maximum	=	1,
	.step	=	1,
	.default_value	= 1,
	},
	{
	.id	=	V4L2_CID_AUDIO_LOUDNESS,
	.flags	=	V4L2_CTRL_FLAG_DISABLED,
	},
	{
	.id	=	V4L2_CID_PRIVATE_IRIS_SRCHMODE,
	.type	=	V4L2_CTRL_TYPE_INTEGER,
	.name	=	"Search mode",
	.minimum	=	0,
	.maximum	= 7,
	.step	= 1,
	.default_value	= 0,
	},
	{
	.id	= V4L2_CID_PRIVATE_IRIS_SCANDWELL,
	.type	= V4L2_CTRL_TYPE_INTEGER,
	.name	=	"Search dwell time",
	.minimum	= 0,
	.maximum	= 7,
	.step	= 1,
	.default_value	= 0,
	},
	{
	.id	= V4L2_CID_PRIVATE_IRIS_SRCHON,
	.type	= V4L2_CTRL_TYPE_BOOLEAN,
	.name	= "Search on/off",
	.minimum	= 0,
	.maximum	= 1,
	.step	= 1,
	.default_value	= 1,

	},
	{
	.id	=	V4L2_CID_PRIVATE_IRIS_STATE,
	.type	= V4L2_CTRL_TYPE_INTEGER,
	.name	= "radio 0ff/rx/tx/reset",
	.minimum	= 0,
	.maximum	= 3,
	.step	= 1,
	.default_value	=	1,

	},
	{
	.id	= V4L2_CID_PRIVATE_IRIS_REGION,
	.type	= V4L2_CTRL_TYPE_INTEGER,
	.name	=	"radio standard",
	.minimum	=	0,
	.maximum	=	2,
	.step	=	1,
	.default_value	=	0,
	},
	{
	.id	=	V4L2_CID_PRIVATE_IRIS_SIGNAL_TH,
	.type	=	V4L2_CTRL_TYPE_INTEGER,
	.name	=	"Signal Threshold",
	.minimum	=	0x80,
	.maximum	=	0x7F,
	.step	=	1,
	.default_value	=	0,
	},
	{
	.id	=	V4L2_CID_PRIVATE_IRIS_SRCH_PTY,
	.type	=	V4L2_CTRL_TYPE_INTEGER,
	.name	=	"Search PTY",
	.minimum	=	0,
	.maximum	=	31,
	.default_value	=	0,
	},
	{
	.id	=	V4L2_CID_PRIVATE_IRIS_SRCH_PI,
	.type	=	V4L2_CTRL_TYPE_INTEGER,
	.name	=	"Search PI",
	.minimum	=	0,
	.maximum	=	0xFF,
	.default_value	=	0,
	},
	{
	.id	=	V4L2_CID_PRIVATE_IRIS_SRCH_CNT,
	.type	=	V4L2_CTRL_TYPE_INTEGER,
	.name	=	"Preset num",
	.minimum	=	0,
	.maximum	=	12,
	.default_value	=	0,
	},
	{
	.id	=	V4L2_CID_PRIVATE_IRIS_EMPHASIS,
	.type	=	V4L2_CTRL_TYPE_BOOLEAN,
	.name	=	"Emphasis",
	.minimum	=	0,
	.maximum	=	1,
	.default_value	=	0,
	},
	{
	.id	=	V4L2_CID_PRIVATE_IRIS_RDS_STD,
	.type	=	V4L2_CTRL_TYPE_BOOLEAN,
	.name	=	"RDS standard",
	.minimum	=	0,
	.maximum	=	1,
	.default_value	=	0,
	},
	{
	.id	=	V4L2_CID_PRIVATE_IRIS_SPACING,
	.type	=	V4L2_CTRL_TYPE_INTEGER,
	.name	=	"Channel spacing",
	.minimum	=	0,
	.maximum	=	2,
	.default_value	=	0,
	},
	{
	.id	=	V4L2_CID_PRIVATE_IRIS_RDSON,
	.type	=	V4L2_CTRL_TYPE_BOOLEAN,
	.name	=	"RDS on/off",
	.minimum	=	0,
	.maximum	=	1,
	.default_value	=	0,
	},
	{
	.id	=	V4L2_CID_PRIVATE_IRIS_RDSGROUP_MASK,
	.type	=	V4L2_CTRL_TYPE_INTEGER,
	.name	=	"RDS group mask",
	.minimum	=	0,
	.maximum	=	0xFFFFFFFF,
	.default_value	=	0,
	},
	{
	.id	=	V4L2_CID_PRIVATE_IRIS_RDSGROUP_PROC,
	.type	=	V4L2_CTRL_TYPE_INTEGER,
	.name	=	"RDS processing",
	.minimum	=	0,
	.maximum	=	0xFF,
	.default_value	=	0,
	},
	{
	.id	=	V4L2_CID_PRIVATE_IRIS_RDSD_BUF,
	.type	=	V4L2_CTRL_TYPE_INTEGER,
	.name	=	"RDS data groups to buffer",
	.minimum	=	1,
	.maximum	=	21,
	.default_value	=	0,
	},
	{
	.id	=	V4L2_CID_PRIVATE_IRIS_PSALL,
	.type	=	V4L2_CTRL_TYPE_BOOLEAN,
	.name	=	"pass all ps strings",
	.minimum	=	0,
	.maximum	=	1,
	.default_value	=	0,
	},
	{
	.id	=	V4L2_CID_PRIVATE_IRIS_LP_MODE,
	.type	=	V4L2_CTRL_TYPE_BOOLEAN,
	.name	=	"Low power mode",
	.minimum	=	0,
	.maximum	=	1,
	.default_value	=	0,
	},
	{
	.id	=	V4L2_CID_PRIVATE_IRIS_ANTENNA,
	.type	=	V4L2_CTRL_TYPE_BOOLEAN,
	.name	=	"headset/internal",
	.minimum	=	0,
	.maximum	=	1,
	.default_value	=	0,
	},
	{
	.id	=	V4L2_CID_PRIVATE_IRIS_TX_SETPSREPEATCOUNT,
	.type	=	V4L2_CTRL_TYPE_INTEGER,
	.name	=	"Set PS REPEATCOUNT",
	.minimum	=	0,
	.maximum	=	15,
	},
	{
	.id	=	V4L2_CID_PRIVATE_IRIS_STOP_RDS_TX_PS_NAME,
	.type	=	V4L2_CTRL_TYPE_BOOLEAN,
	.name	=	"Stop PS NAME",
	.minimum	=	0,
	.maximum	=	1,
	},
	{
	.id	=	V4L2_CID_PRIVATE_IRIS_STOP_RDS_TX_RT,
	.type	=	V4L2_CTRL_TYPE_BOOLEAN,
	.name	=	"Stop RT",
	.minimum	=	0,
	.maximum	=	1,
	},
	{
	.id	=	V4L2_CID_PRIVATE_IRIS_SOFT_MUTE,
	.type	=	V4L2_CTRL_TYPE_BOOLEAN,
	.name	=	"Soft Mute",
	.minimum	=	0,
	.maximum	=	1,
	},
	{
	.id	=	V4L2_CID_PRIVATE_IRIS_RIVA_ACCS_ADDR,
	.type	=	V4L2_CTRL_TYPE_BOOLEAN,
	.name	=	"Riva addr",
	.minimum	=	0x3180000,
	.maximum	=	0x31E0004,
	},
	{
	.id	=	V4L2_CID_PRIVATE_IRIS_RIVA_ACCS_LEN,
	.type	=	V4L2_CTRL_TYPE_INTEGER,
	.name	=	"Data len",
	.minimum	=	0,
	.maximum	=	0xFF,
	},
	{
	.id	=	V4L2_CID_PRIVATE_IRIS_RIVA_PEEK,
	.type	=	V4L2_CTRL_TYPE_BOOLEAN,
	.name	=	"Riva peek",
	.minimum	=	0,
	.maximum	=	1,
	},
	{
	.id	=	V4L2_CID_PRIVATE_IRIS_RIVA_POKE,
	.type	=	V4L2_CTRL_TYPE_INTEGER,
	.name	=	"Riva poke",
	.minimum	=	0x3180000,
	.maximum	=	0x31E0004,
	},
	{
	.id	=	V4L2_CID_PRIVATE_IRIS_SSBI_ACCS_ADDR,
	.type	=	V4L2_CTRL_TYPE_INTEGER,
	.name	=	"Ssbi addr",
	.minimum	=	0x280,
	.maximum	=	0x37F,
	},
	{
	.id	=	V4L2_CID_PRIVATE_IRIS_SSBI_PEEK,
	.type	=	V4L2_CTRL_TYPE_INTEGER,
	.name	=	"Ssbi peek",
	.minimum	=	0,
	.maximum	=	0x37F,
	},
	{
	.id	=	V4L2_CID_PRIVATE_IRIS_SSBI_POKE,
	.type	=	V4L2_CTRL_TYPE_INTEGER,
	.name	=	"ssbi poke",
	.minimum	=	0x01,
	.maximum	=	0xFF,
	},
	{
	.id =	 V4L2_CID_PRIVATE_IRIS_HLSI,
	.type	=	V4L2_CTRL_TYPE_INTEGER,
	.name	=	"set hlsi",
	.minimum	=	0,
	.maximum	=	2,
	},
	{
	.id =	 V4L2_CID_PRIVATE_IRIS_RDS_GRP_COUNTERS,
	.type	=	V4L2_CTRL_TYPE_BOOLEAN,
	.name	=	"RDS grp",
	.minimum	=	0,
	.maximum	=	1,
	},
	{
	.id	=	V4L2_CID_PRIVATE_IRIS_SET_NOTCH_FILTER,
	.type	=	V4L2_CTRL_TYPE_INTEGER,
	.name	=	"Notch filter",
	.minimum	=	0,
	.maximum	=	2,
	},
	{
	.id	=	V4L2_CID_PRIVATE_IRIS_READ_DEFAULT,
	.type	=	V4L2_CTRL_TYPE_INTEGER,
	.name	=	"Read default",
	},
	{
	.id	=	V4L2_CID_PRIVATE_IRIS_WRITE_DEFAULT,
	.type	=	V4L2_CTRL_TYPE_INTEGER,
	.name	=	"Write default",
	},
	{
	.id	=	V4L2_CID_PRIVATE_IRIS_SET_CALIBRATION,
	.type	=	V4L2_CTRL_TYPE_BOOLEAN,
	.name	=	"SET Calibration",
	.minimum	=	0,
	.maximum	=	1,
	},
	{
	.id	=	V4L2_CID_PRIVATE_IRIS_DO_CALIBRATION,
	.type	=	V4L2_CTRL_TYPE_BOOLEAN,
	.name	=	"SET Calibration",
	.minimum	=	0,
	.maximum	=	1,
	},
	{
	.id     =       V4L2_CID_PRIVATE_IRIS_GET_SINR,
	.type   =       V4L2_CTRL_TYPE_INTEGER,
	.name   =       "GET SINR",
	.minimum        =       -128,
	.maximum        =       127,
	},
	{
	.id     =       V4L2_CID_PRIVATE_INTF_HIGH_THRESHOLD,
	.type   =       V4L2_CTRL_TYPE_INTEGER,
	.name   =       "Intf High Threshold",
	.minimum        =       0,
	.maximum        =       0xFF,
	.default_value  =       0,
	},
	{
	.id     =       V4L2_CID_PRIVATE_INTF_LOW_THRESHOLD,
	.type   =       V4L2_CTRL_TYPE_INTEGER,
	.name   =       "Intf low Threshold",
	.minimum        =       0,
	.maximum        =       0xFF,
	.default_value  =       0,
	},
	{
	.id     =       V4L2_CID_PRIVATE_SINR_THRESHOLD,
	.type   =       V4L2_CTRL_TYPE_INTEGER,
	.name   =       "SINR Threshold",
	.minimum        =       -128,
	.maximum        =       127,
	.default_value  =       0,
	},
	{
	.id     =       V4L2_CID_PRIVATE_SINR_SAMPLES,
	.type   =       V4L2_CTRL_TYPE_INTEGER,
	.name   =       "SINR samples",
	.minimum        =       1,
	.maximum        =       0xFF,
	.default_value  =       0,
	},
};

static void iris_q_event(struct iris_device *radio,
				enum iris_evt_t event)
{
	struct kfifo *data_b;
	unsigned char evt = event;

	if (unlikely(radio == NULL)) {
		FMDERR(":radio is null");
		return;
	}

	data_b = &radio->data_buf[IRIS_BUF_EVENTS];
	if (kfifo_in_locked(data_b, &evt, 1, &radio->buf_lock[IRIS_BUF_EVENTS]))
		wake_up_interruptible(&radio->event_queue);
}

static int hci_send_frame(struct sk_buff *skb)
{
	struct radio_hci_dev *hdev;

	if (unlikely(skb == NULL)) {
		FMDERR("%s, socket buffer is null\n", __func__);
		return -EINVAL;
	}
	hdev = (struct radio_hci_dev *) skb->dev;
	if (unlikely(!hdev)) {
		kfree_skb(skb);
		return -ENODEV;
	}

	__net_timestamp(skb);

	skb_orphan(skb);
	return hdev->send(skb);
}

static void radio_hci_cmd_task(unsigned long arg)
{
	struct radio_hci_dev *hdev = (struct radio_hci_dev *) arg;
	struct sk_buff *skb;

	if (unlikely(hdev == NULL)) {
		FMDERR("%s, HCI Device is null\n", __func__);
		return;
	}
	if (!(atomic_read(&hdev->cmd_cnt))
		&& time_after(jiffies, hdev->cmd_last_tx + HZ)) {
		FMDERR("%s command tx timeout", hdev->name);
		atomic_set(&hdev->cmd_cnt, 1);
	}

	skb = skb_dequeue(&hdev->cmd_q);
	if (atomic_read(&hdev->cmd_cnt) && skb) {
		kfree_skb(hdev->sent_cmd);
		hdev->sent_cmd = skb_clone(skb, GFP_ATOMIC);
		if (hdev->sent_cmd) {
			atomic_dec(&hdev->cmd_cnt);
			hci_send_frame(skb);
			hdev->cmd_last_tx = jiffies;
		} else {
			skb_queue_head(&hdev->cmd_q, skb);
			tasklet_schedule(&hdev->cmd_task);
		}
	}

}

static void radio_hci_rx_task(unsigned long arg)
{
	struct radio_hci_dev *hdev = (struct radio_hci_dev *) arg;
	struct sk_buff *skb;

	if (unlikely(hdev == NULL)) {
		FMDERR("%s, HCI Device is null\n", __func__);
		return;
	}
	read_lock(&hci_task_lock);

	skb = skb_dequeue(&hdev->rx_q);
	radio_hci_event_packet(hdev, skb);

	read_unlock(&hci_task_lock);
}

int radio_hci_register_dev(struct radio_hci_dev *hdev)
{
	struct iris_device *radio = video_get_drvdata(video_get_dev());

	if (!radio) {
		FMDERR(":radio is null");
		return -EINVAL;
	}

	if (!hdev) {
		FMDERR("hdev is null");
		return -EINVAL;
	}

	hdev->flags = 0;

	tasklet_init(&hdev->cmd_task, radio_hci_cmd_task, (unsigned long)
		hdev);
	tasklet_init(&hdev->rx_task, radio_hci_rx_task, (unsigned long)
		hdev);

	init_waitqueue_head(&hdev->req_wait_q);

	skb_queue_head_init(&hdev->rx_q);
	skb_queue_head_init(&hdev->cmd_q);
	skb_queue_head_init(&hdev->raw_q);


	radio->fm_hdev = hdev;

	return 0;
}
EXPORT_SYMBOL(radio_hci_register_dev);

int radio_hci_unregister_dev(struct radio_hci_dev *hdev)
{
	struct iris_device *radio = video_get_drvdata(video_get_dev());

	if (!radio) {
		FMDERR(":radio is null");
		return -EINVAL;
	}

	tasklet_kill(&hdev->rx_task);
	tasklet_kill(&hdev->cmd_task);
	skb_queue_purge(&hdev->rx_q);
	skb_queue_purge(&hdev->cmd_q);
	skb_queue_purge(&hdev->raw_q);
	kfree(radio->fm_hdev);
	kfree(radio->videodev);

	return 0;
}
EXPORT_SYMBOL(radio_hci_unregister_dev);

int radio_hci_recv_frame(struct sk_buff *skb)
{
	struct radio_hci_dev *hdev;

	if (unlikely(skb == NULL)) {
		FMDERR("%s, socket buffer is null\n", __func__);
		return -EINVAL;
	}
	hdev = (struct radio_hci_dev *) skb->dev;
	if (unlikely(!hdev)) {
		FMDERR("%s hdev is null while receiving frame", hdev->name);
		kfree_skb(skb);
		return -ENXIO;
	}

	__net_timestamp(skb);

	radio_hci_event_packet(hdev, skb);
	kfree_skb(skb);
	return 0;
}
EXPORT_SYMBOL(radio_hci_recv_frame);

int radio_hci_send_cmd(struct radio_hci_dev *hdev, __u16 opcode, __u32 plen,
		void *param)
{
	int len = RADIO_HCI_COMMAND_HDR_SIZE + plen;
	struct radio_hci_command_hdr *hdr;
	struct sk_buff *skb;
	int ret = 0;

	if (unlikely(hdev == NULL)) {
		FMDERR("%s, hci device is null\n", __func__);
		return -EINVAL;
	}
	skb = alloc_skb(len, GFP_ATOMIC);
	if (!skb) {
		FMDERR("%s no memory for command", hdev->name);
		return -ENOMEM;
	}

	hdr = (struct radio_hci_command_hdr *) skb_put(skb,
		RADIO_HCI_COMMAND_HDR_SIZE);
	hdr->opcode = cpu_to_le16(opcode);
	hdr->plen   = plen;

	if (plen)
		memcpy(skb_put(skb, plen), param, plen);

	skb->dev = (void *) hdev;

	ret = hci_send_frame(skb);

	return ret;
}
EXPORT_SYMBOL(radio_hci_send_cmd);

static int hci_fm_enable_recv_req(struct radio_hci_dev *hdev,
	unsigned long param)
{
	__u16 opcode = 0;

	opcode = hci_opcode_pack(HCI_OGF_FM_RECV_CTRL_CMD_REQ,
		HCI_OCF_FM_ENABLE_RECV_REQ);
	return radio_hci_send_cmd(hdev, opcode, 0, NULL);
}

static int hci_fm_tone_generator(struct radio_hci_dev *hdev,
	unsigned long param)
{
	struct iris_device *radio = video_get_drvdata(video_get_dev());
	__u16 opcode = 0;

	if (unlikely(radio == NULL)) {
		FMDERR(":radio is null");
		return -EINVAL;
	}
	opcode = hci_opcode_pack(HCI_OGF_FM_DIAGNOSTIC_CMD_REQ,
		HCI_FM_SET_INTERNAL_TONE_GENRATOR);
	return radio_hci_send_cmd(hdev, opcode,
			sizeof(radio->tone_freq), &radio->tone_freq);
}

static int hci_fm_enable_trans_req(struct radio_hci_dev *hdev,
	unsigned long param)
{
	__u16 opcode = 0;

	opcode = hci_opcode_pack(HCI_OGF_FM_TRANS_CTRL_CMD_REQ,
		HCI_OCF_FM_ENABLE_TRANS_REQ);
	return radio_hci_send_cmd(hdev, opcode, 0, NULL);
}

static int hci_fm_disable_recv_req(struct radio_hci_dev *hdev,
	unsigned long param)
{
	__u16 opcode = 0;

	opcode = hci_opcode_pack(HCI_OGF_FM_RECV_CTRL_CMD_REQ,
		HCI_OCF_FM_DISABLE_RECV_REQ);
	return radio_hci_send_cmd(hdev, opcode, 0, NULL);
}

static int hci_fm_disable_trans_req(struct radio_hci_dev *hdev,
	unsigned long param)
{
	__u16 opcode = 0;

	opcode = hci_opcode_pack(HCI_OGF_FM_TRANS_CTRL_CMD_REQ,
		HCI_OCF_FM_DISABLE_TRANS_REQ);
	return radio_hci_send_cmd(hdev, opcode, 0, NULL);
}

static int hci_get_fm_recv_conf_req(struct radio_hci_dev *hdev,
	unsigned long param)
{
	__u16 opcode = 0;

	opcode = hci_opcode_pack(HCI_OGF_FM_RECV_CTRL_CMD_REQ,
		HCI_OCF_FM_GET_RECV_CONF_REQ);
	return radio_hci_send_cmd(hdev, opcode, 0, NULL);
}

static int hci_get_fm_trans_conf_req(struct radio_hci_dev *hdev,
	unsigned long param)
{
	u16 opcode = 0;

	opcode = hci_opcode_pack(HCI_OGF_FM_TRANS_CTRL_CMD_REQ,
		HCI_OCF_FM_GET_TRANS_CONF_REQ);
	return radio_hci_send_cmd(hdev, opcode, 0, NULL);
}
static int hci_set_fm_recv_conf_req(struct radio_hci_dev *hdev,
	unsigned long param)
{
	__u16 opcode = 0;

	struct hci_fm_recv_conf_req *recv_conf_req =
		(struct hci_fm_recv_conf_req *) param;

	if (recv_conf_req == NULL) {
		FMDERR("%s, recv conf is null\n", __func__);
		return -EINVAL;
	}
	opcode = hci_opcode_pack(HCI_OGF_FM_RECV_CTRL_CMD_REQ,
		HCI_OCF_FM_SET_RECV_CONF_REQ);
	return radio_hci_send_cmd(hdev, opcode, sizeof((*recv_conf_req)),
		recv_conf_req);
}

static int hci_set_fm_trans_conf_req(struct radio_hci_dev *hdev,
	unsigned long param)
{
	__u16 opcode = 0;

	struct hci_fm_trans_conf_req_struct *trans_conf_req =
		(struct hci_fm_trans_conf_req_struct *) param;

	if (trans_conf_req == NULL) {
		FMDERR("%s, tx conf is null\n", __func__);
		return -EINVAL;
	}

	opcode = hci_opcode_pack(HCI_OGF_FM_TRANS_CTRL_CMD_REQ,
		HCI_OCF_FM_SET_TRANS_CONF_REQ);
	return radio_hci_send_cmd(hdev, opcode, sizeof((*trans_conf_req)),
		trans_conf_req);
}

static int hci_fm_get_station_param_req(struct radio_hci_dev *hdev,
		unsigned long param)
{
	__u16 opcode = 0;

	opcode = hci_opcode_pack(HCI_OGF_FM_RECV_CTRL_CMD_REQ,
		HCI_OCF_FM_GET_STATION_PARAM_REQ);
	return radio_hci_send_cmd(hdev, opcode, 0, NULL);
}

static int hci_set_fm_mute_mode_req(struct radio_hci_dev *hdev,
		unsigned long param)
{
	__u16 opcode = 0;
	struct hci_fm_mute_mode_req *mute_mode_req =
		(struct hci_fm_mute_mode_req *) param;

	if (mute_mode_req == NULL) {
		FMDERR("%s, mute mode is null\n", __func__);
		return -EINVAL;
	}
	opcode = hci_opcode_pack(HCI_OGF_FM_RECV_CTRL_CMD_REQ,
		HCI_OCF_FM_SET_MUTE_MODE_REQ);
	return radio_hci_send_cmd(hdev, opcode, sizeof((*mute_mode_req)),
		mute_mode_req);
}


static int hci_trans_ps_req(struct radio_hci_dev *hdev,
		unsigned long param)
{
	__u16 opcode = 0;
	struct hci_fm_tx_ps *tx_ps_req =
		(struct hci_fm_tx_ps *) param;

	if (tx_ps_req == NULL) {
		FMDERR("%s, tx ps req is null\n", __func__);
		return -EINVAL;
	}
	opcode = hci_opcode_pack(HCI_OGF_FM_TRANS_CTRL_CMD_REQ,
		HCI_OCF_FM_RDS_PS_REQ);

	return radio_hci_send_cmd(hdev, opcode, sizeof((*tx_ps_req)),
		tx_ps_req);
}

static int hci_trans_rt_req(struct radio_hci_dev *hdev,
		unsigned long param)
{
	__u16 opcode = 0;
	struct hci_fm_tx_rt *tx_rt_req =
		(struct hci_fm_tx_rt *) param;

	if (tx_rt_req == NULL) {
		FMDERR("%s, tx rt req is null\n", __func__);
		return -EINVAL;
	}
	opcode = hci_opcode_pack(HCI_OGF_FM_TRANS_CTRL_CMD_REQ,
		HCI_OCF_FM_RDS_RT_REQ);

	return radio_hci_send_cmd(hdev, opcode, sizeof((*tx_rt_req)),
		tx_rt_req);
}

static int hci_set_fm_stereo_mode_req(struct radio_hci_dev *hdev,
		unsigned long param)
{
	__u16 opcode = 0;
	struct hci_fm_stereo_mode_req *stereo_mode_req =
		(struct hci_fm_stereo_mode_req *) param;

	if (stereo_mode_req == NULL) {
		FMDERR("%s, stere mode req is null\n", __func__);
		return -EINVAL;
	}
	opcode = hci_opcode_pack(HCI_OGF_FM_RECV_CTRL_CMD_REQ,
		HCI_OCF_FM_SET_STEREO_MODE_REQ);
	return radio_hci_send_cmd(hdev, opcode, sizeof((*stereo_mode_req)),
		stereo_mode_req);
}

static int hci_fm_set_antenna_req(struct radio_hci_dev *hdev,
	unsigned long param)
{
	__u16 opcode = 0;

	__u8 antenna = param;

	opcode = hci_opcode_pack(HCI_OGF_FM_RECV_CTRL_CMD_REQ,
		HCI_OCF_FM_SET_ANTENNA);
	return radio_hci_send_cmd(hdev, opcode, sizeof(antenna), &antenna);
}

static int hci_fm_set_sig_threshold_req(struct radio_hci_dev *hdev,
		unsigned long param)
{
	__u16 opcode = 0;

	__u8 sig_threshold = param;

	opcode = hci_opcode_pack(HCI_OGF_FM_RECV_CTRL_CMD_REQ,
		HCI_OCF_FM_SET_SIGNAL_THRESHOLD);
	return radio_hci_send_cmd(hdev, opcode, sizeof(sig_threshold),
		&sig_threshold);
}

static int hci_fm_set_event_mask(struct radio_hci_dev *hdev,
		unsigned long param)
{
	u16 opcode = 0;
	u8 event_mask = param;

	opcode = hci_opcode_pack(HCI_OGF_FM_RECV_CTRL_CMD_REQ,
		HCI_OCF_FM_SET_EVENT_MASK);
	return radio_hci_send_cmd(hdev, opcode, sizeof(event_mask),
		&event_mask);
}
static int hci_fm_get_sig_threshold_req(struct radio_hci_dev *hdev,
		unsigned long param)
{
	__u16 opcode = 0;

	opcode = hci_opcode_pack(HCI_OGF_FM_RECV_CTRL_CMD_REQ,
		HCI_OCF_FM_GET_SIGNAL_THRESHOLD);
	return radio_hci_send_cmd(hdev, opcode, 0, NULL);
}

static int hci_fm_get_program_service_req(struct radio_hci_dev *hdev,
		unsigned long param)
{
	__u16 opcode = 0;

	opcode = hci_opcode_pack(HCI_OGF_FM_RECV_CTRL_CMD_REQ,
		HCI_OCF_FM_GET_PROGRAM_SERVICE_REQ);
	return radio_hci_send_cmd(hdev, opcode, 0, NULL);
}

static int hci_fm_get_radio_text_req(struct radio_hci_dev *hdev,
		unsigned long param)
{
	__u16 opcode = 0;

	opcode = hci_opcode_pack(HCI_OGF_FM_RECV_CTRL_CMD_REQ,
		HCI_OCF_FM_GET_RADIO_TEXT_REQ);
	return radio_hci_send_cmd(hdev, opcode, 0, NULL);
}

static int hci_fm_get_af_list_req(struct radio_hci_dev *hdev,
	unsigned long param)
{
	__u16 opcode = 0;

	opcode = hci_opcode_pack(HCI_OGF_FM_RECV_CTRL_CMD_REQ,
		HCI_OCF_FM_GET_AF_LIST_REQ);
	return radio_hci_send_cmd(hdev, opcode, 0, NULL);
}

static int hci_fm_search_stations_req(struct radio_hci_dev *hdev,
		unsigned long param)
{
	__u16 opcode = 0;
	struct hci_fm_search_station_req *srch_stations =
		(struct hci_fm_search_station_req *) param;

	if (srch_stations == NULL) {
		FMDERR("%s, search station param is null\n", __func__);
		return -EINVAL;
	}
	opcode = hci_opcode_pack(HCI_OGF_FM_RECV_CTRL_CMD_REQ,
		HCI_OCF_FM_SEARCH_STATIONS);
	return radio_hci_send_cmd(hdev, opcode, sizeof((*srch_stations)),
		srch_stations);
}

static int hci_fm_srch_rds_stations_req(struct radio_hci_dev *hdev,
		unsigned long param)
{
	__u16 opcode = 0;
	struct hci_fm_search_rds_station_req *srch_stations =
		(struct hci_fm_search_rds_station_req *) param;

	if (srch_stations == NULL) {
		FMDERR("%s, rds stations param is null\n", __func__);
		return -EINVAL;
	}
	opcode = hci_opcode_pack(HCI_OGF_FM_RECV_CTRL_CMD_REQ,
		HCI_OCF_FM_SEARCH_RDS_STATIONS);
	return radio_hci_send_cmd(hdev, opcode, sizeof((*srch_stations)),
		srch_stations);
}

static int hci_fm_srch_station_list_req(struct radio_hci_dev *hdev,
		unsigned long param)
{
	__u16 opcode = 0;
	struct hci_fm_search_station_list_req *srch_list =
		(struct hci_fm_search_station_list_req *) param;

	if (srch_list == NULL) {
		FMDERR("%s, search list param is null\n", __func__);
		return -EINVAL;
	}
	opcode = hci_opcode_pack(HCI_OGF_FM_RECV_CTRL_CMD_REQ,
		HCI_OCF_FM_SEARCH_STATIONS_LIST);
	return radio_hci_send_cmd(hdev, opcode, sizeof((*srch_list)),
		srch_list);
}

static int hci_fm_cancel_search_req(struct radio_hci_dev *hdev,
		unsigned long param)
{
	__u16 opcode = 0;

	opcode = hci_opcode_pack(HCI_OGF_FM_RECV_CTRL_CMD_REQ,
		HCI_OCF_FM_CANCEL_SEARCH);
	return radio_hci_send_cmd(hdev, opcode, 0, NULL);
}

static int hci_fm_rds_grp_mask_req(struct radio_hci_dev *hdev,
		unsigned long param)
{
	 __u16 opcode = 0;

	struct hci_fm_rds_grp_req *fm_grp_mask =
		(struct hci_fm_rds_grp_req *)param;

	if (fm_grp_mask == NULL) {
		FMDERR("%s, grp mask param is null\n", __func__);
		return -EINVAL;
	}
	opcode = hci_opcode_pack(HCI_OGF_FM_RECV_CTRL_CMD_REQ,
		HCI_OCF_FM_RDS_GRP);
	return radio_hci_send_cmd(hdev, opcode, sizeof(*fm_grp_mask),
		fm_grp_mask);
}

static int hci_fm_rds_grp_process_req(struct radio_hci_dev *hdev,
		unsigned long param)
{
	__u16 opcode = 0;

	__u32 fm_grps_process = param;

	opcode = hci_opcode_pack(HCI_OGF_FM_RECV_CTRL_CMD_REQ,
		HCI_OCF_FM_RDS_GRP_PROCESS);
	return radio_hci_send_cmd(hdev, opcode, sizeof(fm_grps_process),
		&fm_grps_process);
}

static int hci_fm_tune_station_req(struct radio_hci_dev *hdev,
	unsigned long param)
{
	__u16 opcode = 0;

	__u32 tune_freq = param;

	opcode = hci_opcode_pack(HCI_OGF_FM_COMMON_CTRL_CMD_REQ,
		HCI_OCF_FM_TUNE_STATION_REQ);
	return radio_hci_send_cmd(hdev, opcode, sizeof(tune_freq), &tune_freq);
}

static int hci_def_data_read_req(struct radio_hci_dev *hdev,
	unsigned long param)
{
	__u16 opcode = 0;
	struct hci_fm_def_data_rd_req *def_data_rd =
		(struct hci_fm_def_data_rd_req *) param;

	if (def_data_rd == NULL) {
		FMDERR("%s, def data read param is null\n", __func__);
		return -EINVAL;
	}
	opcode = hci_opcode_pack(HCI_OGF_FM_COMMON_CTRL_CMD_REQ,
		HCI_OCF_FM_DEFAULT_DATA_READ);
	return radio_hci_send_cmd(hdev, opcode, sizeof((*def_data_rd)),
	def_data_rd);
}

static int hci_def_data_write_req(struct radio_hci_dev *hdev,
	unsigned long param)
{
	__u16 opcode = 0;
	struct hci_fm_def_data_wr_req *def_data_wr =
		(struct hci_fm_def_data_wr_req *) param;

	if (def_data_wr == NULL) {
		FMDERR("%s, def data write param is null\n", __func__);
		return -EINVAL;
	}
	opcode = hci_opcode_pack(HCI_OGF_FM_COMMON_CTRL_CMD_REQ,
		HCI_OCF_FM_DEFAULT_DATA_WRITE);

	return radio_hci_send_cmd(hdev, opcode, (def_data_wr->length+2),
	def_data_wr);
}

static int hci_set_notch_filter_req(struct radio_hci_dev *hdev,
	unsigned long param)
{
	__u16 opcode = 0;
	__u8 notch_filter_val = param;

	opcode = hci_opcode_pack(HCI_OGF_FM_RECV_CTRL_CMD_REQ,
		HCI_OCF_FM_EN_NOTCH_CTRL);
	return radio_hci_send_cmd(hdev, opcode, sizeof(notch_filter_val),
	&notch_filter_val);
}



static int hci_fm_reset_req(struct radio_hci_dev *hdev, unsigned long param)
{
	__u16 opcode = 0;

	opcode = hci_opcode_pack(HCI_OGF_FM_COMMON_CTRL_CMD_REQ,
		HCI_OCF_FM_RESET);
	return radio_hci_send_cmd(hdev, opcode, 0, NULL);
}

static int hci_fm_get_feature_lists_req(struct radio_hci_dev *hdev,
		unsigned long param)
{
	__u16 opcode = 0;

	opcode = hci_opcode_pack(HCI_OGF_FM_COMMON_CTRL_CMD_REQ,
		HCI_OCF_FM_GET_FEATURE_LIST);
	return radio_hci_send_cmd(hdev, opcode, 0, NULL);
}

static int hci_fm_do_calibration_req(struct radio_hci_dev *hdev,
		unsigned long param)
{
	__u16 opcode = 0;

	__u8 mode = param;

	opcode = hci_opcode_pack(HCI_OGF_FM_COMMON_CTRL_CMD_REQ,
		HCI_OCF_FM_DO_CALIBRATION);
	return radio_hci_send_cmd(hdev, opcode, sizeof(mode), &mode);
}

static int hci_read_grp_counters_req(struct radio_hci_dev *hdev,
		unsigned long param)
{
	__u16 opcode = 0;
	__u8 reset_counters = param;

	opcode = hci_opcode_pack(HCI_OGF_FM_STATUS_PARAMETERS_CMD_REQ,
		HCI_OCF_FM_READ_GRP_COUNTERS);
	return radio_hci_send_cmd(hdev, opcode, sizeof(reset_counters),
		&reset_counters);
}

static int hci_peek_data_req(struct radio_hci_dev *hdev, unsigned long param)
{
	__u16 opcode = 0;
	struct hci_fm_riva_data *peek_data = (struct hci_fm_riva_data *)param;

	if (peek_data == NULL) {
		FMDERR("%s, peek data param is null\n", __func__);
		return -EINVAL;
	}
	opcode = hci_opcode_pack(HCI_OGF_FM_DIAGNOSTIC_CMD_REQ,
		HCI_OCF_FM_PEEK_DATA);
	return radio_hci_send_cmd(hdev, opcode, sizeof((*peek_data)),
	peek_data);
}

static int hci_poke_data_req(struct radio_hci_dev *hdev, unsigned long param)
{
	__u16 opcode = 0;
	struct hci_fm_riva_poke *poke_data = (struct hci_fm_riva_poke *) param;

	if (poke_data == NULL) {
		FMDERR("%s, poke data param is null\n", __func__);
		return -EINVAL;
	}
	opcode = hci_opcode_pack(HCI_OGF_FM_DIAGNOSTIC_CMD_REQ,
		HCI_OCF_FM_POKE_DATA);
	return radio_hci_send_cmd(hdev, opcode, sizeof((*poke_data)),
	poke_data);
}

static int hci_ssbi_peek_reg_req(struct radio_hci_dev *hdev,
	unsigned long param)
{
	__u16 opcode = 0;
	struct hci_fm_ssbi_peek *ssbi_peek = (struct hci_fm_ssbi_peek *) param;

	if (ssbi_peek == NULL) {
		FMDERR("%s, ssbi peek param is null\n", __func__);
		return -EINVAL;
	}
	opcode = hci_opcode_pack(HCI_OGF_FM_DIAGNOSTIC_CMD_REQ,
		HCI_OCF_FM_SSBI_PEEK_REG);
	return radio_hci_send_cmd(hdev, opcode, sizeof((*ssbi_peek)),
	ssbi_peek);
}

static int hci_ssbi_poke_reg_req(struct radio_hci_dev *hdev,
	unsigned long param)
{
	__u16 opcode = 0;
	struct hci_fm_ssbi_req *ssbi_poke = (struct hci_fm_ssbi_req *) param;

	if (ssbi_poke == NULL) {
		FMDERR("%s, ssbi poke param is null\n", __func__);
		return -EINVAL;
	}
	opcode = hci_opcode_pack(HCI_OGF_FM_DIAGNOSTIC_CMD_REQ,
		HCI_OCF_FM_SSBI_POKE_REG);
	return radio_hci_send_cmd(hdev, opcode, sizeof((*ssbi_poke)),
	ssbi_poke);
}

static int hci_fm_get_station_dbg_param_req(struct radio_hci_dev *hdev,
		unsigned long param)
{
	__u16 opcode = 0;

	opcode = hci_opcode_pack(HCI_OGF_FM_DIAGNOSTIC_CMD_REQ,
		HCI_OCF_FM_STATION_DBG_PARAM);
	return radio_hci_send_cmd(hdev, opcode, 0, NULL);
}

static int hci_fm_set_ch_det_th(struct radio_hci_dev *hdev,
	unsigned long param)
{
	struct hci_fm_ch_det_threshold *ch_det_th =
			 (struct hci_fm_ch_det_threshold *) param;
	u16 opcode;

	if (ch_det_th == NULL) {
		FMDERR("%s, channel det thrshld is null\n", __func__);
		return -EINVAL;
	}
	opcode = hci_opcode_pack(HCI_OGF_FM_RECV_CTRL_CMD_REQ,
		HCI_OCF_FM_SET_CH_DET_THRESHOLD);
	return radio_hci_send_cmd(hdev, opcode, sizeof((*ch_det_th)),
		ch_det_th);
}

static int hci_fm_get_ch_det_th(struct radio_hci_dev *hdev,
		unsigned long param)
{
	u16 opcode = hci_opcode_pack(HCI_OGF_FM_RECV_CTRL_CMD_REQ,
			HCI_OCF_FM_GET_CH_DET_THRESHOLD);
	return radio_hci_send_cmd(hdev, opcode, 0, NULL);
}

static int hci_fm_get_blend_tbl(struct radio_hci_dev *hdev,
		unsigned long param)
{
	u16 opcode = hci_opcode_pack(HCI_OGF_FM_RECV_CTRL_CMD_REQ,
				HCI_OCF_FM_GET_BLND_TBL);
	return radio_hci_send_cmd(hdev, opcode, 0, NULL);
}

static int hci_fm_set_blend_tbl(struct radio_hci_dev *hdev,
		unsigned long param)
{
	struct hci_fm_blend_table *blnd_tbl =
			 (struct hci_fm_blend_table *) param;
	u16 opcode;

	if (blnd_tbl == NULL) {
		FMDERR("%s, blend tbl is null\n", __func__);
		return -EINVAL;
	}
	opcode = hci_opcode_pack(HCI_OGF_FM_RECV_CTRL_CMD_REQ,
			HCI_OCF_FM_SET_BLND_TBL);
	return radio_hci_send_cmd(hdev, opcode,
			sizeof(struct hci_fm_blend_table), blnd_tbl);
}

static int radio_hci_err(__u32 code)
{
	switch (code) {
	case 0:
		return 0;
	case 0x01:
		return -EBADRQC;
	case 0x02:
		return -ENOTCONN;
	case 0x03:
		return -EIO;
	case 0x07:
		return -ENOMEM;
	case 0x0c:
		return -EBUSY;
	case 0x11:
		return -EOPNOTSUPP;
	case 0x12:
		return -EINVAL;
	default:
		return -ENOSYS;
	}
}

static int __radio_hci_request(struct radio_hci_dev *hdev,
		int (*req)(struct radio_hci_dev *hdev,
			unsigned long param),
			unsigned long param, __u32 timeout)
{
	int err = 0;
	DECLARE_WAITQUEUE(wait, current);

	if (unlikely(hdev == NULL)) {
		FMDERR("%s, hci dev is null\n", __func__);
		return -EINVAL;
	}

	mutex_lock(&iris_fm);
	hdev->req_status = HCI_REQ_PEND;

	add_wait_queue(&hdev->req_wait_q, &wait);
	set_current_state(TASK_INTERRUPTIBLE);

	err = req(hdev, param);

	schedule_timeout(timeout);

	remove_wait_queue(&hdev->req_wait_q, &wait);

	if (signal_pending(current)) {
		mutex_unlock(&iris_fm);
		return -EINTR;
	}

	switch (hdev->req_status) {
	case HCI_REQ_DONE:
	case HCI_REQ_STATUS:
		err = radio_hci_err(hdev->req_result);
		break;
	default:
		err = -ETIMEDOUT;
		break;
	}

	hdev->req_status = hdev->req_result = 0;
	mutex_unlock(&iris_fm);

	return err;
}

static inline int radio_hci_request(struct radio_hci_dev *hdev,
		int (*req)(struct
		radio_hci_dev * hdev, unsigned long param),
		unsigned long param, __u32 timeout)
{
	int ret = 0;

	ret = __radio_hci_request(hdev, req, param, timeout);

	return ret;
}

static inline int hci_conf_event_mask(__u8 *arg,
		struct radio_hci_dev *hdev)
{
	u8 event_mask;

	if (arg == NULL) {
		FMDERR("%s, arg is null\n", __func__);
		return -EINVAL;
	}
	event_mask = *arg;
	return  radio_hci_request(hdev, hci_fm_set_event_mask,
				event_mask, RADIO_HCI_TIMEOUT);
}
static int hci_set_fm_recv_conf(struct hci_fm_recv_conf_req *arg,
		struct radio_hci_dev *hdev)
{
	int ret = 0;
	struct hci_fm_recv_conf_req *set_recv_conf = arg;

	ret = radio_hci_request(hdev, hci_set_fm_recv_conf_req, (unsigned
		long)set_recv_conf, RADIO_HCI_TIMEOUT);

	return ret;
}

static int hci_set_fm_trans_conf(struct hci_fm_trans_conf_req_struct *arg,
		struct radio_hci_dev *hdev)
{
	int ret = 0;
	struct hci_fm_trans_conf_req_struct *set_trans_conf = arg;

	ret = radio_hci_request(hdev, hci_set_fm_trans_conf_req, (unsigned
		long)set_trans_conf, RADIO_HCI_TIMEOUT);

	return ret;
}

static int hci_fm_tune_station(__u32 *arg, struct radio_hci_dev *hdev)
{
	int ret = 0;
	__u32 tune_freq;

	if (arg == NULL) {
		FMDERR("%s, arg is null\n", __func__);
		return -EINVAL;
	}
	tune_freq = *arg;
	ret = radio_hci_request(hdev, hci_fm_tune_station_req, tune_freq,
		RADIO_HCI_TIMEOUT);

	return ret;
}

static int hci_set_fm_mute_mode(struct hci_fm_mute_mode_req *arg,
	struct radio_hci_dev *hdev)
{
	int ret = 0;
	struct hci_fm_mute_mode_req *set_mute_conf = arg;

	ret = radio_hci_request(hdev, hci_set_fm_mute_mode_req, (unsigned
		long)set_mute_conf, RADIO_HCI_TIMEOUT);

	return ret;
}

static int hci_set_fm_stereo_mode(struct hci_fm_stereo_mode_req *arg,
	struct radio_hci_dev *hdev)
{
	int ret = 0;
	struct hci_fm_stereo_mode_req *set_stereo_conf = arg;

	ret = radio_hci_request(hdev, hci_set_fm_stereo_mode_req, (unsigned
		long)set_stereo_conf, RADIO_HCI_TIMEOUT);

	return ret;
}

static int hci_fm_set_antenna(__u8 *arg, struct radio_hci_dev *hdev)
{
	int ret = 0;
	__u8 antenna;

	if (arg == NULL) {
		FMDERR("%s, arg is null\n", __func__);
		return -EINVAL;
	}
	antenna = *arg;
	ret = radio_hci_request(hdev, hci_fm_set_antenna_req, antenna,
		RADIO_HCI_TIMEOUT);

	return ret;
}

static int hci_fm_set_signal_threshold(__u8 *arg,
	struct radio_hci_dev *hdev)
{
	int ret = 0;
	__u8 sig_threshold;

	if (arg == NULL) {
		FMDERR("%s, arg is null\n", __func__);
		return -EINVAL;
	}
	sig_threshold = *arg;
	ret = radio_hci_request(hdev, hci_fm_set_sig_threshold_req,
		sig_threshold, RADIO_HCI_TIMEOUT);

	return ret;
}

static int hci_fm_search_stations(struct hci_fm_search_station_req *arg,
	struct radio_hci_dev *hdev)
{
	int ret = 0;
	struct hci_fm_search_station_req *srch_stations = arg;

	ret = radio_hci_request(hdev, hci_fm_search_stations_req, (unsigned
		long)srch_stations, RADIO_HCI_TIMEOUT);

	return ret;
}

static int hci_fm_search_rds_stations(struct hci_fm_search_rds_station_req *arg,
	struct radio_hci_dev *hdev)
{
	int ret = 0;
	struct hci_fm_search_rds_station_req *srch_stations = arg;

	ret = radio_hci_request(hdev, hci_fm_srch_rds_stations_req, (unsigned
		long)srch_stations, RADIO_HCI_TIMEOUT);

	return ret;
}

static int hci_fm_search_station_list
	(struct hci_fm_search_station_list_req *arg,
	struct radio_hci_dev *hdev)
{
	int ret = 0;
	struct hci_fm_search_station_list_req *srch_list = arg;

	ret = radio_hci_request(hdev, hci_fm_srch_station_list_req, (unsigned
		long)srch_list, RADIO_HCI_TIMEOUT);

	return ret;
}

static int hci_fm_rds_grp(struct hci_fm_rds_grp_req *arg,
	struct radio_hci_dev *hdev)
{
	int ret = 0;
	struct hci_fm_rds_grp_req *fm_grp_mask = arg;

	ret = radio_hci_request(hdev, hci_fm_rds_grp_mask_req, (unsigned
		long)fm_grp_mask, RADIO_HCI_TIMEOUT);

	return ret;
}

static int hci_fm_rds_grps_process(__u32 *arg, struct radio_hci_dev *hdev)
{
	int ret = 0;
	__u32 fm_grps_process;

	if (arg == NULL) {
		FMDERR("%s, arg is null\n", __func__);
		return -EINVAL;
	}
	fm_grps_process = *arg;
	ret = radio_hci_request(hdev, hci_fm_rds_grp_process_req,
		fm_grps_process, RADIO_HCI_TIMEOUT);

	return ret;
}

int hci_def_data_read(struct hci_fm_def_data_rd_req *arg,
	struct radio_hci_dev *hdev)
{
	int ret = 0;
	struct hci_fm_def_data_rd_req *def_data_rd = arg;

	ret = radio_hci_request(hdev, hci_def_data_read_req, (unsigned
		long)def_data_rd, RADIO_HCI_TIMEOUT);

	return ret;
}

int hci_def_data_write(struct hci_fm_def_data_wr_req *arg,
	struct radio_hci_dev *hdev)
{
	int ret = 0;
	struct hci_fm_def_data_wr_req *def_data_wr = arg;

	ret = radio_hci_request(hdev, hci_def_data_write_req, (unsigned
		long)def_data_wr, RADIO_HCI_TIMEOUT);

	return ret;
}

int hci_fm_do_calibration(__u8 *arg, struct radio_hci_dev *hdev)
{
	int ret = 0;
	__u8 mode;

	if (arg == NULL) {
		FMDERR("%s, arg is null\n", __func__);
		return -EINVAL;
	}
	mode = *arg;
	ret = radio_hci_request(hdev, hci_fm_do_calibration_req, mode,
		RADIO_HCI_TIMEOUT);

	return ret;
}

static int hci_read_grp_counters(__u8 *arg, struct radio_hci_dev *hdev)
{
	int ret = 0;
	__u8 reset_counters;

	if (arg == NULL) {
		FMDERR("%s, arg is null\n", __func__);
		return -EINVAL;
	}
	reset_counters = *arg;
	ret = radio_hci_request(hdev, hci_read_grp_counters_req,
		reset_counters, RADIO_HCI_TIMEOUT);

	return ret;
}

static int hci_set_notch_filter(__u8 *arg, struct radio_hci_dev *hdev)
{
	int ret = 0;
	__u8 notch_filter;

	if (arg == NULL) {
		FMDERR("%s, arg is null\n", __func__);
		return -EINVAL;
	}

	notch_filter = *arg;
	ret = radio_hci_request(hdev, hci_set_notch_filter_req,
		notch_filter, RADIO_HCI_TIMEOUT);

	return ret;
}

static int hci_peek_data(struct hci_fm_riva_data *arg,
				struct radio_hci_dev *hdev)
{
	int ret = 0;
	struct hci_fm_riva_data *peek_data = arg;

	ret = radio_hci_request(hdev, hci_peek_data_req, (unsigned
		long)peek_data, RADIO_HCI_TIMEOUT);

	return ret;
}

static int hci_poke_data(struct hci_fm_riva_poke *arg,
			struct radio_hci_dev *hdev)
{
	int ret = 0;
	struct hci_fm_riva_poke *poke_data = arg;

	ret = radio_hci_request(hdev, hci_poke_data_req, (unsigned
		long)poke_data, RADIO_HCI_TIMEOUT);

	return ret;
}

static int hci_ssbi_peek_reg(struct hci_fm_ssbi_peek *arg,
	struct radio_hci_dev *hdev)
{
	int ret = 0;
	struct hci_fm_ssbi_peek *ssbi_peek_reg = arg;

	ret = radio_hci_request(hdev, hci_ssbi_peek_reg_req, (unsigned
		long)ssbi_peek_reg, RADIO_HCI_TIMEOUT);

	return ret;
}

static int hci_ssbi_poke_reg(struct hci_fm_ssbi_req *arg,
			struct radio_hci_dev *hdev)
{
	int ret = 0;
	struct hci_fm_ssbi_req *ssbi_poke_reg = arg;

	ret = radio_hci_request(hdev, hci_ssbi_poke_reg_req, (unsigned
		long)ssbi_poke_reg, RADIO_HCI_TIMEOUT);

	return ret;
}

static int hci_set_ch_det_thresholds_req(struct hci_fm_ch_det_threshold *arg,
		struct radio_hci_dev *hdev)
{
	int ret = 0;
	struct hci_fm_ch_det_threshold *ch_det_threshold = arg;

	ret = radio_hci_request(hdev, hci_fm_set_ch_det_th,
		 (unsigned long)ch_det_threshold, RADIO_HCI_TIMEOUT);
	return ret;
}

static int hci_fm_set_cal_req_proc(struct radio_hci_dev *hdev,
		unsigned long param)
{
	u16 opcode = 0;
	struct hci_fm_set_cal_req_proc *cal_req =
		(struct hci_fm_set_cal_req_proc *)param;

	opcode = hci_opcode_pack(HCI_OGF_FM_COMMON_CTRL_CMD_REQ,
		HCI_OCF_FM_SET_CALIBRATION);
	return radio_hci_send_cmd(hdev, opcode,
		sizeof(struct hci_fm_set_cal_req_proc), cal_req);
}

static int hci_fm_do_cal_req(struct radio_hci_dev *hdev,
		unsigned long param)
{
	u16 opcode = 0;
	u8 cal_mode = param;

	opcode = hci_opcode_pack(HCI_OGF_FM_COMMON_CTRL_CMD_REQ,
		HCI_OCF_FM_DO_CALIBRATION);
	return radio_hci_send_cmd(hdev, opcode, sizeof(cal_mode),
		&cal_mode);

}

static int hci_fm_set_spur_tbl_req(struct radio_hci_dev *hdev,
					unsigned long param)
{
	u16 opcode = 0, len = 0;
	struct hci_fm_set_spur_table_req *spur_req =
		(struct hci_fm_set_spur_table_req *)param;

	opcode = hci_opcode_pack(HCI_OGF_FM_COMMON_CTRL_CMD_REQ,
			HCI_OCF_FM_SET_SPUR_TABLE);
	if (spur_req->no_of_freqs_entries > ENTRIES_EACH_CMD)
		len = (ENTRIES_EACH_CMD * SPUR_DATA_LEN)
			+ SPUR_DATA_INDEX;
	else
		len = (spur_req->no_of_freqs_entries * SPUR_DATA_LEN)
			+ SPUR_DATA_INDEX;

	return radio_hci_send_cmd(hdev, opcode, len, spur_req);
}

static int hci_fm_get_spur_tbl_data(struct radio_hci_dev *hdev,
					unsigned long param)
{
	u16 opcode = 0;
	unsigned int spur_freq = (unsigned int)param;

	opcode = hci_opcode_pack(HCI_OGF_FM_COMMON_CTRL_CMD_REQ,
			HCI_OCF_FM_GET_SPUR_TABLE);
	return radio_hci_send_cmd(hdev, opcode, sizeof(int), &spur_freq);
}

static int hci_set_blend_tbl_req(struct hci_fm_blend_table *arg,
		struct radio_hci_dev *hdev)
{
	int ret = 0;
	struct hci_fm_blend_table *blend_tbl = arg;

	ret = radio_hci_request(hdev, hci_fm_set_blend_tbl,
		 (unsigned long)blend_tbl, RADIO_HCI_TIMEOUT);
	return ret;
}

static int hci_cmd(unsigned int cmd, struct radio_hci_dev *hdev)
{
	int ret = 0;
	unsigned long arg = 0;

	if (!hdev)
		return -ENODEV;

	switch (cmd) {
	case HCI_FM_ENABLE_RECV_CMD:
		ret = radio_hci_request(hdev, hci_fm_enable_recv_req, arg,
			msecs_to_jiffies(RADIO_HCI_TIMEOUT));
		break;

	case HCI_FM_DISABLE_RECV_CMD:
		ret = radio_hci_request(hdev, hci_fm_disable_recv_req, arg,
			msecs_to_jiffies(RADIO_HCI_TIMEOUT));
		break;

	case HCI_FM_GET_RECV_CONF_CMD:
		ret = radio_hci_request(hdev, hci_get_fm_recv_conf_req, arg,
			msecs_to_jiffies(RADIO_HCI_TIMEOUT));
		break;

	case HCI_FM_GET_STATION_PARAM_CMD:
		ret = radio_hci_request(hdev,
			hci_fm_get_station_param_req, arg,
			msecs_to_jiffies(RADIO_HCI_TIMEOUT));
		break;

	case HCI_FM_GET_SIGNAL_TH_CMD:
		ret = radio_hci_request(hdev,
			hci_fm_get_sig_threshold_req, arg,
			msecs_to_jiffies(RADIO_HCI_TIMEOUT));
		break;

	case HCI_FM_GET_PROGRAM_SERVICE_CMD:
		ret = radio_hci_request(hdev,
			hci_fm_get_program_service_req, arg,
			msecs_to_jiffies(RADIO_HCI_TIMEOUT));
		break;

	case HCI_FM_GET_RADIO_TEXT_CMD:
		ret = radio_hci_request(hdev, hci_fm_get_radio_text_req, arg,
			msecs_to_jiffies(RADIO_HCI_TIMEOUT));
		break;

	case HCI_FM_GET_AF_LIST_CMD:
		ret = radio_hci_request(hdev, hci_fm_get_af_list_req, arg,
			msecs_to_jiffies(RADIO_HCI_TIMEOUT));
		break;

	case HCI_FM_CANCEL_SEARCH_CMD:
		ret = radio_hci_request(hdev, hci_fm_cancel_search_req, arg,
			msecs_to_jiffies(RADIO_HCI_TIMEOUT));
		break;

	case HCI_FM_RESET_CMD:
		ret = radio_hci_request(hdev, hci_fm_reset_req, arg,
			msecs_to_jiffies(RADIO_HCI_TIMEOUT));
		break;

	case HCI_FM_GET_FEATURES_CMD:
		ret = radio_hci_request(hdev,
		hci_fm_get_feature_lists_req, arg,
			msecs_to_jiffies(RADIO_HCI_TIMEOUT));
		break;

	case HCI_FM_STATION_DBG_PARAM_CMD:
		ret = radio_hci_request(hdev,
		hci_fm_get_station_dbg_param_req, arg,
			msecs_to_jiffies(RADIO_HCI_TIMEOUT));
		break;

	case HCI_FM_ENABLE_TRANS_CMD:
		ret = radio_hci_request(hdev, hci_fm_enable_trans_req, arg,
			msecs_to_jiffies(RADIO_HCI_TIMEOUT));
		break;

	case HCI_FM_DISABLE_TRANS_CMD:
		ret = radio_hci_request(hdev, hci_fm_disable_trans_req, arg,
			msecs_to_jiffies(RADIO_HCI_TIMEOUT));
		break;

	case HCI_FM_GET_TX_CONFIG:
		ret = radio_hci_request(hdev, hci_get_fm_trans_conf_req, arg,
			msecs_to_jiffies(RADIO_HCI_TIMEOUT));
		break;
	case HCI_FM_GET_DET_CH_TH_CMD:
		ret = radio_hci_request(hdev, hci_fm_get_ch_det_th, arg,
					msecs_to_jiffies(RADIO_HCI_TIMEOUT));
		break;
	case HCI_FM_GET_BLND_TBL_CMD:
		ret = radio_hci_request(hdev, hci_fm_get_blend_tbl, arg,
					msecs_to_jiffies(RADIO_HCI_TIMEOUT));
		break;
	default:
		ret = -EINVAL;
		break;
	}

	return ret;
}

static void radio_hci_req_complete(struct radio_hci_dev *hdev, int result)
{

	if (unlikely(hdev == NULL)) {
		FMDERR("%s, hci device is null\n", __func__);
		return;
	}
	hdev->req_result = result;
	hdev->req_status = HCI_REQ_DONE;
	wake_up_interruptible(&hdev->req_wait_q);
}

static void radio_hci_status_complete(struct radio_hci_dev *hdev, int result)
{
	if (unlikely(hdev == NULL)) {
		FMDERR("%s, hci device is null\n", __func__);
		return;
	}
	hdev->req_result = result;
	hdev->req_status = HCI_REQ_STATUS;
	wake_up_interruptible(&hdev->req_wait_q);
}

static void hci_cc_rsp(struct radio_hci_dev *hdev, struct sk_buff *skb)
{
	__u8 status;

	if (unlikely(skb == NULL)) {
		FMDERR("%s, socket buffer is null\n", __func__);
		return;
	}
	status = *((__u8 *) skb->data);

	radio_hci_req_complete(hdev, status);
}

static void hci_cc_fm_disable_rsp(struct radio_hci_dev *hdev,
	struct sk_buff *skb)
{
	__u8 status;
	struct iris_device *radio = video_get_drvdata(video_get_dev());

	if (unlikely(radio == NULL)) {
		FMDERR(":radio is null");
		return;
	}

	if (unlikely(skb == NULL)) {
		FMDERR("%s, socket buffer is null\n", __func__);
		return;
	}

	status = *((__u8 *) skb->data);
	if ((radio->mode == FM_TURNING_OFF) && (status == 0)) {
		iris_q_event(radio, IRIS_EVT_RADIO_DISABLED);
		radio_hci_req_complete(hdev, status);
		radio->mode = FM_OFF;
	} else if (radio->mode == FM_CALIB) {
		radio_hci_req_complete(hdev, status);
	} else if ((radio->mode == FM_RECV) || (radio->mode == FM_TRANS)) {
		iris_q_event(radio, IRIS_EVT_RADIO_DISABLED);
		radio->mode = FM_OFF;
	} else if ((radio->mode == FM_TURNING_OFF) && (status != 0)) {
		radio_hci_req_complete(hdev, status);
	}
}

static void hci_cc_conf_rsp(struct radio_hci_dev *hdev, struct sk_buff *skb)
{
	struct hci_fm_conf_rsp  *rsp;
	struct iris_device *radio = video_get_drvdata(video_get_dev());

	if (unlikely(radio == NULL)) {
		FMDERR(":radio is null");
		return;
	}
	if (unlikely(skb == NULL)) {
		FMDERR("%s, socket buffer is null\n", __func__);
		return;
	}
	rsp = (struct hci_fm_conf_rsp *)skb->data;
	if (!rsp->status)
		radio->recv_conf = rsp->recv_conf_rsp;
	radio_hci_req_complete(hdev, rsp->status);
}

static void hci_cc_fm_trans_get_conf_rsp(struct radio_hci_dev *hdev,
		struct sk_buff *skb)
{
	struct hci_fm_get_trans_conf_rsp  *rsp;
	struct iris_device *radio = video_get_drvdata(video_get_dev());

	if (unlikely(radio == NULL)) {
		FMDERR(":radio is null");
		return;
	}
	if (unlikely(skb == NULL)) {
		FMDERR("%s, socket buffer is null\n", __func__);
		return;
	}

	rsp = (struct hci_fm_get_trans_conf_rsp *)skb->data;
	if (!rsp->status)
		memcpy((void *)&radio->trans_conf,
			(void *)&rsp->trans_conf_rsp,
			sizeof(rsp->trans_conf_rsp));

	radio_hci_req_complete(hdev, rsp->status);
}

static void hci_cc_fm_enable_rsp(struct radio_hci_dev *hdev,
	struct sk_buff *skb)
{
	struct hci_fm_conf_rsp  *rsp;
	struct iris_device *radio = video_get_drvdata(video_get_dev());

	if (unlikely(radio == NULL)) {
		FMDERR(":radio is null");
		return;
	}

	if (unlikely(skb == NULL)) {
		FMDERR("%s, socket buffer is null\n", __func__);
		return;
	}

	rsp = (struct hci_fm_conf_rsp *)skb->data;
	if (rsp->status) {
		radio_hci_req_complete(hdev, rsp->status);
		return;
	}

	radio_hci_req_complete(hdev, rsp->status);
}


static void hci_cc_fm_trans_set_conf_rsp(struct radio_hci_dev *hdev,
	struct sk_buff *skb)
{
	struct hci_fm_conf_rsp  *rsp;
	struct iris_device *radio = video_get_drvdata(video_get_dev());

	if (unlikely(radio == NULL)) {
		FMDERR(":radio is null");
		return;
	}

	if (unlikely(skb == NULL)) {
		FMDERR("%s, socket buffer is null\n", __func__);
		return;
	}
	rsp = (struct hci_fm_conf_rsp  *)skb->data;
	if (!rsp->status)
		iris_q_event(radio, HCI_EV_CMD_COMPLETE);

	radio_hci_req_complete(hdev, rsp->status);
}


static void hci_cc_sig_threshold_rsp(struct radio_hci_dev *hdev,
		struct sk_buff *skb)
{
	struct hci_fm_sig_threshold_rsp  *rsp;
	struct iris_device *radio = video_get_drvdata(video_get_dev());

	if (unlikely(radio == NULL)) {
		FMDERR(":radio is null");
		return;
	}
	if (unlikely(skb == NULL)) {
		FMDERR("%s, socket buffer is null\n", __func__);
		return;
	}

	rsp = (struct hci_fm_sig_threshold_rsp  *)skb->data;
	if (!rsp->status)
		memcpy(&radio->sig_th, rsp,
			sizeof(struct hci_fm_sig_threshold_rsp));
	radio_hci_req_complete(hdev, rsp->status);
}

static void hci_cc_station_rsp(struct radio_hci_dev *hdev, struct sk_buff *skb)
{
	struct iris_device *radio = video_get_drvdata(video_get_dev());
	struct hci_fm_station_rsp *rsp;

	if (unlikely(radio == NULL)) {
		FMDERR(":radio is null");
		return;
	}
	if (unlikely(skb == NULL)) {
		FMDERR("%s, socket buffer is null\n", __func__);
		return;
	}

	rsp = (struct hci_fm_station_rsp *)skb->data;
	radio->fm_st_rsp = *(rsp);

	/* Tune is always successful */
	radio_hci_req_complete(hdev, 0);
}

static void hci_cc_prg_srv_rsp(struct radio_hci_dev *hdev, struct sk_buff *skb)
{
	struct hci_fm_prgm_srv_rsp  *rsp;

	if (unlikely(skb == NULL)) {
		FMDERR("%s, socket buffer is null\n", __func__);
		return;
	}

	rsp = (struct hci_fm_prgm_srv_rsp  *)skb->data;

	radio_hci_req_complete(hdev, rsp->status);
}

static void hci_cc_rd_txt_rsp(struct radio_hci_dev *hdev, struct sk_buff *skb)
{
	struct hci_fm_radio_txt_rsp  *rsp;

	if (unlikely(skb == NULL)) {
		FMDERR("%s, socket buffer is null\n", __func__);
		return;
	}

	rsp = (struct hci_fm_radio_txt_rsp  *)skb->data;
	radio_hci_req_complete(hdev, rsp->status);
}

static void hci_cc_af_list_rsp(struct radio_hci_dev *hdev, struct sk_buff *skb)
{
	struct hci_fm_af_list_rsp  *rsp;

	if (unlikely(skb == NULL)) {
		FMDERR("%s, socket buffer is null\n", __func__);
		return;
	}

	rsp = (struct hci_fm_af_list_rsp  *)skb->data;
	radio_hci_req_complete(hdev, rsp->status);
}

static void hci_cc_feature_list_rsp(struct radio_hci_dev *hdev,
	struct sk_buff *skb)
{
	struct v4l2_capability *v4l_cap;
	struct hci_fm_feature_list_rsp  *rsp;
	struct iris_device *radio = video_get_drvdata(video_get_dev());

	if (unlikely(radio == NULL)) {
		FMDERR(":radio is null");
		return;
	}

	if (unlikely(skb == NULL)) {
		FMDERR("%s, socket buffer is null\n", __func__);
		return;
	}

	rsp = (struct hci_fm_feature_list_rsp  *)skb->data;
	v4l_cap = &radio->g_cap;

	if (!rsp->status)
		v4l_cap->capabilities = (rsp->feature_mask & 0x000002) |
						(rsp->feature_mask & 0x000001);

	radio_hci_req_complete(hdev, rsp->status);
}

static void hci_cc_dbg_param_rsp(struct radio_hci_dev *hdev,
	struct sk_buff *skb)
{
	struct iris_device *radio = video_get_drvdata(video_get_dev());
	struct hci_fm_dbg_param_rsp *rsp;

	if (unlikely(radio == NULL)) {
		FMDERR(":radio is null");
		return;
	}

	if (unlikely(skb == NULL)) {
		FMDERR("%s, socket buffer is null\n", __func__);
		return;
	}

	rsp = (struct hci_fm_dbg_param_rsp *)skb->data;
	radio->st_dbg_param = *(rsp);
	radio_hci_req_complete(hdev, radio->st_dbg_param.status);
}

static void iris_q_evt_data(struct iris_device *radio,
				char *data, int len, int event)
{
	struct kfifo *data_b;

	if (unlikely(radio == NULL)) {
		FMDERR(":radio is null");
		return;
	}
	data_b = &radio->data_buf[event];
	if (kfifo_in_locked(data_b, data, len, &radio->buf_lock[event]))
		wake_up_interruptible(&radio->event_queue);
}

static void hci_cc_riva_peek_rsp(struct radio_hci_dev *hdev,
		struct sk_buff *skb)
{
	struct iris_device *radio = video_get_drvdata(video_get_dev());
	__u8 status;
	int len;
	char *data;

	if (unlikely(skb == NULL)) {
		FMDERR("%s, socket buffer is null\n", __func__);
		return;
	}
	status = *((__u8 *) skb->data);
	if (!status) {
		len = skb->data[RIVA_PEEK_LEN_OFSET] + RIVA_PEEK_PARAM;
		data = kmalloc(len, GFP_ATOMIC);

		if (data != NULL) {
			memcpy(data, &skb->data[PEEK_DATA_OFSET], len);
			iris_q_evt_data(radio, data, len, IRIS_BUF_PEEK);
			kfree(data);
		} else {
			FMDERR("Memory allocation failed");
		}
	}

	radio_hci_req_complete(hdev, status);
}

static void hci_cc_riva_read_default_rsp(struct radio_hci_dev *hdev,
		struct sk_buff *skb)
{
	struct iris_device *radio = video_get_drvdata(video_get_dev());
	__u8 status;
	__u8 len;

	if (unlikely(radio == NULL)) {
		FMDERR(":radio is null");
		return;
	}
	if (unlikely(skb == NULL)) {
		FMDERR("%s, socket buffer is null\n", __func__);
		return;
	}
	status = *((__u8 *) skb->data);
	if (!status) {
		len = skb->data[1];
		memset(&radio->default_data, 0,
			sizeof(struct hci_fm_data_rd_rsp));
		memcpy(&radio->default_data, &skb->data[0], len+2);
		iris_q_evt_data(radio, &skb->data[0], len+2,
				IRIS_BUF_RD_DEFAULT);
	}
	radio_hci_req_complete(hdev, status);
}

static void hci_cc_get_spur_tbl(struct radio_hci_dev *hdev,
		struct sk_buff *skb)
{
	struct iris_device *radio = video_get_drvdata(video_get_dev());
	__u8 status;

	if (unlikely(radio == NULL)) {
		FMDERR(":radio is null");
		return;
	}
	if (unlikely(skb == NULL)) {
		FMDERR("%s, socket buffer is null\n", __func__);
		return;
	}
	status = *((__u8 *) skb->data);
	if (!status) {
		iris_q_evt_data(radio, &skb->data[1], SPUR_DATA_LEN,
							IRIS_BUF_SPUR);
		iris_q_event(radio, IRIS_EVT_SPUR_TBL);
	}
	radio_hci_req_complete(hdev, status);
}

static void hci_cc_ssbi_peek_rsp(struct radio_hci_dev *hdev,
		struct sk_buff *skb)
{
	struct iris_device *radio = video_get_drvdata(video_get_dev());
	__u8 status;
	char *data;

	if (unlikely(skb == NULL)) {
		FMDERR("%s, socket buffer is null\n", __func__);
		return;
	}
	status = *((__u8 *) skb->data);
	if (!status) {
		data = kmalloc(SSBI_PEEK_LEN, GFP_ATOMIC);
		if (data != NULL) {
			data[0] = skb->data[PEEK_DATA_OFSET];
			iris_q_evt_data(radio, data, SSBI_PEEK_LEN,
					IRIS_BUF_SSBI_PEEK);
			kfree(data);
		} else {
			FMDERR("Memory allocation failed");
		}
	}

	radio_hci_req_complete(hdev, status);
}

static void hci_cc_rds_grp_cntrs_rsp(struct radio_hci_dev *hdev,
		struct sk_buff *skb)
{
	struct iris_device *radio = video_get_drvdata(video_get_dev());
	__u8 status;
	char *data;

	if (unlikely(skb == NULL)) {
		FMDERR("%s, socket buffer is null\n", __func__);
		return;
	}
	status = *((__u8 *) skb->data);
	if (!status) {
		data = kmalloc(RDS_GRP_CNTR_LEN, GFP_ATOMIC);
		if (data != NULL) {
			memcpy(data, &skb->data[1], RDS_GRP_CNTR_LEN);
			iris_q_evt_data(radio, data, RDS_GRP_CNTR_LEN,
						IRIS_BUF_RDS_CNTRS);
			kfree(data);
		} else {
			FMDERR("memory allocation failed");
		}
	}
	radio_hci_req_complete(hdev, status);
}

static void hci_cc_do_calibration_rsp(struct radio_hci_dev *hdev,
		struct sk_buff *skb)
{
	struct iris_device *radio = video_get_drvdata(video_get_dev());
	static struct hci_cc_do_calibration_rsp rsp;

	if (unlikely(skb == NULL)) {
		FMDERR("%s, socket buffer is null\n", __func__);
		return;
	}

	rsp.status = skb->data[0];
	rsp.mode = skb->data[CALIB_MODE_OFSET];

	if (!rsp.status) {
		if (rsp.mode == PROCS_CALIB_MODE) {
			memcpy(&rsp.data[0], &skb->data[CALIB_DATA_OFSET],
				PROCS_CALIB_SIZE);
			iris_q_evt_data(radio, rsp.data, PROCS_CALIB_SIZE,
					IRIS_BUF_CAL_DATA);
		}
	}
	radio_hci_req_complete(hdev, rsp.status);
}

static void hci_cc_get_ch_det_threshold_rsp(struct radio_hci_dev *hdev,
		struct sk_buff *skb)
{
	struct iris_device *radio = video_get_drvdata(video_get_dev());
	u8  status;

	if (unlikely(radio == NULL)) {
		FMDERR(":radio is null");
		return;
	}
	if (unlikely(skb == NULL)) {
		FMDERR("%s, socket buffer is null\n", __func__);
		return;
	}
	status = skb->data[0];
	if (!status)
		memcpy(&radio->ch_det_threshold, &skb->data[1],
			sizeof(struct hci_fm_ch_det_threshold));

	radio_hci_req_complete(hdev, status);
}

static void hci_cc_get_blend_tbl_rsp(struct radio_hci_dev *hdev,
		struct sk_buff *skb)
{
	struct iris_device *radio = video_get_drvdata(video_get_dev());
	u8  status;

	if (unlikely(radio == NULL)) {
		FMDERR(":radio is null");
		return;
	}
	if (unlikely(skb == NULL)) {
		FMDERR("%s, socket buffer is null\n", __func__);
		return;
	}
	status = skb->data[0];
	if (!status)
		memcpy(&radio->blend_tbl, &skb->data[1],
			sizeof(struct hci_fm_blend_table));

	radio_hci_req_complete(hdev, status);
}

static inline void hci_cmd_complete_event(struct radio_hci_dev *hdev,
		struct sk_buff *skb)
{
	struct hci_ev_cmd_complete *cmd_compl_ev;
	__u16 opcode;


	if (unlikely(skb == NULL)) {
		FMDERR("%s, socket buffer is null\n", __func__);
		return;
	}

	cmd_compl_ev = (struct hci_ev_cmd_complete *)skb->data;
	skb_pull(skb, sizeof(*cmd_compl_ev));

	opcode = __le16_to_cpu(cmd_compl_ev->cmd_opcode);

	switch (opcode) {
	case hci_recv_ctrl_cmd_op_pack(HCI_OCF_FM_ENABLE_RECV_REQ):
	case hci_trans_ctrl_cmd_op_pack(HCI_OCF_FM_ENABLE_TRANS_REQ):
		hci_cc_fm_enable_rsp(hdev, skb);
		break;
	case hci_recv_ctrl_cmd_op_pack(HCI_OCF_FM_GET_RECV_CONF_REQ):
		hci_cc_conf_rsp(hdev, skb);
		break;

	case hci_recv_ctrl_cmd_op_pack(HCI_OCF_FM_DISABLE_RECV_REQ):
	case hci_trans_ctrl_cmd_op_pack(HCI_OCF_FM_DISABLE_TRANS_REQ):
		hci_cc_fm_disable_rsp(hdev, skb);
		break;

	case hci_recv_ctrl_cmd_op_pack(HCI_OCF_FM_SET_RECV_CONF_REQ):
	case hci_recv_ctrl_cmd_op_pack(HCI_OCF_FM_SET_MUTE_MODE_REQ):
	case hci_recv_ctrl_cmd_op_pack(HCI_OCF_FM_SET_STEREO_MODE_REQ):
	case hci_recv_ctrl_cmd_op_pack(HCI_OCF_FM_SET_ANTENNA):
	case hci_recv_ctrl_cmd_op_pack(HCI_OCF_FM_SET_SIGNAL_THRESHOLD):
	case hci_recv_ctrl_cmd_op_pack(HCI_OCF_FM_CANCEL_SEARCH):
	case hci_recv_ctrl_cmd_op_pack(HCI_OCF_FM_RDS_GRP):
	case hci_recv_ctrl_cmd_op_pack(HCI_OCF_FM_RDS_GRP_PROCESS):
	case hci_recv_ctrl_cmd_op_pack(HCI_OCF_FM_EN_WAN_AVD_CTRL):
	case hci_recv_ctrl_cmd_op_pack(HCI_OCF_FM_EN_NOTCH_CTRL):
	case hci_recv_ctrl_cmd_op_pack(HCI_OCF_FM_SET_CH_DET_THRESHOLD):
	case hci_recv_ctrl_cmd_op_pack(HCI_OCF_FM_SET_BLND_TBL):
	case hci_trans_ctrl_cmd_op_pack(HCI_OCF_FM_RDS_RT_REQ):
	case hci_trans_ctrl_cmd_op_pack(HCI_OCF_FM_RDS_PS_REQ):
	case hci_common_cmd_op_pack(HCI_OCF_FM_DEFAULT_DATA_WRITE):
		hci_cc_rsp(hdev, skb);
		break;
	case hci_common_cmd_op_pack(HCI_OCF_FM_RESET):
	case hci_diagnostic_cmd_op_pack(HCI_OCF_FM_SSBI_POKE_REG):
	case hci_diagnostic_cmd_op_pack(HCI_OCF_FM_POKE_DATA):
	case hci_diagnostic_cmd_op_pack(HCI_FM_SET_INTERNAL_TONE_GENRATOR):
	case hci_common_cmd_op_pack(HCI_OCF_FM_SET_CALIBRATION):
	case hci_recv_ctrl_cmd_op_pack(HCI_OCF_FM_SET_EVENT_MASK):
	case hci_common_cmd_op_pack(HCI_OCF_FM_SET_SPUR_TABLE):
		hci_cc_rsp(hdev, skb);
		break;
	case hci_common_cmd_op_pack(HCI_OCF_FM_GET_SPUR_TABLE):
		hci_cc_get_spur_tbl(hdev, skb);
		break;
	case hci_diagnostic_cmd_op_pack(HCI_OCF_FM_SSBI_PEEK_REG):
		hci_cc_ssbi_peek_rsp(hdev, skb);
		break;
	case hci_recv_ctrl_cmd_op_pack(HCI_OCF_FM_GET_SIGNAL_THRESHOLD):
		hci_cc_sig_threshold_rsp(hdev, skb);
		break;

	case hci_recv_ctrl_cmd_op_pack(HCI_OCF_FM_GET_STATION_PARAM_REQ):
		hci_cc_station_rsp(hdev, skb);
		break;

	case hci_recv_ctrl_cmd_op_pack(HCI_OCF_FM_GET_PROGRAM_SERVICE_REQ):
		hci_cc_prg_srv_rsp(hdev, skb);
		break;

	case hci_recv_ctrl_cmd_op_pack(HCI_OCF_FM_GET_RADIO_TEXT_REQ):
		hci_cc_rd_txt_rsp(hdev, skb);
		break;

	case hci_recv_ctrl_cmd_op_pack(HCI_OCF_FM_GET_AF_LIST_REQ):
		hci_cc_af_list_rsp(hdev, skb);
		break;

	case hci_common_cmd_op_pack(HCI_OCF_FM_DEFAULT_DATA_READ):
		hci_cc_riva_read_default_rsp(hdev, skb);
		break;

	case hci_diagnostic_cmd_op_pack(HCI_OCF_FM_PEEK_DATA):
		hci_cc_riva_peek_rsp(hdev, skb);
		break;

	case hci_common_cmd_op_pack(HCI_OCF_FM_GET_FEATURE_LIST):
		hci_cc_feature_list_rsp(hdev, skb);
		break;

	case hci_diagnostic_cmd_op_pack(HCI_OCF_FM_STATION_DBG_PARAM):
		hci_cc_dbg_param_rsp(hdev, skb);
		break;
	case hci_trans_ctrl_cmd_op_pack(HCI_OCF_FM_SET_TRANS_CONF_REQ):
		hci_cc_fm_trans_set_conf_rsp(hdev, skb);
		break;

	case hci_status_param_op_pack(HCI_OCF_FM_READ_GRP_COUNTERS):
		hci_cc_rds_grp_cntrs_rsp(hdev, skb);
		break;
	case hci_common_cmd_op_pack(HCI_OCF_FM_DO_CALIBRATION):
		hci_cc_do_calibration_rsp(hdev, skb);
		break;

	case hci_trans_ctrl_cmd_op_pack(HCI_OCF_FM_GET_TRANS_CONF_REQ):
		hci_cc_fm_trans_get_conf_rsp(hdev, skb);
		break;
	case hci_recv_ctrl_cmd_op_pack(HCI_OCF_FM_GET_CH_DET_THRESHOLD):
		hci_cc_get_ch_det_threshold_rsp(hdev, skb);
		break;
	case hci_recv_ctrl_cmd_op_pack(HCI_OCF_FM_GET_BLND_TBL):
		hci_cc_get_blend_tbl_rsp(hdev, skb);
		break;
	default:
		FMDERR("%s opcode 0x%x", hdev->name, opcode);
		break;
	}

}

static inline void hci_cmd_status_event(struct radio_hci_dev *hdev,
		struct sk_buff *skb)
{
	struct hci_ev_cmd_status *ev = (void *) skb->data;

	radio_hci_status_complete(hdev, ev->status);
}

static inline void hci_ev_tune_status(struct radio_hci_dev *hdev,
		struct sk_buff *skb)
{
	int i;
	struct iris_device *radio = video_get_drvdata(video_get_dev());

	if (unlikely(radio == NULL)) {
		FMDERR(":radio is null");
		return;
	}
	memcpy(&radio->fm_st_rsp.station_rsp, &skb->data[0],
				sizeof(struct hci_ev_tune_status));
	iris_q_event(radio, IRIS_EVT_TUNE_SUCC);

	for (i = 0; i < IRIS_BUF_MAX; i++) {
		if (i >= IRIS_BUF_RT_RDS)
			kfifo_reset(&radio->data_buf[i]);
	}
	if (radio->fm_st_rsp.station_rsp.serv_avble)
		iris_q_event(radio, IRIS_EVT_ABOVE_TH);
	else
		iris_q_event(radio, IRIS_EVT_BELOW_TH);

	if (radio->fm_st_rsp.station_rsp.stereo_prg)
		iris_q_event(radio, IRIS_EVT_STEREO);
	else if (radio->fm_st_rsp.station_rsp.stereo_prg == 0)
		iris_q_event(radio, IRIS_EVT_MONO);

	if (radio->fm_st_rsp.station_rsp.rds_sync_status)
		iris_q_event(radio, IRIS_EVT_RDS_AVAIL);
	else
		iris_q_event(radio, IRIS_EVT_RDS_NOT_AVAIL);
}

static inline void hci_ev_search_compl(struct radio_hci_dev *hdev,
		struct sk_buff *skb)
{
	struct iris_device *radio = video_get_drvdata(video_get_dev());

	radio->search_on = 0;
	iris_q_event(radio, IRIS_EVT_SEEK_COMPLETE);
}

static inline void hci_ev_srch_st_list_compl(struct radio_hci_dev *hdev,
		struct sk_buff *skb)
{
	struct iris_device *radio = video_get_drvdata(video_get_dev());
	struct hci_ev_srch_list_compl *ev;
	int cnt;
	int stn_num;
	int rel_freq;
	int abs_freq;
	int len;

	if (unlikely(radio == NULL)) {
		FMDERR(":radio is null");
		return;
	}

	if (unlikely(skb == NULL)) {
		FMDERR("%s, socket buffer is null\n", __func__);
		return;
	}
	ev = kmalloc(sizeof(*ev), GFP_ATOMIC);
	if (!ev) {
		FMDERR("Memory allocation failed");
		return;
	}

	ev->num_stations_found = skb->data[STN_NUM_OFFSET];
	len = ev->num_stations_found * PARAMS_PER_STATION + STN_FREQ_OFFSET;

	for (cnt = STN_FREQ_OFFSET, stn_num = 0;
		(cnt < len) && (stn_num < ev->num_stations_found)
		&& (stn_num < ARRAY_SIZE(ev->rel_freq));
		cnt += PARAMS_PER_STATION, stn_num++) {
		abs_freq = *((int *)&skb->data[cnt]);
		rel_freq = abs_freq - radio->recv_conf.band_low_limit;
		rel_freq = (rel_freq * 20) / KHZ_TO_MHZ;

		ev->rel_freq[stn_num].rel_freq_lsb = GET_LSB(rel_freq);
		ev->rel_freq[stn_num].rel_freq_msb = GET_MSB(rel_freq);
	}

	len = ev->num_stations_found * 2 + sizeof(ev->num_stations_found);
	iris_q_event(radio, IRIS_EVT_NEW_SRCH_LIST);
	iris_q_evt_data(radio, (char *)ev, len, IRIS_BUF_SRCH_LIST);
	kfree(ev);
}

static inline void hci_ev_search_next(struct radio_hci_dev *hdev,
		struct sk_buff *skb)
{
	struct iris_device *radio = video_get_drvdata(video_get_dev());

	iris_q_event(radio, IRIS_EVT_SCAN_NEXT);
}

static inline void hci_ev_stereo_status(struct radio_hci_dev *hdev,
		struct sk_buff *skb)
{
	struct iris_device *radio = video_get_drvdata(video_get_dev());
	__u8 st_status;

	if (unlikely(skb == NULL)) {
		FMDERR("%s, socket buffer is null\n", __func__);
		return;
	}
	st_status = *((__u8 *) skb->data);
	if (st_status)
		iris_q_event(radio, IRIS_EVT_STEREO);
	else
		iris_q_event(radio, IRIS_EVT_MONO);
}

static void hci_ev_raw_rds_group_data(struct radio_hci_dev *hdev,
		struct sk_buff *skb)
{
	struct iris_device *radio;
	unsigned char blocknum, index;
	struct rds_grp_data temp;
	unsigned int mask_bit;
	unsigned short int aid, agt, gtc;
	unsigned short int carrier;

	radio = video_get_drvdata(video_get_dev());
	index = RDSGRP_DATA_OFFSET;

	if (unlikely(radio == NULL)) {
		FMDERR(":radio is null");
		return;
	}

	if (unlikely(skb == NULL)) {
		FMDERR("%s, socket buffer is null\n", __func__);
		return;
	}

	for (blocknum = 0; blocknum < RDS_BLOCKS_NUM; blocknum++) {
		temp.rdsBlk[blocknum].rdsLsb =
			(skb->data[index]);
		temp.rdsBlk[blocknum].rdsMsb =
			(skb->data[index+1]);
		index = index + 2;
	}

	aid = AID(temp.rdsBlk[3].rdsLsb, temp.rdsBlk[3].rdsMsb);
	gtc = GTC(temp.rdsBlk[1].rdsMsb);
	agt = AGT(temp.rdsBlk[1].rdsLsb);

	if (gtc == GRP_3A) {
		switch (aid) {
		case ERT_AID:
			/* calculate the grp mask for RDS grp
			 * which will contain actual eRT text
			 *
			 * Bit Pos  0  1  2  3  4   5  6   7
			 * Grp Type 0A 0B 1A 1B 2A  2B 3A  3B
			 *
			 * similarly for rest grps
			 */
			mask_bit = (((agt >> 1) << 1) + (agt & 1));
			oda_agt = (1 << mask_bit);
			utf_8_flag = (temp.rdsBlk[2].rdsLsb & 1);
			formatting_dir = EXTRACT_BIT(temp.rdsBlk[2].rdsLsb,
							ERT_FORMAT_DIR_BIT);
			if (ert_carrier != agt)
				iris_q_event(radio, IRIS_EVT_NEW_ODA);
			ert_carrier = agt;
			break;
		case RT_PLUS_AID:
			/* calculate the grp mask for RDS grp
			 * which will contain actual eRT text
			 *
			 * Bit Pos  0  1  2  3  4   5  6   7
			 * Grp Type 0A 0B 1A 1B 2A  2B 3A  3B
			 *
			 * similarly for rest grps
			 */
			mask_bit = (((agt >> 1) << 1) + (agt & 1));
			oda_agt =  (1 << mask_bit);
			/*Extract 5th bit of MSB (b7b6b5b4b3b2b1b0)*/
			rt_ert_flag = EXTRACT_BIT(temp.rdsBlk[2].rdsMsb,
					 RT_ERT_FLAG_BIT);
			if (rt_plus_carrier != agt)
				iris_q_event(radio, IRIS_EVT_NEW_ODA);
			rt_plus_carrier = agt;
			break;
		default:
			oda_agt = 0;
			break;
		}
	} else {
		carrier = gtc;
		if (carrier == rt_plus_carrier)
			hci_ev_rt_plus(radio, temp);
		else if (carrier == ert_carrier)
			hci_buff_ert(radio, &temp);
	}
}

static void hci_buff_ert(struct iris_device *radio,
	struct rds_grp_data *rds_buf)
{
	int i;
	unsigned short int info_byte = 0;
	unsigned short int byte_pair_index;

	if (rds_buf == NULL) {
		FMDERR("%s, rds buffer is null\n", __func__);
		return;
	}
	byte_pair_index = AGT(rds_buf->rdsBlk[1].rdsLsb);
	if (byte_pair_index == 0) {
		c_byt_pair_index = 0;
		ert_len = 0;
	}
	if (c_byt_pair_index == byte_pair_index) {
		c_byt_pair_index++;
		for (i = 2; i <= 3; i++) {
			info_byte = rds_buf->rdsBlk[i].rdsLsb;
			info_byte |= (rds_buf->rdsBlk[i].rdsMsb << 8);
			ert_buf[ert_len++] = rds_buf->rdsBlk[i].rdsMsb;
			ert_buf[ert_len++] = rds_buf->rdsBlk[i].rdsLsb;
			if ((utf_8_flag == 0)
				 && (info_byte == CARRIAGE_RETURN)) {
				ert_len -= 2;
				break;
			} else if ((utf_8_flag == 1)
					&&
					(rds_buf->rdsBlk[i].rdsMsb
						 == CARRIAGE_RETURN)) {
				info_byte = CARRIAGE_RETURN;
				ert_len -= 2;
				break;
			} else if ((utf_8_flag == 1)
					&&
					(rds_buf->rdsBlk[i].rdsLsb
						 == CARRIAGE_RETURN)) {
				info_byte = CARRIAGE_RETURN;
				ert_len--;
				break;
			}
		}
		if ((byte_pair_index == MAX_ERT_SEGMENT) ||
			(info_byte == CARRIAGE_RETURN)) {
			hci_ev_ert(radio);
			c_byt_pair_index = 0;
			ert_len = 0;
		}
	} else {
		ert_len = 0;
		c_byt_pair_index = 0;
	}
}
static void hci_ev_ert(struct iris_device *radio)

{
	char *data = NULL;

	if (ert_len <= 0)
		return;
	data = kmalloc((ert_len + 3), GFP_ATOMIC);
	if (data != NULL) {
		data[0] = ert_len;
		data[1] = utf_8_flag;
		data[2] = formatting_dir;
		memcpy((data + 3), ert_buf, ert_len);
		iris_q_evt_data(radio, data, (ert_len + 3), IRIS_BUF_ERT);
		iris_q_event(radio, IRIS_EVT_NEW_ERT);
		kfree(data);
	}
}

static void hci_ev_rt_plus(struct iris_device *radio,
		 struct rds_grp_data rds_buf)
{
	char tag_type1, tag_type2;
	char *data = NULL;
	int len = 0;
	unsigned short int agt;

	agt = AGT(rds_buf.rdsBlk[1].rdsLsb);
	/*right most 3 bits of Lsb of block 2
	 * and left most 3 bits of Msb of block 3
	 */
	tag_type1 = (((agt & TAG1_MSB_MASK) << TAG1_MSB_OFFSET) |
			 (rds_buf.rdsBlk[2].rdsMsb >> TAG1_LSB_OFFSET));

	/*right most 1 bit of lsb of 3rd block
	 * and left most 5 bits of Msb of 4th block
	*/
	tag_type2 = (((rds_buf.rdsBlk[2].rdsLsb & TAG2_MSB_MASK)
			 << TAG2_MSB_OFFSET) |
			 (rds_buf.rdsBlk[3].rdsMsb >> TAG2_LSB_OFFSET));

	if (tag_type1 != DUMMY_CLASS)
		len += RT_PLUS_LEN_1_TAG;
	if (tag_type2 != DUMMY_CLASS)
		len += RT_PLUS_LEN_1_TAG;

	if (len != 0) {
		len += 2;
		data = kmalloc(len, GFP_ATOMIC);
	} else {
		FMDERR("Len is zero\n");
		return;
	}
	if (data != NULL) {
		data[0] = len;
		len = 1;
		data[len++] = rt_ert_flag;
		if (tag_type1 != DUMMY_CLASS) {
			data[len++] = tag_type1;
			/*start position of tag1
			 *right most 5 bits of msb of 3rd block
			 *and left most bit of lsb of 3rd block
			 */
			data[len++] = (((rds_buf.rdsBlk[2].rdsMsb &
						 TAG1_POS_MSB_MASK)
						<< TAG1_POS_MSB_OFFSET)
						|
					(rds_buf.rdsBlk[2].rdsLsb >>
						TAG1_POS_LSB_OFFSET));
			/*length of tag1
			 *left most 6 bits of lsb of 3rd block
			 */
			data[len++] = ((rds_buf.rdsBlk[2].rdsLsb
						>> TAG1_LEN_OFFSET)
							 &
						TAG1_LEN_MASK) + 1;
		}
		if (tag_type2 != DUMMY_CLASS) {
			data[len++] = tag_type2;
			/*start position of tag2
			 *right most 3 bit of msb of 4th block
			 *and left most 3 bits of lsb of 4th block
			 */
			data[len++] = (((rds_buf.rdsBlk[3].rdsMsb
						& TAG2_POS_MSB_MASK)
						<< TAG2_POS_MSB_OFFSET)
						|
					(rds_buf.rdsBlk[3].rdsLsb
						>> TAG2_POS_LSB_OFFSET));
			/*length of tag2
			 *right most 5 bits of lsb of 4th block
			 */
			data[len++] = (rds_buf.rdsBlk[3].rdsLsb
						& TAG2_LEN_MASK) + 1;
		}
		iris_q_evt_data(radio, data, len, IRIS_BUF_RT_PLUS);
		iris_q_event(radio,  IRIS_EVT_NEW_RT_PLUS);
		kfree(data);
	} else {
		FMDERR("memory allocation failed\n");
	}
}

static inline void hci_ev_program_service(struct radio_hci_dev *hdev,
		struct sk_buff *skb)
{
	struct iris_device *radio = video_get_drvdata(video_get_dev());
	int len;
	char *data;

	len = (skb->data[RDS_PS_LENGTH_OFFSET] * RDS_STRING) + RDS_OFFSET;
	iris_q_event(radio, IRIS_EVT_NEW_PS_RDS);
	data = kmalloc(len, GFP_ATOMIC);
	if (!data) {
		FMDERR("Failed to allocate memory");
		return;
	}

	data[0] = skb->data[RDS_PS_LENGTH_OFFSET];
	data[1] = skb->data[RDS_PTYPE];
	data[2] = skb->data[RDS_PID_LOWER];
	data[3] = skb->data[RDS_PID_HIGHER];
	data[4] = 0;

	memcpy(data+RDS_OFFSET, &skb->data[RDS_PS_DATA_OFFSET], len-RDS_OFFSET);

	iris_q_evt_data(radio, data, len, IRIS_BUF_PS_RDS);

	kfree(data);
}


static inline void hci_ev_radio_text(struct radio_hci_dev *hdev,
	struct sk_buff *skb)
{
	struct iris_device *radio = video_get_drvdata(video_get_dev());
	int len = 0;
	char *data;

	if (unlikely(skb == NULL)) {
		FMDERR("%s, socket buffer is null\n", __func__);
		return;
	}
	iris_q_event(radio, IRIS_EVT_NEW_RT_RDS);

	while ((skb->data[len+RDS_OFFSET] != 0x0d) && (len < MAX_RT_LENGTH))
		len++;
	data = kmalloc(len+RDS_OFFSET, GFP_ATOMIC);
	if (!data) {
		FMDERR("Failed to allocate memory");
		return;
	}

	data[0] = len;
	data[1] = skb->data[RDS_PTYPE];
	data[2] = skb->data[RDS_PID_LOWER];
	data[3] = skb->data[RDS_PID_HIGHER];
	data[4] = skb->data[RT_A_B_FLAG_OFFSET];

	memcpy(data+RDS_OFFSET, &skb->data[RDS_OFFSET], len);
	data[len+RDS_OFFSET] = 0x00;

	iris_q_evt_data(radio, data, len+RDS_OFFSET, IRIS_BUF_RT_RDS);

	kfree(data);
}

static void hci_ev_af_list(struct radio_hci_dev *hdev,
	struct sk_buff *skb)
{
	struct iris_device *radio = video_get_drvdata(video_get_dev());
	struct hci_ev_af_list ev;

	if (unlikely(skb == NULL)) {
		FMDERR("%s, socket buffer is null\n", __func__);
		return;
	}
	ev.tune_freq = *((int *) &skb->data[0]);
	ev.pi_code = *((__le16 *) &skb->data[PI_CODE_OFFSET]);
	ev.af_size = skb->data[AF_SIZE_OFFSET];
	if (ev.af_size > AF_LIST_MAX) {
		FMDERR("AF list size received more than available size");
		return;
	}
	memcpy(&ev.af_list[0], &skb->data[AF_LIST_OFFSET],
					ev.af_size * sizeof(int));
	iris_q_event(radio, IRIS_EVT_NEW_AF_LIST);
	iris_q_evt_data(radio, (char *)&ev, (7 + ev.af_size * sizeof(int)),
							IRIS_BUF_AF_LIST);
}

static void hci_ev_rds_lock_status(struct radio_hci_dev *hdev,
	struct sk_buff *skb)
{
	struct iris_device *radio = video_get_drvdata(video_get_dev());
	__u8 rds_status;

	if (unlikely(skb == NULL)) {
		FMDERR("%s, socket buffer is null\n", __func__);
		return;
	}

	rds_status = skb->data[0];

	if (rds_status)
		iris_q_event(radio, IRIS_EVT_RDS_AVAIL);
	else
		iris_q_event(radio, IRIS_EVT_RDS_NOT_AVAIL);
}

static void hci_ev_service_available(struct radio_hci_dev *hdev,
	struct sk_buff *skb)
{
	struct iris_device *radio = video_get_drvdata(video_get_dev());
	u8 serv_avble;

	if (unlikely(skb == NULL)) {
		FMDERR("%s, socket buffer is null\n", __func__);
		return;
	}
	serv_avble = skb->data[0];
	if (serv_avble)
		iris_q_event(radio, IRIS_EVT_ABOVE_TH);
	else
		iris_q_event(radio, IRIS_EVT_BELOW_TH);
}

static void hci_ev_rds_grp_complete(struct radio_hci_dev *hdev,
	struct sk_buff *skb)
{
	struct iris_device *radio = video_get_drvdata(video_get_dev());

	iris_q_event(radio, IRIS_EVT_TXRDSDONE);
}

void radio_hci_event_packet(struct radio_hci_dev *hdev, struct sk_buff *skb)
{
	struct radio_hci_event_hdr *hdr;
	u8 event;

	if (skb == NULL) {
		FMDERR("Socket buffer is NULL");
		return;
	}

	hdr = (void *) skb->data;
	event = hdr->evt;

	skb_pull(skb, RADIO_HCI_EVENT_HDR_SIZE);

	switch (event) {
	case HCI_EV_TUNE_STATUS:
		hci_ev_tune_status(hdev, skb);
		break;
	case HCI_EV_SEARCH_PROGRESS:
	case HCI_EV_SEARCH_RDS_PROGRESS:
	case HCI_EV_SEARCH_LIST_PROGRESS:
		hci_ev_search_next(hdev, skb);
		break;
	case HCI_EV_STEREO_STATUS:
		hci_ev_stereo_status(hdev, skb);
		break;
	case HCI_EV_RDS_LOCK_STATUS:
		hci_ev_rds_lock_status(hdev, skb);
		break;
	case HCI_EV_SERVICE_AVAILABLE:
		hci_ev_service_available(hdev, skb);
		break;
	case HCI_EV_RDS_RX_DATA:
		hci_ev_raw_rds_group_data(hdev, skb);
		break;
	case HCI_EV_PROGRAM_SERVICE:
		hci_ev_program_service(hdev, skb);
		break;
	case HCI_EV_RADIO_TEXT:
		hci_ev_radio_text(hdev, skb);
		break;
	case HCI_EV_FM_AF_LIST:
		hci_ev_af_list(hdev, skb);
		break;
	case HCI_EV_TX_RDS_GRP_COMPL:
		hci_ev_rds_grp_complete(hdev, skb);
		break;
	case HCI_EV_TX_RDS_CONT_GRP_COMPL:
		break;

	case HCI_EV_CMD_COMPLETE:
		hci_cmd_complete_event(hdev, skb);
		break;

	case HCI_EV_CMD_STATUS:
		hci_cmd_status_event(hdev, skb);
		break;

	case HCI_EV_SEARCH_COMPLETE:
	case HCI_EV_SEARCH_RDS_COMPLETE:
		hci_ev_search_compl(hdev, skb);
		break;

	case HCI_EV_SEARCH_LIST_COMPLETE:
		hci_ev_srch_st_list_compl(hdev, skb);
		break;

	default:
		break;
	}
}

/*
 * fops/IOCTL helper functions
 */

static int iris_search(struct iris_device *radio, int on, int dir)
{
	int retval = 0;
	enum search_t srch;
	int saved_val;

	if (unlikely(radio == NULL)) {
		FMDERR(":radio is null");
		return -EINVAL;
	}

	srch = radio->g_search_mode & SRCH_MODE;
	saved_val = radio->search_on;
	radio->search_on = on;
	if (on) {
		switch (srch) {
		case SCAN_FOR_STRONG:
		case SCAN_FOR_WEAK:
			radio->srch_st_list.srch_list_dir = dir;
			radio->srch_st_list.srch_list_mode = srch;
			retval = hci_fm_search_station_list(
				&radio->srch_st_list, radio->fm_hdev);
			break;
		case RDS_SEEK_PTY:
		case RDS_SCAN_PTY:
		case RDS_SEEK_PI:
			srch = srch - SEARCH_RDS_STNS_MODE_OFFSET;
			radio->srch_rds.srch_station.srch_mode = srch;
			radio->srch_rds.srch_station.srch_dir = dir;
			radio->srch_rds.srch_station.scan_time =
				radio->g_scan_time;
			retval = hci_fm_search_rds_stations(&radio->srch_rds,
				radio->fm_hdev);
			break;
		default:
			radio->srch_st.srch_mode = srch;
			radio->srch_st.scan_time = radio->g_scan_time;
			radio->srch_st.srch_dir = dir;
			retval = hci_fm_search_stations(
				&radio->srch_st, radio->fm_hdev);
			break;
		}

	} else {
		retval = hci_cmd(HCI_FM_CANCEL_SEARCH_CMD, radio->fm_hdev);
	}

	if (retval < 0)
		radio->search_on = saved_val;
	return retval;
}

static int set_low_power_mode(struct iris_device *radio, int power_mode)
{

	int rds_grps_proc = 0x00;
	int retval = 0;
	struct hci_fm_rds_grp_req grp_3a;

	if (unlikely(radio == NULL)) {
		FMDERR(":radio is null");
		return -EINVAL;
	}

	if (radio->power_mode != power_mode) {

		if (power_mode) {
			memcpy(&grp_3a, &radio->rds_grp,
					sizeof(struct hci_fm_rds_grp_req));
			/* Disable 3A group */
			grp_3a.rds_grp_enable_mask &= ~FM_RDS_3A_GRP;
			retval = hci_fm_rds_grp(&grp_3a, radio->fm_hdev);
			if (retval < 0)
				FMDERR("error in disable 3A group mask\n");
			radio->event_mask = 0x00;
			if (radio->af_jump_bit)
				rds_grps_proc = 0x00 | AF_JUMP_ENABLE;
			else
				rds_grps_proc = 0x00;
			retval = hci_fm_rds_grps_process(
				&rds_grps_proc,
				radio->fm_hdev);
			if (retval < 0) {
				FMDERR("Disable RDS failed");
				return retval;
			}
			retval = hci_conf_event_mask(&radio->event_mask,
				radio->fm_hdev);
		} else {
			/* Enable RDS group to normal */
			retval = hci_fm_rds_grp(&radio->rds_grp,
							radio->fm_hdev);
			if (retval < 0)
				FMDERR("error in enable 3A group mask\n");
			radio->event_mask = SIG_LEVEL_INTR |
					RDS_SYNC_INTR | AUDIO_CTRL_INTR;
			retval = hci_conf_event_mask(&radio->event_mask,
				radio->fm_hdev);
			if (retval < 0) {
				FMDERR("Enable Async events failed");
				return retval;
			}
			retval = hci_fm_rds_grps_process(
				&radio->g_rds_grp_proc_ps,
				radio->fm_hdev);
		}
		radio->power_mode = power_mode;
	}
	return retval;
}
static int iris_recv_set_region(struct iris_device *radio, int req_region)
{
	int retval;
	int saved_val;

	if (unlikely(radio == NULL)) {
		FMDERR(":radio is null");
		return -EINVAL;
	}
	saved_val = radio->region;
	radio->region = req_region;

	retval = hci_set_fm_recv_conf(
			&radio->recv_conf,
			radio->fm_hdev);

	if (retval < 0)
		radio->region = saved_val;

	return retval;
}


static int iris_trans_set_region(struct iris_device *radio, int req_region)
{
	int retval;
	int saved_val;

	if (unlikely(radio == NULL)) {
		FMDERR(":radio is null");
		return -EINVAL;
	}

	saved_val = radio->region;
	radio->region = req_region;

	retval = hci_set_fm_trans_conf(
			&radio->trans_conf,
				radio->fm_hdev);

	if (retval < 0)
		radio->region = saved_val;
	return retval;
}


static int iris_set_freq(struct iris_device *radio, unsigned int freq)
{

	int retval;

	if (unlikely(radio == NULL)) {
		FMDERR(":radio is null");
		return -EINVAL;
	}
	retval = hci_fm_tune_station(&freq, radio->fm_hdev);
	if (retval < 0)
		FMDERR("Error while setting the frequency : %d\n", retval);
	return retval;
}


static int iris_vidioc_queryctrl(struct file *file, void *priv,
		struct v4l2_queryctrl *qc)
{
	unsigned char i;
	int retval = -EINVAL;

	if (qc == NULL) {
		FMDERR("%s, query ctrl is null\n", __func__);
		return retval;
	}
	for (i = 0; i < ARRAY_SIZE(iris_v4l2_queryctrl); i++) {
		if (qc->id && qc->id == iris_v4l2_queryctrl[i].id) {
			memcpy(qc, &(iris_v4l2_queryctrl[i]), sizeof(*qc));
			retval = 0;
			break;
		}
	}

	return retval;
}

static int iris_do_calibration(struct iris_device *radio)
{
	char cal_mode = 0x00;
	int retval = 0x00;

	if (unlikely(radio == NULL)) {
		FMDERR(":radio is null");
		return -EINVAL;
	}

	cal_mode = PROCS_CALIB_MODE;
	radio->mode = FM_CALIB;
	retval = hci_cmd(HCI_FM_ENABLE_RECV_CMD,
			radio->fm_hdev);
	if (retval < 0) {
		FMDERR("Enable failed before calibration %x", retval);
		radio->mode = FM_OFF;
		return retval;
	}
	retval = radio_hci_request(radio->fm_hdev, hci_fm_do_cal_req,
		(unsigned long)cal_mode, RADIO_HCI_TIMEOUT);
	if (retval < 0) {
		FMDERR("Do Process calibration failed %x", retval);
		radio->mode = FM_RECV;
		return retval;
	}
	retval = hci_cmd(HCI_FM_DISABLE_RECV_CMD,
			radio->fm_hdev);
	if (retval < 0)
		FMDERR("Disable Failed after calibration %d", retval);

	return retval;
}
static int iris_vidioc_g_ctrl(struct file *file, void *priv,
		struct v4l2_control *ctrl)
{
	struct iris_device *radio = video_get_drvdata(video_devdata(file));
	int retval = 0;
	int cf0;
	struct hci_fm_def_data_rd_req rd;
	int lsb, msb;

	if (unlikely(radio == NULL)) {
		FMDERR(":radio is null");
		retval = -EINVAL;
		goto END;
	}

	if (ctrl == NULL) {
		FMDERR("%s, v4l2 ctrl is null\n", __func__);
		retval = -EINVAL;
		goto END;
	}
	switch (ctrl->id) {
	case V4L2_CID_AUDIO_VOLUME:
		break;
	case V4L2_CID_AUDIO_MUTE:
		if (is_valid_hard_mute(radio->mute_mode.hard_mute))
			ctrl->value = radio->mute_mode.hard_mute;
		else
			retval = -EINVAL;
		break;
	case V4L2_CID_PRIVATE_IRIS_SRCHMODE:
		if (is_valid_srch_mode(radio->g_search_mode))
			ctrl->value = radio->g_search_mode;
		else
			retval = -EINVAL;
		break;
	case V4L2_CID_PRIVATE_IRIS_SCANDWELL:
		if (is_valid_scan_dwell_prd(radio->g_scan_time))
			ctrl->value = radio->g_scan_time;
		else
			retval = -EINVAL;
		break;
	case V4L2_CID_PRIVATE_IRIS_SRCHON:
		ctrl->value = radio->search_on;
		break;
	case V4L2_CID_PRIVATE_IRIS_STATE:
		if (is_valid_fm_state(radio->mode))
			ctrl->value = radio->mode;
		else
			retval = -EINVAL;
		break;
	case V4L2_CID_PRIVATE_IRIS_IOVERC:
		retval = hci_cmd(HCI_FM_STATION_DBG_PARAM_CMD, radio->fm_hdev);
		if (retval < 0)
			return retval;
		ctrl->value = radio->st_dbg_param.io_verc;
		break;
	case V4L2_CID_PRIVATE_IRIS_INTDET:
		retval = hci_cmd(HCI_FM_STATION_DBG_PARAM_CMD, radio->fm_hdev);
		if (retval == 0)
			ctrl->value = radio->st_dbg_param.in_det_out;
		else
			retval = -EINVAL;
		break;
	case V4L2_CID_PRIVATE_IRIS_REGION:
		ctrl->value = radio->region;
		break;
	case V4L2_CID_PRIVATE_IRIS_SIGNAL_TH:
		retval = hci_cmd(HCI_FM_GET_SIGNAL_TH_CMD, radio->fm_hdev);
		if ((retval == 0) &&
			is_valid_sig_th(radio->sig_th.sig_threshold))
			ctrl->value = radio->sig_th.sig_threshold;
		else
			retval = -EINVAL;
		break;
	case V4L2_CID_PRIVATE_IRIS_SRCH_PTY:
		if (is_valid_pty(radio->srch_rds.srch_pty))
			ctrl->value = radio->srch_rds.srch_pty;
		else
			retval = -EINVAL;
		break;
	case V4L2_CID_PRIVATE_IRIS_SRCH_PI:
		if (is_valid_pi(radio->srch_rds.srch_pi))
			ctrl->value = radio->srch_rds.srch_pi;
		else
			retval = -EINVAL;
		break;
	case V4L2_CID_PRIVATE_IRIS_SRCH_CNT:
		if (is_valid_srch_station_cnt(
			radio->srch_st_result.num_stations_found))
			ctrl->value = radio->srch_st_result.num_stations_found;
		else
			retval = -EINVAL;
		break;
	case V4L2_CID_PRIVATE_IRIS_EMPHASIS:
		if (radio->mode == FM_RECV) {
			retval = hci_cmd(HCI_FM_GET_RECV_CONF_CMD,
						radio->fm_hdev);
			if ((retval == 0) &&
				is_valid_emphasis(radio->recv_conf.emphasis))
				ctrl->value = radio->recv_conf.emphasis;
			else
				retval = -EINVAL;
		} else if (radio->mode == FM_TRANS) {
			retval =  hci_cmd(HCI_FM_GET_TX_CONFIG,
						radio->fm_hdev);
			if ((retval == 0) &&
				is_valid_emphasis(radio->trans_conf.emphasis))
				ctrl->value = radio->trans_conf.emphasis;
			else
				retval = -EINVAL;
		} else {
			retval = -EINVAL;
			FMDERR("Error in radio mode"" %d\n", retval);
		}
		break;
	case V4L2_CID_PRIVATE_IRIS_RDS_STD:
		if (radio->mode == FM_RECV) {
			retval = hci_cmd(HCI_FM_GET_RECV_CONF_CMD,
						radio->fm_hdev);
			if ((retval == 0) &&
				is_valid_rds_std(radio->recv_conf.rds_std))
				ctrl->value = radio->recv_conf.rds_std;
			else
				retval = -EINVAL;
		} else if (radio->mode == FM_TRANS) {
			retval =  hci_cmd(HCI_FM_GET_TX_CONFIG,
						radio->fm_hdev);
			if ((retval == 0) &&
				is_valid_rds_std(radio->trans_conf.rds_std))
				ctrl->value = radio->trans_conf.rds_std;
			else
				retval = -EINVAL;
		} else {
			retval = -EINVAL;
			FMDERR("Error in radio mode %d\n", retval);
		}
		break;
	case V4L2_CID_PRIVATE_IRIS_SPACING:
		if (radio->mode == FM_RECV) {
			retval = hci_cmd(HCI_FM_GET_RECV_CONF_CMD,
						radio->fm_hdev);
			if ((retval == 0) &&
				is_valid_chan_spacing(
						radio->recv_conf.ch_spacing))
				ctrl->value = radio->recv_conf.ch_spacing;
			else
				retval = -EINVAL;
		} else {
			retval = -EINVAL;
			FMDERR("Error in radio mode %d\n", retval);
		}
		break;
	case V4L2_CID_PRIVATE_IRIS_RDSON:
		if (radio->mode == FM_RECV) {
			retval = hci_cmd(HCI_FM_GET_RECV_CONF_CMD,
						radio->fm_hdev);
			if ((retval == 0) &&
				is_valid_rds_std(radio->recv_conf.rds_std))
				ctrl->value = radio->recv_conf.rds_std;
			else
				retval = -EINVAL;
		} else {
			retval = -EINVAL;
			FMDERR("Error in radio mode %d\n", retval);
		}
		break;
	case V4L2_CID_PRIVATE_IRIS_RDSGROUP_MASK:
		ctrl->value = radio->rds_grp.rds_grp_enable_mask;
		break;
	case V4L2_CID_PRIVATE_IRIS_RDSGROUP_PROC:
	case V4L2_CID_PRIVATE_IRIS_PSALL:
		ctrl->value = (radio->g_rds_grp_proc_ps << RDS_CONFIG_OFFSET);
		break;
	case V4L2_CID_PRIVATE_IRIS_RDSD_BUF:
		ctrl->value = radio->rds_grp.rds_buf_size;
		break;
	case V4L2_CID_PRIVATE_IRIS_LP_MODE:
		ctrl->value = radio->power_mode;
		break;
	case V4L2_CID_PRIVATE_IRIS_ANTENNA:
		ctrl->value = radio->g_antenna;
		break;
	case V4L2_CID_PRIVATE_IRIS_SOFT_MUTE:
		retval = hci_cmd(HCI_FM_STATION_DBG_PARAM_CMD, radio->fm_hdev);
		if ((retval == 0) &&
			is_valid_soft_mute(radio->mute_mode.soft_mute))
			ctrl->value = radio->mute_mode.soft_mute;
		else
			retval = -EINVAL;
		break;
	case V4L2_CID_PRIVATE_IRIS_DO_CALIBRATION:
		retval = iris_do_calibration(radio);
		break;
	case V4L2_CID_PRIVATE_IRIS_GET_SINR:
		if (radio->mode == FM_RECV) {
			retval = hci_cmd(HCI_FM_GET_STATION_PARAM_CMD,
						 radio->fm_hdev);
			if (retval == 0)
				ctrl->value = radio->fm_st_rsp.station_rsp.sinr;
		} else
			retval = -EINVAL;
		break;
	case V4L2_CID_PRIVATE_INTF_HIGH_THRESHOLD:
		retval = hci_cmd(HCI_FM_GET_DET_CH_TH_CMD, radio->fm_hdev);
		if (retval == 0)
			ctrl->value = radio->ch_det_threshold.high_th;
		break;
	case V4L2_CID_PRIVATE_INTF_LOW_THRESHOLD:
		retval = hci_cmd(HCI_FM_GET_DET_CH_TH_CMD, radio->fm_hdev);
		if (retval == 0)
			ctrl->value = radio->ch_det_threshold.low_th;
		break;
	case V4L2_CID_PRIVATE_SINR_THRESHOLD:
		retval = hci_cmd(HCI_FM_GET_DET_CH_TH_CMD, radio->fm_hdev);
		if (retval == 0)
			ctrl->value = radio->ch_det_threshold.sinr;
		break;
	case V4L2_CID_PRIVATE_SINR_SAMPLES:
		retval = hci_cmd(HCI_FM_GET_DET_CH_TH_CMD, radio->fm_hdev);
		if (retval == 0)
			ctrl->value = radio->ch_det_threshold.sinr_samples;
		break;
	case V4L2_CID_PRIVATE_VALID_CHANNEL:
		ctrl->value = radio->is_station_valid;
		break;
	case V4L2_CID_PRIVATE_AF_RMSSI_TH:
		rd.mode = FM_RDS_CNFG_MODE;
		rd.length = FM_RDS_CNFG_LEN;
		rd.param_len = 0;
		rd.param = 0;

		retval = hci_def_data_read(&rd, radio->fm_hdev);
		if (retval == 0) {
			lsb = radio->default_data.data[AF_RMSSI_TH_LSB_OFFSET];
			msb = radio->default_data.data[AF_RMSSI_TH_MSB_OFFSET];
			ctrl->value = ((msb << 8) | lsb);
		}
		break;
	case V4L2_CID_PRIVATE_AF_RMSSI_SAMPLES:
		rd.mode = FM_RDS_CNFG_MODE;
		rd.length = FM_RDS_CNFG_LEN;
		rd.param_len = 0;
		rd.param = 0;

		retval = hci_def_data_read(&rd, radio->fm_hdev);
		if (retval == 0)
			ctrl->value =
			radio->default_data.data[AF_RMSSI_SAMPLES_OFFSET];
		break;
	case V4L2_CID_PRIVATE_GOOD_CH_RMSSI_TH:
		rd.mode = FM_RX_CONFG_MODE;
		rd.length = FM_RX_CNFG_LEN;
		rd.param_len = 0;
		rd.param = 0;

		retval = hci_def_data_read(&rd, radio->fm_hdev);
		if (retval == 0) {
			ctrl->value =
			radio->default_data.data[GD_CH_RMSSI_TH_OFFSET];
			if (ctrl->value > MAX_GD_CH_RMSSI_TH)
				ctrl->value -= 256;
		}
		break;
	case V4L2_CID_PRIVATE_SRCHALGOTYPE:
		rd.mode = FM_RX_CONFG_MODE;
		rd.length = FM_RX_CNFG_LEN;
		rd.param_len = 0;
		rd.param = 0;

		retval = hci_def_data_read(&rd, radio->fm_hdev);
		if (retval == 0)
			ctrl->value =
			radio->default_data.data[SRCH_ALGO_TYPE_OFFSET];
		break;
	case V4L2_CID_PRIVATE_SINRFIRSTSTAGE:
		rd.mode = FM_RX_CONFG_MODE;
		rd.length = FM_RX_CNFG_LEN;
		rd.param_len = 0;
		rd.param = 0;

		retval = hci_def_data_read(&rd, radio->fm_hdev);
		if (retval == 0) {
			ctrl->value =
			radio->default_data.data[SINRFIRSTSTAGE_OFFSET];
			if (ctrl->value > MAX_SINR_FIRSTSTAGE)
				ctrl->value -= 256;
		}
		break;
	case V4L2_CID_PRIVATE_RMSSIFIRSTSTAGE:
		rd.mode = FM_RX_CONFG_MODE;
		rd.length = FM_RX_CNFG_LEN;
		rd.param_len = 0;
		rd.param = 0;

		retval = hci_def_data_read(&rd, radio->fm_hdev);
		if (retval == 0) {
			ctrl->value =
			radio->default_data.data[RMSSIFIRSTSTAGE_OFFSET];
			if (ctrl->value > MAX_RMSSI_FIRSTSTAGE)
				ctrl->value -= 256;
		}
		break;
	case V4L2_CID_PRIVATE_CF0TH12:
		rd.mode = FM_RX_CONFG_MODE;
		rd.length = FM_RX_CNFG_LEN;
		rd.param_len = 0;
		rd.param = 0;

		retval = hci_def_data_read(&rd, radio->fm_hdev);
		if (retval == 0) {
			ctrl->value =
			radio->default_data.data[CF0TH12_BYTE1_OFFSET];
			cf0 = radio->default_data.data[CF0TH12_BYTE2_OFFSET];
			ctrl->value |= (cf0 << 8);
			cf0 = radio->default_data.data[CF0TH12_BYTE3_OFFSET];
			ctrl->value |= (cf0 << 16);
			cf0 = radio->default_data.data[CF0TH12_BYTE4_OFFSET];
			if (cf0 > 127)
				cf0 -= 256;
			ctrl->value |= (cf0 << 24);
		}
		break;
	case V4L2_CID_PRIVATE_BLEND_SINRHI:
		retval = hci_cmd(HCI_FM_GET_BLND_TBL_CMD, radio->fm_hdev);
		if (retval < 0) {
			FMDERR("Failed to get blend table  %d", retval);
			goto END;
		}
		ctrl->value = radio->blend_tbl.scBlendSinrHi;
		break;
	case V4L2_CID_PRIVATE_BLEND_RMSSIHI:
		retval = hci_cmd(HCI_FM_GET_BLND_TBL_CMD, radio->fm_hdev);
		if (retval < 0) {
			FMDERR("Failed to get blend table  %d", retval);
			goto END;
		}
		ctrl->value = radio->blend_tbl.scBlendRmssiHi;
		break;
	default:
		retval = -EINVAL;
		break;
	}

END:
	if (retval > 0)
		retval = -EINVAL;
	if (ctrl != NULL && retval < 0)
		FMDERR("get control failed: %d, ret: %d\n", ctrl->id, retval);

	return retval;
}

static int iris_vidioc_g_ext_ctrls(struct file *file, void *priv,
			struct v4l2_ext_controls *ctrl)
{
	int retval = 0;
	char *data = NULL;
	struct iris_device *radio = video_get_drvdata(video_devdata(file));
	struct hci_fm_def_data_rd_req default_data_rd;

	if (unlikely(radio == NULL)) {
		FMDERR(":radio is null");
		retval = -EINVAL;
		goto END;
	}

	if ((ctrl == NULL) || (ctrl->count == 0)
		|| (ctrl->controls == NULL)) {
		FMDERR("%s, invalid v4l2 ctrl\n", __func__);
		retval = -EINVAL;
		goto END;
	}
	switch ((ctrl->controls[0]).id) {
	case V4L2_CID_PRIVATE_IRIS_READ_DEFAULT:
		data = (ctrl->controls[0]).string;
		memset(&default_data_rd, 0, sizeof(default_data_rd));
		if (copy_from_user(&default_data_rd.mode, data,
					sizeof(default_data_rd))) {
			retval = -EFAULT;
			goto END;
		}
		retval = hci_def_data_read(&default_data_rd, radio->fm_hdev);
		break;
	default:
		retval = -EINVAL;
		break;
	}

END:
	if (retval > 0)
		retval = -EINVAL;

	return retval;
}

static int iris_vidioc_s_ext_ctrls(struct file *file, void *priv,
			struct v4l2_ext_controls *ctrl)
{
	int retval = 0;
	size_t bytes_to_copy;
	struct hci_fm_tx_ps tx_ps;
	struct hci_fm_tx_rt tx_rt;
	struct hci_fm_def_data_wr_req default_data;
	struct hci_fm_set_cal_req_proc proc_cal_req;
	struct hci_fm_set_spur_table_req spur_tbl_req;
	char *spur_data;

	struct iris_device *radio = video_get_drvdata(video_devdata(file));
	char *data = NULL;

	if (unlikely(radio == NULL)) {
		FMDERR(":radio is null");
		retval = -EINVAL;
		goto END;
	}

	if ((ctrl == NULL) || (ctrl->count == 0)
		|| (ctrl->controls == NULL)) {
		FMDERR("%s, invalid v4l2 ctrl\n", __func__);
		retval = -EINVAL;
		goto END;
	}

	switch ((ctrl->controls[0]).id) {
	case V4L2_CID_RDS_TX_PS_NAME:
		FMDBG("In V4L2_CID_RDS_TX_PS_NAME\n");
		/*Pass a sample PS string */

		memset(tx_ps.ps_data, 0, MAX_PS_LENGTH);
		bytes_to_copy = min_t(size_t, ctrl->controls[0].size,
					MAX_PS_LENGTH);
		data = (ctrl->controls[0]).string;

		if (copy_from_user(tx_ps.ps_data,
				data, bytes_to_copy)) {
			FMDERR("%s: copy from user for tx ps name failed\n",
				__func__);
			retval = -EFAULT;
			goto END;
		} else {
			tx_ps.ps_control =  0x01;
			tx_ps.pi = radio->pi;
			tx_ps.pty = radio->pty;
			tx_ps.ps_repeatcount = radio->ps_repeatcount;
			tx_ps.ps_num = (bytes_to_copy / PS_STRING_LEN);

			retval = radio_hci_request(radio->fm_hdev,
							hci_trans_ps_req,
							(unsigned long)&tx_ps,
							RADIO_HCI_TIMEOUT);
		}
		break;
	case V4L2_CID_RDS_TX_RADIO_TEXT:
		bytes_to_copy =
		    min_t(size_t, (ctrl->controls[0]).size, MAX_RT_LENGTH);
		data = (ctrl->controls[0]).string;

		memset(tx_rt.rt_data, 0, MAX_RT_LENGTH);

		if (copy_from_user(tx_rt.rt_data,
				data, bytes_to_copy)) {
			FMDERR("%s: copy from user for tx rt failed\n",
				 __func__);
			retval = -EFAULT;
			goto END;
		} else {
			tx_rt.rt_control = 0x01;
			tx_rt.pi = radio->pi;
			tx_rt.pty = radio->pty;
			tx_rt.rt_len = bytes_to_copy;

			retval = radio_hci_request(radio->fm_hdev,
							hci_trans_rt_req,
							(unsigned long)&tx_rt,
							RADIO_HCI_TIMEOUT);
		}
		break;
	case V4L2_CID_PRIVATE_IRIS_WRITE_DEFAULT:
		data = (ctrl->controls[0]).string;
		memset(&default_data, 0, sizeof(default_data));
		/*
		 * Check if length of the 'FM Default Data' to be sent
		 * is within the maximum  'FM Default Data' packet limit.
		 * Max. 'FM Default Data' packet length is 251 bytes:
		 *	1 byte    - XFR Mode
		 *	1 byte    - length of the default data
		 *	249 bytes - actual data to be configured
		 */
		if (ctrl->controls[0].size > (DEFAULT_DATA_SIZE + 2)) {
			pr_err("%s: Default data buffer overflow!\n", __func__);
			retval = -EINVAL;
			goto END;
		}

		/* copy only 'size' bytes of data as requested by user */
		retval = copy_from_user(&default_data, data,
			ctrl->controls[0].size);
		if (retval > 0) {
			FMDERR("Failed to copy %d bytes data\n", retval);
			retval = -EFAULT;
			goto END;
		}
		FMDBG("%s: XFR Mode\t: 0x%x\n", __func__, default_data.mode);
		FMDBG("%s: XFR Data Length\t: %d\n", __func__,
			default_data.length);
		/*
		 * Check if the 'length' of the actual XFR data to be configured
		 * is valid or not. Length of actual XFR data should be always
		 * 2 bytes less than the total length of the 'FM Default Data'.
		 * Length of 'FM Default Data' DEF_DATA_LEN: (1+1+XFR Data Size)
		 * Length of 'Actual XFR Data' XFR_DATA_LEN: (DEF_DATA_LEN - 2)
		 */
		if (default_data.length != (ctrl->controls[0].size - 2)) {
			FMDERR("Invalid 'length' parameter\n");
			retval = -EINVAL;
			goto END;
		}
		retval = hci_def_data_write(&default_data, radio->fm_hdev);
		break;
	case V4L2_CID_PRIVATE_IRIS_SET_CALIBRATION:
		data = (ctrl->controls[0]).string;
		bytes_to_copy = (ctrl->controls[0]).size;
		if (bytes_to_copy < PROCS_CALIB_SIZE) {
			FMDERR("data is less than required size");
			retval = -EFAULT;
			goto END;
		}
		memset(proc_cal_req.data, 0, PROCS_CALIB_SIZE);
		proc_cal_req.mode = PROCS_CALIB_MODE;
		if (copy_from_user(&proc_cal_req.data[0],
				data, sizeof(proc_cal_req.data))) {
			retval = -EFAULT;
			goto END;
		}
		retval = radio_hci_request(radio->fm_hdev,
				hci_fm_set_cal_req_proc,
				(unsigned long)&proc_cal_req,
				 RADIO_HCI_TIMEOUT);
		break;
	case V4L2_CID_PRIVATE_IRIS_SET_SPURTABLE:
		memset(&spur_tbl_req, 0, sizeof(spur_tbl_req));
		data = (ctrl->controls[0]).string;
		bytes_to_copy = (ctrl->controls[0]).size;
		spur_tbl_req.mode = data[0];
		spur_tbl_req.no_of_freqs_entries = data[1];
		spur_data = kmalloc((data[1] * SPUR_DATA_LEN) + 2,
							GFP_ATOMIC);
		if (!spur_data) {
			FMDERR("Allocation failed for Spur data");
			retval = -EFAULT;
			goto END;
		}
		if (copy_from_user(spur_data,
				&data[2], (bytes_to_copy - 2))) {
			kfree(spur_data);
			retval = -EFAULT;
			goto END;
		}

		if (spur_tbl_req.no_of_freqs_entries <= ENTRIES_EACH_CMD) {
			memcpy(&spur_tbl_req.spur_data[0], spur_data,
					(data[1] * SPUR_DATA_LEN));
			retval = radio_hci_request(radio->fm_hdev,
					hci_fm_set_spur_tbl_req,
					(unsigned long)&spur_tbl_req,
					RADIO_HCI_TIMEOUT);
		} else {
			memcpy(&spur_tbl_req.spur_data[0], spur_data,
				(ENTRIES_EACH_CMD * SPUR_DATA_LEN));
			retval = radio_hci_request(radio->fm_hdev,
					hci_fm_set_spur_tbl_req,
					(unsigned long)&spur_tbl_req,
					RADIO_HCI_TIMEOUT);
			if (retval < 0) {
				FMDERR("Spur command failed to execute");
				kfree(spur_data);
				goto END;
			}
			spur_tbl_req.mode = 0x02;/* 02-Continue mode */
			spur_tbl_req.no_of_freqs_entries =
				spur_tbl_req.no_of_freqs_entries
					- ENTRIES_EACH_CMD;
			memcpy(&spur_tbl_req.spur_data[0],
				&spur_data[ENTRIES_EACH_CMD * SPUR_DATA_LEN],
			(spur_tbl_req.no_of_freqs_entries * SPUR_DATA_LEN));
			retval = radio_hci_request(radio->fm_hdev,
					hci_fm_set_spur_tbl_req,
					(unsigned long)&spur_tbl_req,
					RADIO_HCI_TIMEOUT);
		}
		kfree(spur_data);
		break;
	default:
		FMDBG("Shouldn't reach here\n");
		retval = -1;
		goto END;
	}

END:
	if (retval > 0)
		retval = -EINVAL;

	return retval;
}

static int iris_vidioc_s_ctrl(struct file *file, void *priv,
		struct v4l2_control *ctrl)
{
	struct iris_device *radio = video_get_drvdata(video_devdata(file));
	int retval = 0;
	unsigned int rds_grps_proc = 0;
	__u8 temp_val = 0;
	int saved_val;
	unsigned long arg = 0;
	struct hci_fm_tx_ps tx_ps = {0};
	struct hci_fm_tx_rt tx_rt = {0};
	struct hci_fm_def_data_rd_req rd;
	struct hci_fm_def_data_wr_req wrd;
	char sinr_th, sinr;
	__u8 intf_det_low_th, intf_det_high_th, intf_det_out;
	unsigned int spur_freq;

	if (unlikely(radio == NULL)) {
		FMDERR(":radio is null");
		retval = -EINVAL;
		goto END;
	}

	if (ctrl == NULL) {
		FMDERR("%s, v4l2 ctrl is null\n", __func__);
		retval = -EINVAL;
		goto END;
	}
	switch (ctrl->id) {
	case V4L2_CID_PRIVATE_IRIS_TX_TONE:
		if (!is_valid_tone(ctrl->value)) {
			retval = -EINVAL;
			FMDERR("%s: tone value is not valid\n", __func__);
			goto END;
		}
		saved_val = radio->tone_freq;
		radio->tone_freq = ctrl->value;
		retval = radio_hci_request(radio->fm_hdev,
				hci_fm_tone_generator, arg,
				msecs_to_jiffies(RADIO_HCI_TIMEOUT));
		if (retval < 0) {
			FMDERR("Error while setting the tone %d", retval);
			radio->tone_freq = saved_val;
		}
		break;
	case V4L2_CID_AUDIO_VOLUME:
		break;
	case V4L2_CID_AUDIO_MUTE:
		if (!is_valid_hard_mute(ctrl->value)) {
			retval = -EINVAL;
			FMDERR("%s: hard mute value is not valid\n", __func__);
			goto END;
		}
		saved_val = radio->mute_mode.hard_mute;
		radio->mute_mode.hard_mute = ctrl->value;
		retval = hci_set_fm_mute_mode(
				&radio->mute_mode,
				radio->fm_hdev);
		if (retval < 0) {
			FMDERR("Error while set FM hard mute"" %d\n",
				retval);
			radio->mute_mode.hard_mute = saved_val;
		}
		break;
	case V4L2_CID_PRIVATE_IRIS_SRCHMODE:
		if (is_valid_srch_mode(ctrl->value)) {
			radio->g_search_mode = ctrl->value;
		} else {
			FMDERR("%s: srch mode is not valid\n", __func__);
			retval = -EINVAL;
			goto END;
		}
		break;
	case V4L2_CID_PRIVATE_IRIS_SCANDWELL:
		if (is_valid_scan_dwell_prd(ctrl->value)) {
			radio->g_scan_time = ctrl->value;
		} else {
			FMDERR("%s: scandwell period is not valid\n", __func__);
			retval = -EINVAL;
			goto END;
		}
		break;
	case V4L2_CID_PRIVATE_IRIS_SRCHON:
		iris_search(radio, ctrl->value, SRCH_DIR_UP);
		break;
	case V4L2_CID_PRIVATE_IRIS_STATE:
		switch (ctrl->value) {
		case FM_RECV:
			if (radio->mode != FM_OFF) {
				FMDERR("FM is not in proper state\n");
				retval = -EINVAL;
				goto END;
			}
			if (is_enable_rx_possible(radio) != 0) {
				FMDERR("%s: fm is not in proper state\n",
					 __func__);
				retval = -EINVAL;
				goto END;
			}
			radio->mode = FM_RECV_TURNING_ON;
			retval = hci_cmd(HCI_FM_ENABLE_RECV_CMD,
							 radio->fm_hdev);
			if (retval < 0) {
				FMDERR("Enabling RECV FM fail %d\n", retval);
				radio->mode = FM_OFF;
				goto END;
			} else {
				retval = initialise_recv(radio);
				if (retval < 0) {
					FMDERR("Error while initialising");
					FMDERR("radio %d\n", retval);
					hci_cmd(HCI_FM_DISABLE_RECV_CMD,
							radio->fm_hdev);
					radio->mode = FM_OFF;
					goto END;
				}
			}
			if (radio->mode == FM_RECV_TURNING_ON) {
				radio->mode = FM_RECV;
				iris_q_event(radio, IRIS_EVT_RADIO_READY);
			}
			break;
		case FM_TRANS:
			if (is_enable_tx_possible(radio) != 0) {
				retval = -EINVAL;
				goto END;
			}
			radio->mode = FM_TRANS_TURNING_ON;
			retval = hci_cmd(HCI_FM_ENABLE_TRANS_CMD,
							 radio->fm_hdev);
			if (retval < 0) {
				FMDERR("Enabling TRANS FM fail %d\n", retval);
				radio->mode = FM_OFF;
				goto END;
			} else {
				retval = initialise_trans(radio);
				if (retval < 0) {
					FMDERR("Error while initialising");
					FMDERR("radio %d\n", retval);
					hci_cmd(HCI_FM_DISABLE_TRANS_CMD,
								radio->fm_hdev);
					radio->mode = FM_OFF;
					goto END;
				}
			}
			if (radio->mode == FM_TRANS_TURNING_ON) {
				radio->mode = FM_TRANS;
				iris_q_event(radio, IRIS_EVT_RADIO_READY);
			}
			break;
		case FM_OFF:
			radio->spur_table_size = 0;
			switch (radio->mode) {
			case FM_RECV:
				radio->mode = FM_TURNING_OFF;
				retval = hci_cmd(HCI_FM_DISABLE_RECV_CMD,
						radio->fm_hdev);
				if (retval < 0) {
					FMDERR("Err on disable recv FM");
					FMDERR("%d\n", retval);
					radio->mode = FM_RECV;
					goto END;
				}
				break;
			case FM_TRANS:
				radio->mode = FM_TURNING_OFF;
				retval = hci_cmd(HCI_FM_DISABLE_TRANS_CMD,
						radio->fm_hdev);

				if (retval < 0) {
					FMDERR("Err disabling trans FM");
					FMDERR("%d\n", retval);
					radio->mode = FM_TRANS;
					goto END;
				}
				break;
			default:
				retval = -EINVAL;
			}
			break;
		default:
			retval = -EINVAL;
		}
		break;
	case V4L2_CID_PRIVATE_IRIS_REGION:
		if (radio->mode == FM_RECV) {
			retval = iris_recv_set_region(radio, ctrl->value);
		} else {
			if (radio->mode == FM_TRANS) {
				retval = iris_trans_set_region(radio,
						ctrl->value);
			} else {
				FMDERR("%s: fm is not in proper state\n",
					__func__);
				retval = -EINVAL;
				goto END;
			}
		}
		break;
	case V4L2_CID_PRIVATE_IRIS_SIGNAL_TH:
		if (!is_valid_sig_th(ctrl->value)) {
			retval = -EINVAL;
			FMDERR("%s: sig threshold is not valid\n", __func__);
			goto END;
		}
		temp_val = ctrl->value;
		retval = hci_fm_set_signal_threshold(
				&temp_val,
				radio->fm_hdev);
		if (retval < 0) {
			FMDERR("Error while setting signal threshold\n");
			goto END;
		}
		break;
	case V4L2_CID_PRIVATE_IRIS_SRCH_PTY:
		if (is_valid_pty(ctrl->value)) {
			radio->srch_rds.srch_pty = ctrl->value;
			radio->srch_st_list.srch_pty = ctrl->value;
		} else {
			FMDERR("%s: pty is not valid\n", __func__);
			retval = -EINVAL;
			goto END;
		}
		break;
	case V4L2_CID_PRIVATE_IRIS_SRCH_PI:
		if (is_valid_pi(ctrl->value)) {
			radio->srch_rds.srch_pi = ctrl->value;
		} else {
			retval = -EINVAL;
			FMDERR("%s: Pi is not valid\n", __func__);
			goto END;
		}
		break;
	case V4L2_CID_PRIVATE_IRIS_SRCH_CNT:
		if (is_valid_srch_station_cnt(ctrl->value)) {
			radio->srch_st_list.srch_list_max = ctrl->value;
		} else {
			retval = -EINVAL;
			FMDERR("%s: srch station count is not valid\n",
				__func__);
			goto END;
		}
		break;
	case V4L2_CID_PRIVATE_IRIS_SPACING:
		if (!is_valid_chan_spacing(ctrl->value)) {
			retval = -EINVAL;
			FMDERR("%s: channel spacing is not valid\n", __func__);
			goto END;
		}
		if (radio->mode == FM_RECV) {
			saved_val = radio->recv_conf.ch_spacing;
			radio->recv_conf.ch_spacing = ctrl->value;
			retval = hci_set_fm_recv_conf(
					&radio->recv_conf,
						radio->fm_hdev);
			if (retval < 0) {
				FMDERR("Error in setting channel spacing");
				radio->recv_conf.ch_spacing = saved_val;
				goto END;
			}
		}
		break;
	case V4L2_CID_PRIVATE_IRIS_EMPHASIS:
		if (!is_valid_emphasis(ctrl->value)) {
			retval = -EINVAL;
			FMDERR("%s, emphasis is not valid\n", __func__);
			goto END;
		}
		switch (radio->mode) {
		case FM_RECV:
			saved_val = radio->recv_conf.emphasis;
			radio->recv_conf.emphasis = ctrl->value;
			retval = hci_set_fm_recv_conf(
					&radio->recv_conf,
						radio->fm_hdev);
			if (retval < 0) {
				FMDERR("Error in setting emphasis");
				radio->recv_conf.emphasis = saved_val;
				goto END;
			}
			break;
		case FM_TRANS:
			saved_val = radio->trans_conf.emphasis;
			radio->trans_conf.emphasis = ctrl->value;
			retval = hci_set_fm_trans_conf(
					&radio->trans_conf,
						radio->fm_hdev);
			if (retval < 0) {
				FMDERR("Error in setting emphasis");
				radio->trans_conf.emphasis = saved_val;
				goto END;
			}
			break;
		default:
			retval = -EINVAL;
			FMDERR("%s, FM is not in proper state\n", __func__);
			goto END;
		}
		break;
	case V4L2_CID_PRIVATE_IRIS_RDS_STD:
		if (!is_valid_rds_std(ctrl->value)) {
			retval = -EINVAL;
			FMDERR("%s: rds std is not valid\n", __func__);
			goto END;
		}
		switch (radio->mode) {
		case FM_RECV:
			saved_val = radio->recv_conf.rds_std;
			radio->recv_conf.rds_std = ctrl->value;
			retval = hci_set_fm_recv_conf(
					&radio->recv_conf,
						radio->fm_hdev);
			if (retval < 0) {
				FMDERR("Error in rds_std");
				radio->recv_conf.rds_std = saved_val;
				goto END;
			}
			break;
		case FM_TRANS:
			saved_val = radio->trans_conf.rds_std;
			radio->trans_conf.rds_std = ctrl->value;
			retval = hci_set_fm_trans_conf(
					&radio->trans_conf,
						radio->fm_hdev);
			if (retval < 0) {
				FMDERR("Error in rds_Std");
				radio->trans_conf.rds_std = saved_val;
				goto END;
			}
			break;
		default:
			retval = -EINVAL;
			FMDERR("%s: fm is not in proper state\n", __func__);
			goto END;
		}
		break;
	case V4L2_CID_PRIVATE_IRIS_RDSON:
		if (!is_valid_rds_std(ctrl->value)) {
			retval = -EINVAL;
			FMDERR("%s: rds std is not valid\n", __func__);
			goto END;
		}
		switch (radio->mode) {
		case FM_RECV:
			saved_val = radio->recv_conf.rds_std;
			radio->recv_conf.rds_std = ctrl->value;
			retval = hci_set_fm_recv_conf(
					&radio->recv_conf,
						radio->fm_hdev);
			if (retval < 0) {
				FMDERR("Error in rds_std");
				radio->recv_conf.rds_std = saved_val;
				goto END;
			}
			break;
		case FM_TRANS:
			saved_val = radio->trans_conf.rds_std;
			radio->trans_conf.rds_std = ctrl->value;
			retval = hci_set_fm_trans_conf(
					&radio->trans_conf,
						radio->fm_hdev);
			if (retval < 0) {
				FMDERR("Error in rds_Std");
				radio->trans_conf.rds_std = saved_val;
				goto END;
			}
			break;
		default:
			retval = -EINVAL;
			FMDERR("%s: fm is not in proper state\n", __func__);
			goto END;
		}
		break;
	case V4L2_CID_PRIVATE_IRIS_RDSGROUP_MASK:
		saved_val = radio->rds_grp.rds_grp_enable_mask;
		grp_mask = (grp_mask | oda_agt | ctrl->value);
		radio->rds_grp.rds_grp_enable_mask = grp_mask;
		radio->rds_grp.rds_buf_size = 1;
		radio->rds_grp.en_rds_change_filter = 0;
		retval = hci_fm_rds_grp(&radio->rds_grp, radio->fm_hdev);
		if (retval < 0) {
			FMDERR("error in setting group mask\n");
			radio->rds_grp.rds_grp_enable_mask = saved_val;
			goto END;
		}
		break;
	case V4L2_CID_PRIVATE_IRIS_RDSGROUP_PROC:
		saved_val = radio->g_rds_grp_proc_ps;
		rds_grps_proc = radio->g_rds_grp_proc_ps | ctrl->value;
		radio->g_rds_grp_proc_ps = (rds_grps_proc >> RDS_CONFIG_OFFSET);
		retval = hci_fm_rds_grps_process(
				&radio->g_rds_grp_proc_ps,
				radio->fm_hdev);
		if (retval < 0) {
			radio->g_rds_grp_proc_ps = saved_val;
			goto END;
		}
		break;
	case V4L2_CID_PRIVATE_IRIS_RDSD_BUF:
		radio->rds_grp.rds_buf_size = ctrl->value;
		break;
	case V4L2_CID_PRIVATE_IRIS_PSALL:
		saved_val = radio->g_rds_grp_proc_ps;
		rds_grps_proc = (ctrl->value << RDS_CONFIG_OFFSET);
		radio->g_rds_grp_proc_ps |= rds_grps_proc;
		retval = hci_fm_rds_grps_process(
				&radio->g_rds_grp_proc_ps,
				radio->fm_hdev);
		if (retval < 0) {
			radio->g_rds_grp_proc_ps = saved_val;
			goto END;
		}
		break;
	case V4L2_CID_PRIVATE_IRIS_AF_JUMP:
		saved_val = radio->g_rds_grp_proc_ps;
		/*Clear the current AF jump settings*/
		radio->g_rds_grp_proc_ps &= ~(1 << RDS_AF_JUMP_OFFSET);
		radio->af_jump_bit = ctrl->value;
		rds_grps_proc = 0x00;
		rds_grps_proc = (ctrl->value << RDS_AF_JUMP_OFFSET);
		radio->g_rds_grp_proc_ps |= rds_grps_proc;
		retval = hci_fm_rds_grps_process(
				&radio->g_rds_grp_proc_ps,
				radio->fm_hdev);
		if (retval < 0) {
			radio->g_rds_grp_proc_ps = saved_val;
			goto END;
		}
		break;
	case V4L2_CID_PRIVATE_IRIS_LP_MODE:
		set_low_power_mode(radio, ctrl->value);
		break;
	case V4L2_CID_PRIVATE_IRIS_ANTENNA:
		if (!is_valid_antenna(ctrl->value)) {
			retval = -EINVAL;
			FMDERR("%s: antenna type is not valid\n", __func__);
			goto END;
		}
		temp_val = ctrl->value;
		retval = hci_fm_set_antenna(&temp_val, radio->fm_hdev);
		if (retval < 0) {
			FMDERR("Set Antenna failed retval = %x", retval);
			goto END;
		}
		radio->g_antenna =  ctrl->value;
		break;
	case V4L2_CID_RDS_TX_PTY:
		if (is_valid_pty(ctrl->value)) {
			radio->pty = ctrl->value;
		} else {
			retval = -EINVAL;
			FMDERR("%s: pty is not valid\n", __func__);
			goto END;
		}
		break;
	case V4L2_CID_RDS_TX_PI:
		if (is_valid_pi(ctrl->value)) {
			radio->pi = ctrl->value;
		} else {
			retval = -EINVAL;
			FMDERR("%s: pi is not valid\n", __func__);
			goto END;
		}
		break;
	case V4L2_CID_PRIVATE_IRIS_STOP_RDS_TX_PS_NAME:
		tx_ps.ps_control =  0x00;
		retval = radio_hci_request(radio->fm_hdev, hci_trans_ps_req,
				(unsigned long)&tx_ps, RADIO_HCI_TIMEOUT);
		break;
	case V4L2_CID_PRIVATE_IRIS_STOP_RDS_TX_RT:
		tx_rt.rt_control =  0x00;
		retval = radio_hci_request(radio->fm_hdev, hci_trans_rt_req,
				(unsigned long)&tx_rt, RADIO_HCI_TIMEOUT);
		break;
	case V4L2_CID_PRIVATE_IRIS_TX_SETPSREPEATCOUNT:
		if (is_valid_ps_repeat_cnt(ctrl->value)) {
			radio->ps_repeatcount = ctrl->value;
		} else {
			retval = -EINVAL;
			FMDERR("%s: ps repeat count is not valid\n", __func__);
			goto END;
		}
		break;
	case V4L2_CID_TUNE_POWER_LEVEL:
		if (ctrl->value > FM_TX_PWR_LVL_MAX)
			ctrl->value = FM_TX_PWR_LVL_MAX;
		if (ctrl->value < FM_TX_PWR_LVL_0)
			ctrl->value = FM_TX_PWR_LVL_0;
		rd.mode = FM_TX_PHY_CFG_MODE;
		rd.length = FM_TX_PHY_CFG_LEN;
		rd.param_len = 0x00;
		rd.param = 0x00;

		retval = hci_def_data_read(&rd, radio->fm_hdev);
		if (retval < 0) {
			FMDERR("Default data read failed for PHY_CFG %d\n",
				retval);
			goto END;
		}
		memset(&wrd, 0, sizeof(wrd));
		wrd.mode = FM_TX_PHY_CFG_MODE;
		wrd.length = FM_TX_PHY_CFG_LEN;
		memcpy(&wrd.data, &radio->default_data.data,
					radio->default_data.ret_data_len);
		wrd.data[FM_TX_PWR_GAIN_OFFSET] =
				(ctrl->value) * FM_TX_PWR_LVL_STEP_SIZE;
		retval = hci_def_data_write(&wrd, radio->fm_hdev);
		if (retval < 0)
			FMDERR("Default write failed for PHY_TXGAIN %d\n",
				retval);
		break;
	case V4L2_CID_PRIVATE_IRIS_SOFT_MUTE:
		if (!is_valid_soft_mute(ctrl->value)) {
			retval = -EINVAL;
			FMDERR("%s: soft mute is not valid\n", __func__);
			goto END;
		}
		saved_val = radio->mute_mode.soft_mute;
		radio->mute_mode.soft_mute = ctrl->value;
		retval = hci_set_fm_mute_mode(
				&radio->mute_mode,
				radio->fm_hdev);
		if (retval < 0) {
			FMDERR("Error while setting FM soft mute"" %d\n",
				retval);
			radio->mute_mode.soft_mute = saved_val;
			goto END;
		}
		break;
	case V4L2_CID_PRIVATE_IRIS_RIVA_ACCS_ADDR:
		radio->riva_data_req.cmd_params.start_addr = ctrl->value;
		break;
	case V4L2_CID_PRIVATE_IRIS_RIVA_ACCS_LEN:
		if (is_valid_peek_len(ctrl->value)) {
			radio->riva_data_req.cmd_params.length = ctrl->value;
		} else {
			retval = -EINVAL;
			FMDERR("%s: riva access len is not valid\n", __func__);
			goto END;
		}
		break;
	case V4L2_CID_PRIVATE_IRIS_RIVA_POKE:
		if (radio->riva_data_req.cmd_params.length <=
		    MAX_RIVA_PEEK_RSP_SIZE) {
#ifdef CONFIG_COMPAT
			retval = copy_from_user(
					radio->riva_data_req.data,
					(void *)(__s64)ctrl->value,
					radio->riva_data_req.cmd_params.length);
#else
			retval = copy_from_user(
					radio->riva_data_req.data,
					(void *)ctrl->value,
					radio->riva_data_req.cmd_params.length);
#endif
			if (retval != 0) {
				retval = -retval;
				goto END;
			}
			radio->riva_data_req.cmd_params.subopcode =
						RIVA_POKE_OPCODE;
			retval = hci_poke_data(
					&radio->riva_data_req,
					radio->fm_hdev);
		} else {
			FMDERR("Can not copy into driver's buffer.\n");
			retval = -EINVAL;
			goto END;
		}
		break;
	case V4L2_CID_PRIVATE_IRIS_SSBI_ACCS_ADDR:
		radio->ssbi_data_accs.start_addr = ctrl->value;
		break;
	case V4L2_CID_PRIVATE_IRIS_SSBI_POKE:
		radio->ssbi_data_accs.data = ctrl->value;
		retval = hci_ssbi_poke_reg(&radio->ssbi_data_accs ,
								radio->fm_hdev);
		break;
	case V4L2_CID_PRIVATE_IRIS_RIVA_PEEK:
		radio->riva_data_req.cmd_params.subopcode = RIVA_PEEK_OPCODE;
		ctrl->value = hci_peek_data(&radio->riva_data_req.cmd_params ,
						radio->fm_hdev);
		break;
	case V4L2_CID_PRIVATE_IRIS_SSBI_PEEK:
		radio->ssbi_peek_reg.start_address = ctrl->value;
		hci_ssbi_peek_reg(&radio->ssbi_peek_reg, radio->fm_hdev);
		break;
	case V4L2_CID_PRIVATE_IRIS_RDS_GRP_COUNTERS:
		if (is_valid_reset_cntr(ctrl->value)) {
			temp_val = ctrl->value;
			hci_read_grp_counters(&temp_val, radio->fm_hdev);
		} else {
			FMDERR("%s: reset counter value is not valid\n",
				__func__);
			retval = -EINVAL;
			goto END;
		}
		break;
	case V4L2_CID_PRIVATE_IRIS_HLSI:
		if (!is_valid_hlsi(ctrl->value)) {
			FMDERR("%s: hlsi value is not valid\n", __func__);
			retval = -EINVAL;
			goto END;
		}
		retval = hci_cmd(HCI_FM_GET_RECV_CONF_CMD,
						radio->fm_hdev);
		if (retval)
			goto END;
		saved_val = radio->recv_conf.hlsi;
		radio->recv_conf.hlsi = ctrl->value;
		retval = hci_set_fm_recv_conf(
					&radio->recv_conf,
						radio->fm_hdev);
		if (retval < 0)
			radio->recv_conf.hlsi = saved_val;
		break;
	case V4L2_CID_PRIVATE_IRIS_SET_NOTCH_FILTER:
		if (is_valid_notch_filter(ctrl->value)) {
			temp_val = ctrl->value;
			retval = hci_set_notch_filter(&temp_val,
							radio->fm_hdev);
		} else {
			FMDERR("%s: notch filter is not valid\n", __func__);
			retval = -EINVAL;
			goto END;
		}
		break;
	case V4L2_CID_PRIVATE_INTF_HIGH_THRESHOLD:
		if (!is_valid_intf_det_hgh_th(ctrl->value)) {
			FMDERR("%s: intf high threshold is not valid\n",
				__func__);
			retval = -EINVAL;
			goto END;
		}
		retval = hci_cmd(HCI_FM_GET_DET_CH_TH_CMD, radio->fm_hdev);
		if (retval < 0) {
			FMDERR("Failed to get chnl det thresholds  %d", retval);
			goto END;
		}
		saved_val = radio->ch_det_threshold.high_th;
		radio->ch_det_threshold.high_th = ctrl->value;
		retval = hci_set_ch_det_thresholds_req(&radio->ch_det_threshold,
							 radio->fm_hdev);
		if (retval < 0) {
			FMDERR("Failed to set High det threshold %d ", retval);
			radio->ch_det_threshold.high_th = saved_val;
			goto END;
		}
		break;

	case V4L2_CID_PRIVATE_INTF_LOW_THRESHOLD:
		if (!is_valid_intf_det_low_th(ctrl->value)) {
			FMDERR("%s: intf det low threshold is not valid\n",
				__func__);
			retval = -EINVAL;
			goto END;
		}
		retval = hci_cmd(HCI_FM_GET_DET_CH_TH_CMD, radio->fm_hdev);
		if (retval < 0) {
			FMDERR("Failed to get chnl det thresholds  %d", retval);
			goto END;
		}
		saved_val = radio->ch_det_threshold.low_th;
		radio->ch_det_threshold.low_th = ctrl->value;
		retval = hci_set_ch_det_thresholds_req(&radio->ch_det_threshold,
							 radio->fm_hdev);
		if (retval < 0) {
			FMDERR("Failed to Set Low det threshold %d", retval);
			radio->ch_det_threshold.low_th = saved_val;
			goto END;
		}
		break;

	case V4L2_CID_PRIVATE_SINR_THRESHOLD:
		if (!is_valid_sinr_th(ctrl->value)) {
			FMDERR("%s: sinr threshold is not valid\n", __func__);
			retval = -EINVAL;
			goto END;
		}
		retval = hci_cmd(HCI_FM_GET_DET_CH_TH_CMD, radio->fm_hdev);
		if (retval < 0) {
			FMDERR("Failed to get chnl det thresholds  %d", retval);
			goto END;
		}
		saved_val = radio->ch_det_threshold.sinr;
		radio->ch_det_threshold.sinr = ctrl->value;
		retval = hci_set_ch_det_thresholds_req(&radio->ch_det_threshold,
							 radio->fm_hdev);
		if (retval < 0) {
			FMDERR("Failed to set SINR threshold %d", retval);
			radio->ch_det_threshold.sinr = saved_val;
			goto END;
		}
		break;

	case V4L2_CID_PRIVATE_SINR_SAMPLES:
		if (!is_valid_sinr_samples(ctrl->value)) {
			FMDERR("%s: sinr samples count is not valid\n",
				__func__);
			retval = -EINVAL;
			goto END;
		}
		retval = hci_cmd(HCI_FM_GET_DET_CH_TH_CMD, radio->fm_hdev);
		if (retval < 0) {
			FMDERR("Failed to get chnl det thresholds  %d", retval);
			goto END;
		}
		saved_val = radio->ch_det_threshold.sinr_samples;
		radio->ch_det_threshold.sinr_samples = ctrl->value;
		retval = hci_set_ch_det_thresholds_req(&radio->ch_det_threshold,
							 radio->fm_hdev);
	       if (retval < 0) {
			FMDERR("Failed to set SINR samples  %d", retval);
			radio->ch_det_threshold.sinr_samples = saved_val;
			goto END;
		}
		break;

	case V4L2_CID_PRIVATE_IRIS_SRCH_ALGORITHM:
	case V4L2_CID_PRIVATE_IRIS_SET_AUDIO_PATH:
		/*
		These private controls are place holders to keep the
		driver compatible with changes done in the frameworks
		which are specific to TAVARUA.
		*/
		retval = 0;
		break;
	case V4L2_CID_PRIVATE_SPUR_FREQ:
		if (radio->spur_table_size >= MAX_SPUR_FREQ_LIMIT) {
			FMDERR("%s: Spur Table Full!\n", __func__);
			retval = -1;
		} else
			radio->spur_data.freq[radio->spur_table_size] =
				ctrl->value;
		break;
	case V4L2_CID_PRIVATE_SPUR_FREQ_RMSSI:
		if (radio->spur_table_size >= MAX_SPUR_FREQ_LIMIT) {
			FMDERR("%s: Spur Table Full!\n", __func__);
			retval = -1;
		} else
			radio->spur_data.rmssi[radio->spur_table_size] =
				ctrl->value;
		break;
	case V4L2_CID_PRIVATE_SPUR_SELECTION:
		if (radio->spur_table_size >= MAX_SPUR_FREQ_LIMIT) {
			FMDERR("%s: Spur Table Full!\n", __func__);
			retval = -1;
		} else {
			radio->spur_data.enable[radio->spur_table_size] =
				ctrl->value;
			radio->spur_table_size++;
		}
		break;
	case V4L2_CID_PRIVATE_UPDATE_SPUR_TABLE:
		update_spur_table(radio);
		break;
	case V4L2_CID_PRIVATE_VALID_CHANNEL:
		retval = hci_cmd(HCI_FM_GET_DET_CH_TH_CMD, radio->fm_hdev);
		if (retval < 0) {
			FMDERR("%s: Failed to determine channel's validity\n",
				__func__);
			goto END;
		} else {
			sinr_th = radio->ch_det_threshold.sinr;
			intf_det_low_th = radio->ch_det_threshold.low_th;
			intf_det_high_th = radio->ch_det_threshold.high_th;
		}
		if (!is_valid_sinr_th(sinr_th) ||
			!is_valid_intf_det_low_th(intf_det_low_th) ||
			!is_valid_intf_det_hgh_th(intf_det_high_th)) {
			retval = -EINVAL;
			goto END;
		}
		retval = hci_cmd(HCI_FM_GET_STATION_PARAM_CMD, radio->fm_hdev);
		if (retval < 0) {
			FMDERR("%s: Failed to determine channel's validity\n",
				__func__);
			goto END;
		} else
			sinr = radio->fm_st_rsp.station_rsp.sinr;

		retval = hci_cmd(HCI_FM_STATION_DBG_PARAM_CMD, radio->fm_hdev);
		if (retval < 0) {
			FMDERR("%s: Failed to determine channel's validity\n",
				 __func__);
			goto END;
		} else
			intf_det_out = radio->st_dbg_param.in_det_out;

		if ((sinr >= sinr_th) && (intf_det_out >= intf_det_low_th) &&
			(intf_det_out <= intf_det_high_th))
			radio->is_station_valid = VALID_CHANNEL;
		else
			radio->is_station_valid = INVALID_CHANNEL;
		break;
	case V4L2_CID_PRIVATE_AF_RMSSI_TH:
		rd.mode = FM_RDS_CNFG_MODE;
		rd.length = FM_RDS_CNFG_LEN;
		rd.param_len = 0;
		rd.param = 0;

		retval = hci_def_data_read(&rd, radio->fm_hdev);
		if (retval < 0) {
			FMDERR("default data read failed %x", retval);
			goto END;
		}
		wrd.mode = FM_RDS_CNFG_MODE;
		wrd.length = FM_RDS_CNFG_LEN;
		memcpy(&wrd.data, &radio->default_data.data,
				radio->default_data.ret_data_len);
		wrd.data[AF_RMSSI_TH_LSB_OFFSET] = ((ctrl->value) & 255);
		wrd.data[AF_RMSSI_TH_MSB_OFFSET] = ((ctrl->value) >> 8);
		retval = hci_def_data_write(&wrd, radio->fm_hdev);
		if (retval < 0)
			FMDERR("set AF jump RMSSI threshold failed\n");
		break;
	case V4L2_CID_PRIVATE_AF_RMSSI_SAMPLES:
		rd.mode = FM_RDS_CNFG_MODE;
		rd.length = FM_RDS_CNFG_LEN;
		rd.param_len = 0;
		rd.param = 0;

		retval = hci_def_data_read(&rd, radio->fm_hdev);
		if (retval < 0) {
			FMDERR("default data read failed %x", retval);
			goto END;
		}
		wrd.mode = FM_RDS_CNFG_MODE;
		wrd.length = FM_RDS_CNFG_LEN;
		memcpy(&wrd.data, &radio->default_data.data,
				radio->default_data.ret_data_len);
		wrd.data[AF_RMSSI_SAMPLES_OFFSET] = ctrl->value;
		retval = hci_def_data_write(&wrd, radio->fm_hdev);
		if (retval < 0)
			FMDERR("set AF jump RMSSI Samples failed\n");
		break;
	case V4L2_CID_PRIVATE_GOOD_CH_RMSSI_TH:
		rd.mode = FM_RX_CONFG_MODE;
		rd.length = FM_RX_CNFG_LEN;
		rd.param_len = 0;
		rd.param = 0;

		retval = hci_def_data_read(&rd, radio->fm_hdev);
		if (retval < 0) {
			FMDERR("default data read failed %x", retval);
			goto END;
		}
		wrd.mode = FM_RX_CONFG_MODE;
		wrd.length = FM_RX_CNFG_LEN;
		memcpy(&wrd.data, &radio->default_data.data,
				radio->default_data.ret_data_len);
		wrd.data[GD_CH_RMSSI_TH_OFFSET] = ctrl->value;
		retval = hci_def_data_write(&wrd, radio->fm_hdev);
		if (retval < 0)
			FMDERR("set good channel RMSSI th failed\n");
		break;
	case V4L2_CID_PRIVATE_SRCHALGOTYPE:
		rd.mode = FM_RX_CONFG_MODE;
		rd.length = FM_RX_CNFG_LEN;
		rd.param_len = 0;
		rd.param = 0;

		retval = hci_def_data_read(&rd, radio->fm_hdev);
		if (retval < 0) {
			FMDERR("default data read failed %x", retval);
			goto END;
		}
		wrd.mode = FM_RX_CONFG_MODE;
		wrd.length = FM_RX_CNFG_LEN;
		memcpy(&wrd.data, &radio->default_data.data,
				radio->default_data.ret_data_len);
		wrd.data[SRCH_ALGO_TYPE_OFFSET] = ctrl->value;
		retval = hci_def_data_write(&wrd, radio->fm_hdev);
		if (retval < 0)
			FMDERR("set Search Algo Type failed\n");
		break;
	case V4L2_CID_PRIVATE_SINRFIRSTSTAGE:
		rd.mode = FM_RX_CONFG_MODE;
		rd.length = FM_RX_CNFG_LEN;
		rd.param_len = 0;
		rd.param = 0;

		retval = hci_def_data_read(&rd, radio->fm_hdev);
		if (retval < 0) {
			FMDERR("default data read failed %x", retval);
			goto END;
		}
		wrd.mode = FM_RX_CONFG_MODE;
		wrd.length = FM_RX_CNFG_LEN;
		memcpy(&wrd.data, &radio->default_data.data,
				radio->default_data.ret_data_len);
		wrd.data[SINRFIRSTSTAGE_OFFSET] = ctrl->value;
		retval = hci_def_data_write(&wrd, radio->fm_hdev);
		if (retval < 0)
			FMDERR("set SINR First Stage failed\n");
		break;
	case V4L2_CID_PRIVATE_RMSSIFIRSTSTAGE:
		rd.mode = FM_RX_CONFG_MODE;
		rd.length = FM_RX_CNFG_LEN;
		rd.param_len = 0;
		rd.param = 0;

		retval = hci_def_data_read(&rd, radio->fm_hdev);
		if (retval < 0) {
			FMDERR("default data read failed %x", retval);
			goto END;
		}
		wrd.mode = FM_RX_CONFG_MODE;
		wrd.length = FM_RX_CNFG_LEN;
		memcpy(&wrd.data, &radio->default_data.data,
				radio->default_data.ret_data_len);
		wrd.data[RMSSIFIRSTSTAGE_OFFSET] = ctrl->value;
		retval = hci_def_data_write(&wrd, radio->fm_hdev);
		if (retval < 0)
			FMDERR("set RMSSI First Stage failed\n");
		break;
	case V4L2_CID_PRIVATE_CF0TH12:
		rd.mode = FM_RX_CONFG_MODE;
		rd.length = FM_RX_CNFG_LEN;
		rd.param_len = 0;
		rd.param = 0;

		retval = hci_def_data_read(&rd, radio->fm_hdev);
		if (retval < 0) {
			FMDERR("default data read failed %x", retval);
			goto END;
		}
		wrd.mode = FM_RX_CONFG_MODE;
		wrd.length = FM_RX_CNFG_LEN;
		memcpy(&wrd.data, &radio->default_data.data,
				radio->default_data.ret_data_len);
		wrd.data[CF0TH12_BYTE1_OFFSET] = (ctrl->value & 255);
		wrd.data[CF0TH12_BYTE2_OFFSET] = ((ctrl->value >> 8) & 255);
		wrd.data[CF0TH12_BYTE3_OFFSET] = ((ctrl->value >> 16) & 255);
		wrd.data[CF0TH12_BYTE4_OFFSET] = ((ctrl->value >> 24) & 255);
		retval = hci_def_data_write(&wrd, radio->fm_hdev);
		if (retval < 0)
			FMDERR("set CF0 Threshold failed\n");
		break;
	case V4L2_CID_PRIVATE_RXREPEATCOUNT:
		rd.mode = RDS_PS0_XFR_MODE;
		rd.length = RDS_PS0_LEN;
		rd.param_len = 0;
		rd.param = 0;

		retval = hci_def_data_read(&rd, radio->fm_hdev);
		if (retval < 0) {
			FMDERR("default data read failed for PS0 %x", retval);
			goto END;
		}
		wrd.mode = RDS_PS0_XFR_MODE;
		wrd.length = RDS_PS0_LEN;
		memcpy(&wrd.data, &radio->default_data.data,
				radio->default_data.ret_data_len);
		wrd.data[RX_REPEATE_BYTE_OFFSET] = ctrl->value;

		retval = hci_def_data_write(&wrd, radio->fm_hdev);
		if (retval < 0)
			FMDERR("set RxRePeat count failed\n");
		break;
	case V4L2_CID_PRIVATE_IRIS_GET_SPUR_TBL:
		spur_freq = ctrl->value;
		retval = radio_hci_request(radio->fm_hdev,
					hci_fm_get_spur_tbl_data,
					(unsigned long)spur_freq,
					RADIO_HCI_TIMEOUT);
		if (retval < 0)
			FMDERR("get Spur data failed\n");
		break;
	case V4L2_CID_PRIVATE_BLEND_SINRHI:
		if (!is_valid_blend_value(ctrl->value)) {
			FMDERR("%s: blend sinr count is not valid\n",
				__func__);
			retval = -EINVAL;
			goto END;
		}
		retval = hci_cmd(HCI_FM_GET_BLND_TBL_CMD, radio->fm_hdev);
		if (retval < 0) {
			FMDERR("Failed to get blend table  %d", retval);
			goto END;
		}
		radio->blend_tbl.scBlendSinrHi = ctrl->value;
		retval = hci_set_blend_tbl_req(&radio->blend_tbl,
					 radio->fm_hdev);
		if (retval < 0) {
			FMDERR("Failed to set blend tble %d ", retval);
			goto END;
		}
		break;
	case V4L2_CID_PRIVATE_BLEND_RMSSIHI:
		if (!is_valid_blend_value(ctrl->value)) {
			FMDERR("%s: blend rmssi count is not valid\n",
				__func__);
			retval = -EINVAL;
			goto END;
		}
		retval = hci_cmd(HCI_FM_GET_BLND_TBL_CMD, radio->fm_hdev);
		if (retval < 0) {
			FMDERR("Failed to get blend table  %d", retval);
			goto END;
		}
		radio->blend_tbl.scBlendRmssiHi = ctrl->value;
		retval = hci_set_blend_tbl_req(&radio->blend_tbl,
					 radio->fm_hdev);
		if (retval < 0) {
			FMDERR("Failed to set blend tble %d ", retval);
			goto END;
		}
		break;
	default:
		retval = -EINVAL;
		break;
	}

END:
	if (retval > 0)
		retval = -EINVAL;

	return retval;
}

static int update_spur_table(struct iris_device *radio)
{
	struct hci_fm_def_data_wr_req default_data;
	int len = 0, index = 0, offset = 0, i = 0;
	int retval = 0, temp = 0, cnt = 0;

	memset(&default_data, 0, sizeof(default_data));

	/* Pass the mode of SPUR_CLK */
	default_data.mode = CKK_SPUR;

	if (unlikely(radio == NULL)) {
		FMDERR(":radio is null");
		return -EINVAL;
	}
	temp = radio->spur_table_size;
	for (cnt = 0; cnt < (temp / 5); cnt++) {
		offset = 0;
		/*
		 * Program the spur entries in spur table in following order:
		 *    Spur index
		 *    Length of the spur data
		 *    Spur Data:
		 *        MSB of the spur frequency
		 *        LSB of the spur frequency
		 *        Enable/Disable the spur frequency
		 *        RMSSI value of the spur frequency
		 */
		default_data.data[offset++] = ENTRY_0 + cnt;
		for (i = 0; i < SPUR_ENTRIES_PER_ID; i++) {
			default_data.data[offset++] = GET_FREQ(COMPUTE_SPUR(
				radio->spur_data.freq[index]), 0);
			default_data.data[offset++] = GET_FREQ(COMPUTE_SPUR(
				radio->spur_data.freq[index]), 1);
			default_data.data[offset++] =
				radio->spur_data.enable[index];
			default_data.data[offset++] =
				radio->spur_data.rmssi[index];
			index++;
		}
		len = (SPUR_ENTRIES_PER_ID * SPUR_DATA_SIZE);
		default_data.length = (len + 1);
		retval = hci_def_data_write(&default_data, radio->fm_hdev);
		if (retval < 0) {
			FMDBG("%s: Failed to configure entries for ID : %d\n",
				__func__, default_data.data[0]);
			return retval;
		}
	}

	/* Compute balance SPUR frequencies to be programmed */
	temp %= SPUR_ENTRIES_PER_ID;
	if (temp > 0) {
		offset = 0;
		default_data.data[offset++] = (radio->spur_table_size / 5);
		for (i = 0; i < temp; i++) {
			default_data.data[offset++] = GET_FREQ(COMPUTE_SPUR(
				radio->spur_data.freq[index]), 0);
			default_data.data[offset++] = GET_FREQ(COMPUTE_SPUR(
				radio->spur_data.freq[index]), 1);
			default_data.data[offset++] =
				radio->spur_data.enable[index];
			default_data.data[offset++] =
				radio->spur_data.rmssi[index];
			index++;
		}
		len = (temp * SPUR_DATA_SIZE);
		default_data.length = (len + 1);
		retval = hci_def_data_write(&default_data, radio->fm_hdev);
		if (retval < 0) {
			FMDERR("%s: Failed to configure entries for ID : %d\n",
				__func__, default_data.data[0]);
			return retval;
		}
	}

	return retval;
}

static int iris_vidioc_g_tuner(struct file *file, void *priv,
		struct v4l2_tuner *tuner)
{
	int retval;
	struct iris_device *radio = video_get_drvdata(video_devdata(file));

	if (unlikely(radio == NULL)) {
		FMDERR(":radio is null");
		return -EINVAL;
	}
	if (tuner == NULL) {
		FMDERR("%s, tuner is null\n", __func__);
		return -EINVAL;
	}
	if (tuner->index > 0) {
		FMDERR("Invalid Tuner Index");
		return -EINVAL;
	}
	if (radio->mode == FM_RECV) {
		retval = hci_cmd(HCI_FM_GET_STATION_PARAM_CMD, radio->fm_hdev);
		if (retval < 0) {
			FMDERR("Failed to Get station params");
			return retval;
		}
		tuner->type = V4L2_TUNER_RADIO;
		tuner->rangelow  =
			radio->recv_conf.band_low_limit * TUNE_PARAM;
		tuner->rangehigh =
			radio->recv_conf.band_high_limit * TUNE_PARAM;
		tuner->rxsubchans = V4L2_TUNER_SUB_MONO | V4L2_TUNER_SUB_STEREO;
		tuner->capability = V4L2_TUNER_CAP_LOW;
		tuner->signal = radio->fm_st_rsp.station_rsp.rssi;
		tuner->audmode = radio->fm_st_rsp.station_rsp.stereo_prg;
		tuner->afc = 0;
	} else if (radio->mode == FM_TRANS) {
		retval = hci_cmd(HCI_FM_GET_TX_CONFIG, radio->fm_hdev);
		if (retval < 0) {
			FMDERR("get Tx config failed %d\n", retval);
			return retval;
		}
		tuner->type = V4L2_TUNER_RADIO;
		tuner->rangelow =
			radio->trans_conf.band_low_limit * TUNE_PARAM;
		tuner->rangehigh =
			radio->trans_conf.band_high_limit * TUNE_PARAM;
	} else
		return -EINVAL;
	return 0;
}

static int iris_vidioc_s_tuner(struct file *file, void *priv,
		const struct v4l2_tuner *tuner)
{
	struct iris_device *radio = video_get_drvdata(video_devdata(file));
	int retval = 0;

	if (unlikely(radio == NULL)) {
		FMDERR(":radio is null");
		return -EINVAL;
	}

	if (tuner == NULL) {
		FMDERR("%s, tuner is null\n", __func__);
		return -EINVAL;
	}

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

	if (radio->mode == FM_RECV) {
		radio->recv_conf.band_low_limit = tuner->rangelow / TUNE_PARAM;
		radio->recv_conf.band_high_limit =
			tuner->rangehigh / TUNE_PARAM;
		if (tuner->audmode == V4L2_TUNER_MODE_MONO) {
			radio->stereo_mode.stereo_mode = 0x01;
			retval = hci_set_fm_stereo_mode(
					&radio->stereo_mode,
					radio->fm_hdev);
		} else {
			radio->stereo_mode.stereo_mode = 0x00;
			retval = hci_set_fm_stereo_mode(
					&radio->stereo_mode,
					radio->fm_hdev);
		}
		if (retval < 0)
			FMDERR(": set tuner failed with %d\n", retval);
		return retval;
	} else if (radio->mode == FM_TRANS) {
			radio->trans_conf.band_low_limit =
				tuner->rangelow / TUNE_PARAM;
			radio->trans_conf.band_high_limit =
				tuner->rangehigh / TUNE_PARAM;
	} else
		return -EINVAL;

	return retval;
}

static int iris_vidioc_g_frequency(struct file *file, void *priv,
		struct v4l2_frequency *freq)
{
	struct iris_device *radio = video_get_drvdata(video_devdata(file));

	if ((freq != NULL) && (radio != NULL)) {
		freq->frequency =
			radio->fm_st_rsp.station_rsp.station_freq * TUNE_PARAM;
	} else
		return -EINVAL;
	return 0;
}

static int iris_vidioc_s_frequency(struct file *file, void *priv,
					const struct v4l2_frequency *freq)
{
	struct iris_device  *radio = video_get_drvdata(video_devdata(file));
	int retval = -1;
	u32 f;

	if (freq == NULL) {
		FMDERR("%s, v4l2 freq is null\n", __func__);
		return -EINVAL;
	}
	f = (freq->frequency / TUNE_PARAM);

	if (unlikely(radio == NULL)) {
		FMDERR(":radio is null");
		return -EINVAL;
	}
	if (freq->type != V4L2_TUNER_RADIO)
		return -EINVAL;

	/* We turn off RDS prior to tuning to a new station.
	   because of a bug in SoC which prevents tuning
	   during RDS transmission.
	 */
	if (radio->mode == FM_TRANS
		&& (radio->trans_conf.rds_std == 0 ||
			radio->trans_conf.rds_std == 1)) {
		radio->prev_trans_rds = radio->trans_conf.rds_std;
		radio->trans_conf.rds_std = 2;
		hci_set_fm_trans_conf(&radio->trans_conf,
				radio->fm_hdev);
	}

	retval = iris_set_freq(radio, f);

	if (radio->mode == FM_TRANS
		 && radio->trans_conf.rds_std == 2
			&& (radio->prev_trans_rds == 1
				|| radio->prev_trans_rds == 0)) {
		radio->trans_conf.rds_std = radio->prev_trans_rds;
		hci_set_fm_trans_conf(&radio->trans_conf,
				radio->fm_hdev);
	}

	if (retval < 0)
		FMDERR(" set frequency failed with %d\n", retval);
	return retval;
}

static int iris_fops_release(struct file *file)
{
	struct iris_device *radio = video_get_drvdata(video_devdata(file));
	int retval = 0;

	FMDBG("Enter %s ", __func__);
	if (radio == NULL)
		return -EINVAL;

	if (radio->mode == FM_OFF)
		goto END;

	if (radio->mode == FM_RECV) {
		radio->mode = FM_OFF;
		retval = hci_cmd(HCI_FM_DISABLE_RECV_CMD,
						radio->fm_hdev);
		/* wait for disable cmd resp from controller */
		msleep(50);
	} else if (radio->mode == FM_TRANS) {
		radio->mode = FM_OFF;
		retval = hci_cmd(HCI_FM_DISABLE_TRANS_CMD,
					radio->fm_hdev);
		/* wait for disable cmd resp from controller */
		msleep(50);
	} else if (radio->mode == FM_CALIB) {
		radio->mode = FM_OFF;
		return retval;
	}
END:
	if (radio->fm_hdev != NULL)
		radio->fm_hdev->close_smd();
	if (retval < 0)
		FMDERR("Err on disable FM %d\n", retval);

	return retval;
}

static int iris_vidioc_dqbuf(struct file *file, void *priv,
				struct v4l2_buffer *buffer)
{
	struct iris_device  *radio = video_get_drvdata(video_devdata(file));
	enum iris_buf_t buf_type = -1;
	unsigned char buf_fifo[STD_BUF_SIZE] = {0};
	struct kfifo *data_fifo = NULL;
	unsigned char *buf = NULL;
	unsigned int len = 0, retval = -1;

	if ((radio == NULL) || (buffer == NULL)) {
		FMDERR("radio/buffer is NULL\n");
		return -ENXIO;
	}
	buf_type = buffer->index;
	buf = (unsigned char *)buffer->m.userptr;
	len = buffer->length;

	if ((buf_type < IRIS_BUF_MAX) && (buf_type >= 0)) {
		data_fifo = &radio->data_buf[buf_type];
		if (buf_type == IRIS_BUF_EVENTS)
			if (wait_event_interruptible(radio->event_queue,
				kfifo_len(data_fifo)) < 0)
				return -EINTR;
	} else {
		FMDERR("invalid buffer type\n");
		return -EINVAL;
	}
	if (len <= STD_BUF_SIZE) {
		buffer->bytesused = kfifo_out_locked(data_fifo, &buf_fifo[0],
					len, &radio->buf_lock[buf_type]);
	} else {
		FMDERR("kfifo_out_locked can not use len more than 128\n");
		return -EINVAL;
	}
	retval = copy_to_user(buf, &buf_fifo[0], buffer->bytesused);
	if (retval > 0) {
		FMDERR("Failed to copy %d bytes of data\n", retval);
		return -EAGAIN;
	}

	return retval;
}

static int iris_vidioc_g_fmt_type_private(struct file *file, void *priv,
						struct v4l2_format *f)
{
	return 0;

}

static int iris_vidioc_s_hw_freq_seek(struct file *file, void *priv,
					const struct v4l2_hw_freq_seek *seek)
{
	struct iris_device *radio = video_get_drvdata(video_devdata(file));
	int dir;

	if (seek == NULL) {
		FMDERR("%s, v4l2_hw_freq_seek is null\n", __func__);
		return -EINVAL;
	}
	if (seek->seek_upward)
		dir = SRCH_DIR_UP;
	else
		dir = SRCH_DIR_DOWN;
	return iris_search(radio, CTRL_ON, dir);
}

static int iris_vidioc_querycap(struct file *file, void *priv,
	struct v4l2_capability *capability)
{
	struct iris_device *radio;

	radio = video_get_drvdata(video_devdata(file));

	if (unlikely(radio == NULL)) {
		FMDERR(":radio is null");
		return -EINVAL;
	}
	if (capability == NULL) {
		FMDERR("%s, capability struct is null\n", __func__);
		return -EINVAL;
	}
	strlcpy(capability->driver, DRIVER_NAME, sizeof(capability->driver));
	strlcpy(capability->card, DRIVER_CARD, sizeof(capability->card));

	strlcpy(radio->g_cap.driver, DRIVER_NAME, sizeof(radio->g_cap.driver));
	strlcpy(radio->g_cap.card, DRIVER_CARD, sizeof(radio->g_cap.card));

	radio->g_cap.capabilities = V4L2_CAP_TUNER | V4L2_CAP_RADIO;
	capability->capabilities = radio->g_cap.capabilities;
	return 0;
}

static int initialise_recv(struct iris_device *radio)
{
	int retval;

	if (unlikely(radio == NULL)) {
		FMDERR(":radio is null");
		return -EINVAL;
	}

	radio->mute_mode.soft_mute = CTRL_ON;
	retval = hci_set_fm_mute_mode(&radio->mute_mode,
					radio->fm_hdev);

	if (retval < 0) {
		FMDERR("Failed to enable Smute\n");
		return retval;
	}

	radio->stereo_mode.stereo_mode = CTRL_OFF;
	radio->stereo_mode.sig_blend = sig_blend;
	radio->stereo_mode.intf_blend = CTRL_ON;
	radio->stereo_mode.most_switch = CTRL_ON;
	retval = hci_set_fm_stereo_mode(&radio->stereo_mode,
						radio->fm_hdev);

	if (retval < 0) {
		FMDERR("Failed to set stereo mode\n");
		return retval;
	}

	radio->event_mask = SIG_LEVEL_INTR | RDS_SYNC_INTR | AUDIO_CTRL_INTR;
	retval = hci_conf_event_mask(&radio->event_mask, radio->fm_hdev);
	if (retval < 0) {
		FMDERR("Enable Async events failed");
		return retval;
	}

	retval = hci_cmd(HCI_FM_GET_RECV_CONF_CMD, radio->fm_hdev);
	if (retval < 0)
		FMDERR("Failed to get the Recv Config\n");
	return retval;
}

static int initialise_trans(struct iris_device *radio)
{

	int retval;

	if (unlikely(radio == NULL)) {
		FMDERR(":radio is null");
		return -EINVAL;
	}

	retval = hci_cmd(HCI_FM_GET_TX_CONFIG, radio->fm_hdev);
	if (retval < 0)
		FMDERR("get frequency failed %d\n", retval);

	return retval;
}

static int is_enable_rx_possible(struct iris_device *radio)
{
	int retval = 1;

	if (unlikely(radio == NULL)) {
		FMDERR(":radio is null");
		return -EINVAL;
	}

	if (radio->mode == FM_OFF || radio->mode == FM_RECV)
		retval = 0;

	return retval;
}

static int is_enable_tx_possible(struct iris_device *radio)
{
	int retval = 1;

	if (radio->mode == FM_OFF || radio->mode == FM_TRANS)
		retval = 0;

	return retval;
}

static const struct v4l2_ioctl_ops iris_ioctl_ops = {
	.vidioc_querycap              = iris_vidioc_querycap,
	.vidioc_queryctrl             = iris_vidioc_queryctrl,
	.vidioc_g_ctrl                = iris_vidioc_g_ctrl,
	.vidioc_s_ctrl                = iris_vidioc_s_ctrl,
	.vidioc_g_tuner               = iris_vidioc_g_tuner,
	.vidioc_s_tuner               = iris_vidioc_s_tuner,
	.vidioc_g_frequency           = iris_vidioc_g_frequency,
	.vidioc_s_frequency           = iris_vidioc_s_frequency,
	.vidioc_s_hw_freq_seek        = iris_vidioc_s_hw_freq_seek,
	.vidioc_dqbuf                 = iris_vidioc_dqbuf,
	.vidioc_g_fmt_type_private    = iris_vidioc_g_fmt_type_private,
	.vidioc_s_ext_ctrls           = iris_vidioc_s_ext_ctrls,
	.vidioc_g_ext_ctrls           = iris_vidioc_g_ext_ctrls,
};

static const struct v4l2_file_operations iris_fops = {
	.owner = THIS_MODULE,
	.unlocked_ioctl = video_ioctl2,
#ifdef CONFIG_COMPAT
	.compat_ioctl32 = v4l2_compat_ioctl32,
#endif
	.release        = iris_fops_release,
};

static struct video_device iris_viddev_template = {
	.fops                   = &iris_fops,
	.ioctl_ops              = &iris_ioctl_ops,
	.name                   = DRIVER_NAME,
	.release                = video_device_release,
};

static struct video_device *video_get_dev(void)
{
	return priv_videodev;
}

static int iris_probe(struct platform_device *pdev)
{
	struct iris_device *radio;
	int retval;
	int radio_nr = -1;
	int i;

	if (!pdev) {
		FMDERR(": pdev is null\n");
		return -ENOMEM;
	}

	radio = kzalloc(sizeof(struct iris_device), GFP_KERNEL);
	if (!radio) {
		FMDERR(": Could not allocate radio device\n");
		return -ENOMEM;
	}

	radio->dev = &pdev->dev;
	platform_set_drvdata(pdev, radio);

	radio->videodev = video_device_alloc();
	if (!radio->videodev) {
		FMDERR(": Could not allocate V4L device\n");
		kfree(radio);
		return -ENOMEM;
	}

	memcpy(radio->videodev, &iris_viddev_template,
	  sizeof(iris_viddev_template));
	strlcpy(radio->v4l2_dev.name, DRIVER_NAME,
			sizeof(radio->v4l2_dev.name));
	retval = v4l2_device_register(NULL, &radio->v4l2_dev);
	if (retval)
		return -EINVAL;
	radio->videodev->v4l2_dev = &radio->v4l2_dev;

	for (i = 0; i < IRIS_BUF_MAX; i++) {
		int kfifo_alloc_rc = 0;

		spin_lock_init(&radio->buf_lock[i]);

		if ((i == IRIS_BUF_RAW_RDS) || (i == IRIS_BUF_PEEK))
			kfifo_alloc_rc = kfifo_alloc(&radio->data_buf[i],
				rds_buf*3, GFP_KERNEL);
		else if ((i == IRIS_BUF_CAL_DATA) || (i == IRIS_BUF_RT_RDS))
			kfifo_alloc_rc = kfifo_alloc(&radio->data_buf[i],
				STD_BUF_SIZE*2, GFP_KERNEL);
		else
			kfifo_alloc_rc = kfifo_alloc(&radio->data_buf[i],
				STD_BUF_SIZE, GFP_KERNEL);

		if (kfifo_alloc_rc != 0) {
			FMDERR("failed allocating buffers %d\n",
				   kfifo_alloc_rc);
			for (; i > -1; i--)
				kfifo_free(&radio->data_buf[i]);
			video_device_release(radio->videodev);
			kfree(radio);
			return -ENOMEM;
		}
	}

	mutex_init(&radio->lock);
	init_completion(&radio->sync_xfr_start);
	radio->tune_req = 0;
	radio->prev_trans_rds = 2;
	init_waitqueue_head(&radio->event_queue);
	init_waitqueue_head(&radio->read_queue);

	video_set_drvdata(radio->videodev, radio);

	if (NULL == video_get_drvdata(radio->videodev))
		FMDERR(": video_get_drvdata failed\n");

	retval = video_register_device(radio->videodev, VFL_TYPE_RADIO,
								   radio_nr);
	if (retval) {
		FMDERR(": Could not register video device\n");
		video_device_release(radio->videodev);
		for (; i > -1; i--)
			kfifo_free(&radio->data_buf[i]);
		kfree(radio);
		return retval;
	}
	priv_videodev = kzalloc(sizeof(struct video_device),
			GFP_KERNEL);
	if (priv_videodev != NULL) {
		memcpy(priv_videodev, radio->videodev,
			sizeof(struct video_device));
	} else {
		video_unregister_device(radio->videodev);
		video_device_release(radio->videodev);
		for (; i > -1; i--)
			kfifo_free(&radio->data_buf[i]);
		kfree(radio);
	}
	return 0;
}


static int iris_remove(struct platform_device *pdev)
{
	int i;
	struct iris_device *radio = platform_get_drvdata(pdev);

	if (radio == NULL) {
		FMDERR(":radio is null");
		return -EINVAL;
	}
	video_unregister_device(radio->videodev);

	for (i = 0; i < IRIS_BUF_MAX; i++)
		kfifo_free(&radio->data_buf[i]);

	kfree(radio);

	platform_set_drvdata(pdev, NULL);

	return 0;
}

static const struct of_device_id iris_fm_match[] = {
	{.compatible = "qcom,iris_fm"},
	{}
};

static struct platform_driver iris_driver = {
	.probe	= iris_probe,
	.driver = {
		.owner  = THIS_MODULE,
		.name   = "iris_fm",
		.of_match_table = iris_fm_match,
	},
	.remove = iris_remove,
};

static int __init iris_radio_init(void)
{
	return platform_driver_register(&iris_driver);
}
module_init(iris_radio_init);

static void __exit iris_radio_exit(void)
{
	platform_driver_unregister(&iris_driver);
}
module_exit(iris_radio_exit);

MODULE_LICENSE("GPL v2");
MODULE_DESCRIPTION(DRIVER_DESC);