1 /* 2 * Copyright (c) 1982, 1986, 1993 3 * The Regents of the University of California. All rights reserved. 4 * 5 * Redistribution and use in source and binary forms, with or without 6 * modification, are permitted provided that the following conditions 7 * are met: 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 the 12 * documentation and/or other materials provided with the distribution. 13 * 3. All advertising materials mentioning features or use of this software 14 * must display the following acknowledgement: 15 * This product includes software developed by the University of 16 * California, Berkeley and its contributors. 17 * 4. Neither the name of the University nor the names of its contributors 18 * may be used to endorse or promote products derived from this software 19 * without specific prior written permission. 20 * 21 * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND 22 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 23 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 24 * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE 25 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 26 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 27 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 28 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 29 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 30 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 31 * SUCH DAMAGE. 32 * 33 * @(#)if_loop.c 8.1 (Berkeley) 6/10/93 34 * $FreeBSD$ 35 */ 36 37 /* 38 * Loopback interface driver for protocol testing and timing. 39 */ 40 #include "loop.h" 41 42 #include "opt_atalk.h" 43 #include "opt_inet.h" 44 #include "opt_inet6.h" 45 #include "opt_ipx.h" 46 47 #include <sys/param.h> 48 #include <sys/systm.h> 49 #include <sys/kernel.h> 50 #include <sys/mbuf.h> 51 #include <sys/socket.h> 52 #include <sys/sockio.h> 53 54 #include <net/if.h> 55 #include <net/if_types.h> 56 #include <net/netisr.h> 57 #include <net/route.h> 58 #include <net/bpf.h> 59 60 #ifdef INET 61 #include <netinet/in.h> 62 #include <netinet/in_var.h> 63 #endif 64 65 #ifdef IPX 66 #include <netipx/ipx.h> 67 #include <netipx/ipx_if.h> 68 #endif 69 70 #ifdef INET6 71 #ifndef INET 72 #include <netinet/in.h> 73 #endif 74 #include <netinet6/in6_var.h> 75 #include <netinet6/ip6.h> 76 #endif 77 78 #ifdef NS 79 #include <netns/ns.h> 80 #include <netns/ns_if.h> 81 #endif 82 83 #ifdef NETATALK 84 #include <netatalk/at.h> 85 #include <netatalk/at_var.h> 86 #endif NETATALK 87 88 int loioctl __P((struct ifnet *, u_long, caddr_t)); 89 static void lortrequest __P((int, struct rtentry *, struct sockaddr *)); 90 91 static void loopattach __P((void *)); 92 PSEUDO_SET(loopattach, if_loop); 93 94 int looutput __P((struct ifnet *ifp, 95 struct mbuf *m, struct sockaddr *dst, struct rtentry *rt)); 96 97 #ifdef TINY_LOMTU 98 #define LOMTU (1024+512) 99 #elif defined(LARGE_LOMTU) 100 #define LOMTU 131072 101 #else 102 #define LOMTU 16384 103 #endif 104 105 struct ifnet loif[NLOOP]; 106 107 /* ARGSUSED */ 108 static void 109 loopattach(dummy) 110 void *dummy; 111 { 112 register struct ifnet *ifp; 113 register int i = 0; 114 115 for (ifp = loif; i < NLOOP; ifp++) { 116 ifp->if_name = "lo"; 117 ifp->if_unit = i++; 118 ifp->if_mtu = LOMTU; 119 ifp->if_flags = IFF_LOOPBACK | IFF_MULTICAST; 120 ifp->if_ioctl = loioctl; 121 ifp->if_output = looutput; 122 ifp->if_type = IFT_LOOP; 123 ifp->if_snd.ifq_maxlen = ifqmaxlen; 124 if_attach(ifp); 125 bpfattach(ifp, DLT_NULL, sizeof(u_int)); 126 } 127 } 128 129 int 130 looutput(ifp, m, dst, rt) 131 struct ifnet *ifp; 132 register struct mbuf *m; 133 struct sockaddr *dst; 134 register struct rtentry *rt; 135 { 136 if ((m->m_flags & M_PKTHDR) == 0) 137 panic("looutput no HDR"); 138 139 if (rt && rt->rt_flags & (RTF_REJECT|RTF_BLACKHOLE)) { 140 m_freem(m); 141 return (rt->rt_flags & RTF_BLACKHOLE ? 0 : 142 rt->rt_flags & RTF_HOST ? EHOSTUNREACH : ENETUNREACH); 143 } 144 /* 145 * KAME requires that the packet to be contiguous on the 146 * mbuf. We need to make that sure. 147 * this kind of code should be avoided. 148 * XXX: fails to join if interface MTU > MCLBYTES. jumbogram? 149 */ 150 if (m && m->m_next != NULL && m->m_pkthdr.len < MCLBYTES) { 151 struct mbuf *n; 152 153 MGETHDR(n, M_DONTWAIT, MT_HEADER); 154 if (!n) 155 goto contiguousfail; 156 MCLGET(n, M_DONTWAIT); 157 if (! (n->m_flags & M_EXT)) { 158 m_freem(n); 159 goto contiguousfail; 160 } 161 162 m_copydata(m, 0, m->m_pkthdr.len, mtod(n, caddr_t)); 163 n->m_pkthdr = m->m_pkthdr; 164 n->m_len = m->m_pkthdr.len; 165 m_freem(m); 166 m = n; 167 } 168 if (0) { 169 contiguousfail: 170 printf("looutput: mbuf allocation failed\n"); 171 } 172 173 ifp->if_opackets++; 174 ifp->if_obytes += m->m_pkthdr.len; 175 #if 1 /* XXX */ 176 switch (dst->sa_family) { 177 case AF_INET: 178 case AF_INET6: 179 case AF_IPX: 180 case AF_NS: 181 case AF_APPLETALK: 182 break; 183 default: 184 printf("looutput: af=%d unexpected", dst->sa_family); 185 m_freem(m); 186 return (EAFNOSUPPORT); 187 } 188 #endif 189 return(if_simloop(ifp, m, dst->sa_family, 0)); 190 } 191 192 /* 193 * if_simloop() 194 * 195 * This function is to support software emulation of hardware loopback, 196 * i.e., for interfaces with the IFF_SIMPLEX attribute. Since they can't 197 * hear their own broadcasts, we create a copy of the packet that we 198 * would normally receive via a hardware loopback. 199 * 200 * This function expects the packet to include the media header of length hlen. 201 */ 202 203 int 204 if_simloop(ifp, m, af, hlen) 205 struct ifnet *ifp; 206 register struct mbuf *m; 207 int af; 208 int hlen; 209 { 210 int s, isr; 211 register struct ifqueue *ifq = 0; 212 213 KASSERT((m->m_flags & M_PKTHDR) != 0, ("if_simloop: no HDR")); 214 m->m_pkthdr.rcvif = ifp; 215 216 /* BPF write needs to be handled specially */ 217 if (af == AF_UNSPEC) { 218 KASSERT(m->m_len >= sizeof(int), ("if_simloop: m_len")); 219 af = *(mtod(m, int *)); 220 m->m_len -= sizeof(int); 221 m->m_pkthdr.len -= sizeof(int); 222 m->m_data += sizeof(int); 223 } 224 225 /* Let BPF see incoming packet */ 226 if (ifp->if_bpf) { 227 struct mbuf m0, *n = m; 228 229 /* 230 * We need to prepend the address family as 231 * a four byte field. Cons up a dummy header 232 * to pacify bpf. This is safe because bpf 233 * will only read from the mbuf (i.e., it won't 234 * try to free it or keep a pointer a to it). 235 */ 236 m0.m_next = m; 237 m0.m_len = 4; 238 m0.m_data = (char *)⁡ 239 n = &m0; 240 bpf_mtap(ifp, n); 241 } 242 243 /* Strip away media header */ 244 if (hlen > 0) { 245 #ifdef __alpha__ 246 /* The alpha doesn't like unaligned data. 247 * We move data down in the first mbuf */ 248 if (hlen & 3) { 249 bcopy(m->m_data + hlen, m->m_data, m->m_len - hlen); 250 m->m_len -= hlen; 251 if (m->m_flags & M_PKTHDR) 252 m->m_pkthdr.len -= hlen; 253 } else 254 #endif 255 m_adj(m, hlen); 256 } 257 258 /* Deliver to upper layer protocol */ 259 switch (af) { 260 #ifdef INET 261 case AF_INET: 262 ifq = &ipintrq; 263 isr = NETISR_IP; 264 break; 265 #endif 266 #ifdef INET6 267 case AF_INET6: 268 m->m_flags |= M_LOOP; 269 ifq = &ip6intrq; 270 isr = NETISR_IPV6; 271 break; 272 #endif 273 #ifdef IPX 274 case AF_IPX: 275 ifq = &ipxintrq; 276 isr = NETISR_IPX; 277 break; 278 #endif 279 #ifdef NS 280 case AF_NS: 281 ifq = &nsintrq; 282 isr = NETISR_NS; 283 break; 284 #endif 285 #ifdef NETATALK 286 case AF_APPLETALK: 287 ifq = &atintrq2; 288 isr = NETISR_ATALK; 289 break; 290 #endif NETATALK 291 default: 292 printf("if_simloop: can't handle af=%d\n", af); 293 m_freem(m); 294 return (EAFNOSUPPORT); 295 } 296 s = splimp(); 297 if (IF_QFULL(ifq)) { 298 IF_DROP(ifq); 299 m_freem(m); 300 splx(s); 301 return (ENOBUFS); 302 } 303 IF_ENQUEUE(ifq, m); 304 schednetisr(isr); 305 ifp->if_ipackets++; 306 ifp->if_ibytes += m->m_pkthdr.len; 307 splx(s); 308 return (0); 309 } 310 311 /* ARGSUSED */ 312 static void 313 lortrequest(cmd, rt, sa) 314 int cmd; 315 struct rtentry *rt; 316 struct sockaddr *sa; 317 { 318 if (rt) { 319 rt->rt_rmx.rmx_mtu = rt->rt_ifp->if_mtu; /* for ISO */ 320 /* 321 * For optimal performance, the send and receive buffers 322 * should be at least twice the MTU plus a little more for 323 * overhead. 324 */ 325 rt->rt_rmx.rmx_recvpipe = 326 rt->rt_rmx.rmx_sendpipe = 3 * LOMTU; 327 } 328 } 329 330 /* 331 * Process an ioctl request. 332 */ 333 /* ARGSUSED */ 334 int 335 loioctl(ifp, cmd, data) 336 register struct ifnet *ifp; 337 u_long cmd; 338 caddr_t data; 339 { 340 register struct ifaddr *ifa; 341 register struct ifreq *ifr = (struct ifreq *)data; 342 register int error = 0; 343 344 switch (cmd) { 345 346 case SIOCSIFADDR: 347 ifp->if_flags |= IFF_UP | IFF_RUNNING; 348 ifa = (struct ifaddr *)data; 349 ifa->ifa_rtrequest = lortrequest; 350 /* 351 * Everything else is done at a higher level. 352 */ 353 break; 354 355 case SIOCADDMULTI: 356 case SIOCDELMULTI: 357 if (ifr == 0) { 358 error = EAFNOSUPPORT; /* XXX */ 359 break; 360 } 361 switch (ifr->ifr_addr.sa_family) { 362 363 #ifdef INET 364 case AF_INET: 365 break; 366 #endif 367 #ifdef INET6 368 case AF_INET6: 369 break; 370 #endif 371 372 default: 373 error = EAFNOSUPPORT; 374 break; 375 } 376 break; 377 378 case SIOCSIFMTU: 379 ifp->if_mtu = ifr->ifr_mtu; 380 break; 381 382 case SIOCSIFFLAGS: 383 break; 384 385 default: 386 error = EINVAL; 387 } 388 return (error); 389 } 390