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
 15static 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
 40static 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 0;
 74}
 75
 76static 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
 83static 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 */
158int 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		wl1251_mem_read(wl, wl->mbox_ptr[0], &events_vector,
173				sizeof(events_vector));
174		event = events_vector & mask;
175		wl1251_mem_read(wl, wl->mbox_ptr[1], &events_vector,
176				sizeof(events_vector));
177		event |= events_vector & mask;
178	} while (!event);
179
180	return 0;
181}
182
183int wl1251_event_unmask(struct wl1251 *wl)
184{
185	int ret;
186
187	ret = wl1251_acx_event_mbox_mask(wl, ~(wl->event_mask));
188	if (ret < 0)
189		return ret;
190
191	return 0;
192}
193
194void wl1251_event_mbox_config(struct wl1251 *wl)
195{
196	wl->mbox_ptr[0] = wl1251_reg_read32(wl, REG_EVENT_MAILBOX_PTR);
197	wl->mbox_ptr[1] = wl->mbox_ptr[0] + sizeof(struct event_mailbox);
198
199	wl1251_debug(DEBUG_EVENT, "MBOX ptrs: 0x%x 0x%x",
200		     wl->mbox_ptr[0], wl->mbox_ptr[1]);
201}
202
203int wl1251_event_handle(struct wl1251 *wl, u8 mbox_num)
204{
205	struct event_mailbox mbox;
206	int ret;
207
208	wl1251_debug(DEBUG_EVENT, "EVENT on mbox %d", mbox_num);
209
210	if (mbox_num > 1)
211		return -EINVAL;
212
213	/* first we read the mbox descriptor */
214	wl1251_mem_read(wl, wl->mbox_ptr[mbox_num], &mbox,
215			    sizeof(struct event_mailbox));
216
217	/* process the descriptor */
218	ret = wl1251_event_process(wl, &mbox);
219	if (ret < 0)
220		return ret;
221
222	/* then we let the firmware know it can go on...*/
223	wl1251_reg_write32(wl, ACX_REG_INTERRUPT_TRIG, INTR_TRIG_EVENT_ACK);
224
225	return 0;
226}