drivers/net/wireless/ath/ath6kl/recovery.c

   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(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
  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         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
 116 void 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
 127 void 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
 145 void 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 }