drivers/net/wireless/rockchip_wlan/rtl8723bu/core/rtw_sta_mgt.c

   1 /******************************************************************************
   2  *
   3  * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved.
   4  *
   5  * This program is free software; you can redistribute it and/or modify it
   6  * under the terms of version 2 of the GNU General Public License as
   7  * published by the Free Software Foundation.
   8  *
   9  * This program is distributed in the hope that it will be useful, but WITHOUT
  10  * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  11  * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
  12  * more details.
  13  *
  14  * You should have received a copy of the GNU General Public License along with
  15  * this program; if not, write to the Free Software Foundation, Inc.,
  16  * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA
  17  *
  18  *
  19  ******************************************************************************/
  20 #define _RTW_STA_MGT_C_
  21
  22 #include <drv_types.h>
  23
  24 #if defined (PLATFORM_LINUX) && defined (PLATFORM_WINDOWS)
  25
  26 #error "Shall be Linux or Windows, but not both!\n"
  27
  28 #endif
  29
  30
  31 void _rtw_init_stainfo(struct sta_info *psta);
  32 void _rtw_init_stainfo(struct sta_info *psta)
  33 {
  34
  35 _func_enter_;
  36
  37         _rtw_memset((u8 *)psta, 0, sizeof (struct sta_info));
  38
  39          _rtw_spinlock_init(&psta->lock);
  40         _rtw_init_listhead(&psta->list);
  41         _rtw_init_listhead(&psta->hash_list);
  42         //_rtw_init_listhead(&psta->asoc_list);
  43         //_rtw_init_listhead(&psta->sleep_list);
  44         //_rtw_init_listhead(&psta->wakeup_list);
  45
  46         _rtw_init_queue(&psta->sleep_q);
  47         psta->sleepq_len = 0;
  48
  49         _rtw_init_sta_xmit_priv(&psta->sta_xmitpriv);
  50         _rtw_init_sta_recv_priv(&psta->sta_recvpriv);
  51
  52 #ifdef CONFIG_AP_MODE
  53
  54         _rtw_init_listhead(&psta->asoc_list);
  55
  56         _rtw_init_listhead(&psta->auth_list);
  57
  58         psta->expire_to = 0;
  59
  60         psta->flags = 0;
  61
  62         psta->capability = 0;
  63
  64         psta->bpairwise_key_installed = _FALSE;
  65
  66
  67 #ifdef CONFIG_NATIVEAP_MLME
  68         psta->nonerp_set = 0;
  69         psta->no_short_slot_time_set = 0;
  70         psta->no_short_preamble_set = 0;
  71         psta->no_ht_gf_set = 0;
  72         psta->no_ht_set = 0;
  73         psta->ht_20mhz_set = 0;
  74 #endif
  75
  76 #ifdef CONFIG_TX_MCAST2UNI
  77         psta->under_exist_checking = 0;
  78 #endif  // CONFIG_TX_MCAST2UNI
  79
  80         psta->keep_alive_trycnt = 0;
  81
  82 #endif  // CONFIG_AP_MODE
  83
  84 _func_exit_;
  85
  86 }
  87
  88 u32     _rtw_init_sta_priv(struct       sta_priv *pstapriv)
  89 {
  90         struct sta_info *psta;
  91         s32 i;
  92
  93 _func_enter_;
  94
  95         pstapriv->pallocated_stainfo_buf = rtw_zvmalloc (sizeof(struct sta_info) * NUM_STA+ 4);
  96
  97         if(!pstapriv->pallocated_stainfo_buf)
  98                 return _FAIL;
  99
 100         pstapriv->pstainfo_buf = pstapriv->pallocated_stainfo_buf + 4 -
 101                 ((SIZE_PTR)(pstapriv->pallocated_stainfo_buf ) & 3);
 102
 103         _rtw_init_queue(&pstapriv->free_sta_queue);
 104
 105         _rtw_spinlock_init(&pstapriv->sta_hash_lock);
 106
 107         //_rtw_init_queue(&pstapriv->asoc_q);
 108         pstapriv->asoc_sta_count = 0;
 109         _rtw_init_queue(&pstapriv->sleep_q);
 110         _rtw_init_queue(&pstapriv->wakeup_q);
 111
 112         psta = (struct sta_info *)(pstapriv->pstainfo_buf);
 113
 114
 115         for(i = 0; i < NUM_STA; i++)
 116         {
 117                 _rtw_init_stainfo(psta);
 118
 119                 _rtw_init_listhead(&(pstapriv->sta_hash[i]));
 120
 121                 rtw_list_insert_tail(&psta->list, get_list_head(&pstapriv->free_sta_queue));
 122
 123                 psta++;
 124         }
 125
 126
 127
 128 #ifdef CONFIG_AP_MODE
 129
 130         pstapriv->sta_dz_bitmap = 0;
 131         pstapriv->tim_bitmap = 0;
 132
 133         _rtw_init_listhead(&pstapriv->asoc_list);
 134         _rtw_init_listhead(&pstapriv->auth_list);
 135         _rtw_spinlock_init(&pstapriv->asoc_list_lock);
 136         _rtw_spinlock_init(&pstapriv->auth_list_lock);
 137         pstapriv->asoc_list_cnt = 0;
 138         pstapriv->auth_list_cnt = 0;
 139
 140         pstapriv->auth_to = 3; // 3*2 = 6 sec
 141         pstapriv->assoc_to = 3;
 142         //pstapriv->expire_to = 900;// 900*2 = 1800 sec = 30 min, expire after no any traffic.
 143         //pstapriv->expire_to = 30;// 30*2 = 60 sec = 1 min, expire after no any traffic.
 144 #ifdef CONFIG_ACTIVE_KEEP_ALIVE_CHECK
 145         pstapriv->expire_to = 3; // 3*2 = 6 sec
 146 #else
 147         pstapriv->expire_to = 60;// 60*2 = 120 sec = 2 min, expire after no any traffic.
 148 #endif
 149 #ifdef CONFIG_ATMEL_RC_PATCH
 150         _rtw_memset(  pstapriv->atmel_rc_pattern, 0, ETH_ALEN);
 151 #endif
 152         pstapriv->max_num_sta = NUM_STA;
 153
 154 #endif
 155
 156 _func_exit_;
 157
 158         return _SUCCESS;
 159
 160 }
 161
 162 inline int rtw_stainfo_offset(struct sta_priv *stapriv, struct sta_info *sta)
 163 {
 164         int offset = (((u8 *)sta) - stapriv->pstainfo_buf)/sizeof(struct sta_info);
 165
 166         if (!stainfo_offset_valid(offset))
 167                 DBG_871X("%s invalid offset(%d), out of range!!!", __func__, offset);
 168
 169         return offset;
 170 }
 171
 172 inline struct sta_info *rtw_get_stainfo_by_offset(struct sta_priv *stapriv, int offset)
 173 {
 174         if (!stainfo_offset_valid(offset))
 175                 DBG_871X("%s invalid offset(%d), out of range!!!", __func__, offset);
 176
 177         return (struct sta_info *)(stapriv->pstainfo_buf + offset * sizeof(struct sta_info));
 178 }
 179
 180 void    _rtw_free_sta_xmit_priv_lock(struct sta_xmit_priv *psta_xmitpriv);
 181 void    _rtw_free_sta_xmit_priv_lock(struct sta_xmit_priv *psta_xmitpriv)
 182 {
 183 _func_enter_;
 184
 185         _rtw_spinlock_free(&psta_xmitpriv->lock);
 186
 187         _rtw_spinlock_free(&(psta_xmitpriv->be_q.sta_pending.lock));
 188         _rtw_spinlock_free(&(psta_xmitpriv->bk_q.sta_pending.lock));
 189         _rtw_spinlock_free(&(psta_xmitpriv->vi_q.sta_pending.lock));
 190         _rtw_spinlock_free(&(psta_xmitpriv->vo_q.sta_pending.lock));
 191 _func_exit_;
 192 }
 193
 194 static void     _rtw_free_sta_recv_priv_lock(struct sta_recv_priv *psta_recvpriv)
 195 {
 196 _func_enter_;
 197
 198         _rtw_spinlock_free(&psta_recvpriv->lock);
 199
 200         _rtw_spinlock_free(&(psta_recvpriv->defrag_q.lock));
 201
 202 _func_exit_;
 203
 204 }
 205
 206 void rtw_mfree_stainfo(struct sta_info *psta);
 207 void rtw_mfree_stainfo(struct sta_info *psta)
 208 {
 209 _func_enter_;
 210
 211         if(&psta->lock != NULL)
 212                  _rtw_spinlock_free(&psta->lock);
 213
 214         _rtw_free_sta_xmit_priv_lock(&psta->sta_xmitpriv);
 215         _rtw_free_sta_recv_priv_lock(&psta->sta_recvpriv);
 216
 217 _func_exit_;
 218 }
 219
 220
 221 // this function is used to free the memory of lock || sema for all stainfos
 222 void rtw_mfree_all_stainfo(struct sta_priv *pstapriv );
 223 void rtw_mfree_all_stainfo(struct sta_priv *pstapriv )
 224 {
 225         _irqL    irqL;
 226         _list   *plist, *phead;
 227         struct sta_info *psta = NULL;
 228
 229 _func_enter_;
 230
 231         _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL);
 232
 233         phead = get_list_head(&pstapriv->free_sta_queue);
 234         plist = get_next(phead);
 235
 236         while ((rtw_end_of_queue_search(phead, plist)) == _FALSE)
 237         {
 238                 psta = LIST_CONTAINOR(plist, struct sta_info ,list);
 239                 plist = get_next(plist);
 240
 241                 rtw_mfree_stainfo(psta);
 242         }
 243
 244         _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL);
 245
 246 _func_exit_;
 247
 248 }
 249
 250 void rtw_mfree_sta_priv_lock(struct     sta_priv *pstapriv);
 251 void rtw_mfree_sta_priv_lock(struct     sta_priv *pstapriv)
 252 {
 253 #ifdef CONFIG_AP_MODE
 254         struct wlan_acl_pool *pacl_list = &pstapriv->acl_list;
 255 #endif
 256
 257          rtw_mfree_all_stainfo(pstapriv); //be done before free sta_hash_lock
 258
 259         _rtw_spinlock_free(&pstapriv->free_sta_queue.lock);
 260
 261         _rtw_spinlock_free(&pstapriv->sta_hash_lock);
 262         _rtw_spinlock_free(&pstapriv->wakeup_q.lock);
 263         _rtw_spinlock_free(&pstapriv->sleep_q.lock);
 264
 265 #ifdef CONFIG_AP_MODE
 266         _rtw_spinlock_free(&pstapriv->asoc_list_lock);
 267         _rtw_spinlock_free(&pstapriv->auth_list_lock);
 268         _rtw_spinlock_free(&pacl_list->acl_node_q.lock);
 269 #endif
 270
 271 }
 272
 273 u32     _rtw_free_sta_priv(struct       sta_priv *pstapriv)
 274 {
 275         _irqL   irqL;
 276         _list   *phead, *plist;
 277         struct sta_info *psta = NULL;
 278         struct recv_reorder_ctrl *preorder_ctrl;
 279         int     index;
 280
 281 _func_enter_;
 282         if(pstapriv){
 283
 284                 /*      delete all reordering_ctrl_timer                */
 285                 _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL);
 286                 for(index = 0; index < NUM_STA; index++)
 287                 {
 288                         phead = &(pstapriv->sta_hash[index]);
 289                         plist = get_next(phead);
 290
 291                         while ((rtw_end_of_queue_search(phead, plist)) == _FALSE)
 292                         {
 293                                 int i;
 294                                 psta = LIST_CONTAINOR(plist, struct sta_info ,hash_list);
 295                                 plist = get_next(plist);
 296
 297                                 for(i=0; i < 16 ; i++)
 298                                 {
 299                                         preorder_ctrl = &psta->recvreorder_ctrl[i];
 300                                         _cancel_timer_ex(&preorder_ctrl->reordering_ctrl_timer);
 301                                 }
 302                         }
 303                 }
 304                 _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL);
 305                 /*===============================*/
 306
 307                 rtw_mfree_sta_priv_lock(pstapriv);
 308
 309                 if(pstapriv->pallocated_stainfo_buf) {
 310                         rtw_vmfree(pstapriv->pallocated_stainfo_buf, sizeof(struct sta_info)*NUM_STA+4);
 311                 }
 312         }
 313
 314 _func_exit_;
 315         return _SUCCESS;
 316 }
 317
 318
 319 //struct        sta_info *rtw_alloc_stainfo(_queue *pfree_sta_queue, unsigned char *hwaddr)
 320 struct  sta_info *rtw_alloc_stainfo(struct      sta_priv *pstapriv, u8 *hwaddr)
 321 {
 322         _irqL irqL, irqL2;
 323         uint tmp_aid;
 324         s32     index;
 325         _list   *phash_list;
 326         struct sta_info *psta;
 327         _queue *pfree_sta_queue;
 328         struct recv_reorder_ctrl *preorder_ctrl;
 329         int i = 0;
 330         u16  wRxSeqInitialValue = 0xffff;
 331
 332 _func_enter_;
 333
 334         pfree_sta_queue = &pstapriv->free_sta_queue;
 335
 336         //_enter_critical_bh(&(pfree_sta_queue->lock), &irqL);
 337         _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL2);
 338         if (_rtw_queue_empty(pfree_sta_queue) == _TRUE)
 339         {
 340                 //_exit_critical_bh(&(pfree_sta_queue->lock), &irqL);
 341                 _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL2);
 342                 psta = NULL;
 343         }
 344         else
 345         {
 346                 psta = LIST_CONTAINOR(get_next(&pfree_sta_queue->queue), struct sta_info, list);
 347
 348                 rtw_list_delete(&(psta->list));
 349
 350                 //_exit_critical_bh(&(pfree_sta_queue->lock), &irqL);
 351
 352                 tmp_aid = psta->aid;
 353
 354                 _rtw_init_stainfo(psta);
 355
 356                 psta->padapter = pstapriv->padapter;
 357
 358                 _rtw_memcpy(psta->hwaddr, hwaddr, ETH_ALEN);
 359
 360                 index = wifi_mac_hash(hwaddr);
 361
 362                 RT_TRACE(_module_rtl871x_sta_mgt_c_,_drv_info_,("rtw_alloc_stainfo: index  = %x", index));
 363
 364                 if(index >= NUM_STA){
 365                         RT_TRACE(_module_rtl871x_sta_mgt_c_,_drv_err_,("ERROR=> rtw_alloc_stainfo: index >= NUM_STA"));
 366                         psta= NULL;
 367                         goto exit;
 368                 }
 369                 phash_list = &(pstapriv->sta_hash[index]);
 370
 371                 //_enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL2);
 372
 373                 rtw_list_insert_tail(&psta->hash_list, phash_list);
 374
 375                 pstapriv->asoc_sta_count ++ ;
 376
 377                 //_exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL2);
 378
 379 // Commented by Albert 2009/08/13
 380 // For the SMC router, the sequence number of first packet of WPS handshake will be 0.
 381 // In this case, this packet will be dropped by recv_decache function if we use the 0x00 as the default value for tid_rxseq variable.
 382 // So, we initialize the tid_rxseq variable as the 0xffff.
 383
 384                 for( i = 0; i < 16; i++ )
 385                 {
 386                      _rtw_memcpy( &psta->sta_recvpriv.rxcache.tid_rxseq[ i ], &wRxSeqInitialValue, 2 );
 387                 }
 388
 389                 RT_TRACE(_module_rtl871x_sta_mgt_c_,_drv_info_,("alloc number_%d stainfo  with hwaddr = %x %x %x %x %x %x  \n",
 390                 pstapriv->asoc_sta_count , hwaddr[0], hwaddr[1], hwaddr[2],hwaddr[3],hwaddr[4],hwaddr[5]));
 391
 392                 init_addba_retry_timer(pstapriv->padapter, psta);
 393
 394 #ifdef CONFIG_TDLS
 395                 rtw_init_tdls_timer(pstapriv->padapter, psta);
 396 #endif //CONFIG_TDLS
 397
 398                 //for A-MPDU Rx reordering buffer control
 399                 for(i=0; i < 16 ; i++)
 400                 {
 401                         preorder_ctrl = &psta->recvreorder_ctrl[i];
 402
 403                         preorder_ctrl->padapter = pstapriv->padapter;
 404
 405                         preorder_ctrl->enable = _FALSE;
 406
 407                         preorder_ctrl->indicate_seq = 0xffff;
 408                         #ifdef DBG_RX_SEQ
 409                         DBG_871X("DBG_RX_SEQ %s:%d IndicateSeq: %d\n", __FUNCTION__, __LINE__,
 410                                 preorder_ctrl->indicate_seq);
 411                         #endif
 412                         preorder_ctrl->wend_b= 0xffff;
 413                         //preorder_ctrl->wsize_b = (NR_RECVBUFF-2);
 414                         preorder_ctrl->wsize_b = 64;//64;
 415                         preorder_ctrl->ampdu_size = RX_AMPDU_SIZE_INVALID;
 416
 417                         _rtw_init_queue(&preorder_ctrl->pending_recvframe_queue);
 418
 419                         rtw_init_recv_timer(preorder_ctrl);
 420                 }
 421
 422
 423                 //init for DM
 424                 psta->rssi_stat.UndecoratedSmoothedPWDB = (-1);
 425                 psta->rssi_stat.UndecoratedSmoothedCCK = (-1);
 426 #ifdef CONFIG_ATMEL_RC_PATCH
 427                 psta->flag_atmel_rc = 0;
 428 #endif
 429                 /* init for the sequence number of received management frame */
 430                 psta->RxMgmtFrameSeqNum = 0xffff;
 431
 432                 //alloc mac id for non-bc/mc station,
 433                 rtw_alloc_macid(pstapriv->padapter, psta);
 434
 435         }
 436
 437 exit:
 438
 439         _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL2);
 440
 441 _func_exit_;
 442
 443         return psta;
 444
 445
 446 }
 447
 448
 449 // using pstapriv->sta_hash_lock to protect
 450 u32     rtw_free_stainfo(_adapter *padapter , struct sta_info *psta)
 451 {
 452         int i;
 453         _irqL irqL0;
 454         _queue *pfree_sta_queue;
 455         struct recv_reorder_ctrl *preorder_ctrl;
 456         struct  sta_xmit_priv   *pstaxmitpriv;
 457         struct  xmit_priv       *pxmitpriv= &padapter->xmitpriv;
 458         struct  sta_priv *pstapriv = &padapter->stapriv;
 459         struct hw_xmit *phwxmit;
 460         int pending_qcnt[4];
 461
 462 _func_enter_;
 463
 464         if (psta == NULL)
 465                 goto exit;
 466
 467         _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL0);
 468         rtw_list_delete(&psta->hash_list);
 469         RT_TRACE(_module_rtl871x_sta_mgt_c_,_drv_err_,("\n free number_%d stainfo  with hwaddr = 0x%.2x 0x%.2x 0x%.2x 0x%.2x 0x%.2x 0x%.2x  \n",pstapriv->asoc_sta_count , psta->hwaddr[0], psta->hwaddr[1], psta->hwaddr[2],psta->hwaddr[3],psta->hwaddr[4],psta->hwaddr[5]));
 470         pstapriv->asoc_sta_count --;
 471         _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL0);
 472
 473
 474         _enter_critical_bh(&psta->lock, &irqL0);
 475         psta->state &= ~_FW_LINKED;
 476         _exit_critical_bh(&psta->lock, &irqL0);
 477
 478         pfree_sta_queue = &pstapriv->free_sta_queue;
 479
 480
 481         pstaxmitpriv = &psta->sta_xmitpriv;
 482
 483         //rtw_list_delete(&psta->sleep_list);
 484
 485         //rtw_list_delete(&psta->wakeup_list);
 486
 487         _enter_critical_bh(&pxmitpriv->lock, &irqL0);
 488
 489         rtw_free_xmitframe_queue(pxmitpriv, &psta->sleep_q);
 490         psta->sleepq_len = 0;
 491
 492         //vo
 493         //_enter_critical_bh(&(pxmitpriv->vo_pending.lock), &irqL0);
 494         rtw_free_xmitframe_queue( pxmitpriv, &pstaxmitpriv->vo_q.sta_pending);
 495         rtw_list_delete(&(pstaxmitpriv->vo_q.tx_pending));
 496         phwxmit = pxmitpriv->hwxmits;
 497         phwxmit->accnt -= pstaxmitpriv->vo_q.qcnt;
 498         pending_qcnt[0] = pstaxmitpriv->vo_q.qcnt;
 499         pstaxmitpriv->vo_q.qcnt = 0;
 500         //_exit_critical_bh(&(pxmitpriv->vo_pending.lock), &irqL0);
 501
 502         //vi
 503         //_enter_critical_bh(&(pxmitpriv->vi_pending.lock), &irqL0);
 504         rtw_free_xmitframe_queue( pxmitpriv, &pstaxmitpriv->vi_q.sta_pending);
 505         rtw_list_delete(&(pstaxmitpriv->vi_q.tx_pending));
 506         phwxmit = pxmitpriv->hwxmits+1;
 507         phwxmit->accnt -= pstaxmitpriv->vi_q.qcnt;
 508         pending_qcnt[1] = pstaxmitpriv->vi_q.qcnt;
 509         pstaxmitpriv->vi_q.qcnt = 0;
 510         //_exit_critical_bh(&(pxmitpriv->vi_pending.lock), &irqL0);
 511
 512         //be
 513         //_enter_critical_bh(&(pxmitpriv->be_pending.lock), &irqL0);
 514         rtw_free_xmitframe_queue( pxmitpriv, &pstaxmitpriv->be_q.sta_pending);
 515         rtw_list_delete(&(pstaxmitpriv->be_q.tx_pending));
 516         phwxmit = pxmitpriv->hwxmits+2;
 517         phwxmit->accnt -= pstaxmitpriv->be_q.qcnt;
 518         pending_qcnt[2] = pstaxmitpriv->be_q.qcnt;
 519         pstaxmitpriv->be_q.qcnt = 0;
 520         //_exit_critical_bh(&(pxmitpriv->be_pending.lock), &irqL0);
 521
 522         //bk
 523         //_enter_critical_bh(&(pxmitpriv->bk_pending.lock), &irqL0);
 524         rtw_free_xmitframe_queue( pxmitpriv, &pstaxmitpriv->bk_q.sta_pending);
 525         rtw_list_delete(&(pstaxmitpriv->bk_q.tx_pending));
 526         phwxmit = pxmitpriv->hwxmits+3;
 527         phwxmit->accnt -= pstaxmitpriv->bk_q.qcnt;
 528         pending_qcnt[3] = pstaxmitpriv->bk_q.qcnt;
 529         pstaxmitpriv->bk_q.qcnt = 0;
 530         //_exit_critical_bh(&(pxmitpriv->bk_pending.lock), &irqL0);
 531
 532         rtw_os_wake_queue_at_free_stainfo(padapter, pending_qcnt);
 533
 534         _exit_critical_bh(&pxmitpriv->lock, &irqL0);
 535
 536
 537         // re-init sta_info; 20061114 // will be init in alloc_stainfo
 538         //_rtw_init_sta_xmit_priv(&psta->sta_xmitpriv);
 539         //_rtw_init_sta_recv_priv(&psta->sta_recvpriv);
 540
 541         _cancel_timer_ex(&psta->addba_retry_timer);
 542
 543 #ifdef CONFIG_TDLS
 544         psta->tdls_sta_state = TDLS_STATE_NONE;
 545         rtw_free_tdls_timer(psta);
 546 #endif //CONFIG_TDLS
 547
 548         //for A-MPDU Rx reordering buffer control, cancel reordering_ctrl_timer
 549         for(i=0; i < 16 ; i++)
 550         {
 551                 _irqL irqL;
 552                 _list   *phead, *plist;
 553                 union recv_frame *prframe;
 554                 _queue *ppending_recvframe_queue;
 555                 _queue *pfree_recv_queue = &padapter->recvpriv.free_recv_queue;
 556
 557                 preorder_ctrl = &psta->recvreorder_ctrl[i];
 558
 559                 _cancel_timer_ex(&preorder_ctrl->reordering_ctrl_timer);
 560
 561
 562                 ppending_recvframe_queue = &preorder_ctrl->pending_recvframe_queue;
 563
 564                 _enter_critical_bh(&ppending_recvframe_queue->lock, &irqL);
 565
 566                 phead =         get_list_head(ppending_recvframe_queue);
 567                 plist = get_next(phead);
 568
 569                 while(!rtw_is_list_empty(phead))
 570                 {
 571                         prframe = LIST_CONTAINOR(plist, union recv_frame, u);
 572
 573                         plist = get_next(plist);
 574
 575                         rtw_list_delete(&(prframe->u.hdr.list));
 576
 577                         rtw_free_recvframe(prframe, pfree_recv_queue);
 578                 }
 579
 580                 _exit_critical_bh(&ppending_recvframe_queue->lock, &irqL);
 581
 582         }
 583
 584         if (!(psta->state & WIFI_AP_STATE))
 585                 rtw_hal_set_odm_var(padapter, HAL_ODM_STA_INFO, psta, _FALSE);
 586
 587
 588         //release mac id for non-bc/mc station,
 589         rtw_release_macid(pstapriv->padapter, psta);
 590
 591 #ifdef CONFIG_AP_MODE
 592
 593 /*
 594         _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL0);
 595         rtw_list_delete(&psta->asoc_list);
 596         _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL0);
 597 */
 598         _enter_critical_bh(&pstapriv->auth_list_lock, &irqL0);
 599         if (!rtw_is_list_empty(&psta->auth_list)) {
 600                 rtw_list_delete(&psta->auth_list);
 601                 pstapriv->auth_list_cnt--;
 602         }
 603         _exit_critical_bh(&pstapriv->auth_list_lock, &irqL0);
 604
 605         psta->expire_to = 0;
 606 #ifdef CONFIG_ATMEL_RC_PATCH
 607         psta->flag_atmel_rc = 0;
 608 #endif
 609         psta->sleepq_ac_len = 0;
 610         psta->qos_info = 0;
 611
 612         psta->max_sp_len = 0;
 613         psta->uapsd_bk = 0;
 614         psta->uapsd_be = 0;
 615         psta->uapsd_vi = 0;
 616         psta->uapsd_vo = 0;
 617
 618         psta->has_legacy_ac = 0;
 619
 620 #ifdef CONFIG_NATIVEAP_MLME
 621
 622         pstapriv->sta_dz_bitmap &=~BIT(psta->aid);
 623         pstapriv->tim_bitmap &=~BIT(psta->aid);
 624
 625         //rtw_indicate_sta_disassoc_event(padapter, psta);
 626
 627         if ((psta->aid >0)&&(pstapriv->sta_aid[psta->aid - 1] == psta))
 628         {
 629                 pstapriv->sta_aid[psta->aid - 1] = NULL;
 630                 psta->aid = 0;
 631         }
 632
 633 #endif  // CONFIG_NATIVEAP_MLME
 634
 635 #ifdef CONFIG_TX_MCAST2UNI
 636         psta->under_exist_checking = 0;
 637 #endif  // CONFIG_TX_MCAST2UNI
 638
 639 #endif  // CONFIG_AP_MODE
 640
 641          _rtw_spinlock_free(&psta->lock);
 642
 643         //_enter_critical_bh(&(pfree_sta_queue->lock), &irqL0);
 644         _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL0);
 645         rtw_list_insert_tail(&psta->list, get_list_head(pfree_sta_queue));
 646         _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL0);
 647         //_exit_critical_bh(&(pfree_sta_queue->lock), &irqL0);
 648
 649 exit:
 650
 651 _func_exit_;
 652
 653         return _SUCCESS;
 654
 655 }
 656
 657 // free all stainfo which in sta_hash[all]
 658 void rtw_free_all_stainfo(_adapter *padapter)
 659 {
 660         _irqL    irqL;
 661         _list   *plist, *phead;
 662         s32     index;
 663         struct sta_info *psta = NULL;
 664         struct  sta_priv *pstapriv = &padapter->stapriv;
 665         struct sta_info* pbcmc_stainfo =rtw_get_bcmc_stainfo( padapter);
 666         u8 free_sta_num = 0;
 667         char free_sta_list[NUM_STA];
 668         int stainfo_offset;
 669
 670 _func_enter_;
 671
 672         if(pstapriv->asoc_sta_count==1)
 673                 goto exit;
 674
 675         _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL);
 676
 677         for(index=0; index< NUM_STA; index++)
 678         {
 679                 phead = &(pstapriv->sta_hash[index]);
 680                 plist = get_next(phead);
 681
 682                 while ((rtw_end_of_queue_search(phead, plist)) == _FALSE)
 683                 {
 684                         psta = LIST_CONTAINOR(plist, struct sta_info ,hash_list);
 685
 686                         plist = get_next(plist);
 687
 688                         if(pbcmc_stainfo!=psta)
 689                         {
 690                                 rtw_list_delete(&psta->hash_list);
 691                                 //rtw_free_stainfo(padapter , psta);
 692                                 stainfo_offset = rtw_stainfo_offset(pstapriv, psta);
 693                                 if (stainfo_offset_valid(stainfo_offset)) {
 694                                         free_sta_list[free_sta_num++] = stainfo_offset;
 695                                 }
 696                         }
 697
 698                 }
 699         }
 700
 701         _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL);
 702
 703
 704         for (index = 0; index < free_sta_num; index++)
 705         {
 706                 psta = rtw_get_stainfo_by_offset(pstapriv, free_sta_list[index]);
 707                 rtw_free_stainfo(padapter , psta);
 708         }
 709
 710 exit:
 711
 712 _func_exit_;
 713
 714 }
 715
 716 /* any station allocated can be searched by hash list */
 717 struct sta_info *rtw_get_stainfo(struct sta_priv *pstapriv, u8 *hwaddr)
 718 {
 719
 720         _irqL    irqL;
 721
 722         _list   *plist, *phead;
 723
 724         struct sta_info *psta = NULL;
 725
 726         u32     index;
 727
 728         u8 *addr;
 729
 730         u8 bc_addr[ETH_ALEN] = {0xff,0xff,0xff,0xff,0xff,0xff};
 731
 732 _func_enter_;
 733
 734         if(hwaddr==NULL)
 735                 return NULL;
 736
 737         if(IS_MCAST(hwaddr))
 738         {
 739                 addr = bc_addr;
 740         }
 741         else
 742         {
 743                 addr = hwaddr;
 744         }
 745
 746         index = wifi_mac_hash(addr);
 747
 748         _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL);
 749
 750         phead = &(pstapriv->sta_hash[index]);
 751         plist = get_next(phead);
 752
 753
 754         while ((rtw_end_of_queue_search(phead, plist)) == _FALSE)
 755         {
 756
 757                 psta = LIST_CONTAINOR(plist, struct sta_info, hash_list);
 758
 759                 if ((_rtw_memcmp(psta->hwaddr, addr, ETH_ALEN))== _TRUE)
 760                 { // if found the matched address
 761                         break;
 762                 }
 763                 psta=NULL;
 764                 plist = get_next(plist);
 765         }
 766
 767         _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL);
 768 _func_exit_;
 769         return psta;
 770
 771 }
 772
 773 u32 rtw_init_bcmc_stainfo(_adapter* padapter)
 774 {
 775
 776         struct sta_info         *psta;
 777         struct tx_servq *ptxservq;
 778         u32 res=_SUCCESS;
 779         NDIS_802_11_MAC_ADDRESS bcast_addr= {0xff,0xff,0xff,0xff,0xff,0xff};
 780
 781         struct  sta_priv *pstapriv = &padapter->stapriv;
 782         //_queue        *pstapending = &padapter->xmitpriv.bm_pending;
 783
 784 _func_enter_;
 785
 786         psta = rtw_alloc_stainfo(pstapriv, bcast_addr);
 787
 788         if(psta==NULL){
 789                 res=_FAIL;
 790                 RT_TRACE(_module_rtl871x_sta_mgt_c_,_drv_err_,("rtw_alloc_stainfo fail"));
 791                 goto exit;
 792         }
 793
 794         ptxservq= &(psta->sta_xmitpriv.be_q);
 795
 796 /*
 797         _enter_critical(&pstapending->lock, &irqL0);
 798
 799         if (rtw_is_list_empty(&ptxservq->tx_pending))
 800                 rtw_list_insert_tail(&ptxservq->tx_pending, get_list_head(pstapending));
 801
 802         _exit_critical(&pstapending->lock, &irqL0);
 803 */
 804
 805 exit:
 806 _func_exit_;
 807         return _SUCCESS;
 808
 809 }
 810
 811
 812 struct sta_info* rtw_get_bcmc_stainfo(_adapter* padapter)
 813 {
 814         struct sta_info         *psta;
 815         struct sta_priv         *pstapriv = &padapter->stapriv;
 816         u8 bc_addr[ETH_ALEN] = {0xff,0xff,0xff,0xff,0xff,0xff};
 817 _func_enter_;
 818          psta = rtw_get_stainfo(pstapriv, bc_addr);
 819 _func_exit_;
 820         return psta;
 821
 822 }
 823
 824 u8 rtw_access_ctrl(_adapter *padapter, u8 *mac_addr)
 825 {
 826         u8 res = _TRUE;
 827 #ifdef  CONFIG_AP_MODE
 828         _irqL irqL;
 829         _list   *plist, *phead;
 830         struct rtw_wlan_acl_node *paclnode;
 831         u8 match = _FALSE;
 832         struct sta_priv *pstapriv = &padapter->stapriv;
 833         struct wlan_acl_pool *pacl_list = &pstapriv->acl_list;
 834         _queue  *pacl_node_q =&pacl_list->acl_node_q;
 835
 836         _enter_critical_bh(&(pacl_node_q->lock), &irqL);
 837         phead = get_list_head(pacl_node_q);
 838         plist = get_next(phead);
 839         while ((rtw_end_of_queue_search(phead, plist)) == _FALSE)
 840         {
 841                 paclnode = LIST_CONTAINOR(plist, struct rtw_wlan_acl_node, list);
 842                 plist = get_next(plist);
 843
 844                 if(_rtw_memcmp(paclnode->addr, mac_addr, ETH_ALEN))
 845                 {
 846                         if(paclnode->valid == _TRUE)
 847                         {
 848                                 match = _TRUE;
 849                                 break;
 850                         }
 851                 }
 852         }
 853         _exit_critical_bh(&(pacl_node_q->lock), &irqL);
 854
 855
 856         if(pacl_list->mode == 1)//accept unless in deny list
 857         {
 858                 res = (match == _TRUE) ?  _FALSE:_TRUE;
 859         }
 860         else if(pacl_list->mode == 2)//deny unless in accept list
 861         {
 862                 res = (match == _TRUE) ?  _TRUE:_FALSE;
 863         }
 864         else
 865         {
 866                  res = _TRUE;
 867         }
 868
 869 #endif
 870
 871         return res;
 872
 873 }
 874