Lines Matching refs:fmdev
79 static void fm_irq_send_flag_getcmd(struct fmdev *);
80 static void fm_irq_handle_flag_getcmd_resp(struct fmdev *);
81 static void fm_irq_handle_hw_malfunction(struct fmdev *);
82 static void fm_irq_handle_rds_start(struct fmdev *);
83 static void fm_irq_send_rdsdata_getcmd(struct fmdev *);
84 static void fm_irq_handle_rdsdata_getcmd_resp(struct fmdev *);
85 static void fm_irq_handle_rds_finish(struct fmdev *);
86 static void fm_irq_handle_tune_op_ended(struct fmdev *);
87 static void fm_irq_handle_power_enb(struct fmdev *);
88 static void fm_irq_handle_low_rssi_start(struct fmdev *);
89 static void fm_irq_afjump_set_pi(struct fmdev *);
90 static void fm_irq_handle_set_pi_resp(struct fmdev *);
91 static void fm_irq_afjump_set_pimask(struct fmdev *);
92 static void fm_irq_handle_set_pimask_resp(struct fmdev *);
93 static void fm_irq_afjump_setfreq(struct fmdev *);
94 static void fm_irq_handle_setfreq_resp(struct fmdev *);
95 static void fm_irq_afjump_enableint(struct fmdev *);
96 static void fm_irq_afjump_enableint_resp(struct fmdev *);
97 static void fm_irq_start_afjump(struct fmdev *);
98 static void fm_irq_handle_start_afjump_resp(struct fmdev *);
99 static void fm_irq_afjump_rd_freq(struct fmdev *);
100 static void fm_irq_afjump_rd_freq_resp(struct fmdev *);
101 static void fm_irq_handle_low_rssi_finish(struct fmdev *);
102 static void fm_irq_send_intmsk_cmd(struct fmdev *);
103 static void fm_irq_handle_intmsk_cmd_resp(struct fmdev *);
181 static inline void fm_irq_call(struct fmdev *fmdev) in fm_irq_call() argument
183 fmdev->irq_info.handlers[fmdev->irq_info.stage](fmdev); in fm_irq_call()
187 static inline void fm_irq_call_stage(struct fmdev *fmdev, u8 stage) in fm_irq_call_stage() argument
189 fmdev->irq_info.stage = stage; in fm_irq_call_stage()
190 fm_irq_call(fmdev); in fm_irq_call_stage()
193 static inline void fm_irq_timeout_stage(struct fmdev *fmdev, u8 stage) in fm_irq_timeout_stage() argument
195 fmdev->irq_info.stage = stage; in fm_irq_timeout_stage()
196 mod_timer(&fmdev->irq_info.timer, jiffies + FM_DRV_TX_TIMEOUT); in fm_irq_timeout_stage()
251 void fmc_update_region_info(struct fmdev *fmdev, u8 region_to_set) in fmc_update_region_info() argument
253 fmdev->rx.region = region_configs[region_to_set]; in fmc_update_region_info()
262 struct fmdev *fmdev; in recv_tasklet() local
269 fmdev = (struct fmdev *)arg; in recv_tasklet()
270 irq_info = &fmdev->irq_info; in recv_tasklet()
272 while ((skb = skb_dequeue(&fmdev->rx_q))) { in recv_tasklet()
287 if (!test_bit(FM_INTTASK_RUNNING, &fmdev->flag)) { in recv_tasklet()
288 set_bit(FM_INTTASK_RUNNING, &fmdev->flag); in recv_tasklet()
298 irq_info->handlers[irq_info->stage](fmdev); in recv_tasklet()
300 set_bit(FM_INTTASK_SCHEDULE_PENDING, &fmdev->flag); in recv_tasklet()
305 else if (evt_hdr->op == fmdev->pre_op && fmdev->resp_comp != NULL) { in recv_tasklet()
307 spin_lock_irqsave(&fmdev->resp_skb_lock, flags); in recv_tasklet()
308 fmdev->resp_skb = skb; in recv_tasklet()
309 spin_unlock_irqrestore(&fmdev->resp_skb_lock, flags); in recv_tasklet()
310 complete(fmdev->resp_comp); in recv_tasklet()
312 fmdev->resp_comp = NULL; in recv_tasklet()
313 atomic_set(&fmdev->tx_cnt, 1); in recv_tasklet()
316 else if (evt_hdr->op == fmdev->pre_op && fmdev->resp_comp == NULL) { in recv_tasklet()
317 if (fmdev->resp_skb != NULL) in recv_tasklet()
320 spin_lock_irqsave(&fmdev->resp_skb_lock, flags); in recv_tasklet()
321 fmdev->resp_skb = skb; in recv_tasklet()
322 spin_unlock_irqrestore(&fmdev->resp_skb_lock, flags); in recv_tasklet()
325 irq_info->handlers[irq_info->stage](fmdev); in recv_tasklet()
328 atomic_set(&fmdev->tx_cnt, 1); in recv_tasklet()
337 if (num_fm_hci_cmds && atomic_read(&fmdev->tx_cnt)) in recv_tasklet()
338 if (!skb_queue_empty(&fmdev->tx_q)) in recv_tasklet()
339 tasklet_schedule(&fmdev->tx_task); in recv_tasklet()
346 struct fmdev *fmdev; in send_tasklet() local
350 fmdev = (struct fmdev *)arg; in send_tasklet()
352 if (!atomic_read(&fmdev->tx_cnt)) in send_tasklet()
356 if ((jiffies - fmdev->last_tx_jiffies) > FM_DRV_TX_TIMEOUT) { in send_tasklet()
358 atomic_set(&fmdev->tx_cnt, 1); in send_tasklet()
362 skb = skb_dequeue(&fmdev->tx_q); in send_tasklet()
366 atomic_dec(&fmdev->tx_cnt); in send_tasklet()
367 fmdev->pre_op = fm_cb(skb)->fm_op; in send_tasklet()
369 if (fmdev->resp_comp != NULL) in send_tasklet()
372 fmdev->resp_comp = fm_cb(skb)->completion; in send_tasklet()
378 fmdev->resp_comp = NULL; in send_tasklet()
380 atomic_set(&fmdev->tx_cnt, 1); in send_tasklet()
382 fmdev->last_tx_jiffies = jiffies; in send_tasklet()
390 static int fm_send_cmd(struct fmdev *fmdev, u8 fm_op, u16 type, void *payload, in fm_send_cmd() argument
401 if (test_bit(FM_FW_DW_INPROGRESS, &fmdev->flag) && payload == NULL) { in fm_send_cmd()
405 if (!test_bit(FM_FW_DW_INPROGRESS, &fmdev->flag)) in fm_send_cmd()
420 if (!test_bit(FM_FW_DW_INPROGRESS, &fmdev->flag) || in fm_send_cmd()
421 test_bit(FM_INTTASK_RUNNING, &fmdev->flag)) { in fm_send_cmd()
452 skb_queue_tail(&fmdev->tx_q, skb); in fm_send_cmd()
453 tasklet_schedule(&fmdev->tx_task); in fm_send_cmd()
459 int fmc_send_cmd(struct fmdev *fmdev, u8 fm_op, u16 type, void *payload, in fmc_send_cmd() argument
467 init_completion(&fmdev->maintask_comp); in fmc_send_cmd()
468 ret = fm_send_cmd(fmdev, fm_op, type, payload, payload_len, in fmc_send_cmd()
469 &fmdev->maintask_comp); in fmc_send_cmd()
473 if (!wait_for_completion_timeout(&fmdev->maintask_comp, in fmc_send_cmd()
480 if (!fmdev->resp_skb) { in fmc_send_cmd()
484 spin_lock_irqsave(&fmdev->resp_skb_lock, flags); in fmc_send_cmd()
485 skb = fmdev->resp_skb; in fmc_send_cmd()
486 fmdev->resp_skb = NULL; in fmc_send_cmd()
487 spin_unlock_irqrestore(&fmdev->resp_skb_lock, flags); in fmc_send_cmd()
511 static inline int check_cmdresp_status(struct fmdev *fmdev, in check_cmdresp_status() argument
517 del_timer(&fmdev->irq_info.timer); in check_cmdresp_status()
519 spin_lock_irqsave(&fmdev->resp_skb_lock, flags); in check_cmdresp_status()
520 *skb = fmdev->resp_skb; in check_cmdresp_status()
521 fmdev->resp_skb = NULL; in check_cmdresp_status()
522 spin_unlock_irqrestore(&fmdev->resp_skb_lock, flags); in check_cmdresp_status()
530 mod_timer(&fmdev->irq_info.timer, jiffies + FM_DRV_TX_TIMEOUT); in check_cmdresp_status()
537 static inline void fm_irq_common_cmd_resp_helper(struct fmdev *fmdev, u8 stage) in fm_irq_common_cmd_resp_helper() argument
541 if (!check_cmdresp_status(fmdev, &skb)) in fm_irq_common_cmd_resp_helper()
542 fm_irq_call_stage(fmdev, stage); in fm_irq_common_cmd_resp_helper()
554 struct fmdev *fmdev; in int_timeout_handler() local
558 fmdev = (struct fmdev *)data; in int_timeout_handler()
559 fmirq = &fmdev->irq_info; in int_timeout_handler()
571 fm_irq_call_stage(fmdev, FM_SEND_INTMSK_CMD_IDX); in int_timeout_handler()
575 static void fm_irq_send_flag_getcmd(struct fmdev *fmdev) in fm_irq_send_flag_getcmd() argument
580 if (!fm_send_cmd(fmdev, FLAG_GET, REG_RD, NULL, sizeof(flag), NULL)) in fm_irq_send_flag_getcmd()
581 fm_irq_timeout_stage(fmdev, FM_HANDLE_FLAG_GETCMD_RESP_IDX); in fm_irq_send_flag_getcmd()
584 static void fm_irq_handle_flag_getcmd_resp(struct fmdev *fmdev) in fm_irq_handle_flag_getcmd_resp() argument
589 if (check_cmdresp_status(fmdev, &skb)) in fm_irq_handle_flag_getcmd_resp()
596 memcpy(&fmdev->irq_info.flag, skb->data, fm_evt_hdr->dlen); in fm_irq_handle_flag_getcmd_resp()
598 fmdev->irq_info.flag = be16_to_cpu((__force __be16)fmdev->irq_info.flag); in fm_irq_handle_flag_getcmd_resp()
599 fmdbg("irq: flag register(0x%x)\n", fmdev->irq_info.flag); in fm_irq_handle_flag_getcmd_resp()
602 fm_irq_call_stage(fmdev, FM_HW_MAL_FUNC_IDX); in fm_irq_handle_flag_getcmd_resp()
605 static void fm_irq_handle_hw_malfunction(struct fmdev *fmdev) in fm_irq_handle_hw_malfunction() argument
607 if (fmdev->irq_info.flag & FM_MAL_EVENT & fmdev->irq_info.mask) in fm_irq_handle_hw_malfunction()
611 fm_irq_call_stage(fmdev, FM_RDS_START_IDX); in fm_irq_handle_hw_malfunction()
614 static void fm_irq_handle_rds_start(struct fmdev *fmdev) in fm_irq_handle_rds_start() argument
616 if (fmdev->irq_info.flag & FM_RDS_EVENT & fmdev->irq_info.mask) { in fm_irq_handle_rds_start()
618 fmdev->irq_info.stage = FM_RDS_SEND_RDS_GETCMD_IDX; in fm_irq_handle_rds_start()
621 fmdev->irq_info.stage = FM_HW_TUNE_OP_ENDED_IDX; in fm_irq_handle_rds_start()
624 fm_irq_call(fmdev); in fm_irq_handle_rds_start()
627 static void fm_irq_send_rdsdata_getcmd(struct fmdev *fmdev) in fm_irq_send_rdsdata_getcmd() argument
630 if (!fm_send_cmd(fmdev, RDS_DATA_GET, REG_RD, NULL, in fm_irq_send_rdsdata_getcmd()
632 fm_irq_timeout_stage(fmdev, FM_RDS_HANDLE_RDS_GETCMD_RESP_IDX); in fm_irq_send_rdsdata_getcmd()
636 static void fm_rx_update_af_cache(struct fmdev *fmdev, u8 af) in fm_rx_update_af_cache() argument
638 struct tuned_station_info *stat_info = &fmdev->rx.stat_info; in fm_rx_update_af_cache()
639 u8 reg_idx = fmdev->rx.region.fm_band; in fm_rx_update_af_cache()
645 fmdev->rx.stat_info.af_list_max = (af - FM_RDS_1_AF_FOLLOWS + 1); in fm_rx_update_af_cache()
646 fmdev->rx.stat_info.afcache_size = 0; in fm_rx_update_af_cache()
647 fmdbg("No of expected AF : %d\n", fmdev->rx.stat_info.af_list_max); in fm_rx_update_af_cache()
658 freq = fmdev->rx.region.bot_freq + (af * 100); in fm_rx_update_af_cache()
659 if (freq == fmdev->rx.freq) { in fm_rx_update_af_cache()
661 fmdev->rx.freq, freq); in fm_rx_update_af_cache()
689 static void fm_rdsparse_swapbytes(struct fmdev *fmdev, in fm_rdsparse_swapbytes() argument
701 if (fmdev->asci_id != 0x6350) { in fm_rdsparse_swapbytes()
712 static void fm_irq_handle_rdsdata_getcmd_resp(struct fmdev *fmdev) in fm_irq_handle_rdsdata_getcmd_resp() argument
716 struct fm_rds *rds = &fmdev->rx.rds; in fm_irq_handle_rdsdata_getcmd_resp()
723 if (check_cmdresp_status(fmdev, &skb)) in fm_irq_handle_rdsdata_getcmd_resp()
761 fm_rdsparse_swapbytes(fmdev, &rds_fmt); in fm_irq_handle_rdsdata_getcmd_resp()
768 if (fmdev->rx.stat_info.picode != cur_picode) in fm_irq_handle_rdsdata_getcmd_resp()
769 fmdev->rx.stat_info.picode = cur_picode; in fm_irq_handle_rdsdata_getcmd_resp()
779 fm_rx_update_af_cache(fmdev, rds_fmt.data.group0A.af[0]); in fm_irq_handle_rdsdata_getcmd_resp()
780 fm_rx_update_af_cache(fmdev, rds_fmt.data.group0A.af[1]); in fm_irq_handle_rdsdata_getcmd_resp()
791 spin_lock_irqsave(&fmdev->rds_buff_lock, flags); in fm_irq_handle_rdsdata_getcmd_resp()
819 spin_unlock_irqrestore(&fmdev->rds_buff_lock, flags); in fm_irq_handle_rdsdata_getcmd_resp()
825 fm_irq_call_stage(fmdev, FM_RDS_FINISH_IDX); in fm_irq_handle_rdsdata_getcmd_resp()
828 static void fm_irq_handle_rds_finish(struct fmdev *fmdev) in fm_irq_handle_rds_finish() argument
830 fm_irq_call_stage(fmdev, FM_HW_TUNE_OP_ENDED_IDX); in fm_irq_handle_rds_finish()
833 static void fm_irq_handle_tune_op_ended(struct fmdev *fmdev) in fm_irq_handle_tune_op_ended() argument
835 if (fmdev->irq_info.flag & (FM_FR_EVENT | FM_BL_EVENT) & fmdev-> in fm_irq_handle_tune_op_ended()
838 if (test_and_clear_bit(FM_AF_SWITCH_INPROGRESS, &fmdev->flag)) { in fm_irq_handle_tune_op_ended()
839 fmdev->irq_info.stage = FM_AF_JUMP_RD_FREQ_IDX; in fm_irq_handle_tune_op_ended()
841 complete(&fmdev->maintask_comp); in fm_irq_handle_tune_op_ended()
842 fmdev->irq_info.stage = FM_HW_POWER_ENB_IDX; in fm_irq_handle_tune_op_ended()
845 fmdev->irq_info.stage = FM_HW_POWER_ENB_IDX; in fm_irq_handle_tune_op_ended()
847 fm_irq_call(fmdev); in fm_irq_handle_tune_op_ended()
850 static void fm_irq_handle_power_enb(struct fmdev *fmdev) in fm_irq_handle_power_enb() argument
852 if (fmdev->irq_info.flag & FM_POW_ENB_EVENT) { in fm_irq_handle_power_enb()
854 complete(&fmdev->maintask_comp); in fm_irq_handle_power_enb()
857 fm_irq_call_stage(fmdev, FM_LOW_RSSI_START_IDX); in fm_irq_handle_power_enb()
860 static void fm_irq_handle_low_rssi_start(struct fmdev *fmdev) in fm_irq_handle_low_rssi_start() argument
862 if ((fmdev->rx.af_mode == FM_RX_RDS_AF_SWITCH_MODE_ON) && in fm_irq_handle_low_rssi_start()
863 (fmdev->irq_info.flag & FM_LEV_EVENT & fmdev->irq_info.mask) && in fm_irq_handle_low_rssi_start()
864 (fmdev->rx.freq != FM_UNDEFINED_FREQ) && in fm_irq_handle_low_rssi_start()
865 (fmdev->rx.stat_info.afcache_size != 0)) { in fm_irq_handle_low_rssi_start()
869 fmdev->irq_info.mask &= ~FM_LEV_EVENT; in fm_irq_handle_low_rssi_start()
871 fmdev->rx.afjump_idx = 0; in fm_irq_handle_low_rssi_start()
872 fmdev->rx.freq_before_jump = fmdev->rx.freq; in fm_irq_handle_low_rssi_start()
873 fmdev->irq_info.stage = FM_AF_JUMP_SETPI_IDX; in fm_irq_handle_low_rssi_start()
876 fmdev->irq_info.stage = FM_SEND_INTMSK_CMD_IDX; in fm_irq_handle_low_rssi_start()
879 fm_irq_call(fmdev); in fm_irq_handle_low_rssi_start()
882 static void fm_irq_afjump_set_pi(struct fmdev *fmdev) in fm_irq_afjump_set_pi() argument
887 payload = fmdev->rx.stat_info.picode; in fm_irq_afjump_set_pi()
888 if (!fm_send_cmd(fmdev, RDS_PI_SET, REG_WR, &payload, sizeof(payload), NULL)) in fm_irq_afjump_set_pi()
889 fm_irq_timeout_stage(fmdev, FM_AF_JUMP_HANDLE_SETPI_RESP_IDX); in fm_irq_afjump_set_pi()
892 static void fm_irq_handle_set_pi_resp(struct fmdev *fmdev) in fm_irq_handle_set_pi_resp() argument
894 fm_irq_common_cmd_resp_helper(fmdev, FM_AF_JUMP_SETPI_MASK_IDX); in fm_irq_handle_set_pi_resp()
902 static void fm_irq_afjump_set_pimask(struct fmdev *fmdev) in fm_irq_afjump_set_pimask() argument
907 if (!fm_send_cmd(fmdev, RDS_PI_MASK_SET, REG_WR, &payload, sizeof(payload), NULL)) in fm_irq_afjump_set_pimask()
908 fm_irq_timeout_stage(fmdev, FM_AF_JUMP_HANDLE_SETPI_MASK_RESP_IDX); in fm_irq_afjump_set_pimask()
911 static void fm_irq_handle_set_pimask_resp(struct fmdev *fmdev) in fm_irq_handle_set_pimask_resp() argument
913 fm_irq_common_cmd_resp_helper(fmdev, FM_AF_JUMP_SET_AF_FREQ_IDX); in fm_irq_handle_set_pimask_resp()
916 static void fm_irq_afjump_setfreq(struct fmdev *fmdev) in fm_irq_afjump_setfreq() argument
921 fmdbg("Swtich to %d KHz\n", fmdev->rx.stat_info.af_cache[fmdev->rx.afjump_idx]); in fm_irq_afjump_setfreq()
922 frq_index = (fmdev->rx.stat_info.af_cache[fmdev->rx.afjump_idx] - in fm_irq_afjump_setfreq()
923 fmdev->rx.region.bot_freq) / FM_FREQ_MUL; in fm_irq_afjump_setfreq()
926 if (!fm_send_cmd(fmdev, AF_FREQ_SET, REG_WR, &payload, sizeof(payload), NULL)) in fm_irq_afjump_setfreq()
927 fm_irq_timeout_stage(fmdev, FM_AF_JUMP_HANDLE_SET_AFFREQ_RESP_IDX); in fm_irq_afjump_setfreq()
930 static void fm_irq_handle_setfreq_resp(struct fmdev *fmdev) in fm_irq_handle_setfreq_resp() argument
932 fm_irq_common_cmd_resp_helper(fmdev, FM_AF_JUMP_ENABLE_INT_IDX); in fm_irq_handle_setfreq_resp()
935 static void fm_irq_afjump_enableint(struct fmdev *fmdev) in fm_irq_afjump_enableint() argument
941 if (!fm_send_cmd(fmdev, INT_MASK_SET, REG_WR, &payload, sizeof(payload), NULL)) in fm_irq_afjump_enableint()
942 fm_irq_timeout_stage(fmdev, FM_AF_JUMP_ENABLE_INT_RESP_IDX); in fm_irq_afjump_enableint()
945 static void fm_irq_afjump_enableint_resp(struct fmdev *fmdev) in fm_irq_afjump_enableint_resp() argument
947 fm_irq_common_cmd_resp_helper(fmdev, FM_AF_JUMP_START_AFJUMP_IDX); in fm_irq_afjump_enableint_resp()
950 static void fm_irq_start_afjump(struct fmdev *fmdev) in fm_irq_start_afjump() argument
955 if (!fm_send_cmd(fmdev, TUNER_MODE_SET, REG_WR, &payload, in fm_irq_start_afjump()
957 fm_irq_timeout_stage(fmdev, FM_AF_JUMP_HANDLE_START_AFJUMP_RESP_IDX); in fm_irq_start_afjump()
960 static void fm_irq_handle_start_afjump_resp(struct fmdev *fmdev) in fm_irq_handle_start_afjump_resp() argument
964 if (check_cmdresp_status(fmdev, &skb)) in fm_irq_handle_start_afjump_resp()
967 fmdev->irq_info.stage = FM_SEND_FLAG_GETCMD_IDX; in fm_irq_handle_start_afjump_resp()
968 set_bit(FM_AF_SWITCH_INPROGRESS, &fmdev->flag); in fm_irq_handle_start_afjump_resp()
969 clear_bit(FM_INTTASK_RUNNING, &fmdev->flag); in fm_irq_handle_start_afjump_resp()
972 static void fm_irq_afjump_rd_freq(struct fmdev *fmdev) in fm_irq_afjump_rd_freq() argument
976 if (!fm_send_cmd(fmdev, FREQ_SET, REG_RD, NULL, sizeof(payload), NULL)) in fm_irq_afjump_rd_freq()
977 fm_irq_timeout_stage(fmdev, FM_AF_JUMP_RD_FREQ_RESP_IDX); in fm_irq_afjump_rd_freq()
980 static void fm_irq_afjump_rd_freq_resp(struct fmdev *fmdev) in fm_irq_afjump_rd_freq_resp() argument
986 if (check_cmdresp_status(fmdev, &skb)) in fm_irq_afjump_rd_freq_resp()
993 curr_freq = fmdev->rx.region.bot_freq + ((u32)read_freq * FM_FREQ_MUL); in fm_irq_afjump_rd_freq_resp()
995 jumped_freq = fmdev->rx.stat_info.af_cache[fmdev->rx.afjump_idx]; in fm_irq_afjump_rd_freq_resp()
998 if ((curr_freq != fmdev->rx.freq_before_jump) && (curr_freq == jumped_freq)) { in fm_irq_afjump_rd_freq_resp()
1000 fmdev->rx.freq = curr_freq; in fm_irq_afjump_rd_freq_resp()
1001 fm_rx_reset_rds_cache(fmdev); in fm_irq_afjump_rd_freq_resp()
1004 if (fmdev->rx.af_mode == FM_RX_RDS_AF_SWITCH_MODE_ON) in fm_irq_afjump_rd_freq_resp()
1005 fmdev->irq_info.mask |= FM_LEV_EVENT; in fm_irq_afjump_rd_freq_resp()
1007 fmdev->irq_info.stage = FM_LOW_RSSI_FINISH_IDX; in fm_irq_afjump_rd_freq_resp()
1009 fmdev->rx.afjump_idx++; in fm_irq_afjump_rd_freq_resp()
1012 if (fmdev->rx.afjump_idx >= fmdev->rx.stat_info.afcache_size) { in fm_irq_afjump_rd_freq_resp()
1014 fmdev->irq_info.stage = FM_LOW_RSSI_FINISH_IDX; in fm_irq_afjump_rd_freq_resp()
1018 fmdev->irq_info.stage = FM_AF_JUMP_SETPI_IDX; in fm_irq_afjump_rd_freq_resp()
1021 fm_irq_call(fmdev); in fm_irq_afjump_rd_freq_resp()
1024 static void fm_irq_handle_low_rssi_finish(struct fmdev *fmdev) in fm_irq_handle_low_rssi_finish() argument
1026 fm_irq_call_stage(fmdev, FM_SEND_INTMSK_CMD_IDX); in fm_irq_handle_low_rssi_finish()
1029 static void fm_irq_send_intmsk_cmd(struct fmdev *fmdev) in fm_irq_send_intmsk_cmd() argument
1034 payload = fmdev->irq_info.mask; in fm_irq_send_intmsk_cmd()
1036 if (!fm_send_cmd(fmdev, INT_MASK_SET, REG_WR, &payload, in fm_irq_send_intmsk_cmd()
1038 fm_irq_timeout_stage(fmdev, FM_HANDLE_INTMSK_CMD_RESP_IDX); in fm_irq_send_intmsk_cmd()
1041 static void fm_irq_handle_intmsk_cmd_resp(struct fmdev *fmdev) in fm_irq_handle_intmsk_cmd_resp() argument
1045 if (check_cmdresp_status(fmdev, &skb)) in fm_irq_handle_intmsk_cmd_resp()
1051 fmdev->irq_info.stage = FM_SEND_FLAG_GETCMD_IDX; in fm_irq_handle_intmsk_cmd_resp()
1054 if (test_and_clear_bit(FM_INTTASK_SCHEDULE_PENDING, &fmdev->flag)) in fm_irq_handle_intmsk_cmd_resp()
1055 fmdev->irq_info.handlers[fmdev->irq_info.stage](fmdev); in fm_irq_handle_intmsk_cmd_resp()
1057 clear_bit(FM_INTTASK_RUNNING, &fmdev->flag); in fm_irq_handle_intmsk_cmd_resp()
1061 int fmc_is_rds_data_available(struct fmdev *fmdev, struct file *file, in fmc_is_rds_data_available() argument
1064 poll_wait(file, &fmdev->rx.rds.read_queue, pts); in fmc_is_rds_data_available()
1065 if (fmdev->rx.rds.rd_idx != fmdev->rx.rds.wr_idx) in fmc_is_rds_data_available()
1072 int fmc_transfer_rds_from_internal_buff(struct fmdev *fmdev, struct file *file, in fmc_transfer_rds_from_internal_buff() argument
1080 if (fmdev->rx.rds.wr_idx == fmdev->rx.rds.rd_idx) { in fmc_transfer_rds_from_internal_buff()
1084 ret = wait_event_interruptible(fmdev->rx.rds.read_queue, in fmc_transfer_rds_from_internal_buff()
1085 (fmdev->rx.rds.wr_idx != fmdev->rx.rds.rd_idx)); in fmc_transfer_rds_from_internal_buff()
1096 spin_lock_irqsave(&fmdev->rds_buff_lock, flags); in fmc_transfer_rds_from_internal_buff()
1098 if (fmdev->rx.rds.wr_idx == fmdev->rx.rds.rd_idx) { in fmc_transfer_rds_from_internal_buff()
1099 spin_unlock_irqrestore(&fmdev->rds_buff_lock, flags); in fmc_transfer_rds_from_internal_buff()
1102 memcpy(tmpbuf, &fmdev->rx.rds.buff[fmdev->rx.rds.rd_idx], in fmc_transfer_rds_from_internal_buff()
1104 fmdev->rx.rds.rd_idx += FM_RDS_BLK_SIZE; in fmc_transfer_rds_from_internal_buff()
1105 if (fmdev->rx.rds.rd_idx >= fmdev->rx.rds.buf_size) in fmc_transfer_rds_from_internal_buff()
1106 fmdev->rx.rds.rd_idx = 0; in fmc_transfer_rds_from_internal_buff()
1108 spin_unlock_irqrestore(&fmdev->rds_buff_lock, flags); in fmc_transfer_rds_from_internal_buff()
1120 int fmc_set_freq(struct fmdev *fmdev, u32 freq_to_set) in fmc_set_freq() argument
1122 switch (fmdev->curr_fmmode) { in fmc_set_freq()
1124 return fm_rx_set_freq(fmdev, freq_to_set); in fmc_set_freq()
1127 return fm_tx_set_freq(fmdev, freq_to_set); in fmc_set_freq()
1134 int fmc_get_freq(struct fmdev *fmdev, u32 *cur_tuned_frq) in fmc_get_freq() argument
1136 if (fmdev->rx.freq == FM_UNDEFINED_FREQ) { in fmc_get_freq()
1145 switch (fmdev->curr_fmmode) { in fmc_get_freq()
1147 *cur_tuned_frq = fmdev->rx.freq; in fmc_get_freq()
1160 int fmc_set_region(struct fmdev *fmdev, u8 region_to_set) in fmc_set_region() argument
1162 switch (fmdev->curr_fmmode) { in fmc_set_region()
1164 return fm_rx_set_region(fmdev, region_to_set); in fmc_set_region()
1167 return fm_tx_set_region(fmdev, region_to_set); in fmc_set_region()
1174 int fmc_set_mute_mode(struct fmdev *fmdev, u8 mute_mode_toset) in fmc_set_mute_mode() argument
1176 switch (fmdev->curr_fmmode) { in fmc_set_mute_mode()
1178 return fm_rx_set_mute_mode(fmdev, mute_mode_toset); in fmc_set_mute_mode()
1181 return fm_tx_set_mute_mode(fmdev, mute_mode_toset); in fmc_set_mute_mode()
1188 int fmc_set_stereo_mono(struct fmdev *fmdev, u16 mode) in fmc_set_stereo_mono() argument
1190 switch (fmdev->curr_fmmode) { in fmc_set_stereo_mono()
1192 return fm_rx_set_stereo_mono(fmdev, mode); in fmc_set_stereo_mono()
1195 return fm_tx_set_stereo_mono(fmdev, mode); in fmc_set_stereo_mono()
1202 int fmc_set_rds_mode(struct fmdev *fmdev, u8 rds_en_dis) in fmc_set_rds_mode() argument
1204 switch (fmdev->curr_fmmode) { in fmc_set_rds_mode()
1206 return fm_rx_set_rds_mode(fmdev, rds_en_dis); in fmc_set_rds_mode()
1209 return fm_tx_set_rds_mode(fmdev, rds_en_dis); in fmc_set_rds_mode()
1217 static int fm_power_down(struct fmdev *fmdev) in fm_power_down() argument
1222 if (!test_bit(FM_CORE_READY, &fmdev->flag)) { in fm_power_down()
1226 if (fmdev->curr_fmmode == FM_MODE_OFF) { in fm_power_down()
1232 ret = fmc_send_cmd(fmdev, FM_POWER_MODE, REG_WR, &payload, in fm_power_down()
1237 return fmc_release(fmdev); in fm_power_down()
1241 static int fm_download_firmware(struct fmdev *fmdev, const u8 *fw_name) in fm_download_firmware() argument
1251 set_bit(FM_FW_DW_INPROGRESS, &fmdev->flag); in fm_download_firmware()
1254 &fmdev->radio_dev->dev); in fm_download_firmware()
1281 if (fmc_send_cmd(fmdev, 0, 0, action->data, in fm_download_firmware()
1300 clear_bit(FM_FW_DW_INPROGRESS, &fmdev->flag); in fm_download_firmware()
1306 static int load_default_rx_configuration(struct fmdev *fmdev) in load_default_rx_configuration() argument
1310 ret = fm_rx_set_volume(fmdev, FM_DEFAULT_RX_VOLUME); in load_default_rx_configuration()
1314 return fm_rx_set_rssi_threshold(fmdev, FM_DEFAULT_RSSI_THRESHOLD); in load_default_rx_configuration()
1318 static int fm_power_up(struct fmdev *fmdev, u8 mode) in fm_power_up() argument
1334 ret = fmc_prepare(fmdev); in fm_power_up()
1341 if (fmc_send_cmd(fmdev, FM_POWER_MODE, REG_WR, &payload, in fm_power_up()
1348 if (fmc_send_cmd(fmdev, ASIC_ID_GET, REG_RD, NULL, in fm_power_up()
1352 if (fmc_send_cmd(fmdev, ASIC_VER_GET, REG_RD, NULL, in fm_power_up()
1362 ret = fm_download_firmware(fmdev, fw_name); in fm_power_up()
1371 ret = fm_download_firmware(fmdev, fw_name); in fm_power_up()
1378 return fmc_release(fmdev); in fm_power_up()
1382 int fmc_set_mode(struct fmdev *fmdev, u8 fm_mode) in fmc_set_mode() argument
1390 if (fmdev->curr_fmmode == fm_mode) { in fmc_set_mode()
1397 ret = fm_power_down(fmdev); in fmc_set_mode()
1407 if (fmdev->curr_fmmode != FM_MODE_OFF) { in fmc_set_mode()
1408 ret = fm_power_down(fmdev); in fmc_set_mode()
1415 ret = fm_power_up(fmdev, fm_mode); in fmc_set_mode()
1421 fmdev->curr_fmmode = fm_mode; in fmc_set_mode()
1424 if (fmdev->curr_fmmode == FM_MODE_RX) { in fmc_set_mode()
1426 ret = load_default_rx_configuration(fmdev); in fmc_set_mode()
1435 int fmc_get_mode(struct fmdev *fmdev, u8 *fmmode) in fmc_get_mode() argument
1437 if (!test_bit(FM_CORE_READY, &fmdev->flag)) { in fmc_get_mode()
1446 *fmmode = fmdev->curr_fmmode; in fmc_get_mode()
1453 struct fmdev *fmdev; in fm_st_receive() local
1455 fmdev = (struct fmdev *)arg; in fm_st_receive()
1468 skb_queue_tail(&fmdev->rx_q, skb); in fm_st_receive()
1469 tasklet_schedule(&fmdev->rx_task); in fm_st_receive()
1480 struct fmdev *fmdev; in fm_st_reg_comp_cb() local
1482 fmdev = (struct fmdev *)arg; in fm_st_reg_comp_cb()
1483 fmdev->streg_cbdata = data; in fm_st_reg_comp_cb()
1491 int fmc_prepare(struct fmdev *fmdev) in fmc_prepare() argument
1496 if (test_bit(FM_CORE_READY, &fmdev->flag)) { in fmc_prepare()
1506 fm_st_proto.priv_data = fmdev; in fmc_prepare()
1517 fmdev->streg_cbdata = -EINPROGRESS; in fmc_prepare()
1527 if (fmdev->streg_cbdata != 0) { in fmc_prepare()
1529 "status %d\n", fmdev->streg_cbdata); in fmc_prepare()
1549 spin_lock_init(&fmdev->rds_buff_lock); in fmc_prepare()
1550 spin_lock_init(&fmdev->resp_skb_lock); in fmc_prepare()
1553 skb_queue_head_init(&fmdev->tx_q); in fmc_prepare()
1554 tasklet_init(&fmdev->tx_task, send_tasklet, (unsigned long)fmdev); in fmc_prepare()
1557 skb_queue_head_init(&fmdev->rx_q); in fmc_prepare()
1558 tasklet_init(&fmdev->rx_task, recv_tasklet, (unsigned long)fmdev); in fmc_prepare()
1560 fmdev->irq_info.stage = 0; in fmc_prepare()
1561 atomic_set(&fmdev->tx_cnt, 1); in fmc_prepare()
1562 fmdev->resp_comp = NULL; in fmc_prepare()
1564 init_timer(&fmdev->irq_info.timer); in fmc_prepare()
1565 fmdev->irq_info.timer.function = &int_timeout_handler; in fmc_prepare()
1566 fmdev->irq_info.timer.data = (unsigned long)fmdev; in fmc_prepare()
1568 fmdev->irq_info.mask = FM_MAL_EVENT; in fmc_prepare()
1571 fmdev->rx.region = region_configs[default_radio_region]; in fmc_prepare()
1573 fmdev->rx.mute_mode = FM_MUTE_OFF; in fmc_prepare()
1574 fmdev->rx.rf_depend_mute = FM_RX_RF_DEPENDENT_MUTE_OFF; in fmc_prepare()
1575 fmdev->rx.rds.flag = FM_RDS_DISABLE; in fmc_prepare()
1576 fmdev->rx.freq = FM_UNDEFINED_FREQ; in fmc_prepare()
1577 fmdev->rx.rds_mode = FM_RDS_SYSTEM_RDS; in fmc_prepare()
1578 fmdev->rx.af_mode = FM_RX_RDS_AF_SWITCH_MODE_OFF; in fmc_prepare()
1579 fmdev->irq_info.retry = 0; in fmc_prepare()
1581 fm_rx_reset_rds_cache(fmdev); in fmc_prepare()
1582 init_waitqueue_head(&fmdev->rx.rds.read_queue); in fmc_prepare()
1584 fm_rx_reset_station_info(fmdev); in fmc_prepare()
1585 set_bit(FM_CORE_READY, &fmdev->flag); in fmc_prepare()
1594 int fmc_release(struct fmdev *fmdev) in fmc_release() argument
1599 if (!test_bit(FM_CORE_READY, &fmdev->flag)) { in fmc_release()
1604 wake_up_interruptible(&fmdev->rx.rds.read_queue); in fmc_release()
1606 tasklet_kill(&fmdev->tx_task); in fmc_release()
1607 tasklet_kill(&fmdev->rx_task); in fmc_release()
1609 skb_queue_purge(&fmdev->tx_q); in fmc_release()
1610 skb_queue_purge(&fmdev->rx_q); in fmc_release()
1612 fmdev->resp_comp = NULL; in fmc_release()
1613 fmdev->rx.freq = 0; in fmc_release()
1625 clear_bit(FM_CORE_READY, &fmdev->flag); in fmc_release()
1635 struct fmdev *fmdev = NULL; in fm_drv_init() local
1640 fmdev = kzalloc(sizeof(struct fmdev), GFP_KERNEL); in fm_drv_init()
1641 if (NULL == fmdev) { in fm_drv_init()
1645 fmdev->rx.rds.buf_size = default_rds_buf * FM_RDS_BLK_SIZE; in fm_drv_init()
1646 fmdev->rx.rds.buff = kzalloc(fmdev->rx.rds.buf_size, GFP_KERNEL); in fm_drv_init()
1647 if (NULL == fmdev->rx.rds.buff) { in fm_drv_init()
1652 ret = fm_v4l2_init_video_device(fmdev, radio_nr); in fm_drv_init()
1656 fmdev->irq_info.handlers = int_handler_table; in fm_drv_init()
1657 fmdev->curr_fmmode = FM_MODE_OFF; in fm_drv_init()
1658 fmdev->tx_data.pwr_lvl = FM_PWR_LVL_DEF; in fm_drv_init()
1659 fmdev->tx_data.preemph = FM_TX_PREEMPH_50US; in fm_drv_init()
1663 kfree(fmdev->rx.rds.buff); in fm_drv_init()
1665 kfree(fmdev); in fm_drv_init()
1673 struct fmdev *fmdev = NULL; in fm_drv_exit() local
1675 fmdev = fm_v4l2_deinit_video_device(); in fm_drv_exit()
1676 if (fmdev != NULL) { in fm_drv_exit()
1677 kfree(fmdev->rx.rds.buff); in fm_drv_exit()
1678 kfree(fmdev); in fm_drv_exit()