linux/drivers/net/wireless/ath/ath6kl/recovery.c
<<
>>
Prefs
   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
  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(unsigned long data)
  64{
  65        struct ath6kl *ar = (struct ath6kl *) data;
  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
  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        ar->fw_recovery.hb_timer.function = ath6kl_recovery_hb_timer;
 108        ar->fw_recovery.hb_timer.data = (unsigned long) ar;
 109        init_timer_deferrable(&ar->fw_recovery.hb_timer);
 110
 111        if (ar->fw_recovery.hb_poll)
 112                mod_timer(&ar->fw_recovery.hb_timer, jiffies +
 113                          msecs_to_jiffies(ar->fw_recovery.hb_poll));
 114}
 115
 116void ath6kl_recovery_cleanup(struct ath6kl *ar)
 117{
 118        if (!ar->fw_recovery.enable)
 119                return;
 120
 121        set_bit(RECOVERY_CLEANUP, &ar->flag);
 122
 123        del_timer_sync(&ar->fw_recovery.hb_timer);
 124        cancel_work_sync(&ar->fw_recovery.recovery_work);
 125}
 126
 127void ath6kl_recovery_suspend(struct ath6kl *ar)
 128{
 129        if (!ar->fw_recovery.enable)
 130                return;
 131
 132        ath6kl_recovery_cleanup(ar);
 133
 134        if (!ar->fw_recovery.err_reason)
 135                return;
 136
 137        /* Process pending fw error detection */
 138        ar->fw_recovery.err_reason = 0;
 139        WARN_ON(ar->state != ATH6KL_STATE_ON);
 140        ar->state = ATH6KL_STATE_RECOVERY;
 141        ath6kl_init_hw_restart(ar);
 142        ar->state = ATH6KL_STATE_ON;
 143}
 144
 145void ath6kl_recovery_resume(struct ath6kl *ar)
 146{
 147        if (!ar->fw_recovery.enable)
 148                return;
 149
 150        clear_bit(RECOVERY_CLEANUP, &ar->flag);
 151
 152        if (!ar->fw_recovery.hb_poll)
 153                return;
 154
 155        ar->fw_recovery.hb_pending = false;
 156        ar->fw_recovery.seq_num = 0;
 157        ar->fw_recovery.hb_misscnt = 0;
 158        mod_timer(&ar->fw_recovery.hb_timer,
 159                  jiffies + msecs_to_jiffies(ar->fw_recovery.hb_poll));
 160}
 161