161 lines
4.3 KiB
C
161 lines
4.3 KiB
C
/*
|
|
* 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));
|
|
}
|