2 *************************************************************************
4 * 5F., No.36, Taiyuan St., Jhubei City,
8 * (c) Copyright 2002-2007, Ralink Technology, Inc.
10 * This program is free software; you can redistribute it and/or modify *
11 * it under the terms of the GNU General Public License as published by *
12 * the Free Software Foundation; either version 2 of the License, or *
13 * (at your option) any later version. *
15 * This program is distributed in the hope that it will be useful, *
16 * but WITHOUT ANY WARRANTY; without even the implied warranty of *
17 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
18 * GNU General Public License for more details. *
20 * You should have received a copy of the GNU General Public License *
21 * along with this program; if not, write to the *
22 * Free Software Foundation, Inc., *
23 * 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. *
25 *************************************************************************
31 Handle association related requests either from WSTA or from local MLME
35 -------- ---------- ----------------------------------------------
36 Jan Lee 2006 created for rt2860
39 #include "../rt_config.h"
40 #include "../action.h"
43 static VOID ReservedAction(
45 IN MLME_QUEUE_ELEM *Elem);
48 ==========================================================================
50 association state machine init, including state transition and timer init
52 S - pointer to the association state machine
54 The state machine looks like the following
57 MT2_MLME_DISASSOC_REQ mlme_disassoc_req_action
58 MT2_PEER_DISASSOC_REQ peer_disassoc_action
59 MT2_PEER_ASSOC_REQ drop
60 MT2_PEER_REASSOC_REQ drop
61 MT2_CLS3ERR cls3err_action
62 ==========================================================================
64 VOID ActionStateMachineInit(
67 OUT STATE_MACHINE_FUNC Trans[])
69 StateMachineInit(S, (STATE_MACHINE_FUNC *)Trans, MAX_ACT_STATE, MAX_ACT_MSG, (STATE_MACHINE_FUNC)Drop, ACT_IDLE, ACT_MACHINE_BASE);
71 StateMachineSetAction(S, ACT_IDLE, MT2_PEER_SPECTRUM_CATE, (STATE_MACHINE_FUNC)PeerSpectrumAction);
72 StateMachineSetAction(S, ACT_IDLE, MT2_PEER_QOS_CATE, (STATE_MACHINE_FUNC)PeerQOSAction);
74 StateMachineSetAction(S, ACT_IDLE, MT2_PEER_DLS_CATE, (STATE_MACHINE_FUNC)ReservedAction);
76 StateMachineSetAction(S, ACT_IDLE, MT2_PEER_BA_CATE, (STATE_MACHINE_FUNC)PeerBAAction);
77 StateMachineSetAction(S, ACT_IDLE, MT2_PEER_HT_CATE, (STATE_MACHINE_FUNC)PeerHTAction);
78 StateMachineSetAction(S, ACT_IDLE, MT2_MLME_ADD_BA_CATE, (STATE_MACHINE_FUNC)MlmeADDBAAction);
79 StateMachineSetAction(S, ACT_IDLE, MT2_MLME_ORI_DELBA_CATE, (STATE_MACHINE_FUNC)MlmeDELBAAction);
80 StateMachineSetAction(S, ACT_IDLE, MT2_MLME_REC_DELBA_CATE, (STATE_MACHINE_FUNC)MlmeDELBAAction);
82 StateMachineSetAction(S, ACT_IDLE, MT2_PEER_PUBLIC_CATE, (STATE_MACHINE_FUNC)PeerPublicAction);
83 StateMachineSetAction(S, ACT_IDLE, MT2_PEER_RM_CATE, (STATE_MACHINE_FUNC)PeerRMAction);
85 StateMachineSetAction(S, ACT_IDLE, MT2_MLME_QOS_CATE, (STATE_MACHINE_FUNC)MlmeQOSAction);
86 StateMachineSetAction(S, ACT_IDLE, MT2_MLME_DLS_CATE, (STATE_MACHINE_FUNC)MlmeDLSAction);
87 StateMachineSetAction(S, ACT_IDLE, MT2_ACT_INVALID, (STATE_MACHINE_FUNC)MlmeInvalidAction);
92 IN MLME_QUEUE_ELEM *Elem)
95 MLME_ADDBA_REQ_STRUCT *pInfo;
97 PUCHAR pOutBuffer = NULL;
100 FRAME_ADDBA_REQ Frame;
102 BA_ORI_ENTRY *pBAEntry = NULL;
104 pInfo = (MLME_ADDBA_REQ_STRUCT *)Elem->Msg;
105 NdisZeroMemory(&Frame, sizeof(FRAME_ADDBA_REQ));
107 if(MlmeAddBAReqSanity(pAd, Elem->Msg, Elem->MsgLen, Addr))
109 NStatus = MlmeAllocateMemory(pAd, &pOutBuffer); //Get an unused nonpaged memory
110 if(NStatus != NDIS_STATUS_SUCCESS)
112 DBGPRINT(RT_DEBUG_TRACE,("BA - MlmeADDBAAction() allocate memory failed \n"));
116 Idx = pAd->MacTab.Content[pInfo->Wcid].BAOriWcidArray[pInfo->TID];
119 MlmeFreeMemory(pAd, pOutBuffer);
120 DBGPRINT(RT_DEBUG_ERROR,("BA - MlmeADDBAAction() can't find BAOriEntry \n"));
125 pBAEntry =&pAd->BATable.BAOriEntry[Idx];
128 IF_DEV_CONFIG_OPMODE_ON_STA(pAd)
131 ActHeaderInit(pAd, &Frame.Hdr, pInfo->pAddr, pAd->CurrentAddress, pAd->CommonCfg.Bssid);
133 ActHeaderInit(pAd, &Frame.Hdr, pAd->CommonCfg.Bssid, pAd->CurrentAddress, pInfo->pAddr);
137 Frame.Category = CATEGORY_BA;
138 Frame.Action = ADDBA_REQ;
139 Frame.BaParm.AMSDUSupported = 0;
140 Frame.BaParm.BAPolicy = IMMED_BA;
141 Frame.BaParm.TID = pInfo->TID;
142 Frame.BaParm.BufSize = pInfo->BaBufSize;
143 Frame.Token = pInfo->Token;
144 Frame.TimeOutValue = pInfo->TimeOutValue;
145 Frame.BaStartSeq.field.FragNum = 0;
146 Frame.BaStartSeq.field.StartSeq = pAd->MacTab.Content[pInfo->Wcid].TxSeq[pInfo->TID];
148 *(USHORT *)(&Frame.BaParm) = cpu2le16(*(USHORT *)(&Frame.BaParm));
149 Frame.TimeOutValue = cpu2le16(Frame.TimeOutValue);
150 Frame.BaStartSeq.word = cpu2le16(Frame.BaStartSeq.word);
152 MakeOutgoingFrame(pOutBuffer, &FrameLen,
153 sizeof(FRAME_ADDBA_REQ), &Frame,
155 MiniportMMRequest(pAd, QID_AC_BE, pOutBuffer, FrameLen);
156 //MiniportDataMMRequest(pAd, MapUserPriorityToAccessCategory[pInfo->TID], pOutBuffer, FrameLen);
157 MlmeFreeMemory(pAd, pOutBuffer);
159 DBGPRINT(RT_DEBUG_TRACE, ("BA - Send ADDBA request. StartSeq = %x, FrameLen = %ld. BufSize = %d\n", Frame.BaStartSeq.field.StartSeq, FrameLen, Frame.BaParm.BufSize));
164 ==========================================================================
166 send DELBA and delete BaEntry if any
168 Elem - MLME message MLME_DELBA_REQ_STRUCT
170 IRQL = DISPATCH_LEVEL
172 ==========================================================================
174 VOID MlmeDELBAAction(
175 IN PRTMP_ADAPTER pAd,
176 IN MLME_QUEUE_ELEM *Elem)
178 MLME_DELBA_REQ_STRUCT *pInfo;
179 PUCHAR pOutBuffer = NULL;
180 PUCHAR pOutBuffer2 = NULL;
183 FRAME_DELBA_REQ Frame;
187 pInfo = (MLME_DELBA_REQ_STRUCT *)Elem->Msg;
188 // must send back DELBA
189 NdisZeroMemory(&Frame, sizeof(FRAME_DELBA_REQ));
190 DBGPRINT(RT_DEBUG_TRACE, ("==> MlmeDELBAAction(), Initiator(%d) \n", pInfo->Initiator));
192 if(MlmeDelBAReqSanity(pAd, Elem->Msg, Elem->MsgLen))
194 NStatus = MlmeAllocateMemory(pAd, &pOutBuffer); //Get an unused nonpaged memory
195 if(NStatus != NDIS_STATUS_SUCCESS)
197 DBGPRINT(RT_DEBUG_ERROR,("BA - MlmeDELBAAction() allocate memory failed 1. \n"));
201 NStatus = MlmeAllocateMemory(pAd, &pOutBuffer2); //Get an unused nonpaged memory
202 if(NStatus != NDIS_STATUS_SUCCESS)
204 MlmeFreeMemory(pAd, pOutBuffer);
205 DBGPRINT(RT_DEBUG_ERROR, ("BA - MlmeDELBAAction() allocate memory failed 2. \n"));
209 // SEND BAR (Send BAR to refresh peer reordering buffer.)
210 Idx = pAd->MacTab.Content[pInfo->Wcid].BAOriWcidArray[pInfo->TID];
212 IF_DEV_CONFIG_OPMODE_ON_STA(pAd)
213 BarHeaderInit(pAd, &FrameBar, pAd->MacTab.Content[pInfo->Wcid].Addr, pAd->CurrentAddress);
215 FrameBar.StartingSeq.field.FragNum = 0; // make sure sequence not clear in DEL funciton.
216 FrameBar.StartingSeq.field.StartSeq = pAd->MacTab.Content[pInfo->Wcid].TxSeq[pInfo->TID]; // make sure sequence not clear in DEL funciton.
217 FrameBar.BarControl.TID = pInfo->TID; // make sure sequence not clear in DEL funciton.
218 FrameBar.BarControl.ACKPolicy = IMMED_BA; // make sure sequence not clear in DEL funciton.
219 FrameBar.BarControl.Compressed = 1; // make sure sequence not clear in DEL funciton.
220 FrameBar.BarControl.MTID = 0; // make sure sequence not clear in DEL funciton.
222 MakeOutgoingFrame(pOutBuffer2, &FrameLen,
223 sizeof(FRAME_BAR), &FrameBar,
225 MiniportMMRequest(pAd, QID_AC_BE, pOutBuffer2, FrameLen);
226 MlmeFreeMemory(pAd, pOutBuffer2);
227 DBGPRINT(RT_DEBUG_TRACE,("BA - MlmeDELBAAction() . Send BAR to refresh peer reordering buffer \n"));
232 IF_DEV_CONFIG_OPMODE_ON_STA(pAd)
235 ActHeaderInit(pAd, &Frame.Hdr, pAd->MacTab.Content[pInfo->Wcid].Addr, pAd->CurrentAddress, pAd->CommonCfg.Bssid);
237 ActHeaderInit(pAd, &Frame.Hdr, pAd->CommonCfg.Bssid, pAd->CurrentAddress, pAd->MacTab.Content[pInfo->Wcid].Addr);
240 Frame.Category = CATEGORY_BA;
241 Frame.Action = DELBA;
242 Frame.DelbaParm.Initiator = pInfo->Initiator;
243 Frame.DelbaParm.TID = pInfo->TID;
244 Frame.ReasonCode = 39; // Time Out
245 *(USHORT *)(&Frame.DelbaParm) = cpu2le16(*(USHORT *)(&Frame.DelbaParm));
246 Frame.ReasonCode = cpu2le16(Frame.ReasonCode);
248 MakeOutgoingFrame(pOutBuffer, &FrameLen,
249 sizeof(FRAME_DELBA_REQ), &Frame,
251 MiniportMMRequest(pAd, QID_AC_BE, pOutBuffer, FrameLen);
252 MlmeFreeMemory(pAd, pOutBuffer);
253 DBGPRINT(RT_DEBUG_TRACE, ("BA - MlmeDELBAAction() . 3 DELBA sent. Initiator(%d)\n", pInfo->Initiator));
258 IN PRTMP_ADAPTER pAd,
259 IN MLME_QUEUE_ELEM *Elem)
264 IN PRTMP_ADAPTER pAd,
265 IN MLME_QUEUE_ELEM *Elem)
269 VOID MlmeInvalidAction(
270 IN PRTMP_ADAPTER pAd,
271 IN MLME_QUEUE_ELEM *Elem)
273 //PUCHAR pOutBuffer = NULL;
274 //Return the receiving frame except the MSB of category filed set to 1. 7.3.1.11
278 IN PRTMP_ADAPTER pAd,
279 IN MLME_QUEUE_ELEM *Elem)
284 IN PRTMP_ADAPTER pAd,
285 IN MLME_QUEUE_ELEM *Elem)
287 UCHAR Action = Elem->Msg[LENGTH_802_11+1];
292 PeerAddBAReqAction(pAd,Elem);
295 PeerAddBARspAction(pAd,Elem);
298 PeerDelBAAction(pAd,Elem);
303 VOID PeerPublicAction(
304 IN PRTMP_ADAPTER pAd,
305 IN MLME_QUEUE_ELEM *Elem)
307 if (Elem->Wcid >= MAX_LEN_OF_MAC_TABLE)
312 static VOID ReservedAction(
313 IN PRTMP_ADAPTER pAd,
314 IN MLME_QUEUE_ELEM *Elem)
318 if (Elem->MsgLen <= LENGTH_802_11)
323 Category = Elem->Msg[LENGTH_802_11];
324 DBGPRINT(RT_DEBUG_TRACE,("Rcv reserved category(%d) Action Frame\n", Category));
325 hex_dump("Reserved Action Frame", &Elem->Msg[0], Elem->MsgLen);
329 IN PRTMP_ADAPTER pAd,
330 IN MLME_QUEUE_ELEM *Elem)
336 static VOID respond_ht_information_exchange_action(
337 IN PRTMP_ADAPTER pAd,
338 IN MLME_QUEUE_ELEM *Elem)
340 PUCHAR pOutBuffer = NULL;
343 FRAME_HT_INFO HTINFOframe, *pFrame;
347 // 2. Always send back ADDBA Response
348 NStatus = MlmeAllocateMemory(pAd, &pOutBuffer); //Get an unused nonpaged memory
350 if (NStatus != NDIS_STATUS_SUCCESS)
352 DBGPRINT(RT_DEBUG_TRACE,("ACTION - respond_ht_information_exchange_action() allocate memory failed \n"));
357 pFrame = (FRAME_HT_INFO *) &Elem->Msg[0];
358 pAddr = pFrame->Hdr.Addr2;
360 NdisZeroMemory(&HTINFOframe, sizeof(FRAME_HT_INFO));
361 // 2-1. Prepare ADDBA Response frame.
362 IF_DEV_CONFIG_OPMODE_ON_STA(pAd)
365 ActHeaderInit(pAd, &HTINFOframe.Hdr, pAddr, pAd->CurrentAddress, pAd->CommonCfg.Bssid);
367 ActHeaderInit(pAd, &HTINFOframe.Hdr, pAd->CommonCfg.Bssid, pAd->CurrentAddress, pAddr);
370 HTINFOframe.Category = CATEGORY_HT;
371 HTINFOframe.Action = HT_INFO_EXCHANGE;
372 HTINFOframe.HT_Info.Request = 0;
373 HTINFOframe.HT_Info.Forty_MHz_Intolerant = pAd->CommonCfg.HtCapability.HtCapInfo.Forty_Mhz_Intolerant;
374 HTINFOframe.HT_Info.STA_Channel_Width = pAd->CommonCfg.AddHTInfo.AddHtInfo.RecomWidth;
376 MakeOutgoingFrame(pOutBuffer, &FrameLen,
377 sizeof(FRAME_HT_INFO), &HTINFOframe,
380 MiniportMMRequest(pAd, QID_AC_BE, pOutBuffer, FrameLen);
381 MlmeFreeMemory(pAd, pOutBuffer);
385 IN PRTMP_ADAPTER pAd,
386 IN MLME_QUEUE_ELEM *Elem)
388 UCHAR Action = Elem->Msg[LENGTH_802_11+1];
390 if (Elem->Wcid >= MAX_LEN_OF_MAC_TABLE)
395 case NOTIFY_BW_ACTION:
396 DBGPRINT(RT_DEBUG_TRACE,("ACTION - HT Notify Channel bandwidth action----> \n"));
398 if(pAd->StaActive.SupportedPhyInfo.bHtEnable == FALSE)
400 // Note, this is to patch DIR-1353 AP. When the AP set to Wep, it will use legacy mode. But AP still keeps
401 // sending BW_Notify Action frame, and cause us to linkup and linkdown.
402 // In legacy mode, don't need to parse HT action frame.
403 DBGPRINT(RT_DEBUG_TRACE,("ACTION -Ignore HT Notify Channel BW when link as legacy mode. BW = %d---> \n",
404 Elem->Msg[LENGTH_802_11+2] ));
408 if (Elem->Msg[LENGTH_802_11+2] == 0) // 7.4.8.2. if value is 1, keep the same as supported channel bandwidth.
409 pAd->MacTab.Content[Elem->Wcid].HTPhyMode.field.BW = 0;
415 DBGPRINT(RT_DEBUG_TRACE,("ACTION - SMPS action----> \n"));
416 if (((Elem->Msg[LENGTH_802_11+2]&0x1) == 0))
418 pAd->MacTab.Content[Elem->Wcid].MmpsMode = MMPS_ENABLE;
420 else if (((Elem->Msg[LENGTH_802_11+2]&0x2) == 0))
422 pAd->MacTab.Content[Elem->Wcid].MmpsMode = MMPS_STATIC;
426 pAd->MacTab.Content[Elem->Wcid].MmpsMode = MMPS_DYNAMIC;
429 DBGPRINT(RT_DEBUG_TRACE,("Aid(%d) MIMO PS = %d\n", Elem->Wcid, pAd->MacTab.Content[Elem->Wcid].MmpsMode));
430 // rt2860c : add something for smps change.
436 case MIMO_CHA_MEASURE_ACTION:
439 case HT_INFO_EXCHANGE:
441 HT_INFORMATION_OCTET *pHT_info;
443 pHT_info = (HT_INFORMATION_OCTET *) &Elem->Msg[LENGTH_802_11+2];
445 DBGPRINT(RT_DEBUG_TRACE,("ACTION - HT Information Exchange action----> \n"));
446 if (pHT_info->Request)
448 respond_ht_information_exchange_action(pAd, Elem);
457 ==========================================================================
459 Retry sending ADDBA Reqest.
461 IRQL = DISPATCH_LEVEL
464 p8023Header: if this is already 802.3 format, p8023Header is NULL
466 Return : TRUE if put into rx reordering buffer, shouldn't indicaterxhere.
467 FALSE , then continue indicaterx at this moment.
468 ==========================================================================
470 VOID ORIBATimerTimeout(
471 IN PRTMP_ADAPTER pAd)
473 MAC_TABLE_ENTRY *pEntry;
475 // FRAME_BAR FrameBar;
477 // NDIS_STATUS NStatus;
478 // PUCHAR pOutBuffer = NULL;
482 total = pAd->MacTab.Size * NUM_OF_TID;
484 for (i = 1; ((i <MAX_LEN_OF_BA_ORI_TABLE) && (total > 0)) ; i++)
486 if (pAd->BATable.BAOriEntry[i].ORI_BA_Status == Originator_Done)
488 pEntry = &pAd->MacTab.Content[pAd->BATable.BAOriEntry[i].Wcid];
489 TID = pAd->BATable.BAOriEntry[i].TID;
491 ASSERT(pAd->BATable.BAOriEntry[i].Wcid < MAX_LEN_OF_MAC_TABLE);
499 IN PRTMP_ADAPTER pAd,
500 IN MAC_TABLE_ENTRY *pEntry)
505 PUCHAR pOutBuffer = NULL;
509 BA_ORI_ENTRY *pBAEntry;
511 for (i = 0; i <NUM_OF_TID; i++)
513 idx = pEntry->BAOriWcidArray[i];
518 pBAEntry = &pAd->BATable.BAOriEntry[idx];
520 if (pBAEntry->ORI_BA_Status == Originator_Done)
524 ASSERT(pBAEntry->Wcid < MAX_LEN_OF_MAC_TABLE);
526 NStatus = MlmeAllocateMemory(pAd, &pOutBuffer); //Get an unused nonpaged memory
527 if(NStatus != NDIS_STATUS_SUCCESS)
529 DBGPRINT(RT_DEBUG_ERROR,("BA - MlmeADDBAAction() allocate memory failed \n"));
533 Sequence = pEntry->TxSeq[TID];
535 IF_DEV_CONFIG_OPMODE_ON_STA(pAd)
536 BarHeaderInit(pAd, &FrameBar, pEntry->Addr, pAd->CurrentAddress);
538 FrameBar.StartingSeq.field.FragNum = 0; // make sure sequence not clear in DEL function.
539 FrameBar.StartingSeq.field.StartSeq = Sequence; // make sure sequence not clear in DEL funciton.
540 FrameBar.BarControl.TID = TID; // make sure sequence not clear in DEL funciton.
542 MakeOutgoingFrame(pOutBuffer, &FrameLen,
543 sizeof(FRAME_BAR), &FrameBar,
545 //if (!(CLIENT_STATUS_TEST_FLAG(pEntry, fCLIENT_STATUS_RALINK_CHIPSET)))
546 if (1) // Now we always send BAR.
548 //MiniportMMRequestUnlock(pAd, 0, pOutBuffer, FrameLen);
549 MiniportMMRequest(pAd, QID_AC_BE, pOutBuffer, FrameLen);
550 //MiniportDataMMRequest(pAd, MapUserPriorityToAccessCategory[TID], pOutBuffer, FrameLen);
552 MlmeFreeMemory(pAd, pOutBuffer);
558 IN PRTMP_ADAPTER pAd,
559 IN OUT PHEADER_802_11 pHdr80211,
564 NdisZeroMemory(pHdr80211, sizeof(HEADER_802_11));
565 pHdr80211->FC.Type = BTYPE_MGMT;
566 pHdr80211->FC.SubType = SUBTYPE_ACTION;
568 COPY_MAC_ADDR(pHdr80211->Addr1, Addr1);
569 COPY_MAC_ADDR(pHdr80211->Addr2, Addr2);
570 COPY_MAC_ADDR(pHdr80211->Addr3, Addr3);
574 IN PRTMP_ADAPTER pAd,
575 IN OUT PFRAME_BAR pCntlBar,
581 NdisZeroMemory(pCntlBar, sizeof(FRAME_BAR));
582 pCntlBar->FC.Type = BTYPE_CNTL;
583 pCntlBar->FC.SubType = SUBTYPE_BLOCK_ACK_REQ;
584 pCntlBar->BarControl.MTID = 0;
585 pCntlBar->BarControl.Compressed = 1;
586 pCntlBar->BarControl.ACKPolicy = 0;
589 pCntlBar->Duration = 16 + RTMPCalcDuration(pAd, RATE_1, sizeof(FRAME_BA));
591 COPY_MAC_ADDR(pCntlBar->Addr1, pDA);
592 COPY_MAC_ADDR(pCntlBar->Addr2, pSA);
597 ==========================================================================
599 Insert Category and action code into the action frame.
602 1. frame buffer pointer.
604 3. category code of the frame.
605 4. action code of the frame.
608 ==========================================================================
611 IN PRTMP_ADAPTER pAd,
612 OUT PUCHAR pFrameBuf,
613 OUT PULONG pFrameLen,
619 MakeOutgoingFrame( pFrameBuf, &TempLen,
624 *pFrameLen = *pFrameLen + TempLen;