xref: /freebsd/usr.sbin/ppp/ip.c (revision e2ccf799f2c53f920f6801a2bbf2fda4c2b20ce7)
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