sys/netinet/ip_flow.c

   1 /*-
   2  * Copyright (c) 1998 The NetBSD Foundation, Inc.
   3  * All rights reserved.
   4  *
   5  * This code is derived from software contributed to The NetBSD Foundation
   6  * by the 3am Software Foundry ("3am").  It was developed by Matt Thomas.
   7  *
   8  * Redistribution and use in source and binary forms, with or without
   9  * modification, are permitted provided that the following conditions
  10  * are met:
  11  * 1. Redistributions of source code must retain the above copyright
  12  *    notice, this list of conditions and the following disclaimer.
  13  * 2. Redistributions in binary form must reproduce the above copyright
  14  *    notice, this list of conditions and the following disclaimer in the
  15  *    documentation and/or other materials provided with the distribution.
  16  * 3. All advertising materials mentioning features or use of this software
  17  *    must display the following acknowledgement:
  18  *      This product includes software developed by the NetBSD
  19  *      Foundation, Inc. and its contributors.
  20  * 4. Neither the name of The NetBSD Foundation nor the names of its
  21  *    contributors may be used to endorse or promote products derived
  22  *    from this software without specific prior written permission.
  23  *
  24  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
  25  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
  26  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
  27  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
  28  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
  29  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
  30  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
  31  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
  32  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
  33  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
  34  * POSSIBILITY OF SUCH DAMAGE.
  35  *
  36  * $FreeBSD: src/sys/netinet/ip_flow.c,v 1.9.2.2 2001/11/04 17:35:31 luigi Exp $
  37  * $DragonFly: src/sys/netinet/ip_flow.c,v 1.2 2003/06/17 04:28:51 dillon Exp $
  38  */
  39
  40 #include <sys/param.h>
  41 #include <sys/systm.h>
  42 #include <sys/malloc.h>
  43 #include <sys/mbuf.h>
  44 #include <sys/protosw.h>
  45 #include <sys/socket.h>
  46 #include <sys/kernel.h>
  47
  48 #include <sys/sysctl.h>
  49
  50 #include <net/if.h>
  51 #include <net/route.h>
  52
  53 #include <netinet/in.h>
  54 #include <netinet/in_systm.h>
  55 #include <netinet/ip.h>
  56 #include <netinet/in_var.h>
  57 #include <netinet/ip_var.h>
  58 #include <netinet/ip_flow.h>
  59
  60 #define IPFLOW_TIMER            (5 * PR_SLOWHZ)
  61 #define IPFLOW_HASHBITS         6       /* should not be a multiple of 8 */
  62 #define IPFLOW_HASHSIZE         (1 << IPFLOW_HASHBITS)
  63 static LIST_HEAD(ipflowhead, ipflow) ipflows[IPFLOW_HASHSIZE];
  64 static int ipflow_inuse;
  65 #define IPFLOW_MAX              256
  66
  67 static int ipflow_active = 0;
  68 SYSCTL_INT(_net_inet_ip, IPCTL_FASTFORWARDING, fastforwarding, CTLFLAG_RW,
  69     &ipflow_active, 0, "Enable flow-based IP forwarding");
  70
  71 static MALLOC_DEFINE(M_IPFLOW, "ip_flow", "IP flow");
  72
  73 static unsigned
  74 ipflow_hash(
  75         struct in_addr dst,
  76         struct in_addr src,
  77         unsigned tos)
  78 {
  79         unsigned hash = tos;
  80         int idx;
  81         for (idx = 0; idx < 32; idx += IPFLOW_HASHBITS)
  82                 hash += (dst.s_addr >> (32 - idx)) + (src.s_addr >> idx);
  83         return hash & (IPFLOW_HASHSIZE-1);
  84 }
  85
  86 static struct ipflow *
  87 ipflow_lookup(
  88         const struct ip *ip)
  89 {
  90         unsigned hash;
  91         struct ipflow *ipf;
  92
  93         hash = ipflow_hash(ip->ip_dst, ip->ip_src, ip->ip_tos);
  94
  95         ipf = LIST_FIRST(&ipflows[hash]);
  96         while (ipf != NULL) {
  97                 if (ip->ip_dst.s_addr == ipf->ipf_dst.s_addr
  98                     && ip->ip_src.s_addr == ipf->ipf_src.s_addr
  99                     && ip->ip_tos == ipf->ipf_tos)
 100                         break;
 101                 ipf = LIST_NEXT(ipf, ipf_next);
 102         }
 103         return ipf;
 104 }
 105
 106 int
 107 ipflow_fastforward(
 108         struct mbuf *m)
 109 {
 110         struct ip *ip;
 111         struct ipflow *ipf;
 112         struct rtentry *rt;
 113         struct sockaddr *dst;
 114         int error;
 115
 116         /*
 117          * Are we forwarding packets?  Big enough for an IP packet?
 118          */
 119         if (!ipforwarding || !ipflow_active || m->m_len < sizeof(struct ip))
 120                 return 0;
 121         /*
 122          * IP header with no option and valid version and length
 123          */
 124         ip = mtod(m, struct ip *);
 125         if (ip->ip_v != IPVERSION || ip->ip_hl != (sizeof(struct ip) >> 2)
 126             || ntohs(ip->ip_len) > m->m_pkthdr.len)
 127                 return 0;
 128         /*
 129          * Find a flow.
 130          */
 131         if ((ipf = ipflow_lookup(ip)) == NULL)
 132                 return 0;
 133
 134         /*
 135          * Route and interface still up?
 136          */
 137         rt = ipf->ipf_ro.ro_rt;
 138         if ((rt->rt_flags & RTF_UP) == 0 || (rt->rt_ifp->if_flags & IFF_UP) == 0)
 139                 return 0;
 140
 141         /*
 142          * Packet size OK?  TTL?
 143          */
 144         if (m->m_pkthdr.len > rt->rt_ifp->if_mtu || ip->ip_ttl <= IPTTLDEC)
 145                 return 0;
 146
 147         /*
 148          * Everything checks out and so we can forward this packet.
 149          * Modify the TTL and incrementally change the checksum.
 150          */
 151         ip->ip_ttl -= IPTTLDEC;
 152         if (ip->ip_sum >= htons(0xffff - (IPTTLDEC << 8))) {
 153                 ip->ip_sum += htons(IPTTLDEC << 8) + 1;
 154         } else {
 155                 ip->ip_sum += htons(IPTTLDEC << 8);
 156         }
 157
 158         /*
 159          * Send the packet on its way.  All we can get back is ENOBUFS
 160          */
 161         ipf->ipf_uses++;
 162         ipf->ipf_timer = IPFLOW_TIMER;
 163
 164         if (rt->rt_flags & RTF_GATEWAY)
 165                 dst = rt->rt_gateway;
 166         else
 167                 dst = &ipf->ipf_ro.ro_dst;
 168         if ((error = (*rt->rt_ifp->if_output)(rt->rt_ifp, m, dst, rt)) != 0) {
 169                 if (error == ENOBUFS)
 170                         ipf->ipf_dropped++;
 171                 else
 172                         ipf->ipf_errors++;
 173         }
 174         return 1;
 175 }
 176 \f
 177 static void
 178 ipflow_addstats(
 179         struct ipflow *ipf)
 180 {
 181         ipf->ipf_ro.ro_rt->rt_use += ipf->ipf_uses;
 182         ipstat.ips_cantforward += ipf->ipf_errors + ipf->ipf_dropped;
 183         ipstat.ips_forward += ipf->ipf_uses;
 184         ipstat.ips_fastforward += ipf->ipf_uses;
 185 }
 186
 187 static void
 188 ipflow_free(
 189         struct ipflow *ipf)
 190 {
 191         int s;
 192         /*
 193          * Remove the flow from the hash table (at elevated IPL).
 194          * Once it's off the list, we can deal with it at normal
 195          * network IPL.
 196          */
 197         s = splimp();
 198         LIST_REMOVE(ipf, ipf_next);
 199         splx(s);
 200         ipflow_addstats(ipf);
 201         RTFREE(ipf->ipf_ro.ro_rt);
 202         ipflow_inuse--;
 203         free(ipf, M_IPFLOW);
 204 }
 205
 206 static struct ipflow *
 207 ipflow_reap(
 208         void)
 209 {
 210         struct ipflow *ipf, *maybe_ipf = NULL;
 211         int idx;
 212         int s;
 213
 214         for (idx = 0; idx < IPFLOW_HASHSIZE; idx++) {
 215                 ipf = LIST_FIRST(&ipflows[idx]);
 216                 while (ipf != NULL) {
 217                         /*
 218                          * If this no longer points to a valid route
 219                          * reclaim it.
 220                          */
 221                         if ((ipf->ipf_ro.ro_rt->rt_flags & RTF_UP) == 0)
 222                                 goto done;
 223                         /*
 224                          * choose the one that's been least recently used
 225                          * or has had the least uses in the last 1.5
 226                          * intervals.
 227                          */
 228                         if (maybe_ipf == NULL
 229                             || ipf->ipf_timer < maybe_ipf->ipf_timer
 230                             || (ipf->ipf_timer == maybe_ipf->ipf_timer
 231                                 && ipf->ipf_last_uses + ipf->ipf_uses <
 232                                       maybe_ipf->ipf_last_uses +
 233                                         maybe_ipf->ipf_uses))
 234                                 maybe_ipf = ipf;
 235                         ipf = LIST_NEXT(ipf, ipf_next);
 236                 }
 237         }
 238         ipf = maybe_ipf;
 239     done:
 240         /*
 241          * Remove the entry from the flow table.
 242          */
 243         s = splimp();
 244         LIST_REMOVE(ipf, ipf_next);
 245         splx(s);
 246         ipflow_addstats(ipf);
 247         RTFREE(ipf->ipf_ro.ro_rt);
 248         return ipf;
 249 }
 250
 251 void
 252 ipflow_slowtimo(
 253         void)
 254 {
 255         struct ipflow *ipf;
 256         int idx;
 257
 258         for (idx = 0; idx < IPFLOW_HASHSIZE; idx++) {
 259                 ipf = LIST_FIRST(&ipflows[idx]);
 260                 while (ipf != NULL) {
 261                         struct ipflow *next_ipf = LIST_NEXT(ipf, ipf_next);
 262                         if (--ipf->ipf_timer == 0) {
 263                                 ipflow_free(ipf);
 264                         } else {
 265                                 ipf->ipf_last_uses = ipf->ipf_uses;
 266                                 ipf->ipf_ro.ro_rt->rt_use += ipf->ipf_uses;
 267                                 ipstat.ips_forward += ipf->ipf_uses;
 268                                 ipstat.ips_fastforward += ipf->ipf_uses;
 269                                 ipf->ipf_uses = 0;
 270                         }
 271                         ipf = next_ipf;
 272                 }
 273         }
 274 }
 275
 276 void
 277 ipflow_create(
 278         const struct route *ro,
 279         struct mbuf *m)
 280 {
 281         const struct ip *const ip = mtod(m, struct ip *);
 282         struct ipflow *ipf;
 283         unsigned hash;
 284         int s;
 285
 286         /*
 287          * Don't create cache entries for ICMP messages.
 288          */
 289         if (!ipflow_active || ip->ip_p == IPPROTO_ICMP)
 290                 return;
 291         /*
 292          * See if an existing flow struct exists.  If so remove it from it's
 293          * list and free the old route.  If not, try to malloc a new one
 294          * (if we aren't at our limit).
 295          */
 296         ipf = ipflow_lookup(ip);
 297         if (ipf == NULL) {
 298                 if (ipflow_inuse == IPFLOW_MAX) {
 299                         ipf = ipflow_reap();
 300                 } else {
 301                         ipf = (struct ipflow *) malloc(sizeof(*ipf), M_IPFLOW,
 302                                                        M_NOWAIT);
 303                         if (ipf == NULL)
 304                                 return;
 305                         ipflow_inuse++;
 306                 }
 307                 bzero((caddr_t) ipf, sizeof(*ipf));
 308         } else {
 309                 s = splimp();
 310                 LIST_REMOVE(ipf, ipf_next);
 311                 splx(s);
 312                 ipflow_addstats(ipf);
 313                 RTFREE(ipf->ipf_ro.ro_rt);
 314                 ipf->ipf_uses = ipf->ipf_last_uses = 0;
 315                 ipf->ipf_errors = ipf->ipf_dropped = 0;
 316         }
 317
 318         /*
 319          * Fill in the updated information.
 320          */
 321         ipf->ipf_ro = *ro;
 322         ro->ro_rt->rt_refcnt++;
 323         ipf->ipf_dst = ip->ip_dst;
 324         ipf->ipf_src = ip->ip_src;
 325         ipf->ipf_tos = ip->ip_tos;
 326         ipf->ipf_timer = IPFLOW_TIMER;
 327         /*
 328          * Insert into the approriate bucket of the flow table.
 329          */
 330         hash = ipflow_hash(ip->ip_dst, ip->ip_src, ip->ip_tos);
 331         s = splimp();
 332         LIST_INSERT_HEAD(&ipflows[hash], ipf, ipf_next);
 333         splx(s);
 334 }