blob: 8110362e0af558a9ff77824bc78c1b3677369855 [file] [log] [blame]
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001/*
2 * Linux IPv6 multicast routing support for BSD pim6sd
3 * Based on net/ipv4/ipmr.c.
4 *
5 * (c) 2004 Mickael Hoerdt, <hoerdt@clarinet.u-strasbg.fr>
6 * LSIIT Laboratory, Strasbourg, France
7 * (c) 2004 Jean-Philippe Andriot, <jean-philippe.andriot@6WIND.com>
8 * 6WIND, Paris, France
9 * Copyright (C)2007,2008 USAGI/WIDE Project
10 * YOSHIFUJI Hideaki <yoshfuji@linux-ipv6.org>
11 *
12 * This program is free software; you can redistribute it and/or
13 * modify it under the terms of the GNU General Public License
14 * as published by the Free Software Foundation; either version
15 * 2 of the License, or (at your option) any later version.
16 *
17 */
18
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +090019#include <asm/uaccess.h>
20#include <linux/types.h>
21#include <linux/sched.h>
22#include <linux/errno.h>
23#include <linux/timer.h>
24#include <linux/mm.h>
25#include <linux/kernel.h>
26#include <linux/fcntl.h>
27#include <linux/stat.h>
28#include <linux/socket.h>
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +090029#include <linux/inet.h>
30#include <linux/netdevice.h>
31#include <linux/inetdevice.h>
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +090032#include <linux/proc_fs.h>
33#include <linux/seq_file.h>
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +090034#include <linux/init.h>
Tejun Heo5a0e3ad2010-03-24 17:04:11 +090035#include <linux/slab.h>
David S. Millere2d57762011-02-03 17:59:32 -080036#include <linux/compat.h>
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +090037#include <net/protocol.h>
38#include <linux/skbuff.h>
39#include <net/sock.h>
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +090040#include <net/raw.h>
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +090041#include <linux/notifier.h>
42#include <linux/if_arp.h>
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +090043#include <net/checksum.h>
44#include <net/netlink.h>
Patrick McHardyd1db2752010-05-11 14:40:55 +020045#include <net/fib_rules.h>
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +090046
47#include <net/ipv6.h>
48#include <net/ip6_route.h>
49#include <linux/mroute6.h>
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +090050#include <linux/pim.h>
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +090051#include <net/addrconf.h>
52#include <linux/netfilter_ipv6.h>
Paul Gortmakerbc3b2d72011-07-15 11:47:34 -040053#include <linux/export.h>
Dave Jones5d6e4302009-01-31 00:51:49 -080054#include <net/ip6_checksum.h>
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +090055
Patrick McHardy6bd52142010-05-11 14:40:53 +020056struct mr6_table {
Patrick McHardyd1db2752010-05-11 14:40:55 +020057 struct list_head list;
Patrick McHardy6bd52142010-05-11 14:40:53 +020058#ifdef CONFIG_NET_NS
59 struct net *net;
60#endif
Patrick McHardyd1db2752010-05-11 14:40:55 +020061 u32 id;
Patrick McHardy6bd52142010-05-11 14:40:53 +020062 struct sock *mroute6_sk;
63 struct timer_list ipmr_expire_timer;
64 struct list_head mfc6_unres_queue;
65 struct list_head mfc6_cache_array[MFC6_LINES];
66 struct mif_device vif6_table[MAXMIFS];
67 int maxvif;
68 atomic_t cache_resolve_queue_len;
69 int mroute_do_assert;
70 int mroute_do_pim;
71#ifdef CONFIG_IPV6_PIMSM_V2
72 int mroute_reg_vif_num;
73#endif
74};
75
Patrick McHardyd1db2752010-05-11 14:40:55 +020076struct ip6mr_rule {
77 struct fib_rule common;
78};
79
80struct ip6mr_result {
81 struct mr6_table *mrt;
82};
83
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +090084/* Big lock, protecting vif table, mrt cache and mroute socket state.
85 Note that the changes are semaphored via rtnl_lock.
86 */
87
88static DEFINE_RWLOCK(mrt_lock);
89
90/*
91 * Multicast router control variables
92 */
93
Patrick McHardy6bd52142010-05-11 14:40:53 +020094#define MIF_EXISTS(_mrt, _idx) ((_mrt)->vif6_table[_idx].dev != NULL)
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +090095
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +090096/* Special spinlock for queue of unresolved entries */
97static DEFINE_SPINLOCK(mfc_unres_lock);
98
99/* We return to original Alan's scheme. Hash table of resolved
100 entries is changed only in process context and protected
101 with weak lock mrt_lock. Queue of unresolved entries is protected
102 with strong spinlock mfc_unres_lock.
103
104 In this case data path is free of exclusive locks at all.
105 */
106
107static struct kmem_cache *mrt_cachep __read_mostly;
108
Patrick McHardyd1db2752010-05-11 14:40:55 +0200109static struct mr6_table *ip6mr_new_table(struct net *net, u32 id);
110static void ip6mr_free_table(struct mr6_table *mrt);
111
Patrick McHardy6bd52142010-05-11 14:40:53 +0200112static int ip6_mr_forward(struct net *net, struct mr6_table *mrt,
113 struct sk_buff *skb, struct mfc6_cache *cache);
114static int ip6mr_cache_report(struct mr6_table *mrt, struct sk_buff *pkt,
Benjamin Thery8229efd2008-12-10 16:30:15 -0800115 mifi_t mifi, int assert);
Patrick McHardy5b285ca2010-05-11 14:40:56 +0200116static int __ip6mr_fill_mroute(struct mr6_table *mrt, struct sk_buff *skb,
117 struct mfc6_cache *c, struct rtmsg *rtm);
118static int ip6mr_rtm_dumproute(struct sk_buff *skb,
119 struct netlink_callback *cb);
Patrick McHardy6bd52142010-05-11 14:40:53 +0200120static void mroute_clean_tables(struct mr6_table *mrt);
Patrick McHardyd1db2752010-05-11 14:40:55 +0200121static void ipmr_expire_process(unsigned long arg);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900122
Patrick McHardyd1db2752010-05-11 14:40:55 +0200123#ifdef CONFIG_IPV6_MROUTE_MULTIPLE_TABLES
Eric Dumazet8ffb3352010-06-06 15:34:40 -0700124#define ip6mr_for_each_table(mrt, net) \
Patrick McHardyd1db2752010-05-11 14:40:55 +0200125 list_for_each_entry_rcu(mrt, &net->ipv6.mr6_tables, list)
126
127static struct mr6_table *ip6mr_get_table(struct net *net, u32 id)
128{
129 struct mr6_table *mrt;
130
131 ip6mr_for_each_table(mrt, net) {
132 if (mrt->id == id)
133 return mrt;
134 }
135 return NULL;
136}
137
David S. Miller4c9483b2011-03-12 16:22:43 -0500138static int ip6mr_fib_lookup(struct net *net, struct flowi6 *flp6,
Patrick McHardyd1db2752010-05-11 14:40:55 +0200139 struct mr6_table **mrt)
140{
141 struct ip6mr_result res;
142 struct fib_lookup_arg arg = { .result = &res, };
143 int err;
144
David S. Miller4c9483b2011-03-12 16:22:43 -0500145 err = fib_rules_lookup(net->ipv6.mr6_rules_ops,
146 flowi6_to_flowi(flp6), 0, &arg);
Patrick McHardyd1db2752010-05-11 14:40:55 +0200147 if (err < 0)
148 return err;
149 *mrt = res.mrt;
150 return 0;
151}
152
153static int ip6mr_rule_action(struct fib_rule *rule, struct flowi *flp,
154 int flags, struct fib_lookup_arg *arg)
155{
156 struct ip6mr_result *res = arg->result;
157 struct mr6_table *mrt;
158
159 switch (rule->action) {
160 case FR_ACT_TO_TBL:
161 break;
162 case FR_ACT_UNREACHABLE:
163 return -ENETUNREACH;
164 case FR_ACT_PROHIBIT:
165 return -EACCES;
166 case FR_ACT_BLACKHOLE:
167 default:
168 return -EINVAL;
169 }
170
171 mrt = ip6mr_get_table(rule->fr_net, rule->table);
172 if (mrt == NULL)
173 return -EAGAIN;
174 res->mrt = mrt;
175 return 0;
176}
177
178static int ip6mr_rule_match(struct fib_rule *rule, struct flowi *flp, int flags)
179{
180 return 1;
181}
182
183static const struct nla_policy ip6mr_rule_policy[FRA_MAX + 1] = {
184 FRA_GENERIC_POLICY,
185};
186
187static int ip6mr_rule_configure(struct fib_rule *rule, struct sk_buff *skb,
188 struct fib_rule_hdr *frh, struct nlattr **tb)
189{
190 return 0;
191}
192
193static int ip6mr_rule_compare(struct fib_rule *rule, struct fib_rule_hdr *frh,
194 struct nlattr **tb)
195{
196 return 1;
197}
198
199static int ip6mr_rule_fill(struct fib_rule *rule, struct sk_buff *skb,
200 struct fib_rule_hdr *frh)
201{
202 frh->dst_len = 0;
203 frh->src_len = 0;
204 frh->tos = 0;
205 return 0;
206}
207
208static const struct fib_rules_ops __net_initdata ip6mr_rules_ops_template = {
209 .family = RTNL_FAMILY_IP6MR,
210 .rule_size = sizeof(struct ip6mr_rule),
211 .addr_size = sizeof(struct in6_addr),
212 .action = ip6mr_rule_action,
213 .match = ip6mr_rule_match,
214 .configure = ip6mr_rule_configure,
215 .compare = ip6mr_rule_compare,
216 .default_pref = fib_default_rule_pref,
217 .fill = ip6mr_rule_fill,
218 .nlgroup = RTNLGRP_IPV6_RULE,
219 .policy = ip6mr_rule_policy,
220 .owner = THIS_MODULE,
221};
222
223static int __net_init ip6mr_rules_init(struct net *net)
224{
225 struct fib_rules_ops *ops;
226 struct mr6_table *mrt;
227 int err;
228
229 ops = fib_rules_register(&ip6mr_rules_ops_template, net);
230 if (IS_ERR(ops))
231 return PTR_ERR(ops);
232
233 INIT_LIST_HEAD(&net->ipv6.mr6_tables);
234
235 mrt = ip6mr_new_table(net, RT6_TABLE_DFLT);
236 if (mrt == NULL) {
237 err = -ENOMEM;
238 goto err1;
239 }
240
241 err = fib_default_rule_add(ops, 0x7fff, RT6_TABLE_DFLT, 0);
242 if (err < 0)
243 goto err2;
244
245 net->ipv6.mr6_rules_ops = ops;
246 return 0;
247
248err2:
249 kfree(mrt);
250err1:
251 fib_rules_unregister(ops);
252 return err;
253}
254
255static void __net_exit ip6mr_rules_exit(struct net *net)
256{
257 struct mr6_table *mrt, *next;
258
Eric Dumazet035320d2010-06-06 23:48:40 +0000259 list_for_each_entry_safe(mrt, next, &net->ipv6.mr6_tables, list) {
260 list_del(&mrt->list);
Patrick McHardyd1db2752010-05-11 14:40:55 +0200261 ip6mr_free_table(mrt);
Eric Dumazet035320d2010-06-06 23:48:40 +0000262 }
Patrick McHardyd1db2752010-05-11 14:40:55 +0200263 fib_rules_unregister(net->ipv6.mr6_rules_ops);
264}
265#else
266#define ip6mr_for_each_table(mrt, net) \
267 for (mrt = net->ipv6.mrt6; mrt; mrt = NULL)
268
269static struct mr6_table *ip6mr_get_table(struct net *net, u32 id)
270{
271 return net->ipv6.mrt6;
272}
273
David S. Miller4c9483b2011-03-12 16:22:43 -0500274static int ip6mr_fib_lookup(struct net *net, struct flowi6 *flp6,
Patrick McHardyd1db2752010-05-11 14:40:55 +0200275 struct mr6_table **mrt)
276{
277 *mrt = net->ipv6.mrt6;
278 return 0;
279}
280
281static int __net_init ip6mr_rules_init(struct net *net)
282{
283 net->ipv6.mrt6 = ip6mr_new_table(net, RT6_TABLE_DFLT);
284 return net->ipv6.mrt6 ? 0 : -ENOMEM;
285}
286
287static void __net_exit ip6mr_rules_exit(struct net *net)
288{
289 ip6mr_free_table(net->ipv6.mrt6);
290}
291#endif
292
293static struct mr6_table *ip6mr_new_table(struct net *net, u32 id)
294{
295 struct mr6_table *mrt;
296 unsigned int i;
297
298 mrt = ip6mr_get_table(net, id);
299 if (mrt != NULL)
300 return mrt;
301
302 mrt = kzalloc(sizeof(*mrt), GFP_KERNEL);
303 if (mrt == NULL)
304 return NULL;
305 mrt->id = id;
306 write_pnet(&mrt->net, net);
307
308 /* Forwarding cache */
309 for (i = 0; i < MFC6_LINES; i++)
310 INIT_LIST_HEAD(&mrt->mfc6_cache_array[i]);
311
312 INIT_LIST_HEAD(&mrt->mfc6_unres_queue);
313
314 setup_timer(&mrt->ipmr_expire_timer, ipmr_expire_process,
315 (unsigned long)mrt);
316
317#ifdef CONFIG_IPV6_PIMSM_V2
318 mrt->mroute_reg_vif_num = -1;
319#endif
320#ifdef CONFIG_IPV6_MROUTE_MULTIPLE_TABLES
321 list_add_tail_rcu(&mrt->list, &net->ipv6.mr6_tables);
322#endif
323 return mrt;
324}
325
326static void ip6mr_free_table(struct mr6_table *mrt)
327{
328 del_timer(&mrt->ipmr_expire_timer);
329 mroute_clean_tables(mrt);
330 kfree(mrt);
331}
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900332
333#ifdef CONFIG_PROC_FS
334
335struct ipmr_mfc_iter {
Benjamin Thery8b90fc72008-12-10 16:29:48 -0800336 struct seq_net_private p;
Patrick McHardyd1db2752010-05-11 14:40:55 +0200337 struct mr6_table *mrt;
Patrick McHardyf30a77842010-05-11 14:40:51 +0200338 struct list_head *cache;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900339 int ct;
340};
341
342
Benjamin Thery8b90fc72008-12-10 16:29:48 -0800343static struct mfc6_cache *ipmr_mfc_seq_idx(struct net *net,
344 struct ipmr_mfc_iter *it, loff_t pos)
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900345{
Patrick McHardyd1db2752010-05-11 14:40:55 +0200346 struct mr6_table *mrt = it->mrt;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900347 struct mfc6_cache *mfc;
348
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900349 read_lock(&mrt_lock);
Patrick McHardyf30a77842010-05-11 14:40:51 +0200350 for (it->ct = 0; it->ct < MFC6_LINES; it->ct++) {
Patrick McHardy6bd52142010-05-11 14:40:53 +0200351 it->cache = &mrt->mfc6_cache_array[it->ct];
Patrick McHardyf30a77842010-05-11 14:40:51 +0200352 list_for_each_entry(mfc, it->cache, list)
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900353 if (pos-- == 0)
354 return mfc;
Patrick McHardyf30a77842010-05-11 14:40:51 +0200355 }
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900356 read_unlock(&mrt_lock);
357
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900358 spin_lock_bh(&mfc_unres_lock);
Patrick McHardy6bd52142010-05-11 14:40:53 +0200359 it->cache = &mrt->mfc6_unres_queue;
Patrick McHardyf30a77842010-05-11 14:40:51 +0200360 list_for_each_entry(mfc, it->cache, list)
Patrick McHardyc476efb2010-05-11 14:40:48 +0200361 if (pos-- == 0)
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900362 return mfc;
363 spin_unlock_bh(&mfc_unres_lock);
364
365 it->cache = NULL;
366 return NULL;
367}
368
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900369/*
370 * The /proc interfaces to multicast routing /proc/ip6_mr_cache /proc/ip6_mr_vif
371 */
372
373struct ipmr_vif_iter {
Benjamin Thery8b90fc72008-12-10 16:29:48 -0800374 struct seq_net_private p;
Patrick McHardyd1db2752010-05-11 14:40:55 +0200375 struct mr6_table *mrt;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900376 int ct;
377};
378
Benjamin Thery8b90fc72008-12-10 16:29:48 -0800379static struct mif_device *ip6mr_vif_seq_idx(struct net *net,
380 struct ipmr_vif_iter *iter,
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900381 loff_t pos)
382{
Patrick McHardyd1db2752010-05-11 14:40:55 +0200383 struct mr6_table *mrt = iter->mrt;
Patrick McHardy6bd52142010-05-11 14:40:53 +0200384
385 for (iter->ct = 0; iter->ct < mrt->maxvif; ++iter->ct) {
386 if (!MIF_EXISTS(mrt, iter->ct))
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900387 continue;
388 if (pos-- == 0)
Patrick McHardy6bd52142010-05-11 14:40:53 +0200389 return &mrt->vif6_table[iter->ct];
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900390 }
391 return NULL;
392}
393
394static void *ip6mr_vif_seq_start(struct seq_file *seq, loff_t *pos)
395 __acquires(mrt_lock)
396{
Patrick McHardyd1db2752010-05-11 14:40:55 +0200397 struct ipmr_vif_iter *iter = seq->private;
Benjamin Thery8b90fc72008-12-10 16:29:48 -0800398 struct net *net = seq_file_net(seq);
Patrick McHardyd1db2752010-05-11 14:40:55 +0200399 struct mr6_table *mrt;
400
401 mrt = ip6mr_get_table(net, RT6_TABLE_DFLT);
402 if (mrt == NULL)
403 return ERR_PTR(-ENOENT);
404
405 iter->mrt = mrt;
Benjamin Thery8b90fc72008-12-10 16:29:48 -0800406
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900407 read_lock(&mrt_lock);
Benjamin Thery8b90fc72008-12-10 16:29:48 -0800408 return *pos ? ip6mr_vif_seq_idx(net, seq->private, *pos - 1)
409 : SEQ_START_TOKEN;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900410}
411
412static void *ip6mr_vif_seq_next(struct seq_file *seq, void *v, loff_t *pos)
413{
414 struct ipmr_vif_iter *iter = seq->private;
Benjamin Thery8b90fc72008-12-10 16:29:48 -0800415 struct net *net = seq_file_net(seq);
Patrick McHardyd1db2752010-05-11 14:40:55 +0200416 struct mr6_table *mrt = iter->mrt;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900417
418 ++*pos;
419 if (v == SEQ_START_TOKEN)
Benjamin Thery8b90fc72008-12-10 16:29:48 -0800420 return ip6mr_vif_seq_idx(net, iter, 0);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900421
Patrick McHardy6bd52142010-05-11 14:40:53 +0200422 while (++iter->ct < mrt->maxvif) {
423 if (!MIF_EXISTS(mrt, iter->ct))
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900424 continue;
Patrick McHardy6bd52142010-05-11 14:40:53 +0200425 return &mrt->vif6_table[iter->ct];
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900426 }
427 return NULL;
428}
429
430static void ip6mr_vif_seq_stop(struct seq_file *seq, void *v)
431 __releases(mrt_lock)
432{
433 read_unlock(&mrt_lock);
434}
435
436static int ip6mr_vif_seq_show(struct seq_file *seq, void *v)
437{
Patrick McHardyd1db2752010-05-11 14:40:55 +0200438 struct ipmr_vif_iter *iter = seq->private;
439 struct mr6_table *mrt = iter->mrt;
Benjamin Thery8b90fc72008-12-10 16:29:48 -0800440
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900441 if (v == SEQ_START_TOKEN) {
442 seq_puts(seq,
443 "Interface BytesIn PktsIn BytesOut PktsOut Flags\n");
444 } else {
445 const struct mif_device *vif = v;
446 const char *name = vif->dev ? vif->dev->name : "none";
447
448 seq_printf(seq,
Al Virod430a222008-06-02 10:59:02 +0100449 "%2td %-10s %8ld %7ld %8ld %7ld %05X\n",
Patrick McHardy6bd52142010-05-11 14:40:53 +0200450 vif - mrt->vif6_table,
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900451 name, vif->bytes_in, vif->pkt_in,
452 vif->bytes_out, vif->pkt_out,
453 vif->flags);
454 }
455 return 0;
456}
457
Stephen Hemminger98147d52009-09-01 19:25:02 +0000458static const struct seq_operations ip6mr_vif_seq_ops = {
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900459 .start = ip6mr_vif_seq_start,
460 .next = ip6mr_vif_seq_next,
461 .stop = ip6mr_vif_seq_stop,
462 .show = ip6mr_vif_seq_show,
463};
464
465static int ip6mr_vif_open(struct inode *inode, struct file *file)
466{
Benjamin Thery8b90fc72008-12-10 16:29:48 -0800467 return seq_open_net(inode, file, &ip6mr_vif_seq_ops,
468 sizeof(struct ipmr_vif_iter));
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900469}
470
Stephen Hemminger5ca1b992009-09-01 19:25:05 +0000471static const struct file_operations ip6mr_vif_fops = {
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900472 .owner = THIS_MODULE,
473 .open = ip6mr_vif_open,
474 .read = seq_read,
475 .llseek = seq_lseek,
Benjamin Thery8b90fc72008-12-10 16:29:48 -0800476 .release = seq_release_net,
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900477};
478
479static void *ipmr_mfc_seq_start(struct seq_file *seq, loff_t *pos)
480{
Patrick McHardyd1db2752010-05-11 14:40:55 +0200481 struct ipmr_mfc_iter *it = seq->private;
Benjamin Thery8b90fc72008-12-10 16:29:48 -0800482 struct net *net = seq_file_net(seq);
Patrick McHardyd1db2752010-05-11 14:40:55 +0200483 struct mr6_table *mrt;
Benjamin Thery8b90fc72008-12-10 16:29:48 -0800484
Patrick McHardyd1db2752010-05-11 14:40:55 +0200485 mrt = ip6mr_get_table(net, RT6_TABLE_DFLT);
486 if (mrt == NULL)
487 return ERR_PTR(-ENOENT);
488
489 it->mrt = mrt;
Benjamin Thery8b90fc72008-12-10 16:29:48 -0800490 return *pos ? ipmr_mfc_seq_idx(net, seq->private, *pos - 1)
491 : SEQ_START_TOKEN;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900492}
493
494static void *ipmr_mfc_seq_next(struct seq_file *seq, void *v, loff_t *pos)
495{
496 struct mfc6_cache *mfc = v;
497 struct ipmr_mfc_iter *it = seq->private;
Benjamin Thery8b90fc72008-12-10 16:29:48 -0800498 struct net *net = seq_file_net(seq);
Patrick McHardyd1db2752010-05-11 14:40:55 +0200499 struct mr6_table *mrt = it->mrt;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900500
501 ++*pos;
502
503 if (v == SEQ_START_TOKEN)
Benjamin Thery8b90fc72008-12-10 16:29:48 -0800504 return ipmr_mfc_seq_idx(net, seq->private, 0);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900505
Patrick McHardyf30a77842010-05-11 14:40:51 +0200506 if (mfc->list.next != it->cache)
507 return list_entry(mfc->list.next, struct mfc6_cache, list);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900508
Patrick McHardy6bd52142010-05-11 14:40:53 +0200509 if (it->cache == &mrt->mfc6_unres_queue)
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900510 goto end_of_list;
511
Patrick McHardy6bd52142010-05-11 14:40:53 +0200512 BUG_ON(it->cache != &mrt->mfc6_cache_array[it->ct]);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900513
Benjamin Thery4a6258a2008-12-10 16:24:07 -0800514 while (++it->ct < MFC6_LINES) {
Patrick McHardy6bd52142010-05-11 14:40:53 +0200515 it->cache = &mrt->mfc6_cache_array[it->ct];
Patrick McHardyf30a77842010-05-11 14:40:51 +0200516 if (list_empty(it->cache))
517 continue;
518 return list_first_entry(it->cache, struct mfc6_cache, list);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900519 }
520
521 /* exhausted cache_array, show unresolved */
522 read_unlock(&mrt_lock);
Patrick McHardy6bd52142010-05-11 14:40:53 +0200523 it->cache = &mrt->mfc6_unres_queue;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900524 it->ct = 0;
525
526 spin_lock_bh(&mfc_unres_lock);
Patrick McHardyf30a77842010-05-11 14:40:51 +0200527 if (!list_empty(it->cache))
528 return list_first_entry(it->cache, struct mfc6_cache, list);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900529
530 end_of_list:
531 spin_unlock_bh(&mfc_unres_lock);
532 it->cache = NULL;
533
534 return NULL;
535}
536
537static void ipmr_mfc_seq_stop(struct seq_file *seq, void *v)
538{
539 struct ipmr_mfc_iter *it = seq->private;
Patrick McHardyd1db2752010-05-11 14:40:55 +0200540 struct mr6_table *mrt = it->mrt;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900541
Patrick McHardy6bd52142010-05-11 14:40:53 +0200542 if (it->cache == &mrt->mfc6_unres_queue)
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900543 spin_unlock_bh(&mfc_unres_lock);
Patrick McHardy6bd52142010-05-11 14:40:53 +0200544 else if (it->cache == mrt->mfc6_cache_array)
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900545 read_unlock(&mrt_lock);
546}
547
548static int ipmr_mfc_seq_show(struct seq_file *seq, void *v)
549{
550 int n;
551
552 if (v == SEQ_START_TOKEN) {
553 seq_puts(seq,
554 "Group "
555 "Origin "
556 "Iif Pkts Bytes Wrong Oifs\n");
557 } else {
558 const struct mfc6_cache *mfc = v;
559 const struct ipmr_mfc_iter *it = seq->private;
Patrick McHardyd1db2752010-05-11 14:40:55 +0200560 struct mr6_table *mrt = it->mrt;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900561
Benjamin Thery999890b2008-12-03 22:22:16 -0800562 seq_printf(seq, "%pI6 %pI6 %-3hd",
Harvey Harrison0c6ce782008-10-28 16:09:23 -0700563 &mfc->mf6c_mcastgrp, &mfc->mf6c_origin,
Benjamin Thery1ea472e2008-12-03 22:21:47 -0800564 mfc->mf6c_parent);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900565
Patrick McHardy6bd52142010-05-11 14:40:53 +0200566 if (it->cache != &mrt->mfc6_unres_queue) {
Benjamin Thery1ea472e2008-12-03 22:21:47 -0800567 seq_printf(seq, " %8lu %8lu %8lu",
568 mfc->mfc_un.res.pkt,
569 mfc->mfc_un.res.bytes,
570 mfc->mfc_un.res.wrong_if);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900571 for (n = mfc->mfc_un.res.minvif;
572 n < mfc->mfc_un.res.maxvif; n++) {
Patrick McHardy6bd52142010-05-11 14:40:53 +0200573 if (MIF_EXISTS(mrt, n) &&
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900574 mfc->mfc_un.res.ttls[n] < 255)
575 seq_printf(seq,
576 " %2d:%-3d",
577 n, mfc->mfc_un.res.ttls[n]);
578 }
Benjamin Thery1ea472e2008-12-03 22:21:47 -0800579 } else {
580 /* unresolved mfc_caches don't contain
581 * pkt, bytes and wrong_if values
582 */
583 seq_printf(seq, " %8lu %8lu %8lu", 0ul, 0ul, 0ul);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900584 }
585 seq_putc(seq, '\n');
586 }
587 return 0;
588}
589
James Morris88e9d342009-09-22 16:43:43 -0700590static const struct seq_operations ipmr_mfc_seq_ops = {
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900591 .start = ipmr_mfc_seq_start,
592 .next = ipmr_mfc_seq_next,
593 .stop = ipmr_mfc_seq_stop,
594 .show = ipmr_mfc_seq_show,
595};
596
597static int ipmr_mfc_open(struct inode *inode, struct file *file)
598{
Benjamin Thery8b90fc72008-12-10 16:29:48 -0800599 return seq_open_net(inode, file, &ipmr_mfc_seq_ops,
600 sizeof(struct ipmr_mfc_iter));
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900601}
602
Stephen Hemminger5ca1b992009-09-01 19:25:05 +0000603static const struct file_operations ip6mr_mfc_fops = {
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900604 .owner = THIS_MODULE,
605 .open = ipmr_mfc_open,
606 .read = seq_read,
607 .llseek = seq_lseek,
Benjamin Thery8b90fc72008-12-10 16:29:48 -0800608 .release = seq_release_net,
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900609};
610#endif
611
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +0900612#ifdef CONFIG_IPV6_PIMSM_V2
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +0900613
614static int pim6_rcv(struct sk_buff *skb)
615{
616 struct pimreghdr *pim;
617 struct ipv6hdr *encap;
618 struct net_device *reg_dev = NULL;
Benjamin Thery8229efd2008-12-10 16:30:15 -0800619 struct net *net = dev_net(skb->dev);
Patrick McHardyd1db2752010-05-11 14:40:55 +0200620 struct mr6_table *mrt;
David S. Miller4c9483b2011-03-12 16:22:43 -0500621 struct flowi6 fl6 = {
622 .flowi6_iif = skb->dev->ifindex,
623 .flowi6_mark = skb->mark,
Patrick McHardyd1db2752010-05-11 14:40:55 +0200624 };
625 int reg_vif_num;
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +0900626
627 if (!pskb_may_pull(skb, sizeof(*pim) + sizeof(*encap)))
628 goto drop;
629
630 pim = (struct pimreghdr *)skb_transport_header(skb);
631 if (pim->type != ((PIM_VERSION << 4) | PIM_REGISTER) ||
632 (pim->flags & PIM_NULL_REGISTER) ||
Thomas Goff1d6e55f2009-01-27 22:39:59 -0800633 (csum_ipv6_magic(&ipv6_hdr(skb)->saddr, &ipv6_hdr(skb)->daddr,
634 sizeof(*pim), IPPROTO_PIM,
635 csum_partial((void *)pim, sizeof(*pim), 0)) &&
Al Viroec6b4862008-04-26 22:28:58 -0700636 csum_fold(skb_checksum(skb, 0, skb->len, 0))))
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +0900637 goto drop;
638
639 /* check if the inner packet is destined to mcast group */
640 encap = (struct ipv6hdr *)(skb_transport_header(skb) +
641 sizeof(*pim));
642
643 if (!ipv6_addr_is_multicast(&encap->daddr) ||
644 encap->payload_len == 0 ||
645 ntohs(encap->payload_len) + sizeof(*pim) > skb->len)
646 goto drop;
647
David S. Miller4c9483b2011-03-12 16:22:43 -0500648 if (ip6mr_fib_lookup(net, &fl6, &mrt) < 0)
Patrick McHardyd1db2752010-05-11 14:40:55 +0200649 goto drop;
650 reg_vif_num = mrt->mroute_reg_vif_num;
651
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +0900652 read_lock(&mrt_lock);
653 if (reg_vif_num >= 0)
Patrick McHardy6bd52142010-05-11 14:40:53 +0200654 reg_dev = mrt->vif6_table[reg_vif_num].dev;
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +0900655 if (reg_dev)
656 dev_hold(reg_dev);
657 read_unlock(&mrt_lock);
658
659 if (reg_dev == NULL)
660 goto drop;
661
662 skb->mac_header = skb->network_header;
663 skb_pull(skb, (u8 *)encap - skb->data);
664 skb_reset_network_header(skb);
Thomas Goff1d6e55f2009-01-27 22:39:59 -0800665 skb->protocol = htons(ETH_P_IPV6);
Cesar Eduardo Barros3e49e6d2011-03-26 05:10:30 +0000666 skb->ip_summed = CHECKSUM_NONE;
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +0900667 skb->pkt_type = PACKET_HOST;
Eric Dumazetd19d56d2010-05-17 22:36:55 -0700668
669 skb_tunnel_rx(skb, reg_dev);
670
Eric Dumazetcaf586e2010-09-30 21:06:55 +0000671 netif_rx(skb);
Eric Dumazet8990f462010-09-20 00:12:11 +0000672
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +0900673 dev_put(reg_dev);
674 return 0;
675 drop:
676 kfree_skb(skb);
677 return 0;
678}
679
Alexey Dobriyan41135cc2009-09-14 12:22:28 +0000680static const struct inet6_protocol pim6_protocol = {
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +0900681 .handler = pim6_rcv,
682};
683
684/* Service routines creating virtual interfaces: PIMREG */
685
Stephen Hemminger6fef4c02009-08-31 19:50:41 +0000686static netdev_tx_t reg_vif_xmit(struct sk_buff *skb,
687 struct net_device *dev)
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +0900688{
Benjamin Thery8229efd2008-12-10 16:30:15 -0800689 struct net *net = dev_net(dev);
Patrick McHardyd1db2752010-05-11 14:40:55 +0200690 struct mr6_table *mrt;
David S. Miller4c9483b2011-03-12 16:22:43 -0500691 struct flowi6 fl6 = {
692 .flowi6_oif = dev->ifindex,
693 .flowi6_iif = skb->skb_iif,
694 .flowi6_mark = skb->mark,
Patrick McHardyd1db2752010-05-11 14:40:55 +0200695 };
696 int err;
697
David S. Miller4c9483b2011-03-12 16:22:43 -0500698 err = ip6mr_fib_lookup(net, &fl6, &mrt);
Ben Greear67928c42011-09-23 13:11:01 +0000699 if (err < 0) {
700 kfree_skb(skb);
Patrick McHardyd1db2752010-05-11 14:40:55 +0200701 return err;
Ben Greear67928c42011-09-23 13:11:01 +0000702 }
Benjamin Thery8229efd2008-12-10 16:30:15 -0800703
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +0900704 read_lock(&mrt_lock);
Pavel Emelyanovdc58c782008-05-21 14:17:54 -0700705 dev->stats.tx_bytes += skb->len;
706 dev->stats.tx_packets++;
Patrick McHardy6bd52142010-05-11 14:40:53 +0200707 ip6mr_cache_report(mrt, skb, mrt->mroute_reg_vif_num, MRT6MSG_WHOLEPKT);
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +0900708 read_unlock(&mrt_lock);
709 kfree_skb(skb);
Patrick McHardy6ed10652009-06-23 06:03:08 +0000710 return NETDEV_TX_OK;
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +0900711}
712
Stephen Hemminger007c3832008-11-20 20:28:35 -0800713static const struct net_device_ops reg_vif_netdev_ops = {
714 .ndo_start_xmit = reg_vif_xmit,
715};
716
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +0900717static void reg_vif_setup(struct net_device *dev)
718{
719 dev->type = ARPHRD_PIMREG;
720 dev->mtu = 1500 - sizeof(struct ipv6hdr) - 8;
721 dev->flags = IFF_NOARP;
Stephen Hemminger007c3832008-11-20 20:28:35 -0800722 dev->netdev_ops = &reg_vif_netdev_ops;
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +0900723 dev->destructor = free_netdev;
Tom Goff403dbb92009-06-14 03:16:13 -0700724 dev->features |= NETIF_F_NETNS_LOCAL;
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +0900725}
726
Patrick McHardyd1db2752010-05-11 14:40:55 +0200727static struct net_device *ip6mr_reg_vif(struct net *net, struct mr6_table *mrt)
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +0900728{
729 struct net_device *dev;
Patrick McHardyd1db2752010-05-11 14:40:55 +0200730 char name[IFNAMSIZ];
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +0900731
Patrick McHardyd1db2752010-05-11 14:40:55 +0200732 if (mrt->id == RT6_TABLE_DFLT)
733 sprintf(name, "pim6reg");
734 else
735 sprintf(name, "pim6reg%u", mrt->id);
736
737 dev = alloc_netdev(0, name, reg_vif_setup);
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +0900738 if (dev == NULL)
739 return NULL;
740
Benjamin Thery8229efd2008-12-10 16:30:15 -0800741 dev_net_set(dev, net);
742
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +0900743 if (register_netdevice(dev)) {
744 free_netdev(dev);
745 return NULL;
746 }
747 dev->iflink = 0;
748
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +0900749 if (dev_open(dev))
750 goto failure;
751
Wang Chen7af3db72008-07-14 20:54:54 -0700752 dev_hold(dev);
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +0900753 return dev;
754
755failure:
756 /* allow the register to be completed before unregistering. */
757 rtnl_unlock();
758 rtnl_lock();
759
760 unregister_netdevice(dev);
761 return NULL;
762}
763#endif
764
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900765/*
766 * Delete a VIF entry
767 */
768
Patrick McHardy6bd52142010-05-11 14:40:53 +0200769static int mif6_delete(struct mr6_table *mrt, int vifi, struct list_head *head)
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900770{
771 struct mif_device *v;
772 struct net_device *dev;
Thomas Goff1d6e55f2009-01-27 22:39:59 -0800773 struct inet6_dev *in6_dev;
Patrick McHardy6bd52142010-05-11 14:40:53 +0200774
775 if (vifi < 0 || vifi >= mrt->maxvif)
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900776 return -EADDRNOTAVAIL;
777
Patrick McHardy6bd52142010-05-11 14:40:53 +0200778 v = &mrt->vif6_table[vifi];
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900779
780 write_lock_bh(&mrt_lock);
781 dev = v->dev;
782 v->dev = NULL;
783
784 if (!dev) {
785 write_unlock_bh(&mrt_lock);
786 return -EADDRNOTAVAIL;
787 }
788
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +0900789#ifdef CONFIG_IPV6_PIMSM_V2
Patrick McHardy6bd52142010-05-11 14:40:53 +0200790 if (vifi == mrt->mroute_reg_vif_num)
791 mrt->mroute_reg_vif_num = -1;
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +0900792#endif
793
Patrick McHardy6bd52142010-05-11 14:40:53 +0200794 if (vifi + 1 == mrt->maxvif) {
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900795 int tmp;
796 for (tmp = vifi - 1; tmp >= 0; tmp--) {
Patrick McHardy6bd52142010-05-11 14:40:53 +0200797 if (MIF_EXISTS(mrt, tmp))
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900798 break;
799 }
Patrick McHardy6bd52142010-05-11 14:40:53 +0200800 mrt->maxvif = tmp + 1;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900801 }
802
803 write_unlock_bh(&mrt_lock);
804
805 dev_set_allmulti(dev, -1);
806
Thomas Goff1d6e55f2009-01-27 22:39:59 -0800807 in6_dev = __in6_dev_get(dev);
808 if (in6_dev)
809 in6_dev->cnf.mc_forwarding--;
810
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900811 if (v->flags & MIFF_REGISTER)
Eric Dumazetc871e662009-10-28 04:48:11 +0000812 unregister_netdevice_queue(dev, head);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900813
814 dev_put(dev);
815 return 0;
816}
817
Benjamin Thery58701ad2008-12-10 16:22:34 -0800818static inline void ip6mr_cache_free(struct mfc6_cache *c)
819{
Benjamin Thery58701ad2008-12-10 16:22:34 -0800820 kmem_cache_free(mrt_cachep, c);
821}
822
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900823/* Destroy an unresolved cache entry, killing queued skbs
824 and reporting error to netlink readers.
825 */
826
Patrick McHardy6bd52142010-05-11 14:40:53 +0200827static void ip6mr_destroy_unres(struct mr6_table *mrt, struct mfc6_cache *c)
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900828{
Patrick McHardy6bd52142010-05-11 14:40:53 +0200829 struct net *net = read_pnet(&mrt->net);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900830 struct sk_buff *skb;
831
Patrick McHardy6bd52142010-05-11 14:40:53 +0200832 atomic_dec(&mrt->cache_resolve_queue_len);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900833
834 while((skb = skb_dequeue(&c->mfc_un.unres.unresolved)) != NULL) {
835 if (ipv6_hdr(skb)->version == 0) {
836 struct nlmsghdr *nlh = (struct nlmsghdr *)skb_pull(skb, sizeof(struct ipv6hdr));
837 nlh->nlmsg_type = NLMSG_ERROR;
838 nlh->nlmsg_len = NLMSG_LENGTH(sizeof(struct nlmsgerr));
839 skb_trim(skb, nlh->nlmsg_len);
840 ((struct nlmsgerr *)NLMSG_DATA(nlh))->error = -ETIMEDOUT;
Benjamin Thery8229efd2008-12-10 16:30:15 -0800841 rtnl_unicast(skb, net, NETLINK_CB(skb).pid);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900842 } else
843 kfree_skb(skb);
844 }
845
Benjamin Thery58701ad2008-12-10 16:22:34 -0800846 ip6mr_cache_free(c);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900847}
848
849
Patrick McHardyc476efb2010-05-11 14:40:48 +0200850/* Timer process for all the unresolved queue. */
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900851
Patrick McHardy6bd52142010-05-11 14:40:53 +0200852static void ipmr_do_expire_process(struct mr6_table *mrt)
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900853{
854 unsigned long now = jiffies;
855 unsigned long expires = 10 * HZ;
Patrick McHardyf30a77842010-05-11 14:40:51 +0200856 struct mfc6_cache *c, *next;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900857
Patrick McHardy6bd52142010-05-11 14:40:53 +0200858 list_for_each_entry_safe(c, next, &mrt->mfc6_unres_queue, list) {
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900859 if (time_after(c->mfc_un.unres.expires, now)) {
860 /* not yet... */
861 unsigned long interval = c->mfc_un.unres.expires - now;
862 if (interval < expires)
863 expires = interval;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900864 continue;
865 }
866
Patrick McHardyf30a77842010-05-11 14:40:51 +0200867 list_del(&c->list);
Patrick McHardy6bd52142010-05-11 14:40:53 +0200868 ip6mr_destroy_unres(mrt, c);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900869 }
870
Patrick McHardy6bd52142010-05-11 14:40:53 +0200871 if (!list_empty(&mrt->mfc6_unres_queue))
872 mod_timer(&mrt->ipmr_expire_timer, jiffies + expires);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900873}
874
Patrick McHardyc476efb2010-05-11 14:40:48 +0200875static void ipmr_expire_process(unsigned long arg)
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900876{
Patrick McHardy6bd52142010-05-11 14:40:53 +0200877 struct mr6_table *mrt = (struct mr6_table *)arg;
Patrick McHardyc476efb2010-05-11 14:40:48 +0200878
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900879 if (!spin_trylock(&mfc_unres_lock)) {
Patrick McHardy6bd52142010-05-11 14:40:53 +0200880 mod_timer(&mrt->ipmr_expire_timer, jiffies + 1);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900881 return;
882 }
883
Patrick McHardy6bd52142010-05-11 14:40:53 +0200884 if (!list_empty(&mrt->mfc6_unres_queue))
885 ipmr_do_expire_process(mrt);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900886
887 spin_unlock(&mfc_unres_lock);
888}
889
890/* Fill oifs list. It is called under write locked mrt_lock. */
891
Patrick McHardy6bd52142010-05-11 14:40:53 +0200892static void ip6mr_update_thresholds(struct mr6_table *mrt, struct mfc6_cache *cache,
Patrick McHardyb5aa30b2010-05-11 14:40:50 +0200893 unsigned char *ttls)
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900894{
895 int vifi;
896
Rami Rosen6ac7eb02008-04-10 12:40:10 +0300897 cache->mfc_un.res.minvif = MAXMIFS;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900898 cache->mfc_un.res.maxvif = 0;
Rami Rosen6ac7eb02008-04-10 12:40:10 +0300899 memset(cache->mfc_un.res.ttls, 255, MAXMIFS);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900900
Patrick McHardy6bd52142010-05-11 14:40:53 +0200901 for (vifi = 0; vifi < mrt->maxvif; vifi++) {
902 if (MIF_EXISTS(mrt, vifi) &&
Benjamin Thery4e168802008-12-10 16:15:08 -0800903 ttls[vifi] && ttls[vifi] < 255) {
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900904 cache->mfc_un.res.ttls[vifi] = ttls[vifi];
905 if (cache->mfc_un.res.minvif > vifi)
906 cache->mfc_un.res.minvif = vifi;
907 if (cache->mfc_un.res.maxvif <= vifi)
908 cache->mfc_un.res.maxvif = vifi + 1;
909 }
910 }
911}
912
Patrick McHardy6bd52142010-05-11 14:40:53 +0200913static int mif6_add(struct net *net, struct mr6_table *mrt,
914 struct mif6ctl *vifc, int mrtsock)
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900915{
916 int vifi = vifc->mif6c_mifi;
Patrick McHardy6bd52142010-05-11 14:40:53 +0200917 struct mif_device *v = &mrt->vif6_table[vifi];
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900918 struct net_device *dev;
Thomas Goff1d6e55f2009-01-27 22:39:59 -0800919 struct inet6_dev *in6_dev;
Wang Chen5ae7b442008-07-14 20:54:23 -0700920 int err;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900921
922 /* Is vif busy ? */
Patrick McHardy6bd52142010-05-11 14:40:53 +0200923 if (MIF_EXISTS(mrt, vifi))
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900924 return -EADDRINUSE;
925
926 switch (vifc->mif6c_flags) {
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +0900927#ifdef CONFIG_IPV6_PIMSM_V2
928 case MIFF_REGISTER:
929 /*
930 * Special Purpose VIF in PIM
931 * All the packets will be sent to the daemon
932 */
Patrick McHardy6bd52142010-05-11 14:40:53 +0200933 if (mrt->mroute_reg_vif_num >= 0)
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +0900934 return -EADDRINUSE;
Patrick McHardyd1db2752010-05-11 14:40:55 +0200935 dev = ip6mr_reg_vif(net, mrt);
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +0900936 if (!dev)
937 return -ENOBUFS;
Wang Chen5ae7b442008-07-14 20:54:23 -0700938 err = dev_set_allmulti(dev, 1);
939 if (err) {
940 unregister_netdevice(dev);
Wang Chen7af3db72008-07-14 20:54:54 -0700941 dev_put(dev);
Wang Chen5ae7b442008-07-14 20:54:23 -0700942 return err;
943 }
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +0900944 break;
945#endif
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900946 case 0:
Benjamin Thery8229efd2008-12-10 16:30:15 -0800947 dev = dev_get_by_index(net, vifc->mif6c_pifi);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900948 if (!dev)
949 return -EADDRNOTAVAIL;
Wang Chen5ae7b442008-07-14 20:54:23 -0700950 err = dev_set_allmulti(dev, 1);
Wang Chen7af3db72008-07-14 20:54:54 -0700951 if (err) {
952 dev_put(dev);
Wang Chen5ae7b442008-07-14 20:54:23 -0700953 return err;
Wang Chen7af3db72008-07-14 20:54:54 -0700954 }
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900955 break;
956 default:
957 return -EINVAL;
958 }
959
Thomas Goff1d6e55f2009-01-27 22:39:59 -0800960 in6_dev = __in6_dev_get(dev);
961 if (in6_dev)
962 in6_dev->cnf.mc_forwarding++;
963
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900964 /*
965 * Fill in the VIF structures
966 */
967 v->rate_limit = vifc->vifc_rate_limit;
968 v->flags = vifc->mif6c_flags;
969 if (!mrtsock)
970 v->flags |= VIFF_STATIC;
971 v->threshold = vifc->vifc_threshold;
972 v->bytes_in = 0;
973 v->bytes_out = 0;
974 v->pkt_in = 0;
975 v->pkt_out = 0;
976 v->link = dev->ifindex;
977 if (v->flags & MIFF_REGISTER)
978 v->link = dev->iflink;
979
980 /* And finish update writing critical data */
981 write_lock_bh(&mrt_lock);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900982 v->dev = dev;
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +0900983#ifdef CONFIG_IPV6_PIMSM_V2
984 if (v->flags & MIFF_REGISTER)
Patrick McHardy6bd52142010-05-11 14:40:53 +0200985 mrt->mroute_reg_vif_num = vifi;
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +0900986#endif
Patrick McHardy6bd52142010-05-11 14:40:53 +0200987 if (vifi + 1 > mrt->maxvif)
988 mrt->maxvif = vifi + 1;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900989 write_unlock_bh(&mrt_lock);
990 return 0;
991}
992
Patrick McHardy6bd52142010-05-11 14:40:53 +0200993static struct mfc6_cache *ip6mr_cache_find(struct mr6_table *mrt,
Eric Dumazetb71d1d42011-04-22 04:53:02 +0000994 const struct in6_addr *origin,
995 const struct in6_addr *mcastgrp)
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +0900996{
997 int line = MFC6_HASH(mcastgrp, origin);
998 struct mfc6_cache *c;
999
Patrick McHardy6bd52142010-05-11 14:40:53 +02001000 list_for_each_entry(c, &mrt->mfc6_cache_array[line], list) {
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001001 if (ipv6_addr_equal(&c->mf6c_origin, origin) &&
1002 ipv6_addr_equal(&c->mf6c_mcastgrp, mcastgrp))
Patrick McHardyf30a77842010-05-11 14:40:51 +02001003 return c;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001004 }
Patrick McHardyf30a77842010-05-11 14:40:51 +02001005 return NULL;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001006}
1007
1008/*
1009 * Allocate a multicast cache entry
1010 */
Patrick McHardyb5aa30b2010-05-11 14:40:50 +02001011static struct mfc6_cache *ip6mr_cache_alloc(void)
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001012{
Joe Perches36cbac52008-12-03 22:27:25 -08001013 struct mfc6_cache *c = kmem_cache_zalloc(mrt_cachep, GFP_KERNEL);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001014 if (c == NULL)
1015 return NULL;
Rami Rosen6ac7eb02008-04-10 12:40:10 +03001016 c->mfc_un.res.minvif = MAXMIFS;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001017 return c;
1018}
1019
Patrick McHardyb5aa30b2010-05-11 14:40:50 +02001020static struct mfc6_cache *ip6mr_cache_alloc_unres(void)
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001021{
Joe Perches36cbac52008-12-03 22:27:25 -08001022 struct mfc6_cache *c = kmem_cache_zalloc(mrt_cachep, GFP_ATOMIC);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001023 if (c == NULL)
1024 return NULL;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001025 skb_queue_head_init(&c->mfc_un.unres.unresolved);
1026 c->mfc_un.unres.expires = jiffies + 10 * HZ;
1027 return c;
1028}
1029
1030/*
1031 * A cache entry has gone into a resolved state from queued
1032 */
1033
Patrick McHardy6bd52142010-05-11 14:40:53 +02001034static void ip6mr_cache_resolve(struct net *net, struct mr6_table *mrt,
1035 struct mfc6_cache *uc, struct mfc6_cache *c)
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001036{
1037 struct sk_buff *skb;
1038
1039 /*
1040 * Play the pending entries through our router
1041 */
1042
1043 while((skb = __skb_dequeue(&uc->mfc_un.unres.unresolved))) {
1044 if (ipv6_hdr(skb)->version == 0) {
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001045 struct nlmsghdr *nlh = (struct nlmsghdr *)skb_pull(skb, sizeof(struct ipv6hdr));
1046
Patrick McHardy5b285ca2010-05-11 14:40:56 +02001047 if (__ip6mr_fill_mroute(mrt, skb, c, NLMSG_DATA(nlh)) > 0) {
YOSHIFUJI Hideaki549e0282008-04-05 22:17:39 +09001048 nlh->nlmsg_len = skb_tail_pointer(skb) - (u8 *)nlh;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001049 } else {
1050 nlh->nlmsg_type = NLMSG_ERROR;
1051 nlh->nlmsg_len = NLMSG_LENGTH(sizeof(struct nlmsgerr));
1052 skb_trim(skb, nlh->nlmsg_len);
1053 ((struct nlmsgerr *)NLMSG_DATA(nlh))->error = -EMSGSIZE;
1054 }
Hagen Paul Pfeiferddc37312011-02-25 05:45:20 +00001055 rtnl_unicast(skb, net, NETLINK_CB(skb).pid);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001056 } else
Patrick McHardy6bd52142010-05-11 14:40:53 +02001057 ip6_mr_forward(net, mrt, skb, c);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001058 }
1059}
1060
1061/*
1062 * Bounce a cache query up to pim6sd. We could use netlink for this but pim6sd
1063 * expects the following bizarre scheme.
1064 *
1065 * Called under mrt_lock.
1066 */
1067
Patrick McHardy6bd52142010-05-11 14:40:53 +02001068static int ip6mr_cache_report(struct mr6_table *mrt, struct sk_buff *pkt,
1069 mifi_t mifi, int assert)
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001070{
1071 struct sk_buff *skb;
1072 struct mrt6msg *msg;
1073 int ret;
1074
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +09001075#ifdef CONFIG_IPV6_PIMSM_V2
1076 if (assert == MRT6MSG_WHOLEPKT)
1077 skb = skb_realloc_headroom(pkt, -skb_network_offset(pkt)
1078 +sizeof(*msg));
1079 else
1080#endif
1081 skb = alloc_skb(sizeof(struct ipv6hdr) + sizeof(*msg), GFP_ATOMIC);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001082
1083 if (!skb)
1084 return -ENOBUFS;
1085
1086 /* I suppose that internal messages
1087 * do not require checksums */
1088
1089 skb->ip_summed = CHECKSUM_UNNECESSARY;
1090
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +09001091#ifdef CONFIG_IPV6_PIMSM_V2
1092 if (assert == MRT6MSG_WHOLEPKT) {
1093 /* Ugly, but we have no choice with this interface.
1094 Duplicate old header, fix length etc.
1095 And all this only to mangle msg->im6_msgtype and
1096 to set msg->im6_mbz to "mbz" :-)
1097 */
1098 skb_push(skb, -skb_network_offset(pkt));
1099
1100 skb_push(skb, sizeof(*msg));
1101 skb_reset_transport_header(skb);
1102 msg = (struct mrt6msg *)skb_transport_header(skb);
1103 msg->im6_mbz = 0;
1104 msg->im6_msgtype = MRT6MSG_WHOLEPKT;
Patrick McHardy6bd52142010-05-11 14:40:53 +02001105 msg->im6_mif = mrt->mroute_reg_vif_num;
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +09001106 msg->im6_pad = 0;
Alexey Dobriyan4e3fd7a2011-11-21 03:39:03 +00001107 msg->im6_src = ipv6_hdr(pkt)->saddr;
1108 msg->im6_dst = ipv6_hdr(pkt)->daddr;
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +09001109
1110 skb->ip_summed = CHECKSUM_UNNECESSARY;
1111 } else
1112#endif
1113 {
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001114 /*
1115 * Copy the IP header
1116 */
1117
1118 skb_put(skb, sizeof(struct ipv6hdr));
1119 skb_reset_network_header(skb);
1120 skb_copy_to_linear_data(skb, ipv6_hdr(pkt), sizeof(struct ipv6hdr));
1121
1122 /*
1123 * Add our header
1124 */
1125 skb_put(skb, sizeof(*msg));
1126 skb_reset_transport_header(skb);
1127 msg = (struct mrt6msg *)skb_transport_header(skb);
1128
1129 msg->im6_mbz = 0;
1130 msg->im6_msgtype = assert;
Rami Rosen6ac7eb02008-04-10 12:40:10 +03001131 msg->im6_mif = mifi;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001132 msg->im6_pad = 0;
Alexey Dobriyan4e3fd7a2011-11-21 03:39:03 +00001133 msg->im6_src = ipv6_hdr(pkt)->saddr;
1134 msg->im6_dst = ipv6_hdr(pkt)->daddr;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001135
Eric Dumazetadf30902009-06-02 05:19:30 +00001136 skb_dst_set(skb, dst_clone(skb_dst(pkt)));
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001137 skb->ip_summed = CHECKSUM_UNNECESSARY;
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +09001138 }
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001139
Patrick McHardy6bd52142010-05-11 14:40:53 +02001140 if (mrt->mroute6_sk == NULL) {
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001141 kfree_skb(skb);
1142 return -EINVAL;
1143 }
1144
1145 /*
1146 * Deliver to user space multicast routing algorithms
1147 */
Patrick McHardy6bd52142010-05-11 14:40:53 +02001148 ret = sock_queue_rcv_skb(mrt->mroute6_sk, skb);
Benjamin Therybd91b8b2008-12-10 16:07:08 -08001149 if (ret < 0) {
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001150 if (net_ratelimit())
1151 printk(KERN_WARNING "mroute6: pending queue full, dropping entries.\n");
1152 kfree_skb(skb);
1153 }
1154
1155 return ret;
1156}
1157
1158/*
1159 * Queue a packet for resolution. It gets locked cache entry!
1160 */
1161
1162static int
Patrick McHardy6bd52142010-05-11 14:40:53 +02001163ip6mr_cache_unresolved(struct mr6_table *mrt, mifi_t mifi, struct sk_buff *skb)
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001164{
Patrick McHardyf30a77842010-05-11 14:40:51 +02001165 bool found = false;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001166 int err;
1167 struct mfc6_cache *c;
1168
1169 spin_lock_bh(&mfc_unres_lock);
Patrick McHardy6bd52142010-05-11 14:40:53 +02001170 list_for_each_entry(c, &mrt->mfc6_unres_queue, list) {
Patrick McHardyc476efb2010-05-11 14:40:48 +02001171 if (ipv6_addr_equal(&c->mf6c_mcastgrp, &ipv6_hdr(skb)->daddr) &&
Patrick McHardyf30a77842010-05-11 14:40:51 +02001172 ipv6_addr_equal(&c->mf6c_origin, &ipv6_hdr(skb)->saddr)) {
1173 found = true;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001174 break;
Patrick McHardyf30a77842010-05-11 14:40:51 +02001175 }
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001176 }
1177
Patrick McHardyf30a77842010-05-11 14:40:51 +02001178 if (!found) {
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001179 /*
1180 * Create a new entry if allowable
1181 */
1182
Patrick McHardy6bd52142010-05-11 14:40:53 +02001183 if (atomic_read(&mrt->cache_resolve_queue_len) >= 10 ||
Patrick McHardyb5aa30b2010-05-11 14:40:50 +02001184 (c = ip6mr_cache_alloc_unres()) == NULL) {
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001185 spin_unlock_bh(&mfc_unres_lock);
1186
1187 kfree_skb(skb);
1188 return -ENOBUFS;
1189 }
1190
1191 /*
1192 * Fill in the new cache entry
1193 */
1194 c->mf6c_parent = -1;
1195 c->mf6c_origin = ipv6_hdr(skb)->saddr;
1196 c->mf6c_mcastgrp = ipv6_hdr(skb)->daddr;
1197
1198 /*
1199 * Reflect first query at pim6sd
1200 */
Patrick McHardy6bd52142010-05-11 14:40:53 +02001201 err = ip6mr_cache_report(mrt, skb, mifi, MRT6MSG_NOCACHE);
Benjamin Thery8229efd2008-12-10 16:30:15 -08001202 if (err < 0) {
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001203 /* If the report failed throw the cache entry
1204 out - Brad Parker
1205 */
1206 spin_unlock_bh(&mfc_unres_lock);
1207
Benjamin Thery58701ad2008-12-10 16:22:34 -08001208 ip6mr_cache_free(c);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001209 kfree_skb(skb);
1210 return err;
1211 }
1212
Patrick McHardy6bd52142010-05-11 14:40:53 +02001213 atomic_inc(&mrt->cache_resolve_queue_len);
1214 list_add(&c->list, &mrt->mfc6_unres_queue);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001215
Patrick McHardy6bd52142010-05-11 14:40:53 +02001216 ipmr_do_expire_process(mrt);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001217 }
1218
1219 /*
1220 * See if we can append the packet
1221 */
1222 if (c->mfc_un.unres.unresolved.qlen > 3) {
1223 kfree_skb(skb);
1224 err = -ENOBUFS;
1225 } else {
1226 skb_queue_tail(&c->mfc_un.unres.unresolved, skb);
1227 err = 0;
1228 }
1229
1230 spin_unlock_bh(&mfc_unres_lock);
1231 return err;
1232}
1233
1234/*
1235 * MFC6 cache manipulation by user space
1236 */
1237
Patrick McHardy6bd52142010-05-11 14:40:53 +02001238static int ip6mr_mfc_delete(struct mr6_table *mrt, struct mf6cctl *mfc)
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001239{
1240 int line;
Patrick McHardyf30a77842010-05-11 14:40:51 +02001241 struct mfc6_cache *c, *next;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001242
1243 line = MFC6_HASH(&mfc->mf6cc_mcastgrp.sin6_addr, &mfc->mf6cc_origin.sin6_addr);
1244
Patrick McHardy6bd52142010-05-11 14:40:53 +02001245 list_for_each_entry_safe(c, next, &mrt->mfc6_cache_array[line], list) {
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001246 if (ipv6_addr_equal(&c->mf6c_origin, &mfc->mf6cc_origin.sin6_addr) &&
1247 ipv6_addr_equal(&c->mf6c_mcastgrp, &mfc->mf6cc_mcastgrp.sin6_addr)) {
1248 write_lock_bh(&mrt_lock);
Patrick McHardyf30a77842010-05-11 14:40:51 +02001249 list_del(&c->list);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001250 write_unlock_bh(&mrt_lock);
1251
Benjamin Thery58701ad2008-12-10 16:22:34 -08001252 ip6mr_cache_free(c);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001253 return 0;
1254 }
1255 }
1256 return -ENOENT;
1257}
1258
1259static int ip6mr_device_event(struct notifier_block *this,
1260 unsigned long event, void *ptr)
1261{
1262 struct net_device *dev = ptr;
Benjamin Thery8229efd2008-12-10 16:30:15 -08001263 struct net *net = dev_net(dev);
Patrick McHardyd1db2752010-05-11 14:40:55 +02001264 struct mr6_table *mrt;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001265 struct mif_device *v;
1266 int ct;
Eric Dumazetc871e662009-10-28 04:48:11 +00001267 LIST_HEAD(list);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001268
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001269 if (event != NETDEV_UNREGISTER)
1270 return NOTIFY_DONE;
1271
Patrick McHardyd1db2752010-05-11 14:40:55 +02001272 ip6mr_for_each_table(mrt, net) {
1273 v = &mrt->vif6_table[0];
1274 for (ct = 0; ct < mrt->maxvif; ct++, v++) {
1275 if (v->dev == dev)
1276 mif6_delete(mrt, ct, &list);
1277 }
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001278 }
Eric Dumazetc871e662009-10-28 04:48:11 +00001279 unregister_netdevice_many(&list);
1280
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001281 return NOTIFY_DONE;
1282}
1283
1284static struct notifier_block ip6_mr_notifier = {
1285 .notifier_call = ip6mr_device_event
1286};
1287
1288/*
1289 * Setup for IP multicast routing
1290 */
1291
Benjamin Thery4e168802008-12-10 16:15:08 -08001292static int __net_init ip6mr_net_init(struct net *net)
1293{
Patrick McHardyd1db2752010-05-11 14:40:55 +02001294 int err;
Patrick McHardyf30a77842010-05-11 14:40:51 +02001295
Patrick McHardyd1db2752010-05-11 14:40:55 +02001296 err = ip6mr_rules_init(net);
1297 if (err < 0)
Benjamin Thery4e168802008-12-10 16:15:08 -08001298 goto fail;
Benjamin Thery8b90fc72008-12-10 16:29:48 -08001299
1300#ifdef CONFIG_PROC_FS
1301 err = -ENOMEM;
1302 if (!proc_net_fops_create(net, "ip6_mr_vif", 0, &ip6mr_vif_fops))
1303 goto proc_vif_fail;
1304 if (!proc_net_fops_create(net, "ip6_mr_cache", 0, &ip6mr_mfc_fops))
1305 goto proc_cache_fail;
1306#endif
Patrick McHardy6bd52142010-05-11 14:40:53 +02001307
Benjamin Thery4a6258a2008-12-10 16:24:07 -08001308 return 0;
1309
Benjamin Thery8b90fc72008-12-10 16:29:48 -08001310#ifdef CONFIG_PROC_FS
1311proc_cache_fail:
1312 proc_net_remove(net, "ip6_mr_vif");
1313proc_vif_fail:
Patrick McHardyd1db2752010-05-11 14:40:55 +02001314 ip6mr_rules_exit(net);
Benjamin Thery8b90fc72008-12-10 16:29:48 -08001315#endif
Benjamin Thery4e168802008-12-10 16:15:08 -08001316fail:
1317 return err;
1318}
1319
1320static void __net_exit ip6mr_net_exit(struct net *net)
1321{
Benjamin Thery8b90fc72008-12-10 16:29:48 -08001322#ifdef CONFIG_PROC_FS
1323 proc_net_remove(net, "ip6_mr_cache");
1324 proc_net_remove(net, "ip6_mr_vif");
1325#endif
Patrick McHardyd1db2752010-05-11 14:40:55 +02001326 ip6mr_rules_exit(net);
Benjamin Thery4e168802008-12-10 16:15:08 -08001327}
1328
1329static struct pernet_operations ip6mr_net_ops = {
1330 .init = ip6mr_net_init,
1331 .exit = ip6mr_net_exit,
1332};
1333
Wang Chen623d1a12008-07-03 12:13:30 +08001334int __init ip6_mr_init(void)
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001335{
Wang Chen623d1a12008-07-03 12:13:30 +08001336 int err;
1337
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001338 mrt_cachep = kmem_cache_create("ip6_mrt_cache",
1339 sizeof(struct mfc6_cache),
1340 0, SLAB_HWCACHE_ALIGN,
1341 NULL);
1342 if (!mrt_cachep)
Wang Chen623d1a12008-07-03 12:13:30 +08001343 return -ENOMEM;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001344
Benjamin Thery4e168802008-12-10 16:15:08 -08001345 err = register_pernet_subsys(&ip6mr_net_ops);
1346 if (err)
1347 goto reg_pernet_fail;
1348
Wang Chen623d1a12008-07-03 12:13:30 +08001349 err = register_netdevice_notifier(&ip6_mr_notifier);
1350 if (err)
1351 goto reg_notif_fail;
Tom Goff403dbb92009-06-14 03:16:13 -07001352#ifdef CONFIG_IPV6_PIMSM_V2
1353 if (inet6_add_protocol(&pim6_protocol, IPPROTO_PIM) < 0) {
1354 printk(KERN_ERR "ip6_mr_init: can't add PIM protocol\n");
1355 err = -EAGAIN;
1356 goto add_proto_fail;
1357 }
1358#endif
Greg Rosec7ac8672011-06-10 01:27:09 +00001359 rtnl_register(RTNL_FAMILY_IP6MR, RTM_GETROUTE, NULL,
1360 ip6mr_rtm_dumproute, NULL);
Wang Chen623d1a12008-07-03 12:13:30 +08001361 return 0;
Tom Goff403dbb92009-06-14 03:16:13 -07001362#ifdef CONFIG_IPV6_PIMSM_V2
1363add_proto_fail:
1364 unregister_netdevice_notifier(&ip6_mr_notifier);
1365#endif
Benjamin Thery87b30a62008-11-10 16:34:11 -08001366reg_notif_fail:
Benjamin Thery4e168802008-12-10 16:15:08 -08001367 unregister_pernet_subsys(&ip6mr_net_ops);
1368reg_pernet_fail:
Benjamin Thery87b30a62008-11-10 16:34:11 -08001369 kmem_cache_destroy(mrt_cachep);
Wang Chen623d1a12008-07-03 12:13:30 +08001370 return err;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001371}
1372
Wang Chen623d1a12008-07-03 12:13:30 +08001373void ip6_mr_cleanup(void)
1374{
Wang Chen623d1a12008-07-03 12:13:30 +08001375 unregister_netdevice_notifier(&ip6_mr_notifier);
Benjamin Thery4e168802008-12-10 16:15:08 -08001376 unregister_pernet_subsys(&ip6mr_net_ops);
Wang Chen623d1a12008-07-03 12:13:30 +08001377 kmem_cache_destroy(mrt_cachep);
1378}
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001379
Patrick McHardy6bd52142010-05-11 14:40:53 +02001380static int ip6mr_mfc_add(struct net *net, struct mr6_table *mrt,
1381 struct mf6cctl *mfc, int mrtsock)
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001382{
Patrick McHardyf30a77842010-05-11 14:40:51 +02001383 bool found = false;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001384 int line;
Patrick McHardyf30a77842010-05-11 14:40:51 +02001385 struct mfc6_cache *uc, *c;
Rami Rosen6ac7eb02008-04-10 12:40:10 +03001386 unsigned char ttls[MAXMIFS];
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001387 int i;
1388
Patrick McHardya50436f2010-03-17 06:04:14 +00001389 if (mfc->mf6cc_parent >= MAXMIFS)
1390 return -ENFILE;
1391
Rami Rosen6ac7eb02008-04-10 12:40:10 +03001392 memset(ttls, 255, MAXMIFS);
1393 for (i = 0; i < MAXMIFS; i++) {
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001394 if (IF_ISSET(i, &mfc->mf6cc_ifset))
1395 ttls[i] = 1;
1396
1397 }
1398
1399 line = MFC6_HASH(&mfc->mf6cc_mcastgrp.sin6_addr, &mfc->mf6cc_origin.sin6_addr);
1400
Patrick McHardy6bd52142010-05-11 14:40:53 +02001401 list_for_each_entry(c, &mrt->mfc6_cache_array[line], list) {
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001402 if (ipv6_addr_equal(&c->mf6c_origin, &mfc->mf6cc_origin.sin6_addr) &&
Patrick McHardyf30a77842010-05-11 14:40:51 +02001403 ipv6_addr_equal(&c->mf6c_mcastgrp, &mfc->mf6cc_mcastgrp.sin6_addr)) {
1404 found = true;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001405 break;
Patrick McHardyf30a77842010-05-11 14:40:51 +02001406 }
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001407 }
1408
Patrick McHardyf30a77842010-05-11 14:40:51 +02001409 if (found) {
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001410 write_lock_bh(&mrt_lock);
1411 c->mf6c_parent = mfc->mf6cc_parent;
Patrick McHardy6bd52142010-05-11 14:40:53 +02001412 ip6mr_update_thresholds(mrt, c, ttls);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001413 if (!mrtsock)
1414 c->mfc_flags |= MFC_STATIC;
1415 write_unlock_bh(&mrt_lock);
1416 return 0;
1417 }
1418
1419 if (!ipv6_addr_is_multicast(&mfc->mf6cc_mcastgrp.sin6_addr))
1420 return -EINVAL;
1421
Patrick McHardyb5aa30b2010-05-11 14:40:50 +02001422 c = ip6mr_cache_alloc();
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001423 if (c == NULL)
1424 return -ENOMEM;
1425
1426 c->mf6c_origin = mfc->mf6cc_origin.sin6_addr;
1427 c->mf6c_mcastgrp = mfc->mf6cc_mcastgrp.sin6_addr;
1428 c->mf6c_parent = mfc->mf6cc_parent;
Patrick McHardy6bd52142010-05-11 14:40:53 +02001429 ip6mr_update_thresholds(mrt, c, ttls);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001430 if (!mrtsock)
1431 c->mfc_flags |= MFC_STATIC;
1432
1433 write_lock_bh(&mrt_lock);
Patrick McHardy6bd52142010-05-11 14:40:53 +02001434 list_add(&c->list, &mrt->mfc6_cache_array[line]);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001435 write_unlock_bh(&mrt_lock);
1436
1437 /*
1438 * Check to see if we resolved a queued list. If so we
1439 * need to send on the frames and tidy up.
1440 */
Patrick McHardyf30a77842010-05-11 14:40:51 +02001441 found = false;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001442 spin_lock_bh(&mfc_unres_lock);
Patrick McHardy6bd52142010-05-11 14:40:53 +02001443 list_for_each_entry(uc, &mrt->mfc6_unres_queue, list) {
Patrick McHardyc476efb2010-05-11 14:40:48 +02001444 if (ipv6_addr_equal(&uc->mf6c_origin, &c->mf6c_origin) &&
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001445 ipv6_addr_equal(&uc->mf6c_mcastgrp, &c->mf6c_mcastgrp)) {
Patrick McHardyf30a77842010-05-11 14:40:51 +02001446 list_del(&uc->list);
Patrick McHardy6bd52142010-05-11 14:40:53 +02001447 atomic_dec(&mrt->cache_resolve_queue_len);
Patrick McHardyf30a77842010-05-11 14:40:51 +02001448 found = true;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001449 break;
1450 }
1451 }
Patrick McHardy6bd52142010-05-11 14:40:53 +02001452 if (list_empty(&mrt->mfc6_unres_queue))
1453 del_timer(&mrt->ipmr_expire_timer);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001454 spin_unlock_bh(&mfc_unres_lock);
1455
Patrick McHardyf30a77842010-05-11 14:40:51 +02001456 if (found) {
Patrick McHardy6bd52142010-05-11 14:40:53 +02001457 ip6mr_cache_resolve(net, mrt, uc, c);
Benjamin Thery58701ad2008-12-10 16:22:34 -08001458 ip6mr_cache_free(uc);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001459 }
1460 return 0;
1461}
1462
1463/*
1464 * Close the multicast socket, and clear the vif tables etc
1465 */
1466
Patrick McHardy6bd52142010-05-11 14:40:53 +02001467static void mroute_clean_tables(struct mr6_table *mrt)
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001468{
1469 int i;
Eric Dumazetc871e662009-10-28 04:48:11 +00001470 LIST_HEAD(list);
Patrick McHardyf30a77842010-05-11 14:40:51 +02001471 struct mfc6_cache *c, *next;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001472
1473 /*
1474 * Shut down all active vif entries
1475 */
Patrick McHardy6bd52142010-05-11 14:40:53 +02001476 for (i = 0; i < mrt->maxvif; i++) {
1477 if (!(mrt->vif6_table[i].flags & VIFF_STATIC))
1478 mif6_delete(mrt, i, &list);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001479 }
Eric Dumazetc871e662009-10-28 04:48:11 +00001480 unregister_netdevice_many(&list);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001481
1482 /*
1483 * Wipe the cache
1484 */
Benjamin Thery4a6258a2008-12-10 16:24:07 -08001485 for (i = 0; i < MFC6_LINES; i++) {
Patrick McHardy6bd52142010-05-11 14:40:53 +02001486 list_for_each_entry_safe(c, next, &mrt->mfc6_cache_array[i], list) {
Patrick McHardyf30a77842010-05-11 14:40:51 +02001487 if (c->mfc_flags & MFC_STATIC)
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001488 continue;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001489 write_lock_bh(&mrt_lock);
Patrick McHardyf30a77842010-05-11 14:40:51 +02001490 list_del(&c->list);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001491 write_unlock_bh(&mrt_lock);
1492
Benjamin Thery58701ad2008-12-10 16:22:34 -08001493 ip6mr_cache_free(c);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001494 }
1495 }
1496
Patrick McHardy6bd52142010-05-11 14:40:53 +02001497 if (atomic_read(&mrt->cache_resolve_queue_len) != 0) {
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001498 spin_lock_bh(&mfc_unres_lock);
Patrick McHardy6bd52142010-05-11 14:40:53 +02001499 list_for_each_entry_safe(c, next, &mrt->mfc6_unres_queue, list) {
Patrick McHardyf30a77842010-05-11 14:40:51 +02001500 list_del(&c->list);
Patrick McHardy6bd52142010-05-11 14:40:53 +02001501 ip6mr_destroy_unres(mrt, c);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001502 }
1503 spin_unlock_bh(&mfc_unres_lock);
1504 }
1505}
1506
Patrick McHardy6bd52142010-05-11 14:40:53 +02001507static int ip6mr_sk_init(struct mr6_table *mrt, struct sock *sk)
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001508{
1509 int err = 0;
Benjamin Thery8229efd2008-12-10 16:30:15 -08001510 struct net *net = sock_net(sk);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001511
1512 rtnl_lock();
1513 write_lock_bh(&mrt_lock);
Patrick McHardy6bd52142010-05-11 14:40:53 +02001514 if (likely(mrt->mroute6_sk == NULL)) {
1515 mrt->mroute6_sk = sk;
Thomas Goff1d6e55f2009-01-27 22:39:59 -08001516 net->ipv6.devconf_all->mc_forwarding++;
1517 }
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001518 else
1519 err = -EADDRINUSE;
1520 write_unlock_bh(&mrt_lock);
1521
1522 rtnl_unlock();
1523
1524 return err;
1525}
1526
1527int ip6mr_sk_done(struct sock *sk)
1528{
Patrick McHardyd1db2752010-05-11 14:40:55 +02001529 int err = -EACCES;
Benjamin Thery8229efd2008-12-10 16:30:15 -08001530 struct net *net = sock_net(sk);
Patrick McHardyd1db2752010-05-11 14:40:55 +02001531 struct mr6_table *mrt;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001532
1533 rtnl_lock();
Patrick McHardyd1db2752010-05-11 14:40:55 +02001534 ip6mr_for_each_table(mrt, net) {
1535 if (sk == mrt->mroute6_sk) {
1536 write_lock_bh(&mrt_lock);
1537 mrt->mroute6_sk = NULL;
1538 net->ipv6.devconf_all->mc_forwarding--;
1539 write_unlock_bh(&mrt_lock);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001540
Patrick McHardyd1db2752010-05-11 14:40:55 +02001541 mroute_clean_tables(mrt);
1542 err = 0;
1543 break;
1544 }
1545 }
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001546 rtnl_unlock();
1547
1548 return err;
1549}
1550
Patrick McHardyd1db2752010-05-11 14:40:55 +02001551struct sock *mroute6_socket(struct net *net, struct sk_buff *skb)
Patrick McHardy6bd52142010-05-11 14:40:53 +02001552{
Patrick McHardyd1db2752010-05-11 14:40:55 +02001553 struct mr6_table *mrt;
David S. Miller4c9483b2011-03-12 16:22:43 -05001554 struct flowi6 fl6 = {
1555 .flowi6_iif = skb->skb_iif,
1556 .flowi6_oif = skb->dev->ifindex,
1557 .flowi6_mark = skb->mark,
Patrick McHardyd1db2752010-05-11 14:40:55 +02001558 };
1559
David S. Miller4c9483b2011-03-12 16:22:43 -05001560 if (ip6mr_fib_lookup(net, &fl6, &mrt) < 0)
Patrick McHardyd1db2752010-05-11 14:40:55 +02001561 return NULL;
Patrick McHardy6bd52142010-05-11 14:40:53 +02001562
1563 return mrt->mroute6_sk;
1564}
1565
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001566/*
1567 * Socket options and virtual interface manipulation. The whole
1568 * virtual interface system is a complete heap, but unfortunately
1569 * that's how BSD mrouted happens to think. Maybe one day with a proper
1570 * MOSPF/PIM router set up we can clean this up.
1571 */
1572
David S. Millerb7058842009-09-30 16:12:20 -07001573int ip6_mroute_setsockopt(struct sock *sk, int optname, char __user *optval, unsigned int optlen)
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001574{
1575 int ret;
1576 struct mif6ctl vif;
1577 struct mf6cctl mfc;
1578 mifi_t mifi;
Benjamin Thery8229efd2008-12-10 16:30:15 -08001579 struct net *net = sock_net(sk);
Patrick McHardyd1db2752010-05-11 14:40:55 +02001580 struct mr6_table *mrt;
1581
1582 mrt = ip6mr_get_table(net, raw6_sk(sk)->ip6mr_table ? : RT6_TABLE_DFLT);
1583 if (mrt == NULL)
1584 return -ENOENT;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001585
1586 if (optname != MRT6_INIT) {
Patrick McHardy6bd52142010-05-11 14:40:53 +02001587 if (sk != mrt->mroute6_sk && !capable(CAP_NET_ADMIN))
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001588 return -EACCES;
1589 }
1590
1591 switch (optname) {
1592 case MRT6_INIT:
1593 if (sk->sk_type != SOCK_RAW ||
Eric Dumazetc720c7e2009-10-15 06:30:45 +00001594 inet_sk(sk)->inet_num != IPPROTO_ICMPV6)
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001595 return -EOPNOTSUPP;
1596 if (optlen < sizeof(int))
1597 return -EINVAL;
1598
Patrick McHardy6bd52142010-05-11 14:40:53 +02001599 return ip6mr_sk_init(mrt, sk);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001600
1601 case MRT6_DONE:
1602 return ip6mr_sk_done(sk);
1603
1604 case MRT6_ADD_MIF:
1605 if (optlen < sizeof(vif))
1606 return -EINVAL;
1607 if (copy_from_user(&vif, optval, sizeof(vif)))
1608 return -EFAULT;
Rami Rosen6ac7eb02008-04-10 12:40:10 +03001609 if (vif.mif6c_mifi >= MAXMIFS)
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001610 return -ENFILE;
1611 rtnl_lock();
Patrick McHardy6bd52142010-05-11 14:40:53 +02001612 ret = mif6_add(net, mrt, &vif, sk == mrt->mroute6_sk);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001613 rtnl_unlock();
1614 return ret;
1615
1616 case MRT6_DEL_MIF:
1617 if (optlen < sizeof(mifi_t))
1618 return -EINVAL;
1619 if (copy_from_user(&mifi, optval, sizeof(mifi_t)))
1620 return -EFAULT;
1621 rtnl_lock();
Patrick McHardy6bd52142010-05-11 14:40:53 +02001622 ret = mif6_delete(mrt, mifi, NULL);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001623 rtnl_unlock();
1624 return ret;
1625
1626 /*
1627 * Manipulate the forwarding caches. These live
1628 * in a sort of kernel/user symbiosis.
1629 */
1630 case MRT6_ADD_MFC:
1631 case MRT6_DEL_MFC:
1632 if (optlen < sizeof(mfc))
1633 return -EINVAL;
1634 if (copy_from_user(&mfc, optval, sizeof(mfc)))
1635 return -EFAULT;
1636 rtnl_lock();
1637 if (optname == MRT6_DEL_MFC)
Patrick McHardy6bd52142010-05-11 14:40:53 +02001638 ret = ip6mr_mfc_delete(mrt, &mfc);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001639 else
Patrick McHardy6bd52142010-05-11 14:40:53 +02001640 ret = ip6mr_mfc_add(net, mrt, &mfc, sk == mrt->mroute6_sk);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001641 rtnl_unlock();
1642 return ret;
1643
1644 /*
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +09001645 * Control PIM assert (to activate pim will activate assert)
1646 */
1647 case MRT6_ASSERT:
1648 {
1649 int v;
1650 if (get_user(v, (int __user *)optval))
1651 return -EFAULT;
Patrick McHardy6bd52142010-05-11 14:40:53 +02001652 mrt->mroute_do_assert = !!v;
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +09001653 return 0;
1654 }
1655
1656#ifdef CONFIG_IPV6_PIMSM_V2
1657 case MRT6_PIM:
1658 {
YOSHIFUJI Hideakia9f83bf2008-04-10 15:41:28 +09001659 int v;
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +09001660 if (get_user(v, (int __user *)optval))
1661 return -EFAULT;
1662 v = !!v;
1663 rtnl_lock();
1664 ret = 0;
Patrick McHardy6bd52142010-05-11 14:40:53 +02001665 if (v != mrt->mroute_do_pim) {
1666 mrt->mroute_do_pim = v;
1667 mrt->mroute_do_assert = v;
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +09001668 }
1669 rtnl_unlock();
1670 return ret;
1671 }
1672
1673#endif
Patrick McHardyd1db2752010-05-11 14:40:55 +02001674#ifdef CONFIG_IPV6_MROUTE_MULTIPLE_TABLES
1675 case MRT6_TABLE:
1676 {
1677 u32 v;
1678
1679 if (optlen != sizeof(u32))
1680 return -EINVAL;
1681 if (get_user(v, (u32 __user *)optval))
1682 return -EFAULT;
1683 if (sk == mrt->mroute6_sk)
1684 return -EBUSY;
1685
1686 rtnl_lock();
1687 ret = 0;
1688 if (!ip6mr_new_table(net, v))
1689 ret = -ENOMEM;
1690 raw6_sk(sk)->ip6mr_table = v;
1691 rtnl_unlock();
1692 return ret;
1693 }
1694#endif
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +09001695 /*
Rami Rosen7d120c52008-04-23 14:35:13 +03001696 * Spurious command, or MRT6_VERSION which you cannot
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001697 * set.
1698 */
1699 default:
1700 return -ENOPROTOOPT;
1701 }
1702}
1703
1704/*
1705 * Getsock opt support for the multicast routing system.
1706 */
1707
1708int ip6_mroute_getsockopt(struct sock *sk, int optname, char __user *optval,
1709 int __user *optlen)
1710{
1711 int olr;
1712 int val;
Benjamin Thery8229efd2008-12-10 16:30:15 -08001713 struct net *net = sock_net(sk);
Patrick McHardyd1db2752010-05-11 14:40:55 +02001714 struct mr6_table *mrt;
1715
1716 mrt = ip6mr_get_table(net, raw6_sk(sk)->ip6mr_table ? : RT6_TABLE_DFLT);
1717 if (mrt == NULL)
1718 return -ENOENT;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001719
1720 switch (optname) {
1721 case MRT6_VERSION:
1722 val = 0x0305;
1723 break;
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +09001724#ifdef CONFIG_IPV6_PIMSM_V2
1725 case MRT6_PIM:
Patrick McHardy6bd52142010-05-11 14:40:53 +02001726 val = mrt->mroute_do_pim;
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +09001727 break;
1728#endif
1729 case MRT6_ASSERT:
Patrick McHardy6bd52142010-05-11 14:40:53 +02001730 val = mrt->mroute_do_assert;
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +09001731 break;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001732 default:
1733 return -ENOPROTOOPT;
1734 }
1735
1736 if (get_user(olr, optlen))
1737 return -EFAULT;
1738
1739 olr = min_t(int, olr, sizeof(int));
1740 if (olr < 0)
1741 return -EINVAL;
1742
1743 if (put_user(olr, optlen))
1744 return -EFAULT;
1745 if (copy_to_user(optval, &val, olr))
1746 return -EFAULT;
1747 return 0;
1748}
1749
1750/*
1751 * The IP multicast ioctl support routines.
1752 */
1753
1754int ip6mr_ioctl(struct sock *sk, int cmd, void __user *arg)
1755{
1756 struct sioc_sg_req6 sr;
1757 struct sioc_mif_req6 vr;
1758 struct mif_device *vif;
1759 struct mfc6_cache *c;
Benjamin Thery8229efd2008-12-10 16:30:15 -08001760 struct net *net = sock_net(sk);
Patrick McHardyd1db2752010-05-11 14:40:55 +02001761 struct mr6_table *mrt;
1762
1763 mrt = ip6mr_get_table(net, raw6_sk(sk)->ip6mr_table ? : RT6_TABLE_DFLT);
1764 if (mrt == NULL)
1765 return -ENOENT;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001766
1767 switch (cmd) {
1768 case SIOCGETMIFCNT_IN6:
1769 if (copy_from_user(&vr, arg, sizeof(vr)))
1770 return -EFAULT;
Patrick McHardy6bd52142010-05-11 14:40:53 +02001771 if (vr.mifi >= mrt->maxvif)
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001772 return -EINVAL;
1773 read_lock(&mrt_lock);
Patrick McHardy6bd52142010-05-11 14:40:53 +02001774 vif = &mrt->vif6_table[vr.mifi];
1775 if (MIF_EXISTS(mrt, vr.mifi)) {
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001776 vr.icount = vif->pkt_in;
1777 vr.ocount = vif->pkt_out;
1778 vr.ibytes = vif->bytes_in;
1779 vr.obytes = vif->bytes_out;
1780 read_unlock(&mrt_lock);
1781
1782 if (copy_to_user(arg, &vr, sizeof(vr)))
1783 return -EFAULT;
1784 return 0;
1785 }
1786 read_unlock(&mrt_lock);
1787 return -EADDRNOTAVAIL;
1788 case SIOCGETSGCNT_IN6:
1789 if (copy_from_user(&sr, arg, sizeof(sr)))
1790 return -EFAULT;
1791
1792 read_lock(&mrt_lock);
Patrick McHardy6bd52142010-05-11 14:40:53 +02001793 c = ip6mr_cache_find(mrt, &sr.src.sin6_addr, &sr.grp.sin6_addr);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001794 if (c) {
1795 sr.pktcnt = c->mfc_un.res.pkt;
1796 sr.bytecnt = c->mfc_un.res.bytes;
1797 sr.wrong_if = c->mfc_un.res.wrong_if;
1798 read_unlock(&mrt_lock);
1799
1800 if (copy_to_user(arg, &sr, sizeof(sr)))
1801 return -EFAULT;
1802 return 0;
1803 }
1804 read_unlock(&mrt_lock);
1805 return -EADDRNOTAVAIL;
1806 default:
1807 return -ENOIOCTLCMD;
1808 }
1809}
1810
David S. Millere2d57762011-02-03 17:59:32 -08001811#ifdef CONFIG_COMPAT
1812struct compat_sioc_sg_req6 {
1813 struct sockaddr_in6 src;
1814 struct sockaddr_in6 grp;
1815 compat_ulong_t pktcnt;
1816 compat_ulong_t bytecnt;
1817 compat_ulong_t wrong_if;
1818};
1819
1820struct compat_sioc_mif_req6 {
1821 mifi_t mifi;
1822 compat_ulong_t icount;
1823 compat_ulong_t ocount;
1824 compat_ulong_t ibytes;
1825 compat_ulong_t obytes;
1826};
1827
1828int ip6mr_compat_ioctl(struct sock *sk, unsigned int cmd, void __user *arg)
1829{
1830 struct compat_sioc_sg_req6 sr;
1831 struct compat_sioc_mif_req6 vr;
1832 struct mif_device *vif;
1833 struct mfc6_cache *c;
1834 struct net *net = sock_net(sk);
1835 struct mr6_table *mrt;
1836
1837 mrt = ip6mr_get_table(net, raw6_sk(sk)->ip6mr_table ? : RT6_TABLE_DFLT);
1838 if (mrt == NULL)
1839 return -ENOENT;
1840
1841 switch (cmd) {
1842 case SIOCGETMIFCNT_IN6:
1843 if (copy_from_user(&vr, arg, sizeof(vr)))
1844 return -EFAULT;
1845 if (vr.mifi >= mrt->maxvif)
1846 return -EINVAL;
1847 read_lock(&mrt_lock);
1848 vif = &mrt->vif6_table[vr.mifi];
1849 if (MIF_EXISTS(mrt, vr.mifi)) {
1850 vr.icount = vif->pkt_in;
1851 vr.ocount = vif->pkt_out;
1852 vr.ibytes = vif->bytes_in;
1853 vr.obytes = vif->bytes_out;
1854 read_unlock(&mrt_lock);
1855
1856 if (copy_to_user(arg, &vr, sizeof(vr)))
1857 return -EFAULT;
1858 return 0;
1859 }
1860 read_unlock(&mrt_lock);
1861 return -EADDRNOTAVAIL;
1862 case SIOCGETSGCNT_IN6:
1863 if (copy_from_user(&sr, arg, sizeof(sr)))
1864 return -EFAULT;
1865
1866 read_lock(&mrt_lock);
1867 c = ip6mr_cache_find(mrt, &sr.src.sin6_addr, &sr.grp.sin6_addr);
1868 if (c) {
1869 sr.pktcnt = c->mfc_un.res.pkt;
1870 sr.bytecnt = c->mfc_un.res.bytes;
1871 sr.wrong_if = c->mfc_un.res.wrong_if;
1872 read_unlock(&mrt_lock);
1873
1874 if (copy_to_user(arg, &sr, sizeof(sr)))
1875 return -EFAULT;
1876 return 0;
1877 }
1878 read_unlock(&mrt_lock);
1879 return -EADDRNOTAVAIL;
1880 default:
1881 return -ENOIOCTLCMD;
1882 }
1883}
1884#endif
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001885
1886static inline int ip6mr_forward2_finish(struct sk_buff *skb)
1887{
Eric Dumazetadf30902009-06-02 05:19:30 +00001888 IP6_INC_STATS_BH(dev_net(skb_dst(skb)->dev), ip6_dst_idev(skb_dst(skb)),
Denis V. Lunev483a47d2008-10-08 11:09:27 -07001889 IPSTATS_MIB_OUTFORWDATAGRAMS);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001890 return dst_output(skb);
1891}
1892
1893/*
1894 * Processing handlers for ip6mr_forward
1895 */
1896
Patrick McHardy6bd52142010-05-11 14:40:53 +02001897static int ip6mr_forward2(struct net *net, struct mr6_table *mrt,
1898 struct sk_buff *skb, struct mfc6_cache *c, int vifi)
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001899{
1900 struct ipv6hdr *ipv6h;
Patrick McHardy6bd52142010-05-11 14:40:53 +02001901 struct mif_device *vif = &mrt->vif6_table[vifi];
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001902 struct net_device *dev;
1903 struct dst_entry *dst;
David S. Miller4c9483b2011-03-12 16:22:43 -05001904 struct flowi6 fl6;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001905
1906 if (vif->dev == NULL)
1907 goto out_free;
1908
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +09001909#ifdef CONFIG_IPV6_PIMSM_V2
1910 if (vif->flags & MIFF_REGISTER) {
1911 vif->pkt_out++;
1912 vif->bytes_out += skb->len;
Pavel Emelyanovdc58c782008-05-21 14:17:54 -07001913 vif->dev->stats.tx_bytes += skb->len;
1914 vif->dev->stats.tx_packets++;
Patrick McHardy6bd52142010-05-11 14:40:53 +02001915 ip6mr_cache_report(mrt, skb, vifi, MRT6MSG_WHOLEPKT);
Ilpo Järvinen8da73b72008-12-14 23:15:49 -08001916 goto out_free;
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +09001917 }
1918#endif
1919
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001920 ipv6h = ipv6_hdr(skb);
1921
David S. Miller4c9483b2011-03-12 16:22:43 -05001922 fl6 = (struct flowi6) {
1923 .flowi6_oif = vif->link,
1924 .daddr = ipv6h->daddr,
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001925 };
1926
David S. Miller4c9483b2011-03-12 16:22:43 -05001927 dst = ip6_route_output(net, NULL, &fl6);
RongQing.Li5095d642012-02-21 22:10:49 +00001928 if (dst->error) {
1929 dst_release(dst);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001930 goto out_free;
RongQing.Li5095d642012-02-21 22:10:49 +00001931 }
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001932
Eric Dumazetadf30902009-06-02 05:19:30 +00001933 skb_dst_drop(skb);
1934 skb_dst_set(skb, dst);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001935
1936 /*
1937 * RFC1584 teaches, that DVMRP/PIM router must deliver packets locally
1938 * not only before forwarding, but after forwarding on all output
1939 * interfaces. It is clear, if mrouter runs a multicasting
1940 * program, it should receive packets not depending to what interface
1941 * program is joined.
1942 * If we will not make it, the program will have to join on all
1943 * interfaces. On the other hand, multihoming host (or router, but
1944 * not mrouter) cannot join to more than one interface - it will
1945 * result in receiving multiple packets.
1946 */
1947 dev = vif->dev;
1948 skb->dev = dev;
1949 vif->pkt_out++;
1950 vif->bytes_out += skb->len;
1951
1952 /* We are about to write */
1953 /* XXX: extension headers? */
1954 if (skb_cow(skb, sizeof(*ipv6h) + LL_RESERVED_SPACE(dev)))
1955 goto out_free;
1956
1957 ipv6h = ipv6_hdr(skb);
1958 ipv6h->hop_limit--;
1959
1960 IP6CB(skb)->flags |= IP6SKB_FORWARDED;
1961
Jan Engelhardtb2e0b382010-03-23 04:09:07 +01001962 return NF_HOOK(NFPROTO_IPV6, NF_INET_FORWARD, skb, skb->dev, dev,
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001963 ip6mr_forward2_finish);
1964
1965out_free:
1966 kfree_skb(skb);
1967 return 0;
1968}
1969
Patrick McHardy6bd52142010-05-11 14:40:53 +02001970static int ip6mr_find_vif(struct mr6_table *mrt, struct net_device *dev)
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001971{
1972 int ct;
Patrick McHardy6bd52142010-05-11 14:40:53 +02001973
1974 for (ct = mrt->maxvif - 1; ct >= 0; ct--) {
1975 if (mrt->vif6_table[ct].dev == dev)
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001976 break;
1977 }
1978 return ct;
1979}
1980
Patrick McHardy6bd52142010-05-11 14:40:53 +02001981static int ip6_mr_forward(struct net *net, struct mr6_table *mrt,
1982 struct sk_buff *skb, struct mfc6_cache *cache)
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001983{
1984 int psend = -1;
1985 int vif, ct;
1986
1987 vif = cache->mf6c_parent;
1988 cache->mfc_un.res.pkt++;
1989 cache->mfc_un.res.bytes += skb->len;
1990
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +09001991 /*
1992 * Wrong interface: drop packet and (maybe) send PIM assert.
1993 */
Patrick McHardy6bd52142010-05-11 14:40:53 +02001994 if (mrt->vif6_table[vif].dev != skb->dev) {
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +09001995 int true_vifi;
1996
1997 cache->mfc_un.res.wrong_if++;
Patrick McHardy6bd52142010-05-11 14:40:53 +02001998 true_vifi = ip6mr_find_vif(mrt, skb->dev);
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +09001999
Patrick McHardy6bd52142010-05-11 14:40:53 +02002000 if (true_vifi >= 0 && mrt->mroute_do_assert &&
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +09002001 /* pimsm uses asserts, when switching from RPT to SPT,
2002 so that we cannot check that packet arrived on an oif.
2003 It is bad, but otherwise we would need to move pretty
2004 large chunk of pimd to kernel. Ough... --ANK
2005 */
Patrick McHardy6bd52142010-05-11 14:40:53 +02002006 (mrt->mroute_do_pim ||
Benjamin Therya21f3f92008-12-10 16:28:44 -08002007 cache->mfc_un.res.ttls[true_vifi] < 255) &&
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +09002008 time_after(jiffies,
2009 cache->mfc_un.res.last_assert + MFC_ASSERT_THRESH)) {
2010 cache->mfc_un.res.last_assert = jiffies;
Patrick McHardy6bd52142010-05-11 14:40:53 +02002011 ip6mr_cache_report(mrt, skb, true_vifi, MRT6MSG_WRONGMIF);
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +09002012 }
2013 goto dont_forward;
2014 }
2015
Patrick McHardy6bd52142010-05-11 14:40:53 +02002016 mrt->vif6_table[vif].pkt_in++;
2017 mrt->vif6_table[vif].bytes_in += skb->len;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09002018
2019 /*
2020 * Forward the frame
2021 */
2022 for (ct = cache->mfc_un.res.maxvif - 1; ct >= cache->mfc_un.res.minvif; ct--) {
2023 if (ipv6_hdr(skb)->hop_limit > cache->mfc_un.res.ttls[ct]) {
2024 if (psend != -1) {
2025 struct sk_buff *skb2 = skb_clone(skb, GFP_ATOMIC);
2026 if (skb2)
Patrick McHardy6bd52142010-05-11 14:40:53 +02002027 ip6mr_forward2(net, mrt, skb2, cache, psend);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09002028 }
2029 psend = ct;
2030 }
2031 }
2032 if (psend != -1) {
Patrick McHardy6bd52142010-05-11 14:40:53 +02002033 ip6mr_forward2(net, mrt, skb, cache, psend);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09002034 return 0;
2035 }
2036
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +09002037dont_forward:
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09002038 kfree_skb(skb);
2039 return 0;
2040}
2041
2042
2043/*
2044 * Multicast packets for forwarding arrive here
2045 */
2046
2047int ip6_mr_input(struct sk_buff *skb)
2048{
2049 struct mfc6_cache *cache;
Benjamin Thery8229efd2008-12-10 16:30:15 -08002050 struct net *net = dev_net(skb->dev);
Patrick McHardyd1db2752010-05-11 14:40:55 +02002051 struct mr6_table *mrt;
David S. Miller4c9483b2011-03-12 16:22:43 -05002052 struct flowi6 fl6 = {
2053 .flowi6_iif = skb->dev->ifindex,
2054 .flowi6_mark = skb->mark,
Patrick McHardyd1db2752010-05-11 14:40:55 +02002055 };
2056 int err;
2057
David S. Miller4c9483b2011-03-12 16:22:43 -05002058 err = ip6mr_fib_lookup(net, &fl6, &mrt);
Ben Greear2015de52011-09-27 15:16:08 -04002059 if (err < 0) {
2060 kfree_skb(skb);
Patrick McHardyd1db2752010-05-11 14:40:55 +02002061 return err;
Ben Greear2015de52011-09-27 15:16:08 -04002062 }
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09002063
2064 read_lock(&mrt_lock);
Patrick McHardy6bd52142010-05-11 14:40:53 +02002065 cache = ip6mr_cache_find(mrt,
Benjamin Thery8229efd2008-12-10 16:30:15 -08002066 &ipv6_hdr(skb)->saddr, &ipv6_hdr(skb)->daddr);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09002067
2068 /*
2069 * No usable cache entry
2070 */
2071 if (cache == NULL) {
2072 int vif;
2073
Patrick McHardy6bd52142010-05-11 14:40:53 +02002074 vif = ip6mr_find_vif(mrt, skb->dev);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09002075 if (vif >= 0) {
Patrick McHardy6bd52142010-05-11 14:40:53 +02002076 int err = ip6mr_cache_unresolved(mrt, vif, skb);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09002077 read_unlock(&mrt_lock);
2078
2079 return err;
2080 }
2081 read_unlock(&mrt_lock);
2082 kfree_skb(skb);
2083 return -ENODEV;
2084 }
2085
Patrick McHardy6bd52142010-05-11 14:40:53 +02002086 ip6_mr_forward(net, mrt, skb, cache);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09002087
2088 read_unlock(&mrt_lock);
2089
2090 return 0;
2091}
2092
2093
Patrick McHardy5b285ca2010-05-11 14:40:56 +02002094static int __ip6mr_fill_mroute(struct mr6_table *mrt, struct sk_buff *skb,
2095 struct mfc6_cache *c, struct rtmsg *rtm)
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09002096{
2097 int ct;
2098 struct rtnexthop *nhp;
YOSHIFUJI Hideaki549e0282008-04-05 22:17:39 +09002099 u8 *b = skb_tail_pointer(skb);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09002100 struct rtattr *mp_head;
2101
Nicolas Dichtel74381892010-03-25 23:45:35 +00002102 /* If cache is unresolved, don't try to parse IIF and OIF */
Dan Carpentered0f1602010-05-26 00:38:56 -07002103 if (c->mf6c_parent >= MAXMIFS)
Nicolas Dichtel74381892010-03-25 23:45:35 +00002104 return -ENOENT;
2105
Patrick McHardy6bd52142010-05-11 14:40:53 +02002106 if (MIF_EXISTS(mrt, c->mf6c_parent))
2107 RTA_PUT(skb, RTA_IIF, 4, &mrt->vif6_table[c->mf6c_parent].dev->ifindex);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09002108
2109 mp_head = (struct rtattr *)skb_put(skb, RTA_LENGTH(0));
2110
2111 for (ct = c->mfc_un.res.minvif; ct < c->mfc_un.res.maxvif; ct++) {
Patrick McHardy6bd52142010-05-11 14:40:53 +02002112 if (MIF_EXISTS(mrt, ct) && c->mfc_un.res.ttls[ct] < 255) {
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09002113 if (skb_tailroom(skb) < RTA_ALIGN(RTA_ALIGN(sizeof(*nhp)) + 4))
2114 goto rtattr_failure;
2115 nhp = (struct rtnexthop *)skb_put(skb, RTA_ALIGN(sizeof(*nhp)));
2116 nhp->rtnh_flags = 0;
2117 nhp->rtnh_hops = c->mfc_un.res.ttls[ct];
Patrick McHardy6bd52142010-05-11 14:40:53 +02002118 nhp->rtnh_ifindex = mrt->vif6_table[ct].dev->ifindex;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09002119 nhp->rtnh_len = sizeof(*nhp);
2120 }
2121 }
2122 mp_head->rta_type = RTA_MULTIPATH;
YOSHIFUJI Hideaki549e0282008-04-05 22:17:39 +09002123 mp_head->rta_len = skb_tail_pointer(skb) - (u8 *)mp_head;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09002124 rtm->rtm_type = RTN_MULTICAST;
2125 return 1;
2126
2127rtattr_failure:
2128 nlmsg_trim(skb, b);
2129 return -EMSGSIZE;
2130}
2131
Benjamin Thery8229efd2008-12-10 16:30:15 -08002132int ip6mr_get_route(struct net *net,
2133 struct sk_buff *skb, struct rtmsg *rtm, int nowait)
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09002134{
2135 int err;
Patrick McHardyd1db2752010-05-11 14:40:55 +02002136 struct mr6_table *mrt;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09002137 struct mfc6_cache *cache;
Eric Dumazetadf30902009-06-02 05:19:30 +00002138 struct rt6_info *rt = (struct rt6_info *)skb_dst(skb);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09002139
Patrick McHardyd1db2752010-05-11 14:40:55 +02002140 mrt = ip6mr_get_table(net, RT6_TABLE_DFLT);
2141 if (mrt == NULL)
2142 return -ENOENT;
2143
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09002144 read_lock(&mrt_lock);
Patrick McHardy6bd52142010-05-11 14:40:53 +02002145 cache = ip6mr_cache_find(mrt, &rt->rt6i_src.addr, &rt->rt6i_dst.addr);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09002146
2147 if (!cache) {
2148 struct sk_buff *skb2;
2149 struct ipv6hdr *iph;
2150 struct net_device *dev;
2151 int vif;
2152
2153 if (nowait) {
2154 read_unlock(&mrt_lock);
2155 return -EAGAIN;
2156 }
2157
2158 dev = skb->dev;
Patrick McHardy6bd52142010-05-11 14:40:53 +02002159 if (dev == NULL || (vif = ip6mr_find_vif(mrt, dev)) < 0) {
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09002160 read_unlock(&mrt_lock);
2161 return -ENODEV;
2162 }
2163
2164 /* really correct? */
2165 skb2 = alloc_skb(sizeof(struct ipv6hdr), GFP_ATOMIC);
2166 if (!skb2) {
2167 read_unlock(&mrt_lock);
2168 return -ENOMEM;
2169 }
2170
2171 skb_reset_transport_header(skb2);
2172
2173 skb_put(skb2, sizeof(struct ipv6hdr));
2174 skb_reset_network_header(skb2);
2175
2176 iph = ipv6_hdr(skb2);
2177 iph->version = 0;
2178 iph->priority = 0;
2179 iph->flow_lbl[0] = 0;
2180 iph->flow_lbl[1] = 0;
2181 iph->flow_lbl[2] = 0;
2182 iph->payload_len = 0;
2183 iph->nexthdr = IPPROTO_NONE;
2184 iph->hop_limit = 0;
Alexey Dobriyan4e3fd7a2011-11-21 03:39:03 +00002185 iph->saddr = rt->rt6i_src.addr;
2186 iph->daddr = rt->rt6i_dst.addr;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09002187
Patrick McHardy6bd52142010-05-11 14:40:53 +02002188 err = ip6mr_cache_unresolved(mrt, vif, skb2);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09002189 read_unlock(&mrt_lock);
2190
2191 return err;
2192 }
2193
2194 if (!nowait && (rtm->rtm_flags&RTM_F_NOTIFY))
2195 cache->mfc_flags |= MFC_NOTIFY;
2196
Patrick McHardy5b285ca2010-05-11 14:40:56 +02002197 err = __ip6mr_fill_mroute(mrt, skb, cache, rtm);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09002198 read_unlock(&mrt_lock);
2199 return err;
2200}
2201
Patrick McHardy5b285ca2010-05-11 14:40:56 +02002202static int ip6mr_fill_mroute(struct mr6_table *mrt, struct sk_buff *skb,
2203 u32 pid, u32 seq, struct mfc6_cache *c)
2204{
2205 struct nlmsghdr *nlh;
2206 struct rtmsg *rtm;
2207
2208 nlh = nlmsg_put(skb, pid, seq, RTM_NEWROUTE, sizeof(*rtm), NLM_F_MULTI);
2209 if (nlh == NULL)
2210 return -EMSGSIZE;
2211
2212 rtm = nlmsg_data(nlh);
2213 rtm->rtm_family = RTNL_FAMILY_IPMR;
2214 rtm->rtm_dst_len = 128;
2215 rtm->rtm_src_len = 128;
2216 rtm->rtm_tos = 0;
2217 rtm->rtm_table = mrt->id;
2218 NLA_PUT_U32(skb, RTA_TABLE, mrt->id);
2219 rtm->rtm_scope = RT_SCOPE_UNIVERSE;
2220 rtm->rtm_protocol = RTPROT_UNSPEC;
2221 rtm->rtm_flags = 0;
2222
2223 NLA_PUT(skb, RTA_SRC, 16, &c->mf6c_origin);
2224 NLA_PUT(skb, RTA_DST, 16, &c->mf6c_mcastgrp);
2225
2226 if (__ip6mr_fill_mroute(mrt, skb, c, rtm) < 0)
2227 goto nla_put_failure;
2228
2229 return nlmsg_end(skb, nlh);
2230
2231nla_put_failure:
2232 nlmsg_cancel(skb, nlh);
2233 return -EMSGSIZE;
2234}
2235
2236static int ip6mr_rtm_dumproute(struct sk_buff *skb, struct netlink_callback *cb)
2237{
2238 struct net *net = sock_net(skb->sk);
2239 struct mr6_table *mrt;
2240 struct mfc6_cache *mfc;
2241 unsigned int t = 0, s_t;
2242 unsigned int h = 0, s_h;
2243 unsigned int e = 0, s_e;
2244
2245 s_t = cb->args[0];
2246 s_h = cb->args[1];
2247 s_e = cb->args[2];
2248
2249 read_lock(&mrt_lock);
2250 ip6mr_for_each_table(mrt, net) {
2251 if (t < s_t)
2252 goto next_table;
2253 if (t > s_t)
2254 s_h = 0;
2255 for (h = s_h; h < MFC6_LINES; h++) {
2256 list_for_each_entry(mfc, &mrt->mfc6_cache_array[h], list) {
2257 if (e < s_e)
2258 goto next_entry;
2259 if (ip6mr_fill_mroute(mrt, skb,
2260 NETLINK_CB(cb->skb).pid,
2261 cb->nlh->nlmsg_seq,
2262 mfc) < 0)
2263 goto done;
2264next_entry:
2265 e++;
2266 }
2267 e = s_e = 0;
2268 }
2269 s_h = 0;
2270next_table:
2271 t++;
2272 }
2273done:
2274 read_unlock(&mrt_lock);
2275
2276 cb->args[2] = e;
2277 cb->args[1] = h;
2278 cb->args[0] = t;
2279
2280 return skb->len;
2281}