blob: 66dc65e7c6a1079d09f63c6caa3de115cc22bc54 [file] [log] [blame]
Rémi Denis-Courmont02a47612008-10-05 11:16:16 -07001/*
2 * File: pep-gprs.c
3 *
4 * GPRS over Phonet pipe end point socket
5 *
6 * Copyright (C) 2008 Nokia Corporation.
7 *
Rémi Denis-Courmont31fdc552012-06-13 22:29:03 +00008 * Author: Rémi Denis-Courmont
Rémi Denis-Courmont02a47612008-10-05 11:16:16 -07009 *
10 * This program is free software; you can redistribute it and/or
11 * modify it under the terms of the GNU General Public License
12 * version 2 as published by the Free Software Foundation.
13 *
14 * This program is distributed in the hope that it will be useful, but
15 * WITHOUT ANY WARRANTY; without even the implied warranty of
16 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
17 * General Public License for more details.
18 *
19 * You should have received a copy of the GNU General Public License
20 * along with this program; if not, write to the Free Software
21 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
22 * 02110-1301 USA
23 */
24
25#include <linux/kernel.h>
26#include <linux/netdevice.h>
27#include <linux/if_ether.h>
28#include <linux/if_arp.h>
29#include <net/sock.h>
30
31#include <linux/if_phonet.h>
32#include <net/tcp_states.h>
33#include <net/phonet/gprs.h>
34
35#define GPRS_DEFAULT_MTU 1400
36
37struct gprs_dev {
38 struct sock *sk;
39 void (*old_state_change)(struct sock *);
David S. Miller676d2362014-04-11 16:15:36 -040040 void (*old_data_ready)(struct sock *);
Rémi Denis-Courmont02a47612008-10-05 11:16:16 -070041 void (*old_write_space)(struct sock *);
42
Rémi Denis-Courmont09a2c3c2008-12-16 01:18:31 -080043 struct net_device *dev;
Rémi Denis-Courmont02a47612008-10-05 11:16:16 -070044};
45
Harvey Harrison5c7f0332008-11-06 23:10:50 -080046static __be16 gprs_type_trans(struct sk_buff *skb)
Rémi Denis-Courmont02a47612008-10-05 11:16:16 -070047{
48 const u8 *pvfc;
49 u8 buf;
50
51 pvfc = skb_header_pointer(skb, 0, 1, &buf);
52 if (!pvfc)
Harvey Harrison5c7f0332008-11-06 23:10:50 -080053 return htons(0);
Rémi Denis-Courmont02a47612008-10-05 11:16:16 -070054 /* Look at IP version field */
55 switch (*pvfc >> 4) {
56 case 4:
57 return htons(ETH_P_IP);
58 case 6:
59 return htons(ETH_P_IPV6);
60 }
Harvey Harrison5c7f0332008-11-06 23:10:50 -080061 return htons(0);
Rémi Denis-Courmont02a47612008-10-05 11:16:16 -070062}
63
Rémi Denis-Courmont893873f2008-12-17 15:48:50 -080064static void gprs_writeable(struct gprs_dev *gp)
65{
66 struct net_device *dev = gp->dev;
67
68 if (pep_writeable(gp->sk))
69 netif_wake_queue(dev);
70}
71
Rémi Denis-Courmont02a47612008-10-05 11:16:16 -070072/*
73 * Socket callbacks
74 */
75
76static void gprs_state_change(struct sock *sk)
77{
Rémi Denis-Courmont09a2c3c2008-12-16 01:18:31 -080078 struct gprs_dev *gp = sk->sk_user_data;
Rémi Denis-Courmont02a47612008-10-05 11:16:16 -070079
80 if (sk->sk_state == TCP_CLOSE_WAIT) {
Rémi Denis-Courmont09a2c3c2008-12-16 01:18:31 -080081 struct net_device *dev = gp->dev;
82
83 netif_stop_queue(dev);
84 netif_carrier_off(dev);
Rémi Denis-Courmont02a47612008-10-05 11:16:16 -070085 }
86}
87
Rémi Denis-Courmont09a2c3c2008-12-16 01:18:31 -080088static int gprs_recv(struct gprs_dev *gp, struct sk_buff *skb)
Rémi Denis-Courmont02a47612008-10-05 11:16:16 -070089{
Rémi Denis-Courmont09a2c3c2008-12-16 01:18:31 -080090 struct net_device *dev = gp->dev;
Rémi Denis-Courmont02a47612008-10-05 11:16:16 -070091 int err = 0;
Harvey Harrison5c7f0332008-11-06 23:10:50 -080092 __be16 protocol = gprs_type_trans(skb);
Rémi Denis-Courmont02a47612008-10-05 11:16:16 -070093
94 if (!protocol) {
95 err = -EINVAL;
96 goto drop;
97 }
98
Rémi Denis-Courmontfc6a1102010-01-04 02:02:47 +000099 if (skb_headroom(skb) & 3) {
Rémi Denis-Courmont02a47612008-10-05 11:16:16 -0700100 struct sk_buff *rskb, *fs;
101 int flen = 0;
102
Rémi Denis-Courmontfc6a1102010-01-04 02:02:47 +0000103 /* Phonet Pipe data header may be misaligned (3 bytes),
Rémi Denis-Courmont02a47612008-10-05 11:16:16 -0700104 * so wrap the IP packet as a single fragment of an head-less
105 * socket buffer. The network stack will pull what it needs,
106 * but at least, the whole IP payload is not memcpy'd. */
Rémi Denis-Courmont09a2c3c2008-12-16 01:18:31 -0800107 rskb = netdev_alloc_skb(dev, 0);
Rémi Denis-Courmont02a47612008-10-05 11:16:16 -0700108 if (!rskb) {
109 err = -ENOBUFS;
110 goto drop;
111 }
112 skb_shinfo(rskb)->frag_list = skb;
113 rskb->len += skb->len;
114 rskb->data_len += rskb->len;
115 rskb->truesize += rskb->len;
116
117 /* Avoid nested fragments */
David S. Miller5c313e92009-06-09 00:21:58 -0700118 skb_walk_frags(skb, fs)
Rémi Denis-Courmont02a47612008-10-05 11:16:16 -0700119 flen += fs->len;
120 skb->next = skb_shinfo(skb)->frag_list;
David S. Miller5c313e92009-06-09 00:21:58 -0700121 skb_frag_list_init(skb);
Rémi Denis-Courmont02a47612008-10-05 11:16:16 -0700122 skb->len -= flen;
123 skb->data_len -= flen;
124 skb->truesize -= flen;
125
126 skb = rskb;
127 }
128
129 skb->protocol = protocol;
130 skb_reset_mac_header(skb);
Rémi Denis-Courmont09a2c3c2008-12-16 01:18:31 -0800131 skb->dev = dev;
Rémi Denis-Courmont02a47612008-10-05 11:16:16 -0700132
Rémi Denis-Courmont09a2c3c2008-12-16 01:18:31 -0800133 if (likely(dev->flags & IFF_UP)) {
134 dev->stats.rx_packets++;
135 dev->stats.rx_bytes += skb->len;
Rémi Denis-Courmont02a47612008-10-05 11:16:16 -0700136 netif_rx(skb);
137 skb = NULL;
138 } else
139 err = -ENODEV;
140
141drop:
142 if (skb) {
143 dev_kfree_skb(skb);
Rémi Denis-Courmont09a2c3c2008-12-16 01:18:31 -0800144 dev->stats.rx_dropped++;
Rémi Denis-Courmont02a47612008-10-05 11:16:16 -0700145 }
146 return err;
147}
148
David S. Miller676d2362014-04-11 16:15:36 -0400149static void gprs_data_ready(struct sock *sk)
Rémi Denis-Courmont02a47612008-10-05 11:16:16 -0700150{
Rémi Denis-Courmont09a2c3c2008-12-16 01:18:31 -0800151 struct gprs_dev *gp = sk->sk_user_data;
Rémi Denis-Courmont02a47612008-10-05 11:16:16 -0700152 struct sk_buff *skb;
153
154 while ((skb = pep_read(sk)) != NULL) {
155 skb_orphan(skb);
Rémi Denis-Courmont09a2c3c2008-12-16 01:18:31 -0800156 gprs_recv(gp, skb);
Rémi Denis-Courmont02a47612008-10-05 11:16:16 -0700157 }
158}
159
160static void gprs_write_space(struct sock *sk)
161{
Rémi Denis-Courmont09a2c3c2008-12-16 01:18:31 -0800162 struct gprs_dev *gp = sk->sk_user_data;
Rémi Denis-Courmont02a47612008-10-05 11:16:16 -0700163
Rémi Denis-Courmont893873f2008-12-17 15:48:50 -0800164 if (netif_running(gp->dev))
165 gprs_writeable(gp);
Rémi Denis-Courmont02a47612008-10-05 11:16:16 -0700166}
167
168/*
169 * Network device callbacks
170 */
171
Rémi Denis-Courmont4798a2b2008-12-15 00:53:57 -0800172static int gprs_open(struct net_device *dev)
173{
174 struct gprs_dev *gp = netdev_priv(dev);
175
Rémi Denis-Courmont893873f2008-12-17 15:48:50 -0800176 gprs_writeable(gp);
Rémi Denis-Courmont4798a2b2008-12-15 00:53:57 -0800177 return 0;
178}
179
180static int gprs_close(struct net_device *dev)
181{
Rémi Denis-Courmont4798a2b2008-12-15 00:53:57 -0800182 netif_stop_queue(dev);
Rémi Denis-Courmont4798a2b2008-12-15 00:53:57 -0800183 return 0;
184}
185
Stephen Hemminger424efe92009-08-31 19:50:51 +0000186static netdev_tx_t gprs_xmit(struct sk_buff *skb, struct net_device *dev)
Rémi Denis-Courmont02a47612008-10-05 11:16:16 -0700187{
Rémi Denis-Courmont09a2c3c2008-12-16 01:18:31 -0800188 struct gprs_dev *gp = netdev_priv(dev);
Rémi Denis-Courmont893873f2008-12-17 15:48:50 -0800189 struct sock *sk = gp->sk;
190 int len, err;
Rémi Denis-Courmont02a47612008-10-05 11:16:16 -0700191
192 switch (skb->protocol) {
193 case htons(ETH_P_IP):
194 case htons(ETH_P_IPV6):
195 break;
196 default:
197 dev_kfree_skb(skb);
Patrick McHardy6ed10652009-06-23 06:03:08 +0000198 return NETDEV_TX_OK;
Rémi Denis-Courmont02a47612008-10-05 11:16:16 -0700199 }
200
Rémi Denis-Courmont893873f2008-12-17 15:48:50 -0800201 skb_orphan(skb);
202 skb_set_owner_w(skb, sk);
203 len = skb->len;
204 err = pep_write(sk, skb);
205 if (err) {
206 LIMIT_NETDEBUG(KERN_WARNING"%s: TX error (%d)\n",
207 dev->name, err);
208 dev->stats.tx_aborted_errors++;
209 dev->stats.tx_errors++;
Rémi Denis-Courmont893873f2008-12-17 15:48:50 -0800210 } else {
Rémi Denis-Courmont09a2c3c2008-12-16 01:18:31 -0800211 dev->stats.tx_packets++;
Rémi Denis-Courmont893873f2008-12-17 15:48:50 -0800212 dev->stats.tx_bytes += len;
Rémi Denis-Courmont02a47612008-10-05 11:16:16 -0700213 }
214
Rémi Denis-Courmontbbd58982009-06-01 00:35:16 +0000215 netif_stop_queue(dev);
216 if (pep_writeable(sk))
217 netif_wake_queue(dev);
Patrick McHardy6ed10652009-06-23 06:03:08 +0000218 return NETDEV_TX_OK;
Rémi Denis-Courmont02a47612008-10-05 11:16:16 -0700219}
220
Rémi Denis-Courmont09a2c3c2008-12-16 01:18:31 -0800221static int gprs_set_mtu(struct net_device *dev, int new_mtu)
Rémi Denis-Courmont02a47612008-10-05 11:16:16 -0700222{
223 if ((new_mtu < 576) || (new_mtu > (PHONET_MAX_MTU - 11)))
224 return -EINVAL;
225
Rémi Denis-Courmont09a2c3c2008-12-16 01:18:31 -0800226 dev->mtu = new_mtu;
Rémi Denis-Courmont02a47612008-10-05 11:16:16 -0700227 return 0;
228}
229
Stephen Hemmingerab638e62009-01-07 17:24:34 -0800230static const struct net_device_ops gprs_netdev_ops = {
231 .ndo_open = gprs_open,
232 .ndo_stop = gprs_close,
233 .ndo_start_xmit = gprs_xmit,
234 .ndo_change_mtu = gprs_set_mtu,
235};
236
Rémi Denis-Courmont09a2c3c2008-12-16 01:18:31 -0800237static void gprs_setup(struct net_device *dev)
Rémi Denis-Courmont02a47612008-10-05 11:16:16 -0700238{
Rémi Denis-Courmont09a2c3c2008-12-16 01:18:31 -0800239 dev->features = NETIF_F_FRAGLIST;
Rémi Denis-Courmont57c81ff2008-12-17 15:47:48 -0800240 dev->type = ARPHRD_PHONET_PIPE;
Rémi Denis-Courmont09a2c3c2008-12-16 01:18:31 -0800241 dev->flags = IFF_POINTOPOINT | IFF_NOARP;
242 dev->mtu = GPRS_DEFAULT_MTU;
243 dev->hard_header_len = 0;
244 dev->addr_len = 0;
245 dev->tx_queue_len = 10;
Rémi Denis-Courmont02a47612008-10-05 11:16:16 -0700246
Stephen Hemmingerab638e62009-01-07 17:24:34 -0800247 dev->netdev_ops = &gprs_netdev_ops;
Rémi Denis-Courmont09a2c3c2008-12-16 01:18:31 -0800248 dev->destructor = free_netdev;
Rémi Denis-Courmont02a47612008-10-05 11:16:16 -0700249}
250
251/*
252 * External interface
253 */
254
255/*
256 * Attach a GPRS interface to a datagram socket.
257 * Returns the interface index on success, negative error code on error.
258 */
259int gprs_attach(struct sock *sk)
260{
261 static const char ifname[] = "gprs%d";
Rémi Denis-Courmont09a2c3c2008-12-16 01:18:31 -0800262 struct gprs_dev *gp;
263 struct net_device *dev;
Rémi Denis-Courmont02a47612008-10-05 11:16:16 -0700264 int err;
265
266 if (unlikely(sk->sk_type == SOCK_STREAM))
267 return -EINVAL; /* need packet boundaries */
268
269 /* Create net device */
Rémi Denis-Courmont09a2c3c2008-12-16 01:18:31 -0800270 dev = alloc_netdev(sizeof(*gp), ifname, gprs_setup);
271 if (!dev)
Rémi Denis-Courmont02a47612008-10-05 11:16:16 -0700272 return -ENOMEM;
Rémi Denis-Courmont09a2c3c2008-12-16 01:18:31 -0800273 gp = netdev_priv(dev);
Rémi Denis-Courmont893873f2008-12-17 15:48:50 -0800274 gp->sk = sk;
Rémi Denis-Courmont09a2c3c2008-12-16 01:18:31 -0800275 gp->dev = dev;
Rémi Denis-Courmont02a47612008-10-05 11:16:16 -0700276
Rémi Denis-Courmont09a2c3c2008-12-16 01:18:31 -0800277 netif_stop_queue(dev);
278 err = register_netdev(dev);
Rémi Denis-Courmont02a47612008-10-05 11:16:16 -0700279 if (err) {
Rémi Denis-Courmont09a2c3c2008-12-16 01:18:31 -0800280 free_netdev(dev);
Rémi Denis-Courmont02a47612008-10-05 11:16:16 -0700281 return err;
282 }
283
284 lock_sock(sk);
285 if (unlikely(sk->sk_user_data)) {
286 err = -EBUSY;
287 goto out_rel;
288 }
289 if (unlikely((1 << sk->sk_state & (TCPF_CLOSE|TCPF_LISTEN)) ||
290 sock_flag(sk, SOCK_DEAD))) {
291 err = -EINVAL;
292 goto out_rel;
293 }
Rémi Denis-Courmont09a2c3c2008-12-16 01:18:31 -0800294 sk->sk_user_data = gp;
295 gp->old_state_change = sk->sk_state_change;
296 gp->old_data_ready = sk->sk_data_ready;
297 gp->old_write_space = sk->sk_write_space;
Rémi Denis-Courmont02a47612008-10-05 11:16:16 -0700298 sk->sk_state_change = gprs_state_change;
299 sk->sk_data_ready = gprs_data_ready;
300 sk->sk_write_space = gprs_write_space;
301 release_sock(sk);
Rémi Denis-Courmont02a47612008-10-05 11:16:16 -0700302 sock_hold(sk);
Rémi Denis-Courmont02a47612008-10-05 11:16:16 -0700303
Rémi Denis-Courmont09a2c3c2008-12-16 01:18:31 -0800304 printk(KERN_DEBUG"%s: attached\n", dev->name);
305 return dev->ifindex;
Rémi Denis-Courmont02a47612008-10-05 11:16:16 -0700306
307out_rel:
308 release_sock(sk);
Rémi Denis-Courmont09a2c3c2008-12-16 01:18:31 -0800309 unregister_netdev(dev);
Rémi Denis-Courmont02a47612008-10-05 11:16:16 -0700310 return err;
311}
312
313void gprs_detach(struct sock *sk)
314{
Rémi Denis-Courmont09a2c3c2008-12-16 01:18:31 -0800315 struct gprs_dev *gp = sk->sk_user_data;
316 struct net_device *dev = gp->dev;
Rémi Denis-Courmont02a47612008-10-05 11:16:16 -0700317
318 lock_sock(sk);
319 sk->sk_user_data = NULL;
Rémi Denis-Courmont09a2c3c2008-12-16 01:18:31 -0800320 sk->sk_state_change = gp->old_state_change;
321 sk->sk_data_ready = gp->old_data_ready;
322 sk->sk_write_space = gp->old_write_space;
Rémi Denis-Courmont02a47612008-10-05 11:16:16 -0700323 release_sock(sk);
324
Rémi Denis-Courmont09a2c3c2008-12-16 01:18:31 -0800325 printk(KERN_DEBUG"%s: detached\n", dev->name);
326 unregister_netdev(dev);
Rémi Denis-Courmont02a47612008-10-05 11:16:16 -0700327 sock_put(sk);
Rémi Denis-Courmont02a47612008-10-05 11:16:16 -0700328}