drivers/net/wireless/rockchip_wlan/rtl8723bs/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
 416                         _rtw_init_queue(&preorder_ctrl->pending_recvframe_queue);
 417
 418                         rtw_init_recv_timer(preorder_ctrl);
 419                 }
 420
 421
 422                 //init for DM
 423                 psta->rssi_stat.UndecoratedSmoothedPWDB = (-1);
 424                 psta->rssi_stat.UndecoratedSmoothedCCK = (-1);
 425 #ifdef CONFIG_ATMEL_RC_PATCH
 426                 psta->flag_atmel_rc = 0;
 427 #endif
 428                 /* init for the sequence number of received management frame */
 429                 psta->RxMgmtFrameSeqNum = 0xffff;
 430
 431                 //alloc mac id for non-bc/mc station,
 432                 rtw_alloc_macid(pstapriv->padapter, psta);
 433
 434         }
 435
 436 exit:
 437
 438         _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL2);
 439
 440 _func_exit_;
 441
 442         return psta;
 443
 444
 445 }
 446
 447
 448 // using pstapriv->sta_hash_lock to protect
 449 u32     rtw_free_stainfo(_adapter *padapter , struct sta_info *psta)
 450 {
 451         int i;
 452         _irqL irqL0;
 453         _queue *pfree_sta_queue;
 454         struct recv_reorder_ctrl *preorder_ctrl;
 455         struct  sta_xmit_priv   *pstaxmitpriv;
 456         struct  xmit_priv       *pxmitpriv= &padapter->xmitpriv;
 457         struct  sta_priv *pstapriv = &padapter->stapriv;
 458         struct hw_xmit *phwxmit;
 459         int pending_qcnt[4];
 460
 461 _func_enter_;
 462
 463         if (psta == NULL)
 464                 goto exit;
 465
 466         _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL0);
 467         rtw_list_delete(&psta->hash_list);
 468         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]));
 469         pstapriv->asoc_sta_count --;
 470         _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL0);
 471
 472
 473         _enter_critical_bh(&psta->lock, &irqL0);
 474         psta->state &= ~_FW_LINKED;
 475         _exit_critical_bh(&psta->lock, &irqL0);
 476
 477         pfree_sta_queue = &pstapriv->free_sta_queue;
 478
 479
 480         pstaxmitpriv = &psta->sta_xmitpriv;
 481
 482         //rtw_list_delete(&psta->sleep_list);
 483
 484         //rtw_list_delete(&psta->wakeup_list);
 485
 486         _enter_critical_bh(&pxmitpriv->lock, &irqL0);
 487
 488         rtw_free_xmitframe_queue(pxmitpriv, &psta->sleep_q);
 489         psta->sleepq_len = 0;
 490
 491         //vo
 492         //_enter_critical_bh(&(pxmitpriv->vo_pending.lock), &irqL0);
 493         rtw_free_xmitframe_queue( pxmitpriv, &pstaxmitpriv->vo_q.sta_pending);
 494         rtw_list_delete(&(pstaxmitpriv->vo_q.tx_pending));
 495         phwxmit = pxmitpriv->hwxmits;
 496         phwxmit->accnt -= pstaxmitpriv->vo_q.qcnt;
 497         pending_qcnt[0] = pstaxmitpriv->vo_q.qcnt;
 498         pstaxmitpriv->vo_q.qcnt = 0;
 499         //_exit_critical_bh(&(pxmitpriv->vo_pending.lock), &irqL0);
 500
 501         //vi
 502         //_enter_critical_bh(&(pxmitpriv->vi_pending.lock), &irqL0);
 503         rtw_free_xmitframe_queue( pxmitpriv, &pstaxmitpriv->vi_q.sta_pending);
 504         rtw_list_delete(&(pstaxmitpriv->vi_q.tx_pending));
 505         phwxmit = pxmitpriv->hwxmits+1;
 506         phwxmit->accnt -= pstaxmitpriv->vi_q.qcnt;
 507         pending_qcnt[1] = pstaxmitpriv->vi_q.qcnt;
 508         pstaxmitpriv->vi_q.qcnt = 0;
 509         //_exit_critical_bh(&(pxmitpriv->vi_pending.lock), &irqL0);
 510
 511         //be
 512         //_enter_critical_bh(&(pxmitpriv->be_pending.lock), &irqL0);
 513         rtw_free_xmitframe_queue( pxmitpriv, &pstaxmitpriv->be_q.sta_pending);
 514         rtw_list_delete(&(pstaxmitpriv->be_q.tx_pending));
 515         phwxmit = pxmitpriv->hwxmits+2;
 516         phwxmit->accnt -= pstaxmitpriv->be_q.qcnt;
 517         pending_qcnt[2] = pstaxmitpriv->be_q.qcnt;
 518         pstaxmitpriv->be_q.qcnt = 0;
 519         //_exit_critical_bh(&(pxmitpriv->be_pending.lock), &irqL0);
 520
 521         //bk
 522         //_enter_critical_bh(&(pxmitpriv->bk_pending.lock), &irqL0);
 523         rtw_free_xmitframe_queue( pxmitpriv, &pstaxmitpriv->bk_q.sta_pending);
 524         rtw_list_delete(&(pstaxmitpriv->bk_q.tx_pending));
 525         phwxmit = pxmitpriv->hwxmits+3;
 526         phwxmit->accnt -= pstaxmitpriv->bk_q.qcnt;
 527         pending_qcnt[3] = pstaxmitpriv->bk_q.qcnt;
 528         pstaxmitpriv->bk_q.qcnt = 0;
 529         //_exit_critical_bh(&(pxmitpriv->bk_pending.lock), &irqL0);
 530
 531         rtw_os_wake_queue_at_free_stainfo(padapter, pending_qcnt);
 532
 533         _exit_critical_bh(&pxmitpriv->lock, &irqL0);
 534
 535
 536         // re-init sta_info; 20061114 // will be init in alloc_stainfo
 537         //_rtw_init_sta_xmit_priv(&psta->sta_xmitpriv);
 538         //_rtw_init_sta_recv_priv(&psta->sta_recvpriv);
 539
 540         _cancel_timer_ex(&psta->addba_retry_timer);
 541
 542 #ifdef CONFIG_TDLS
 543         rtw_free_tdls_timer(psta);
 544 #endif //CONFIG_TDLS
 545
 546         //for A-MPDU Rx reordering buffer control, cancel reordering_ctrl_timer
 547         for(i=0; i < 16 ; i++)
 548         {
 549                 _irqL irqL;
 550                 _list   *phead, *plist;
 551                 union recv_frame *prframe;
 552                 _queue *ppending_recvframe_queue;
 553                 _queue *pfree_recv_queue = &padapter->recvpriv.free_recv_queue;
 554
 555                 preorder_ctrl = &psta->recvreorder_ctrl[i];
 556
 557                 _cancel_timer_ex(&preorder_ctrl->reordering_ctrl_timer);
 558
 559
 560                 ppending_recvframe_queue = &preorder_ctrl->pending_recvframe_queue;
 561
 562                 _enter_critical_bh(&ppending_recvframe_queue->lock, &irqL);
 563
 564                 phead =         get_list_head(ppending_recvframe_queue);
 565                 plist = get_next(phead);
 566
 567                 while(!rtw_is_list_empty(phead))
 568                 {
 569                         prframe = LIST_CONTAINOR(plist, union recv_frame, u);
 570
 571                         plist = get_next(plist);
 572
 573                         rtw_list_delete(&(prframe->u.hdr.list));
 574
 575                         rtw_free_recvframe(prframe, pfree_recv_queue);
 576                 }
 577
 578                 _exit_critical_bh(&ppending_recvframe_queue->lock, &irqL);
 579
 580         }
 581
 582         if (!(psta->state & WIFI_AP_STATE))
 583                 rtw_hal_set_odm_var(padapter, HAL_ODM_STA_INFO, psta, _FALSE);
 584
 585
 586         //release mac id for non-bc/mc station,
 587         rtw_release_macid(pstapriv->padapter, psta);
 588
 589 #ifdef CONFIG_AP_MODE
 590
 591 /*
 592         _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL0);
 593         rtw_list_delete(&psta->asoc_list);
 594         _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL0);
 595 */
 596         _enter_critical_bh(&pstapriv->auth_list_lock, &irqL0);
 597         if (!rtw_is_list_empty(&psta->auth_list)) {
 598                 rtw_list_delete(&psta->auth_list);
 599                 pstapriv->auth_list_cnt--;
 600         }
 601         _exit_critical_bh(&pstapriv->auth_list_lock, &irqL0);
 602
 603         psta->expire_to = 0;
 604 #ifdef CONFIG_ATMEL_RC_PATCH
 605         psta->flag_atmel_rc = 0;
 606 #endif
 607         psta->sleepq_ac_len = 0;
 608         psta->qos_info = 0;
 609
 610         psta->max_sp_len = 0;
 611         psta->uapsd_bk = 0;
 612         psta->uapsd_be = 0;
 613         psta->uapsd_vi = 0;
 614         psta->uapsd_vo = 0;
 615
 616         psta->has_legacy_ac = 0;
 617
 618 #ifdef CONFIG_NATIVEAP_MLME
 619
 620         pstapriv->sta_dz_bitmap &=~BIT(psta->aid);
 621         pstapriv->tim_bitmap &=~BIT(psta->aid);
 622
 623         //rtw_indicate_sta_disassoc_event(padapter, psta);
 624
 625         if ((psta->aid >0)&&(pstapriv->sta_aid[psta->aid - 1] == psta))
 626         {
 627                 pstapriv->sta_aid[psta->aid - 1] = NULL;
 628                 psta->aid = 0;
 629         }
 630
 631 #endif  // CONFIG_NATIVEAP_MLME
 632
 633 #ifdef CONFIG_TX_MCAST2UNI
 634         psta->under_exist_checking = 0;
 635 #endif  // CONFIG_TX_MCAST2UNI
 636
 637 #endif  // CONFIG_AP_MODE
 638
 639          _rtw_spinlock_free(&psta->lock);
 640
 641         //_enter_critical_bh(&(pfree_sta_queue->lock), &irqL0);
 642         _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL0);
 643         rtw_list_insert_tail(&psta->list, get_list_head(pfree_sta_queue));
 644         _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL0);
 645         //_exit_critical_bh(&(pfree_sta_queue->lock), &irqL0);
 646
 647 exit:
 648
 649 _func_exit_;
 650
 651         return _SUCCESS;
 652
 653 }
 654
 655 // free all stainfo which in sta_hash[all]
 656 void rtw_free_all_stainfo(_adapter *padapter)
 657 {
 658         _irqL    irqL;
 659         _list   *plist, *phead;
 660         s32     index;
 661         struct sta_info *psta = NULL;
 662         struct  sta_priv *pstapriv = &padapter->stapriv;
 663         struct sta_info* pbcmc_stainfo =rtw_get_bcmc_stainfo( padapter);
 664         u8 free_sta_num = 0;
 665         char free_sta_list[NUM_STA];
 666         int stainfo_offset;
 667
 668 _func_enter_;
 669
 670         if(pstapriv->asoc_sta_count==1)
 671                 goto exit;
 672
 673         _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL);
 674
 675         for(index=0; index< NUM_STA; index++)
 676         {
 677                 phead = &(pstapriv->sta_hash[index]);
 678                 plist = get_next(phead);
 679
 680                 while ((rtw_end_of_queue_search(phead, plist)) == _FALSE)
 681                 {
 682                         psta = LIST_CONTAINOR(plist, struct sta_info ,hash_list);
 683
 684                         plist = get_next(plist);
 685
 686                         if(pbcmc_stainfo!=psta)
 687                         {
 688                                 rtw_list_delete(&psta->hash_list);
 689                                 //rtw_free_stainfo(padapter , psta);
 690                                 stainfo_offset = rtw_stainfo_offset(pstapriv, psta);
 691                                 if (stainfo_offset_valid(stainfo_offset)) {
 692                                         free_sta_list[free_sta_num++] = stainfo_offset;
 693                                 }
 694                         }
 695
 696                 }
 697         }
 698
 699         _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL);
 700
 701
 702         for (index = 0; index < free_sta_num; index++)
 703         {
 704                 psta = rtw_get_stainfo_by_offset(pstapriv, free_sta_list[index]);
 705                 rtw_free_stainfo(padapter , psta);
 706         }
 707
 708 exit:
 709
 710 _func_exit_;
 711
 712 }
 713
 714 /* any station allocated can be searched by hash list */
 715 struct sta_info *rtw_get_stainfo(struct sta_priv *pstapriv, u8 *hwaddr)
 716 {
 717
 718         _irqL    irqL;
 719
 720         _list   *plist, *phead;
 721
 722         struct sta_info *psta = NULL;
 723
 724         u32     index;
 725
 726         u8 *addr;
 727
 728         u8 bc_addr[ETH_ALEN] = {0xff,0xff,0xff,0xff,0xff,0xff};
 729
 730 _func_enter_;
 731
 732         if(hwaddr==NULL)
 733                 return NULL;
 734
 735         if(IS_MCAST(hwaddr))
 736         {
 737                 addr = bc_addr;
 738         }
 739         else
 740         {
 741                 addr = hwaddr;
 742         }
 743
 744         index = wifi_mac_hash(addr);
 745
 746         _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL);
 747
 748         phead = &(pstapriv->sta_hash[index]);
 749         plist = get_next(phead);
 750
 751
 752         while ((rtw_end_of_queue_search(phead, plist)) == _FALSE)
 753         {
 754
 755                 psta = LIST_CONTAINOR(plist, struct sta_info, hash_list);
 756
 757                 if ((_rtw_memcmp(psta->hwaddr, addr, ETH_ALEN))== _TRUE)
 758                 { // if found the matched address
 759                         break;
 760                 }
 761                 psta=NULL;
 762                 plist = get_next(plist);
 763         }
 764
 765         _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL);
 766 _func_exit_;
 767         return psta;
 768
 769 }
 770
 771 u32 rtw_init_bcmc_stainfo(_adapter* padapter)
 772 {
 773
 774         struct sta_info         *psta;
 775         struct tx_servq *ptxservq;
 776         u32 res=_SUCCESS;
 777         NDIS_802_11_MAC_ADDRESS bcast_addr= {0xff,0xff,0xff,0xff,0xff,0xff};
 778
 779         struct  sta_priv *pstapriv = &padapter->stapriv;
 780         //_queue        *pstapending = &padapter->xmitpriv.bm_pending;
 781
 782 _func_enter_;
 783
 784         psta = rtw_alloc_stainfo(pstapriv, bcast_addr);
 785
 786         if(psta==NULL){
 787                 res=_FAIL;
 788                 RT_TRACE(_module_rtl871x_sta_mgt_c_,_drv_err_,("rtw_alloc_stainfo fail"));
 789                 goto exit;
 790         }
 791
 792         ptxservq= &(psta->sta_xmitpriv.be_q);
 793
 794 /*
 795         _enter_critical(&pstapending->lock, &irqL0);
 796
 797         if (rtw_is_list_empty(&ptxservq->tx_pending))
 798                 rtw_list_insert_tail(&ptxservq->tx_pending, get_list_head(pstapending));
 799
 800         _exit_critical(&pstapending->lock, &irqL0);
 801 */
 802
 803 exit:
 804 _func_exit_;
 805         return _SUCCESS;
 806
 807 }
 808
 809
 810 struct sta_info* rtw_get_bcmc_stainfo(_adapter* padapter)
 811 {
 812         struct sta_info         *psta;
 813         struct sta_priv         *pstapriv = &padapter->stapriv;
 814         u8 bc_addr[ETH_ALEN] = {0xff,0xff,0xff,0xff,0xff,0xff};
 815 _func_enter_;
 816          psta = rtw_get_stainfo(pstapriv, bc_addr);
 817 _func_exit_;
 818         return psta;
 819
 820 }
 821
 822 u8 rtw_access_ctrl(_adapter *padapter, u8 *mac_addr)
 823 {
 824         u8 res = _TRUE;
 825 #ifdef  CONFIG_AP_MODE
 826         _irqL irqL;
 827         _list   *plist, *phead;
 828         struct rtw_wlan_acl_node *paclnode;
 829         u8 match = _FALSE;
 830         struct sta_priv *pstapriv = &padapter->stapriv;
 831         struct wlan_acl_pool *pacl_list = &pstapriv->acl_list;
 832         _queue  *pacl_node_q =&pacl_list->acl_node_q;
 833
 834         _enter_critical_bh(&(pacl_node_q->lock), &irqL);
 835         phead = get_list_head(pacl_node_q);
 836         plist = get_next(phead);
 837         while ((rtw_end_of_queue_search(phead, plist)) == _FALSE)
 838         {
 839                 paclnode = LIST_CONTAINOR(plist, struct rtw_wlan_acl_node, list);
 840                 plist = get_next(plist);
 841
 842                 if(_rtw_memcmp(paclnode->addr, mac_addr, ETH_ALEN))
 843                 {
 844                         if(paclnode->valid == _TRUE)
 845                         {
 846                                 match = _TRUE;
 847                                 break;
 848                         }
 849                 }
 850         }
 851         _exit_critical_bh(&(pacl_node_q->lock), &irqL);
 852
 853
 854         if(pacl_list->mode == 1)//accept unless in deny list
 855         {
 856                 res = (match == _TRUE) ?  _FALSE:_TRUE;
 857         }
 858         else if(pacl_list->mode == 2)//deny unless in accept list
 859         {
 860                 res = (match == _TRUE) ?  _TRUE:_FALSE;
 861         }
 862         else
 863         {
 864                  res = _TRUE;
 865         }
 866
 867 #endif
 868
 869         return res;
 870
 871 }
 872