/* * Copyright (c) 2012 Qualcomm Atheros, Inc. * * Permission to use, copy, modify, and/or distribute this software for any * purpose with or without fee is hereby granted, provided that the above * copyright notice and this permission notice appear in all copies. * * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. */ #include "core.h" #include "cfg80211.h" #include "debug.h" static void ath6kl_recovery_work(struct work_struct *work) { struct ath6kl *ar = container_of(work, struct ath6kl, fw_recovery.recovery_work); ar->state = ATH6KL_STATE_RECOVERY; del_timer_sync(&ar->fw_recovery.hb_timer); ath6kl_init_hw_restart(ar); ar->state = ATH6KL_STATE_ON; clear_bit(WMI_CTRL_EP_FULL, &ar->flag); ar->fw_recovery.err_reason = 0; if (ar->fw_recovery.hb_poll) mod_timer(&ar->fw_recovery.hb_timer, jiffies + msecs_to_jiffies(ar->fw_recovery.hb_poll)); } void ath6kl_recovery_err_notify(struct ath6kl *ar, enum ath6kl_fw_err reason) { if (!ar->fw_recovery.enable) return; ath6kl_dbg(ATH6KL_DBG_RECOVERY, "Fw error detected, reason:%d\n", reason); set_bit(reason, &ar->fw_recovery.err_reason); if (!test_bit(RECOVERY_CLEANUP, &ar->flag) && ar->state != ATH6KL_STATE_RECOVERY) queue_work(ar->ath6kl_wq, &ar->fw_recovery.recovery_work); } void ath6kl_recovery_hb_event(struct ath6kl *ar, u32 cookie) { if (cookie == ar->fw_recovery.seq_num) ar->fw_recovery.hb_pending = false; } static void ath6kl_recovery_hb_timer(unsigned long data) { struct ath6kl *ar = (struct ath6kl *) data; int err; if (test_bit(RECOVERY_CLEANUP, &ar->flag) || (ar->state == ATH6KL_STATE_RECOVERY)) return; if (ar->fw_recovery.hb_pending) ar->fw_recovery.hb_misscnt++; else ar->fw_recovery.hb_misscnt = 0; if (ar->fw_recovery.hb_misscnt > ATH6KL_HB_RESP_MISS_THRES) { ar->fw_recovery.hb_misscnt = 0; ar->fw_recovery.seq_num = 0; ar->fw_recovery.hb_pending = false; ath6kl_recovery_err_notify(ar, ATH6KL_FW_HB_RESP_FAILURE); return; } ar->fw_recovery.seq_num++; ar->fw_recovery.hb_pending = true; err = ath6kl_wmi_get_challenge_resp_cmd(ar->wmi, ar->fw_recovery.seq_num, 0); if (err) ath6kl_warn("Failed to send hb challenge request, err:%d\n", err); mod_timer(&ar->fw_recovery.hb_timer, jiffies + msecs_to_jiffies(ar->fw_recovery.hb_poll)); } void ath6kl_recovery_init(struct ath6kl *ar) { struct ath6kl_fw_recovery *recovery = &ar->fw_recovery; clear_bit(RECOVERY_CLEANUP, &ar->flag); INIT_WORK(&recovery->recovery_work, ath6kl_recovery_work); recovery->seq_num = 0; recovery->hb_misscnt = 0; ar->fw_recovery.hb_pending = false; ar->fw_recovery.hb_timer.function = ath6kl_recovery_hb_timer; ar->fw_recovery.hb_timer.data = (unsigned long) ar; init_timer_deferrable(&ar->fw_recovery.hb_timer); if (ar->fw_recovery.hb_poll) mod_timer(&ar->fw_recovery.hb_timer, jiffies + msecs_to_jiffies(ar->fw_recovery.hb_poll)); } void ath6kl_recovery_cleanup(struct ath6kl *ar) { if (!ar->fw_recovery.enable) return; set_bit(RECOVERY_CLEANUP, &ar->flag); del_timer_sync(&ar->fw_recovery.hb_timer); cancel_work_sync(&ar->fw_recovery.recovery_work); } void ath6kl_recovery_suspend(struct ath6kl *ar) { if (!ar->fw_recovery.enable) return; ath6kl_recovery_cleanup(ar); if (!ar->fw_recovery.err_reason) return; /* Process pending fw error detection */ ar->fw_recovery.err_reason = 0; WARN_ON(ar->state != ATH6KL_STATE_ON); ar->state = ATH6KL_STATE_RECOVERY; ath6kl_init_hw_restart(ar); ar->state = ATH6KL_STATE_ON; } void ath6kl_recovery_resume(struct ath6kl *ar) { if (!ar->fw_recovery.enable) return; clear_bit(RECOVERY_CLEANUP, &ar->flag); if (!ar->fw_recovery.hb_poll) return; ar->fw_recovery.hb_pending = false; ar->fw_recovery.seq_num = 0; ar->fw_recovery.hb_misscnt = 0; mod_timer(&ar->fw_recovery.hb_timer, jiffies + msecs_to_jiffies(ar->fw_recovery.hb_poll)); }