160 lines · c
1/*2 * Copyright (c) 2012 Qualcomm Atheros, Inc.3 *4 * Permission to use, copy, modify, and/or distribute this software for any5 * purpose with or without fee is hereby granted, provided that the above6 * copyright notice and this permission notice appear in all copies.7 *8 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES9 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF10 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR11 * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES12 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN13 * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF14 * 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 21static 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 42void 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 57void 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 63static 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 else75 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 98void 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 115void 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 126void 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 144void 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