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
 37static 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
 64void 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			continue;
 75
 76		skb2 = skb_clone(skb, GFP_ATOMIC);
 77		skb2->dev = sdata->dev;
 78		skb2->pkt_type = PACKET_HOST;
 79		data = skb_put(skb2, 2);
 80		data[0] = crc & 0xff;
 81		data[1] = crc >> 8;
 82
 83		netif_rx_ni(skb2);
 84	}
 85	rcu_read_unlock();
 86}
 87
 88static const struct net_device_ops mac802154_monitor_ops = {
 89	.ndo_open		= mac802154_slave_open,
 90	.ndo_stop		= mac802154_slave_close,
 91	.ndo_start_xmit		= mac802154_monitor_xmit,
 92};
 93
 94void mac802154_monitor_setup(struct net_device *dev)
 95{
 96	struct mac802154_sub_if_data *priv;
 97
 98	dev->addr_len		= 0;
 99	dev->hard_header_len	= 0;
100	dev->needed_tailroom	= 2; /* room for FCS */
101	dev->mtu		= IEEE802154_MTU;
102	dev->tx_queue_len	= 10;
103	dev->type		= ARPHRD_IEEE802154_MONITOR;
104	dev->flags		= IFF_NOARP | IFF_BROADCAST;
105	dev->watchdog_timeo	= 0;
106
107	dev->destructor		= free_netdev;
108	dev->netdev_ops		= &mac802154_monitor_ops;
109	dev->ml_priv		= &mac802154_mlme_reduced;
110
111	priv = netdev_priv(dev);
112	priv->type = IEEE802154_DEV_MONITOR;
113
114	priv->chan = MAC802154_CHAN_NONE; /* not initialized */
115	priv->page = 0;
116}