Pileus Git - ~andy/linux/blob - drivers/net/wireless/wl12xx/event.c

   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
  24 #include "wl12xx.h"
  25 #include "debug.h"
  26 #include "reg.h"
  27 #include "io.h"
  28 #include "event.h"
  29 #include "ps.h"
  30 #include "scan.h"
  31 #include "wl12xx_80211.h"
  32
  33 static void wl1271_event_rssi_trigger(struct wl1271 *wl,
  34                                       struct wl12xx_vif *wlvif,
  35                                       struct event_mailbox *mbox)
  36 {
  37         struct ieee80211_vif *vif = wl12xx_wlvif_to_vif(wlvif);
  38         enum nl80211_cqm_rssi_threshold_event event;
  39         s8 metric = mbox->rssi_snr_trigger_metric[0];
  40
  41         wl1271_debug(DEBUG_EVENT, "RSSI trigger metric: %d", metric);
  42
  43         if (metric <= wlvif->rssi_thold)
  44                 event = NL80211_CQM_RSSI_THRESHOLD_EVENT_LOW;
  45         else
  46                 event = NL80211_CQM_RSSI_THRESHOLD_EVENT_HIGH;
  47
  48         if (event != wlvif->last_rssi_event)
  49                 ieee80211_cqm_rssi_notify(vif, event, GFP_KERNEL);
  50         wlvif->last_rssi_event = event;
  51 }
  52
  53 static void wl1271_stop_ba_event(struct wl1271 *wl, struct wl12xx_vif *wlvif)
  54 {
  55         struct ieee80211_vif *vif = wl12xx_wlvif_to_vif(wlvif);
  56
  57         if (wlvif->bss_type != BSS_TYPE_AP_BSS) {
  58                 if (!wlvif->sta.ba_rx_bitmap)
  59                         return;
  60                 ieee80211_stop_rx_ba_session(vif, wlvif->sta.ba_rx_bitmap,
  61                                              vif->bss_conf.bssid);
  62         } else {
  63                 u8 hlid;
  64                 struct wl1271_link *lnk;
  65                 for_each_set_bit(hlid, wlvif->ap.sta_hlid_map,
  66                                  WL12XX_MAX_LINKS) {
  67                         lnk = &wl->links[hlid];
  68                         if (!lnk->ba_bitmap)
  69                                 continue;
  70
  71                         ieee80211_stop_rx_ba_session(vif,
  72                                                      lnk->ba_bitmap,
  73                                                      lnk->addr);
  74                 }
  75         }
  76 }
  77
  78 static void wl12xx_event_soft_gemini_sense(struct wl1271 *wl,
  79                                                u8 enable)
  80 {
  81         struct wl12xx_vif *wlvif;
  82
  83         if (enable) {
  84                 set_bit(WL1271_FLAG_SOFT_GEMINI, &wl->flags);
  85         } else {
  86                 clear_bit(WL1271_FLAG_SOFT_GEMINI, &wl->flags);
  87                 wl12xx_for_each_wlvif_sta(wl, wlvif) {
  88                         wl1271_recalc_rx_streaming(wl, wlvif);
  89                 }
  90         }
  91
  92 }
  93
  94 static void wl1271_event_mbox_dump(struct event_mailbox *mbox)
  95 {
  96         wl1271_debug(DEBUG_EVENT, "MBOX DUMP:");
  97         wl1271_debug(DEBUG_EVENT, "\tvector: 0x%x", mbox->events_vector);
  98         wl1271_debug(DEBUG_EVENT, "\tmask: 0x%x", mbox->events_mask);
  99 }
 100
 101 static int wl1271_event_process(struct wl1271 *wl, struct event_mailbox *mbox)
 102 {
 103         struct ieee80211_vif *vif;
 104         struct wl12xx_vif *wlvif;
 105         u32 vector;
 106         bool beacon_loss = false;
 107         bool disconnect_sta = false;
 108         unsigned long sta_bitmap = 0;
 109
 110         wl1271_event_mbox_dump(mbox);
 111
 112         vector = le32_to_cpu(mbox->events_vector);
 113         vector &= ~(le32_to_cpu(mbox->events_mask));
 114         wl1271_debug(DEBUG_EVENT, "vector: 0x%x", vector);
 115
 116         if (vector & SCAN_COMPLETE_EVENT_ID) {
 117                 wl1271_debug(DEBUG_EVENT, "status: 0x%x",
 118                              mbox->scheduled_scan_status);
 119
 120                 wl1271_scan_stm(wl, wl->scan_vif);
 121         }
 122
 123         if (vector & PERIODIC_SCAN_REPORT_EVENT_ID) {
 124                 wl1271_debug(DEBUG_EVENT, "PERIODIC_SCAN_REPORT_EVENT "
 125                              "(status 0x%0x)", mbox->scheduled_scan_status);
 126
 127                 wl1271_scan_sched_scan_results(wl);
 128         }
 129
 130         if (vector & PERIODIC_SCAN_COMPLETE_EVENT_ID) {
 131                 wl1271_debug(DEBUG_EVENT, "PERIODIC_SCAN_COMPLETE_EVENT "
 132                              "(status 0x%0x)", mbox->scheduled_scan_status);
 133                 if (wl->sched_scanning) {
 134                         ieee80211_sched_scan_stopped(wl->hw);
 135                         wl->sched_scanning = false;
 136                 }
 137         }
 138
 139         if (vector & SOFT_GEMINI_SENSE_EVENT_ID)
 140                 wl12xx_event_soft_gemini_sense(wl,
 141                                                mbox->soft_gemini_sense_info);
 142
 143         /*
 144          * The BSS_LOSE_EVENT_ID is only needed while psm (and hence beacon
 145          * filtering) is enabled. Without PSM, the stack will receive all
 146          * beacons and can detect beacon loss by itself.
 147          *
 148          * As there's possibility that the driver disables PSM before receiving
 149          * BSS_LOSE_EVENT, beacon loss has to be reported to the stack.
 150          *
 151          */
 152         if (vector & BSS_LOSE_EVENT_ID) {
 153                 /* TODO: check for multi-role */
 154                 wl1271_info("Beacon loss detected.");
 155
 156                 /* indicate to the stack, that beacons have been lost */
 157                 beacon_loss = true;
 158         }
 159
 160         if (vector & RSSI_SNR_TRIGGER_0_EVENT_ID) {
 161                 /* TODO: check actual multi-role support */
 162                 wl1271_debug(DEBUG_EVENT, "RSSI_SNR_TRIGGER_0_EVENT");
 163                 wl12xx_for_each_wlvif_sta(wl, wlvif) {
 164                         wl1271_event_rssi_trigger(wl, wlvif, mbox);
 165                 }
 166         }
 167
 168         if (vector & BA_SESSION_RX_CONSTRAINT_EVENT_ID) {
 169                 u8 role_id = mbox->role_id;
 170                 wl1271_debug(DEBUG_EVENT, "BA_SESSION_RX_CONSTRAINT_EVENT_ID. "
 171                              "ba_allowed = 0x%x, role_id=%d",
 172                              mbox->rx_ba_allowed, role_id);
 173
 174                 wl12xx_for_each_wlvif(wl, wlvif) {
 175                         if (role_id != 0xff && role_id != wlvif->role_id)
 176                                 continue;
 177
 178                         wlvif->ba_allowed = !!mbox->rx_ba_allowed;
 179                         if (!wlvif->ba_allowed)
 180                                 wl1271_stop_ba_event(wl, wlvif);
 181                 }
 182         }
 183
 184         if (vector & CHANNEL_SWITCH_COMPLETE_EVENT_ID) {
 185                 wl1271_debug(DEBUG_EVENT, "CHANNEL_SWITCH_COMPLETE_EVENT_ID. "
 186                                           "status = 0x%x",
 187                                           mbox->channel_switch_status);
 188                 /*
 189                  * That event uses for two cases:
 190                  * 1) channel switch complete with status=0
 191                  * 2) channel switch failed status=1
 192                  */
 193
 194                 /* TODO: configure only the relevant vif */
 195                 wl12xx_for_each_wlvif_sta(wl, wlvif) {
 196                         bool success;
 197
 198                         if (!test_and_clear_bit(WLVIF_FLAG_CS_PROGRESS,
 199                                                 &wl->flags))
 200                                 continue;
 201
 202                         success = mbox->channel_switch_status ? false : true;
 203                         vif = wl12xx_wlvif_to_vif(wlvif);
 204
 205                         ieee80211_chswitch_done(vif, success);
 206                 }
 207         }
 208
 209         if ((vector & DUMMY_PACKET_EVENT_ID)) {
 210                 wl1271_debug(DEBUG_EVENT, "DUMMY_PACKET_ID_EVENT_ID");
 211                 wl1271_tx_dummy_packet(wl);
 212         }
 213
 214         /*
 215          * "TX retries exceeded" has a different meaning according to mode.
 216          * In AP mode the offending station is disconnected.
 217          */
 218         if (vector & MAX_TX_RETRY_EVENT_ID) {
 219                 wl1271_debug(DEBUG_EVENT, "MAX_TX_RETRY_EVENT_ID");
 220                 sta_bitmap |= le16_to_cpu(mbox->sta_tx_retry_exceeded);
 221                 disconnect_sta = true;
 222         }
 223
 224         if (vector & INACTIVE_STA_EVENT_ID) {
 225                 wl1271_debug(DEBUG_EVENT, "INACTIVE_STA_EVENT_ID");
 226                 sta_bitmap |= le16_to_cpu(mbox->sta_aging_status);
 227                 disconnect_sta = true;
 228         }
 229
 230         if (disconnect_sta) {
 231                 u32 num_packets = wl->conf.tx.max_tx_retries;
 232                 struct ieee80211_sta *sta;
 233                 const u8 *addr;
 234                 int h;
 235
 236                 for_each_set_bit(h, &sta_bitmap, WL12XX_MAX_LINKS) {
 237                         bool found = false;
 238                         /* find the ap vif connected to this sta */
 239                         wl12xx_for_each_wlvif_ap(wl, wlvif) {
 240                                 if (!test_bit(h, wlvif->ap.sta_hlid_map))
 241                                         continue;
 242                                 found = true;
 243                                 break;
 244                         }
 245                         if (!found)
 246                                 continue;
 247
 248                         vif = wl12xx_wlvif_to_vif(wlvif);
 249                         addr = wl->links[h].addr;
 250
 251                         rcu_read_lock();
 252                         sta = ieee80211_find_sta(vif, addr);
 253                         if (sta) {
 254                                 wl1271_debug(DEBUG_EVENT, "remove sta %d", h);
 255                                 ieee80211_report_low_ack(sta, num_packets);
 256                         }
 257                         rcu_read_unlock();
 258                 }
 259         }
 260
 261         if (beacon_loss)
 262                 wl12xx_for_each_wlvif_sta(wl, wlvif) {
 263                         vif = wl12xx_wlvif_to_vif(wlvif);
 264                         ieee80211_connection_loss(vif);
 265                 }
 266
 267         return 0;
 268 }
 269
 270 int wl1271_event_unmask(struct wl1271 *wl)
 271 {
 272         int ret;
 273
 274         ret = wl1271_acx_event_mbox_mask(wl, ~(wl->event_mask));
 275         if (ret < 0)
 276                 return ret;
 277
 278         return 0;
 279 }
 280
 281 void wl1271_event_mbox_config(struct wl1271 *wl)
 282 {
 283         wl->mbox_ptr[0] = wl1271_read32(wl, REG_EVENT_MAILBOX_PTR);
 284         wl->mbox_ptr[1] = wl->mbox_ptr[0] + sizeof(struct event_mailbox);
 285
 286         wl1271_debug(DEBUG_EVENT, "MBOX ptrs: 0x%x 0x%x",
 287                      wl->mbox_ptr[0], wl->mbox_ptr[1]);
 288 }
 289
 290 int wl1271_event_handle(struct wl1271 *wl, u8 mbox_num)
 291 {
 292         struct event_mailbox mbox;
 293         int ret;
 294
 295         wl1271_debug(DEBUG_EVENT, "EVENT on mbox %d", mbox_num);
 296
 297         if (mbox_num > 1)
 298                 return -EINVAL;
 299
 300         /* first we read the mbox descriptor */
 301         wl1271_read(wl, wl->mbox_ptr[mbox_num], &mbox,
 302                     sizeof(struct event_mailbox), false);
 303
 304         /* process the descriptor */
 305         ret = wl1271_event_process(wl, &mbox);
 306         if (ret < 0)
 307                 return ret;
 308
 309         /* then we let the firmware know it can go on...*/
 310         wl1271_write32(wl, ACX_REG_INTERRUPT_TRIG, INTR_TRIG_EVENT_ACK);
 311
 312         return 0;
 313 }