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