OpenCores
URL https://opencores.org/ocsvn/or1k/or1k/trunk

Subversion Repositories or1k

[/] [or1k/] [trunk/] [linux/] [linux-2.4/] [net/] [ipv4/] [ip_sockglue.c] - Blame information for rev 1774

Go to most recent revision | Details | Compare with Previous | View Log

Line No. Rev Author Line
1 1275 phoenix
/*
2
 * INET         An implementation of the TCP/IP protocol suite for the LINUX
3
 *              operating system.  INET is implemented using the  BSD Socket
4
 *              interface as the means of communication with the user level.
5
 *
6
 *              The IP to API glue.
7
 *
8
 * Version:     $Id: ip_sockglue.c,v 1.1.1.1 2004-04-15 01:13:42 phoenix Exp $
9
 *
10
 * Authors:     see ip.c
11
 *
12
 * Fixes:
13
 *              Many            :       Split from ip.c , see ip.c for history.
14
 *              Martin Mares    :       TOS setting fixed.
15
 *              Alan Cox        :       Fixed a couple of oopses in Martin's
16
 *                                      TOS tweaks.
17
 *              Mike McLagan    :       Routing by source
18
 */
19
 
20
#include <linux/config.h>
21
#include <linux/types.h>
22
#include <linux/mm.h>
23
#include <linux/sched.h>
24
#include <linux/skbuff.h>
25
#include <linux/ip.h>
26
#include <linux/icmp.h>
27
#include <linux/netdevice.h>
28
#include <net/sock.h>
29
#include <net/ip.h>
30
#include <net/icmp.h>
31
#include <net/tcp.h>
32
#include <linux/tcp.h>
33
#include <linux/udp.h>
34
#include <linux/igmp.h>
35
#include <linux/netfilter.h>
36
#include <linux/route.h>
37
#include <linux/mroute.h>
38
#include <net/route.h>
39
#if defined(CONFIG_IPV6) || defined(CONFIG_IPV6_MODULE)
40
#include <net/transp_v6.h>
41
#endif
42
 
43
#include <linux/errqueue.h>
44
#include <asm/uaccess.h>
45
 
46
#define IP_CMSG_PKTINFO         1
47
#define IP_CMSG_TTL             2
48
#define IP_CMSG_TOS             4
49
#define IP_CMSG_RECVOPTS        8
50
#define IP_CMSG_RETOPTS         16
51
 
52
/*
53
 *      SOL_IP control messages.
54
 */
55
 
56
static void ip_cmsg_recv_pktinfo(struct msghdr *msg, struct sk_buff *skb)
57
{
58
        struct in_pktinfo info;
59
        struct rtable *rt = (struct rtable *)skb->dst;
60
 
61
        info.ipi_addr.s_addr = skb->nh.iph->daddr;
62
        if (rt) {
63
                info.ipi_ifindex = rt->rt_iif;
64
                info.ipi_spec_dst.s_addr = rt->rt_spec_dst;
65
        } else {
66
                info.ipi_ifindex = 0;
67
                info.ipi_spec_dst.s_addr = 0;
68
        }
69
 
70
        put_cmsg(msg, SOL_IP, IP_PKTINFO, sizeof(info), &info);
71
}
72
 
73
static void ip_cmsg_recv_ttl(struct msghdr *msg, struct sk_buff *skb)
74
{
75
        int ttl = skb->nh.iph->ttl;
76
        put_cmsg(msg, SOL_IP, IP_TTL, sizeof(int), &ttl);
77
}
78
 
79
static void ip_cmsg_recv_tos(struct msghdr *msg, struct sk_buff *skb)
80
{
81
        put_cmsg(msg, SOL_IP, IP_TOS, 1, &skb->nh.iph->tos);
82
}
83
 
84
static void ip_cmsg_recv_opts(struct msghdr *msg, struct sk_buff *skb)
85
{
86
        if (IPCB(skb)->opt.optlen == 0)
87
                return;
88
 
89
        put_cmsg(msg, SOL_IP, IP_RECVOPTS, IPCB(skb)->opt.optlen, skb->nh.iph+1);
90
}
91
 
92
 
93
void ip_cmsg_recv_retopts(struct msghdr *msg, struct sk_buff *skb)
94
{
95
        unsigned char optbuf[sizeof(struct ip_options) + 40];
96
        struct ip_options * opt = (struct ip_options*)optbuf;
97
 
98
        if (IPCB(skb)->opt.optlen == 0)
99
                return;
100
 
101
        if (ip_options_echo(opt, skb)) {
102
                msg->msg_flags |= MSG_CTRUNC;
103
                return;
104
        }
105
        ip_options_undo(opt);
106
 
107
        put_cmsg(msg, SOL_IP, IP_RETOPTS, opt->optlen, opt->__data);
108
}
109
 
110
 
111
void ip_cmsg_recv(struct msghdr *msg, struct sk_buff *skb)
112
{
113
        unsigned flags = skb->sk->protinfo.af_inet.cmsg_flags;
114
 
115
        /* Ordered by supposed usage frequency */
116
        if (flags & 1)
117
                ip_cmsg_recv_pktinfo(msg, skb);
118
        if ((flags>>=1) == 0)
119
                return;
120
 
121
        if (flags & 1)
122
                ip_cmsg_recv_ttl(msg, skb);
123
        if ((flags>>=1) == 0)
124
                return;
125
 
126
        if (flags & 1)
127
                ip_cmsg_recv_tos(msg, skb);
128
        if ((flags>>=1) == 0)
129
                return;
130
 
131
        if (flags & 1)
132
                ip_cmsg_recv_opts(msg, skb);
133
        if ((flags>>=1) == 0)
134
                return;
135
 
136
        if (flags & 1)
137
                ip_cmsg_recv_retopts(msg, skb);
138
}
139
 
140
int ip_cmsg_send(struct msghdr *msg, struct ipcm_cookie *ipc)
141
{
142
        int err;
143
        struct cmsghdr *cmsg;
144
 
145
        for (cmsg = CMSG_FIRSTHDR(msg); cmsg; cmsg = CMSG_NXTHDR(msg, cmsg)) {
146
                if (cmsg->cmsg_len < sizeof(struct cmsghdr) ||
147
                    (unsigned long)(((char*)cmsg - (char*)msg->msg_control)
148
                                    + cmsg->cmsg_len) > msg->msg_controllen) {
149
                        return -EINVAL;
150
                }
151
                if (cmsg->cmsg_level != SOL_IP)
152
                        continue;
153
                switch (cmsg->cmsg_type) {
154
                case IP_RETOPTS:
155
                        err = cmsg->cmsg_len - CMSG_ALIGN(sizeof(struct cmsghdr));
156
                        err = ip_options_get(&ipc->opt, CMSG_DATA(cmsg), err < 40 ? err : 40, 0);
157
                        if (err)
158
                                return err;
159
                        break;
160
                case IP_PKTINFO:
161
                {
162
                        struct in_pktinfo *info;
163
                        if (cmsg->cmsg_len != CMSG_LEN(sizeof(struct in_pktinfo)))
164
                                return -EINVAL;
165
                        info = (struct in_pktinfo *)CMSG_DATA(cmsg);
166
                        ipc->oif = info->ipi_ifindex;
167
                        ipc->addr = info->ipi_spec_dst.s_addr;
168
                        break;
169
                }
170
                default:
171
                        return -EINVAL;
172
                }
173
        }
174
        return 0;
175
}
176
 
177
 
178
/* Special input handler for packets catched by router alert option.
179
   They are selected only by protocol field, and then processed likely
180
   local ones; but only if someone wants them! Otherwise, router
181
   not running rsvpd will kill RSVP.
182
 
183
   It is user level problem, what it will make with them.
184
   I have no idea, how it will masquearde or NAT them (it is joke, joke :-)),
185
   but receiver should be enough clever f.e. to forward mtrace requests,
186
   sent to multicast group to reach destination designated router.
187
 */
188
struct ip_ra_chain *ip_ra_chain;
189
rwlock_t ip_ra_lock = RW_LOCK_UNLOCKED;
190
 
191
int ip_ra_control(struct sock *sk, unsigned char on, void (*destructor)(struct sock *))
192
{
193
        struct ip_ra_chain *ra, *new_ra, **rap;
194
 
195
        if (sk->type != SOCK_RAW || sk->num == IPPROTO_RAW)
196
                return -EINVAL;
197
 
198
        new_ra = on ? kmalloc(sizeof(*new_ra), GFP_KERNEL) : NULL;
199
 
200
        write_lock_bh(&ip_ra_lock);
201
        for (rap = &ip_ra_chain; (ra=*rap) != NULL; rap = &ra->next) {
202
                if (ra->sk == sk) {
203
                        if (on) {
204
                                write_unlock_bh(&ip_ra_lock);
205
                                if (new_ra)
206
                                        kfree(new_ra);
207
                                return -EADDRINUSE;
208
                        }
209
                        *rap = ra->next;
210
                        write_unlock_bh(&ip_ra_lock);
211
 
212
                        if (ra->destructor)
213
                                ra->destructor(sk);
214
                        sock_put(sk);
215
                        kfree(ra);
216
                        return 0;
217
                }
218
        }
219
        if (new_ra == NULL) {
220
                write_unlock_bh(&ip_ra_lock);
221
                return -ENOBUFS;
222
        }
223
        new_ra->sk = sk;
224
        new_ra->destructor = destructor;
225
 
226
        new_ra->next = ra;
227
        *rap = new_ra;
228
        sock_hold(sk);
229
        write_unlock_bh(&ip_ra_lock);
230
 
231
        return 0;
232
}
233
 
234
void ip_icmp_error(struct sock *sk, struct sk_buff *skb, int err,
235
                   u16 port, u32 info, u8 *payload)
236
{
237
        struct sock_exterr_skb *serr;
238
 
239
        if (!sk->protinfo.af_inet.recverr)
240
                return;
241
 
242
        skb = skb_clone(skb, GFP_ATOMIC);
243
        if (!skb)
244
                return;
245
 
246
        serr = SKB_EXT_ERR(skb);
247
        serr->ee.ee_errno = err;
248
        serr->ee.ee_origin = SO_EE_ORIGIN_ICMP;
249
        serr->ee.ee_type = skb->h.icmph->type;
250
        serr->ee.ee_code = skb->h.icmph->code;
251
        serr->ee.ee_pad = 0;
252
        serr->ee.ee_info = info;
253
        serr->ee.ee_data = 0;
254
        serr->addr_offset = (u8*)&(((struct iphdr*)(skb->h.icmph+1))->daddr) - skb->nh.raw;
255
        serr->port = port;
256
 
257
        skb->h.raw = payload;
258
        if (!skb_pull(skb, payload - skb->data) ||
259
            sock_queue_err_skb(sk, skb))
260
                kfree_skb(skb);
261
}
262
 
263
void ip_local_error(struct sock *sk, int err, u32 daddr, u16 port, u32 info)
264
{
265
        struct sock_exterr_skb *serr;
266
        struct iphdr *iph;
267
        struct sk_buff *skb;
268
 
269
        if (!sk->protinfo.af_inet.recverr)
270
                return;
271
 
272
        skb = alloc_skb(sizeof(struct iphdr), GFP_ATOMIC);
273
        if (!skb)
274
                return;
275
 
276
        iph = (struct iphdr*)skb_put(skb, sizeof(struct iphdr));
277
        skb->nh.iph = iph;
278
        iph->daddr = daddr;
279
 
280
        serr = SKB_EXT_ERR(skb);
281
        serr->ee.ee_errno = err;
282
        serr->ee.ee_origin = SO_EE_ORIGIN_LOCAL;
283
        serr->ee.ee_type = 0;
284
        serr->ee.ee_code = 0;
285
        serr->ee.ee_pad = 0;
286
        serr->ee.ee_info = info;
287
        serr->ee.ee_data = 0;
288
        serr->addr_offset = (u8*)&iph->daddr - skb->nh.raw;
289
        serr->port = port;
290
 
291
        skb->h.raw = skb->tail;
292
        __skb_pull(skb, skb->tail - skb->data);
293
 
294
        if (sock_queue_err_skb(sk, skb))
295
                kfree_skb(skb);
296
}
297
 
298
/*
299
 *      Handle MSG_ERRQUEUE
300
 */
301
int ip_recv_error(struct sock *sk, struct msghdr *msg, int len)
302
{
303
        struct sock_exterr_skb *serr;
304
        struct sk_buff *skb, *skb2;
305
        struct sockaddr_in *sin;
306
        struct {
307
                struct sock_extended_err ee;
308
                struct sockaddr_in       offender;
309
        } errhdr;
310
        int err;
311
        int copied;
312
 
313
        err = -EAGAIN;
314
        skb = skb_dequeue(&sk->error_queue);
315
        if (skb == NULL)
316
                goto out;
317
 
318
        copied = skb->len;
319
        if (copied > len) {
320
                msg->msg_flags |= MSG_TRUNC;
321
                copied = len;
322
        }
323
        err = skb_copy_datagram_iovec(skb, 0, msg->msg_iov, copied);
324
        if (err)
325
                goto out_free_skb;
326
 
327
        sock_recv_timestamp(msg, sk, skb);
328
 
329
        serr = SKB_EXT_ERR(skb);
330
 
331
        sin = (struct sockaddr_in *)msg->msg_name;
332
        if (sin) {
333
                sin->sin_family = AF_INET;
334
                sin->sin_addr.s_addr = *(u32*)(skb->nh.raw + serr->addr_offset);
335
                sin->sin_port = serr->port;
336
                memset(&sin->sin_zero, 0, sizeof(sin->sin_zero));
337
        }
338
 
339
        memcpy(&errhdr.ee, &serr->ee, sizeof(struct sock_extended_err));
340
        sin = &errhdr.offender;
341
        sin->sin_family = AF_UNSPEC;
342
        if (serr->ee.ee_origin == SO_EE_ORIGIN_ICMP) {
343
                sin->sin_family = AF_INET;
344
                sin->sin_addr.s_addr = skb->nh.iph->saddr;
345
                sin->sin_port = 0;
346
                memset(&sin->sin_zero, 0, sizeof(sin->sin_zero));
347
                if (sk->protinfo.af_inet.cmsg_flags)
348
                        ip_cmsg_recv(msg, skb);
349
        }
350
 
351
        put_cmsg(msg, SOL_IP, IP_RECVERR, sizeof(errhdr), &errhdr);
352
 
353
        /* Now we could try to dump offended packet options */
354
 
355
        msg->msg_flags |= MSG_ERRQUEUE;
356
        err = copied;
357
 
358
        /* Reset and regenerate socket error */
359
        spin_lock_irq(&sk->error_queue.lock);
360
        sk->err = 0;
361
        if ((skb2 = skb_peek(&sk->error_queue)) != NULL) {
362
                sk->err = SKB_EXT_ERR(skb2)->ee.ee_errno;
363
                spin_unlock_irq(&sk->error_queue.lock);
364
                sk->error_report(sk);
365
        } else {
366
                spin_unlock_irq(&sk->error_queue.lock);
367
        }
368
 
369
out_free_skb:
370
        kfree_skb(skb);
371
out:
372
        return err;
373
}
374
 
375
 
376
/*
377
 *      Socket option code for IP. This is the end of the line after any TCP,UDP etc options on
378
 *      an IP socket.
379
 */
380
 
381
int ip_setsockopt(struct sock *sk, int level, int optname, char *optval, int optlen)
382
{
383
        int val=0,err;
384
 
385
        if (level != SOL_IP)
386
                return -ENOPROTOOPT;
387
 
388
        if (((1<<optname) & ((1<<IP_PKTINFO) | (1<<IP_RECVTTL) |
389
                            (1<<IP_RECVOPTS) | (1<<IP_RECVTOS) |
390
                            (1<<IP_RETOPTS) | (1<<IP_TOS) |
391
                            (1<<IP_TTL) | (1<<IP_HDRINCL) |
392
                            (1<<IP_MTU_DISCOVER) | (1<<IP_RECVERR) |
393
                            (1<<IP_ROUTER_ALERT) | (1<<IP_FREEBIND))) ||
394
                                optname == IP_MULTICAST_TTL ||
395
                                optname == IP_MULTICAST_LOOP) {
396
                if (optlen >= sizeof(int)) {
397
                        if (get_user(val, (int *) optval))
398
                                return -EFAULT;
399
                } else if (optlen >= sizeof(char)) {
400
                        unsigned char ucval;
401
 
402
                        if (get_user(ucval, (unsigned char *) optval))
403
                                return -EFAULT;
404
                        val = (int) ucval;
405
                }
406
        }
407
 
408
        /* If optlen==0, it is equivalent to val == 0 */
409
 
410
#ifdef CONFIG_IP_MROUTE
411
        if (optname >= MRT_BASE && optname <= (MRT_BASE + 10))
412
                return ip_mroute_setsockopt(sk,optname,optval,optlen);
413
#endif
414
 
415
        err = 0;
416
        lock_sock(sk);
417
 
418
        switch (optname) {
419
                case IP_OPTIONS:
420
                {
421
                        struct ip_options * opt = NULL;
422
                        if (optlen > 40 || optlen < 0)
423
                                goto e_inval;
424
                        err = ip_options_get(&opt, optval, optlen, 1);
425
                        if (err)
426
                                break;
427
                        if (sk->type == SOCK_STREAM) {
428
                                struct tcp_opt *tp = &sk->tp_pinfo.af_tcp;
429
#if defined(CONFIG_IPV6) || defined(CONFIG_IPV6_MODULE)
430
                                if (sk->family == PF_INET ||
431
                                    (!((1<<sk->state)&(TCPF_LISTEN|TCPF_CLOSE))
432
                                     && sk->daddr != LOOPBACK4_IPV6)) {
433
#endif
434
                                        if (opt)
435
                                                tp->ext_header_len = opt->optlen;
436
                                        tcp_sync_mss(sk, tp->pmtu_cookie);
437
#if defined(CONFIG_IPV6) || defined(CONFIG_IPV6_MODULE)
438
                                }
439
#endif
440
                        }
441
                        opt = xchg(&sk->protinfo.af_inet.opt, opt);
442
                        if (opt)
443
                                kfree(opt);
444
                        break;
445
                }
446
                case IP_PKTINFO:
447
                        if (val)
448
                                sk->protinfo.af_inet.cmsg_flags |= IP_CMSG_PKTINFO;
449
                        else
450
                                sk->protinfo.af_inet.cmsg_flags &= ~IP_CMSG_PKTINFO;
451
                        break;
452
                case IP_RECVTTL:
453
                        if (val)
454
                                sk->protinfo.af_inet.cmsg_flags |=  IP_CMSG_TTL;
455
                        else
456
                                sk->protinfo.af_inet.cmsg_flags &= ~IP_CMSG_TTL;
457
                        break;
458
                case IP_RECVTOS:
459
                        if (val)
460
                                sk->protinfo.af_inet.cmsg_flags |=  IP_CMSG_TOS;
461
                        else
462
                                sk->protinfo.af_inet.cmsg_flags &= ~IP_CMSG_TOS;
463
                        break;
464
                case IP_RECVOPTS:
465
                        if (val)
466
                                sk->protinfo.af_inet.cmsg_flags |=  IP_CMSG_RECVOPTS;
467
                        else
468
                                sk->protinfo.af_inet.cmsg_flags &= ~IP_CMSG_RECVOPTS;
469
                        break;
470
                case IP_RETOPTS:
471
                        if (val)
472
                                sk->protinfo.af_inet.cmsg_flags |= IP_CMSG_RETOPTS;
473
                        else
474
                                sk->protinfo.af_inet.cmsg_flags &= ~IP_CMSG_RETOPTS;
475
                        break;
476
                case IP_TOS:    /* This sets both TOS and Precedence */
477
                        if (sk->type == SOCK_STREAM) {
478
                                val &= ~3;
479
                                val |= sk->protinfo.af_inet.tos & 3;
480
                        }
481
                        if (IPTOS_PREC(val) >= IPTOS_PREC_CRITIC_ECP &&
482
                            !capable(CAP_NET_ADMIN)) {
483
                                err = -EPERM;
484
                                break;
485
                        }
486
                        if (sk->protinfo.af_inet.tos != val) {
487
                                sk->protinfo.af_inet.tos=val;
488
                                sk->priority = rt_tos2priority(val);
489
                                sk_dst_reset(sk);
490
                        }
491
                        break;
492
                case IP_TTL:
493
                        if (optlen<1)
494
                                goto e_inval;
495
                        if(val==-1)
496
                                val = sysctl_ip_default_ttl;
497
                        if(val<1||val>255)
498
                                goto e_inval;
499
                        sk->protinfo.af_inet.ttl=val;
500
                        break;
501
                case IP_HDRINCL:
502
                        if(sk->type!=SOCK_RAW) {
503
                                err = -ENOPROTOOPT;
504
                                break;
505
                        }
506
                        sk->protinfo.af_inet.hdrincl=val?1:0;
507
                        break;
508
                case IP_MTU_DISCOVER:
509
                        if (val<0 || val>2)
510
                                goto e_inval;
511
                        sk->protinfo.af_inet.pmtudisc = val;
512
                        break;
513
                case IP_RECVERR:
514
                        sk->protinfo.af_inet.recverr = !!val;
515
                        if (!val)
516
                                skb_queue_purge(&sk->error_queue);
517
                        break;
518
                case IP_MULTICAST_TTL:
519
                        if (sk->type == SOCK_STREAM)
520
                                goto e_inval;
521
                        if (optlen<1)
522
                                goto e_inval;
523
                        if (val==-1)
524
                                val = 1;
525
                        if (val < 0 || val > 255)
526
                                goto e_inval;
527
                        sk->protinfo.af_inet.mc_ttl=val;
528
                        break;
529
                case IP_MULTICAST_LOOP:
530
                        if (optlen<1)
531
                                goto e_inval;
532
                        sk->protinfo.af_inet.mc_loop = val ? 1 : 0;
533
                        break;
534
                case IP_MULTICAST_IF:
535
                {
536
                        struct ip_mreqn mreq;
537
                        struct net_device *dev = NULL;
538
 
539
                        if (sk->type == SOCK_STREAM)
540
                                goto e_inval;
541
                        /*
542
                         *      Check the arguments are allowable
543
                         */
544
 
545
                        err = -EFAULT;
546
                        if (optlen >= sizeof(struct ip_mreqn)) {
547
                                if (copy_from_user(&mreq,optval,sizeof(mreq)))
548
                                        break;
549
                        } else {
550
                                memset(&mreq, 0, sizeof(mreq));
551
                                if (optlen >= sizeof(struct in_addr) &&
552
                                    copy_from_user(&mreq.imr_address,optval,sizeof(struct in_addr)))
553
                                        break;
554
                        }
555
 
556
                        if (!mreq.imr_ifindex) {
557
                                if (mreq.imr_address.s_addr == INADDR_ANY) {
558
                                        sk->protinfo.af_inet.mc_index = 0;
559
                                        sk->protinfo.af_inet.mc_addr  = 0;
560
                                        err = 0;
561
                                        break;
562
                                }
563
                                dev = ip_dev_find(mreq.imr_address.s_addr);
564
                                if (dev) {
565
                                        mreq.imr_ifindex = dev->ifindex;
566
                                        dev_put(dev);
567
                                }
568
                        } else
569
                                dev = __dev_get_by_index(mreq.imr_ifindex);
570
 
571
 
572
                        err = -EADDRNOTAVAIL;
573
                        if (!dev)
574
                                break;
575
 
576
                        err = -EINVAL;
577
                        if (sk->bound_dev_if && mreq.imr_ifindex != sk->bound_dev_if)
578
                                break;
579
 
580
                        sk->protinfo.af_inet.mc_index = mreq.imr_ifindex;
581
                        sk->protinfo.af_inet.mc_addr  = mreq.imr_address.s_addr;
582
                        err = 0;
583
                        break;
584
                }
585
 
586
                case IP_ADD_MEMBERSHIP:
587
                case IP_DROP_MEMBERSHIP:
588
                {
589
                        struct ip_mreqn mreq;
590
 
591
                        if (optlen < sizeof(struct ip_mreq))
592
                                goto e_inval;
593
                        err = -EFAULT;
594
                        if (optlen >= sizeof(struct ip_mreqn)) {
595
                                if(copy_from_user(&mreq,optval,sizeof(mreq)))
596
                                        break;
597
                        } else {
598
                                memset(&mreq, 0, sizeof(mreq));
599
                                if (copy_from_user(&mreq,optval,sizeof(struct ip_mreq)))
600
                                        break;
601
                        }
602
 
603
                        if (optname == IP_ADD_MEMBERSHIP)
604
                                err = ip_mc_join_group(sk, &mreq);
605
                        else
606
                                err = ip_mc_leave_group(sk, &mreq);
607
                        break;
608
                }
609
                case IP_MSFILTER:
610
                {
611
                        extern int sysctl_optmem_max;
612
                        extern int sysctl_igmp_max_msf;
613
                        struct ip_msfilter *msf;
614
 
615
                        if (optlen < IP_MSFILTER_SIZE(0))
616
                                goto e_inval;
617
                        if (optlen > sysctl_optmem_max) {
618
                                err = -ENOBUFS;
619
                                break;
620
                        }
621
                        msf = (struct ip_msfilter *)kmalloc(optlen, GFP_KERNEL);
622
                        if (msf == 0) {
623
                                err = -ENOBUFS;
624
                                break;
625
                        }
626
                        err = -EFAULT;
627
                        if (copy_from_user(msf, optval, optlen)) {
628
                                kfree(msf);
629
                                break;
630
                        }
631
                        /* numsrc >= (1G-4) overflow in 32 bits */
632
                        if (msf->imsf_numsrc >= 0x3ffffffcU ||
633
                            msf->imsf_numsrc > sysctl_igmp_max_msf) {
634
                                kfree(msf);
635
                                err = -ENOBUFS;
636
                                break;
637
                        }
638
                        if (IP_MSFILTER_SIZE(msf->imsf_numsrc) > optlen) {
639
                                kfree(msf);
640
                                err = -EINVAL;
641
                                break;
642
                        }
643
                        err = ip_mc_msfilter(sk, msf, 0);
644
                        kfree(msf);
645
                        break;
646
                }
647
                case IP_BLOCK_SOURCE:
648
                case IP_UNBLOCK_SOURCE:
649
                case IP_ADD_SOURCE_MEMBERSHIP:
650
                case IP_DROP_SOURCE_MEMBERSHIP:
651
                {
652
                        struct ip_mreq_source mreqs;
653
                        int omode, add;
654
 
655
                        if (optlen != sizeof(struct ip_mreq_source))
656
                                goto e_inval;
657
                        if (copy_from_user(&mreqs, optval, sizeof(mreqs))) {
658
                                err = -EFAULT;
659
                                break;
660
                        }
661
                        if (optname == IP_BLOCK_SOURCE) {
662
                                omode = MCAST_EXCLUDE;
663
                                add = 1;
664
                        } else if (optname == IP_UNBLOCK_SOURCE) {
665
                                omode = MCAST_EXCLUDE;
666
                                add = 0;
667
                        } else if (optname == IP_ADD_SOURCE_MEMBERSHIP) {
668
                                struct ip_mreqn mreq;
669
 
670
                                mreq.imr_multiaddr.s_addr = mreqs.imr_multiaddr;
671
                                mreq.imr_address.s_addr = mreqs.imr_interface;
672
                                mreq.imr_ifindex = 0;
673
                                err = ip_mc_join_group(sk, &mreq);
674
                                if (err)
675
                                        break;
676
                                omode = MCAST_INCLUDE;
677
                                add = 1;
678
                        } else /*IP_DROP_SOURCE_MEMBERSHIP */ {
679
                                omode = MCAST_INCLUDE;
680
                                add = 0;
681
                        }
682
                        err = ip_mc_source(add, omode, sk, &mreqs, 0);
683
                        break;
684
                }
685
                case MCAST_JOIN_GROUP:
686
                case MCAST_LEAVE_GROUP:
687
                {
688
                        struct group_req greq;
689
                        struct sockaddr_in *psin;
690
                        struct ip_mreqn mreq;
691
 
692
                        if (optlen < sizeof(struct group_req))
693
                                goto e_inval;
694
                        err = -EFAULT;
695
                        if(copy_from_user(&greq, optval, sizeof(greq)))
696
                                break;
697
                        psin = (struct sockaddr_in *)&greq.gr_group;
698
                        if (psin->sin_family != AF_INET)
699
                                goto e_inval;
700
                        memset(&mreq, 0, sizeof(mreq));
701
                        mreq.imr_multiaddr = psin->sin_addr;
702
                        mreq.imr_ifindex = greq.gr_interface;
703
 
704
                        if (optname == MCAST_JOIN_GROUP)
705
                                err = ip_mc_join_group(sk, &mreq);
706
                        else
707
                                err = ip_mc_leave_group(sk, &mreq);
708
                        break;
709
                }
710
                case MCAST_JOIN_SOURCE_GROUP:
711
                case MCAST_LEAVE_SOURCE_GROUP:
712
                case MCAST_BLOCK_SOURCE:
713
                case MCAST_UNBLOCK_SOURCE:
714
                {
715
                        struct group_source_req greqs;
716
                        struct ip_mreq_source mreqs;
717
                        struct sockaddr_in *psin;
718
                        int omode, add;
719
 
720
                        if (optlen != sizeof(struct group_source_req))
721
                                goto e_inval;
722
                        if (copy_from_user(&greqs, optval, sizeof(greqs))) {
723
                                err = -EFAULT;
724
                                break;
725
                        }
726
                        if (greqs.gsr_group.ss_family != AF_INET ||
727
                            greqs.gsr_source.ss_family != AF_INET) {
728
                                err = -EADDRNOTAVAIL;
729
                                break;
730
                        }
731
                        psin = (struct sockaddr_in *)&greqs.gsr_group;
732
                        mreqs.imr_multiaddr = psin->sin_addr.s_addr;
733
                        psin = (struct sockaddr_in *)&greqs.gsr_source;
734
                        mreqs.imr_sourceaddr = psin->sin_addr.s_addr;
735
                        mreqs.imr_interface = 0; /* use index for mc_source */
736
 
737
                        if (optname == MCAST_BLOCK_SOURCE) {
738
                                omode = MCAST_EXCLUDE;
739
                                add = 1;
740
                        } else if (optname == MCAST_UNBLOCK_SOURCE) {
741
                                omode = MCAST_EXCLUDE;
742
                                add = 0;
743
                        } else if (optname == MCAST_JOIN_SOURCE_GROUP) {
744
                                struct ip_mreqn mreq;
745
 
746
                                psin = (struct sockaddr_in *)&greqs.gsr_group;
747
                                mreq.imr_multiaddr = psin->sin_addr;
748
                                mreq.imr_address.s_addr = 0;
749
                                mreq.imr_ifindex = greqs.gsr_interface;
750
                                err = ip_mc_join_group(sk, &mreq);
751
                                if (err)
752
                                        break;
753
                                omode = MCAST_INCLUDE;
754
                                add = 1;
755
                        } else /* MCAST_LEAVE_SOURCE_GROUP */ {
756
                                omode = MCAST_INCLUDE;
757
                                add = 0;
758
                        }
759
                        err = ip_mc_source(add, omode, sk, &mreqs,
760
                                greqs.gsr_interface);
761
                        break;
762
                }
763
                case MCAST_MSFILTER:
764
                {
765
                        extern int sysctl_optmem_max;
766
                        extern int sysctl_igmp_max_msf;
767
                        struct sockaddr_in *psin;
768
                        struct ip_msfilter *msf = 0;
769
                        struct group_filter *gsf = 0;
770
                        int msize, i, ifindex;
771
 
772
                        if (optlen < GROUP_FILTER_SIZE(0))
773
                                goto e_inval;
774
                        if (optlen > sysctl_optmem_max) {
775
                                err = -ENOBUFS;
776
                                break;
777
                        }
778
                        gsf = (struct group_filter *)kmalloc(optlen,GFP_KERNEL);
779
                        if (gsf == 0) {
780
                                err = -ENOBUFS;
781
                                break;
782
                        }
783
                        err = -EFAULT;
784
                        if (copy_from_user(gsf, optval, optlen)) {
785
                                goto mc_msf_out;
786
                        }
787
                        /* numsrc >= (4G-140)/128 overflow in 32 bits */
788
                        if (gsf->gf_numsrc >= 0x1ffffff ||
789
                            gsf->gf_numsrc > sysctl_igmp_max_msf) {
790
                                err = -ENOBUFS;
791
                                goto mc_msf_out;
792
                        }
793
                        if (GROUP_FILTER_SIZE(gsf->gf_numsrc) > optlen) {
794
                                err = EINVAL;
795
                                goto mc_msf_out;
796
                        }
797
                        msize = IP_MSFILTER_SIZE(gsf->gf_numsrc);
798
                        msf = (struct ip_msfilter *)kmalloc(msize,GFP_KERNEL);
799
                        if (msf == 0) {
800
                                err = -ENOBUFS;
801
                                goto mc_msf_out;
802
                        }
803
                        ifindex = gsf->gf_interface;
804
                        psin = (struct sockaddr_in *)&gsf->gf_group;
805
                        if (psin->sin_family != AF_INET) {
806
                                err = -EADDRNOTAVAIL;
807
                                goto mc_msf_out;
808
                        }
809
                        msf->imsf_multiaddr = psin->sin_addr.s_addr;
810
                        msf->imsf_interface = 0;
811
                        msf->imsf_fmode = gsf->gf_fmode;
812
                        msf->imsf_numsrc = gsf->gf_numsrc;
813
                        err = -EADDRNOTAVAIL;
814
                        for (i=0; i<gsf->gf_numsrc; ++i) {
815
                                psin = (struct sockaddr_in *)&gsf->gf_slist[i];
816
 
817
                                if (psin->sin_family != AF_INET)
818
                                        goto mc_msf_out;
819
                                msf->imsf_slist[i] = psin->sin_addr.s_addr;
820
                        }
821
                        kfree(gsf);
822
                        gsf = 0;
823
 
824
                        err = ip_mc_msfilter(sk, msf, ifindex);
825
mc_msf_out:
826
                        if (msf)
827
                                kfree(msf);
828
                        if (gsf)
829
                                kfree(gsf);
830
                        break;
831
                }
832
                case IP_ROUTER_ALERT:
833
                        err = ip_ra_control(sk, val ? 1 : 0, NULL);
834
                        break;
835
 
836
                case IP_FREEBIND:
837
                        if (optlen<1)
838
                                goto e_inval;
839
                        sk->protinfo.af_inet.freebind = !!val;
840
                        break;
841
 
842
                default:
843
#ifdef CONFIG_NETFILTER
844
                        err = nf_setsockopt(sk, PF_INET, optname, optval,
845
                                            optlen);
846
#else
847
                        err = -ENOPROTOOPT;
848
#endif
849
                        break;
850
        }
851
        release_sock(sk);
852
        return err;
853
 
854
e_inval:
855
        release_sock(sk);
856
        return -EINVAL;
857
}
858
 
859
/*
860
 *      Get the options. Note for future reference. The GET of IP options gets the
861
 *      _received_ ones. The set sets the _sent_ ones.
862
 */
863
 
864
int ip_getsockopt(struct sock *sk, int level, int optname, char *optval, int *optlen)
865
{
866
        int val;
867
        int len;
868
 
869
        if(level!=SOL_IP)
870
                return -EOPNOTSUPP;
871
 
872
#ifdef CONFIG_IP_MROUTE
873
        if(optname>=MRT_BASE && optname <=MRT_BASE+10)
874
        {
875
                return ip_mroute_getsockopt(sk,optname,optval,optlen);
876
        }
877
#endif
878
 
879
        if(get_user(len,optlen))
880
                return -EFAULT;
881
        if(len < 0)
882
                return -EINVAL;
883
 
884
        lock_sock(sk);
885
 
886
        switch(optname) {
887
                case IP_OPTIONS:
888
                        {
889
                                unsigned char optbuf[sizeof(struct ip_options)+40];
890
                                struct ip_options * opt = (struct ip_options*)optbuf;
891
                                opt->optlen = 0;
892
                                if (sk->protinfo.af_inet.opt)
893
                                        memcpy(optbuf, sk->protinfo.af_inet.opt,
894
                                               sizeof(struct ip_options)+
895
                                               sk->protinfo.af_inet.opt->optlen);
896
                                release_sock(sk);
897
 
898
                                if (opt->optlen == 0)
899
                                        return put_user(0, optlen);
900
 
901
                                ip_options_undo(opt);
902
 
903
                                len = min_t(unsigned int, len, opt->optlen);
904
                                if(put_user(len, optlen))
905
                                        return -EFAULT;
906
                                if(copy_to_user(optval, opt->__data, len))
907
                                        return -EFAULT;
908
                                return 0;
909
                        }
910
                case IP_PKTINFO:
911
                        val = (sk->protinfo.af_inet.cmsg_flags & IP_CMSG_PKTINFO) != 0;
912
                        break;
913
                case IP_RECVTTL:
914
                        val = (sk->protinfo.af_inet.cmsg_flags & IP_CMSG_TTL) != 0;
915
                        break;
916
                case IP_RECVTOS:
917
                        val = (sk->protinfo.af_inet.cmsg_flags & IP_CMSG_TOS) != 0;
918
                        break;
919
                case IP_RECVOPTS:
920
                        val = (sk->protinfo.af_inet.cmsg_flags & IP_CMSG_RECVOPTS) != 0;
921
                        break;
922
                case IP_RETOPTS:
923
                        val = (sk->protinfo.af_inet.cmsg_flags & IP_CMSG_RETOPTS) != 0;
924
                        break;
925
                case IP_TOS:
926
                        val=sk->protinfo.af_inet.tos;
927
                        break;
928
                case IP_TTL:
929
                        val=sk->protinfo.af_inet.ttl;
930
                        break;
931
                case IP_HDRINCL:
932
                        val=sk->protinfo.af_inet.hdrincl;
933
                        break;
934
                case IP_MTU_DISCOVER:
935
                        val=sk->protinfo.af_inet.pmtudisc;
936
                        break;
937
                case IP_MTU:
938
                {
939
                        struct dst_entry *dst;
940
                        val = 0;
941
                        dst = sk_dst_get(sk);
942
                        if (dst) {
943
                                val = dst->pmtu;
944
                                dst_release(dst);
945
                        }
946
                        if (!val) {
947
                                release_sock(sk);
948
                                return -ENOTCONN;
949
                        }
950
                        break;
951
                }
952
                case IP_RECVERR:
953
                        val=sk->protinfo.af_inet.recverr;
954
                        break;
955
                case IP_MULTICAST_TTL:
956
                        val=sk->protinfo.af_inet.mc_ttl;
957
                        break;
958
                case IP_MULTICAST_LOOP:
959
                        val=sk->protinfo.af_inet.mc_loop;
960
                        break;
961
                case IP_MULTICAST_IF:
962
                {
963
                        struct in_addr addr;
964
                        len = min_t(unsigned int, len, sizeof(struct in_addr));
965
                        addr.s_addr = sk->protinfo.af_inet.mc_addr;
966
                        release_sock(sk);
967
 
968
                        if(put_user(len, optlen))
969
                                return -EFAULT;
970
                        if(copy_to_user((void *)optval, &addr, len))
971
                                return -EFAULT;
972
                        return 0;
973
                }
974
                case IP_MSFILTER:
975
                {
976
                        struct ip_msfilter msf;
977
                        int err;
978
 
979
                        if (len < IP_MSFILTER_SIZE(0)) {
980
                                release_sock(sk);
981
                                return -EINVAL;
982
                        }
983
                        if (copy_from_user(&msf, optval, IP_MSFILTER_SIZE(0))) {
984
                                release_sock(sk);
985
                                return -EFAULT;
986
                        }
987
                        err = ip_mc_msfget(sk, &msf,
988
                                (struct ip_msfilter *)optval, optlen);
989
                        release_sock(sk);
990
                        return err;
991
                }
992
                case MCAST_MSFILTER:
993
                {
994
                        struct group_filter gsf;
995
                        int err;
996
 
997
                        if (len < GROUP_FILTER_SIZE(0)) {
998
                                release_sock(sk);
999
                                return -EINVAL;
1000
                        }
1001
                        if (copy_from_user(&gsf, optval, GROUP_FILTER_SIZE(0))) {
1002
                                release_sock(sk);
1003
                                return -EFAULT;
1004
                        }
1005
                        err = ip_mc_gsfget(sk, &gsf,
1006
                                (struct group_filter *)optval, optlen);
1007
                        release_sock(sk);
1008
                        return err;
1009
                }
1010
                case IP_PKTOPTIONS:
1011
                {
1012
                        struct msghdr msg;
1013
 
1014
                        release_sock(sk);
1015
 
1016
                        if (sk->type != SOCK_STREAM)
1017
                                return -ENOPROTOOPT;
1018
 
1019
                        msg.msg_control = optval;
1020
                        msg.msg_controllen = len;
1021
                        msg.msg_flags = 0;
1022
 
1023
                        if (sk->protinfo.af_inet.cmsg_flags&IP_CMSG_PKTINFO) {
1024
                                struct in_pktinfo info;
1025
 
1026
                                info.ipi_addr.s_addr = sk->rcv_saddr;
1027
                                info.ipi_spec_dst.s_addr = sk->rcv_saddr;
1028
                                info.ipi_ifindex = sk->protinfo.af_inet.mc_index;
1029
                                put_cmsg(&msg, SOL_IP, IP_PKTINFO, sizeof(info), &info);
1030
                        }
1031
                        if (sk->protinfo.af_inet.cmsg_flags&IP_CMSG_TTL) {
1032
                                int hlim = sk->protinfo.af_inet.mc_ttl;
1033
                                put_cmsg(&msg, SOL_IP, IP_TTL, sizeof(hlim), &hlim);
1034
                        }
1035
                        len -= msg.msg_controllen;
1036
                        return put_user(len, optlen);
1037
                }
1038
                case IP_FREEBIND:
1039
                        val = sk->protinfo.af_inet.freebind;
1040
                        break;
1041
                default:
1042
#ifdef CONFIG_NETFILTER
1043
                        val = nf_getsockopt(sk, PF_INET, optname, optval,
1044
                                            &len);
1045
                        release_sock(sk);
1046
                        if (val >= 0)
1047
                                val = put_user(len, optlen);
1048
                        return val;
1049
#else
1050
                        release_sock(sk);
1051
                        return -ENOPROTOOPT;
1052
#endif
1053
        }
1054
        release_sock(sk);
1055
 
1056
        if (len < sizeof(int) && len > 0 && val>=0 && val<255) {
1057
                unsigned char ucval = (unsigned char)val;
1058
                len = 1;
1059
                if(put_user(len, optlen))
1060
                        return -EFAULT;
1061
                if(copy_to_user(optval,&ucval,1))
1062
                        return -EFAULT;
1063
        } else {
1064
                len = min_t(unsigned int, sizeof(int), len);
1065
                if(put_user(len, optlen))
1066
                        return -EFAULT;
1067
                if(copy_to_user(optval,&val,len))
1068
                        return -EFAULT;
1069
        }
1070
        return 0;
1071
}

powered by: WebSVN 2.1.0

© copyright 1999-2024 OpenCores.org, equivalent to Oliscience, all rights reserved. OpenCores®, registered trademark.