YOSHIFUJI Hideaki | 8e87d14 | 2007-02-09 23:24:33 +0900 | [diff] [blame] | 1 | /* |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2 | BNEP implementation for Linux Bluetooth stack (BlueZ). |
| 3 | Copyright (C) 2001-2002 Inventel Systemes |
| 4 | Written 2001-2002 by |
Jan Engelhardt | 96de0e2 | 2007-10-19 23:21:04 +0200 | [diff] [blame] | 5 | Clément Moreau <clement.moreau@inventel.fr> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 6 | David Libault <david.libault@inventel.fr> |
| 7 | |
| 8 | Copyright (C) 2002 Maxim Krasnyansky <maxk@qualcomm.com> |
| 9 | |
| 10 | This program is free software; you can redistribute it and/or modify |
| 11 | it under the terms of the GNU General Public License version 2 as |
| 12 | published by the Free Software Foundation; |
| 13 | |
| 14 | THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS |
| 15 | OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, |
| 16 | FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT OF THIRD PARTY RIGHTS. |
| 17 | IN NO EVENT SHALL THE COPYRIGHT HOLDER(S) AND AUTHOR(S) BE LIABLE FOR ANY |
YOSHIFUJI Hideaki | 8e87d14 | 2007-02-09 23:24:33 +0900 | [diff] [blame] | 18 | CLAIM, OR ANY SPECIAL INDIRECT OR CONSEQUENTIAL DAMAGES, OR ANY DAMAGES |
| 19 | WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN |
| 20 | ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 21 | OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. |
| 22 | |
YOSHIFUJI Hideaki | 8e87d14 | 2007-02-09 23:24:33 +0900 | [diff] [blame] | 23 | ALL LIABILITY, INCLUDING LIABILITY FOR INFRINGEMENT OF ANY PATENTS, |
| 24 | COPYRIGHTS, TRADEMARKS OR OTHER RIGHTS, RELATING TO USE OF THIS |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 25 | SOFTWARE IS DISCLAIMED. |
| 26 | */ |
| 27 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 28 | #include <linux/module.h> |
Tejun Heo | 5a0e3ad | 2010-03-24 17:04:11 +0900 | [diff] [blame] | 29 | #include <linux/slab.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 30 | |
| 31 | #include <linux/socket.h> |
| 32 | #include <linux/netdevice.h> |
| 33 | #include <linux/etherdevice.h> |
| 34 | #include <linux/skbuff.h> |
| 35 | #include <linux/wait.h> |
| 36 | |
| 37 | #include <asm/unaligned.h> |
| 38 | |
| 39 | #include <net/bluetooth/bluetooth.h> |
| 40 | #include <net/bluetooth/hci_core.h> |
| 41 | #include <net/bluetooth/l2cap.h> |
| 42 | |
| 43 | #include "bnep.h" |
| 44 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 45 | #define BNEP_TX_QUEUE_LEN 20 |
| 46 | |
| 47 | static int bnep_net_open(struct net_device *dev) |
| 48 | { |
| 49 | netif_start_queue(dev); |
| 50 | return 0; |
| 51 | } |
| 52 | |
| 53 | static int bnep_net_close(struct net_device *dev) |
| 54 | { |
| 55 | netif_stop_queue(dev); |
| 56 | return 0; |
| 57 | } |
| 58 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 59 | static void bnep_net_set_mc_list(struct net_device *dev) |
| 60 | { |
| 61 | #ifdef CONFIG_BT_BNEP_MC_FILTER |
Wang Chen | 524ad0a | 2008-11-12 23:39:10 -0800 | [diff] [blame] | 62 | struct bnep_session *s = netdev_priv(dev); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 63 | struct sock *sk = s->sock->sk; |
| 64 | struct bnep_set_filter_req *r; |
| 65 | struct sk_buff *skb; |
| 66 | int size; |
| 67 | |
Jiri Pirko | 4cd24ea | 2010-02-08 04:30:35 +0000 | [diff] [blame] | 68 | BT_DBG("%s mc_count %d", dev->name, netdev_mc_count(dev)); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 69 | |
| 70 | size = sizeof(*r) + (BNEP_MAX_MULTICAST_FILTERS + 1) * ETH_ALEN * 2; |
| 71 | skb = alloc_skb(size, GFP_ATOMIC); |
| 72 | if (!skb) { |
| 73 | BT_ERR("%s Multicast list allocation failed", dev->name); |
| 74 | return; |
| 75 | } |
| 76 | |
| 77 | r = (void *) skb->data; |
| 78 | __skb_put(skb, sizeof(*r)); |
| 79 | |
| 80 | r->type = BNEP_CONTROL; |
| 81 | r->ctrl = BNEP_FILTER_MULTI_ADDR_SET; |
| 82 | |
YOSHIFUJI Hideaki | 8e87d14 | 2007-02-09 23:24:33 +0900 | [diff] [blame] | 83 | if (dev->flags & (IFF_PROMISC | IFF_ALLMULTI)) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 84 | u8 start[ETH_ALEN] = { 0x01 }; |
| 85 | |
| 86 | /* Request all addresses */ |
| 87 | memcpy(__skb_put(skb, ETH_ALEN), start, ETH_ALEN); |
| 88 | memcpy(__skb_put(skb, ETH_ALEN), dev->broadcast, ETH_ALEN); |
| 89 | r->len = htons(ETH_ALEN * 2); |
| 90 | } else { |
Jiri Pirko | 22bedad3 | 2010-04-01 21:22:57 +0000 | [diff] [blame] | 91 | struct netdev_hw_addr *ha; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 92 | int i, len = skb->len; |
| 93 | |
| 94 | if (dev->flags & IFF_BROADCAST) { |
| 95 | memcpy(__skb_put(skb, ETH_ALEN), dev->broadcast, ETH_ALEN); |
| 96 | memcpy(__skb_put(skb, ETH_ALEN), dev->broadcast, ETH_ALEN); |
YOSHIFUJI Hideaki | 8e87d14 | 2007-02-09 23:24:33 +0900 | [diff] [blame] | 97 | } |
| 98 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 99 | /* FIXME: We should group addresses here. */ |
| 100 | |
Jiri Pirko | ff6e216 | 2010-03-01 05:09:14 +0000 | [diff] [blame] | 101 | i = 0; |
Jiri Pirko | 22bedad3 | 2010-04-01 21:22:57 +0000 | [diff] [blame] | 102 | netdev_for_each_mc_addr(ha, dev) { |
Jiri Pirko | ff6e216 | 2010-03-01 05:09:14 +0000 | [diff] [blame] | 103 | if (i == BNEP_MAX_MULTICAST_FILTERS) |
| 104 | break; |
Jiri Pirko | 22bedad3 | 2010-04-01 21:22:57 +0000 | [diff] [blame] | 105 | memcpy(__skb_put(skb, ETH_ALEN), ha->addr, ETH_ALEN); |
| 106 | memcpy(__skb_put(skb, ETH_ALEN), ha->addr, ETH_ALEN); |
Gustavo F. Padovan | 1a61a83 | 2010-06-18 14:24:00 +0000 | [diff] [blame] | 107 | |
| 108 | i++; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 109 | } |
| 110 | r->len = htons(skb->len - len); |
| 111 | } |
| 112 | |
| 113 | skb_queue_tail(&sk->sk_write_queue, skb); |
Eric Dumazet | aa39514 | 2010-04-20 13:03:51 +0000 | [diff] [blame] | 114 | wake_up_interruptible(sk_sleep(sk)); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 115 | #endif |
| 116 | } |
| 117 | |
| 118 | static int bnep_net_set_mac_addr(struct net_device *dev, void *arg) |
| 119 | { |
| 120 | BT_DBG("%s", dev->name); |
| 121 | return 0; |
| 122 | } |
| 123 | |
| 124 | static void bnep_net_timeout(struct net_device *dev) |
| 125 | { |
| 126 | BT_DBG("net_timeout"); |
| 127 | netif_wake_queue(dev); |
| 128 | } |
| 129 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 130 | #ifdef CONFIG_BT_BNEP_MC_FILTER |
| 131 | static inline int bnep_net_mc_filter(struct sk_buff *skb, struct bnep_session *s) |
| 132 | { |
| 133 | struct ethhdr *eh = (void *) skb->data; |
| 134 | |
| 135 | if ((eh->h_dest[0] & 1) && !test_bit(bnep_mc_hash(eh->h_dest), (ulong *) &s->mc_filter)) |
| 136 | return 1; |
| 137 | return 0; |
| 138 | } |
| 139 | #endif |
| 140 | |
| 141 | #ifdef CONFIG_BT_BNEP_PROTO_FILTER |
| 142 | /* Determine ether protocol. Based on eth_type_trans. */ |
| 143 | static inline u16 bnep_net_eth_proto(struct sk_buff *skb) |
| 144 | { |
| 145 | struct ethhdr *eh = (void *) skb->data; |
Al Viro | e41d216 | 2006-11-08 00:27:36 -0800 | [diff] [blame] | 146 | u16 proto = ntohs(eh->h_proto); |
YOSHIFUJI Hideaki | 8e87d14 | 2007-02-09 23:24:33 +0900 | [diff] [blame] | 147 | |
Al Viro | e41d216 | 2006-11-08 00:27:36 -0800 | [diff] [blame] | 148 | if (proto >= 1536) |
| 149 | return proto; |
YOSHIFUJI Hideaki | 8e87d14 | 2007-02-09 23:24:33 +0900 | [diff] [blame] | 150 | |
Al Viro | e41d216 | 2006-11-08 00:27:36 -0800 | [diff] [blame] | 151 | if (get_unaligned((__be16 *) skb->data) == htons(0xFFFF)) |
| 152 | return ETH_P_802_3; |
YOSHIFUJI Hideaki | 8e87d14 | 2007-02-09 23:24:33 +0900 | [diff] [blame] | 153 | |
Al Viro | e41d216 | 2006-11-08 00:27:36 -0800 | [diff] [blame] | 154 | return ETH_P_802_2; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 155 | } |
| 156 | |
| 157 | static inline int bnep_net_proto_filter(struct sk_buff *skb, struct bnep_session *s) |
| 158 | { |
| 159 | u16 proto = bnep_net_eth_proto(skb); |
| 160 | struct bnep_proto_filter *f = s->proto_filter; |
| 161 | int i; |
YOSHIFUJI Hideaki | 8e87d14 | 2007-02-09 23:24:33 +0900 | [diff] [blame] | 162 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 163 | for (i = 0; i < BNEP_MAX_PROTO_FILTERS && f[i].end; i++) { |
| 164 | if (proto >= f[i].start && proto <= f[i].end) |
| 165 | return 0; |
| 166 | } |
| 167 | |
| 168 | BT_DBG("BNEP: filtered skb %p, proto 0x%.4x", skb, proto); |
| 169 | return 1; |
| 170 | } |
| 171 | #endif |
| 172 | |
Stephen Hemminger | 6fef4c0 | 2009-08-31 19:50:41 +0000 | [diff] [blame] | 173 | static netdev_tx_t bnep_net_xmit(struct sk_buff *skb, |
| 174 | struct net_device *dev) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 175 | { |
Wang Chen | 524ad0a | 2008-11-12 23:39:10 -0800 | [diff] [blame] | 176 | struct bnep_session *s = netdev_priv(dev); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 177 | struct sock *sk = s->sock->sk; |
| 178 | |
| 179 | BT_DBG("skb %p, dev %p", skb, dev); |
| 180 | |
| 181 | #ifdef CONFIG_BT_BNEP_MC_FILTER |
| 182 | if (bnep_net_mc_filter(skb, s)) { |
| 183 | kfree_skb(skb); |
Patrick McHardy | 6ed1065 | 2009-06-23 06:03:08 +0000 | [diff] [blame] | 184 | return NETDEV_TX_OK; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 185 | } |
| 186 | #endif |
YOSHIFUJI Hideaki | 8e87d14 | 2007-02-09 23:24:33 +0900 | [diff] [blame] | 187 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 188 | #ifdef CONFIG_BT_BNEP_PROTO_FILTER |
| 189 | if (bnep_net_proto_filter(skb, s)) { |
| 190 | kfree_skb(skb); |
Patrick McHardy | 6ed1065 | 2009-06-23 06:03:08 +0000 | [diff] [blame] | 191 | return NETDEV_TX_OK; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 192 | } |
| 193 | #endif |
YOSHIFUJI Hideaki | 8e87d14 | 2007-02-09 23:24:33 +0900 | [diff] [blame] | 194 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 195 | /* |
| 196 | * We cannot send L2CAP packets from here as we are potentially in a bh. |
| 197 | * So we have to queue them and wake up session thread which is sleeping |
Eric Dumazet | aa39514 | 2010-04-20 13:03:51 +0000 | [diff] [blame] | 198 | * on the sk_sleep(sk). |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 199 | */ |
| 200 | dev->trans_start = jiffies; |
| 201 | skb_queue_tail(&sk->sk_write_queue, skb); |
Eric Dumazet | aa39514 | 2010-04-20 13:03:51 +0000 | [diff] [blame] | 202 | wake_up_interruptible(sk_sleep(sk)); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 203 | |
| 204 | if (skb_queue_len(&sk->sk_write_queue) >= BNEP_TX_QUEUE_LEN) { |
| 205 | BT_DBG("tx queue is full"); |
| 206 | |
| 207 | /* Stop queuing. |
| 208 | * Session thread will do netif_wake_queue() */ |
| 209 | netif_stop_queue(dev); |
| 210 | } |
| 211 | |
Patrick McHardy | 6ed1065 | 2009-06-23 06:03:08 +0000 | [diff] [blame] | 212 | return NETDEV_TX_OK; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 213 | } |
| 214 | |
Stephen Hemminger | b4d7f0a | 2009-01-07 17:23:17 -0800 | [diff] [blame] | 215 | static const struct net_device_ops bnep_netdev_ops = { |
| 216 | .ndo_open = bnep_net_open, |
| 217 | .ndo_stop = bnep_net_close, |
| 218 | .ndo_start_xmit = bnep_net_xmit, |
| 219 | .ndo_validate_addr = eth_validate_addr, |
| 220 | .ndo_set_multicast_list = bnep_net_set_mc_list, |
| 221 | .ndo_set_mac_address = bnep_net_set_mac_addr, |
| 222 | .ndo_tx_timeout = bnep_net_timeout, |
| 223 | .ndo_change_mtu = eth_change_mtu, |
| 224 | |
| 225 | }; |
| 226 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 227 | void bnep_net_setup(struct net_device *dev) |
| 228 | { |
| 229 | |
| 230 | memset(dev->broadcast, 0xff, ETH_ALEN); |
| 231 | dev->addr_len = ETH_ALEN; |
| 232 | |
| 233 | ether_setup(dev); |
Stephen Hemminger | b4d7f0a | 2009-01-07 17:23:17 -0800 | [diff] [blame] | 234 | dev->netdev_ops = &bnep_netdev_ops; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 235 | |
| 236 | dev->watchdog_timeo = HZ * 2; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 237 | } |