int hdd_mon_hard_start_xmit(struct sk_buff *skb, struct net_device *dev) { v_U16_t rt_hdr_len; struct ieee80211_hdr *hdr; hdd_adapter_t *pPgBkAdapter, *pAdapter = WLAN_HDD_GET_PRIV_PTR(dev); struct ieee80211_radiotap_header *rtap_hdr = (struct ieee80211_radiotap_header *)skb->data; /*Supplicant sends the EAPOL packet on monitor interface*/ pPgBkAdapter = pAdapter->sessionCtx.monitor.pAdapterForTx; if(pPgBkAdapter == NULL) { VOS_TRACE( VOS_MODULE_ID_HDD, VOS_TRACE_LEVEL_FATAL, "%s: No Adapter to piggy back. Dropping the pkt on monitor inf", __func__); goto fail; /* too short to be possibly valid */ } /* check if toal skb length is greater then radio tab header length of not */ if (unlikely(skb->len < sizeof(struct ieee80211_radiotap_header))) goto fail; /* too short to be possibly valid */ /* check if radio tap header version is correct or not */ if (unlikely(rtap_hdr->it_version)) goto fail; /* only version 0 is supported */ /*Strip off the radio tap header*/ rt_hdr_len = ieee80211_get_radiotap_len(skb->data); /* check if skb length if greator then total radio tap header length ot not*/ if (unlikely(skb->len < rt_hdr_len)) goto fail; /* Update the trans_start for this netdev */ dev->trans_start = jiffies; /* * fix up the pointers accounting for the radiotap * header still being in there. */ skb_set_mac_header(skb, rt_hdr_len); skb_set_network_header(skb, rt_hdr_len); skb_set_transport_header(skb, rt_hdr_len); /* Pull rtap header out of the skb */ skb_pull(skb, rt_hdr_len); /*Supplicant adds: radiotap Hdr + radiotap data + 80211 Header. So after * radio tap header and 802.11 header starts */ hdr = (struct ieee80211_hdr *)skb->data; /* Send data frames through the normal Data path. In this path we will * conver rcvd 802.11 packet to 802.3 packet */ if ( (hdr->frame_control & HDD_FRAME_TYPE_MASK) == HDD_FRAME_TYPE_DATA) { v_U8_t da[6]; v_U8_t sa[6]; memcpy (da, hdr->addr1, VOS_MAC_ADDR_SIZE); memcpy (sa, hdr->addr2, VOS_MAC_ADDR_SIZE); /* Pull 802.11 MAC header */ skb_pull(skb, HDD_80211_HEADER_LEN); if ( HDD_FRAME_SUBTYPE_QOSDATA == (hdr->frame_control & HDD_FRAME_SUBTYPE_MASK)) { skb_pull(skb, HDD_80211_HEADER_QOS_CTL); } /* Pull LLC header */ skb_pull(skb, HDD_LLC_HDR_LEN); /* Create space for Ethernet header */ skb_push(skb, HDD_MAC_HDR_SIZE*2); memcpy(&skb->data[0], da, HDD_MAC_HDR_SIZE); memcpy(&skb->data[HDD_DEST_ADDR_OFFSET], sa, HDD_MAC_HDR_SIZE); /* Only EAPOL Data packets are allowed through monitor interface */ if (vos_be16_to_cpu( (*(unsigned short*)&skb->data[HDD_ETHERTYPE_802_1_X_FRAME_OFFSET]) ) != HDD_ETHERTYPE_802_1_X) { VOS_TRACE( VOS_MODULE_ID_HDD, VOS_TRACE_LEVEL_FATAL, "%s: Not a Eapol packet. Drop this frame", __func__); //If not EAPOL frames, drop them. kfree_skb(skb); return NETDEV_TX_OK; } skb->protocol = htons(HDD_ETHERTYPE_802_1_X); hdd_hostapd_select_queue(pPgBkAdapter->dev, skb); return hdd_softap_hard_start_xmit( skb, pPgBkAdapter->dev ); } else { VOS_STATUS status; WLANTL_ACEnumType ac = 0; skb_list_node_t *pktNode = NULL; v_SIZE_t pktListSize = 0; spin_lock(&pAdapter->wmm_tx_queue[ac].lock); //If we have already reached the max queue size, disable the TX queue if ( pAdapter->wmm_tx_queue[ac].count == pAdapter->wmm_tx_queue[ac].max_size) { /* We want to process one packet at a time, so lets disable all TX queues * and re-enable the queues once we get TX feedback for this packet */ netif_tx_stop_all_queues(pAdapter->dev); pAdapter->isTxSuspended[ac] = VOS_TRUE; spin_unlock(&pAdapter->wmm_tx_queue[ac].lock); return NETDEV_TX_BUSY; } spin_unlock(&pAdapter->wmm_tx_queue[ac].lock); //Use the skb->cb field to hold the list node information pktNode = (skb_list_node_t *)&skb->cb; //Stick the OS packet inside this node. pktNode->skb = skb; INIT_LIST_HEAD(&pktNode->anchor); //Insert the OS packet into the appropriate AC queue spin_lock(&pAdapter->wmm_tx_queue[ac].lock); status = hdd_list_insert_back_size( &pAdapter->wmm_tx_queue[ac], &pktNode->anchor, &pktListSize ); spin_unlock(&pAdapter->wmm_tx_queue[ac].lock); if ( !VOS_IS_STATUS_SUCCESS( status ) ) { VOS_TRACE( VOS_MODULE_ID_HDD, VOS_TRACE_LEVEL_ERROR, "%s:Insert Tx queue failed. Pkt dropped", __FUNCTION__); kfree_skb(skb); return NETDEV_TX_OK; } if ( pktListSize == 1 ) { /* In this context we cannot acquire any mutex etc. And to transmit * this packet we need to call SME API. So to take care of this we will * schedule a workqueue */ schedule_work(&pPgBkAdapter->monTxWorkQueue); } return NETDEV_TX_OK; } fail: VOS_TRACE( VOS_MODULE_ID_HDD, VOS_TRACE_LEVEL_WARN, "%s: Packet Rcvd at Monitor interface is not proper," " Dropping the packet", __func__); kfree_skb(skb); return NETDEV_TX_OK; }
/** * @brief ATWILC_WFI_mon_xmit * @details * @param[in] * @return int : Return 0 on Success * @author mdaftedar * @date 12 JUL 2012 * @version 1.0 */ static netdev_tx_t ATWILC_WFI_mon_xmit(struct sk_buff *skb, struct net_device *dev) { struct ieee80211_radiotap_header *rtap_hdr; ATL_Uint32 rtap_len,i,ret=0; struct ATWILC_WFI_mon_priv *mon_priv ; struct sk_buff *skb2; struct atwilc_wfi_radiotap_cb_hdr *cb_hdr; //PRINT_D(HOSTAPD_DBG,"Monitor xmit function b4\n"); /* Bug 4601 */ if(atwilc_wfi_mon == NULL) return ATL_FAIL; //if(skb->data[3] == 0x10 || skb->data[3] == 0xb0) mon_priv = netdev_priv(atwilc_wfi_mon); if(mon_priv== NULL) { PRINT_ER("Monitor interface private structure is NULL\n"); return ATL_FAIL; } rtap_hdr = (struct ieee80211_radiotap_header *)skb->data; rtap_len = ieee80211_get_radiotap_len(skb->data); if (skb->len < rtap_len) { PRINT_ER("Error in radiotap header\n"); return -1; } /* skip the radiotap header */ PRINT_INFO(HOSTAPD_DBG,"Radiotap len: %d\n", rtap_len); if(INFO) { for(i=0; i<rtap_len ; i++) PRINT_INFO(HOSTAPD_DBG,"Radiotap_hdr[%d] %02x\n",i,skb->data[i]); } /* Skip the ratio tap header */ skb_pull(skb, rtap_len); if( skb->data[0] == 0xc0) PRINT_INFO(HOSTAPD_DBG, "%x:%x:%x:%x:%x%x\n",skb->data[4],skb->data[5],skb->data[6],skb->data[7],skb->data[8],skb->data[9]); if( skb->data[0] == 0xc0 &&(!(memcmp(broadcast, &skb->data[4],6) )) ) { skb2 = dev_alloc_skb(skb->len+sizeof(struct atwilc_wfi_radiotap_cb_hdr)); memcpy(skb_put(skb2,skb->len),skb->data, skb->len); cb_hdr = (struct atwilc_wfi_radiotap_cb_hdr *) skb_push(skb2, sizeof(*cb_hdr)); memset(cb_hdr, 0, sizeof(struct atwilc_wfi_radiotap_cb_hdr)); cb_hdr->hdr.it_version = 0;//PKTHDR_RADIOTAP_VERSION; cb_hdr->hdr.it_len = cpu_to_le16(sizeof(struct atwilc_wfi_radiotap_cb_hdr)); cb_hdr->hdr.it_present = cpu_to_le32( (1 << IEEE80211_RADIOTAP_RATE) | (1 << IEEE80211_RADIOTAP_TX_FLAGS)); cb_hdr->rate = 5;//txrate->bitrate / 5; cb_hdr->tx_flags = 0x0004; skb2->dev = atwilc_wfi_mon; skb_set_mac_header(skb2, 0); skb2->ip_summed = CHECKSUM_UNNECESSARY; skb2->pkt_type = PACKET_OTHERHOST; skb2->protocol = htons(ETH_P_802_2); memset(skb2->cb, 0, sizeof(skb2->cb)); netif_rx(skb2); return 0; } skb->dev = mon_priv->real_ndev; PRINT_INFO(HOSTAPD_DBG,"Skipping the radiotap header\n"); /* actual deliver of data is device-specific, and not shown here */ PRINT_INFO(HOSTAPD_DBG,"SKB netdevice name = %s\n", skb->dev->name); PRINT_INFO(HOSTAPD_DBG,"MONITOR real dev name = %s\n", mon_priv->real_ndev->name); #ifdef SIMULATION ret = ATWILC_WFI_Tx(skb,mon_priv->real_ndev); #elif USE_WIRELESS //Identify if Ethernet or MAC header (data or mgmt) memcpy(srcAdd,& skb->data[10],6); memcpy(bssid, &skb->data[16],6); //if source address and bssid fields are equal>>Mac header /*send it to mgmt frames handler */ if(!(memcmp(srcAdd,bssid,6))) { //ATL_PRINTF("--MGMT PKT in mon_xmit--\n"); mon_mgmt_tx(mon_priv->real_ndev, skb->data, skb->len); dev_kfree_skb(skb); } else ret = mac_xmit(skb,mon_priv->real_ndev); #endif //return NETDEV_TX_OK; return ret; }
/** * @brief WILC_WFI_mon_xmit * @details * @param[in] * @return int : Return 0 on Success * @author mdaftedar * @date 12 JUL 2012 * @version 1.0 */ static netdev_tx_t WILC_WFI_mon_xmit(struct sk_buff *skb, struct net_device *dev) { u32 rtap_len, ret = 0; struct WILC_WFI_mon_priv *mon_priv; struct sk_buff *skb2; struct wilc_wfi_radiotap_cb_hdr *cb_hdr; if (!wilc_wfi_mon) return -EFAULT; mon_priv = netdev_priv(wilc_wfi_mon); if (!mon_priv) return -EFAULT; rtap_len = ieee80211_get_radiotap_len(skb->data); if (skb->len < rtap_len) return -1; skb_pull(skb, rtap_len); if (skb->data[0] == 0xc0 && (!(memcmp(broadcast, &skb->data[4], 6)))) { skb2 = dev_alloc_skb(skb->len + sizeof(struct wilc_wfi_radiotap_cb_hdr)); memcpy(skb_put(skb2, skb->len), skb->data, skb->len); cb_hdr = (struct wilc_wfi_radiotap_cb_hdr *)skb_push(skb2, sizeof(*cb_hdr)); memset(cb_hdr, 0, sizeof(struct wilc_wfi_radiotap_cb_hdr)); cb_hdr->hdr.it_version = 0; /* PKTHDR_RADIOTAP_VERSION; */ cb_hdr->hdr.it_len = cpu_to_le16(sizeof(struct wilc_wfi_radiotap_cb_hdr)); cb_hdr->hdr.it_present = cpu_to_le32( (1 << IEEE80211_RADIOTAP_RATE) | (1 << IEEE80211_RADIOTAP_TX_FLAGS)); cb_hdr->rate = 5; /* txrate->bitrate / 5; */ cb_hdr->tx_flags = 0x0004; skb2->dev = wilc_wfi_mon; skb_set_mac_header(skb2, 0); skb2->ip_summed = CHECKSUM_UNNECESSARY; skb2->pkt_type = PACKET_OTHERHOST; skb2->protocol = htons(ETH_P_802_2); memset(skb2->cb, 0, sizeof(skb2->cb)); netif_rx(skb2); return 0; } skb->dev = mon_priv->real_ndev; /* Identify if Ethernet or MAC header (data or mgmt) */ memcpy(srcadd, &skb->data[10], 6); memcpy(bssid, &skb->data[16], 6); /* if source address and bssid fields are equal>>Mac header */ /*send it to mgmt frames handler */ if (!(memcmp(srcadd, bssid, 6))) { ret = mon_mgmt_tx(mon_priv->real_ndev, skb->data, skb->len); if (ret) netdev_err(dev, "fail to mgmt tx\n"); dev_kfree_skb(skb); } else { ret = wilc_mac_xmit(skb, mon_priv->real_ndev); } return ret; }
static netdev_tx_t wilc_wfi_mon_xmit(struct sk_buff *skb, struct net_device *dev) { u32 rtap_len, ret = 0; struct wilc_wfi_mon_priv *mon_priv; struct sk_buff *skb2; struct wilc_wfi_radiotap_cb_hdr *cb_hdr; if (!wilc_wfi_mon) return -EFAULT; mon_priv = netdev_priv(wilc_wfi_mon); if (!mon_priv) return -EFAULT; rtap_len = ieee80211_get_radiotap_len(skb->data); if (skb->len < rtap_len) return -1; skb_pull(skb, rtap_len); if (skb->data[0] == 0xc0 && is_broadcast_ether_addr(&skb->data[4])) { skb2 = dev_alloc_skb(skb->len + sizeof(*cb_hdr)); if (!skb2) return -ENOMEM; skb_put_data(skb2, skb->data, skb->len); cb_hdr = skb_push(skb2, sizeof(*cb_hdr)); memset(cb_hdr, 0, sizeof(struct wilc_wfi_radiotap_cb_hdr)); cb_hdr->hdr.it_version = 0; /* PKTHDR_RADIOTAP_VERSION; */ cb_hdr->hdr.it_len = cpu_to_le16(sizeof(*cb_hdr)); cb_hdr->hdr.it_present = cpu_to_le32(TX_RADIOTAP_PRESENT); cb_hdr->rate = 5; cb_hdr->tx_flags = 0x0004; skb2->dev = wilc_wfi_mon; skb_reset_mac_header(skb2); skb2->ip_summed = CHECKSUM_UNNECESSARY; skb2->pkt_type = PACKET_OTHERHOST; skb2->protocol = htons(ETH_P_802_2); memset(skb2->cb, 0, sizeof(skb2->cb)); netif_rx(skb2); return 0; } skb->dev = mon_priv->real_ndev; memcpy(srcadd, &skb->data[10], 6); memcpy(bssid, &skb->data[16], 6); /* * Identify if data or mgmt packet, if source address and bssid * fields are equal send it to mgmt frames handler */ if (!(memcmp(srcadd, bssid, 6))) { ret = mon_mgmt_tx(mon_priv->real_ndev, skb->data, skb->len); if (ret) netdev_err(dev, "fail to mgmt tx\n"); dev_kfree_skb(skb); } else { ret = wilc_mac_xmit(skb, mon_priv->real_ndev); } return ret; }