1 /* 2 * Copyright (c) 2007 The DragonFly Project. All rights reserved. 3 * 4 * Redistribution and use in source and binary forms, with or without 5 * modification, are permitted provided that the following conditions 6 * are met: 7 * 8 * 1. Redistributions of source code must retain the above copyright 9 * notice, this list of conditions and the following disclaimer. 10 * 2. Redistributions in binary form must reproduce the above copyright 11 * notice, this list of conditions and the following disclaimer in 12 * the documentation and/or other materials provided with the 13 * distribution. 14 * 3. Neither the name of The DragonFly Project nor the names of its 15 * contributors may be used to endorse or promote products derived 16 * from this software without specific, prior written permission. 17 * 18 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS 19 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 20 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS 21 * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE 22 * COPYRIGHT HOLDERS OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, 23 * INCIDENTAL, SPECIAL, EXEMPLARY OR CONSEQUENTIAL DAMAGES (INCLUDING, 24 * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; 25 * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED 26 * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, 27 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT 28 * OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 29 * SUCH DAMAGE. 30 * 31 * $DragonFly: src/sys/netproto/mpls/mpls_demux.c,v 1.2 2008/08/05 15:11:32 nant Exp $ 32 */ 33 34 #include <sys/mbuf.h> 35 #include <sys/systm.h> /* ncpus2_mask */ 36 #include <sys/types.h> 37 38 #include <net/netisr.h> 39 40 #include <netinet/in_var.h> 41 42 #include <netproto/mpls/mpls.h> 43 #include <netproto/mpls/mpls_var.h> 44 45 static __inline int 46 MPLSP_MPORT_HASH(mpls_label_t label, u_short if_index) 47 { 48 /* Use low order byte (demux up to 256 cpus) */ 49 KASSERT(ncpus2 < 256, ("need different hash function")); /* XXX */ 50 #if BYTE_ORDER == LITTLE_ENDIAN 51 label &= 0x00ff0000; 52 label = label >> 16; 53 #endif 54 return ((label ^ if_index) & ncpus2_mask); 55 } 56 57 static void 58 mpls_lengthcheck(struct mbuf **mp, int hoff) 59 { 60 struct mbuf *m = *mp; 61 int hlen = hoff + sizeof(struct mpls); 62 63 /* The packet must be at least the size of an MPLS header. */ 64 if (m->m_pkthdr.len < hlen) { 65 mplsstat.mplss_tooshort++; 66 m_free(m); 67 *mp = NULL; 68 return; 69 } 70 71 /* The MPLS header must reside completely in the first mbuf. */ 72 if (m->m_len < hlen) { 73 m = m_pullup(m, hlen); 74 if (m == NULL) { 75 mplsstat.mplss_toosmall++; 76 *mp = NULL; 77 return; 78 } 79 } 80 *mp = m; 81 } 82 83 void 84 mpls_hashfn(struct mbuf **mp, int hoff) 85 { 86 struct mbuf *m = *mp; 87 struct mpls *mpls; 88 mpls_label_t label; 89 struct ifnet *ifp; 90 91 mpls_lengthcheck(mp, hoff); 92 if ((m = *mp) == NULL) 93 return; 94 95 mpls = mtodoff(m, struct mpls *, hoff); 96 97 label = MPLS_LABEL(ntohl(mpls->mpls_shim)); 98 ifp = m->m_pkthdr.rcvif; 99 m_sethash(m, MPLSP_MPORT_HASH(label, ifp->if_index)); 100 } 101 102