projects / deliverable / linux.git / blame
| 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 | } |