Commit | Line | Data |
---|---|---|
0606069d | 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) { | |
2d3b5b0a PB |
73 | if (sdata->type != IEEE802154_DEV_MONITOR || |
74 | !netif_running(sdata->dev)) | |
0606069d | 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 | } |