1 /* ************************************************************
4 * This file is for TXBF interface mechanism
6 * ************************************************************ */
7 #include "mp_precomp.h"
8 #include "../phydm_precomp.h"
10 #if (BEAMFORMING_SUPPORT == 1)
11 #if (DM_ODM_SUPPORT_TYPE == ODM_WIN)
14 struct _ADAPTER *adapter,
20 u8 *p_header = GET_FRAME_OF_FIRST_FRAG(adapter, p_tcb);
21 HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter);
22 struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc;
23 struct _RT_BEAMFORMING_INFO *p_beam_info = &(p_dm_odm->beamforming_info);
25 if (adapter->HardwareType < HARDWARE_TYPE_RTL8192EE)
27 else if (IS_WIRELESS_MODE_N(adapter) == false)
30 #if (SUPPORT_MU_BF == 1)
31 if (p_tcb->tx_bf_pkt_type == RT_BF_PKT_TYPE_BROADCAST_NDPA) { /* MU NDPA */
35 /* Fill G_ID and P_AID */
37 if (p_beam_info->first_mu_bfee_index < BEAMFORMEE_ENTRY_NUM) {
38 p_tcb->P_AID = p_beam_info->beamformee_entry[p_beam_info->first_mu_bfee_index].p_aid;
39 RT_DISP(FBEAM, FBEAM_FUN, ("[David]@%s End, G_ID=0x%X, P_AID=0x%X\n", __func__, p_tcb->G_ID, p_tcb->P_AID));
42 GET_80211_HDR_ADDRESS1(p_header, &RA);
44 /* VHT SU PPDU carrying one or more group addressed MPDUs or */
45 /* Transmitting a VHT NDP intended for multiple recipients */
46 if (MacAddr_isBcst(RA) || MacAddr_isMulticast(RA) || p_tcb->macId == MAC_ID_STATIC_FOR_BROADCAST_MULTICAST) {
49 } else if (ACTING_AS_AP(adapter)) {
50 u16 AID = (u16)(MacIdGetOwnerAssociatedClientAID(adapter, p_tcb->macId) & 0x1ff); /*AID[0:8]*/
52 /*RT_DISP(FBEAM, FBEAM_FUN, ("@%s p_tcb->mac_id=0x%X, AID=0x%X\n", __func__, p_tcb->mac_id, AID));*/
55 if (AID == 0) /*A PPDU sent by an AP to a non associated STA*/
57 else { /*Sent by an AP and addressed to a STA associated with that AP*/
59 GET_80211_HDR_ADDRESS2(p_header, &RA);
60 BSSID = ((RA[5] & 0xf0) >> 4) ^ (RA[5] & 0xf); /*BSSID[44:47] xor BSSID[40:43]*/
61 p_tcb->P_AID = (AID + BSSID * 32) & 0x1ff; /*(dec(A) + dec(B)*32) mod 512*/
63 } else if (ACTING_AS_IBSS(adapter)) {
65 /*P_AID for infrasturcture mode; MACID for ad-hoc mode. */
66 p_tcb->P_AID = p_tcb->macId;
67 } else if (MgntLinkStatusQuery(adapter)) { /*Addressed to AP*/
69 GET_80211_HDR_ADDRESS1(p_header, &RA);
70 p_tcb->P_AID = RA[5]; /*RA[39:47]*/
71 p_tcb->P_AID = (p_tcb->P_AID << 1) | (RA[4] >> 7);
76 /*RT_DISP(FBEAM, FBEAM_FUN, ("[David]@%s End, G_ID=0x%X, P_AID=0x%X\n", __func__, p_tcb->G_ID, p_tcb->P_AID));*/
82 beamforming_get_report_frame(
83 struct _ADAPTER *adapter,
85 POCTET_STRING p_pdu_os
88 HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter);
89 struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc;
90 struct _RT_BEAMFORMEE_ENTRY *p_beamform_entry = NULL;
91 u8 *p_mimo_ctrl_field, p_csi_report, p_csi_matrix;
93 u16 csi_matrix_len = 0;
95 ACT_PKT_TYPE pkt_type = ACT_PKT_TYPE_UNKNOWN;
97 /* Memory comparison to see if CSI report is the same with previous one */
98 p_beamform_entry = phydm_beamforming_get_bfee_entry_by_addr(p_dm_odm, Frame_Addr2(*p_pdu_os), &idx);
100 if (p_beamform_entry == NULL) {
101 ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("beamforming_get_report_frame: Cannot find entry by addr\n"));
102 return RT_STATUS_FAILURE;
105 pkt_type = PacketGetActionFrameType(p_pdu_os);
107 /* -@ Modified by David */
108 if (pkt_type == ACT_PKT_VHT_COMPRESSED_BEAMFORMING) {
109 p_mimo_ctrl_field = p_pdu_os->Octet + 26;
110 nc = ((*p_mimo_ctrl_field) & 0x7) + 1;
111 nr = (((*p_mimo_ctrl_field) & 0x38) >> 3) + 1;
112 CH_W = (((*p_mimo_ctrl_field) & 0xC0) >> 6);
113 /*p_csi_matrix = p_mimo_ctrl_field + 3 + nc;*/ /* 24+(1+1+3)+2 MAC header+(Category+ActionCode+MIMOControlField) +SNR(nc=2) */
114 csi_matrix_len = p_pdu_os->Length - 26 - 3 - nc;
115 } else if (pkt_type == ACT_PKT_HT_COMPRESSED_BEAMFORMING) {
116 p_mimo_ctrl_field = p_pdu_os->Octet + 26;
117 nc = ((*p_mimo_ctrl_field) & 0x3) + 1;
118 nr = (((*p_mimo_ctrl_field) & 0xC) >> 2) + 1;
119 CH_W = (((*p_mimo_ctrl_field) & 0x10) >> 4);
120 /*p_csi_matrix = p_mimo_ctrl_field + 6 + nr;*/ /* 24+(1+1+6)+2 MAC header+(Category+ActionCode+MIMOControlField) +SNR(nc=2) */
121 csi_matrix_len = p_pdu_os->Length - 26 - 6 - nr;
123 return RT_STATUS_SUCCESS;
125 ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] idx=%d, pkt type=%d, nc=%d, nr=%d, CH_W=%d\n", __func__, idx, pkt_type, nc, nr, CH_W));
127 return RT_STATUS_SUCCESS;
132 construct_ht_ndpa_packet(
133 struct _ADAPTER *adapter,
141 PMGNT_INFO p_mgnt_info = &(adapter->MgntInfo);
142 OCTET_STRING p_ndpa_frame, action_content;
143 u8 action_hdr[4] = {ACT_CAT_VENDOR, 0x00, 0xe0, 0x4c};
145 PlatformZeroMemory(buffer, 32);
147 SET_80211_HDR_FRAME_CONTROL(buffer, 0);
149 SET_80211_HDR_ORDER(buffer, 1);
150 SET_80211_HDR_TYPE_AND_SUBTYPE(buffer, Type_Action_No_Ack);
152 SET_80211_HDR_ADDRESS1(buffer, RA);
153 SET_80211_HDR_ADDRESS2(buffer, adapter->CurrentAddress);
154 SET_80211_HDR_ADDRESS3(buffer, p_mgnt_info->Bssid);
156 duration = 2 * a_SifsTime + 40;
158 if (BW == CHANNEL_WIDTH_40)
163 SET_80211_HDR_DURATION(buffer, duration);
165 /* HT control field */
166 SET_HT_CTRL_CSI_STEERING(buffer + sMacHdrLng, 3);
167 SET_HT_CTRL_NDP_ANNOUNCEMENT(buffer + sMacHdrLng, 1);
169 FillOctetString(p_ndpa_frame, buffer, sMacHdrLng + sHTCLng);
171 FillOctetString(action_content, action_hdr, 4);
172 PacketAppendData(&p_ndpa_frame, action_content);
181 send_fw_ht_ndpa_packet(
187 struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void;
188 struct _ADAPTER *adapter = p_dm_odm->adapter;
190 PRT_TX_LOCAL_BUFFER p_buf;
194 u8 desc_len = 0, idx = 0, ndp_tx_rate;
195 struct _ADAPTER *p_def_adapter = GetDefaultAdapter(adapter);
196 struct _RT_BEAMFORMING_INFO *p_beam_info = &p_dm_odm->beamforming_info;
197 HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter);
198 struct _RT_BEAMFORMEE_ENTRY *p_beamform_entry = phydm_beamforming_get_bfee_entry_by_addr(p_dm_odm, RA, &idx);
200 ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__));
202 if (p_beamform_entry == NULL)
205 ndp_tx_rate = beamforming_get_htndp_tx_rate(p_dm_odm, p_beamform_entry->comp_steering_num_of_bfer);
206 ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] ndp_tx_rate =%d\n", __func__, ndp_tx_rate));
207 PlatformAcquireSpinLock(adapter, RT_TX_SPINLOCK);
209 if (MgntGetFWBuffer(p_def_adapter, &p_tcb, &p_buf)) {
210 #if (DEV_BUS_TYPE != RT_PCI_INTERFACE)
211 desc_len = adapter->HWDescHeadLength - p_hal_data->USBALLDummyLength;
213 buf_addr = p_buf->Buffer.VirtualAddress + desc_len;
215 construct_ht_ndpa_packet(
223 p_tcb->PacketLength = buf_len + desc_len;
225 p_tcb->bTxEnableSwCalcDur = true;
227 p_tcb->BWOfPacket = BW;
229 if (ACTING_AS_IBSS(adapter) || ACTING_AS_AP(adapter))
232 p_tcb->P_AID = p_beamform_entry->p_aid;
233 p_tcb->DataRate = ndp_tx_rate; /*rate of NDP decide by nr*/
235 adapter->HalFunc.CmdSendPacketHandler(adapter, p_tcb, p_buf, p_tcb->PacketLength, DESC_PACKET_TYPE_NORMAL, false);
239 PlatformReleaseSpinLock(adapter, RT_TX_SPINLOCK);
242 RT_DISP_DATA(FBEAM, FBEAM_DATA, "", p_buf->Buffer.VirtualAddress, p_tcb->PacketLength);
249 send_sw_ht_ndpa_packet(
255 struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void;
256 struct _ADAPTER *adapter = p_dm_odm->adapter;
258 PRT_TX_LOCAL_BUFFER p_buf;
260 u8 idx = 0, ndp_tx_rate = 0;
261 struct _RT_BEAMFORMING_INFO *p_beam_info = &p_dm_odm->beamforming_info;
262 struct _RT_BEAMFORMEE_ENTRY *p_beamform_entry = phydm_beamforming_get_bfee_entry_by_addr(p_dm_odm, RA, &idx);
264 ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__));
266 ndp_tx_rate = beamforming_get_htndp_tx_rate(p_dm_odm, p_beamform_entry->comp_steering_num_of_bfer);
267 ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] ndp_tx_rate =%d\n", __func__, ndp_tx_rate));
269 PlatformAcquireSpinLock(adapter, RT_TX_SPINLOCK);
271 if (MgntGetBuffer(adapter, &p_tcb, &p_buf)) {
272 construct_ht_ndpa_packet(
275 p_buf->Buffer.VirtualAddress,
276 &p_tcb->PacketLength,
280 p_tcb->bTxEnableSwCalcDur = true;
282 p_tcb->BWOfPacket = BW;
284 MgntSendPacket(adapter, p_tcb, p_buf, p_tcb->PacketLength, NORMAL_QUEUE, ndp_tx_rate);
288 PlatformReleaseSpinLock(adapter, RT_TX_SPINLOCK);
291 RT_DISP_DATA(FBEAM, FBEAM_DATA, "", p_buf->Buffer.VirtualAddress, p_tcb->PacketLength);
299 construct_vht_ndpa_packet(
300 struct PHY_DM_STRUCT *p_dm_odm,
310 u8 *p_ndpa_frame = buffer;
311 struct _RT_NDPA_STA_INFO sta_info;
312 struct _ADAPTER *adapter = p_dm_odm->adapter;
314 struct _RT_BEAMFORMEE_ENTRY *p_beamform_entry = phydm_beamforming_get_bfee_entry_by_addr(p_dm_odm, RA, &idx);
316 SET_80211_HDR_FRAME_CONTROL(p_ndpa_frame, 0);
317 SET_80211_HDR_TYPE_AND_SUBTYPE(p_ndpa_frame, Type_NDPA);
319 SET_80211_HDR_ADDRESS1(p_ndpa_frame, RA);
320 SET_80211_HDR_ADDRESS2(p_ndpa_frame, p_beamform_entry->my_mac_addr);
322 duration = 2 * a_SifsTime + 44;
324 if (BW == CHANNEL_WIDTH_80)
326 else if (BW == CHANNEL_WIDTH_40)
331 SET_80211_HDR_DURATION(p_ndpa_frame, duration);
333 sequence = *(p_dm_odm->p_sounding_seq) << 2;
334 odm_move_memory(p_dm_odm, p_ndpa_frame + 16, &sequence, 1);
336 if (phydm_acting_determine(p_dm_odm, phydm_acting_as_ibss) || phydm_acting_determine(p_dm_odm, phydm_acting_as_ap) == false)
340 sta_info.feedback_type = 0;
341 sta_info.nc_index = 0;
343 odm_move_memory(p_dm_odm, p_ndpa_frame + 17, (u8 *)&sta_info, 2);
350 send_fw_vht_ndpa_packet(
357 struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void;
358 struct _ADAPTER *adapter = p_dm_odm->adapter;
360 PRT_TX_LOCAL_BUFFER p_buf;
364 u8 desc_len = 0, idx = 0, ndp_tx_rate = 0;
365 struct _ADAPTER *p_def_adapter = GetDefaultAdapter(adapter);
366 struct _RT_BEAMFORMING_INFO *p_beam_info = &p_dm_odm->beamforming_info;
367 HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter);
368 struct _RT_BEAMFORMEE_ENTRY *p_beamform_entry = phydm_beamforming_get_bfee_entry_by_addr(p_dm_odm, RA, &idx);
370 ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__));
372 if (p_beamform_entry == NULL)
375 ndp_tx_rate = beamforming_get_vht_ndp_tx_rate(p_dm_odm, p_beamform_entry->comp_steering_num_of_bfer);
376 ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] ndp_tx_rate =%d\n", __func__, ndp_tx_rate));
378 PlatformAcquireSpinLock(adapter, RT_TX_SPINLOCK);
380 if (MgntGetFWBuffer(p_def_adapter, &p_tcb, &p_buf)) {
381 #if (DEV_BUS_TYPE != RT_PCI_INTERFACE)
382 desc_len = adapter->HWDescHeadLength - p_hal_data->USBALLDummyLength;
384 buf_addr = p_buf->Buffer.VirtualAddress + desc_len;
386 construct_vht_ndpa_packet(
395 p_tcb->PacketLength = buf_len + desc_len;
397 p_tcb->bTxEnableSwCalcDur = true;
399 p_tcb->BWOfPacket = BW;
401 if (phydm_acting_determine(p_dm_odm, phydm_acting_as_ibss) || phydm_acting_determine(p_dm_odm, phydm_acting_as_ap))
404 p_tcb->P_AID = p_beamform_entry->p_aid;
405 p_tcb->DataRate = ndp_tx_rate; /*decide by nr*/
407 adapter->HalFunc.CmdSendPacketHandler(adapter, p_tcb, p_buf, p_tcb->PacketLength, DESC_PACKET_TYPE_NORMAL, false);
411 PlatformReleaseSpinLock(adapter, RT_TX_SPINLOCK);
413 ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] End, ret=%d\n", __func__, ret));
416 RT_DISP_DATA(FBEAM, FBEAM_DATA, "", p_buf->Buffer.VirtualAddress, p_tcb->PacketLength);
424 send_sw_vht_ndpa_packet(
431 struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void;
432 struct _ADAPTER *adapter = p_dm_odm->adapter;
434 PRT_TX_LOCAL_BUFFER p_buf;
436 u8 idx = 0, ndp_tx_rate = 0;
437 struct _RT_BEAMFORMING_INFO *p_beam_info = &(p_dm_odm->beamforming_info);
438 struct _RT_BEAMFORMEE_ENTRY *p_beamform_entry = phydm_beamforming_get_bfee_entry_by_addr(p_dm_odm, RA, &idx);
440 ndp_tx_rate = beamforming_get_vht_ndp_tx_rate(p_dm_odm, p_beamform_entry->comp_steering_num_of_bfer);
441 ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] ndp_tx_rate =%d\n", __func__, ndp_tx_rate));
443 PlatformAcquireSpinLock(adapter, RT_TX_SPINLOCK);
445 if (MgntGetBuffer(adapter, &p_tcb, &p_buf)) {
446 construct_vht_ndpa_packet(
450 p_buf->Buffer.VirtualAddress,
451 &p_tcb->PacketLength,
455 p_tcb->bTxEnableSwCalcDur = true;
456 p_tcb->BWOfPacket = BW;
458 /*rate of NDP decide by nr*/
459 MgntSendPacket(adapter, p_tcb, p_buf, p_tcb->PacketLength, NORMAL_QUEUE, ndp_tx_rate);
463 PlatformReleaseSpinLock(adapter, RT_TX_SPINLOCK);
466 RT_DISP_DATA(FBEAM, FBEAM_DATA, "", p_buf->Buffer.VirtualAddress, p_tcb->PacketLength);
472 #if (SUPPORT_MU_BF == 1)
474 * Description: On VHT GID management frame by an MU beamformee.
476 * 2015.05.20. Created by tynli.
479 beamforming_get_vht_gid_mgnt_frame(
480 struct _ADAPTER *adapter,
482 POCTET_STRING p_pdu_os
485 HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter);
486 struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc;
487 enum rt_status rt_status = RT_STATUS_SUCCESS;
490 u8 mem_status[8] = {0}, user_pos[16] = {0};
492 struct _RT_BEAMFORMING_INFO *p_beam_info = &(p_dm_odm->beamforming_info);
493 struct _RT_BEAMFORMER_ENTRY *p_beamform_entry = &p_beam_info->beamformer_entry[p_beam_info->mu_ap_index];
495 ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] On VHT GID mgnt frame!\n", __func__));
498 if (p_pdu_os->length < (FRAME_OFFSET_VHT_GID_MGNT_USER_POSITION_ARRAY + 16)) {
499 ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("beamforming_get_vht_gid_mgnt_frame(): Invalid length (%d)\n", p_pdu_os->length));
500 return RT_STATUS_INVALID_LENGTH;
504 p_raddr = (u8 *)(p_pdu_os->Octet) + 4;
505 if (!eq_mac_addr(p_raddr, adapter->CurrentAddress)) {
506 ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("beamforming_get_vht_gid_mgnt_frame(): Drop because of RA error.\n"));
507 return RT_STATUS_PKT_DROP;
510 RT_DISP_DATA(FBEAM, FBEAM_DATA, "On VHT GID Mgnt Frame ==>:\n", p_pdu_os->Octet, p_pdu_os->length);
512 /*Parsing Membership status array*/
513 p_buffer = p_pdu_os->Octet + FRAME_OFFSET_VHT_GID_MGNT_MEMBERSHIP_STATUS_ARRAY;
514 for (idx = 0; idx < 8; idx++) {
515 mem_status[idx] = GET_VHT_GID_MGNT_INFO_MEMBERSHIP_STATUS(p_buffer + idx);
516 p_beamform_entry->gid_valid[idx] = GET_VHT_GID_MGNT_INFO_MEMBERSHIP_STATUS(p_buffer + idx);
519 RT_DISP_DATA(FBEAM, FBEAM_DATA, "mem_status: ", mem_status, 8);
521 /* Parsing User Position array*/
522 p_buffer = p_pdu_os->Octet + FRAME_OFFSET_VHT_GID_MGNT_USER_POSITION_ARRAY;
523 for (idx = 0; idx < 16; idx++) {
524 user_pos[idx] = GET_VHT_GID_MGNT_INFO_USER_POSITION(p_buffer + idx);
525 p_beamform_entry->user_position[idx] = GET_VHT_GID_MGNT_INFO_USER_POSITION(p_buffer + idx);
528 RT_DISP_DATA(FBEAM, FBEAM_DATA, "user_pos: ", user_pos, 16);
530 /* Group ID detail printed*/
536 for (i = 0; i < 8; i++) {
537 tmp_val = mem_status[i];
538 tmp_val2 = ((user_pos[i * 2 + 1] << 8) & 0xFF00) + (user_pos[i * 2] & 0xFF);
539 for (j = 0; j < 8; j++) {
540 if ((tmp_val >> j) & BIT(0)) {
541 ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("Use Group ID (%d), User Position (%d)\n",
542 (i * 8 + j), (tmp_val2 >> 2 * j) & 0x3));
548 /* Indicate GID frame to IHV service. */
550 u8 indibuffer[24] = {0};
553 PlatformMoveMemory(indibuffer + indioffset, p_beamform_entry->gid_valid, 8);
555 PlatformMoveMemory(indibuffer + indioffset, p_beamform_entry->user_position, 16);
558 PlatformIndicateCustomStatus(
560 RT_CUSTOM_EVENT_VHT_RECV_GID_MGNT_FRAME,
561 RT_CUSTOM_INDI_TARGET_IHV,
566 /* Config HW GID table */
567 hal_com_txbf_config_gtab(p_dm_odm);
573 * Description: Construct VHT Group ID (GID) management frame.
575 * 2015.05.20. Created by tynli.
578 construct_vht_gid_mgnt_frame(
579 struct PHY_DM_STRUCT *p_dm_odm,
581 struct _RT_BEAMFORMEE_ENTRY *p_beamform_entry,
587 struct _RT_BEAMFORMING_INFO *p_beam_info = &(p_dm_odm->beamforming_info);
588 struct _ADAPTER *adapter = p_beam_info->source_adapter;
589 OCTET_STRING os_ftm_frame, tmp;
591 FillOctetString(os_ftm_frame, buffer, 0);
598 ACT_VHT_GROUPID_MANAGEMENT,
601 /* Membership status array*/
602 FillOctetString(tmp, p_beamform_entry->gid_valid, 8);
603 PacketAppendData(&os_ftm_frame, tmp);
605 /* User Position array*/
606 FillOctetString(tmp, p_beamform_entry->user_position, 16);
607 PacketAppendData(&os_ftm_frame, tmp);
609 *p_length = os_ftm_frame.length;
611 RT_DISP_DATA(FBEAM, FBEAM_DATA, "construct_vht_gid_mgnt_frame():\n", buffer, *p_length);
615 send_sw_vht_gid_mgnt_frame(
621 struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void;
623 PRT_TX_LOCAL_BUFFER p_buf;
626 struct _RT_BEAMFORMING_INFO *p_beam_info = &(p_dm_odm->beamforming_info);
627 struct _RT_BEAMFORMEE_ENTRY *p_beamform_entry = &p_beam_info->beamformee_entry[idx];
628 struct _ADAPTER *adapter = p_beam_info->source_adapter;
630 ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__));
632 PlatformAcquireSpinLock(adapter, RT_TX_SPINLOCK);
634 if (MgntGetBuffer(adapter, &p_tcb, &p_buf)) {
635 construct_vht_gid_mgnt_frame(
639 p_buf->Buffer.VirtualAddress,
643 p_tcb->bw_of_packet = CHANNEL_WIDTH_20;
645 MgntSendPacket(adapter, p_tcb, p_buf, p_tcb->PacketLength, NORMAL_QUEUE, data_rate);
649 PlatformReleaseSpinLock(adapter, RT_TX_SPINLOCK);
652 RT_DISP_DATA(FBEAM, FBEAM_DATA, "", p_buf->Buffer.VirtualAddress, p_tcb->PacketLength);
659 * Description: Construct VHT beamforming report poll.
661 * 2015.05.20. Created by tynli.
664 construct_vht_bf_report_poll(
665 struct PHY_DM_STRUCT *p_dm_odm,
671 struct _RT_BEAMFORMING_INFO *p_beam_info = &(p_dm_odm->beamforming_info);
672 struct _ADAPTER *adapter = p_beam_info->source_adapter;
673 u8 *p_bf_rpt_poll = buffer;
676 SET_80211_HDR_FRAME_CONTROL(p_bf_rpt_poll, 0);
677 SET_80211_HDR_TYPE_AND_SUBTYPE(p_bf_rpt_poll, Type_Beamforming_Report_Poll);
680 SET_80211_HDR_DURATION(p_bf_rpt_poll, 100);
683 SET_VHT_BF_REPORT_POLL_RA(p_bf_rpt_poll, RA);
686 SET_VHT_BF_REPORT_POLL_TA(p_bf_rpt_poll, adapter->CurrentAddress);
688 /* Feedback Segment Retransmission Bitmap*/
689 SET_VHT_BF_REPORT_POLL_FEEDBACK_SEG_RETRAN_BITMAP(p_bf_rpt_poll, 0xFF);
693 RT_DISP_DATA(FBEAM, FBEAM_DATA, "construct_vht_bf_report_poll():\n", buffer, *p_length);
698 send_sw_vht_bf_report_poll(
701 boolean is_final_poll
704 struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void;
706 PRT_TX_LOCAL_BUFFER p_buf;
708 u8 idx = 0, data_rate = 0;
709 struct _RT_BEAMFORMING_INFO *p_beam_info = &(p_dm_odm->beamforming_info);
710 struct _RT_BEAMFORMEE_ENTRY *p_beamform_entry = phydm_beamforming_get_bfee_entry_by_addr(p_dm_odm, RA, &idx);
711 struct _ADAPTER *adapter = p_beam_info->source_adapter;
713 ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__));
715 PlatformAcquireSpinLock(adapter, RT_TX_SPINLOCK);
717 if (MgntGetBuffer(adapter, &p_tcb, &p_buf)) {
718 construct_vht_bf_report_poll(
721 p_buf->Buffer.VirtualAddress,
725 p_tcb->bTxEnableSwCalcDur = true; /* <tynli_note> need?*/
726 p_tcb->BWOfPacket = CHANNEL_WIDTH_20;
729 p_tcb->TxBFPktType = RT_BF_PKT_TYPE_FINAL_BF_REPORT_POLL;
731 p_tcb->TxBFPktType = RT_BF_PKT_TYPE_BF_REPORT_POLL;
733 data_rate = MGN_6M; /* Legacy OFDM rate*/
734 MgntSendPacket(adapter, p_tcb, p_buf, p_tcb->PacketLength, NORMAL_QUEUE, data_rate);
738 PlatformReleaseSpinLock(adapter, RT_TX_SPINLOCK);
741 RT_DISP_DATA(FBEAM, FBEAM_DATA, "send_sw_vht_bf_report_poll():\n", p_buf->Buffer.VirtualAddress, p_tcb->PacketLength);
749 * Description: Construct VHT MU NDPA packet.
750 * <Note> We should combine this function with construct_vht_ndpa_packet() in the future.
752 * 2015.05.21. Created by tynli.
755 construct_vht_mu_ndpa_packet(
756 struct PHY_DM_STRUCT *p_dm_odm,
762 struct _RT_BEAMFORMING_INFO *p_beam_info = &(p_dm_odm->beamforming_info);
763 struct _ADAPTER *adapter = p_beam_info->source_adapter;
766 u8 *p_ndpa_frame = buffer;
767 struct _RT_NDPA_STA_INFO sta_info;
769 u8 dest_addr[6] = {0};
770 struct _RT_BEAMFORMEE_ENTRY *p_entry = NULL;
772 /* Fill the first MU BFee entry (STA1) MAC addr to destination address then
773 HW will change A1 to broadcast addr. 2015.05.28. Suggested by SD1 Chunchu. */
774 for (idx = 0; idx < BEAMFORMEE_ENTRY_NUM; idx++) {
775 p_entry = &(p_beam_info->beamformee_entry[idx]);
776 if (p_entry->is_mu_sta) {
777 cp_mac_addr(dest_addr, p_entry->mac_addr);
785 SET_80211_HDR_FRAME_CONTROL(p_ndpa_frame, 0);
786 SET_80211_HDR_TYPE_AND_SUBTYPE(p_ndpa_frame, Type_NDPA);
788 SET_80211_HDR_ADDRESS1(p_ndpa_frame, dest_addr);
789 SET_80211_HDR_ADDRESS2(p_ndpa_frame, p_entry->my_mac_addr);
791 /*--------------------------------------------*/
792 /* <Note> Need to modify "duration" to MU consideration. */
793 duration = 2 * a_SifsTime + 44;
795 if (BW == CHANNEL_WIDTH_80)
797 else if (BW == CHANNEL_WIDTH_40)
801 /*--------------------------------------------*/
803 SET_80211_HDR_DURATION(p_ndpa_frame, duration);
805 sequence = *(p_dm_odm->p_sounding_seq) << 2;
806 odm_move_memory(p_dm_odm, p_ndpa_frame + 16, &sequence, 1);
810 /* Construct STA info. for multiple STAs*/
811 for (idx = 0; idx < BEAMFORMEE_ENTRY_NUM; idx++) {
812 p_entry = &(p_beam_info->beamformee_entry[idx]);
813 if (p_entry->is_mu_sta) {
814 sta_info.aid = p_entry->AID;
815 sta_info.feedback_type = 1; /* 1'b1: MU*/
816 sta_info.nc_index = 0;
818 ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Get beamformee_entry idx(%d), AID =%d\n", __func__, idx, p_entry->AID));
820 odm_move_memory(p_dm_odm, p_ndpa_frame + (*p_length), (u8 *)&sta_info, 2);
828 send_sw_vht_mu_ndpa_packet(
833 struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void;
835 PRT_TX_LOCAL_BUFFER p_buf;
838 struct _RT_BEAMFORMING_INFO *p_beam_info = &(p_dm_odm->beamforming_info);
839 struct _ADAPTER *adapter = p_beam_info->source_adapter;
841 ndp_tx_rate = MGN_VHT2SS_MCS0;
842 ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] ndp_tx_rate =%d\n", __func__, ndp_tx_rate));
844 PlatformAcquireSpinLock(adapter, RT_TX_SPINLOCK);
846 if (MgntGetBuffer(adapter, &p_tcb, &p_buf)) {
847 construct_vht_mu_ndpa_packet(
850 p_buf->Buffer.VirtualAddress,
854 p_tcb->bTxEnableSwCalcDur = true;
855 p_tcb->BWOfPacket = BW;
856 p_tcb->TxBFPktType = RT_BF_PKT_TYPE_BROADCAST_NDPA;
858 /*rate of NDP decide by nr*/
859 MgntSendPacket(adapter, p_tcb, p_buf, p_tcb->PacketLength, NORMAL_QUEUE, ndp_tx_rate);
863 PlatformReleaseSpinLock(adapter, RT_TX_SPINLOCK);
866 RT_DISP_DATA(FBEAM, FBEAM_DATA, "", p_buf->Buffer.VirtualAddress, p_tcb->PacketLength);
873 dbg_construct_vht_mundpa_packet(
874 struct PHY_DM_STRUCT *p_dm_odm,
880 struct _RT_BEAMFORMING_INFO *p_beam_info = &(p_dm_odm->beamforming_info);
881 struct _ADAPTER *adapter = p_beam_info->source_adapter;
884 u8 *p_ndpa_frame = buffer;
885 struct _RT_NDPA_STA_INFO sta_info;
887 u8 dest_addr[6] = {0};
888 struct _RT_BEAMFORMEE_ENTRY *p_entry = NULL;
890 boolean is_STA1 = false;
893 /* Fill the first MU BFee entry (STA1) MAC addr to destination address then
894 HW will change A1 to broadcast addr. 2015.05.28. Suggested by SD1 Chunchu. */
895 for (idx = 0; idx < BEAMFORMEE_ENTRY_NUM; idx++) {
896 p_entry = &(p_beam_info->beamformee_entry[idx]);
897 if (p_entry->is_mu_sta) {
898 if (is_STA1 == false) {
902 cp_mac_addr(dest_addr, p_entry->mac_addr);
909 SET_80211_HDR_FRAME_CONTROL(p_ndpa_frame, 0);
910 SET_80211_HDR_TYPE_AND_SUBTYPE(p_ndpa_frame, Type_NDPA);
912 SET_80211_HDR_ADDRESS1(p_ndpa_frame, dest_addr);
913 SET_80211_HDR_ADDRESS2(p_ndpa_frame, p_dm_odm->CurrentAddress);
915 /*--------------------------------------------*/
916 /* <Note> Need to modify "duration" to MU consideration. */
917 duration = 2 * a_SifsTime + 44;
919 if (BW == CHANNEL_WIDTH_80)
921 else if (BW == CHANNEL_WIDTH_40)
925 /*--------------------------------------------*/
927 SET_80211_HDR_DURATION(p_ndpa_frame, duration);
929 sequence = *(p_dm_odm->p_sounding_seq) << 2;
930 odm_move_memory(p_dm_odm, p_ndpa_frame + 16, &sequence, 1);
935 sta_info.aid = p_entry->aid;
936 sta_info.feedback_type = 1; /* 1'b1: MU */
937 sta_info.nc_index = 0;
939 ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Get beamformee_entry idx(%d), AID =%d\n", __func__, idx, p_entry->aid));
941 odm_move_memory(p_dm_odm, p_ndpa_frame + (*p_length), (u8 *)&sta_info, 2);
947 dbg_send_sw_vht_mundpa_packet(
952 struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void;
954 PRT_TX_LOCAL_BUFFER p_buf;
957 struct _RT_BEAMFORMING_INFO *p_beam_info = &(p_dm_odm->beamforming_info);
958 struct _ADAPTER *adapter = p_beam_info->source_adapter;
960 ndp_tx_rate = MGN_VHT2SS_MCS0;
961 ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] ndp_tx_rate =%d\n", __func__, ndp_tx_rate));
963 PlatformAcquireSpinLock(adapter, RT_TX_SPINLOCK);
965 if (MgntGetBuffer(adapter, &p_tcb, &p_buf)) {
966 dbg_construct_vht_mundpa_packet(
969 p_buf->Buffer.VirtualAddress,
973 p_tcb->bTxEnableSwCalcDur = true;
974 p_tcb->BWOfPacket = BW;
975 p_tcb->TxBFPktType = RT_BF_PKT_TYPE_UNICAST_NDPA;
977 /*rate of NDP decide by nr*/
978 MgntSendPacket(adapter, p_tcb, p_buf, p_tcb->PacketLength, NORMAL_QUEUE, ndp_tx_rate);
982 PlatformReleaseSpinLock(adapter, RT_TX_SPINLOCK);
985 RT_DISP_DATA(FBEAM, FBEAM_DATA, "", p_buf->Buffer.VirtualAddress, p_tcb->PacketLength);
991 #endif /*#if (SUPPORT_MU_BF == 1)*/
992 #endif /*#ifdef SUPPORT_MU_BF*/
995 #elif (DM_ODM_SUPPORT_TYPE == ODM_CE)
998 beamforming_get_report_frame(
1000 union recv_frame *precv_frame
1003 struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void;
1005 struct _RT_BEAMFORMEE_ENTRY *p_beamform_entry = NULL;
1006 u8 *pframe = precv_frame->u.hdr.rx_data;
1007 u32 frame_len = precv_frame->u.hdr.len;
1012 /*Memory comparison to see if CSI report is the same with previous one*/
1013 TA = get_addr2_ptr(pframe);
1014 p_beamform_entry = phydm_beamforming_get_bfee_entry_by_addr(p_dm_odm, TA, &idx);
1015 if (p_beamform_entry->beamform_entry_cap & BEAMFORMER_CAP_VHT_SU)
1016 offset = 31; /*24+(1+1+3)+2 MAC header+(Category+ActionCode+MIMOControlField)+SNR(nc=2)*/
1017 else if (p_beamform_entry->beamform_entry_cap & BEAMFORMER_CAP_HT_EXPLICIT)
1018 offset = 34; /*24+(1+1+6)+2 MAC header+(Category+ActionCode+MIMOControlField)+SNR(nc=2)*/
1028 send_fw_ht_ndpa_packet(
1034 struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void;
1035 struct _ADAPTER *adapter = p_dm_odm->adapter;
1036 struct xmit_frame *pmgntframe;
1037 struct pkt_attrib *pattrib;
1038 struct rtw_ieee80211_hdr *pwlanhdr;
1039 struct xmit_priv *pxmitpriv = &(adapter->xmitpriv);
1040 struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv;
1041 struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info);
1042 u8 action_hdr[4] = {ACT_CAT_VENDOR, 0x00, 0xe0, 0x4c};
1046 u8 a_sifs_time = 0, ndp_tx_rate = 0, idx = 0;
1047 struct _RT_BEAMFORMING_INFO *p_beam_info = &(p_dm_odm->beamforming_info);
1048 struct _RT_BEAMFORMEE_ENTRY *p_beamform_entry = phydm_beamforming_get_bfee_entry_by_addr(p_dm_odm, RA, &idx);
1050 pmgntframe = alloc_mgtxmitframe(pxmitpriv);
1052 if (pmgntframe == NULL) {
1053 ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s, alloc mgnt frame fail\n", __func__));
1057 /* update attribute */
1058 pattrib = &pmgntframe->attrib;
1059 update_mgntframe_attrib(adapter, pattrib);
1061 pattrib->qsel = QSLT_BEACON;
1062 ndp_tx_rate = beamforming_get_htndp_tx_rate(p_dm_odm, p_beamform_entry->comp_steering_num_of_bfer);
1063 ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] ndp_tx_rate =%d\n", __func__, ndp_tx_rate));
1064 pattrib->rate = ndp_tx_rate;
1065 pattrib->bwmode = BW;
1067 pattrib->subtype = WIFI_ACTION_NOACK;
1069 _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET);
1071 pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET;
1073 pwlanhdr = (struct rtw_ieee80211_hdr *)pframe;
1075 fctrl = &pwlanhdr->frame_ctl;
1078 set_order_bit(pframe);
1079 set_frame_sub_type(pframe, WIFI_ACTION_NOACK);
1081 _rtw_memcpy(pwlanhdr->addr1, RA, ETH_ALEN);
1082 _rtw_memcpy(pwlanhdr->addr2, p_beamform_entry->my_mac_addr, ETH_ALEN);
1083 _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN);
1085 if (pmlmeext->cur_wireless_mode == WIRELESS_11B)
1090 duration = 2 * a_sifs_time + 40;
1092 if (BW == CHANNEL_WIDTH_40)
1097 set_duration(pframe, duration);
1099 /* HT control field */
1100 SET_HT_CTRL_CSI_STEERING(pframe + 24, 3);
1101 SET_HT_CTRL_NDP_ANNOUNCEMENT(pframe + 24, 1);
1103 _rtw_memcpy(pframe + 28, action_hdr, 4);
1105 pattrib->pktlen = 32;
1107 pattrib->last_txcmdsz = pattrib->pktlen;
1109 dump_mgntframe(adapter, pmgntframe);
1116 send_sw_ht_ndpa_packet(
1122 struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void;
1123 struct _ADAPTER *adapter = p_dm_odm->adapter;
1124 struct xmit_frame *pmgntframe;
1125 struct pkt_attrib *pattrib;
1126 struct rtw_ieee80211_hdr *pwlanhdr;
1127 struct xmit_priv *pxmitpriv = &(adapter->xmitpriv);
1128 struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv;
1129 struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info);
1130 u8 action_hdr[4] = {ACT_CAT_VENDOR, 0x00, 0xe0, 0x4c};
1134 u8 a_sifs_time = 0, ndp_tx_rate = 0, idx = 0;
1135 struct _RT_BEAMFORMING_INFO *p_beam_info = &(p_dm_odm->beamforming_info);
1136 struct _RT_BEAMFORMEE_ENTRY *p_beamform_entry = phydm_beamforming_get_bfee_entry_by_addr(p_dm_odm, RA, &idx);
1138 ndp_tx_rate = beamforming_get_htndp_tx_rate(p_dm_odm, p_beamform_entry->comp_steering_num_of_bfer);
1140 pmgntframe = alloc_mgtxmitframe(pxmitpriv);
1142 if (pmgntframe == NULL) {
1143 ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s, alloc mgnt frame fail\n", __func__));
1147 /*update attribute*/
1148 pattrib = &pmgntframe->attrib;
1149 update_mgntframe_attrib(adapter, pattrib);
1150 pattrib->qsel = QSLT_MGNT;
1151 pattrib->rate = ndp_tx_rate;
1152 pattrib->bwmode = BW;
1154 pattrib->subtype = WIFI_ACTION_NOACK;
1156 _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET);
1158 pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET;
1160 pwlanhdr = (struct rtw_ieee80211_hdr *)pframe;
1162 fctrl = &pwlanhdr->frame_ctl;
1165 set_order_bit(pframe);
1166 set_frame_sub_type(pframe, WIFI_ACTION_NOACK);
1168 _rtw_memcpy(pwlanhdr->addr1, RA, ETH_ALEN);
1169 _rtw_memcpy(pwlanhdr->addr2, p_beamform_entry->my_mac_addr, ETH_ALEN);
1170 _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN);
1172 if (pmlmeext->cur_wireless_mode == WIRELESS_11B)
1177 duration = 2 * a_sifs_time + 40;
1179 if (BW == CHANNEL_WIDTH_40)
1184 set_duration(pframe, duration);
1186 /*HT control field*/
1187 SET_HT_CTRL_CSI_STEERING(pframe + 24, 3);
1188 SET_HT_CTRL_NDP_ANNOUNCEMENT(pframe + 24, 1);
1190 _rtw_memcpy(pframe + 28, action_hdr, 4);
1192 pattrib->pktlen = 32;
1194 pattrib->last_txcmdsz = pattrib->pktlen;
1196 dump_mgntframe(adapter, pmgntframe);
1203 send_fw_vht_ndpa_packet(
1210 struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void;
1211 struct _ADAPTER *adapter = p_dm_odm->adapter;
1212 struct xmit_frame *pmgntframe;
1213 struct pkt_attrib *pattrib;
1214 struct rtw_ieee80211_hdr *pwlanhdr;
1215 struct xmit_priv *pxmitpriv = &(adapter->xmitpriv);
1216 struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv;
1217 struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info);
1218 struct mlme_priv *pmlmepriv = &(adapter->mlmepriv);
1222 u8 sequence = 0, a_sifs_time = 0, ndp_tx_rate = 0, idx = 0;
1223 struct _RT_BEAMFORMING_INFO *p_beam_info = &(p_dm_odm->beamforming_info);
1224 struct _RT_BEAMFORMEE_ENTRY *p_beamform_entry = phydm_beamforming_get_bfee_entry_by_addr(p_dm_odm, RA, &idx);
1225 struct _RT_NDPA_STA_INFO sta_info;
1227 pmgntframe = alloc_mgtxmitframe(pxmitpriv);
1229 if (pmgntframe == NULL) {
1230 ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s, alloc mgnt frame fail\n", __func__));
1234 /* update attribute */
1235 pattrib = &pmgntframe->attrib;
1236 _rtw_memcpy(pattrib->ra, RA, ETH_ALEN);
1237 update_mgntframe_attrib(adapter, pattrib);
1239 pattrib->qsel = QSLT_BEACON;
1240 ndp_tx_rate = beamforming_get_vht_ndp_tx_rate(p_dm_odm, p_beamform_entry->comp_steering_num_of_bfer);
1241 ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] ndp_tx_rate =%d\n", __func__, ndp_tx_rate));
1242 pattrib->rate = ndp_tx_rate;
1243 pattrib->bwmode = BW;
1244 pattrib->subtype = WIFI_NDPA;
1246 _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET);
1248 pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET;
1250 pwlanhdr = (struct rtw_ieee80211_hdr *)pframe;
1252 fctrl = &pwlanhdr->frame_ctl;
1255 set_frame_sub_type(pframe, WIFI_NDPA);
1257 _rtw_memcpy(pwlanhdr->addr1, RA, ETH_ALEN);
1258 _rtw_memcpy(pwlanhdr->addr2, p_beamform_entry->my_mac_addr, ETH_ALEN);
1260 if (is_supported_5g(pmlmeext->cur_wireless_mode) || is_supported_ht(pmlmeext->cur_wireless_mode))
1265 duration = 2 * a_sifs_time + 44;
1267 if (BW == CHANNEL_WIDTH_80)
1269 else if (BW == CHANNEL_WIDTH_40)
1274 set_duration(pframe, duration);
1276 sequence = p_beam_info->sounding_sequence << 2;
1277 if (p_beam_info->sounding_sequence >= 0x3f)
1278 p_beam_info->sounding_sequence = 0;
1280 p_beam_info->sounding_sequence++;
1282 _rtw_memcpy(pframe + 16, &sequence, 1);
1284 if (((pmlmeinfo->state & 0x03) == WIFI_FW_ADHOC_STATE) || ((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE))
1288 sta_info.feedback_type = 0;
1289 sta_info.nc_index = 0;
1291 _rtw_memcpy(pframe + 17, (u8 *)&sta_info, 2);
1293 pattrib->pktlen = 19;
1295 pattrib->last_txcmdsz = pattrib->pktlen;
1297 dump_mgntframe(adapter, pmgntframe);
1305 send_sw_vht_ndpa_packet(
1312 struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void;
1313 struct _ADAPTER *adapter = p_dm_odm->adapter;
1314 struct xmit_frame *pmgntframe;
1315 struct pkt_attrib *pattrib;
1316 struct rtw_ieee80211_hdr *pwlanhdr;
1317 struct xmit_priv *pxmitpriv = &(adapter->xmitpriv);
1318 struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv;
1319 struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info);
1320 struct mlme_priv *pmlmepriv = &(adapter->mlmepriv);
1321 struct _RT_NDPA_STA_INFO ndpa_sta_info;
1322 u8 ndp_tx_rate = 0, sequence = 0, a_sifs_time = 0, idx = 0;
1326 struct _RT_BEAMFORMING_INFO *p_beam_info = &(p_dm_odm->beamforming_info);
1327 struct _RT_BEAMFORMEE_ENTRY *p_beamform_entry = phydm_beamforming_get_bfee_entry_by_addr(p_dm_odm, RA, &idx);
1329 ndp_tx_rate = beamforming_get_vht_ndp_tx_rate(p_dm_odm, p_beamform_entry->comp_steering_num_of_bfer);
1330 ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] ndp_tx_rate =%d\n", __func__, ndp_tx_rate));
1332 pmgntframe = alloc_mgtxmitframe(pxmitpriv);
1334 if (pmgntframe == NULL) {
1335 ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s, alloc mgnt frame fail\n", __func__));
1339 /*update attribute*/
1340 pattrib = &pmgntframe->attrib;
1341 _rtw_memcpy(pattrib->ra, RA, ETH_ALEN);
1342 update_mgntframe_attrib(adapter, pattrib);
1343 pattrib->qsel = QSLT_MGNT;
1344 pattrib->rate = ndp_tx_rate;
1345 pattrib->bwmode = BW;
1346 pattrib->subtype = WIFI_NDPA;
1348 _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET);
1350 pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET;
1352 pwlanhdr = (struct rtw_ieee80211_hdr *)pframe;
1354 fctrl = &pwlanhdr->frame_ctl;
1357 set_frame_sub_type(pframe, WIFI_NDPA);
1359 _rtw_memcpy(pwlanhdr->addr1, RA, ETH_ALEN);
1360 _rtw_memcpy(pwlanhdr->addr2, p_beamform_entry->my_mac_addr, ETH_ALEN);
1362 if (is_supported_5g(pmlmeext->cur_wireless_mode) || is_supported_ht(pmlmeext->cur_wireless_mode))
1367 duration = 2 * a_sifs_time + 44;
1369 if (BW == CHANNEL_WIDTH_80)
1371 else if (BW == CHANNEL_WIDTH_40)
1376 set_duration(pframe, duration);
1378 sequence = p_beam_info->sounding_sequence << 2;
1379 if (p_beam_info->sounding_sequence >= 0x3f)
1380 p_beam_info->sounding_sequence = 0;
1382 p_beam_info->sounding_sequence++;
1384 _rtw_memcpy(pframe + 16, &sequence, 1);
1385 if (((pmlmeinfo->state & 0x03) == WIFI_FW_ADHOC_STATE) || ((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE))
1388 ndpa_sta_info.aid = AID;
1389 ndpa_sta_info.feedback_type = 0;
1390 ndpa_sta_info.nc_index = 0;
1392 _rtw_memcpy(pframe + 17, (u8 *)&ndpa_sta_info, 2);
1394 pattrib->pktlen = 19;
1396 pattrib->last_txcmdsz = pattrib->pktlen;
1398 dump_mgntframe(adapter, pmgntframe);
1399 ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] [%d]\n", __func__, __LINE__));
1409 beamforming_get_ndpa_frame(
1411 #if (DM_ODM_SUPPORT_TYPE == ODM_WIN)
1413 #elif (DM_ODM_SUPPORT_TYPE == ODM_CE)
1414 union recv_frame *precv_frame
1418 struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void;
1419 struct _ADAPTER *adapter = p_dm_odm->adapter;
1422 #if (DM_ODM_SUPPORT_TYPE == ODM_WIN)
1423 u8 *p_ndpa_frame = pdu_os.Octet;
1424 #elif (DM_ODM_SUPPORT_TYPE == ODM_CE)
1425 u8 *p_ndpa_frame = precv_frame->u.hdr.rx_data;
1427 struct _RT_BEAMFORMER_ENTRY *p_beamformer_entry = NULL; /*Modified By Jeffery @2014-10-29*/
1430 #if (DM_ODM_SUPPORT_TYPE == ODM_WIN)
1431 RT_DISP_DATA(FBEAM, FBEAM_DATA, "beamforming_get_ndpa_frame\n", pdu_os.Octet, pdu_os.Length);
1432 if (IsCtrlNDPA(p_ndpa_frame) == false)
1433 #elif (DM_ODM_SUPPORT_TYPE == ODM_CE)
1434 if (get_frame_sub_type(p_ndpa_frame) != WIFI_NDPA)
1437 else if (!(p_dm_odm->support_ic_type & (ODM_RTL8812 | ODM_RTL8821))) {
1438 ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] not 8812 or 8821A, return\n", __func__));
1441 #if (DM_ODM_SUPPORT_TYPE == ODM_WIN)
1442 TA = Frame_Addr2(pdu_os);
1443 #elif (DM_ODM_SUPPORT_TYPE == ODM_CE)
1444 TA = get_addr2_ptr(p_ndpa_frame);
1446 /*Remove signaling TA. */
1447 TA[0] = TA[0] & 0xFE;
1449 p_beamformer_entry = phydm_beamforming_get_bfer_entry_by_addr(p_dm_odm, TA, &idx); /* Modified By Jeffery @2014-10-29 */
1451 /*Break options for Clock Reset*/
1452 if (p_beamformer_entry == NULL)
1454 else if (!(p_beamformer_entry->beamform_entry_cap & BEAMFORMEE_CAP_VHT_SU))
1456 /*log_success: As long as 8812A receive NDPA and feedback CSI succeed once, clock reset is NO LONGER needed !2015-04-10, Jeffery*/
1457 /*clock_reset_times: While BFer entry always doesn't receive our CSI, clock will reset again and again.So clock_reset_times is limited to 5 times.2015-04-13, Jeffery*/
1458 else if ((p_beamformer_entry->log_success == 1) || (p_beamformer_entry->clock_reset_times == 5)) {
1459 ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] log_seq=%d, pre_log_seq=%d, log_retry_cnt=%d, log_success=%d, clock_reset_times=%d, clock reset is no longer needed.\n",
1460 __func__, p_beamformer_entry->log_seq, p_beamformer_entry->pre_log_seq, p_beamformer_entry->log_retry_cnt, p_beamformer_entry->log_success, p_beamformer_entry->clock_reset_times));
1465 sequence = (p_ndpa_frame[16]) >> 2;
1467 ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start, sequence=%d, log_seq=%d, pre_log_seq=%d, log_retry_cnt=%d, clock_reset_times=%d, log_success=%d\n",
1468 __func__, sequence, p_beamformer_entry->log_seq, p_beamformer_entry->pre_log_seq, p_beamformer_entry->log_retry_cnt, p_beamformer_entry->clock_reset_times, p_beamformer_entry->log_success));
1470 if ((p_beamformer_entry->log_seq != 0) && (p_beamformer_entry->pre_log_seq != 0)) {
1471 /*Success condition*/
1472 if ((p_beamformer_entry->log_seq != sequence) && (p_beamformer_entry->pre_log_seq != p_beamformer_entry->log_seq)) {
1473 /* break option for clcok reset, 2015-03-30, Jeffery */
1474 p_beamformer_entry->log_retry_cnt = 0;
1475 /*As long as 8812A receive NDPA and feedback CSI succeed once, clock reset is no longer needed.*/
1476 /*That is, log_success is NOT needed to be reset to zero, 2015-04-13, Jeffery*/
1477 p_beamformer_entry->log_success = 1;
1479 } else {/*Fail condition*/
1481 if (p_beamformer_entry->log_retry_cnt == 5) {
1482 p_beamformer_entry->clock_reset_times++;
1483 p_beamformer_entry->log_retry_cnt = 0;
1485 ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Clock Reset!!! clock_reset_times=%d\n",
1486 __func__, p_beamformer_entry->clock_reset_times));
1487 hal_com_txbf_set(p_dm_odm, TXBF_SET_SOUNDING_CLK, NULL);
1490 p_beamformer_entry->log_retry_cnt++;
1494 /*Update log_seq & pre_log_seq*/
1495 p_beamformer_entry->pre_log_seq = p_beamformer_entry->log_seq;
1496 p_beamformer_entry->log_seq = sequence;