75 static void fm_irq_send_flag_getcmd(struct fmdev *);
76 static void fm_irq_handle_flag_getcmd_resp(struct fmdev *);
77 static void fm_irq_handle_hw_malfunction(struct fmdev *);
78 static void fm_irq_handle_rds_start(struct fmdev *);
79 static void fm_irq_send_rdsdata_getcmd(struct fmdev *);
80 static void fm_irq_handle_rdsdata_getcmd_resp(struct fmdev *);
81 static void fm_irq_handle_rds_finish(struct fmdev *);
82 static void fm_irq_handle_tune_op_ended(struct fmdev *);
83 static void fm_irq_handle_power_enb(struct fmdev *);
84 static void fm_irq_handle_low_rssi_start(struct fmdev *);
85 static void fm_irq_afjump_set_pi(struct fmdev *);
86 static void fm_irq_handle_set_pi_resp(struct fmdev *);
87 static void fm_irq_afjump_set_pimask(struct fmdev *);
88 static void fm_irq_handle_set_pimask_resp(struct fmdev *);
89 static void fm_irq_afjump_setfreq(struct fmdev *);
90 static void fm_irq_handle_setfreq_resp(struct fmdev *);
91 static void fm_irq_afjump_enableint(struct fmdev *);
92 static void fm_irq_afjump_enableint_resp(struct fmdev *);
93 static void fm_irq_start_afjump(struct fmdev *);
94 static void fm_irq_handle_start_afjump_resp(struct fmdev *);
95 static void fm_irq_afjump_rd_freq(struct fmdev *);
96 static void fm_irq_afjump_rd_freq_resp(struct fmdev *);
97 static void fm_irq_handle_low_rssi_finish(struct fmdev *);
98 static void fm_irq_send_intmsk_cmd(struct fmdev *);
99 static void fm_irq_handle_intmsk_cmd_resp(struct fmdev *);
177 static inline void fm_irq_call(struct fmdev *fmdev)  in fm_irq_call()  argument
179 	fmdev->irq_info.handlers[fmdev->irq_info.stage](fmdev);  in fm_irq_call()
183 static inline void fm_irq_call_stage(struct fmdev *fmdev, u8 stage)  in fm_irq_call_stage()  argument
185 	fmdev->irq_info.stage = stage;  in fm_irq_call_stage()
186 	fm_irq_call(fmdev);  in fm_irq_call_stage()
189 static inline void fm_irq_timeout_stage(struct fmdev *fmdev, u8 stage)  in fm_irq_timeout_stage()  argument
191 	fmdev->irq_info.stage = stage;  in fm_irq_timeout_stage()
192 	mod_timer(&fmdev->irq_info.timer, jiffies + FM_DRV_TX_TIMEOUT);  in fm_irq_timeout_stage()
247 void fmc_update_region_info(struct fmdev *fmdev, u8 region_to_set)  in fmc_update_region_info()  argument
249 	fmdev->rx.region = region_configs[region_to_set];  in fmc_update_region_info()
258 	struct fmdev *fmdev;  in recv_tasklet()  local
265 	fmdev = (struct fmdev *)arg;  in recv_tasklet()
266 	irq_info = &fmdev->irq_info;  in recv_tasklet()
268 	while ((skb = skb_dequeue(&fmdev->rx_q))) {  in recv_tasklet()
283 			if (!test_bit(FM_INTTASK_RUNNING, &fmdev->flag)) {  in recv_tasklet()
284 				set_bit(FM_INTTASK_RUNNING, &fmdev->flag);  in recv_tasklet()
294 				irq_info->handlers[irq_info->stage](fmdev);  in recv_tasklet()
296 				set_bit(FM_INTTASK_SCHEDULE_PENDING, &fmdev->flag);  in recv_tasklet()
301 		else if (evt_hdr->op == fmdev->pre_op && fmdev->resp_comp != NULL) {  in recv_tasklet()
303 			spin_lock_irqsave(&fmdev->resp_skb_lock, flags);  in recv_tasklet()
304 			fmdev->resp_skb = skb;  in recv_tasklet()
305 			spin_unlock_irqrestore(&fmdev->resp_skb_lock, flags);  in recv_tasklet()
306 			complete(fmdev->resp_comp);  in recv_tasklet()
308 			fmdev->resp_comp = NULL;  in recv_tasklet()
309 			atomic_set(&fmdev->tx_cnt, 1);  in recv_tasklet()
312 		else if (evt_hdr->op == fmdev->pre_op && fmdev->resp_comp == NULL) {  in recv_tasklet()
313 			if (fmdev->resp_skb != NULL)  in recv_tasklet()
316 			spin_lock_irqsave(&fmdev->resp_skb_lock, flags);  in recv_tasklet()
317 			fmdev->resp_skb = skb;  in recv_tasklet()
318 			spin_unlock_irqrestore(&fmdev->resp_skb_lock, flags);  in recv_tasklet()
321 			irq_info->handlers[irq_info->stage](fmdev);  in recv_tasklet()
324 			atomic_set(&fmdev->tx_cnt, 1);  in recv_tasklet()
333 		if (num_fm_hci_cmds && atomic_read(&fmdev->tx_cnt))  in recv_tasklet()
334 			if (!skb_queue_empty(&fmdev->tx_q))  in recv_tasklet()
335 				tasklet_schedule(&fmdev->tx_task);  in recv_tasklet()
342 	struct fmdev *fmdev;  in send_tasklet()  local
346 	fmdev = (struct fmdev *)arg;  in send_tasklet()
348 	if (!atomic_read(&fmdev->tx_cnt))  in send_tasklet()
352 	if ((jiffies - fmdev->last_tx_jiffies) > FM_DRV_TX_TIMEOUT) {  in send_tasklet()
354 		atomic_set(&fmdev->tx_cnt, 1);  in send_tasklet()
358 	skb = skb_dequeue(&fmdev->tx_q);  in send_tasklet()
362 	atomic_dec(&fmdev->tx_cnt);  in send_tasklet()
363 	fmdev->pre_op = fm_cb(skb)->fm_op;  in send_tasklet()
365 	if (fmdev->resp_comp != NULL)  in send_tasklet()
368 	fmdev->resp_comp = fm_cb(skb)->completion;  in send_tasklet()
374 		fmdev->resp_comp = NULL;  in send_tasklet()
376 		atomic_set(&fmdev->tx_cnt, 1);  in send_tasklet()
378 		fmdev->last_tx_jiffies = jiffies;  in send_tasklet()
386 static int fm_send_cmd(struct fmdev *fmdev, u8 fm_op, u16 type,	void *payload,  in fm_send_cmd()  argument
397 	if (test_bit(FM_FW_DW_INPROGRESS, &fmdev->flag) && payload == NULL) {  in fm_send_cmd()
401 	if (!test_bit(FM_FW_DW_INPROGRESS, &fmdev->flag))  in fm_send_cmd()
416 	if (!test_bit(FM_FW_DW_INPROGRESS, &fmdev->flag) ||  in fm_send_cmd()
417 			test_bit(FM_INTTASK_RUNNING, &fmdev->flag)) {  in fm_send_cmd()
448 	skb_queue_tail(&fmdev->tx_q, skb);  in fm_send_cmd()
449 	tasklet_schedule(&fmdev->tx_task);  in fm_send_cmd()
455 int fmc_send_cmd(struct fmdev *fmdev, u8 fm_op, u16 type, void *payload,  in fmc_send_cmd()  argument
463 	init_completion(&fmdev->maintask_comp);  in fmc_send_cmd()
464 	ret = fm_send_cmd(fmdev, fm_op, type, payload, payload_len,  in fmc_send_cmd()
465 			    &fmdev->maintask_comp);  in fmc_send_cmd()
469 	if (!wait_for_completion_timeout(&fmdev->maintask_comp,  in fmc_send_cmd()
475 	if (!fmdev->resp_skb) {  in fmc_send_cmd()
479 	spin_lock_irqsave(&fmdev->resp_skb_lock, flags);  in fmc_send_cmd()
480 	skb = fmdev->resp_skb;  in fmc_send_cmd()
481 	fmdev->resp_skb = NULL;  in fmc_send_cmd()
482 	spin_unlock_irqrestore(&fmdev->resp_skb_lock, flags);  in fmc_send_cmd()
506 static inline int check_cmdresp_status(struct fmdev *fmdev,  in check_cmdresp_status()  argument
512 	del_timer(&fmdev->irq_info.timer);  in check_cmdresp_status()
514 	spin_lock_irqsave(&fmdev->resp_skb_lock, flags);  in check_cmdresp_status()
515 	*skb = fmdev->resp_skb;  in check_cmdresp_status()
516 	fmdev->resp_skb = NULL;  in check_cmdresp_status()
517 	spin_unlock_irqrestore(&fmdev->resp_skb_lock, flags);  in check_cmdresp_status()
524 		mod_timer(&fmdev->irq_info.timer, jiffies + FM_DRV_TX_TIMEOUT);  in check_cmdresp_status()
531 static inline void fm_irq_common_cmd_resp_helper(struct fmdev *fmdev, u8 stage)  in fm_irq_common_cmd_resp_helper()  argument
535 	if (!check_cmdresp_status(fmdev, &skb))  in fm_irq_common_cmd_resp_helper()
536 		fm_irq_call_stage(fmdev, stage);  in fm_irq_common_cmd_resp_helper()
548 	struct fmdev *fmdev;  in int_timeout_handler()  local
552 	fmdev = from_timer(fmdev, t, irq_info.timer);  in int_timeout_handler()
553 	fmirq = &fmdev->irq_info;  in int_timeout_handler()
564 	fm_irq_call_stage(fmdev, FM_SEND_INTMSK_CMD_IDX);  in int_timeout_handler()
568 static void fm_irq_send_flag_getcmd(struct fmdev *fmdev)  in fm_irq_send_flag_getcmd()  argument
573 	if (!fm_send_cmd(fmdev, FLAG_GET, REG_RD, NULL, sizeof(flag), NULL))  in fm_irq_send_flag_getcmd()
574 		fm_irq_timeout_stage(fmdev, FM_HANDLE_FLAG_GETCMD_RESP_IDX);  in fm_irq_send_flag_getcmd()
577 static void fm_irq_handle_flag_getcmd_resp(struct fmdev *fmdev)  in fm_irq_handle_flag_getcmd_resp()  argument
582 	if (check_cmdresp_status(fmdev, &skb))  in fm_irq_handle_flag_getcmd_resp()
589 	memcpy(&fmdev->irq_info.flag, skb->data, fm_evt_hdr->dlen);  in fm_irq_handle_flag_getcmd_resp()
591 	fmdev->irq_info.flag = be16_to_cpu((__force __be16)fmdev->irq_info.flag);  in fm_irq_handle_flag_getcmd_resp()
592 	fmdbg("irq: flag register(0x%x)\n", fmdev->irq_info.flag);  in fm_irq_handle_flag_getcmd_resp()
595 	fm_irq_call_stage(fmdev, FM_HW_MAL_FUNC_IDX);  in fm_irq_handle_flag_getcmd_resp()
598 static void fm_irq_handle_hw_malfunction(struct fmdev *fmdev)  in fm_irq_handle_hw_malfunction()  argument
600 	if (fmdev->irq_info.flag & FM_MAL_EVENT & fmdev->irq_info.mask)  in fm_irq_handle_hw_malfunction()
604 	fm_irq_call_stage(fmdev, FM_RDS_START_IDX);  in fm_irq_handle_hw_malfunction()
607 static void fm_irq_handle_rds_start(struct fmdev *fmdev)  in fm_irq_handle_rds_start()  argument
609 	if (fmdev->irq_info.flag & FM_RDS_EVENT & fmdev->irq_info.mask) {  in fm_irq_handle_rds_start()
611 		fmdev->irq_info.stage = FM_RDS_SEND_RDS_GETCMD_IDX;  in fm_irq_handle_rds_start()
614 		fmdev->irq_info.stage = FM_HW_TUNE_OP_ENDED_IDX;  in fm_irq_handle_rds_start()
617 	fm_irq_call(fmdev);  in fm_irq_handle_rds_start()
620 static void fm_irq_send_rdsdata_getcmd(struct fmdev *fmdev)  in fm_irq_send_rdsdata_getcmd()  argument
623 	if (!fm_send_cmd(fmdev, RDS_DATA_GET, REG_RD, NULL,  in fm_irq_send_rdsdata_getcmd()
625 		fm_irq_timeout_stage(fmdev, FM_RDS_HANDLE_RDS_GETCMD_RESP_IDX);  in fm_irq_send_rdsdata_getcmd()
629 static void fm_rx_update_af_cache(struct fmdev *fmdev, u8 af)  in fm_rx_update_af_cache()  argument
631 	struct tuned_station_info *stat_info = &fmdev->rx.stat_info;  in fm_rx_update_af_cache()
632 	u8 reg_idx = fmdev->rx.region.fm_band;  in fm_rx_update_af_cache()
638 		fmdev->rx.stat_info.af_list_max = (af - FM_RDS_1_AF_FOLLOWS + 1);  in fm_rx_update_af_cache()
639 		fmdev->rx.stat_info.afcache_size = 0;  in fm_rx_update_af_cache()
640 		fmdbg("No of expected AF : %d\n", fmdev->rx.stat_info.af_list_max);  in fm_rx_update_af_cache()
651 	freq = fmdev->rx.region.bot_freq + (af * 100);  in fm_rx_update_af_cache()
652 	if (freq == fmdev->rx.freq) {  in fm_rx_update_af_cache()
654 				fmdev->rx.freq, freq);  in fm_rx_update_af_cache()
682 static void fm_rdsparse_swapbytes(struct fmdev *fmdev,  in fm_rdsparse_swapbytes()  argument
693 	if (fmdev->asci_id != 0x6350) {  in fm_rdsparse_swapbytes()
702 static void fm_irq_handle_rdsdata_getcmd_resp(struct fmdev *fmdev)  in fm_irq_handle_rdsdata_getcmd_resp()  argument
706 	struct fm_rds *rds = &fmdev->rx.rds;  in fm_irq_handle_rdsdata_getcmd_resp()
713 	if (check_cmdresp_status(fmdev, &skb))  in fm_irq_handle_rdsdata_getcmd_resp()
751 			fm_rdsparse_swapbytes(fmdev, &rds_fmt);  in fm_irq_handle_rdsdata_getcmd_resp()
758 			if (fmdev->rx.stat_info.picode != cur_picode)  in fm_irq_handle_rdsdata_getcmd_resp()
759 				fmdev->rx.stat_info.picode = cur_picode;  in fm_irq_handle_rdsdata_getcmd_resp()
769 				fm_rx_update_af_cache(fmdev, rds_fmt.data.group0A.af[0]);  in fm_irq_handle_rdsdata_getcmd_resp()
770 				fm_rx_update_af_cache(fmdev, rds_fmt.data.group0A.af[1]);  in fm_irq_handle_rdsdata_getcmd_resp()
781 	spin_lock_irqsave(&fmdev->rds_buff_lock, flags);  in fm_irq_handle_rdsdata_getcmd_resp()
809 	spin_unlock_irqrestore(&fmdev->rds_buff_lock, flags);  in fm_irq_handle_rdsdata_getcmd_resp()
815 	fm_irq_call_stage(fmdev, FM_RDS_FINISH_IDX);  in fm_irq_handle_rdsdata_getcmd_resp()
818 static void fm_irq_handle_rds_finish(struct fmdev *fmdev)  in fm_irq_handle_rds_finish()  argument
820 	fm_irq_call_stage(fmdev, FM_HW_TUNE_OP_ENDED_IDX);  in fm_irq_handle_rds_finish()
823 static void fm_irq_handle_tune_op_ended(struct fmdev *fmdev)  in fm_irq_handle_tune_op_ended()  argument
825 	if (fmdev->irq_info.flag & (FM_FR_EVENT | FM_BL_EVENT) & fmdev->  in fm_irq_handle_tune_op_ended()
828 		if (test_and_clear_bit(FM_AF_SWITCH_INPROGRESS, &fmdev->flag)) {  in fm_irq_handle_tune_op_ended()
829 			fmdev->irq_info.stage = FM_AF_JUMP_RD_FREQ_IDX;  in fm_irq_handle_tune_op_ended()
831 			complete(&fmdev->maintask_comp);  in fm_irq_handle_tune_op_ended()
832 			fmdev->irq_info.stage = FM_HW_POWER_ENB_IDX;  in fm_irq_handle_tune_op_ended()
835 		fmdev->irq_info.stage = FM_HW_POWER_ENB_IDX;  in fm_irq_handle_tune_op_ended()
837 	fm_irq_call(fmdev);  in fm_irq_handle_tune_op_ended()
840 static void fm_irq_handle_power_enb(struct fmdev *fmdev)  in fm_irq_handle_power_enb()  argument
842 	if (fmdev->irq_info.flag & FM_POW_ENB_EVENT) {  in fm_irq_handle_power_enb()
844 		complete(&fmdev->maintask_comp);  in fm_irq_handle_power_enb()
847 	fm_irq_call_stage(fmdev, FM_LOW_RSSI_START_IDX);  in fm_irq_handle_power_enb()
850 static void fm_irq_handle_low_rssi_start(struct fmdev *fmdev)  in fm_irq_handle_low_rssi_start()  argument
852 	if ((fmdev->rx.af_mode == FM_RX_RDS_AF_SWITCH_MODE_ON) &&  in fm_irq_handle_low_rssi_start()
853 	    (fmdev->irq_info.flag & FM_LEV_EVENT & fmdev->irq_info.mask) &&  in fm_irq_handle_low_rssi_start()
854 	    (fmdev->rx.freq != FM_UNDEFINED_FREQ) &&  in fm_irq_handle_low_rssi_start()
855 	    (fmdev->rx.stat_info.afcache_size != 0)) {  in fm_irq_handle_low_rssi_start()
859 		fmdev->irq_info.mask &= ~FM_LEV_EVENT;  in fm_irq_handle_low_rssi_start()
861 		fmdev->rx.afjump_idx = 0;  in fm_irq_handle_low_rssi_start()
862 		fmdev->rx.freq_before_jump = fmdev->rx.freq;  in fm_irq_handle_low_rssi_start()
863 		fmdev->irq_info.stage = FM_AF_JUMP_SETPI_IDX;  in fm_irq_handle_low_rssi_start()
866 		fmdev->irq_info.stage = FM_SEND_INTMSK_CMD_IDX;  in fm_irq_handle_low_rssi_start()
869 	fm_irq_call(fmdev);  in fm_irq_handle_low_rssi_start()
872 static void fm_irq_afjump_set_pi(struct fmdev *fmdev)  in fm_irq_afjump_set_pi()  argument
877 	payload = fmdev->rx.stat_info.picode;  in fm_irq_afjump_set_pi()
878 	if (!fm_send_cmd(fmdev, RDS_PI_SET, REG_WR, &payload, sizeof(payload), NULL))  in fm_irq_afjump_set_pi()
879 		fm_irq_timeout_stage(fmdev, FM_AF_JUMP_HANDLE_SETPI_RESP_IDX);  in fm_irq_afjump_set_pi()
882 static void fm_irq_handle_set_pi_resp(struct fmdev *fmdev)  in fm_irq_handle_set_pi_resp()  argument
884 	fm_irq_common_cmd_resp_helper(fmdev, FM_AF_JUMP_SETPI_MASK_IDX);  in fm_irq_handle_set_pi_resp()
892 static void fm_irq_afjump_set_pimask(struct fmdev *fmdev)  in fm_irq_afjump_set_pimask()  argument
897 	if (!fm_send_cmd(fmdev, RDS_PI_MASK_SET, REG_WR, &payload, sizeof(payload), NULL))  in fm_irq_afjump_set_pimask()
898 		fm_irq_timeout_stage(fmdev, FM_AF_JUMP_HANDLE_SETPI_MASK_RESP_IDX);  in fm_irq_afjump_set_pimask()
901 static void fm_irq_handle_set_pimask_resp(struct fmdev *fmdev)  in fm_irq_handle_set_pimask_resp()  argument
903 	fm_irq_common_cmd_resp_helper(fmdev, FM_AF_JUMP_SET_AF_FREQ_IDX);  in fm_irq_handle_set_pimask_resp()
906 static void fm_irq_afjump_setfreq(struct fmdev *fmdev)  in fm_irq_afjump_setfreq()  argument
911 	fmdbg("Swtich to %d KHz\n", fmdev->rx.stat_info.af_cache[fmdev->rx.afjump_idx]);  in fm_irq_afjump_setfreq()
912 	frq_index = (fmdev->rx.stat_info.af_cache[fmdev->rx.afjump_idx] -  in fm_irq_afjump_setfreq()
913 	     fmdev->rx.region.bot_freq) / FM_FREQ_MUL;  in fm_irq_afjump_setfreq()
916 	if (!fm_send_cmd(fmdev, AF_FREQ_SET, REG_WR, &payload, sizeof(payload), NULL))  in fm_irq_afjump_setfreq()
917 		fm_irq_timeout_stage(fmdev, FM_AF_JUMP_HANDLE_SET_AFFREQ_RESP_IDX);  in fm_irq_afjump_setfreq()
920 static void fm_irq_handle_setfreq_resp(struct fmdev *fmdev)  in fm_irq_handle_setfreq_resp()  argument
922 	fm_irq_common_cmd_resp_helper(fmdev, FM_AF_JUMP_ENABLE_INT_IDX);  in fm_irq_handle_setfreq_resp()
925 static void fm_irq_afjump_enableint(struct fmdev *fmdev)  in fm_irq_afjump_enableint()  argument
931 	if (!fm_send_cmd(fmdev, INT_MASK_SET, REG_WR, &payload, sizeof(payload), NULL))  in fm_irq_afjump_enableint()
932 		fm_irq_timeout_stage(fmdev, FM_AF_JUMP_ENABLE_INT_RESP_IDX);  in fm_irq_afjump_enableint()
935 static void fm_irq_afjump_enableint_resp(struct fmdev *fmdev)  in fm_irq_afjump_enableint_resp()  argument
937 	fm_irq_common_cmd_resp_helper(fmdev, FM_AF_JUMP_START_AFJUMP_IDX);  in fm_irq_afjump_enableint_resp()
940 static void fm_irq_start_afjump(struct fmdev *fmdev)  in fm_irq_start_afjump()  argument
945 	if (!fm_send_cmd(fmdev, TUNER_MODE_SET, REG_WR, &payload,  in fm_irq_start_afjump()
947 		fm_irq_timeout_stage(fmdev, FM_AF_JUMP_HANDLE_START_AFJUMP_RESP_IDX);  in fm_irq_start_afjump()
950 static void fm_irq_handle_start_afjump_resp(struct fmdev *fmdev)  in fm_irq_handle_start_afjump_resp()  argument
954 	if (check_cmdresp_status(fmdev, &skb))  in fm_irq_handle_start_afjump_resp()
957 	fmdev->irq_info.stage = FM_SEND_FLAG_GETCMD_IDX;  in fm_irq_handle_start_afjump_resp()
958 	set_bit(FM_AF_SWITCH_INPROGRESS, &fmdev->flag);  in fm_irq_handle_start_afjump_resp()
959 	clear_bit(FM_INTTASK_RUNNING, &fmdev->flag);  in fm_irq_handle_start_afjump_resp()
962 static void fm_irq_afjump_rd_freq(struct fmdev *fmdev)  in fm_irq_afjump_rd_freq()  argument
966 	if (!fm_send_cmd(fmdev, FREQ_SET, REG_RD, NULL, sizeof(payload), NULL))  in fm_irq_afjump_rd_freq()
967 		fm_irq_timeout_stage(fmdev, FM_AF_JUMP_RD_FREQ_RESP_IDX);  in fm_irq_afjump_rd_freq()
970 static void fm_irq_afjump_rd_freq_resp(struct fmdev *fmdev)  in fm_irq_afjump_rd_freq_resp()  argument
976 	if (check_cmdresp_status(fmdev, &skb))  in fm_irq_afjump_rd_freq_resp()
983 	curr_freq = fmdev->rx.region.bot_freq + ((u32)read_freq * FM_FREQ_MUL);  in fm_irq_afjump_rd_freq_resp()
985 	jumped_freq = fmdev->rx.stat_info.af_cache[fmdev->rx.afjump_idx];  in fm_irq_afjump_rd_freq_resp()
988 	if ((curr_freq != fmdev->rx.freq_before_jump) && (curr_freq == jumped_freq)) {  in fm_irq_afjump_rd_freq_resp()
990 		fmdev->rx.freq = curr_freq;  in fm_irq_afjump_rd_freq_resp()
991 		fm_rx_reset_rds_cache(fmdev);  in fm_irq_afjump_rd_freq_resp()
994 		if (fmdev->rx.af_mode == FM_RX_RDS_AF_SWITCH_MODE_ON)  in fm_irq_afjump_rd_freq_resp()
995 			fmdev->irq_info.mask |= FM_LEV_EVENT;  in fm_irq_afjump_rd_freq_resp()
997 		fmdev->irq_info.stage = FM_LOW_RSSI_FINISH_IDX;  in fm_irq_afjump_rd_freq_resp()
999 		fmdev->rx.afjump_idx++;  in fm_irq_afjump_rd_freq_resp()
1002 		if (fmdev->rx.afjump_idx >= fmdev->rx.stat_info.afcache_size) {  in fm_irq_afjump_rd_freq_resp()
1004 			fmdev->irq_info.stage = FM_LOW_RSSI_FINISH_IDX;  in fm_irq_afjump_rd_freq_resp()
1008 			fmdev->irq_info.stage = FM_AF_JUMP_SETPI_IDX;  in fm_irq_afjump_rd_freq_resp()
1011 	fm_irq_call(fmdev);  in fm_irq_afjump_rd_freq_resp()
1014 static void fm_irq_handle_low_rssi_finish(struct fmdev *fmdev)  in fm_irq_handle_low_rssi_finish()  argument
1016 	fm_irq_call_stage(fmdev, FM_SEND_INTMSK_CMD_IDX);  in fm_irq_handle_low_rssi_finish()
1019 static void fm_irq_send_intmsk_cmd(struct fmdev *fmdev)  in fm_irq_send_intmsk_cmd()  argument
1024 	payload = fmdev->irq_info.mask;  in fm_irq_send_intmsk_cmd()
1026 	if (!fm_send_cmd(fmdev, INT_MASK_SET, REG_WR, &payload,  in fm_irq_send_intmsk_cmd()
1028 		fm_irq_timeout_stage(fmdev, FM_HANDLE_INTMSK_CMD_RESP_IDX);  in fm_irq_send_intmsk_cmd()
1031 static void fm_irq_handle_intmsk_cmd_resp(struct fmdev *fmdev)  in fm_irq_handle_intmsk_cmd_resp()  argument
1035 	if (check_cmdresp_status(fmdev, &skb))  in fm_irq_handle_intmsk_cmd_resp()
1041 	fmdev->irq_info.stage = FM_SEND_FLAG_GETCMD_IDX;  in fm_irq_handle_intmsk_cmd_resp()
1044 	if (test_and_clear_bit(FM_INTTASK_SCHEDULE_PENDING, &fmdev->flag))  in fm_irq_handle_intmsk_cmd_resp()
1045 		fmdev->irq_info.handlers[fmdev->irq_info.stage](fmdev);  in fm_irq_handle_intmsk_cmd_resp()
1047 		clear_bit(FM_INTTASK_RUNNING, &fmdev->flag);  in fm_irq_handle_intmsk_cmd_resp()
1051 int fmc_is_rds_data_available(struct fmdev *fmdev, struct file *file,  in fmc_is_rds_data_available()  argument
1054 	poll_wait(file, &fmdev->rx.rds.read_queue, pts);  in fmc_is_rds_data_available()
1055 	if (fmdev->rx.rds.rd_idx != fmdev->rx.rds.wr_idx)  in fmc_is_rds_data_available()
1062 int fmc_transfer_rds_from_internal_buff(struct fmdev *fmdev, struct file *file,  in fmc_transfer_rds_from_internal_buff()  argument
1070 	if (fmdev->rx.rds.wr_idx == fmdev->rx.rds.rd_idx) {  in fmc_transfer_rds_from_internal_buff()
1074 		ret = wait_event_interruptible(fmdev->rx.rds.read_queue,  in fmc_transfer_rds_from_internal_buff()
1075 				(fmdev->rx.rds.wr_idx != fmdev->rx.rds.rd_idx));  in fmc_transfer_rds_from_internal_buff()
1086 		spin_lock_irqsave(&fmdev->rds_buff_lock, flags);  in fmc_transfer_rds_from_internal_buff()
1088 		if (fmdev->rx.rds.wr_idx == fmdev->rx.rds.rd_idx) {  in fmc_transfer_rds_from_internal_buff()
1089 			spin_unlock_irqrestore(&fmdev->rds_buff_lock, flags);  in fmc_transfer_rds_from_internal_buff()
1092 		memcpy(tmpbuf, &fmdev->rx.rds.buff[fmdev->rx.rds.rd_idx],  in fmc_transfer_rds_from_internal_buff()
1094 		fmdev->rx.rds.rd_idx += FM_RDS_BLK_SIZE;  in fmc_transfer_rds_from_internal_buff()
1095 		if (fmdev->rx.rds.rd_idx >= fmdev->rx.rds.buf_size)  in fmc_transfer_rds_from_internal_buff()
1096 			fmdev->rx.rds.rd_idx = 0;  in fmc_transfer_rds_from_internal_buff()
1098 		spin_unlock_irqrestore(&fmdev->rds_buff_lock, flags);  in fmc_transfer_rds_from_internal_buff()
1110 int fmc_set_freq(struct fmdev *fmdev, u32 freq_to_set)  in fmc_set_freq()  argument
1112 	switch (fmdev->curr_fmmode) {  in fmc_set_freq()
1114 		return fm_rx_set_freq(fmdev, freq_to_set);  in fmc_set_freq()
1117 		return fm_tx_set_freq(fmdev, freq_to_set);  in fmc_set_freq()
1124 int fmc_get_freq(struct fmdev *fmdev, u32 *cur_tuned_frq)  in fmc_get_freq()  argument
1126 	if (fmdev->rx.freq == FM_UNDEFINED_FREQ) {  in fmc_get_freq()
1135 	switch (fmdev->curr_fmmode) {  in fmc_get_freq()
1137 		*cur_tuned_frq = fmdev->rx.freq;  in fmc_get_freq()
1150 int fmc_set_region(struct fmdev *fmdev, u8 region_to_set)  in fmc_set_region()  argument
1152 	switch (fmdev->curr_fmmode) {  in fmc_set_region()
1154 		return fm_rx_set_region(fmdev, region_to_set);  in fmc_set_region()
1157 		return fm_tx_set_region(fmdev, region_to_set);  in fmc_set_region()
1164 int fmc_set_mute_mode(struct fmdev *fmdev, u8 mute_mode_toset)  in fmc_set_mute_mode()  argument
1166 	switch (fmdev->curr_fmmode) {  in fmc_set_mute_mode()
1168 		return fm_rx_set_mute_mode(fmdev, mute_mode_toset);  in fmc_set_mute_mode()
1171 		return fm_tx_set_mute_mode(fmdev, mute_mode_toset);  in fmc_set_mute_mode()
1178 int fmc_set_stereo_mono(struct fmdev *fmdev, u16 mode)  in fmc_set_stereo_mono()  argument
1180 	switch (fmdev->curr_fmmode) {  in fmc_set_stereo_mono()
1182 		return fm_rx_set_stereo_mono(fmdev, mode);  in fmc_set_stereo_mono()
1185 		return fm_tx_set_stereo_mono(fmdev, mode);  in fmc_set_stereo_mono()
1192 int fmc_set_rds_mode(struct fmdev *fmdev, u8 rds_en_dis)  in fmc_set_rds_mode()  argument
1194 	switch (fmdev->curr_fmmode) {  in fmc_set_rds_mode()
1196 		return fm_rx_set_rds_mode(fmdev, rds_en_dis);  in fmc_set_rds_mode()
1199 		return fm_tx_set_rds_mode(fmdev, rds_en_dis);  in fmc_set_rds_mode()
1207 static int fm_power_down(struct fmdev *fmdev)  in fm_power_down()  argument
1212 	if (!test_bit(FM_CORE_READY, &fmdev->flag)) {  in fm_power_down()
1216 	if (fmdev->curr_fmmode == FM_MODE_OFF) {  in fm_power_down()
1222 	ret = fmc_send_cmd(fmdev, FM_POWER_MODE, REG_WR, &payload,  in fm_power_down()
1227 	return fmc_release(fmdev);  in fm_power_down()
1231 static int fm_download_firmware(struct fmdev *fmdev, const u8 *fw_name)  in fm_download_firmware()  argument
1241 	set_bit(FM_FW_DW_INPROGRESS, &fmdev->flag);  in fm_download_firmware()
1244 				&fmdev->radio_dev->dev);  in fm_download_firmware()
1271 			if (fmc_send_cmd(fmdev, 0, 0, action->data,  in fm_download_firmware()
1290 	clear_bit(FM_FW_DW_INPROGRESS, &fmdev->flag);  in fm_download_firmware()
1296 static int load_default_rx_configuration(struct fmdev *fmdev)  in load_default_rx_configuration()  argument
1300 	ret = fm_rx_set_volume(fmdev, FM_DEFAULT_RX_VOLUME);  in load_default_rx_configuration()
1304 	return fm_rx_set_rssi_threshold(fmdev, FM_DEFAULT_RSSI_THRESHOLD);  in load_default_rx_configuration()
1308 static int fm_power_up(struct fmdev *fmdev, u8 mode)  in fm_power_up()  argument
1324 	ret = fmc_prepare(fmdev);  in fm_power_up()
1331 	if (fmc_send_cmd(fmdev, FM_POWER_MODE, REG_WR, &payload,  in fm_power_up()
1338 	if (fmc_send_cmd(fmdev, ASIC_ID_GET, REG_RD, NULL,  in fm_power_up()
1342 	if (fmc_send_cmd(fmdev, ASIC_VER_GET, REG_RD, NULL,  in fm_power_up()
1352 	ret = fm_download_firmware(fmdev, fw_name);  in fm_power_up()
1361 	ret = fm_download_firmware(fmdev, fw_name);  in fm_power_up()
1368 	return fmc_release(fmdev);  in fm_power_up()
1372 int fmc_set_mode(struct fmdev *fmdev, u8 fm_mode)  in fmc_set_mode()  argument
1380 	if (fmdev->curr_fmmode == fm_mode) {  in fmc_set_mode()
1387 		ret = fm_power_down(fmdev);  in fmc_set_mode()
1397 		if (fmdev->curr_fmmode != FM_MODE_OFF) {  in fmc_set_mode()
1398 			ret = fm_power_down(fmdev);  in fmc_set_mode()
1405 		ret = fm_power_up(fmdev, fm_mode);  in fmc_set_mode()
1411 	fmdev->curr_fmmode = fm_mode;  in fmc_set_mode()
1414 	if (fmdev->curr_fmmode == FM_MODE_RX) {  in fmc_set_mode()
1416 		ret = load_default_rx_configuration(fmdev);  in fmc_set_mode()
1425 int fmc_get_mode(struct fmdev *fmdev, u8 *fmmode)  in fmc_get_mode()  argument
1427 	if (!test_bit(FM_CORE_READY, &fmdev->flag)) {  in fmc_get_mode()
1436 	*fmmode = fmdev->curr_fmmode;  in fmc_get_mode()
1443 	struct fmdev *fmdev;  in fm_st_receive()  local
1445 	fmdev = (struct fmdev *)arg;  in fm_st_receive()
1458 	skb_queue_tail(&fmdev->rx_q, skb);  in fm_st_receive()
1459 	tasklet_schedule(&fmdev->rx_task);  in fm_st_receive()
1470 	struct fmdev *fmdev;  in fm_st_reg_comp_cb()  local
1472 	fmdev = (struct fmdev *)arg;  in fm_st_reg_comp_cb()
1473 	fmdev->streg_cbdata = data;  in fm_st_reg_comp_cb()
1481 int fmc_prepare(struct fmdev *fmdev)  in fmc_prepare()  argument
1486 	if (test_bit(FM_CORE_READY, &fmdev->flag)) {  in fmc_prepare()
1496 	fm_st_proto.priv_data = fmdev;  in fmc_prepare()
1507 		fmdev->streg_cbdata = -EINPROGRESS;  in fmc_prepare()
1516 		if (fmdev->streg_cbdata != 0) {  in fmc_prepare()
1518 			      fmdev->streg_cbdata);  in fmc_prepare()
1538 	spin_lock_init(&fmdev->rds_buff_lock);  in fmc_prepare()
1539 	spin_lock_init(&fmdev->resp_skb_lock);  in fmc_prepare()
1542 	skb_queue_head_init(&fmdev->tx_q);  in fmc_prepare()
1543 	tasklet_init(&fmdev->tx_task, send_tasklet, (unsigned long)fmdev);  in fmc_prepare()
1546 	skb_queue_head_init(&fmdev->rx_q);  in fmc_prepare()
1547 	tasklet_init(&fmdev->rx_task, recv_tasklet, (unsigned long)fmdev);  in fmc_prepare()
1549 	fmdev->irq_info.stage = 0;  in fmc_prepare()
1550 	atomic_set(&fmdev->tx_cnt, 1);  in fmc_prepare()
1551 	fmdev->resp_comp = NULL;  in fmc_prepare()
1553 	timer_setup(&fmdev->irq_info.timer, int_timeout_handler, 0);  in fmc_prepare()
1555 	fmdev->irq_info.mask = FM_MAL_EVENT;  in fmc_prepare()
1558 	fmdev->rx.region = region_configs[default_radio_region];  in fmc_prepare()
1560 	fmdev->rx.mute_mode = FM_MUTE_OFF;  in fmc_prepare()
1561 	fmdev->rx.rf_depend_mute = FM_RX_RF_DEPENDENT_MUTE_OFF;  in fmc_prepare()
1562 	fmdev->rx.rds.flag = FM_RDS_DISABLE;  in fmc_prepare()
1563 	fmdev->rx.freq = FM_UNDEFINED_FREQ;  in fmc_prepare()
1564 	fmdev->rx.rds_mode = FM_RDS_SYSTEM_RDS;  in fmc_prepare()
1565 	fmdev->rx.af_mode = FM_RX_RDS_AF_SWITCH_MODE_OFF;  in fmc_prepare()
1566 	fmdev->irq_info.retry = 0;  in fmc_prepare()
1568 	fm_rx_reset_rds_cache(fmdev);  in fmc_prepare()
1569 	init_waitqueue_head(&fmdev->rx.rds.read_queue);  in fmc_prepare()
1571 	fm_rx_reset_station_info(fmdev);  in fmc_prepare()
1572 	set_bit(FM_CORE_READY, &fmdev->flag);  in fmc_prepare()
1581 int fmc_release(struct fmdev *fmdev)  in fmc_release()  argument
1586 	if (!test_bit(FM_CORE_READY, &fmdev->flag)) {  in fmc_release()
1591 	wake_up_interruptible(&fmdev->rx.rds.read_queue);  in fmc_release()
1593 	tasklet_kill(&fmdev->tx_task);  in fmc_release()
1594 	tasklet_kill(&fmdev->rx_task);  in fmc_release()
1596 	skb_queue_purge(&fmdev->tx_q);  in fmc_release()
1597 	skb_queue_purge(&fmdev->rx_q);  in fmc_release()
1599 	fmdev->resp_comp = NULL;  in fmc_release()
1600 	fmdev->rx.freq = 0;  in fmc_release()
1612 	clear_bit(FM_CORE_READY, &fmdev->flag);  in fmc_release()
1622 	struct fmdev *fmdev = NULL;  in fm_drv_init()  local
1627 	fmdev = kzalloc(sizeof(struct fmdev), GFP_KERNEL);  in fm_drv_init()
1628 	if (NULL == fmdev) {  in fm_drv_init()
1632 	fmdev->rx.rds.buf_size = default_rds_buf * FM_RDS_BLK_SIZE;  in fm_drv_init()
1633 	fmdev->rx.rds.buff = kzalloc(fmdev->rx.rds.buf_size, GFP_KERNEL);  in fm_drv_init()
1634 	if (NULL == fmdev->rx.rds.buff) {  in fm_drv_init()
1639 	ret = fm_v4l2_init_video_device(fmdev, radio_nr);  in fm_drv_init()
1643 	fmdev->irq_info.handlers = int_handler_table;  in fm_drv_init()
1644 	fmdev->curr_fmmode = FM_MODE_OFF;  in fm_drv_init()
1645 	fmdev->tx_data.pwr_lvl = FM_PWR_LVL_DEF;  in fm_drv_init()
1646 	fmdev->tx_data.preemph = FM_TX_PREEMPH_50US;  in fm_drv_init()
1650 	kfree(fmdev->rx.rds.buff);  in fm_drv_init()
1652 	kfree(fmdev);  in fm_drv_init()
1660 	struct fmdev *fmdev = NULL;  in fm_drv_exit()  local
1662 	fmdev = fm_v4l2_deinit_video_device();  in fm_drv_exit()
1663 	if (fmdev != NULL) {  in fm_drv_exit()
1664 		kfree(fmdev->rx.rds.buff);  in fm_drv_exit()
1665 		kfree(fmdev);  in fm_drv_exit()