#include "pf.h"
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/mbuf.h>
#include <sys/socket.h>
#include <sys/errno.h>
#include <sys/time.h>
#include <sys/syslog.h>
#include <net/if.h>
#include <net/if_var.h>
#include <net/route.h>
#if NPF > 0
#include <net/pfvar.h>
#endif
#include <netinet/in.h>
#include <netinet6/in6_var.h>
#include <netinet/ip6.h>
#include <netinet6/ip6_var.h>
#include <netinet/icmp6.h>
#include <netinet6/nd6.h>
#include <netinet/udp.h>
#include <netinet/tcp.h>
#ifdef IPSEC
#include <netinet/ip_ipsp.h>
#endif
void
ip6_forward(struct mbuf *m, struct route *ro, int flags)
{
struct ip6_hdr *ip6 = mtod(m, struct ip6_hdr *);
struct route iproute;
struct rtentry *rt;
struct sockaddr *dst;
struct ifnet *ifp = NULL;
u_int rtableid = m->m_pkthdr.ph_rtableid;
u_int ifidx = m->m_pkthdr.ph_ifidx;
u_int8_t loopcnt = m->m_pkthdr.ph_loopcnt;
u_int icmp_len;
char icmp_buf[MHLEN];
CTASSERT(sizeof(struct ip6_hdr) + sizeof(struct tcphdr) +
MAX_TCPOPTLEN <= sizeof(icmp_buf));
u_short mflags, pfflags;
struct mbuf *mcopy;
int error = 0, type = 0, code = 0, destmtu = 0;
u_int orig_rtableid;
#ifdef IPSEC
struct tdb *tdb = NULL;
#endif
if ((m->m_flags & (M_BCAST|M_MCAST)) != 0 ||
IN6_IS_ADDR_MULTICAST(&ip6->ip6_dst) ||
IN6_IS_ADDR_UNSPECIFIED(&ip6->ip6_src)) {
ip6stat_inc(ip6s_cantforward);
m_freem(m);
goto done;
}
if (ip6->ip6_hlim <= IPV6_HLIMDEC) {
icmp6_error(m, ICMP6_TIME_EXCEEDED,
ICMP6_TIME_EXCEED_TRANSIT, 0);
goto done;
}
ip6->ip6_hlim -= IPV6_HLIMDEC;
switch (ip6->ip6_nxt) {
case IPPROTO_TCP:
icmp_len = sizeof(struct ip6_hdr) + sizeof(struct tcphdr) +
MAX_TCPOPTLEN;
break;
case IPPROTO_UDP:
icmp_len = sizeof(struct ip6_hdr) + sizeof(struct udphdr);
break;
case IPPROTO_ESP:
icmp_len = sizeof(struct ip6_hdr) + 2 * sizeof(u_int32_t);
break;
default:
icmp_len = ICMPV6_PLD_MAXLEN;
break;
}
if (icmp_len > m->m_pkthdr.len)
icmp_len = m->m_pkthdr.len;
if (icmp_len <= sizeof(icmp_buf)) {
mflags = m->m_flags;
pfflags = m->m_pkthdr.pf.flags;
m_copydata(m, 0, icmp_len, icmp_buf);
mcopy = NULL;
} else {
mcopy = m_copym(m, 0, icmp_len, M_NOWAIT);
icmp_len = 0;
}
orig_rtableid = m->m_pkthdr.ph_rtableid;
#if NPF > 0
reroute:
#endif
#ifdef IPSEC
if (ipsec_in_use) {
error = ip6_output_ipsec_lookup(m, NULL, &tdb);
if (error) {
if (error == -EINVAL)
error = 0;
m_freem(m);
goto freecopy;
}
}
#endif
if (ro == NULL) {
ro = &iproute;
ro->ro_rt = NULL;
}
rt = route6_mpath(ro, &ip6->ip6_dst, &ip6->ip6_src,
m->m_pkthdr.ph_rtableid);
if (rt == NULL) {
ip6stat_inc(ip6s_noroute);
type = ICMP6_DST_UNREACH;
code = ICMP6_DST_UNREACH_NOROUTE;
m_freem(m);
goto icmperror;
}
dst = &ro->ro_dstsa;
if (in6_addr2scopeid(ifidx, &ip6->ip6_src) !=
in6_addr2scopeid(rt->rt_ifidx, &ip6->ip6_src)) {
ip6stat_inc(ip6s_cantforward);
ip6stat_inc(ip6s_badscope);
type = ICMP6_DST_UNREACH;
code = ICMP6_DST_UNREACH_BEYONDSCOPE;
m_freem(m);
goto icmperror;
}
#ifdef IPSEC
if (tdb != NULL) {
error = ip6_output_ipsec_send(tdb, m, ro, orig_rtableid, 0, 1);
rt = ro->ro_rt;
if (error)
goto senderr;
goto freecopy;
}
#endif
if (rt->rt_flags & RTF_GATEWAY)
dst = rt->rt_gateway;
ifp = if_get(rt->rt_ifidx);
if (ifp == NULL) {
m_freem(m);
goto freecopy;
}
if (rt->rt_ifidx == ifidx &&
!ISSET(rt->rt_flags, RTF_DYNAMIC|RTF_MODIFIED) &&
!ISSET(flags, IPV6_REDIRECT) &&
atomic_load_int(&ip6_sendredirects)) {
if ((ifp->if_flags & IFF_POINTOPOINT) &&
nd6_is_addr_neighbor(&ro->ro_dstsin6, ifp)) {
type = ICMP6_DST_UNREACH;
code = ICMP6_DST_UNREACH_ADDR;
m_freem(m);
goto icmperror;
}
type = ND_REDIRECT;
}
if (IN6_IS_SCOPE_EMBED(&ip6->ip6_src))
ip6->ip6_src.s6_addr16[1] = 0;
if (IN6_IS_SCOPE_EMBED(&ip6->ip6_dst))
ip6->ip6_dst.s6_addr16[1] = 0;
#if NPF > 0
if (pf_test(AF_INET6, PF_FWD, ifp, &m) != PF_PASS) {
m_freem(m);
goto senderr;
}
if (m == NULL)
goto senderr;
ip6 = mtod(m, struct ip6_hdr *);
if ((m->m_pkthdr.pf.flags & (PF_TAG_REROUTE | PF_TAG_GENERATED)) ==
(PF_TAG_REROUTE | PF_TAG_GENERATED)) {
m->m_pkthdr.pf.flags &= ~(PF_TAG_GENERATED | PF_TAG_REROUTE);
} else if (m->m_pkthdr.pf.flags & PF_TAG_REROUTE) {
m->m_pkthdr.pf.flags |= PF_TAG_GENERATED;
SET(flags, IPV6_REDIRECT);
if (ro == &iproute)
rtfree(ro->ro_rt);
ro = NULL;
if_put(ifp);
ifp = NULL;
goto reroute;
}
#endif
#ifdef IPSEC
if (ISSET(flags, IPV6_FORWARDING) &&
ISSET(flags, IPV6_FORWARDING_IPSEC) &&
!ISSET(m->m_pkthdr.ph_tagsset, PACKET_TAG_IPSEC_IN_DONE)) {
error = EHOSTUNREACH;
goto senderr;
}
#endif
error = if_output_tso(ifp, &m, dst, rt, ifp->if_mtu);
if (error)
ip6stat_inc(ip6s_cantforward);
else if (m == NULL)
ip6stat_inc(ip6s_forward);
if (error || m == NULL)
goto senderr;
type = ICMP6_PACKET_TOO_BIG;
destmtu = ifp->if_mtu;
m_freem(m);
goto icmperror;
senderr:
if (mcopy == NULL && icmp_len == 0)
goto done;
switch (error) {
case 0:
if (type == ND_REDIRECT) {
if (icmp_len != 0) {
mcopy = m_gethdr(M_DONTWAIT, MT_DATA);
if (mcopy == NULL)
goto done;
mcopy->m_len = mcopy->m_pkthdr.len = icmp_len;
mcopy->m_flags |= (mflags & M_COPYFLAGS);
mcopy->m_pkthdr.ph_rtableid = rtableid;
mcopy->m_pkthdr.ph_ifidx = ifidx;
mcopy->m_pkthdr.ph_loopcnt = loopcnt;
mcopy->m_pkthdr.pf.flags |=
(pfflags & PF_TAG_GENERATED);
memcpy(mcopy->m_data, icmp_buf, icmp_len);
}
if (mcopy != NULL) {
icmp6_redirect_output(mcopy, rt);
ip6stat_inc(ip6s_redirectsent);
}
goto done;
}
goto freecopy;
case EMSGSIZE:
type = ICMP6_PACKET_TOO_BIG;
if (rt != NULL) {
u_int rtmtu;
rtmtu = atomic_load_int(&rt->rt_mtu);
if (rtmtu != 0) {
destmtu = rtmtu;
} else {
struct ifnet *destifp;
destifp = if_get(rt->rt_ifidx);
if (destifp != NULL)
destmtu = destifp->if_mtu;
if_put(destifp);
}
}
ip6stat_inc(ip6s_cantfrag);
if (destmtu == 0)
goto freecopy;
break;
case EACCES:
goto freecopy;
case ENOBUFS:
goto freecopy;
case ENETUNREACH:
case EHOSTUNREACH:
case ENETDOWN:
case EHOSTDOWN:
default:
type = ICMP6_DST_UNREACH;
code = ICMP6_DST_UNREACH_ADDR;
break;
}
icmperror:
if (icmp_len != 0) {
mcopy = m_gethdr(M_DONTWAIT, MT_DATA);
if (mcopy == NULL)
goto done;
mcopy->m_len = mcopy->m_pkthdr.len = icmp_len;
mcopy->m_flags |= (mflags & M_COPYFLAGS);
mcopy->m_pkthdr.ph_rtableid = rtableid;
mcopy->m_pkthdr.ph_ifidx = ifidx;
mcopy->m_pkthdr.ph_loopcnt = loopcnt;
mcopy->m_pkthdr.pf.flags |= (pfflags & PF_TAG_GENERATED);
memcpy(mcopy->m_data, icmp_buf, icmp_len);
}
if (mcopy != NULL)
icmp6_error(mcopy, type, code, destmtu);
goto done;
freecopy:
m_freem(mcopy);
done:
if (ro == &iproute)
rtfree(ro->ro_rt);
if_put(ifp);
#ifdef IPSEC
tdb_unref(tdb);
#endif
}