165309e5cSBrian Somers /*- 265309e5cSBrian Somers * Copyright (c) 1996 - 2001 Brian Somers <brian@Awfulhak.org> 365309e5cSBrian Somers * based on work by Toshiharu OHNO <tony-o@iij.ad.jp> 465309e5cSBrian Somers * Internet Initiative Japan, Inc (IIJ) 565309e5cSBrian Somers * All rights reserved. 6af57ed9fSAtsushi Murai * 765309e5cSBrian Somers * Redistribution and use in source and binary forms, with or without 865309e5cSBrian Somers * modification, are permitted provided that the following conditions 965309e5cSBrian Somers * are met: 1065309e5cSBrian Somers * 1. Redistributions of source code must retain the above copyright 1165309e5cSBrian Somers * notice, this list of conditions and the following disclaimer. 1265309e5cSBrian Somers * 2. Redistributions in binary form must reproduce the above copyright 1365309e5cSBrian Somers * notice, this list of conditions and the following disclaimer in the 1465309e5cSBrian Somers * documentation and/or other materials provided with the distribution. 15af57ed9fSAtsushi Murai * 1665309e5cSBrian Somers * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 1765309e5cSBrian Somers * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 1865309e5cSBrian Somers * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 1965309e5cSBrian Somers * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 2065309e5cSBrian Somers * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 2165309e5cSBrian Somers * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 2265309e5cSBrian Somers * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 2365309e5cSBrian Somers * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 2465309e5cSBrian Somers * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 2565309e5cSBrian Somers * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 2665309e5cSBrian Somers * SUCH DAMAGE. 27af57ed9fSAtsushi Murai * 2897d92980SPeter Wemm * $FreeBSD$ 29af57ed9fSAtsushi Murai */ 3065309e5cSBrian Somers 31972a1bcfSBrian Somers #include <sys/param.h> 326a6b4bbbSBrian Somers #include <sys/socket.h> 3375240ed1SBrian Somers #include <netinet/in.h> 34af57ed9fSAtsushi Murai #include <netinet/in_systm.h> 35af57ed9fSAtsushi Murai #include <netinet/ip.h> 3630949fd4SBrian Somers #ifndef NOINET6 3730949fd4SBrian Somers #include <netinet/icmp6.h> 3830949fd4SBrian Somers #include <netinet/ip6.h> 3930949fd4SBrian Somers #endif 40af57ed9fSAtsushi Murai #include <netinet/ip_icmp.h> 41af57ed9fSAtsushi Murai #include <netinet/udp.h> 42af57ed9fSAtsushi Murai #include <netinet/tcp.h> 431fa665f5SBrian Somers #include <sys/un.h> 4475240ed1SBrian Somers 4557fd05c4SBrian Somers #include <errno.h> 4630949fd4SBrian Somers #include <netdb.h> 4775240ed1SBrian Somers #include <stdio.h> 4875240ed1SBrian Somers #include <string.h> 495d9e6103SBrian Somers #include <termios.h> 5075240ed1SBrian Somers #include <unistd.h> 5175240ed1SBrian Somers 525d9e6103SBrian Somers #include "layer.h" 535d9e6103SBrian Somers #include "proto.h" 54927145beSBrian Somers #include "mbuf.h" 55927145beSBrian Somers #include "log.h" 5675240ed1SBrian Somers #include "defs.h" 5775240ed1SBrian Somers #include "timer.h" 5875240ed1SBrian Somers #include "fsm.h" 59879ed6faSBrian Somers #include "lqr.h" 6075240ed1SBrian Somers #include "hdlc.h" 615828db6dSBrian Somers #include "throughput.h" 625828db6dSBrian Somers #include "iplist.h" 63eaa4df37SBrian Somers #include "slcompress.h" 6430949fd4SBrian Somers #include "ncpaddr.h" 6530949fd4SBrian Somers #include "ip.h" 6675240ed1SBrian Somers #include "ipcp.h" 671ae349f5Scvs2svn #include "filter.h" 682f786681SBrian Somers #include "descriptor.h" 6975240ed1SBrian Somers #include "lcp.h" 703b0f8d2eSBrian Somers #include "ccp.h" 713b0f8d2eSBrian Somers #include "link.h" 723b0f8d2eSBrian Somers #include "mp.h" 73972a1bcfSBrian Somers #ifndef NORADIUS 74972a1bcfSBrian Somers #include "radius.h" 75972a1bcfSBrian Somers #endif 7630949fd4SBrian Somers #include "ipv6cp.h" 7730949fd4SBrian Somers #include "ncp.h" 787a6f8720SBrian Somers #include "bundle.h" 796a6b4bbbSBrian Somers #include "tun.h" 80af57ed9fSAtsushi Murai 8152c9ca19SBrian Somers 8252c9ca19SBrian Somers #define OPCODE_QUERY 0 8352c9ca19SBrian Somers #define OPCODE_IQUERY 1 8452c9ca19SBrian Somers #define OPCODE_STATUS 2 8552c9ca19SBrian Somers 8652c9ca19SBrian Somers struct dns_header { 8752c9ca19SBrian Somers u_short id; 8852c9ca19SBrian Somers unsigned qr : 1; 8952c9ca19SBrian Somers unsigned opcode : 4; 9052c9ca19SBrian Somers unsigned aa : 1; 9152c9ca19SBrian Somers unsigned tc : 1; 9252c9ca19SBrian Somers unsigned rd : 1; 9352c9ca19SBrian Somers unsigned ra : 1; 9452c9ca19SBrian Somers unsigned z : 3; 9552c9ca19SBrian Somers unsigned rcode : 4; 9652c9ca19SBrian Somers u_short qdcount; 9752c9ca19SBrian Somers u_short ancount; 9852c9ca19SBrian Somers u_short nscount; 9952c9ca19SBrian Somers u_short arcount; 100182c898aSBrian Somers }; 101af57ed9fSAtsushi Murai 10252c9ca19SBrian Somers static const char * 10352c9ca19SBrian Somers dns_Qclass2Txt(u_short qclass) 10452c9ca19SBrian Somers { 10552c9ca19SBrian Somers static char failure[6]; 10652c9ca19SBrian Somers struct { 10752c9ca19SBrian Somers u_short id; 10852c9ca19SBrian Somers const char *txt; 10952c9ca19SBrian Somers } qtxt[] = { 11052c9ca19SBrian Somers /* rfc1035 */ 11152c9ca19SBrian Somers { 1, "IN" }, { 2, "CS" }, { 3, "CH" }, { 4, "HS" }, { 255, "*" } 11252c9ca19SBrian Somers }; 11352c9ca19SBrian Somers int f; 11452c9ca19SBrian Somers 11552c9ca19SBrian Somers for (f = 0; f < sizeof qtxt / sizeof *qtxt; f++) 11652c9ca19SBrian Somers if (qtxt[f].id == qclass) 11752c9ca19SBrian Somers return qtxt[f].txt; 11852c9ca19SBrian Somers 119d6d3eeabSBrian Somers return HexStr(qclass, failure, sizeof failure); 12052c9ca19SBrian Somers } 12152c9ca19SBrian Somers 12252c9ca19SBrian Somers static const char * 12352c9ca19SBrian Somers dns_Qtype2Txt(u_short qtype) 12452c9ca19SBrian Somers { 12552c9ca19SBrian Somers static char failure[6]; 12652c9ca19SBrian Somers struct { 12752c9ca19SBrian Somers u_short id; 12852c9ca19SBrian Somers const char *txt; 12952c9ca19SBrian Somers } qtxt[] = { 13052c9ca19SBrian Somers /* rfc1035/rfc1700 */ 13152c9ca19SBrian Somers { 1, "A" }, { 2, "NS" }, { 3, "MD" }, { 4, "MF" }, { 5, "CNAME" }, 13252c9ca19SBrian Somers { 6, "SOA" }, { 7, "MB" }, { 8, "MG" }, { 9, "MR" }, { 10, "NULL" }, 13352c9ca19SBrian Somers { 11, "WKS" }, { 12, "PTR" }, { 13, "HINFO" }, { 14, "MINFO" }, 13452c9ca19SBrian Somers { 15, "MX" }, { 16, "TXT" }, { 17, "RP" }, { 18, "AFSDB" }, 13552c9ca19SBrian Somers { 19, "X25" }, { 20, "ISDN" }, { 21, "RT" }, { 22, "NSAP" }, 13652c9ca19SBrian Somers { 23, "NSAP-PTR" }, { 24, "SIG" }, { 25, "KEY" }, { 26, "PX" }, 13752c9ca19SBrian Somers { 27, "GPOS" }, { 28, "AAAA" }, { 252, "AXFR" }, { 253, "MAILB" }, 13852c9ca19SBrian Somers { 254, "MAILA" }, { 255, "*" } 13952c9ca19SBrian Somers }; 14052c9ca19SBrian Somers int f; 14152c9ca19SBrian Somers 14252c9ca19SBrian Somers for (f = 0; f < sizeof qtxt / sizeof *qtxt; f++) 14352c9ca19SBrian Somers if (qtxt[f].id == qtype) 14452c9ca19SBrian Somers return qtxt[f].txt; 14552c9ca19SBrian Somers 146d6d3eeabSBrian Somers return HexStr(qtype, failure, sizeof failure); 14752c9ca19SBrian Somers } 14852c9ca19SBrian Somers 149cad7e742SBrian Somers static __inline int 150944f7098SBrian Somers PortMatch(int op, u_short pport, u_short rport) 151af57ed9fSAtsushi Murai { 152af57ed9fSAtsushi Murai switch (op) { 153af57ed9fSAtsushi Murai case OP_EQ: 1540a4b6c5cSBrian Somers return pport == rport; 155af57ed9fSAtsushi Murai case OP_GT: 1560a4b6c5cSBrian Somers return pport > rport; 157af57ed9fSAtsushi Murai case OP_LT: 1580a4b6c5cSBrian Somers return pport < rport; 159af57ed9fSAtsushi Murai default: 1600a4b6c5cSBrian Somers return 0; 161af57ed9fSAtsushi Murai } 162af57ed9fSAtsushi Murai } 163af57ed9fSAtsushi Murai 164af57ed9fSAtsushi Murai /* 165e2ccf799SDiomidis Spinellis * Return a text string representing the cproto protocol number. 166e2ccf799SDiomidis Spinellis * 167e2ccf799SDiomidis Spinellis * The purpose of this routine is calculate this result, for 168e2ccf799SDiomidis Spinellis * the many times it is needed in FilterCheck, only on demand 169e2ccf799SDiomidis Spinellis * (i.e. when the corresponding logging functions are invoked). 170e2ccf799SDiomidis Spinellis * 171e2ccf799SDiomidis Spinellis * This optimization saves, over the previous implementation, which 172e2ccf799SDiomidis Spinellis * calculated prototxt at the beginning of FilterCheck, an 173e2ccf799SDiomidis Spinellis * open/read/close system call sequence per packet, approximately 174e2ccf799SDiomidis Spinellis * halving the ppp system overhead and reducing the overall (u + s) 175e2ccf799SDiomidis Spinellis * time by 38%. 176e2ccf799SDiomidis Spinellis * 177e2ccf799SDiomidis Spinellis * The caching performed here is just a side effect. 178e2ccf799SDiomidis Spinellis */ 179e2ccf799SDiomidis Spinellis static const char * 180e2ccf799SDiomidis Spinellis prototxt(int cproto) 181e2ccf799SDiomidis Spinellis { 182e2ccf799SDiomidis Spinellis static int oproto = -1; 183e2ccf799SDiomidis Spinellis static char protobuff[16] = "-1"; 184e2ccf799SDiomidis Spinellis struct protoent *pe; 185e2ccf799SDiomidis Spinellis 186e2ccf799SDiomidis Spinellis if (cproto == oproto) 187e2ccf799SDiomidis Spinellis return protobuff; 188e2ccf799SDiomidis Spinellis if ((pe = getprotobynumber(cproto)) == NULL) 189e2ccf799SDiomidis Spinellis snprintf(protobuff, sizeof protobuff, "%d", cproto); 190e2ccf799SDiomidis Spinellis else 191e2ccf799SDiomidis Spinellis snprintf(protobuff, sizeof protobuff, "%s", pe->p_name); 192e2ccf799SDiomidis Spinellis oproto = cproto; 193e2ccf799SDiomidis Spinellis return (protobuff); 194e2ccf799SDiomidis Spinellis } 195e2ccf799SDiomidis Spinellis 196e2ccf799SDiomidis Spinellis /* 19730949fd4SBrian Somers * Check a packet against the given filter 19830949fd4SBrian Somers * Returns 0 to accept the packet, non-zero to drop the packet. 19930949fd4SBrian Somers * If psecs is not NULL, populate it with the timeout associated 20030949fd4SBrian Somers * with the filter rule matched. 201cad7e742SBrian Somers * 202cad7e742SBrian Somers * If filtering is enabled, the initial fragment of a datagram must 203cad7e742SBrian Somers * contain the complete protocol header, and subsequent fragments 204cad7e742SBrian Somers * must not attempt to over-write it. 20530949fd4SBrian Somers * 20630949fd4SBrian Somers * One (and only one) of pip or pip6 must be set. 207af57ed9fSAtsushi Murai */ 20830949fd4SBrian Somers int 20930949fd4SBrian Somers FilterCheck(const unsigned char *packet, u_int32_t family, 21030949fd4SBrian Somers const struct filter *filter, unsigned *psecs) 211af57ed9fSAtsushi Murai { 212cad7e742SBrian Somers int gotinfo; /* true if IP payload decoded */ 21330949fd4SBrian Somers int cproto; /* IPPROTO_* protocol number if (gotinfo) */ 214cad7e742SBrian Somers int estab, syn, finrst; /* TCP state flags if (gotinfo) */ 215cad7e742SBrian Somers u_short sport, dport; /* src, dest port from packet if (gotinfo) */ 216cad7e742SBrian Somers int n; /* filter rule to process */ 217cad7e742SBrian Somers int len; /* bytes used in dbuff */ 218cad7e742SBrian Somers int didname; /* true if filter header printed */ 219cad7e742SBrian Somers int match; /* true if condition matched */ 22030949fd4SBrian Somers int mindata; /* minimum data size or zero */ 221cad7e742SBrian Somers const struct filterent *fp = filter->rule; 222e2ccf799SDiomidis Spinellis char dbuff[100], dstip[16]; 22330949fd4SBrian Somers struct ncpaddr srcaddr, dstaddr; 22430949fd4SBrian Somers const char *payload; /* IP payload */ 22530949fd4SBrian Somers int datalen; /* IP datagram length */ 226af57ed9fSAtsushi Murai 227cad7e742SBrian Somers if (fp->f_action == A_NONE) 2280a4b6c5cSBrian Somers return 0; /* No rule is given. Permit this packet */ 229cad7e742SBrian Somers 23030949fd4SBrian Somers #ifndef NOINET6 23130949fd4SBrian Somers if (family == AF_INET6) { 23230949fd4SBrian Somers const struct ip6_hdr *pip6 = (const struct ip6_hdr *)packet; 23330949fd4SBrian Somers 23430949fd4SBrian Somers ncpaddr_setip6(&srcaddr, &pip6->ip6_src); 23530949fd4SBrian Somers ncpaddr_setip6(&dstaddr, &pip6->ip6_dst); 2366de54bbeSBrian Somers datalen = ntohs(pip6->ip6_plen); 2376de54bbeSBrian Somers payload = packet + sizeof *pip6; 23830949fd4SBrian Somers cproto = pip6->ip6_nxt; 23930949fd4SBrian Somers } else 24030949fd4SBrian Somers #endif 24130949fd4SBrian Somers { 2420a4b6c5cSBrian Somers /* 2430a4b6c5cSBrian Somers * Deny any packet fragment that tries to over-write the header. 244cad7e742SBrian Somers * Since we no longer have the real header available, punt on the 245cad7e742SBrian Somers * largest normal header - 20 bytes for TCP without options, rounded 246cad7e742SBrian Somers * up to the next possible fragment boundary. Since the smallest 247cad7e742SBrian Somers * `legal' MTU is 576, and the smallest recommended MTU is 296, any 2480a4b6c5cSBrian Somers * fragmentation within this range is dubious at best 2490a4b6c5cSBrian Somers */ 25030949fd4SBrian Somers const struct ip *pip = (const struct ip *)packet; 25130949fd4SBrian Somers 252cad7e742SBrian Somers len = ntohs(pip->ip_off) & IP_OFFMASK; /* fragment offset */ 253cad7e742SBrian Somers if (len > 0) { /* Not first fragment within datagram */ 25406a43ce0SBrian Somers if (len < (24 >> 3)) { /* don't allow fragment to over-write header */ 25506a43ce0SBrian Somers log_Printf(LogFILTER, " error: illegal header\n"); 2560a4b6c5cSBrian Somers return 1; 25706a43ce0SBrian Somers } 258cad7e742SBrian Somers /* permit fragments on in and out filter */ 25906a43ce0SBrian Somers if (!filter->fragok) { 26006a43ce0SBrian Somers log_Printf(LogFILTER, " error: illegal fragmentation\n"); 26106a43ce0SBrian Somers return 1; 26206a43ce0SBrian Somers } else 26306a43ce0SBrian Somers return 0; 264cad7e742SBrian Somers } 265cad7e742SBrian Somers 26630949fd4SBrian Somers ncpaddr_setip4(&srcaddr, pip->ip_src); 26730949fd4SBrian Somers ncpaddr_setip4(&dstaddr, pip->ip_dst); 26830949fd4SBrian Somers datalen = ntohs(pip->ip_len) - (pip->ip_hl << 2); 26930949fd4SBrian Somers payload = packet + (pip->ip_hl << 2); 27030949fd4SBrian Somers cproto = pip->ip_p; 27130949fd4SBrian Somers } 27230949fd4SBrian Somers 273e2ccf799SDiomidis Spinellis 27430949fd4SBrian Somers gotinfo = estab = syn = finrst = didname = 0; 275af57ed9fSAtsushi Murai sport = dport = 0; 27630949fd4SBrian Somers 277cad7e742SBrian Somers for (n = 0; n < MAXFILTERS; ) { 278cad7e742SBrian Somers if (fp->f_action == A_NONE) { 279cad7e742SBrian Somers n++; 280cad7e742SBrian Somers fp++; 281cad7e742SBrian Somers continue; 282cad7e742SBrian Somers } 2835ca5389aSBrian Somers 284cad7e742SBrian Somers if (!didname) { 285dd7e2610SBrian Somers log_Printf(LogDEBUG, "%s filter:\n", filter->name); 2868390b576SBrian Somers didname = 1; 287cad7e742SBrian Somers } 2888390b576SBrian Somers 289cad7e742SBrian Somers match = 0; 29030949fd4SBrian Somers 29130949fd4SBrian Somers if ((ncprange_family(&fp->f_src) == AF_UNSPEC || 29230949fd4SBrian Somers ncprange_contains(&fp->f_src, &srcaddr)) && 29330949fd4SBrian Somers (ncprange_family(&fp->f_dst) == AF_UNSPEC || 29430949fd4SBrian Somers ncprange_contains(&fp->f_dst, &dstaddr))) { 29530949fd4SBrian Somers if (fp->f_proto != 0) { 296af57ed9fSAtsushi Murai if (!gotinfo) { 297cad7e742SBrian Somers const struct tcphdr *th; 298cad7e742SBrian Somers const struct udphdr *uh; 299cad7e742SBrian Somers const struct icmp *ih; 30030949fd4SBrian Somers #ifndef NOINET6 30130949fd4SBrian Somers const struct icmp6_hdr *ih6; 30230949fd4SBrian Somers #endif 30330949fd4SBrian Somers mindata = 0; 30430949fd4SBrian Somers sport = dport = 0; 30563f98b41SBrian Somers estab = syn = finrst = -1; 30630949fd4SBrian Somers 30730949fd4SBrian Somers switch (cproto) { 30830949fd4SBrian Somers case IPPROTO_ICMP: 30930949fd4SBrian Somers mindata = 8; /* ICMP must be at least 8 octets */ 31030949fd4SBrian Somers ih = (const struct icmp *)payload; 31192941b90SBrian Somers sport = ih->icmp_type; 312dd7e2610SBrian Somers if (log_IsKept(LogDEBUG)) 3138390b576SBrian Somers snprintf(dbuff, sizeof dbuff, "sport = %d", sport); 314af57ed9fSAtsushi Murai break; 31530949fd4SBrian Somers 31630949fd4SBrian Somers #ifndef NOINET6 31730949fd4SBrian Somers case IPPROTO_ICMPV6: 31830949fd4SBrian Somers mindata = 8; /* ICMP must be at least 8 octets */ 31930949fd4SBrian Somers ih6 = (const struct icmp6_hdr *)payload; 32092941b90SBrian Somers sport = ih6->icmp6_type; 32130949fd4SBrian Somers if (log_IsKept(LogDEBUG)) 32230949fd4SBrian Somers snprintf(dbuff, sizeof dbuff, "sport = %d", sport); 3231f9e5fe5SBrian Somers break; 32430949fd4SBrian Somers #endif 32530949fd4SBrian Somers 32630949fd4SBrian Somers case IPPROTO_IGMP: 32730949fd4SBrian Somers mindata = 8; /* IGMP uses 8-octet messages */ 32830949fd4SBrian Somers break; 32930949fd4SBrian Somers 33028149effSBrian Somers #ifdef IPPROTO_GRE 33128149effSBrian Somers case IPPROTO_GRE: 33230949fd4SBrian Somers mindata = 2; /* GRE uses 2-octet+ messages */ 33328149effSBrian Somers break; 33428149effSBrian Somers #endif 33562e85934SBrian Somers #ifdef IPPROTO_OSPFIGP 3362faae814SBrian Somers case IPPROTO_OSPFIGP: 33730949fd4SBrian Somers mindata = 8; /* IGMP uses 8-octet messages */ 3382faae814SBrian Somers break; 33962e85934SBrian Somers #endif 34030949fd4SBrian Somers #ifndef NOINET6 34130949fd4SBrian Somers case IPPROTO_IPV6: 34230949fd4SBrian Somers mindata = 20; /* RFC2893 Section 3.5: 5 * 32bit words */ 3432231246bSBrian Somers break; 34430949fd4SBrian Somers #endif 34506a43ce0SBrian Somers 34630949fd4SBrian Somers case IPPROTO_UDP: 34730949fd4SBrian Somers mindata = 8; /* UDP header is 8 octets */ 34830949fd4SBrian Somers uh = (const struct udphdr *)payload; 349944f7098SBrian Somers sport = ntohs(uh->uh_sport); 350944f7098SBrian Somers dport = ntohs(uh->uh_dport); 351dd7e2610SBrian Somers if (log_IsKept(LogDEBUG)) 3528390b576SBrian Somers snprintf(dbuff, sizeof dbuff, "sport = %d, dport = %d", 3538390b576SBrian Somers sport, dport); 354af57ed9fSAtsushi Murai break; 35530949fd4SBrian Somers 356af57ed9fSAtsushi Murai case IPPROTO_TCP: 35730949fd4SBrian Somers th = (const struct tcphdr *)payload; 35830949fd4SBrian Somers /* 35930949fd4SBrian Somers * TCP headers are variable length. The following code 360cad7e742SBrian Somers * ensures that the TCP header length isn't de-referenced if 361cad7e742SBrian Somers * the datagram is too short 362cad7e742SBrian Somers */ 36306a43ce0SBrian Somers if (datalen < 20 || datalen < (th->th_off << 2)) { 36406a43ce0SBrian Somers log_Printf(LogFILTER, " error: TCP header incorrect\n"); 3650a4b6c5cSBrian Somers return 1; 36606a43ce0SBrian Somers } 367944f7098SBrian Somers sport = ntohs(th->th_sport); 368944f7098SBrian Somers dport = ntohs(th->th_dport); 369af57ed9fSAtsushi Murai estab = (th->th_flags & TH_ACK); 37063f98b41SBrian Somers syn = (th->th_flags & TH_SYN); 37163f98b41SBrian Somers finrst = (th->th_flags & (TH_FIN|TH_RST)); 3722b81c773SBrian Somers if (log_IsKept(LogDEBUG)) { 3732b81c773SBrian Somers if (!estab) 3748390b576SBrian Somers snprintf(dbuff, sizeof dbuff, 3758390b576SBrian Somers "flags = %02x, sport = %d, dport = %d", 376927145beSBrian Somers th->th_flags, sport, dport); 3772b81c773SBrian Somers else 3782b81c773SBrian Somers *dbuff = '\0'; 3792b81c773SBrian Somers } 380af57ed9fSAtsushi Murai break; 381af57ed9fSAtsushi Murai default: 38230949fd4SBrian Somers break; 38330949fd4SBrian Somers } 38430949fd4SBrian Somers 38530949fd4SBrian Somers if (datalen < mindata) { 38630949fd4SBrian Somers log_Printf(LogFILTER, " error: proto %s must be at least" 387e2ccf799SDiomidis Spinellis " %d octets\n", prototxt(cproto), mindata); 38830949fd4SBrian Somers return 1; 389af57ed9fSAtsushi Murai } 390cad7e742SBrian Somers 391dd7e2610SBrian Somers if (log_IsKept(LogDEBUG)) { 3928390b576SBrian Somers if (estab != -1) { 3938390b576SBrian Somers len = strlen(dbuff); 39463f98b41SBrian Somers snprintf(dbuff + len, sizeof dbuff - len, 39563f98b41SBrian Somers ", estab = %d, syn = %d, finrst = %d", 39663f98b41SBrian Somers estab, syn, finrst); 397af57ed9fSAtsushi Murai } 398e2ccf799SDiomidis Spinellis log_Printf(LogDEBUG, " Filter: proto = %s, %s\n", 399e2ccf799SDiomidis Spinellis prototxt(cproto), dbuff); 4008390b576SBrian Somers } 4018390b576SBrian Somers gotinfo = 1; 4028390b576SBrian Somers } 40330949fd4SBrian Somers 404dd7e2610SBrian Somers if (log_IsKept(LogDEBUG)) { 405cad7e742SBrian Somers if (fp->f_srcop != OP_NONE) { 4068390b576SBrian Somers snprintf(dbuff, sizeof dbuff, ", src %s %d", 407cad7e742SBrian Somers filter_Op2Nam(fp->f_srcop), fp->f_srcport); 4088390b576SBrian Somers len = strlen(dbuff); 4098390b576SBrian Somers } else 4108390b576SBrian Somers len = 0; 411cad7e742SBrian Somers if (fp->f_dstop != OP_NONE) { 4128390b576SBrian Somers snprintf(dbuff + len, sizeof dbuff - len, 413cad7e742SBrian Somers ", dst %s %d", filter_Op2Nam(fp->f_dstop), 414cad7e742SBrian Somers fp->f_dstport); 4158390b576SBrian Somers } else if (!len) 4168390b576SBrian Somers *dbuff = '\0'; 4178390b576SBrian Somers 418dd7e2610SBrian Somers log_Printf(LogDEBUG, " rule = %d: Address match, " 41930949fd4SBrian Somers "check against proto %d%s, action = %s\n", 42030949fd4SBrian Somers n, fp->f_proto, dbuff, filter_Action2Nam(fp->f_action)); 4218390b576SBrian Somers } 422927145beSBrian Somers 423cad7e742SBrian Somers if (cproto == fp->f_proto) { 424cad7e742SBrian Somers if ((fp->f_srcop == OP_NONE || 425cad7e742SBrian Somers PortMatch(fp->f_srcop, sport, fp->f_srcport)) && 426cad7e742SBrian Somers (fp->f_dstop == OP_NONE || 427cad7e742SBrian Somers PortMatch(fp->f_dstop, dport, fp->f_dstport)) && 428cad7e742SBrian Somers (fp->f_estab == 0 || estab) && 429cad7e742SBrian Somers (fp->f_syn == 0 || syn) && 430cad7e742SBrian Somers (fp->f_finrst == 0 || finrst)) { 431cad7e742SBrian Somers match = 1; 432af57ed9fSAtsushi Murai } 433af57ed9fSAtsushi Murai } 434af57ed9fSAtsushi Murai } else { 435cad7e742SBrian Somers /* Address is matched and no protocol specified. Make a decision. */ 436dd7e2610SBrian Somers log_Printf(LogDEBUG, " rule = %d: Address match, action = %s\n", n, 437cad7e742SBrian Somers filter_Action2Nam(fp->f_action)); 438cad7e742SBrian Somers match = 1; 439af57ed9fSAtsushi Murai } 4408390b576SBrian Somers } else 441dd7e2610SBrian Somers log_Printf(LogDEBUG, " rule = %d: Address mismatch\n", n); 442cad7e742SBrian Somers 443cad7e742SBrian Somers if (match != fp->f_invert) { 444cad7e742SBrian Somers /* Take specified action */ 445cad7e742SBrian Somers if (fp->f_action < A_NONE) 446cad7e742SBrian Somers fp = &filter->rule[n = fp->f_action]; 44706a43ce0SBrian Somers else { 4480a4b6c5cSBrian Somers if (fp->f_action == A_PERMIT) { 4490a4b6c5cSBrian Somers if (psecs != NULL) 4500a4b6c5cSBrian Somers *psecs = fp->timeout; 45106a43ce0SBrian Somers if (strcmp(filter->name, "DIAL") == 0) { 45206a43ce0SBrian Somers /* If dial filter then even print out accept packets */ 45306a43ce0SBrian Somers if (log_IsKept(LogFILTER)) { 45430949fd4SBrian Somers snprintf(dstip, sizeof dstip, "%s", ncpaddr_ntoa(&dstaddr)); 45506a43ce0SBrian Somers log_Printf(LogFILTER, "%sbound rule = %d accept %s " 456e2ccf799SDiomidis Spinellis "src = %s:%d dst = %s:%d\n", filter->name, n, 457e2ccf799SDiomidis Spinellis prototxt(cproto), ncpaddr_ntoa(&srcaddr), sport, 458e2ccf799SDiomidis Spinellis dstip, dport); 45906a43ce0SBrian Somers } 46006a43ce0SBrian Somers } 4610a4b6c5cSBrian Somers return 0; 46206a43ce0SBrian Somers } else { 46306a43ce0SBrian Somers if (log_IsKept(LogFILTER)) { 46430949fd4SBrian Somers snprintf(dstip, sizeof dstip, "%s", ncpaddr_ntoa(&dstaddr)); 46506a43ce0SBrian Somers log_Printf(LogFILTER, 46606a43ce0SBrian Somers "%sbound rule = %d deny %s src = %s/%d dst = %s/%d\n", 467e2ccf799SDiomidis Spinellis filter->name, n, prototxt(cproto), 46830949fd4SBrian Somers ncpaddr_ntoa(&srcaddr), sport, dstip, dport); 46906a43ce0SBrian Somers } 4700a4b6c5cSBrian Somers return 1; 47130949fd4SBrian Somers } /* Explict match. Deny this packet */ 47206a43ce0SBrian Somers } 473cad7e742SBrian Somers } else { 474cad7e742SBrian Somers n++; 475af57ed9fSAtsushi Murai fp++; 476af57ed9fSAtsushi Murai } 477af57ed9fSAtsushi Murai } 47806a43ce0SBrian Somers 47906a43ce0SBrian Somers if (log_IsKept(LogFILTER)) { 48030949fd4SBrian Somers snprintf(dstip, sizeof dstip, "%s", ncpaddr_ntoa(&dstaddr)); 48106a43ce0SBrian Somers log_Printf(LogFILTER, 48206a43ce0SBrian Somers "%sbound rule = implicit deny %s src = %s/%d dst = %s/%d\n", 483e2ccf799SDiomidis Spinellis filter->name, prototxt(cproto), ncpaddr_ntoa(&srcaddr), 484e2ccf799SDiomidis Spinellis sport, dstip, dport); 48506a43ce0SBrian Somers } 48606a43ce0SBrian Somers 48730949fd4SBrian Somers return 1; /* No rule matched, deny this packet */ 488af57ed9fSAtsushi Murai } 489af57ed9fSAtsushi Murai 49052c9ca19SBrian Somers static void 49152c9ca19SBrian Somers ip_LogDNS(const struct udphdr *uh, const char *direction) 49252c9ca19SBrian Somers { 49352c9ca19SBrian Somers struct dns_header header; 49452c9ca19SBrian Somers const u_short *pktptr; 49552c9ca19SBrian Somers const u_char *ptr; 49647fe010cSBrian Somers u_short *hptr, tmp; 49752c9ca19SBrian Somers int len; 49852c9ca19SBrian Somers 49952c9ca19SBrian Somers ptr = (const char *)uh + sizeof *uh; 50052c9ca19SBrian Somers len = ntohs(uh->uh_ulen) - sizeof *uh; 50152c9ca19SBrian Somers if (len < sizeof header + 5) /* rfc1024 */ 50252c9ca19SBrian Somers return; 50352c9ca19SBrian Somers 50452c9ca19SBrian Somers pktptr = (const u_short *)ptr; 50552c9ca19SBrian Somers hptr = (u_short *)&header; 50652c9ca19SBrian Somers ptr += sizeof header; 50752c9ca19SBrian Somers len -= sizeof header; 50852c9ca19SBrian Somers 50952c9ca19SBrian Somers while (pktptr < (const u_short *)ptr) { 51052c9ca19SBrian Somers *hptr++ = ntohs(*pktptr); /* Careful of macro side-effects ! */ 51152c9ca19SBrian Somers pktptr++; 51252c9ca19SBrian Somers } 51352c9ca19SBrian Somers 51452c9ca19SBrian Somers if (header.opcode == OPCODE_QUERY && header.qr == 0) { 51552c9ca19SBrian Somers /* rfc1035 */ 51626e6a622SBrian Somers char namewithdot[MAXHOSTNAMELEN + 1], *n; 51752c9ca19SBrian Somers const char *qtype, *qclass; 51852c9ca19SBrian Somers const u_char *end; 51952c9ca19SBrian Somers 52026e6a622SBrian Somers n = namewithdot; 52152c9ca19SBrian Somers end = ptr + len - 4; 52226e6a622SBrian Somers if (end - ptr >= sizeof namewithdot) 52326e6a622SBrian Somers end = ptr + sizeof namewithdot - 1; 52452c9ca19SBrian Somers while (ptr < end) { 52552c9ca19SBrian Somers len = *ptr++; 52652c9ca19SBrian Somers if (len > end - ptr) 52752c9ca19SBrian Somers len = end - ptr; 52826e6a622SBrian Somers if (n != namewithdot) 52952c9ca19SBrian Somers *n++ = '.'; 53052c9ca19SBrian Somers memcpy(n, ptr, len); 53152c9ca19SBrian Somers ptr += len; 53252c9ca19SBrian Somers n += len; 53352c9ca19SBrian Somers } 53452c9ca19SBrian Somers *n = '\0'; 53547fe010cSBrian Somers 53647fe010cSBrian Somers if (log_IsKept(LogDNS)) { 53747fe010cSBrian Somers memcpy(&tmp, end, sizeof tmp); 53847fe010cSBrian Somers qtype = dns_Qtype2Txt(ntohs(tmp)); 53947fe010cSBrian Somers memcpy(&tmp, end + 2, sizeof tmp); 54047fe010cSBrian Somers qclass = dns_Qclass2Txt(ntohs(tmp)); 54152c9ca19SBrian Somers 54252c9ca19SBrian Somers log_Printf(LogDNS, "%sbound query %s %s %s\n", 54326e6a622SBrian Somers direction, qclass, qtype, namewithdot); 54452c9ca19SBrian Somers } 54552c9ca19SBrian Somers } 54647fe010cSBrian Somers } 54752c9ca19SBrian Somers 548af57ed9fSAtsushi Murai /* 54930949fd4SBrian Somers * Check if the given packet matches the given filter. 55030949fd4SBrian Somers * One of pip or pip6 must be set. 551af57ed9fSAtsushi Murai */ 552af57ed9fSAtsushi Murai int 55330949fd4SBrian Somers PacketCheck(struct bundle *bundle, u_int32_t family, 55430949fd4SBrian Somers const unsigned char *packet, int nb, struct filter *filter, 55530949fd4SBrian Somers const char *prefix, unsigned *psecs) 556af57ed9fSAtsushi Murai { 55752c9ca19SBrian Somers static const char *const TcpFlags[] = { 55852c9ca19SBrian Somers "FIN", "SYN", "RST", "PSH", "ACK", "URG" 55952c9ca19SBrian Somers }; 56030949fd4SBrian Somers const struct tcphdr *th; 56130949fd4SBrian Somers const struct udphdr *uh; 56230949fd4SBrian Somers const struct icmp *icmph; 56330949fd4SBrian Somers #ifndef NOINET6 56430949fd4SBrian Somers const struct icmp6_hdr *icmp6h; 56530949fd4SBrian Somers #endif 56630949fd4SBrian Somers const unsigned char *payload; 56730949fd4SBrian Somers struct ncpaddr srcaddr, dstaddr; 56830949fd4SBrian Somers int cproto, mask, len, n, pri, logit, loglen, result; 569d93d3a9cSBrian Somers char logbuf[200]; 57030949fd4SBrian Somers int datalen, frag; 57130949fd4SBrian Somers u_char tos; 572af57ed9fSAtsushi Murai 573b565321aSBrian Somers logit = (log_IsKept(LogTCPIP) || log_IsKept(LogDNS)) && 574b565321aSBrian Somers (!filter || filter->logok); 57555a8cdeaSBrian Somers loglen = 0; 57652c9ca19SBrian Somers pri = 0; 577af57ed9fSAtsushi Murai 57830949fd4SBrian Somers #ifndef NOINET6 57930949fd4SBrian Somers if (family == AF_INET6) { 58030949fd4SBrian Somers const struct ip6_hdr *pip6 = (const struct ip6_hdr *)packet; 58130949fd4SBrian Somers 58230949fd4SBrian Somers ncpaddr_setip6(&srcaddr, &pip6->ip6_src); 58330949fd4SBrian Somers ncpaddr_setip6(&dstaddr, &pip6->ip6_dst); 58430949fd4SBrian Somers datalen = ntohs(pip6->ip6_plen); 58530949fd4SBrian Somers payload = packet + sizeof *pip6; 58630949fd4SBrian Somers cproto = pip6->ip6_nxt; 5876de54bbeSBrian Somers tos = 0; /* XXX: pip6->ip6_vfc >> 4 ? */ 58830949fd4SBrian Somers frag = 0; /* XXX: ??? */ 58930949fd4SBrian Somers } else 59030949fd4SBrian Somers #endif 59130949fd4SBrian Somers { 59230949fd4SBrian Somers const struct ip *pip = (const struct ip *)packet; 59330949fd4SBrian Somers 59430949fd4SBrian Somers ncpaddr_setip4(&srcaddr, pip->ip_src); 59530949fd4SBrian Somers ncpaddr_setip4(&dstaddr, pip->ip_dst); 59630949fd4SBrian Somers datalen = ntohs(pip->ip_len) - (pip->ip_hl << 2); 59730949fd4SBrian Somers payload = packet + (pip->ip_hl << 2); 59830949fd4SBrian Somers cproto = pip->ip_p; 59930949fd4SBrian Somers tos = pip->ip_tos; 60030949fd4SBrian Somers frag = ntohs(pip->ip_off) & IP_OFFMASK; 60130949fd4SBrian Somers } 60230949fd4SBrian Somers 60352c9ca19SBrian Somers uh = NULL; 604af57ed9fSAtsushi Murai 60555a8cdeaSBrian Somers if (logit && loglen < sizeof logbuf) { 60698251667SBrian Somers if (prefix) 60798251667SBrian Somers snprintf(logbuf + loglen, sizeof logbuf - loglen, "%s", prefix); 60898251667SBrian Somers else if (filter) 6095ca5389aSBrian Somers snprintf(logbuf + loglen, sizeof logbuf - loglen, "%s ", filter->name); 610b565321aSBrian Somers else 611b565321aSBrian Somers snprintf(logbuf + loglen, sizeof logbuf - loglen, " "); 61255a8cdeaSBrian Somers loglen += strlen(logbuf + loglen); 61355a8cdeaSBrian Somers } 614af57ed9fSAtsushi Murai 61530949fd4SBrian Somers switch (cproto) { 616af57ed9fSAtsushi Murai case IPPROTO_ICMP: 61755a8cdeaSBrian Somers if (logit && loglen < sizeof logbuf) { 61830949fd4SBrian Somers len = datalen - sizeof *icmph; 61930949fd4SBrian Somers icmph = (const struct icmp *)payload; 62055a8cdeaSBrian Somers snprintf(logbuf + loglen, sizeof logbuf - loglen, 62130949fd4SBrian Somers "ICMP: %s:%d ---> ", ncpaddr_ntoa(&srcaddr), icmph->icmp_type); 62255a8cdeaSBrian Somers loglen += strlen(logbuf + loglen); 62355a8cdeaSBrian Somers snprintf(logbuf + loglen, sizeof logbuf - loglen, 62430949fd4SBrian Somers "%s (%d/%d)", ncpaddr_ntoa(&dstaddr), len, nb); 62555a8cdeaSBrian Somers loglen += strlen(logbuf + loglen); 626af57ed9fSAtsushi Murai } 627af57ed9fSAtsushi Murai break; 628da477886SBrian Somers 62930949fd4SBrian Somers #ifndef NOINET6 63030949fd4SBrian Somers case IPPROTO_ICMPV6: 63130949fd4SBrian Somers if (logit && loglen < sizeof logbuf) { 63230949fd4SBrian Somers len = datalen - sizeof *icmp6h; 63330949fd4SBrian Somers icmp6h = (const struct icmp6_hdr *)payload; 63430949fd4SBrian Somers snprintf(logbuf + loglen, sizeof logbuf - loglen, 63530949fd4SBrian Somers "ICMP: %s:%d ---> ", ncpaddr_ntoa(&srcaddr), icmp6h->icmp6_type); 63630949fd4SBrian Somers loglen += strlen(logbuf + loglen); 63730949fd4SBrian Somers snprintf(logbuf + loglen, sizeof logbuf - loglen, 63830949fd4SBrian Somers "%s (%d/%d)", ncpaddr_ntoa(&dstaddr), len, nb); 63930949fd4SBrian Somers loglen += strlen(logbuf + loglen); 64030949fd4SBrian Somers } 64130949fd4SBrian Somers break; 64230949fd4SBrian Somers #endif 64330949fd4SBrian Somers 644af57ed9fSAtsushi Murai case IPPROTO_UDP: 64530949fd4SBrian Somers uh = (const struct udphdr *)payload; 64630949fd4SBrian Somers if (tos == IPTOS_LOWDELAY && bundle->ncp.cfg.urgent.tos) 647da477886SBrian Somers pri++; 648da477886SBrian Somers 64930949fd4SBrian Somers if (!frag && ncp_IsUrgentUdpPort(&bundle->ncp, ntohs(uh->uh_sport), 650da477886SBrian Somers ntohs(uh->uh_dport))) 651da477886SBrian Somers pri++; 652da477886SBrian Somers 653da477886SBrian Somers if (logit && loglen < sizeof logbuf) { 65430949fd4SBrian Somers len = datalen - sizeof *uh; 65555a8cdeaSBrian Somers snprintf(logbuf + loglen, sizeof logbuf - loglen, 65630949fd4SBrian Somers "UDP: %s:%d ---> ", ncpaddr_ntoa(&srcaddr), ntohs(uh->uh_sport)); 65755a8cdeaSBrian Somers loglen += strlen(logbuf + loglen); 65855a8cdeaSBrian Somers snprintf(logbuf + loglen, sizeof logbuf - loglen, 65930949fd4SBrian Somers "%s:%d (%d/%d)", ncpaddr_ntoa(&dstaddr), ntohs(uh->uh_dport), 66098251667SBrian Somers len, nb); 66155a8cdeaSBrian Somers loglen += strlen(logbuf + loglen); 662af57ed9fSAtsushi Murai } 66398251667SBrian Somers 66498251667SBrian Somers if (Enabled(bundle, OPT_FILTERDECAP) && 66530949fd4SBrian Somers payload[sizeof *uh] == HDLC_ADDR && 66630949fd4SBrian Somers payload[sizeof *uh + 1] == HDLC_UI) { 66798251667SBrian Somers u_short proto; 66898251667SBrian Somers const char *type; 66998251667SBrian Somers 67030949fd4SBrian Somers memcpy(&proto, payload + sizeof *uh + 2, sizeof proto); 67198251667SBrian Somers type = NULL; 67298251667SBrian Somers 67398251667SBrian Somers switch (ntohs(proto)) { 67498251667SBrian Somers case PROTO_IP: 67598251667SBrian Somers snprintf(logbuf + loglen, sizeof logbuf - loglen, " contains "); 67630949fd4SBrian Somers result = PacketCheck(bundle, AF_INET, payload + sizeof *uh + 4, 67730949fd4SBrian Somers nb - (payload - packet) - sizeof *uh - 4, filter, 6780a4b6c5cSBrian Somers logbuf, psecs); 67998251667SBrian Somers if (result != -2) 68098251667SBrian Somers return result; 68198251667SBrian Somers type = "IP"; 68298251667SBrian Somers break; 68398251667SBrian Somers 68498251667SBrian Somers case PROTO_VJUNCOMP: type = "compressed VJ"; break; 68598251667SBrian Somers case PROTO_VJCOMP: type = "uncompressed VJ"; break; 68698251667SBrian Somers case PROTO_MP: type = "Multi-link"; break; 68798251667SBrian Somers case PROTO_ICOMPD: type = "Individual link CCP"; break; 68898251667SBrian Somers case PROTO_COMPD: type = "CCP"; break; 68998251667SBrian Somers case PROTO_IPCP: type = "IPCP"; break; 69098251667SBrian Somers case PROTO_LCP: type = "LCP"; break; 69198251667SBrian Somers case PROTO_PAP: type = "PAP"; break; 69298251667SBrian Somers case PROTO_CBCP: type = "CBCP"; break; 69398251667SBrian Somers case PROTO_LQR: type = "LQR"; break; 69498251667SBrian Somers case PROTO_CHAP: type = "CHAP"; break; 69598251667SBrian Somers } 69698251667SBrian Somers if (type) { 69798251667SBrian Somers snprintf(logbuf + loglen, sizeof logbuf - loglen, 69898251667SBrian Somers " - %s data", type); 69998251667SBrian Somers loglen += strlen(logbuf + loglen); 70098251667SBrian Somers } 70198251667SBrian Somers } 70298251667SBrian Somers 703af57ed9fSAtsushi Murai break; 704da477886SBrian Somers 70528149effSBrian Somers #ifdef IPPROTO_GRE 70628149effSBrian Somers case IPPROTO_GRE: 70728149effSBrian Somers if (logit && loglen < sizeof logbuf) { 70828149effSBrian Somers snprintf(logbuf + loglen, sizeof logbuf - loglen, 70930949fd4SBrian Somers "GRE: %s ---> ", ncpaddr_ntoa(&srcaddr)); 71028149effSBrian Somers loglen += strlen(logbuf + loglen); 71128149effSBrian Somers snprintf(logbuf + loglen, sizeof logbuf - loglen, 71230949fd4SBrian Somers "%s (%d/%d)", ncpaddr_ntoa(&dstaddr), datalen, nb); 71328149effSBrian Somers loglen += strlen(logbuf + loglen); 71428149effSBrian Somers } 71528149effSBrian Somers break; 71628149effSBrian Somers #endif 71728149effSBrian Somers 71862e85934SBrian Somers #ifdef IPPROTO_OSPFIGP 7192faae814SBrian Somers case IPPROTO_OSPFIGP: 7202faae814SBrian Somers if (logit && loglen < sizeof logbuf) { 7212faae814SBrian Somers snprintf(logbuf + loglen, sizeof logbuf - loglen, 72230949fd4SBrian Somers "OSPF: %s ---> ", ncpaddr_ntoa(&srcaddr)); 7232faae814SBrian Somers loglen += strlen(logbuf + loglen); 7242faae814SBrian Somers snprintf(logbuf + loglen, sizeof logbuf - loglen, 72530949fd4SBrian Somers "%s (%d/%d)", ncpaddr_ntoa(&dstaddr), datalen, nb); 7262faae814SBrian Somers loglen += strlen(logbuf + loglen); 7272faae814SBrian Somers } 7282faae814SBrian Somers break; 72962e85934SBrian Somers #endif 730da477886SBrian Somers 73130949fd4SBrian Somers #ifndef NOINET6 73230949fd4SBrian Somers case IPPROTO_IPV6: 73330949fd4SBrian Somers if (logit && loglen < sizeof logbuf) { 73430949fd4SBrian Somers snprintf(logbuf + loglen, sizeof logbuf - loglen, 73530949fd4SBrian Somers "IPv6: %s ---> ", ncpaddr_ntoa(&srcaddr)); 73630949fd4SBrian Somers loglen += strlen(logbuf + loglen); 73730949fd4SBrian Somers snprintf(logbuf + loglen, sizeof logbuf - loglen, 73830949fd4SBrian Somers "%s (%d/%d)", ncpaddr_ntoa(&dstaddr), datalen, nb); 73930949fd4SBrian Somers loglen += strlen(logbuf + loglen); 74030949fd4SBrian Somers } 74130949fd4SBrian Somers 74230949fd4SBrian Somers if (Enabled(bundle, OPT_FILTERDECAP)) { 74330949fd4SBrian Somers snprintf(logbuf + loglen, sizeof logbuf - loglen, " contains "); 74430949fd4SBrian Somers result = PacketCheck(bundle, AF_INET6, payload, nb - (payload - packet), 74530949fd4SBrian Somers filter, logbuf, psecs); 74630949fd4SBrian Somers if (result != -2) 74730949fd4SBrian Somers return result; 74830949fd4SBrian Somers } 74930949fd4SBrian Somers break; 75030949fd4SBrian Somers #endif 75130949fd4SBrian Somers 752eee772ecSBrian Somers case IPPROTO_IPIP: 753eee772ecSBrian Somers if (logit && loglen < sizeof logbuf) { 754eee772ecSBrian Somers snprintf(logbuf + loglen, sizeof logbuf - loglen, 75530949fd4SBrian Somers "IPIP: %s ---> ", ncpaddr_ntoa(&srcaddr)); 756eee772ecSBrian Somers loglen += strlen(logbuf + loglen); 757eee772ecSBrian Somers snprintf(logbuf + loglen, sizeof logbuf - loglen, 75830949fd4SBrian Somers "%s", ncpaddr_ntoa(&dstaddr)); 759eee772ecSBrian Somers loglen += strlen(logbuf + loglen); 76030949fd4SBrian Somers } 761da70ad60SBrian Somers 76230949fd4SBrian Somers if (Enabled(bundle, OPT_FILTERDECAP) && 76330949fd4SBrian Somers ((const struct ip *)payload)->ip_v == 4) { 764da70ad60SBrian Somers snprintf(logbuf + loglen, sizeof logbuf - loglen, " contains "); 76530949fd4SBrian Somers result = PacketCheck(bundle, AF_INET, payload, nb - (payload - packet), 76630949fd4SBrian Somers filter, logbuf, psecs); 767da70ad60SBrian Somers if (result != -2) 768da70ad60SBrian Somers return result; 769da70ad60SBrian Somers } 770eee772ecSBrian Somers break; 771da477886SBrian Somers 7722231246bSBrian Somers case IPPROTO_ESP: 7732231246bSBrian Somers if (logit && loglen < sizeof logbuf) { 7742231246bSBrian Somers snprintf(logbuf + loglen, sizeof logbuf - loglen, 77530949fd4SBrian Somers "ESP: %s ---> ", ncpaddr_ntoa(&srcaddr)); 7762231246bSBrian Somers loglen += strlen(logbuf + loglen); 77725254215SBrian Somers snprintf(logbuf + loglen, sizeof logbuf - loglen, "%s, spi %p", 77830949fd4SBrian Somers ncpaddr_ntoa(&dstaddr), payload); 7792231246bSBrian Somers loglen += strlen(logbuf + loglen); 7802231246bSBrian Somers } 7812231246bSBrian Somers break; 7822231246bSBrian Somers 7832231246bSBrian Somers case IPPROTO_AH: 7842231246bSBrian Somers if (logit && loglen < sizeof logbuf) { 7852231246bSBrian Somers snprintf(logbuf + loglen, sizeof logbuf - loglen, 78630949fd4SBrian Somers "AH: %s ---> ", ncpaddr_ntoa(&srcaddr)); 7872231246bSBrian Somers loglen += strlen(logbuf + loglen); 78825254215SBrian Somers snprintf(logbuf + loglen, sizeof logbuf - loglen, "%s, spi %p", 78930949fd4SBrian Somers ncpaddr_ntoa(&dstaddr), payload + sizeof(u_int32_t)); 7902231246bSBrian Somers loglen += strlen(logbuf + loglen); 7912231246bSBrian Somers } 7922231246bSBrian Somers break; 7932231246bSBrian Somers 794eee772ecSBrian Somers case IPPROTO_IGMP: 795eee772ecSBrian Somers if (logit && loglen < sizeof logbuf) { 79630949fd4SBrian Somers uh = (const struct udphdr *)payload; 797eee772ecSBrian Somers snprintf(logbuf + loglen, sizeof logbuf - loglen, 79830949fd4SBrian Somers "IGMP: %s:%d ---> ", ncpaddr_ntoa(&srcaddr), 7990a4b6c5cSBrian Somers ntohs(uh->uh_sport)); 800eee772ecSBrian Somers loglen += strlen(logbuf + loglen); 801eee772ecSBrian Somers snprintf(logbuf + loglen, sizeof logbuf - loglen, 80230949fd4SBrian Somers "%s:%d", ncpaddr_ntoa(&dstaddr), ntohs(uh->uh_dport)); 803eee772ecSBrian Somers loglen += strlen(logbuf + loglen); 804eee772ecSBrian Somers } 805eee772ecSBrian Somers break; 806da477886SBrian Somers 807af57ed9fSAtsushi Murai case IPPROTO_TCP: 80830949fd4SBrian Somers th = (const struct tcphdr *)payload; 80930949fd4SBrian Somers if (tos == IPTOS_LOWDELAY && bundle->ncp.cfg.urgent.tos) 810442f8495SBrian Somers pri++; 811da477886SBrian Somers 81230949fd4SBrian Somers if (!frag && ncp_IsUrgentTcpPort(&bundle->ncp, ntohs(th->th_sport), 813442f8495SBrian Somers ntohs(th->th_dport))) 814442f8495SBrian Somers pri++; 815442f8495SBrian Somers 81655a8cdeaSBrian Somers if (logit && loglen < sizeof logbuf) { 81730949fd4SBrian Somers len = datalen - (th->th_off << 2); 81855a8cdeaSBrian Somers snprintf(logbuf + loglen, sizeof logbuf - loglen, 81930949fd4SBrian Somers "TCP: %s:%d ---> ", ncpaddr_ntoa(&srcaddr), ntohs(th->th_sport)); 82055a8cdeaSBrian Somers loglen += strlen(logbuf + loglen); 82155a8cdeaSBrian Somers snprintf(logbuf + loglen, sizeof logbuf - loglen, 82230949fd4SBrian Somers "%s:%d", ncpaddr_ntoa(&dstaddr), ntohs(th->th_dport)); 82355a8cdeaSBrian Somers loglen += strlen(logbuf + loglen); 824af57ed9fSAtsushi Murai n = 0; 825af57ed9fSAtsushi Murai for (mask = TH_FIN; mask != 0x40; mask <<= 1) { 82655a8cdeaSBrian Somers if (th->th_flags & mask) { 82755a8cdeaSBrian Somers snprintf(logbuf + loglen, sizeof logbuf - loglen, " %s", TcpFlags[n]); 82855a8cdeaSBrian Somers loglen += strlen(logbuf + loglen); 82955a8cdeaSBrian Somers } 830af57ed9fSAtsushi Murai n++; 831af57ed9fSAtsushi Murai } 83255a8cdeaSBrian Somers snprintf(logbuf + loglen, sizeof logbuf - loglen, 8333a2e4f62SBrian Somers " seq:%lx ack:%lx (%d/%d)", 8343a2e4f62SBrian Somers (u_long)ntohl(th->th_seq), (u_long)ntohl(th->th_ack), len, nb); 83555a8cdeaSBrian Somers loglen += strlen(logbuf + loglen); 836af57ed9fSAtsushi Murai if ((th->th_flags & TH_SYN) && nb > 40) { 83730949fd4SBrian Somers const u_short *sp; 838af57ed9fSAtsushi Murai 83930949fd4SBrian Somers sp = (const u_short *)(payload + 20); 84055a8cdeaSBrian Somers if (ntohs(sp[0]) == 0x0204) { 84155a8cdeaSBrian Somers snprintf(logbuf + loglen, sizeof logbuf - loglen, 84255a8cdeaSBrian Somers " MSS = %d", ntohs(sp[1])); 84355a8cdeaSBrian Somers loglen += strlen(logbuf + loglen); 84455a8cdeaSBrian Somers } 845af57ed9fSAtsushi Murai } 846af57ed9fSAtsushi Murai } 847af57ed9fSAtsushi Murai break; 84898251667SBrian Somers 84998251667SBrian Somers default: 85098251667SBrian Somers if (prefix) 85198251667SBrian Somers return -2; 85230949fd4SBrian Somers 85330949fd4SBrian Somers if (logit && loglen < sizeof logbuf) { 85430949fd4SBrian Somers snprintf(logbuf + loglen, sizeof logbuf - loglen, 85530949fd4SBrian Somers "<%d>: %s ---> ", cproto, ncpaddr_ntoa(&srcaddr)); 85630949fd4SBrian Somers loglen += strlen(logbuf + loglen); 85730949fd4SBrian Somers snprintf(logbuf + loglen, sizeof logbuf - loglen, 85830949fd4SBrian Somers "%s (%d)", ncpaddr_ntoa(&dstaddr), nb); 85930949fd4SBrian Somers loglen += strlen(logbuf + loglen); 86030949fd4SBrian Somers } 86130949fd4SBrian Somers break; 862af57ed9fSAtsushi Murai } 86376bd0c0aSDoug Rabson 86430949fd4SBrian Somers if (filter && FilterCheck(packet, family, filter, psecs)) { 865710e9c29SBrian Somers if (logit) 866dd7e2610SBrian Somers log_Printf(LogTCPIP, "%s - BLOCKED\n", logbuf); 86752c9ca19SBrian Somers result = -1; 868af57ed9fSAtsushi Murai } else { 8695ca5389aSBrian Somers /* Check Keep Alive filter */ 87052c9ca19SBrian Somers if (logit && log_IsKept(LogTCPIP)) { 8710a4b6c5cSBrian Somers unsigned alivesecs; 8720a4b6c5cSBrian Somers 8730a4b6c5cSBrian Somers alivesecs = 0; 87430949fd4SBrian Somers if (filter && 87530949fd4SBrian Somers FilterCheck(packet, family, &bundle->filter.alive, &alivesecs)) 876dd7e2610SBrian Somers log_Printf(LogTCPIP, "%s - NO KEEPALIVE\n", logbuf); 8770a4b6c5cSBrian Somers else if (psecs != NULL) { 8780a4b6c5cSBrian Somers if(*psecs == 0) 8790a4b6c5cSBrian Somers *psecs = alivesecs; 8800a4b6c5cSBrian Somers if (*psecs) { 8810a4b6c5cSBrian Somers if (*psecs != alivesecs) 8820a4b6c5cSBrian Somers log_Printf(LogTCPIP, "%s - (timeout = %d / ALIVE = %d secs)\n", 8830a4b6c5cSBrian Somers logbuf, *psecs, alivesecs); 8841e991daaSBrian Somers else 8850a4b6c5cSBrian Somers log_Printf(LogTCPIP, "%s - (timeout = %d secs)\n", logbuf, *psecs); 8860a4b6c5cSBrian Somers } else 887dd7e2610SBrian Somers log_Printf(LogTCPIP, "%s\n", logbuf); 88853c9f6c0SAtsushi Murai } 8890a4b6c5cSBrian Somers } 89052c9ca19SBrian Somers result = pri; 891af57ed9fSAtsushi Murai } 89252c9ca19SBrian Somers 893b565321aSBrian Somers if (filter && uh && ntohs(uh->uh_dport) == 53 && log_IsKept(LogDNS)) 89452c9ca19SBrian Somers ip_LogDNS(uh, filter->name); 89552c9ca19SBrian Somers 89652c9ca19SBrian Somers return result; 897af57ed9fSAtsushi Murai } 898af57ed9fSAtsushi Murai 89930949fd4SBrian Somers static int 90030949fd4SBrian Somers ip_Input(struct bundle *bundle, struct link *l, struct mbuf *bp, u_int32_t af) 9017a6f8720SBrian Somers { 902af57ed9fSAtsushi Murai int nb, nw; 903b6e82f33SBrian Somers struct tun_data tun; 9043a7b6d76SBrian Somers char *data; 9050a4b6c5cSBrian Somers unsigned secs, alivesecs; 9065d9e6103SBrian Somers 90726af0ae9SBrian Somers nb = m_length(bp); 90876d98538SBrian Somers if (nb > sizeof tun.data) { 90976d98538SBrian Somers log_Printf(LogWARN, "ip_Input: %s: Packet too large (got %d, max %d)\n", 91076d98538SBrian Somers l->name, nb, (int)(sizeof tun.data)); 91126af0ae9SBrian Somers m_freem(bp); 91230949fd4SBrian Somers return 0; 91376d98538SBrian Somers } 9145d9e6103SBrian Somers mbuf_Read(bp, tun.data, nb); 915af57ed9fSAtsushi Murai 9160a4b6c5cSBrian Somers secs = 0; 91730949fd4SBrian Somers if (PacketCheck(bundle, af, tun.data, nb, &bundle->filter.in, 91830949fd4SBrian Somers NULL, &secs) < 0) 91930949fd4SBrian Somers return 0; 9206db75539SBrian Somers 9210a4b6c5cSBrian Somers alivesecs = 0; 92230949fd4SBrian Somers if (!FilterCheck(tun.data, af, &bundle->filter.alive, &alivesecs)) { 9230a4b6c5cSBrian Somers if (secs == 0) 9240a4b6c5cSBrian Somers secs = alivesecs; 9250a4b6c5cSBrian Somers bundle_StartIdleTimer(bundle, secs); 9260a4b6c5cSBrian Somers } 9271e991daaSBrian Somers 9283a7b6d76SBrian Somers if (bundle->dev.header) { 92930949fd4SBrian Somers tun.header.family = htonl(af); 93070ee81ffSBrian Somers nb += sizeof tun - sizeof tun.data; 9313a7b6d76SBrian Somers data = (char *)&tun; 9323a7b6d76SBrian Somers } else 9333a7b6d76SBrian Somers data = tun.data; 9343a7b6d76SBrian Somers 9353a7b6d76SBrian Somers nw = write(bundle->dev.fd, data, nb); 936c4c4aaacSBrian Somers if (nw != nb) { 93757fd05c4SBrian Somers if (nw == -1) 93876d98538SBrian Somers log_Printf(LogERROR, "ip_Input: %s: wrote %d, got %s\n", 93976d98538SBrian Somers l->name, nb, strerror(errno)); 94057fd05c4SBrian Somers else 94176d98538SBrian Somers log_Printf(LogERROR, "ip_Input: %s: wrote %d, got %d\n", l->name, nb, nw); 9426db75539SBrian Somers } 9435d9e6103SBrian Somers 94430949fd4SBrian Somers return nb; 94530949fd4SBrian Somers } 94630949fd4SBrian Somers 94730949fd4SBrian Somers struct mbuf * 94830949fd4SBrian Somers ipv4_Input(struct bundle *bundle, struct link *l, struct mbuf *bp) 94930949fd4SBrian Somers { 95030949fd4SBrian Somers int nb; 95130949fd4SBrian Somers 95230949fd4SBrian Somers if (bundle->ncp.ipcp.fsm.state != ST_OPENED) { 95330949fd4SBrian Somers log_Printf(LogWARN, "ipv4_Input: IPCP not open - packet dropped\n"); 95430949fd4SBrian Somers m_freem(bp); 9555d9e6103SBrian Somers return NULL; 956af57ed9fSAtsushi Murai } 957af57ed9fSAtsushi Murai 95830949fd4SBrian Somers m_settype(bp, MB_IPIN); 95930949fd4SBrian Somers 96030949fd4SBrian Somers nb = ip_Input(bundle, l, bp, AF_INET); 96130949fd4SBrian Somers ipcp_AddInOctets(&bundle->ncp.ipcp, nb); 96230949fd4SBrian Somers 96330949fd4SBrian Somers return NULL; 96430949fd4SBrian Somers } 96530949fd4SBrian Somers 96630949fd4SBrian Somers #ifndef NOINET6 96730949fd4SBrian Somers struct mbuf * 96830949fd4SBrian Somers ipv6_Input(struct bundle *bundle, struct link *l, struct mbuf *bp) 969af57ed9fSAtsushi Murai { 97030949fd4SBrian Somers int nb; 971af57ed9fSAtsushi Murai 9721136c6acSBrian Somers if (bundle->ncp.ipv6cp.fsm.state != ST_OPENED) { 97330949fd4SBrian Somers log_Printf(LogWARN, "ipv6_Input: IPV6CP not open - packet dropped\n"); 97430949fd4SBrian Somers m_freem(bp); 97530949fd4SBrian Somers return NULL; 976af57ed9fSAtsushi Murai } 977af57ed9fSAtsushi Murai 97830949fd4SBrian Somers m_settype(bp, MB_IPV6IN); 9796f8e9f0aSBrian Somers 98030949fd4SBrian Somers nb = ip_Input(bundle, l, bp, AF_INET6); 98130949fd4SBrian Somers ipv6cp_AddInOctets(&bundle->ncp.ipv6cp, nb); 98230949fd4SBrian Somers 98330949fd4SBrian Somers return NULL; 9846f8e9f0aSBrian Somers } 98530949fd4SBrian Somers #endif 986