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 | * | |
0606069d | 13 | * Written by: |
14 | * Dmitry Eremin-Solenikov <dbaryshkov@gmail.com> | |
15 | * Sergey Lapin <slapin@ossfans.org> | |
16 | * Maxim Gorbachyov <maxim.gorbachev@siemens.com> | |
17 | * Alexander Smirnov <alex.bluesman.smirnov@gmail.com> | |
18 | */ | |
19 | ||
20 | #include <linux/netdevice.h> | |
21 | #include <linux/skbuff.h> | |
22 | #include <linux/if_arp.h> | |
23 | #include <linux/crc-ccitt.h> | |
24 | ||
25 | #include <net/ieee802154.h> | |
26 | #include <net/mac802154.h> | |
27 | #include <net/netlink.h> | |
28 | #include <net/wpan-phy.h> | |
29 | #include <linux/nl802154.h> | |
30 | ||
0f1556bc | 31 | #include "ieee802154_i.h" |
0606069d | 32 | |
33 | static netdev_tx_t mac802154_monitor_xmit(struct sk_buff *skb, | |
34 | struct net_device *dev) | |
35 | { | |
36 | struct mac802154_sub_if_data *priv; | |
37 | u8 chan, page; | |
38 | ||
39 | priv = netdev_priv(dev); | |
40 | ||
41 | /* FIXME: locking */ | |
42 | chan = priv->hw->phy->current_channel; | |
43 | page = priv->hw->phy->current_page; | |
44 | ||
45 | if (chan == MAC802154_CHAN_NONE) /* not initialized */ | |
46 | return NETDEV_TX_OK; | |
47 | ||
48 | if (WARN_ON(page >= WPAN_NUM_PAGES) || | |
49 | WARN_ON(chan >= WPAN_NUM_CHANNELS)) | |
50 | return NETDEV_TX_OK; | |
51 | ||
52 | skb->skb_iif = dev->ifindex; | |
53 | dev->stats.tx_packets++; | |
54 | dev->stats.tx_bytes += skb->len; | |
55 | ||
56 | return mac802154_tx(priv->hw, skb, page, chan); | |
57 | } | |
58 | ||
59 | ||
60 | void mac802154_monitors_rx(struct mac802154_priv *priv, struct sk_buff *skb) | |
61 | { | |
62 | struct sk_buff *skb2; | |
63 | struct mac802154_sub_if_data *sdata; | |
64 | u16 crc = crc_ccitt(0, skb->data, skb->len); | |
65 | u8 *data; | |
66 | ||
67 | rcu_read_lock(); | |
68 | list_for_each_entry_rcu(sdata, &priv->slaves, list) { | |
2d3b5b0a PB |
69 | if (sdata->type != IEEE802154_DEV_MONITOR || |
70 | !netif_running(sdata->dev)) | |
0606069d | 71 | continue; |
72 | ||
73 | skb2 = skb_clone(skb, GFP_ATOMIC); | |
74 | skb2->dev = sdata->dev; | |
75 | skb2->pkt_type = PACKET_HOST; | |
76 | data = skb_put(skb2, 2); | |
77 | data[0] = crc & 0xff; | |
78 | data[1] = crc >> 8; | |
79 | ||
80 | netif_rx_ni(skb2); | |
81 | } | |
82 | rcu_read_unlock(); | |
83 | } | |
84 | ||
85 | static const struct net_device_ops mac802154_monitor_ops = { | |
86 | .ndo_open = mac802154_slave_open, | |
87 | .ndo_stop = mac802154_slave_close, | |
88 | .ndo_start_xmit = mac802154_monitor_xmit, | |
89 | }; | |
90 | ||
91 | void mac802154_monitor_setup(struct net_device *dev) | |
92 | { | |
93 | struct mac802154_sub_if_data *priv; | |
94 | ||
95 | dev->addr_len = 0; | |
96 | dev->hard_header_len = 0; | |
97 | dev->needed_tailroom = 2; /* room for FCS */ | |
98 | dev->mtu = IEEE802154_MTU; | |
99 | dev->tx_queue_len = 10; | |
100 | dev->type = ARPHRD_IEEE802154_MONITOR; | |
101 | dev->flags = IFF_NOARP | IFF_BROADCAST; | |
102 | dev->watchdog_timeo = 0; | |
103 | ||
104 | dev->destructor = free_netdev; | |
105 | dev->netdev_ops = &mac802154_monitor_ops; | |
106 | dev->ml_priv = &mac802154_mlme_reduced; | |
107 | ||
108 | priv = netdev_priv(dev); | |
109 | priv->type = IEEE802154_DEV_MONITOR; | |
110 | ||
111 | priv->chan = MAC802154_CHAN_NONE; /* not initialized */ | |
112 | priv->page = 0; | |
113 | } |