1ab84be7eSDavid Ahern // SPDX-License-Identifier: GPL-2.0 2ab84be7eSDavid Ahern /* Generic nexthop implementation 3ab84be7eSDavid Ahern * 4ab84be7eSDavid Ahern * Copyright (c) 2017-19 Cumulus Networks 5ab84be7eSDavid Ahern * Copyright (c) 2017-19 David Ahern <dsa@cumulusnetworks.com> 6ab84be7eSDavid Ahern */ 7ab84be7eSDavid Ahern 8ab84be7eSDavid Ahern #include <linux/nexthop.h> 9ab84be7eSDavid Ahern #include <linux/rtnetlink.h> 10ab84be7eSDavid Ahern #include <linux/slab.h> 11430a0491SDavid Ahern #include <net/arp.h> 1253010f99SDavid Ahern #include <net/ipv6_stubs.h> 13b513bd03SDavid Ahern #include <net/lwtunnel.h> 14430a0491SDavid Ahern #include <net/ndisc.h> 15ab84be7eSDavid Ahern #include <net/nexthop.h> 16597cfe4fSDavid Ahern #include <net/route.h> 17ab84be7eSDavid Ahern #include <net/sock.h> 18ab84be7eSDavid Ahern 19430a0491SDavid Ahern static void remove_nexthop(struct net *net, struct nexthop *nh, 20430a0491SDavid Ahern struct nl_info *nlinfo); 21430a0491SDavid Ahern 22597cfe4fSDavid Ahern #define NH_DEV_HASHBITS 8 23597cfe4fSDavid Ahern #define NH_DEV_HASHSIZE (1U << NH_DEV_HASHBITS) 24597cfe4fSDavid Ahern 25643d0878SPetr Machata static const struct nla_policy rtm_nh_policy_new[] = { 26ab84be7eSDavid Ahern [NHA_ID] = { .type = NLA_U32 }, 27ab84be7eSDavid Ahern [NHA_GROUP] = { .type = NLA_BINARY }, 28ab84be7eSDavid Ahern [NHA_GROUP_TYPE] = { .type = NLA_U16 }, 29ab84be7eSDavid Ahern [NHA_BLACKHOLE] = { .type = NLA_FLAG }, 30ab84be7eSDavid Ahern [NHA_OIF] = { .type = NLA_U32 }, 31ab84be7eSDavid Ahern [NHA_GATEWAY] = { .type = NLA_BINARY }, 32ab84be7eSDavid Ahern [NHA_ENCAP_TYPE] = { .type = NLA_U16 }, 33ab84be7eSDavid Ahern [NHA_ENCAP] = { .type = NLA_NESTED }, 3438428d68SRoopa Prabhu [NHA_FDB] = { .type = NLA_FLAG }, 35ab84be7eSDavid Ahern }; 36ab84be7eSDavid Ahern 3760f5ad5eSPetr Machata static const struct nla_policy rtm_nh_policy_get[] = { 3860f5ad5eSPetr Machata [NHA_ID] = { .type = NLA_U32 }, 3960f5ad5eSPetr Machata }; 4060f5ad5eSPetr Machata 4144551bffSPetr Machata static const struct nla_policy rtm_nh_policy_dump[] = { 4244551bffSPetr Machata [NHA_OIF] = { .type = NLA_U32 }, 4344551bffSPetr Machata [NHA_GROUPS] = { .type = NLA_FLAG }, 4444551bffSPetr Machata [NHA_MASTER] = { .type = NLA_U32 }, 4544551bffSPetr Machata [NHA_FDB] = { .type = NLA_FLAG }, 4644551bffSPetr Machata }; 4744551bffSPetr Machata 485ca474f2SIdo Schimmel static bool nexthop_notifiers_is_empty(struct net *net) 495ca474f2SIdo Schimmel { 505ca474f2SIdo Schimmel return !net->nexthop.notifier_chain.head; 515ca474f2SIdo Schimmel } 525ca474f2SIdo Schimmel 535ca474f2SIdo Schimmel static void 545ca474f2SIdo Schimmel __nh_notifier_single_info_init(struct nh_notifier_single_info *nh_info, 555ca474f2SIdo Schimmel const struct nexthop *nh) 565ca474f2SIdo Schimmel { 575ca474f2SIdo Schimmel struct nh_info *nhi = rtnl_dereference(nh->nh_info); 585ca474f2SIdo Schimmel 595ca474f2SIdo Schimmel nh_info->dev = nhi->fib_nhc.nhc_dev; 605ca474f2SIdo Schimmel nh_info->gw_family = nhi->fib_nhc.nhc_gw_family; 615ca474f2SIdo Schimmel if (nh_info->gw_family == AF_INET) 625ca474f2SIdo Schimmel nh_info->ipv4 = nhi->fib_nhc.nhc_gw.ipv4; 635ca474f2SIdo Schimmel else if (nh_info->gw_family == AF_INET6) 645ca474f2SIdo Schimmel nh_info->ipv6 = nhi->fib_nhc.nhc_gw.ipv6; 655ca474f2SIdo Schimmel 665ca474f2SIdo Schimmel nh_info->is_reject = nhi->reject_nh; 675ca474f2SIdo Schimmel nh_info->is_fdb = nhi->fdb_nh; 685ca474f2SIdo Schimmel nh_info->has_encap = !!nhi->fib_nhc.nhc_lwtstate; 695ca474f2SIdo Schimmel } 705ca474f2SIdo Schimmel 715ca474f2SIdo Schimmel static int nh_notifier_single_info_init(struct nh_notifier_info *info, 725ca474f2SIdo Schimmel const struct nexthop *nh) 735ca474f2SIdo Schimmel { 7409ad6becSIdo Schimmel info->type = NH_NOTIFIER_INFO_TYPE_SINGLE; 755ca474f2SIdo Schimmel info->nh = kzalloc(sizeof(*info->nh), GFP_KERNEL); 765ca474f2SIdo Schimmel if (!info->nh) 775ca474f2SIdo Schimmel return -ENOMEM; 785ca474f2SIdo Schimmel 795ca474f2SIdo Schimmel __nh_notifier_single_info_init(info->nh, nh); 805ca474f2SIdo Schimmel 815ca474f2SIdo Schimmel return 0; 825ca474f2SIdo Schimmel } 835ca474f2SIdo Schimmel 845ca474f2SIdo Schimmel static void nh_notifier_single_info_fini(struct nh_notifier_info *info) 855ca474f2SIdo Schimmel { 865ca474f2SIdo Schimmel kfree(info->nh); 875ca474f2SIdo Schimmel } 885ca474f2SIdo Schimmel 89da230501SPetr Machata static int nh_notifier_mp_info_init(struct nh_notifier_info *info, 90da230501SPetr Machata struct nh_group *nhg) 915ca474f2SIdo Schimmel { 925ca474f2SIdo Schimmel u16 num_nh = nhg->num_nh; 935ca474f2SIdo Schimmel int i; 945ca474f2SIdo Schimmel 9509ad6becSIdo Schimmel info->type = NH_NOTIFIER_INFO_TYPE_GRP; 965ca474f2SIdo Schimmel info->nh_grp = kzalloc(struct_size(info->nh_grp, nh_entries, num_nh), 975ca474f2SIdo Schimmel GFP_KERNEL); 985ca474f2SIdo Schimmel if (!info->nh_grp) 995ca474f2SIdo Schimmel return -ENOMEM; 1005ca474f2SIdo Schimmel 1015ca474f2SIdo Schimmel info->nh_grp->num_nh = num_nh; 1025ca474f2SIdo Schimmel info->nh_grp->is_fdb = nhg->fdb_nh; 1035ca474f2SIdo Schimmel 1045ca474f2SIdo Schimmel for (i = 0; i < num_nh; i++) { 1055ca474f2SIdo Schimmel struct nh_grp_entry *nhge = &nhg->nh_entries[i]; 1065ca474f2SIdo Schimmel 1075ca474f2SIdo Schimmel info->nh_grp->nh_entries[i].id = nhge->nh->id; 1085ca474f2SIdo Schimmel info->nh_grp->nh_entries[i].weight = nhge->weight; 1095ca474f2SIdo Schimmel __nh_notifier_single_info_init(&info->nh_grp->nh_entries[i].nh, 1105ca474f2SIdo Schimmel nhge->nh); 1115ca474f2SIdo Schimmel } 1125ca474f2SIdo Schimmel 1135ca474f2SIdo Schimmel return 0; 1145ca474f2SIdo Schimmel } 1155ca474f2SIdo Schimmel 116da230501SPetr Machata static int nh_notifier_grp_info_init(struct nh_notifier_info *info, 117da230501SPetr Machata const struct nexthop *nh) 1185ca474f2SIdo Schimmel { 119da230501SPetr Machata struct nh_group *nhg = rtnl_dereference(nh->nh_grp); 120da230501SPetr Machata 121da230501SPetr Machata if (nhg->mpath) 122da230501SPetr Machata return nh_notifier_mp_info_init(info, nhg); 123da230501SPetr Machata return -EINVAL; 124da230501SPetr Machata } 125da230501SPetr Machata 126da230501SPetr Machata static void nh_notifier_grp_info_fini(struct nh_notifier_info *info, 127da230501SPetr Machata const struct nexthop *nh) 128da230501SPetr Machata { 129da230501SPetr Machata struct nh_group *nhg = rtnl_dereference(nh->nh_grp); 130da230501SPetr Machata 131da230501SPetr Machata if (nhg->mpath) 1325ca474f2SIdo Schimmel kfree(info->nh_grp); 1335ca474f2SIdo Schimmel } 1345ca474f2SIdo Schimmel 1355ca474f2SIdo Schimmel static int nh_notifier_info_init(struct nh_notifier_info *info, 1365ca474f2SIdo Schimmel const struct nexthop *nh) 1375ca474f2SIdo Schimmel { 1385ca474f2SIdo Schimmel info->id = nh->id; 1395ca474f2SIdo Schimmel 14009ad6becSIdo Schimmel if (nh->is_group) 1415ca474f2SIdo Schimmel return nh_notifier_grp_info_init(info, nh); 1425ca474f2SIdo Schimmel else 1435ca474f2SIdo Schimmel return nh_notifier_single_info_init(info, nh); 1445ca474f2SIdo Schimmel } 1455ca474f2SIdo Schimmel 14609ad6becSIdo Schimmel static void nh_notifier_info_fini(struct nh_notifier_info *info, 14709ad6becSIdo Schimmel const struct nexthop *nh) 1485ca474f2SIdo Schimmel { 14909ad6becSIdo Schimmel if (nh->is_group) 150da230501SPetr Machata nh_notifier_grp_info_fini(info, nh); 1515ca474f2SIdo Schimmel else 1525ca474f2SIdo Schimmel nh_notifier_single_info_fini(info); 1535ca474f2SIdo Schimmel } 1545ca474f2SIdo Schimmel 1558590ceedSRoopa Prabhu static int call_nexthop_notifiers(struct net *net, 156d8e79f1dSNathan Chancellor enum nexthop_event_type event_type, 1573578d53dSIdo Schimmel struct nexthop *nh, 1583578d53dSIdo Schimmel struct netlink_ext_ack *extack) 1598590ceedSRoopa Prabhu { 1605ca474f2SIdo Schimmel struct nh_notifier_info info = { 1615ca474f2SIdo Schimmel .net = net, 1625ca474f2SIdo Schimmel .extack = extack, 1635ca474f2SIdo Schimmel }; 1648590ceedSRoopa Prabhu int err; 1658590ceedSRoopa Prabhu 1665ca474f2SIdo Schimmel ASSERT_RTNL(); 1675ca474f2SIdo Schimmel 1685ca474f2SIdo Schimmel if (nexthop_notifiers_is_empty(net)) 1695ca474f2SIdo Schimmel return 0; 1705ca474f2SIdo Schimmel 1715ca474f2SIdo Schimmel err = nh_notifier_info_init(&info, nh); 1725ca474f2SIdo Schimmel if (err) { 1735ca474f2SIdo Schimmel NL_SET_ERR_MSG(extack, "Failed to initialize nexthop notifier info"); 1745ca474f2SIdo Schimmel return err; 1755ca474f2SIdo Schimmel } 1765ca474f2SIdo Schimmel 17780690ec6SIdo Schimmel err = blocking_notifier_call_chain(&net->nexthop.notifier_chain, 1781ec69d18SIdo Schimmel event_type, &info); 17909ad6becSIdo Schimmel nh_notifier_info_fini(&info, nh); 1805ca474f2SIdo Schimmel 1818590ceedSRoopa Prabhu return notifier_to_errno(err); 1828590ceedSRoopa Prabhu } 1838590ceedSRoopa Prabhu 184975ff7f3SIdo Schimmel static int call_nexthop_notifier(struct notifier_block *nb, struct net *net, 185975ff7f3SIdo Schimmel enum nexthop_event_type event_type, 186975ff7f3SIdo Schimmel struct nexthop *nh, 187975ff7f3SIdo Schimmel struct netlink_ext_ack *extack) 188975ff7f3SIdo Schimmel { 189975ff7f3SIdo Schimmel struct nh_notifier_info info = { 190975ff7f3SIdo Schimmel .net = net, 191975ff7f3SIdo Schimmel .extack = extack, 192975ff7f3SIdo Schimmel }; 193975ff7f3SIdo Schimmel int err; 194975ff7f3SIdo Schimmel 195975ff7f3SIdo Schimmel err = nh_notifier_info_init(&info, nh); 196975ff7f3SIdo Schimmel if (err) 197975ff7f3SIdo Schimmel return err; 198975ff7f3SIdo Schimmel 199975ff7f3SIdo Schimmel err = nb->notifier_call(nb, event_type, &info); 20009ad6becSIdo Schimmel nh_notifier_info_fini(&info, nh); 201975ff7f3SIdo Schimmel 202975ff7f3SIdo Schimmel return notifier_to_errno(err); 203975ff7f3SIdo Schimmel } 204975ff7f3SIdo Schimmel 205597cfe4fSDavid Ahern static unsigned int nh_dev_hashfn(unsigned int val) 206597cfe4fSDavid Ahern { 207597cfe4fSDavid Ahern unsigned int mask = NH_DEV_HASHSIZE - 1; 208597cfe4fSDavid Ahern 209597cfe4fSDavid Ahern return (val ^ 210597cfe4fSDavid Ahern (val >> NH_DEV_HASHBITS) ^ 211597cfe4fSDavid Ahern (val >> (NH_DEV_HASHBITS * 2))) & mask; 212597cfe4fSDavid Ahern } 213597cfe4fSDavid Ahern 214597cfe4fSDavid Ahern static void nexthop_devhash_add(struct net *net, struct nh_info *nhi) 215597cfe4fSDavid Ahern { 216597cfe4fSDavid Ahern struct net_device *dev = nhi->fib_nhc.nhc_dev; 217597cfe4fSDavid Ahern struct hlist_head *head; 218597cfe4fSDavid Ahern unsigned int hash; 219597cfe4fSDavid Ahern 220597cfe4fSDavid Ahern WARN_ON(!dev); 221597cfe4fSDavid Ahern 222597cfe4fSDavid Ahern hash = nh_dev_hashfn(dev->ifindex); 223597cfe4fSDavid Ahern head = &net->nexthop.devhash[hash]; 224597cfe4fSDavid Ahern hlist_add_head(&nhi->dev_hash, head); 225597cfe4fSDavid Ahern } 226597cfe4fSDavid Ahern 2275d1f0f09SDavid Ahern static void nexthop_free_group(struct nexthop *nh) 228ab84be7eSDavid Ahern { 229430a0491SDavid Ahern struct nh_group *nhg; 230430a0491SDavid Ahern int i; 231430a0491SDavid Ahern 232430a0491SDavid Ahern nhg = rcu_dereference_raw(nh->nh_grp); 23390f33bffSNikolay Aleksandrov for (i = 0; i < nhg->num_nh; ++i) { 23490f33bffSNikolay Aleksandrov struct nh_grp_entry *nhge = &nhg->nh_entries[i]; 235430a0491SDavid Ahern 23690f33bffSNikolay Aleksandrov WARN_ON(!list_empty(&nhge->nh_list)); 23790f33bffSNikolay Aleksandrov nexthop_put(nhge->nh); 23890f33bffSNikolay Aleksandrov } 23990f33bffSNikolay Aleksandrov 24090f33bffSNikolay Aleksandrov WARN_ON(nhg->spare == nhg); 24190f33bffSNikolay Aleksandrov 24290f33bffSNikolay Aleksandrov kfree(nhg->spare); 243430a0491SDavid Ahern kfree(nhg); 244430a0491SDavid Ahern } 245430a0491SDavid Ahern 246430a0491SDavid Ahern static void nexthop_free_single(struct nexthop *nh) 247430a0491SDavid Ahern { 248ab84be7eSDavid Ahern struct nh_info *nhi; 249ab84be7eSDavid Ahern 250ab84be7eSDavid Ahern nhi = rcu_dereference_raw(nh->nh_info); 251597cfe4fSDavid Ahern switch (nhi->family) { 252597cfe4fSDavid Ahern case AF_INET: 253597cfe4fSDavid Ahern fib_nh_release(nh->net, &nhi->fib_nh); 254597cfe4fSDavid Ahern break; 25553010f99SDavid Ahern case AF_INET6: 25653010f99SDavid Ahern ipv6_stub->fib6_nh_release(&nhi->fib6_nh); 25753010f99SDavid Ahern break; 258597cfe4fSDavid Ahern } 259ab84be7eSDavid Ahern kfree(nhi); 260430a0491SDavid Ahern } 261430a0491SDavid Ahern 262430a0491SDavid Ahern void nexthop_free_rcu(struct rcu_head *head) 263430a0491SDavid Ahern { 264430a0491SDavid Ahern struct nexthop *nh = container_of(head, struct nexthop, rcu); 265430a0491SDavid Ahern 266430a0491SDavid Ahern if (nh->is_group) 2675d1f0f09SDavid Ahern nexthop_free_group(nh); 268430a0491SDavid Ahern else 269430a0491SDavid Ahern nexthop_free_single(nh); 270ab84be7eSDavid Ahern 271ab84be7eSDavid Ahern kfree(nh); 272ab84be7eSDavid Ahern } 273ab84be7eSDavid Ahern EXPORT_SYMBOL_GPL(nexthop_free_rcu); 274ab84be7eSDavid Ahern 275ab84be7eSDavid Ahern static struct nexthop *nexthop_alloc(void) 276ab84be7eSDavid Ahern { 277ab84be7eSDavid Ahern struct nexthop *nh; 278ab84be7eSDavid Ahern 279ab84be7eSDavid Ahern nh = kzalloc(sizeof(struct nexthop), GFP_KERNEL); 280430a0491SDavid Ahern if (nh) { 2814c7e8084SDavid Ahern INIT_LIST_HEAD(&nh->fi_list); 282f88d8ea6SDavid Ahern INIT_LIST_HEAD(&nh->f6i_list); 283430a0491SDavid Ahern INIT_LIST_HEAD(&nh->grp_list); 28438428d68SRoopa Prabhu INIT_LIST_HEAD(&nh->fdb_list); 285430a0491SDavid Ahern } 286ab84be7eSDavid Ahern return nh; 287ab84be7eSDavid Ahern } 288ab84be7eSDavid Ahern 289430a0491SDavid Ahern static struct nh_group *nexthop_grp_alloc(u16 num_nh) 290430a0491SDavid Ahern { 291430a0491SDavid Ahern struct nh_group *nhg; 292430a0491SDavid Ahern 293d7d49dc7SIdo Schimmel nhg = kzalloc(struct_size(nhg, nh_entries, num_nh), GFP_KERNEL); 294430a0491SDavid Ahern if (nhg) 295430a0491SDavid Ahern nhg->num_nh = num_nh; 296430a0491SDavid Ahern 297430a0491SDavid Ahern return nhg; 298430a0491SDavid Ahern } 299430a0491SDavid Ahern 300ab84be7eSDavid Ahern static void nh_base_seq_inc(struct net *net) 301ab84be7eSDavid Ahern { 302ab84be7eSDavid Ahern while (++net->nexthop.seq == 0) 303ab84be7eSDavid Ahern ; 304ab84be7eSDavid Ahern } 305ab84be7eSDavid Ahern 306ab84be7eSDavid Ahern /* no reference taken; rcu lock or rtnl must be held */ 307ab84be7eSDavid Ahern struct nexthop *nexthop_find_by_id(struct net *net, u32 id) 308ab84be7eSDavid Ahern { 309ab84be7eSDavid Ahern struct rb_node **pp, *parent = NULL, *next; 310ab84be7eSDavid Ahern 311ab84be7eSDavid Ahern pp = &net->nexthop.rb_root.rb_node; 312ab84be7eSDavid Ahern while (1) { 313ab84be7eSDavid Ahern struct nexthop *nh; 314ab84be7eSDavid Ahern 315ab84be7eSDavid Ahern next = rcu_dereference_raw(*pp); 316ab84be7eSDavid Ahern if (!next) 317ab84be7eSDavid Ahern break; 318ab84be7eSDavid Ahern parent = next; 319ab84be7eSDavid Ahern 320ab84be7eSDavid Ahern nh = rb_entry(parent, struct nexthop, rb_node); 321ab84be7eSDavid Ahern if (id < nh->id) 322ab84be7eSDavid Ahern pp = &next->rb_left; 323ab84be7eSDavid Ahern else if (id > nh->id) 324ab84be7eSDavid Ahern pp = &next->rb_right; 325ab84be7eSDavid Ahern else 326ab84be7eSDavid Ahern return nh; 327ab84be7eSDavid Ahern } 328ab84be7eSDavid Ahern return NULL; 329ab84be7eSDavid Ahern } 330ab84be7eSDavid Ahern EXPORT_SYMBOL_GPL(nexthop_find_by_id); 331ab84be7eSDavid Ahern 332ab84be7eSDavid Ahern /* used for auto id allocation; called with rtnl held */ 333ab84be7eSDavid Ahern static u32 nh_find_unused_id(struct net *net) 334ab84be7eSDavid Ahern { 335ab84be7eSDavid Ahern u32 id_start = net->nexthop.last_id_allocated; 336ab84be7eSDavid Ahern 337ab84be7eSDavid Ahern while (1) { 338ab84be7eSDavid Ahern net->nexthop.last_id_allocated++; 339ab84be7eSDavid Ahern if (net->nexthop.last_id_allocated == id_start) 340ab84be7eSDavid Ahern break; 341ab84be7eSDavid Ahern 342ab84be7eSDavid Ahern if (!nexthop_find_by_id(net, net->nexthop.last_id_allocated)) 343ab84be7eSDavid Ahern return net->nexthop.last_id_allocated; 344ab84be7eSDavid Ahern } 345ab84be7eSDavid Ahern return 0; 346ab84be7eSDavid Ahern } 347ab84be7eSDavid Ahern 348430a0491SDavid Ahern static int nla_put_nh_group(struct sk_buff *skb, struct nh_group *nhg) 349430a0491SDavid Ahern { 350430a0491SDavid Ahern struct nexthop_grp *p; 351430a0491SDavid Ahern size_t len = nhg->num_nh * sizeof(*p); 352430a0491SDavid Ahern struct nlattr *nla; 353430a0491SDavid Ahern u16 group_type = 0; 354430a0491SDavid Ahern int i; 355430a0491SDavid Ahern 356430a0491SDavid Ahern if (nhg->mpath) 357430a0491SDavid Ahern group_type = NEXTHOP_GRP_TYPE_MPATH; 358430a0491SDavid Ahern 359430a0491SDavid Ahern if (nla_put_u16(skb, NHA_GROUP_TYPE, group_type)) 360430a0491SDavid Ahern goto nla_put_failure; 361430a0491SDavid Ahern 362430a0491SDavid Ahern nla = nla_reserve(skb, NHA_GROUP, len); 363430a0491SDavid Ahern if (!nla) 364430a0491SDavid Ahern goto nla_put_failure; 365430a0491SDavid Ahern 366430a0491SDavid Ahern p = nla_data(nla); 367430a0491SDavid Ahern for (i = 0; i < nhg->num_nh; ++i) { 368430a0491SDavid Ahern p->id = nhg->nh_entries[i].nh->id; 369430a0491SDavid Ahern p->weight = nhg->nh_entries[i].weight - 1; 370430a0491SDavid Ahern p += 1; 371430a0491SDavid Ahern } 372430a0491SDavid Ahern 373430a0491SDavid Ahern return 0; 374430a0491SDavid Ahern 375430a0491SDavid Ahern nla_put_failure: 376430a0491SDavid Ahern return -EMSGSIZE; 377430a0491SDavid Ahern } 378430a0491SDavid Ahern 379ab84be7eSDavid Ahern static int nh_fill_node(struct sk_buff *skb, struct nexthop *nh, 380ab84be7eSDavid Ahern int event, u32 portid, u32 seq, unsigned int nlflags) 381ab84be7eSDavid Ahern { 38253010f99SDavid Ahern struct fib6_nh *fib6_nh; 383597cfe4fSDavid Ahern struct fib_nh *fib_nh; 384ab84be7eSDavid Ahern struct nlmsghdr *nlh; 385ab84be7eSDavid Ahern struct nh_info *nhi; 386ab84be7eSDavid Ahern struct nhmsg *nhm; 387ab84be7eSDavid Ahern 388ab84be7eSDavid Ahern nlh = nlmsg_put(skb, portid, seq, event, sizeof(*nhm), nlflags); 389ab84be7eSDavid Ahern if (!nlh) 390ab84be7eSDavid Ahern return -EMSGSIZE; 391ab84be7eSDavid Ahern 392ab84be7eSDavid Ahern nhm = nlmsg_data(nlh); 393ab84be7eSDavid Ahern nhm->nh_family = AF_UNSPEC; 394ab84be7eSDavid Ahern nhm->nh_flags = nh->nh_flags; 395ab84be7eSDavid Ahern nhm->nh_protocol = nh->protocol; 396ab84be7eSDavid Ahern nhm->nh_scope = 0; 397ab84be7eSDavid Ahern nhm->resvd = 0; 398ab84be7eSDavid Ahern 399ab84be7eSDavid Ahern if (nla_put_u32(skb, NHA_ID, nh->id)) 400ab84be7eSDavid Ahern goto nla_put_failure; 401ab84be7eSDavid Ahern 402430a0491SDavid Ahern if (nh->is_group) { 403430a0491SDavid Ahern struct nh_group *nhg = rtnl_dereference(nh->nh_grp); 404430a0491SDavid Ahern 405ce9ac056SDavid Ahern if (nhg->fdb_nh && nla_put_flag(skb, NHA_FDB)) 406ce9ac056SDavid Ahern goto nla_put_failure; 407430a0491SDavid Ahern if (nla_put_nh_group(skb, nhg)) 408430a0491SDavid Ahern goto nla_put_failure; 409430a0491SDavid Ahern goto out; 410430a0491SDavid Ahern } 411430a0491SDavid Ahern 412ab84be7eSDavid Ahern nhi = rtnl_dereference(nh->nh_info); 413ab84be7eSDavid Ahern nhm->nh_family = nhi->family; 414ab84be7eSDavid Ahern if (nhi->reject_nh) { 415ab84be7eSDavid Ahern if (nla_put_flag(skb, NHA_BLACKHOLE)) 416ab84be7eSDavid Ahern goto nla_put_failure; 417ab84be7eSDavid Ahern goto out; 418ce9ac056SDavid Ahern } else if (nhi->fdb_nh) { 419ce9ac056SDavid Ahern if (nla_put_flag(skb, NHA_FDB)) 420ce9ac056SDavid Ahern goto nla_put_failure; 421ce9ac056SDavid Ahern } else { 422597cfe4fSDavid Ahern const struct net_device *dev; 423597cfe4fSDavid Ahern 424597cfe4fSDavid Ahern dev = nhi->fib_nhc.nhc_dev; 425597cfe4fSDavid Ahern if (dev && nla_put_u32(skb, NHA_OIF, dev->ifindex)) 426597cfe4fSDavid Ahern goto nla_put_failure; 427597cfe4fSDavid Ahern } 428597cfe4fSDavid Ahern 429597cfe4fSDavid Ahern nhm->nh_scope = nhi->fib_nhc.nhc_scope; 430597cfe4fSDavid Ahern switch (nhi->family) { 431597cfe4fSDavid Ahern case AF_INET: 432597cfe4fSDavid Ahern fib_nh = &nhi->fib_nh; 433597cfe4fSDavid Ahern if (fib_nh->fib_nh_gw_family && 43433d80996SIdo Schimmel nla_put_be32(skb, NHA_GATEWAY, fib_nh->fib_nh_gw4)) 435597cfe4fSDavid Ahern goto nla_put_failure; 436597cfe4fSDavid Ahern break; 43753010f99SDavid Ahern 43853010f99SDavid Ahern case AF_INET6: 43953010f99SDavid Ahern fib6_nh = &nhi->fib6_nh; 44053010f99SDavid Ahern if (fib6_nh->fib_nh_gw_family && 44153010f99SDavid Ahern nla_put_in6_addr(skb, NHA_GATEWAY, &fib6_nh->fib_nh_gw6)) 44253010f99SDavid Ahern goto nla_put_failure; 44353010f99SDavid Ahern break; 444ab84be7eSDavid Ahern } 445ab84be7eSDavid Ahern 446b513bd03SDavid Ahern if (nhi->fib_nhc.nhc_lwtstate && 447b513bd03SDavid Ahern lwtunnel_fill_encap(skb, nhi->fib_nhc.nhc_lwtstate, 448b513bd03SDavid Ahern NHA_ENCAP, NHA_ENCAP_TYPE) < 0) 449b513bd03SDavid Ahern goto nla_put_failure; 450b513bd03SDavid Ahern 451ab84be7eSDavid Ahern out: 452ab84be7eSDavid Ahern nlmsg_end(skb, nlh); 453ab84be7eSDavid Ahern return 0; 454ab84be7eSDavid Ahern 455ab84be7eSDavid Ahern nla_put_failure: 456d69100b8SStephen Worley nlmsg_cancel(skb, nlh); 457ab84be7eSDavid Ahern return -EMSGSIZE; 458ab84be7eSDavid Ahern } 459ab84be7eSDavid Ahern 460430a0491SDavid Ahern static size_t nh_nlmsg_size_grp(struct nexthop *nh) 461430a0491SDavid Ahern { 462430a0491SDavid Ahern struct nh_group *nhg = rtnl_dereference(nh->nh_grp); 463430a0491SDavid Ahern size_t sz = sizeof(struct nexthop_grp) * nhg->num_nh; 464430a0491SDavid Ahern 465430a0491SDavid Ahern return nla_total_size(sz) + 466430a0491SDavid Ahern nla_total_size(2); /* NHA_GROUP_TYPE */ 467430a0491SDavid Ahern } 468430a0491SDavid Ahern 469430a0491SDavid Ahern static size_t nh_nlmsg_size_single(struct nexthop *nh) 470ab84be7eSDavid Ahern { 471597cfe4fSDavid Ahern struct nh_info *nhi = rtnl_dereference(nh->nh_info); 472430a0491SDavid Ahern size_t sz; 473ab84be7eSDavid Ahern 474ab84be7eSDavid Ahern /* covers NHA_BLACKHOLE since NHA_OIF and BLACKHOLE 475ab84be7eSDavid Ahern * are mutually exclusive 476ab84be7eSDavid Ahern */ 477430a0491SDavid Ahern sz = nla_total_size(4); /* NHA_OIF */ 478ab84be7eSDavid Ahern 479597cfe4fSDavid Ahern switch (nhi->family) { 480597cfe4fSDavid Ahern case AF_INET: 481597cfe4fSDavid Ahern if (nhi->fib_nh.fib_nh_gw_family) 482597cfe4fSDavid Ahern sz += nla_total_size(4); /* NHA_GATEWAY */ 483597cfe4fSDavid Ahern break; 48453010f99SDavid Ahern 48553010f99SDavid Ahern case AF_INET6: 48653010f99SDavid Ahern /* NHA_GATEWAY */ 48753010f99SDavid Ahern if (nhi->fib6_nh.fib_nh_gw_family) 48853010f99SDavid Ahern sz += nla_total_size(sizeof(const struct in6_addr)); 48953010f99SDavid Ahern break; 490597cfe4fSDavid Ahern } 491597cfe4fSDavid Ahern 492b513bd03SDavid Ahern if (nhi->fib_nhc.nhc_lwtstate) { 493b513bd03SDavid Ahern sz += lwtunnel_get_encap_size(nhi->fib_nhc.nhc_lwtstate); 494b513bd03SDavid Ahern sz += nla_total_size(2); /* NHA_ENCAP_TYPE */ 495b513bd03SDavid Ahern } 496b513bd03SDavid Ahern 497ab84be7eSDavid Ahern return sz; 498ab84be7eSDavid Ahern } 499ab84be7eSDavid Ahern 500430a0491SDavid Ahern static size_t nh_nlmsg_size(struct nexthop *nh) 501430a0491SDavid Ahern { 502f9e95555SStephen Worley size_t sz = NLMSG_ALIGN(sizeof(struct nhmsg)); 503f9e95555SStephen Worley 504f9e95555SStephen Worley sz += nla_total_size(4); /* NHA_ID */ 505430a0491SDavid Ahern 506430a0491SDavid Ahern if (nh->is_group) 507430a0491SDavid Ahern sz += nh_nlmsg_size_grp(nh); 508430a0491SDavid Ahern else 509430a0491SDavid Ahern sz += nh_nlmsg_size_single(nh); 510430a0491SDavid Ahern 511430a0491SDavid Ahern return sz; 512430a0491SDavid Ahern } 513430a0491SDavid Ahern 514ab84be7eSDavid Ahern static void nexthop_notify(int event, struct nexthop *nh, struct nl_info *info) 515ab84be7eSDavid Ahern { 516ab84be7eSDavid Ahern unsigned int nlflags = info->nlh ? info->nlh->nlmsg_flags : 0; 517ab84be7eSDavid Ahern u32 seq = info->nlh ? info->nlh->nlmsg_seq : 0; 518ab84be7eSDavid Ahern struct sk_buff *skb; 519ab84be7eSDavid Ahern int err = -ENOBUFS; 520ab84be7eSDavid Ahern 521ab84be7eSDavid Ahern skb = nlmsg_new(nh_nlmsg_size(nh), gfp_any()); 522ab84be7eSDavid Ahern if (!skb) 523ab84be7eSDavid Ahern goto errout; 524ab84be7eSDavid Ahern 525ab84be7eSDavid Ahern err = nh_fill_node(skb, nh, event, info->portid, seq, nlflags); 526ab84be7eSDavid Ahern if (err < 0) { 527ab84be7eSDavid Ahern /* -EMSGSIZE implies BUG in nh_nlmsg_size() */ 528ab84be7eSDavid Ahern WARN_ON(err == -EMSGSIZE); 529ab84be7eSDavid Ahern kfree_skb(skb); 530ab84be7eSDavid Ahern goto errout; 531ab84be7eSDavid Ahern } 532ab84be7eSDavid Ahern 533ab84be7eSDavid Ahern rtnl_notify(skb, info->nl_net, info->portid, RTNLGRP_NEXTHOP, 534ab84be7eSDavid Ahern info->nlh, gfp_any()); 535ab84be7eSDavid Ahern return; 536ab84be7eSDavid Ahern errout: 537ab84be7eSDavid Ahern if (err < 0) 538ab84be7eSDavid Ahern rtnl_set_sk_err(info->nl_net, RTNLGRP_NEXTHOP, err); 539ab84be7eSDavid Ahern } 540ab84be7eSDavid Ahern 541430a0491SDavid Ahern static bool valid_group_nh(struct nexthop *nh, unsigned int npaths, 542ce9ac056SDavid Ahern bool *is_fdb, struct netlink_ext_ack *extack) 543597cfe4fSDavid Ahern { 544430a0491SDavid Ahern if (nh->is_group) { 545430a0491SDavid Ahern struct nh_group *nhg = rtnl_dereference(nh->nh_grp); 546430a0491SDavid Ahern 547430a0491SDavid Ahern /* nested multipath (group within a group) is not 548430a0491SDavid Ahern * supported 549430a0491SDavid Ahern */ 550430a0491SDavid Ahern if (nhg->mpath) { 551430a0491SDavid Ahern NL_SET_ERR_MSG(extack, 552430a0491SDavid Ahern "Multipath group can not be a nexthop within a group"); 553430a0491SDavid Ahern return false; 554430a0491SDavid Ahern } 555ce9ac056SDavid Ahern *is_fdb = nhg->fdb_nh; 556430a0491SDavid Ahern } else { 557430a0491SDavid Ahern struct nh_info *nhi = rtnl_dereference(nh->nh_info); 558430a0491SDavid Ahern 559430a0491SDavid Ahern if (nhi->reject_nh && npaths > 1) { 560430a0491SDavid Ahern NL_SET_ERR_MSG(extack, 561430a0491SDavid Ahern "Blackhole nexthop can not be used in a group with more than 1 path"); 562430a0491SDavid Ahern return false; 563430a0491SDavid Ahern } 564ce9ac056SDavid Ahern *is_fdb = nhi->fdb_nh; 565430a0491SDavid Ahern } 566430a0491SDavid Ahern 567430a0491SDavid Ahern return true; 568430a0491SDavid Ahern } 569430a0491SDavid Ahern 57038428d68SRoopa Prabhu static int nh_check_attr_fdb_group(struct nexthop *nh, u8 *nh_family, 57138428d68SRoopa Prabhu struct netlink_ext_ack *extack) 57238428d68SRoopa Prabhu { 57338428d68SRoopa Prabhu struct nh_info *nhi; 57438428d68SRoopa Prabhu 575ce9ac056SDavid Ahern nhi = rtnl_dereference(nh->nh_info); 576ce9ac056SDavid Ahern 577ce9ac056SDavid Ahern if (!nhi->fdb_nh) { 57838428d68SRoopa Prabhu NL_SET_ERR_MSG(extack, "FDB nexthop group can only have fdb nexthops"); 57938428d68SRoopa Prabhu return -EINVAL; 58038428d68SRoopa Prabhu } 58138428d68SRoopa Prabhu 58238428d68SRoopa Prabhu if (*nh_family == AF_UNSPEC) { 58338428d68SRoopa Prabhu *nh_family = nhi->family; 58438428d68SRoopa Prabhu } else if (*nh_family != nhi->family) { 58538428d68SRoopa Prabhu NL_SET_ERR_MSG(extack, "FDB nexthop group cannot have mixed family nexthops"); 58638428d68SRoopa Prabhu return -EINVAL; 58738428d68SRoopa Prabhu } 58838428d68SRoopa Prabhu 58938428d68SRoopa Prabhu return 0; 59038428d68SRoopa Prabhu } 59138428d68SRoopa Prabhu 592643d0878SPetr Machata static int nh_check_attr_group(struct net *net, 593643d0878SPetr Machata struct nlattr *tb[], size_t tb_size, 594430a0491SDavid Ahern struct netlink_ext_ack *extack) 595430a0491SDavid Ahern { 596430a0491SDavid Ahern unsigned int len = nla_len(tb[NHA_GROUP]); 59738428d68SRoopa Prabhu u8 nh_family = AF_UNSPEC; 598430a0491SDavid Ahern struct nexthop_grp *nhg; 599430a0491SDavid Ahern unsigned int i, j; 60038428d68SRoopa Prabhu u8 nhg_fdb = 0; 601430a0491SDavid Ahern 602eeaac363SNikolay Aleksandrov if (!len || len & (sizeof(struct nexthop_grp) - 1)) { 603430a0491SDavid Ahern NL_SET_ERR_MSG(extack, 604430a0491SDavid Ahern "Invalid length for nexthop group attribute"); 605430a0491SDavid Ahern return -EINVAL; 606430a0491SDavid Ahern } 607430a0491SDavid Ahern 608430a0491SDavid Ahern /* convert len to number of nexthop ids */ 609430a0491SDavid Ahern len /= sizeof(*nhg); 610430a0491SDavid Ahern 611430a0491SDavid Ahern nhg = nla_data(tb[NHA_GROUP]); 612430a0491SDavid Ahern for (i = 0; i < len; ++i) { 613430a0491SDavid Ahern if (nhg[i].resvd1 || nhg[i].resvd2) { 614430a0491SDavid Ahern NL_SET_ERR_MSG(extack, "Reserved fields in nexthop_grp must be 0"); 615430a0491SDavid Ahern return -EINVAL; 616430a0491SDavid Ahern } 617430a0491SDavid Ahern if (nhg[i].weight > 254) { 618430a0491SDavid Ahern NL_SET_ERR_MSG(extack, "Invalid value for weight"); 619430a0491SDavid Ahern return -EINVAL; 620430a0491SDavid Ahern } 621430a0491SDavid Ahern for (j = i + 1; j < len; ++j) { 622430a0491SDavid Ahern if (nhg[i].id == nhg[j].id) { 623430a0491SDavid Ahern NL_SET_ERR_MSG(extack, "Nexthop id can not be used twice in a group"); 624430a0491SDavid Ahern return -EINVAL; 625430a0491SDavid Ahern } 626430a0491SDavid Ahern } 627430a0491SDavid Ahern } 628430a0491SDavid Ahern 62938428d68SRoopa Prabhu if (tb[NHA_FDB]) 63038428d68SRoopa Prabhu nhg_fdb = 1; 631430a0491SDavid Ahern nhg = nla_data(tb[NHA_GROUP]); 632430a0491SDavid Ahern for (i = 0; i < len; ++i) { 633430a0491SDavid Ahern struct nexthop *nh; 634ce9ac056SDavid Ahern bool is_fdb_nh; 635430a0491SDavid Ahern 636430a0491SDavid Ahern nh = nexthop_find_by_id(net, nhg[i].id); 637430a0491SDavid Ahern if (!nh) { 638430a0491SDavid Ahern NL_SET_ERR_MSG(extack, "Invalid nexthop id"); 639430a0491SDavid Ahern return -EINVAL; 640430a0491SDavid Ahern } 641ce9ac056SDavid Ahern if (!valid_group_nh(nh, len, &is_fdb_nh, extack)) 642430a0491SDavid Ahern return -EINVAL; 64338428d68SRoopa Prabhu 64438428d68SRoopa Prabhu if (nhg_fdb && nh_check_attr_fdb_group(nh, &nh_family, extack)) 64538428d68SRoopa Prabhu return -EINVAL; 64638428d68SRoopa Prabhu 647ce9ac056SDavid Ahern if (!nhg_fdb && is_fdb_nh) { 64838428d68SRoopa Prabhu NL_SET_ERR_MSG(extack, "Non FDB nexthop group cannot have fdb nexthops"); 64938428d68SRoopa Prabhu return -EINVAL; 65038428d68SRoopa Prabhu } 651430a0491SDavid Ahern } 652643d0878SPetr Machata for (i = NHA_GROUP_TYPE + 1; i < tb_size; ++i) { 653430a0491SDavid Ahern if (!tb[i]) 654430a0491SDavid Ahern continue; 655b19218b2SPetr Machata if (i == NHA_FDB) 65638428d68SRoopa Prabhu continue; 657430a0491SDavid Ahern NL_SET_ERR_MSG(extack, 658430a0491SDavid Ahern "No other attributes can be set in nexthop groups"); 659430a0491SDavid Ahern return -EINVAL; 660430a0491SDavid Ahern } 661430a0491SDavid Ahern 662430a0491SDavid Ahern return 0; 663430a0491SDavid Ahern } 664430a0491SDavid Ahern 665430a0491SDavid Ahern static bool ipv6_good_nh(const struct fib6_nh *nh) 666430a0491SDavid Ahern { 667430a0491SDavid Ahern int state = NUD_REACHABLE; 668430a0491SDavid Ahern struct neighbour *n; 669430a0491SDavid Ahern 670430a0491SDavid Ahern rcu_read_lock_bh(); 671430a0491SDavid Ahern 672430a0491SDavid Ahern n = __ipv6_neigh_lookup_noref_stub(nh->fib_nh_dev, &nh->fib_nh_gw6); 673430a0491SDavid Ahern if (n) 674430a0491SDavid Ahern state = n->nud_state; 675430a0491SDavid Ahern 676430a0491SDavid Ahern rcu_read_unlock_bh(); 677430a0491SDavid Ahern 678430a0491SDavid Ahern return !!(state & NUD_VALID); 679430a0491SDavid Ahern } 680430a0491SDavid Ahern 681430a0491SDavid Ahern static bool ipv4_good_nh(const struct fib_nh *nh) 682430a0491SDavid Ahern { 683430a0491SDavid Ahern int state = NUD_REACHABLE; 684430a0491SDavid Ahern struct neighbour *n; 685430a0491SDavid Ahern 686430a0491SDavid Ahern rcu_read_lock_bh(); 687430a0491SDavid Ahern 688430a0491SDavid Ahern n = __ipv4_neigh_lookup_noref(nh->fib_nh_dev, 689430a0491SDavid Ahern (__force u32)nh->fib_nh_gw4); 690430a0491SDavid Ahern if (n) 691430a0491SDavid Ahern state = n->nud_state; 692430a0491SDavid Ahern 693430a0491SDavid Ahern rcu_read_unlock_bh(); 694430a0491SDavid Ahern 695430a0491SDavid Ahern return !!(state & NUD_VALID); 696430a0491SDavid Ahern } 697430a0491SDavid Ahern 69879bc55e3SPetr Machata static struct nexthop *nexthop_select_path_mp(struct nh_group *nhg, int hash) 699430a0491SDavid Ahern { 700430a0491SDavid Ahern struct nexthop *rc = NULL; 701430a0491SDavid Ahern int i; 702430a0491SDavid Ahern 703430a0491SDavid Ahern for (i = 0; i < nhg->num_nh; ++i) { 704430a0491SDavid Ahern struct nh_grp_entry *nhge = &nhg->nh_entries[i]; 705430a0491SDavid Ahern struct nh_info *nhi; 706430a0491SDavid Ahern 707b9bae61bSPetr Machata if (hash > atomic_read(&nhge->mpath.upper_bound)) 708430a0491SDavid Ahern continue; 709430a0491SDavid Ahern 710ce9ac056SDavid Ahern nhi = rcu_dereference(nhge->nh->nh_info); 711ce9ac056SDavid Ahern if (nhi->fdb_nh) 71238428d68SRoopa Prabhu return nhge->nh; 71338428d68SRoopa Prabhu 714430a0491SDavid Ahern /* nexthops always check if it is good and does 715430a0491SDavid Ahern * not rely on a sysctl for this behavior 716430a0491SDavid Ahern */ 717430a0491SDavid Ahern switch (nhi->family) { 718430a0491SDavid Ahern case AF_INET: 719430a0491SDavid Ahern if (ipv4_good_nh(&nhi->fib_nh)) 720430a0491SDavid Ahern return nhge->nh; 721430a0491SDavid Ahern break; 722430a0491SDavid Ahern case AF_INET6: 723430a0491SDavid Ahern if (ipv6_good_nh(&nhi->fib6_nh)) 724430a0491SDavid Ahern return nhge->nh; 725430a0491SDavid Ahern break; 726430a0491SDavid Ahern } 727430a0491SDavid Ahern 728430a0491SDavid Ahern if (!rc) 729430a0491SDavid Ahern rc = nhge->nh; 730430a0491SDavid Ahern } 731430a0491SDavid Ahern 732430a0491SDavid Ahern return rc; 733430a0491SDavid Ahern } 73479bc55e3SPetr Machata 73579bc55e3SPetr Machata struct nexthop *nexthop_select_path(struct nexthop *nh, int hash) 73679bc55e3SPetr Machata { 73779bc55e3SPetr Machata struct nh_group *nhg; 73879bc55e3SPetr Machata 73979bc55e3SPetr Machata if (!nh->is_group) 74079bc55e3SPetr Machata return nh; 74179bc55e3SPetr Machata 74279bc55e3SPetr Machata nhg = rcu_dereference(nh->nh_grp); 74379bc55e3SPetr Machata if (nhg->mpath) 74479bc55e3SPetr Machata return nexthop_select_path_mp(nhg, hash); 74579bc55e3SPetr Machata 74679bc55e3SPetr Machata /* Unreachable. */ 74779bc55e3SPetr Machata return NULL; 74879bc55e3SPetr Machata } 749430a0491SDavid Ahern EXPORT_SYMBOL_GPL(nexthop_select_path); 750430a0491SDavid Ahern 751f88c9aa1SDavid Ahern int nexthop_for_each_fib6_nh(struct nexthop *nh, 752f88c9aa1SDavid Ahern int (*cb)(struct fib6_nh *nh, void *arg), 753f88c9aa1SDavid Ahern void *arg) 754f88c9aa1SDavid Ahern { 755f88c9aa1SDavid Ahern struct nh_info *nhi; 756f88c9aa1SDavid Ahern int err; 757f88c9aa1SDavid Ahern 758f88c9aa1SDavid Ahern if (nh->is_group) { 759f88c9aa1SDavid Ahern struct nh_group *nhg; 760f88c9aa1SDavid Ahern int i; 761f88c9aa1SDavid Ahern 762f88c9aa1SDavid Ahern nhg = rcu_dereference_rtnl(nh->nh_grp); 763f88c9aa1SDavid Ahern for (i = 0; i < nhg->num_nh; i++) { 764f88c9aa1SDavid Ahern struct nh_grp_entry *nhge = &nhg->nh_entries[i]; 765f88c9aa1SDavid Ahern 766f88c9aa1SDavid Ahern nhi = rcu_dereference_rtnl(nhge->nh->nh_info); 767f88c9aa1SDavid Ahern err = cb(&nhi->fib6_nh, arg); 768f88c9aa1SDavid Ahern if (err) 769f88c9aa1SDavid Ahern return err; 770f88c9aa1SDavid Ahern } 771f88c9aa1SDavid Ahern } else { 772f88c9aa1SDavid Ahern nhi = rcu_dereference_rtnl(nh->nh_info); 773f88c9aa1SDavid Ahern err = cb(&nhi->fib6_nh, arg); 774f88c9aa1SDavid Ahern if (err) 775f88c9aa1SDavid Ahern return err; 776f88c9aa1SDavid Ahern } 777f88c9aa1SDavid Ahern 778f88c9aa1SDavid Ahern return 0; 779f88c9aa1SDavid Ahern } 780f88c9aa1SDavid Ahern EXPORT_SYMBOL_GPL(nexthop_for_each_fib6_nh); 781f88c9aa1SDavid Ahern 7827bf4796dSDavid Ahern static int check_src_addr(const struct in6_addr *saddr, 7837bf4796dSDavid Ahern struct netlink_ext_ack *extack) 7847bf4796dSDavid Ahern { 7857bf4796dSDavid Ahern if (!ipv6_addr_any(saddr)) { 7867bf4796dSDavid Ahern NL_SET_ERR_MSG(extack, "IPv6 routes using source address can not use nexthop objects"); 7877bf4796dSDavid Ahern return -EINVAL; 7887bf4796dSDavid Ahern } 7897bf4796dSDavid Ahern return 0; 7907bf4796dSDavid Ahern } 7917bf4796dSDavid Ahern 792f88d8ea6SDavid Ahern int fib6_check_nexthop(struct nexthop *nh, struct fib6_config *cfg, 793f88d8ea6SDavid Ahern struct netlink_ext_ack *extack) 794f88d8ea6SDavid Ahern { 795f88d8ea6SDavid Ahern struct nh_info *nhi; 796ce9ac056SDavid Ahern bool is_fdb_nh; 79738428d68SRoopa Prabhu 798f88d8ea6SDavid Ahern /* fib6_src is unique to a fib6_info and limits the ability to cache 799f88d8ea6SDavid Ahern * routes in fib6_nh within a nexthop that is potentially shared 800f88d8ea6SDavid Ahern * across multiple fib entries. If the config wants to use source 801f88d8ea6SDavid Ahern * routing it can not use nexthop objects. mlxsw also does not allow 802f88d8ea6SDavid Ahern * fib6_src on routes. 803f88d8ea6SDavid Ahern */ 8047bf4796dSDavid Ahern if (cfg && check_src_addr(&cfg->fc_src, extack) < 0) 805f88d8ea6SDavid Ahern return -EINVAL; 806f88d8ea6SDavid Ahern 807f88d8ea6SDavid Ahern if (nh->is_group) { 808f88d8ea6SDavid Ahern struct nh_group *nhg; 809f88d8ea6SDavid Ahern 810f88d8ea6SDavid Ahern nhg = rtnl_dereference(nh->nh_grp); 811f88d8ea6SDavid Ahern if (nhg->has_v4) 812f88d8ea6SDavid Ahern goto no_v4_nh; 813ce9ac056SDavid Ahern is_fdb_nh = nhg->fdb_nh; 814f88d8ea6SDavid Ahern } else { 815f88d8ea6SDavid Ahern nhi = rtnl_dereference(nh->nh_info); 816f88d8ea6SDavid Ahern if (nhi->family == AF_INET) 817f88d8ea6SDavid Ahern goto no_v4_nh; 818ce9ac056SDavid Ahern is_fdb_nh = nhi->fdb_nh; 819ce9ac056SDavid Ahern } 820ce9ac056SDavid Ahern 821ce9ac056SDavid Ahern if (is_fdb_nh) { 822ce9ac056SDavid Ahern NL_SET_ERR_MSG(extack, "Route cannot point to a fdb nexthop"); 823ce9ac056SDavid Ahern return -EINVAL; 824f88d8ea6SDavid Ahern } 825f88d8ea6SDavid Ahern 826f88d8ea6SDavid Ahern return 0; 827f88d8ea6SDavid Ahern no_v4_nh: 828f88d8ea6SDavid Ahern NL_SET_ERR_MSG(extack, "IPv6 routes can not use an IPv4 nexthop"); 829f88d8ea6SDavid Ahern return -EINVAL; 830f88d8ea6SDavid Ahern } 831f88d8ea6SDavid Ahern EXPORT_SYMBOL_GPL(fib6_check_nexthop); 832f88d8ea6SDavid Ahern 8337bf4796dSDavid Ahern /* if existing nexthop has ipv6 routes linked to it, need 8347bf4796dSDavid Ahern * to verify this new spec works with ipv6 8357bf4796dSDavid Ahern */ 8367bf4796dSDavid Ahern static int fib6_check_nh_list(struct nexthop *old, struct nexthop *new, 8377bf4796dSDavid Ahern struct netlink_ext_ack *extack) 8387bf4796dSDavid Ahern { 8397bf4796dSDavid Ahern struct fib6_info *f6i; 8407bf4796dSDavid Ahern 8417bf4796dSDavid Ahern if (list_empty(&old->f6i_list)) 8427bf4796dSDavid Ahern return 0; 8437bf4796dSDavid Ahern 8447bf4796dSDavid Ahern list_for_each_entry(f6i, &old->f6i_list, nh_list) { 8457bf4796dSDavid Ahern if (check_src_addr(&f6i->fib6_src.addr, extack) < 0) 8467bf4796dSDavid Ahern return -EINVAL; 8477bf4796dSDavid Ahern } 8487bf4796dSDavid Ahern 8497bf4796dSDavid Ahern return fib6_check_nexthop(new, NULL, extack); 8507bf4796dSDavid Ahern } 8517bf4796dSDavid Ahern 852ce9ac056SDavid Ahern static int nexthop_check_scope(struct nh_info *nhi, u8 scope, 8534c7e8084SDavid Ahern struct netlink_ext_ack *extack) 8544c7e8084SDavid Ahern { 8554c7e8084SDavid Ahern if (scope == RT_SCOPE_HOST && nhi->fib_nhc.nhc_gw_family) { 8564c7e8084SDavid Ahern NL_SET_ERR_MSG(extack, 8574c7e8084SDavid Ahern "Route with host scope can not have a gateway"); 8584c7e8084SDavid Ahern return -EINVAL; 8594c7e8084SDavid Ahern } 8604c7e8084SDavid Ahern 8614c7e8084SDavid Ahern if (nhi->fib_nhc.nhc_flags & RTNH_F_ONLINK && scope >= RT_SCOPE_LINK) { 8624c7e8084SDavid Ahern NL_SET_ERR_MSG(extack, "Scope mismatch with nexthop"); 8634c7e8084SDavid Ahern return -EINVAL; 8644c7e8084SDavid Ahern } 8654c7e8084SDavid Ahern 8664c7e8084SDavid Ahern return 0; 8674c7e8084SDavid Ahern } 8684c7e8084SDavid Ahern 8694c7e8084SDavid Ahern /* Invoked by fib add code to verify nexthop by id is ok with 8704c7e8084SDavid Ahern * config for prefix; parts of fib_check_nh not done when nexthop 8714c7e8084SDavid Ahern * object is used. 8724c7e8084SDavid Ahern */ 8734c7e8084SDavid Ahern int fib_check_nexthop(struct nexthop *nh, u8 scope, 8744c7e8084SDavid Ahern struct netlink_ext_ack *extack) 8754c7e8084SDavid Ahern { 876ce9ac056SDavid Ahern struct nh_info *nhi; 8774c7e8084SDavid Ahern int err = 0; 8784c7e8084SDavid Ahern 879ce9ac056SDavid Ahern if (nh->is_group) { 880ce9ac056SDavid Ahern struct nh_group *nhg; 881ce9ac056SDavid Ahern 882ce9ac056SDavid Ahern nhg = rtnl_dereference(nh->nh_grp); 883ce9ac056SDavid Ahern if (nhg->fdb_nh) { 88438428d68SRoopa Prabhu NL_SET_ERR_MSG(extack, "Route cannot point to a fdb nexthop"); 88538428d68SRoopa Prabhu err = -EINVAL; 88638428d68SRoopa Prabhu goto out; 88738428d68SRoopa Prabhu } 88838428d68SRoopa Prabhu 8894c7e8084SDavid Ahern if (scope == RT_SCOPE_HOST) { 8904c7e8084SDavid Ahern NL_SET_ERR_MSG(extack, "Route with host scope can not have multiple nexthops"); 8914c7e8084SDavid Ahern err = -EINVAL; 8924c7e8084SDavid Ahern goto out; 8934c7e8084SDavid Ahern } 8944c7e8084SDavid Ahern 8954c7e8084SDavid Ahern /* all nexthops in a group have the same scope */ 896ce9ac056SDavid Ahern nhi = rtnl_dereference(nhg->nh_entries[0].nh->nh_info); 897ce9ac056SDavid Ahern err = nexthop_check_scope(nhi, scope, extack); 8984c7e8084SDavid Ahern } else { 899ce9ac056SDavid Ahern nhi = rtnl_dereference(nh->nh_info); 900ce9ac056SDavid Ahern if (nhi->fdb_nh) { 901ce9ac056SDavid Ahern NL_SET_ERR_MSG(extack, "Route cannot point to a fdb nexthop"); 902ce9ac056SDavid Ahern err = -EINVAL; 903ce9ac056SDavid Ahern goto out; 9044c7e8084SDavid Ahern } 905ce9ac056SDavid Ahern err = nexthop_check_scope(nhi, scope, extack); 906ce9ac056SDavid Ahern } 907ce9ac056SDavid Ahern 9084c7e8084SDavid Ahern out: 9094c7e8084SDavid Ahern return err; 9104c7e8084SDavid Ahern } 9114c7e8084SDavid Ahern 9127bf4796dSDavid Ahern static int fib_check_nh_list(struct nexthop *old, struct nexthop *new, 9137bf4796dSDavid Ahern struct netlink_ext_ack *extack) 9147bf4796dSDavid Ahern { 9157bf4796dSDavid Ahern struct fib_info *fi; 9167bf4796dSDavid Ahern 9177bf4796dSDavid Ahern list_for_each_entry(fi, &old->fi_list, nh_list) { 9187bf4796dSDavid Ahern int err; 9197bf4796dSDavid Ahern 9207bf4796dSDavid Ahern err = fib_check_nexthop(new, fi->fib_scope, extack); 9217bf4796dSDavid Ahern if (err) 9227bf4796dSDavid Ahern return err; 9237bf4796dSDavid Ahern } 9247bf4796dSDavid Ahern return 0; 9257bf4796dSDavid Ahern } 9267bf4796dSDavid Ahern 927430a0491SDavid Ahern static void nh_group_rebalance(struct nh_group *nhg) 928430a0491SDavid Ahern { 929430a0491SDavid Ahern int total = 0; 930430a0491SDavid Ahern int w = 0; 931430a0491SDavid Ahern int i; 932430a0491SDavid Ahern 933430a0491SDavid Ahern for (i = 0; i < nhg->num_nh; ++i) 934430a0491SDavid Ahern total += nhg->nh_entries[i].weight; 935430a0491SDavid Ahern 936430a0491SDavid Ahern for (i = 0; i < nhg->num_nh; ++i) { 937430a0491SDavid Ahern struct nh_grp_entry *nhge = &nhg->nh_entries[i]; 938430a0491SDavid Ahern int upper_bound; 939430a0491SDavid Ahern 940430a0491SDavid Ahern w += nhge->weight; 941430a0491SDavid Ahern upper_bound = DIV_ROUND_CLOSEST_ULL((u64)w << 31, total) - 1; 942b9bae61bSPetr Machata atomic_set(&nhge->mpath.upper_bound, upper_bound); 943430a0491SDavid Ahern } 944430a0491SDavid Ahern } 945430a0491SDavid Ahern 946ac21753aSDavid Ahern static void remove_nh_grp_entry(struct net *net, struct nh_grp_entry *nhge, 947430a0491SDavid Ahern struct nl_info *nlinfo) 948430a0491SDavid Ahern { 94990f33bffSNikolay Aleksandrov struct nh_grp_entry *nhges, *new_nhges; 950ac21753aSDavid Ahern struct nexthop *nhp = nhge->nh_parent; 951833a1065SIdo Schimmel struct netlink_ext_ack extack; 952430a0491SDavid Ahern struct nexthop *nh = nhge->nh; 95390f33bffSNikolay Aleksandrov struct nh_group *nhg, *newg; 954833a1065SIdo Schimmel int i, j, err; 955430a0491SDavid Ahern 956430a0491SDavid Ahern WARN_ON(!nh); 957430a0491SDavid Ahern 958ac21753aSDavid Ahern nhg = rtnl_dereference(nhp->nh_grp); 95990f33bffSNikolay Aleksandrov newg = nhg->spare; 960430a0491SDavid Ahern 96190f33bffSNikolay Aleksandrov /* last entry, keep it visible and remove the parent */ 96290f33bffSNikolay Aleksandrov if (nhg->num_nh == 1) { 96390f33bffSNikolay Aleksandrov remove_nexthop(net, nhp, nlinfo); 964430a0491SDavid Ahern return; 96590f33bffSNikolay Aleksandrov } 966430a0491SDavid Ahern 967863b2558SIdo Schimmel newg->has_v4 = false; 96890f33bffSNikolay Aleksandrov newg->mpath = nhg->mpath; 969ce9ac056SDavid Ahern newg->fdb_nh = nhg->fdb_nh; 97090f33bffSNikolay Aleksandrov newg->num_nh = nhg->num_nh; 971430a0491SDavid Ahern 97290f33bffSNikolay Aleksandrov /* copy old entries to new except the one getting removed */ 97390f33bffSNikolay Aleksandrov nhges = nhg->nh_entries; 97490f33bffSNikolay Aleksandrov new_nhges = newg->nh_entries; 97590f33bffSNikolay Aleksandrov for (i = 0, j = 0; i < nhg->num_nh; ++i) { 976863b2558SIdo Schimmel struct nh_info *nhi; 977863b2558SIdo Schimmel 97890f33bffSNikolay Aleksandrov /* current nexthop getting removed */ 97990f33bffSNikolay Aleksandrov if (nhg->nh_entries[i].nh == nh) { 98090f33bffSNikolay Aleksandrov newg->num_nh--; 98190f33bffSNikolay Aleksandrov continue; 98290f33bffSNikolay Aleksandrov } 983430a0491SDavid Ahern 984863b2558SIdo Schimmel nhi = rtnl_dereference(nhges[i].nh->nh_info); 985863b2558SIdo Schimmel if (nhi->family == AF_INET) 986863b2558SIdo Schimmel newg->has_v4 = true; 987863b2558SIdo Schimmel 98890f33bffSNikolay Aleksandrov list_del(&nhges[i].nh_list); 98990f33bffSNikolay Aleksandrov new_nhges[j].nh_parent = nhges[i].nh_parent; 99090f33bffSNikolay Aleksandrov new_nhges[j].nh = nhges[i].nh; 99190f33bffSNikolay Aleksandrov new_nhges[j].weight = nhges[i].weight; 99290f33bffSNikolay Aleksandrov list_add(&new_nhges[j].nh_list, &new_nhges[j].nh->grp_list); 99390f33bffSNikolay Aleksandrov j++; 99490f33bffSNikolay Aleksandrov } 99590f33bffSNikolay Aleksandrov 99690f33bffSNikolay Aleksandrov nh_group_rebalance(newg); 99790f33bffSNikolay Aleksandrov rcu_assign_pointer(nhp->nh_grp, newg); 99890f33bffSNikolay Aleksandrov 99990f33bffSNikolay Aleksandrov list_del(&nhge->nh_list); 100090f33bffSNikolay Aleksandrov nexthop_put(nhge->nh); 1001430a0491SDavid Ahern 1002833a1065SIdo Schimmel err = call_nexthop_notifiers(net, NEXTHOP_EVENT_REPLACE, nhp, &extack); 1003833a1065SIdo Schimmel if (err) 1004833a1065SIdo Schimmel pr_err("%s\n", extack._msg); 1005833a1065SIdo Schimmel 1006430a0491SDavid Ahern if (nlinfo) 1007ac21753aSDavid Ahern nexthop_notify(RTM_NEWNEXTHOP, nhp, nlinfo); 1008430a0491SDavid Ahern } 1009430a0491SDavid Ahern 1010430a0491SDavid Ahern static void remove_nexthop_from_groups(struct net *net, struct nexthop *nh, 1011430a0491SDavid Ahern struct nl_info *nlinfo) 1012430a0491SDavid Ahern { 1013430a0491SDavid Ahern struct nh_grp_entry *nhge, *tmp; 1014430a0491SDavid Ahern 1015ac21753aSDavid Ahern list_for_each_entry_safe(nhge, tmp, &nh->grp_list, nh_list) 1016ac21753aSDavid Ahern remove_nh_grp_entry(net, nhge, nlinfo); 1017430a0491SDavid Ahern 101890f33bffSNikolay Aleksandrov /* make sure all see the newly published array before releasing rtnl */ 1019df6afe2fSIdo Schimmel synchronize_net(); 1020430a0491SDavid Ahern } 1021430a0491SDavid Ahern 1022430a0491SDavid Ahern static void remove_nexthop_group(struct nexthop *nh, struct nl_info *nlinfo) 1023430a0491SDavid Ahern { 1024430a0491SDavid Ahern struct nh_group *nhg = rcu_dereference_rtnl(nh->nh_grp); 1025430a0491SDavid Ahern int i, num_nh = nhg->num_nh; 1026430a0491SDavid Ahern 1027430a0491SDavid Ahern for (i = 0; i < num_nh; ++i) { 1028430a0491SDavid Ahern struct nh_grp_entry *nhge = &nhg->nh_entries[i]; 1029430a0491SDavid Ahern 1030430a0491SDavid Ahern if (WARN_ON(!nhge->nh)) 1031430a0491SDavid Ahern continue; 1032430a0491SDavid Ahern 103390f33bffSNikolay Aleksandrov list_del_init(&nhge->nh_list); 1034430a0491SDavid Ahern } 1035430a0491SDavid Ahern } 1036430a0491SDavid Ahern 10377bf4796dSDavid Ahern /* not called for nexthop replace */ 10384c7e8084SDavid Ahern static void __remove_nexthop_fib(struct net *net, struct nexthop *nh) 10394c7e8084SDavid Ahern { 1040f88d8ea6SDavid Ahern struct fib6_info *f6i, *tmp; 10414c7e8084SDavid Ahern bool do_flush = false; 10424c7e8084SDavid Ahern struct fib_info *fi; 10434c7e8084SDavid Ahern 10444c7e8084SDavid Ahern list_for_each_entry(fi, &nh->fi_list, nh_list) { 10454c7e8084SDavid Ahern fi->fib_flags |= RTNH_F_DEAD; 10464c7e8084SDavid Ahern do_flush = true; 10474c7e8084SDavid Ahern } 10484c7e8084SDavid Ahern if (do_flush) 10494c7e8084SDavid Ahern fib_flush(net); 1050f88d8ea6SDavid Ahern 1051f88d8ea6SDavid Ahern /* ip6_del_rt removes the entry from this list hence the _safe */ 1052f88d8ea6SDavid Ahern list_for_each_entry_safe(f6i, tmp, &nh->f6i_list, nh_list) { 1053f88d8ea6SDavid Ahern /* __ip6_del_rt does a release, so do a hold here */ 1054f88d8ea6SDavid Ahern fib6_info_hold(f6i); 10554f80116dSRoopa Prabhu ipv6_stub->ip6_del_rt(net, f6i, 10564f80116dSRoopa Prabhu !net->ipv4.sysctl_nexthop_compat_mode); 1057f88d8ea6SDavid Ahern } 10584c7e8084SDavid Ahern } 10594c7e8084SDavid Ahern 1060430a0491SDavid Ahern static void __remove_nexthop(struct net *net, struct nexthop *nh, 1061430a0491SDavid Ahern struct nl_info *nlinfo) 1062430a0491SDavid Ahern { 10634c7e8084SDavid Ahern __remove_nexthop_fib(net, nh); 10644c7e8084SDavid Ahern 1065430a0491SDavid Ahern if (nh->is_group) { 1066430a0491SDavid Ahern remove_nexthop_group(nh, nlinfo); 1067430a0491SDavid Ahern } else { 1068597cfe4fSDavid Ahern struct nh_info *nhi; 1069597cfe4fSDavid Ahern 1070597cfe4fSDavid Ahern nhi = rtnl_dereference(nh->nh_info); 1071597cfe4fSDavid Ahern if (nhi->fib_nhc.nhc_dev) 1072597cfe4fSDavid Ahern hlist_del(&nhi->dev_hash); 1073430a0491SDavid Ahern 1074430a0491SDavid Ahern remove_nexthop_from_groups(net, nh, nlinfo); 1075430a0491SDavid Ahern } 1076597cfe4fSDavid Ahern } 1077597cfe4fSDavid Ahern 1078ab84be7eSDavid Ahern static void remove_nexthop(struct net *net, struct nexthop *nh, 1079430a0491SDavid Ahern struct nl_info *nlinfo) 1080ab84be7eSDavid Ahern { 10813578d53dSIdo Schimmel call_nexthop_notifiers(net, NEXTHOP_EVENT_DEL, nh, NULL); 10820695564bSIdo Schimmel 1083ab84be7eSDavid Ahern /* remove from the tree */ 1084ab84be7eSDavid Ahern rb_erase(&nh->rb_node, &net->nexthop.rb_root); 1085ab84be7eSDavid Ahern 1086ab84be7eSDavid Ahern if (nlinfo) 1087ab84be7eSDavid Ahern nexthop_notify(RTM_DELNEXTHOP, nh, nlinfo); 1088ab84be7eSDavid Ahern 1089430a0491SDavid Ahern __remove_nexthop(net, nh, nlinfo); 1090ab84be7eSDavid Ahern nh_base_seq_inc(net); 1091ab84be7eSDavid Ahern 1092ab84be7eSDavid Ahern nexthop_put(nh); 1093ab84be7eSDavid Ahern } 1094ab84be7eSDavid Ahern 10957bf4796dSDavid Ahern /* if any FIB entries reference this nexthop, any dst entries 10967bf4796dSDavid Ahern * need to be regenerated 10977bf4796dSDavid Ahern */ 10987bf4796dSDavid Ahern static void nh_rt_cache_flush(struct net *net, struct nexthop *nh) 10997bf4796dSDavid Ahern { 11007bf4796dSDavid Ahern struct fib6_info *f6i; 11017bf4796dSDavid Ahern 11027bf4796dSDavid Ahern if (!list_empty(&nh->fi_list)) 11037bf4796dSDavid Ahern rt_cache_flush(net); 11047bf4796dSDavid Ahern 11057bf4796dSDavid Ahern list_for_each_entry(f6i, &nh->f6i_list, nh_list) 11067bf4796dSDavid Ahern ipv6_stub->fib6_update_sernum(net, f6i); 11077bf4796dSDavid Ahern } 11087bf4796dSDavid Ahern 11097bf4796dSDavid Ahern static int replace_nexthop_grp(struct net *net, struct nexthop *old, 11107bf4796dSDavid Ahern struct nexthop *new, 11117bf4796dSDavid Ahern struct netlink_ext_ack *extack) 11127bf4796dSDavid Ahern { 11137bf4796dSDavid Ahern struct nh_group *oldg, *newg; 1114d144cc5fSIdo Schimmel int i, err; 11157bf4796dSDavid Ahern 11167bf4796dSDavid Ahern if (!new->is_group) { 11177bf4796dSDavid Ahern NL_SET_ERR_MSG(extack, "Can not replace a nexthop group with a nexthop."); 11187bf4796dSDavid Ahern return -EINVAL; 11197bf4796dSDavid Ahern } 11207bf4796dSDavid Ahern 1121d144cc5fSIdo Schimmel err = call_nexthop_notifiers(net, NEXTHOP_EVENT_REPLACE, new, extack); 1122d144cc5fSIdo Schimmel if (err) 1123d144cc5fSIdo Schimmel return err; 1124d144cc5fSIdo Schimmel 11257bf4796dSDavid Ahern oldg = rtnl_dereference(old->nh_grp); 11267bf4796dSDavid Ahern newg = rtnl_dereference(new->nh_grp); 11277bf4796dSDavid Ahern 11287bf4796dSDavid Ahern /* update parents - used by nexthop code for cleanup */ 11297bf4796dSDavid Ahern for (i = 0; i < newg->num_nh; i++) 11307bf4796dSDavid Ahern newg->nh_entries[i].nh_parent = old; 11317bf4796dSDavid Ahern 11327bf4796dSDavid Ahern rcu_assign_pointer(old->nh_grp, newg); 11337bf4796dSDavid Ahern 11347bf4796dSDavid Ahern for (i = 0; i < oldg->num_nh; i++) 11357bf4796dSDavid Ahern oldg->nh_entries[i].nh_parent = new; 11367bf4796dSDavid Ahern 11377bf4796dSDavid Ahern rcu_assign_pointer(new->nh_grp, oldg); 11387bf4796dSDavid Ahern 11397bf4796dSDavid Ahern return 0; 11407bf4796dSDavid Ahern } 11417bf4796dSDavid Ahern 1142885a3b15SIdo Schimmel static void nh_group_v4_update(struct nh_group *nhg) 1143885a3b15SIdo Schimmel { 1144885a3b15SIdo Schimmel struct nh_grp_entry *nhges; 1145885a3b15SIdo Schimmel bool has_v4 = false; 1146885a3b15SIdo Schimmel int i; 1147885a3b15SIdo Schimmel 1148885a3b15SIdo Schimmel nhges = nhg->nh_entries; 1149885a3b15SIdo Schimmel for (i = 0; i < nhg->num_nh; i++) { 1150885a3b15SIdo Schimmel struct nh_info *nhi; 1151885a3b15SIdo Schimmel 1152885a3b15SIdo Schimmel nhi = rtnl_dereference(nhges[i].nh->nh_info); 1153885a3b15SIdo Schimmel if (nhi->family == AF_INET) 1154885a3b15SIdo Schimmel has_v4 = true; 1155885a3b15SIdo Schimmel } 1156885a3b15SIdo Schimmel nhg->has_v4 = has_v4; 1157885a3b15SIdo Schimmel } 1158885a3b15SIdo Schimmel 11597bf4796dSDavid Ahern static int replace_nexthop_single(struct net *net, struct nexthop *old, 11607bf4796dSDavid Ahern struct nexthop *new, 11617bf4796dSDavid Ahern struct netlink_ext_ack *extack) 11627bf4796dSDavid Ahern { 1163f17bc33dSIdo Schimmel u8 old_protocol, old_nh_flags; 11647bf4796dSDavid Ahern struct nh_info *oldi, *newi; 1165f17bc33dSIdo Schimmel struct nh_grp_entry *nhge; 11668c09c9f9SIdo Schimmel int err; 11677bf4796dSDavid Ahern 11687bf4796dSDavid Ahern if (new->is_group) { 11697bf4796dSDavid Ahern NL_SET_ERR_MSG(extack, "Can not replace a nexthop with a nexthop group."); 11707bf4796dSDavid Ahern return -EINVAL; 11717bf4796dSDavid Ahern } 11727bf4796dSDavid Ahern 11738c09c9f9SIdo Schimmel err = call_nexthop_notifiers(net, NEXTHOP_EVENT_REPLACE, new, extack); 11748c09c9f9SIdo Schimmel if (err) 11758c09c9f9SIdo Schimmel return err; 11768c09c9f9SIdo Schimmel 11778c09c9f9SIdo Schimmel /* Hardware flags were set on 'old' as 'new' is not in the red-black 11788c09c9f9SIdo Schimmel * tree. Therefore, inherit the flags from 'old' to 'new'. 11798c09c9f9SIdo Schimmel */ 11808c09c9f9SIdo Schimmel new->nh_flags |= old->nh_flags & (RTNH_F_OFFLOAD | RTNH_F_TRAP); 11818c09c9f9SIdo Schimmel 11827bf4796dSDavid Ahern oldi = rtnl_dereference(old->nh_info); 11837bf4796dSDavid Ahern newi = rtnl_dereference(new->nh_info); 11847bf4796dSDavid Ahern 11857bf4796dSDavid Ahern newi->nh_parent = old; 11867bf4796dSDavid Ahern oldi->nh_parent = new; 11877bf4796dSDavid Ahern 1188f17bc33dSIdo Schimmel old_protocol = old->protocol; 1189f17bc33dSIdo Schimmel old_nh_flags = old->nh_flags; 1190f17bc33dSIdo Schimmel 11917bf4796dSDavid Ahern old->protocol = new->protocol; 11927bf4796dSDavid Ahern old->nh_flags = new->nh_flags; 11937bf4796dSDavid Ahern 11947bf4796dSDavid Ahern rcu_assign_pointer(old->nh_info, newi); 11957bf4796dSDavid Ahern rcu_assign_pointer(new->nh_info, oldi); 11967bf4796dSDavid Ahern 1197f17bc33dSIdo Schimmel /* Send a replace notification for all the groups using the nexthop. */ 1198f17bc33dSIdo Schimmel list_for_each_entry(nhge, &old->grp_list, nh_list) { 1199f17bc33dSIdo Schimmel struct nexthop *nhp = nhge->nh_parent; 1200f17bc33dSIdo Schimmel 1201f17bc33dSIdo Schimmel err = call_nexthop_notifiers(net, NEXTHOP_EVENT_REPLACE, nhp, 1202f17bc33dSIdo Schimmel extack); 1203f17bc33dSIdo Schimmel if (err) 1204f17bc33dSIdo Schimmel goto err_notify; 1205f17bc33dSIdo Schimmel } 1206f17bc33dSIdo Schimmel 1207885a3b15SIdo Schimmel /* When replacing an IPv4 nexthop with an IPv6 nexthop, potentially 1208885a3b15SIdo Schimmel * update IPv4 indication in all the groups using the nexthop. 1209885a3b15SIdo Schimmel */ 1210885a3b15SIdo Schimmel if (oldi->family == AF_INET && newi->family == AF_INET6) { 1211885a3b15SIdo Schimmel list_for_each_entry(nhge, &old->grp_list, nh_list) { 1212885a3b15SIdo Schimmel struct nexthop *nhp = nhge->nh_parent; 1213885a3b15SIdo Schimmel struct nh_group *nhg; 1214885a3b15SIdo Schimmel 1215885a3b15SIdo Schimmel nhg = rtnl_dereference(nhp->nh_grp); 1216885a3b15SIdo Schimmel nh_group_v4_update(nhg); 1217885a3b15SIdo Schimmel } 1218885a3b15SIdo Schimmel } 1219885a3b15SIdo Schimmel 12207bf4796dSDavid Ahern return 0; 1221f17bc33dSIdo Schimmel 1222f17bc33dSIdo Schimmel err_notify: 1223f17bc33dSIdo Schimmel rcu_assign_pointer(new->nh_info, newi); 1224f17bc33dSIdo Schimmel rcu_assign_pointer(old->nh_info, oldi); 1225f17bc33dSIdo Schimmel old->nh_flags = old_nh_flags; 1226f17bc33dSIdo Schimmel old->protocol = old_protocol; 1227f17bc33dSIdo Schimmel oldi->nh_parent = old; 1228f17bc33dSIdo Schimmel newi->nh_parent = new; 1229f17bc33dSIdo Schimmel list_for_each_entry_continue_reverse(nhge, &old->grp_list, nh_list) { 1230f17bc33dSIdo Schimmel struct nexthop *nhp = nhge->nh_parent; 1231f17bc33dSIdo Schimmel 1232f17bc33dSIdo Schimmel call_nexthop_notifiers(net, NEXTHOP_EVENT_REPLACE, nhp, extack); 1233f17bc33dSIdo Schimmel } 1234f17bc33dSIdo Schimmel call_nexthop_notifiers(net, NEXTHOP_EVENT_REPLACE, old, extack); 1235f17bc33dSIdo Schimmel return err; 12367bf4796dSDavid Ahern } 12377bf4796dSDavid Ahern 12387bf4796dSDavid Ahern static void __nexthop_replace_notify(struct net *net, struct nexthop *nh, 12397bf4796dSDavid Ahern struct nl_info *info) 12407bf4796dSDavid Ahern { 12417bf4796dSDavid Ahern struct fib6_info *f6i; 12427bf4796dSDavid Ahern 12437bf4796dSDavid Ahern if (!list_empty(&nh->fi_list)) { 12447bf4796dSDavid Ahern struct fib_info *fi; 12457bf4796dSDavid Ahern 12467bf4796dSDavid Ahern /* expectation is a few fib_info per nexthop and then 12477bf4796dSDavid Ahern * a lot of routes per fib_info. So mark the fib_info 12487bf4796dSDavid Ahern * and then walk the fib tables once 12497bf4796dSDavid Ahern */ 12507bf4796dSDavid Ahern list_for_each_entry(fi, &nh->fi_list, nh_list) 12517bf4796dSDavid Ahern fi->nh_updated = true; 12527bf4796dSDavid Ahern 12537bf4796dSDavid Ahern fib_info_notify_update(net, info); 12547bf4796dSDavid Ahern 12557bf4796dSDavid Ahern list_for_each_entry(fi, &nh->fi_list, nh_list) 12567bf4796dSDavid Ahern fi->nh_updated = false; 12577bf4796dSDavid Ahern } 12587bf4796dSDavid Ahern 12597bf4796dSDavid Ahern list_for_each_entry(f6i, &nh->f6i_list, nh_list) 12607bf4796dSDavid Ahern ipv6_stub->fib6_rt_update(net, f6i, info); 12617bf4796dSDavid Ahern } 12627bf4796dSDavid Ahern 12637bf4796dSDavid Ahern /* send RTM_NEWROUTE with REPLACE flag set for all FIB entries 12647bf4796dSDavid Ahern * linked to this nexthop and for all groups that the nexthop 12657bf4796dSDavid Ahern * is a member of 12667bf4796dSDavid Ahern */ 12677bf4796dSDavid Ahern static void nexthop_replace_notify(struct net *net, struct nexthop *nh, 12687bf4796dSDavid Ahern struct nl_info *info) 12697bf4796dSDavid Ahern { 12707bf4796dSDavid Ahern struct nh_grp_entry *nhge; 12717bf4796dSDavid Ahern 12727bf4796dSDavid Ahern __nexthop_replace_notify(net, nh, info); 12737bf4796dSDavid Ahern 12747bf4796dSDavid Ahern list_for_each_entry(nhge, &nh->grp_list, nh_list) 12757bf4796dSDavid Ahern __nexthop_replace_notify(net, nhge->nh_parent, info); 12767bf4796dSDavid Ahern } 12777bf4796dSDavid Ahern 1278ab84be7eSDavid Ahern static int replace_nexthop(struct net *net, struct nexthop *old, 1279ab84be7eSDavid Ahern struct nexthop *new, struct netlink_ext_ack *extack) 1280ab84be7eSDavid Ahern { 12817bf4796dSDavid Ahern bool new_is_reject = false; 12827bf4796dSDavid Ahern struct nh_grp_entry *nhge; 12837bf4796dSDavid Ahern int err; 12847bf4796dSDavid Ahern 12857bf4796dSDavid Ahern /* check that existing FIB entries are ok with the 12867bf4796dSDavid Ahern * new nexthop definition 12877bf4796dSDavid Ahern */ 12887bf4796dSDavid Ahern err = fib_check_nh_list(old, new, extack); 12897bf4796dSDavid Ahern if (err) 12907bf4796dSDavid Ahern return err; 12917bf4796dSDavid Ahern 12927bf4796dSDavid Ahern err = fib6_check_nh_list(old, new, extack); 12937bf4796dSDavid Ahern if (err) 12947bf4796dSDavid Ahern return err; 12957bf4796dSDavid Ahern 12967bf4796dSDavid Ahern if (!new->is_group) { 12977bf4796dSDavid Ahern struct nh_info *nhi = rtnl_dereference(new->nh_info); 12987bf4796dSDavid Ahern 12997bf4796dSDavid Ahern new_is_reject = nhi->reject_nh; 13007bf4796dSDavid Ahern } 13017bf4796dSDavid Ahern 13027bf4796dSDavid Ahern list_for_each_entry(nhge, &old->grp_list, nh_list) { 13037bf4796dSDavid Ahern /* if new nexthop is a blackhole, any groups using this 13047bf4796dSDavid Ahern * nexthop cannot have more than 1 path 13057bf4796dSDavid Ahern */ 13067bf4796dSDavid Ahern if (new_is_reject && 13077bf4796dSDavid Ahern nexthop_num_path(nhge->nh_parent) > 1) { 13087bf4796dSDavid Ahern NL_SET_ERR_MSG(extack, "Blackhole nexthop can not be a member of a group with more than one path"); 13097bf4796dSDavid Ahern return -EINVAL; 13107bf4796dSDavid Ahern } 13117bf4796dSDavid Ahern 13127bf4796dSDavid Ahern err = fib_check_nh_list(nhge->nh_parent, new, extack); 13137bf4796dSDavid Ahern if (err) 13147bf4796dSDavid Ahern return err; 13157bf4796dSDavid Ahern 13167bf4796dSDavid Ahern err = fib6_check_nh_list(nhge->nh_parent, new, extack); 13177bf4796dSDavid Ahern if (err) 13187bf4796dSDavid Ahern return err; 13197bf4796dSDavid Ahern } 13207bf4796dSDavid Ahern 13217bf4796dSDavid Ahern if (old->is_group) 13227bf4796dSDavid Ahern err = replace_nexthop_grp(net, old, new, extack); 13237bf4796dSDavid Ahern else 13247bf4796dSDavid Ahern err = replace_nexthop_single(net, old, new, extack); 13257bf4796dSDavid Ahern 13267bf4796dSDavid Ahern if (!err) { 13277bf4796dSDavid Ahern nh_rt_cache_flush(net, old); 13287bf4796dSDavid Ahern 13297bf4796dSDavid Ahern __remove_nexthop(net, new, NULL); 13307bf4796dSDavid Ahern nexthop_put(new); 13317bf4796dSDavid Ahern } 13327bf4796dSDavid Ahern 13337bf4796dSDavid Ahern return err; 1334ab84be7eSDavid Ahern } 1335ab84be7eSDavid Ahern 1336ab84be7eSDavid Ahern /* called with rtnl_lock held */ 1337ab84be7eSDavid Ahern static int insert_nexthop(struct net *net, struct nexthop *new_nh, 1338ab84be7eSDavid Ahern struct nh_config *cfg, struct netlink_ext_ack *extack) 1339ab84be7eSDavid Ahern { 1340ab84be7eSDavid Ahern struct rb_node **pp, *parent = NULL, *next; 1341ab84be7eSDavid Ahern struct rb_root *root = &net->nexthop.rb_root; 1342ab84be7eSDavid Ahern bool replace = !!(cfg->nlflags & NLM_F_REPLACE); 1343ab84be7eSDavid Ahern bool create = !!(cfg->nlflags & NLM_F_CREATE); 1344ab84be7eSDavid Ahern u32 new_id = new_nh->id; 13457bf4796dSDavid Ahern int replace_notify = 0; 1346ab84be7eSDavid Ahern int rc = -EEXIST; 1347ab84be7eSDavid Ahern 1348ab84be7eSDavid Ahern pp = &root->rb_node; 1349ab84be7eSDavid Ahern while (1) { 1350ab84be7eSDavid Ahern struct nexthop *nh; 1351ab84be7eSDavid Ahern 1352233c6378SIdo Schimmel next = *pp; 1353ab84be7eSDavid Ahern if (!next) 1354ab84be7eSDavid Ahern break; 1355ab84be7eSDavid Ahern 1356ab84be7eSDavid Ahern parent = next; 1357ab84be7eSDavid Ahern 1358ab84be7eSDavid Ahern nh = rb_entry(parent, struct nexthop, rb_node); 1359ab84be7eSDavid Ahern if (new_id < nh->id) { 1360ab84be7eSDavid Ahern pp = &next->rb_left; 1361ab84be7eSDavid Ahern } else if (new_id > nh->id) { 1362ab84be7eSDavid Ahern pp = &next->rb_right; 1363ab84be7eSDavid Ahern } else if (replace) { 1364ab84be7eSDavid Ahern rc = replace_nexthop(net, nh, new_nh, extack); 13657bf4796dSDavid Ahern if (!rc) { 1366ab84be7eSDavid Ahern new_nh = nh; /* send notification with old nh */ 13677bf4796dSDavid Ahern replace_notify = 1; 13687bf4796dSDavid Ahern } 1369ab84be7eSDavid Ahern goto out; 1370ab84be7eSDavid Ahern } else { 1371ab84be7eSDavid Ahern /* id already exists and not a replace */ 1372ab84be7eSDavid Ahern goto out; 1373ab84be7eSDavid Ahern } 1374ab84be7eSDavid Ahern } 1375ab84be7eSDavid Ahern 1376ab84be7eSDavid Ahern if (replace && !create) { 1377ab84be7eSDavid Ahern NL_SET_ERR_MSG(extack, "Replace specified without create and no entry exists"); 1378ab84be7eSDavid Ahern rc = -ENOENT; 1379ab84be7eSDavid Ahern goto out; 1380ab84be7eSDavid Ahern } 1381ab84be7eSDavid Ahern 1382ab84be7eSDavid Ahern rb_link_node_rcu(&new_nh->rb_node, parent, pp); 1383ab84be7eSDavid Ahern rb_insert_color(&new_nh->rb_node, root); 1384732d167bSIdo Schimmel 1385732d167bSIdo Schimmel rc = call_nexthop_notifiers(net, NEXTHOP_EVENT_REPLACE, new_nh, extack); 1386732d167bSIdo Schimmel if (rc) 1387732d167bSIdo Schimmel rb_erase(&new_nh->rb_node, &net->nexthop.rb_root); 1388732d167bSIdo Schimmel 1389ab84be7eSDavid Ahern out: 1390ab84be7eSDavid Ahern if (!rc) { 1391ab84be7eSDavid Ahern nh_base_seq_inc(net); 1392ab84be7eSDavid Ahern nexthop_notify(RTM_NEWNEXTHOP, new_nh, &cfg->nlinfo); 13934f80116dSRoopa Prabhu if (replace_notify && net->ipv4.sysctl_nexthop_compat_mode) 13947bf4796dSDavid Ahern nexthop_replace_notify(net, new_nh, &cfg->nlinfo); 1395ab84be7eSDavid Ahern } 1396ab84be7eSDavid Ahern 1397ab84be7eSDavid Ahern return rc; 1398ab84be7eSDavid Ahern } 1399ab84be7eSDavid Ahern 1400597cfe4fSDavid Ahern /* rtnl */ 1401597cfe4fSDavid Ahern /* remove all nexthops tied to a device being deleted */ 1402597cfe4fSDavid Ahern static void nexthop_flush_dev(struct net_device *dev) 1403597cfe4fSDavid Ahern { 1404597cfe4fSDavid Ahern unsigned int hash = nh_dev_hashfn(dev->ifindex); 1405597cfe4fSDavid Ahern struct net *net = dev_net(dev); 1406597cfe4fSDavid Ahern struct hlist_head *head = &net->nexthop.devhash[hash]; 1407597cfe4fSDavid Ahern struct hlist_node *n; 1408597cfe4fSDavid Ahern struct nh_info *nhi; 1409597cfe4fSDavid Ahern 1410597cfe4fSDavid Ahern hlist_for_each_entry_safe(nhi, n, head, dev_hash) { 1411597cfe4fSDavid Ahern if (nhi->fib_nhc.nhc_dev != dev) 1412597cfe4fSDavid Ahern continue; 1413597cfe4fSDavid Ahern 1414430a0491SDavid Ahern remove_nexthop(net, nhi->nh_parent, NULL); 1415597cfe4fSDavid Ahern } 1416597cfe4fSDavid Ahern } 1417597cfe4fSDavid Ahern 1418ab84be7eSDavid Ahern /* rtnl; called when net namespace is deleted */ 1419ab84be7eSDavid Ahern static void flush_all_nexthops(struct net *net) 1420ab84be7eSDavid Ahern { 1421ab84be7eSDavid Ahern struct rb_root *root = &net->nexthop.rb_root; 1422ab84be7eSDavid Ahern struct rb_node *node; 1423ab84be7eSDavid Ahern struct nexthop *nh; 1424ab84be7eSDavid Ahern 1425ab84be7eSDavid Ahern while ((node = rb_first(root))) { 1426ab84be7eSDavid Ahern nh = rb_entry(node, struct nexthop, rb_node); 1427430a0491SDavid Ahern remove_nexthop(net, nh, NULL); 1428ab84be7eSDavid Ahern cond_resched(); 1429ab84be7eSDavid Ahern } 1430ab84be7eSDavid Ahern } 1431ab84be7eSDavid Ahern 1432430a0491SDavid Ahern static struct nexthop *nexthop_create_group(struct net *net, 1433430a0491SDavid Ahern struct nh_config *cfg) 1434430a0491SDavid Ahern { 1435430a0491SDavid Ahern struct nlattr *grps_attr = cfg->nh_grp; 1436430a0491SDavid Ahern struct nexthop_grp *entry = nla_data(grps_attr); 143790f33bffSNikolay Aleksandrov u16 num_nh = nla_len(grps_attr) / sizeof(*entry); 1438430a0491SDavid Ahern struct nh_group *nhg; 1439430a0491SDavid Ahern struct nexthop *nh; 1440430a0491SDavid Ahern int i; 1441430a0491SDavid Ahern 1442eeaac363SNikolay Aleksandrov if (WARN_ON(!num_nh)) 1443eeaac363SNikolay Aleksandrov return ERR_PTR(-EINVAL); 1444eeaac363SNikolay Aleksandrov 1445430a0491SDavid Ahern nh = nexthop_alloc(); 1446430a0491SDavid Ahern if (!nh) 1447430a0491SDavid Ahern return ERR_PTR(-ENOMEM); 1448430a0491SDavid Ahern 1449430a0491SDavid Ahern nh->is_group = 1; 1450430a0491SDavid Ahern 145190f33bffSNikolay Aleksandrov nhg = nexthop_grp_alloc(num_nh); 1452430a0491SDavid Ahern if (!nhg) { 1453430a0491SDavid Ahern kfree(nh); 1454430a0491SDavid Ahern return ERR_PTR(-ENOMEM); 1455430a0491SDavid Ahern } 1456430a0491SDavid Ahern 145790f33bffSNikolay Aleksandrov /* spare group used for removals */ 145890f33bffSNikolay Aleksandrov nhg->spare = nexthop_grp_alloc(num_nh); 1459dafe2078SPatrick Eigensatz if (!nhg->spare) { 146090f33bffSNikolay Aleksandrov kfree(nhg); 146190f33bffSNikolay Aleksandrov kfree(nh); 1462dafe2078SPatrick Eigensatz return ERR_PTR(-ENOMEM); 146390f33bffSNikolay Aleksandrov } 146490f33bffSNikolay Aleksandrov nhg->spare->spare = nhg; 146590f33bffSNikolay Aleksandrov 1466430a0491SDavid Ahern for (i = 0; i < nhg->num_nh; ++i) { 1467430a0491SDavid Ahern struct nexthop *nhe; 1468430a0491SDavid Ahern struct nh_info *nhi; 1469430a0491SDavid Ahern 1470430a0491SDavid Ahern nhe = nexthop_find_by_id(net, entry[i].id); 1471430a0491SDavid Ahern if (!nexthop_get(nhe)) 1472430a0491SDavid Ahern goto out_no_nh; 1473430a0491SDavid Ahern 1474430a0491SDavid Ahern nhi = rtnl_dereference(nhe->nh_info); 1475430a0491SDavid Ahern if (nhi->family == AF_INET) 1476430a0491SDavid Ahern nhg->has_v4 = true; 1477430a0491SDavid Ahern 1478430a0491SDavid Ahern nhg->nh_entries[i].nh = nhe; 1479430a0491SDavid Ahern nhg->nh_entries[i].weight = entry[i].weight + 1; 1480430a0491SDavid Ahern list_add(&nhg->nh_entries[i].nh_list, &nhe->grp_list); 1481430a0491SDavid Ahern nhg->nh_entries[i].nh_parent = nh; 1482430a0491SDavid Ahern } 1483430a0491SDavid Ahern 1484720ccd9aSPetr Machata if (cfg->nh_grp_type == NEXTHOP_GRP_TYPE_MPATH) 1485430a0491SDavid Ahern nhg->mpath = 1; 1486720ccd9aSPetr Machata 1487720ccd9aSPetr Machata WARN_ON_ONCE(nhg->mpath != 1); 1488720ccd9aSPetr Machata 1489720ccd9aSPetr Machata if (nhg->mpath) 1490430a0491SDavid Ahern nh_group_rebalance(nhg); 1491430a0491SDavid Ahern 149238428d68SRoopa Prabhu if (cfg->nh_fdb) 1493ce9ac056SDavid Ahern nhg->fdb_nh = 1; 149438428d68SRoopa Prabhu 1495430a0491SDavid Ahern rcu_assign_pointer(nh->nh_grp, nhg); 1496430a0491SDavid Ahern 1497430a0491SDavid Ahern return nh; 1498430a0491SDavid Ahern 1499430a0491SDavid Ahern out_no_nh: 15007b01e53eSIdo Schimmel for (i--; i >= 0; --i) { 15017b01e53eSIdo Schimmel list_del(&nhg->nh_entries[i].nh_list); 1502430a0491SDavid Ahern nexthop_put(nhg->nh_entries[i].nh); 15037b01e53eSIdo Schimmel } 1504430a0491SDavid Ahern 150590f33bffSNikolay Aleksandrov kfree(nhg->spare); 1506430a0491SDavid Ahern kfree(nhg); 1507430a0491SDavid Ahern kfree(nh); 1508430a0491SDavid Ahern 1509430a0491SDavid Ahern return ERR_PTR(-ENOENT); 1510430a0491SDavid Ahern } 1511430a0491SDavid Ahern 1512597cfe4fSDavid Ahern static int nh_create_ipv4(struct net *net, struct nexthop *nh, 1513597cfe4fSDavid Ahern struct nh_info *nhi, struct nh_config *cfg, 1514597cfe4fSDavid Ahern struct netlink_ext_ack *extack) 1515597cfe4fSDavid Ahern { 1516597cfe4fSDavid Ahern struct fib_nh *fib_nh = &nhi->fib_nh; 1517597cfe4fSDavid Ahern struct fib_config fib_cfg = { 1518597cfe4fSDavid Ahern .fc_oif = cfg->nh_ifindex, 1519597cfe4fSDavid Ahern .fc_gw4 = cfg->gw.ipv4, 1520597cfe4fSDavid Ahern .fc_gw_family = cfg->gw.ipv4 ? AF_INET : 0, 1521597cfe4fSDavid Ahern .fc_flags = cfg->nh_flags, 1522b513bd03SDavid Ahern .fc_encap = cfg->nh_encap, 1523b513bd03SDavid Ahern .fc_encap_type = cfg->nh_encap_type, 1524597cfe4fSDavid Ahern }; 152538428d68SRoopa Prabhu u32 tb_id = (cfg->dev ? l3mdev_fib_table(cfg->dev) : RT_TABLE_MAIN); 1526c76c9925SColin Ian King int err; 1527597cfe4fSDavid Ahern 1528597cfe4fSDavid Ahern err = fib_nh_init(net, fib_nh, &fib_cfg, 1, extack); 1529597cfe4fSDavid Ahern if (err) { 1530597cfe4fSDavid Ahern fib_nh_release(net, fib_nh); 1531597cfe4fSDavid Ahern goto out; 1532597cfe4fSDavid Ahern } 1533597cfe4fSDavid Ahern 1534ce9ac056SDavid Ahern if (nhi->fdb_nh) 153538428d68SRoopa Prabhu goto out; 153638428d68SRoopa Prabhu 1537597cfe4fSDavid Ahern /* sets nh_dev if successful */ 1538597cfe4fSDavid Ahern err = fib_check_nh(net, fib_nh, tb_id, 0, extack); 1539597cfe4fSDavid Ahern if (!err) { 1540597cfe4fSDavid Ahern nh->nh_flags = fib_nh->fib_nh_flags; 1541dcb1ecb5SDavid Ahern fib_info_update_nhc_saddr(net, &fib_nh->nh_common, 1542dcb1ecb5SDavid Ahern fib_nh->fib_nh_scope); 1543597cfe4fSDavid Ahern } else { 1544597cfe4fSDavid Ahern fib_nh_release(net, fib_nh); 1545597cfe4fSDavid Ahern } 1546597cfe4fSDavid Ahern out: 1547597cfe4fSDavid Ahern return err; 1548597cfe4fSDavid Ahern } 1549597cfe4fSDavid Ahern 155053010f99SDavid Ahern static int nh_create_ipv6(struct net *net, struct nexthop *nh, 155153010f99SDavid Ahern struct nh_info *nhi, struct nh_config *cfg, 155253010f99SDavid Ahern struct netlink_ext_ack *extack) 155353010f99SDavid Ahern { 155453010f99SDavid Ahern struct fib6_nh *fib6_nh = &nhi->fib6_nh; 155553010f99SDavid Ahern struct fib6_config fib6_cfg = { 155653010f99SDavid Ahern .fc_table = l3mdev_fib_table(cfg->dev), 155753010f99SDavid Ahern .fc_ifindex = cfg->nh_ifindex, 155853010f99SDavid Ahern .fc_gateway = cfg->gw.ipv6, 155953010f99SDavid Ahern .fc_flags = cfg->nh_flags, 1560b513bd03SDavid Ahern .fc_encap = cfg->nh_encap, 1561b513bd03SDavid Ahern .fc_encap_type = cfg->nh_encap_type, 156238428d68SRoopa Prabhu .fc_is_fdb = cfg->nh_fdb, 156353010f99SDavid Ahern }; 15646f43e525SColin Ian King int err; 156553010f99SDavid Ahern 156653010f99SDavid Ahern if (!ipv6_addr_any(&cfg->gw.ipv6)) 156753010f99SDavid Ahern fib6_cfg.fc_flags |= RTF_GATEWAY; 156853010f99SDavid Ahern 156953010f99SDavid Ahern /* sets nh_dev if successful */ 157053010f99SDavid Ahern err = ipv6_stub->fib6_nh_init(net, fib6_nh, &fib6_cfg, GFP_KERNEL, 157153010f99SDavid Ahern extack); 157253010f99SDavid Ahern if (err) 157353010f99SDavid Ahern ipv6_stub->fib6_nh_release(fib6_nh); 157453010f99SDavid Ahern else 157553010f99SDavid Ahern nh->nh_flags = fib6_nh->fib_nh_flags; 157653010f99SDavid Ahern 157753010f99SDavid Ahern return err; 157853010f99SDavid Ahern } 157953010f99SDavid Ahern 1580ab84be7eSDavid Ahern static struct nexthop *nexthop_create(struct net *net, struct nh_config *cfg, 1581ab84be7eSDavid Ahern struct netlink_ext_ack *extack) 1582ab84be7eSDavid Ahern { 1583ab84be7eSDavid Ahern struct nh_info *nhi; 1584ab84be7eSDavid Ahern struct nexthop *nh; 1585ab84be7eSDavid Ahern int err = 0; 1586ab84be7eSDavid Ahern 1587ab84be7eSDavid Ahern nh = nexthop_alloc(); 1588ab84be7eSDavid Ahern if (!nh) 1589ab84be7eSDavid Ahern return ERR_PTR(-ENOMEM); 1590ab84be7eSDavid Ahern 1591ab84be7eSDavid Ahern nhi = kzalloc(sizeof(*nhi), GFP_KERNEL); 1592ab84be7eSDavid Ahern if (!nhi) { 1593ab84be7eSDavid Ahern kfree(nh); 1594ab84be7eSDavid Ahern return ERR_PTR(-ENOMEM); 1595ab84be7eSDavid Ahern } 1596ab84be7eSDavid Ahern 1597ab84be7eSDavid Ahern nh->nh_flags = cfg->nh_flags; 1598ab84be7eSDavid Ahern nh->net = net; 1599ab84be7eSDavid Ahern 1600ab84be7eSDavid Ahern nhi->nh_parent = nh; 1601ab84be7eSDavid Ahern nhi->family = cfg->nh_family; 1602ab84be7eSDavid Ahern nhi->fib_nhc.nhc_scope = RT_SCOPE_LINK; 1603ab84be7eSDavid Ahern 160438428d68SRoopa Prabhu if (cfg->nh_fdb) 1605ce9ac056SDavid Ahern nhi->fdb_nh = 1; 160638428d68SRoopa Prabhu 1607ab84be7eSDavid Ahern if (cfg->nh_blackhole) { 1608ab84be7eSDavid Ahern nhi->reject_nh = 1; 1609ab84be7eSDavid Ahern cfg->nh_ifindex = net->loopback_dev->ifindex; 1610ab84be7eSDavid Ahern } 1611ab84be7eSDavid Ahern 1612597cfe4fSDavid Ahern switch (cfg->nh_family) { 1613597cfe4fSDavid Ahern case AF_INET: 1614597cfe4fSDavid Ahern err = nh_create_ipv4(net, nh, nhi, cfg, extack); 1615597cfe4fSDavid Ahern break; 161653010f99SDavid Ahern case AF_INET6: 161753010f99SDavid Ahern err = nh_create_ipv6(net, nh, nhi, cfg, extack); 161853010f99SDavid Ahern break; 1619597cfe4fSDavid Ahern } 1620597cfe4fSDavid Ahern 1621ab84be7eSDavid Ahern if (err) { 1622ab84be7eSDavid Ahern kfree(nhi); 1623ab84be7eSDavid Ahern kfree(nh); 1624ab84be7eSDavid Ahern return ERR_PTR(err); 1625ab84be7eSDavid Ahern } 1626ab84be7eSDavid Ahern 1627597cfe4fSDavid Ahern /* add the entry to the device based hash */ 1628ce9ac056SDavid Ahern if (!nhi->fdb_nh) 1629597cfe4fSDavid Ahern nexthop_devhash_add(net, nhi); 1630597cfe4fSDavid Ahern 1631ab84be7eSDavid Ahern rcu_assign_pointer(nh->nh_info, nhi); 1632ab84be7eSDavid Ahern 1633ab84be7eSDavid Ahern return nh; 1634ab84be7eSDavid Ahern } 1635ab84be7eSDavid Ahern 1636ab84be7eSDavid Ahern /* called with rtnl lock held */ 1637ab84be7eSDavid Ahern static struct nexthop *nexthop_add(struct net *net, struct nh_config *cfg, 1638ab84be7eSDavid Ahern struct netlink_ext_ack *extack) 1639ab84be7eSDavid Ahern { 1640ab84be7eSDavid Ahern struct nexthop *nh; 1641ab84be7eSDavid Ahern int err; 1642ab84be7eSDavid Ahern 1643ab84be7eSDavid Ahern if (cfg->nlflags & NLM_F_REPLACE && !cfg->nh_id) { 1644ab84be7eSDavid Ahern NL_SET_ERR_MSG(extack, "Replace requires nexthop id"); 1645ab84be7eSDavid Ahern return ERR_PTR(-EINVAL); 1646ab84be7eSDavid Ahern } 1647ab84be7eSDavid Ahern 1648ab84be7eSDavid Ahern if (!cfg->nh_id) { 1649ab84be7eSDavid Ahern cfg->nh_id = nh_find_unused_id(net); 1650ab84be7eSDavid Ahern if (!cfg->nh_id) { 1651ab84be7eSDavid Ahern NL_SET_ERR_MSG(extack, "No unused id"); 1652ab84be7eSDavid Ahern return ERR_PTR(-EINVAL); 1653ab84be7eSDavid Ahern } 1654ab84be7eSDavid Ahern } 1655ab84be7eSDavid Ahern 1656430a0491SDavid Ahern if (cfg->nh_grp) 1657430a0491SDavid Ahern nh = nexthop_create_group(net, cfg); 1658430a0491SDavid Ahern else 1659ab84be7eSDavid Ahern nh = nexthop_create(net, cfg, extack); 1660430a0491SDavid Ahern 1661ab84be7eSDavid Ahern if (IS_ERR(nh)) 1662ab84be7eSDavid Ahern return nh; 1663ab84be7eSDavid Ahern 1664ab84be7eSDavid Ahern refcount_set(&nh->refcnt, 1); 1665ab84be7eSDavid Ahern nh->id = cfg->nh_id; 1666ab84be7eSDavid Ahern nh->protocol = cfg->nh_protocol; 1667ab84be7eSDavid Ahern nh->net = net; 1668ab84be7eSDavid Ahern 1669ab84be7eSDavid Ahern err = insert_nexthop(net, nh, cfg, extack); 1670ab84be7eSDavid Ahern if (err) { 1671430a0491SDavid Ahern __remove_nexthop(net, nh, NULL); 1672ab84be7eSDavid Ahern nexthop_put(nh); 1673ab84be7eSDavid Ahern nh = ERR_PTR(err); 1674ab84be7eSDavid Ahern } 1675ab84be7eSDavid Ahern 1676ab84be7eSDavid Ahern return nh; 1677ab84be7eSDavid Ahern } 1678ab84be7eSDavid Ahern 1679ab84be7eSDavid Ahern static int rtm_to_nh_config(struct net *net, struct sk_buff *skb, 1680ab84be7eSDavid Ahern struct nlmsghdr *nlh, struct nh_config *cfg, 1681ab84be7eSDavid Ahern struct netlink_ext_ack *extack) 1682ab84be7eSDavid Ahern { 1683ab84be7eSDavid Ahern struct nhmsg *nhm = nlmsg_data(nlh); 1684643d0878SPetr Machata struct nlattr *tb[ARRAY_SIZE(rtm_nh_policy_new)]; 1685ab84be7eSDavid Ahern int err; 1686ab84be7eSDavid Ahern 1687643d0878SPetr Machata err = nlmsg_parse(nlh, sizeof(*nhm), tb, 1688643d0878SPetr Machata ARRAY_SIZE(rtm_nh_policy_new) - 1, 1689643d0878SPetr Machata rtm_nh_policy_new, extack); 1690ab84be7eSDavid Ahern if (err < 0) 1691ab84be7eSDavid Ahern return err; 1692ab84be7eSDavid Ahern 1693ab84be7eSDavid Ahern err = -EINVAL; 1694ab84be7eSDavid Ahern if (nhm->resvd || nhm->nh_scope) { 1695ab84be7eSDavid Ahern NL_SET_ERR_MSG(extack, "Invalid values in ancillary header"); 1696ab84be7eSDavid Ahern goto out; 1697ab84be7eSDavid Ahern } 1698ab84be7eSDavid Ahern if (nhm->nh_flags & ~NEXTHOP_VALID_USER_FLAGS) { 1699ab84be7eSDavid Ahern NL_SET_ERR_MSG(extack, "Invalid nexthop flags in ancillary header"); 1700ab84be7eSDavid Ahern goto out; 1701ab84be7eSDavid Ahern } 1702ab84be7eSDavid Ahern 1703ab84be7eSDavid Ahern switch (nhm->nh_family) { 1704597cfe4fSDavid Ahern case AF_INET: 170553010f99SDavid Ahern case AF_INET6: 1706597cfe4fSDavid Ahern break; 1707430a0491SDavid Ahern case AF_UNSPEC: 1708430a0491SDavid Ahern if (tb[NHA_GROUP]) 1709430a0491SDavid Ahern break; 1710a8eceea8SJoe Perches fallthrough; 1711ab84be7eSDavid Ahern default: 1712ab84be7eSDavid Ahern NL_SET_ERR_MSG(extack, "Invalid address family"); 1713ab84be7eSDavid Ahern goto out; 1714ab84be7eSDavid Ahern } 1715ab84be7eSDavid Ahern 1716ab84be7eSDavid Ahern memset(cfg, 0, sizeof(*cfg)); 1717ab84be7eSDavid Ahern cfg->nlflags = nlh->nlmsg_flags; 1718ab84be7eSDavid Ahern cfg->nlinfo.portid = NETLINK_CB(skb).portid; 1719ab84be7eSDavid Ahern cfg->nlinfo.nlh = nlh; 1720ab84be7eSDavid Ahern cfg->nlinfo.nl_net = net; 1721ab84be7eSDavid Ahern 1722ab84be7eSDavid Ahern cfg->nh_family = nhm->nh_family; 1723ab84be7eSDavid Ahern cfg->nh_protocol = nhm->nh_protocol; 1724ab84be7eSDavid Ahern cfg->nh_flags = nhm->nh_flags; 1725ab84be7eSDavid Ahern 1726ab84be7eSDavid Ahern if (tb[NHA_ID]) 1727ab84be7eSDavid Ahern cfg->nh_id = nla_get_u32(tb[NHA_ID]); 1728ab84be7eSDavid Ahern 172938428d68SRoopa Prabhu if (tb[NHA_FDB]) { 173038428d68SRoopa Prabhu if (tb[NHA_OIF] || tb[NHA_BLACKHOLE] || 173138428d68SRoopa Prabhu tb[NHA_ENCAP] || tb[NHA_ENCAP_TYPE]) { 173238428d68SRoopa Prabhu NL_SET_ERR_MSG(extack, "Fdb attribute can not be used with encap, oif or blackhole"); 173338428d68SRoopa Prabhu goto out; 173438428d68SRoopa Prabhu } 173538428d68SRoopa Prabhu if (nhm->nh_flags) { 173638428d68SRoopa Prabhu NL_SET_ERR_MSG(extack, "Unsupported nexthop flags in ancillary header"); 173738428d68SRoopa Prabhu goto out; 173838428d68SRoopa Prabhu } 173938428d68SRoopa Prabhu cfg->nh_fdb = nla_get_flag(tb[NHA_FDB]); 174038428d68SRoopa Prabhu } 174138428d68SRoopa Prabhu 1742430a0491SDavid Ahern if (tb[NHA_GROUP]) { 1743430a0491SDavid Ahern if (nhm->nh_family != AF_UNSPEC) { 1744430a0491SDavid Ahern NL_SET_ERR_MSG(extack, "Invalid family for group"); 1745430a0491SDavid Ahern goto out; 1746430a0491SDavid Ahern } 1747430a0491SDavid Ahern cfg->nh_grp = tb[NHA_GROUP]; 1748430a0491SDavid Ahern 1749430a0491SDavid Ahern cfg->nh_grp_type = NEXTHOP_GRP_TYPE_MPATH; 1750430a0491SDavid Ahern if (tb[NHA_GROUP_TYPE]) 1751430a0491SDavid Ahern cfg->nh_grp_type = nla_get_u16(tb[NHA_GROUP_TYPE]); 1752430a0491SDavid Ahern 1753430a0491SDavid Ahern if (cfg->nh_grp_type > NEXTHOP_GRP_TYPE_MAX) { 1754430a0491SDavid Ahern NL_SET_ERR_MSG(extack, "Invalid group type"); 1755430a0491SDavid Ahern goto out; 1756430a0491SDavid Ahern } 1757643d0878SPetr Machata err = nh_check_attr_group(net, tb, ARRAY_SIZE(tb), extack); 1758430a0491SDavid Ahern 1759430a0491SDavid Ahern /* no other attributes should be set */ 1760430a0491SDavid Ahern goto out; 1761430a0491SDavid Ahern } 1762430a0491SDavid Ahern 1763ab84be7eSDavid Ahern if (tb[NHA_BLACKHOLE]) { 1764b513bd03SDavid Ahern if (tb[NHA_GATEWAY] || tb[NHA_OIF] || 176538428d68SRoopa Prabhu tb[NHA_ENCAP] || tb[NHA_ENCAP_TYPE] || tb[NHA_FDB]) { 176638428d68SRoopa Prabhu NL_SET_ERR_MSG(extack, "Blackhole attribute can not be used with gateway, oif, encap or fdb"); 1767ab84be7eSDavid Ahern goto out; 1768ab84be7eSDavid Ahern } 1769ab84be7eSDavid Ahern 1770ab84be7eSDavid Ahern cfg->nh_blackhole = 1; 1771ab84be7eSDavid Ahern err = 0; 1772ab84be7eSDavid Ahern goto out; 1773ab84be7eSDavid Ahern } 1774ab84be7eSDavid Ahern 177538428d68SRoopa Prabhu if (!cfg->nh_fdb && !tb[NHA_OIF]) { 177638428d68SRoopa Prabhu NL_SET_ERR_MSG(extack, "Device attribute required for non-blackhole and non-fdb nexthops"); 1777ab84be7eSDavid Ahern goto out; 1778ab84be7eSDavid Ahern } 1779ab84be7eSDavid Ahern 178038428d68SRoopa Prabhu if (!cfg->nh_fdb && tb[NHA_OIF]) { 1781ab84be7eSDavid Ahern cfg->nh_ifindex = nla_get_u32(tb[NHA_OIF]); 1782ab84be7eSDavid Ahern if (cfg->nh_ifindex) 1783ab84be7eSDavid Ahern cfg->dev = __dev_get_by_index(net, cfg->nh_ifindex); 1784ab84be7eSDavid Ahern 1785ab84be7eSDavid Ahern if (!cfg->dev) { 1786ab84be7eSDavid Ahern NL_SET_ERR_MSG(extack, "Invalid device index"); 1787ab84be7eSDavid Ahern goto out; 1788ab84be7eSDavid Ahern } else if (!(cfg->dev->flags & IFF_UP)) { 1789ab84be7eSDavid Ahern NL_SET_ERR_MSG(extack, "Nexthop device is not up"); 1790ab84be7eSDavid Ahern err = -ENETDOWN; 1791ab84be7eSDavid Ahern goto out; 1792ab84be7eSDavid Ahern } else if (!netif_carrier_ok(cfg->dev)) { 1793ab84be7eSDavid Ahern NL_SET_ERR_MSG(extack, "Carrier for nexthop device is down"); 1794ab84be7eSDavid Ahern err = -ENETDOWN; 1795ab84be7eSDavid Ahern goto out; 1796ab84be7eSDavid Ahern } 179738428d68SRoopa Prabhu } 1798ab84be7eSDavid Ahern 1799597cfe4fSDavid Ahern err = -EINVAL; 1800597cfe4fSDavid Ahern if (tb[NHA_GATEWAY]) { 1801597cfe4fSDavid Ahern struct nlattr *gwa = tb[NHA_GATEWAY]; 1802597cfe4fSDavid Ahern 1803597cfe4fSDavid Ahern switch (cfg->nh_family) { 1804597cfe4fSDavid Ahern case AF_INET: 1805597cfe4fSDavid Ahern if (nla_len(gwa) != sizeof(u32)) { 1806597cfe4fSDavid Ahern NL_SET_ERR_MSG(extack, "Invalid gateway"); 1807597cfe4fSDavid Ahern goto out; 1808597cfe4fSDavid Ahern } 1809597cfe4fSDavid Ahern cfg->gw.ipv4 = nla_get_be32(gwa); 1810597cfe4fSDavid Ahern break; 181153010f99SDavid Ahern case AF_INET6: 181253010f99SDavid Ahern if (nla_len(gwa) != sizeof(struct in6_addr)) { 181353010f99SDavid Ahern NL_SET_ERR_MSG(extack, "Invalid gateway"); 181453010f99SDavid Ahern goto out; 181553010f99SDavid Ahern } 181653010f99SDavid Ahern cfg->gw.ipv6 = nla_get_in6_addr(gwa); 181753010f99SDavid Ahern break; 1818597cfe4fSDavid Ahern default: 1819597cfe4fSDavid Ahern NL_SET_ERR_MSG(extack, 1820597cfe4fSDavid Ahern "Unknown address family for gateway"); 1821597cfe4fSDavid Ahern goto out; 1822597cfe4fSDavid Ahern } 1823597cfe4fSDavid Ahern } else { 1824597cfe4fSDavid Ahern /* device only nexthop (no gateway) */ 1825597cfe4fSDavid Ahern if (cfg->nh_flags & RTNH_F_ONLINK) { 1826597cfe4fSDavid Ahern NL_SET_ERR_MSG(extack, 1827597cfe4fSDavid Ahern "ONLINK flag can not be set for nexthop without a gateway"); 1828597cfe4fSDavid Ahern goto out; 1829597cfe4fSDavid Ahern } 1830597cfe4fSDavid Ahern } 1831597cfe4fSDavid Ahern 1832b513bd03SDavid Ahern if (tb[NHA_ENCAP]) { 1833b513bd03SDavid Ahern cfg->nh_encap = tb[NHA_ENCAP]; 1834b513bd03SDavid Ahern 1835b513bd03SDavid Ahern if (!tb[NHA_ENCAP_TYPE]) { 1836b513bd03SDavid Ahern NL_SET_ERR_MSG(extack, "LWT encapsulation type is missing"); 1837b513bd03SDavid Ahern goto out; 1838b513bd03SDavid Ahern } 1839b513bd03SDavid Ahern 1840b513bd03SDavid Ahern cfg->nh_encap_type = nla_get_u16(tb[NHA_ENCAP_TYPE]); 1841b513bd03SDavid Ahern err = lwtunnel_valid_encap_type(cfg->nh_encap_type, extack); 1842b513bd03SDavid Ahern if (err < 0) 1843b513bd03SDavid Ahern goto out; 1844b513bd03SDavid Ahern 1845b513bd03SDavid Ahern } else if (tb[NHA_ENCAP_TYPE]) { 1846b513bd03SDavid Ahern NL_SET_ERR_MSG(extack, "LWT encapsulation attribute is missing"); 1847b513bd03SDavid Ahern goto out; 1848b513bd03SDavid Ahern } 1849b513bd03SDavid Ahern 1850b513bd03SDavid Ahern 1851ab84be7eSDavid Ahern err = 0; 1852ab84be7eSDavid Ahern out: 1853ab84be7eSDavid Ahern return err; 1854ab84be7eSDavid Ahern } 1855ab84be7eSDavid Ahern 1856ab84be7eSDavid Ahern /* rtnl */ 1857ab84be7eSDavid Ahern static int rtm_new_nexthop(struct sk_buff *skb, struct nlmsghdr *nlh, 1858ab84be7eSDavid Ahern struct netlink_ext_ack *extack) 1859ab84be7eSDavid Ahern { 1860ab84be7eSDavid Ahern struct net *net = sock_net(skb->sk); 1861ab84be7eSDavid Ahern struct nh_config cfg; 1862ab84be7eSDavid Ahern struct nexthop *nh; 1863ab84be7eSDavid Ahern int err; 1864ab84be7eSDavid Ahern 1865ab84be7eSDavid Ahern err = rtm_to_nh_config(net, skb, nlh, &cfg, extack); 1866ab84be7eSDavid Ahern if (!err) { 1867ab84be7eSDavid Ahern nh = nexthop_add(net, &cfg, extack); 1868ab84be7eSDavid Ahern if (IS_ERR(nh)) 1869ab84be7eSDavid Ahern err = PTR_ERR(nh); 1870ab84be7eSDavid Ahern } 1871ab84be7eSDavid Ahern 1872ab84be7eSDavid Ahern return err; 1873ab84be7eSDavid Ahern } 1874ab84be7eSDavid Ahern 1875ab84be7eSDavid Ahern static int nh_valid_get_del_req(struct nlmsghdr *nlh, u32 *id, 1876ab84be7eSDavid Ahern struct netlink_ext_ack *extack) 1877ab84be7eSDavid Ahern { 1878ab84be7eSDavid Ahern struct nhmsg *nhm = nlmsg_data(nlh); 187960f5ad5eSPetr Machata struct nlattr *tb[ARRAY_SIZE(rtm_nh_policy_get)]; 188060f5ad5eSPetr Machata int err; 1881ab84be7eSDavid Ahern 188260f5ad5eSPetr Machata err = nlmsg_parse(nlh, sizeof(*nhm), tb, 188360f5ad5eSPetr Machata ARRAY_SIZE(rtm_nh_policy_get) - 1, 188460f5ad5eSPetr Machata rtm_nh_policy_get, extack); 1885ab84be7eSDavid Ahern if (err < 0) 1886ab84be7eSDavid Ahern return err; 1887ab84be7eSDavid Ahern 1888ab84be7eSDavid Ahern err = -EINVAL; 1889ab84be7eSDavid Ahern if (nhm->nh_protocol || nhm->resvd || nhm->nh_scope || nhm->nh_flags) { 1890ab84be7eSDavid Ahern NL_SET_ERR_MSG(extack, "Invalid values in header"); 1891ab84be7eSDavid Ahern goto out; 1892ab84be7eSDavid Ahern } 1893ab84be7eSDavid Ahern 1894ab84be7eSDavid Ahern if (!tb[NHA_ID]) { 1895ab84be7eSDavid Ahern NL_SET_ERR_MSG(extack, "Nexthop id is missing"); 1896ab84be7eSDavid Ahern goto out; 1897ab84be7eSDavid Ahern } 1898ab84be7eSDavid Ahern 1899ab84be7eSDavid Ahern *id = nla_get_u32(tb[NHA_ID]); 1900ab84be7eSDavid Ahern if (!(*id)) 1901ab84be7eSDavid Ahern NL_SET_ERR_MSG(extack, "Invalid nexthop id"); 1902ab84be7eSDavid Ahern else 1903ab84be7eSDavid Ahern err = 0; 1904ab84be7eSDavid Ahern out: 1905ab84be7eSDavid Ahern return err; 1906ab84be7eSDavid Ahern } 1907ab84be7eSDavid Ahern 1908ab84be7eSDavid Ahern /* rtnl */ 1909ab84be7eSDavid Ahern static int rtm_del_nexthop(struct sk_buff *skb, struct nlmsghdr *nlh, 1910ab84be7eSDavid Ahern struct netlink_ext_ack *extack) 1911ab84be7eSDavid Ahern { 1912ab84be7eSDavid Ahern struct net *net = sock_net(skb->sk); 1913ab84be7eSDavid Ahern struct nl_info nlinfo = { 1914ab84be7eSDavid Ahern .nlh = nlh, 1915ab84be7eSDavid Ahern .nl_net = net, 1916ab84be7eSDavid Ahern .portid = NETLINK_CB(skb).portid, 1917ab84be7eSDavid Ahern }; 1918ab84be7eSDavid Ahern struct nexthop *nh; 1919ab84be7eSDavid Ahern int err; 1920ab84be7eSDavid Ahern u32 id; 1921ab84be7eSDavid Ahern 1922ab84be7eSDavid Ahern err = nh_valid_get_del_req(nlh, &id, extack); 1923ab84be7eSDavid Ahern if (err) 1924ab84be7eSDavid Ahern return err; 1925ab84be7eSDavid Ahern 1926ab84be7eSDavid Ahern nh = nexthop_find_by_id(net, id); 1927ab84be7eSDavid Ahern if (!nh) 1928ab84be7eSDavid Ahern return -ENOENT; 1929ab84be7eSDavid Ahern 1930430a0491SDavid Ahern remove_nexthop(net, nh, &nlinfo); 1931ab84be7eSDavid Ahern 1932ab84be7eSDavid Ahern return 0; 1933ab84be7eSDavid Ahern } 1934ab84be7eSDavid Ahern 1935ab84be7eSDavid Ahern /* rtnl */ 1936ab84be7eSDavid Ahern static int rtm_get_nexthop(struct sk_buff *in_skb, struct nlmsghdr *nlh, 1937ab84be7eSDavid Ahern struct netlink_ext_ack *extack) 1938ab84be7eSDavid Ahern { 1939ab84be7eSDavid Ahern struct net *net = sock_net(in_skb->sk); 1940ab84be7eSDavid Ahern struct sk_buff *skb = NULL; 1941ab84be7eSDavid Ahern struct nexthop *nh; 1942ab84be7eSDavid Ahern int err; 1943ab84be7eSDavid Ahern u32 id; 1944ab84be7eSDavid Ahern 1945ab84be7eSDavid Ahern err = nh_valid_get_del_req(nlh, &id, extack); 1946ab84be7eSDavid Ahern if (err) 1947ab84be7eSDavid Ahern return err; 1948ab84be7eSDavid Ahern 1949ab84be7eSDavid Ahern err = -ENOBUFS; 1950ab84be7eSDavid Ahern skb = alloc_skb(NLMSG_GOODSIZE, GFP_KERNEL); 1951ab84be7eSDavid Ahern if (!skb) 1952ab84be7eSDavid Ahern goto out; 1953ab84be7eSDavid Ahern 1954ab84be7eSDavid Ahern err = -ENOENT; 1955ab84be7eSDavid Ahern nh = nexthop_find_by_id(net, id); 1956ab84be7eSDavid Ahern if (!nh) 1957ab84be7eSDavid Ahern goto errout_free; 1958ab84be7eSDavid Ahern 1959ab84be7eSDavid Ahern err = nh_fill_node(skb, nh, RTM_NEWNEXTHOP, NETLINK_CB(in_skb).portid, 1960ab84be7eSDavid Ahern nlh->nlmsg_seq, 0); 1961ab84be7eSDavid Ahern if (err < 0) { 1962ab84be7eSDavid Ahern WARN_ON(err == -EMSGSIZE); 1963ab84be7eSDavid Ahern goto errout_free; 1964ab84be7eSDavid Ahern } 1965ab84be7eSDavid Ahern 1966ab84be7eSDavid Ahern err = rtnl_unicast(skb, net, NETLINK_CB(in_skb).portid); 1967ab84be7eSDavid Ahern out: 1968ab84be7eSDavid Ahern return err; 1969ab84be7eSDavid Ahern errout_free: 1970ab84be7eSDavid Ahern kfree_skb(skb); 1971ab84be7eSDavid Ahern goto out; 1972ab84be7eSDavid Ahern } 1973ab84be7eSDavid Ahern 197456450ec6SPetr Machata struct nh_dump_filter { 197556450ec6SPetr Machata int dev_idx; 197656450ec6SPetr Machata int master_idx; 197756450ec6SPetr Machata bool group_filter; 197856450ec6SPetr Machata bool fdb_filter; 197956450ec6SPetr Machata }; 198056450ec6SPetr Machata 198156450ec6SPetr Machata static bool nh_dump_filtered(struct nexthop *nh, 198256450ec6SPetr Machata struct nh_dump_filter *filter, u8 family) 1983ab84be7eSDavid Ahern { 1984ab84be7eSDavid Ahern const struct net_device *dev; 1985ab84be7eSDavid Ahern const struct nh_info *nhi; 1986ab84be7eSDavid Ahern 198756450ec6SPetr Machata if (filter->group_filter && !nh->is_group) 1988430a0491SDavid Ahern return true; 1989430a0491SDavid Ahern 199056450ec6SPetr Machata if (!filter->dev_idx && !filter->master_idx && !family) 1991ab84be7eSDavid Ahern return false; 1992ab84be7eSDavid Ahern 1993430a0491SDavid Ahern if (nh->is_group) 1994430a0491SDavid Ahern return true; 1995430a0491SDavid Ahern 1996ab84be7eSDavid Ahern nhi = rtnl_dereference(nh->nh_info); 1997ab84be7eSDavid Ahern if (family && nhi->family != family) 1998ab84be7eSDavid Ahern return true; 1999ab84be7eSDavid Ahern 2000ab84be7eSDavid Ahern dev = nhi->fib_nhc.nhc_dev; 200156450ec6SPetr Machata if (filter->dev_idx && (!dev || dev->ifindex != filter->dev_idx)) 2002ab84be7eSDavid Ahern return true; 2003ab84be7eSDavid Ahern 200456450ec6SPetr Machata if (filter->master_idx) { 2005ab84be7eSDavid Ahern struct net_device *master; 2006ab84be7eSDavid Ahern 2007ab84be7eSDavid Ahern if (!dev) 2008ab84be7eSDavid Ahern return true; 2009ab84be7eSDavid Ahern 2010ab84be7eSDavid Ahern master = netdev_master_upper_dev_get((struct net_device *)dev); 201156450ec6SPetr Machata if (!master || master->ifindex != filter->master_idx) 2012ab84be7eSDavid Ahern return true; 2013ab84be7eSDavid Ahern } 2014ab84be7eSDavid Ahern 2015ab84be7eSDavid Ahern return false; 2016ab84be7eSDavid Ahern } 2017ab84be7eSDavid Ahern 2018b9ebea12SPetr Machata static int __nh_valid_dump_req(const struct nlmsghdr *nlh, struct nlattr **tb, 201956450ec6SPetr Machata struct nh_dump_filter *filter, 2020b9ebea12SPetr Machata struct netlink_ext_ack *extack) 2021ab84be7eSDavid Ahern { 2022ab84be7eSDavid Ahern struct nhmsg *nhm; 2023ab84be7eSDavid Ahern u32 idx; 2024ab84be7eSDavid Ahern 202544551bffSPetr Machata if (tb[NHA_OIF]) { 202644551bffSPetr Machata idx = nla_get_u32(tb[NHA_OIF]); 2027ab84be7eSDavid Ahern if (idx > INT_MAX) { 2028ab84be7eSDavid Ahern NL_SET_ERR_MSG(extack, "Invalid device index"); 2029ab84be7eSDavid Ahern return -EINVAL; 2030ab84be7eSDavid Ahern } 203156450ec6SPetr Machata filter->dev_idx = idx; 203244551bffSPetr Machata } 203344551bffSPetr Machata if (tb[NHA_MASTER]) { 203444551bffSPetr Machata idx = nla_get_u32(tb[NHA_MASTER]); 2035ab84be7eSDavid Ahern if (idx > INT_MAX) { 2036ab84be7eSDavid Ahern NL_SET_ERR_MSG(extack, "Invalid master device index"); 2037ab84be7eSDavid Ahern return -EINVAL; 2038ab84be7eSDavid Ahern } 203956450ec6SPetr Machata filter->master_idx = idx; 2040ab84be7eSDavid Ahern } 204156450ec6SPetr Machata filter->group_filter = nla_get_flag(tb[NHA_GROUPS]); 204256450ec6SPetr Machata filter->fdb_filter = nla_get_flag(tb[NHA_FDB]); 2043ab84be7eSDavid Ahern 2044ab84be7eSDavid Ahern nhm = nlmsg_data(nlh); 2045ab84be7eSDavid Ahern if (nhm->nh_protocol || nhm->resvd || nhm->nh_scope || nhm->nh_flags) { 2046ab84be7eSDavid Ahern NL_SET_ERR_MSG(extack, "Invalid values in header for nexthop dump request"); 2047ab84be7eSDavid Ahern return -EINVAL; 2048ab84be7eSDavid Ahern } 2049ab84be7eSDavid Ahern 2050ab84be7eSDavid Ahern return 0; 2051ab84be7eSDavid Ahern } 2052ab84be7eSDavid Ahern 2053b9ebea12SPetr Machata static int nh_valid_dump_req(const struct nlmsghdr *nlh, 2054b9ebea12SPetr Machata struct nh_dump_filter *filter, 2055b9ebea12SPetr Machata struct netlink_callback *cb) 2056b9ebea12SPetr Machata { 2057b9ebea12SPetr Machata struct nlattr *tb[ARRAY_SIZE(rtm_nh_policy_dump)]; 2058b9ebea12SPetr Machata int err; 2059b9ebea12SPetr Machata 2060b9ebea12SPetr Machata err = nlmsg_parse(nlh, sizeof(struct nhmsg), tb, 2061b9ebea12SPetr Machata ARRAY_SIZE(rtm_nh_policy_dump) - 1, 2062b9ebea12SPetr Machata rtm_nh_policy_dump, cb->extack); 2063b9ebea12SPetr Machata if (err < 0) 2064b9ebea12SPetr Machata return err; 2065b9ebea12SPetr Machata 2066b9ebea12SPetr Machata return __nh_valid_dump_req(nlh, tb, filter, cb->extack); 2067b9ebea12SPetr Machata } 2068b9ebea12SPetr Machata 2069*a6fbbaa6SPetr Machata struct rtm_dump_nh_ctx { 2070*a6fbbaa6SPetr Machata u32 idx; 2071*a6fbbaa6SPetr Machata }; 2072*a6fbbaa6SPetr Machata 2073*a6fbbaa6SPetr Machata static struct rtm_dump_nh_ctx * 2074*a6fbbaa6SPetr Machata rtm_dump_nh_ctx(struct netlink_callback *cb) 2075*a6fbbaa6SPetr Machata { 2076*a6fbbaa6SPetr Machata struct rtm_dump_nh_ctx *ctx = (void *)cb->ctx; 2077*a6fbbaa6SPetr Machata 2078*a6fbbaa6SPetr Machata BUILD_BUG_ON(sizeof(*ctx) > sizeof(cb->ctx)); 2079*a6fbbaa6SPetr Machata return ctx; 2080*a6fbbaa6SPetr Machata } 2081*a6fbbaa6SPetr Machata 2082ab84be7eSDavid Ahern /* rtnl */ 2083ab84be7eSDavid Ahern static int rtm_dump_nexthop(struct sk_buff *skb, struct netlink_callback *cb) 2084ab84be7eSDavid Ahern { 2085*a6fbbaa6SPetr Machata struct rtm_dump_nh_ctx *ctx = rtm_dump_nh_ctx(cb); 2086ab84be7eSDavid Ahern struct nhmsg *nhm = nlmsg_data(cb->nlh); 2087ab84be7eSDavid Ahern struct net *net = sock_net(skb->sk); 2088ab84be7eSDavid Ahern struct rb_root *root = &net->nexthop.rb_root; 208956450ec6SPetr Machata struct nh_dump_filter filter = {}; 2090ab84be7eSDavid Ahern struct rb_node *node; 2091ab84be7eSDavid Ahern int idx = 0, s_idx; 2092ab84be7eSDavid Ahern int err; 2093ab84be7eSDavid Ahern 209456450ec6SPetr Machata err = nh_valid_dump_req(cb->nlh, &filter, cb); 2095ab84be7eSDavid Ahern if (err < 0) 2096ab84be7eSDavid Ahern return err; 2097ab84be7eSDavid Ahern 2098*a6fbbaa6SPetr Machata s_idx = ctx->idx; 2099ab84be7eSDavid Ahern for (node = rb_first(root); node; node = rb_next(node)) { 2100ab84be7eSDavid Ahern struct nexthop *nh; 2101ab84be7eSDavid Ahern 2102ab84be7eSDavid Ahern if (idx < s_idx) 2103ab84be7eSDavid Ahern goto cont; 2104ab84be7eSDavid Ahern 2105ab84be7eSDavid Ahern nh = rb_entry(node, struct nexthop, rb_node); 210656450ec6SPetr Machata if (nh_dump_filtered(nh, &filter, nhm->nh_family)) 2107ab84be7eSDavid Ahern goto cont; 2108ab84be7eSDavid Ahern 2109ab84be7eSDavid Ahern err = nh_fill_node(skb, nh, RTM_NEWNEXTHOP, 2110ab84be7eSDavid Ahern NETLINK_CB(cb->skb).portid, 2111ab84be7eSDavid Ahern cb->nlh->nlmsg_seq, NLM_F_MULTI); 2112ab84be7eSDavid Ahern if (err < 0) { 2113ab84be7eSDavid Ahern if (likely(skb->len)) 2114ab84be7eSDavid Ahern goto out; 2115ab84be7eSDavid Ahern 2116ab84be7eSDavid Ahern goto out_err; 2117ab84be7eSDavid Ahern } 2118ab84be7eSDavid Ahern cont: 2119ab84be7eSDavid Ahern idx++; 2120ab84be7eSDavid Ahern } 2121ab84be7eSDavid Ahern 2122ab84be7eSDavid Ahern out: 2123ab84be7eSDavid Ahern err = skb->len; 2124ab84be7eSDavid Ahern out_err: 2125*a6fbbaa6SPetr Machata ctx->idx = idx; 2126ab84be7eSDavid Ahern cb->seq = net->nexthop.seq; 2127ab84be7eSDavid Ahern nl_dump_check_consistent(cb, nlmsg_hdr(skb)); 2128ab84be7eSDavid Ahern 2129ab84be7eSDavid Ahern return err; 2130ab84be7eSDavid Ahern } 2131ab84be7eSDavid Ahern 2132597cfe4fSDavid Ahern static void nexthop_sync_mtu(struct net_device *dev, u32 orig_mtu) 2133597cfe4fSDavid Ahern { 2134597cfe4fSDavid Ahern unsigned int hash = nh_dev_hashfn(dev->ifindex); 2135597cfe4fSDavid Ahern struct net *net = dev_net(dev); 2136597cfe4fSDavid Ahern struct hlist_head *head = &net->nexthop.devhash[hash]; 2137597cfe4fSDavid Ahern struct hlist_node *n; 2138597cfe4fSDavid Ahern struct nh_info *nhi; 2139597cfe4fSDavid Ahern 2140597cfe4fSDavid Ahern hlist_for_each_entry_safe(nhi, n, head, dev_hash) { 2141597cfe4fSDavid Ahern if (nhi->fib_nhc.nhc_dev == dev) { 2142597cfe4fSDavid Ahern if (nhi->family == AF_INET) 2143597cfe4fSDavid Ahern fib_nhc_update_mtu(&nhi->fib_nhc, dev->mtu, 2144597cfe4fSDavid Ahern orig_mtu); 2145597cfe4fSDavid Ahern } 2146597cfe4fSDavid Ahern } 2147597cfe4fSDavid Ahern } 2148597cfe4fSDavid Ahern 2149597cfe4fSDavid Ahern /* rtnl */ 2150597cfe4fSDavid Ahern static int nh_netdev_event(struct notifier_block *this, 2151597cfe4fSDavid Ahern unsigned long event, void *ptr) 2152597cfe4fSDavid Ahern { 2153597cfe4fSDavid Ahern struct net_device *dev = netdev_notifier_info_to_dev(ptr); 2154597cfe4fSDavid Ahern struct netdev_notifier_info_ext *info_ext; 2155597cfe4fSDavid Ahern 2156597cfe4fSDavid Ahern switch (event) { 2157597cfe4fSDavid Ahern case NETDEV_DOWN: 2158597cfe4fSDavid Ahern case NETDEV_UNREGISTER: 2159597cfe4fSDavid Ahern nexthop_flush_dev(dev); 2160597cfe4fSDavid Ahern break; 2161597cfe4fSDavid Ahern case NETDEV_CHANGE: 2162597cfe4fSDavid Ahern if (!(dev_get_flags(dev) & (IFF_RUNNING | IFF_LOWER_UP))) 2163597cfe4fSDavid Ahern nexthop_flush_dev(dev); 2164597cfe4fSDavid Ahern break; 2165597cfe4fSDavid Ahern case NETDEV_CHANGEMTU: 2166597cfe4fSDavid Ahern info_ext = ptr; 2167597cfe4fSDavid Ahern nexthop_sync_mtu(dev, info_ext->ext.mtu); 2168597cfe4fSDavid Ahern rt_cache_flush(dev_net(dev)); 2169597cfe4fSDavid Ahern break; 2170597cfe4fSDavid Ahern } 2171597cfe4fSDavid Ahern return NOTIFY_DONE; 2172597cfe4fSDavid Ahern } 2173597cfe4fSDavid Ahern 2174597cfe4fSDavid Ahern static struct notifier_block nh_netdev_notifier = { 2175597cfe4fSDavid Ahern .notifier_call = nh_netdev_event, 2176597cfe4fSDavid Ahern }; 2177597cfe4fSDavid Ahern 2178975ff7f3SIdo Schimmel static int nexthops_dump(struct net *net, struct notifier_block *nb, 2179975ff7f3SIdo Schimmel struct netlink_ext_ack *extack) 2180975ff7f3SIdo Schimmel { 2181975ff7f3SIdo Schimmel struct rb_root *root = &net->nexthop.rb_root; 2182975ff7f3SIdo Schimmel struct rb_node *node; 2183975ff7f3SIdo Schimmel int err = 0; 2184975ff7f3SIdo Schimmel 2185975ff7f3SIdo Schimmel for (node = rb_first(root); node; node = rb_next(node)) { 2186975ff7f3SIdo Schimmel struct nexthop *nh; 2187975ff7f3SIdo Schimmel 2188975ff7f3SIdo Schimmel nh = rb_entry(node, struct nexthop, rb_node); 2189975ff7f3SIdo Schimmel err = call_nexthop_notifier(nb, net, NEXTHOP_EVENT_REPLACE, nh, 2190975ff7f3SIdo Schimmel extack); 2191975ff7f3SIdo Schimmel if (err) 2192975ff7f3SIdo Schimmel break; 2193975ff7f3SIdo Schimmel } 2194975ff7f3SIdo Schimmel 2195975ff7f3SIdo Schimmel return err; 2196975ff7f3SIdo Schimmel } 2197975ff7f3SIdo Schimmel 2198ce7e9c8aSIdo Schimmel int register_nexthop_notifier(struct net *net, struct notifier_block *nb, 2199ce7e9c8aSIdo Schimmel struct netlink_ext_ack *extack) 22008590ceedSRoopa Prabhu { 2201975ff7f3SIdo Schimmel int err; 2202975ff7f3SIdo Schimmel 2203975ff7f3SIdo Schimmel rtnl_lock(); 2204975ff7f3SIdo Schimmel err = nexthops_dump(net, nb, extack); 2205975ff7f3SIdo Schimmel if (err) 2206975ff7f3SIdo Schimmel goto unlock; 2207975ff7f3SIdo Schimmel err = blocking_notifier_chain_register(&net->nexthop.notifier_chain, 220880690ec6SIdo Schimmel nb); 2209975ff7f3SIdo Schimmel unlock: 2210975ff7f3SIdo Schimmel rtnl_unlock(); 2211975ff7f3SIdo Schimmel return err; 22128590ceedSRoopa Prabhu } 22138590ceedSRoopa Prabhu EXPORT_SYMBOL(register_nexthop_notifier); 22148590ceedSRoopa Prabhu 22158590ceedSRoopa Prabhu int unregister_nexthop_notifier(struct net *net, struct notifier_block *nb) 22168590ceedSRoopa Prabhu { 221780690ec6SIdo Schimmel return blocking_notifier_chain_unregister(&net->nexthop.notifier_chain, 22188590ceedSRoopa Prabhu nb); 22198590ceedSRoopa Prabhu } 22208590ceedSRoopa Prabhu EXPORT_SYMBOL(unregister_nexthop_notifier); 22218590ceedSRoopa Prabhu 2222e95f2592SIdo Schimmel void nexthop_set_hw_flags(struct net *net, u32 id, bool offload, bool trap) 2223e95f2592SIdo Schimmel { 2224e95f2592SIdo Schimmel struct nexthop *nexthop; 2225e95f2592SIdo Schimmel 2226e95f2592SIdo Schimmel rcu_read_lock(); 2227e95f2592SIdo Schimmel 2228e95f2592SIdo Schimmel nexthop = nexthop_find_by_id(net, id); 2229e95f2592SIdo Schimmel if (!nexthop) 2230e95f2592SIdo Schimmel goto out; 2231e95f2592SIdo Schimmel 2232e95f2592SIdo Schimmel nexthop->nh_flags &= ~(RTNH_F_OFFLOAD | RTNH_F_TRAP); 2233e95f2592SIdo Schimmel if (offload) 2234e95f2592SIdo Schimmel nexthop->nh_flags |= RTNH_F_OFFLOAD; 2235e95f2592SIdo Schimmel if (trap) 2236e95f2592SIdo Schimmel nexthop->nh_flags |= RTNH_F_TRAP; 2237e95f2592SIdo Schimmel 2238e95f2592SIdo Schimmel out: 2239e95f2592SIdo Schimmel rcu_read_unlock(); 2240e95f2592SIdo Schimmel } 2241e95f2592SIdo Schimmel EXPORT_SYMBOL(nexthop_set_hw_flags); 2242e95f2592SIdo Schimmel 2243ab84be7eSDavid Ahern static void __net_exit nexthop_net_exit(struct net *net) 2244ab84be7eSDavid Ahern { 2245ab84be7eSDavid Ahern rtnl_lock(); 2246ab84be7eSDavid Ahern flush_all_nexthops(net); 2247ab84be7eSDavid Ahern rtnl_unlock(); 2248597cfe4fSDavid Ahern kfree(net->nexthop.devhash); 2249ab84be7eSDavid Ahern } 2250ab84be7eSDavid Ahern 2251ab84be7eSDavid Ahern static int __net_init nexthop_net_init(struct net *net) 2252ab84be7eSDavid Ahern { 2253597cfe4fSDavid Ahern size_t sz = sizeof(struct hlist_head) * NH_DEV_HASHSIZE; 2254597cfe4fSDavid Ahern 2255ab84be7eSDavid Ahern net->nexthop.rb_root = RB_ROOT; 2256597cfe4fSDavid Ahern net->nexthop.devhash = kzalloc(sz, GFP_KERNEL); 2257597cfe4fSDavid Ahern if (!net->nexthop.devhash) 2258597cfe4fSDavid Ahern return -ENOMEM; 225980690ec6SIdo Schimmel BLOCKING_INIT_NOTIFIER_HEAD(&net->nexthop.notifier_chain); 2260ab84be7eSDavid Ahern 2261ab84be7eSDavid Ahern return 0; 2262ab84be7eSDavid Ahern } 2263ab84be7eSDavid Ahern 2264ab84be7eSDavid Ahern static struct pernet_operations nexthop_net_ops = { 2265ab84be7eSDavid Ahern .init = nexthop_net_init, 2266ab84be7eSDavid Ahern .exit = nexthop_net_exit, 2267ab84be7eSDavid Ahern }; 2268ab84be7eSDavid Ahern 2269ab84be7eSDavid Ahern static int __init nexthop_init(void) 2270ab84be7eSDavid Ahern { 2271ab84be7eSDavid Ahern register_pernet_subsys(&nexthop_net_ops); 2272ab84be7eSDavid Ahern 2273597cfe4fSDavid Ahern register_netdevice_notifier(&nh_netdev_notifier); 2274597cfe4fSDavid Ahern 2275ab84be7eSDavid Ahern rtnl_register(PF_UNSPEC, RTM_NEWNEXTHOP, rtm_new_nexthop, NULL, 0); 2276ab84be7eSDavid Ahern rtnl_register(PF_UNSPEC, RTM_DELNEXTHOP, rtm_del_nexthop, NULL, 0); 2277ab84be7eSDavid Ahern rtnl_register(PF_UNSPEC, RTM_GETNEXTHOP, rtm_get_nexthop, 2278ab84be7eSDavid Ahern rtm_dump_nexthop, 0); 2279ab84be7eSDavid Ahern 2280ab84be7eSDavid Ahern rtnl_register(PF_INET, RTM_NEWNEXTHOP, rtm_new_nexthop, NULL, 0); 2281ab84be7eSDavid Ahern rtnl_register(PF_INET, RTM_GETNEXTHOP, NULL, rtm_dump_nexthop, 0); 2282ab84be7eSDavid Ahern 2283ab84be7eSDavid Ahern rtnl_register(PF_INET6, RTM_NEWNEXTHOP, rtm_new_nexthop, NULL, 0); 2284ab84be7eSDavid Ahern rtnl_register(PF_INET6, RTM_GETNEXTHOP, NULL, rtm_dump_nexthop, 0); 2285ab84be7eSDavid Ahern 2286ab84be7eSDavid Ahern return 0; 2287ab84be7eSDavid Ahern } 2288ab84be7eSDavid Ahern subsys_initcall(nexthop_init); 2289