1/* $FreeBSD: head/sys/net/if_stf.c 78701 2001-06-24 14:52:55Z ume $ */
2/* $KAME: if_stf.c,v 1.62 2001/06/07 22:32:16 itojun Exp $ */
3
4/*
5 * Copyright (C) 2000 WIDE Project.
6 * All rights reserved.
7 *
8 * Redistribution and use in source and binary forms, with or without
9 * modification, are permitted provided that the following conditions
--- 83 unchanged lines hidden (view full) ---
93#include <net/route.h>
94#include <net/netisr.h>
95#include <net/if_types.h>
96#include <net/if_stf.h>
97
98#include <netinet/in.h>
99#include <netinet/in_systm.h>
100#include <netinet/ip.h>
101#include <netinet/ip_var.h>
102#include <netinet/in_var.h>
103
104#include <netinet/ip6.h>
105#include <netinet6/ip6_var.h>
106#include <netinet6/in6_gif.h>
107#include <netinet6/in6_var.h>
108#include <netinet/ip_ecn.h>
109
110#include <netinet/ip_encap.h>
111
112#include <machine/stdarg.h>
113
114#include <net/net_osdep.h>
115
116#include "bpf.h"
117#define NBPFILTER NBPF
118#include "stf.h"
119#include "gif.h" /*XXX*/
120
121#if NBPFILTER > 0
122#include <net/bpf.h>
123#endif
124
125#if NGIF > 0
126#include <net/if_gif.h>
127#endif
128
129#if NSTF > 0
130#if NSTF != 1
131# error only single stf interface allowed
132#endif
133
134#define IN6_IS_ADDR_6TO4(x) (ntohs((x)->s6_addr16[0]) == 0x2002)
135#define GET_V4(x) ((struct in_addr *)(&(x)->s6_addr16[1]))
136
137struct stf_softc {
138 struct ifnet sc_if; /* common area */
139 union {
140 struct route __sc_ro4;
141 struct route_in6 __sc_ro6; /* just for safety */
142 } __sc_ro46;
143#define sc_ro __sc_ro46.__sc_ro4
144 const struct encaptab *encap_cookie;
145};
146
147static struct stf_softc *stf;
148static int nstf;
149
150#if NGIF > 0
151extern int ip_gif_ttl; /*XXX*/
152#else
153static int ip_gif_ttl = 40; /*XXX*/
154#endif
155
156extern struct protosw in_stf_protosw;
157
158void stfattach __P((void *));
159static int stf_encapcheck __P((const struct mbuf *, int, int, void *));
160static struct in6_ifaddr *stf_getsrcifa6 __P((struct ifnet *));
161static int stf_output __P((struct ifnet *, struct mbuf *, struct sockaddr *,
162 struct rtentry *));
163static int stf_checkaddr4 __P((struct stf_softc *, struct in_addr *,
164 struct ifnet *));
165static int stf_checkaddr6 __P((struct stf_softc *, struct in6_addr *,
166 struct ifnet *));
167static void stf_rtrequest __P((int, struct rtentry *, struct sockaddr *));
168static int stf_ioctl __P((struct ifnet *, u_long, caddr_t));
169
170void
171stfattach(dummy)
172 void *dummy;
173{
174 struct stf_softc *sc;
175 int i;
176 const struct encaptab *p;
177
178 nstf = NSTF;
179 stf = malloc(nstf * sizeof(struct stf_softc), M_DEVBUF, M_WAITOK);
180 bzero(stf, nstf * sizeof(struct stf_softc));
181 sc = stf;
182
183 /* XXX just in case... */
184 for (i = 0; i < nstf; i++) {
185 sc = &stf[i];
186 bzero(sc, sizeof(*sc));
187 sc->sc_if.if_name = "stf";
188 sc->sc_if.if_unit = i;
189
190 p = encap_attach_func(AF_INET, IPPROTO_IPV6, stf_encapcheck,
191 &in_stf_protosw, sc);
192 if (p == NULL) {
193 printf("%s: attach failed\n", if_name(&sc->sc_if));
194 continue;
195 }
196 sc->encap_cookie = p;
197
198 sc->sc_if.if_mtu = IPV6_MMTU;
199 sc->sc_if.if_flags = 0;
200 sc->sc_if.if_ioctl = stf_ioctl;
201 sc->sc_if.if_output = stf_output;
202 sc->sc_if.if_type = IFT_STF;
203#if 0
204 /* turn off ingress filter */
205 sc->sc_if.if_flags |= IFF_LINK2;
206#endif
207 sc->sc_if.if_snd.ifq_maxlen = IFQ_MAXLEN;
208 if_attach(&sc->sc_if);
209#if NBPFILTER > 0
210#ifdef HAVE_OLD_BPF
211 bpfattach(&sc->sc_if, DLT_NULL, sizeof(u_int));
212#else
213 bpfattach(&sc->sc_if.if_bpf, &sc->sc_if, DLT_NULL, sizeof(u_int));
214#endif
215#endif
216 }
217}
218
219PSEUDO_SET(stfattach, if_stf);
220
221static int
222stf_encapcheck(m, off, proto, arg)
223 const struct mbuf *m;
224 int off;
225 int proto;
226 void *arg;
227{
228 struct ip ip;
--- 179 unchanged lines hidden (view full) ---
408 ip = mtod(m, struct ip *);
409
410 bzero(ip, sizeof(*ip));
411
412 bcopy(GET_V4(&((struct sockaddr_in6 *)&ia6->ia_addr)->sin6_addr),
413 &ip->ip_src, sizeof(ip->ip_src));
414 bcopy(in4, &ip->ip_dst, sizeof(ip->ip_dst));
415 ip->ip_p = IPPROTO_IPV6;
416 ip->ip_ttl = ip_gif_ttl; /*XXX*/
417 ip->ip_len = m->m_pkthdr.len; /*host order*/
418 if (ifp->if_flags & IFF_LINK1)
419 ip_ecn_ingress(ECN_ALLOWED, &ip->ip_tos, &tos);
420 else
421 ip_ecn_ingress(ECN_NOCARE, &ip->ip_tos, &tos);
422
423 dst4 = (struct sockaddr_in *)&sc->sc_ro.ro_dst;
424 if (dst4->sin_family != AF_INET ||
--- 177 unchanged lines hidden (view full) ---
602 ip_ecn_egress(ECN_ALLOWED, &otos, &itos);
603 else
604 ip_ecn_egress(ECN_NOCARE, &otos, &itos);
605 ip6->ip6_flow &= ~htonl(0xff << 20);
606 ip6->ip6_flow |= htonl((u_int32_t)itos << 20);
607
608 m->m_pkthdr.rcvif = ifp;
609
610#if NBPFILTER > 0
611 if (ifp->if_bpf) {
612 /*
613 * We need to prepend the address family as
614 * a four byte field. Cons up a dummy header
615 * to pacify bpf. This is safe because bpf
616 * will only read from the mbuf (i.e., it won't
617 * try to free it or keep a pointer a to it).
618 */
--- 5 unchanged lines hidden (view full) ---
624 m0.m_data = (char *)⁡
625
626#ifdef HAVE_OLD_BPF
627 bpf_mtap(ifp, &m0);
628#else
629 bpf_mtap(ifp->if_bpf, &m0);
630#endif
631 }
632#endif /*NBPFILTER > 0*/
633
634 /*
635 * Put the packet to the network layer input queue according to the
636 * specified address family.
637 * See net/if_gif.c for possible issues with packet processing
638 * reorder due to extra queueing.
639 */
640 ifq = &ip6intrq;
--- 57 unchanged lines hidden (view full) ---
698
699 default:
700 error = EINVAL;
701 break;
702 }
703
704 return error;
705}
706
707#endif /* NSTF > 0 */
2/* $KAME: if_stf.c,v 1.62 2001/06/07 22:32:16 itojun Exp $ */
3
4/*
5 * Copyright (C) 2000 WIDE Project.
6 * All rights reserved.
7 *
8 * Redistribution and use in source and binary forms, with or without
9 * modification, are permitted provided that the following conditions
--- 83 unchanged lines hidden (view full) ---
93#include <net/route.h>
94#include <net/netisr.h>
95#include <net/if_types.h>
96#include <net/if_stf.h>
97
98#include <netinet/in.h>
99#include <netinet/in_systm.h>
100#include <netinet/ip.h>
101#include <netinet/ip_var.h>
102#include <netinet/in_var.h>
103
104#include <netinet/ip6.h>
105#include <netinet6/ip6_var.h>
106#include <netinet6/in6_gif.h>
107#include <netinet6/in6_var.h>
108#include <netinet/ip_ecn.h>
109
110#include <netinet/ip_encap.h>
111
112#include <machine/stdarg.h>
113
114#include <net/net_osdep.h>
115
116#include "bpf.h"
117#define NBPFILTER NBPF
118#include "stf.h"
119#include "gif.h" /*XXX*/
120
121#if NBPFILTER > 0
122#include <net/bpf.h>
123#endif
124
125#if NGIF > 0
126#include <net/if_gif.h>
127#endif
128
129#if NSTF > 0
130#if NSTF != 1
131# error only single stf interface allowed
132#endif
133
134#define IN6_IS_ADDR_6TO4(x) (ntohs((x)->s6_addr16[0]) == 0x2002)
135#define GET_V4(x) ((struct in_addr *)(&(x)->s6_addr16[1]))
136
137struct stf_softc {
138 struct ifnet sc_if; /* common area */
139 union {
140 struct route __sc_ro4;
141 struct route_in6 __sc_ro6; /* just for safety */
142 } __sc_ro46;
143#define sc_ro __sc_ro46.__sc_ro4
144 const struct encaptab *encap_cookie;
145};
146
147static struct stf_softc *stf;
148static int nstf;
149
150#if NGIF > 0
151extern int ip_gif_ttl; /*XXX*/
152#else
153static int ip_gif_ttl = 40; /*XXX*/
154#endif
155
156extern struct protosw in_stf_protosw;
157
158void stfattach __P((void *));
159static int stf_encapcheck __P((const struct mbuf *, int, int, void *));
160static struct in6_ifaddr *stf_getsrcifa6 __P((struct ifnet *));
161static int stf_output __P((struct ifnet *, struct mbuf *, struct sockaddr *,
162 struct rtentry *));
163static int stf_checkaddr4 __P((struct stf_softc *, struct in_addr *,
164 struct ifnet *));
165static int stf_checkaddr6 __P((struct stf_softc *, struct in6_addr *,
166 struct ifnet *));
167static void stf_rtrequest __P((int, struct rtentry *, struct sockaddr *));
168static int stf_ioctl __P((struct ifnet *, u_long, caddr_t));
169
170void
171stfattach(dummy)
172 void *dummy;
173{
174 struct stf_softc *sc;
175 int i;
176 const struct encaptab *p;
177
178 nstf = NSTF;
179 stf = malloc(nstf * sizeof(struct stf_softc), M_DEVBUF, M_WAITOK);
180 bzero(stf, nstf * sizeof(struct stf_softc));
181 sc = stf;
182
183 /* XXX just in case... */
184 for (i = 0; i < nstf; i++) {
185 sc = &stf[i];
186 bzero(sc, sizeof(*sc));
187 sc->sc_if.if_name = "stf";
188 sc->sc_if.if_unit = i;
189
190 p = encap_attach_func(AF_INET, IPPROTO_IPV6, stf_encapcheck,
191 &in_stf_protosw, sc);
192 if (p == NULL) {
193 printf("%s: attach failed\n", if_name(&sc->sc_if));
194 continue;
195 }
196 sc->encap_cookie = p;
197
198 sc->sc_if.if_mtu = IPV6_MMTU;
199 sc->sc_if.if_flags = 0;
200 sc->sc_if.if_ioctl = stf_ioctl;
201 sc->sc_if.if_output = stf_output;
202 sc->sc_if.if_type = IFT_STF;
203#if 0
204 /* turn off ingress filter */
205 sc->sc_if.if_flags |= IFF_LINK2;
206#endif
207 sc->sc_if.if_snd.ifq_maxlen = IFQ_MAXLEN;
208 if_attach(&sc->sc_if);
209#if NBPFILTER > 0
210#ifdef HAVE_OLD_BPF
211 bpfattach(&sc->sc_if, DLT_NULL, sizeof(u_int));
212#else
213 bpfattach(&sc->sc_if.if_bpf, &sc->sc_if, DLT_NULL, sizeof(u_int));
214#endif
215#endif
216 }
217}
218
219PSEUDO_SET(stfattach, if_stf);
220
221static int
222stf_encapcheck(m, off, proto, arg)
223 const struct mbuf *m;
224 int off;
225 int proto;
226 void *arg;
227{
228 struct ip ip;
--- 179 unchanged lines hidden (view full) ---
408 ip = mtod(m, struct ip *);
409
410 bzero(ip, sizeof(*ip));
411
412 bcopy(GET_V4(&((struct sockaddr_in6 *)&ia6->ia_addr)->sin6_addr),
413 &ip->ip_src, sizeof(ip->ip_src));
414 bcopy(in4, &ip->ip_dst, sizeof(ip->ip_dst));
415 ip->ip_p = IPPROTO_IPV6;
416 ip->ip_ttl = ip_gif_ttl; /*XXX*/
417 ip->ip_len = m->m_pkthdr.len; /*host order*/
418 if (ifp->if_flags & IFF_LINK1)
419 ip_ecn_ingress(ECN_ALLOWED, &ip->ip_tos, &tos);
420 else
421 ip_ecn_ingress(ECN_NOCARE, &ip->ip_tos, &tos);
422
423 dst4 = (struct sockaddr_in *)&sc->sc_ro.ro_dst;
424 if (dst4->sin_family != AF_INET ||
--- 177 unchanged lines hidden (view full) ---
602 ip_ecn_egress(ECN_ALLOWED, &otos, &itos);
603 else
604 ip_ecn_egress(ECN_NOCARE, &otos, &itos);
605 ip6->ip6_flow &= ~htonl(0xff << 20);
606 ip6->ip6_flow |= htonl((u_int32_t)itos << 20);
607
608 m->m_pkthdr.rcvif = ifp;
609
610#if NBPFILTER > 0
611 if (ifp->if_bpf) {
612 /*
613 * We need to prepend the address family as
614 * a four byte field. Cons up a dummy header
615 * to pacify bpf. This is safe because bpf
616 * will only read from the mbuf (i.e., it won't
617 * try to free it or keep a pointer a to it).
618 */
--- 5 unchanged lines hidden (view full) ---
624 m0.m_data = (char *)⁡
625
626#ifdef HAVE_OLD_BPF
627 bpf_mtap(ifp, &m0);
628#else
629 bpf_mtap(ifp->if_bpf, &m0);
630#endif
631 }
632#endif /*NBPFILTER > 0*/
633
634 /*
635 * Put the packet to the network layer input queue according to the
636 * specified address family.
637 * See net/if_gif.c for possible issues with packet processing
638 * reorder due to extra queueing.
639 */
640 ifq = &ip6intrq;
--- 57 unchanged lines hidden (view full) ---
698
699 default:
700 error = EINVAL;
701 break;
702 }
703
704 return error;
705}
706
707#endif /* NSTF > 0 */