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
mac802154_monitor_xmit(struct sk_buff * skb,struct net_device * dev)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
mac802154_monitors_rx(struct mac802154_priv * priv,struct sk_buff * skb)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
mac802154_monitor_setup(struct net_device * dev)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 }
118