123186Smckusick /* 237322Skarels * Copyright (c) 1982, 1986, 1988 Regents of the University of California. 332787Sbostic * All rights reserved. 423186Smckusick * 544482Sbostic * %sccs.include.redist.c% 632787Sbostic * 7*57433Sandrew * @(#)raw_ip.c 7.11 (Berkeley) 01/08/93 823186Smckusick */ 95123Swnj 1056531Sbostic #include <sys/param.h> 1156531Sbostic #include <sys/malloc.h> 1256531Sbostic #include <sys/mbuf.h> 1356531Sbostic #include <sys/socket.h> 1456531Sbostic #include <sys/protosw.h> 1556531Sbostic #include <sys/socketvar.h> 1656531Sbostic #include <sys/errno.h> 1756531Sbostic #include <sys/systm.h> 1810894Ssam 1956531Sbostic #include <net/if.h> 2056531Sbostic #include <net/route.h> 2110894Ssam 2256531Sbostic #include <netinet/in.h> 2356531Sbostic #include <netinet/in_systm.h> 2456531Sbostic #include <netinet/ip.h> 2556531Sbostic #include <netinet/ip_var.h> 2656531Sbostic #include <netinet/ip_mroute.h> 2756531Sbostic #include <netinet/in_pcb.h> 285123Swnj 2954716Ssklower struct inpcb rawinpcb; 3054716Ssklower 315123Swnj /* 3254716Ssklower * Nominal space allocated to a raw ip socket. 3354716Ssklower */ 3454716Ssklower #define RIPSNDQ 8192 3554716Ssklower #define RIPRCVQ 8192 3654716Ssklower 3754716Ssklower /* 385612Swnj * Raw interface to IP protocol. 395123Swnj */ 405612Swnj 4154716Ssklower /* 4254716Ssklower * Initialize raw connection block q. 4354716Ssklower */ 4454716Ssklower rip_init() 4554716Ssklower { 4654716Ssklower 4754716Ssklower rawinpcb.inp_next = rawinpcb.inp_prev = &rawinpcb; 4854716Ssklower } 4954716Ssklower 5037322Skarels struct sockaddr_in ripsrc = { sizeof(ripsrc), AF_INET }; 515612Swnj /* 525612Swnj * Setup generic address and protocol structures 535612Swnj * for raw_input routine, then pass them along with 545612Swnj * mbuf chain. 555612Swnj */ 565123Swnj rip_input(m) 575123Swnj struct mbuf *m; 585123Swnj { 595612Swnj register struct ip *ip = mtod(m, struct ip *); 6054716Ssklower register struct inpcb *inp; 6154716Ssklower struct socket *last = 0; 625123Swnj 635646Ssam ripsrc.sin_addr = ip->ip_src; 6454716Ssklower for (inp = rawinpcb.inp_next; inp != &rawinpcb; inp = inp->inp_next) { 6554716Ssklower if (inp->inp_ip.ip_p && inp->inp_ip.ip_p != ip->ip_p) 6654716Ssklower continue; 6754716Ssklower if (inp->inp_laddr.s_addr && 6854716Ssklower inp->inp_laddr.s_addr == ip->ip_dst.s_addr) 6954716Ssklower continue; 7054716Ssklower if (inp->inp_faddr.s_addr && 7154716Ssklower inp->inp_faddr.s_addr == ip->ip_src.s_addr) 7254716Ssklower continue; 7354716Ssklower if (last) { 7454716Ssklower struct mbuf *n; 7554716Ssklower if (n = m_copy(m, 0, (int)M_COPYALL)) { 7654716Ssklower if (sbappendaddr(&last->so_rcv, &ripsrc, 7754716Ssklower n, (struct mbuf *)0) == 0) 7854716Ssklower /* should notify about lost packet */ 7954716Ssklower m_freem(n); 8054716Ssklower else 8154716Ssklower sorwakeup(last); 8254716Ssklower } 8354716Ssklower } 8454716Ssklower last = inp->inp_socket; 8554716Ssklower } 8654716Ssklower if (last) { 8754716Ssklower if (sbappendaddr(&last->so_rcv, &ripsrc, 8854716Ssklower m, (struct mbuf *)0) == 0) 8954716Ssklower m_freem(m); 9054716Ssklower else 9154716Ssklower sorwakeup(last); 9254716Ssklower } else { 9354716Ssklower m_freem(m); 9439184Ssklower ipstat.ips_noproto++; 9539184Ssklower ipstat.ips_delivered--; 9639184Ssklower } 975123Swnj } 985123Swnj 995612Swnj /* 1005612Swnj * Generate IP header and pass packet to ip_output. 1015612Swnj * Tack on options user may have setup with control call. 1025612Swnj */ 10354716Ssklower rip_output(m, so, dst) 10437322Skarels register struct mbuf *m; 1055612Swnj struct socket *so; 10654716Ssklower u_long dst; 1075123Swnj { 1085612Swnj register struct ip *ip; 10954716Ssklower register struct inpcb *inp = sotoinpcb(so); 11037322Skarels register struct sockaddr_in *sin; 1115123Swnj 1125612Swnj /* 11337322Skarels * If the user handed us a complete IP packet, use it. 11437322Skarels * Otherwise, allocate an mbuf for a header and fill it in. 1155612Swnj */ 11654716Ssklower if ((inp->inp_flags & INP_HDRINCL) == 0) { 11737322Skarels M_PREPEND(m, sizeof(struct ip), M_WAIT); 11837322Skarels ip = mtod(m, struct ip *); 11937322Skarels ip->ip_tos = 0; 12037322Skarels ip->ip_off = 0; 12154716Ssklower ip->ip_p = inp->inp_ip.ip_p; 12237322Skarels ip->ip_len = m->m_pkthdr.len; 12354716Ssklower ip->ip_src = inp->inp_laddr; 12454716Ssklower ip->ip_dst.s_addr = dst; 12537322Skarels ip->ip_ttl = MAXTTL; 1265612Swnj } 12737322Skarels return (ip_output(m, 12854716Ssklower (inp->inp_flags & INP_HDRINCL)? (struct mbuf *)0: inp->inp_options, 12954716Ssklower &inp->inp_route, 130*57433Sandrew (so->so_options & SO_DONTROUTE) | IP_ALLOWBROADCAST, 131*57433Sandrew inp->inp_moptions)); 1325123Swnj } 13326037Skarels 13426037Skarels /* 13526037Skarels * Raw IP socket option processing. 13626037Skarels */ 13726037Skarels rip_ctloutput(op, so, level, optname, m) 13826037Skarels int op; 13926037Skarels struct socket *so; 14026037Skarels int level, optname; 14126037Skarels struct mbuf **m; 14226037Skarels { 14354716Ssklower register struct inpcb *inp = sotoinpcb(so); 14454716Ssklower register int error; 14526037Skarels 14626037Skarels if (level != IPPROTO_IP) 14754716Ssklower return (EINVAL); 14826037Skarels 14954716Ssklower switch (optname) { 15037322Skarels 15154716Ssklower case IP_HDRINCL: 15254716Ssklower if (op == PRCO_SETOPT || op == PRCO_GETOPT) { 15354716Ssklower if (m == 0 || *m == 0 || (*m)->m_len < sizeof (int)) 15454716Ssklower return (EINVAL); 15554716Ssklower if (op == PRCO_SETOPT) { 15654716Ssklower if (*mtod(*m, int *)) 15754716Ssklower inp->inp_flags |= INP_HDRINCL; 15854716Ssklower else 15954716Ssklower inp->inp_flags &= ~INP_HDRINCL; 16054716Ssklower (void)m_free(*m); 16154716Ssklower } else { 16254716Ssklower (*m)->m_len = sizeof (int); 16354716Ssklower *mtod(*m, int *) = inp->inp_flags & INP_HDRINCL; 16437322Skarels } 16554716Ssklower return (0); 16626037Skarels } 16726037Skarels break; 16826037Skarels 16954716Ssklower case DVMRP_INIT: 17054716Ssklower case DVMRP_DONE: 17154716Ssklower case DVMRP_ADD_VIF: 17254716Ssklower case DVMRP_DEL_VIF: 17354716Ssklower case DVMRP_ADD_LGRP: 17454716Ssklower case DVMRP_DEL_LGRP: 17554716Ssklower case DVMRP_ADD_MRT: 17654716Ssklower case DVMRP_DEL_MRT: 17754716Ssklower #ifdef MROUTING 17854716Ssklower if (op == PRCO_SETOPT) { 17954716Ssklower error = ip_mrouter_cmd(optname, so, *m); 18054716Ssklower if (*m) 18154716Ssklower (void)m_free(*m); 18254716Ssklower } else 18326037Skarels error = EINVAL; 18454716Ssklower return (error); 18554716Ssklower #else 18654716Ssklower if (op == PRCO_SETOPT && *m) 18754716Ssklower (void)m_free(*m); 18854716Ssklower return (EOPNOTSUPP); 18954716Ssklower #endif 19026037Skarels } 19154716Ssklower return (ip_ctloutput(op, so, level, optname, m)); 19226037Skarels } 19337322Skarels 19454716Ssklower u_long rip_sendspace = RIPSNDQ; 19554716Ssklower u_long rip_recvspace = RIPRCVQ; 19654716Ssklower 19737322Skarels /*ARGSUSED*/ 19854716Ssklower rip_usrreq(so, req, m, nam, control) 19937322Skarels register struct socket *so; 20037322Skarels int req; 20154716Ssklower struct mbuf *m, *nam, *control; 20237322Skarels { 20337322Skarels register int error = 0; 20454716Ssklower register struct inpcb *inp = sotoinpcb(so); 205*57433Sandrew #ifdef MROUTING 20654716Ssklower extern struct socket *ip_mrouter; 20754716Ssklower #endif 20837322Skarels 20937322Skarels switch (req) { 21037322Skarels 21137322Skarels case PRU_ATTACH: 21254716Ssklower if (inp) 21337322Skarels panic("rip_attach"); 21454716Ssklower if ((so->so_state & SS_PRIV) == 0) { 21554716Ssklower error = EACCES; 21654716Ssklower break; 21754716Ssklower } 21854716Ssklower if ((error = soreserve(so, rip_sendspace, rip_recvspace)) || 21954716Ssklower (error = in_pcballoc(so, &rawinpcb))) 22054716Ssklower break; 22154716Ssklower inp = (struct inpcb *)so->so_pcb; 22254716Ssklower inp->inp_ip.ip_p = (int)nam; 22337322Skarels break; 22437322Skarels 22554716Ssklower case PRU_DISCONNECT: 22654716Ssklower if ((so->so_state & SS_ISCONNECTED) == 0) { 22754716Ssklower error = ENOTCONN; 22854716Ssklower break; 22954716Ssklower } 23054716Ssklower /* FALLTHROUGH */ 23154716Ssklower case PRU_ABORT: 23254716Ssklower soisdisconnected(so); 23354716Ssklower /* FALLTHROUGH */ 23437322Skarels case PRU_DETACH: 23554716Ssklower if (inp == 0) 23637322Skarels panic("rip_detach"); 237*57433Sandrew #ifdef MROUTING 23854716Ssklower if (so == ip_mrouter) 23954716Ssklower ip_mrouter_done(); 24054716Ssklower #endif 24154716Ssklower in_pcbdetach(inp); 24237322Skarels break; 24337322Skarels 24437322Skarels case PRU_BIND: 24537322Skarels { 24637322Skarels struct sockaddr_in *addr = mtod(nam, struct sockaddr_in *); 24737322Skarels 24854716Ssklower if (nam->m_len != sizeof(*addr)) { 24954716Ssklower error = EINVAL; 25054716Ssklower break; 25154716Ssklower } 25237322Skarels if ((ifnet == 0) || 25337322Skarels ((addr->sin_family != AF_INET) && 25437322Skarels (addr->sin_family != AF_IMPLINK)) || 25537322Skarels (addr->sin_addr.s_addr && 25654716Ssklower ifa_ifwithaddr((struct sockaddr *)addr) == 0)) { 25754716Ssklower error = EADDRNOTAVAIL; 25854716Ssklower break; 25954716Ssklower } 26054716Ssklower inp->inp_laddr = addr->sin_addr; 26154716Ssklower break; 26237322Skarels } 26337322Skarels case PRU_CONNECT: 26437322Skarels { 26537322Skarels struct sockaddr_in *addr = mtod(nam, struct sockaddr_in *); 26637322Skarels 26754716Ssklower if (nam->m_len != sizeof(*addr)) { 26854716Ssklower error = EINVAL; 26954716Ssklower break; 27054716Ssklower } 27154716Ssklower if (ifnet == 0) { 27254716Ssklower error = EADDRNOTAVAIL; 27354716Ssklower break; 27454716Ssklower } 27537322Skarels if ((addr->sin_family != AF_INET) && 27654716Ssklower (addr->sin_family != AF_IMPLINK)) { 27754716Ssklower error = EAFNOSUPPORT; 27854716Ssklower break; 27954716Ssklower } 28054716Ssklower inp->inp_faddr = addr->sin_addr; 28137322Skarels soisconnected(so); 28254716Ssklower break; 28354716Ssklower } 28454716Ssklower 28554716Ssklower case PRU_CONNECT2: 28654716Ssklower error = EOPNOTSUPP; 28754716Ssklower break; 28854716Ssklower 28954716Ssklower /* 29054716Ssklower * Mark the connection as being incapable of further input. 29154716Ssklower */ 29254716Ssklower case PRU_SHUTDOWN: 29354716Ssklower socantsendmore(so); 29454716Ssklower break; 29554716Ssklower 29654716Ssklower /* 29754716Ssklower * Ship a packet out. The appropriate raw output 29854716Ssklower * routine handles any massaging necessary. 29954716Ssklower */ 30054716Ssklower case PRU_SEND: 30154716Ssklower { 30254716Ssklower register u_long dst; 30354716Ssklower 30454716Ssklower if (so->so_state & SS_ISCONNECTED) { 30554716Ssklower if (nam) { 30654716Ssklower error = EISCONN; 30754716Ssklower break; 30854716Ssklower } 30954716Ssklower dst = inp->inp_faddr.s_addr; 31054716Ssklower } else { 31154716Ssklower if (nam == NULL) { 31254716Ssklower error = ENOTCONN; 31354716Ssklower break; 31454716Ssklower } 31554716Ssklower dst = mtod(nam, struct sockaddr_in *)->sin_addr.s_addr; 31654716Ssklower } 31754716Ssklower error = rip_output(m, so, dst); 31854716Ssklower m = NULL; 31954716Ssklower break; 32054716Ssklower } 32154716Ssklower 32254716Ssklower case PRU_SENSE: 32354716Ssklower /* 32454716Ssklower * stat: don't bother with a blocksize. 32554716Ssklower */ 32637322Skarels return (0); 32754716Ssklower 32854716Ssklower /* 32954716Ssklower * Not supported. 33054716Ssklower */ 33154716Ssklower case PRU_RCVOOB: 33254716Ssklower case PRU_RCVD: 33354716Ssklower case PRU_LISTEN: 33454716Ssklower case PRU_ACCEPT: 33554716Ssklower case PRU_SENDOOB: 33654716Ssklower error = EOPNOTSUPP; 33754716Ssklower break; 33854716Ssklower 33954716Ssklower case PRU_SOCKADDR: 34054716Ssklower in_setsockaddr(inp, nam); 34154716Ssklower break; 34254716Ssklower 34354716Ssklower case PRU_PEERADDR: 34454716Ssklower in_setpeeraddr(inp, nam); 34554716Ssklower break; 34654716Ssklower 34754716Ssklower default: 34854716Ssklower panic("rip_usrreq"); 34937322Skarels } 35054716Ssklower if (m != NULL) 35154716Ssklower m_freem(m); 35237322Skarels return (error); 35337322Skarels } 354