/* $OpenBSD: mpls_output.c,v 1.10 2010/06/02 15:41:07 claudio Exp $ */ /* * Copyright (c) 2008 Claudio Jeker <claudio@openbsd.org> * Copyright (c) 2008 Michele Marchetto <michele@openbsd.org> * * Permission to use, copy, modify, and distribute this software for any * purpose with or without fee is hereby granted, provided that the above * copyright notice and this permission notice appear in all copies. * * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. */ #include <sys/param.h> #include <sys/mbuf.h> #include <sys/systm.h> #include <sys/socket.h> #include <net/if.h> #include <net/route.h> #include <netmpls/mpls.h> #ifdef INET #include <netinet/in.h> #include <netinet/in_systm.h> #include <netinet/ip.h> #endif extern int mpls_inkloop; #ifdef MPLS_DEBUG #define MPLS_LABEL_GET(l) ((ntohl((l) & MPLS_LABEL_MASK)) >> MPLS_LABEL_OFFSET) #endif void mpls_do_cksum(struct mbuf *); int mpls_output(struct ifnet *ifp0, struct mbuf *m, struct sockaddr *dst, struct rtentry *rt0) { struct ifnet *ifp = ifp0; struct sockaddr_mpls *smpls; struct sockaddr_mpls sa_mpls; struct shim_hdr *shim; struct rtentry *rt = rt0; struct rt_mpls *rt_mpls; int i, error; if (rt0 == NULL || (dst->sa_family != AF_INET && dst->sa_family != AF_INET6 && dst->sa_family != AF_MPLS)) { if (!ISSET(ifp->if_xflags, IFXF_MPLS)) return (ifp->if_output(ifp, m, dst, rt)); else return (ifp->if_ll_output(ifp, m, dst, rt)); } /* need to calculate checksums now if necessary */ if (m->m_pkthdr.csum_flags & (M_IPV4_CSUM_OUT | M_TCPV4_CSUM_OUT | M_UDPV4_CSUM_OUT)) mpls_do_cksum(m); /* initialize sockaddr_mpls */ bzero(&sa_mpls, sizeof(sa_mpls)); smpls = &sa_mpls; smpls->smpls_family = AF_MPLS; smpls->smpls_len = sizeof(*smpls); for (i = 0; i < mpls_inkloop; i++) { rt_mpls = (struct rt_mpls *)rt->rt_llinfo; if (rt_mpls == NULL || (rt->rt_flags & RTF_MPLS) == 0) { /* no MPLS information for this entry */ if (!ISSET(ifp->if_xflags, IFXF_MPLS)) { #ifdef MPLS_DEBUG printf("MPLS_DEBUG: interface not mpls enabled\n"); #endif error = ENETUNREACH; goto bad; } return (ifp->if_ll_output(ifp0, m, dst, rt0)); } switch (rt_mpls->mpls_operation) { case MPLS_OP_PUSH: m = mpls_shim_push(m, rt_mpls); break; case MPLS_OP_POP: m = mpls_shim_pop(m); break; case MPLS_OP_SWAP: m = mpls_shim_swap(m, rt_mpls); break; default: error = EINVAL; goto bad; } if (m == NULL) { error = ENOBUFS; goto bad; } /* refetch label */ shim = mtod(m, struct shim_hdr *); /* mark first label with BOS flag */ if (rt0 == rt && dst->sa_family != AF_MPLS) shim->shim_label |= MPLS_BOS_MASK; ifp = rt->rt_ifp; if (ifp != NULL) break; shim = mtod(m, struct shim_hdr *); smpls->smpls_label = shim->shim_label & MPLS_LABEL_MASK; rt = rtalloc1(smplstosa(smpls), RT_REPORT, 0); if (rt == NULL) { /* no entry for this label */ #ifdef MPLS_DEBUG printf("MPLS_DEBUG: label %d not found\n", MPLS_LABEL_GET(shim->shim_label)); #endif error = EHOSTUNREACH; goto bad; } rt->rt_use++; rt->rt_refcnt--; } /* write back TTL */ shim->shim_label &= ~MPLS_TTL_MASK; shim->shim_label |= htonl(mpls_defttl); #ifdef MPLS_DEBUG printf("MPLS: sending on %s outshim %x outlabel %d\n", ifp->if_xname, ntohl(shim->shim_label), MPLS_LABEL_GET(rt_mpls->mpls_label)); #endif /* Output iface is not MPLS-enabled */ if (!ISSET(ifp->if_xflags, IFXF_MPLS)) { #ifdef MPLS_DEBUG printf("MPLS_DEBUG: interface not mpls enabled\n"); #endif error = ENETUNREACH; goto bad; } /* reset broadcast and multicast flags, this is a P2P tunnel */ m->m_flags &= ~(M_BCAST | M_MCAST); smpls->smpls_label = shim->shim_label & MPLS_LABEL_MASK; return (ifp->if_ll_output(ifp, m, smplstosa(smpls), rt)); bad: if (m) m_freem(m); return (error); } void mpls_do_cksum(struct mbuf *m) { #ifdef INET struct ip *ip; u_int16_t hlen; if (m->m_pkthdr.csum_flags & (M_TCPV4_CSUM_OUT | M_UDPV4_CSUM_OUT)) { in_delayed_cksum(m); m->m_pkthdr.csum_flags &= ~(M_UDPV4_CSUM_OUT|M_TCPV4_CSUM_OUT); } if (m->m_pkthdr.csum_flags & M_IPV4_CSUM_OUT) { ip = mtod(m, struct ip *); hlen = ip->ip_hl << 2; ip->ip_sum = in_cksum(m, hlen); m->m_pkthdr.csum_flags &= ~M_IPV4_CSUM_OUT; } #endif }