net/ipv4/fib_frontend.c

   1 /*
   2  * INET         An implementation of the TCP/IP protocol suite for the LINUX
   3  *              operating system.  INET is implemented using the  BSD Socket
   4  *              interface as the means of communication with the user level.
   5  *
   6  *              IPv4 Forwarding Information Base: FIB frontend.
   7  *
   8  * Version:     $Id: fib_frontend.c,v 1.26 2001/10/31 21:55:54 davem Exp $
   9  *
  10  * Authors:     Alexey Kuznetsov, <kuznet@ms2.inr.ac.ru>
  11  *
  12  *              This program is free software; you can redistribute it and/or
  13  *              modify it under the terms of the GNU General Public License
  14  *              as published by the Free Software Foundation; either version
  15  *              2 of the License, or (at your option) any later version.
  16  */
  17
  18 #include <linux/module.h>
  19 #include <asm/uaccess.h>
  20 #include <asm/system.h>
  21 #include <linux/bitops.h>
  22 #include <linux/capability.h>
  23 #include <linux/types.h>
  24 #include <linux/kernel.h>
  25 #include <linux/sched.h>
  26 #include <linux/mm.h>
  27 #include <linux/string.h>
  28 #include <linux/socket.h>
  29 #include <linux/sockios.h>
  30 #include <linux/errno.h>
  31 #include <linux/in.h>
  32 #include <linux/inet.h>
  33 #include <linux/inetdevice.h>
  34 #include <linux/netdevice.h>
  35 #include <linux/if_addr.h>
  36 #include <linux/if_arp.h>
  37 #include <linux/skbuff.h>
  38 #include <linux/netlink.h>
  39 #include <linux/init.h>
  40 #include <linux/list.h>
  41
  42 #include <net/ip.h>
  43 #include <net/protocol.h>
  44 #include <net/route.h>
  45 #include <net/tcp.h>
  46 #include <net/sock.h>
  47 #include <net/icmp.h>
  48 #include <net/arp.h>
  49 #include <net/ip_fib.h>
  50
  51 #define FFprint(a...) printk(KERN_DEBUG a)
  52
  53 #ifndef CONFIG_IP_MULTIPLE_TABLES
  54
  55 struct fib_table *ip_fib_local_table;
  56 struct fib_table *ip_fib_main_table;
  57
  58 #define FIB_TABLE_HASHSZ 1
  59 static struct hlist_head fib_table_hash[FIB_TABLE_HASHSZ];
  60
  61 #else
  62
  63 #define FIB_TABLE_HASHSZ 256
  64 static struct hlist_head fib_table_hash[FIB_TABLE_HASHSZ];
  65
  66 struct fib_table *fib_new_table(u32 id)
  67 {
  68         struct fib_table *tb;
  69         unsigned int h;
  70
  71         if (id == 0)
  72                 id = RT_TABLE_MAIN;
  73         tb = fib_get_table(id);
  74         if (tb)
  75                 return tb;
  76         tb = fib_hash_init(id);
  77         if (!tb)
  78                 return NULL;
  79         h = id & (FIB_TABLE_HASHSZ - 1);
  80         hlist_add_head_rcu(&tb->tb_hlist, &fib_table_hash[h]);
  81         return tb;
  82 }
  83
  84 struct fib_table *fib_get_table(u32 id)
  85 {
  86         struct fib_table *tb;
  87         struct hlist_node *node;
  88         unsigned int h;
  89
  90         if (id == 0)
  91                 id = RT_TABLE_MAIN;
  92         h = id & (FIB_TABLE_HASHSZ - 1);
  93         rcu_read_lock();
  94         hlist_for_each_entry_rcu(tb, node, &fib_table_hash[h], tb_hlist) {
  95                 if (tb->tb_id == id) {
  96                         rcu_read_unlock();
  97                         return tb;
  98                 }
  99         }
 100         rcu_read_unlock();
 101         return NULL;
 102 }
 103 #endif /* CONFIG_IP_MULTIPLE_TABLES */
 104
 105 static void fib_flush(void)
 106 {
 107         int flushed = 0;
 108         struct fib_table *tb;
 109         struct hlist_node *node;
 110         unsigned int h;
 111
 112         for (h = 0; h < FIB_TABLE_HASHSZ; h++) {
 113                 hlist_for_each_entry(tb, node, &fib_table_hash[h], tb_hlist)
 114                         flushed += tb->tb_flush(tb);
 115         }
 116
 117         if (flushed)
 118                 rt_cache_flush(-1);
 119 }
 120
 121 /*
 122  *      Find the first device with a given source address.
 123  */
 124
 125 struct net_device * ip_dev_find(__be32 addr)
 126 {
 127         struct flowi fl = { .nl_u = { .ip4_u = { .daddr = addr } } };
 128         struct fib_result res;
 129         struct net_device *dev = NULL;
 130
 131 #ifdef CONFIG_IP_MULTIPLE_TABLES
 132         res.r = NULL;
 133 #endif
 134
 135         if (!ip_fib_local_table ||
 136             ip_fib_local_table->tb_lookup(ip_fib_local_table, &fl, &res))
 137                 return NULL;
 138         if (res.type != RTN_LOCAL)
 139                 goto out;
 140         dev = FIB_RES_DEV(res);
 141
 142         if (dev)
 143                 dev_hold(dev);
 144 out:
 145         fib_res_put(&res);
 146         return dev;
 147 }
 148
 149 unsigned inet_addr_type(__be32 addr)
 150 {
 151         struct flowi            fl = { .nl_u = { .ip4_u = { .daddr = addr } } };
 152         struct fib_result       res;
 153         unsigned ret = RTN_BROADCAST;
 154
 155         if (ZERONET(addr) || BADCLASS(addr))
 156                 return RTN_BROADCAST;
 157         if (MULTICAST(addr))
 158                 return RTN_MULTICAST;
 159
 160 #ifdef CONFIG_IP_MULTIPLE_TABLES
 161         res.r = NULL;
 162 #endif
 163
 164         if (ip_fib_local_table) {
 165                 ret = RTN_UNICAST;
 166                 if (!ip_fib_local_table->tb_lookup(ip_fib_local_table,
 167                                                    &fl, &res)) {
 168                         ret = res.type;
 169                         fib_res_put(&res);
 170                 }
 171         }
 172         return ret;
 173 }
 174
 175 /* Given (packet source, input interface) and optional (dst, oif, tos):
 176    - (main) check, that source is valid i.e. not broadcast or our local
 177      address.
 178    - figure out what "logical" interface this packet arrived
 179      and calculate "specific destination" address.
 180    - check, that packet arrived from expected physical interface.
 181  */
 182
 183 int fib_validate_source(__be32 src, __be32 dst, u8 tos, int oif,
 184                         struct net_device *dev, __be32 *spec_dst, u32 *itag)
 185 {
 186         struct in_device *in_dev;
 187         struct flowi fl = { .nl_u = { .ip4_u =
 188                                       { .daddr = src,
 189                                         .saddr = dst,
 190                                         .tos = tos } },
 191                             .iif = oif };
 192         struct fib_result res;
 193         int no_addr, rpf;
 194         int ret;
 195
 196         no_addr = rpf = 0;
 197         rcu_read_lock();
 198         in_dev = __in_dev_get_rcu(dev);
 199         if (in_dev) {
 200                 no_addr = in_dev->ifa_list == NULL;
 201                 rpf = IN_DEV_RPFILTER(in_dev);
 202         }
 203         rcu_read_unlock();
 204
 205         if (in_dev == NULL)
 206                 goto e_inval;
 207
 208         if (fib_lookup(&fl, &res))
 209                 goto last_resort;
 210         if (res.type != RTN_UNICAST)
 211                 goto e_inval_res;
 212         *spec_dst = FIB_RES_PREFSRC(res);
 213         fib_combine_itag(itag, &res);
 214 #ifdef CONFIG_IP_ROUTE_MULTIPATH
 215         if (FIB_RES_DEV(res) == dev || res.fi->fib_nhs > 1)
 216 #else
 217         if (FIB_RES_DEV(res) == dev)
 218 #endif
 219         {
 220                 ret = FIB_RES_NH(res).nh_scope >= RT_SCOPE_HOST;
 221                 fib_res_put(&res);
 222                 return ret;
 223         }
 224         fib_res_put(&res);
 225         if (no_addr)
 226                 goto last_resort;
 227         if (rpf)
 228                 goto e_inval;
 229         fl.oif = dev->ifindex;
 230
 231         ret = 0;
 232         if (fib_lookup(&fl, &res) == 0) {
 233                 if (res.type == RTN_UNICAST) {
 234                         *spec_dst = FIB_RES_PREFSRC(res);
 235                         ret = FIB_RES_NH(res).nh_scope >= RT_SCOPE_HOST;
 236                 }
 237                 fib_res_put(&res);
 238         }
 239         return ret;
 240
 241 last_resort:
 242         if (rpf)
 243                 goto e_inval;
 244         *spec_dst = inet_select_addr(dev, 0, RT_SCOPE_UNIVERSE);
 245         *itag = 0;
 246         return 0;
 247
 248 e_inval_res:
 249         fib_res_put(&res);
 250 e_inval:
 251         return -EINVAL;
 252 }
 253
 254 #ifndef CONFIG_IP_NOSIOCRT
 255
 256 static inline __be32 sk_extract_addr(struct sockaddr *addr)
 257 {
 258         return ((struct sockaddr_in *) addr)->sin_addr.s_addr;
 259 }
 260
 261 static int put_rtax(struct nlattr *mx, int len, int type, u32 value)
 262 {
 263         struct nlattr *nla;
 264
 265         nla = (struct nlattr *) ((char *) mx + len);
 266         nla->nla_type = type;
 267         nla->nla_len = nla_attr_size(4);
 268         *(u32 *) nla_data(nla) = value;
 269
 270         return len + nla_total_size(4);
 271 }
 272
 273 static int rtentry_to_fib_config(int cmd, struct rtentry *rt,
 274                                  struct fib_config *cfg)
 275 {
 276         __be32 addr;
 277         int plen;
 278
 279         memset(cfg, 0, sizeof(*cfg));
 280
 281         if (rt->rt_dst.sa_family != AF_INET)
 282                 return -EAFNOSUPPORT;
 283
 284         /*
 285          * Check mask for validity:
 286          * a) it must be contiguous.
 287          * b) destination must have all host bits clear.
 288          * c) if application forgot to set correct family (AF_INET),
 289          *    reject request unless it is absolutely clear i.e.
 290          *    both family and mask are zero.
 291          */
 292         plen = 32;
 293         addr = sk_extract_addr(&rt->rt_dst);
 294         if (!(rt->rt_flags & RTF_HOST)) {
 295                 __be32 mask = sk_extract_addr(&rt->rt_genmask);
 296
 297                 if (rt->rt_genmask.sa_family != AF_INET) {
 298                         if (mask || rt->rt_genmask.sa_family)
 299                                 return -EAFNOSUPPORT;
 300                 }
 301
 302                 if (bad_mask(mask, addr))
 303                         return -EINVAL;
 304
 305                 plen = inet_mask_len(mask);
 306         }
 307
 308         cfg->fc_dst_len = plen;
 309         cfg->fc_dst = addr;
 310
 311         if (cmd != SIOCDELRT) {
 312                 cfg->fc_nlflags = NLM_F_CREATE;
 313                 cfg->fc_protocol = RTPROT_BOOT;
 314         }
 315
 316         if (rt->rt_metric)
 317                 cfg->fc_priority = rt->rt_metric - 1;
 318
 319         if (rt->rt_flags & RTF_REJECT) {
 320                 cfg->fc_scope = RT_SCOPE_HOST;
 321                 cfg->fc_type = RTN_UNREACHABLE;
 322                 return 0;
 323         }
 324
 325         cfg->fc_scope = RT_SCOPE_NOWHERE;
 326         cfg->fc_type = RTN_UNICAST;
 327
 328         if (rt->rt_dev) {
 329                 char *colon;
 330                 struct net_device *dev;
 331                 char devname[IFNAMSIZ];
 332
 333                 if (copy_from_user(devname, rt->rt_dev, IFNAMSIZ-1))
 334                         return -EFAULT;
 335
 336                 devname[IFNAMSIZ-1] = 0;
 337                 colon = strchr(devname, ':');
 338                 if (colon)
 339                         *colon = 0;
 340                 dev = __dev_get_by_name(devname);
 341                 if (!dev)
 342                         return -ENODEV;
 343                 cfg->fc_oif = dev->ifindex;
 344                 if (colon) {
 345                         struct in_ifaddr *ifa;
 346                         struct in_device *in_dev = __in_dev_get_rtnl(dev);
 347                         if (!in_dev)
 348                                 return -ENODEV;
 349                         *colon = ':';
 350                         for (ifa = in_dev->ifa_list; ifa; ifa = ifa->ifa_next)
 351                                 if (strcmp(ifa->ifa_label, devname) == 0)
 352                                         break;
 353                         if (ifa == NULL)
 354                                 return -ENODEV;
 355                         cfg->fc_prefsrc = ifa->ifa_local;
 356                 }
 357         }
 358
 359         addr = sk_extract_addr(&rt->rt_gateway);
 360         if (rt->rt_gateway.sa_family == AF_INET && addr) {
 361                 cfg->fc_gw = addr;
 362                 if (rt->rt_flags & RTF_GATEWAY &&
 363                     inet_addr_type(addr) == RTN_UNICAST)
 364                         cfg->fc_scope = RT_SCOPE_UNIVERSE;
 365         }
 366
 367         if (cmd == SIOCDELRT)
 368                 return 0;
 369
 370         if (rt->rt_flags & RTF_GATEWAY && !cfg->fc_gw)
 371                 return -EINVAL;
 372
 373         if (cfg->fc_scope == RT_SCOPE_NOWHERE)
 374                 cfg->fc_scope = RT_SCOPE_LINK;
 375
 376         if (rt->rt_flags & (RTF_MTU | RTF_WINDOW | RTF_IRTT)) {
 377                 struct nlattr *mx;
 378                 int len = 0;
 379
 380                 mx = kzalloc(3 * nla_total_size(4), GFP_KERNEL);
 381                 if (mx == NULL)
 382                         return -ENOMEM;
 383
 384                 if (rt->rt_flags & RTF_MTU)
 385                         len = put_rtax(mx, len, RTAX_ADVMSS, rt->rt_mtu - 40);
 386
 387                 if (rt->rt_flags & RTF_WINDOW)
 388                         len = put_rtax(mx, len, RTAX_WINDOW, rt->rt_window);
 389
 390                 if (rt->rt_flags & RTF_IRTT)
 391                         len = put_rtax(mx, len, RTAX_RTT, rt->rt_irtt << 3);
 392
 393                 cfg->fc_mx = mx;
 394                 cfg->fc_mx_len = len;
 395         }
 396
 397         return 0;
 398 }
 399
 400 /*
 401  *      Handle IP routing ioctl calls. These are used to manipulate the routing tables
 402  */
 403
 404 int ip_rt_ioctl(unsigned int cmd, void __user *arg)
 405 {
 406         struct fib_config cfg;
 407         struct rtentry rt;
 408         int err;
 409
 410         switch (cmd) {
 411         case SIOCADDRT:         /* Add a route */
 412         case SIOCDELRT:         /* Delete a route */
 413                 if (!capable(CAP_NET_ADMIN))
 414                         return -EPERM;
 415
 416                 if (copy_from_user(&rt, arg, sizeof(rt)))
 417                         return -EFAULT;
 418
 419                 rtnl_lock();
 420                 err = rtentry_to_fib_config(cmd, &rt, &cfg);
 421                 if (err == 0) {
 422                         struct fib_table *tb;
 423
 424                         if (cmd == SIOCDELRT) {
 425                                 tb = fib_get_table(cfg.fc_table);
 426                                 if (tb)
 427                                         err = tb->tb_delete(tb, &cfg);
 428                                 else
 429                                         err = -ESRCH;
 430                         } else {
 431                                 tb = fib_new_table(cfg.fc_table);
 432                                 if (tb)
 433                                         err = tb->tb_insert(tb, &cfg);
 434                                 else
 435                                         err = -ENOBUFS;
 436                         }
 437
 438                         /* allocated by rtentry_to_fib_config() */
 439                         kfree(cfg.fc_mx);
 440                 }
 441                 rtnl_unlock();
 442                 return err;
 443         }
 444         return -EINVAL;
 445 }
 446
 447 #else
 448
 449 int ip_rt_ioctl(unsigned int cmd, void *arg)
 450 {
 451         return -EINVAL;
 452 }
 453
 454 #endif
 455
 456 struct nla_policy rtm_ipv4_policy[RTA_MAX+1] __read_mostly = {
 457         [RTA_DST]               = { .type = NLA_U32 },
 458         [RTA_SRC]               = { .type = NLA_U32 },
 459         [RTA_IIF]               = { .type = NLA_U32 },
 460         [RTA_OIF]               = { .type = NLA_U32 },
 461         [RTA_GATEWAY]           = { .type = NLA_U32 },
 462         [RTA_PRIORITY]          = { .type = NLA_U32 },
 463         [RTA_PREFSRC]           = { .type = NLA_U32 },
 464         [RTA_METRICS]           = { .type = NLA_NESTED },
 465         [RTA_MULTIPATH]         = { .len = sizeof(struct rtnexthop) },
 466         [RTA_PROTOINFO]         = { .type = NLA_U32 },
 467         [RTA_FLOW]              = { .type = NLA_U32 },
 468         [RTA_MP_ALGO]           = { .type = NLA_U32 },
 469 };
 470
 471 static int rtm_to_fib_config(struct sk_buff *skb, struct nlmsghdr *nlh,
 472                              struct fib_config *cfg)
 473 {
 474         struct nlattr *attr;
 475         int err, remaining;
 476         struct rtmsg *rtm;
 477
 478         err = nlmsg_validate(nlh, sizeof(*rtm), RTA_MAX, rtm_ipv4_policy);
 479         if (err < 0)
 480                 goto errout;
 481
 482         memset(cfg, 0, sizeof(*cfg));
 483
 484         rtm = nlmsg_data(nlh);
 485         cfg->fc_family = rtm->rtm_family;
 486         cfg->fc_dst_len = rtm->rtm_dst_len;
 487         cfg->fc_src_len = rtm->rtm_src_len;
 488         cfg->fc_tos = rtm->rtm_tos;
 489         cfg->fc_table = rtm->rtm_table;
 490         cfg->fc_protocol = rtm->rtm_protocol;
 491         cfg->fc_scope = rtm->rtm_scope;
 492         cfg->fc_type = rtm->rtm_type;
 493         cfg->fc_flags = rtm->rtm_flags;
 494         cfg->fc_nlflags = nlh->nlmsg_flags;
 495
 496         cfg->fc_nlinfo.pid = NETLINK_CB(skb).pid;
 497         cfg->fc_nlinfo.nlh = nlh;
 498
 499         nlmsg_for_each_attr(attr, nlh, sizeof(struct rtmsg), remaining) {
 500                 switch (attr->nla_type) {
 501                 case RTA_DST:
 502                         cfg->fc_dst = nla_get_be32(attr);
 503                         break;
 504                 case RTA_SRC:
 505                         cfg->fc_src = nla_get_be32(attr);
 506                         break;
 507                 case RTA_OIF:
 508                         cfg->fc_oif = nla_get_u32(attr);
 509                         break;
 510                 case RTA_GATEWAY:
 511                         cfg->fc_gw = nla_get_be32(attr);
 512                         break;
 513                 case RTA_PRIORITY:
 514                         cfg->fc_priority = nla_get_u32(attr);
 515                         break;
 516                 case RTA_PREFSRC:
 517                         cfg->fc_prefsrc = nla_get_be32(attr);
 518                         break;
 519                 case RTA_METRICS:
 520                         cfg->fc_mx = nla_data(attr);
 521                         cfg->fc_mx_len = nla_len(attr);
 522                         break;
 523                 case RTA_MULTIPATH:
 524                         cfg->fc_mp = nla_data(attr);
 525                         cfg->fc_mp_len = nla_len(attr);
 526                         break;
 527                 case RTA_FLOW:
 528                         cfg->fc_flow = nla_get_u32(attr);
 529                         break;
 530                 case RTA_MP_ALGO:
 531                         cfg->fc_mp_alg = nla_get_u32(attr);
 532                         break;
 533                 case RTA_TABLE:
 534                         cfg->fc_table = nla_get_u32(attr);
 535                         break;
 536                 }
 537         }
 538
 539         return 0;
 540 errout:
 541         return err;
 542 }
 543
 544 int inet_rtm_delroute(struct sk_buff *skb, struct nlmsghdr* nlh, void *arg)
 545 {
 546         struct fib_config cfg;
 547         struct fib_table *tb;
 548         int err;
 549
 550         err = rtm_to_fib_config(skb, nlh, &cfg);
 551         if (err < 0)
 552                 goto errout;
 553
 554         tb = fib_get_table(cfg.fc_table);
 555         if (tb == NULL) {
 556                 err = -ESRCH;
 557                 goto errout;
 558         }
 559
 560         err = tb->tb_delete(tb, &cfg);
 561 errout:
 562         return err;
 563 }
 564
 565 int inet_rtm_newroute(struct sk_buff *skb, struct nlmsghdr* nlh, void *arg)
 566 {
 567         struct fib_config cfg;
 568         struct fib_table *tb;
 569         int err;
 570
 571         err = rtm_to_fib_config(skb, nlh, &cfg);
 572         if (err < 0)
 573                 goto errout;
 574
 575         tb = fib_new_table(cfg.fc_table);
 576         if (tb == NULL) {
 577                 err = -ENOBUFS;
 578                 goto errout;
 579         }
 580
 581         err = tb->tb_insert(tb, &cfg);
 582 errout:
 583         return err;
 584 }
 585
 586 int inet_dump_fib(struct sk_buff *skb, struct netlink_callback *cb)
 587 {
 588         unsigned int h, s_h;
 589         unsigned int e = 0, s_e;
 590         struct fib_table *tb;
 591         struct hlist_node *node;
 592         int dumped = 0;
 593
 594         if (nlmsg_len(cb->nlh) >= sizeof(struct rtmsg) &&
 595             ((struct rtmsg *) nlmsg_data(cb->nlh))->rtm_flags & RTM_F_CLONED)
 596                 return ip_rt_dump(skb, cb);
 597
 598         s_h = cb->args[0];
 599         s_e = cb->args[1];
 600
 601         for (h = s_h; h < FIB_TABLE_HASHSZ; h++, s_e = 0) {
 602                 e = 0;
 603                 hlist_for_each_entry(tb, node, &fib_table_hash[h], tb_hlist) {
 604                         if (e < s_e)
 605                                 goto next;
 606                         if (dumped)
 607                                 memset(&cb->args[2], 0, sizeof(cb->args) -
 608                                                  2 * sizeof(cb->args[0]));
 609                         if (tb->tb_dump(tb, skb, cb) < 0)
 610                                 goto out;
 611                         dumped = 1;
 612 next:
 613                         e++;
 614                 }
 615         }
 616 out:
 617         cb->args[1] = e;
 618         cb->args[0] = h;
 619
 620         return skb->len;
 621 }
 622
 623 /* Prepare and feed intra-kernel routing request.
 624    Really, it should be netlink message, but :-( netlink
 625    can be not configured, so that we feed it directly
 626    to fib engine. It is legal, because all events occur
 627    only when netlink is already locked.
 628  */
 629
 630 static void fib_magic(int cmd, int type, __be32 dst, int dst_len, struct in_ifaddr *ifa)
 631 {
 632         struct fib_table *tb;
 633         struct fib_config cfg = {
 634                 .fc_protocol = RTPROT_KERNEL,
 635                 .fc_type = type,
 636                 .fc_dst = dst,
 637                 .fc_dst_len = dst_len,
 638                 .fc_prefsrc = ifa->ifa_local,
 639                 .fc_oif = ifa->ifa_dev->dev->ifindex,
 640                 .fc_nlflags = NLM_F_CREATE | NLM_F_APPEND,
 641         };
 642
 643         if (type == RTN_UNICAST)
 644                 tb = fib_new_table(RT_TABLE_MAIN);
 645         else
 646                 tb = fib_new_table(RT_TABLE_LOCAL);
 647
 648         if (tb == NULL)
 649                 return;
 650
 651         cfg.fc_table = tb->tb_id;
 652
 653         if (type != RTN_LOCAL)
 654                 cfg.fc_scope = RT_SCOPE_LINK;
 655         else
 656                 cfg.fc_scope = RT_SCOPE_HOST;
 657
 658         if (cmd == RTM_NEWROUTE)
 659                 tb->tb_insert(tb, &cfg);
 660         else
 661                 tb->tb_delete(tb, &cfg);
 662 }
 663
 664 void fib_add_ifaddr(struct in_ifaddr *ifa)
 665 {
 666         struct in_device *in_dev = ifa->ifa_dev;
 667         struct net_device *dev = in_dev->dev;
 668         struct in_ifaddr *prim = ifa;
 669         __be32 mask = ifa->ifa_mask;
 670         __be32 addr = ifa->ifa_local;
 671         __be32 prefix = ifa->ifa_address&mask;
 672
 673         if (ifa->ifa_flags&IFA_F_SECONDARY) {
 674                 prim = inet_ifa_byprefix(in_dev, prefix, mask);
 675                 if (prim == NULL) {
 676                         printk(KERN_DEBUG "fib_add_ifaddr: bug: prim == NULL\n");
 677                         return;
 678                 }
 679         }
 680
 681         fib_magic(RTM_NEWROUTE, RTN_LOCAL, addr, 32, prim);
 682
 683         if (!(dev->flags&IFF_UP))
 684                 return;
 685
 686         /* Add broadcast address, if it is explicitly assigned. */
 687         if (ifa->ifa_broadcast && ifa->ifa_broadcast != htonl(0xFFFFFFFF))
 688                 fib_magic(RTM_NEWROUTE, RTN_BROADCAST, ifa->ifa_broadcast, 32, prim);
 689
 690         if (!ZERONET(prefix) && !(ifa->ifa_flags&IFA_F_SECONDARY) &&
 691             (prefix != addr || ifa->ifa_prefixlen < 32)) {
 692                 fib_magic(RTM_NEWROUTE, dev->flags&IFF_LOOPBACK ? RTN_LOCAL :
 693                           RTN_UNICAST, prefix, ifa->ifa_prefixlen, prim);
 694
 695                 /* Add network specific broadcasts, when it takes a sense */
 696                 if (ifa->ifa_prefixlen < 31) {
 697                         fib_magic(RTM_NEWROUTE, RTN_BROADCAST, prefix, 32, prim);
 698                         fib_magic(RTM_NEWROUTE, RTN_BROADCAST, prefix|~mask, 32, prim);
 699                 }
 700         }
 701 }
 702
 703 static void fib_del_ifaddr(struct in_ifaddr *ifa)
 704 {
 705         struct in_device *in_dev = ifa->ifa_dev;
 706         struct net_device *dev = in_dev->dev;
 707         struct in_ifaddr *ifa1;
 708         struct in_ifaddr *prim = ifa;
 709         __be32 brd = ifa->ifa_address|~ifa->ifa_mask;
 710         __be32 any = ifa->ifa_address&ifa->ifa_mask;
 711 #define LOCAL_OK        1
 712 #define BRD_OK          2
 713 #define BRD0_OK         4
 714 #define BRD1_OK         8
 715         unsigned ok = 0;
 716
 717         if (!(ifa->ifa_flags&IFA_F_SECONDARY))
 718                 fib_magic(RTM_DELROUTE, dev->flags&IFF_LOOPBACK ? RTN_LOCAL :
 719                           RTN_UNICAST, any, ifa->ifa_prefixlen, prim);
 720         else {
 721                 prim = inet_ifa_byprefix(in_dev, any, ifa->ifa_mask);
 722                 if (prim == NULL) {
 723                         printk(KERN_DEBUG "fib_del_ifaddr: bug: prim == NULL\n");
 724                         return;
 725                 }
 726         }
 727
 728         /* Deletion is more complicated than add.
 729            We should take care of not to delete too much :-)
 730
 731            Scan address list to be sure that addresses are really gone.
 732          */
 733
 734         for (ifa1 = in_dev->ifa_list; ifa1; ifa1 = ifa1->ifa_next) {
 735                 if (ifa->ifa_local == ifa1->ifa_local)
 736                         ok |= LOCAL_OK;
 737                 if (ifa->ifa_broadcast == ifa1->ifa_broadcast)
 738                         ok |= BRD_OK;
 739                 if (brd == ifa1->ifa_broadcast)
 740                         ok |= BRD1_OK;
 741                 if (any == ifa1->ifa_broadcast)
 742                         ok |= BRD0_OK;
 743         }
 744
 745         if (!(ok&BRD_OK))
 746                 fib_magic(RTM_DELROUTE, RTN_BROADCAST, ifa->ifa_broadcast, 32, prim);
 747         if (!(ok&BRD1_OK))
 748                 fib_magic(RTM_DELROUTE, RTN_BROADCAST, brd, 32, prim);
 749         if (!(ok&BRD0_OK))
 750                 fib_magic(RTM_DELROUTE, RTN_BROADCAST, any, 32, prim);
 751         if (!(ok&LOCAL_OK)) {
 752                 fib_magic(RTM_DELROUTE, RTN_LOCAL, ifa->ifa_local, 32, prim);
 753
 754                 /* Check, that this local address finally disappeared. */
 755                 if (inet_addr_type(ifa->ifa_local) != RTN_LOCAL) {
 756                         /* And the last, but not the least thing.
 757                            We must flush stray FIB entries.
 758
 759                            First of all, we scan fib_info list searching
 760                            for stray nexthop entries, then ignite fib_flush.
 761                         */
 762                         if (fib_sync_down(ifa->ifa_local, NULL, 0))
 763                                 fib_flush();
 764                 }
 765         }
 766 #undef LOCAL_OK
 767 #undef BRD_OK
 768 #undef BRD0_OK
 769 #undef BRD1_OK
 770 }
 771
 772 static void nl_fib_lookup(struct fib_result_nl *frn, struct fib_table *tb )
 773 {
 774
 775         struct fib_result       res;
 776         struct flowi            fl = { .nl_u = { .ip4_u = { .daddr = frn->fl_addr,
 777                                                             .fwmark = frn->fl_fwmark,
 778                                                             .tos = frn->fl_tos,
 779                                                             .scope = frn->fl_scope } } };
 780         if (tb) {
 781                 local_bh_disable();
 782
 783                 frn->tb_id = tb->tb_id;
 784                 frn->err = tb->tb_lookup(tb, &fl, &res);
 785
 786                 if (!frn->err) {
 787                         frn->prefixlen = res.prefixlen;
 788                         frn->nh_sel = res.nh_sel;
 789                         frn->type = res.type;
 790                         frn->scope = res.scope;
 791                 }
 792                 local_bh_enable();
 793         }
 794 }
 795
 796 static void nl_fib_input(struct sock *sk, int len)
 797 {
 798         struct sk_buff *skb = NULL;
 799         struct nlmsghdr *nlh = NULL;
 800         struct fib_result_nl *frn;
 801         u32 pid;
 802         struct fib_table *tb;
 803
 804         skb = skb_dequeue(&sk->sk_receive_queue);
 805         nlh = (struct nlmsghdr *)skb->data;
 806         if (skb->len < NLMSG_SPACE(0) || skb->len < nlh->nlmsg_len ||
 807             nlh->nlmsg_len < NLMSG_LENGTH(sizeof(*frn))) {
 808                 kfree_skb(skb);
 809                 return;
 810         }
 811
 812         frn = (struct fib_result_nl *) NLMSG_DATA(nlh);
 813         tb = fib_get_table(frn->tb_id_in);
 814
 815         nl_fib_lookup(frn, tb);
 816
 817         pid = nlh->nlmsg_pid;           /*pid of sending process */
 818         NETLINK_CB(skb).pid = 0;         /* from kernel */
 819         NETLINK_CB(skb).dst_pid = pid;
 820         NETLINK_CB(skb).dst_group = 0;  /* unicast */
 821         netlink_unicast(sk, skb, pid, MSG_DONTWAIT);
 822 }
 823
 824 static void nl_fib_lookup_init(void)
 825 {
 826       netlink_kernel_create(NETLINK_FIB_LOOKUP, 0, nl_fib_input, THIS_MODULE);
 827 }
 828
 829 static void fib_disable_ip(struct net_device *dev, int force)
 830 {
 831         if (fib_sync_down(0, dev, force))
 832                 fib_flush();
 833         rt_cache_flush(0);
 834         arp_ifdown(dev);
 835 }
 836
 837 static int fib_inetaddr_event(struct notifier_block *this, unsigned long event, void *ptr)
 838 {
 839         struct in_ifaddr *ifa = (struct in_ifaddr*)ptr;
 840
 841         switch (event) {
 842         case NETDEV_UP:
 843                 fib_add_ifaddr(ifa);
 844 #ifdef CONFIG_IP_ROUTE_MULTIPATH
 845                 fib_sync_up(ifa->ifa_dev->dev);
 846 #endif
 847                 rt_cache_flush(-1);
 848                 break;
 849         case NETDEV_DOWN:
 850                 fib_del_ifaddr(ifa);
 851                 if (ifa->ifa_dev->ifa_list == NULL) {
 852                         /* Last address was deleted from this interface.
 853                            Disable IP.
 854                          */
 855                         fib_disable_ip(ifa->ifa_dev->dev, 1);
 856                 } else {
 857                         rt_cache_flush(-1);
 858                 }
 859                 break;
 860         }
 861         return NOTIFY_DONE;
 862 }
 863
 864 static int fib_netdev_event(struct notifier_block *this, unsigned long event, void *ptr)
 865 {
 866         struct net_device *dev = ptr;
 867         struct in_device *in_dev = __in_dev_get_rtnl(dev);
 868
 869         if (event == NETDEV_UNREGISTER) {
 870                 fib_disable_ip(dev, 2);
 871                 return NOTIFY_DONE;
 872         }
 873
 874         if (!in_dev)
 875                 return NOTIFY_DONE;
 876
 877         switch (event) {
 878         case NETDEV_UP:
 879                 for_ifa(in_dev) {
 880                         fib_add_ifaddr(ifa);
 881                 } endfor_ifa(in_dev);
 882 #ifdef CONFIG_IP_ROUTE_MULTIPATH
 883                 fib_sync_up(dev);
 884 #endif
 885                 rt_cache_flush(-1);
 886                 break;
 887         case NETDEV_DOWN:
 888                 fib_disable_ip(dev, 0);
 889                 break;
 890         case NETDEV_CHANGEMTU:
 891         case NETDEV_CHANGE:
 892                 rt_cache_flush(0);
 893                 break;
 894         }
 895         return NOTIFY_DONE;
 896 }
 897
 898 static struct notifier_block fib_inetaddr_notifier = {
 899         .notifier_call =fib_inetaddr_event,
 900 };
 901
 902 static struct notifier_block fib_netdev_notifier = {
 903         .notifier_call =fib_netdev_event,
 904 };
 905
 906 void __init ip_fib_init(void)
 907 {
 908         unsigned int i;
 909
 910         for (i = 0; i < FIB_TABLE_HASHSZ; i++)
 911                 INIT_HLIST_HEAD(&fib_table_hash[i]);
 912 #ifndef CONFIG_IP_MULTIPLE_TABLES
 913         ip_fib_local_table = fib_hash_init(RT_TABLE_LOCAL);
 914         hlist_add_head_rcu(&ip_fib_local_table->tb_hlist, &fib_table_hash[0]);
 915         ip_fib_main_table  = fib_hash_init(RT_TABLE_MAIN);
 916         hlist_add_head_rcu(&ip_fib_main_table->tb_hlist, &fib_table_hash[0]);
 917 #else
 918         fib4_rules_init();
 919 #endif
 920
 921         register_netdevice_notifier(&fib_netdev_notifier);
 922         register_inetaddr_notifier(&fib_inetaddr_notifier);
 923         nl_fib_lookup_init();
 924 }
 925
 926 EXPORT_SYMBOL(inet_addr_type);
 927 EXPORT_SYMBOL(ip_dev_find);