blob: 461e47c8e95620456e83710eaf99643c1382c8fc [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) {
Joe Perchese87cc472012-05-13 21:56:26 +00001150 net_warn_ratelimited("mroute6: pending queue full, dropping entries\n");
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001151 kfree_skb(skb);
1152 }
1153
1154 return ret;
1155}
1156
1157/*
1158 * Queue a packet for resolution. It gets locked cache entry!
1159 */
1160
1161static int
Patrick McHardy6bd52142010-05-11 14:40:53 +02001162ip6mr_cache_unresolved(struct mr6_table *mrt, mifi_t mifi, struct sk_buff *skb)
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001163{
Patrick McHardyf30a77842010-05-11 14:40:51 +02001164 bool found = false;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001165 int err;
1166 struct mfc6_cache *c;
1167
1168 spin_lock_bh(&mfc_unres_lock);
Patrick McHardy6bd52142010-05-11 14:40:53 +02001169 list_for_each_entry(c, &mrt->mfc6_unres_queue, list) {
Patrick McHardyc476efb2010-05-11 14:40:48 +02001170 if (ipv6_addr_equal(&c->mf6c_mcastgrp, &ipv6_hdr(skb)->daddr) &&
Patrick McHardyf30a77842010-05-11 14:40:51 +02001171 ipv6_addr_equal(&c->mf6c_origin, &ipv6_hdr(skb)->saddr)) {
1172 found = true;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001173 break;
Patrick McHardyf30a77842010-05-11 14:40:51 +02001174 }
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001175 }
1176
Patrick McHardyf30a77842010-05-11 14:40:51 +02001177 if (!found) {
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001178 /*
1179 * Create a new entry if allowable
1180 */
1181
Patrick McHardy6bd52142010-05-11 14:40:53 +02001182 if (atomic_read(&mrt->cache_resolve_queue_len) >= 10 ||
Patrick McHardyb5aa30b2010-05-11 14:40:50 +02001183 (c = ip6mr_cache_alloc_unres()) == NULL) {
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001184 spin_unlock_bh(&mfc_unres_lock);
1185
1186 kfree_skb(skb);
1187 return -ENOBUFS;
1188 }
1189
1190 /*
1191 * Fill in the new cache entry
1192 */
1193 c->mf6c_parent = -1;
1194 c->mf6c_origin = ipv6_hdr(skb)->saddr;
1195 c->mf6c_mcastgrp = ipv6_hdr(skb)->daddr;
1196
1197 /*
1198 * Reflect first query at pim6sd
1199 */
Patrick McHardy6bd52142010-05-11 14:40:53 +02001200 err = ip6mr_cache_report(mrt, skb, mifi, MRT6MSG_NOCACHE);
Benjamin Thery8229efd2008-12-10 16:30:15 -08001201 if (err < 0) {
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001202 /* If the report failed throw the cache entry
1203 out - Brad Parker
1204 */
1205 spin_unlock_bh(&mfc_unres_lock);
1206
Benjamin Thery58701ad2008-12-10 16:22:34 -08001207 ip6mr_cache_free(c);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001208 kfree_skb(skb);
1209 return err;
1210 }
1211
Patrick McHardy6bd52142010-05-11 14:40:53 +02001212 atomic_inc(&mrt->cache_resolve_queue_len);
1213 list_add(&c->list, &mrt->mfc6_unres_queue);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001214
Patrick McHardy6bd52142010-05-11 14:40:53 +02001215 ipmr_do_expire_process(mrt);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001216 }
1217
1218 /*
1219 * See if we can append the packet
1220 */
1221 if (c->mfc_un.unres.unresolved.qlen > 3) {
1222 kfree_skb(skb);
1223 err = -ENOBUFS;
1224 } else {
1225 skb_queue_tail(&c->mfc_un.unres.unresolved, skb);
1226 err = 0;
1227 }
1228
1229 spin_unlock_bh(&mfc_unres_lock);
1230 return err;
1231}
1232
1233/*
1234 * MFC6 cache manipulation by user space
1235 */
1236
Patrick McHardy6bd52142010-05-11 14:40:53 +02001237static int ip6mr_mfc_delete(struct mr6_table *mrt, struct mf6cctl *mfc)
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001238{
1239 int line;
Patrick McHardyf30a77842010-05-11 14:40:51 +02001240 struct mfc6_cache *c, *next;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001241
1242 line = MFC6_HASH(&mfc->mf6cc_mcastgrp.sin6_addr, &mfc->mf6cc_origin.sin6_addr);
1243
Patrick McHardy6bd52142010-05-11 14:40:53 +02001244 list_for_each_entry_safe(c, next, &mrt->mfc6_cache_array[line], list) {
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001245 if (ipv6_addr_equal(&c->mf6c_origin, &mfc->mf6cc_origin.sin6_addr) &&
1246 ipv6_addr_equal(&c->mf6c_mcastgrp, &mfc->mf6cc_mcastgrp.sin6_addr)) {
1247 write_lock_bh(&mrt_lock);
Patrick McHardyf30a77842010-05-11 14:40:51 +02001248 list_del(&c->list);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001249 write_unlock_bh(&mrt_lock);
1250
Benjamin Thery58701ad2008-12-10 16:22:34 -08001251 ip6mr_cache_free(c);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001252 return 0;
1253 }
1254 }
1255 return -ENOENT;
1256}
1257
1258static int ip6mr_device_event(struct notifier_block *this,
1259 unsigned long event, void *ptr)
1260{
1261 struct net_device *dev = ptr;
Benjamin Thery8229efd2008-12-10 16:30:15 -08001262 struct net *net = dev_net(dev);
Patrick McHardyd1db2752010-05-11 14:40:55 +02001263 struct mr6_table *mrt;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001264 struct mif_device *v;
1265 int ct;
Eric Dumazetc871e662009-10-28 04:48:11 +00001266 LIST_HEAD(list);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001267
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001268 if (event != NETDEV_UNREGISTER)
1269 return NOTIFY_DONE;
1270
Patrick McHardyd1db2752010-05-11 14:40:55 +02001271 ip6mr_for_each_table(mrt, net) {
1272 v = &mrt->vif6_table[0];
1273 for (ct = 0; ct < mrt->maxvif; ct++, v++) {
1274 if (v->dev == dev)
1275 mif6_delete(mrt, ct, &list);
1276 }
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001277 }
Eric Dumazetc871e662009-10-28 04:48:11 +00001278 unregister_netdevice_many(&list);
1279
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001280 return NOTIFY_DONE;
1281}
1282
1283static struct notifier_block ip6_mr_notifier = {
1284 .notifier_call = ip6mr_device_event
1285};
1286
1287/*
1288 * Setup for IP multicast routing
1289 */
1290
Benjamin Thery4e168802008-12-10 16:15:08 -08001291static int __net_init ip6mr_net_init(struct net *net)
1292{
Patrick McHardyd1db2752010-05-11 14:40:55 +02001293 int err;
Patrick McHardyf30a77842010-05-11 14:40:51 +02001294
Patrick McHardyd1db2752010-05-11 14:40:55 +02001295 err = ip6mr_rules_init(net);
1296 if (err < 0)
Benjamin Thery4e168802008-12-10 16:15:08 -08001297 goto fail;
Benjamin Thery8b90fc72008-12-10 16:29:48 -08001298
1299#ifdef CONFIG_PROC_FS
1300 err = -ENOMEM;
1301 if (!proc_net_fops_create(net, "ip6_mr_vif", 0, &ip6mr_vif_fops))
1302 goto proc_vif_fail;
1303 if (!proc_net_fops_create(net, "ip6_mr_cache", 0, &ip6mr_mfc_fops))
1304 goto proc_cache_fail;
1305#endif
Patrick McHardy6bd52142010-05-11 14:40:53 +02001306
Benjamin Thery4a6258a2008-12-10 16:24:07 -08001307 return 0;
1308
Benjamin Thery8b90fc72008-12-10 16:29:48 -08001309#ifdef CONFIG_PROC_FS
1310proc_cache_fail:
1311 proc_net_remove(net, "ip6_mr_vif");
1312proc_vif_fail:
Patrick McHardyd1db2752010-05-11 14:40:55 +02001313 ip6mr_rules_exit(net);
Benjamin Thery8b90fc72008-12-10 16:29:48 -08001314#endif
Benjamin Thery4e168802008-12-10 16:15:08 -08001315fail:
1316 return err;
1317}
1318
1319static void __net_exit ip6mr_net_exit(struct net *net)
1320{
Benjamin Thery8b90fc72008-12-10 16:29:48 -08001321#ifdef CONFIG_PROC_FS
1322 proc_net_remove(net, "ip6_mr_cache");
1323 proc_net_remove(net, "ip6_mr_vif");
1324#endif
Patrick McHardyd1db2752010-05-11 14:40:55 +02001325 ip6mr_rules_exit(net);
Benjamin Thery4e168802008-12-10 16:15:08 -08001326}
1327
1328static struct pernet_operations ip6mr_net_ops = {
1329 .init = ip6mr_net_init,
1330 .exit = ip6mr_net_exit,
1331};
1332
Wang Chen623d1a12008-07-03 12:13:30 +08001333int __init ip6_mr_init(void)
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001334{
Wang Chen623d1a12008-07-03 12:13:30 +08001335 int err;
1336
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001337 mrt_cachep = kmem_cache_create("ip6_mrt_cache",
1338 sizeof(struct mfc6_cache),
1339 0, SLAB_HWCACHE_ALIGN,
1340 NULL);
1341 if (!mrt_cachep)
Wang Chen623d1a12008-07-03 12:13:30 +08001342 return -ENOMEM;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001343
Benjamin Thery4e168802008-12-10 16:15:08 -08001344 err = register_pernet_subsys(&ip6mr_net_ops);
1345 if (err)
1346 goto reg_pernet_fail;
1347
Wang Chen623d1a12008-07-03 12:13:30 +08001348 err = register_netdevice_notifier(&ip6_mr_notifier);
1349 if (err)
1350 goto reg_notif_fail;
Tom Goff403dbb92009-06-14 03:16:13 -07001351#ifdef CONFIG_IPV6_PIMSM_V2
1352 if (inet6_add_protocol(&pim6_protocol, IPPROTO_PIM) < 0) {
Joe Perchesf3213832012-05-15 14:11:53 +00001353 pr_err("%s: can't add PIM protocol\n", __func__);
Tom Goff403dbb92009-06-14 03:16:13 -07001354 err = -EAGAIN;
1355 goto add_proto_fail;
1356 }
1357#endif
Greg Rosec7ac8672011-06-10 01:27:09 +00001358 rtnl_register(RTNL_FAMILY_IP6MR, RTM_GETROUTE, NULL,
1359 ip6mr_rtm_dumproute, NULL);
Wang Chen623d1a12008-07-03 12:13:30 +08001360 return 0;
Tom Goff403dbb92009-06-14 03:16:13 -07001361#ifdef CONFIG_IPV6_PIMSM_V2
1362add_proto_fail:
1363 unregister_netdevice_notifier(&ip6_mr_notifier);
1364#endif
Benjamin Thery87b30a62008-11-10 16:34:11 -08001365reg_notif_fail:
Benjamin Thery4e168802008-12-10 16:15:08 -08001366 unregister_pernet_subsys(&ip6mr_net_ops);
1367reg_pernet_fail:
Benjamin Thery87b30a62008-11-10 16:34:11 -08001368 kmem_cache_destroy(mrt_cachep);
Wang Chen623d1a12008-07-03 12:13:30 +08001369 return err;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001370}
1371
Wang Chen623d1a12008-07-03 12:13:30 +08001372void ip6_mr_cleanup(void)
1373{
Wang Chen623d1a12008-07-03 12:13:30 +08001374 unregister_netdevice_notifier(&ip6_mr_notifier);
Benjamin Thery4e168802008-12-10 16:15:08 -08001375 unregister_pernet_subsys(&ip6mr_net_ops);
Wang Chen623d1a12008-07-03 12:13:30 +08001376 kmem_cache_destroy(mrt_cachep);
1377}
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001378
Patrick McHardy6bd52142010-05-11 14:40:53 +02001379static int ip6mr_mfc_add(struct net *net, struct mr6_table *mrt,
1380 struct mf6cctl *mfc, int mrtsock)
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001381{
Patrick McHardyf30a77842010-05-11 14:40:51 +02001382 bool found = false;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001383 int line;
Patrick McHardyf30a77842010-05-11 14:40:51 +02001384 struct mfc6_cache *uc, *c;
Rami Rosen6ac7eb02008-04-10 12:40:10 +03001385 unsigned char ttls[MAXMIFS];
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001386 int i;
1387
Patrick McHardya50436f22010-03-17 06:04:14 +00001388 if (mfc->mf6cc_parent >= MAXMIFS)
1389 return -ENFILE;
1390
Rami Rosen6ac7eb02008-04-10 12:40:10 +03001391 memset(ttls, 255, MAXMIFS);
1392 for (i = 0; i < MAXMIFS; i++) {
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001393 if (IF_ISSET(i, &mfc->mf6cc_ifset))
1394 ttls[i] = 1;
1395
1396 }
1397
1398 line = MFC6_HASH(&mfc->mf6cc_mcastgrp.sin6_addr, &mfc->mf6cc_origin.sin6_addr);
1399
Patrick McHardy6bd52142010-05-11 14:40:53 +02001400 list_for_each_entry(c, &mrt->mfc6_cache_array[line], list) {
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001401 if (ipv6_addr_equal(&c->mf6c_origin, &mfc->mf6cc_origin.sin6_addr) &&
Patrick McHardyf30a77842010-05-11 14:40:51 +02001402 ipv6_addr_equal(&c->mf6c_mcastgrp, &mfc->mf6cc_mcastgrp.sin6_addr)) {
1403 found = true;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001404 break;
Patrick McHardyf30a77842010-05-11 14:40:51 +02001405 }
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001406 }
1407
Patrick McHardyf30a77842010-05-11 14:40:51 +02001408 if (found) {
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001409 write_lock_bh(&mrt_lock);
1410 c->mf6c_parent = mfc->mf6cc_parent;
Patrick McHardy6bd52142010-05-11 14:40:53 +02001411 ip6mr_update_thresholds(mrt, c, ttls);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001412 if (!mrtsock)
1413 c->mfc_flags |= MFC_STATIC;
1414 write_unlock_bh(&mrt_lock);
1415 return 0;
1416 }
1417
1418 if (!ipv6_addr_is_multicast(&mfc->mf6cc_mcastgrp.sin6_addr))
1419 return -EINVAL;
1420
Patrick McHardyb5aa30b2010-05-11 14:40:50 +02001421 c = ip6mr_cache_alloc();
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001422 if (c == NULL)
1423 return -ENOMEM;
1424
1425 c->mf6c_origin = mfc->mf6cc_origin.sin6_addr;
1426 c->mf6c_mcastgrp = mfc->mf6cc_mcastgrp.sin6_addr;
1427 c->mf6c_parent = mfc->mf6cc_parent;
Patrick McHardy6bd52142010-05-11 14:40:53 +02001428 ip6mr_update_thresholds(mrt, c, ttls);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001429 if (!mrtsock)
1430 c->mfc_flags |= MFC_STATIC;
1431
1432 write_lock_bh(&mrt_lock);
Patrick McHardy6bd52142010-05-11 14:40:53 +02001433 list_add(&c->list, &mrt->mfc6_cache_array[line]);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001434 write_unlock_bh(&mrt_lock);
1435
1436 /*
1437 * Check to see if we resolved a queued list. If so we
1438 * need to send on the frames and tidy up.
1439 */
Patrick McHardyf30a77842010-05-11 14:40:51 +02001440 found = false;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001441 spin_lock_bh(&mfc_unres_lock);
Patrick McHardy6bd52142010-05-11 14:40:53 +02001442 list_for_each_entry(uc, &mrt->mfc6_unres_queue, list) {
Patrick McHardyc476efb2010-05-11 14:40:48 +02001443 if (ipv6_addr_equal(&uc->mf6c_origin, &c->mf6c_origin) &&
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001444 ipv6_addr_equal(&uc->mf6c_mcastgrp, &c->mf6c_mcastgrp)) {
Patrick McHardyf30a77842010-05-11 14:40:51 +02001445 list_del(&uc->list);
Patrick McHardy6bd52142010-05-11 14:40:53 +02001446 atomic_dec(&mrt->cache_resolve_queue_len);
Patrick McHardyf30a77842010-05-11 14:40:51 +02001447 found = true;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001448 break;
1449 }
1450 }
Patrick McHardy6bd52142010-05-11 14:40:53 +02001451 if (list_empty(&mrt->mfc6_unres_queue))
1452 del_timer(&mrt->ipmr_expire_timer);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001453 spin_unlock_bh(&mfc_unres_lock);
1454
Patrick McHardyf30a77842010-05-11 14:40:51 +02001455 if (found) {
Patrick McHardy6bd52142010-05-11 14:40:53 +02001456 ip6mr_cache_resolve(net, mrt, uc, c);
Benjamin Thery58701ad2008-12-10 16:22:34 -08001457 ip6mr_cache_free(uc);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001458 }
1459 return 0;
1460}
1461
1462/*
1463 * Close the multicast socket, and clear the vif tables etc
1464 */
1465
Patrick McHardy6bd52142010-05-11 14:40:53 +02001466static void mroute_clean_tables(struct mr6_table *mrt)
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001467{
1468 int i;
Eric Dumazetc871e662009-10-28 04:48:11 +00001469 LIST_HEAD(list);
Patrick McHardyf30a77842010-05-11 14:40:51 +02001470 struct mfc6_cache *c, *next;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001471
1472 /*
1473 * Shut down all active vif entries
1474 */
Patrick McHardy6bd52142010-05-11 14:40:53 +02001475 for (i = 0; i < mrt->maxvif; i++) {
1476 if (!(mrt->vif6_table[i].flags & VIFF_STATIC))
1477 mif6_delete(mrt, i, &list);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001478 }
Eric Dumazetc871e662009-10-28 04:48:11 +00001479 unregister_netdevice_many(&list);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001480
1481 /*
1482 * Wipe the cache
1483 */
Benjamin Thery4a6258a2008-12-10 16:24:07 -08001484 for (i = 0; i < MFC6_LINES; i++) {
Patrick McHardy6bd52142010-05-11 14:40:53 +02001485 list_for_each_entry_safe(c, next, &mrt->mfc6_cache_array[i], list) {
Patrick McHardyf30a77842010-05-11 14:40:51 +02001486 if (c->mfc_flags & MFC_STATIC)
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001487 continue;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001488 write_lock_bh(&mrt_lock);
Patrick McHardyf30a77842010-05-11 14:40:51 +02001489 list_del(&c->list);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001490 write_unlock_bh(&mrt_lock);
1491
Benjamin Thery58701ad2008-12-10 16:22:34 -08001492 ip6mr_cache_free(c);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001493 }
1494 }
1495
Patrick McHardy6bd52142010-05-11 14:40:53 +02001496 if (atomic_read(&mrt->cache_resolve_queue_len) != 0) {
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001497 spin_lock_bh(&mfc_unres_lock);
Patrick McHardy6bd52142010-05-11 14:40:53 +02001498 list_for_each_entry_safe(c, next, &mrt->mfc6_unres_queue, list) {
Patrick McHardyf30a77842010-05-11 14:40:51 +02001499 list_del(&c->list);
Patrick McHardy6bd52142010-05-11 14:40:53 +02001500 ip6mr_destroy_unres(mrt, c);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001501 }
1502 spin_unlock_bh(&mfc_unres_lock);
1503 }
1504}
1505
Patrick McHardy6bd52142010-05-11 14:40:53 +02001506static int ip6mr_sk_init(struct mr6_table *mrt, struct sock *sk)
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001507{
1508 int err = 0;
Benjamin Thery8229efd2008-12-10 16:30:15 -08001509 struct net *net = sock_net(sk);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001510
1511 rtnl_lock();
1512 write_lock_bh(&mrt_lock);
Patrick McHardy6bd52142010-05-11 14:40:53 +02001513 if (likely(mrt->mroute6_sk == NULL)) {
1514 mrt->mroute6_sk = sk;
Thomas Goff1d6e55f2009-01-27 22:39:59 -08001515 net->ipv6.devconf_all->mc_forwarding++;
1516 }
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001517 else
1518 err = -EADDRINUSE;
1519 write_unlock_bh(&mrt_lock);
1520
1521 rtnl_unlock();
1522
1523 return err;
1524}
1525
1526int ip6mr_sk_done(struct sock *sk)
1527{
Patrick McHardyd1db2752010-05-11 14:40:55 +02001528 int err = -EACCES;
Benjamin Thery8229efd2008-12-10 16:30:15 -08001529 struct net *net = sock_net(sk);
Patrick McHardyd1db2752010-05-11 14:40:55 +02001530 struct mr6_table *mrt;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001531
1532 rtnl_lock();
Patrick McHardyd1db2752010-05-11 14:40:55 +02001533 ip6mr_for_each_table(mrt, net) {
1534 if (sk == mrt->mroute6_sk) {
1535 write_lock_bh(&mrt_lock);
1536 mrt->mroute6_sk = NULL;
1537 net->ipv6.devconf_all->mc_forwarding--;
1538 write_unlock_bh(&mrt_lock);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001539
Patrick McHardyd1db2752010-05-11 14:40:55 +02001540 mroute_clean_tables(mrt);
1541 err = 0;
1542 break;
1543 }
1544 }
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001545 rtnl_unlock();
1546
1547 return err;
1548}
1549
Patrick McHardyd1db2752010-05-11 14:40:55 +02001550struct sock *mroute6_socket(struct net *net, struct sk_buff *skb)
Patrick McHardy6bd52142010-05-11 14:40:53 +02001551{
Patrick McHardyd1db2752010-05-11 14:40:55 +02001552 struct mr6_table *mrt;
David S. Miller4c9483b2011-03-12 16:22:43 -05001553 struct flowi6 fl6 = {
1554 .flowi6_iif = skb->skb_iif,
1555 .flowi6_oif = skb->dev->ifindex,
1556 .flowi6_mark = skb->mark,
Patrick McHardyd1db2752010-05-11 14:40:55 +02001557 };
1558
David S. Miller4c9483b2011-03-12 16:22:43 -05001559 if (ip6mr_fib_lookup(net, &fl6, &mrt) < 0)
Patrick McHardyd1db2752010-05-11 14:40:55 +02001560 return NULL;
Patrick McHardy6bd52142010-05-11 14:40:53 +02001561
1562 return mrt->mroute6_sk;
1563}
1564
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001565/*
1566 * Socket options and virtual interface manipulation. The whole
1567 * virtual interface system is a complete heap, but unfortunately
1568 * that's how BSD mrouted happens to think. Maybe one day with a proper
1569 * MOSPF/PIM router set up we can clean this up.
1570 */
1571
David S. Millerb7058842009-09-30 16:12:20 -07001572int ip6_mroute_setsockopt(struct sock *sk, int optname, char __user *optval, unsigned int optlen)
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001573{
1574 int ret;
1575 struct mif6ctl vif;
1576 struct mf6cctl mfc;
1577 mifi_t mifi;
Benjamin Thery8229efd2008-12-10 16:30:15 -08001578 struct net *net = sock_net(sk);
Patrick McHardyd1db2752010-05-11 14:40:55 +02001579 struct mr6_table *mrt;
1580
1581 mrt = ip6mr_get_table(net, raw6_sk(sk)->ip6mr_table ? : RT6_TABLE_DFLT);
1582 if (mrt == NULL)
1583 return -ENOENT;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001584
1585 if (optname != MRT6_INIT) {
Patrick McHardy6bd52142010-05-11 14:40:53 +02001586 if (sk != mrt->mroute6_sk && !capable(CAP_NET_ADMIN))
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001587 return -EACCES;
1588 }
1589
1590 switch (optname) {
1591 case MRT6_INIT:
1592 if (sk->sk_type != SOCK_RAW ||
Eric Dumazetc720c7e2009-10-15 06:30:45 +00001593 inet_sk(sk)->inet_num != IPPROTO_ICMPV6)
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001594 return -EOPNOTSUPP;
1595 if (optlen < sizeof(int))
1596 return -EINVAL;
1597
Patrick McHardy6bd52142010-05-11 14:40:53 +02001598 return ip6mr_sk_init(mrt, sk);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001599
1600 case MRT6_DONE:
1601 return ip6mr_sk_done(sk);
1602
1603 case MRT6_ADD_MIF:
1604 if (optlen < sizeof(vif))
1605 return -EINVAL;
1606 if (copy_from_user(&vif, optval, sizeof(vif)))
1607 return -EFAULT;
Rami Rosen6ac7eb02008-04-10 12:40:10 +03001608 if (vif.mif6c_mifi >= MAXMIFS)
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001609 return -ENFILE;
1610 rtnl_lock();
Patrick McHardy6bd52142010-05-11 14:40:53 +02001611 ret = mif6_add(net, mrt, &vif, sk == mrt->mroute6_sk);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001612 rtnl_unlock();
1613 return ret;
1614
1615 case MRT6_DEL_MIF:
1616 if (optlen < sizeof(mifi_t))
1617 return -EINVAL;
1618 if (copy_from_user(&mifi, optval, sizeof(mifi_t)))
1619 return -EFAULT;
1620 rtnl_lock();
Patrick McHardy6bd52142010-05-11 14:40:53 +02001621 ret = mif6_delete(mrt, mifi, NULL);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001622 rtnl_unlock();
1623 return ret;
1624
1625 /*
1626 * Manipulate the forwarding caches. These live
1627 * in a sort of kernel/user symbiosis.
1628 */
1629 case MRT6_ADD_MFC:
1630 case MRT6_DEL_MFC:
1631 if (optlen < sizeof(mfc))
1632 return -EINVAL;
1633 if (copy_from_user(&mfc, optval, sizeof(mfc)))
1634 return -EFAULT;
1635 rtnl_lock();
1636 if (optname == MRT6_DEL_MFC)
Patrick McHardy6bd52142010-05-11 14:40:53 +02001637 ret = ip6mr_mfc_delete(mrt, &mfc);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001638 else
Patrick McHardy6bd52142010-05-11 14:40:53 +02001639 ret = ip6mr_mfc_add(net, mrt, &mfc, sk == mrt->mroute6_sk);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001640 rtnl_unlock();
1641 return ret;
1642
1643 /*
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +09001644 * Control PIM assert (to activate pim will activate assert)
1645 */
1646 case MRT6_ASSERT:
1647 {
1648 int v;
1649 if (get_user(v, (int __user *)optval))
1650 return -EFAULT;
Patrick McHardy6bd52142010-05-11 14:40:53 +02001651 mrt->mroute_do_assert = !!v;
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +09001652 return 0;
1653 }
1654
1655#ifdef CONFIG_IPV6_PIMSM_V2
1656 case MRT6_PIM:
1657 {
YOSHIFUJI Hideakia9f83bf2008-04-10 15:41:28 +09001658 int v;
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +09001659 if (get_user(v, (int __user *)optval))
1660 return -EFAULT;
1661 v = !!v;
1662 rtnl_lock();
1663 ret = 0;
Patrick McHardy6bd52142010-05-11 14:40:53 +02001664 if (v != mrt->mroute_do_pim) {
1665 mrt->mroute_do_pim = v;
1666 mrt->mroute_do_assert = v;
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +09001667 }
1668 rtnl_unlock();
1669 return ret;
1670 }
1671
1672#endif
Patrick McHardyd1db2752010-05-11 14:40:55 +02001673#ifdef CONFIG_IPV6_MROUTE_MULTIPLE_TABLES
1674 case MRT6_TABLE:
1675 {
1676 u32 v;
1677
1678 if (optlen != sizeof(u32))
1679 return -EINVAL;
1680 if (get_user(v, (u32 __user *)optval))
1681 return -EFAULT;
1682 if (sk == mrt->mroute6_sk)
1683 return -EBUSY;
1684
1685 rtnl_lock();
1686 ret = 0;
1687 if (!ip6mr_new_table(net, v))
1688 ret = -ENOMEM;
1689 raw6_sk(sk)->ip6mr_table = v;
1690 rtnl_unlock();
1691 return ret;
1692 }
1693#endif
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +09001694 /*
Rami Rosen7d120c52008-04-23 14:35:13 +03001695 * Spurious command, or MRT6_VERSION which you cannot
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001696 * set.
1697 */
1698 default:
1699 return -ENOPROTOOPT;
1700 }
1701}
1702
1703/*
1704 * Getsock opt support for the multicast routing system.
1705 */
1706
1707int ip6_mroute_getsockopt(struct sock *sk, int optname, char __user *optval,
1708 int __user *optlen)
1709{
1710 int olr;
1711 int val;
Benjamin Thery8229efd2008-12-10 16:30:15 -08001712 struct net *net = sock_net(sk);
Patrick McHardyd1db2752010-05-11 14:40:55 +02001713 struct mr6_table *mrt;
1714
1715 mrt = ip6mr_get_table(net, raw6_sk(sk)->ip6mr_table ? : RT6_TABLE_DFLT);
1716 if (mrt == NULL)
1717 return -ENOENT;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001718
1719 switch (optname) {
1720 case MRT6_VERSION:
1721 val = 0x0305;
1722 break;
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +09001723#ifdef CONFIG_IPV6_PIMSM_V2
1724 case MRT6_PIM:
Patrick McHardy6bd52142010-05-11 14:40:53 +02001725 val = mrt->mroute_do_pim;
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +09001726 break;
1727#endif
1728 case MRT6_ASSERT:
Patrick McHardy6bd52142010-05-11 14:40:53 +02001729 val = mrt->mroute_do_assert;
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +09001730 break;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001731 default:
1732 return -ENOPROTOOPT;
1733 }
1734
1735 if (get_user(olr, optlen))
1736 return -EFAULT;
1737
1738 olr = min_t(int, olr, sizeof(int));
1739 if (olr < 0)
1740 return -EINVAL;
1741
1742 if (put_user(olr, optlen))
1743 return -EFAULT;
1744 if (copy_to_user(optval, &val, olr))
1745 return -EFAULT;
1746 return 0;
1747}
1748
1749/*
1750 * The IP multicast ioctl support routines.
1751 */
1752
1753int ip6mr_ioctl(struct sock *sk, int cmd, void __user *arg)
1754{
1755 struct sioc_sg_req6 sr;
1756 struct sioc_mif_req6 vr;
1757 struct mif_device *vif;
1758 struct mfc6_cache *c;
Benjamin Thery8229efd2008-12-10 16:30:15 -08001759 struct net *net = sock_net(sk);
Patrick McHardyd1db2752010-05-11 14:40:55 +02001760 struct mr6_table *mrt;
1761
1762 mrt = ip6mr_get_table(net, raw6_sk(sk)->ip6mr_table ? : RT6_TABLE_DFLT);
1763 if (mrt == NULL)
1764 return -ENOENT;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001765
1766 switch (cmd) {
1767 case SIOCGETMIFCNT_IN6:
1768 if (copy_from_user(&vr, arg, sizeof(vr)))
1769 return -EFAULT;
Patrick McHardy6bd52142010-05-11 14:40:53 +02001770 if (vr.mifi >= mrt->maxvif)
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001771 return -EINVAL;
1772 read_lock(&mrt_lock);
Patrick McHardy6bd52142010-05-11 14:40:53 +02001773 vif = &mrt->vif6_table[vr.mifi];
1774 if (MIF_EXISTS(mrt, vr.mifi)) {
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001775 vr.icount = vif->pkt_in;
1776 vr.ocount = vif->pkt_out;
1777 vr.ibytes = vif->bytes_in;
1778 vr.obytes = vif->bytes_out;
1779 read_unlock(&mrt_lock);
1780
1781 if (copy_to_user(arg, &vr, sizeof(vr)))
1782 return -EFAULT;
1783 return 0;
1784 }
1785 read_unlock(&mrt_lock);
1786 return -EADDRNOTAVAIL;
1787 case SIOCGETSGCNT_IN6:
1788 if (copy_from_user(&sr, arg, sizeof(sr)))
1789 return -EFAULT;
1790
1791 read_lock(&mrt_lock);
Patrick McHardy6bd52142010-05-11 14:40:53 +02001792 c = ip6mr_cache_find(mrt, &sr.src.sin6_addr, &sr.grp.sin6_addr);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001793 if (c) {
1794 sr.pktcnt = c->mfc_un.res.pkt;
1795 sr.bytecnt = c->mfc_un.res.bytes;
1796 sr.wrong_if = c->mfc_un.res.wrong_if;
1797 read_unlock(&mrt_lock);
1798
1799 if (copy_to_user(arg, &sr, sizeof(sr)))
1800 return -EFAULT;
1801 return 0;
1802 }
1803 read_unlock(&mrt_lock);
1804 return -EADDRNOTAVAIL;
1805 default:
1806 return -ENOIOCTLCMD;
1807 }
1808}
1809
David S. Millere2d57762011-02-03 17:59:32 -08001810#ifdef CONFIG_COMPAT
1811struct compat_sioc_sg_req6 {
1812 struct sockaddr_in6 src;
1813 struct sockaddr_in6 grp;
1814 compat_ulong_t pktcnt;
1815 compat_ulong_t bytecnt;
1816 compat_ulong_t wrong_if;
1817};
1818
1819struct compat_sioc_mif_req6 {
1820 mifi_t mifi;
1821 compat_ulong_t icount;
1822 compat_ulong_t ocount;
1823 compat_ulong_t ibytes;
1824 compat_ulong_t obytes;
1825};
1826
1827int ip6mr_compat_ioctl(struct sock *sk, unsigned int cmd, void __user *arg)
1828{
1829 struct compat_sioc_sg_req6 sr;
1830 struct compat_sioc_mif_req6 vr;
1831 struct mif_device *vif;
1832 struct mfc6_cache *c;
1833 struct net *net = sock_net(sk);
1834 struct mr6_table *mrt;
1835
1836 mrt = ip6mr_get_table(net, raw6_sk(sk)->ip6mr_table ? : RT6_TABLE_DFLT);
1837 if (mrt == NULL)
1838 return -ENOENT;
1839
1840 switch (cmd) {
1841 case SIOCGETMIFCNT_IN6:
1842 if (copy_from_user(&vr, arg, sizeof(vr)))
1843 return -EFAULT;
1844 if (vr.mifi >= mrt->maxvif)
1845 return -EINVAL;
1846 read_lock(&mrt_lock);
1847 vif = &mrt->vif6_table[vr.mifi];
1848 if (MIF_EXISTS(mrt, vr.mifi)) {
1849 vr.icount = vif->pkt_in;
1850 vr.ocount = vif->pkt_out;
1851 vr.ibytes = vif->bytes_in;
1852 vr.obytes = vif->bytes_out;
1853 read_unlock(&mrt_lock);
1854
1855 if (copy_to_user(arg, &vr, sizeof(vr)))
1856 return -EFAULT;
1857 return 0;
1858 }
1859 read_unlock(&mrt_lock);
1860 return -EADDRNOTAVAIL;
1861 case SIOCGETSGCNT_IN6:
1862 if (copy_from_user(&sr, arg, sizeof(sr)))
1863 return -EFAULT;
1864
1865 read_lock(&mrt_lock);
1866 c = ip6mr_cache_find(mrt, &sr.src.sin6_addr, &sr.grp.sin6_addr);
1867 if (c) {
1868 sr.pktcnt = c->mfc_un.res.pkt;
1869 sr.bytecnt = c->mfc_un.res.bytes;
1870 sr.wrong_if = c->mfc_un.res.wrong_if;
1871 read_unlock(&mrt_lock);
1872
1873 if (copy_to_user(arg, &sr, sizeof(sr)))
1874 return -EFAULT;
1875 return 0;
1876 }
1877 read_unlock(&mrt_lock);
1878 return -EADDRNOTAVAIL;
1879 default:
1880 return -ENOIOCTLCMD;
1881 }
1882}
1883#endif
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001884
1885static inline int ip6mr_forward2_finish(struct sk_buff *skb)
1886{
Eric Dumazetadf30902009-06-02 05:19:30 +00001887 IP6_INC_STATS_BH(dev_net(skb_dst(skb)->dev), ip6_dst_idev(skb_dst(skb)),
Denis V. Lunev483a47d2008-10-08 11:09:27 -07001888 IPSTATS_MIB_OUTFORWDATAGRAMS);
Vincent Bernat2d8dbb02012-06-05 03:41:42 +00001889 IP6_ADD_STATS_BH(dev_net(skb_dst(skb)->dev), ip6_dst_idev(skb_dst(skb)),
1890 IPSTATS_MIB_OUTOCTETS, skb->len);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001891 return dst_output(skb);
1892}
1893
1894/*
1895 * Processing handlers for ip6mr_forward
1896 */
1897
Patrick McHardy6bd52142010-05-11 14:40:53 +02001898static int ip6mr_forward2(struct net *net, struct mr6_table *mrt,
1899 struct sk_buff *skb, struct mfc6_cache *c, int vifi)
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001900{
1901 struct ipv6hdr *ipv6h;
Patrick McHardy6bd52142010-05-11 14:40:53 +02001902 struct mif_device *vif = &mrt->vif6_table[vifi];
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001903 struct net_device *dev;
1904 struct dst_entry *dst;
David S. Miller4c9483b2011-03-12 16:22:43 -05001905 struct flowi6 fl6;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001906
1907 if (vif->dev == NULL)
1908 goto out_free;
1909
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +09001910#ifdef CONFIG_IPV6_PIMSM_V2
1911 if (vif->flags & MIFF_REGISTER) {
1912 vif->pkt_out++;
1913 vif->bytes_out += skb->len;
Pavel Emelyanovdc58c782008-05-21 14:17:54 -07001914 vif->dev->stats.tx_bytes += skb->len;
1915 vif->dev->stats.tx_packets++;
Patrick McHardy6bd52142010-05-11 14:40:53 +02001916 ip6mr_cache_report(mrt, skb, vifi, MRT6MSG_WHOLEPKT);
Ilpo Järvinen8da73b72008-12-14 23:15:49 -08001917 goto out_free;
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +09001918 }
1919#endif
1920
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001921 ipv6h = ipv6_hdr(skb);
1922
David S. Miller4c9483b2011-03-12 16:22:43 -05001923 fl6 = (struct flowi6) {
1924 .flowi6_oif = vif->link,
1925 .daddr = ipv6h->daddr,
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001926 };
1927
David S. Miller4c9483b2011-03-12 16:22:43 -05001928 dst = ip6_route_output(net, NULL, &fl6);
RongQing.Li5095d642012-02-21 22:10:49 +00001929 if (dst->error) {
1930 dst_release(dst);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001931 goto out_free;
RongQing.Li5095d642012-02-21 22:10:49 +00001932 }
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001933
Eric Dumazetadf30902009-06-02 05:19:30 +00001934 skb_dst_drop(skb);
1935 skb_dst_set(skb, dst);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001936
1937 /*
1938 * RFC1584 teaches, that DVMRP/PIM router must deliver packets locally
1939 * not only before forwarding, but after forwarding on all output
1940 * interfaces. It is clear, if mrouter runs a multicasting
1941 * program, it should receive packets not depending to what interface
1942 * program is joined.
1943 * If we will not make it, the program will have to join on all
1944 * interfaces. On the other hand, multihoming host (or router, but
1945 * not mrouter) cannot join to more than one interface - it will
1946 * result in receiving multiple packets.
1947 */
1948 dev = vif->dev;
1949 skb->dev = dev;
1950 vif->pkt_out++;
1951 vif->bytes_out += skb->len;
1952
1953 /* We are about to write */
1954 /* XXX: extension headers? */
1955 if (skb_cow(skb, sizeof(*ipv6h) + LL_RESERVED_SPACE(dev)))
1956 goto out_free;
1957
1958 ipv6h = ipv6_hdr(skb);
1959 ipv6h->hop_limit--;
1960
1961 IP6CB(skb)->flags |= IP6SKB_FORWARDED;
1962
Jan Engelhardtb2e0b382010-03-23 04:09:07 +01001963 return NF_HOOK(NFPROTO_IPV6, NF_INET_FORWARD, skb, skb->dev, dev,
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001964 ip6mr_forward2_finish);
1965
1966out_free:
1967 kfree_skb(skb);
1968 return 0;
1969}
1970
Patrick McHardy6bd52142010-05-11 14:40:53 +02001971static int ip6mr_find_vif(struct mr6_table *mrt, struct net_device *dev)
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001972{
1973 int ct;
Patrick McHardy6bd52142010-05-11 14:40:53 +02001974
1975 for (ct = mrt->maxvif - 1; ct >= 0; ct--) {
1976 if (mrt->vif6_table[ct].dev == dev)
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001977 break;
1978 }
1979 return ct;
1980}
1981
Patrick McHardy6bd52142010-05-11 14:40:53 +02001982static int ip6_mr_forward(struct net *net, struct mr6_table *mrt,
1983 struct sk_buff *skb, struct mfc6_cache *cache)
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09001984{
1985 int psend = -1;
1986 int vif, ct;
1987
1988 vif = cache->mf6c_parent;
1989 cache->mfc_un.res.pkt++;
1990 cache->mfc_un.res.bytes += skb->len;
1991
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +09001992 /*
1993 * Wrong interface: drop packet and (maybe) send PIM assert.
1994 */
Patrick McHardy6bd52142010-05-11 14:40:53 +02001995 if (mrt->vif6_table[vif].dev != skb->dev) {
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +09001996 int true_vifi;
1997
1998 cache->mfc_un.res.wrong_if++;
Patrick McHardy6bd52142010-05-11 14:40:53 +02001999 true_vifi = ip6mr_find_vif(mrt, skb->dev);
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +09002000
Patrick McHardy6bd52142010-05-11 14:40:53 +02002001 if (true_vifi >= 0 && mrt->mroute_do_assert &&
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +09002002 /* pimsm uses asserts, when switching from RPT to SPT,
2003 so that we cannot check that packet arrived on an oif.
2004 It is bad, but otherwise we would need to move pretty
2005 large chunk of pimd to kernel. Ough... --ANK
2006 */
Patrick McHardy6bd52142010-05-11 14:40:53 +02002007 (mrt->mroute_do_pim ||
Benjamin Therya21f3f92008-12-10 16:28:44 -08002008 cache->mfc_un.res.ttls[true_vifi] < 255) &&
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +09002009 time_after(jiffies,
2010 cache->mfc_un.res.last_assert + MFC_ASSERT_THRESH)) {
2011 cache->mfc_un.res.last_assert = jiffies;
Patrick McHardy6bd52142010-05-11 14:40:53 +02002012 ip6mr_cache_report(mrt, skb, true_vifi, MRT6MSG_WRONGMIF);
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +09002013 }
2014 goto dont_forward;
2015 }
2016
Patrick McHardy6bd52142010-05-11 14:40:53 +02002017 mrt->vif6_table[vif].pkt_in++;
2018 mrt->vif6_table[vif].bytes_in += skb->len;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09002019
2020 /*
2021 * Forward the frame
2022 */
2023 for (ct = cache->mfc_un.res.maxvif - 1; ct >= cache->mfc_un.res.minvif; ct--) {
2024 if (ipv6_hdr(skb)->hop_limit > cache->mfc_un.res.ttls[ct]) {
2025 if (psend != -1) {
2026 struct sk_buff *skb2 = skb_clone(skb, GFP_ATOMIC);
2027 if (skb2)
Patrick McHardy6bd52142010-05-11 14:40:53 +02002028 ip6mr_forward2(net, mrt, skb2, cache, psend);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09002029 }
2030 psend = ct;
2031 }
2032 }
2033 if (psend != -1) {
Patrick McHardy6bd52142010-05-11 14:40:53 +02002034 ip6mr_forward2(net, mrt, skb, cache, psend);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09002035 return 0;
2036 }
2037
YOSHIFUJI Hideaki14fb64e2008-04-03 09:22:54 +09002038dont_forward:
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09002039 kfree_skb(skb);
2040 return 0;
2041}
2042
2043
2044/*
2045 * Multicast packets for forwarding arrive here
2046 */
2047
2048int ip6_mr_input(struct sk_buff *skb)
2049{
2050 struct mfc6_cache *cache;
Benjamin Thery8229efd2008-12-10 16:30:15 -08002051 struct net *net = dev_net(skb->dev);
Patrick McHardyd1db2752010-05-11 14:40:55 +02002052 struct mr6_table *mrt;
David S. Miller4c9483b2011-03-12 16:22:43 -05002053 struct flowi6 fl6 = {
2054 .flowi6_iif = skb->dev->ifindex,
2055 .flowi6_mark = skb->mark,
Patrick McHardyd1db2752010-05-11 14:40:55 +02002056 };
2057 int err;
2058
David S. Miller4c9483b2011-03-12 16:22:43 -05002059 err = ip6mr_fib_lookup(net, &fl6, &mrt);
Ben Greear2015de52011-09-27 15:16:08 -04002060 if (err < 0) {
2061 kfree_skb(skb);
Patrick McHardyd1db2752010-05-11 14:40:55 +02002062 return err;
Ben Greear2015de52011-09-27 15:16:08 -04002063 }
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09002064
2065 read_lock(&mrt_lock);
Patrick McHardy6bd52142010-05-11 14:40:53 +02002066 cache = ip6mr_cache_find(mrt,
Benjamin Thery8229efd2008-12-10 16:30:15 -08002067 &ipv6_hdr(skb)->saddr, &ipv6_hdr(skb)->daddr);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09002068
2069 /*
2070 * No usable cache entry
2071 */
2072 if (cache == NULL) {
2073 int vif;
2074
Patrick McHardy6bd52142010-05-11 14:40:53 +02002075 vif = ip6mr_find_vif(mrt, skb->dev);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09002076 if (vif >= 0) {
Patrick McHardy6bd52142010-05-11 14:40:53 +02002077 int err = ip6mr_cache_unresolved(mrt, vif, skb);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09002078 read_unlock(&mrt_lock);
2079
2080 return err;
2081 }
2082 read_unlock(&mrt_lock);
2083 kfree_skb(skb);
2084 return -ENODEV;
2085 }
2086
Patrick McHardy6bd52142010-05-11 14:40:53 +02002087 ip6_mr_forward(net, mrt, skb, cache);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09002088
2089 read_unlock(&mrt_lock);
2090
2091 return 0;
2092}
2093
2094
Patrick McHardy5b285ca2010-05-11 14:40:56 +02002095static int __ip6mr_fill_mroute(struct mr6_table *mrt, struct sk_buff *skb,
2096 struct mfc6_cache *c, struct rtmsg *rtm)
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09002097{
2098 int ct;
2099 struct rtnexthop *nhp;
YOSHIFUJI Hideaki549e0282008-04-05 22:17:39 +09002100 u8 *b = skb_tail_pointer(skb);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09002101 struct rtattr *mp_head;
2102
Nicolas Dichtel74381892010-03-25 23:45:35 +00002103 /* If cache is unresolved, don't try to parse IIF and OIF */
Dan Carpentered0f160a2010-05-26 00:38:56 -07002104 if (c->mf6c_parent >= MAXMIFS)
Nicolas Dichtel74381892010-03-25 23:45:35 +00002105 return -ENOENT;
2106
Patrick McHardy6bd52142010-05-11 14:40:53 +02002107 if (MIF_EXISTS(mrt, c->mf6c_parent))
2108 RTA_PUT(skb, RTA_IIF, 4, &mrt->vif6_table[c->mf6c_parent].dev->ifindex);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09002109
2110 mp_head = (struct rtattr *)skb_put(skb, RTA_LENGTH(0));
2111
2112 for (ct = c->mfc_un.res.minvif; ct < c->mfc_un.res.maxvif; ct++) {
Patrick McHardy6bd52142010-05-11 14:40:53 +02002113 if (MIF_EXISTS(mrt, ct) && c->mfc_un.res.ttls[ct] < 255) {
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09002114 if (skb_tailroom(skb) < RTA_ALIGN(RTA_ALIGN(sizeof(*nhp)) + 4))
2115 goto rtattr_failure;
2116 nhp = (struct rtnexthop *)skb_put(skb, RTA_ALIGN(sizeof(*nhp)));
2117 nhp->rtnh_flags = 0;
2118 nhp->rtnh_hops = c->mfc_un.res.ttls[ct];
Patrick McHardy6bd52142010-05-11 14:40:53 +02002119 nhp->rtnh_ifindex = mrt->vif6_table[ct].dev->ifindex;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09002120 nhp->rtnh_len = sizeof(*nhp);
2121 }
2122 }
2123 mp_head->rta_type = RTA_MULTIPATH;
YOSHIFUJI Hideaki549e0282008-04-05 22:17:39 +09002124 mp_head->rta_len = skb_tail_pointer(skb) - (u8 *)mp_head;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09002125 rtm->rtm_type = RTN_MULTICAST;
2126 return 1;
2127
2128rtattr_failure:
2129 nlmsg_trim(skb, b);
2130 return -EMSGSIZE;
2131}
2132
Benjamin Thery8229efd2008-12-10 16:30:15 -08002133int ip6mr_get_route(struct net *net,
2134 struct sk_buff *skb, struct rtmsg *rtm, int nowait)
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09002135{
2136 int err;
Patrick McHardyd1db2752010-05-11 14:40:55 +02002137 struct mr6_table *mrt;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09002138 struct mfc6_cache *cache;
Eric Dumazetadf30902009-06-02 05:19:30 +00002139 struct rt6_info *rt = (struct rt6_info *)skb_dst(skb);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09002140
Patrick McHardyd1db2752010-05-11 14:40:55 +02002141 mrt = ip6mr_get_table(net, RT6_TABLE_DFLT);
2142 if (mrt == NULL)
2143 return -ENOENT;
2144
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09002145 read_lock(&mrt_lock);
Patrick McHardy6bd52142010-05-11 14:40:53 +02002146 cache = ip6mr_cache_find(mrt, &rt->rt6i_src.addr, &rt->rt6i_dst.addr);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09002147
2148 if (!cache) {
2149 struct sk_buff *skb2;
2150 struct ipv6hdr *iph;
2151 struct net_device *dev;
2152 int vif;
2153
2154 if (nowait) {
2155 read_unlock(&mrt_lock);
2156 return -EAGAIN;
2157 }
2158
2159 dev = skb->dev;
Patrick McHardy6bd52142010-05-11 14:40:53 +02002160 if (dev == NULL || (vif = ip6mr_find_vif(mrt, dev)) < 0) {
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09002161 read_unlock(&mrt_lock);
2162 return -ENODEV;
2163 }
2164
2165 /* really correct? */
2166 skb2 = alloc_skb(sizeof(struct ipv6hdr), GFP_ATOMIC);
2167 if (!skb2) {
2168 read_unlock(&mrt_lock);
2169 return -ENOMEM;
2170 }
2171
2172 skb_reset_transport_header(skb2);
2173
2174 skb_put(skb2, sizeof(struct ipv6hdr));
2175 skb_reset_network_header(skb2);
2176
2177 iph = ipv6_hdr(skb2);
2178 iph->version = 0;
2179 iph->priority = 0;
2180 iph->flow_lbl[0] = 0;
2181 iph->flow_lbl[1] = 0;
2182 iph->flow_lbl[2] = 0;
2183 iph->payload_len = 0;
2184 iph->nexthdr = IPPROTO_NONE;
2185 iph->hop_limit = 0;
Alexey Dobriyan4e3fd7a2011-11-21 03:39:03 +00002186 iph->saddr = rt->rt6i_src.addr;
2187 iph->daddr = rt->rt6i_dst.addr;
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09002188
Patrick McHardy6bd52142010-05-11 14:40:53 +02002189 err = ip6mr_cache_unresolved(mrt, vif, skb2);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09002190 read_unlock(&mrt_lock);
2191
2192 return err;
2193 }
2194
2195 if (!nowait && (rtm->rtm_flags&RTM_F_NOTIFY))
2196 cache->mfc_flags |= MFC_NOTIFY;
2197
Patrick McHardy5b285ca2010-05-11 14:40:56 +02002198 err = __ip6mr_fill_mroute(mrt, skb, cache, rtm);
YOSHIFUJI Hideaki7bc570c2008-04-03 09:22:53 +09002199 read_unlock(&mrt_lock);
2200 return err;
2201}
2202
Patrick McHardy5b285ca2010-05-11 14:40:56 +02002203static int ip6mr_fill_mroute(struct mr6_table *mrt, struct sk_buff *skb,
2204 u32 pid, u32 seq, struct mfc6_cache *c)
2205{
2206 struct nlmsghdr *nlh;
2207 struct rtmsg *rtm;
2208
2209 nlh = nlmsg_put(skb, pid, seq, RTM_NEWROUTE, sizeof(*rtm), NLM_F_MULTI);
2210 if (nlh == NULL)
2211 return -EMSGSIZE;
2212
2213 rtm = nlmsg_data(nlh);
2214 rtm->rtm_family = RTNL_FAMILY_IPMR;
2215 rtm->rtm_dst_len = 128;
2216 rtm->rtm_src_len = 128;
2217 rtm->rtm_tos = 0;
2218 rtm->rtm_table = mrt->id;
David S. Millerc78679e2012-04-01 20:27:33 -04002219 if (nla_put_u32(skb, RTA_TABLE, mrt->id))
2220 goto nla_put_failure;
Patrick McHardy5b285ca2010-05-11 14:40:56 +02002221 rtm->rtm_scope = RT_SCOPE_UNIVERSE;
2222 rtm->rtm_protocol = RTPROT_UNSPEC;
2223 rtm->rtm_flags = 0;
2224
David S. Millerc78679e2012-04-01 20:27:33 -04002225 if (nla_put(skb, RTA_SRC, 16, &c->mf6c_origin) ||
2226 nla_put(skb, RTA_DST, 16, &c->mf6c_mcastgrp))
2227 goto nla_put_failure;
Patrick McHardy5b285ca2010-05-11 14:40:56 +02002228 if (__ip6mr_fill_mroute(mrt, skb, c, rtm) < 0)
2229 goto nla_put_failure;
2230
2231 return nlmsg_end(skb, nlh);
2232
2233nla_put_failure:
2234 nlmsg_cancel(skb, nlh);
2235 return -EMSGSIZE;
2236}
2237
2238static int ip6mr_rtm_dumproute(struct sk_buff *skb, struct netlink_callback *cb)
2239{
2240 struct net *net = sock_net(skb->sk);
2241 struct mr6_table *mrt;
2242 struct mfc6_cache *mfc;
2243 unsigned int t = 0, s_t;
2244 unsigned int h = 0, s_h;
2245 unsigned int e = 0, s_e;
2246
2247 s_t = cb->args[0];
2248 s_h = cb->args[1];
2249 s_e = cb->args[2];
2250
2251 read_lock(&mrt_lock);
2252 ip6mr_for_each_table(mrt, net) {
2253 if (t < s_t)
2254 goto next_table;
2255 if (t > s_t)
2256 s_h = 0;
2257 for (h = s_h; h < MFC6_LINES; h++) {
2258 list_for_each_entry(mfc, &mrt->mfc6_cache_array[h], list) {
2259 if (e < s_e)
2260 goto next_entry;
2261 if (ip6mr_fill_mroute(mrt, skb,
2262 NETLINK_CB(cb->skb).pid,
2263 cb->nlh->nlmsg_seq,
2264 mfc) < 0)
2265 goto done;
2266next_entry:
2267 e++;
2268 }
2269 e = s_e = 0;
2270 }
2271 s_h = 0;
2272next_table:
2273 t++;
2274 }
2275done:
2276 read_unlock(&mrt_lock);
2277
2278 cb->args[2] = e;
2279 cb->args[1] = h;
2280 cb->args[0] = t;
2281
2282 return skb->len;
2283}