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
ath6kl_recovery_work(struct work_struct * work)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
ath6kl_recovery_err_notify(struct ath6kl * ar,enum ath6kl_fw_err reason)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
ath6kl_recovery_hb_event(struct ath6kl * ar,u32 cookie)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
ath6kl_recovery_hb_timer(unsigned long data)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
ath6kl_recovery_init(struct ath6kl * ar)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
ath6kl_recovery_cleanup(struct ath6kl * ar)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
ath6kl_recovery_suspend(struct ath6kl * ar)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
ath6kl_recovery_resume(struct ath6kl * ar)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 }
161