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