645 lines · 14.6 KB · C
RawDownload
// SPDX-License-Identifier: GPL-2.0/* * INET		An implementation of the TCP/IP protocol suite for the LINUX *		operating system.  INET is implemented using the  BSD Socket *		interface as the means of communication with the user level. * *		The options processing module for ip.c * * Authors:	A.N.Kuznetsov * */ #define pr_fmt(fmt) "IPv4: " fmt #include <linux/capability.h>#include <linux/module.h>#include <linux/slab.h>#include <linux/types.h>#include <linux/uaccess.h>#include <linux/unaligned.h>#include <linux/skbuff.h>#include <linux/ip.h>#include <linux/icmp.h>#include <linux/netdevice.h>#include <linux/rtnetlink.h>#include <net/sock.h>#include <net/ip.h>#include <net/icmp.h>#include <net/route.h>#include <net/cipso_ipv4.h>#include <net/ip_fib.h> /* * Write options to IP header, record destination address to * source route option, address of outgoing interface * (we should already know it, so that this  function is allowed be * called only after routing decision) and timestamp, * if we originate this datagram. * * daddr is real destination address, next hop is recorded in IP header. * saddr is address of outgoing interface. */ void ip_options_build(struct sk_buff *skb, struct ip_options *opt,		      __be32 daddr, struct rtable *rt){	unsigned char *iph = skb_network_header(skb); 	memcpy(&(IPCB(skb)->opt), opt, sizeof(struct ip_options));	memcpy(iph + sizeof(struct iphdr), opt->__data, opt->optlen);	opt = &(IPCB(skb)->opt); 	if (opt->srr)		memcpy(iph + opt->srr + iph[opt->srr + 1] - 4, &daddr, 4); 	if (opt->rr_needaddr)		ip_rt_get_source(iph + opt->rr + iph[opt->rr + 2] - 5, skb, rt);	if (opt->ts_needaddr)		ip_rt_get_source(iph + opt->ts + iph[opt->ts + 2] - 9, skb, rt);	if (opt->ts_needtime) {		__be32 midtime; 		midtime = inet_current_timestamp();		memcpy(iph + opt->ts + iph[opt->ts + 2] - 5, &midtime, 4);	}} /* * Provided (sopt, skb) points to received options, * build in dopt compiled option set appropriate for answering. * i.e. invert SRR option, copy anothers, * and grab room in RR/TS options. * * NOTE: dopt cannot point to skb. */ int __ip_options_echo(struct net *net, struct ip_options *dopt,		      struct sk_buff *skb, const struct ip_options *sopt){	unsigned char *sptr, *dptr;	int soffset, doffset;	int	optlen; 	memset(dopt, 0, sizeof(struct ip_options)); 	if (sopt->optlen == 0)		return 0; 	sptr = skb_network_header(skb);	dptr = dopt->__data; 	if (sopt->rr) {		optlen  = sptr[sopt->rr+1];		soffset = sptr[sopt->rr+2];		dopt->rr = dopt->optlen + sizeof(struct iphdr);		memcpy(dptr, sptr+sopt->rr, optlen);		if (sopt->rr_needaddr && soffset <= optlen) {			if (soffset + 3 > optlen)				return -EINVAL;			dptr[2] = soffset + 4;			dopt->rr_needaddr = 1;		}		dptr += optlen;		dopt->optlen += optlen;	}	if (sopt->ts) {		optlen = sptr[sopt->ts+1];		soffset = sptr[sopt->ts+2];		dopt->ts = dopt->optlen + sizeof(struct iphdr);		memcpy(dptr, sptr+sopt->ts, optlen);		if (soffset <= optlen) {			if (sopt->ts_needaddr) {				if (soffset + 3 > optlen)					return -EINVAL;				dopt->ts_needaddr = 1;				soffset += 4;			}			if (sopt->ts_needtime) {				if (soffset + 3 > optlen)					return -EINVAL;				if ((dptr[3]&0xF) != IPOPT_TS_PRESPEC) {					dopt->ts_needtime = 1;					soffset += 4;				} else {					dopt->ts_needtime = 0; 					if (soffset + 7 <= optlen) {						__be32 addr; 						memcpy(&addr, dptr+soffset-1, 4);						if (inet_addr_type(net, addr) != RTN_UNICAST) {							dopt->ts_needtime = 1;							soffset += 8;						}					}				}			}			dptr[2] = soffset;		}		dptr += optlen;		dopt->optlen += optlen;	}	if (sopt->srr) {		unsigned char *start = sptr+sopt->srr;		__be32 faddr; 		optlen  = start[1];		soffset = start[2];		doffset = 0;		if (soffset > optlen)			soffset = optlen + 1;		soffset -= 4;		if (soffset > 3) {			memcpy(&faddr, &start[soffset-1], 4);			for (soffset -= 4, doffset = 4; soffset > 3; soffset -= 4, doffset += 4)				memcpy(&dptr[doffset-1], &start[soffset-1], 4);			/*			 * RFC1812 requires to fix illegal source routes.			 */			if (memcmp(&ip_hdr(skb)->saddr,				   &start[soffset + 3], 4) == 0)				doffset -= 4;		}		if (doffset > 3) {			dopt->faddr = faddr;			dptr[0] = start[0];			dptr[1] = doffset+3;			dptr[2] = 4;			dptr += doffset+3;			dopt->srr = dopt->optlen + sizeof(struct iphdr);			dopt->optlen += doffset+3;			dopt->is_strictroute = sopt->is_strictroute;		}	}	if (sopt->cipso) {		optlen  = sptr[sopt->cipso+1];		dopt->cipso = dopt->optlen+sizeof(struct iphdr);		memcpy(dptr, sptr+sopt->cipso, optlen);		dptr += optlen;		dopt->optlen += optlen;	}	while (dopt->optlen & 3) {		*dptr++ = IPOPT_END;		dopt->optlen++;	}	return 0;} /* *	Options "fragmenting", just fill options not *	allowed in fragments with NOOPs. *	Simple and stupid 8), but the most efficient way. */ void ip_options_fragment(struct sk_buff *skb){	unsigned char *optptr = skb_network_header(skb) + sizeof(struct iphdr);	struct ip_options *opt = &(IPCB(skb)->opt);	int  l = opt->optlen;	int  optlen; 	while (l > 0) {		switch (*optptr) {		case IPOPT_END:			return;		case IPOPT_NOOP:			l--;			optptr++;			continue;		}		optlen = optptr[1];		if (optlen < 2 || optlen > l)		  return;		if (!IPOPT_COPIED(*optptr))			memset(optptr, IPOPT_NOOP, optlen);		l -= optlen;		optptr += optlen;	}	opt->ts = 0;	opt->rr = 0;	opt->rr_needaddr = 0;	opt->ts_needaddr = 0;	opt->ts_needtime = 0;} /* helper used by ip_options_compile() to call fib_compute_spec_dst() * at most one time. */static void spec_dst_fill(__be32 *spec_dst, struct sk_buff *skb){	if (*spec_dst == htonl(INADDR_ANY))		*spec_dst = fib_compute_spec_dst(skb);} /* * Verify options and fill pointers in struct options. * Caller should clear *opt, and set opt->data. * If opt == NULL, then skb->data should point to IP header. */ int __ip_options_compile(struct net *net,			 struct ip_options *opt, struct sk_buff *skb,			 __be32 *info){	__be32 spec_dst = htonl(INADDR_ANY);	unsigned char *pp_ptr = NULL;	struct rtable *rt = NULL;	unsigned char *optptr;	unsigned char *iph;	int optlen, l; 	if (skb) {		rt = skb_rtable(skb);		optptr = (unsigned char *)&(ip_hdr(skb)[1]);	} else		optptr = opt->__data;	iph = optptr - sizeof(struct iphdr); 	for (l = opt->optlen; l > 0; ) {		switch (*optptr) {		case IPOPT_END:			for (optptr++, l--; l > 0; optptr++, l--) {				if (*optptr != IPOPT_END) {					*optptr = IPOPT_END;					opt->is_changed = 1;				}			}			goto eol;		case IPOPT_NOOP:			l--;			optptr++;			continue;		}		if (unlikely(l < 2)) {			pp_ptr = optptr;			goto error;		}		optlen = optptr[1];		if (optlen < 2 || optlen > l) {			pp_ptr = optptr;			goto error;		}		switch (*optptr) {		case IPOPT_SSRR:		case IPOPT_LSRR:			if (optlen < 3) {				pp_ptr = optptr + 1;				goto error;			}			if (optptr[2] < 4) {				pp_ptr = optptr + 2;				goto error;			}			/* NB: cf RFC-1812 5.2.4.1 */			if (opt->srr) {				pp_ptr = optptr;				goto error;			}			if (!skb) {				if (optptr[2] != 4 || optlen < 7 || ((optlen-3) & 3)) {					pp_ptr = optptr + 1;					goto error;				}				memcpy(&opt->faddr, &optptr[3], 4);				if (optlen > 7)					memmove(&optptr[3], &optptr[7], optlen-7);			}			opt->is_strictroute = (optptr[0] == IPOPT_SSRR);			opt->srr = optptr - iph;			break;		case IPOPT_RR:			if (opt->rr) {				pp_ptr = optptr;				goto error;			}			if (optlen < 3) {				pp_ptr = optptr + 1;				goto error;			}			if (optptr[2] < 4) {				pp_ptr = optptr + 2;				goto error;			}			if (optptr[2] <= optlen) {				if (optptr[2]+3 > optlen) {					pp_ptr = optptr + 2;					goto error;				}				if (rt) {					spec_dst_fill(&spec_dst, skb);					memcpy(&optptr[optptr[2]-1], &spec_dst, 4);					opt->is_changed = 1;				}				optptr[2] += 4;				opt->rr_needaddr = 1;			}			opt->rr = optptr - iph;			break;		case IPOPT_TIMESTAMP:			if (opt->ts) {				pp_ptr = optptr;				goto error;			}			if (optlen < 4) {				pp_ptr = optptr + 1;				goto error;			}			if (optptr[2] < 5) {				pp_ptr = optptr + 2;				goto error;			}			if (optptr[2] <= optlen) {				unsigned char *timeptr = NULL;				if (optptr[2]+3 > optlen) {					pp_ptr = optptr + 2;					goto error;				}				switch (optptr[3]&0xF) {				case IPOPT_TS_TSONLY:					if (skb)						timeptr = &optptr[optptr[2]-1];					opt->ts_needtime = 1;					optptr[2] += 4;					break;				case IPOPT_TS_TSANDADDR:					if (optptr[2]+7 > optlen) {						pp_ptr = optptr + 2;						goto error;					}					if (rt)  {						spec_dst_fill(&spec_dst, skb);						memcpy(&optptr[optptr[2]-1], &spec_dst, 4);						timeptr = &optptr[optptr[2]+3];					}					opt->ts_needaddr = 1;					opt->ts_needtime = 1;					optptr[2] += 8;					break;				case IPOPT_TS_PRESPEC:					if (optptr[2]+7 > optlen) {						pp_ptr = optptr + 2;						goto error;					}					{						__be32 addr;						memcpy(&addr, &optptr[optptr[2]-1], 4);						if (inet_addr_type(net, addr) == RTN_UNICAST)							break;						if (skb)							timeptr = &optptr[optptr[2]+3];					}					opt->ts_needtime = 1;					optptr[2] += 8;					break;				default:					if (!skb && !ns_capable(net->user_ns, CAP_NET_RAW)) {						pp_ptr = optptr + 3;						goto error;					}					break;				}				if (timeptr) {					__be32 midtime; 					midtime = inet_current_timestamp();					memcpy(timeptr, &midtime, 4);					opt->is_changed = 1;				}			} else if ((optptr[3]&0xF) != IPOPT_TS_PRESPEC) {				unsigned int overflow = optptr[3]>>4;				if (overflow == 15) {					pp_ptr = optptr + 3;					goto error;				}				if (skb) {					optptr[3] = (optptr[3]&0xF)|((overflow+1)<<4);					opt->is_changed = 1;				}			}			opt->ts = optptr - iph;			break;		case IPOPT_RA:			if (optlen < 4) {				pp_ptr = optptr + 1;				goto error;			}			if (optptr[2] == 0 && optptr[3] == 0)				opt->router_alert = optptr - iph;			break;		case IPOPT_CIPSO:			if ((!skb && !ns_capable(net->user_ns, CAP_NET_RAW)) || opt->cipso) {				pp_ptr = optptr;				goto error;			}			opt->cipso = optptr - iph;			if (cipso_v4_validate(skb, &optptr)) {				pp_ptr = optptr;				goto error;			}			break;		case IPOPT_SEC:		case IPOPT_SID:		default:			if (!skb && !ns_capable(net->user_ns, CAP_NET_RAW)) {				pp_ptr = optptr;				goto error;			}			break;		}		l -= optlen;		optptr += optlen;	} eol:	if (!pp_ptr)		return 0; error:	if (info)		*info = htonl((pp_ptr-iph)<<24);	return -EINVAL;}EXPORT_SYMBOL(__ip_options_compile); int ip_options_compile(struct net *net,		       struct ip_options *opt, struct sk_buff *skb){	int ret;	__be32 info; 	ret = __ip_options_compile(net, opt, skb, &info);	if (ret != 0 && skb)		icmp_send(skb, ICMP_PARAMETERPROB, 0, info);	return ret;}EXPORT_SYMBOL(ip_options_compile); /* *	Undo all the changes done by ip_options_compile(). */ void ip_options_undo(struct ip_options *opt){	if (opt->srr) {		unsigned char *optptr = opt->__data + opt->srr - sizeof(struct iphdr); 		memmove(optptr + 7, optptr + 3, optptr[1] - 7);		memcpy(optptr + 3, &opt->faddr, 4);	}	if (opt->rr_needaddr) {		unsigned char *optptr = opt->__data + opt->rr - sizeof(struct iphdr); 		optptr[2] -= 4;		memset(&optptr[optptr[2] - 1], 0, 4);	}	if (opt->ts) {		unsigned char *optptr = opt->__data + opt->ts - sizeof(struct iphdr); 		if (opt->ts_needtime) {			optptr[2] -= 4;

Lines 1–500 of 645.