/*- * Copyright (c) 1996 - 2001 Brian Somers * based on work by Toshiharu OHNO * Internet Initiative Japan, Inc (IIJ) * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions * are met: * 1. Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright * notice, this list of conditions and the following disclaimer in the * documentation and/or other materials provided with the distribution. * * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF * SUCH DAMAGE. * * $FreeBSD$ */ #include #include #include #include #include #ifndef NOINET6 #include #include #endif #include #include #include #include #include #include #include #include #include #include #include "layer.h" #include "proto.h" #include "mbuf.h" #include "log.h" #include "defs.h" #include "timer.h" #include "fsm.h" #include "lqr.h" #include "hdlc.h" #include "throughput.h" #include "iplist.h" #include "slcompress.h" #include "ncpaddr.h" #include "ip.h" #include "ipcp.h" #include "filter.h" #include "descriptor.h" #include "lcp.h" #include "ccp.h" #include "link.h" #include "mp.h" #ifndef NORADIUS #include "radius.h" #endif #include "ipv6cp.h" #include "ncp.h" #include "bundle.h" #include "tun.h" #define OPCODE_QUERY 0 #define OPCODE_IQUERY 1 #define OPCODE_STATUS 2 struct dns_header { u_short id; unsigned qr : 1; unsigned opcode : 4; unsigned aa : 1; unsigned tc : 1; unsigned rd : 1; unsigned ra : 1; unsigned z : 3; unsigned rcode : 4; u_short qdcount; u_short ancount; u_short nscount; u_short arcount; }; static const char * dns_Qclass2Txt(u_short qclass) { static char failure[6]; struct { u_short id; const char *txt; } qtxt[] = { /* rfc1035 */ { 1, "IN" }, { 2, "CS" }, { 3, "CH" }, { 4, "HS" }, { 255, "*" } }; unsigned f; for (f = 0; f < sizeof qtxt / sizeof *qtxt; f++) if (qtxt[f].id == qclass) return qtxt[f].txt; return HexStr(qclass, failure, sizeof failure); } static const char * dns_Qtype2Txt(u_short qtype) { static char failure[6]; struct { u_short id; const char *txt; } qtxt[] = { /* rfc1035/rfc1700 */ { 1, "A" }, { 2, "NS" }, { 3, "MD" }, { 4, "MF" }, { 5, "CNAME" }, { 6, "SOA" }, { 7, "MB" }, { 8, "MG" }, { 9, "MR" }, { 10, "NULL" }, { 11, "WKS" }, { 12, "PTR" }, { 13, "HINFO" }, { 14, "MINFO" }, { 15, "MX" }, { 16, "TXT" }, { 17, "RP" }, { 18, "AFSDB" }, { 19, "X25" }, { 20, "ISDN" }, { 21, "RT" }, { 22, "NSAP" }, { 23, "NSAP-PTR" }, { 24, "SIG" }, { 25, "KEY" }, { 26, "PX" }, { 27, "GPOS" }, { 28, "AAAA" }, { 252, "AXFR" }, { 253, "MAILB" }, { 254, "MAILA" }, { 255, "*" } }; unsigned f; for (f = 0; f < sizeof qtxt / sizeof *qtxt; f++) if (qtxt[f].id == qtype) return qtxt[f].txt; return HexStr(qtype, failure, sizeof failure); } static __inline int PortMatch(int op, u_short pport, u_short rport) { switch (op) { case OP_EQ: return pport == rport; case OP_GT: return pport > rport; case OP_LT: return pport < rport; default: return 0; } } /* * Return a text string representing the cproto protocol number. * * The purpose of this routine is calculate this result, for * the many times it is needed in FilterCheck, only on demand * (i.e. when the corresponding logging functions are invoked). * * This optimization saves, over the previous implementation, which * calculated prototxt at the beginning of FilterCheck, an * open/read/close system call sequence per packet, approximately * halving the ppp system overhead and reducing the overall (u + s) * time by 38%. * * The caching performed here is just a side effect. */ static const char * prototxt(int cproto) { static int oproto = -1; static char protobuff[16] = "-1"; struct protoent *pe; if (cproto == oproto) return protobuff; if ((pe = getprotobynumber(cproto)) == NULL) snprintf(protobuff, sizeof protobuff, "%d", cproto); else snprintf(protobuff, sizeof protobuff, "%s", pe->p_name); oproto = cproto; return (protobuff); } /* * Check a packet against the given filter * Returns 0 to accept the packet, non-zero to drop the packet. * If psecs is not NULL, populate it with the timeout associated * with the filter rule matched. * * If filtering is enabled, the initial fragment of a datagram must * contain the complete protocol header, and subsequent fragments * must not attempt to over-write it. * * One (and only one) of pip or pip6 must be set. */ int FilterCheck(const unsigned char *packet, #ifdef NOINET6 u_int32_t family __unused, #else u_int32_t family, #endif const struct filter *filter, unsigned *psecs) { int gotinfo; /* true if IP payload decoded */ int cproto; /* IPPROTO_* protocol number if (gotinfo) */ int estab, syn, finrst; /* TCP state flags if (gotinfo) */ u_short sport, dport; /* src, dest port from packet if (gotinfo) */ int n; /* filter rule to process */ int len; /* bytes used in dbuff */ int didname; /* true if filter header printed */ int match; /* true if condition matched */ int mindata; /* minimum data size or zero */ const struct filterent *fp = filter->rule; char dbuff[100], dstip[16]; struct ncpaddr srcaddr, dstaddr; const char *payload; /* IP payload */ int datalen; /* IP datagram length */ if (fp->f_action == A_NONE) return 0; /* No rule is given. Permit this packet */ #ifndef NOINET6 if (family == AF_INET6) { const struct ip6_hdr *pip6 = (const struct ip6_hdr *)packet; ncpaddr_setip6(&srcaddr, &pip6->ip6_src); ncpaddr_setip6(&dstaddr, &pip6->ip6_dst); datalen = ntohs(pip6->ip6_plen); payload = packet + sizeof *pip6; cproto = pip6->ip6_nxt; } else #endif { /* * Deny any packet fragment that tries to over-write the header. * Since we no longer have the real header available, punt on the * largest normal header - 20 bytes for TCP without options, rounded * up to the next possible fragment boundary. Since the smallest * `legal' MTU is 576, and the smallest recommended MTU is 296, any * fragmentation within this range is dubious at best */ const struct ip *pip = (const struct ip *)packet; len = ntohs(pip->ip_off) & IP_OFFMASK; /* fragment offset */ if (len > 0) { /* Not first fragment within datagram */ if (len < (24 >> 3)) { /* don't allow fragment to over-write header */ log_Printf(LogFILTER, " error: illegal header\n"); return 1; } /* permit fragments on in and out filter */ if (!filter->fragok) { log_Printf(LogFILTER, " error: illegal fragmentation\n"); return 1; } else return 0; } ncpaddr_setip4(&srcaddr, pip->ip_src); ncpaddr_setip4(&dstaddr, pip->ip_dst); datalen = ntohs(pip->ip_len) - (pip->ip_hl << 2); payload = packet + (pip->ip_hl << 2); cproto = pip->ip_p; } gotinfo = estab = syn = finrst = didname = 0; sport = dport = 0; for (n = 0; n < MAXFILTERS; ) { if (fp->f_action == A_NONE) { n++; fp++; continue; } if (!didname) { log_Printf(LogDEBUG, "%s filter:\n", filter->name); didname = 1; } match = 0; if ((ncprange_family(&fp->f_src) == AF_UNSPEC || ncprange_contains(&fp->f_src, &srcaddr)) && (ncprange_family(&fp->f_dst) == AF_UNSPEC || ncprange_contains(&fp->f_dst, &dstaddr))) { if (fp->f_proto != 0) { if (!gotinfo) { const struct tcphdr *th; const struct udphdr *uh; const struct icmp *ih; #ifndef NOINET6 const struct icmp6_hdr *ih6; #endif mindata = 0; sport = dport = 0; estab = syn = finrst = -1; switch (cproto) { case IPPROTO_ICMP: mindata = 8; /* ICMP must be at least 8 octets */ ih = (const struct icmp *)payload; sport = ih->icmp_type; if (log_IsKept(LogDEBUG)) snprintf(dbuff, sizeof dbuff, "sport = %d", sport); break; #ifndef NOINET6 case IPPROTO_ICMPV6: mindata = 8; /* ICMP must be at least 8 octets */ ih6 = (const struct icmp6_hdr *)payload; sport = ih6->icmp6_type; if (log_IsKept(LogDEBUG)) snprintf(dbuff, sizeof dbuff, "sport = %d", sport); break; #endif case IPPROTO_IGMP: mindata = 8; /* IGMP uses 8-octet messages */ break; #ifdef IPPROTO_GRE case IPPROTO_GRE: mindata = 2; /* GRE uses 2-octet+ messages */ break; #endif #ifdef IPPROTO_OSPFIGP case IPPROTO_OSPFIGP: mindata = 8; /* IGMP uses 8-octet messages */ break; #endif #ifndef NOINET6 case IPPROTO_IPV6: mindata = 20; /* RFC2893 Section 3.5: 5 * 32bit words */ break; #endif case IPPROTO_UDP: mindata = 8; /* UDP header is 8 octets */ uh = (const struct udphdr *)payload; sport = ntohs(uh->uh_sport); dport = ntohs(uh->uh_dport); if (log_IsKept(LogDEBUG)) snprintf(dbuff, sizeof dbuff, "sport = %d, dport = %d", sport, dport); break; case IPPROTO_TCP: th = (const struct tcphdr *)payload; /* * TCP headers are variable length. The following code * ensures that the TCP header length isn't de-referenced if * the datagram is too short */ if (datalen < 20 || datalen < (th->th_off << 2)) { log_Printf(LogFILTER, " error: TCP header incorrect\n"); return 1; } sport = ntohs(th->th_sport); dport = ntohs(th->th_dport); estab = (th->th_flags & TH_ACK); syn = (th->th_flags & TH_SYN); finrst = (th->th_flags & (TH_FIN|TH_RST)); if (log_IsKept(LogDEBUG)) { if (!estab) snprintf(dbuff, sizeof dbuff, "flags = %02x, sport = %d, dport = %d", th->th_flags, sport, dport); else *dbuff = '\0'; } break; default: break; } if (datalen < mindata) { log_Printf(LogFILTER, " error: proto %s must be at least" " %d octets\n", prototxt(cproto), mindata); return 1; } if (log_IsKept(LogDEBUG)) { if (estab != -1) { len = strlen(dbuff); snprintf(dbuff + len, sizeof dbuff - len, ", estab = %d, syn = %d, finrst = %d", estab, syn, finrst); } log_Printf(LogDEBUG, " Filter: proto = %s, %s\n", prototxt(cproto), dbuff); } gotinfo = 1; } if (log_IsKept(LogDEBUG)) { if (fp->f_srcop != OP_NONE) { snprintf(dbuff, sizeof dbuff, ", src %s %d", filter_Op2Nam(fp->f_srcop), fp->f_srcport); len = strlen(dbuff); } else len = 0; if (fp->f_dstop != OP_NONE) { snprintf(dbuff + len, sizeof dbuff - len, ", dst %s %d", filter_Op2Nam(fp->f_dstop), fp->f_dstport); } else if (!len) *dbuff = '\0'; log_Printf(LogDEBUG, " rule = %d: Address match, " "check against proto %d%s, action = %s\n", n, fp->f_proto, dbuff, filter_Action2Nam(fp->f_action)); } if (cproto == fp->f_proto) { if ((fp->f_srcop == OP_NONE || PortMatch(fp->f_srcop, sport, fp->f_srcport)) && (fp->f_dstop == OP_NONE || PortMatch(fp->f_dstop, dport, fp->f_dstport)) && (fp->f_estab == 0 || estab) && (fp->f_syn == 0 || syn) && (fp->f_finrst == 0 || finrst)) { match = 1; } } } else { /* Address is matched and no protocol specified. Make a decision. */ log_Printf(LogDEBUG, " rule = %d: Address match, action = %s\n", n, filter_Action2Nam(fp->f_action)); match = 1; } } else log_Printf(LogDEBUG, " rule = %d: Address mismatch\n", n); if (match != fp->f_invert) { /* Take specified action */ if (fp->f_action < A_NONE) fp = &filter->rule[n = fp->f_action]; else { if (fp->f_action == A_PERMIT) { if (psecs != NULL) *psecs = fp->timeout; if (strcmp(filter->name, "DIAL") == 0) { /* If dial filter then even print out accept packets */ if (log_IsKept(LogFILTER)) { snprintf(dstip, sizeof dstip, "%s", ncpaddr_ntoa(&dstaddr)); log_Printf(LogFILTER, "%sbound rule = %d accept %s " "src = %s:%d dst = %s:%d\n", filter->name, n, prototxt(cproto), ncpaddr_ntoa(&srcaddr), sport, dstip, dport); } } return 0; } else { if (log_IsKept(LogFILTER)) { snprintf(dstip, sizeof dstip, "%s", ncpaddr_ntoa(&dstaddr)); log_Printf(LogFILTER, "%sbound rule = %d deny %s src = %s/%d dst = %s/%d\n", filter->name, n, prototxt(cproto), ncpaddr_ntoa(&srcaddr), sport, dstip, dport); } return 1; } /* Explict match. Deny this packet */ } } else { n++; fp++; } } if (log_IsKept(LogFILTER)) { snprintf(dstip, sizeof dstip, "%s", ncpaddr_ntoa(&dstaddr)); log_Printf(LogFILTER, "%sbound rule = implicit deny %s src = %s/%d dst = %s/%d\n", filter->name, prototxt(cproto), ncpaddr_ntoa(&srcaddr), sport, dstip, dport); } return 1; /* No rule matched, deny this packet */ } static void ip_LogDNS(const struct udphdr *uh, const char *direction) { struct dns_header header; const u_short *pktptr; const u_char *ptr; u_short *hptr, tmp; unsigned len; ptr = (const char *)uh + sizeof *uh; len = ntohs(uh->uh_ulen) - sizeof *uh; if (len < sizeof header + 5) /* rfc1024 */ return; pktptr = (const u_short *)ptr; hptr = (u_short *)&header; ptr += sizeof header; len -= sizeof header; while (pktptr < (const u_short *)ptr) { *hptr++ = ntohs(*pktptr); /* Careful of macro side-effects ! */ pktptr++; } if (header.opcode == OPCODE_QUERY && header.qr == 0) { /* rfc1035 */ char namewithdot[MAXHOSTNAMELEN + 1], *n; const char *qtype, *qclass; const u_char *end; n = namewithdot; end = ptr + len - 4; if (end - ptr >= (int)sizeof namewithdot) end = ptr + sizeof namewithdot - 1; while (ptr < end) { len = *ptr++; if ((int)len > end - ptr) len = end - ptr; if (n != namewithdot) *n++ = '.'; memcpy(n, ptr, len); ptr += len; n += len; } *n = '\0'; if (log_IsKept(LogDNS)) { memcpy(&tmp, end, sizeof tmp); qtype = dns_Qtype2Txt(ntohs(tmp)); memcpy(&tmp, end + 2, sizeof tmp); qclass = dns_Qclass2Txt(ntohs(tmp)); log_Printf(LogDNS, "%sbound query %s %s %s\n", direction, qclass, qtype, namewithdot); } } } /* * Check if the given packet matches the given filter. * One of pip or pip6 must be set. */ int PacketCheck(struct bundle *bundle, u_int32_t family, const unsigned char *packet, int nb, struct filter *filter, const char *prefix, unsigned *psecs) { char logbuf[200]; static const char *const TcpFlags[] = { "FIN", "SYN", "RST", "PSH", "ACK", "URG" }; const struct tcphdr *th; const struct udphdr *uh; const struct icmp *icmph; #ifndef NOINET6 const struct icmp6_hdr *icmp6h; #endif const unsigned char *payload; struct ncpaddr srcaddr, dstaddr; int cproto, mask, len, n, pri, logit, result, datalen, frag; unsigned loglen; u_char tos; logit = (log_IsKept(LogTCPIP) || log_IsKept(LogDNS)) && (!filter || filter->logok); loglen = 0; pri = 0; #ifndef NOINET6 if (family == AF_INET6) { const struct ip6_hdr *pip6 = (const struct ip6_hdr *)packet; ncpaddr_setip6(&srcaddr, &pip6->ip6_src); ncpaddr_setip6(&dstaddr, &pip6->ip6_dst); datalen = ntohs(pip6->ip6_plen); payload = packet + sizeof *pip6; cproto = pip6->ip6_nxt; tos = 0; /* XXX: pip6->ip6_vfc >> 4 ? */ frag = 0; /* XXX: ??? */ } else #endif { const struct ip *pip = (const struct ip *)packet; ncpaddr_setip4(&srcaddr, pip->ip_src); ncpaddr_setip4(&dstaddr, pip->ip_dst); datalen = ntohs(pip->ip_len) - (pip->ip_hl << 2); payload = packet + (pip->ip_hl << 2); cproto = pip->ip_p; tos = pip->ip_tos; frag = ntohs(pip->ip_off) & IP_OFFMASK; } uh = NULL; if (logit && loglen < sizeof logbuf) { if (prefix) snprintf(logbuf + loglen, sizeof logbuf - loglen, "%s", prefix); else if (filter) snprintf(logbuf + loglen, sizeof logbuf - loglen, "%s ", filter->name); else snprintf(logbuf + loglen, sizeof logbuf - loglen, " "); loglen += strlen(logbuf + loglen); } switch (cproto) { case IPPROTO_ICMP: if (logit && loglen < sizeof logbuf) { len = datalen - sizeof *icmph; icmph = (const struct icmp *)payload; snprintf(logbuf + loglen, sizeof logbuf - loglen, "ICMP: %s:%d ---> ", ncpaddr_ntoa(&srcaddr), icmph->icmp_type); loglen += strlen(logbuf + loglen); snprintf(logbuf + loglen, sizeof logbuf - loglen, "%s (%d/%d)", ncpaddr_ntoa(&dstaddr), len, nb); loglen += strlen(logbuf + loglen); } break; #ifndef NOINET6 case IPPROTO_ICMPV6: if (logit && loglen < sizeof logbuf) { len = datalen - sizeof *icmp6h; icmp6h = (const struct icmp6_hdr *)payload; snprintf(logbuf + loglen, sizeof logbuf - loglen, "ICMP: %s:%d ---> ", ncpaddr_ntoa(&srcaddr), icmp6h->icmp6_type); loglen += strlen(logbuf + loglen); snprintf(logbuf + loglen, sizeof logbuf - loglen, "%s (%d/%d)", ncpaddr_ntoa(&dstaddr), len, nb); loglen += strlen(logbuf + loglen); } break; #endif case IPPROTO_UDP: uh = (const struct udphdr *)payload; if (tos == IPTOS_LOWDELAY && bundle->ncp.cfg.urgent.tos) pri++; if (!frag && ncp_IsUrgentUdpPort(&bundle->ncp, ntohs(uh->uh_sport), ntohs(uh->uh_dport))) pri++; if (logit && loglen < sizeof logbuf) { len = datalen - sizeof *uh; snprintf(logbuf + loglen, sizeof logbuf - loglen, "UDP: %s:%d ---> ", ncpaddr_ntoa(&srcaddr), ntohs(uh->uh_sport)); loglen += strlen(logbuf + loglen); snprintf(logbuf + loglen, sizeof logbuf - loglen, "%s:%d (%d/%d)", ncpaddr_ntoa(&dstaddr), ntohs(uh->uh_dport), len, nb); loglen += strlen(logbuf + loglen); } if (Enabled(bundle, OPT_FILTERDECAP) && payload[sizeof *uh] == HDLC_ADDR && payload[sizeof *uh + 1] == HDLC_UI) { u_short proto; const char *type; memcpy(&proto, payload + sizeof *uh + 2, sizeof proto); type = NULL; switch (ntohs(proto)) { case PROTO_IP: snprintf(logbuf + loglen, sizeof logbuf - loglen, " contains "); result = PacketCheck(bundle, AF_INET, payload + sizeof *uh + 4, nb - (payload - packet) - sizeof *uh - 4, filter, logbuf, psecs); if (result != -2) return result; type = "IP"; break; case PROTO_VJUNCOMP: type = "compressed VJ"; break; case PROTO_VJCOMP: type = "uncompressed VJ"; break; case PROTO_MP: type = "Multi-link"; break; case PROTO_ICOMPD: type = "Individual link CCP"; break; case PROTO_COMPD: type = "CCP"; break; case PROTO_IPCP: type = "IPCP"; break; case PROTO_LCP: type = "LCP"; break; case PROTO_PAP: type = "PAP"; break; case PROTO_CBCP: type = "CBCP"; break; case PROTO_LQR: type = "LQR"; break; case PROTO_CHAP: type = "CHAP"; break; } if (type) { snprintf(logbuf + loglen, sizeof logbuf - loglen, " - %s data", type); loglen += strlen(logbuf + loglen); } } break; #ifdef IPPROTO_GRE case IPPROTO_GRE: if (logit && loglen < sizeof logbuf) { snprintf(logbuf + loglen, sizeof logbuf - loglen, "GRE: %s ---> ", ncpaddr_ntoa(&srcaddr)); loglen += strlen(logbuf + loglen); snprintf(logbuf + loglen, sizeof logbuf - loglen, "%s (%d/%d)", ncpaddr_ntoa(&dstaddr), datalen, nb); loglen += strlen(logbuf + loglen); } break; #endif #ifdef IPPROTO_OSPFIGP case IPPROTO_OSPFIGP: if (logit && loglen < sizeof logbuf) { snprintf(logbuf + loglen, sizeof logbuf - loglen, "OSPF: %s ---> ", ncpaddr_ntoa(&srcaddr)); loglen += strlen(logbuf + loglen); snprintf(logbuf + loglen, sizeof logbuf - loglen, "%s (%d/%d)", ncpaddr_ntoa(&dstaddr), datalen, nb); loglen += strlen(logbuf + loglen); } break; #endif #ifndef NOINET6 case IPPROTO_IPV6: if (logit && loglen < sizeof logbuf) { snprintf(logbuf + loglen, sizeof logbuf - loglen, "IPv6: %s ---> ", ncpaddr_ntoa(&srcaddr)); loglen += strlen(logbuf + loglen); snprintf(logbuf + loglen, sizeof logbuf - loglen, "%s (%d/%d)", ncpaddr_ntoa(&dstaddr), datalen, nb); loglen += strlen(logbuf + loglen); } if (Enabled(bundle, OPT_FILTERDECAP)) { snprintf(logbuf + loglen, sizeof logbuf - loglen, " contains "); result = PacketCheck(bundle, AF_INET6, payload, nb - (payload - packet), filter, logbuf, psecs); if (result != -2) return result; } break; #endif case IPPROTO_IPIP: if (logit && loglen < sizeof logbuf) { snprintf(logbuf + loglen, sizeof logbuf - loglen, "IPIP: %s ---> ", ncpaddr_ntoa(&srcaddr)); loglen += strlen(logbuf + loglen); snprintf(logbuf + loglen, sizeof logbuf - loglen, "%s", ncpaddr_ntoa(&dstaddr)); loglen += strlen(logbuf + loglen); } if (Enabled(bundle, OPT_FILTERDECAP) && ((const struct ip *)payload)->ip_v == 4) { snprintf(logbuf + loglen, sizeof logbuf - loglen, " contains "); result = PacketCheck(bundle, AF_INET, payload, nb - (payload - packet), filter, logbuf, psecs); loglen += strlen(logbuf + loglen); if (result != -2) return result; } break; case IPPROTO_ESP: if (logit && loglen < sizeof logbuf) { snprintf(logbuf + loglen, sizeof logbuf - loglen, "ESP: %s ---> ", ncpaddr_ntoa(&srcaddr)); loglen += strlen(logbuf + loglen); snprintf(logbuf + loglen, sizeof logbuf - loglen, "%s, spi %p", ncpaddr_ntoa(&dstaddr), payload); loglen += strlen(logbuf + loglen); } break; case IPPROTO_AH: if (logit && loglen < sizeof logbuf) { snprintf(logbuf + loglen, sizeof logbuf - loglen, "AH: %s ---> ", ncpaddr_ntoa(&srcaddr)); loglen += strlen(logbuf + loglen); snprintf(logbuf + loglen, sizeof logbuf - loglen, "%s, spi %p", ncpaddr_ntoa(&dstaddr), payload + sizeof(u_int32_t)); loglen += strlen(logbuf + loglen); } break; case IPPROTO_IGMP: if (logit && loglen < sizeof logbuf) { uh = (const struct udphdr *)payload; snprintf(logbuf + loglen, sizeof logbuf - loglen, "IGMP: %s:%d ---> ", ncpaddr_ntoa(&srcaddr), ntohs(uh->uh_sport)); loglen += strlen(logbuf + loglen); snprintf(logbuf + loglen, sizeof logbuf - loglen, "%s:%d", ncpaddr_ntoa(&dstaddr), ntohs(uh->uh_dport)); loglen += strlen(logbuf + loglen); } break; case IPPROTO_TCP: th = (const struct tcphdr *)payload; if (tos == IPTOS_LOWDELAY && bundle->ncp.cfg.urgent.tos) pri++; if (!frag && ncp_IsUrgentTcpPort(&bundle->ncp, ntohs(th->th_sport), ntohs(th->th_dport))) pri++; if (logit && loglen < sizeof logbuf) { len = datalen - (th->th_off << 2); snprintf(logbuf + loglen, sizeof logbuf - loglen, "TCP: %s:%d ---> ", ncpaddr_ntoa(&srcaddr), ntohs(th->th_sport)); loglen += strlen(logbuf + loglen); snprintf(logbuf + loglen, sizeof logbuf - loglen, "%s:%d", ncpaddr_ntoa(&dstaddr), ntohs(th->th_dport)); loglen += strlen(logbuf + loglen); n = 0; for (mask = TH_FIN; mask != 0x40; mask <<= 1) { if (th->th_flags & mask) { snprintf(logbuf + loglen, sizeof logbuf - loglen, " %s", TcpFlags[n]); loglen += strlen(logbuf + loglen); } n++; } snprintf(logbuf + loglen, sizeof logbuf - loglen, " seq:%lx ack:%lx (%d/%d)", (u_long)ntohl(th->th_seq), (u_long)ntohl(th->th_ack), len, nb); loglen += strlen(logbuf + loglen); if ((th->th_flags & TH_SYN) && nb > 40) { const u_short *sp; sp = (const u_short *)(payload + 20); if (ntohs(sp[0]) == 0x0204) { snprintf(logbuf + loglen, sizeof logbuf - loglen, " MSS = %d", ntohs(sp[1])); loglen += strlen(logbuf + loglen); } } } break; default: if (prefix) return -2; if (logit && loglen < sizeof logbuf) { snprintf(logbuf + loglen, sizeof logbuf - loglen, "<%d>: %s ---> ", cproto, ncpaddr_ntoa(&srcaddr)); loglen += strlen(logbuf + loglen); snprintf(logbuf + loglen, sizeof logbuf - loglen, "%s (%d)", ncpaddr_ntoa(&dstaddr), nb); loglen += strlen(logbuf + loglen); } break; } if (filter && FilterCheck(packet, family, filter, psecs)) { if (logit) log_Printf(LogTCPIP, "%s - BLOCKED\n", logbuf); result = -1; } else { /* Check Keep Alive filter */ if (logit && log_IsKept(LogTCPIP)) { unsigned alivesecs; alivesecs = 0; if (filter && FilterCheck(packet, family, &bundle->filter.alive, &alivesecs)) log_Printf(LogTCPIP, "%s - NO KEEPALIVE\n", logbuf); else if (psecs != NULL) { if(*psecs == 0) *psecs = alivesecs; if (*psecs) { if (*psecs != alivesecs) log_Printf(LogTCPIP, "%s - (timeout = %d / ALIVE = %d secs)\n", logbuf, *psecs, alivesecs); else log_Printf(LogTCPIP, "%s - (timeout = %d secs)\n", logbuf, *psecs); } else log_Printf(LogTCPIP, "%s\n", logbuf); } } result = pri; } if (filter && uh && ntohs(uh->uh_dport) == 53 && log_IsKept(LogDNS)) ip_LogDNS(uh, filter->name); return result; } static size_t ip_Input(struct bundle *bundle, struct link *l, struct mbuf *bp, u_int32_t af) { ssize_t nw; size_t nb; struct tun_data tun; char *data; unsigned secs, alivesecs; nb = m_length(bp); if (nb > sizeof tun.data) { log_Printf(LogWARN, "ip_Input: %s: Packet too large (got %zd, max %d)\n", l->name, nb, (int)(sizeof tun.data)); m_freem(bp); return 0; } mbuf_Read(bp, tun.data, nb); secs = 0; if (PacketCheck(bundle, af, tun.data, nb, &bundle->filter.in, NULL, &secs) < 0) return 0; alivesecs = 0; if (!FilterCheck(tun.data, af, &bundle->filter.alive, &alivesecs)) { if (secs == 0) secs = alivesecs; bundle_StartIdleTimer(bundle, secs); } if (bundle->dev.header) { tun.header.family = htonl(af); nb += sizeof tun - sizeof tun.data; data = (char *)&tun; } else data = tun.data; nw = write(bundle->dev.fd, data, nb); if (nw != (ssize_t)nb) { if (nw == -1) log_Printf(LogERROR, "ip_Input: %s: wrote %zd, got %s\n", l->name, nb, strerror(errno)); else log_Printf(LogERROR, "ip_Input: %s: wrote %zd, got %zd\n", l->name, nb, nw); } return nb; } struct mbuf * ipv4_Input(struct bundle *bundle, struct link *l, struct mbuf *bp) { int nb; if (bundle->ncp.ipcp.fsm.state != ST_OPENED) { log_Printf(LogWARN, "ipv4_Input: IPCP not open - packet dropped\n"); m_freem(bp); return NULL; } m_settype(bp, MB_IPIN); nb = ip_Input(bundle, l, bp, AF_INET); ipcp_AddInOctets(&bundle->ncp.ipcp, nb); return NULL; } #ifndef NOINET6 struct mbuf * ipv6_Input(struct bundle *bundle, struct link *l, struct mbuf *bp) { int nb; if (bundle->ncp.ipv6cp.fsm.state != ST_OPENED) { log_Printf(LogWARN, "ipv6_Input: IPV6CP not open - packet dropped\n"); m_freem(bp); return NULL; } m_settype(bp, MB_IPV6IN); nb = ip_Input(bundle, l, bp, AF_INET6); ipv6cp_AddInOctets(&bundle->ncp.ipv6cp, nb); return NULL; } #endif