Luciano Coelho | f5fc0f8 | 2009-08-06 16:25:28 +0300 | [diff] [blame] | 1 | /* |
| 2 | * This file is part of wl1271 |
| 3 | * |
| 4 | * Copyright (C) 2008-2009 Nokia Corporation |
| 5 | * |
| 6 | * Contact: Luciano Coelho <luciano.coelho@nokia.com> |
| 7 | * |
| 8 | * This program is free software; you can redistribute it and/or |
| 9 | * modify it under the terms of the GNU General Public License |
| 10 | * version 2 as published by the Free Software Foundation. |
| 11 | * |
| 12 | * This program is distributed in the hope that it will be useful, but |
| 13 | * WITHOUT ANY WARRANTY; without even the implied warranty of |
| 14 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU |
| 15 | * General Public License for more details. |
| 16 | * |
| 17 | * You should have received a copy of the GNU General Public License |
| 18 | * along with this program; if not, write to the Free Software |
| 19 | * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA |
| 20 | * 02110-1301 USA |
| 21 | * |
| 22 | */ |
| 23 | |
Luciano Coelho | c31be25 | 2011-11-21 19:25:24 +0200 | [diff] [blame] | 24 | #include "wlcore.h" |
Luciano Coelho | 0f4e312 | 2011-10-07 11:02:42 +0300 | [diff] [blame] | 25 | #include "debug.h" |
Shahar Levi | 00d2010 | 2010-11-08 11:20:10 +0000 | [diff] [blame] | 26 | #include "io.h" |
| 27 | #include "event.h" |
| 28 | #include "ps.h" |
| 29 | #include "scan.h" |
Juuso Oikarinen | 66497dc | 2009-10-08 21:56:30 +0300 | [diff] [blame] | 30 | #include "wl12xx_80211.h" |
Luciano Coelho | f5fc0f8 | 2009-08-06 16:25:28 +0300 | [diff] [blame] | 31 | |
Juuso Oikarinen | 00236aed | 2010-04-09 11:07:30 +0300 | [diff] [blame] | 32 | static void wl1271_event_rssi_trigger(struct wl1271 *wl, |
Eliad Peller | 4b730b6 | 2011-10-10 10:12:57 +0200 | [diff] [blame] | 33 | struct wl12xx_vif *wlvif, |
Juuso Oikarinen | 00236aed | 2010-04-09 11:07:30 +0300 | [diff] [blame] | 34 | struct event_mailbox *mbox) |
| 35 | { |
Eliad Peller | 4b730b6 | 2011-10-10 10:12:57 +0200 | [diff] [blame] | 36 | struct ieee80211_vif *vif = wl12xx_wlvif_to_vif(wlvif); |
Juuso Oikarinen | 00236aed | 2010-04-09 11:07:30 +0300 | [diff] [blame] | 37 | enum nl80211_cqm_rssi_threshold_event event; |
| 38 | s8 metric = mbox->rssi_snr_trigger_metric[0]; |
| 39 | |
| 40 | wl1271_debug(DEBUG_EVENT, "RSSI trigger metric: %d", metric); |
| 41 | |
Eliad Peller | 04324d9 | 2011-10-05 11:56:03 +0200 | [diff] [blame] | 42 | if (metric <= wlvif->rssi_thold) |
Juuso Oikarinen | 00236aed | 2010-04-09 11:07:30 +0300 | [diff] [blame] | 43 | event = NL80211_CQM_RSSI_THRESHOLD_EVENT_LOW; |
| 44 | else |
| 45 | event = NL80211_CQM_RSSI_THRESHOLD_EVENT_HIGH; |
| 46 | |
Eliad Peller | 04324d9 | 2011-10-05 11:56:03 +0200 | [diff] [blame] | 47 | if (event != wlvif->last_rssi_event) |
| 48 | ieee80211_cqm_rssi_notify(vif, event, GFP_KERNEL); |
| 49 | wlvif->last_rssi_event = event; |
Juuso Oikarinen | 00236aed | 2010-04-09 11:07:30 +0300 | [diff] [blame] | 50 | } |
| 51 | |
Eliad Peller | 536129c | 2011-10-05 11:55:45 +0200 | [diff] [blame] | 52 | static void wl1271_stop_ba_event(struct wl1271 *wl, struct wl12xx_vif *wlvif) |
Shahar Levi | 70559a0 | 2011-05-22 16:10:22 +0300 | [diff] [blame] | 53 | { |
Eliad Peller | 4b730b6 | 2011-10-10 10:12:57 +0200 | [diff] [blame] | 54 | struct ieee80211_vif *vif = wl12xx_wlvif_to_vif(wlvif); |
| 55 | |
Eliad Peller | 536129c | 2011-10-05 11:55:45 +0200 | [diff] [blame] | 56 | if (wlvif->bss_type != BSS_TYPE_AP_BSS) { |
Eliad Peller | d0802ab | 2011-10-05 11:56:04 +0200 | [diff] [blame] | 57 | if (!wlvif->sta.ba_rx_bitmap) |
Arik Nemtsov | f4d3b6a | 2011-08-25 12:43:16 +0300 | [diff] [blame] | 58 | return; |
Eliad Peller | 4b730b6 | 2011-10-10 10:12:57 +0200 | [diff] [blame] | 59 | ieee80211_stop_rx_ba_session(vif, wlvif->sta.ba_rx_bitmap, |
| 60 | vif->bss_conf.bssid); |
Arik Nemtsov | f4d3b6a | 2011-08-25 12:43:16 +0300 | [diff] [blame] | 61 | } else { |
Eliad Peller | c7ffb90 | 2011-10-05 11:56:05 +0200 | [diff] [blame] | 62 | u8 hlid; |
Arik Nemtsov | f4d3b6a | 2011-08-25 12:43:16 +0300 | [diff] [blame] | 63 | struct wl1271_link *lnk; |
Eliad Peller | c7ffb90 | 2011-10-05 11:56:05 +0200 | [diff] [blame] | 64 | for_each_set_bit(hlid, wlvif->ap.sta_hlid_map, |
| 65 | WL12XX_MAX_LINKS) { |
| 66 | lnk = &wl->links[hlid]; |
| 67 | if (!lnk->ba_bitmap) |
Arik Nemtsov | f4d3b6a | 2011-08-25 12:43:16 +0300 | [diff] [blame] | 68 | continue; |
Shahar Levi | 70559a0 | 2011-05-22 16:10:22 +0300 | [diff] [blame] | 69 | |
Eliad Peller | 4b730b6 | 2011-10-10 10:12:57 +0200 | [diff] [blame] | 70 | ieee80211_stop_rx_ba_session(vif, |
Arik Nemtsov | f4d3b6a | 2011-08-25 12:43:16 +0300 | [diff] [blame] | 71 | lnk->ba_bitmap, |
| 72 | lnk->addr); |
| 73 | } |
| 74 | } |
Shahar Levi | 70559a0 | 2011-05-22 16:10:22 +0300 | [diff] [blame] | 75 | } |
| 76 | |
Eliad Peller | 77ddaa1 | 2011-05-15 11:10:29 +0300 | [diff] [blame] | 77 | static void wl12xx_event_soft_gemini_sense(struct wl1271 *wl, |
| 78 | u8 enable) |
| 79 | { |
Eliad Peller | 4b730b6 | 2011-10-10 10:12:57 +0200 | [diff] [blame] | 80 | struct wl12xx_vif *wlvif; |
| 81 | |
Eliad Peller | 77ddaa1 | 2011-05-15 11:10:29 +0300 | [diff] [blame] | 82 | if (enable) { |
Eliad Peller | 77ddaa1 | 2011-05-15 11:10:29 +0300 | [diff] [blame] | 83 | set_bit(WL1271_FLAG_SOFT_GEMINI, &wl->flags); |
| 84 | } else { |
Eliad Peller | 9eb599e | 2011-10-10 10:12:59 +0200 | [diff] [blame] | 85 | clear_bit(WL1271_FLAG_SOFT_GEMINI, &wl->flags); |
Eliad Peller | 4b730b6 | 2011-10-10 10:12:57 +0200 | [diff] [blame] | 86 | wl12xx_for_each_wlvif_sta(wl, wlvif) { |
Eliad Peller | 9eb599e | 2011-10-10 10:12:59 +0200 | [diff] [blame] | 87 | wl1271_recalc_rx_streaming(wl, wlvif); |
Eliad Peller | 4b730b6 | 2011-10-10 10:12:57 +0200 | [diff] [blame] | 88 | } |
Eliad Peller | 77ddaa1 | 2011-05-15 11:10:29 +0300 | [diff] [blame] | 89 | } |
| 90 | |
| 91 | } |
| 92 | |
Luciano Coelho | f5fc0f8 | 2009-08-06 16:25:28 +0300 | [diff] [blame] | 93 | static void wl1271_event_mbox_dump(struct event_mailbox *mbox) |
| 94 | { |
| 95 | wl1271_debug(DEBUG_EVENT, "MBOX DUMP:"); |
| 96 | wl1271_debug(DEBUG_EVENT, "\tvector: 0x%x", mbox->events_vector); |
| 97 | wl1271_debug(DEBUG_EVENT, "\tmask: 0x%x", mbox->events_mask); |
| 98 | } |
| 99 | |
Mircea Gherzan | 690142e | 2012-03-17 18:41:53 +0100 | [diff] [blame] | 100 | static int wl1271_event_process(struct wl1271 *wl) |
Luciano Coelho | f5fc0f8 | 2009-08-06 16:25:28 +0300 | [diff] [blame] | 101 | { |
Mircea Gherzan | 690142e | 2012-03-17 18:41:53 +0100 | [diff] [blame] | 102 | struct event_mailbox *mbox = wl->mbox; |
Eliad Peller | 4b730b6 | 2011-10-10 10:12:57 +0200 | [diff] [blame] | 103 | struct ieee80211_vif *vif; |
| 104 | struct wl12xx_vif *wlvif; |
Luciano Coelho | f5fc0f8 | 2009-08-06 16:25:28 +0300 | [diff] [blame] | 105 | u32 vector; |
Arik Nemtsov | 3618f30 | 2011-06-26 10:36:03 +0300 | [diff] [blame] | 106 | bool disconnect_sta = false; |
| 107 | unsigned long sta_bitmap = 0; |
Luciano Coelho | f5fc0f8 | 2009-08-06 16:25:28 +0300 | [diff] [blame] | 108 | |
| 109 | wl1271_event_mbox_dump(mbox); |
| 110 | |
Luciano Coelho | d0f63b2 | 2009-10-15 10:33:29 +0300 | [diff] [blame] | 111 | vector = le32_to_cpu(mbox->events_vector); |
| 112 | vector &= ~(le32_to_cpu(mbox->events_mask)); |
Luciano Coelho | f5fc0f8 | 2009-08-06 16:25:28 +0300 | [diff] [blame] | 113 | wl1271_debug(DEBUG_EVENT, "vector: 0x%x", vector); |
| 114 | |
| 115 | if (vector & SCAN_COMPLETE_EVENT_ID) { |
Luciano Coelho | 34dd2aa | 2010-07-08 17:50:06 +0300 | [diff] [blame] | 116 | wl1271_debug(DEBUG_EVENT, "status: 0x%x", |
| 117 | mbox->scheduled_scan_status); |
| 118 | |
Eliad Peller | 784f694 | 2011-10-05 11:55:39 +0200 | [diff] [blame] | 119 | wl1271_scan_stm(wl, wl->scan_vif); |
Luciano Coelho | f5fc0f8 | 2009-08-06 16:25:28 +0300 | [diff] [blame] | 120 | } |
| 121 | |
Luciano Coelho | 6394c01 | 2011-05-10 14:28:27 +0300 | [diff] [blame] | 122 | if (vector & PERIODIC_SCAN_REPORT_EVENT_ID) { |
| 123 | wl1271_debug(DEBUG_EVENT, "PERIODIC_SCAN_REPORT_EVENT " |
| 124 | "(status 0x%0x)", mbox->scheduled_scan_status); |
Luciano Coelho | 33c2c06 | 2011-05-10 14:46:02 +0300 | [diff] [blame] | 125 | |
| 126 | wl1271_scan_sched_scan_results(wl); |
Luciano Coelho | 6394c01 | 2011-05-10 14:28:27 +0300 | [diff] [blame] | 127 | } |
| 128 | |
| 129 | if (vector & PERIODIC_SCAN_COMPLETE_EVENT_ID) { |
| 130 | wl1271_debug(DEBUG_EVENT, "PERIODIC_SCAN_COMPLETE_EVENT " |
| 131 | "(status 0x%0x)", mbox->scheduled_scan_status); |
Luciano Coelho | 33c2c06 | 2011-05-10 14:46:02 +0300 | [diff] [blame] | 132 | if (wl->sched_scanning) { |
Luciano Coelho | 33c2c06 | 2011-05-10 14:46:02 +0300 | [diff] [blame] | 133 | ieee80211_sched_scan_stopped(wl->hw); |
Eyal Shapira | ee91d18 | 2011-12-20 14:55:38 +0200 | [diff] [blame] | 134 | wl->sched_scanning = false; |
Luciano Coelho | 33c2c06 | 2011-05-10 14:46:02 +0300 | [diff] [blame] | 135 | } |
Luciano Coelho | 6394c01 | 2011-05-10 14:28:27 +0300 | [diff] [blame] | 136 | } |
| 137 | |
Eliad Peller | 4b730b6 | 2011-10-10 10:12:57 +0200 | [diff] [blame] | 138 | if (vector & SOFT_GEMINI_SENSE_EVENT_ID) |
Eliad Peller | 77ddaa1 | 2011-05-15 11:10:29 +0300 | [diff] [blame] | 139 | wl12xx_event_soft_gemini_sense(wl, |
| 140 | mbox->soft_gemini_sense_info); |
Juuso Oikarinen | 8d2ef7b | 2010-07-08 17:50:03 +0300 | [diff] [blame] | 141 | |
Juuso Oikarinen | b771eee | 2009-10-08 21:56:34 +0300 | [diff] [blame] | 142 | /* |
Bartosz.Markowski@tieto.com | 5f561f6 | 2012-04-26 10:35:07 +0300 | [diff] [blame] | 143 | * We are HW_MONITOR device. On beacon loss - queue |
| 144 | * connection loss work. Cancel it on REGAINED event. |
Juuso Oikarinen | b771eee | 2009-10-08 21:56:34 +0300 | [diff] [blame] | 145 | */ |
Eliad Peller | 4b730b6 | 2011-10-10 10:12:57 +0200 | [diff] [blame] | 146 | if (vector & BSS_LOSE_EVENT_ID) { |
| 147 | /* TODO: check for multi-role */ |
Bartosz.Markowski@tieto.com | 5f561f6 | 2012-04-26 10:35:07 +0300 | [diff] [blame] | 148 | int delay = wl->conf.conn.synch_fail_thold * |
| 149 | wl->conf.conn.bss_lose_timeout; |
Juuso Oikarinen | 1a186a5 | 2010-04-01 11:38:23 +0300 | [diff] [blame] | 150 | wl1271_info("Beacon loss detected."); |
Arik Nemtsov | 6b8bf5b | 2012-05-15 17:08:54 +0300 | [diff] [blame] | 151 | |
| 152 | /* |
| 153 | * if the work is already queued, it should take place. We |
| 154 | * don't want to delay the connection loss indication |
| 155 | * any more. |
| 156 | */ |
Bartosz.Markowski@tieto.com | 5f561f6 | 2012-04-26 10:35:07 +0300 | [diff] [blame] | 157 | ieee80211_queue_delayed_work(wl->hw, &wl->connection_loss_work, |
Arik Nemtsov | 6b8bf5b | 2012-05-15 17:08:54 +0300 | [diff] [blame] | 158 | msecs_to_jiffies(delay)); |
Eliad Peller | 9f5b424 | 2012-05-15 14:53:17 +0300 | [diff] [blame^] | 159 | |
| 160 | wl12xx_for_each_wlvif_sta(wl, wlvif) { |
| 161 | vif = wl12xx_wlvif_to_vif(wlvif); |
| 162 | |
| 163 | ieee80211_cqm_rssi_notify( |
| 164 | vif, |
| 165 | NL80211_CQM_RSSI_BEACON_LOSS_EVENT, |
| 166 | GFP_KERNEL); |
| 167 | } |
Bartosz.Markowski@tieto.com | 5f561f6 | 2012-04-26 10:35:07 +0300 | [diff] [blame] | 168 | } |
Luciano Coelho | f5fc0f8 | 2009-08-06 16:25:28 +0300 | [diff] [blame] | 169 | |
Bartosz.Markowski@tieto.com | 5f561f6 | 2012-04-26 10:35:07 +0300 | [diff] [blame] | 170 | if (vector & REGAINED_BSS_EVENT_ID) { |
| 171 | /* TODO: check for multi-role */ |
| 172 | wl1271_info("Beacon regained."); |
Arik Nemtsov | 6b8bf5b | 2012-05-15 17:08:54 +0300 | [diff] [blame] | 173 | cancel_delayed_work(&wl->connection_loss_work); |
| 174 | |
| 175 | /* sanity check - we can't lose and gain the beacon together */ |
| 176 | WARN(vector & BSS_LOSE_EVENT_ID, |
| 177 | "Concurrent beacon loss and gain from FW"); |
Juuso Oikarinen | 19ad071 | 2009-11-02 20:22:11 +0200 | [diff] [blame] | 178 | } |
| 179 | |
Juuso Oikarinen | 00236aed | 2010-04-09 11:07:30 +0300 | [diff] [blame] | 180 | if (vector & RSSI_SNR_TRIGGER_0_EVENT_ID) { |
Eliad Peller | 4b730b6 | 2011-10-10 10:12:57 +0200 | [diff] [blame] | 181 | /* TODO: check actual multi-role support */ |
Juuso Oikarinen | 00236aed | 2010-04-09 11:07:30 +0300 | [diff] [blame] | 182 | wl1271_debug(DEBUG_EVENT, "RSSI_SNR_TRIGGER_0_EVENT"); |
Eliad Peller | 4b730b6 | 2011-10-10 10:12:57 +0200 | [diff] [blame] | 183 | wl12xx_for_each_wlvif_sta(wl, wlvif) { |
| 184 | wl1271_event_rssi_trigger(wl, wlvif, mbox); |
| 185 | } |
Juuso Oikarinen | 00236aed | 2010-04-09 11:07:30 +0300 | [diff] [blame] | 186 | } |
| 187 | |
Eliad Peller | 4b730b6 | 2011-10-10 10:12:57 +0200 | [diff] [blame] | 188 | if (vector & BA_SESSION_RX_CONSTRAINT_EVENT_ID) { |
| 189 | u8 role_id = mbox->role_id; |
Shahar Levi | 70559a0 | 2011-05-22 16:10:22 +0300 | [diff] [blame] | 190 | wl1271_debug(DEBUG_EVENT, "BA_SESSION_RX_CONSTRAINT_EVENT_ID. " |
Eliad Peller | 4b730b6 | 2011-10-10 10:12:57 +0200 | [diff] [blame] | 191 | "ba_allowed = 0x%x, role_id=%d", |
| 192 | mbox->rx_ba_allowed, role_id); |
Shahar Levi | 70559a0 | 2011-05-22 16:10:22 +0300 | [diff] [blame] | 193 | |
Eliad Peller | 4b730b6 | 2011-10-10 10:12:57 +0200 | [diff] [blame] | 194 | wl12xx_for_each_wlvif(wl, wlvif) { |
| 195 | if (role_id != 0xff && role_id != wlvif->role_id) |
| 196 | continue; |
Arik Nemtsov | f4d3b6a | 2011-08-25 12:43:16 +0300 | [diff] [blame] | 197 | |
Eliad Peller | 4b730b6 | 2011-10-10 10:12:57 +0200 | [diff] [blame] | 198 | wlvif->ba_allowed = !!mbox->rx_ba_allowed; |
| 199 | if (!wlvif->ba_allowed) |
| 200 | wl1271_stop_ba_event(wl, wlvif); |
| 201 | } |
Shahar Levi | 70559a0 | 2011-05-22 16:10:22 +0300 | [diff] [blame] | 202 | } |
| 203 | |
Eliad Peller | 4b730b6 | 2011-10-10 10:12:57 +0200 | [diff] [blame] | 204 | if (vector & CHANNEL_SWITCH_COMPLETE_EVENT_ID) { |
Shahar Levi | 6d158ff | 2011-09-08 13:01:33 +0300 | [diff] [blame] | 205 | wl1271_debug(DEBUG_EVENT, "CHANNEL_SWITCH_COMPLETE_EVENT_ID. " |
| 206 | "status = 0x%x", |
| 207 | mbox->channel_switch_status); |
| 208 | /* |
| 209 | * That event uses for two cases: |
| 210 | * 1) channel switch complete with status=0 |
| 211 | * 2) channel switch failed status=1 |
| 212 | */ |
Eliad Peller | 4b730b6 | 2011-10-10 10:12:57 +0200 | [diff] [blame] | 213 | |
Eliad Peller | 52630c5 | 2011-10-10 10:13:08 +0200 | [diff] [blame] | 214 | /* TODO: configure only the relevant vif */ |
| 215 | wl12xx_for_each_wlvif_sta(wl, wlvif) { |
Eliad Peller | 52630c5 | 2011-10-10 10:13:08 +0200 | [diff] [blame] | 216 | bool success; |
| 217 | |
| 218 | if (!test_and_clear_bit(WLVIF_FLAG_CS_PROGRESS, |
Victor Goldenshtein | ec414c7 | 2012-03-12 16:36:48 +0200 | [diff] [blame] | 219 | &wlvif->flags)) |
Eliad Peller | 52630c5 | 2011-10-10 10:13:08 +0200 | [diff] [blame] | 220 | continue; |
| 221 | |
| 222 | success = mbox->channel_switch_status ? false : true; |
Luciano Coelho | 775e1a4 | 2012-01-24 11:46:32 +0200 | [diff] [blame] | 223 | vif = wl12xx_wlvif_to_vif(wlvif); |
| 224 | |
Eliad Peller | 52630c5 | 2011-10-10 10:13:08 +0200 | [diff] [blame] | 225 | ieee80211_chswitch_done(vif, success); |
Eliad Peller | 4b730b6 | 2011-10-10 10:12:57 +0200 | [diff] [blame] | 226 | } |
Shahar Levi | 6d158ff | 2011-09-08 13:01:33 +0300 | [diff] [blame] | 227 | } |
| 228 | |
Arik Nemtsov | 79ebec7 | 2011-08-14 13:17:18 +0300 | [diff] [blame] | 229 | if ((vector & DUMMY_PACKET_EVENT_ID)) { |
Shahar Levi | ae47c45 | 2011-03-06 16:32:14 +0200 | [diff] [blame] | 230 | wl1271_debug(DEBUG_EVENT, "DUMMY_PACKET_ID_EVENT_ID"); |
Eliad Peller | 4b730b6 | 2011-10-10 10:12:57 +0200 | [diff] [blame] | 231 | wl1271_tx_dummy_packet(wl); |
Shahar Levi | ae47c45 | 2011-03-06 16:32:14 +0200 | [diff] [blame] | 232 | } |
| 233 | |
Arik Nemtsov | 3618f30 | 2011-06-26 10:36:03 +0300 | [diff] [blame] | 234 | /* |
| 235 | * "TX retries exceeded" has a different meaning according to mode. |
| 236 | * In AP mode the offending station is disconnected. |
| 237 | */ |
Eliad Peller | 4b730b6 | 2011-10-10 10:12:57 +0200 | [diff] [blame] | 238 | if (vector & MAX_TX_RETRY_EVENT_ID) { |
Arik Nemtsov | 3618f30 | 2011-06-26 10:36:03 +0300 | [diff] [blame] | 239 | wl1271_debug(DEBUG_EVENT, "MAX_TX_RETRY_EVENT_ID"); |
| 240 | sta_bitmap |= le16_to_cpu(mbox->sta_tx_retry_exceeded); |
| 241 | disconnect_sta = true; |
| 242 | } |
| 243 | |
Eliad Peller | 4b730b6 | 2011-10-10 10:12:57 +0200 | [diff] [blame] | 244 | if (vector & INACTIVE_STA_EVENT_ID) { |
Arik Nemtsov | 3618f30 | 2011-06-26 10:36:03 +0300 | [diff] [blame] | 245 | wl1271_debug(DEBUG_EVENT, "INACTIVE_STA_EVENT_ID"); |
| 246 | sta_bitmap |= le16_to_cpu(mbox->sta_aging_status); |
| 247 | disconnect_sta = true; |
| 248 | } |
| 249 | |
Eliad Peller | 4b730b6 | 2011-10-10 10:12:57 +0200 | [diff] [blame] | 250 | if (disconnect_sta) { |
Arik Nemtsov | 3618f30 | 2011-06-26 10:36:03 +0300 | [diff] [blame] | 251 | u32 num_packets = wl->conf.tx.max_tx_retries; |
| 252 | struct ieee80211_sta *sta; |
| 253 | const u8 *addr; |
| 254 | int h; |
| 255 | |
Eliad Peller | c7ffb90 | 2011-10-05 11:56:05 +0200 | [diff] [blame] | 256 | for_each_set_bit(h, &sta_bitmap, WL12XX_MAX_LINKS) { |
Eliad Peller | 4b730b6 | 2011-10-10 10:12:57 +0200 | [diff] [blame] | 257 | bool found = false; |
| 258 | /* find the ap vif connected to this sta */ |
| 259 | wl12xx_for_each_wlvif_ap(wl, wlvif) { |
| 260 | if (!test_bit(h, wlvif->ap.sta_hlid_map)) |
| 261 | continue; |
| 262 | found = true; |
| 263 | break; |
| 264 | } |
| 265 | if (!found) |
Arik Nemtsov | 3618f30 | 2011-06-26 10:36:03 +0300 | [diff] [blame] | 266 | continue; |
| 267 | |
Eliad Peller | 4b730b6 | 2011-10-10 10:12:57 +0200 | [diff] [blame] | 268 | vif = wl12xx_wlvif_to_vif(wlvif); |
Arik Nemtsov | 3618f30 | 2011-06-26 10:36:03 +0300 | [diff] [blame] | 269 | addr = wl->links[h].addr; |
| 270 | |
| 271 | rcu_read_lock(); |
Eliad Peller | 4b730b6 | 2011-10-10 10:12:57 +0200 | [diff] [blame] | 272 | sta = ieee80211_find_sta(vif, addr); |
Arik Nemtsov | 3618f30 | 2011-06-26 10:36:03 +0300 | [diff] [blame] | 273 | if (sta) { |
| 274 | wl1271_debug(DEBUG_EVENT, "remove sta %d", h); |
| 275 | ieee80211_report_low_ack(sta, num_packets); |
| 276 | } |
| 277 | rcu_read_unlock(); |
| 278 | } |
| 279 | } |
Luciano Coelho | f5fc0f8 | 2009-08-06 16:25:28 +0300 | [diff] [blame] | 280 | return 0; |
| 281 | } |
| 282 | |
| 283 | int wl1271_event_unmask(struct wl1271 *wl) |
| 284 | { |
| 285 | int ret; |
| 286 | |
| 287 | ret = wl1271_acx_event_mbox_mask(wl, ~(wl->event_mask)); |
| 288 | if (ret < 0) |
| 289 | return ret; |
| 290 | |
| 291 | return 0; |
| 292 | } |
| 293 | |
Juuso Oikarinen | 13f2dc5 | 2009-12-11 15:40:59 +0200 | [diff] [blame] | 294 | int wl1271_event_handle(struct wl1271 *wl, u8 mbox_num) |
Luciano Coelho | f5fc0f8 | 2009-08-06 16:25:28 +0300 | [diff] [blame] | 295 | { |
Luciano Coelho | f5fc0f8 | 2009-08-06 16:25:28 +0300 | [diff] [blame] | 296 | int ret; |
| 297 | |
| 298 | wl1271_debug(DEBUG_EVENT, "EVENT on mbox %d", mbox_num); |
| 299 | |
| 300 | if (mbox_num > 1) |
| 301 | return -EINVAL; |
| 302 | |
| 303 | /* first we read the mbox descriptor */ |
Mircea Gherzan | 690142e | 2012-03-17 18:41:53 +0100 | [diff] [blame] | 304 | wl1271_read(wl, wl->mbox_ptr[mbox_num], wl->mbox, |
| 305 | sizeof(*wl->mbox), false); |
Luciano Coelho | f5fc0f8 | 2009-08-06 16:25:28 +0300 | [diff] [blame] | 306 | |
| 307 | /* process the descriptor */ |
Mircea Gherzan | 690142e | 2012-03-17 18:41:53 +0100 | [diff] [blame] | 308 | ret = wl1271_event_process(wl); |
Luciano Coelho | f5fc0f8 | 2009-08-06 16:25:28 +0300 | [diff] [blame] | 309 | if (ret < 0) |
| 310 | return ret; |
| 311 | |
Luciano Coelho | f16ff75 | 2012-04-11 10:15:46 +0300 | [diff] [blame] | 312 | /* |
| 313 | * TODO: we just need this because one bit is in a different |
| 314 | * place. Is there any better way? |
| 315 | */ |
| 316 | wl->ops->ack_event(wl); |
Luciano Coelho | f5fc0f8 | 2009-08-06 16:25:28 +0300 | [diff] [blame] | 317 | |
| 318 | return 0; |
| 319 | } |