1 /* 2 * Copyright (c) 2012 Qualcomm Atheros, Inc. 3 * 4 * Permission to use, copy, modify, and/or distribute this software for any 5 * purpose with or without fee is hereby granted, provided that the above 6 * copyright notice and this permission notice appear in all copies. 7 * 8 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES 9 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF 10 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR 11 * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES 12 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN 13 * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF 14 * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. 15 */ 16 17 #include "core.h" 18 #include "cfg80211.h" 19 #include "debug.h" 20 21 static void ath6kl_recovery_work(struct work_struct *work) 22 { 23 struct ath6kl *ar = container_of(work, struct ath6kl, 24 fw_recovery.recovery_work); 25 26 ar->state = ATH6KL_STATE_RECOVERY; 27 28 del_timer_sync(&ar->fw_recovery.hb_timer); 29 30 ath6kl_init_hw_restart(ar); 31 32 ar->state = ATH6KL_STATE_ON; 33 clear_bit(WMI_CTRL_EP_FULL, &ar->flag); 34 35 ar->fw_recovery.err_reason = 0; 36 37 if (ar->fw_recovery.hb_poll) 38 mod_timer(&ar->fw_recovery.hb_timer, jiffies + 39 msecs_to_jiffies(ar->fw_recovery.hb_poll)); 40 } 41 42 void ath6kl_recovery_err_notify(struct ath6kl *ar, enum ath6kl_fw_err reason) 43 { 44 if (!ar->fw_recovery.enable) 45 return; 46 47 ath6kl_dbg(ATH6KL_DBG_RECOVERY, "Fw error detected, reason:%d\n", 48 reason); 49 50 set_bit(reason, &ar->fw_recovery.err_reason); 51 52 if (!test_bit(RECOVERY_CLEANUP, &ar->flag) && 53 ar->state != ATH6KL_STATE_RECOVERY) 54 queue_work(ar->ath6kl_wq, &ar->fw_recovery.recovery_work); 55 } 56 57 void ath6kl_recovery_hb_event(struct ath6kl *ar, u32 cookie) 58 { 59 if (cookie == ar->fw_recovery.seq_num) 60 ar->fw_recovery.hb_pending = false; 61 } 62 63 static void ath6kl_recovery_hb_timer(struct timer_list *t) 64 { 65 struct ath6kl *ar = from_timer(ar, t, fw_recovery.hb_timer); 66 int err; 67 68 if (test_bit(RECOVERY_CLEANUP, &ar->flag) || 69 (ar->state == ATH6KL_STATE_RECOVERY)) 70 return; 71 72 if (ar->fw_recovery.hb_pending) 73 ar->fw_recovery.hb_misscnt++; 74 else 75 ar->fw_recovery.hb_misscnt = 0; 76 77 if (ar->fw_recovery.hb_misscnt > ATH6KL_HB_RESP_MISS_THRES) { 78 ar->fw_recovery.hb_misscnt = 0; 79 ar->fw_recovery.seq_num = 0; 80 ar->fw_recovery.hb_pending = false; 81 ath6kl_recovery_err_notify(ar, ATH6KL_FW_HB_RESP_FAILURE); 82 return; 83 } 84 85 ar->fw_recovery.seq_num++; 86 ar->fw_recovery.hb_pending = true; 87 88 err = ath6kl_wmi_get_challenge_resp_cmd(ar->wmi, 89 ar->fw_recovery.seq_num, 0); 90 if (err) 91 ath6kl_warn("Failed to send hb challenge request, err:%d\n", 92 err); 93 94 mod_timer(&ar->fw_recovery.hb_timer, jiffies + 95 msecs_to_jiffies(ar->fw_recovery.hb_poll)); 96 } 97 98 void ath6kl_recovery_init(struct ath6kl *ar) 99 { 100 struct ath6kl_fw_recovery *recovery = &ar->fw_recovery; 101 102 clear_bit(RECOVERY_CLEANUP, &ar->flag); 103 INIT_WORK(&recovery->recovery_work, ath6kl_recovery_work); 104 recovery->seq_num = 0; 105 recovery->hb_misscnt = 0; 106 ar->fw_recovery.hb_pending = false; 107 timer_setup(&ar->fw_recovery.hb_timer, ath6kl_recovery_hb_timer, 108 TIMER_DEFERRABLE); 109 110 if (ar->fw_recovery.hb_poll) 111 mod_timer(&ar->fw_recovery.hb_timer, jiffies + 112 msecs_to_jiffies(ar->fw_recovery.hb_poll)); 113 } 114 115 void ath6kl_recovery_cleanup(struct ath6kl *ar) 116 { 117 if (!ar->fw_recovery.enable) 118 return; 119 120 set_bit(RECOVERY_CLEANUP, &ar->flag); 121 122 del_timer_sync(&ar->fw_recovery.hb_timer); 123 cancel_work_sync(&ar->fw_recovery.recovery_work); 124 } 125 126 void ath6kl_recovery_suspend(struct ath6kl *ar) 127 { 128 if (!ar->fw_recovery.enable) 129 return; 130 131 ath6kl_recovery_cleanup(ar); 132 133 if (!ar->fw_recovery.err_reason) 134 return; 135 136 /* Process pending fw error detection */ 137 ar->fw_recovery.err_reason = 0; 138 WARN_ON(ar->state != ATH6KL_STATE_ON); 139 ar->state = ATH6KL_STATE_RECOVERY; 140 ath6kl_init_hw_restart(ar); 141 ar->state = ATH6KL_STATE_ON; 142 } 143 144 void ath6kl_recovery_resume(struct ath6kl *ar) 145 { 146 if (!ar->fw_recovery.enable) 147 return; 148 149 clear_bit(RECOVERY_CLEANUP, &ar->flag); 150 151 if (!ar->fw_recovery.hb_poll) 152 return; 153 154 ar->fw_recovery.hb_pending = false; 155 ar->fw_recovery.seq_num = 0; 156 ar->fw_recovery.hb_misscnt = 0; 157 mod_timer(&ar->fw_recovery.hb_timer, 158 jiffies + msecs_to_jiffies(ar->fw_recovery.hb_poll)); 159 } 160