/* NOTE:
This function return a list of SKB which is proper to be aggregated.
If no proper SKB is found to do aggregation, SendList will only contain the input SKB.
*/
u8 AMSDU_GetAggregatibleList(
struct rtllib_device * ieee,
struct sk_buff * pCurSkb,
struct sk_buff_head *pSendList,
u8 queue_index
)
{
struct sk_buff *pSkb = NULL;
u16 nMaxAMSDUSize = 0;
u32 AggrSize = 0;
u32 nAggrSkbNum = 0;
u8 padding = 0;
struct sta_info *psta = NULL;
u8 *addr = (u8*)(pCurSkb->data);
struct sk_buff_head *header;
struct sk_buff *punlinkskb = NULL;
padding = ((4-pCurSkb->len%4)==4)?0:(4-pCurSkb->len%4);
AggrSize = AMSDU_SUBHEADER_LEN + pCurSkb->len + padding;
skb_queue_tail(pSendList, pCurSkb);
nAggrSkbNum++;
//
// Get A-MSDU aggregation threshold.
//
if(ieee->iw_mode == IW_MODE_MASTER){
psta = GetStaInfo(ieee, addr);
if(NULL != psta)
nMaxAMSDUSize = psta->htinfo.AMSDU_MaxSize;
else
return 1;
}else if(ieee->iw_mode == IW_MODE_ADHOC){
psta = GetStaInfo(ieee, addr);
if(NULL != psta)
nMaxAMSDUSize = psta->htinfo.AMSDU_MaxSize;
else
return 1;
}else{
nMaxAMSDUSize = ieee->pHTInfo->nCurrent_AMSDU_MaxSize;
}
nMaxAMSDUSize = ((nMaxAMSDUSize)==0)?HT_AMSDU_SIZE_4K:HT_AMSDU_SIZE_8K;
if(ieee->pHTInfo->ForcedAMSDUMode == HT_AGG_FORCE_ENABLE)
{
nMaxAMSDUSize = ieee->pHTInfo->ForcedAMSDUMaxSize;
}
//
// Build pSendList
//
header = (&ieee->skb_aggQ[queue_index]);
pSkb = header->next;
while(pSkb != (struct sk_buff*)header)
{
//
// Get Aggregation List. Only those frames with the same RA can be aggregated.
// For Infrastructure mode, RA is always the AP MAC address so the frame can just be aggregated
// without checking RA.
// For AP mode and IBSS mode, RA is the same as DA. Checking RA is needed before aggregation.
//
if((ieee->iw_mode == IW_MODE_MASTER) ||(ieee->iw_mode == IW_MODE_ADHOC))
{
if(memcmp(pCurSkb->data, pSkb->data, ETH_ALEN) != 0) //DA
{
//printk(""MAC_FMT"-"MAC_FMT"\n",MAC_ARG(pCurSkb->data), MAC_ARG(pSkb->data));
pSkb = pSkb->next;
continue;
}
}
//
// Limitation shall be checked:
// (1) A-MSDU size limitation
//
if((AMSDU_SUBHEADER_LEN + pSkb->len + AggrSize < nMaxAMSDUSize) )
{
// Unlink skb
punlinkskb = pSkb;
pSkb = pSkb->next;
#if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,14)
skb_unlink(punlinkskb, header);
#else
/*
* __skb_unlink before linux2.6.14 does not use spinlock to protect list head.
* add spinlock function manually. john,2008/12/03
*/
{
unsigned long flags;
spin_lock_irqsave(&ieee->lock, flags);
__skb_unlink(punlinkskb,header);
spin_unlock_irqrestore(&ieee->lock, flags);
}
#endif
//Do aggregation
padding = ((4-punlinkskb->len%4)==4)?0:(4-punlinkskb->len%4);
AggrSize += AMSDU_SUBHEADER_LEN + punlinkskb->len + padding;
//printk(""MAC_FMT": %d\n",MAC_ARG(punlinkskb->data),punlinkskb->len);
skb_queue_tail(pSendList, punlinkskb);
nAggrSkbNum++;
}
else
{
//Do not do aggregation because out of resources
//printk("\nStop aggregation: ");
if(!(AMSDU_SUBHEADER_LEN + pSkb->len + AggrSize < nMaxAMSDUSize))
;//printk("[A-MSDU size limitation]");
break; //To be sure First In First Out, 'break' should be marked,
}
}
return nAggrSkbNum;
}
/* NOTE:
This function return a list of SKB which is proper to be aggregated.
If no proper SKB is found to do aggregation, SendList will only contain the input SKB.
*/
u8 AMSDU_GetAggregatibleList(
struct rtllib_device * ieee,
struct sk_buff * pCurSkb,
struct sk_buff_head *pSendList,
u8 queue_index,
bool is_ap
)
{
struct sk_buff *pSkb = NULL;
u16 nMaxAMSDUSize = 0;
u32 AggrSize = 0;
u32 nAggrSkbNum = 0;
u8 padding = 0;
struct sta_info *psta = NULL;
u8 *addr = (u8*)(pCurSkb->data);
struct sk_buff_head *header;
struct sk_buff *punlinkskb = NULL;
padding = ((4-pCurSkb->len%4)==4)?0:(4-pCurSkb->len%4);
AggrSize = AMSDU_SUBHEADER_LEN + pCurSkb->len + padding;
skb_queue_tail(pSendList, pCurSkb);
nAggrSkbNum++;
if (is_ap) {
#ifdef ASL
if((ieee->iw_mode == IW_MODE_MASTER || ieee->iw_mode == IW_MODE_APSTA) && (ieee->ap_state == RTLLIB_LINKED)){
psta = ap_get_stainfo(ieee, addr);
if(NULL != psta){
nMaxAMSDUSize = psta->htinfo.AMSDU_MaxSize;
}
else {
return 1;
}
}else
#endif
return 1;
}else {
if(ieee->iw_mode == IW_MODE_ADHOC){
psta = GetStaInfo(ieee, addr);
if(NULL != psta)
nMaxAMSDUSize = psta->htinfo.AMSDU_MaxSize;
else
return 1;
}else{
nMaxAMSDUSize = ieee->pHTInfo->nCurrent_AMSDU_MaxSize;
}
}
if(ieee->pHTInfo->ForcedAMSDUMode == HT_AGG_FORCE_ENABLE)
{
nMaxAMSDUSize = ieee->pHTInfo->ForcedAMSDUMaxSize;
}
if (is_ap) {
#ifdef ASL
header = (&ieee->skb_apaggQ[queue_index]);
#endif
} else
header = (&ieee->skb_aggQ[queue_index]);
pSkb = header->next;
while(pSkb != (struct sk_buff*)header)
{
if (is_ap) {
#ifdef ASL
if((ieee->iw_mode == IW_MODE_MASTER) ||(ieee->iw_mode == IW_MODE_APSTA))
{
if(memcmp(pCurSkb->data, pSkb->data, ETH_ALEN) != 0)
{
pSkb = pSkb->next;
continue;
}
}
#endif
} else {
if(ieee->iw_mode == IW_MODE_ADHOC)
{
if(memcmp(pCurSkb->data, pSkb->data, ETH_ALEN) != 0)
{
pSkb = pSkb->next;
continue;
}
}
}
if((AMSDU_SUBHEADER_LEN + pSkb->len + AggrSize < nMaxAMSDUSize) )
{
punlinkskb = pSkb;
pSkb = pSkb->next;
#if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,14)
skb_unlink(punlinkskb, header);
#else
/*
* __skb_unlink before linux2.6.14 does not use spinlock to protect list head.
* add spinlock function manually. john,2008/12/03
*/
{
unsigned long flags;
spin_lock_irqsave(&ieee->lock, flags);
__skb_unlink(punlinkskb,header);
spin_unlock_irqrestore(&ieee->lock, flags);
}
#endif
padding = ((4-punlinkskb->len%4)==4)?0:(4-punlinkskb->len%4);
AggrSize += AMSDU_SUBHEADER_LEN + punlinkskb->len + padding;
skb_queue_tail(pSendList, punlinkskb);
nAggrSkbNum++;
}
else
{
if(!(AMSDU_SUBHEADER_LEN + pSkb->len + AggrSize < nMaxAMSDUSize))
;
break;
}
}
return nAggrSkbNum;
}
int rtllib_xmit_inter(struct sk_buff *skb, struct net_device *dev)
{
struct rtllib_device *ieee = (struct rtllib_device *)netdev_priv_rsl(dev);
struct rtllib_txb *txb = NULL;
struct rtllib_hdr_3addrqos *frag_hdr;
int i, bytes_per_frag, nr_frags, bytes_last_frag, frag_size;
unsigned long flags;
struct net_device_stats *stats = &ieee->stats;
int ether_type = 0, encrypt;
int bytes, fc, qos_ctl = 0, hdr_len;
struct sk_buff *skb_frag;
struct rtllib_hdr_3addrqos header = { /* Ensure zero initialized */
.duration_id = 0,
.seq_ctl = 0,
.qos_ctl = 0
};
u8 dest[ETH_ALEN], src[ETH_ALEN];
int qos_actived = ieee->current_network.qos_data.active;
struct rtllib_crypt_data* crypt = NULL;
cb_desc *tcb_desc;
u8 bIsMulticast = false;
#if defined(RTL8192U) || defined(RTL8192SU) || defined(RTL8192SE)
struct sta_info *p_sta = NULL;
#endif
u8 IsAmsdu = false;
#ifdef ENABLE_AMSDU
u8 queue_index = WME_AC_BE;
cb_desc *tcb_desc_skb;
u8 bIsSptAmsdu = false;
#endif
bool bdhcp =false;
#ifndef _RTL8192_EXT_PATCH_
//PRT_POWER_SAVE_CONTROL pPSC = (PRT_POWER_SAVE_CONTROL)(&(ieee->PowerSaveControl));//added by amy for Leisure PS 090402
#endif
spin_lock_irqsave(&ieee->lock, flags);
/* If there is no driver handler to take the TXB, dont' bother
* creating it... */
if ((!ieee->hard_start_xmit && !(ieee->softmac_features & IEEE_SOFTMAC_TX_QUEUE))||
((!ieee->softmac_data_hard_start_xmit && (ieee->softmac_features & IEEE_SOFTMAC_TX_QUEUE)))) {
printk(KERN_WARNING "%s: No xmit handler.\n",
ieee->dev->name);
goto success;
}
if(likely(ieee->raw_tx == 0)){
if (unlikely(skb->len < SNAP_SIZE + sizeof(u16))) {
printk(KERN_WARNING "%s: skb too small (%d).\n",
ieee->dev->name, skb->len);
goto success;
}
/* Save source and destination addresses */
memcpy(dest, skb->data, ETH_ALEN);
memcpy(src, skb->data+ETH_ALEN, ETH_ALEN);
#ifdef ENABLE_AMSDU
if(ieee->iw_mode == IW_MODE_ADHOC)
{
p_sta = GetStaInfo(ieee, dest);
if(p_sta) {
if(p_sta->htinfo.bEnableHT)
bIsSptAmsdu = true;
}
}else if(ieee->iw_mode == IW_MODE_INFRA) {
bIsSptAmsdu = true;
}else
bIsSptAmsdu = true;
bIsSptAmsdu = (bIsSptAmsdu && ieee->pHTInfo->bCurrent_AMSDU_Support && qos_actived);
//u8 *a = skb->data;
//u8 *b = (u8*)skb->data + ETH_ALEN;
//printk("\n&&&&&&&skb=%p len=%d dst:"MAC_FMT" src:"MAC_FMT"\n",skb,skb->len,MAC_ARG(a),MAC_ARG(b));
tcb_desc_skb = (pcb_desc)(skb->cb + MAX_DEV_ADDR_SIZE); //YJ,move,081104
if(bIsSptAmsdu) {
if(!tcb_desc_skb->bFromAggrQ) //Normal MSDU
{
if(qos_actived)
{
queue_index = UP2AC(skb->priority);
} else {
queue_index = WME_AC_BE;
}
//printk("Normal MSDU,queue_idx=%d nic_enough=%d queue_len=%d\n", queue_index, ieee->check_nic_enough_desc(ieee->dev,queue_index), skb_queue_len(&ieee->skb_aggQ[queue_index]));
if ((skb_queue_len(&ieee->skb_aggQ[queue_index]) != 0)||
#if defined RTL8192SE || defined RTL8192CE
(ieee->get_nic_desc_num(ieee->dev,queue_index)) > 1||
#else
(!ieee->check_nic_enough_desc(ieee->dev,queue_index))||
#endif
(ieee->queue_stop) ||
(ieee->amsdu_in_process)) //YJ,add,090409
{
/* insert the skb packet to the Aggregation queue */
//printk("!!!!!!!!!!%s(): intert to aggr queue\n", __FUNCTION__);
skb_queue_tail(&ieee->skb_aggQ[queue_index], skb);
spin_unlock_irqrestore(&ieee->lock, flags);
return 0;
}
}
else //AMSDU
{
//printk("AMSDU!!!!!!!!!!!!!\n");
if(tcb_desc_skb->bAMSDU)
IsAmsdu = true;
//YJ,add,090409
ieee->amsdu_in_process = false;
}
}
#endif
memset(skb->cb, 0, sizeof(skb->cb));
ether_type = ntohs(((struct ethhdr *)skb->data)->h_proto);
// The following is for DHCP and ARP packet, we use cck1M to tx these packets and let LPS awake some time
// to prevent DHCP protocol fail
if (skb->len > 282){//MINIMUM_DHCP_PACKET_SIZE) {
if (ETH_P_IP == ether_type) {// IP header
const struct iphdr *ip = (struct iphdr *)((u8 *)skb->data+14);
if (IPPROTO_UDP == ip->protocol) {//FIXME windows is 11 but here UDP in linux kernel is 17.
struct udphdr *udp = (struct udphdr *)((u8 *)ip + (ip->ihl << 2));
//if(((ntohs(udp->source) == 68) && (ntohs(udp->dest) == 67)) ||
/// ((ntohs(udp->source) == 67) && (ntohs(udp->dest) == 68))) {
if(((((u8 *)udp)[1] == 68) && (((u8 *)udp)[3] == 67)) ||
((((u8 *)udp)[1] == 67) && (((u8 *)udp)[3] == 68))) {
// 68 : UDP BOOTP client
// 67 : UDP BOOTP server
printk("===>DHCP Protocol start tx DHCP pkt src port:%d, dest port:%d!!\n", ((u8 *)udp)[1],((u8 *)udp)[3]);
// Use low rate to send DHCP packet.
//if(pMgntInfo->IOTAction & HT_IOT_ACT_WA_IOT_Broadcom)
//{
// tcb_desc->DataRate = MgntQuery_TxRateExcludeCCKRates(ieee);//0xc;//ofdm 6m
// tcb_desc->bTxDisableRateFallBack = false;
//}
//else
//pTcb->DataRate = Adapter->MgntInfo.LowestBasicRate;
//RTPRINT(FDM, WA_IOT, ("DHCP TranslateHeader(), pTcb->DataRate = 0x%x\n", pTcb->DataRate));
bdhcp = true;
#ifdef _RTL8192_EXT_PATCH_
ieee->LPSDelayCnt = 100;//pPSC->LPSAwakeIntvl*2; //AMY,090701
#else
ieee->LPSDelayCnt = 100;//pPSC->LPSAwakeIntvl*2;
#endif
}
}
}else if(ETH_P_ARP == ether_type){// IP ARP packet
printk("=================>DHCP Protocol start tx ARP pkt!!\n");
bdhcp = true;
ieee->LPSDelayCnt = ieee->current_network.tim.tim_count;
//if(pMgntInfo->IOTAction & HT_IOT_ACT_WA_IOT_Broadcom)
//{
// tcb_desc->DataRate = MgntQuery_TxRateExcludeCCKRates(Adapter->MgntInfo.mBrates);//0xc;//ofdm 6m
// tcb_desc->bTxDisableRateFallBack = FALSE;
//}
//else
// tcb_desc->DataRate = Adapter->MgntInfo.LowestBasicRate;
//RTPRINT(FDM, WA_IOT, ("ARP TranslateHeader(), pTcb->DataRate = 0x%x\n", pTcb->DataRate));
}
}
skb->priority = rtllib_classify(skb, IsAmsdu);
#ifdef _RTL8192_EXT_PATCH_
crypt = ieee->sta_crypt[ieee->tx_keyidx];
#else
crypt = ieee->crypt[ieee->tx_keyidx];
#endif
encrypt = !(ether_type == ETH_P_PAE && ieee->ieee802_1x) &&
ieee->host_encrypt && crypt && crypt->ops;
if (!encrypt && ieee->ieee802_1x &&
ieee->drop_unencrypted && ether_type != ETH_P_PAE) {
stats->tx_dropped++;
goto success;
}
#ifdef CONFIG_RTLLIB_DEBUG
if (crypt && !encrypt && ether_type == ETH_P_PAE) {
struct eapol *eap = (struct eapol *)(skb->data +
sizeof(struct ethhdr) - SNAP_SIZE - sizeof(u16));
RTLLIB_DEBUG_EAP("TX: IEEE 802.11 EAPOL frame: %s\n",
eap_get_type(eap->type));
}
#endif
/* Advance the SKB to the start of the payload */
skb_pull(skb, sizeof(struct ethhdr));
/* Determine total amount of storage required for TXB packets */
#ifdef ENABLE_AMSDU
if(!IsAmsdu)
bytes = skb->len + SNAP_SIZE + sizeof(u16);
else
bytes = skb->len;
#else
bytes = skb->len + SNAP_SIZE + sizeof(u16);
#endif
if (encrypt)
fc = RTLLIB_FTYPE_DATA | RTLLIB_FCTL_WEP;
else
fc = RTLLIB_FTYPE_DATA;
//if(ieee->current_network.QoS_Enable)
if(qos_actived)
fc |= RTLLIB_STYPE_QOS_DATA;
else
fc |= RTLLIB_STYPE_DATA;
#ifdef _RTL8192_EXT_PATCH_
if ((ieee->iw_mode == IW_MODE_INFRA)
//|| ((ieee->iw_mode == IW_MODE_MESH) && (ieee->only_mesh == 0))) //YJ,test,090610
|| (ieee->iw_mode == IW_MODE_MESH) )
#else
if (ieee->iw_mode == IW_MODE_INFRA)
#endif
{
fc |= RTLLIB_FCTL_TODS;
/* To DS: Addr1 = BSSID, Addr2 = SA,
Addr3 = DA */
memcpy(&header.addr1, ieee->current_network.bssid, ETH_ALEN);
memcpy(&header.addr2, &src, ETH_ALEN);
if(IsAmsdu)
memcpy(&header.addr3, ieee->current_network.bssid, ETH_ALEN);
else
memcpy(&header.addr3, &dest, ETH_ALEN);
} else if (ieee->iw_mode == IW_MODE_ADHOC) {
/* not From/To DS: Addr1 = DA, Addr2 = SA,
Addr3 = BSSID */
memcpy(&header.addr1, dest, ETH_ALEN);
memcpy(&header.addr2, src, ETH_ALEN);
memcpy(&header.addr3, ieee->current_network.bssid, ETH_ALEN);
}
bIsMulticast = is_broadcast_ether_addr(header.addr1) ||is_multicast_ether_addr(header.addr1);
header.frame_ctl = cpu_to_le16(fc);
/* Determine fragmentation size based on destination (multicast
* and broadcast are not fragmented) */
if (bIsMulticast) {
frag_size = MAX_FRAG_THRESHOLD;
qos_ctl |= QOS_CTL_NOTCONTAIN_ACK;
}
else {
#ifdef ENABLE_AMSDU
if(bIsSptAmsdu) {
if(ieee->iw_mode == IW_MODE_ADHOC) {
if(p_sta)
frag_size = p_sta->htinfo.AMSDU_MaxSize;
else
frag_size = ieee->pHTInfo->nAMSDU_MaxSize;
}
else
frag_size = ieee->pHTInfo->nAMSDU_MaxSize;
qos_ctl = 0;
}
else
#endif
{
frag_size = ieee->fts;//default:392
qos_ctl = 0;
}
}
if(qos_actived)
{
hdr_len = RTLLIB_3ADDR_LEN + 2;
/* in case we are a client verify acm is not set for this ac */
while (unlikely(ieee->wmm_acm & (0x01 << skb->priority))) {
printk("skb->priority = %x\n", skb->priority);
if (wme_downgrade_ac(skb)) {
break;
}
printk("converted skb->priority = %x\n", skb->priority);
}
qos_ctl |= skb->priority; //set in the rtllib_classify
#ifdef ENABLE_AMSDU
if(IsAmsdu)
{
qos_ctl |= QOS_CTL_AMSDU_PRESENT;
}
header.qos_ctl = cpu_to_le16(qos_ctl);
#else
header.qos_ctl = cpu_to_le16(qos_ctl & RTLLIB_QOS_TID);
#endif
} else {
hdr_len = RTLLIB_3ADDR_LEN;
}
/* Determine amount of payload per fragment. Regardless of if
* this stack is providing the full 802.11 header, one will
* eventually be affixed to this fragment -- so we must account for
* it when determining the amount of payload space. */
bytes_per_frag = frag_size - hdr_len;
if (ieee->config &
(CFG_RTLLIB_COMPUTE_FCS | CFG_RTLLIB_RESERVE_FCS))
bytes_per_frag -= RTLLIB_FCS_LEN;
/* Each fragment may need to have room for encryptiong pre/postfix */
if (encrypt){
bytes_per_frag -= crypt->ops->extra_prefix_len +
crypt->ops->extra_postfix_len;
}
/* Number of fragments is the total bytes_per_frag /
* payload_per_fragment */
nr_frags = bytes / bytes_per_frag;
bytes_last_frag = bytes % bytes_per_frag;
if (bytes_last_frag)
nr_frags++;
else
bytes_last_frag = bytes_per_frag;
/* When we allocate the TXB we allocate enough space for the reserve
* and full fragment bytes (bytes_per_frag doesn't include prefix,
* postfix, header, FCS, etc.) */
txb = rtllib_alloc_txb(nr_frags, frag_size + ieee->tx_headroom, GFP_ATOMIC);
if (unlikely(!txb)) {
printk(KERN_WARNING "%s: Could not allocate TXB\n",
ieee->dev->name);
goto failed;
}
txb->encrypted = encrypt;
txb->payload_size = bytes;
//if (ieee->current_network.QoS_Enable)
if(qos_actived)
{
txb->queue_index = UP2AC(skb->priority);
} else {
txb->queue_index = WME_AC_BE;;
}
for (i = 0; i < nr_frags; i++) {
skb_frag = txb->fragments[i];
tcb_desc = (cb_desc *)(skb_frag->cb + MAX_DEV_ADDR_SIZE);
#ifdef _RTL8192_EXT_PATCH_
tcb_desc->mesh_pkt = 0;//AMY added 090226
if(ieee->iw_mode == IW_MODE_ADHOC)
tcb_desc->badhoc = 1;
else
tcb_desc->badhoc = 0;
#endif
if(qos_actived){
skb_frag->priority = skb->priority;//UP2AC(skb->priority);
tcb_desc->queue_index = UP2AC(skb->priority);
} else {
skb_frag->priority = WME_AC_BE;
tcb_desc->queue_index = WME_AC_BE;
}
skb_reserve(skb_frag, ieee->tx_headroom);
if (encrypt){
if (ieee->hwsec_active)
tcb_desc->bHwSec = 1;
else
tcb_desc->bHwSec = 0;
skb_reserve(skb_frag, crypt->ops->extra_prefix_len);
}
else
{
tcb_desc->bHwSec = 0;
}
frag_hdr = (struct rtllib_hdr_3addrqos *)skb_put(skb_frag, hdr_len);
memcpy(frag_hdr, &header, hdr_len);
/* If this is not the last fragment, then add the MOREFRAGS
* bit to the frame control */
if (i != nr_frags - 1) {
frag_hdr->frame_ctl = cpu_to_le16(
fc | RTLLIB_FCTL_MOREFRAGS);
bytes = bytes_per_frag;
} else {
/* The last fragment takes the remaining length */
bytes = bytes_last_frag;
}
//if(ieee->current_network.QoS_Enable)
if((qos_actived) && (!bIsMulticast))
{
// add 1 only indicate to corresponding seq number control 2006/7/12
//frag_hdr->seq_ctl = cpu_to_le16(ieee->seq_ctrl[UP2AC(skb->priority)+1]<<4 | i);
frag_hdr->seq_ctl = rtllib_query_seqnum(ieee, skb_frag, header.addr1);
frag_hdr->seq_ctl = cpu_to_le16(frag_hdr->seq_ctl<<4 | i);
} else {
frag_hdr->seq_ctl = cpu_to_le16(ieee->seq_ctrl[0]<<4 | i);
}
/* Put a SNAP header on the first fragment */
#ifdef ENABLE_AMSDU
if ((i == 0) && (!IsAmsdu))
#else
if (i == 0)
#endif
{
rtllib_put_snap(
skb_put(skb_frag, SNAP_SIZE + sizeof(u16)),
ether_type);
bytes -= SNAP_SIZE + sizeof(u16);
}
memcpy(skb_put(skb_frag, bytes), skb->data, bytes);
/* Advance the SKB... */
skb_pull(skb, bytes);
/* Encryption routine will move the header forward in order
* to insert the IV between the header and the payload */
if (encrypt){
#ifdef _RTL8192_EXT_PATCH_
rtllib_encrypt_fragment(ieee, skb_frag, hdr_len, 0);
#else
rtllib_encrypt_fragment(ieee, skb_frag, hdr_len);
#endif
}
if (ieee->config &
(CFG_RTLLIB_COMPUTE_FCS | CFG_RTLLIB_RESERVE_FCS))
skb_put(skb_frag, 4);
}
if((qos_actived) && (!bIsMulticast))
{
if (ieee->seq_ctrl[UP2AC(skb->priority) + 1] == 0xFFF)
ieee->seq_ctrl[UP2AC(skb->priority) + 1] = 0;
else
ieee->seq_ctrl[UP2AC(skb->priority) + 1]++;
} else {
if (ieee->seq_ctrl[0] == 0xFFF)
ieee->seq_ctrl[0] = 0;
else
ieee->seq_ctrl[0]++;
}
}else{
if (unlikely(skb->len < sizeof(struct rtllib_hdr_3addr))) {
printk(KERN_WARNING "%s: skb too small (%d).\n",
ieee->dev->name, skb->len);
goto success;
}
txb = rtllib_alloc_txb(1, skb->len, GFP_ATOMIC);
if(!txb){
printk(KERN_WARNING "%s: Could not allocate TXB\n",
ieee->dev->name);
goto failed;
}
txb->encrypted = 0;
txb->payload_size = skb->len;
memcpy(skb_put(txb->fragments[0],skb->len), skb->data, skb->len);
}
success:
//WB add to fill data tcb_desc here. only first fragment is considered, need to change, and you may remove to other place.
if (txb)
{
#if 1
cb_desc *tcb_desc = (cb_desc *)(txb->fragments[0]->cb + MAX_DEV_ADDR_SIZE);
tcb_desc->bTxEnableFwCalcDur = 1;
tcb_desc->priority = skb->priority;
if(ether_type == ETH_P_PAE) {
if(ieee->pHTInfo->IOTAction & HT_IOT_ACT_WA_IOT_Broadcom)
{
tcb_desc->data_rate = MgntQuery_TxRateExcludeCCKRates(ieee);//0xc;//ofdm 6m
tcb_desc->bTxDisableRateFallBack = false;
}else{
tcb_desc->data_rate = ieee->basic_rate;
tcb_desc->bTxDisableRateFallBack = 1;
}
printk("EAPOL TranslateHeader(), pTcb->DataRate = 0x%x\n", tcb_desc->data_rate);
tcb_desc->RATRIndex = 7;
tcb_desc->bTxUseDriverAssingedRate = 1;
} else {
if (is_multicast_ether_addr(header.addr1))
tcb_desc->bMulticast = 1;
if (is_broadcast_ether_addr(header.addr1))
tcb_desc->bBroadcast = 1;
#if defined(RTL8192U) || defined(RTL8192SU) || defined(RTL8192SE)
if ( tcb_desc->bMulticast || tcb_desc->bBroadcast){
rtllib_txrate_selectmode(ieee, tcb_desc, 7);
tcb_desc->data_rate = ieee->basic_rate;
}
else
{
if(ieee->iw_mode == IW_MODE_ADHOC)
{
u8 is_peer_shortGI_40M = 0;
u8 is_peer_shortGI_20M = 0;
u8 is_peer_BW_40M = 0;
p_sta = GetStaInfo(ieee, header.addr1);
if(NULL == p_sta)
{
rtllib_txrate_selectmode(ieee, tcb_desc, 7);
tcb_desc->data_rate = ieee->rate;
}
else
{
rtllib_txrate_selectmode(ieee, tcb_desc, p_sta->ratr_index);
tcb_desc->data_rate = CURRENT_RATE(p_sta->wireless_mode, p_sta->CurDataRate, p_sta->htinfo.HTHighestOperaRate);
is_peer_shortGI_40M = p_sta->htinfo.bCurShortGI40MHz;
is_peer_shortGI_20M = p_sta->htinfo.bCurShortGI20MHz;
is_peer_BW_40M = p_sta->htinfo.bCurTxBW40MHz;
}
rtllib_qurey_ShortPreambleMode(ieee, tcb_desc);
rtllib_tx_query_agg_cap(ieee, txb->fragments[0], tcb_desc);
rtllib_ibss_query_HTCapShortGI(ieee, tcb_desc,is_peer_shortGI_40M,is_peer_shortGI_20M);
rtllib_ibss_query_BandwidthMode(ieee, tcb_desc,is_peer_BW_40M);
rtllib_query_protectionmode(ieee, tcb_desc, txb->fragments[0]);
//CB_DESC_DUMP(tcb_desc, __FUNCTION__);
}
else {
rtllib_txrate_selectmode(ieee, tcb_desc, 0);
tcb_desc->data_rate = CURRENT_RATE(ieee->mode, ieee->rate, ieee->HTCurrentOperaRate);
if(bdhcp == true){
// Use low rate to send DHCP packet.
if(ieee->pHTInfo->IOTAction & HT_IOT_ACT_WA_IOT_Broadcom) {
tcb_desc->data_rate = MGN_1M;//MgntQuery_TxRateExcludeCCKRates(ieee);//0xc;//ofdm 6m
tcb_desc->bTxDisableRateFallBack = false;
}else{
tcb_desc->data_rate = MGN_1M;
tcb_desc->bTxDisableRateFallBack = 1;
}
tcb_desc->RATRIndex = 7;
tcb_desc->bTxUseDriverAssingedRate = 1;
tcb_desc->bdhcp = 1;
}
rtllib_qurey_ShortPreambleMode(ieee, tcb_desc);
rtllib_tx_query_agg_cap(ieee, txb->fragments[0], tcb_desc);
rtllib_query_HTCapShortGI(ieee, tcb_desc);
rtllib_query_BandwidthMode(ieee, tcb_desc);
rtllib_query_protectionmode(ieee, tcb_desc, txb->fragments[0]);
}
}
#else
rtllib_txrate_selectmode(ieee, tcb_desc);
if ( tcb_desc->bMulticast || tcb_desc->bBroadcast)
tcb_desc->data_rate = ieee->basic_rate;
else
//tcb_desc->data_rate = CURRENT_RATE(ieee->current_network.mode, ieee->rate, ieee->HTCurrentOperaRate);
tcb_desc->data_rate = CURRENT_RATE(ieee->mode, ieee->rate, ieee->HTCurrentOperaRate);
if(bdhcp == true){
// Use low rate to send DHCP packet.
if(ieee->pHTInfo->IOTAction & HT_IOT_ACT_WA_IOT_Broadcom)
{
tcb_desc->data_rate = MgntQuery_TxRateExcludeCCKRates(ieee);//0xc;//ofdm 6m
tcb_desc->bTxDisableRateFallBack = false;
}else{
tcb_desc->data_rate = MGN_1M;
tcb_desc->bTxDisableRateFallBack = 1;
}
//printk("DHCP TranslateHeader(), pTcb->DataRate = 0x%x\n", tcb_desc->data_rate);
tcb_desc->RATRIndex = 7;
tcb_desc->bTxUseDriverAssingedRate = 1;
//tcb_desc->bTxEnableFwCalcDur = 1;
}
rtllib_qurey_ShortPreambleMode(ieee, tcb_desc);
rtllib_tx_query_agg_cap(ieee, txb->fragments[0], tcb_desc);
rtllib_query_HTCapShortGI(ieee, tcb_desc);
rtllib_query_BandwidthMode(ieee, tcb_desc);
rtllib_query_protectionmode(ieee, tcb_desc, txb->fragments[0]);
#endif
}
// rtllib_query_seqnum(ieee, txb->fragments[0], header.addr1);
// RTLLIB_DEBUG_DATA(RTLLIB_DL_DATA, txb->fragments[0]->data, txb->fragments[0]->len);
//RTLLIB_DEBUG_DATA(RTLLIB_DL_DATA, tcb_desc, sizeof(cb_desc));
#endif
}
spin_unlock_irqrestore(&ieee->lock, flags);
dev_kfree_skb_any(skb);
if (txb) {
if (ieee->softmac_features & IEEE_SOFTMAC_TX_QUEUE){
rtllib_softmac_xmit(txb, ieee);
}else{
if ((*ieee->hard_start_xmit)(txb, dev) == 0) {
stats->tx_packets++;
stats->tx_bytes += txb->payload_size;
return 0;
}
rtllib_txb_free(txb);
}
}
return 0;
failed:
spin_unlock_irqrestore(&ieee->lock, flags);
netif_stop_queue(dev);
stats->tx_errors++;
return 1;
}
int rtllib_xmit(struct sk_buff *skb, struct net_device *dev)
{
memset(skb->cb, 0, sizeof(skb->cb));
return rtllib_xmit_inter(skb, dev);
}
int rtllib_xmit_inter(struct sk_buff *skb, struct net_device *dev)
{
struct rtllib_device *ieee = (struct rtllib_device *)netdev_priv_rsl(dev);
struct rtllib_txb *txb = NULL;
struct rtllib_hdr_3addrqos *frag_hdr;
int i, bytes_per_frag, nr_frags, bytes_last_frag, frag_size;
unsigned long flags;
struct net_device_stats *stats = &ieee->stats;
int ether_type = 0, encrypt;
int bytes, fc, qos_ctl = 0, hdr_len;
struct sk_buff *skb_frag;
struct rtllib_hdr_3addrqos header = { /* Ensure zero initialized */
.duration_id = 0,
.seq_ctl = 0,
.qos_ctl = 0
};
u8 dest[ETH_ALEN], src[ETH_ALEN];
int qos_actived = ieee->current_network.qos_data.active;
struct rtllib_crypt_data* crypt = NULL;
cb_desc *tcb_desc;
u8 bIsMulticast = false;
#if defined(RTL8192U) || defined(RTL8192SU) || defined(RTL8192SE) || defined RTL8192CE
struct sta_info *p_sta = NULL;
#endif
u8 IsAmsdu = false;
cb_desc *tcb_desc_skb;
#ifdef ENABLE_AMSDU
u8 queue_index = WME_AC_BE;
u8 bIsSptAmsdu = false;
#endif
bool bdhcp =false;
#ifndef _RTL8192_EXT_PATCH_
#endif
#ifdef RTL8192S_WAPI_SUPPORT
static u8 zero14[14] = {0};
#endif
u8 bEosp = false;
spin_lock_irqsave(&ieee->lock, flags);
/* If there is no driver handler to take the TXB, dont' bother
* creating it... */
if ((!ieee->hard_start_xmit && !(ieee->softmac_features & IEEE_SOFTMAC_TX_QUEUE))||
((!ieee->softmac_data_hard_start_xmit && (ieee->softmac_features & IEEE_SOFTMAC_TX_QUEUE)))) {
printk(KERN_WARNING "%s: No xmit handler.\n",
ieee->dev->name);
goto success;
}
if(likely(ieee->raw_tx == 0)){
if (unlikely(skb->len < SNAP_SIZE + sizeof(u16))) {
printk(KERN_WARNING "%s: skb too small (%d).\n",
ieee->dev->name, skb->len);
goto success;
}
#ifdef RTL8192S_WAPI_SUPPORT
if(memcmp(skb->data, zero14, sizeof(zero14))==0){
if(WapiSendWaiPacket(ieee, skb)< 0)
goto failed;
else{
spin_unlock_irqrestore(&ieee->lock, flags);
return 0;
}
}
#endif
/* Save source and destination addresses */
memcpy(dest, skb->data, ETH_ALEN);
memcpy(src, skb->data+ETH_ALEN, ETH_ALEN);
tcb_desc_skb = (pcb_desc)(skb->cb + MAX_DEV_ADDR_SIZE);
#ifdef ENABLE_AMSDU
if (ieee->iw_mode == IW_MODE_ADHOC) {
p_sta = GetStaInfo(ieee, dest);
if(p_sta) {
if(p_sta->htinfo.bEnableHT)
bIsSptAmsdu = true;
}
}else if(ieee->iw_mode == IW_MODE_INFRA
#ifdef ASL
|| ieee->iw_mode == IW_MODE_APSTA
#endif
) {
bIsSptAmsdu = true;
}else
bIsSptAmsdu = true;
bIsSptAmsdu = (bIsSptAmsdu && ieee->pHTInfo->bCurrent_AMSDU_Support && qos_actived);
if(bIsSptAmsdu) {
if(!tcb_desc_skb->bFromAggrQ) {
if (qos_actived) {
queue_index = UP2AC(skb->priority);
} else {
queue_index = WME_AC_BE;
}
if ((skb_queue_len(&ieee->skb_aggQ[queue_index]) != 0)||
#if defined RTL8192SE || defined RTL8192CE
(ieee->get_nic_desc_num(ieee->dev,queue_index)) > 1||
#else
(!ieee->check_nic_enough_desc(ieee->dev,queue_index))||
#endif
(ieee->queue_stop) ||
(ieee->amsdu_in_process))
{
/* insert the skb packet to the Aggregation queue */
skb_queue_tail(&ieee->skb_aggQ[queue_index], skb);
spin_unlock_irqrestore(&ieee->lock, flags);
return 0;
}
} else {
if(tcb_desc_skb->bAMSDU)
IsAmsdu = true;
ieee->amsdu_in_process = false;
}
}
#endif
ether_type = ntohs(((struct ethhdr *)skb->data)->h_proto);
if(ieee->iw_mode == IW_MODE_MONITOR)
{
txb = rtllib_alloc_txb(1, skb->len, GFP_ATOMIC);
if (unlikely(!txb)) {
printk(KERN_WARNING "%s: Could not allocate TXB\n",
ieee->dev->name);
goto failed;
}
txb->encrypted = 0;
txb->payload_size = skb->len;
memcpy(skb_put(txb->fragments[0],skb->len), skb->data, skb->len);
goto success;
}
if (skb->len > 282){
if (ETH_P_IP == ether_type) {
const struct iphdr *ip = (struct iphdr *)((u8 *)skb->data+14);
if (IPPROTO_UDP == ip->protocol) {
struct udphdr *udp = (struct udphdr *)((u8 *)ip + (ip->ihl << 2));
if(((((u8 *)udp)[1] == 68) && (((u8 *)udp)[3] == 67)) ||
((((u8 *)udp)[1] == 67) && (((u8 *)udp)[3] == 68))) {
printk("DHCP pkt src port:%d, dest port:%d!!\n", ((u8 *)udp)[1],((u8 *)udp)[3]);
bdhcp = true;
#ifdef _RTL8192_EXT_PATCH_
ieee->LPSDelayCnt = 200;
#else
ieee->LPSDelayCnt = 200;
#endif
}
}
}else if(ETH_P_ARP == ether_type){
printk("=================>DHCP Protocol start tx ARP pkt!!\n");
bdhcp = true;
ieee->LPSDelayCnt = ieee->current_network.tim.tim_count;
}
}
skb->priority = rtllib_classify(skb, IsAmsdu);
if (qos_actived) {
/* in case we are a client verify acm is not set for this ac */
while (unlikely(ieee->wmm_acm & (0x01 << skb->priority))) {
printk("skb->priority = %x\n", skb->priority);
if (wme_downgrade_ac(skb)) {
break;
}
printk("converted skb->priority = %x\n", skb->priority);
}
}
memset(skb->cb, 0, sizeof(skb->cb));
#ifdef RTL8192S_WAPI_SUPPORT
if(ieee->WapiSupport && ieee->wapiInfo.bWapiEnable){
crypt = NULL;
encrypt = !(ether_type == ETH_P_PAE && ieee->ieee802_1x) &&
ieee->host_encrypt && ieee->WapiSupport && ieee->wapiInfo.bWapiEnable;
}
else{
#endif
#if defined(_RTL8192_EXT_PATCH_) || defined(ASL)
crypt = ieee->sta_crypt[ieee->tx_keyidx];
#else
crypt = ieee->crypt[ieee->tx_keyidx];
#endif
encrypt = !(ether_type == ETH_P_PAE && ieee->ieee802_1x) &&
ieee->host_encrypt && crypt && crypt->ops;
#ifdef RTL8192S_WAPI_SUPPORT
}
#endif
if (!encrypt && ieee->ieee802_1x &&
ieee->drop_unencrypted && ether_type != ETH_P_PAE) {
stats->tx_dropped++;
goto success;
}
#ifdef CONFIG_RTLLIB_DEBUG
if (crypt && !encrypt && ether_type == ETH_P_PAE) {
struct eapol *eap = (struct eapol *)(skb->data +
sizeof(struct ethhdr) - SNAP_SIZE - sizeof(u16));
RTLLIB_DEBUG_EAP("TX: IEEE 802.11 EAPOL frame: %s\n",
eap_get_type(eap->type));
}
#endif
/* Advance the SKB to the start of the payload */
skb_pull(skb, sizeof(struct ethhdr));
/* Determine total amount of storage required for TXB packets */
#ifdef ENABLE_AMSDU
if(!IsAmsdu)
bytes = skb->len + SNAP_SIZE + sizeof(u16);
else
bytes = skb->len;
#else
bytes = skb->len + SNAP_SIZE + sizeof(u16);
#endif
if (encrypt)
fc = RTLLIB_FTYPE_DATA | RTLLIB_FCTL_WEP;
else
fc = RTLLIB_FTYPE_DATA;
if(qos_actived)
fc |= RTLLIB_STYPE_QOS_DATA;
else
fc |= RTLLIB_STYPE_DATA;
#ifdef _RTL8192_EXT_PATCH_
if ((ieee->iw_mode == IW_MODE_INFRA)
|| (ieee->iw_mode == IW_MODE_MESH) )
#else
#ifdef ASL
if ((ieee->iw_mode == IW_MODE_INFRA) || (ieee->iw_mode == IW_MODE_APSTA))
#else
if (ieee->iw_mode == IW_MODE_INFRA)
#endif
#endif
{
fc |= RTLLIB_FCTL_TODS;
/* To DS: Addr1 = BSSID, Addr2 = SA,
Addr3 = DA */
memcpy(&header.addr1, ieee->current_network.bssid, ETH_ALEN);
memcpy(&header.addr2, &src, ETH_ALEN);
if(IsAmsdu)
memcpy(&header.addr3, ieee->current_network.bssid, ETH_ALEN);
else
memcpy(&header.addr3, &dest, ETH_ALEN);
} else if (ieee->iw_mode == IW_MODE_ADHOC) {
/* not From/To DS: Addr1 = DA, Addr2 = SA,
Addr3 = BSSID */
memcpy(&header.addr1, dest, ETH_ALEN);
memcpy(&header.addr2, src, ETH_ALEN);
memcpy(&header.addr3, ieee->current_network.bssid, ETH_ALEN);
}
bIsMulticast = is_broadcast_ether_addr(header.addr1) ||is_multicast_ether_addr(header.addr1);
header.frame_ctl = cpu_to_le16(fc);
/* Determine fragmentation size based on destination (multicast
* and broadcast are not fragmented) */
if (bIsMulticast) {
frag_size = MAX_FRAG_THRESHOLD;
qos_ctl |= QOS_CTL_NOTCONTAIN_ACK;
}
else {
#ifdef ENABLE_AMSDU
if(bIsSptAmsdu) {
if(ieee->iw_mode == IW_MODE_ADHOC) {
if(p_sta)
frag_size = p_sta->htinfo.AMSDU_MaxSize;
else
frag_size = ieee->pHTInfo->nAMSDU_MaxSize;
}
else
frag_size = ieee->pHTInfo->nAMSDU_MaxSize;
qos_ctl = 0;
}
else
#endif
{
frag_size = ieee->fts;
qos_ctl = 0;
}
}
if(qos_actived)
{
hdr_len = RTLLIB_3ADDR_LEN + 2;
qos_ctl |= skb->priority;
qos_ctl |= (bEosp?1:0)<<4;
#ifdef ENABLE_AMSDU
if(IsAmsdu)
{
qos_ctl |= QOS_CTL_AMSDU_PRESENT;
}
header.qos_ctl = cpu_to_le16(qos_ctl);
#else
header.qos_ctl = cpu_to_le16(qos_ctl & RTLLIB_QOS_TID);
#endif
} else {
hdr_len = RTLLIB_3ADDR_LEN;
}
/* Determine amount of payload per fragment. Regardless of if
* this stack is providing the full 802.11 header, one will
* eventually be affixed to this fragment -- so we must account for
* it when determining the amount of payload space. */
bytes_per_frag = frag_size - hdr_len;
if (ieee->config &
(CFG_RTLLIB_COMPUTE_FCS | CFG_RTLLIB_RESERVE_FCS))
bytes_per_frag -= RTLLIB_FCS_LEN;
/* Each fragment may need to have room for encryptiong pre/postfix */
if (encrypt) {
#ifdef RTL8192S_WAPI_SUPPORT
if(ieee->WapiSupport && ieee->wapiInfo.bWapiEnable)
bytes_per_frag -= ieee->wapiInfo.extra_prefix_len +
ieee->wapiInfo.extra_postfix_len;
else
#endif
bytes_per_frag -= crypt->ops->extra_prefix_len +
crypt->ops->extra_postfix_len;
}
/* Number of fragments is the total bytes_per_frag /
* payload_per_fragment */
nr_frags = bytes / bytes_per_frag;
bytes_last_frag = bytes % bytes_per_frag;
if (bytes_last_frag)
nr_frags++;
else
bytes_last_frag = bytes_per_frag;
/* When we allocate the TXB we allocate enough space for the reserve
* and full fragment bytes (bytes_per_frag doesn't include prefix,
* postfix, header, FCS, etc.) */
txb = rtllib_alloc_txb(nr_frags, frag_size + ieee->tx_headroom, GFP_ATOMIC);
if (unlikely(!txb)) {
printk(KERN_WARNING "%s: Could not allocate TXB\n",
ieee->dev->name);
goto failed;
}
txb->encrypted = encrypt;
txb->payload_size = bytes;
if(qos_actived)
{
txb->queue_index = UP2AC(skb->priority);
} else {
txb->queue_index = WME_AC_BE;;
}
for (i = 0; i < nr_frags; i++) {
skb_frag = txb->fragments[i];
tcb_desc = (cb_desc *)(skb_frag->cb + MAX_DEV_ADDR_SIZE);
#ifdef _RTL8192_EXT_PATCH_
tcb_desc->mesh_pkt = 0;
#endif
if(ieee->iw_mode == IW_MODE_ADHOC)
tcb_desc->badhoc = 1;
else
tcb_desc->badhoc = 0;
if(qos_actived){
skb_frag->priority = skb->priority;
tcb_desc->queue_index = UP2AC(skb->priority);
} else {
skb_frag->priority = WME_AC_BE;
tcb_desc->queue_index = WME_AC_BE;
}
skb_reserve(skb_frag, ieee->tx_headroom);
if (encrypt){
if (ieee->hwsec_active)
tcb_desc->bHwSec = 1;
else
tcb_desc->bHwSec = 0;
#ifdef RTL8192S_WAPI_SUPPORT
if(ieee->WapiSupport && ieee->wapiInfo.bWapiEnable)
skb_reserve(skb_frag, ieee->wapiInfo.extra_prefix_len);
else
#endif
skb_reserve(skb_frag, crypt->ops->extra_prefix_len);
}
else
{
tcb_desc->bHwSec = 0;
}
frag_hdr = (struct rtllib_hdr_3addrqos *)skb_put(skb_frag, hdr_len);
memcpy(frag_hdr, &header, hdr_len);
/* If this is not the last fragment, then add the MOREFRAGS
* bit to the frame control */
if (i != nr_frags - 1) {
frag_hdr->frame_ctl = cpu_to_le16(
fc | RTLLIB_FCTL_MOREFRAGS);
bytes = bytes_per_frag;
} else {
/* The last fragment takes the remaining length */
bytes = bytes_last_frag;
}
if((qos_actived) && (!bIsMulticast))
{
frag_hdr->seq_ctl = rtllib_query_seqnum(ieee, skb_frag, header.addr1);
frag_hdr->seq_ctl = cpu_to_le16(frag_hdr->seq_ctl<<4 | i);
} else {
frag_hdr->seq_ctl = cpu_to_le16(ieee->seq_ctrl[0]<<4 | i);
}
/* Put a SNAP header on the first fragment */
#ifdef ENABLE_AMSDU
if ((i == 0) && (!IsAmsdu))
#else
if (i == 0)
#endif
{
rtllib_put_snap(
skb_put(skb_frag, SNAP_SIZE + sizeof(u16)),
ether_type);
bytes -= SNAP_SIZE + sizeof(u16);
}
memcpy(skb_put(skb_frag, bytes), skb->data, bytes);
/* Advance the SKB... */
skb_pull(skb, bytes);
/* Encryption routine will move the header forward in order
* to insert the IV between the header and the payload */
if (encrypt) {
#ifdef RTL8192S_WAPI_SUPPORT
if(ieee->WapiSupport && ieee->wapiInfo.bWapiEnable){
if(SecSMS4HeaderFillIV(ieee, skb_frag) == 0){
SecSWSMS4Encryption(ieee, skb_frag);
} else {
spin_unlock_irqrestore(&ieee->lock, flags);
dev_kfree_skb_any(skb);
rtllib_txb_free(txb);
return 0;
}
}
else
#endif
{
#if defined(_RTL8192_EXT_PATCH_) || defined(ASL)
rtllib_encrypt_fragment(ieee, skb_frag, hdr_len, 0, 0);
#else
rtllib_encrypt_fragment(ieee, skb_frag, hdr_len);
#endif
}
}
if (ieee->config &
(CFG_RTLLIB_COMPUTE_FCS | CFG_RTLLIB_RESERVE_FCS))
skb_put(skb_frag, 4);
}
if ((!qos_actived) || (bIsMulticast)) {
if (ieee->seq_ctrl[0] == 0xFFF)
ieee->seq_ctrl[0] = 0;
else
ieee->seq_ctrl[0]++;
}
}else{
if (unlikely(skb->len < sizeof(struct rtllib_hdr_3addr))) {
printk(KERN_WARNING "%s: skb too small (%d).\n",
ieee->dev->name, skb->len);
goto success;
}
txb = rtllib_alloc_txb(1, skb->len, GFP_ATOMIC);
if(!txb){
printk(KERN_WARNING "%s: Could not allocate TXB\n",
ieee->dev->name);
goto failed;
}
txb->encrypted = 0;
txb->payload_size = skb->len;
memcpy(skb_put(txb->fragments[0],skb->len), skb->data, skb->len);
}
success:
if (txb)
{
#if 1
cb_desc *tcb_desc = (cb_desc *)(txb->fragments[0]->cb + MAX_DEV_ADDR_SIZE);
tcb_desc->bTxEnableFwCalcDur = 1;
tcb_desc->priority = skb->priority;
if(ether_type == ETH_P_PAE) {
if(ieee->pHTInfo->IOTAction & HT_IOT_ACT_WA_IOT_Broadcom)
{
#ifdef ASL
tcb_desc->data_rate = MgntQuery_TxRateExcludeCCKRates(ieee,0);
#else
tcb_desc->data_rate = MgntQuery_TxRateExcludeCCKRates(ieee);
#endif
tcb_desc->bTxDisableRateFallBack = false;
}else{
tcb_desc->data_rate = ieee->basic_rate;
tcb_desc->bTxDisableRateFallBack = 1;
}
tcb_desc->RATRIndex = 7;
tcb_desc->bTxUseDriverAssingedRate = 1;
} else {
if (is_multicast_ether_addr(header.addr1))
tcb_desc->bMulticast = 1;
if (is_broadcast_ether_addr(header.addr1))
tcb_desc->bBroadcast = 1;
#if defined(RTL8192U) || defined(RTL8192SU) || defined(RTL8192SE) || defined RTL8192CE
if ( tcb_desc->bMulticast || tcb_desc->bBroadcast){
rtllib_txrate_selectmode(ieee, tcb_desc, p_sta);
tcb_desc->data_rate = ieee->basic_rate;
}
else
{
if(ieee->iw_mode == IW_MODE_ADHOC)
{
u8 is_peer_shortGI_40M = 0;
u8 is_peer_shortGI_20M = 0;
u8 is_peer_BW_40M = 0;
p_sta = GetStaInfo(ieee, header.addr1);
if(NULL == p_sta)
{
rtllib_txrate_selectmode(ieee, tcb_desc, p_sta);
tcb_desc->data_rate = ieee->rate;
}
else
{
rtllib_txrate_selectmode(ieee, tcb_desc, p_sta);
tcb_desc->data_rate = CURRENT_RATE(p_sta->wireless_mode, p_sta->CurDataRate, p_sta->htinfo.HTHighestOperaRate);
is_peer_shortGI_40M = p_sta->htinfo.bCurShortGI40MHz;
is_peer_shortGI_20M = p_sta->htinfo.bCurShortGI20MHz;
is_peer_BW_40M = p_sta->htinfo.bCurTxBW40MHz;
}
rtllib_qurey_ShortPreambleMode(ieee, tcb_desc);
rtllib_tx_query_agg_cap(ieee, txb->fragments[0], tcb_desc);
rtllib_entry_query_HTCapShortGI(ieee, tcb_desc,is_peer_shortGI_40M,is_peer_shortGI_20M);
rtllib_entry_query_BandwidthMode(ieee, tcb_desc,is_peer_BW_40M);
rtllib_query_protectionmode(ieee, tcb_desc, txb->fragments[0]);
} else {
rtllib_txrate_selectmode(ieee, tcb_desc, p_sta);
tcb_desc->data_rate = CURRENT_RATE(ieee->mode, ieee->rate, ieee->HTCurrentOperaRate);
if(bdhcp == true){
if(ieee->pHTInfo->IOTAction & HT_IOT_ACT_WA_IOT_Broadcom) {
tcb_desc->data_rate = MGN_1M;
tcb_desc->bTxDisableRateFallBack = false;
}else{
tcb_desc->data_rate = MGN_1M;
tcb_desc->bTxDisableRateFallBack = 1;
}
tcb_desc->RATRIndex = 7;
tcb_desc->bTxUseDriverAssingedRate = 1;
tcb_desc->bdhcp = 1;
}
rtllib_qurey_ShortPreambleMode(ieee, tcb_desc);
rtllib_tx_query_agg_cap(ieee, txb->fragments[0], tcb_desc);
rtllib_query_HTCapShortGI(ieee, tcb_desc);
rtllib_query_BandwidthMode(ieee, tcb_desc);
rtllib_query_protectionmode(ieee, tcb_desc, txb->fragments[0]);
#ifdef _RTL8192_EXT_PATCH_
ieee->LinkDetectInfo.NumTxUnicastOkInPeriod ++;
#endif
}
}
#else
rtllib_txrate_selectmode(ieee, tcb_desc);
if ( tcb_desc->bMulticast || tcb_desc->bBroadcast)
tcb_desc->data_rate = ieee->basic_rate;
else
tcb_desc->data_rate = CURRENT_RATE(ieee->mode, ieee->rate, ieee->HTCurrentOperaRate);
if(bdhcp == true){
if(ieee->pHTInfo->IOTAction & HT_IOT_ACT_WA_IOT_Broadcom)
{
#ifdef ASL
tcb_desc->data_rate = MgntQuery_TxRateExcludeCCKRates(ieee,0);
#else
tcb_desc->data_rate = MgntQuery_TxRateExcludeCCKRates(ieee);
#endif
tcb_desc->bTxDisableRateFallBack = false;
}else{
tcb_desc->data_rate = MGN_1M;
tcb_desc->bTxDisableRateFallBack = 1;
}
tcb_desc->RATRIndex = 7;
tcb_desc->bTxUseDriverAssingedRate = 1;
tcb_desc->bdhcp = 1;
}
rtllib_qurey_ShortPreambleMode(ieee, tcb_desc);
rtllib_tx_query_agg_cap(ieee, txb->fragments[0], tcb_desc);
rtllib_query_HTCapShortGI(ieee, tcb_desc);
rtllib_query_BandwidthMode(ieee, tcb_desc);
rtllib_query_protectionmode(ieee, tcb_desc, txb->fragments[0]);
#endif
}
#endif
}
spin_unlock_irqrestore(&ieee->lock, flags);
dev_kfree_skb_any(skb);
if (txb) {
if (ieee->softmac_features & IEEE_SOFTMAC_TX_QUEUE){
#if (LINUX_VERSION_CODE > KERNEL_VERSION(2,6,18))
dev->stats.tx_packets++;
dev->stats.tx_bytes += txb->payload_size;
#endif
rtllib_softmac_xmit(txb, ieee);
}else{
if ((*ieee->hard_start_xmit)(txb, dev) == 0) {
stats->tx_packets++;
stats->tx_bytes += txb->payload_size;
return 0;
}
rtllib_txb_free(txb);
}
}
return 0;
failed:
spin_unlock_irqrestore(&ieee->lock, flags);
netif_stop_queue(dev);
stats->tx_errors++;
return 1;
}
int rtllib_xmit(struct sk_buff *skb, struct net_device *dev)
{
memset(skb->cb, 0, sizeof(skb->cb));
return rtllib_xmit_inter(skb, dev);
}