11da177e4SLinus Torvalds /* 21da177e4SLinus Torvalds * IP multicast routing support for mrouted 3.6/3.8 31da177e4SLinus Torvalds * 4113aa838SAlan Cox * (c) 1995 Alan Cox, <alan@lxorguk.ukuu.org.uk> 51da177e4SLinus Torvalds * Linux Consultancy and Custom Driver Development 61da177e4SLinus Torvalds * 71da177e4SLinus Torvalds * This program is free software; you can redistribute it and/or 81da177e4SLinus Torvalds * modify it under the terms of the GNU General Public License 91da177e4SLinus Torvalds * as published by the Free Software Foundation; either version 101da177e4SLinus Torvalds * 2 of the License, or (at your option) any later version. 111da177e4SLinus Torvalds * 121da177e4SLinus Torvalds * Fixes: 131da177e4SLinus Torvalds * Michael Chastain : Incorrect size of copying. 141da177e4SLinus Torvalds * Alan Cox : Added the cache manager code 151da177e4SLinus Torvalds * Alan Cox : Fixed the clone/copy bug and device race. 161da177e4SLinus Torvalds * Mike McLagan : Routing by source 171da177e4SLinus Torvalds * Malcolm Beattie : Buffer handling fixes. 181da177e4SLinus Torvalds * Alexey Kuznetsov : Double buffer free and other fixes. 191da177e4SLinus Torvalds * SVR Anand : Fixed several multicast bugs and problems. 201da177e4SLinus Torvalds * Alexey Kuznetsov : Status, optimisations and more. 211da177e4SLinus Torvalds * Brad Parker : Better behaviour on mrouted upcall 221da177e4SLinus Torvalds * overflow. 231da177e4SLinus Torvalds * Carlos Picoto : PIMv1 Support 241da177e4SLinus Torvalds * Pavlin Ivanov Radoslavov: PIMv2 Registers must checksum only PIM header 25f77f13e2SGilles Espinasse * Relax this requirement to work with older peers. 261da177e4SLinus Torvalds * 271da177e4SLinus Torvalds */ 281da177e4SLinus Torvalds 291da177e4SLinus Torvalds #include <asm/system.h> 301da177e4SLinus Torvalds #include <asm/uaccess.h> 311da177e4SLinus Torvalds #include <linux/types.h> 324fc268d2SRandy Dunlap #include <linux/capability.h> 331da177e4SLinus Torvalds #include <linux/errno.h> 341da177e4SLinus Torvalds #include <linux/timer.h> 351da177e4SLinus Torvalds #include <linux/mm.h> 361da177e4SLinus Torvalds #include <linux/kernel.h> 371da177e4SLinus Torvalds #include <linux/fcntl.h> 381da177e4SLinus Torvalds #include <linux/stat.h> 391da177e4SLinus Torvalds #include <linux/socket.h> 401da177e4SLinus Torvalds #include <linux/in.h> 411da177e4SLinus Torvalds #include <linux/inet.h> 421da177e4SLinus Torvalds #include <linux/netdevice.h> 431da177e4SLinus Torvalds #include <linux/inetdevice.h> 441da177e4SLinus Torvalds #include <linux/igmp.h> 451da177e4SLinus Torvalds #include <linux/proc_fs.h> 461da177e4SLinus Torvalds #include <linux/seq_file.h> 471da177e4SLinus Torvalds #include <linux/mroute.h> 481da177e4SLinus Torvalds #include <linux/init.h> 4946f25dffSKris Katterjohn #include <linux/if_ether.h> 505a0e3ad6STejun Heo #include <linux/slab.h> 51457c4cbcSEric W. Biederman #include <net/net_namespace.h> 521da177e4SLinus Torvalds #include <net/ip.h> 531da177e4SLinus Torvalds #include <net/protocol.h> 541da177e4SLinus Torvalds #include <linux/skbuff.h> 5514c85021SArnaldo Carvalho de Melo #include <net/route.h> 561da177e4SLinus Torvalds #include <net/sock.h> 571da177e4SLinus Torvalds #include <net/icmp.h> 581da177e4SLinus Torvalds #include <net/udp.h> 591da177e4SLinus Torvalds #include <net/raw.h> 601da177e4SLinus Torvalds #include <linux/notifier.h> 611da177e4SLinus Torvalds #include <linux/if_arp.h> 621da177e4SLinus Torvalds #include <linux/netfilter_ipv4.h> 631da177e4SLinus Torvalds #include <net/ipip.h> 641da177e4SLinus Torvalds #include <net/checksum.h> 65dc5fc579SArnaldo Carvalho de Melo #include <net/netlink.h> 66f0ad0860SPatrick McHardy #include <net/fib_rules.h> 671da177e4SLinus Torvalds 681da177e4SLinus Torvalds #if defined(CONFIG_IP_PIMSM_V1) || defined(CONFIG_IP_PIMSM_V2) 691da177e4SLinus Torvalds #define CONFIG_IP_PIMSM 1 701da177e4SLinus Torvalds #endif 711da177e4SLinus Torvalds 720c12295aSPatrick McHardy struct mr_table { 73f0ad0860SPatrick McHardy struct list_head list; 748de53dfbSPatrick McHardy #ifdef CONFIG_NET_NS 758de53dfbSPatrick McHardy struct net *net; 768de53dfbSPatrick McHardy #endif 77f0ad0860SPatrick McHardy u32 id; 780c12295aSPatrick McHardy struct sock *mroute_sk; 790c12295aSPatrick McHardy struct timer_list ipmr_expire_timer; 800c12295aSPatrick McHardy struct list_head mfc_unres_queue; 810c12295aSPatrick McHardy struct list_head mfc_cache_array[MFC_LINES]; 820c12295aSPatrick McHardy struct vif_device vif_table[MAXVIFS]; 830c12295aSPatrick McHardy int maxvif; 840c12295aSPatrick McHardy atomic_t cache_resolve_queue_len; 850c12295aSPatrick McHardy int mroute_do_assert; 860c12295aSPatrick McHardy int mroute_do_pim; 870c12295aSPatrick McHardy #if defined(CONFIG_IP_PIMSM_V1) || defined(CONFIG_IP_PIMSM_V2) 880c12295aSPatrick McHardy int mroute_reg_vif_num; 890c12295aSPatrick McHardy #endif 900c12295aSPatrick McHardy }; 910c12295aSPatrick McHardy 92f0ad0860SPatrick McHardy struct ipmr_rule { 93f0ad0860SPatrick McHardy struct fib_rule common; 94f0ad0860SPatrick McHardy }; 95f0ad0860SPatrick McHardy 96f0ad0860SPatrick McHardy struct ipmr_result { 97f0ad0860SPatrick McHardy struct mr_table *mrt; 98f0ad0860SPatrick McHardy }; 99f0ad0860SPatrick McHardy 1001da177e4SLinus Torvalds /* Big lock, protecting vif table, mrt cache and mroute socket state. 1011da177e4SLinus Torvalds Note that the changes are semaphored via rtnl_lock. 1021da177e4SLinus Torvalds */ 1031da177e4SLinus Torvalds 1041da177e4SLinus Torvalds static DEFINE_RWLOCK(mrt_lock); 1051da177e4SLinus Torvalds 1061da177e4SLinus Torvalds /* 1071da177e4SLinus Torvalds * Multicast router control variables 1081da177e4SLinus Torvalds */ 1091da177e4SLinus Torvalds 1100c12295aSPatrick McHardy #define VIF_EXISTS(_mrt, _idx) ((_mrt)->vif_table[_idx].dev != NULL) 1111da177e4SLinus Torvalds 1121da177e4SLinus Torvalds /* Special spinlock for queue of unresolved entries */ 1131da177e4SLinus Torvalds static DEFINE_SPINLOCK(mfc_unres_lock); 1141da177e4SLinus Torvalds 1151da177e4SLinus Torvalds /* We return to original Alan's scheme. Hash table of resolved 1161da177e4SLinus Torvalds entries is changed only in process context and protected 1171da177e4SLinus Torvalds with weak lock mrt_lock. Queue of unresolved entries is protected 1181da177e4SLinus Torvalds with strong spinlock mfc_unres_lock. 1191da177e4SLinus Torvalds 1201da177e4SLinus Torvalds In this case data path is free of exclusive locks at all. 1211da177e4SLinus Torvalds */ 1221da177e4SLinus Torvalds 123e18b890bSChristoph Lameter static struct kmem_cache *mrt_cachep __read_mostly; 1241da177e4SLinus Torvalds 125f0ad0860SPatrick McHardy static struct mr_table *ipmr_new_table(struct net *net, u32 id); 1260c12295aSPatrick McHardy static int ip_mr_forward(struct net *net, struct mr_table *mrt, 1270c12295aSPatrick McHardy struct sk_buff *skb, struct mfc_cache *cache, 1280c12295aSPatrick McHardy int local); 1290c12295aSPatrick McHardy static int ipmr_cache_report(struct mr_table *mrt, 1304feb88e5SBenjamin Thery struct sk_buff *pkt, vifi_t vifi, int assert); 131cb6a4e46SPatrick McHardy static int __ipmr_fill_mroute(struct mr_table *mrt, struct sk_buff *skb, 132d658f8a0SPatrick McHardy struct mfc_cache *c, struct rtmsg *rtm); 133f0ad0860SPatrick McHardy static void ipmr_expire_process(unsigned long arg); 1341da177e4SLinus Torvalds 135f0ad0860SPatrick McHardy #ifdef CONFIG_IP_MROUTE_MULTIPLE_TABLES 136f0ad0860SPatrick McHardy #define ipmr_for_each_table(mrt, net) \ 137f0ad0860SPatrick McHardy list_for_each_entry_rcu(mrt, &net->ipv4.mr_tables, list) 138f0ad0860SPatrick McHardy 139f0ad0860SPatrick McHardy static struct mr_table *ipmr_get_table(struct net *net, u32 id) 140f0ad0860SPatrick McHardy { 141f0ad0860SPatrick McHardy struct mr_table *mrt; 142f0ad0860SPatrick McHardy 143f0ad0860SPatrick McHardy ipmr_for_each_table(mrt, net) { 144f0ad0860SPatrick McHardy if (mrt->id == id) 145f0ad0860SPatrick McHardy return mrt; 146f0ad0860SPatrick McHardy } 147f0ad0860SPatrick McHardy return NULL; 148f0ad0860SPatrick McHardy } 149f0ad0860SPatrick McHardy 150f0ad0860SPatrick McHardy static int ipmr_fib_lookup(struct net *net, struct flowi *flp, 151f0ad0860SPatrick McHardy struct mr_table **mrt) 152f0ad0860SPatrick McHardy { 153f0ad0860SPatrick McHardy struct ipmr_result res; 154f0ad0860SPatrick McHardy struct fib_lookup_arg arg = { .result = &res, }; 155f0ad0860SPatrick McHardy int err; 156f0ad0860SPatrick McHardy 157f0ad0860SPatrick McHardy err = fib_rules_lookup(net->ipv4.mr_rules_ops, flp, 0, &arg); 158f0ad0860SPatrick McHardy if (err < 0) 159f0ad0860SPatrick McHardy return err; 160f0ad0860SPatrick McHardy *mrt = res.mrt; 161f0ad0860SPatrick McHardy return 0; 162f0ad0860SPatrick McHardy } 163f0ad0860SPatrick McHardy 164f0ad0860SPatrick McHardy static int ipmr_rule_action(struct fib_rule *rule, struct flowi *flp, 165f0ad0860SPatrick McHardy int flags, struct fib_lookup_arg *arg) 166f0ad0860SPatrick McHardy { 167f0ad0860SPatrick McHardy struct ipmr_result *res = arg->result; 168f0ad0860SPatrick McHardy struct mr_table *mrt; 169f0ad0860SPatrick McHardy 170f0ad0860SPatrick McHardy switch (rule->action) { 171f0ad0860SPatrick McHardy case FR_ACT_TO_TBL: 172f0ad0860SPatrick McHardy break; 173f0ad0860SPatrick McHardy case FR_ACT_UNREACHABLE: 174f0ad0860SPatrick McHardy return -ENETUNREACH; 175f0ad0860SPatrick McHardy case FR_ACT_PROHIBIT: 176f0ad0860SPatrick McHardy return -EACCES; 177f0ad0860SPatrick McHardy case FR_ACT_BLACKHOLE: 178f0ad0860SPatrick McHardy default: 179f0ad0860SPatrick McHardy return -EINVAL; 180f0ad0860SPatrick McHardy } 181f0ad0860SPatrick McHardy 182f0ad0860SPatrick McHardy mrt = ipmr_get_table(rule->fr_net, rule->table); 183f0ad0860SPatrick McHardy if (mrt == NULL) 184f0ad0860SPatrick McHardy return -EAGAIN; 185f0ad0860SPatrick McHardy res->mrt = mrt; 186f0ad0860SPatrick McHardy return 0; 187f0ad0860SPatrick McHardy } 188f0ad0860SPatrick McHardy 189f0ad0860SPatrick McHardy static int ipmr_rule_match(struct fib_rule *rule, struct flowi *fl, int flags) 190f0ad0860SPatrick McHardy { 191f0ad0860SPatrick McHardy return 1; 192f0ad0860SPatrick McHardy } 193f0ad0860SPatrick McHardy 194f0ad0860SPatrick McHardy static const struct nla_policy ipmr_rule_policy[FRA_MAX + 1] = { 195f0ad0860SPatrick McHardy FRA_GENERIC_POLICY, 196f0ad0860SPatrick McHardy }; 197f0ad0860SPatrick McHardy 198f0ad0860SPatrick McHardy static int ipmr_rule_configure(struct fib_rule *rule, struct sk_buff *skb, 199f0ad0860SPatrick McHardy struct fib_rule_hdr *frh, struct nlattr **tb) 200f0ad0860SPatrick McHardy { 201f0ad0860SPatrick McHardy return 0; 202f0ad0860SPatrick McHardy } 203f0ad0860SPatrick McHardy 204f0ad0860SPatrick McHardy static int ipmr_rule_compare(struct fib_rule *rule, struct fib_rule_hdr *frh, 205f0ad0860SPatrick McHardy struct nlattr **tb) 206f0ad0860SPatrick McHardy { 207f0ad0860SPatrick McHardy return 1; 208f0ad0860SPatrick McHardy } 209f0ad0860SPatrick McHardy 210f0ad0860SPatrick McHardy static int ipmr_rule_fill(struct fib_rule *rule, struct sk_buff *skb, 211f0ad0860SPatrick McHardy struct fib_rule_hdr *frh) 212f0ad0860SPatrick McHardy { 213f0ad0860SPatrick McHardy frh->dst_len = 0; 214f0ad0860SPatrick McHardy frh->src_len = 0; 215f0ad0860SPatrick McHardy frh->tos = 0; 216f0ad0860SPatrick McHardy return 0; 217f0ad0860SPatrick McHardy } 218f0ad0860SPatrick McHardy 2193d0c9c4eSPatrick McHardy static const struct fib_rules_ops __net_initdata ipmr_rules_ops_template = { 22025239ceeSPatrick McHardy .family = RTNL_FAMILY_IPMR, 221f0ad0860SPatrick McHardy .rule_size = sizeof(struct ipmr_rule), 222f0ad0860SPatrick McHardy .addr_size = sizeof(u32), 223f0ad0860SPatrick McHardy .action = ipmr_rule_action, 224f0ad0860SPatrick McHardy .match = ipmr_rule_match, 225f0ad0860SPatrick McHardy .configure = ipmr_rule_configure, 226f0ad0860SPatrick McHardy .compare = ipmr_rule_compare, 227f0ad0860SPatrick McHardy .default_pref = fib_default_rule_pref, 228f0ad0860SPatrick McHardy .fill = ipmr_rule_fill, 229f0ad0860SPatrick McHardy .nlgroup = RTNLGRP_IPV4_RULE, 230f0ad0860SPatrick McHardy .policy = ipmr_rule_policy, 231f0ad0860SPatrick McHardy .owner = THIS_MODULE, 232f0ad0860SPatrick McHardy }; 233f0ad0860SPatrick McHardy 234f0ad0860SPatrick McHardy static int __net_init ipmr_rules_init(struct net *net) 235f0ad0860SPatrick McHardy { 236f0ad0860SPatrick McHardy struct fib_rules_ops *ops; 237f0ad0860SPatrick McHardy struct mr_table *mrt; 238f0ad0860SPatrick McHardy int err; 239f0ad0860SPatrick McHardy 240f0ad0860SPatrick McHardy ops = fib_rules_register(&ipmr_rules_ops_template, net); 241f0ad0860SPatrick McHardy if (IS_ERR(ops)) 242f0ad0860SPatrick McHardy return PTR_ERR(ops); 243f0ad0860SPatrick McHardy 244f0ad0860SPatrick McHardy INIT_LIST_HEAD(&net->ipv4.mr_tables); 245f0ad0860SPatrick McHardy 246f0ad0860SPatrick McHardy mrt = ipmr_new_table(net, RT_TABLE_DEFAULT); 247f0ad0860SPatrick McHardy if (mrt == NULL) { 248f0ad0860SPatrick McHardy err = -ENOMEM; 249f0ad0860SPatrick McHardy goto err1; 250f0ad0860SPatrick McHardy } 251f0ad0860SPatrick McHardy 252f0ad0860SPatrick McHardy err = fib_default_rule_add(ops, 0x7fff, RT_TABLE_DEFAULT, 0); 253f0ad0860SPatrick McHardy if (err < 0) 254f0ad0860SPatrick McHardy goto err2; 255f0ad0860SPatrick McHardy 256f0ad0860SPatrick McHardy net->ipv4.mr_rules_ops = ops; 257f0ad0860SPatrick McHardy return 0; 258f0ad0860SPatrick McHardy 259f0ad0860SPatrick McHardy err2: 260f0ad0860SPatrick McHardy kfree(mrt); 261f0ad0860SPatrick McHardy err1: 262f0ad0860SPatrick McHardy fib_rules_unregister(ops); 263f0ad0860SPatrick McHardy return err; 264f0ad0860SPatrick McHardy } 265f0ad0860SPatrick McHardy 266f0ad0860SPatrick McHardy static void __net_exit ipmr_rules_exit(struct net *net) 267f0ad0860SPatrick McHardy { 268f0ad0860SPatrick McHardy struct mr_table *mrt, *next; 269f0ad0860SPatrick McHardy 270035320d5SEric Dumazet list_for_each_entry_safe(mrt, next, &net->ipv4.mr_tables, list) { 271035320d5SEric Dumazet list_del(&mrt->list); 272f0ad0860SPatrick McHardy kfree(mrt); 273035320d5SEric Dumazet } 274f0ad0860SPatrick McHardy fib_rules_unregister(net->ipv4.mr_rules_ops); 275f0ad0860SPatrick McHardy } 276f0ad0860SPatrick McHardy #else 277f0ad0860SPatrick McHardy #define ipmr_for_each_table(mrt, net) \ 278f0ad0860SPatrick McHardy for (mrt = net->ipv4.mrt; mrt; mrt = NULL) 279f0ad0860SPatrick McHardy 280f0ad0860SPatrick McHardy static struct mr_table *ipmr_get_table(struct net *net, u32 id) 281f0ad0860SPatrick McHardy { 282f0ad0860SPatrick McHardy return net->ipv4.mrt; 283f0ad0860SPatrick McHardy } 284f0ad0860SPatrick McHardy 285f0ad0860SPatrick McHardy static int ipmr_fib_lookup(struct net *net, struct flowi *flp, 286f0ad0860SPatrick McHardy struct mr_table **mrt) 287f0ad0860SPatrick McHardy { 288f0ad0860SPatrick McHardy *mrt = net->ipv4.mrt; 289f0ad0860SPatrick McHardy return 0; 290f0ad0860SPatrick McHardy } 291f0ad0860SPatrick McHardy 292f0ad0860SPatrick McHardy static int __net_init ipmr_rules_init(struct net *net) 293f0ad0860SPatrick McHardy { 294f0ad0860SPatrick McHardy net->ipv4.mrt = ipmr_new_table(net, RT_TABLE_DEFAULT); 295f0ad0860SPatrick McHardy return net->ipv4.mrt ? 0 : -ENOMEM; 296f0ad0860SPatrick McHardy } 297f0ad0860SPatrick McHardy 298f0ad0860SPatrick McHardy static void __net_exit ipmr_rules_exit(struct net *net) 299f0ad0860SPatrick McHardy { 300f0ad0860SPatrick McHardy kfree(net->ipv4.mrt); 301f0ad0860SPatrick McHardy } 302f0ad0860SPatrick McHardy #endif 303f0ad0860SPatrick McHardy 304f0ad0860SPatrick McHardy static struct mr_table *ipmr_new_table(struct net *net, u32 id) 305f0ad0860SPatrick McHardy { 306f0ad0860SPatrick McHardy struct mr_table *mrt; 307f0ad0860SPatrick McHardy unsigned int i; 308f0ad0860SPatrick McHardy 309f0ad0860SPatrick McHardy mrt = ipmr_get_table(net, id); 310f0ad0860SPatrick McHardy if (mrt != NULL) 311f0ad0860SPatrick McHardy return mrt; 312f0ad0860SPatrick McHardy 313f0ad0860SPatrick McHardy mrt = kzalloc(sizeof(*mrt), GFP_KERNEL); 314f0ad0860SPatrick McHardy if (mrt == NULL) 315f0ad0860SPatrick McHardy return NULL; 3168de53dfbSPatrick McHardy write_pnet(&mrt->net, net); 317f0ad0860SPatrick McHardy mrt->id = id; 318f0ad0860SPatrick McHardy 319f0ad0860SPatrick McHardy /* Forwarding cache */ 320f0ad0860SPatrick McHardy for (i = 0; i < MFC_LINES; i++) 321f0ad0860SPatrick McHardy INIT_LIST_HEAD(&mrt->mfc_cache_array[i]); 322f0ad0860SPatrick McHardy 323f0ad0860SPatrick McHardy INIT_LIST_HEAD(&mrt->mfc_unres_queue); 324f0ad0860SPatrick McHardy 325f0ad0860SPatrick McHardy setup_timer(&mrt->ipmr_expire_timer, ipmr_expire_process, 326f0ad0860SPatrick McHardy (unsigned long)mrt); 327f0ad0860SPatrick McHardy 328f0ad0860SPatrick McHardy #ifdef CONFIG_IP_PIMSM 329f0ad0860SPatrick McHardy mrt->mroute_reg_vif_num = -1; 330f0ad0860SPatrick McHardy #endif 331f0ad0860SPatrick McHardy #ifdef CONFIG_IP_MROUTE_MULTIPLE_TABLES 332f0ad0860SPatrick McHardy list_add_tail_rcu(&mrt->list, &net->ipv4.mr_tables); 333f0ad0860SPatrick McHardy #endif 334f0ad0860SPatrick McHardy return mrt; 335f0ad0860SPatrick McHardy } 3361da177e4SLinus Torvalds 3371da177e4SLinus Torvalds /* Service routines creating virtual interfaces: DVMRP tunnels and PIMREG */ 3381da177e4SLinus Torvalds 339d607032dSWang Chen static void ipmr_del_tunnel(struct net_device *dev, struct vifctl *v) 340d607032dSWang Chen { 3414feb88e5SBenjamin Thery struct net *net = dev_net(dev); 3424feb88e5SBenjamin Thery 343d607032dSWang Chen dev_close(dev); 344d607032dSWang Chen 3454feb88e5SBenjamin Thery dev = __dev_get_by_name(net, "tunl0"); 346d607032dSWang Chen if (dev) { 3475bc3eb7eSStephen Hemminger const struct net_device_ops *ops = dev->netdev_ops; 348d607032dSWang Chen struct ifreq ifr; 349d607032dSWang Chen struct ip_tunnel_parm p; 350d607032dSWang Chen 351d607032dSWang Chen memset(&p, 0, sizeof(p)); 352d607032dSWang Chen p.iph.daddr = v->vifc_rmt_addr.s_addr; 353d607032dSWang Chen p.iph.saddr = v->vifc_lcl_addr.s_addr; 354d607032dSWang Chen p.iph.version = 4; 355d607032dSWang Chen p.iph.ihl = 5; 356d607032dSWang Chen p.iph.protocol = IPPROTO_IPIP; 357d607032dSWang Chen sprintf(p.name, "dvmrp%d", v->vifc_vifi); 358d607032dSWang Chen ifr.ifr_ifru.ifru_data = (__force void __user *)&p; 359d607032dSWang Chen 3605bc3eb7eSStephen Hemminger if (ops->ndo_do_ioctl) { 3615bc3eb7eSStephen Hemminger mm_segment_t oldfs = get_fs(); 3625bc3eb7eSStephen Hemminger 3635bc3eb7eSStephen Hemminger set_fs(KERNEL_DS); 3645bc3eb7eSStephen Hemminger ops->ndo_do_ioctl(dev, &ifr, SIOCDELTUNNEL); 365d607032dSWang Chen set_fs(oldfs); 366d607032dSWang Chen } 367d607032dSWang Chen } 3685bc3eb7eSStephen Hemminger } 369d607032dSWang Chen 3701da177e4SLinus Torvalds static 3714feb88e5SBenjamin Thery struct net_device *ipmr_new_tunnel(struct net *net, struct vifctl *v) 3721da177e4SLinus Torvalds { 3731da177e4SLinus Torvalds struct net_device *dev; 3741da177e4SLinus Torvalds 3754feb88e5SBenjamin Thery dev = __dev_get_by_name(net, "tunl0"); 3761da177e4SLinus Torvalds 3771da177e4SLinus Torvalds if (dev) { 3785bc3eb7eSStephen Hemminger const struct net_device_ops *ops = dev->netdev_ops; 3791da177e4SLinus Torvalds int err; 3801da177e4SLinus Torvalds struct ifreq ifr; 3811da177e4SLinus Torvalds struct ip_tunnel_parm p; 3821da177e4SLinus Torvalds struct in_device *in_dev; 3831da177e4SLinus Torvalds 3841da177e4SLinus Torvalds memset(&p, 0, sizeof(p)); 3851da177e4SLinus Torvalds p.iph.daddr = v->vifc_rmt_addr.s_addr; 3861da177e4SLinus Torvalds p.iph.saddr = v->vifc_lcl_addr.s_addr; 3871da177e4SLinus Torvalds p.iph.version = 4; 3881da177e4SLinus Torvalds p.iph.ihl = 5; 3891da177e4SLinus Torvalds p.iph.protocol = IPPROTO_IPIP; 3901da177e4SLinus Torvalds sprintf(p.name, "dvmrp%d", v->vifc_vifi); 391ba93ef74SStephen Hemminger ifr.ifr_ifru.ifru_data = (__force void __user *)&p; 3921da177e4SLinus Torvalds 3935bc3eb7eSStephen Hemminger if (ops->ndo_do_ioctl) { 3945bc3eb7eSStephen Hemminger mm_segment_t oldfs = get_fs(); 3955bc3eb7eSStephen Hemminger 3965bc3eb7eSStephen Hemminger set_fs(KERNEL_DS); 3975bc3eb7eSStephen Hemminger err = ops->ndo_do_ioctl(dev, &ifr, SIOCADDTUNNEL); 3981da177e4SLinus Torvalds set_fs(oldfs); 3995bc3eb7eSStephen Hemminger } else 4005bc3eb7eSStephen Hemminger err = -EOPNOTSUPP; 4011da177e4SLinus Torvalds 4021da177e4SLinus Torvalds dev = NULL; 4031da177e4SLinus Torvalds 4044feb88e5SBenjamin Thery if (err == 0 && 4054feb88e5SBenjamin Thery (dev = __dev_get_by_name(net, p.name)) != NULL) { 4061da177e4SLinus Torvalds dev->flags |= IFF_MULTICAST; 4071da177e4SLinus Torvalds 408e5ed6399SHerbert Xu in_dev = __in_dev_get_rtnl(dev); 40971e27da9SHerbert Xu if (in_dev == NULL) 4101da177e4SLinus Torvalds goto failure; 41171e27da9SHerbert Xu 41271e27da9SHerbert Xu ipv4_devconf_setall(in_dev); 41371e27da9SHerbert Xu IPV4_DEVCONF(in_dev->cnf, RP_FILTER) = 0; 4141da177e4SLinus Torvalds 4151da177e4SLinus Torvalds if (dev_open(dev)) 4161da177e4SLinus Torvalds goto failure; 4177dc00c82SWang Chen dev_hold(dev); 4181da177e4SLinus Torvalds } 4191da177e4SLinus Torvalds } 4201da177e4SLinus Torvalds return dev; 4211da177e4SLinus Torvalds 4221da177e4SLinus Torvalds failure: 4231da177e4SLinus Torvalds /* allow the register to be completed before unregistering. */ 4241da177e4SLinus Torvalds rtnl_unlock(); 4251da177e4SLinus Torvalds rtnl_lock(); 4261da177e4SLinus Torvalds 4271da177e4SLinus Torvalds unregister_netdevice(dev); 4281da177e4SLinus Torvalds return NULL; 4291da177e4SLinus Torvalds } 4301da177e4SLinus Torvalds 4311da177e4SLinus Torvalds #ifdef CONFIG_IP_PIMSM 4321da177e4SLinus Torvalds 4336fef4c0cSStephen Hemminger static netdev_tx_t reg_vif_xmit(struct sk_buff *skb, struct net_device *dev) 4341da177e4SLinus Torvalds { 4354feb88e5SBenjamin Thery struct net *net = dev_net(dev); 436f0ad0860SPatrick McHardy struct mr_table *mrt; 437f0ad0860SPatrick McHardy struct flowi fl = { 438f0ad0860SPatrick McHardy .oif = dev->ifindex, 439f0ad0860SPatrick McHardy .iif = skb->skb_iif, 440f0ad0860SPatrick McHardy .mark = skb->mark, 441f0ad0860SPatrick McHardy }; 442f0ad0860SPatrick McHardy int err; 443f0ad0860SPatrick McHardy 444f0ad0860SPatrick McHardy err = ipmr_fib_lookup(net, &fl, &mrt); 445*e40dbc51SBen Greear if (err < 0) { 446*e40dbc51SBen Greear kfree_skb(skb); 447f0ad0860SPatrick McHardy return err; 448*e40dbc51SBen Greear } 4494feb88e5SBenjamin Thery 4501da177e4SLinus Torvalds read_lock(&mrt_lock); 451cf3677aeSPavel Emelyanov dev->stats.tx_bytes += skb->len; 452cf3677aeSPavel Emelyanov dev->stats.tx_packets++; 4530c12295aSPatrick McHardy ipmr_cache_report(mrt, skb, mrt->mroute_reg_vif_num, IGMPMSG_WHOLEPKT); 4541da177e4SLinus Torvalds read_unlock(&mrt_lock); 4551da177e4SLinus Torvalds kfree_skb(skb); 4566ed10654SPatrick McHardy return NETDEV_TX_OK; 4571da177e4SLinus Torvalds } 4581da177e4SLinus Torvalds 459007c3838SStephen Hemminger static const struct net_device_ops reg_vif_netdev_ops = { 460007c3838SStephen Hemminger .ndo_start_xmit = reg_vif_xmit, 461007c3838SStephen Hemminger }; 462007c3838SStephen Hemminger 4631da177e4SLinus Torvalds static void reg_vif_setup(struct net_device *dev) 4641da177e4SLinus Torvalds { 4651da177e4SLinus Torvalds dev->type = ARPHRD_PIMREG; 46646f25dffSKris Katterjohn dev->mtu = ETH_DATA_LEN - sizeof(struct iphdr) - 8; 4671da177e4SLinus Torvalds dev->flags = IFF_NOARP; 468007c3838SStephen Hemminger dev->netdev_ops = ®_vif_netdev_ops, 4691da177e4SLinus Torvalds dev->destructor = free_netdev; 470403dbb97STom Goff dev->features |= NETIF_F_NETNS_LOCAL; 4711da177e4SLinus Torvalds } 4721da177e4SLinus Torvalds 473f0ad0860SPatrick McHardy static struct net_device *ipmr_reg_vif(struct net *net, struct mr_table *mrt) 4741da177e4SLinus Torvalds { 4751da177e4SLinus Torvalds struct net_device *dev; 4761da177e4SLinus Torvalds struct in_device *in_dev; 477f0ad0860SPatrick McHardy char name[IFNAMSIZ]; 4781da177e4SLinus Torvalds 479f0ad0860SPatrick McHardy if (mrt->id == RT_TABLE_DEFAULT) 480f0ad0860SPatrick McHardy sprintf(name, "pimreg"); 481f0ad0860SPatrick McHardy else 482f0ad0860SPatrick McHardy sprintf(name, "pimreg%u", mrt->id); 483f0ad0860SPatrick McHardy 484f0ad0860SPatrick McHardy dev = alloc_netdev(0, name, reg_vif_setup); 4851da177e4SLinus Torvalds 4861da177e4SLinus Torvalds if (dev == NULL) 4871da177e4SLinus Torvalds return NULL; 4881da177e4SLinus Torvalds 489403dbb97STom Goff dev_net_set(dev, net); 490403dbb97STom Goff 4911da177e4SLinus Torvalds if (register_netdevice(dev)) { 4921da177e4SLinus Torvalds free_netdev(dev); 4931da177e4SLinus Torvalds return NULL; 4941da177e4SLinus Torvalds } 4951da177e4SLinus Torvalds dev->iflink = 0; 4961da177e4SLinus Torvalds 49771e27da9SHerbert Xu rcu_read_lock(); 49871e27da9SHerbert Xu if ((in_dev = __in_dev_get_rcu(dev)) == NULL) { 49971e27da9SHerbert Xu rcu_read_unlock(); 5001da177e4SLinus Torvalds goto failure; 50171e27da9SHerbert Xu } 5021da177e4SLinus Torvalds 50371e27da9SHerbert Xu ipv4_devconf_setall(in_dev); 50471e27da9SHerbert Xu IPV4_DEVCONF(in_dev->cnf, RP_FILTER) = 0; 50571e27da9SHerbert Xu rcu_read_unlock(); 5061da177e4SLinus Torvalds 5071da177e4SLinus Torvalds if (dev_open(dev)) 5081da177e4SLinus Torvalds goto failure; 5091da177e4SLinus Torvalds 5107dc00c82SWang Chen dev_hold(dev); 5117dc00c82SWang Chen 5121da177e4SLinus Torvalds return dev; 5131da177e4SLinus Torvalds 5141da177e4SLinus Torvalds failure: 5151da177e4SLinus Torvalds /* allow the register to be completed before unregistering. */ 5161da177e4SLinus Torvalds rtnl_unlock(); 5171da177e4SLinus Torvalds rtnl_lock(); 5181da177e4SLinus Torvalds 5191da177e4SLinus Torvalds unregister_netdevice(dev); 5201da177e4SLinus Torvalds return NULL; 5211da177e4SLinus Torvalds } 5221da177e4SLinus Torvalds #endif 5231da177e4SLinus Torvalds 5241da177e4SLinus Torvalds /* 5251da177e4SLinus Torvalds * Delete a VIF entry 5267dc00c82SWang Chen * @notify: Set to 1, if the caller is a notifier_call 5271da177e4SLinus Torvalds */ 5281da177e4SLinus Torvalds 5290c12295aSPatrick McHardy static int vif_delete(struct mr_table *mrt, int vifi, int notify, 530d17fa6faSEric Dumazet struct list_head *head) 5311da177e4SLinus Torvalds { 5321da177e4SLinus Torvalds struct vif_device *v; 5331da177e4SLinus Torvalds struct net_device *dev; 5341da177e4SLinus Torvalds struct in_device *in_dev; 5351da177e4SLinus Torvalds 5360c12295aSPatrick McHardy if (vifi < 0 || vifi >= mrt->maxvif) 5371da177e4SLinus Torvalds return -EADDRNOTAVAIL; 5381da177e4SLinus Torvalds 5390c12295aSPatrick McHardy v = &mrt->vif_table[vifi]; 5401da177e4SLinus Torvalds 5411da177e4SLinus Torvalds write_lock_bh(&mrt_lock); 5421da177e4SLinus Torvalds dev = v->dev; 5431da177e4SLinus Torvalds v->dev = NULL; 5441da177e4SLinus Torvalds 5451da177e4SLinus Torvalds if (!dev) { 5461da177e4SLinus Torvalds write_unlock_bh(&mrt_lock); 5471da177e4SLinus Torvalds return -EADDRNOTAVAIL; 5481da177e4SLinus Torvalds } 5491da177e4SLinus Torvalds 5501da177e4SLinus Torvalds #ifdef CONFIG_IP_PIMSM 5510c12295aSPatrick McHardy if (vifi == mrt->mroute_reg_vif_num) 5520c12295aSPatrick McHardy mrt->mroute_reg_vif_num = -1; 5531da177e4SLinus Torvalds #endif 5541da177e4SLinus Torvalds 5550c12295aSPatrick McHardy if (vifi+1 == mrt->maxvif) { 5561da177e4SLinus Torvalds int tmp; 5571da177e4SLinus Torvalds for (tmp=vifi-1; tmp>=0; tmp--) { 5580c12295aSPatrick McHardy if (VIF_EXISTS(mrt, tmp)) 5591da177e4SLinus Torvalds break; 5601da177e4SLinus Torvalds } 5610c12295aSPatrick McHardy mrt->maxvif = tmp+1; 5621da177e4SLinus Torvalds } 5631da177e4SLinus Torvalds 5641da177e4SLinus Torvalds write_unlock_bh(&mrt_lock); 5651da177e4SLinus Torvalds 5661da177e4SLinus Torvalds dev_set_allmulti(dev, -1); 5671da177e4SLinus Torvalds 568e5ed6399SHerbert Xu if ((in_dev = __in_dev_get_rtnl(dev)) != NULL) { 56942f811b8SHerbert Xu IPV4_DEVCONF(in_dev->cnf, MC_FORWARDING)--; 5701da177e4SLinus Torvalds ip_rt_multicast_event(in_dev); 5711da177e4SLinus Torvalds } 5721da177e4SLinus Torvalds 5737dc00c82SWang Chen if (v->flags&(VIFF_TUNNEL|VIFF_REGISTER) && !notify) 574d17fa6faSEric Dumazet unregister_netdevice_queue(dev, head); 5751da177e4SLinus Torvalds 5761da177e4SLinus Torvalds dev_put(dev); 5771da177e4SLinus Torvalds return 0; 5781da177e4SLinus Torvalds } 5791da177e4SLinus Torvalds 5805c0a66f5SBenjamin Thery static inline void ipmr_cache_free(struct mfc_cache *c) 5815c0a66f5SBenjamin Thery { 5825c0a66f5SBenjamin Thery kmem_cache_free(mrt_cachep, c); 5835c0a66f5SBenjamin Thery } 5845c0a66f5SBenjamin Thery 5851da177e4SLinus Torvalds /* Destroy an unresolved cache entry, killing queued skbs 5861da177e4SLinus Torvalds and reporting error to netlink readers. 5871da177e4SLinus Torvalds */ 5881da177e4SLinus Torvalds 5890c12295aSPatrick McHardy static void ipmr_destroy_unres(struct mr_table *mrt, struct mfc_cache *c) 5901da177e4SLinus Torvalds { 5918de53dfbSPatrick McHardy struct net *net = read_pnet(&mrt->net); 5921da177e4SLinus Torvalds struct sk_buff *skb; 5939ef1d4c7SPatrick McHardy struct nlmsgerr *e; 5941da177e4SLinus Torvalds 5950c12295aSPatrick McHardy atomic_dec(&mrt->cache_resolve_queue_len); 5961da177e4SLinus Torvalds 5971da177e4SLinus Torvalds while ((skb = skb_dequeue(&c->mfc_un.unres.unresolved))) { 598eddc9ec5SArnaldo Carvalho de Melo if (ip_hdr(skb)->version == 0) { 5991da177e4SLinus Torvalds struct nlmsghdr *nlh = (struct nlmsghdr *)skb_pull(skb, sizeof(struct iphdr)); 6001da177e4SLinus Torvalds nlh->nlmsg_type = NLMSG_ERROR; 6011da177e4SLinus Torvalds nlh->nlmsg_len = NLMSG_LENGTH(sizeof(struct nlmsgerr)); 6021da177e4SLinus Torvalds skb_trim(skb, nlh->nlmsg_len); 6039ef1d4c7SPatrick McHardy e = NLMSG_DATA(nlh); 6049ef1d4c7SPatrick McHardy e->error = -ETIMEDOUT; 6059ef1d4c7SPatrick McHardy memset(&e->msg, 0, sizeof(e->msg)); 6062942e900SThomas Graf 6074feb88e5SBenjamin Thery rtnl_unicast(skb, net, NETLINK_CB(skb).pid); 6081da177e4SLinus Torvalds } else 6091da177e4SLinus Torvalds kfree_skb(skb); 6101da177e4SLinus Torvalds } 6111da177e4SLinus Torvalds 6125c0a66f5SBenjamin Thery ipmr_cache_free(c); 6131da177e4SLinus Torvalds } 6141da177e4SLinus Torvalds 6151da177e4SLinus Torvalds 616e258beb2SPatrick McHardy /* Timer process for the unresolved queue. */ 6171da177e4SLinus Torvalds 618e258beb2SPatrick McHardy static void ipmr_expire_process(unsigned long arg) 6191da177e4SLinus Torvalds { 6200c12295aSPatrick McHardy struct mr_table *mrt = (struct mr_table *)arg; 6211da177e4SLinus Torvalds unsigned long now; 6221da177e4SLinus Torvalds unsigned long expires; 623862465f2SPatrick McHardy struct mfc_cache *c, *next; 6241da177e4SLinus Torvalds 6251da177e4SLinus Torvalds if (!spin_trylock(&mfc_unres_lock)) { 6260c12295aSPatrick McHardy mod_timer(&mrt->ipmr_expire_timer, jiffies+HZ/10); 6271da177e4SLinus Torvalds return; 6281da177e4SLinus Torvalds } 6291da177e4SLinus Torvalds 6300c12295aSPatrick McHardy if (list_empty(&mrt->mfc_unres_queue)) 6311da177e4SLinus Torvalds goto out; 6321da177e4SLinus Torvalds 6331da177e4SLinus Torvalds now = jiffies; 6341da177e4SLinus Torvalds expires = 10*HZ; 6351da177e4SLinus Torvalds 6360c12295aSPatrick McHardy list_for_each_entry_safe(c, next, &mrt->mfc_unres_queue, list) { 6371da177e4SLinus Torvalds if (time_after(c->mfc_un.unres.expires, now)) { 6381da177e4SLinus Torvalds unsigned long interval = c->mfc_un.unres.expires - now; 6391da177e4SLinus Torvalds if (interval < expires) 6401da177e4SLinus Torvalds expires = interval; 6411da177e4SLinus Torvalds continue; 6421da177e4SLinus Torvalds } 6431da177e4SLinus Torvalds 644862465f2SPatrick McHardy list_del(&c->list); 6450c12295aSPatrick McHardy ipmr_destroy_unres(mrt, c); 6461da177e4SLinus Torvalds } 6471da177e4SLinus Torvalds 6480c12295aSPatrick McHardy if (!list_empty(&mrt->mfc_unres_queue)) 6490c12295aSPatrick McHardy mod_timer(&mrt->ipmr_expire_timer, jiffies + expires); 6501da177e4SLinus Torvalds 6511da177e4SLinus Torvalds out: 6521da177e4SLinus Torvalds spin_unlock(&mfc_unres_lock); 6531da177e4SLinus Torvalds } 6541da177e4SLinus Torvalds 6551da177e4SLinus Torvalds /* Fill oifs list. It is called under write locked mrt_lock. */ 6561da177e4SLinus Torvalds 6570c12295aSPatrick McHardy static void ipmr_update_thresholds(struct mr_table *mrt, struct mfc_cache *cache, 658d658f8a0SPatrick McHardy unsigned char *ttls) 6591da177e4SLinus Torvalds { 6601da177e4SLinus Torvalds int vifi; 6611da177e4SLinus Torvalds 6621da177e4SLinus Torvalds cache->mfc_un.res.minvif = MAXVIFS; 6631da177e4SLinus Torvalds cache->mfc_un.res.maxvif = 0; 6641da177e4SLinus Torvalds memset(cache->mfc_un.res.ttls, 255, MAXVIFS); 6651da177e4SLinus Torvalds 6660c12295aSPatrick McHardy for (vifi = 0; vifi < mrt->maxvif; vifi++) { 6670c12295aSPatrick McHardy if (VIF_EXISTS(mrt, vifi) && 668cf958ae3SBenjamin Thery ttls[vifi] && ttls[vifi] < 255) { 6691da177e4SLinus Torvalds cache->mfc_un.res.ttls[vifi] = ttls[vifi]; 6701da177e4SLinus Torvalds if (cache->mfc_un.res.minvif > vifi) 6711da177e4SLinus Torvalds cache->mfc_un.res.minvif = vifi; 6721da177e4SLinus Torvalds if (cache->mfc_un.res.maxvif <= vifi) 6731da177e4SLinus Torvalds cache->mfc_un.res.maxvif = vifi + 1; 6741da177e4SLinus Torvalds } 6751da177e4SLinus Torvalds } 6761da177e4SLinus Torvalds } 6771da177e4SLinus Torvalds 6780c12295aSPatrick McHardy static int vif_add(struct net *net, struct mr_table *mrt, 6790c12295aSPatrick McHardy struct vifctl *vifc, int mrtsock) 6801da177e4SLinus Torvalds { 6811da177e4SLinus Torvalds int vifi = vifc->vifc_vifi; 6820c12295aSPatrick McHardy struct vif_device *v = &mrt->vif_table[vifi]; 6831da177e4SLinus Torvalds struct net_device *dev; 6841da177e4SLinus Torvalds struct in_device *in_dev; 685d607032dSWang Chen int err; 6861da177e4SLinus Torvalds 6871da177e4SLinus Torvalds /* Is vif busy ? */ 6880c12295aSPatrick McHardy if (VIF_EXISTS(mrt, vifi)) 6891da177e4SLinus Torvalds return -EADDRINUSE; 6901da177e4SLinus Torvalds 6911da177e4SLinus Torvalds switch (vifc->vifc_flags) { 6921da177e4SLinus Torvalds #ifdef CONFIG_IP_PIMSM 6931da177e4SLinus Torvalds case VIFF_REGISTER: 6941da177e4SLinus Torvalds /* 6951da177e4SLinus Torvalds * Special Purpose VIF in PIM 6961da177e4SLinus Torvalds * All the packets will be sent to the daemon 6971da177e4SLinus Torvalds */ 6980c12295aSPatrick McHardy if (mrt->mroute_reg_vif_num >= 0) 6991da177e4SLinus Torvalds return -EADDRINUSE; 700f0ad0860SPatrick McHardy dev = ipmr_reg_vif(net, mrt); 7011da177e4SLinus Torvalds if (!dev) 7021da177e4SLinus Torvalds return -ENOBUFS; 703d607032dSWang Chen err = dev_set_allmulti(dev, 1); 704d607032dSWang Chen if (err) { 705d607032dSWang Chen unregister_netdevice(dev); 7067dc00c82SWang Chen dev_put(dev); 707d607032dSWang Chen return err; 708d607032dSWang Chen } 7091da177e4SLinus Torvalds break; 7101da177e4SLinus Torvalds #endif 7111da177e4SLinus Torvalds case VIFF_TUNNEL: 7124feb88e5SBenjamin Thery dev = ipmr_new_tunnel(net, vifc); 7131da177e4SLinus Torvalds if (!dev) 7141da177e4SLinus Torvalds return -ENOBUFS; 715d607032dSWang Chen err = dev_set_allmulti(dev, 1); 716d607032dSWang Chen if (err) { 717d607032dSWang Chen ipmr_del_tunnel(dev, vifc); 7187dc00c82SWang Chen dev_put(dev); 719d607032dSWang Chen return err; 720d607032dSWang Chen } 7211da177e4SLinus Torvalds break; 722ee5e81f0SIlia K 723ee5e81f0SIlia K case VIFF_USE_IFINDEX: 7241da177e4SLinus Torvalds case 0: 725ee5e81f0SIlia K if (vifc->vifc_flags == VIFF_USE_IFINDEX) { 726ee5e81f0SIlia K dev = dev_get_by_index(net, vifc->vifc_lcl_ifindex); 727ee5e81f0SIlia K if (dev && dev->ip_ptr == NULL) { 728ee5e81f0SIlia K dev_put(dev); 729ee5e81f0SIlia K return -EADDRNOTAVAIL; 730ee5e81f0SIlia K } 731ee5e81f0SIlia K } else 7324feb88e5SBenjamin Thery dev = ip_dev_find(net, vifc->vifc_lcl_addr.s_addr); 733ee5e81f0SIlia K 7341da177e4SLinus Torvalds if (!dev) 7351da177e4SLinus Torvalds return -EADDRNOTAVAIL; 736d607032dSWang Chen err = dev_set_allmulti(dev, 1); 7377dc00c82SWang Chen if (err) { 7387dc00c82SWang Chen dev_put(dev); 739d607032dSWang Chen return err; 7407dc00c82SWang Chen } 7411da177e4SLinus Torvalds break; 7421da177e4SLinus Torvalds default: 7431da177e4SLinus Torvalds return -EINVAL; 7441da177e4SLinus Torvalds } 7451da177e4SLinus Torvalds 746d0490cfdSDan Carpenter if ((in_dev = __in_dev_get_rtnl(dev)) == NULL) { 747d0490cfdSDan Carpenter dev_put(dev); 7481da177e4SLinus Torvalds return -EADDRNOTAVAIL; 749d0490cfdSDan Carpenter } 75042f811b8SHerbert Xu IPV4_DEVCONF(in_dev->cnf, MC_FORWARDING)++; 7511da177e4SLinus Torvalds ip_rt_multicast_event(in_dev); 7521da177e4SLinus Torvalds 7531da177e4SLinus Torvalds /* 7541da177e4SLinus Torvalds * Fill in the VIF structures 7551da177e4SLinus Torvalds */ 7561da177e4SLinus Torvalds v->rate_limit = vifc->vifc_rate_limit; 7571da177e4SLinus Torvalds v->local = vifc->vifc_lcl_addr.s_addr; 7581da177e4SLinus Torvalds v->remote = vifc->vifc_rmt_addr.s_addr; 7591da177e4SLinus Torvalds v->flags = vifc->vifc_flags; 7601da177e4SLinus Torvalds if (!mrtsock) 7611da177e4SLinus Torvalds v->flags |= VIFF_STATIC; 7621da177e4SLinus Torvalds v->threshold = vifc->vifc_threshold; 7631da177e4SLinus Torvalds v->bytes_in = 0; 7641da177e4SLinus Torvalds v->bytes_out = 0; 7651da177e4SLinus Torvalds v->pkt_in = 0; 7661da177e4SLinus Torvalds v->pkt_out = 0; 7671da177e4SLinus Torvalds v->link = dev->ifindex; 7681da177e4SLinus Torvalds if (v->flags&(VIFF_TUNNEL|VIFF_REGISTER)) 7691da177e4SLinus Torvalds v->link = dev->iflink; 7701da177e4SLinus Torvalds 7711da177e4SLinus Torvalds /* And finish update writing critical data */ 7721da177e4SLinus Torvalds write_lock_bh(&mrt_lock); 7731da177e4SLinus Torvalds v->dev = dev; 7741da177e4SLinus Torvalds #ifdef CONFIG_IP_PIMSM 7751da177e4SLinus Torvalds if (v->flags&VIFF_REGISTER) 7760c12295aSPatrick McHardy mrt->mroute_reg_vif_num = vifi; 7771da177e4SLinus Torvalds #endif 7780c12295aSPatrick McHardy if (vifi+1 > mrt->maxvif) 7790c12295aSPatrick McHardy mrt->maxvif = vifi+1; 7801da177e4SLinus Torvalds write_unlock_bh(&mrt_lock); 7811da177e4SLinus Torvalds return 0; 7821da177e4SLinus Torvalds } 7831da177e4SLinus Torvalds 7840c12295aSPatrick McHardy static struct mfc_cache *ipmr_cache_find(struct mr_table *mrt, 7854feb88e5SBenjamin Thery __be32 origin, 7864feb88e5SBenjamin Thery __be32 mcastgrp) 7871da177e4SLinus Torvalds { 7881da177e4SLinus Torvalds int line = MFC_HASH(mcastgrp, origin); 7891da177e4SLinus Torvalds struct mfc_cache *c; 7901da177e4SLinus Torvalds 7910c12295aSPatrick McHardy list_for_each_entry(c, &mrt->mfc_cache_array[line], list) { 7921da177e4SLinus Torvalds if (c->mfc_origin == origin && c->mfc_mcastgrp == mcastgrp) 7931da177e4SLinus Torvalds return c; 7941da177e4SLinus Torvalds } 795862465f2SPatrick McHardy return NULL; 796862465f2SPatrick McHardy } 7971da177e4SLinus Torvalds 7981da177e4SLinus Torvalds /* 7991da177e4SLinus Torvalds * Allocate a multicast cache entry 8001da177e4SLinus Torvalds */ 801d658f8a0SPatrick McHardy static struct mfc_cache *ipmr_cache_alloc(void) 8021da177e4SLinus Torvalds { 803c3762229SRobert P. J. Day struct mfc_cache *c = kmem_cache_zalloc(mrt_cachep, GFP_KERNEL); 8041da177e4SLinus Torvalds if (c == NULL) 8051da177e4SLinus Torvalds return NULL; 8061da177e4SLinus Torvalds c->mfc_un.res.minvif = MAXVIFS; 8071da177e4SLinus Torvalds return c; 8081da177e4SLinus Torvalds } 8091da177e4SLinus Torvalds 810d658f8a0SPatrick McHardy static struct mfc_cache *ipmr_cache_alloc_unres(void) 8111da177e4SLinus Torvalds { 812c3762229SRobert P. J. Day struct mfc_cache *c = kmem_cache_zalloc(mrt_cachep, GFP_ATOMIC); 8131da177e4SLinus Torvalds if (c == NULL) 8141da177e4SLinus Torvalds return NULL; 8151da177e4SLinus Torvalds skb_queue_head_init(&c->mfc_un.unres.unresolved); 8161da177e4SLinus Torvalds c->mfc_un.unres.expires = jiffies + 10*HZ; 8171da177e4SLinus Torvalds return c; 8181da177e4SLinus Torvalds } 8191da177e4SLinus Torvalds 8201da177e4SLinus Torvalds /* 8211da177e4SLinus Torvalds * A cache entry has gone into a resolved state from queued 8221da177e4SLinus Torvalds */ 8231da177e4SLinus Torvalds 8240c12295aSPatrick McHardy static void ipmr_cache_resolve(struct net *net, struct mr_table *mrt, 8250c12295aSPatrick McHardy struct mfc_cache *uc, struct mfc_cache *c) 8261da177e4SLinus Torvalds { 8271da177e4SLinus Torvalds struct sk_buff *skb; 8289ef1d4c7SPatrick McHardy struct nlmsgerr *e; 8291da177e4SLinus Torvalds 8301da177e4SLinus Torvalds /* 8311da177e4SLinus Torvalds * Play the pending entries through our router 8321da177e4SLinus Torvalds */ 8331da177e4SLinus Torvalds 8341da177e4SLinus Torvalds while ((skb = __skb_dequeue(&uc->mfc_un.unres.unresolved))) { 835eddc9ec5SArnaldo Carvalho de Melo if (ip_hdr(skb)->version == 0) { 8361da177e4SLinus Torvalds struct nlmsghdr *nlh = (struct nlmsghdr *)skb_pull(skb, sizeof(struct iphdr)); 8371da177e4SLinus Torvalds 838cb6a4e46SPatrick McHardy if (__ipmr_fill_mroute(mrt, skb, c, NLMSG_DATA(nlh)) > 0) { 83927a884dcSArnaldo Carvalho de Melo nlh->nlmsg_len = (skb_tail_pointer(skb) - 84027a884dcSArnaldo Carvalho de Melo (u8 *)nlh); 8411da177e4SLinus Torvalds } else { 8421da177e4SLinus Torvalds nlh->nlmsg_type = NLMSG_ERROR; 8431da177e4SLinus Torvalds nlh->nlmsg_len = NLMSG_LENGTH(sizeof(struct nlmsgerr)); 8441da177e4SLinus Torvalds skb_trim(skb, nlh->nlmsg_len); 8459ef1d4c7SPatrick McHardy e = NLMSG_DATA(nlh); 8469ef1d4c7SPatrick McHardy e->error = -EMSGSIZE; 8479ef1d4c7SPatrick McHardy memset(&e->msg, 0, sizeof(e->msg)); 8481da177e4SLinus Torvalds } 8492942e900SThomas Graf 850d658f8a0SPatrick McHardy rtnl_unicast(skb, net, NETLINK_CB(skb).pid); 8511da177e4SLinus Torvalds } else 8520c12295aSPatrick McHardy ip_mr_forward(net, mrt, skb, c, 0); 8531da177e4SLinus Torvalds } 8541da177e4SLinus Torvalds } 8551da177e4SLinus Torvalds 8561da177e4SLinus Torvalds /* 8571da177e4SLinus Torvalds * Bounce a cache query up to mrouted. We could use netlink for this but mrouted 8581da177e4SLinus Torvalds * expects the following bizarre scheme. 8591da177e4SLinus Torvalds * 8601da177e4SLinus Torvalds * Called under mrt_lock. 8611da177e4SLinus Torvalds */ 8621da177e4SLinus Torvalds 8630c12295aSPatrick McHardy static int ipmr_cache_report(struct mr_table *mrt, 8644feb88e5SBenjamin Thery struct sk_buff *pkt, vifi_t vifi, int assert) 8651da177e4SLinus Torvalds { 8661da177e4SLinus Torvalds struct sk_buff *skb; 867c9bdd4b5SArnaldo Carvalho de Melo const int ihl = ip_hdrlen(pkt); 8681da177e4SLinus Torvalds struct igmphdr *igmp; 8691da177e4SLinus Torvalds struct igmpmsg *msg; 8701da177e4SLinus Torvalds int ret; 8711da177e4SLinus Torvalds 8721da177e4SLinus Torvalds #ifdef CONFIG_IP_PIMSM 8731da177e4SLinus Torvalds if (assert == IGMPMSG_WHOLEPKT) 8741da177e4SLinus Torvalds skb = skb_realloc_headroom(pkt, sizeof(struct iphdr)); 8751da177e4SLinus Torvalds else 8761da177e4SLinus Torvalds #endif 8771da177e4SLinus Torvalds skb = alloc_skb(128, GFP_ATOMIC); 8781da177e4SLinus Torvalds 8791da177e4SLinus Torvalds if (!skb) 8801da177e4SLinus Torvalds return -ENOBUFS; 8811da177e4SLinus Torvalds 8821da177e4SLinus Torvalds #ifdef CONFIG_IP_PIMSM 8831da177e4SLinus Torvalds if (assert == IGMPMSG_WHOLEPKT) { 8841da177e4SLinus Torvalds /* Ugly, but we have no choice with this interface. 8851da177e4SLinus Torvalds Duplicate old header, fix ihl, length etc. 8861da177e4SLinus Torvalds And all this only to mangle msg->im_msgtype and 8871da177e4SLinus Torvalds to set msg->im_mbz to "mbz" :-) 8881da177e4SLinus Torvalds */ 889878c8145SArnaldo Carvalho de Melo skb_push(skb, sizeof(struct iphdr)); 890878c8145SArnaldo Carvalho de Melo skb_reset_network_header(skb); 891badff6d0SArnaldo Carvalho de Melo skb_reset_transport_header(skb); 8920272ffc4SArnaldo Carvalho de Melo msg = (struct igmpmsg *)skb_network_header(skb); 893d56f90a7SArnaldo Carvalho de Melo memcpy(msg, skb_network_header(pkt), sizeof(struct iphdr)); 8941da177e4SLinus Torvalds msg->im_msgtype = IGMPMSG_WHOLEPKT; 8951da177e4SLinus Torvalds msg->im_mbz = 0; 8960c12295aSPatrick McHardy msg->im_vif = mrt->mroute_reg_vif_num; 897eddc9ec5SArnaldo Carvalho de Melo ip_hdr(skb)->ihl = sizeof(struct iphdr) >> 2; 898eddc9ec5SArnaldo Carvalho de Melo ip_hdr(skb)->tot_len = htons(ntohs(ip_hdr(pkt)->tot_len) + 899eddc9ec5SArnaldo Carvalho de Melo sizeof(struct iphdr)); 9001da177e4SLinus Torvalds } else 9011da177e4SLinus Torvalds #endif 9021da177e4SLinus Torvalds { 9031da177e4SLinus Torvalds 9041da177e4SLinus Torvalds /* 9051da177e4SLinus Torvalds * Copy the IP header 9061da177e4SLinus Torvalds */ 9071da177e4SLinus Torvalds 90827a884dcSArnaldo Carvalho de Melo skb->network_header = skb->tail; 909ddc7b8e3SArnaldo Carvalho de Melo skb_put(skb, ihl); 91027d7ff46SArnaldo Carvalho de Melo skb_copy_to_linear_data(skb, pkt->data, ihl); 911eddc9ec5SArnaldo Carvalho de Melo ip_hdr(skb)->protocol = 0; /* Flag to the kernel this is a route add */ 912eddc9ec5SArnaldo Carvalho de Melo msg = (struct igmpmsg *)skb_network_header(skb); 9131da177e4SLinus Torvalds msg->im_vif = vifi; 914adf30907SEric Dumazet skb_dst_set(skb, dst_clone(skb_dst(pkt))); 9151da177e4SLinus Torvalds 9161da177e4SLinus Torvalds /* 9171da177e4SLinus Torvalds * Add our header 9181da177e4SLinus Torvalds */ 9191da177e4SLinus Torvalds 9201da177e4SLinus Torvalds igmp=(struct igmphdr *)skb_put(skb, sizeof(struct igmphdr)); 9211da177e4SLinus Torvalds igmp->type = 9221da177e4SLinus Torvalds msg->im_msgtype = assert; 9231da177e4SLinus Torvalds igmp->code = 0; 924eddc9ec5SArnaldo Carvalho de Melo ip_hdr(skb)->tot_len = htons(skb->len); /* Fix the length */ 925b0e380b1SArnaldo Carvalho de Melo skb->transport_header = skb->network_header; 9261da177e4SLinus Torvalds } 9271da177e4SLinus Torvalds 9280c12295aSPatrick McHardy if (mrt->mroute_sk == NULL) { 9291da177e4SLinus Torvalds kfree_skb(skb); 9301da177e4SLinus Torvalds return -EINVAL; 9311da177e4SLinus Torvalds } 9321da177e4SLinus Torvalds 9331da177e4SLinus Torvalds /* 9341da177e4SLinus Torvalds * Deliver to mrouted 9351da177e4SLinus Torvalds */ 9360c12295aSPatrick McHardy ret = sock_queue_rcv_skb(mrt->mroute_sk, skb); 93770a269e6SBenjamin Thery if (ret < 0) { 9381da177e4SLinus Torvalds if (net_ratelimit()) 9391da177e4SLinus Torvalds printk(KERN_WARNING "mroute: pending queue full, dropping entries.\n"); 9401da177e4SLinus Torvalds kfree_skb(skb); 9411da177e4SLinus Torvalds } 9421da177e4SLinus Torvalds 9431da177e4SLinus Torvalds return ret; 9441da177e4SLinus Torvalds } 9451da177e4SLinus Torvalds 9461da177e4SLinus Torvalds /* 9471da177e4SLinus Torvalds * Queue a packet for resolution. It gets locked cache entry! 9481da177e4SLinus Torvalds */ 9491da177e4SLinus Torvalds 9501da177e4SLinus Torvalds static int 9510c12295aSPatrick McHardy ipmr_cache_unresolved(struct mr_table *mrt, vifi_t vifi, struct sk_buff *skb) 9521da177e4SLinus Torvalds { 953862465f2SPatrick McHardy bool found = false; 9541da177e4SLinus Torvalds int err; 9551da177e4SLinus Torvalds struct mfc_cache *c; 956eddc9ec5SArnaldo Carvalho de Melo const struct iphdr *iph = ip_hdr(skb); 9571da177e4SLinus Torvalds 9581da177e4SLinus Torvalds spin_lock_bh(&mfc_unres_lock); 9590c12295aSPatrick McHardy list_for_each_entry(c, &mrt->mfc_unres_queue, list) { 960e258beb2SPatrick McHardy if (c->mfc_mcastgrp == iph->daddr && 961862465f2SPatrick McHardy c->mfc_origin == iph->saddr) { 962862465f2SPatrick McHardy found = true; 9631da177e4SLinus Torvalds break; 9641da177e4SLinus Torvalds } 965862465f2SPatrick McHardy } 9661da177e4SLinus Torvalds 967862465f2SPatrick McHardy if (!found) { 9681da177e4SLinus Torvalds /* 9691da177e4SLinus Torvalds * Create a new entry if allowable 9701da177e4SLinus Torvalds */ 9711da177e4SLinus Torvalds 9720c12295aSPatrick McHardy if (atomic_read(&mrt->cache_resolve_queue_len) >= 10 || 973d658f8a0SPatrick McHardy (c = ipmr_cache_alloc_unres()) == NULL) { 9741da177e4SLinus Torvalds spin_unlock_bh(&mfc_unres_lock); 9751da177e4SLinus Torvalds 9761da177e4SLinus Torvalds kfree_skb(skb); 9771da177e4SLinus Torvalds return -ENOBUFS; 9781da177e4SLinus Torvalds } 9791da177e4SLinus Torvalds 9801da177e4SLinus Torvalds /* 9811da177e4SLinus Torvalds * Fill in the new cache entry 9821da177e4SLinus Torvalds */ 9831da177e4SLinus Torvalds c->mfc_parent = -1; 984eddc9ec5SArnaldo Carvalho de Melo c->mfc_origin = iph->saddr; 985eddc9ec5SArnaldo Carvalho de Melo c->mfc_mcastgrp = iph->daddr; 9861da177e4SLinus Torvalds 9871da177e4SLinus Torvalds /* 9881da177e4SLinus Torvalds * Reflect first query at mrouted. 9891da177e4SLinus Torvalds */ 9900c12295aSPatrick McHardy err = ipmr_cache_report(mrt, skb, vifi, IGMPMSG_NOCACHE); 9914feb88e5SBenjamin Thery if (err < 0) { 9921da177e4SLinus Torvalds /* If the report failed throw the cache entry 9931da177e4SLinus Torvalds out - Brad Parker 9941da177e4SLinus Torvalds */ 9951da177e4SLinus Torvalds spin_unlock_bh(&mfc_unres_lock); 9961da177e4SLinus Torvalds 9975c0a66f5SBenjamin Thery ipmr_cache_free(c); 9981da177e4SLinus Torvalds kfree_skb(skb); 9991da177e4SLinus Torvalds return err; 10001da177e4SLinus Torvalds } 10011da177e4SLinus Torvalds 10020c12295aSPatrick McHardy atomic_inc(&mrt->cache_resolve_queue_len); 10030c12295aSPatrick McHardy list_add(&c->list, &mrt->mfc_unres_queue); 10041da177e4SLinus Torvalds 1005278554bdSDavid S. Miller if (atomic_read(&mrt->cache_resolve_queue_len) == 1) 10060c12295aSPatrick McHardy mod_timer(&mrt->ipmr_expire_timer, c->mfc_un.unres.expires); 10071da177e4SLinus Torvalds } 10081da177e4SLinus Torvalds 10091da177e4SLinus Torvalds /* 10101da177e4SLinus Torvalds * See if we can append the packet 10111da177e4SLinus Torvalds */ 10121da177e4SLinus Torvalds if (c->mfc_un.unres.unresolved.qlen>3) { 10131da177e4SLinus Torvalds kfree_skb(skb); 10141da177e4SLinus Torvalds err = -ENOBUFS; 10151da177e4SLinus Torvalds } else { 10161da177e4SLinus Torvalds skb_queue_tail(&c->mfc_un.unres.unresolved, skb); 10171da177e4SLinus Torvalds err = 0; 10181da177e4SLinus Torvalds } 10191da177e4SLinus Torvalds 10201da177e4SLinus Torvalds spin_unlock_bh(&mfc_unres_lock); 10211da177e4SLinus Torvalds return err; 10221da177e4SLinus Torvalds } 10231da177e4SLinus Torvalds 10241da177e4SLinus Torvalds /* 10251da177e4SLinus Torvalds * MFC cache manipulation by user space mroute daemon 10261da177e4SLinus Torvalds */ 10271da177e4SLinus Torvalds 10280c12295aSPatrick McHardy static int ipmr_mfc_delete(struct mr_table *mrt, struct mfcctl *mfc) 10291da177e4SLinus Torvalds { 10301da177e4SLinus Torvalds int line; 1031862465f2SPatrick McHardy struct mfc_cache *c, *next; 10321da177e4SLinus Torvalds 10331da177e4SLinus Torvalds line = MFC_HASH(mfc->mfcc_mcastgrp.s_addr, mfc->mfcc_origin.s_addr); 10341da177e4SLinus Torvalds 10350c12295aSPatrick McHardy list_for_each_entry_safe(c, next, &mrt->mfc_cache_array[line], list) { 10361da177e4SLinus Torvalds if (c->mfc_origin == mfc->mfcc_origin.s_addr && 10371da177e4SLinus Torvalds c->mfc_mcastgrp == mfc->mfcc_mcastgrp.s_addr) { 10381da177e4SLinus Torvalds write_lock_bh(&mrt_lock); 1039862465f2SPatrick McHardy list_del(&c->list); 10401da177e4SLinus Torvalds write_unlock_bh(&mrt_lock); 10411da177e4SLinus Torvalds 10425c0a66f5SBenjamin Thery ipmr_cache_free(c); 10431da177e4SLinus Torvalds return 0; 10441da177e4SLinus Torvalds } 10451da177e4SLinus Torvalds } 10461da177e4SLinus Torvalds return -ENOENT; 10471da177e4SLinus Torvalds } 10481da177e4SLinus Torvalds 10490c12295aSPatrick McHardy static int ipmr_mfc_add(struct net *net, struct mr_table *mrt, 10500c12295aSPatrick McHardy struct mfcctl *mfc, int mrtsock) 10511da177e4SLinus Torvalds { 1052862465f2SPatrick McHardy bool found = false; 10531da177e4SLinus Torvalds int line; 1054862465f2SPatrick McHardy struct mfc_cache *uc, *c; 10551da177e4SLinus Torvalds 1056a50436f2SPatrick McHardy if (mfc->mfcc_parent >= MAXVIFS) 1057a50436f2SPatrick McHardy return -ENFILE; 1058a50436f2SPatrick McHardy 10591da177e4SLinus Torvalds line = MFC_HASH(mfc->mfcc_mcastgrp.s_addr, mfc->mfcc_origin.s_addr); 10601da177e4SLinus Torvalds 10610c12295aSPatrick McHardy list_for_each_entry(c, &mrt->mfc_cache_array[line], list) { 10621da177e4SLinus Torvalds if (c->mfc_origin == mfc->mfcc_origin.s_addr && 1063862465f2SPatrick McHardy c->mfc_mcastgrp == mfc->mfcc_mcastgrp.s_addr) { 1064862465f2SPatrick McHardy found = true; 10651da177e4SLinus Torvalds break; 10661da177e4SLinus Torvalds } 1067862465f2SPatrick McHardy } 10681da177e4SLinus Torvalds 1069862465f2SPatrick McHardy if (found) { 10701da177e4SLinus Torvalds write_lock_bh(&mrt_lock); 10711da177e4SLinus Torvalds c->mfc_parent = mfc->mfcc_parent; 10720c12295aSPatrick McHardy ipmr_update_thresholds(mrt, c, mfc->mfcc_ttls); 10731da177e4SLinus Torvalds if (!mrtsock) 10741da177e4SLinus Torvalds c->mfc_flags |= MFC_STATIC; 10751da177e4SLinus Torvalds write_unlock_bh(&mrt_lock); 10761da177e4SLinus Torvalds return 0; 10771da177e4SLinus Torvalds } 10781da177e4SLinus Torvalds 1079f97c1e0cSJoe Perches if (!ipv4_is_multicast(mfc->mfcc_mcastgrp.s_addr)) 10801da177e4SLinus Torvalds return -EINVAL; 10811da177e4SLinus Torvalds 1082d658f8a0SPatrick McHardy c = ipmr_cache_alloc(); 10831da177e4SLinus Torvalds if (c == NULL) 10841da177e4SLinus Torvalds return -ENOMEM; 10851da177e4SLinus Torvalds 10861da177e4SLinus Torvalds c->mfc_origin = mfc->mfcc_origin.s_addr; 10871da177e4SLinus Torvalds c->mfc_mcastgrp = mfc->mfcc_mcastgrp.s_addr; 10881da177e4SLinus Torvalds c->mfc_parent = mfc->mfcc_parent; 10890c12295aSPatrick McHardy ipmr_update_thresholds(mrt, c, mfc->mfcc_ttls); 10901da177e4SLinus Torvalds if (!mrtsock) 10911da177e4SLinus Torvalds c->mfc_flags |= MFC_STATIC; 10921da177e4SLinus Torvalds 10931da177e4SLinus Torvalds write_lock_bh(&mrt_lock); 10940c12295aSPatrick McHardy list_add(&c->list, &mrt->mfc_cache_array[line]); 10951da177e4SLinus Torvalds write_unlock_bh(&mrt_lock); 10961da177e4SLinus Torvalds 10971da177e4SLinus Torvalds /* 10981da177e4SLinus Torvalds * Check to see if we resolved a queued list. If so we 10991da177e4SLinus Torvalds * need to send on the frames and tidy up. 11001da177e4SLinus Torvalds */ 1101b0ebb739SPatrick McHardy found = false; 11021da177e4SLinus Torvalds spin_lock_bh(&mfc_unres_lock); 11030c12295aSPatrick McHardy list_for_each_entry(uc, &mrt->mfc_unres_queue, list) { 1104e258beb2SPatrick McHardy if (uc->mfc_origin == c->mfc_origin && 11051da177e4SLinus Torvalds uc->mfc_mcastgrp == c->mfc_mcastgrp) { 1106862465f2SPatrick McHardy list_del(&uc->list); 11070c12295aSPatrick McHardy atomic_dec(&mrt->cache_resolve_queue_len); 1108b0ebb739SPatrick McHardy found = true; 11091da177e4SLinus Torvalds break; 11101da177e4SLinus Torvalds } 11111da177e4SLinus Torvalds } 11120c12295aSPatrick McHardy if (list_empty(&mrt->mfc_unres_queue)) 11130c12295aSPatrick McHardy del_timer(&mrt->ipmr_expire_timer); 11141da177e4SLinus Torvalds spin_unlock_bh(&mfc_unres_lock); 11151da177e4SLinus Torvalds 1116b0ebb739SPatrick McHardy if (found) { 11170c12295aSPatrick McHardy ipmr_cache_resolve(net, mrt, uc, c); 11185c0a66f5SBenjamin Thery ipmr_cache_free(uc); 11191da177e4SLinus Torvalds } 11201da177e4SLinus Torvalds return 0; 11211da177e4SLinus Torvalds } 11221da177e4SLinus Torvalds 11231da177e4SLinus Torvalds /* 11241da177e4SLinus Torvalds * Close the multicast socket, and clear the vif tables etc 11251da177e4SLinus Torvalds */ 11261da177e4SLinus Torvalds 11270c12295aSPatrick McHardy static void mroute_clean_tables(struct mr_table *mrt) 11281da177e4SLinus Torvalds { 11291da177e4SLinus Torvalds int i; 1130d17fa6faSEric Dumazet LIST_HEAD(list); 1131862465f2SPatrick McHardy struct mfc_cache *c, *next; 11321da177e4SLinus Torvalds 11331da177e4SLinus Torvalds /* 11341da177e4SLinus Torvalds * Shut down all active vif entries 11351da177e4SLinus Torvalds */ 11360c12295aSPatrick McHardy for (i = 0; i < mrt->maxvif; i++) { 11370c12295aSPatrick McHardy if (!(mrt->vif_table[i].flags&VIFF_STATIC)) 11380c12295aSPatrick McHardy vif_delete(mrt, i, 0, &list); 11391da177e4SLinus Torvalds } 1140d17fa6faSEric Dumazet unregister_netdevice_many(&list); 11411da177e4SLinus Torvalds 11421da177e4SLinus Torvalds /* 11431da177e4SLinus Torvalds * Wipe the cache 11441da177e4SLinus Torvalds */ 11451da177e4SLinus Torvalds for (i = 0; i < MFC_LINES; i++) { 11460c12295aSPatrick McHardy list_for_each_entry_safe(c, next, &mrt->mfc_cache_array[i], list) { 1147862465f2SPatrick McHardy if (c->mfc_flags&MFC_STATIC) 11481da177e4SLinus Torvalds continue; 11491da177e4SLinus Torvalds write_lock_bh(&mrt_lock); 1150862465f2SPatrick McHardy list_del(&c->list); 11511da177e4SLinus Torvalds write_unlock_bh(&mrt_lock); 11521da177e4SLinus Torvalds 11535c0a66f5SBenjamin Thery ipmr_cache_free(c); 11541da177e4SLinus Torvalds } 11551da177e4SLinus Torvalds } 11561da177e4SLinus Torvalds 11570c12295aSPatrick McHardy if (atomic_read(&mrt->cache_resolve_queue_len) != 0) { 11581da177e4SLinus Torvalds spin_lock_bh(&mfc_unres_lock); 11590c12295aSPatrick McHardy list_for_each_entry_safe(c, next, &mrt->mfc_unres_queue, list) { 1160862465f2SPatrick McHardy list_del(&c->list); 11610c12295aSPatrick McHardy ipmr_destroy_unres(mrt, c); 11621da177e4SLinus Torvalds } 11631da177e4SLinus Torvalds spin_unlock_bh(&mfc_unres_lock); 11641da177e4SLinus Torvalds } 11651da177e4SLinus Torvalds } 11661da177e4SLinus Torvalds 11671da177e4SLinus Torvalds static void mrtsock_destruct(struct sock *sk) 11681da177e4SLinus Torvalds { 11694feb88e5SBenjamin Thery struct net *net = sock_net(sk); 1170f0ad0860SPatrick McHardy struct mr_table *mrt; 11714feb88e5SBenjamin Thery 11721da177e4SLinus Torvalds rtnl_lock(); 1173f0ad0860SPatrick McHardy ipmr_for_each_table(mrt, net) { 11740c12295aSPatrick McHardy if (sk == mrt->mroute_sk) { 11754feb88e5SBenjamin Thery IPV4_DEVCONF_ALL(net, MC_FORWARDING)--; 11761da177e4SLinus Torvalds 11771da177e4SLinus Torvalds write_lock_bh(&mrt_lock); 11780c12295aSPatrick McHardy mrt->mroute_sk = NULL; 11791da177e4SLinus Torvalds write_unlock_bh(&mrt_lock); 11801da177e4SLinus Torvalds 11810c12295aSPatrick McHardy mroute_clean_tables(mrt); 11821da177e4SLinus Torvalds } 11831da177e4SLinus Torvalds } 11841da177e4SLinus Torvalds rtnl_unlock(); 11851da177e4SLinus Torvalds } 11861da177e4SLinus Torvalds 11871da177e4SLinus Torvalds /* 11881da177e4SLinus Torvalds * Socket options and virtual interface manipulation. The whole 11891da177e4SLinus Torvalds * virtual interface system is a complete heap, but unfortunately 11901da177e4SLinus Torvalds * that's how BSD mrouted happens to think. Maybe one day with a proper 11911da177e4SLinus Torvalds * MOSPF/PIM router set up we can clean this up. 11921da177e4SLinus Torvalds */ 11931da177e4SLinus Torvalds 1194b7058842SDavid S. Miller int ip_mroute_setsockopt(struct sock *sk, int optname, char __user *optval, unsigned int optlen) 11951da177e4SLinus Torvalds { 11961da177e4SLinus Torvalds int ret; 11971da177e4SLinus Torvalds struct vifctl vif; 11981da177e4SLinus Torvalds struct mfcctl mfc; 11994feb88e5SBenjamin Thery struct net *net = sock_net(sk); 1200f0ad0860SPatrick McHardy struct mr_table *mrt; 1201f0ad0860SPatrick McHardy 1202f0ad0860SPatrick McHardy mrt = ipmr_get_table(net, raw_sk(sk)->ipmr_table ? : RT_TABLE_DEFAULT); 1203f0ad0860SPatrick McHardy if (mrt == NULL) 1204f0ad0860SPatrick McHardy return -ENOENT; 12051da177e4SLinus Torvalds 1206132adf54SStephen Hemminger if (optname != MRT_INIT) { 12070c12295aSPatrick McHardy if (sk != mrt->mroute_sk && !capable(CAP_NET_ADMIN)) 12081da177e4SLinus Torvalds return -EACCES; 12091da177e4SLinus Torvalds } 12101da177e4SLinus Torvalds 1211132adf54SStephen Hemminger switch (optname) { 12121da177e4SLinus Torvalds case MRT_INIT: 12131da177e4SLinus Torvalds if (sk->sk_type != SOCK_RAW || 1214c720c7e8SEric Dumazet inet_sk(sk)->inet_num != IPPROTO_IGMP) 12151da177e4SLinus Torvalds return -EOPNOTSUPP; 12161da177e4SLinus Torvalds if (optlen != sizeof(int)) 12171da177e4SLinus Torvalds return -ENOPROTOOPT; 12181da177e4SLinus Torvalds 12191da177e4SLinus Torvalds rtnl_lock(); 12200c12295aSPatrick McHardy if (mrt->mroute_sk) { 12211da177e4SLinus Torvalds rtnl_unlock(); 12221da177e4SLinus Torvalds return -EADDRINUSE; 12231da177e4SLinus Torvalds } 12241da177e4SLinus Torvalds 12251da177e4SLinus Torvalds ret = ip_ra_control(sk, 1, mrtsock_destruct); 12261da177e4SLinus Torvalds if (ret == 0) { 12271da177e4SLinus Torvalds write_lock_bh(&mrt_lock); 12280c12295aSPatrick McHardy mrt->mroute_sk = sk; 12291da177e4SLinus Torvalds write_unlock_bh(&mrt_lock); 12301da177e4SLinus Torvalds 12314feb88e5SBenjamin Thery IPV4_DEVCONF_ALL(net, MC_FORWARDING)++; 12321da177e4SLinus Torvalds } 12331da177e4SLinus Torvalds rtnl_unlock(); 12341da177e4SLinus Torvalds return ret; 12351da177e4SLinus Torvalds case MRT_DONE: 12360c12295aSPatrick McHardy if (sk != mrt->mroute_sk) 12371da177e4SLinus Torvalds return -EACCES; 12381da177e4SLinus Torvalds return ip_ra_control(sk, 0, NULL); 12391da177e4SLinus Torvalds case MRT_ADD_VIF: 12401da177e4SLinus Torvalds case MRT_DEL_VIF: 12411da177e4SLinus Torvalds if (optlen != sizeof(vif)) 12421da177e4SLinus Torvalds return -EINVAL; 12431da177e4SLinus Torvalds if (copy_from_user(&vif, optval, sizeof(vif))) 12441da177e4SLinus Torvalds return -EFAULT; 12451da177e4SLinus Torvalds if (vif.vifc_vifi >= MAXVIFS) 12461da177e4SLinus Torvalds return -ENFILE; 12471da177e4SLinus Torvalds rtnl_lock(); 12481da177e4SLinus Torvalds if (optname == MRT_ADD_VIF) { 12490c12295aSPatrick McHardy ret = vif_add(net, mrt, &vif, sk == mrt->mroute_sk); 12501da177e4SLinus Torvalds } else { 12510c12295aSPatrick McHardy ret = vif_delete(mrt, vif.vifc_vifi, 0, NULL); 12521da177e4SLinus Torvalds } 12531da177e4SLinus Torvalds rtnl_unlock(); 12541da177e4SLinus Torvalds return ret; 12551da177e4SLinus Torvalds 12561da177e4SLinus Torvalds /* 12571da177e4SLinus Torvalds * Manipulate the forwarding caches. These live 12581da177e4SLinus Torvalds * in a sort of kernel/user symbiosis. 12591da177e4SLinus Torvalds */ 12601da177e4SLinus Torvalds case MRT_ADD_MFC: 12611da177e4SLinus Torvalds case MRT_DEL_MFC: 12621da177e4SLinus Torvalds if (optlen != sizeof(mfc)) 12631da177e4SLinus Torvalds return -EINVAL; 12641da177e4SLinus Torvalds if (copy_from_user(&mfc, optval, sizeof(mfc))) 12651da177e4SLinus Torvalds return -EFAULT; 12661da177e4SLinus Torvalds rtnl_lock(); 12671da177e4SLinus Torvalds if (optname == MRT_DEL_MFC) 12680c12295aSPatrick McHardy ret = ipmr_mfc_delete(mrt, &mfc); 12691da177e4SLinus Torvalds else 12700c12295aSPatrick McHardy ret = ipmr_mfc_add(net, mrt, &mfc, sk == mrt->mroute_sk); 12711da177e4SLinus Torvalds rtnl_unlock(); 12721da177e4SLinus Torvalds return ret; 12731da177e4SLinus Torvalds /* 12741da177e4SLinus Torvalds * Control PIM assert. 12751da177e4SLinus Torvalds */ 12761da177e4SLinus Torvalds case MRT_ASSERT: 12771da177e4SLinus Torvalds { 12781da177e4SLinus Torvalds int v; 12791da177e4SLinus Torvalds if (get_user(v,(int __user *)optval)) 12801da177e4SLinus Torvalds return -EFAULT; 12810c12295aSPatrick McHardy mrt->mroute_do_assert = (v) ? 1 : 0; 12821da177e4SLinus Torvalds return 0; 12831da177e4SLinus Torvalds } 12841da177e4SLinus Torvalds #ifdef CONFIG_IP_PIMSM 12851da177e4SLinus Torvalds case MRT_PIM: 12861da177e4SLinus Torvalds { 1287ba93ef74SStephen Hemminger int v; 1288ba93ef74SStephen Hemminger 12891da177e4SLinus Torvalds if (get_user(v,(int __user *)optval)) 12901da177e4SLinus Torvalds return -EFAULT; 12911da177e4SLinus Torvalds v = (v) ? 1 : 0; 1292ba93ef74SStephen Hemminger 12931da177e4SLinus Torvalds rtnl_lock(); 12941da177e4SLinus Torvalds ret = 0; 12950c12295aSPatrick McHardy if (v != mrt->mroute_do_pim) { 12960c12295aSPatrick McHardy mrt->mroute_do_pim = v; 12970c12295aSPatrick McHardy mrt->mroute_do_assert = v; 12981da177e4SLinus Torvalds } 12991da177e4SLinus Torvalds rtnl_unlock(); 13001da177e4SLinus Torvalds return ret; 13011da177e4SLinus Torvalds } 13021da177e4SLinus Torvalds #endif 1303f0ad0860SPatrick McHardy #ifdef CONFIG_IP_MROUTE_MULTIPLE_TABLES 1304f0ad0860SPatrick McHardy case MRT_TABLE: 1305f0ad0860SPatrick McHardy { 1306f0ad0860SPatrick McHardy u32 v; 1307f0ad0860SPatrick McHardy 1308f0ad0860SPatrick McHardy if (optlen != sizeof(u32)) 1309f0ad0860SPatrick McHardy return -EINVAL; 1310f0ad0860SPatrick McHardy if (get_user(v, (u32 __user *)optval)) 1311f0ad0860SPatrick McHardy return -EFAULT; 1312f0ad0860SPatrick McHardy if (sk == mrt->mroute_sk) 1313f0ad0860SPatrick McHardy return -EBUSY; 1314f0ad0860SPatrick McHardy 1315f0ad0860SPatrick McHardy rtnl_lock(); 1316f0ad0860SPatrick McHardy ret = 0; 1317f0ad0860SPatrick McHardy if (!ipmr_new_table(net, v)) 1318f0ad0860SPatrick McHardy ret = -ENOMEM; 1319f0ad0860SPatrick McHardy raw_sk(sk)->ipmr_table = v; 1320f0ad0860SPatrick McHardy rtnl_unlock(); 1321f0ad0860SPatrick McHardy return ret; 1322f0ad0860SPatrick McHardy } 1323f0ad0860SPatrick McHardy #endif 13241da177e4SLinus Torvalds /* 13251da177e4SLinus Torvalds * Spurious command, or MRT_VERSION which you cannot 13261da177e4SLinus Torvalds * set. 13271da177e4SLinus Torvalds */ 13281da177e4SLinus Torvalds default: 13291da177e4SLinus Torvalds return -ENOPROTOOPT; 13301da177e4SLinus Torvalds } 13311da177e4SLinus Torvalds } 13321da177e4SLinus Torvalds 13331da177e4SLinus Torvalds /* 13341da177e4SLinus Torvalds * Getsock opt support for the multicast routing system. 13351da177e4SLinus Torvalds */ 13361da177e4SLinus Torvalds 13371da177e4SLinus Torvalds int ip_mroute_getsockopt(struct sock *sk, int optname, char __user *optval, int __user *optlen) 13381da177e4SLinus Torvalds { 13391da177e4SLinus Torvalds int olr; 13401da177e4SLinus Torvalds int val; 13414feb88e5SBenjamin Thery struct net *net = sock_net(sk); 1342f0ad0860SPatrick McHardy struct mr_table *mrt; 1343f0ad0860SPatrick McHardy 1344f0ad0860SPatrick McHardy mrt = ipmr_get_table(net, raw_sk(sk)->ipmr_table ? : RT_TABLE_DEFAULT); 1345f0ad0860SPatrick McHardy if (mrt == NULL) 1346f0ad0860SPatrick McHardy return -ENOENT; 13471da177e4SLinus Torvalds 13481da177e4SLinus Torvalds if (optname != MRT_VERSION && 13491da177e4SLinus Torvalds #ifdef CONFIG_IP_PIMSM 13501da177e4SLinus Torvalds optname!=MRT_PIM && 13511da177e4SLinus Torvalds #endif 13521da177e4SLinus Torvalds optname!=MRT_ASSERT) 13531da177e4SLinus Torvalds return -ENOPROTOOPT; 13541da177e4SLinus Torvalds 13551da177e4SLinus Torvalds if (get_user(olr, optlen)) 13561da177e4SLinus Torvalds return -EFAULT; 13571da177e4SLinus Torvalds 13581da177e4SLinus Torvalds olr = min_t(unsigned int, olr, sizeof(int)); 13591da177e4SLinus Torvalds if (olr < 0) 13601da177e4SLinus Torvalds return -EINVAL; 13611da177e4SLinus Torvalds 13621da177e4SLinus Torvalds if (put_user(olr, optlen)) 13631da177e4SLinus Torvalds return -EFAULT; 13641da177e4SLinus Torvalds if (optname == MRT_VERSION) 13651da177e4SLinus Torvalds val = 0x0305; 13661da177e4SLinus Torvalds #ifdef CONFIG_IP_PIMSM 13671da177e4SLinus Torvalds else if (optname == MRT_PIM) 13680c12295aSPatrick McHardy val = mrt->mroute_do_pim; 13691da177e4SLinus Torvalds #endif 13701da177e4SLinus Torvalds else 13710c12295aSPatrick McHardy val = mrt->mroute_do_assert; 13721da177e4SLinus Torvalds if (copy_to_user(optval, &val, olr)) 13731da177e4SLinus Torvalds return -EFAULT; 13741da177e4SLinus Torvalds return 0; 13751da177e4SLinus Torvalds } 13761da177e4SLinus Torvalds 13771da177e4SLinus Torvalds /* 13781da177e4SLinus Torvalds * The IP multicast ioctl support routines. 13791da177e4SLinus Torvalds */ 13801da177e4SLinus Torvalds 13811da177e4SLinus Torvalds int ipmr_ioctl(struct sock *sk, int cmd, void __user *arg) 13821da177e4SLinus Torvalds { 13831da177e4SLinus Torvalds struct sioc_sg_req sr; 13841da177e4SLinus Torvalds struct sioc_vif_req vr; 13851da177e4SLinus Torvalds struct vif_device *vif; 13861da177e4SLinus Torvalds struct mfc_cache *c; 13874feb88e5SBenjamin Thery struct net *net = sock_net(sk); 1388f0ad0860SPatrick McHardy struct mr_table *mrt; 1389f0ad0860SPatrick McHardy 1390f0ad0860SPatrick McHardy mrt = ipmr_get_table(net, raw_sk(sk)->ipmr_table ? : RT_TABLE_DEFAULT); 1391f0ad0860SPatrick McHardy if (mrt == NULL) 1392f0ad0860SPatrick McHardy return -ENOENT; 13931da177e4SLinus Torvalds 1394132adf54SStephen Hemminger switch (cmd) { 13951da177e4SLinus Torvalds case SIOCGETVIFCNT: 13961da177e4SLinus Torvalds if (copy_from_user(&vr, arg, sizeof(vr))) 13971da177e4SLinus Torvalds return -EFAULT; 13980c12295aSPatrick McHardy if (vr.vifi >= mrt->maxvif) 13991da177e4SLinus Torvalds return -EINVAL; 14001da177e4SLinus Torvalds read_lock(&mrt_lock); 14010c12295aSPatrick McHardy vif = &mrt->vif_table[vr.vifi]; 14020c12295aSPatrick McHardy if (VIF_EXISTS(mrt, vr.vifi)) { 14031da177e4SLinus Torvalds vr.icount = vif->pkt_in; 14041da177e4SLinus Torvalds vr.ocount = vif->pkt_out; 14051da177e4SLinus Torvalds vr.ibytes = vif->bytes_in; 14061da177e4SLinus Torvalds vr.obytes = vif->bytes_out; 14071da177e4SLinus Torvalds read_unlock(&mrt_lock); 14081da177e4SLinus Torvalds 14091da177e4SLinus Torvalds if (copy_to_user(arg, &vr, sizeof(vr))) 14101da177e4SLinus Torvalds return -EFAULT; 14111da177e4SLinus Torvalds return 0; 14121da177e4SLinus Torvalds } 14131da177e4SLinus Torvalds read_unlock(&mrt_lock); 14141da177e4SLinus Torvalds return -EADDRNOTAVAIL; 14151da177e4SLinus Torvalds case SIOCGETSGCNT: 14161da177e4SLinus Torvalds if (copy_from_user(&sr, arg, sizeof(sr))) 14171da177e4SLinus Torvalds return -EFAULT; 14181da177e4SLinus Torvalds 14191da177e4SLinus Torvalds read_lock(&mrt_lock); 14200c12295aSPatrick McHardy c = ipmr_cache_find(mrt, sr.src.s_addr, sr.grp.s_addr); 14211da177e4SLinus Torvalds if (c) { 14221da177e4SLinus Torvalds sr.pktcnt = c->mfc_un.res.pkt; 14231da177e4SLinus Torvalds sr.bytecnt = c->mfc_un.res.bytes; 14241da177e4SLinus Torvalds sr.wrong_if = c->mfc_un.res.wrong_if; 14251da177e4SLinus Torvalds read_unlock(&mrt_lock); 14261da177e4SLinus Torvalds 14271da177e4SLinus Torvalds if (copy_to_user(arg, &sr, sizeof(sr))) 14281da177e4SLinus Torvalds return -EFAULT; 14291da177e4SLinus Torvalds return 0; 14301da177e4SLinus Torvalds } 14311da177e4SLinus Torvalds read_unlock(&mrt_lock); 14321da177e4SLinus Torvalds return -EADDRNOTAVAIL; 14331da177e4SLinus Torvalds default: 14341da177e4SLinus Torvalds return -ENOIOCTLCMD; 14351da177e4SLinus Torvalds } 14361da177e4SLinus Torvalds } 14371da177e4SLinus Torvalds 14381da177e4SLinus Torvalds 14391da177e4SLinus Torvalds static int ipmr_device_event(struct notifier_block *this, unsigned long event, void *ptr) 14401da177e4SLinus Torvalds { 1441e9dc8653SEric W. Biederman struct net_device *dev = ptr; 14424feb88e5SBenjamin Thery struct net *net = dev_net(dev); 1443f0ad0860SPatrick McHardy struct mr_table *mrt; 14441da177e4SLinus Torvalds struct vif_device *v; 14451da177e4SLinus Torvalds int ct; 1446d17fa6faSEric Dumazet LIST_HEAD(list); 1447e9dc8653SEric W. Biederman 14481da177e4SLinus Torvalds if (event != NETDEV_UNREGISTER) 14491da177e4SLinus Torvalds return NOTIFY_DONE; 1450f0ad0860SPatrick McHardy 1451f0ad0860SPatrick McHardy ipmr_for_each_table(mrt, net) { 14520c12295aSPatrick McHardy v = &mrt->vif_table[0]; 14530c12295aSPatrick McHardy for (ct = 0; ct < mrt->maxvif; ct++, v++) { 1454e9dc8653SEric W. Biederman if (v->dev == dev) 14550c12295aSPatrick McHardy vif_delete(mrt, ct, 1, &list); 14561da177e4SLinus Torvalds } 14571da177e4SLinus Torvalds } 1458d17fa6faSEric Dumazet unregister_netdevice_many(&list); 14591da177e4SLinus Torvalds return NOTIFY_DONE; 14601da177e4SLinus Torvalds } 14611da177e4SLinus Torvalds 14621da177e4SLinus Torvalds 14631da177e4SLinus Torvalds static struct notifier_block ip_mr_notifier = { 14641da177e4SLinus Torvalds .notifier_call = ipmr_device_event, 14651da177e4SLinus Torvalds }; 14661da177e4SLinus Torvalds 14671da177e4SLinus Torvalds /* 14681da177e4SLinus Torvalds * Encapsulate a packet by attaching a valid IPIP header to it. 14691da177e4SLinus Torvalds * This avoids tunnel drivers and other mess and gives us the speed so 14701da177e4SLinus Torvalds * important for multicast video. 14711da177e4SLinus Torvalds */ 14721da177e4SLinus Torvalds 1473114c7844SAl Viro static void ip_encap(struct sk_buff *skb, __be32 saddr, __be32 daddr) 14741da177e4SLinus Torvalds { 14758856dfa3SArnaldo Carvalho de Melo struct iphdr *iph; 1476eddc9ec5SArnaldo Carvalho de Melo struct iphdr *old_iph = ip_hdr(skb); 14778856dfa3SArnaldo Carvalho de Melo 14788856dfa3SArnaldo Carvalho de Melo skb_push(skb, sizeof(struct iphdr)); 1479b0e380b1SArnaldo Carvalho de Melo skb->transport_header = skb->network_header; 14808856dfa3SArnaldo Carvalho de Melo skb_reset_network_header(skb); 1481eddc9ec5SArnaldo Carvalho de Melo iph = ip_hdr(skb); 14821da177e4SLinus Torvalds 14831da177e4SLinus Torvalds iph->version = 4; 1484e023dd64SArnaldo Carvalho de Melo iph->tos = old_iph->tos; 1485e023dd64SArnaldo Carvalho de Melo iph->ttl = old_iph->ttl; 14861da177e4SLinus Torvalds iph->frag_off = 0; 14871da177e4SLinus Torvalds iph->daddr = daddr; 14881da177e4SLinus Torvalds iph->saddr = saddr; 14891da177e4SLinus Torvalds iph->protocol = IPPROTO_IPIP; 14901da177e4SLinus Torvalds iph->ihl = 5; 14911da177e4SLinus Torvalds iph->tot_len = htons(skb->len); 1492adf30907SEric Dumazet ip_select_ident(iph, skb_dst(skb), NULL); 14931da177e4SLinus Torvalds ip_send_check(iph); 14941da177e4SLinus Torvalds 14951da177e4SLinus Torvalds memset(&(IPCB(skb)->opt), 0, sizeof(IPCB(skb)->opt)); 14961da177e4SLinus Torvalds nf_reset(skb); 14971da177e4SLinus Torvalds } 14981da177e4SLinus Torvalds 14991da177e4SLinus Torvalds static inline int ipmr_forward_finish(struct sk_buff *skb) 15001da177e4SLinus Torvalds { 15011da177e4SLinus Torvalds struct ip_options * opt = &(IPCB(skb)->opt); 15021da177e4SLinus Torvalds 1503adf30907SEric Dumazet IP_INC_STATS_BH(dev_net(skb_dst(skb)->dev), IPSTATS_MIB_OUTFORWDATAGRAMS); 15041da177e4SLinus Torvalds 15051da177e4SLinus Torvalds if (unlikely(opt->optlen)) 15061da177e4SLinus Torvalds ip_forward_options(skb); 15071da177e4SLinus Torvalds 15081da177e4SLinus Torvalds return dst_output(skb); 15091da177e4SLinus Torvalds } 15101da177e4SLinus Torvalds 15111da177e4SLinus Torvalds /* 15121da177e4SLinus Torvalds * Processing handlers for ipmr_forward 15131da177e4SLinus Torvalds */ 15141da177e4SLinus Torvalds 15150c12295aSPatrick McHardy static void ipmr_queue_xmit(struct net *net, struct mr_table *mrt, 15160c12295aSPatrick McHardy struct sk_buff *skb, struct mfc_cache *c, int vifi) 15171da177e4SLinus Torvalds { 1518eddc9ec5SArnaldo Carvalho de Melo const struct iphdr *iph = ip_hdr(skb); 15190c12295aSPatrick McHardy struct vif_device *vif = &mrt->vif_table[vifi]; 15201da177e4SLinus Torvalds struct net_device *dev; 15211da177e4SLinus Torvalds struct rtable *rt; 15221da177e4SLinus Torvalds int encap = 0; 15231da177e4SLinus Torvalds 15241da177e4SLinus Torvalds if (vif->dev == NULL) 15251da177e4SLinus Torvalds goto out_free; 15261da177e4SLinus Torvalds 15271da177e4SLinus Torvalds #ifdef CONFIG_IP_PIMSM 15281da177e4SLinus Torvalds if (vif->flags & VIFF_REGISTER) { 15291da177e4SLinus Torvalds vif->pkt_out++; 15301da177e4SLinus Torvalds vif->bytes_out += skb->len; 1531cf3677aeSPavel Emelyanov vif->dev->stats.tx_bytes += skb->len; 1532cf3677aeSPavel Emelyanov vif->dev->stats.tx_packets++; 15330c12295aSPatrick McHardy ipmr_cache_report(mrt, skb, vifi, IGMPMSG_WHOLEPKT); 153469ebbf58SIlpo Järvinen goto out_free; 15351da177e4SLinus Torvalds } 15361da177e4SLinus Torvalds #endif 15371da177e4SLinus Torvalds 15381da177e4SLinus Torvalds if (vif->flags&VIFF_TUNNEL) { 15391da177e4SLinus Torvalds struct flowi fl = { .oif = vif->link, 15401da177e4SLinus Torvalds .nl_u = { .ip4_u = 15411da177e4SLinus Torvalds { .daddr = vif->remote, 15421da177e4SLinus Torvalds .saddr = vif->local, 15431da177e4SLinus Torvalds .tos = RT_TOS(iph->tos) } }, 15441da177e4SLinus Torvalds .proto = IPPROTO_IPIP }; 15454feb88e5SBenjamin Thery if (ip_route_output_key(net, &rt, &fl)) 15461da177e4SLinus Torvalds goto out_free; 15471da177e4SLinus Torvalds encap = sizeof(struct iphdr); 15481da177e4SLinus Torvalds } else { 15491da177e4SLinus Torvalds struct flowi fl = { .oif = vif->link, 15501da177e4SLinus Torvalds .nl_u = { .ip4_u = 15511da177e4SLinus Torvalds { .daddr = iph->daddr, 15521da177e4SLinus Torvalds .tos = RT_TOS(iph->tos) } }, 15531da177e4SLinus Torvalds .proto = IPPROTO_IPIP }; 15544feb88e5SBenjamin Thery if (ip_route_output_key(net, &rt, &fl)) 15551da177e4SLinus Torvalds goto out_free; 15561da177e4SLinus Torvalds } 15571da177e4SLinus Torvalds 15581da177e4SLinus Torvalds dev = rt->u.dst.dev; 15591da177e4SLinus Torvalds 15601da177e4SLinus Torvalds if (skb->len+encap > dst_mtu(&rt->u.dst) && (ntohs(iph->frag_off) & IP_DF)) { 15611da177e4SLinus Torvalds /* Do not fragment multicasts. Alas, IPv4 does not 15621da177e4SLinus Torvalds allow to send ICMP, so that packets will disappear 15631da177e4SLinus Torvalds to blackhole. 15641da177e4SLinus Torvalds */ 15651da177e4SLinus Torvalds 15667c73a6faSPavel Emelyanov IP_INC_STATS_BH(dev_net(dev), IPSTATS_MIB_FRAGFAILS); 15671da177e4SLinus Torvalds ip_rt_put(rt); 15681da177e4SLinus Torvalds goto out_free; 15691da177e4SLinus Torvalds } 15701da177e4SLinus Torvalds 15711da177e4SLinus Torvalds encap += LL_RESERVED_SPACE(dev) + rt->u.dst.header_len; 15721da177e4SLinus Torvalds 15731da177e4SLinus Torvalds if (skb_cow(skb, encap)) { 15741da177e4SLinus Torvalds ip_rt_put(rt); 15751da177e4SLinus Torvalds goto out_free; 15761da177e4SLinus Torvalds } 15771da177e4SLinus Torvalds 15781da177e4SLinus Torvalds vif->pkt_out++; 15791da177e4SLinus Torvalds vif->bytes_out += skb->len; 15801da177e4SLinus Torvalds 1581adf30907SEric Dumazet skb_dst_drop(skb); 1582adf30907SEric Dumazet skb_dst_set(skb, &rt->u.dst); 1583eddc9ec5SArnaldo Carvalho de Melo ip_decrease_ttl(ip_hdr(skb)); 15841da177e4SLinus Torvalds 15851da177e4SLinus Torvalds /* FIXME: forward and output firewalls used to be called here. 15861da177e4SLinus Torvalds * What do we do with netfilter? -- RR */ 15871da177e4SLinus Torvalds if (vif->flags & VIFF_TUNNEL) { 15881da177e4SLinus Torvalds ip_encap(skb, vif->local, vif->remote); 15891da177e4SLinus Torvalds /* FIXME: extra output firewall step used to be here. --RR */ 15902f4c02d4SPavel Emelyanov vif->dev->stats.tx_packets++; 15912f4c02d4SPavel Emelyanov vif->dev->stats.tx_bytes += skb->len; 15921da177e4SLinus Torvalds } 15931da177e4SLinus Torvalds 15941da177e4SLinus Torvalds IPCB(skb)->flags |= IPSKB_FORWARDED; 15951da177e4SLinus Torvalds 15961da177e4SLinus Torvalds /* 15971da177e4SLinus Torvalds * RFC1584 teaches, that DVMRP/PIM router must deliver packets locally 15981da177e4SLinus Torvalds * not only before forwarding, but after forwarding on all output 15991da177e4SLinus Torvalds * interfaces. It is clear, if mrouter runs a multicasting 16001da177e4SLinus Torvalds * program, it should receive packets not depending to what interface 16011da177e4SLinus Torvalds * program is joined. 16021da177e4SLinus Torvalds * If we will not make it, the program will have to join on all 16031da177e4SLinus Torvalds * interfaces. On the other hand, multihoming host (or router, but 16041da177e4SLinus Torvalds * not mrouter) cannot join to more than one interface - it will 16051da177e4SLinus Torvalds * result in receiving multiple packets. 16061da177e4SLinus Torvalds */ 16079bbc768aSJan Engelhardt NF_HOOK(NFPROTO_IPV4, NF_INET_FORWARD, skb, skb->dev, dev, 16081da177e4SLinus Torvalds ipmr_forward_finish); 16091da177e4SLinus Torvalds return; 16101da177e4SLinus Torvalds 16111da177e4SLinus Torvalds out_free: 16121da177e4SLinus Torvalds kfree_skb(skb); 16131da177e4SLinus Torvalds } 16141da177e4SLinus Torvalds 16150c12295aSPatrick McHardy static int ipmr_find_vif(struct mr_table *mrt, struct net_device *dev) 16161da177e4SLinus Torvalds { 16171da177e4SLinus Torvalds int ct; 16180c12295aSPatrick McHardy 16190c12295aSPatrick McHardy for (ct = mrt->maxvif-1; ct >= 0; ct--) { 16200c12295aSPatrick McHardy if (mrt->vif_table[ct].dev == dev) 16211da177e4SLinus Torvalds break; 16221da177e4SLinus Torvalds } 16231da177e4SLinus Torvalds return ct; 16241da177e4SLinus Torvalds } 16251da177e4SLinus Torvalds 16261da177e4SLinus Torvalds /* "local" means that we should preserve one skb (for local delivery) */ 16271da177e4SLinus Torvalds 16280c12295aSPatrick McHardy static int ip_mr_forward(struct net *net, struct mr_table *mrt, 16290c12295aSPatrick McHardy struct sk_buff *skb, struct mfc_cache *cache, 16300c12295aSPatrick McHardy int local) 16311da177e4SLinus Torvalds { 16321da177e4SLinus Torvalds int psend = -1; 16331da177e4SLinus Torvalds int vif, ct; 16341da177e4SLinus Torvalds 16351da177e4SLinus Torvalds vif = cache->mfc_parent; 16361da177e4SLinus Torvalds cache->mfc_un.res.pkt++; 16371da177e4SLinus Torvalds cache->mfc_un.res.bytes += skb->len; 16381da177e4SLinus Torvalds 16391da177e4SLinus Torvalds /* 16401da177e4SLinus Torvalds * Wrong interface: drop packet and (maybe) send PIM assert. 16411da177e4SLinus Torvalds */ 16420c12295aSPatrick McHardy if (mrt->vif_table[vif].dev != skb->dev) { 16431da177e4SLinus Torvalds int true_vifi; 16441da177e4SLinus Torvalds 1645511c3f92SEric Dumazet if (skb_rtable(skb)->fl.iif == 0) { 16461da177e4SLinus Torvalds /* It is our own packet, looped back. 16471da177e4SLinus Torvalds Very complicated situation... 16481da177e4SLinus Torvalds 16491da177e4SLinus Torvalds The best workaround until routing daemons will be 16501da177e4SLinus Torvalds fixed is not to redistribute packet, if it was 16511da177e4SLinus Torvalds send through wrong interface. It means, that 16521da177e4SLinus Torvalds multicast applications WILL NOT work for 16531da177e4SLinus Torvalds (S,G), which have default multicast route pointing 16541da177e4SLinus Torvalds to wrong oif. In any case, it is not a good 16551da177e4SLinus Torvalds idea to use multicasting applications on router. 16561da177e4SLinus Torvalds */ 16571da177e4SLinus Torvalds goto dont_forward; 16581da177e4SLinus Torvalds } 16591da177e4SLinus Torvalds 16601da177e4SLinus Torvalds cache->mfc_un.res.wrong_if++; 16610c12295aSPatrick McHardy true_vifi = ipmr_find_vif(mrt, skb->dev); 16621da177e4SLinus Torvalds 16630c12295aSPatrick McHardy if (true_vifi >= 0 && mrt->mroute_do_assert && 16641da177e4SLinus Torvalds /* pimsm uses asserts, when switching from RPT to SPT, 16651da177e4SLinus Torvalds so that we cannot check that packet arrived on an oif. 16661da177e4SLinus Torvalds It is bad, but otherwise we would need to move pretty 16671da177e4SLinus Torvalds large chunk of pimd to kernel. Ough... --ANK 16681da177e4SLinus Torvalds */ 16690c12295aSPatrick McHardy (mrt->mroute_do_pim || 16706f9374a9SBenjamin Thery cache->mfc_un.res.ttls[true_vifi] < 255) && 16711da177e4SLinus Torvalds time_after(jiffies, 16721da177e4SLinus Torvalds cache->mfc_un.res.last_assert + MFC_ASSERT_THRESH)) { 16731da177e4SLinus Torvalds cache->mfc_un.res.last_assert = jiffies; 16740c12295aSPatrick McHardy ipmr_cache_report(mrt, skb, true_vifi, IGMPMSG_WRONGVIF); 16751da177e4SLinus Torvalds } 16761da177e4SLinus Torvalds goto dont_forward; 16771da177e4SLinus Torvalds } 16781da177e4SLinus Torvalds 16790c12295aSPatrick McHardy mrt->vif_table[vif].pkt_in++; 16800c12295aSPatrick McHardy mrt->vif_table[vif].bytes_in += skb->len; 16811da177e4SLinus Torvalds 16821da177e4SLinus Torvalds /* 16831da177e4SLinus Torvalds * Forward the frame 16841da177e4SLinus Torvalds */ 16851da177e4SLinus Torvalds for (ct = cache->mfc_un.res.maxvif-1; ct >= cache->mfc_un.res.minvif; ct--) { 1686eddc9ec5SArnaldo Carvalho de Melo if (ip_hdr(skb)->ttl > cache->mfc_un.res.ttls[ct]) { 16871da177e4SLinus Torvalds if (psend != -1) { 16881da177e4SLinus Torvalds struct sk_buff *skb2 = skb_clone(skb, GFP_ATOMIC); 16891da177e4SLinus Torvalds if (skb2) 16900c12295aSPatrick McHardy ipmr_queue_xmit(net, mrt, skb2, cache, 16910c12295aSPatrick McHardy psend); 16921da177e4SLinus Torvalds } 16931da177e4SLinus Torvalds psend = ct; 16941da177e4SLinus Torvalds } 16951da177e4SLinus Torvalds } 16961da177e4SLinus Torvalds if (psend != -1) { 16971da177e4SLinus Torvalds if (local) { 16981da177e4SLinus Torvalds struct sk_buff *skb2 = skb_clone(skb, GFP_ATOMIC); 16991da177e4SLinus Torvalds if (skb2) 17000c12295aSPatrick McHardy ipmr_queue_xmit(net, mrt, skb2, cache, psend); 17011da177e4SLinus Torvalds } else { 17020c12295aSPatrick McHardy ipmr_queue_xmit(net, mrt, skb, cache, psend); 17031da177e4SLinus Torvalds return 0; 17041da177e4SLinus Torvalds } 17051da177e4SLinus Torvalds } 17061da177e4SLinus Torvalds 17071da177e4SLinus Torvalds dont_forward: 17081da177e4SLinus Torvalds if (!local) 17091da177e4SLinus Torvalds kfree_skb(skb); 17101da177e4SLinus Torvalds return 0; 17111da177e4SLinus Torvalds } 17121da177e4SLinus Torvalds 17131da177e4SLinus Torvalds 17141da177e4SLinus Torvalds /* 17151da177e4SLinus Torvalds * Multicast packets for forwarding arrive here 17161da177e4SLinus Torvalds */ 17171da177e4SLinus Torvalds 17181da177e4SLinus Torvalds int ip_mr_input(struct sk_buff *skb) 17191da177e4SLinus Torvalds { 17201da177e4SLinus Torvalds struct mfc_cache *cache; 17214feb88e5SBenjamin Thery struct net *net = dev_net(skb->dev); 1722511c3f92SEric Dumazet int local = skb_rtable(skb)->rt_flags & RTCF_LOCAL; 1723f0ad0860SPatrick McHardy struct mr_table *mrt; 1724f0ad0860SPatrick McHardy int err; 17251da177e4SLinus Torvalds 17261da177e4SLinus Torvalds /* Packet is looped back after forward, it should not be 17271da177e4SLinus Torvalds forwarded second time, but still can be delivered locally. 17281da177e4SLinus Torvalds */ 17291da177e4SLinus Torvalds if (IPCB(skb)->flags&IPSKB_FORWARDED) 17301da177e4SLinus Torvalds goto dont_forward; 17311da177e4SLinus Torvalds 1732f0ad0860SPatrick McHardy err = ipmr_fib_lookup(net, &skb_rtable(skb)->fl, &mrt); 1733*e40dbc51SBen Greear if (err < 0) { 1734*e40dbc51SBen Greear kfree_skb(skb); 1735f0ad0860SPatrick McHardy return err; 1736*e40dbc51SBen Greear } 1737f0ad0860SPatrick McHardy 17381da177e4SLinus Torvalds if (!local) { 17391da177e4SLinus Torvalds if (IPCB(skb)->opt.router_alert) { 17401da177e4SLinus Torvalds if (ip_call_ra_chain(skb)) 17411da177e4SLinus Torvalds return 0; 1742eddc9ec5SArnaldo Carvalho de Melo } else if (ip_hdr(skb)->protocol == IPPROTO_IGMP){ 17431da177e4SLinus Torvalds /* IGMPv1 (and broken IGMPv2 implementations sort of 17441da177e4SLinus Torvalds Cisco IOS <= 11.2(8)) do not put router alert 17451da177e4SLinus Torvalds option to IGMP packets destined to routable 17461da177e4SLinus Torvalds groups. It is very bad, because it means 17471da177e4SLinus Torvalds that we can forward NO IGMP messages. 17481da177e4SLinus Torvalds */ 17491da177e4SLinus Torvalds read_lock(&mrt_lock); 17500c12295aSPatrick McHardy if (mrt->mroute_sk) { 17512715bcf9SPatrick McHardy nf_reset(skb); 17520c12295aSPatrick McHardy raw_rcv(mrt->mroute_sk, skb); 17531da177e4SLinus Torvalds read_unlock(&mrt_lock); 17541da177e4SLinus Torvalds return 0; 17551da177e4SLinus Torvalds } 17561da177e4SLinus Torvalds read_unlock(&mrt_lock); 17571da177e4SLinus Torvalds } 17581da177e4SLinus Torvalds } 17591da177e4SLinus Torvalds 17601da177e4SLinus Torvalds read_lock(&mrt_lock); 17610c12295aSPatrick McHardy cache = ipmr_cache_find(mrt, ip_hdr(skb)->saddr, ip_hdr(skb)->daddr); 17621da177e4SLinus Torvalds 17631da177e4SLinus Torvalds /* 17641da177e4SLinus Torvalds * No usable cache entry 17651da177e4SLinus Torvalds */ 17661da177e4SLinus Torvalds if (cache == NULL) { 17671da177e4SLinus Torvalds int vif; 17681da177e4SLinus Torvalds 17691da177e4SLinus Torvalds if (local) { 17701da177e4SLinus Torvalds struct sk_buff *skb2 = skb_clone(skb, GFP_ATOMIC); 17711da177e4SLinus Torvalds ip_local_deliver(skb); 17721da177e4SLinus Torvalds if (skb2 == NULL) { 17731da177e4SLinus Torvalds read_unlock(&mrt_lock); 17741da177e4SLinus Torvalds return -ENOBUFS; 17751da177e4SLinus Torvalds } 17761da177e4SLinus Torvalds skb = skb2; 17771da177e4SLinus Torvalds } 17781da177e4SLinus Torvalds 17790c12295aSPatrick McHardy vif = ipmr_find_vif(mrt, skb->dev); 17801da177e4SLinus Torvalds if (vif >= 0) { 17810eae88f3SEric Dumazet int err2 = ipmr_cache_unresolved(mrt, vif, skb); 17821da177e4SLinus Torvalds read_unlock(&mrt_lock); 17831da177e4SLinus Torvalds 17840eae88f3SEric Dumazet return err2; 17851da177e4SLinus Torvalds } 17861da177e4SLinus Torvalds read_unlock(&mrt_lock); 17871da177e4SLinus Torvalds kfree_skb(skb); 17881da177e4SLinus Torvalds return -ENODEV; 17891da177e4SLinus Torvalds } 17901da177e4SLinus Torvalds 17910c12295aSPatrick McHardy ip_mr_forward(net, mrt, skb, cache, local); 17921da177e4SLinus Torvalds 17931da177e4SLinus Torvalds read_unlock(&mrt_lock); 17941da177e4SLinus Torvalds 17951da177e4SLinus Torvalds if (local) 17961da177e4SLinus Torvalds return ip_local_deliver(skb); 17971da177e4SLinus Torvalds 17981da177e4SLinus Torvalds return 0; 17991da177e4SLinus Torvalds 18001da177e4SLinus Torvalds dont_forward: 18011da177e4SLinus Torvalds if (local) 18021da177e4SLinus Torvalds return ip_local_deliver(skb); 18031da177e4SLinus Torvalds kfree_skb(skb); 18041da177e4SLinus Torvalds return 0; 18051da177e4SLinus Torvalds } 18061da177e4SLinus Torvalds 1807b1879204SIlpo Järvinen #ifdef CONFIG_IP_PIMSM 1808f0ad0860SPatrick McHardy static int __pim_rcv(struct mr_table *mrt, struct sk_buff *skb, 1809f0ad0860SPatrick McHardy unsigned int pimlen) 18101da177e4SLinus Torvalds { 18111da177e4SLinus Torvalds struct net_device *reg_dev = NULL; 1812b1879204SIlpo Järvinen struct iphdr *encap; 18131da177e4SLinus Torvalds 1814b1879204SIlpo Järvinen encap = (struct iphdr *)(skb_transport_header(skb) + pimlen); 18151da177e4SLinus Torvalds /* 18161da177e4SLinus Torvalds Check that: 18171da177e4SLinus Torvalds a. packet is really destinted to a multicast group 18181da177e4SLinus Torvalds b. packet is not a NULL-REGISTER 18191da177e4SLinus Torvalds c. packet is not truncated 18201da177e4SLinus Torvalds */ 1821f97c1e0cSJoe Perches if (!ipv4_is_multicast(encap->daddr) || 18221da177e4SLinus Torvalds encap->tot_len == 0 || 1823b1879204SIlpo Järvinen ntohs(encap->tot_len) + pimlen > skb->len) 1824b1879204SIlpo Järvinen return 1; 18251da177e4SLinus Torvalds 18261da177e4SLinus Torvalds read_lock(&mrt_lock); 18270c12295aSPatrick McHardy if (mrt->mroute_reg_vif_num >= 0) 18280c12295aSPatrick McHardy reg_dev = mrt->vif_table[mrt->mroute_reg_vif_num].dev; 18291da177e4SLinus Torvalds if (reg_dev) 18301da177e4SLinus Torvalds dev_hold(reg_dev); 18311da177e4SLinus Torvalds read_unlock(&mrt_lock); 18321da177e4SLinus Torvalds 18331da177e4SLinus Torvalds if (reg_dev == NULL) 1834b1879204SIlpo Järvinen return 1; 18351da177e4SLinus Torvalds 1836b0e380b1SArnaldo Carvalho de Melo skb->mac_header = skb->network_header; 18371da177e4SLinus Torvalds skb_pull(skb, (u8*)encap - skb->data); 183831c7711bSArnaldo Carvalho de Melo skb_reset_network_header(skb); 18391da177e4SLinus Torvalds skb->protocol = htons(ETH_P_IP); 18401da177e4SLinus Torvalds skb->ip_summed = 0; 18411da177e4SLinus Torvalds skb->pkt_type = PACKET_HOST; 1842d19d56ddSEric Dumazet 1843d19d56ddSEric Dumazet skb_tunnel_rx(skb, reg_dev); 1844d19d56ddSEric Dumazet 18451da177e4SLinus Torvalds netif_rx(skb); 18461da177e4SLinus Torvalds dev_put(reg_dev); 1847b1879204SIlpo Järvinen 18481da177e4SLinus Torvalds return 0; 1849b1879204SIlpo Järvinen } 1850b1879204SIlpo Järvinen #endif 1851b1879204SIlpo Järvinen 1852b1879204SIlpo Järvinen #ifdef CONFIG_IP_PIMSM_V1 1853b1879204SIlpo Järvinen /* 1854b1879204SIlpo Järvinen * Handle IGMP messages of PIMv1 1855b1879204SIlpo Järvinen */ 1856b1879204SIlpo Järvinen 1857b1879204SIlpo Järvinen int pim_rcv_v1(struct sk_buff * skb) 1858b1879204SIlpo Järvinen { 1859b1879204SIlpo Järvinen struct igmphdr *pim; 18604feb88e5SBenjamin Thery struct net *net = dev_net(skb->dev); 1861f0ad0860SPatrick McHardy struct mr_table *mrt; 1862b1879204SIlpo Järvinen 1863b1879204SIlpo Järvinen if (!pskb_may_pull(skb, sizeof(*pim) + sizeof(struct iphdr))) 1864b1879204SIlpo Järvinen goto drop; 1865b1879204SIlpo Järvinen 1866b1879204SIlpo Järvinen pim = igmp_hdr(skb); 1867b1879204SIlpo Järvinen 1868f0ad0860SPatrick McHardy if (ipmr_fib_lookup(net, &skb_rtable(skb)->fl, &mrt) < 0) 1869f0ad0860SPatrick McHardy goto drop; 1870f0ad0860SPatrick McHardy 18710c12295aSPatrick McHardy if (!mrt->mroute_do_pim || 1872b1879204SIlpo Järvinen pim->group != PIM_V1_VERSION || pim->code != PIM_V1_REGISTER) 1873b1879204SIlpo Järvinen goto drop; 1874b1879204SIlpo Järvinen 1875f0ad0860SPatrick McHardy if (__pim_rcv(mrt, skb, sizeof(*pim))) { 18761da177e4SLinus Torvalds drop: 18771da177e4SLinus Torvalds kfree_skb(skb); 1878b1879204SIlpo Järvinen } 18791da177e4SLinus Torvalds return 0; 18801da177e4SLinus Torvalds } 18811da177e4SLinus Torvalds #endif 18821da177e4SLinus Torvalds 18831da177e4SLinus Torvalds #ifdef CONFIG_IP_PIMSM_V2 18841da177e4SLinus Torvalds static int pim_rcv(struct sk_buff * skb) 18851da177e4SLinus Torvalds { 18861da177e4SLinus Torvalds struct pimreghdr *pim; 1887f0ad0860SPatrick McHardy struct net *net = dev_net(skb->dev); 1888f0ad0860SPatrick McHardy struct mr_table *mrt; 18891da177e4SLinus Torvalds 1890b1879204SIlpo Järvinen if (!pskb_may_pull(skb, sizeof(*pim) + sizeof(struct iphdr))) 18911da177e4SLinus Torvalds goto drop; 18921da177e4SLinus Torvalds 18939c70220bSArnaldo Carvalho de Melo pim = (struct pimreghdr *)skb_transport_header(skb); 18941da177e4SLinus Torvalds if (pim->type != ((PIM_VERSION<<4)|(PIM_REGISTER)) || 18951da177e4SLinus Torvalds (pim->flags&PIM_NULL_REGISTER) || 18961da177e4SLinus Torvalds (ip_compute_csum((void *)pim, sizeof(*pim)) != 0 && 1897d3bc23e7SAl Viro csum_fold(skb_checksum(skb, 0, skb->len, 0)))) 18981da177e4SLinus Torvalds goto drop; 18991da177e4SLinus Torvalds 1900f0ad0860SPatrick McHardy if (ipmr_fib_lookup(net, &skb_rtable(skb)->fl, &mrt) < 0) 1901f0ad0860SPatrick McHardy goto drop; 1902f0ad0860SPatrick McHardy 1903f0ad0860SPatrick McHardy if (__pim_rcv(mrt, skb, sizeof(*pim))) { 19041da177e4SLinus Torvalds drop: 19051da177e4SLinus Torvalds kfree_skb(skb); 1906b1879204SIlpo Järvinen } 19071da177e4SLinus Torvalds return 0; 19081da177e4SLinus Torvalds } 19091da177e4SLinus Torvalds #endif 19101da177e4SLinus Torvalds 1911cb6a4e46SPatrick McHardy static int __ipmr_fill_mroute(struct mr_table *mrt, struct sk_buff *skb, 1912cb6a4e46SPatrick McHardy struct mfc_cache *c, struct rtmsg *rtm) 19131da177e4SLinus Torvalds { 19141da177e4SLinus Torvalds int ct; 19151da177e4SLinus Torvalds struct rtnexthop *nhp; 191627a884dcSArnaldo Carvalho de Melo u8 *b = skb_tail_pointer(skb); 19171da177e4SLinus Torvalds struct rtattr *mp_head; 19181da177e4SLinus Torvalds 19197438189bSNicolas Dichtel /* If cache is unresolved, don't try to parse IIF and OIF */ 1920ed0f160aSDan Carpenter if (c->mfc_parent >= MAXVIFS) 19217438189bSNicolas Dichtel return -ENOENT; 19227438189bSNicolas Dichtel 19230c12295aSPatrick McHardy if (VIF_EXISTS(mrt, c->mfc_parent)) 19240c12295aSPatrick McHardy RTA_PUT(skb, RTA_IIF, 4, &mrt->vif_table[c->mfc_parent].dev->ifindex); 19251da177e4SLinus Torvalds 19261da177e4SLinus Torvalds mp_head = (struct rtattr *)skb_put(skb, RTA_LENGTH(0)); 19271da177e4SLinus Torvalds 19281da177e4SLinus Torvalds for (ct = c->mfc_un.res.minvif; ct < c->mfc_un.res.maxvif; ct++) { 19290c12295aSPatrick McHardy if (VIF_EXISTS(mrt, ct) && c->mfc_un.res.ttls[ct] < 255) { 19301da177e4SLinus Torvalds if (skb_tailroom(skb) < RTA_ALIGN(RTA_ALIGN(sizeof(*nhp)) + 4)) 19311da177e4SLinus Torvalds goto rtattr_failure; 19321da177e4SLinus Torvalds nhp = (struct rtnexthop *)skb_put(skb, RTA_ALIGN(sizeof(*nhp))); 19331da177e4SLinus Torvalds nhp->rtnh_flags = 0; 19341da177e4SLinus Torvalds nhp->rtnh_hops = c->mfc_un.res.ttls[ct]; 19350c12295aSPatrick McHardy nhp->rtnh_ifindex = mrt->vif_table[ct].dev->ifindex; 19361da177e4SLinus Torvalds nhp->rtnh_len = sizeof(*nhp); 19371da177e4SLinus Torvalds } 19381da177e4SLinus Torvalds } 19391da177e4SLinus Torvalds mp_head->rta_type = RTA_MULTIPATH; 194027a884dcSArnaldo Carvalho de Melo mp_head->rta_len = skb_tail_pointer(skb) - (u8 *)mp_head; 19411da177e4SLinus Torvalds rtm->rtm_type = RTN_MULTICAST; 19421da177e4SLinus Torvalds return 1; 19431da177e4SLinus Torvalds 19441da177e4SLinus Torvalds rtattr_failure: 1945dc5fc579SArnaldo Carvalho de Melo nlmsg_trim(skb, b); 19461da177e4SLinus Torvalds return -EMSGSIZE; 19471da177e4SLinus Torvalds } 19481da177e4SLinus Torvalds 19494feb88e5SBenjamin Thery int ipmr_get_route(struct net *net, 19504feb88e5SBenjamin Thery struct sk_buff *skb, struct rtmsg *rtm, int nowait) 19511da177e4SLinus Torvalds { 19521da177e4SLinus Torvalds int err; 1953f0ad0860SPatrick McHardy struct mr_table *mrt; 19541da177e4SLinus Torvalds struct mfc_cache *cache; 1955511c3f92SEric Dumazet struct rtable *rt = skb_rtable(skb); 19561da177e4SLinus Torvalds 1957f0ad0860SPatrick McHardy mrt = ipmr_get_table(net, RT_TABLE_DEFAULT); 1958f0ad0860SPatrick McHardy if (mrt == NULL) 1959f0ad0860SPatrick McHardy return -ENOENT; 1960f0ad0860SPatrick McHardy 19611da177e4SLinus Torvalds read_lock(&mrt_lock); 19620c12295aSPatrick McHardy cache = ipmr_cache_find(mrt, rt->rt_src, rt->rt_dst); 19631da177e4SLinus Torvalds 19641da177e4SLinus Torvalds if (cache == NULL) { 196572287490SAlexey Kuznetsov struct sk_buff *skb2; 1966eddc9ec5SArnaldo Carvalho de Melo struct iphdr *iph; 19671da177e4SLinus Torvalds struct net_device *dev; 19681da177e4SLinus Torvalds int vif; 19691da177e4SLinus Torvalds 19701da177e4SLinus Torvalds if (nowait) { 19711da177e4SLinus Torvalds read_unlock(&mrt_lock); 19721da177e4SLinus Torvalds return -EAGAIN; 19731da177e4SLinus Torvalds } 19741da177e4SLinus Torvalds 19751da177e4SLinus Torvalds dev = skb->dev; 19760c12295aSPatrick McHardy if (dev == NULL || (vif = ipmr_find_vif(mrt, dev)) < 0) { 19771da177e4SLinus Torvalds read_unlock(&mrt_lock); 19781da177e4SLinus Torvalds return -ENODEV; 19791da177e4SLinus Torvalds } 198072287490SAlexey Kuznetsov skb2 = skb_clone(skb, GFP_ATOMIC); 198172287490SAlexey Kuznetsov if (!skb2) { 198272287490SAlexey Kuznetsov read_unlock(&mrt_lock); 198372287490SAlexey Kuznetsov return -ENOMEM; 198472287490SAlexey Kuznetsov } 198572287490SAlexey Kuznetsov 1986e2d1bca7SArnaldo Carvalho de Melo skb_push(skb2, sizeof(struct iphdr)); 1987e2d1bca7SArnaldo Carvalho de Melo skb_reset_network_header(skb2); 1988eddc9ec5SArnaldo Carvalho de Melo iph = ip_hdr(skb2); 1989eddc9ec5SArnaldo Carvalho de Melo iph->ihl = sizeof(struct iphdr) >> 2; 1990eddc9ec5SArnaldo Carvalho de Melo iph->saddr = rt->rt_src; 1991eddc9ec5SArnaldo Carvalho de Melo iph->daddr = rt->rt_dst; 1992eddc9ec5SArnaldo Carvalho de Melo iph->version = 0; 19930c12295aSPatrick McHardy err = ipmr_cache_unresolved(mrt, vif, skb2); 19941da177e4SLinus Torvalds read_unlock(&mrt_lock); 19951da177e4SLinus Torvalds return err; 19961da177e4SLinus Torvalds } 19971da177e4SLinus Torvalds 19981da177e4SLinus Torvalds if (!nowait && (rtm->rtm_flags&RTM_F_NOTIFY)) 19991da177e4SLinus Torvalds cache->mfc_flags |= MFC_NOTIFY; 2000cb6a4e46SPatrick McHardy err = __ipmr_fill_mroute(mrt, skb, cache, rtm); 20011da177e4SLinus Torvalds read_unlock(&mrt_lock); 20021da177e4SLinus Torvalds return err; 20031da177e4SLinus Torvalds } 20041da177e4SLinus Torvalds 2005cb6a4e46SPatrick McHardy static int ipmr_fill_mroute(struct mr_table *mrt, struct sk_buff *skb, 2006cb6a4e46SPatrick McHardy u32 pid, u32 seq, struct mfc_cache *c) 2007cb6a4e46SPatrick McHardy { 2008cb6a4e46SPatrick McHardy struct nlmsghdr *nlh; 2009cb6a4e46SPatrick McHardy struct rtmsg *rtm; 2010cb6a4e46SPatrick McHardy 2011cb6a4e46SPatrick McHardy nlh = nlmsg_put(skb, pid, seq, RTM_NEWROUTE, sizeof(*rtm), NLM_F_MULTI); 2012cb6a4e46SPatrick McHardy if (nlh == NULL) 2013cb6a4e46SPatrick McHardy return -EMSGSIZE; 2014cb6a4e46SPatrick McHardy 2015cb6a4e46SPatrick McHardy rtm = nlmsg_data(nlh); 2016cb6a4e46SPatrick McHardy rtm->rtm_family = RTNL_FAMILY_IPMR; 2017cb6a4e46SPatrick McHardy rtm->rtm_dst_len = 32; 2018cb6a4e46SPatrick McHardy rtm->rtm_src_len = 32; 2019cb6a4e46SPatrick McHardy rtm->rtm_tos = 0; 2020cb6a4e46SPatrick McHardy rtm->rtm_table = mrt->id; 2021cb6a4e46SPatrick McHardy NLA_PUT_U32(skb, RTA_TABLE, mrt->id); 2022cb6a4e46SPatrick McHardy rtm->rtm_type = RTN_MULTICAST; 2023cb6a4e46SPatrick McHardy rtm->rtm_scope = RT_SCOPE_UNIVERSE; 2024cb6a4e46SPatrick McHardy rtm->rtm_protocol = RTPROT_UNSPEC; 2025cb6a4e46SPatrick McHardy rtm->rtm_flags = 0; 2026cb6a4e46SPatrick McHardy 2027cb6a4e46SPatrick McHardy NLA_PUT_BE32(skb, RTA_SRC, c->mfc_origin); 2028cb6a4e46SPatrick McHardy NLA_PUT_BE32(skb, RTA_DST, c->mfc_mcastgrp); 2029cb6a4e46SPatrick McHardy 2030cb6a4e46SPatrick McHardy if (__ipmr_fill_mroute(mrt, skb, c, rtm) < 0) 2031cb6a4e46SPatrick McHardy goto nla_put_failure; 2032cb6a4e46SPatrick McHardy 2033cb6a4e46SPatrick McHardy return nlmsg_end(skb, nlh); 2034cb6a4e46SPatrick McHardy 2035cb6a4e46SPatrick McHardy nla_put_failure: 2036cb6a4e46SPatrick McHardy nlmsg_cancel(skb, nlh); 2037cb6a4e46SPatrick McHardy return -EMSGSIZE; 2038cb6a4e46SPatrick McHardy } 2039cb6a4e46SPatrick McHardy 2040cb6a4e46SPatrick McHardy static int ipmr_rtm_dumproute(struct sk_buff *skb, struct netlink_callback *cb) 2041cb6a4e46SPatrick McHardy { 2042cb6a4e46SPatrick McHardy struct net *net = sock_net(skb->sk); 2043cb6a4e46SPatrick McHardy struct mr_table *mrt; 2044cb6a4e46SPatrick McHardy struct mfc_cache *mfc; 2045cb6a4e46SPatrick McHardy unsigned int t = 0, s_t; 2046cb6a4e46SPatrick McHardy unsigned int h = 0, s_h; 2047cb6a4e46SPatrick McHardy unsigned int e = 0, s_e; 2048cb6a4e46SPatrick McHardy 2049cb6a4e46SPatrick McHardy s_t = cb->args[0]; 2050cb6a4e46SPatrick McHardy s_h = cb->args[1]; 2051cb6a4e46SPatrick McHardy s_e = cb->args[2]; 2052cb6a4e46SPatrick McHardy 2053cb6a4e46SPatrick McHardy read_lock(&mrt_lock); 2054cb6a4e46SPatrick McHardy ipmr_for_each_table(mrt, net) { 2055cb6a4e46SPatrick McHardy if (t < s_t) 2056cb6a4e46SPatrick McHardy goto next_table; 2057cb6a4e46SPatrick McHardy if (t > s_t) 2058cb6a4e46SPatrick McHardy s_h = 0; 2059cb6a4e46SPatrick McHardy for (h = s_h; h < MFC_LINES; h++) { 2060cb6a4e46SPatrick McHardy list_for_each_entry(mfc, &mrt->mfc_cache_array[h], list) { 2061cb6a4e46SPatrick McHardy if (e < s_e) 2062cb6a4e46SPatrick McHardy goto next_entry; 2063cb6a4e46SPatrick McHardy if (ipmr_fill_mroute(mrt, skb, 2064cb6a4e46SPatrick McHardy NETLINK_CB(cb->skb).pid, 2065cb6a4e46SPatrick McHardy cb->nlh->nlmsg_seq, 2066cb6a4e46SPatrick McHardy mfc) < 0) 2067cb6a4e46SPatrick McHardy goto done; 2068cb6a4e46SPatrick McHardy next_entry: 2069cb6a4e46SPatrick McHardy e++; 2070cb6a4e46SPatrick McHardy } 2071cb6a4e46SPatrick McHardy e = s_e = 0; 2072cb6a4e46SPatrick McHardy } 2073cb6a4e46SPatrick McHardy s_h = 0; 2074cb6a4e46SPatrick McHardy next_table: 2075cb6a4e46SPatrick McHardy t++; 2076cb6a4e46SPatrick McHardy } 2077cb6a4e46SPatrick McHardy done: 2078cb6a4e46SPatrick McHardy read_unlock(&mrt_lock); 2079cb6a4e46SPatrick McHardy 2080cb6a4e46SPatrick McHardy cb->args[2] = e; 2081cb6a4e46SPatrick McHardy cb->args[1] = h; 2082cb6a4e46SPatrick McHardy cb->args[0] = t; 2083cb6a4e46SPatrick McHardy 2084cb6a4e46SPatrick McHardy return skb->len; 2085cb6a4e46SPatrick McHardy } 2086cb6a4e46SPatrick McHardy 20871da177e4SLinus Torvalds #ifdef CONFIG_PROC_FS 20881da177e4SLinus Torvalds /* 20891da177e4SLinus Torvalds * The /proc interfaces to multicast routing /proc/ip_mr_cache /proc/ip_mr_vif 20901da177e4SLinus Torvalds */ 20911da177e4SLinus Torvalds struct ipmr_vif_iter { 2092f6bb4514SBenjamin Thery struct seq_net_private p; 2093f0ad0860SPatrick McHardy struct mr_table *mrt; 20941da177e4SLinus Torvalds int ct; 20951da177e4SLinus Torvalds }; 20961da177e4SLinus Torvalds 2097f6bb4514SBenjamin Thery static struct vif_device *ipmr_vif_seq_idx(struct net *net, 2098f6bb4514SBenjamin Thery struct ipmr_vif_iter *iter, 20991da177e4SLinus Torvalds loff_t pos) 21001da177e4SLinus Torvalds { 2101f0ad0860SPatrick McHardy struct mr_table *mrt = iter->mrt; 21020c12295aSPatrick McHardy 21030c12295aSPatrick McHardy for (iter->ct = 0; iter->ct < mrt->maxvif; ++iter->ct) { 21040c12295aSPatrick McHardy if (!VIF_EXISTS(mrt, iter->ct)) 21051da177e4SLinus Torvalds continue; 21061da177e4SLinus Torvalds if (pos-- == 0) 21070c12295aSPatrick McHardy return &mrt->vif_table[iter->ct]; 21081da177e4SLinus Torvalds } 21091da177e4SLinus Torvalds return NULL; 21101da177e4SLinus Torvalds } 21111da177e4SLinus Torvalds 21121da177e4SLinus Torvalds static void *ipmr_vif_seq_start(struct seq_file *seq, loff_t *pos) 2113ba93ef74SStephen Hemminger __acquires(mrt_lock) 21141da177e4SLinus Torvalds { 2115f0ad0860SPatrick McHardy struct ipmr_vif_iter *iter = seq->private; 2116f6bb4514SBenjamin Thery struct net *net = seq_file_net(seq); 2117f0ad0860SPatrick McHardy struct mr_table *mrt; 2118f0ad0860SPatrick McHardy 2119f0ad0860SPatrick McHardy mrt = ipmr_get_table(net, RT_TABLE_DEFAULT); 2120f0ad0860SPatrick McHardy if (mrt == NULL) 2121f0ad0860SPatrick McHardy return ERR_PTR(-ENOENT); 2122f0ad0860SPatrick McHardy 2123f0ad0860SPatrick McHardy iter->mrt = mrt; 2124f6bb4514SBenjamin Thery 21251da177e4SLinus Torvalds read_lock(&mrt_lock); 2126f6bb4514SBenjamin Thery return *pos ? ipmr_vif_seq_idx(net, seq->private, *pos - 1) 21271da177e4SLinus Torvalds : SEQ_START_TOKEN; 21281da177e4SLinus Torvalds } 21291da177e4SLinus Torvalds 21301da177e4SLinus Torvalds static void *ipmr_vif_seq_next(struct seq_file *seq, void *v, loff_t *pos) 21311da177e4SLinus Torvalds { 21321da177e4SLinus Torvalds struct ipmr_vif_iter *iter = seq->private; 2133f6bb4514SBenjamin Thery struct net *net = seq_file_net(seq); 2134f0ad0860SPatrick McHardy struct mr_table *mrt = iter->mrt; 21351da177e4SLinus Torvalds 21361da177e4SLinus Torvalds ++*pos; 21371da177e4SLinus Torvalds if (v == SEQ_START_TOKEN) 2138f6bb4514SBenjamin Thery return ipmr_vif_seq_idx(net, iter, 0); 21391da177e4SLinus Torvalds 21400c12295aSPatrick McHardy while (++iter->ct < mrt->maxvif) { 21410c12295aSPatrick McHardy if (!VIF_EXISTS(mrt, iter->ct)) 21421da177e4SLinus Torvalds continue; 21430c12295aSPatrick McHardy return &mrt->vif_table[iter->ct]; 21441da177e4SLinus Torvalds } 21451da177e4SLinus Torvalds return NULL; 21461da177e4SLinus Torvalds } 21471da177e4SLinus Torvalds 21481da177e4SLinus Torvalds static void ipmr_vif_seq_stop(struct seq_file *seq, void *v) 2149ba93ef74SStephen Hemminger __releases(mrt_lock) 21501da177e4SLinus Torvalds { 21511da177e4SLinus Torvalds read_unlock(&mrt_lock); 21521da177e4SLinus Torvalds } 21531da177e4SLinus Torvalds 21541da177e4SLinus Torvalds static int ipmr_vif_seq_show(struct seq_file *seq, void *v) 21551da177e4SLinus Torvalds { 2156f0ad0860SPatrick McHardy struct ipmr_vif_iter *iter = seq->private; 2157f0ad0860SPatrick McHardy struct mr_table *mrt = iter->mrt; 2158f6bb4514SBenjamin Thery 21591da177e4SLinus Torvalds if (v == SEQ_START_TOKEN) { 21601da177e4SLinus Torvalds seq_puts(seq, 21611da177e4SLinus Torvalds "Interface BytesIn PktsIn BytesOut PktsOut Flags Local Remote\n"); 21621da177e4SLinus Torvalds } else { 21631da177e4SLinus Torvalds const struct vif_device *vif = v; 21641da177e4SLinus Torvalds const char *name = vif->dev ? vif->dev->name : "none"; 21651da177e4SLinus Torvalds 21661da177e4SLinus Torvalds seq_printf(seq, 21671da177e4SLinus Torvalds "%2Zd %-10s %8ld %7ld %8ld %7ld %05X %08X %08X\n", 21680c12295aSPatrick McHardy vif - mrt->vif_table, 21691da177e4SLinus Torvalds name, vif->bytes_in, vif->pkt_in, 21701da177e4SLinus Torvalds vif->bytes_out, vif->pkt_out, 21711da177e4SLinus Torvalds vif->flags, vif->local, vif->remote); 21721da177e4SLinus Torvalds } 21731da177e4SLinus Torvalds return 0; 21741da177e4SLinus Torvalds } 21751da177e4SLinus Torvalds 2176f690808eSStephen Hemminger static const struct seq_operations ipmr_vif_seq_ops = { 21771da177e4SLinus Torvalds .start = ipmr_vif_seq_start, 21781da177e4SLinus Torvalds .next = ipmr_vif_seq_next, 21791da177e4SLinus Torvalds .stop = ipmr_vif_seq_stop, 21801da177e4SLinus Torvalds .show = ipmr_vif_seq_show, 21811da177e4SLinus Torvalds }; 21821da177e4SLinus Torvalds 21831da177e4SLinus Torvalds static int ipmr_vif_open(struct inode *inode, struct file *file) 21841da177e4SLinus Torvalds { 2185f6bb4514SBenjamin Thery return seq_open_net(inode, file, &ipmr_vif_seq_ops, 2186cf7732e4SPavel Emelyanov sizeof(struct ipmr_vif_iter)); 21871da177e4SLinus Torvalds } 21881da177e4SLinus Torvalds 21899a32144eSArjan van de Ven static const struct file_operations ipmr_vif_fops = { 21901da177e4SLinus Torvalds .owner = THIS_MODULE, 21911da177e4SLinus Torvalds .open = ipmr_vif_open, 21921da177e4SLinus Torvalds .read = seq_read, 21931da177e4SLinus Torvalds .llseek = seq_lseek, 2194f6bb4514SBenjamin Thery .release = seq_release_net, 21951da177e4SLinus Torvalds }; 21961da177e4SLinus Torvalds 21971da177e4SLinus Torvalds struct ipmr_mfc_iter { 2198f6bb4514SBenjamin Thery struct seq_net_private p; 2199f0ad0860SPatrick McHardy struct mr_table *mrt; 2200862465f2SPatrick McHardy struct list_head *cache; 22011da177e4SLinus Torvalds int ct; 22021da177e4SLinus Torvalds }; 22031da177e4SLinus Torvalds 22041da177e4SLinus Torvalds 2205f6bb4514SBenjamin Thery static struct mfc_cache *ipmr_mfc_seq_idx(struct net *net, 2206f6bb4514SBenjamin Thery struct ipmr_mfc_iter *it, loff_t pos) 22071da177e4SLinus Torvalds { 2208f0ad0860SPatrick McHardy struct mr_table *mrt = it->mrt; 22091da177e4SLinus Torvalds struct mfc_cache *mfc; 22101da177e4SLinus Torvalds 22111da177e4SLinus Torvalds read_lock(&mrt_lock); 2212862465f2SPatrick McHardy for (it->ct = 0; it->ct < MFC_LINES; it->ct++) { 22130c12295aSPatrick McHardy it->cache = &mrt->mfc_cache_array[it->ct]; 2214862465f2SPatrick McHardy list_for_each_entry(mfc, it->cache, list) 22151da177e4SLinus Torvalds if (pos-- == 0) 22161da177e4SLinus Torvalds return mfc; 2217862465f2SPatrick McHardy } 22181da177e4SLinus Torvalds read_unlock(&mrt_lock); 22191da177e4SLinus Torvalds 22201da177e4SLinus Torvalds spin_lock_bh(&mfc_unres_lock); 22210c12295aSPatrick McHardy it->cache = &mrt->mfc_unres_queue; 2222862465f2SPatrick McHardy list_for_each_entry(mfc, it->cache, list) 2223e258beb2SPatrick McHardy if (pos-- == 0) 22241da177e4SLinus Torvalds return mfc; 22251da177e4SLinus Torvalds spin_unlock_bh(&mfc_unres_lock); 22261da177e4SLinus Torvalds 22271da177e4SLinus Torvalds it->cache = NULL; 22281da177e4SLinus Torvalds return NULL; 22291da177e4SLinus Torvalds } 22301da177e4SLinus Torvalds 22311da177e4SLinus Torvalds 22321da177e4SLinus Torvalds static void *ipmr_mfc_seq_start(struct seq_file *seq, loff_t *pos) 22331da177e4SLinus Torvalds { 22341da177e4SLinus Torvalds struct ipmr_mfc_iter *it = seq->private; 2235f6bb4514SBenjamin Thery struct net *net = seq_file_net(seq); 2236f0ad0860SPatrick McHardy struct mr_table *mrt; 2237f6bb4514SBenjamin Thery 2238f0ad0860SPatrick McHardy mrt = ipmr_get_table(net, RT_TABLE_DEFAULT); 2239f0ad0860SPatrick McHardy if (mrt == NULL) 2240f0ad0860SPatrick McHardy return ERR_PTR(-ENOENT); 2241f0ad0860SPatrick McHardy 2242f0ad0860SPatrick McHardy it->mrt = mrt; 22431da177e4SLinus Torvalds it->cache = NULL; 22441da177e4SLinus Torvalds it->ct = 0; 2245f6bb4514SBenjamin Thery return *pos ? ipmr_mfc_seq_idx(net, seq->private, *pos - 1) 22461da177e4SLinus Torvalds : SEQ_START_TOKEN; 22471da177e4SLinus Torvalds } 22481da177e4SLinus Torvalds 22491da177e4SLinus Torvalds static void *ipmr_mfc_seq_next(struct seq_file *seq, void *v, loff_t *pos) 22501da177e4SLinus Torvalds { 22511da177e4SLinus Torvalds struct mfc_cache *mfc = v; 22521da177e4SLinus Torvalds struct ipmr_mfc_iter *it = seq->private; 2253f6bb4514SBenjamin Thery struct net *net = seq_file_net(seq); 2254f0ad0860SPatrick McHardy struct mr_table *mrt = it->mrt; 22551da177e4SLinus Torvalds 22561da177e4SLinus Torvalds ++*pos; 22571da177e4SLinus Torvalds 22581da177e4SLinus Torvalds if (v == SEQ_START_TOKEN) 2259f6bb4514SBenjamin Thery return ipmr_mfc_seq_idx(net, seq->private, 0); 22601da177e4SLinus Torvalds 2261862465f2SPatrick McHardy if (mfc->list.next != it->cache) 2262862465f2SPatrick McHardy return list_entry(mfc->list.next, struct mfc_cache, list); 22631da177e4SLinus Torvalds 22640c12295aSPatrick McHardy if (it->cache == &mrt->mfc_unres_queue) 22651da177e4SLinus Torvalds goto end_of_list; 22661da177e4SLinus Torvalds 22670c12295aSPatrick McHardy BUG_ON(it->cache != &mrt->mfc_cache_array[it->ct]); 22681da177e4SLinus Torvalds 22691da177e4SLinus Torvalds while (++it->ct < MFC_LINES) { 22700c12295aSPatrick McHardy it->cache = &mrt->mfc_cache_array[it->ct]; 2271862465f2SPatrick McHardy if (list_empty(it->cache)) 2272862465f2SPatrick McHardy continue; 2273862465f2SPatrick McHardy return list_first_entry(it->cache, struct mfc_cache, list); 22741da177e4SLinus Torvalds } 22751da177e4SLinus Torvalds 22761da177e4SLinus Torvalds /* exhausted cache_array, show unresolved */ 22771da177e4SLinus Torvalds read_unlock(&mrt_lock); 22780c12295aSPatrick McHardy it->cache = &mrt->mfc_unres_queue; 22791da177e4SLinus Torvalds it->ct = 0; 22801da177e4SLinus Torvalds 22811da177e4SLinus Torvalds spin_lock_bh(&mfc_unres_lock); 2282862465f2SPatrick McHardy if (!list_empty(it->cache)) 2283862465f2SPatrick McHardy return list_first_entry(it->cache, struct mfc_cache, list); 22841da177e4SLinus Torvalds 22851da177e4SLinus Torvalds end_of_list: 22861da177e4SLinus Torvalds spin_unlock_bh(&mfc_unres_lock); 22871da177e4SLinus Torvalds it->cache = NULL; 22881da177e4SLinus Torvalds 22891da177e4SLinus Torvalds return NULL; 22901da177e4SLinus Torvalds } 22911da177e4SLinus Torvalds 22921da177e4SLinus Torvalds static void ipmr_mfc_seq_stop(struct seq_file *seq, void *v) 22931da177e4SLinus Torvalds { 22941da177e4SLinus Torvalds struct ipmr_mfc_iter *it = seq->private; 2295f0ad0860SPatrick McHardy struct mr_table *mrt = it->mrt; 22961da177e4SLinus Torvalds 22970c12295aSPatrick McHardy if (it->cache == &mrt->mfc_unres_queue) 22981da177e4SLinus Torvalds spin_unlock_bh(&mfc_unres_lock); 22990c12295aSPatrick McHardy else if (it->cache == &mrt->mfc_cache_array[it->ct]) 23001da177e4SLinus Torvalds read_unlock(&mrt_lock); 23011da177e4SLinus Torvalds } 23021da177e4SLinus Torvalds 23031da177e4SLinus Torvalds static int ipmr_mfc_seq_show(struct seq_file *seq, void *v) 23041da177e4SLinus Torvalds { 23051da177e4SLinus Torvalds int n; 23061da177e4SLinus Torvalds 23071da177e4SLinus Torvalds if (v == SEQ_START_TOKEN) { 23081da177e4SLinus Torvalds seq_puts(seq, 23091da177e4SLinus Torvalds "Group Origin Iif Pkts Bytes Wrong Oifs\n"); 23101da177e4SLinus Torvalds } else { 23111da177e4SLinus Torvalds const struct mfc_cache *mfc = v; 23121da177e4SLinus Torvalds const struct ipmr_mfc_iter *it = seq->private; 2313f0ad0860SPatrick McHardy const struct mr_table *mrt = it->mrt; 23141da177e4SLinus Torvalds 23150eae88f3SEric Dumazet seq_printf(seq, "%08X %08X %-3hd", 23160eae88f3SEric Dumazet (__force u32) mfc->mfc_mcastgrp, 23170eae88f3SEric Dumazet (__force u32) mfc->mfc_origin, 23181ea472e2SBenjamin Thery mfc->mfc_parent); 23191ea472e2SBenjamin Thery 23200c12295aSPatrick McHardy if (it->cache != &mrt->mfc_unres_queue) { 23211ea472e2SBenjamin Thery seq_printf(seq, " %8lu %8lu %8lu", 23221da177e4SLinus Torvalds mfc->mfc_un.res.pkt, 23231da177e4SLinus Torvalds mfc->mfc_un.res.bytes, 23241da177e4SLinus Torvalds mfc->mfc_un.res.wrong_if); 23251da177e4SLinus Torvalds for (n = mfc->mfc_un.res.minvif; 23261da177e4SLinus Torvalds n < mfc->mfc_un.res.maxvif; n++ ) { 23270c12295aSPatrick McHardy if (VIF_EXISTS(mrt, n) && 2328cf958ae3SBenjamin Thery mfc->mfc_un.res.ttls[n] < 255) 23291da177e4SLinus Torvalds seq_printf(seq, 23301da177e4SLinus Torvalds " %2d:%-3d", 23311da177e4SLinus Torvalds n, mfc->mfc_un.res.ttls[n]); 23321da177e4SLinus Torvalds } 23331ea472e2SBenjamin Thery } else { 23341ea472e2SBenjamin Thery /* unresolved mfc_caches don't contain 23351ea472e2SBenjamin Thery * pkt, bytes and wrong_if values 23361ea472e2SBenjamin Thery */ 23371ea472e2SBenjamin Thery seq_printf(seq, " %8lu %8lu %8lu", 0ul, 0ul, 0ul); 23381da177e4SLinus Torvalds } 23391da177e4SLinus Torvalds seq_putc(seq, '\n'); 23401da177e4SLinus Torvalds } 23411da177e4SLinus Torvalds return 0; 23421da177e4SLinus Torvalds } 23431da177e4SLinus Torvalds 2344f690808eSStephen Hemminger static const struct seq_operations ipmr_mfc_seq_ops = { 23451da177e4SLinus Torvalds .start = ipmr_mfc_seq_start, 23461da177e4SLinus Torvalds .next = ipmr_mfc_seq_next, 23471da177e4SLinus Torvalds .stop = ipmr_mfc_seq_stop, 23481da177e4SLinus Torvalds .show = ipmr_mfc_seq_show, 23491da177e4SLinus Torvalds }; 23501da177e4SLinus Torvalds 23511da177e4SLinus Torvalds static int ipmr_mfc_open(struct inode *inode, struct file *file) 23521da177e4SLinus Torvalds { 2353f6bb4514SBenjamin Thery return seq_open_net(inode, file, &ipmr_mfc_seq_ops, 2354cf7732e4SPavel Emelyanov sizeof(struct ipmr_mfc_iter)); 23551da177e4SLinus Torvalds } 23561da177e4SLinus Torvalds 23579a32144eSArjan van de Ven static const struct file_operations ipmr_mfc_fops = { 23581da177e4SLinus Torvalds .owner = THIS_MODULE, 23591da177e4SLinus Torvalds .open = ipmr_mfc_open, 23601da177e4SLinus Torvalds .read = seq_read, 23611da177e4SLinus Torvalds .llseek = seq_lseek, 2362f6bb4514SBenjamin Thery .release = seq_release_net, 23631da177e4SLinus Torvalds }; 23641da177e4SLinus Torvalds #endif 23651da177e4SLinus Torvalds 23661da177e4SLinus Torvalds #ifdef CONFIG_IP_PIMSM_V2 236732613090SAlexey Dobriyan static const struct net_protocol pim_protocol = { 23681da177e4SLinus Torvalds .handler = pim_rcv, 2369403dbb97STom Goff .netns_ok = 1, 23701da177e4SLinus Torvalds }; 23711da177e4SLinus Torvalds #endif 23721da177e4SLinus Torvalds 23731da177e4SLinus Torvalds 23741da177e4SLinus Torvalds /* 23751da177e4SLinus Torvalds * Setup for IP multicast routing 23761da177e4SLinus Torvalds */ 2377cf958ae3SBenjamin Thery static int __net_init ipmr_net_init(struct net *net) 2378cf958ae3SBenjamin Thery { 2379f0ad0860SPatrick McHardy int err; 2380cf958ae3SBenjamin Thery 2381f0ad0860SPatrick McHardy err = ipmr_rules_init(net); 2382f0ad0860SPatrick McHardy if (err < 0) 2383cf958ae3SBenjamin Thery goto fail; 2384f6bb4514SBenjamin Thery 2385f6bb4514SBenjamin Thery #ifdef CONFIG_PROC_FS 2386f6bb4514SBenjamin Thery err = -ENOMEM; 2387f6bb4514SBenjamin Thery if (!proc_net_fops_create(net, "ip_mr_vif", 0, &ipmr_vif_fops)) 2388f6bb4514SBenjamin Thery goto proc_vif_fail; 2389f6bb4514SBenjamin Thery if (!proc_net_fops_create(net, "ip_mr_cache", 0, &ipmr_mfc_fops)) 2390f6bb4514SBenjamin Thery goto proc_cache_fail; 2391f6bb4514SBenjamin Thery #endif 23922bb8b26cSBenjamin Thery return 0; 23932bb8b26cSBenjamin Thery 2394f6bb4514SBenjamin Thery #ifdef CONFIG_PROC_FS 2395f6bb4514SBenjamin Thery proc_cache_fail: 2396f6bb4514SBenjamin Thery proc_net_remove(net, "ip_mr_vif"); 2397f6bb4514SBenjamin Thery proc_vif_fail: 2398f0ad0860SPatrick McHardy ipmr_rules_exit(net); 2399f6bb4514SBenjamin Thery #endif 2400cf958ae3SBenjamin Thery fail: 2401cf958ae3SBenjamin Thery return err; 2402cf958ae3SBenjamin Thery } 2403cf958ae3SBenjamin Thery 2404cf958ae3SBenjamin Thery static void __net_exit ipmr_net_exit(struct net *net) 2405cf958ae3SBenjamin Thery { 2406f6bb4514SBenjamin Thery #ifdef CONFIG_PROC_FS 2407f6bb4514SBenjamin Thery proc_net_remove(net, "ip_mr_cache"); 2408f6bb4514SBenjamin Thery proc_net_remove(net, "ip_mr_vif"); 2409f6bb4514SBenjamin Thery #endif 2410f0ad0860SPatrick McHardy ipmr_rules_exit(net); 2411cf958ae3SBenjamin Thery } 2412cf958ae3SBenjamin Thery 2413cf958ae3SBenjamin Thery static struct pernet_operations ipmr_net_ops = { 2414cf958ae3SBenjamin Thery .init = ipmr_net_init, 2415cf958ae3SBenjamin Thery .exit = ipmr_net_exit, 2416cf958ae3SBenjamin Thery }; 24171da177e4SLinus Torvalds 241803d2f897SWang Chen int __init ip_mr_init(void) 24191da177e4SLinus Torvalds { 242003d2f897SWang Chen int err; 242103d2f897SWang Chen 24221da177e4SLinus Torvalds mrt_cachep = kmem_cache_create("ip_mrt_cache", 24231da177e4SLinus Torvalds sizeof(struct mfc_cache), 2424e5d679f3SAlexey Dobriyan 0, SLAB_HWCACHE_ALIGN|SLAB_PANIC, 242520c2df83SPaul Mundt NULL); 242603d2f897SWang Chen if (!mrt_cachep) 242703d2f897SWang Chen return -ENOMEM; 242803d2f897SWang Chen 2429cf958ae3SBenjamin Thery err = register_pernet_subsys(&ipmr_net_ops); 2430cf958ae3SBenjamin Thery if (err) 2431cf958ae3SBenjamin Thery goto reg_pernet_fail; 2432cf958ae3SBenjamin Thery 243303d2f897SWang Chen err = register_netdevice_notifier(&ip_mr_notifier); 243403d2f897SWang Chen if (err) 243503d2f897SWang Chen goto reg_notif_fail; 2436403dbb97STom Goff #ifdef CONFIG_IP_PIMSM_V2 2437403dbb97STom Goff if (inet_add_protocol(&pim_protocol, IPPROTO_PIM) < 0) { 2438403dbb97STom Goff printk(KERN_ERR "ip_mr_init: can't add PIM protocol\n"); 2439403dbb97STom Goff err = -EAGAIN; 2440403dbb97STom Goff goto add_proto_fail; 2441403dbb97STom Goff } 2442403dbb97STom Goff #endif 2443cb6a4e46SPatrick McHardy rtnl_register(RTNL_FAMILY_IPMR, RTM_GETROUTE, NULL, ipmr_rtm_dumproute); 244403d2f897SWang Chen return 0; 2445f6bb4514SBenjamin Thery 2446403dbb97STom Goff #ifdef CONFIG_IP_PIMSM_V2 2447403dbb97STom Goff add_proto_fail: 2448403dbb97STom Goff unregister_netdevice_notifier(&ip_mr_notifier); 2449403dbb97STom Goff #endif 2450c3e38896SBenjamin Thery reg_notif_fail: 2451cf958ae3SBenjamin Thery unregister_pernet_subsys(&ipmr_net_ops); 2452cf958ae3SBenjamin Thery reg_pernet_fail: 2453c3e38896SBenjamin Thery kmem_cache_destroy(mrt_cachep); 245403d2f897SWang Chen return err; 24551da177e4SLinus Torvalds } 2456