1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3  * This file is part of wl1251
4  *
5  * Copyright (c) 1998-2007 Texas Instruments Incorporated
6  * Copyright (C) 2008 Nokia Corporation
7  */
8 
9 #include "wl1251.h"
10 #include "reg.h"
11 #include "io.h"
12 #include "event.h"
13 #include "ps.h"
14 
wl1251_event_scan_complete(struct wl1251 * wl,struct event_mailbox * mbox)15 static int wl1251_event_scan_complete(struct wl1251 *wl,
16 				      struct event_mailbox *mbox)
17 {
18 	int ret = 0;
19 
20 	wl1251_debug(DEBUG_EVENT, "status: 0x%x, channels: %d",
21 		     mbox->scheduled_scan_status,
22 		     mbox->scheduled_scan_channels);
23 
24 	if (wl->scanning) {
25 		struct cfg80211_scan_info info = {
26 			.aborted = false,
27 		};
28 
29 		ieee80211_scan_completed(wl->hw, &info);
30 		wl1251_debug(DEBUG_MAC80211, "mac80211 hw scan completed");
31 		wl->scanning = false;
32 		if (wl->hw->conf.flags & IEEE80211_CONF_IDLE)
33 			ret = wl1251_ps_set_mode(wl, STATION_IDLE);
34 	}
35 
36 	return ret;
37 }
38 
39 #define WL1251_PSM_ENTRY_RETRIES  3
wl1251_event_ps_report(struct wl1251 * wl,struct event_mailbox * mbox)40 static int wl1251_event_ps_report(struct wl1251 *wl,
41 				  struct event_mailbox *mbox)
42 {
43 	int ret = 0;
44 
45 	wl1251_debug(DEBUG_EVENT, "ps status: %x", mbox->ps_status);
46 
47 	switch (mbox->ps_status) {
48 	case EVENT_ENTER_POWER_SAVE_FAIL:
49 		wl1251_debug(DEBUG_PSM, "PSM entry failed");
50 
51 		if (wl->station_mode != STATION_POWER_SAVE_MODE) {
52 			/* remain in active mode */
53 			wl->psm_entry_retry = 0;
54 			break;
55 		}
56 
57 		if (wl->psm_entry_retry < WL1251_PSM_ENTRY_RETRIES) {
58 			wl->psm_entry_retry++;
59 			ret = wl1251_ps_set_mode(wl, STATION_POWER_SAVE_MODE);
60 		} else {
61 			wl1251_error("Power save entry failed, giving up");
62 			wl->psm_entry_retry = 0;
63 		}
64 		break;
65 	case EVENT_ENTER_POWER_SAVE_SUCCESS:
66 	case EVENT_EXIT_POWER_SAVE_FAIL:
67 	case EVENT_EXIT_POWER_SAVE_SUCCESS:
68 	default:
69 		wl->psm_entry_retry = 0;
70 		break;
71 	}
72 
73 	return ret;
74 }
75 
wl1251_event_mbox_dump(struct event_mailbox * mbox)76 static void wl1251_event_mbox_dump(struct event_mailbox *mbox)
77 {
78 	wl1251_debug(DEBUG_EVENT, "MBOX DUMP:");
79 	wl1251_debug(DEBUG_EVENT, "\tvector: 0x%x", mbox->events_vector);
80 	wl1251_debug(DEBUG_EVENT, "\tmask: 0x%x", mbox->events_mask);
81 }
82 
wl1251_event_process(struct wl1251 * wl,struct event_mailbox * mbox)83 static int wl1251_event_process(struct wl1251 *wl, struct event_mailbox *mbox)
84 {
85 	int ret;
86 	u32 vector;
87 
88 	wl1251_event_mbox_dump(mbox);
89 
90 	vector = mbox->events_vector & ~(mbox->events_mask);
91 	wl1251_debug(DEBUG_EVENT, "vector: 0x%x", vector);
92 
93 	if (vector & SCAN_COMPLETE_EVENT_ID) {
94 		ret = wl1251_event_scan_complete(wl, mbox);
95 		if (ret < 0)
96 			return ret;
97 	}
98 
99 	if (vector & BSS_LOSE_EVENT_ID) {
100 		wl1251_debug(DEBUG_EVENT, "BSS_LOSE_EVENT");
101 
102 		if (wl->psm_requested &&
103 		    wl->station_mode != STATION_ACTIVE_MODE) {
104 			ret = wl1251_ps_set_mode(wl, STATION_ACTIVE_MODE);
105 			if (ret < 0)
106 				return ret;
107 		}
108 	}
109 
110 	if (vector & PS_REPORT_EVENT_ID) {
111 		wl1251_debug(DEBUG_EVENT, "PS_REPORT_EVENT");
112 		ret = wl1251_event_ps_report(wl, mbox);
113 		if (ret < 0)
114 			return ret;
115 	}
116 
117 	if (vector & SYNCHRONIZATION_TIMEOUT_EVENT_ID) {
118 		wl1251_debug(DEBUG_EVENT, "SYNCHRONIZATION_TIMEOUT_EVENT");
119 
120 		/* indicate to the stack, that beacons have been lost */
121 		if (wl->vif && wl->vif->type == NL80211_IFTYPE_STATION)
122 			ieee80211_beacon_loss(wl->vif);
123 	}
124 
125 	if (vector & REGAINED_BSS_EVENT_ID) {
126 		if (wl->psm_requested) {
127 			ret = wl1251_ps_set_mode(wl, STATION_POWER_SAVE_MODE);
128 			if (ret < 0)
129 				return ret;
130 		}
131 	}
132 
133 	if (wl->vif && wl->rssi_thold) {
134 		if (vector & ROAMING_TRIGGER_LOW_RSSI_EVENT_ID) {
135 			wl1251_debug(DEBUG_EVENT,
136 				     "ROAMING_TRIGGER_LOW_RSSI_EVENT");
137 			ieee80211_cqm_rssi_notify(wl->vif,
138 				NL80211_CQM_RSSI_THRESHOLD_EVENT_LOW,
139 				0, GFP_KERNEL);
140 		}
141 
142 		if (vector & ROAMING_TRIGGER_REGAINED_RSSI_EVENT_ID) {
143 			wl1251_debug(DEBUG_EVENT,
144 				     "ROAMING_TRIGGER_REGAINED_RSSI_EVENT");
145 			ieee80211_cqm_rssi_notify(wl->vif,
146 				NL80211_CQM_RSSI_THRESHOLD_EVENT_HIGH,
147 				0, GFP_KERNEL);
148 		}
149 	}
150 
151 	return 0;
152 }
153 
154 /*
155  * Poll the mailbox event field until any of the bits in the mask is set or a
156  * timeout occurs (WL1251_EVENT_TIMEOUT in msecs)
157  */
wl1251_event_wait(struct wl1251 * wl,u32 mask,int timeout_ms)158 int wl1251_event_wait(struct wl1251 *wl, u32 mask, int timeout_ms)
159 {
160 	u32 events_vector, event;
161 	unsigned long timeout;
162 
163 	timeout = jiffies + msecs_to_jiffies(timeout_ms);
164 
165 	do {
166 		if (time_after(jiffies, timeout))
167 			return -ETIMEDOUT;
168 
169 		msleep(1);
170 
171 		/* read from both event fields */
172 		events_vector = wl1251_mem_read32(wl, wl->mbox_ptr[0]);
173 		event = events_vector & mask;
174 		events_vector = wl1251_mem_read32(wl, wl->mbox_ptr[1]);
175 		event |= events_vector & mask;
176 	} while (!event);
177 
178 	return 0;
179 }
180 
wl1251_event_unmask(struct wl1251 * wl)181 int wl1251_event_unmask(struct wl1251 *wl)
182 {
183 	int ret;
184 
185 	ret = wl1251_acx_event_mbox_mask(wl, ~(wl->event_mask));
186 	if (ret < 0)
187 		return ret;
188 
189 	return 0;
190 }
191 
wl1251_event_mbox_config(struct wl1251 * wl)192 void wl1251_event_mbox_config(struct wl1251 *wl)
193 {
194 	wl->mbox_ptr[0] = wl1251_reg_read32(wl, REG_EVENT_MAILBOX_PTR);
195 	wl->mbox_ptr[1] = wl->mbox_ptr[0] + sizeof(struct event_mailbox);
196 
197 	wl1251_debug(DEBUG_EVENT, "MBOX ptrs: 0x%x 0x%x",
198 		     wl->mbox_ptr[0], wl->mbox_ptr[1]);
199 }
200 
wl1251_event_handle(struct wl1251 * wl,u8 mbox_num)201 int wl1251_event_handle(struct wl1251 *wl, u8 mbox_num)
202 {
203 	struct event_mailbox *mbox;
204 	int ret;
205 
206 	wl1251_debug(DEBUG_EVENT, "EVENT on mbox %d", mbox_num);
207 
208 	if (mbox_num > 1)
209 		return -EINVAL;
210 
211 	mbox = kmalloc(sizeof(*mbox), GFP_KERNEL);
212 	if (!mbox) {
213 		wl1251_error("can not allocate mbox buffer");
214 		return -ENOMEM;
215 	}
216 
217 	/* first we read the mbox descriptor */
218 	wl1251_mem_read(wl, wl->mbox_ptr[mbox_num], mbox,
219 			sizeof(*mbox));
220 
221 	/* process the descriptor */
222 	ret = wl1251_event_process(wl, mbox);
223 	kfree(mbox);
224 
225 	if (ret < 0)
226 		return ret;
227 
228 	/* then we let the firmware know it can go on...*/
229 	wl1251_reg_write32(wl, ACX_REG_INTERRUPT_TRIG, INTR_TRIG_EVENT_ACK);
230 
231 	return 0;
232 }
233