Blame view
net/phonet/pep-gprs.c
6.82 KB
02a47617c Phonet: implement... |
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 |
/* * File: pep-gprs.c * * GPRS over Phonet pipe end point socket * * Copyright (C) 2008 Nokia Corporation. * * Author: Rémi Denis-Courmont <remi.denis-courmont@nokia.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. * * This program is distributed in the hope that it will be useful, but * WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU * General Public License for more details. * * You should have received a copy of the GNU General Public License * along with this program; if not, write to the Free Software * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA * 02110-1301 USA */ #include <linux/kernel.h> #include <linux/netdevice.h> #include <linux/if_ether.h> #include <linux/if_arp.h> #include <net/sock.h> #include <linux/if_phonet.h> #include <net/tcp_states.h> #include <net/phonet/gprs.h> #define GPRS_DEFAULT_MTU 1400 struct gprs_dev { struct sock *sk; void (*old_state_change)(struct sock *); void (*old_data_ready)(struct sock *, int); void (*old_write_space)(struct sock *); |
09a2c3c0d Phonet: improve G... |
42 |
struct net_device *dev; |
02a47617c Phonet: implement... |
43 |
}; |
5c7f03335 phonet: sparse an... |
44 |
static __be16 gprs_type_trans(struct sk_buff *skb) |
02a47617c Phonet: implement... |
45 46 47 48 49 50 |
{ const u8 *pvfc; u8 buf; pvfc = skb_header_pointer(skb, 0, 1, &buf); if (!pvfc) |
5c7f03335 phonet: sparse an... |
51 |
return htons(0); |
02a47617c Phonet: implement... |
52 53 54 55 56 57 58 |
/* Look at IP version field */ switch (*pvfc >> 4) { case 4: return htons(ETH_P_IP); case 6: return htons(ETH_P_IPV6); } |
5c7f03335 phonet: sparse an... |
59 |
return htons(0); |
02a47617c Phonet: implement... |
60 |
} |
893873f39 Phonet: get rid o... |
61 62 63 64 65 66 67 |
static void gprs_writeable(struct gprs_dev *gp) { struct net_device *dev = gp->dev; if (pep_writeable(gp->sk)) netif_wake_queue(dev); } |
02a47617c Phonet: implement... |
68 69 70 71 72 73 |
/* * Socket callbacks */ static void gprs_state_change(struct sock *sk) { |
09a2c3c0d Phonet: improve G... |
74 |
struct gprs_dev *gp = sk->sk_user_data; |
02a47617c Phonet: implement... |
75 76 |
if (sk->sk_state == TCP_CLOSE_WAIT) { |
09a2c3c0d Phonet: improve G... |
77 78 79 80 |
struct net_device *dev = gp->dev; netif_stop_queue(dev); netif_carrier_off(dev); |
02a47617c Phonet: implement... |
81 82 |
} } |
09a2c3c0d Phonet: improve G... |
83 |
static int gprs_recv(struct gprs_dev *gp, struct sk_buff *skb) |
02a47617c Phonet: implement... |
84 |
{ |
09a2c3c0d Phonet: improve G... |
85 |
struct net_device *dev = gp->dev; |
02a47617c Phonet: implement... |
86 |
int err = 0; |
5c7f03335 phonet: sparse an... |
87 |
__be16 protocol = gprs_type_trans(skb); |
02a47617c Phonet: implement... |
88 89 90 91 92 |
if (!protocol) { err = -EINVAL; goto drop; } |
fc6a11075 Phonet: zero-copy... |
93 |
if (skb_headroom(skb) & 3) { |
02a47617c Phonet: implement... |
94 95 |
struct sk_buff *rskb, *fs; int flen = 0; |
fc6a11075 Phonet: zero-copy... |
96 |
/* Phonet Pipe data header may be misaligned (3 bytes), |
02a47617c Phonet: implement... |
97 98 99 |
* so wrap the IP packet as a single fragment of an head-less * socket buffer. The network stack will pull what it needs, * but at least, the whole IP payload is not memcpy'd. */ |
09a2c3c0d Phonet: improve G... |
100 |
rskb = netdev_alloc_skb(dev, 0); |
02a47617c Phonet: implement... |
101 102 103 104 105 106 107 108 109 110 |
if (!rskb) { err = -ENOBUFS; goto drop; } skb_shinfo(rskb)->frag_list = skb; rskb->len += skb->len; rskb->data_len += rskb->len; rskb->truesize += rskb->len; /* Avoid nested fragments */ |
5c313e9a7 phonet: Use frag ... |
111 |
skb_walk_frags(skb, fs) |
02a47617c Phonet: implement... |
112 113 |
flen += fs->len; skb->next = skb_shinfo(skb)->frag_list; |
5c313e9a7 phonet: Use frag ... |
114 |
skb_frag_list_init(skb); |
02a47617c Phonet: implement... |
115 116 117 118 119 120 121 122 123 |
skb->len -= flen; skb->data_len -= flen; skb->truesize -= flen; skb = rskb; } skb->protocol = protocol; skb_reset_mac_header(skb); |
09a2c3c0d Phonet: improve G... |
124 |
skb->dev = dev; |
02a47617c Phonet: implement... |
125 |
|
09a2c3c0d Phonet: improve G... |
126 127 128 |
if (likely(dev->flags & IFF_UP)) { dev->stats.rx_packets++; dev->stats.rx_bytes += skb->len; |
02a47617c Phonet: implement... |
129 130 131 132 133 134 135 136 |
netif_rx(skb); skb = NULL; } else err = -ENODEV; drop: if (skb) { dev_kfree_skb(skb); |
09a2c3c0d Phonet: improve G... |
137 |
dev->stats.rx_dropped++; |
02a47617c Phonet: implement... |
138 139 140 141 142 143 |
} return err; } static void gprs_data_ready(struct sock *sk, int len) { |
09a2c3c0d Phonet: improve G... |
144 |
struct gprs_dev *gp = sk->sk_user_data; |
02a47617c Phonet: implement... |
145 146 147 148 |
struct sk_buff *skb; while ((skb = pep_read(sk)) != NULL) { skb_orphan(skb); |
09a2c3c0d Phonet: improve G... |
149 |
gprs_recv(gp, skb); |
02a47617c Phonet: implement... |
150 151 152 153 154 |
} } static void gprs_write_space(struct sock *sk) { |
09a2c3c0d Phonet: improve G... |
155 |
struct gprs_dev *gp = sk->sk_user_data; |
02a47617c Phonet: implement... |
156 |
|
893873f39 Phonet: get rid o... |
157 158 |
if (netif_running(gp->dev)) gprs_writeable(gp); |
02a47617c Phonet: implement... |
159 160 161 162 163 |
} /* * Network device callbacks */ |
4798a2b84 Phonet: keep TX q... |
164 165 166 |
static int gprs_open(struct net_device *dev) { struct gprs_dev *gp = netdev_priv(dev); |
893873f39 Phonet: get rid o... |
167 |
gprs_writeable(gp); |
4798a2b84 Phonet: keep TX q... |
168 169 170 171 172 |
return 0; } static int gprs_close(struct net_device *dev) { |
4798a2b84 Phonet: keep TX q... |
173 |
netif_stop_queue(dev); |
4798a2b84 Phonet: keep TX q... |
174 175 |
return 0; } |
424efe9ca netdev: convert p... |
176 |
static netdev_tx_t gprs_xmit(struct sk_buff *skb, struct net_device *dev) |
02a47617c Phonet: implement... |
177 |
{ |
09a2c3c0d Phonet: improve G... |
178 |
struct gprs_dev *gp = netdev_priv(dev); |
893873f39 Phonet: get rid o... |
179 180 |
struct sock *sk = gp->sk; int len, err; |
02a47617c Phonet: implement... |
181 182 183 184 185 186 187 |
switch (skb->protocol) { case htons(ETH_P_IP): case htons(ETH_P_IPV6): break; default: dev_kfree_skb(skb); |
6ed106549 net: use NETDEV_T... |
188 |
return NETDEV_TX_OK; |
02a47617c Phonet: implement... |
189 |
} |
893873f39 Phonet: get rid o... |
190 191 192 193 194 195 196 197 198 199 |
skb_orphan(skb); skb_set_owner_w(skb, sk); len = skb->len; err = pep_write(sk, skb); if (err) { LIMIT_NETDEBUG(KERN_WARNING"%s: TX error (%d) ", dev->name, err); dev->stats.tx_aborted_errors++; dev->stats.tx_errors++; |
893873f39 Phonet: get rid o... |
200 |
} else { |
09a2c3c0d Phonet: improve G... |
201 |
dev->stats.tx_packets++; |
893873f39 Phonet: get rid o... |
202 |
dev->stats.tx_bytes += len; |
02a47617c Phonet: implement... |
203 |
} |
bbd5898d3 Phonet: fix accou... |
204 205 206 |
netif_stop_queue(dev); if (pep_writeable(sk)) netif_wake_queue(dev); |
6ed106549 net: use NETDEV_T... |
207 |
return NETDEV_TX_OK; |
02a47617c Phonet: implement... |
208 |
} |
09a2c3c0d Phonet: improve G... |
209 |
static int gprs_set_mtu(struct net_device *dev, int new_mtu) |
02a47617c Phonet: implement... |
210 211 212 |
{ if ((new_mtu < 576) || (new_mtu > (PHONET_MAX_MTU - 11))) return -EINVAL; |
09a2c3c0d Phonet: improve G... |
213 |
dev->mtu = new_mtu; |
02a47617c Phonet: implement... |
214 215 |
return 0; } |
ab638e69f phonet: update to... |
216 217 218 219 220 221 |
static const struct net_device_ops gprs_netdev_ops = { .ndo_open = gprs_open, .ndo_stop = gprs_close, .ndo_start_xmit = gprs_xmit, .ndo_change_mtu = gprs_set_mtu, }; |
09a2c3c0d Phonet: improve G... |
222 |
static void gprs_setup(struct net_device *dev) |
02a47617c Phonet: implement... |
223 |
{ |
09a2c3c0d Phonet: improve G... |
224 |
dev->features = NETIF_F_FRAGLIST; |
57c81fffc Phonet: allocate ... |
225 |
dev->type = ARPHRD_PHONET_PIPE; |
09a2c3c0d Phonet: improve G... |
226 227 228 229 230 |
dev->flags = IFF_POINTOPOINT | IFF_NOARP; dev->mtu = GPRS_DEFAULT_MTU; dev->hard_header_len = 0; dev->addr_len = 0; dev->tx_queue_len = 10; |
ab638e69f phonet: update to... |
231 |
dev->netdev_ops = &gprs_netdev_ops; |
09a2c3c0d Phonet: improve G... |
232 |
dev->destructor = free_netdev; |
02a47617c Phonet: implement... |
233 234 235 236 237 238 239 240 241 242 243 244 245 |
} /* * External interface */ /* * Attach a GPRS interface to a datagram socket. * Returns the interface index on success, negative error code on error. */ int gprs_attach(struct sock *sk) { static const char ifname[] = "gprs%d"; |
09a2c3c0d Phonet: improve G... |
246 247 |
struct gprs_dev *gp; struct net_device *dev; |
02a47617c Phonet: implement... |
248 249 250 251 252 253 |
int err; if (unlikely(sk->sk_type == SOCK_STREAM)) return -EINVAL; /* need packet boundaries */ /* Create net device */ |
09a2c3c0d Phonet: improve G... |
254 255 |
dev = alloc_netdev(sizeof(*gp), ifname, gprs_setup); if (!dev) |
02a47617c Phonet: implement... |
256 |
return -ENOMEM; |
09a2c3c0d Phonet: improve G... |
257 |
gp = netdev_priv(dev); |
893873f39 Phonet: get rid o... |
258 |
gp->sk = sk; |
09a2c3c0d Phonet: improve G... |
259 |
gp->dev = dev; |
09a2c3c0d Phonet: improve G... |
260 261 262 |
netif_stop_queue(dev); err = register_netdev(dev); |
02a47617c Phonet: implement... |
263 |
if (err) { |
09a2c3c0d Phonet: improve G... |
264 |
free_netdev(dev); |
02a47617c Phonet: implement... |
265 266 267 268 269 270 271 272 273 274 275 276 277 |
return err; } lock_sock(sk); if (unlikely(sk->sk_user_data)) { err = -EBUSY; goto out_rel; } if (unlikely((1 << sk->sk_state & (TCPF_CLOSE|TCPF_LISTEN)) || sock_flag(sk, SOCK_DEAD))) { err = -EINVAL; goto out_rel; } |
09a2c3c0d Phonet: improve G... |
278 279 280 281 |
sk->sk_user_data = gp; gp->old_state_change = sk->sk_state_change; gp->old_data_ready = sk->sk_data_ready; gp->old_write_space = sk->sk_write_space; |
02a47617c Phonet: implement... |
282 283 284 285 |
sk->sk_state_change = gprs_state_change; sk->sk_data_ready = gprs_data_ready; sk->sk_write_space = gprs_write_space; release_sock(sk); |
02a47617c Phonet: implement... |
286 |
sock_hold(sk); |
02a47617c Phonet: implement... |
287 |
|
09a2c3c0d Phonet: improve G... |
288 289 290 |
printk(KERN_DEBUG"%s: attached ", dev->name); return dev->ifindex; |
02a47617c Phonet: implement... |
291 292 293 |
out_rel: release_sock(sk); |
09a2c3c0d Phonet: improve G... |
294 |
unregister_netdev(dev); |
02a47617c Phonet: implement... |
295 296 297 298 299 |
return err; } void gprs_detach(struct sock *sk) { |
09a2c3c0d Phonet: improve G... |
300 301 |
struct gprs_dev *gp = sk->sk_user_data; struct net_device *dev = gp->dev; |
02a47617c Phonet: implement... |
302 303 304 |
lock_sock(sk); sk->sk_user_data = NULL; |
09a2c3c0d Phonet: improve G... |
305 306 307 |
sk->sk_state_change = gp->old_state_change; sk->sk_data_ready = gp->old_data_ready; sk->sk_write_space = gp->old_write_space; |
02a47617c Phonet: implement... |
308 |
release_sock(sk); |
09a2c3c0d Phonet: improve G... |
309 310 311 |
printk(KERN_DEBUG"%s: detached ", dev->name); unregister_netdev(dev); |
02a47617c Phonet: implement... |
312 |
sock_put(sk); |
02a47617c Phonet: implement... |
313 |
} |