kernel/2.6.29.6-aldebaran-rt/drivers/staging/otus/wrap_pkt.c

   1 /*
   2  * Copyright (c) 2007-2008 Atheros Communications Inc.
   3  *
   4  * Permission to use, copy, modify, and/or distribute this software for any
   5  * purpose with or without fee is hereby granted, provided that the above
   6  * copyright notice and this permission notice appear in all copies.
   7  *
   8  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
   9  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
  10  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
  11  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
  12  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
  13  * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
  14  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
  15  */
  16 /*                                                                      */
  17 /*  Module Name : wrap_pkt.c                                            */
  18 /*                                                                      */
  19 /*  Abstract                                                            */
  20 /*     This module contains wrapper functions for packet handling       */
  21 /*                                                                      */
  22 /*  NOTES                                                               */
  23 /*     Platform dependent.                                              */
  24 /*                                                                      */
  25 /************************************************************************/
  26
  27 #include "oal_dt.h"
  28 #include "usbdrv.h"
  29
  30 #include <linux/netlink.h>
  31
  32 #if WIRELESS_EXT > 12
  33 #include <net/iw_handler.h>
  34 #endif
  35
  36
  37
  38 //extern struct zsWdsStruct wds[ZM_WDS_PORT_NUMBER];
  39 extern struct zsVapStruct vap[ZM_VAP_PORT_NUMBER];
  40
  41
  42 /***** Rx *****/
  43 void zfLnxRecv80211(zdev_t* dev, zbuf_t* buf, struct zsAdditionInfo* addInfo)
  44 {
  45     u16_t frameType;
  46     u16_t frameCtrl;
  47     u16_t frameSubtype;
  48     zbuf_t *skb1;
  49     struct usbdrv_private *macp = dev->ml_priv;
  50
  51     //frameCtrl = zmw_buf_readb(dev, buf, 0);
  52     frameCtrl = *(u8_t*)((u8_t*)buf->data);
  53     frameType = frameCtrl & 0xf;
  54     frameSubtype = frameCtrl & 0xf0;
  55
  56     if ((frameType == 0x0) && (macp->forwardMgmt))
  57     {
  58         switch (frameSubtype)
  59         {
  60                 /* Beacon */
  61             case 0x80 :
  62                 /* Probe response */
  63             case 0x50 :
  64                 skb1 = skb_copy(buf, GFP_ATOMIC);
  65                 if(skb1 != NULL)
  66                 {
  67                     skb1->dev = dev;
  68                     skb1->mac_header = skb1->data;
  69                     skb1->ip_summed = CHECKSUM_NONE;
  70                     skb1->pkt_type = PACKET_OTHERHOST;
  71                     skb1->protocol = __constant_htons(0x0019);  /* ETH_P_80211_RAW */
  72                     netif_rx(skb1);
  73                     }
  74                 break;
  75             default:
  76                 break;
  77         }
  78     }
  79
  80     zfiRecv80211(dev, buf, addInfo);
  81     return;
  82 }
  83
  84 #define ZM_AVOID_UDP_LARGE_PACKET_FAIL
  85 void zfLnxRecvEth(zdev_t* dev, zbuf_t* buf, u16_t port)
  86 {
  87     struct usbdrv_private *macp = dev->ml_priv;
  88 #ifdef ZM_AVOID_UDP_LARGE_PACKET_FAIL
  89     zbuf_t *new_buf;
  90
  91     //new_buf = dev_alloc_skb(2048);
  92     new_buf = dev_alloc_skb(buf->len);
  93
  94 #ifdef NET_SKBUFF_DATA_USES_OFFSET
  95     new_buf->tail = 0;
  96     new_buf->len = 0;
  97 #else
  98     new_buf->tail = new_buf->data;
  99     new_buf->len = 0;
 100 #endif
 101
 102     skb_put(new_buf, buf->len);
 103     memcpy(new_buf->data, buf->data, buf->len);
 104
 105     /* Free buffer */
 106     dev_kfree_skb_any(buf);
 107
 108     if (port == 0)
 109     {
 110         new_buf->dev = dev;
 111         new_buf->protocol = eth_type_trans(new_buf, dev);
 112     }
 113     else
 114     {
 115         /* VAP */
 116         if (vap[0].dev != NULL)
 117         {
 118             new_buf->dev = vap[0].dev;
 119             new_buf->protocol = eth_type_trans(new_buf, vap[0].dev);
 120         }
 121         else
 122         {
 123             new_buf->dev = dev;
 124             new_buf->protocol = eth_type_trans(new_buf, dev);
 125         }
 126     }
 127
 128     new_buf->ip_summed = CHECKSUM_NONE;
 129     dev->last_rx = jiffies;
 130
 131     switch(netif_rx(new_buf))
 132 #else
 133     if (port == 0)
 134     {
 135         buf->dev = dev;
 136         buf->protocol = eth_type_trans(buf, dev);
 137     }
 138     else
 139     {
 140         /* VAP */
 141         if (vap[0].dev != NULL)
 142         {
 143             buf->dev = vap[0].dev;
 144             buf->protocol = eth_type_trans(buf, vap[0].dev);
 145         }
 146         else
 147         {
 148             buf->dev = dev;
 149             buf->protocol = eth_type_trans(buf, dev);
 150         }
 151     }
 152
 153     buf->ip_summed = CHECKSUM_NONE;
 154     dev->last_rx = jiffies;
 155
 156     switch(netif_rx(buf))
 157 #endif
 158     {
 159     case NET_RX_BAD:
 160     case NET_RX_DROP:
 161     case NET_RX_CN_MOD:
 162     case NET_RX_CN_HIGH:
 163         break;
 164     default:
 165             macp->drv_stats.net_stats.rx_packets++;
 166             macp->drv_stats.net_stats.rx_bytes += buf->len;
 167         break;
 168     }
 169
 170     return;
 171 }
 172
 173 /* Leave an empty line below to remove warning message on some compiler */