From: Jes Sorensen <jes.soren...@redhat.com>

Use the kernel provided struct and defines to fill in qos_ctrl

Signed-off-by: Jes Sorensen <jes.soren...@redhat.com>
---
 drivers/staging/rtl8723au/core/rtw_xmit.c | 20 +++++++++++++-------
 1 file changed, 13 insertions(+), 7 deletions(-)

diff --git a/drivers/staging/rtl8723au/core/rtw_xmit.c 
b/drivers/staging/rtl8723au/core/rtw_xmit.c
index a82afcb..f99e59c 100644
--- a/drivers/staging/rtl8723au/core/rtw_xmit.c
+++ b/drivers/staging/rtl8723au/core/rtw_xmit.c
@@ -861,9 +861,8 @@ static int xmitframe_swencrypt(struct rtw_adapter *padapter,
 static int rtw_make_wlanhdr(struct rtw_adapter *padapter, u8 *hdr,
                            struct pkt_attrib *pattrib)
 {
-       u16 *qc;
-
        struct ieee80211_hdr *pwlanhdr = (struct ieee80211_hdr *)hdr;
+       struct ieee80211_qos_hdr *qoshdr;
        struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
        u8 qos_option = false;
        int res = _SUCCESS;
@@ -942,11 +941,18 @@ static int rtw_make_wlanhdr(struct rtw_adapter *padapter, 
u8 *hdr,
                        pwlanhdr->frame_control |=
                                cpu_to_le16(IEEE80211_FCTL_PROTECTED);
                if (qos_option) {
-                       qc = (unsigned short *)(hdr + pattrib->hdrlen - 2);
-                       if (pattrib->priority)
-                               SetPriority(qc, pattrib->priority);
-                       SetEOSP(qc, pattrib->eosp);
-                       SetAckpolicy(qc, pattrib->ack_policy);
+                       qoshdr = (struct ieee80211_qos_hdr *)hdr;
+
+                       qoshdr->qos_ctrl = cpu_to_le16(
+                               pattrib->priority & IEEE80211_QOS_CTL_TID_MASK);
+
+                       qoshdr->qos_ctrl |= cpu_to_le16(
+                               (pattrib->ack_policy << 5) &
+                               IEEE80211_QOS_CTL_ACK_POLICY_MASK);
+
+                       if (pattrib->eosp)
+                               qoshdr->qos_ctrl |=
+                                       cpu_to_le16(IEEE80211_QOS_CTL_EOSP);
                }
                /* TODO: fill HT Control Field */
 
-- 
1.9.0

_______________________________________________
devel mailing list
de...@linuxdriverproject.org
http://driverdev.linuxdriverproject.org/mailman/listinfo/driverdev-devel

Reply via email to