rsi: handle station disconnection in AP mode

When sta_remove of mac80211 is called, driver iterates through
list of existing stations to get the station id. Then peer notify
is prepared and send to firmare.

Signed-off-by: Prameela Rani Garnepudi <prameela.j04cs@gmail.com>
Signed-off-by: Amitkumar Karwar <amit.karwar@redpinesignals.com>
Signed-off-by: Kalle Valo <kvalo@codeaurora.org>

diff --git a/drivers/net/wireless/rsi/rsi_91x_mac80211.c b/drivers/net/wireless/rsi/rsi_91x_mac80211.c
index b1c08491c754ae1696fc95a564ac427f09c17559..be10d508d740b7b2929bd6b6a2a9a22e0f03aa12 100644 (file)
--- a/drivers/net/wireless/rsi/rsi_91x_mac80211.c
+++ b/drivers/net/wireless/rsi/rsi_91x_mac80211.c
@@ -1254,21 +1254,55 @@ static int rsi_mac80211_sta_remove(struct ieee80211_hw *hw,
 {
        struct rsi_hw *adapter = hw->priv;
        struct rsi_common *common = adapter->priv;
+       struct ieee80211_bss_conf *bss = &vif->bss_conf;
+       struct rsi_sta *rsta;
+
+       rsi_dbg(INFO_ZONE, "Station Remove: %pM\n", sta->addr);
 
        mutex_lock(&common->mutex);
 
-       /* Resetting all the fields to default values */
-       common->bitrate_mask[NL80211_BAND_2GHZ] = 0;
-       common->bitrate_mask[NL80211_BAND_5GHZ] = 0;
-       common->min_rate = 0xffff;
-       common->vif_info[0].is_ht = false;
-       common->vif_info[0].sgi = false;
-       common->vif_info[0].seq_start = 0;
-       common->secinfo.ptk_cipher = 0;
-       common->secinfo.gtk_cipher = 0;
+       if (vif->type == NL80211_IFTYPE_AP) {
+               u8 sta_idx, cnt;
 
-       rsi_send_rx_filter_frame(common, 0);
-       
+               /* Send peer notify to device */
+               rsi_dbg(INFO_ZONE, "Indicate bss status to device\n");
+               for (sta_idx = 0; sta_idx < common->max_stations; sta_idx++) {
+                       rsta = &common->stations[sta_idx];
+
+                       if (!rsta->sta)
+                               continue;
+                       if (!memcmp(rsta->sta->addr, sta->addr, ETH_ALEN)) {
+                               rsi_inform_bss_status(common, AP_OPMODE, 0,
+                                                     sta->addr, sta->wme,
+                                                     sta->aid, sta, sta_idx);
+                               rsta->sta = NULL;
+                               rsta->sta_id = -1;
+                               for (cnt = 0; cnt < IEEE80211_NUM_TIDS; cnt++)
+                                       rsta->start_tx_aggr[cnt] = false;
+                               if (common->num_stations > 0)
+                                       common->num_stations--;
+                               break;
+                       }
+               }
+               if (sta_idx >= common->max_stations)
+                       rsi_dbg(ERR_ZONE, "%s: No station found\n", __func__);
+       }
+
+       if (vif->type == NL80211_IFTYPE_STATION) {
+               /* Resetting all the fields to default values */
+               memcpy((u8 *)bss->bssid, (u8 *)sta->addr, ETH_ALEN);
+               bss->qos = sta->wme;
+               common->bitrate_mask[NL80211_BAND_2GHZ] = 0;
+               common->bitrate_mask[NL80211_BAND_5GHZ] = 0;
+               common->min_rate = 0xffff;
+               common->vif_info[0].is_ht = false;
+               common->vif_info[0].sgi = false;
+               common->vif_info[0].seq_start = 0;
+               common->secinfo.ptk_cipher = 0;
+               common->secinfo.gtk_cipher = 0;
+               if (!common->iface_down)
+                       rsi_send_rx_filter_frame(common, 0);
+       }
        mutex_unlock(&common->mutex);
        
        return 0;