12a8cc6c8SYOSHIFUJI Hideaki /* 22a8cc6c8SYOSHIFUJI Hideaki * IPv6 Address Label subsystem 32a8cc6c8SYOSHIFUJI Hideaki * for the IPv6 "Default" Source Address Selection 42a8cc6c8SYOSHIFUJI Hideaki * 52a8cc6c8SYOSHIFUJI Hideaki * Copyright (C)2007 USAGI/WIDE Project 62a8cc6c8SYOSHIFUJI Hideaki */ 72a8cc6c8SYOSHIFUJI Hideaki /* 82a8cc6c8SYOSHIFUJI Hideaki * Author: 92a8cc6c8SYOSHIFUJI Hideaki * YOSHIFUJI Hideaki @ USAGI/WIDE Project <yoshfuji@linux-ipv6.org> 102a8cc6c8SYOSHIFUJI Hideaki */ 112a8cc6c8SYOSHIFUJI Hideaki 122a8cc6c8SYOSHIFUJI Hideaki #include <linux/kernel.h> 132a8cc6c8SYOSHIFUJI Hideaki #include <linux/list.h> 142a8cc6c8SYOSHIFUJI Hideaki #include <linux/rcupdate.h> 152a8cc6c8SYOSHIFUJI Hideaki #include <linux/in6.h> 162a8cc6c8SYOSHIFUJI Hideaki #include <net/addrconf.h> 172a8cc6c8SYOSHIFUJI Hideaki #include <linux/if_addrlabel.h> 182a8cc6c8SYOSHIFUJI Hideaki #include <linux/netlink.h> 192a8cc6c8SYOSHIFUJI Hideaki #include <linux/rtnetlink.h> 202a8cc6c8SYOSHIFUJI Hideaki 212a8cc6c8SYOSHIFUJI Hideaki #if 0 222a8cc6c8SYOSHIFUJI Hideaki #define ADDRLABEL(x...) printk(x) 232a8cc6c8SYOSHIFUJI Hideaki #else 242a8cc6c8SYOSHIFUJI Hideaki #define ADDRLABEL(x...) do { ; } while(0) 252a8cc6c8SYOSHIFUJI Hideaki #endif 262a8cc6c8SYOSHIFUJI Hideaki 272a8cc6c8SYOSHIFUJI Hideaki /* 282a8cc6c8SYOSHIFUJI Hideaki * Policy Table 292a8cc6c8SYOSHIFUJI Hideaki */ 302a8cc6c8SYOSHIFUJI Hideaki struct ip6addrlbl_entry 312a8cc6c8SYOSHIFUJI Hideaki { 323de23255SBenjamin Thery #ifdef CONFIG_NET_NS 333de23255SBenjamin Thery struct net *lbl_net; 343de23255SBenjamin Thery #endif 352a8cc6c8SYOSHIFUJI Hideaki struct in6_addr prefix; 362a8cc6c8SYOSHIFUJI Hideaki int prefixlen; 372a8cc6c8SYOSHIFUJI Hideaki int ifindex; 382a8cc6c8SYOSHIFUJI Hideaki int addrtype; 392a8cc6c8SYOSHIFUJI Hideaki u32 label; 402a8cc6c8SYOSHIFUJI Hideaki struct hlist_node list; 412a8cc6c8SYOSHIFUJI Hideaki atomic_t refcnt; 422a8cc6c8SYOSHIFUJI Hideaki struct rcu_head rcu; 432a8cc6c8SYOSHIFUJI Hideaki }; 442a8cc6c8SYOSHIFUJI Hideaki 452a8cc6c8SYOSHIFUJI Hideaki static struct ip6addrlbl_table 462a8cc6c8SYOSHIFUJI Hideaki { 472a8cc6c8SYOSHIFUJI Hideaki struct hlist_head head; 482a8cc6c8SYOSHIFUJI Hideaki spinlock_t lock; 492a8cc6c8SYOSHIFUJI Hideaki u32 seq; 502a8cc6c8SYOSHIFUJI Hideaki } ip6addrlbl_table; 512a8cc6c8SYOSHIFUJI Hideaki 523de23255SBenjamin Thery static inline 533de23255SBenjamin Thery struct net *ip6addrlbl_net(const struct ip6addrlbl_entry *lbl) 543de23255SBenjamin Thery { 553de23255SBenjamin Thery #ifdef CONFIG_NET_NS 563de23255SBenjamin Thery return lbl->lbl_net; 573de23255SBenjamin Thery #else 583de23255SBenjamin Thery return &init_net; 593de23255SBenjamin Thery #endif 603de23255SBenjamin Thery } 613de23255SBenjamin Thery 622a8cc6c8SYOSHIFUJI Hideaki /* 632a8cc6c8SYOSHIFUJI Hideaki * Default policy table (RFC3484 + extensions) 642a8cc6c8SYOSHIFUJI Hideaki * 652a8cc6c8SYOSHIFUJI Hideaki * prefix addr_type label 662a8cc6c8SYOSHIFUJI Hideaki * ------------------------------------------------------------------------- 672a8cc6c8SYOSHIFUJI Hideaki * ::1/128 LOOPBACK 0 682a8cc6c8SYOSHIFUJI Hideaki * ::/0 N/A 1 692a8cc6c8SYOSHIFUJI Hideaki * 2002::/16 N/A 2 702a8cc6c8SYOSHIFUJI Hideaki * ::/96 COMPATv4 3 712a8cc6c8SYOSHIFUJI Hideaki * ::ffff:0:0/96 V4MAPPED 4 722a8cc6c8SYOSHIFUJI Hideaki * fc00::/7 N/A 5 ULA (RFC 4193) 732a8cc6c8SYOSHIFUJI Hideaki * 2001::/32 N/A 6 Teredo (RFC 4380) 745fe47b8aSJuha-Matti Tapio * 2001:10::/28 N/A 7 ORCHID (RFC 4843) 752a8cc6c8SYOSHIFUJI Hideaki * 762a8cc6c8SYOSHIFUJI Hideaki * Note: 0xffffffff is used if we do not have any policies. 772a8cc6c8SYOSHIFUJI Hideaki */ 782a8cc6c8SYOSHIFUJI Hideaki 792a8cc6c8SYOSHIFUJI Hideaki #define IPV6_ADDR_LABEL_DEFAULT 0xffffffffUL 802a8cc6c8SYOSHIFUJI Hideaki 813de23255SBenjamin Thery static const __net_initdata struct ip6addrlbl_init_table 822a8cc6c8SYOSHIFUJI Hideaki { 832a8cc6c8SYOSHIFUJI Hideaki const struct in6_addr *prefix; 842a8cc6c8SYOSHIFUJI Hideaki int prefixlen; 852a8cc6c8SYOSHIFUJI Hideaki u32 label; 862a8cc6c8SYOSHIFUJI Hideaki } ip6addrlbl_init_table[] = { 872a8cc6c8SYOSHIFUJI Hideaki { /* ::/0 */ 882a8cc6c8SYOSHIFUJI Hideaki .prefix = &in6addr_any, 892a8cc6c8SYOSHIFUJI Hideaki .label = 1, 902a8cc6c8SYOSHIFUJI Hideaki },{ /* fc00::/7 */ 912a8cc6c8SYOSHIFUJI Hideaki .prefix = &(struct in6_addr){{{ 0xfc }}}, 922a8cc6c8SYOSHIFUJI Hideaki .prefixlen = 7, 932a8cc6c8SYOSHIFUJI Hideaki .label = 5, 942a8cc6c8SYOSHIFUJI Hideaki },{ /* 2002::/16 */ 952a8cc6c8SYOSHIFUJI Hideaki .prefix = &(struct in6_addr){{{ 0x20, 0x02 }}}, 962a8cc6c8SYOSHIFUJI Hideaki .prefixlen = 16, 972a8cc6c8SYOSHIFUJI Hideaki .label = 2, 982a8cc6c8SYOSHIFUJI Hideaki },{ /* 2001::/32 */ 992a8cc6c8SYOSHIFUJI Hideaki .prefix = &(struct in6_addr){{{ 0x20, 0x01 }}}, 1002a8cc6c8SYOSHIFUJI Hideaki .prefixlen = 32, 1012a8cc6c8SYOSHIFUJI Hideaki .label = 6, 1025fe47b8aSJuha-Matti Tapio },{ /* 2001:10::/28 */ 1035fe47b8aSJuha-Matti Tapio .prefix = &(struct in6_addr){{{ 0x20, 0x01, 0x00, 0x10 }}}, 1045fe47b8aSJuha-Matti Tapio .prefixlen = 28, 1055fe47b8aSJuha-Matti Tapio .label = 7, 1062a8cc6c8SYOSHIFUJI Hideaki },{ /* ::ffff:0:0 */ 1072a8cc6c8SYOSHIFUJI Hideaki .prefix = &(struct in6_addr){{{ [10] = 0xff, [11] = 0xff }}}, 1082a8cc6c8SYOSHIFUJI Hideaki .prefixlen = 96, 1092a8cc6c8SYOSHIFUJI Hideaki .label = 4, 1102a8cc6c8SYOSHIFUJI Hideaki },{ /* ::/96 */ 1112a8cc6c8SYOSHIFUJI Hideaki .prefix = &in6addr_any, 1122a8cc6c8SYOSHIFUJI Hideaki .prefixlen = 96, 1132a8cc6c8SYOSHIFUJI Hideaki .label = 3, 1142a8cc6c8SYOSHIFUJI Hideaki },{ /* ::1/128 */ 1152a8cc6c8SYOSHIFUJI Hideaki .prefix = &in6addr_loopback, 1162a8cc6c8SYOSHIFUJI Hideaki .prefixlen = 128, 1172a8cc6c8SYOSHIFUJI Hideaki .label = 0, 1182a8cc6c8SYOSHIFUJI Hideaki } 1192a8cc6c8SYOSHIFUJI Hideaki }; 1202a8cc6c8SYOSHIFUJI Hideaki 1212a8cc6c8SYOSHIFUJI Hideaki /* Object management */ 1222a8cc6c8SYOSHIFUJI Hideaki static inline void ip6addrlbl_free(struct ip6addrlbl_entry *p) 1232a8cc6c8SYOSHIFUJI Hideaki { 1243de23255SBenjamin Thery #ifdef CONFIG_NET_NS 1253de23255SBenjamin Thery release_net(p->lbl_net); 1263de23255SBenjamin Thery #endif 1272a8cc6c8SYOSHIFUJI Hideaki kfree(p); 1282a8cc6c8SYOSHIFUJI Hideaki } 1292a8cc6c8SYOSHIFUJI Hideaki 13085040bcbSYOSHIFUJI Hideaki static void ip6addrlbl_free_rcu(struct rcu_head *h) 13185040bcbSYOSHIFUJI Hideaki { 13285040bcbSYOSHIFUJI Hideaki ip6addrlbl_free(container_of(h, struct ip6addrlbl_entry, rcu)); 13385040bcbSYOSHIFUJI Hideaki } 13485040bcbSYOSHIFUJI Hideaki 1352a8cc6c8SYOSHIFUJI Hideaki static inline int ip6addrlbl_hold(struct ip6addrlbl_entry *p) 1362a8cc6c8SYOSHIFUJI Hideaki { 1372a8cc6c8SYOSHIFUJI Hideaki return atomic_inc_not_zero(&p->refcnt); 1382a8cc6c8SYOSHIFUJI Hideaki } 1392a8cc6c8SYOSHIFUJI Hideaki 1402a8cc6c8SYOSHIFUJI Hideaki static inline void ip6addrlbl_put(struct ip6addrlbl_entry *p) 1412a8cc6c8SYOSHIFUJI Hideaki { 1422a8cc6c8SYOSHIFUJI Hideaki if (atomic_dec_and_test(&p->refcnt)) 14385040bcbSYOSHIFUJI Hideaki call_rcu(&p->rcu, ip6addrlbl_free_rcu); 1442a8cc6c8SYOSHIFUJI Hideaki } 1452a8cc6c8SYOSHIFUJI Hideaki 1462a8cc6c8SYOSHIFUJI Hideaki /* Find label */ 1473de23255SBenjamin Thery static int __ip6addrlbl_match(struct net *net, 1483de23255SBenjamin Thery struct ip6addrlbl_entry *p, 1492a8cc6c8SYOSHIFUJI Hideaki const struct in6_addr *addr, 1502a8cc6c8SYOSHIFUJI Hideaki int addrtype, int ifindex) 1512a8cc6c8SYOSHIFUJI Hideaki { 1523de23255SBenjamin Thery if (!net_eq(ip6addrlbl_net(p), net)) 1533de23255SBenjamin Thery return 0; 1542a8cc6c8SYOSHIFUJI Hideaki if (p->ifindex && p->ifindex != ifindex) 1552a8cc6c8SYOSHIFUJI Hideaki return 0; 1562a8cc6c8SYOSHIFUJI Hideaki if (p->addrtype && p->addrtype != addrtype) 1572a8cc6c8SYOSHIFUJI Hideaki return 0; 1582a8cc6c8SYOSHIFUJI Hideaki if (!ipv6_prefix_equal(addr, &p->prefix, p->prefixlen)) 1592a8cc6c8SYOSHIFUJI Hideaki return 0; 1602a8cc6c8SYOSHIFUJI Hideaki return 1; 1612a8cc6c8SYOSHIFUJI Hideaki } 1622a8cc6c8SYOSHIFUJI Hideaki 1633de23255SBenjamin Thery static struct ip6addrlbl_entry *__ipv6_addr_label(struct net *net, 1643de23255SBenjamin Thery const struct in6_addr *addr, 1652a8cc6c8SYOSHIFUJI Hideaki int type, int ifindex) 1662a8cc6c8SYOSHIFUJI Hideaki { 1672a8cc6c8SYOSHIFUJI Hideaki struct hlist_node *pos; 1682a8cc6c8SYOSHIFUJI Hideaki struct ip6addrlbl_entry *p; 1692a8cc6c8SYOSHIFUJI Hideaki hlist_for_each_entry_rcu(p, pos, &ip6addrlbl_table.head, list) { 1703de23255SBenjamin Thery if (__ip6addrlbl_match(net, p, addr, type, ifindex)) 1712a8cc6c8SYOSHIFUJI Hideaki return p; 1722a8cc6c8SYOSHIFUJI Hideaki } 1732a8cc6c8SYOSHIFUJI Hideaki return NULL; 1742a8cc6c8SYOSHIFUJI Hideaki } 1752a8cc6c8SYOSHIFUJI Hideaki 1763de23255SBenjamin Thery u32 ipv6_addr_label(struct net *net, 1773de23255SBenjamin Thery const struct in6_addr *addr, int type, int ifindex) 1782a8cc6c8SYOSHIFUJI Hideaki { 1792a8cc6c8SYOSHIFUJI Hideaki u32 label; 1802a8cc6c8SYOSHIFUJI Hideaki struct ip6addrlbl_entry *p; 1812a8cc6c8SYOSHIFUJI Hideaki 1822a8cc6c8SYOSHIFUJI Hideaki type &= IPV6_ADDR_MAPPED | IPV6_ADDR_COMPATv4 | IPV6_ADDR_LOOPBACK; 1832a8cc6c8SYOSHIFUJI Hideaki 1842a8cc6c8SYOSHIFUJI Hideaki rcu_read_lock(); 1853de23255SBenjamin Thery p = __ipv6_addr_label(net, addr, type, ifindex); 1862a8cc6c8SYOSHIFUJI Hideaki label = p ? p->label : IPV6_ADDR_LABEL_DEFAULT; 1872a8cc6c8SYOSHIFUJI Hideaki rcu_read_unlock(); 1882a8cc6c8SYOSHIFUJI Hideaki 1892a8cc6c8SYOSHIFUJI Hideaki ADDRLABEL(KERN_DEBUG "%s(addr=" NIP6_FMT ", type=%d, ifindex=%d) => %08x\n", 1900dc47877SHarvey Harrison __func__, 1912a8cc6c8SYOSHIFUJI Hideaki NIP6(*addr), type, ifindex, 1922a8cc6c8SYOSHIFUJI Hideaki label); 1932a8cc6c8SYOSHIFUJI Hideaki 1942a8cc6c8SYOSHIFUJI Hideaki return label; 1952a8cc6c8SYOSHIFUJI Hideaki } 1962a8cc6c8SYOSHIFUJI Hideaki 1972a8cc6c8SYOSHIFUJI Hideaki /* allocate one entry */ 1983de23255SBenjamin Thery static struct ip6addrlbl_entry *ip6addrlbl_alloc(struct net *net, 1993de23255SBenjamin Thery const struct in6_addr *prefix, 2002a8cc6c8SYOSHIFUJI Hideaki int prefixlen, int ifindex, 2012a8cc6c8SYOSHIFUJI Hideaki u32 label) 2022a8cc6c8SYOSHIFUJI Hideaki { 2032a8cc6c8SYOSHIFUJI Hideaki struct ip6addrlbl_entry *newp; 2042a8cc6c8SYOSHIFUJI Hideaki int addrtype; 2052a8cc6c8SYOSHIFUJI Hideaki 2062a8cc6c8SYOSHIFUJI Hideaki ADDRLABEL(KERN_DEBUG "%s(prefix=" NIP6_FMT ", prefixlen=%d, ifindex=%d, label=%u)\n", 2070dc47877SHarvey Harrison __func__, 2082a8cc6c8SYOSHIFUJI Hideaki NIP6(*prefix), prefixlen, 2092a8cc6c8SYOSHIFUJI Hideaki ifindex, 2102a8cc6c8SYOSHIFUJI Hideaki (unsigned int)label); 2112a8cc6c8SYOSHIFUJI Hideaki 2122a8cc6c8SYOSHIFUJI Hideaki addrtype = ipv6_addr_type(prefix) & (IPV6_ADDR_MAPPED | IPV6_ADDR_COMPATv4 | IPV6_ADDR_LOOPBACK); 2132a8cc6c8SYOSHIFUJI Hideaki 2142a8cc6c8SYOSHIFUJI Hideaki switch (addrtype) { 2152a8cc6c8SYOSHIFUJI Hideaki case IPV6_ADDR_MAPPED: 2162a8cc6c8SYOSHIFUJI Hideaki if (prefixlen > 96) 2172a8cc6c8SYOSHIFUJI Hideaki return ERR_PTR(-EINVAL); 2182a8cc6c8SYOSHIFUJI Hideaki if (prefixlen < 96) 2192a8cc6c8SYOSHIFUJI Hideaki addrtype = 0; 2202a8cc6c8SYOSHIFUJI Hideaki break; 2212a8cc6c8SYOSHIFUJI Hideaki case IPV6_ADDR_COMPATv4: 2222a8cc6c8SYOSHIFUJI Hideaki if (prefixlen != 96) 2232a8cc6c8SYOSHIFUJI Hideaki addrtype = 0; 2242a8cc6c8SYOSHIFUJI Hideaki break; 2252a8cc6c8SYOSHIFUJI Hideaki case IPV6_ADDR_LOOPBACK: 2262a8cc6c8SYOSHIFUJI Hideaki if (prefixlen != 128) 2272a8cc6c8SYOSHIFUJI Hideaki addrtype = 0; 2282a8cc6c8SYOSHIFUJI Hideaki break; 2292a8cc6c8SYOSHIFUJI Hideaki } 2302a8cc6c8SYOSHIFUJI Hideaki 2312a8cc6c8SYOSHIFUJI Hideaki newp = kmalloc(sizeof(*newp), GFP_KERNEL); 2322a8cc6c8SYOSHIFUJI Hideaki if (!newp) 2332a8cc6c8SYOSHIFUJI Hideaki return ERR_PTR(-ENOMEM); 2342a8cc6c8SYOSHIFUJI Hideaki 2352a8cc6c8SYOSHIFUJI Hideaki ipv6_addr_prefix(&newp->prefix, prefix, prefixlen); 2362a8cc6c8SYOSHIFUJI Hideaki newp->prefixlen = prefixlen; 2372a8cc6c8SYOSHIFUJI Hideaki newp->ifindex = ifindex; 2382a8cc6c8SYOSHIFUJI Hideaki newp->addrtype = addrtype; 2392a8cc6c8SYOSHIFUJI Hideaki newp->label = label; 2402a8cc6c8SYOSHIFUJI Hideaki INIT_HLIST_NODE(&newp->list); 2413de23255SBenjamin Thery #ifdef CONFIG_NET_NS 2423de23255SBenjamin Thery newp->lbl_net = hold_net(net); 2433de23255SBenjamin Thery #endif 2442a8cc6c8SYOSHIFUJI Hideaki atomic_set(&newp->refcnt, 1); 2452a8cc6c8SYOSHIFUJI Hideaki return newp; 2462a8cc6c8SYOSHIFUJI Hideaki } 2472a8cc6c8SYOSHIFUJI Hideaki 2482a8cc6c8SYOSHIFUJI Hideaki /* add a label */ 24940fee36eSYOSHIFUJI Hideaki static int __ip6addrlbl_add(struct ip6addrlbl_entry *newp, int replace) 2502a8cc6c8SYOSHIFUJI Hideaki { 2512a8cc6c8SYOSHIFUJI Hideaki int ret = 0; 2522a8cc6c8SYOSHIFUJI Hideaki 2532a8cc6c8SYOSHIFUJI Hideaki ADDRLABEL(KERN_DEBUG "%s(newp=%p, replace=%d)\n", 2540dc47877SHarvey Harrison __func__, 2552a8cc6c8SYOSHIFUJI Hideaki newp, replace); 2562a8cc6c8SYOSHIFUJI Hideaki 2572a8cc6c8SYOSHIFUJI Hideaki if (hlist_empty(&ip6addrlbl_table.head)) { 2582a8cc6c8SYOSHIFUJI Hideaki hlist_add_head_rcu(&newp->list, &ip6addrlbl_table.head); 2592a8cc6c8SYOSHIFUJI Hideaki } else { 2602a8cc6c8SYOSHIFUJI Hideaki struct hlist_node *pos, *n; 2612a8cc6c8SYOSHIFUJI Hideaki struct ip6addrlbl_entry *p = NULL; 2622a8cc6c8SYOSHIFUJI Hideaki hlist_for_each_entry_safe(p, pos, n, 2632a8cc6c8SYOSHIFUJI Hideaki &ip6addrlbl_table.head, list) { 2642a8cc6c8SYOSHIFUJI Hideaki if (p->prefixlen == newp->prefixlen && 2653de23255SBenjamin Thery net_eq(ip6addrlbl_net(p), ip6addrlbl_net(newp)) && 2662a8cc6c8SYOSHIFUJI Hideaki p->ifindex == newp->ifindex && 2672a8cc6c8SYOSHIFUJI Hideaki ipv6_addr_equal(&p->prefix, &newp->prefix)) { 2682a8cc6c8SYOSHIFUJI Hideaki if (!replace) { 2692a8cc6c8SYOSHIFUJI Hideaki ret = -EEXIST; 2702a8cc6c8SYOSHIFUJI Hideaki goto out; 2712a8cc6c8SYOSHIFUJI Hideaki } 2722a8cc6c8SYOSHIFUJI Hideaki hlist_replace_rcu(&p->list, &newp->list); 2732a8cc6c8SYOSHIFUJI Hideaki ip6addrlbl_put(p); 2742a8cc6c8SYOSHIFUJI Hideaki goto out; 2752a8cc6c8SYOSHIFUJI Hideaki } else if ((p->prefixlen == newp->prefixlen && !p->ifindex) || 2762a8cc6c8SYOSHIFUJI Hideaki (p->prefixlen < newp->prefixlen)) { 2772a8cc6c8SYOSHIFUJI Hideaki hlist_add_before_rcu(&newp->list, &p->list); 2782a8cc6c8SYOSHIFUJI Hideaki goto out; 2792a8cc6c8SYOSHIFUJI Hideaki } 2802a8cc6c8SYOSHIFUJI Hideaki } 2812a8cc6c8SYOSHIFUJI Hideaki hlist_add_after_rcu(&p->list, &newp->list); 2822a8cc6c8SYOSHIFUJI Hideaki } 2832a8cc6c8SYOSHIFUJI Hideaki out: 2842a8cc6c8SYOSHIFUJI Hideaki if (!ret) 2852a8cc6c8SYOSHIFUJI Hideaki ip6addrlbl_table.seq++; 2862a8cc6c8SYOSHIFUJI Hideaki return ret; 2872a8cc6c8SYOSHIFUJI Hideaki } 2882a8cc6c8SYOSHIFUJI Hideaki 2892a8cc6c8SYOSHIFUJI Hideaki /* add a label */ 2903de23255SBenjamin Thery static int ip6addrlbl_add(struct net *net, 2913de23255SBenjamin Thery const struct in6_addr *prefix, int prefixlen, 2922a8cc6c8SYOSHIFUJI Hideaki int ifindex, u32 label, int replace) 2932a8cc6c8SYOSHIFUJI Hideaki { 2942a8cc6c8SYOSHIFUJI Hideaki struct ip6addrlbl_entry *newp; 2952a8cc6c8SYOSHIFUJI Hideaki int ret = 0; 2962a8cc6c8SYOSHIFUJI Hideaki 2972a8cc6c8SYOSHIFUJI Hideaki ADDRLABEL(KERN_DEBUG "%s(prefix=" NIP6_FMT ", prefixlen=%d, ifindex=%d, label=%u, replace=%d)\n", 2980dc47877SHarvey Harrison __func__, 2992a8cc6c8SYOSHIFUJI Hideaki NIP6(*prefix), prefixlen, 3002a8cc6c8SYOSHIFUJI Hideaki ifindex, 3012a8cc6c8SYOSHIFUJI Hideaki (unsigned int)label, 3022a8cc6c8SYOSHIFUJI Hideaki replace); 3032a8cc6c8SYOSHIFUJI Hideaki 3043de23255SBenjamin Thery newp = ip6addrlbl_alloc(net, prefix, prefixlen, ifindex, label); 3052a8cc6c8SYOSHIFUJI Hideaki if (IS_ERR(newp)) 3062a8cc6c8SYOSHIFUJI Hideaki return PTR_ERR(newp); 3072a8cc6c8SYOSHIFUJI Hideaki spin_lock(&ip6addrlbl_table.lock); 3082a8cc6c8SYOSHIFUJI Hideaki ret = __ip6addrlbl_add(newp, replace); 3092a8cc6c8SYOSHIFUJI Hideaki spin_unlock(&ip6addrlbl_table.lock); 3102a8cc6c8SYOSHIFUJI Hideaki if (ret) 3112a8cc6c8SYOSHIFUJI Hideaki ip6addrlbl_free(newp); 3122a8cc6c8SYOSHIFUJI Hideaki return ret; 3132a8cc6c8SYOSHIFUJI Hideaki } 3142a8cc6c8SYOSHIFUJI Hideaki 3152a8cc6c8SYOSHIFUJI Hideaki /* remove a label */ 3163de23255SBenjamin Thery static int __ip6addrlbl_del(struct net *net, 3173de23255SBenjamin Thery const struct in6_addr *prefix, int prefixlen, 3182a8cc6c8SYOSHIFUJI Hideaki int ifindex) 3192a8cc6c8SYOSHIFUJI Hideaki { 3202a8cc6c8SYOSHIFUJI Hideaki struct ip6addrlbl_entry *p = NULL; 3212a8cc6c8SYOSHIFUJI Hideaki struct hlist_node *pos, *n; 3222a8cc6c8SYOSHIFUJI Hideaki int ret = -ESRCH; 3232a8cc6c8SYOSHIFUJI Hideaki 3242a8cc6c8SYOSHIFUJI Hideaki ADDRLABEL(KERN_DEBUG "%s(prefix=" NIP6_FMT ", prefixlen=%d, ifindex=%d)\n", 3250dc47877SHarvey Harrison __func__, 3262a8cc6c8SYOSHIFUJI Hideaki NIP6(*prefix), prefixlen, 3272a8cc6c8SYOSHIFUJI Hideaki ifindex); 3282a8cc6c8SYOSHIFUJI Hideaki 3292a8cc6c8SYOSHIFUJI Hideaki hlist_for_each_entry_safe(p, pos, n, &ip6addrlbl_table.head, list) { 3302a8cc6c8SYOSHIFUJI Hideaki if (p->prefixlen == prefixlen && 3313de23255SBenjamin Thery net_eq(ip6addrlbl_net(p), net) && 3322a8cc6c8SYOSHIFUJI Hideaki p->ifindex == ifindex && 3332a8cc6c8SYOSHIFUJI Hideaki ipv6_addr_equal(&p->prefix, prefix)) { 3342a8cc6c8SYOSHIFUJI Hideaki hlist_del_rcu(&p->list); 3352a8cc6c8SYOSHIFUJI Hideaki ip6addrlbl_put(p); 3362a8cc6c8SYOSHIFUJI Hideaki ret = 0; 3372a8cc6c8SYOSHIFUJI Hideaki break; 3382a8cc6c8SYOSHIFUJI Hideaki } 3392a8cc6c8SYOSHIFUJI Hideaki } 3402a8cc6c8SYOSHIFUJI Hideaki return ret; 3412a8cc6c8SYOSHIFUJI Hideaki } 3422a8cc6c8SYOSHIFUJI Hideaki 3433de23255SBenjamin Thery static int ip6addrlbl_del(struct net *net, 3443de23255SBenjamin Thery const struct in6_addr *prefix, int prefixlen, 3452a8cc6c8SYOSHIFUJI Hideaki int ifindex) 3462a8cc6c8SYOSHIFUJI Hideaki { 3472a8cc6c8SYOSHIFUJI Hideaki struct in6_addr prefix_buf; 3482a8cc6c8SYOSHIFUJI Hideaki int ret; 3492a8cc6c8SYOSHIFUJI Hideaki 3502a8cc6c8SYOSHIFUJI Hideaki ADDRLABEL(KERN_DEBUG "%s(prefix=" NIP6_FMT ", prefixlen=%d, ifindex=%d)\n", 3510dc47877SHarvey Harrison __func__, 3522a8cc6c8SYOSHIFUJI Hideaki NIP6(*prefix), prefixlen, 3532a8cc6c8SYOSHIFUJI Hideaki ifindex); 3542a8cc6c8SYOSHIFUJI Hideaki 3552a8cc6c8SYOSHIFUJI Hideaki ipv6_addr_prefix(&prefix_buf, prefix, prefixlen); 3562a8cc6c8SYOSHIFUJI Hideaki spin_lock(&ip6addrlbl_table.lock); 3573de23255SBenjamin Thery ret = __ip6addrlbl_del(net, &prefix_buf, prefixlen, ifindex); 3582a8cc6c8SYOSHIFUJI Hideaki spin_unlock(&ip6addrlbl_table.lock); 3592a8cc6c8SYOSHIFUJI Hideaki return ret; 3602a8cc6c8SYOSHIFUJI Hideaki } 3612a8cc6c8SYOSHIFUJI Hideaki 3622a8cc6c8SYOSHIFUJI Hideaki /* add default label */ 3633de23255SBenjamin Thery static int __net_init ip6addrlbl_net_init(struct net *net) 3642a8cc6c8SYOSHIFUJI Hideaki { 3652a8cc6c8SYOSHIFUJI Hideaki int err = 0; 3662a8cc6c8SYOSHIFUJI Hideaki int i; 3672a8cc6c8SYOSHIFUJI Hideaki 3680dc47877SHarvey Harrison ADDRLABEL(KERN_DEBUG "%s()\n", __func__); 3692a8cc6c8SYOSHIFUJI Hideaki 3702a8cc6c8SYOSHIFUJI Hideaki for (i = 0; i < ARRAY_SIZE(ip6addrlbl_init_table); i++) { 3713de23255SBenjamin Thery int ret = ip6addrlbl_add(net, 3723de23255SBenjamin Thery ip6addrlbl_init_table[i].prefix, 3732a8cc6c8SYOSHIFUJI Hideaki ip6addrlbl_init_table[i].prefixlen, 3742a8cc6c8SYOSHIFUJI Hideaki 0, 3752a8cc6c8SYOSHIFUJI Hideaki ip6addrlbl_init_table[i].label, 0); 3762a8cc6c8SYOSHIFUJI Hideaki /* XXX: should we free all rules when we catch an error? */ 3772a8cc6c8SYOSHIFUJI Hideaki if (ret && (!err || err != -ENOMEM)) 3782a8cc6c8SYOSHIFUJI Hideaki err = ret; 3792a8cc6c8SYOSHIFUJI Hideaki } 3802a8cc6c8SYOSHIFUJI Hideaki return err; 3812a8cc6c8SYOSHIFUJI Hideaki } 3822a8cc6c8SYOSHIFUJI Hideaki 3833de23255SBenjamin Thery static void __net_exit ip6addrlbl_net_exit(struct net *net) 3843de23255SBenjamin Thery { 3853de23255SBenjamin Thery struct ip6addrlbl_entry *p = NULL; 3863de23255SBenjamin Thery struct hlist_node *pos, *n; 3873de23255SBenjamin Thery 3883de23255SBenjamin Thery /* Remove all labels belonging to the exiting net */ 3893de23255SBenjamin Thery spin_lock(&ip6addrlbl_table.lock); 3903de23255SBenjamin Thery hlist_for_each_entry_safe(p, pos, n, &ip6addrlbl_table.head, list) { 3913de23255SBenjamin Thery if (net_eq(ip6addrlbl_net(p), net)) { 3923de23255SBenjamin Thery hlist_del_rcu(&p->list); 3933de23255SBenjamin Thery ip6addrlbl_put(p); 3943de23255SBenjamin Thery } 3953de23255SBenjamin Thery } 3963de23255SBenjamin Thery spin_unlock(&ip6addrlbl_table.lock); 3973de23255SBenjamin Thery } 3983de23255SBenjamin Thery 3993de23255SBenjamin Thery static struct pernet_operations ipv6_addr_label_ops = { 4003de23255SBenjamin Thery .init = ip6addrlbl_net_init, 4013de23255SBenjamin Thery .exit = ip6addrlbl_net_exit, 4023de23255SBenjamin Thery }; 4033de23255SBenjamin Thery 4042a8cc6c8SYOSHIFUJI Hideaki int __init ipv6_addr_label_init(void) 4052a8cc6c8SYOSHIFUJI Hideaki { 4062a8cc6c8SYOSHIFUJI Hideaki spin_lock_init(&ip6addrlbl_table.lock); 4072a8cc6c8SYOSHIFUJI Hideaki 4083de23255SBenjamin Thery return register_pernet_subsys(&ipv6_addr_label_ops); 4092a8cc6c8SYOSHIFUJI Hideaki } 4102a8cc6c8SYOSHIFUJI Hideaki 4112a8cc6c8SYOSHIFUJI Hideaki static const struct nla_policy ifal_policy[IFAL_MAX+1] = { 4122a8cc6c8SYOSHIFUJI Hideaki [IFAL_ADDRESS] = { .len = sizeof(struct in6_addr), }, 4132a8cc6c8SYOSHIFUJI Hideaki [IFAL_LABEL] = { .len = sizeof(u32), }, 4142a8cc6c8SYOSHIFUJI Hideaki }; 4152a8cc6c8SYOSHIFUJI Hideaki 4162a8cc6c8SYOSHIFUJI Hideaki static int ip6addrlbl_newdel(struct sk_buff *skb, struct nlmsghdr *nlh, 4172a8cc6c8SYOSHIFUJI Hideaki void *arg) 4182a8cc6c8SYOSHIFUJI Hideaki { 4193b1e0a65SYOSHIFUJI Hideaki struct net *net = sock_net(skb->sk); 4202a8cc6c8SYOSHIFUJI Hideaki struct ifaddrlblmsg *ifal; 4212a8cc6c8SYOSHIFUJI Hideaki struct nlattr *tb[IFAL_MAX+1]; 4222a8cc6c8SYOSHIFUJI Hideaki struct in6_addr *pfx; 4232a8cc6c8SYOSHIFUJI Hideaki u32 label; 4242a8cc6c8SYOSHIFUJI Hideaki int err = 0; 4252a8cc6c8SYOSHIFUJI Hideaki 4262a8cc6c8SYOSHIFUJI Hideaki err = nlmsg_parse(nlh, sizeof(*ifal), tb, IFAL_MAX, ifal_policy); 4272a8cc6c8SYOSHIFUJI Hideaki if (err < 0) 4282a8cc6c8SYOSHIFUJI Hideaki return err; 4292a8cc6c8SYOSHIFUJI Hideaki 4302a8cc6c8SYOSHIFUJI Hideaki ifal = nlmsg_data(nlh); 4312a8cc6c8SYOSHIFUJI Hideaki 4322a8cc6c8SYOSHIFUJI Hideaki if (ifal->ifal_family != AF_INET6 || 4332a8cc6c8SYOSHIFUJI Hideaki ifal->ifal_prefixlen > 128) 4342a8cc6c8SYOSHIFUJI Hideaki return -EINVAL; 4352a8cc6c8SYOSHIFUJI Hideaki 4362a8cc6c8SYOSHIFUJI Hideaki if (ifal->ifal_index && 4373de23255SBenjamin Thery !__dev_get_by_index(net, ifal->ifal_index)) 4382a8cc6c8SYOSHIFUJI Hideaki return -EINVAL; 4392a8cc6c8SYOSHIFUJI Hideaki 4402a8cc6c8SYOSHIFUJI Hideaki if (!tb[IFAL_ADDRESS]) 4412a8cc6c8SYOSHIFUJI Hideaki return -EINVAL; 4422a8cc6c8SYOSHIFUJI Hideaki 4432a8cc6c8SYOSHIFUJI Hideaki pfx = nla_data(tb[IFAL_ADDRESS]); 4442a8cc6c8SYOSHIFUJI Hideaki if (!pfx) 4452a8cc6c8SYOSHIFUJI Hideaki return -EINVAL; 4462a8cc6c8SYOSHIFUJI Hideaki 4472a8cc6c8SYOSHIFUJI Hideaki if (!tb[IFAL_LABEL]) 4482a8cc6c8SYOSHIFUJI Hideaki return -EINVAL; 4492a8cc6c8SYOSHIFUJI Hideaki label = nla_get_u32(tb[IFAL_LABEL]); 4502a8cc6c8SYOSHIFUJI Hideaki if (label == IPV6_ADDR_LABEL_DEFAULT) 4512a8cc6c8SYOSHIFUJI Hideaki return -EINVAL; 4522a8cc6c8SYOSHIFUJI Hideaki 4532a8cc6c8SYOSHIFUJI Hideaki switch(nlh->nlmsg_type) { 4542a8cc6c8SYOSHIFUJI Hideaki case RTM_NEWADDRLABEL: 4553de23255SBenjamin Thery err = ip6addrlbl_add(net, pfx, ifal->ifal_prefixlen, 4562a8cc6c8SYOSHIFUJI Hideaki ifal->ifal_index, label, 4572a8cc6c8SYOSHIFUJI Hideaki nlh->nlmsg_flags & NLM_F_REPLACE); 4582a8cc6c8SYOSHIFUJI Hideaki break; 4592a8cc6c8SYOSHIFUJI Hideaki case RTM_DELADDRLABEL: 4603de23255SBenjamin Thery err = ip6addrlbl_del(net, pfx, ifal->ifal_prefixlen, 4612a8cc6c8SYOSHIFUJI Hideaki ifal->ifal_index); 4622a8cc6c8SYOSHIFUJI Hideaki break; 4632a8cc6c8SYOSHIFUJI Hideaki default: 4642a8cc6c8SYOSHIFUJI Hideaki err = -EOPNOTSUPP; 4652a8cc6c8SYOSHIFUJI Hideaki } 4662a8cc6c8SYOSHIFUJI Hideaki return err; 4672a8cc6c8SYOSHIFUJI Hideaki } 4682a8cc6c8SYOSHIFUJI Hideaki 4692a8cc6c8SYOSHIFUJI Hideaki static inline void ip6addrlbl_putmsg(struct nlmsghdr *nlh, 4702a8cc6c8SYOSHIFUJI Hideaki int prefixlen, int ifindex, u32 lseq) 4712a8cc6c8SYOSHIFUJI Hideaki { 4722a8cc6c8SYOSHIFUJI Hideaki struct ifaddrlblmsg *ifal = nlmsg_data(nlh); 4732a8cc6c8SYOSHIFUJI Hideaki ifal->ifal_family = AF_INET6; 4742a8cc6c8SYOSHIFUJI Hideaki ifal->ifal_prefixlen = prefixlen; 4752a8cc6c8SYOSHIFUJI Hideaki ifal->ifal_flags = 0; 4762a8cc6c8SYOSHIFUJI Hideaki ifal->ifal_index = ifindex; 4772a8cc6c8SYOSHIFUJI Hideaki ifal->ifal_seq = lseq; 4782a8cc6c8SYOSHIFUJI Hideaki }; 4792a8cc6c8SYOSHIFUJI Hideaki 4802a8cc6c8SYOSHIFUJI Hideaki static int ip6addrlbl_fill(struct sk_buff *skb, 4812a8cc6c8SYOSHIFUJI Hideaki struct ip6addrlbl_entry *p, 4822a8cc6c8SYOSHIFUJI Hideaki u32 lseq, 4832a8cc6c8SYOSHIFUJI Hideaki u32 pid, u32 seq, int event, 4842a8cc6c8SYOSHIFUJI Hideaki unsigned int flags) 4852a8cc6c8SYOSHIFUJI Hideaki { 4862a8cc6c8SYOSHIFUJI Hideaki struct nlmsghdr *nlh = nlmsg_put(skb, pid, seq, event, 4872a8cc6c8SYOSHIFUJI Hideaki sizeof(struct ifaddrlblmsg), flags); 4882a8cc6c8SYOSHIFUJI Hideaki if (!nlh) 4892a8cc6c8SYOSHIFUJI Hideaki return -EMSGSIZE; 4902a8cc6c8SYOSHIFUJI Hideaki 4912a8cc6c8SYOSHIFUJI Hideaki ip6addrlbl_putmsg(nlh, p->prefixlen, p->ifindex, lseq); 4922a8cc6c8SYOSHIFUJI Hideaki 4932a8cc6c8SYOSHIFUJI Hideaki if (nla_put(skb, IFAL_ADDRESS, 16, &p->prefix) < 0 || 4942a8cc6c8SYOSHIFUJI Hideaki nla_put_u32(skb, IFAL_LABEL, p->label) < 0) { 4952a8cc6c8SYOSHIFUJI Hideaki nlmsg_cancel(skb, nlh); 4962a8cc6c8SYOSHIFUJI Hideaki return -EMSGSIZE; 4972a8cc6c8SYOSHIFUJI Hideaki } 4982a8cc6c8SYOSHIFUJI Hideaki 4992a8cc6c8SYOSHIFUJI Hideaki return nlmsg_end(skb, nlh); 5002a8cc6c8SYOSHIFUJI Hideaki } 5012a8cc6c8SYOSHIFUJI Hideaki 5022a8cc6c8SYOSHIFUJI Hideaki static int ip6addrlbl_dump(struct sk_buff *skb, struct netlink_callback *cb) 5032a8cc6c8SYOSHIFUJI Hideaki { 5043b1e0a65SYOSHIFUJI Hideaki struct net *net = sock_net(skb->sk); 5052a8cc6c8SYOSHIFUJI Hideaki struct ip6addrlbl_entry *p; 5062a8cc6c8SYOSHIFUJI Hideaki struct hlist_node *pos; 5072a8cc6c8SYOSHIFUJI Hideaki int idx = 0, s_idx = cb->args[0]; 5082a8cc6c8SYOSHIFUJI Hideaki int err; 5092a8cc6c8SYOSHIFUJI Hideaki 5102a8cc6c8SYOSHIFUJI Hideaki rcu_read_lock(); 5112a8cc6c8SYOSHIFUJI Hideaki hlist_for_each_entry_rcu(p, pos, &ip6addrlbl_table.head, list) { 5123de23255SBenjamin Thery if (idx >= s_idx && 5133de23255SBenjamin Thery net_eq(ip6addrlbl_net(p), net)) { 5142a8cc6c8SYOSHIFUJI Hideaki if ((err = ip6addrlbl_fill(skb, p, 5152a8cc6c8SYOSHIFUJI Hideaki ip6addrlbl_table.seq, 5162a8cc6c8SYOSHIFUJI Hideaki NETLINK_CB(cb->skb).pid, 5172a8cc6c8SYOSHIFUJI Hideaki cb->nlh->nlmsg_seq, 5182a8cc6c8SYOSHIFUJI Hideaki RTM_NEWADDRLABEL, 5192a8cc6c8SYOSHIFUJI Hideaki NLM_F_MULTI)) <= 0) 5202a8cc6c8SYOSHIFUJI Hideaki break; 5212a8cc6c8SYOSHIFUJI Hideaki } 5222a8cc6c8SYOSHIFUJI Hideaki idx++; 5232a8cc6c8SYOSHIFUJI Hideaki } 5242a8cc6c8SYOSHIFUJI Hideaki rcu_read_unlock(); 5252a8cc6c8SYOSHIFUJI Hideaki cb->args[0] = idx; 5262a8cc6c8SYOSHIFUJI Hideaki return skb->len; 5272a8cc6c8SYOSHIFUJI Hideaki } 5282a8cc6c8SYOSHIFUJI Hideaki 5292a8cc6c8SYOSHIFUJI Hideaki static inline int ip6addrlbl_msgsize(void) 5302a8cc6c8SYOSHIFUJI Hideaki { 5312a8cc6c8SYOSHIFUJI Hideaki return (NLMSG_ALIGN(sizeof(struct ifaddrlblmsg)) 5322a8cc6c8SYOSHIFUJI Hideaki + nla_total_size(16) /* IFAL_ADDRESS */ 5332a8cc6c8SYOSHIFUJI Hideaki + nla_total_size(4) /* IFAL_LABEL */ 5342a8cc6c8SYOSHIFUJI Hideaki ); 5352a8cc6c8SYOSHIFUJI Hideaki } 5362a8cc6c8SYOSHIFUJI Hideaki 5372a8cc6c8SYOSHIFUJI Hideaki static int ip6addrlbl_get(struct sk_buff *in_skb, struct nlmsghdr* nlh, 5382a8cc6c8SYOSHIFUJI Hideaki void *arg) 5392a8cc6c8SYOSHIFUJI Hideaki { 5403b1e0a65SYOSHIFUJI Hideaki struct net *net = sock_net(in_skb->sk); 5412a8cc6c8SYOSHIFUJI Hideaki struct ifaddrlblmsg *ifal; 5422a8cc6c8SYOSHIFUJI Hideaki struct nlattr *tb[IFAL_MAX+1]; 5432a8cc6c8SYOSHIFUJI Hideaki struct in6_addr *addr; 5442a8cc6c8SYOSHIFUJI Hideaki u32 lseq; 5452a8cc6c8SYOSHIFUJI Hideaki int err = 0; 5462a8cc6c8SYOSHIFUJI Hideaki struct ip6addrlbl_entry *p; 5472a8cc6c8SYOSHIFUJI Hideaki struct sk_buff *skb; 5482a8cc6c8SYOSHIFUJI Hideaki 5492a8cc6c8SYOSHIFUJI Hideaki err = nlmsg_parse(nlh, sizeof(*ifal), tb, IFAL_MAX, ifal_policy); 5502a8cc6c8SYOSHIFUJI Hideaki if (err < 0) 5512a8cc6c8SYOSHIFUJI Hideaki return err; 5522a8cc6c8SYOSHIFUJI Hideaki 5532a8cc6c8SYOSHIFUJI Hideaki ifal = nlmsg_data(nlh); 5542a8cc6c8SYOSHIFUJI Hideaki 5552a8cc6c8SYOSHIFUJI Hideaki if (ifal->ifal_family != AF_INET6 || 5562a8cc6c8SYOSHIFUJI Hideaki ifal->ifal_prefixlen != 128) 5572a8cc6c8SYOSHIFUJI Hideaki return -EINVAL; 5582a8cc6c8SYOSHIFUJI Hideaki 5592a8cc6c8SYOSHIFUJI Hideaki if (ifal->ifal_index && 5603de23255SBenjamin Thery !__dev_get_by_index(net, ifal->ifal_index)) 5612a8cc6c8SYOSHIFUJI Hideaki return -EINVAL; 5622a8cc6c8SYOSHIFUJI Hideaki 5632a8cc6c8SYOSHIFUJI Hideaki if (!tb[IFAL_ADDRESS]) 5642a8cc6c8SYOSHIFUJI Hideaki return -EINVAL; 5652a8cc6c8SYOSHIFUJI Hideaki 5662a8cc6c8SYOSHIFUJI Hideaki addr = nla_data(tb[IFAL_ADDRESS]); 5672a8cc6c8SYOSHIFUJI Hideaki if (!addr) 5682a8cc6c8SYOSHIFUJI Hideaki return -EINVAL; 5692a8cc6c8SYOSHIFUJI Hideaki 5702a8cc6c8SYOSHIFUJI Hideaki rcu_read_lock(); 5713de23255SBenjamin Thery p = __ipv6_addr_label(net, addr, ipv6_addr_type(addr), ifal->ifal_index); 5722a8cc6c8SYOSHIFUJI Hideaki if (p && ip6addrlbl_hold(p)) 5732a8cc6c8SYOSHIFUJI Hideaki p = NULL; 5742a8cc6c8SYOSHIFUJI Hideaki lseq = ip6addrlbl_table.seq; 5752a8cc6c8SYOSHIFUJI Hideaki rcu_read_unlock(); 5762a8cc6c8SYOSHIFUJI Hideaki 5772a8cc6c8SYOSHIFUJI Hideaki if (!p) { 5782a8cc6c8SYOSHIFUJI Hideaki err = -ESRCH; 5792a8cc6c8SYOSHIFUJI Hideaki goto out; 5802a8cc6c8SYOSHIFUJI Hideaki } 5812a8cc6c8SYOSHIFUJI Hideaki 5822a8cc6c8SYOSHIFUJI Hideaki if (!(skb = nlmsg_new(ip6addrlbl_msgsize(), GFP_KERNEL))) { 5832a8cc6c8SYOSHIFUJI Hideaki ip6addrlbl_put(p); 5842a8cc6c8SYOSHIFUJI Hideaki return -ENOBUFS; 5852a8cc6c8SYOSHIFUJI Hideaki } 5862a8cc6c8SYOSHIFUJI Hideaki 5872a8cc6c8SYOSHIFUJI Hideaki err = ip6addrlbl_fill(skb, p, lseq, 5882a8cc6c8SYOSHIFUJI Hideaki NETLINK_CB(in_skb).pid, nlh->nlmsg_seq, 5892a8cc6c8SYOSHIFUJI Hideaki RTM_NEWADDRLABEL, 0); 5902a8cc6c8SYOSHIFUJI Hideaki 5912a8cc6c8SYOSHIFUJI Hideaki ip6addrlbl_put(p); 5922a8cc6c8SYOSHIFUJI Hideaki 5932a8cc6c8SYOSHIFUJI Hideaki if (err < 0) { 5942a8cc6c8SYOSHIFUJI Hideaki WARN_ON(err == -EMSGSIZE); 5952a8cc6c8SYOSHIFUJI Hideaki kfree_skb(skb); 5962a8cc6c8SYOSHIFUJI Hideaki goto out; 5972a8cc6c8SYOSHIFUJI Hideaki } 5982a8cc6c8SYOSHIFUJI Hideaki 5993de23255SBenjamin Thery err = rtnl_unicast(skb, net, NETLINK_CB(in_skb).pid); 6002a8cc6c8SYOSHIFUJI Hideaki out: 6012a8cc6c8SYOSHIFUJI Hideaki return err; 6022a8cc6c8SYOSHIFUJI Hideaki } 6032a8cc6c8SYOSHIFUJI Hideaki 6042a8cc6c8SYOSHIFUJI Hideaki void __init ipv6_addr_label_rtnl_register(void) 6052a8cc6c8SYOSHIFUJI Hideaki { 6062a8cc6c8SYOSHIFUJI Hideaki __rtnl_register(PF_INET6, RTM_NEWADDRLABEL, ip6addrlbl_newdel, NULL); 6072a8cc6c8SYOSHIFUJI Hideaki __rtnl_register(PF_INET6, RTM_DELADDRLABEL, ip6addrlbl_newdel, NULL); 6082a8cc6c8SYOSHIFUJI Hideaki __rtnl_register(PF_INET6, RTM_GETADDRLABEL, ip6addrlbl_get, ip6addrlbl_dump); 6092a8cc6c8SYOSHIFUJI Hideaki } 6102a8cc6c8SYOSHIFUJI Hideaki 611