wireless: radiotap updates
[safe/jmp/linux-2.6] / drivers / net / wireless / libertas / rx.c
index 2049559..63d7e19 100644 (file)
@@ -35,160 +35,140 @@ struct rx80211packethdr {
        void *eth80211_hdr;
 } __attribute__ ((packed));
 
-static int process_rxed_802_11_packet(lbs_private *priv, struct sk_buff *skb);
+static int process_rxed_802_11_packet(struct lbs_private *priv,
+       struct sk_buff *skb);
 
 /**
  *  @brief This function computes the avgSNR .
  *
- *  @param priv    A pointer to lbs_private structure
+ *  @param priv    A pointer to struct lbs_private structure
  *  @return       avgSNR
  */
-static u8 lbs_getavgsnr(lbs_private *priv)
+static u8 lbs_getavgsnr(struct lbs_private *priv)
 {
        u8 i;
        u16 temp = 0;
-       lbs_adapter *adapter = priv->adapter;
-       if (adapter->numSNRNF == 0)
+       if (priv->numSNRNF == 0)
                return 0;
-       for (i = 0; i < adapter->numSNRNF; i++)
-               temp += adapter->rawSNR[i];
-       return (u8) (temp / adapter->numSNRNF);
+       for (i = 0; i < priv->numSNRNF; i++)
+               temp += priv->rawSNR[i];
+       return (u8) (temp / priv->numSNRNF);
 
 }
 
 /**
  *  @brief This function computes the AvgNF
  *
- *  @param priv    A pointer to lbs_private structure
+ *  @param priv    A pointer to struct lbs_private structure
  *  @return       AvgNF
  */
-static u8 lbs_getavgnf(lbs_private *priv)
+static u8 lbs_getavgnf(struct lbs_private *priv)
 {
        u8 i;
        u16 temp = 0;
-       lbs_adapter *adapter = priv->adapter;
-       if (adapter->numSNRNF == 0)
+       if (priv->numSNRNF == 0)
                return 0;
-       for (i = 0; i < adapter->numSNRNF; i++)
-               temp += adapter->rawNF[i];
-       return (u8) (temp / adapter->numSNRNF);
+       for (i = 0; i < priv->numSNRNF; i++)
+               temp += priv->rawNF[i];
+       return (u8) (temp / priv->numSNRNF);
 
 }
 
 /**
  *  @brief This function save the raw SNR/NF to our internel buffer
  *
- *  @param priv    A pointer to lbs_private structure
+ *  @param priv    A pointer to struct lbs_private structure
  *  @param prxpd   A pointer to rxpd structure of received packet
  *  @return       n/a
  */
-static void lbs_save_rawSNRNF(lbs_private *priv, struct rxpd *p_rx_pd)
+static void lbs_save_rawSNRNF(struct lbs_private *priv, struct rxpd *p_rx_pd)
 {
-       lbs_adapter *adapter = priv->adapter;
-       if (adapter->numSNRNF < DEFAULT_DATA_AVG_FACTOR)
-               adapter->numSNRNF++;
-       adapter->rawSNR[adapter->nextSNRNF] = p_rx_pd->snr;
-       adapter->rawNF[adapter->nextSNRNF] = p_rx_pd->nf;
-       adapter->nextSNRNF++;
-       if (adapter->nextSNRNF >= DEFAULT_DATA_AVG_FACTOR)
-               adapter->nextSNRNF = 0;
+       if (priv->numSNRNF < DEFAULT_DATA_AVG_FACTOR)
+               priv->numSNRNF++;
+       priv->rawSNR[priv->nextSNRNF] = p_rx_pd->snr;
+       priv->rawNF[priv->nextSNRNF] = p_rx_pd->nf;
+       priv->nextSNRNF++;
+       if (priv->nextSNRNF >= DEFAULT_DATA_AVG_FACTOR)
+               priv->nextSNRNF = 0;
        return;
 }
 
 /**
  *  @brief This function computes the RSSI in received packet.
  *
- *  @param priv    A pointer to lbs_private structure
+ *  @param priv    A pointer to struct lbs_private structure
  *  @param prxpd   A pointer to rxpd structure of received packet
  *  @return       n/a
  */
-static void lbs_compute_rssi(lbs_private *priv, struct rxpd *p_rx_pd)
+static void lbs_compute_rssi(struct lbs_private *priv, struct rxpd *p_rx_pd)
 {
-       lbs_adapter *adapter = priv->adapter;
 
        lbs_deb_enter(LBS_DEB_RX);
 
        lbs_deb_rx("rxpd: SNR %d, NF %d\n", p_rx_pd->snr, p_rx_pd->nf);
        lbs_deb_rx("before computing SNR: SNR-avg = %d, NF-avg = %d\n",
-              adapter->SNR[TYPE_RXPD][TYPE_AVG] / AVG_SCALE,
-              adapter->NF[TYPE_RXPD][TYPE_AVG] / AVG_SCALE);
+              priv->SNR[TYPE_RXPD][TYPE_AVG] / AVG_SCALE,
+              priv->NF[TYPE_RXPD][TYPE_AVG] / AVG_SCALE);
 
-       adapter->SNR[TYPE_RXPD][TYPE_NOAVG] = p_rx_pd->snr;
-       adapter->NF[TYPE_RXPD][TYPE_NOAVG] = p_rx_pd->nf;
+       priv->SNR[TYPE_RXPD][TYPE_NOAVG] = p_rx_pd->snr;
+       priv->NF[TYPE_RXPD][TYPE_NOAVG] = p_rx_pd->nf;
        lbs_save_rawSNRNF(priv, p_rx_pd);
 
-       adapter->SNR[TYPE_RXPD][TYPE_AVG] = lbs_getavgsnr(priv) * AVG_SCALE;
-       adapter->NF[TYPE_RXPD][TYPE_AVG] = lbs_getavgnf(priv) * AVG_SCALE;
+       priv->SNR[TYPE_RXPD][TYPE_AVG] = lbs_getavgsnr(priv) * AVG_SCALE;
+       priv->NF[TYPE_RXPD][TYPE_AVG] = lbs_getavgnf(priv) * AVG_SCALE;
        lbs_deb_rx("after computing SNR: SNR-avg = %d, NF-avg = %d\n",
-              adapter->SNR[TYPE_RXPD][TYPE_AVG] / AVG_SCALE,
-              adapter->NF[TYPE_RXPD][TYPE_AVG] / AVG_SCALE);
+              priv->SNR[TYPE_RXPD][TYPE_AVG] / AVG_SCALE,
+              priv->NF[TYPE_RXPD][TYPE_AVG] / AVG_SCALE);
 
-       adapter->RSSI[TYPE_RXPD][TYPE_NOAVG] =
-           CAL_RSSI(adapter->SNR[TYPE_RXPD][TYPE_NOAVG],
-                    adapter->NF[TYPE_RXPD][TYPE_NOAVG]);
+       priv->RSSI[TYPE_RXPD][TYPE_NOAVG] =
+           CAL_RSSI(priv->SNR[TYPE_RXPD][TYPE_NOAVG],
+                    priv->NF[TYPE_RXPD][TYPE_NOAVG]);
 
-       adapter->RSSI[TYPE_RXPD][TYPE_AVG] =
-           CAL_RSSI(adapter->SNR[TYPE_RXPD][TYPE_AVG] / AVG_SCALE,
-                    adapter->NF[TYPE_RXPD][TYPE_AVG] / AVG_SCALE);
+       priv->RSSI[TYPE_RXPD][TYPE_AVG] =
+           CAL_RSSI(priv->SNR[TYPE_RXPD][TYPE_AVG] / AVG_SCALE,
+                    priv->NF[TYPE_RXPD][TYPE_AVG] / AVG_SCALE);
 
        lbs_deb_leave(LBS_DEB_RX);
 }
 
-void lbs_upload_rx_packet(lbs_private *priv, struct sk_buff *skb)
-{
-       lbs_deb_rx("skb->data %p\n", skb->data);
-
-       if (priv->adapter->monitormode != LBS_MONITOR_OFF) {
-               skb->protocol = eth_type_trans(skb, priv->rtap_net_dev);
-       } else {
-               if (priv->mesh_dev && IS_MESH_FRAME(skb))
-                       skb->protocol = eth_type_trans(skb, priv->mesh_dev);
-               else
-                       skb->protocol = eth_type_trans(skb, priv->dev);
-       }
-       skb->ip_summed = CHECKSUM_UNNECESSARY;
-       netif_rx(skb);
-}
-
 /**
  *  @brief This function processes received packet and forwards it
  *  to kernel/upper layer
  *
- *  @param priv    A pointer to lbs_private
+ *  @param priv    A pointer to struct lbs_private
  *  @param skb     A pointer to skb which includes the received packet
  *  @return       0 or -1
  */
-int lbs_process_rxed_packet(lbs_private *priv, struct sk_buff *skb)
+int lbs_process_rxed_packet(struct lbs_private *priv, struct sk_buff *skb)
 {
-       lbs_adapter *adapter = priv->adapter;
        int ret = 0;
-
+       struct net_device *dev = priv->dev;
        struct rxpackethdr *p_rx_pkt;
        struct rxpd *p_rx_pd;
-
        int hdrchop;
        struct ethhdr *p_ethhdr;
-
        const u8 rfc1042_eth_hdr[] = { 0xaa, 0xaa, 0x03, 0x00, 0x00, 0x00 };
 
        lbs_deb_enter(LBS_DEB_RX);
 
-       if (priv->adapter->monitormode != LBS_MONITOR_OFF)
+       BUG_ON(!skb);
+
+       skb->ip_summed = CHECKSUM_NONE;
+
+       if (priv->monitormode)
                return process_rxed_802_11_packet(priv, skb);
 
        p_rx_pkt = (struct rxpackethdr *) skb->data;
        p_rx_pd = &p_rx_pkt->rx_pd;
-       if (p_rx_pd->rx_control & RxPD_MESH_FRAME)
-               SET_MESH_FRAME(skb);
-       else
-               UNSET_MESH_FRAME(skb);
+       if (priv->mesh_dev && (p_rx_pd->rx_control & RxPD_MESH_FRAME))
+               dev = priv->mesh_dev;
 
        lbs_deb_hex(LBS_DEB_RX, "RX Data: Before chop rxpd", skb->data,
                 min_t(unsigned int, skb->len, 100));
 
        if (skb->len < (ETH_HLEN + 8 + sizeof(struct rxpd))) {
                lbs_deb_rx("rx err: frame received with bad length\n");
-               priv->stats.rx_length_errors++;
+               dev->stats.rx_length_errors++;
                ret = 0;
                goto done;
        }
@@ -199,7 +179,7 @@ int lbs_process_rxed_packet(lbs_private *priv, struct sk_buff *skb)
        if (!(p_rx_pd->status & cpu_to_le16(MRVDRV_RXPD_STATUS_OK))) {
                lbs_deb_rx("rx err: frame received with bad status\n");
                lbs_pr_alert("rxpd not ok\n");
-               priv->stats.rx_errors++;
+               dev->stats.rx_errors++;
                ret = 0;
                goto done;
        }
@@ -257,16 +237,20 @@ int lbs_process_rxed_packet(lbs_private *priv, struct sk_buff *skb)
        /* Take the data rate from the rxpd structure
         * only if the rate is auto
         */
-       if (adapter->auto_rate)
-               adapter->cur_rate = lbs_fw_index_to_data_rate(p_rx_pd->rx_rate);
+       if (priv->enablehwauto)
+               priv->cur_rate = lbs_fw_index_to_data_rate(p_rx_pd->rx_rate);
 
        lbs_compute_rssi(priv, p_rx_pd);
 
        lbs_deb_rx("rx data: size of actual packet %d\n", skb->len);
-       priv->stats.rx_bytes += skb->len;
-       priv->stats.rx_packets++;
+       dev->stats.rx_bytes += skb->len;
+       dev->stats.rx_packets++;
 
-       lbs_upload_rx_packet(priv, skb);
+       skb->protocol = eth_type_trans(skb, dev);
+       if (in_interrupt())
+               netif_rx(skb);
+       else
+               netif_rx_ni(skb);
 
        ret = 0;
 done:
@@ -319,15 +303,15 @@ static u8 convert_mv_rate_to_radiotap(u8 rate)
  *  @brief This function processes a received 802.11 packet and forwards it
  *  to kernel/upper layer
  *
- *  @param priv    A pointer to lbs_private
+ *  @param priv    A pointer to struct lbs_private
  *  @param skb     A pointer to skb which includes the received packet
  *  @return       0 or -1
  */
-static int process_rxed_802_11_packet(lbs_private *priv, struct sk_buff *skb)
+static int process_rxed_802_11_packet(struct lbs_private *priv,
+       struct sk_buff *skb)
 {
-       lbs_adapter *adapter = priv->adapter;
        int ret = 0;
-
+       struct net_device *dev = priv->dev;
        struct rx80211packethdr *p_rx_pkt;
        struct rxpd *prxpd;
        struct rx_radiotap_hdr radiotap_hdr;
@@ -341,9 +325,10 @@ static int process_rxed_802_11_packet(lbs_private *priv, struct sk_buff *skb)
        // lbs_deb_hex(LBS_DEB_RX, "RX Data: Before chop rxpd", skb->data, min(skb->len, 100));
 
        if (skb->len < (ETH_HLEN + 8 + sizeof(struct rxpd))) {
-               lbs_deb_rx("rx err: frame received wit bad length\n");
-               priv->stats.rx_length_errors++;
-               ret = 0;
+               lbs_deb_rx("rx err: frame received with bad length\n");
+               dev->stats.rx_length_errors++;
+               ret = -EINVAL;
+               kfree_skb(skb);
                goto done;
        }
 
@@ -352,72 +337,55 @@ static int process_rxed_802_11_packet(lbs_private *priv, struct sk_buff *skb)
         */
        if (!(prxpd->status & cpu_to_le16(MRVDRV_RXPD_STATUS_OK))) {
                //lbs_deb_rx("rx err: frame received with bad status\n");
-               priv->stats.rx_errors++;
+               dev->stats.rx_errors++;
        }
 
        lbs_deb_rx("rx data: skb->len-sizeof(RxPd) = %d-%zd = %zd\n",
               skb->len, sizeof(struct rxpd), skb->len - sizeof(struct rxpd));
 
        /* create the exported radio header */
-       if (priv->adapter->monitormode == LBS_MONITOR_OFF) {
-               /* no radio header */
-               /* chop the rxpd */
-               skb_pull(skb, sizeof(struct rxpd));
-       }
 
-       else {
-               /* radiotap header */
-               radiotap_hdr.hdr.it_version = 0;
-               /* XXX must check this value for pad */
-               radiotap_hdr.hdr.it_pad = 0;
-               radiotap_hdr.hdr.it_len = cpu_to_le16 (sizeof(struct rx_radiotap_hdr));
-               radiotap_hdr.hdr.it_present = cpu_to_le32 (RX_RADIOTAP_PRESENT);
-               /* unknown values */
-               radiotap_hdr.flags = 0;
-               radiotap_hdr.chan_freq = 0;
-               radiotap_hdr.chan_flags = 0;
-               radiotap_hdr.antenna = 0;
-               /* known values */
-               radiotap_hdr.rate = convert_mv_rate_to_radiotap(prxpd->rx_rate);
-               /* XXX must check no carryout */
-               radiotap_hdr.antsignal = prxpd->snr + prxpd->nf;
-               radiotap_hdr.rx_flags = 0;
-               if (!(prxpd->status & cpu_to_le16(MRVDRV_RXPD_STATUS_OK)))
-                       radiotap_hdr.rx_flags |= IEEE80211_RADIOTAP_F_RX_BADFCS;
-               //memset(radiotap_hdr.pad, 0x11, IEEE80211_RADIOTAP_HDRLEN - 18);
-
-               /* chop the rxpd */
-               skb_pull(skb, sizeof(struct rxpd));
-
-               /* add space for the new radio header */
-               if ((skb_headroom(skb) < sizeof(struct rx_radiotap_hdr)) &&
-                   pskb_expand_head(skb, sizeof(struct rx_radiotap_hdr), 0,
-                                    GFP_ATOMIC)) {
-                       lbs_pr_alert("%s: couldn't pskb_expand_head\n",
-                              __func__);
-               }
-
-               pradiotap_hdr =
-                   (struct rx_radiotap_hdr *)skb_push(skb,
-                                                    sizeof(struct
-                                                           rx_radiotap_hdr));
-               memcpy(pradiotap_hdr, &radiotap_hdr,
-                      sizeof(struct rx_radiotap_hdr));
+       /* radiotap header */
+       radiotap_hdr.hdr.it_version = 0;
+       /* XXX must check this value for pad */
+       radiotap_hdr.hdr.it_pad = 0;
+       radiotap_hdr.hdr.it_len = cpu_to_le16 (sizeof(struct rx_radiotap_hdr));
+       radiotap_hdr.hdr.it_present = cpu_to_le32 (RX_RADIOTAP_PRESENT);
+       if (!(prxpd->status & cpu_to_le16(MRVDRV_RXPD_STATUS_OK)))
+               radiotap_hdr.flags |= IEEE80211_RADIOTAP_F_BADFCS;
+       radiotap_hdr.rate = convert_mv_rate_to_radiotap(prxpd->rx_rate);
+       /* XXX must check no carryout */
+       radiotap_hdr.antsignal = prxpd->snr + prxpd->nf;
+
+       /* chop the rxpd */
+       skb_pull(skb, sizeof(struct rxpd));
+
+       /* add space for the new radio header */
+       if ((skb_headroom(skb) < sizeof(struct rx_radiotap_hdr)) &&
+           pskb_expand_head(skb, sizeof(struct rx_radiotap_hdr), 0, GFP_ATOMIC)) {
+               lbs_pr_alert("%s: couldn't pskb_expand_head\n", __func__);
+               ret = -ENOMEM;
+               kfree_skb(skb);
+               goto done;
        }
 
+       pradiotap_hdr = (void *)skb_push(skb, sizeof(struct rx_radiotap_hdr));
+       memcpy(pradiotap_hdr, &radiotap_hdr, sizeof(struct rx_radiotap_hdr));
+
        /* Take the data rate from the rxpd structure
         * only if the rate is auto
         */
-       if (adapter->auto_rate)
-               adapter->cur_rate = lbs_fw_index_to_data_rate(prxpd->rx_rate);
+       if (priv->enablehwauto)
+               priv->cur_rate = lbs_fw_index_to_data_rate(prxpd->rx_rate);
 
        lbs_compute_rssi(priv, prxpd);
 
        lbs_deb_rx("rx data: size of actual packet %d\n", skb->len);
-       priv->stats.rx_bytes += skb->len;
-       priv->stats.rx_packets++;
+       dev->stats.rx_bytes += skb->len;
+       dev->stats.rx_packets++;
 
-       lbs_upload_rx_packet(priv, skb);
+       skb->protocol = eth_type_trans(skb, priv->rtap_net_dev);
+       netif_rx(skb);
 
        ret = 0;