net/mac802154/monitor.c

   1 /*
   2  * Copyright 2007, 2008, 2009 Siemens AG
   3  *
   4  * This program is free software; you can redistribute it and/or modify
   5  * it under the terms of the GNU General Public License version 2
   6  * as published by the Free Software Foundation.
   7  *
   8  * This program is distributed in the hope that it will be useful,
   9  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  10  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  11  * GNU General Public License for more details.
  12  *
  13  * You should have received a copy of the GNU General Public License along
  14  * with this program; if not, write to the Free Software Foundation, Inc.,
  15  * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
  16  *
  17  * Written by:
  18  * Dmitry Eremin-Solenikov <dbaryshkov@gmail.com>
  19  * Sergey Lapin <slapin@ossfans.org>
  20  * Maxim Gorbachyov <maxim.gorbachev@siemens.com>
  21  * Alexander Smirnov <alex.bluesman.smirnov@gmail.com>
  22  */
  23
  24 #include <linux/netdevice.h>
  25 #include <linux/skbuff.h>
  26 #include <linux/if_arp.h>
  27 #include <linux/crc-ccitt.h>
  28
  29 #include <net/ieee802154.h>
  30 #include <net/mac802154.h>
  31 #include <net/netlink.h>
  32 #include <net/wpan-phy.h>
  33 #include <linux/nl802154.h>
  34
  35 #include "mac802154.h"
  36
  37 static netdev_tx_t mac802154_monitor_xmit(struct sk_buff *skb,
  38                                           struct net_device *dev)
  39 {
  40         struct mac802154_sub_if_data *priv;
  41         u8 chan, page;
  42
  43         priv = netdev_priv(dev);
  44
  45         /* FIXME: locking */
  46         chan = priv->hw->phy->current_channel;
  47         page = priv->hw->phy->current_page;
  48
  49         if (chan == MAC802154_CHAN_NONE) /* not initialized */
  50                 return NETDEV_TX_OK;
  51
  52         if (WARN_ON(page >= WPAN_NUM_PAGES) ||
  53             WARN_ON(chan >= WPAN_NUM_CHANNELS))
  54                 return NETDEV_TX_OK;
  55
  56         skb->skb_iif = dev->ifindex;
  57         dev->stats.tx_packets++;
  58         dev->stats.tx_bytes += skb->len;
  59
  60         return mac802154_tx(priv->hw, skb, page, chan);
  61 }
  62
  63
  64 void mac802154_monitors_rx(struct mac802154_priv *priv, struct sk_buff *skb)
  65 {
  66         struct sk_buff *skb2;
  67         struct mac802154_sub_if_data *sdata;
  68         u16 crc = crc_ccitt(0, skb->data, skb->len);
  69         u8 *data;
  70
  71         rcu_read_lock();
  72         list_for_each_entry_rcu(sdata, &priv->slaves, list) {
  73                 if (sdata->type != IEEE802154_DEV_MONITOR ||
  74                     !netif_running(sdata->dev))
  75                         continue;
  76
  77                 skb2 = skb_clone(skb, GFP_ATOMIC);
  78                 skb2->dev = sdata->dev;
  79                 skb2->pkt_type = PACKET_HOST;
  80                 data = skb_put(skb2, 2);
  81                 data[0] = crc & 0xff;
  82                 data[1] = crc >> 8;
  83
  84                 netif_rx_ni(skb2);
  85         }
  86         rcu_read_unlock();
  87 }
  88
  89 static const struct net_device_ops mac802154_monitor_ops = {
  90         .ndo_open               = mac802154_slave_open,
  91         .ndo_stop               = mac802154_slave_close,
  92         .ndo_start_xmit         = mac802154_monitor_xmit,
  93 };
  94
  95 void mac802154_monitor_setup(struct net_device *dev)
  96 {
  97         struct mac802154_sub_if_data *priv;
  98
  99         dev->addr_len           = 0;
 100         dev->hard_header_len    = 0;
 101         dev->needed_tailroom    = 2; /* room for FCS */
 102         dev->mtu                = IEEE802154_MTU;
 103         dev->tx_queue_len       = 10;
 104         dev->type               = ARPHRD_IEEE802154_MONITOR;
 105         dev->flags              = IFF_NOARP | IFF_BROADCAST;
 106         dev->watchdog_timeo     = 0;
 107
 108         dev->destructor         = free_netdev;
 109         dev->netdev_ops         = &mac802154_monitor_ops;
 110         dev->ml_priv            = &mac802154_mlme_reduced;
 111
 112         priv = netdev_priv(dev);
 113         priv->type = IEEE802154_DEV_MONITOR;
 114
 115         priv->chan = MAC802154_CHAN_NONE; /* not initialized */
 116         priv->page = 0;
 117 }