forked from luck/tmp_suning_uos_patched
b6332e6cf9
Signed-off-by: Andrew Morton <akpm@osdl.org> Signed-off-by: David S. Miller <davem@davemloft.net>
2182 lines
54 KiB
C
2182 lines
54 KiB
C
/*
|
|
* TCP over IPv6
|
|
* Linux INET6 implementation
|
|
*
|
|
* Authors:
|
|
* Pedro Roque <roque@di.fc.ul.pt>
|
|
*
|
|
* $Id: tcp_ipv6.c,v 1.144 2002/02/01 22:01:04 davem Exp $
|
|
*
|
|
* Based on:
|
|
* linux/net/ipv4/tcp.c
|
|
* linux/net/ipv4/tcp_input.c
|
|
* linux/net/ipv4/tcp_output.c
|
|
*
|
|
* Fixes:
|
|
* Hideaki YOSHIFUJI : sin6_scope_id support
|
|
* YOSHIFUJI Hideaki @USAGI and: Support IPV6_V6ONLY socket option, which
|
|
* Alexey Kuznetsov allow both IPv4 and IPv6 sockets to bind
|
|
* a single port at the same time.
|
|
* YOSHIFUJI Hideaki @USAGI: convert /proc/net/tcp6 to seq_file.
|
|
*
|
|
* This program is free software; you can redistribute it and/or
|
|
* modify it under the terms of the GNU General Public License
|
|
* as published by the Free Software Foundation; either version
|
|
* 2 of the License, or (at your option) any later version.
|
|
*/
|
|
|
|
#include <linux/module.h>
|
|
#include <linux/errno.h>
|
|
#include <linux/types.h>
|
|
#include <linux/socket.h>
|
|
#include <linux/sockios.h>
|
|
#include <linux/net.h>
|
|
#include <linux/jiffies.h>
|
|
#include <linux/in.h>
|
|
#include <linux/in6.h>
|
|
#include <linux/netdevice.h>
|
|
#include <linux/init.h>
|
|
#include <linux/jhash.h>
|
|
#include <linux/ipsec.h>
|
|
#include <linux/times.h>
|
|
|
|
#include <linux/ipv6.h>
|
|
#include <linux/icmpv6.h>
|
|
#include <linux/random.h>
|
|
|
|
#include <net/tcp.h>
|
|
#include <net/ndisc.h>
|
|
#include <net/inet6_hashtables.h>
|
|
#include <net/inet6_connection_sock.h>
|
|
#include <net/ipv6.h>
|
|
#include <net/transp_v6.h>
|
|
#include <net/addrconf.h>
|
|
#include <net/ip6_route.h>
|
|
#include <net/ip6_checksum.h>
|
|
#include <net/inet_ecn.h>
|
|
#include <net/protocol.h>
|
|
#include <net/xfrm.h>
|
|
#include <net/addrconf.h>
|
|
#include <net/snmp.h>
|
|
#include <net/dsfield.h>
|
|
#include <net/timewait_sock.h>
|
|
|
|
#include <asm/uaccess.h>
|
|
|
|
#include <linux/proc_fs.h>
|
|
#include <linux/seq_file.h>
|
|
|
|
#include <linux/crypto.h>
|
|
#include <linux/scatterlist.h>
|
|
|
|
/* Socket used for sending RSTs and ACKs */
|
|
static struct socket *tcp6_socket;
|
|
|
|
static void tcp_v6_send_reset(struct sock *sk, struct sk_buff *skb);
|
|
static void tcp_v6_reqsk_send_ack(struct sk_buff *skb, struct request_sock *req);
|
|
static void tcp_v6_send_check(struct sock *sk, int len,
|
|
struct sk_buff *skb);
|
|
|
|
static int tcp_v6_do_rcv(struct sock *sk, struct sk_buff *skb);
|
|
|
|
static struct inet_connection_sock_af_ops ipv6_mapped;
|
|
static struct inet_connection_sock_af_ops ipv6_specific;
|
|
#ifdef CONFIG_TCP_MD5SIG
|
|
static struct tcp_sock_af_ops tcp_sock_ipv6_specific;
|
|
static struct tcp_sock_af_ops tcp_sock_ipv6_mapped_specific;
|
|
#endif
|
|
|
|
static int tcp_v6_get_port(struct sock *sk, unsigned short snum)
|
|
{
|
|
return inet_csk_get_port(&tcp_hashinfo, sk, snum,
|
|
inet6_csk_bind_conflict);
|
|
}
|
|
|
|
static void tcp_v6_hash(struct sock *sk)
|
|
{
|
|
if (sk->sk_state != TCP_CLOSE) {
|
|
if (inet_csk(sk)->icsk_af_ops == &ipv6_mapped) {
|
|
tcp_prot.hash(sk);
|
|
return;
|
|
}
|
|
local_bh_disable();
|
|
__inet6_hash(&tcp_hashinfo, sk);
|
|
local_bh_enable();
|
|
}
|
|
}
|
|
|
|
static __inline__ __sum16 tcp_v6_check(struct tcphdr *th, int len,
|
|
struct in6_addr *saddr,
|
|
struct in6_addr *daddr,
|
|
__wsum base)
|
|
{
|
|
return csum_ipv6_magic(saddr, daddr, len, IPPROTO_TCP, base);
|
|
}
|
|
|
|
static __u32 tcp_v6_init_sequence(struct sk_buff *skb)
|
|
{
|
|
return secure_tcpv6_sequence_number(skb->nh.ipv6h->daddr.s6_addr32,
|
|
skb->nh.ipv6h->saddr.s6_addr32,
|
|
skb->h.th->dest,
|
|
skb->h.th->source);
|
|
}
|
|
|
|
static int tcp_v6_connect(struct sock *sk, struct sockaddr *uaddr,
|
|
int addr_len)
|
|
{
|
|
struct sockaddr_in6 *usin = (struct sockaddr_in6 *) uaddr;
|
|
struct inet_sock *inet = inet_sk(sk);
|
|
struct inet_connection_sock *icsk = inet_csk(sk);
|
|
struct ipv6_pinfo *np = inet6_sk(sk);
|
|
struct tcp_sock *tp = tcp_sk(sk);
|
|
struct in6_addr *saddr = NULL, *final_p = NULL, final;
|
|
struct flowi fl;
|
|
struct dst_entry *dst;
|
|
int addr_type;
|
|
int err;
|
|
|
|
if (addr_len < SIN6_LEN_RFC2133)
|
|
return -EINVAL;
|
|
|
|
if (usin->sin6_family != AF_INET6)
|
|
return(-EAFNOSUPPORT);
|
|
|
|
memset(&fl, 0, sizeof(fl));
|
|
|
|
if (np->sndflow) {
|
|
fl.fl6_flowlabel = usin->sin6_flowinfo&IPV6_FLOWINFO_MASK;
|
|
IP6_ECN_flow_init(fl.fl6_flowlabel);
|
|
if (fl.fl6_flowlabel&IPV6_FLOWLABEL_MASK) {
|
|
struct ip6_flowlabel *flowlabel;
|
|
flowlabel = fl6_sock_lookup(sk, fl.fl6_flowlabel);
|
|
if (flowlabel == NULL)
|
|
return -EINVAL;
|
|
ipv6_addr_copy(&usin->sin6_addr, &flowlabel->dst);
|
|
fl6_sock_release(flowlabel);
|
|
}
|
|
}
|
|
|
|
/*
|
|
* connect() to INADDR_ANY means loopback (BSD'ism).
|
|
*/
|
|
|
|
if(ipv6_addr_any(&usin->sin6_addr))
|
|
usin->sin6_addr.s6_addr[15] = 0x1;
|
|
|
|
addr_type = ipv6_addr_type(&usin->sin6_addr);
|
|
|
|
if(addr_type & IPV6_ADDR_MULTICAST)
|
|
return -ENETUNREACH;
|
|
|
|
if (addr_type&IPV6_ADDR_LINKLOCAL) {
|
|
if (addr_len >= sizeof(struct sockaddr_in6) &&
|
|
usin->sin6_scope_id) {
|
|
/* If interface is set while binding, indices
|
|
* must coincide.
|
|
*/
|
|
if (sk->sk_bound_dev_if &&
|
|
sk->sk_bound_dev_if != usin->sin6_scope_id)
|
|
return -EINVAL;
|
|
|
|
sk->sk_bound_dev_if = usin->sin6_scope_id;
|
|
}
|
|
|
|
/* Connect to link-local address requires an interface */
|
|
if (!sk->sk_bound_dev_if)
|
|
return -EINVAL;
|
|
}
|
|
|
|
if (tp->rx_opt.ts_recent_stamp &&
|
|
!ipv6_addr_equal(&np->daddr, &usin->sin6_addr)) {
|
|
tp->rx_opt.ts_recent = 0;
|
|
tp->rx_opt.ts_recent_stamp = 0;
|
|
tp->write_seq = 0;
|
|
}
|
|
|
|
ipv6_addr_copy(&np->daddr, &usin->sin6_addr);
|
|
np->flow_label = fl.fl6_flowlabel;
|
|
|
|
/*
|
|
* TCP over IPv4
|
|
*/
|
|
|
|
if (addr_type == IPV6_ADDR_MAPPED) {
|
|
u32 exthdrlen = icsk->icsk_ext_hdr_len;
|
|
struct sockaddr_in sin;
|
|
|
|
SOCK_DEBUG(sk, "connect: ipv4 mapped\n");
|
|
|
|
if (__ipv6_only_sock(sk))
|
|
return -ENETUNREACH;
|
|
|
|
sin.sin_family = AF_INET;
|
|
sin.sin_port = usin->sin6_port;
|
|
sin.sin_addr.s_addr = usin->sin6_addr.s6_addr32[3];
|
|
|
|
icsk->icsk_af_ops = &ipv6_mapped;
|
|
sk->sk_backlog_rcv = tcp_v4_do_rcv;
|
|
#ifdef CONFIG_TCP_MD5SIG
|
|
tp->af_specific = &tcp_sock_ipv6_mapped_specific;
|
|
#endif
|
|
|
|
err = tcp_v4_connect(sk, (struct sockaddr *)&sin, sizeof(sin));
|
|
|
|
if (err) {
|
|
icsk->icsk_ext_hdr_len = exthdrlen;
|
|
icsk->icsk_af_ops = &ipv6_specific;
|
|
sk->sk_backlog_rcv = tcp_v6_do_rcv;
|
|
#ifdef CONFIG_TCP_MD5SIG
|
|
tp->af_specific = &tcp_sock_ipv6_specific;
|
|
#endif
|
|
goto failure;
|
|
} else {
|
|
ipv6_addr_set(&np->saddr, 0, 0, htonl(0x0000FFFF),
|
|
inet->saddr);
|
|
ipv6_addr_set(&np->rcv_saddr, 0, 0, htonl(0x0000FFFF),
|
|
inet->rcv_saddr);
|
|
}
|
|
|
|
return err;
|
|
}
|
|
|
|
if (!ipv6_addr_any(&np->rcv_saddr))
|
|
saddr = &np->rcv_saddr;
|
|
|
|
fl.proto = IPPROTO_TCP;
|
|
ipv6_addr_copy(&fl.fl6_dst, &np->daddr);
|
|
ipv6_addr_copy(&fl.fl6_src,
|
|
(saddr ? saddr : &np->saddr));
|
|
fl.oif = sk->sk_bound_dev_if;
|
|
fl.fl_ip_dport = usin->sin6_port;
|
|
fl.fl_ip_sport = inet->sport;
|
|
|
|
if (np->opt && np->opt->srcrt) {
|
|
struct rt0_hdr *rt0 = (struct rt0_hdr *)np->opt->srcrt;
|
|
ipv6_addr_copy(&final, &fl.fl6_dst);
|
|
ipv6_addr_copy(&fl.fl6_dst, rt0->addr);
|
|
final_p = &final;
|
|
}
|
|
|
|
security_sk_classify_flow(sk, &fl);
|
|
|
|
err = ip6_dst_lookup(sk, &dst, &fl);
|
|
if (err)
|
|
goto failure;
|
|
if (final_p)
|
|
ipv6_addr_copy(&fl.fl6_dst, final_p);
|
|
|
|
if ((err = xfrm_lookup(&dst, &fl, sk, 0)) < 0)
|
|
goto failure;
|
|
|
|
if (saddr == NULL) {
|
|
saddr = &fl.fl6_src;
|
|
ipv6_addr_copy(&np->rcv_saddr, saddr);
|
|
}
|
|
|
|
/* set the source address */
|
|
ipv6_addr_copy(&np->saddr, saddr);
|
|
inet->rcv_saddr = LOOPBACK4_IPV6;
|
|
|
|
sk->sk_gso_type = SKB_GSO_TCPV6;
|
|
__ip6_dst_store(sk, dst, NULL, NULL);
|
|
|
|
icsk->icsk_ext_hdr_len = 0;
|
|
if (np->opt)
|
|
icsk->icsk_ext_hdr_len = (np->opt->opt_flen +
|
|
np->opt->opt_nflen);
|
|
|
|
tp->rx_opt.mss_clamp = IPV6_MIN_MTU - sizeof(struct tcphdr) - sizeof(struct ipv6hdr);
|
|
|
|
inet->dport = usin->sin6_port;
|
|
|
|
tcp_set_state(sk, TCP_SYN_SENT);
|
|
err = inet6_hash_connect(&tcp_death_row, sk);
|
|
if (err)
|
|
goto late_failure;
|
|
|
|
if (!tp->write_seq)
|
|
tp->write_seq = secure_tcpv6_sequence_number(np->saddr.s6_addr32,
|
|
np->daddr.s6_addr32,
|
|
inet->sport,
|
|
inet->dport);
|
|
|
|
err = tcp_connect(sk);
|
|
if (err)
|
|
goto late_failure;
|
|
|
|
return 0;
|
|
|
|
late_failure:
|
|
tcp_set_state(sk, TCP_CLOSE);
|
|
__sk_dst_reset(sk);
|
|
failure:
|
|
inet->dport = 0;
|
|
sk->sk_route_caps = 0;
|
|
return err;
|
|
}
|
|
|
|
static void tcp_v6_err(struct sk_buff *skb, struct inet6_skb_parm *opt,
|
|
int type, int code, int offset, __be32 info)
|
|
{
|
|
struct ipv6hdr *hdr = (struct ipv6hdr*)skb->data;
|
|
const struct tcphdr *th = (struct tcphdr *)(skb->data+offset);
|
|
struct ipv6_pinfo *np;
|
|
struct sock *sk;
|
|
int err;
|
|
struct tcp_sock *tp;
|
|
__u32 seq;
|
|
|
|
sk = inet6_lookup(&tcp_hashinfo, &hdr->daddr, th->dest, &hdr->saddr,
|
|
th->source, skb->dev->ifindex);
|
|
|
|
if (sk == NULL) {
|
|
ICMP6_INC_STATS_BH(__in6_dev_get(skb->dev), ICMP6_MIB_INERRORS);
|
|
return;
|
|
}
|
|
|
|
if (sk->sk_state == TCP_TIME_WAIT) {
|
|
inet_twsk_put(inet_twsk(sk));
|
|
return;
|
|
}
|
|
|
|
bh_lock_sock(sk);
|
|
if (sock_owned_by_user(sk))
|
|
NET_INC_STATS_BH(LINUX_MIB_LOCKDROPPEDICMPS);
|
|
|
|
if (sk->sk_state == TCP_CLOSE)
|
|
goto out;
|
|
|
|
tp = tcp_sk(sk);
|
|
seq = ntohl(th->seq);
|
|
if (sk->sk_state != TCP_LISTEN &&
|
|
!between(seq, tp->snd_una, tp->snd_nxt)) {
|
|
NET_INC_STATS_BH(LINUX_MIB_OUTOFWINDOWICMPS);
|
|
goto out;
|
|
}
|
|
|
|
np = inet6_sk(sk);
|
|
|
|
if (type == ICMPV6_PKT_TOOBIG) {
|
|
struct dst_entry *dst = NULL;
|
|
|
|
if (sock_owned_by_user(sk))
|
|
goto out;
|
|
if ((1 << sk->sk_state) & (TCPF_LISTEN | TCPF_CLOSE))
|
|
goto out;
|
|
|
|
/* icmp should have updated the destination cache entry */
|
|
dst = __sk_dst_check(sk, np->dst_cookie);
|
|
|
|
if (dst == NULL) {
|
|
struct inet_sock *inet = inet_sk(sk);
|
|
struct flowi fl;
|
|
|
|
/* BUGGG_FUTURE: Again, it is not clear how
|
|
to handle rthdr case. Ignore this complexity
|
|
for now.
|
|
*/
|
|
memset(&fl, 0, sizeof(fl));
|
|
fl.proto = IPPROTO_TCP;
|
|
ipv6_addr_copy(&fl.fl6_dst, &np->daddr);
|
|
ipv6_addr_copy(&fl.fl6_src, &np->saddr);
|
|
fl.oif = sk->sk_bound_dev_if;
|
|
fl.fl_ip_dport = inet->dport;
|
|
fl.fl_ip_sport = inet->sport;
|
|
security_skb_classify_flow(skb, &fl);
|
|
|
|
if ((err = ip6_dst_lookup(sk, &dst, &fl))) {
|
|
sk->sk_err_soft = -err;
|
|
goto out;
|
|
}
|
|
|
|
if ((err = xfrm_lookup(&dst, &fl, sk, 0)) < 0) {
|
|
sk->sk_err_soft = -err;
|
|
goto out;
|
|
}
|
|
|
|
} else
|
|
dst_hold(dst);
|
|
|
|
if (inet_csk(sk)->icsk_pmtu_cookie > dst_mtu(dst)) {
|
|
tcp_sync_mss(sk, dst_mtu(dst));
|
|
tcp_simple_retransmit(sk);
|
|
} /* else let the usual retransmit timer handle it */
|
|
dst_release(dst);
|
|
goto out;
|
|
}
|
|
|
|
icmpv6_err_convert(type, code, &err);
|
|
|
|
/* Might be for an request_sock */
|
|
switch (sk->sk_state) {
|
|
struct request_sock *req, **prev;
|
|
case TCP_LISTEN:
|
|
if (sock_owned_by_user(sk))
|
|
goto out;
|
|
|
|
req = inet6_csk_search_req(sk, &prev, th->dest, &hdr->daddr,
|
|
&hdr->saddr, inet6_iif(skb));
|
|
if (!req)
|
|
goto out;
|
|
|
|
/* ICMPs are not backlogged, hence we cannot get
|
|
* an established socket here.
|
|
*/
|
|
BUG_TRAP(req->sk == NULL);
|
|
|
|
if (seq != tcp_rsk(req)->snt_isn) {
|
|
NET_INC_STATS_BH(LINUX_MIB_OUTOFWINDOWICMPS);
|
|
goto out;
|
|
}
|
|
|
|
inet_csk_reqsk_queue_drop(sk, req, prev);
|
|
goto out;
|
|
|
|
case TCP_SYN_SENT:
|
|
case TCP_SYN_RECV: /* Cannot happen.
|
|
It can, it SYNs are crossed. --ANK */
|
|
if (!sock_owned_by_user(sk)) {
|
|
sk->sk_err = err;
|
|
sk->sk_error_report(sk); /* Wake people up to see the error (see connect in sock.c) */
|
|
|
|
tcp_done(sk);
|
|
} else
|
|
sk->sk_err_soft = err;
|
|
goto out;
|
|
}
|
|
|
|
if (!sock_owned_by_user(sk) && np->recverr) {
|
|
sk->sk_err = err;
|
|
sk->sk_error_report(sk);
|
|
} else
|
|
sk->sk_err_soft = err;
|
|
|
|
out:
|
|
bh_unlock_sock(sk);
|
|
sock_put(sk);
|
|
}
|
|
|
|
|
|
static int tcp_v6_send_synack(struct sock *sk, struct request_sock *req,
|
|
struct dst_entry *dst)
|
|
{
|
|
struct inet6_request_sock *treq = inet6_rsk(req);
|
|
struct ipv6_pinfo *np = inet6_sk(sk);
|
|
struct sk_buff * skb;
|
|
struct ipv6_txoptions *opt = NULL;
|
|
struct in6_addr * final_p = NULL, final;
|
|
struct flowi fl;
|
|
int err = -1;
|
|
|
|
memset(&fl, 0, sizeof(fl));
|
|
fl.proto = IPPROTO_TCP;
|
|
ipv6_addr_copy(&fl.fl6_dst, &treq->rmt_addr);
|
|
ipv6_addr_copy(&fl.fl6_src, &treq->loc_addr);
|
|
fl.fl6_flowlabel = 0;
|
|
fl.oif = treq->iif;
|
|
fl.fl_ip_dport = inet_rsk(req)->rmt_port;
|
|
fl.fl_ip_sport = inet_sk(sk)->sport;
|
|
security_req_classify_flow(req, &fl);
|
|
|
|
if (dst == NULL) {
|
|
opt = np->opt;
|
|
if (opt == NULL &&
|
|
np->rxopt.bits.osrcrt == 2 &&
|
|
treq->pktopts) {
|
|
struct sk_buff *pktopts = treq->pktopts;
|
|
struct inet6_skb_parm *rxopt = IP6CB(pktopts);
|
|
if (rxopt->srcrt)
|
|
opt = ipv6_invert_rthdr(sk, (struct ipv6_rt_hdr*)(pktopts->nh.raw + rxopt->srcrt));
|
|
}
|
|
|
|
if (opt && opt->srcrt) {
|
|
struct rt0_hdr *rt0 = (struct rt0_hdr *) opt->srcrt;
|
|
ipv6_addr_copy(&final, &fl.fl6_dst);
|
|
ipv6_addr_copy(&fl.fl6_dst, rt0->addr);
|
|
final_p = &final;
|
|
}
|
|
|
|
err = ip6_dst_lookup(sk, &dst, &fl);
|
|
if (err)
|
|
goto done;
|
|
if (final_p)
|
|
ipv6_addr_copy(&fl.fl6_dst, final_p);
|
|
if ((err = xfrm_lookup(&dst, &fl, sk, 0)) < 0)
|
|
goto done;
|
|
}
|
|
|
|
skb = tcp_make_synack(sk, dst, req);
|
|
if (skb) {
|
|
struct tcphdr *th = skb->h.th;
|
|
|
|
th->check = tcp_v6_check(th, skb->len,
|
|
&treq->loc_addr, &treq->rmt_addr,
|
|
csum_partial((char *)th, skb->len, skb->csum));
|
|
|
|
ipv6_addr_copy(&fl.fl6_dst, &treq->rmt_addr);
|
|
err = ip6_xmit(sk, skb, &fl, opt, 0);
|
|
err = net_xmit_eval(err);
|
|
}
|
|
|
|
done:
|
|
if (opt && opt != np->opt)
|
|
sock_kfree_s(sk, opt, opt->tot_len);
|
|
dst_release(dst);
|
|
return err;
|
|
}
|
|
|
|
static void tcp_v6_reqsk_destructor(struct request_sock *req)
|
|
{
|
|
if (inet6_rsk(req)->pktopts)
|
|
kfree_skb(inet6_rsk(req)->pktopts);
|
|
}
|
|
|
|
#ifdef CONFIG_TCP_MD5SIG
|
|
static struct tcp_md5sig_key *tcp_v6_md5_do_lookup(struct sock *sk,
|
|
struct in6_addr *addr)
|
|
{
|
|
struct tcp_sock *tp = tcp_sk(sk);
|
|
int i;
|
|
|
|
BUG_ON(tp == NULL);
|
|
|
|
if (!tp->md5sig_info || !tp->md5sig_info->entries6)
|
|
return NULL;
|
|
|
|
for (i = 0; i < tp->md5sig_info->entries6; i++) {
|
|
if (ipv6_addr_cmp(&tp->md5sig_info->keys6[i].addr, addr) == 0)
|
|
return (struct tcp_md5sig_key *)&tp->md5sig_info->keys6[i];
|
|
}
|
|
return NULL;
|
|
}
|
|
|
|
static struct tcp_md5sig_key *tcp_v6_md5_lookup(struct sock *sk,
|
|
struct sock *addr_sk)
|
|
{
|
|
return tcp_v6_md5_do_lookup(sk, &inet6_sk(addr_sk)->daddr);
|
|
}
|
|
|
|
static struct tcp_md5sig_key *tcp_v6_reqsk_md5_lookup(struct sock *sk,
|
|
struct request_sock *req)
|
|
{
|
|
return tcp_v6_md5_do_lookup(sk, &inet6_rsk(req)->rmt_addr);
|
|
}
|
|
|
|
static int tcp_v6_md5_do_add(struct sock *sk, struct in6_addr *peer,
|
|
char *newkey, u8 newkeylen)
|
|
{
|
|
/* Add key to the list */
|
|
struct tcp6_md5sig_key *key;
|
|
struct tcp_sock *tp = tcp_sk(sk);
|
|
struct tcp6_md5sig_key *keys;
|
|
|
|
key = (struct tcp6_md5sig_key*) tcp_v6_md5_do_lookup(sk, peer);
|
|
if (key) {
|
|
/* modify existing entry - just update that one */
|
|
kfree(key->key);
|
|
key->key = newkey;
|
|
key->keylen = newkeylen;
|
|
} else {
|
|
/* reallocate new list if current one is full. */
|
|
if (!tp->md5sig_info) {
|
|
tp->md5sig_info = kzalloc(sizeof(*tp->md5sig_info), GFP_ATOMIC);
|
|
if (!tp->md5sig_info) {
|
|
kfree(newkey);
|
|
return -ENOMEM;
|
|
}
|
|
}
|
|
tcp_alloc_md5sig_pool();
|
|
if (tp->md5sig_info->alloced6 == tp->md5sig_info->entries6) {
|
|
keys = kmalloc((sizeof (tp->md5sig_info->keys6[0]) *
|
|
(tp->md5sig_info->entries6 + 1)), GFP_ATOMIC);
|
|
|
|
if (!keys) {
|
|
tcp_free_md5sig_pool();
|
|
kfree(newkey);
|
|
return -ENOMEM;
|
|
}
|
|
|
|
if (tp->md5sig_info->entries6)
|
|
memmove(keys, tp->md5sig_info->keys6,
|
|
(sizeof (tp->md5sig_info->keys6[0]) *
|
|
tp->md5sig_info->entries6));
|
|
|
|
kfree(tp->md5sig_info->keys6);
|
|
tp->md5sig_info->keys6 = keys;
|
|
tp->md5sig_info->alloced6++;
|
|
}
|
|
|
|
ipv6_addr_copy(&tp->md5sig_info->keys6[tp->md5sig_info->entries6].addr,
|
|
peer);
|
|
tp->md5sig_info->keys6[tp->md5sig_info->entries6].key = newkey;
|
|
tp->md5sig_info->keys6[tp->md5sig_info->entries6].keylen = newkeylen;
|
|
|
|
tp->md5sig_info->entries6++;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static int tcp_v6_md5_add_func(struct sock *sk, struct sock *addr_sk,
|
|
u8 *newkey, __u8 newkeylen)
|
|
{
|
|
return tcp_v6_md5_do_add(sk, &inet6_sk(addr_sk)->daddr,
|
|
newkey, newkeylen);
|
|
}
|
|
|
|
static int tcp_v6_md5_do_del(struct sock *sk, struct in6_addr *peer)
|
|
{
|
|
struct tcp_sock *tp = tcp_sk(sk);
|
|
int i;
|
|
|
|
for (i = 0; i < tp->md5sig_info->entries6; i++) {
|
|
if (ipv6_addr_cmp(&tp->md5sig_info->keys6[i].addr, peer) == 0) {
|
|
/* Free the key */
|
|
kfree(tp->md5sig_info->keys6[i].key);
|
|
tp->md5sig_info->entries6--;
|
|
|
|
if (tp->md5sig_info->entries6 == 0) {
|
|
kfree(tp->md5sig_info->keys6);
|
|
tp->md5sig_info->keys6 = NULL;
|
|
|
|
tcp_free_md5sig_pool();
|
|
|
|
return 0;
|
|
} else {
|
|
/* shrink the database */
|
|
if (tp->md5sig_info->entries6 != i)
|
|
memmove(&tp->md5sig_info->keys6[i],
|
|
&tp->md5sig_info->keys6[i+1],
|
|
(tp->md5sig_info->entries6 - i)
|
|
* sizeof (tp->md5sig_info->keys6[0]));
|
|
}
|
|
}
|
|
}
|
|
return -ENOENT;
|
|
}
|
|
|
|
static void tcp_v6_clear_md5_list (struct sock *sk)
|
|
{
|
|
struct tcp_sock *tp = tcp_sk(sk);
|
|
int i;
|
|
|
|
if (tp->md5sig_info->entries6) {
|
|
for (i = 0; i < tp->md5sig_info->entries6; i++)
|
|
kfree(tp->md5sig_info->keys6[i].key);
|
|
tp->md5sig_info->entries6 = 0;
|
|
tcp_free_md5sig_pool();
|
|
}
|
|
|
|
kfree(tp->md5sig_info->keys6);
|
|
tp->md5sig_info->keys6 = NULL;
|
|
tp->md5sig_info->alloced6 = 0;
|
|
|
|
if (tp->md5sig_info->entries4) {
|
|
for (i = 0; i < tp->md5sig_info->entries4; i++)
|
|
kfree(tp->md5sig_info->keys4[i].key);
|
|
tp->md5sig_info->entries4 = 0;
|
|
tcp_free_md5sig_pool();
|
|
}
|
|
|
|
kfree(tp->md5sig_info->keys4);
|
|
tp->md5sig_info->keys4 = NULL;
|
|
tp->md5sig_info->alloced4 = 0;
|
|
}
|
|
|
|
static int tcp_v6_parse_md5_keys (struct sock *sk, char __user *optval,
|
|
int optlen)
|
|
{
|
|
struct tcp_md5sig cmd;
|
|
struct sockaddr_in6 *sin6 = (struct sockaddr_in6 *)&cmd.tcpm_addr;
|
|
u8 *newkey;
|
|
|
|
if (optlen < sizeof(cmd))
|
|
return -EINVAL;
|
|
|
|
if (copy_from_user(&cmd, optval, sizeof(cmd)))
|
|
return -EFAULT;
|
|
|
|
if (sin6->sin6_family != AF_INET6)
|
|
return -EINVAL;
|
|
|
|
if (!cmd.tcpm_keylen) {
|
|
if (!tcp_sk(sk)->md5sig_info)
|
|
return -ENOENT;
|
|
if (ipv6_addr_type(&sin6->sin6_addr) & IPV6_ADDR_MAPPED)
|
|
return tcp_v4_md5_do_del(sk, sin6->sin6_addr.s6_addr32[3]);
|
|
return tcp_v6_md5_do_del(sk, &sin6->sin6_addr);
|
|
}
|
|
|
|
if (cmd.tcpm_keylen > TCP_MD5SIG_MAXKEYLEN)
|
|
return -EINVAL;
|
|
|
|
if (!tcp_sk(sk)->md5sig_info) {
|
|
struct tcp_sock *tp = tcp_sk(sk);
|
|
struct tcp_md5sig_info *p;
|
|
|
|
p = kzalloc(sizeof(struct tcp_md5sig_info), GFP_KERNEL);
|
|
if (!p)
|
|
return -ENOMEM;
|
|
|
|
tp->md5sig_info = p;
|
|
}
|
|
|
|
newkey = kmemdup(cmd.tcpm_key, cmd.tcpm_keylen, GFP_KERNEL);
|
|
if (!newkey)
|
|
return -ENOMEM;
|
|
if (ipv6_addr_type(&sin6->sin6_addr) & IPV6_ADDR_MAPPED) {
|
|
return tcp_v4_md5_do_add(sk, sin6->sin6_addr.s6_addr32[3],
|
|
newkey, cmd.tcpm_keylen);
|
|
}
|
|
return tcp_v6_md5_do_add(sk, &sin6->sin6_addr, newkey, cmd.tcpm_keylen);
|
|
}
|
|
|
|
static int tcp_v6_do_calc_md5_hash(char *md5_hash, struct tcp_md5sig_key *key,
|
|
struct in6_addr *saddr,
|
|
struct in6_addr *daddr,
|
|
struct tcphdr *th, int protocol,
|
|
int tcplen)
|
|
{
|
|
struct scatterlist sg[4];
|
|
__u16 data_len;
|
|
int block = 0;
|
|
__sum16 cksum;
|
|
struct tcp_md5sig_pool *hp;
|
|
struct tcp6_pseudohdr *bp;
|
|
struct hash_desc *desc;
|
|
int err;
|
|
unsigned int nbytes = 0;
|
|
|
|
hp = tcp_get_md5sig_pool();
|
|
if (!hp) {
|
|
printk(KERN_WARNING "%s(): hash pool not found...\n", __FUNCTION__);
|
|
goto clear_hash_noput;
|
|
}
|
|
bp = &hp->md5_blk.ip6;
|
|
desc = &hp->md5_desc;
|
|
|
|
/* 1. TCP pseudo-header (RFC2460) */
|
|
ipv6_addr_copy(&bp->saddr, saddr);
|
|
ipv6_addr_copy(&bp->daddr, daddr);
|
|
bp->len = htonl(tcplen);
|
|
bp->protocol = htonl(protocol);
|
|
|
|
sg_set_buf(&sg[block++], bp, sizeof(*bp));
|
|
nbytes += sizeof(*bp);
|
|
|
|
/* 2. TCP header, excluding options */
|
|
cksum = th->check;
|
|
th->check = 0;
|
|
sg_set_buf(&sg[block++], th, sizeof(*th));
|
|
nbytes += sizeof(*th);
|
|
|
|
/* 3. TCP segment data (if any) */
|
|
data_len = tcplen - (th->doff << 2);
|
|
if (data_len > 0) {
|
|
u8 *data = (u8 *)th + (th->doff << 2);
|
|
sg_set_buf(&sg[block++], data, data_len);
|
|
nbytes += data_len;
|
|
}
|
|
|
|
/* 4. shared key */
|
|
sg_set_buf(&sg[block++], key->key, key->keylen);
|
|
nbytes += key->keylen;
|
|
|
|
/* Now store the hash into the packet */
|
|
err = crypto_hash_init(desc);
|
|
if (err) {
|
|
printk(KERN_WARNING "%s(): hash_init failed\n", __FUNCTION__);
|
|
goto clear_hash;
|
|
}
|
|
err = crypto_hash_update(desc, sg, nbytes);
|
|
if (err) {
|
|
printk(KERN_WARNING "%s(): hash_update failed\n", __FUNCTION__);
|
|
goto clear_hash;
|
|
}
|
|
err = crypto_hash_final(desc, md5_hash);
|
|
if (err) {
|
|
printk(KERN_WARNING "%s(): hash_final failed\n", __FUNCTION__);
|
|
goto clear_hash;
|
|
}
|
|
|
|
/* Reset header, and free up the crypto */
|
|
tcp_put_md5sig_pool();
|
|
th->check = cksum;
|
|
out:
|
|
return 0;
|
|
clear_hash:
|
|
tcp_put_md5sig_pool();
|
|
clear_hash_noput:
|
|
memset(md5_hash, 0, 16);
|
|
goto out;
|
|
}
|
|
|
|
static int tcp_v6_calc_md5_hash(char *md5_hash, struct tcp_md5sig_key *key,
|
|
struct sock *sk,
|
|
struct dst_entry *dst,
|
|
struct request_sock *req,
|
|
struct tcphdr *th, int protocol,
|
|
int tcplen)
|
|
{
|
|
struct in6_addr *saddr, *daddr;
|
|
|
|
if (sk) {
|
|
saddr = &inet6_sk(sk)->saddr;
|
|
daddr = &inet6_sk(sk)->daddr;
|
|
} else {
|
|
saddr = &inet6_rsk(req)->loc_addr;
|
|
daddr = &inet6_rsk(req)->rmt_addr;
|
|
}
|
|
return tcp_v6_do_calc_md5_hash(md5_hash, key,
|
|
saddr, daddr,
|
|
th, protocol, tcplen);
|
|
}
|
|
|
|
static int tcp_v6_inbound_md5_hash (struct sock *sk, struct sk_buff *skb)
|
|
{
|
|
__u8 *hash_location = NULL;
|
|
struct tcp_md5sig_key *hash_expected;
|
|
struct ipv6hdr *ip6h = skb->nh.ipv6h;
|
|
struct tcphdr *th = skb->h.th;
|
|
int length = (th->doff << 2) - sizeof (*th);
|
|
int genhash;
|
|
u8 *ptr;
|
|
u8 newhash[16];
|
|
|
|
hash_expected = tcp_v6_md5_do_lookup(sk, &ip6h->saddr);
|
|
|
|
/* If the TCP option is too short, we can short cut */
|
|
if (length < TCPOLEN_MD5SIG)
|
|
return hash_expected ? 1 : 0;
|
|
|
|
/* parse options */
|
|
ptr = (u8*)(th + 1);
|
|
while (length > 0) {
|
|
int opcode = *ptr++;
|
|
int opsize;
|
|
|
|
switch(opcode) {
|
|
case TCPOPT_EOL:
|
|
goto done_opts;
|
|
case TCPOPT_NOP:
|
|
length--;
|
|
continue;
|
|
default:
|
|
opsize = *ptr++;
|
|
if (opsize < 2 || opsize > length)
|
|
goto done_opts;
|
|
if (opcode == TCPOPT_MD5SIG) {
|
|
hash_location = ptr;
|
|
goto done_opts;
|
|
}
|
|
}
|
|
ptr += opsize - 2;
|
|
length -= opsize;
|
|
}
|
|
|
|
done_opts:
|
|
/* do we have a hash as expected? */
|
|
if (!hash_expected) {
|
|
if (!hash_location)
|
|
return 0;
|
|
if (net_ratelimit()) {
|
|
printk(KERN_INFO "MD5 Hash NOT expected but found "
|
|
"(" NIP6_FMT ", %u)->"
|
|
"(" NIP6_FMT ", %u)\n",
|
|
NIP6(ip6h->saddr), ntohs(th->source),
|
|
NIP6(ip6h->daddr), ntohs(th->dest));
|
|
}
|
|
return 1;
|
|
}
|
|
|
|
if (!hash_location) {
|
|
if (net_ratelimit()) {
|
|
printk(KERN_INFO "MD5 Hash expected but NOT found "
|
|
"(" NIP6_FMT ", %u)->"
|
|
"(" NIP6_FMT ", %u)\n",
|
|
NIP6(ip6h->saddr), ntohs(th->source),
|
|
NIP6(ip6h->daddr), ntohs(th->dest));
|
|
}
|
|
return 1;
|
|
}
|
|
|
|
/* check the signature */
|
|
genhash = tcp_v6_do_calc_md5_hash(newhash,
|
|
hash_expected,
|
|
&ip6h->saddr, &ip6h->daddr,
|
|
th, sk->sk_protocol,
|
|
skb->len);
|
|
if (genhash || memcmp(hash_location, newhash, 16) != 0) {
|
|
if (net_ratelimit()) {
|
|
printk(KERN_INFO "MD5 Hash %s for "
|
|
"(" NIP6_FMT ", %u)->"
|
|
"(" NIP6_FMT ", %u)\n",
|
|
genhash ? "failed" : "mismatch",
|
|
NIP6(ip6h->saddr), ntohs(th->source),
|
|
NIP6(ip6h->daddr), ntohs(th->dest));
|
|
}
|
|
return 1;
|
|
}
|
|
return 0;
|
|
}
|
|
#endif
|
|
|
|
static struct request_sock_ops tcp6_request_sock_ops __read_mostly = {
|
|
.family = AF_INET6,
|
|
.obj_size = sizeof(struct tcp6_request_sock),
|
|
.rtx_syn_ack = tcp_v6_send_synack,
|
|
.send_ack = tcp_v6_reqsk_send_ack,
|
|
.destructor = tcp_v6_reqsk_destructor,
|
|
.send_reset = tcp_v6_send_reset
|
|
};
|
|
|
|
#ifdef CONFIG_TCP_MD5SIG
|
|
static struct tcp_request_sock_ops tcp_request_sock_ipv6_ops = {
|
|
.md5_lookup = tcp_v6_reqsk_md5_lookup,
|
|
};
|
|
#endif
|
|
|
|
static struct timewait_sock_ops tcp6_timewait_sock_ops = {
|
|
.twsk_obj_size = sizeof(struct tcp6_timewait_sock),
|
|
.twsk_unique = tcp_twsk_unique,
|
|
.twsk_destructor= tcp_twsk_destructor,
|
|
};
|
|
|
|
static void tcp_v6_send_check(struct sock *sk, int len, struct sk_buff *skb)
|
|
{
|
|
struct ipv6_pinfo *np = inet6_sk(sk);
|
|
struct tcphdr *th = skb->h.th;
|
|
|
|
if (skb->ip_summed == CHECKSUM_PARTIAL) {
|
|
th->check = ~csum_ipv6_magic(&np->saddr, &np->daddr, len, IPPROTO_TCP, 0);
|
|
skb->csum_offset = offsetof(struct tcphdr, check);
|
|
} else {
|
|
th->check = csum_ipv6_magic(&np->saddr, &np->daddr, len, IPPROTO_TCP,
|
|
csum_partial((char *)th, th->doff<<2,
|
|
skb->csum));
|
|
}
|
|
}
|
|
|
|
static int tcp_v6_gso_send_check(struct sk_buff *skb)
|
|
{
|
|
struct ipv6hdr *ipv6h;
|
|
struct tcphdr *th;
|
|
|
|
if (!pskb_may_pull(skb, sizeof(*th)))
|
|
return -EINVAL;
|
|
|
|
ipv6h = skb->nh.ipv6h;
|
|
th = skb->h.th;
|
|
|
|
th->check = 0;
|
|
th->check = ~csum_ipv6_magic(&ipv6h->saddr, &ipv6h->daddr, skb->len,
|
|
IPPROTO_TCP, 0);
|
|
skb->csum_offset = offsetof(struct tcphdr, check);
|
|
skb->ip_summed = CHECKSUM_PARTIAL;
|
|
return 0;
|
|
}
|
|
|
|
static void tcp_v6_send_reset(struct sock *sk, struct sk_buff *skb)
|
|
{
|
|
struct tcphdr *th = skb->h.th, *t1;
|
|
struct sk_buff *buff;
|
|
struct flowi fl;
|
|
int tot_len = sizeof(*th);
|
|
#ifdef CONFIG_TCP_MD5SIG
|
|
struct tcp_md5sig_key *key;
|
|
#endif
|
|
|
|
if (th->rst)
|
|
return;
|
|
|
|
if (!ipv6_unicast_destination(skb))
|
|
return;
|
|
|
|
#ifdef CONFIG_TCP_MD5SIG
|
|
if (sk)
|
|
key = tcp_v6_md5_do_lookup(sk, &skb->nh.ipv6h->daddr);
|
|
else
|
|
key = NULL;
|
|
|
|
if (key)
|
|
tot_len += TCPOLEN_MD5SIG_ALIGNED;
|
|
#endif
|
|
|
|
/*
|
|
* We need to grab some memory, and put together an RST,
|
|
* and then put it into the queue to be sent.
|
|
*/
|
|
|
|
buff = alloc_skb(MAX_HEADER + sizeof(struct ipv6hdr) + tot_len,
|
|
GFP_ATOMIC);
|
|
if (buff == NULL)
|
|
return;
|
|
|
|
skb_reserve(buff, MAX_HEADER + sizeof(struct ipv6hdr) + tot_len);
|
|
|
|
t1 = (struct tcphdr *) skb_push(buff, tot_len);
|
|
|
|
/* Swap the send and the receive. */
|
|
memset(t1, 0, sizeof(*t1));
|
|
t1->dest = th->source;
|
|
t1->source = th->dest;
|
|
t1->doff = tot_len / 4;
|
|
t1->rst = 1;
|
|
|
|
if(th->ack) {
|
|
t1->seq = th->ack_seq;
|
|
} else {
|
|
t1->ack = 1;
|
|
t1->ack_seq = htonl(ntohl(th->seq) + th->syn + th->fin
|
|
+ skb->len - (th->doff<<2));
|
|
}
|
|
|
|
#ifdef CONFIG_TCP_MD5SIG
|
|
if (key) {
|
|
__be32 *opt = (__be32*)(t1 + 1);
|
|
opt[0] = htonl((TCPOPT_NOP << 24) |
|
|
(TCPOPT_NOP << 16) |
|
|
(TCPOPT_MD5SIG << 8) |
|
|
TCPOLEN_MD5SIG);
|
|
tcp_v6_do_calc_md5_hash((__u8*)&opt[1],
|
|
key,
|
|
&skb->nh.ipv6h->daddr,
|
|
&skb->nh.ipv6h->saddr,
|
|
t1, IPPROTO_TCP,
|
|
tot_len);
|
|
}
|
|
#endif
|
|
|
|
buff->csum = csum_partial((char *)t1, sizeof(*t1), 0);
|
|
|
|
memset(&fl, 0, sizeof(fl));
|
|
ipv6_addr_copy(&fl.fl6_dst, &skb->nh.ipv6h->saddr);
|
|
ipv6_addr_copy(&fl.fl6_src, &skb->nh.ipv6h->daddr);
|
|
|
|
t1->check = csum_ipv6_magic(&fl.fl6_src, &fl.fl6_dst,
|
|
sizeof(*t1), IPPROTO_TCP,
|
|
buff->csum);
|
|
|
|
fl.proto = IPPROTO_TCP;
|
|
fl.oif = inet6_iif(skb);
|
|
fl.fl_ip_dport = t1->dest;
|
|
fl.fl_ip_sport = t1->source;
|
|
security_skb_classify_flow(skb, &fl);
|
|
|
|
/* sk = NULL, but it is safe for now. RST socket required. */
|
|
if (!ip6_dst_lookup(NULL, &buff->dst, &fl)) {
|
|
|
|
if (xfrm_lookup(&buff->dst, &fl, NULL, 0) >= 0) {
|
|
ip6_xmit(tcp6_socket->sk, buff, &fl, NULL, 0);
|
|
TCP_INC_STATS_BH(TCP_MIB_OUTSEGS);
|
|
TCP_INC_STATS_BH(TCP_MIB_OUTRSTS);
|
|
return;
|
|
}
|
|
}
|
|
|
|
kfree_skb(buff);
|
|
}
|
|
|
|
static void tcp_v6_send_ack(struct tcp_timewait_sock *tw,
|
|
struct sk_buff *skb, u32 seq, u32 ack, u32 win, u32 ts)
|
|
{
|
|
struct tcphdr *th = skb->h.th, *t1;
|
|
struct sk_buff *buff;
|
|
struct flowi fl;
|
|
int tot_len = sizeof(struct tcphdr);
|
|
__be32 *topt;
|
|
#ifdef CONFIG_TCP_MD5SIG
|
|
struct tcp_md5sig_key *key;
|
|
struct tcp_md5sig_key tw_key;
|
|
#endif
|
|
|
|
#ifdef CONFIG_TCP_MD5SIG
|
|
if (!tw && skb->sk) {
|
|
key = tcp_v6_md5_do_lookup(skb->sk, &skb->nh.ipv6h->daddr);
|
|
} else if (tw && tw->tw_md5_keylen) {
|
|
tw_key.key = tw->tw_md5_key;
|
|
tw_key.keylen = tw->tw_md5_keylen;
|
|
key = &tw_key;
|
|
} else {
|
|
key = NULL;
|
|
}
|
|
#endif
|
|
|
|
if (ts)
|
|
tot_len += TCPOLEN_TSTAMP_ALIGNED;
|
|
#ifdef CONFIG_TCP_MD5SIG
|
|
if (key)
|
|
tot_len += TCPOLEN_MD5SIG_ALIGNED;
|
|
#endif
|
|
|
|
buff = alloc_skb(MAX_HEADER + sizeof(struct ipv6hdr) + tot_len,
|
|
GFP_ATOMIC);
|
|
if (buff == NULL)
|
|
return;
|
|
|
|
skb_reserve(buff, MAX_HEADER + sizeof(struct ipv6hdr) + tot_len);
|
|
|
|
t1 = (struct tcphdr *) skb_push(buff,tot_len);
|
|
|
|
/* Swap the send and the receive. */
|
|
memset(t1, 0, sizeof(*t1));
|
|
t1->dest = th->source;
|
|
t1->source = th->dest;
|
|
t1->doff = tot_len/4;
|
|
t1->seq = htonl(seq);
|
|
t1->ack_seq = htonl(ack);
|
|
t1->ack = 1;
|
|
t1->window = htons(win);
|
|
|
|
topt = (__be32 *)(t1 + 1);
|
|
|
|
if (ts) {
|
|
*topt++ = htonl((TCPOPT_NOP << 24) | (TCPOPT_NOP << 16) |
|
|
(TCPOPT_TIMESTAMP << 8) | TCPOLEN_TIMESTAMP);
|
|
*topt++ = htonl(tcp_time_stamp);
|
|
*topt = htonl(ts);
|
|
}
|
|
|
|
#ifdef CONFIG_TCP_MD5SIG
|
|
if (key) {
|
|
*topt++ = htonl((TCPOPT_NOP << 24) | (TCPOPT_NOP << 16) |
|
|
(TCPOPT_MD5SIG << 8) | TCPOLEN_MD5SIG);
|
|
tcp_v6_do_calc_md5_hash((__u8 *)topt,
|
|
key,
|
|
&skb->nh.ipv6h->daddr,
|
|
&skb->nh.ipv6h->saddr,
|
|
t1, IPPROTO_TCP,
|
|
tot_len);
|
|
}
|
|
#endif
|
|
|
|
buff->csum = csum_partial((char *)t1, tot_len, 0);
|
|
|
|
memset(&fl, 0, sizeof(fl));
|
|
ipv6_addr_copy(&fl.fl6_dst, &skb->nh.ipv6h->saddr);
|
|
ipv6_addr_copy(&fl.fl6_src, &skb->nh.ipv6h->daddr);
|
|
|
|
t1->check = csum_ipv6_magic(&fl.fl6_src, &fl.fl6_dst,
|
|
tot_len, IPPROTO_TCP,
|
|
buff->csum);
|
|
|
|
fl.proto = IPPROTO_TCP;
|
|
fl.oif = inet6_iif(skb);
|
|
fl.fl_ip_dport = t1->dest;
|
|
fl.fl_ip_sport = t1->source;
|
|
security_skb_classify_flow(skb, &fl);
|
|
|
|
if (!ip6_dst_lookup(NULL, &buff->dst, &fl)) {
|
|
if (xfrm_lookup(&buff->dst, &fl, NULL, 0) >= 0) {
|
|
ip6_xmit(tcp6_socket->sk, buff, &fl, NULL, 0);
|
|
TCP_INC_STATS_BH(TCP_MIB_OUTSEGS);
|
|
return;
|
|
}
|
|
}
|
|
|
|
kfree_skb(buff);
|
|
}
|
|
|
|
static void tcp_v6_timewait_ack(struct sock *sk, struct sk_buff *skb)
|
|
{
|
|
struct inet_timewait_sock *tw = inet_twsk(sk);
|
|
struct tcp_timewait_sock *tcptw = tcp_twsk(sk);
|
|
|
|
tcp_v6_send_ack(tcptw, skb, tcptw->tw_snd_nxt, tcptw->tw_rcv_nxt,
|
|
tcptw->tw_rcv_wnd >> tw->tw_rcv_wscale,
|
|
tcptw->tw_ts_recent);
|
|
|
|
inet_twsk_put(tw);
|
|
}
|
|
|
|
static void tcp_v6_reqsk_send_ack(struct sk_buff *skb, struct request_sock *req)
|
|
{
|
|
tcp_v6_send_ack(NULL, skb, tcp_rsk(req)->snt_isn + 1, tcp_rsk(req)->rcv_isn + 1, req->rcv_wnd, req->ts_recent);
|
|
}
|
|
|
|
|
|
static struct sock *tcp_v6_hnd_req(struct sock *sk,struct sk_buff *skb)
|
|
{
|
|
struct request_sock *req, **prev;
|
|
const struct tcphdr *th = skb->h.th;
|
|
struct sock *nsk;
|
|
|
|
/* Find possible connection requests. */
|
|
req = inet6_csk_search_req(sk, &prev, th->source,
|
|
&skb->nh.ipv6h->saddr,
|
|
&skb->nh.ipv6h->daddr, inet6_iif(skb));
|
|
if (req)
|
|
return tcp_check_req(sk, skb, req, prev);
|
|
|
|
nsk = __inet6_lookup_established(&tcp_hashinfo, &skb->nh.ipv6h->saddr,
|
|
th->source, &skb->nh.ipv6h->daddr,
|
|
ntohs(th->dest), inet6_iif(skb));
|
|
|
|
if (nsk) {
|
|
if (nsk->sk_state != TCP_TIME_WAIT) {
|
|
bh_lock_sock(nsk);
|
|
return nsk;
|
|
}
|
|
inet_twsk_put(inet_twsk(nsk));
|
|
return NULL;
|
|
}
|
|
|
|
#if 0 /*def CONFIG_SYN_COOKIES*/
|
|
if (!th->rst && !th->syn && th->ack)
|
|
sk = cookie_v6_check(sk, skb, &(IPCB(skb)->opt));
|
|
#endif
|
|
return sk;
|
|
}
|
|
|
|
/* FIXME: this is substantially similar to the ipv4 code.
|
|
* Can some kind of merge be done? -- erics
|
|
*/
|
|
static int tcp_v6_conn_request(struct sock *sk, struct sk_buff *skb)
|
|
{
|
|
struct inet6_request_sock *treq;
|
|
struct ipv6_pinfo *np = inet6_sk(sk);
|
|
struct tcp_options_received tmp_opt;
|
|
struct tcp_sock *tp = tcp_sk(sk);
|
|
struct request_sock *req = NULL;
|
|
__u32 isn = TCP_SKB_CB(skb)->when;
|
|
|
|
if (skb->protocol == htons(ETH_P_IP))
|
|
return tcp_v4_conn_request(sk, skb);
|
|
|
|
if (!ipv6_unicast_destination(skb))
|
|
goto drop;
|
|
|
|
/*
|
|
* There are no SYN attacks on IPv6, yet...
|
|
*/
|
|
if (inet_csk_reqsk_queue_is_full(sk) && !isn) {
|
|
if (net_ratelimit())
|
|
printk(KERN_INFO "TCPv6: dropping request, synflood is possible\n");
|
|
goto drop;
|
|
}
|
|
|
|
if (sk_acceptq_is_full(sk) && inet_csk_reqsk_queue_young(sk) > 1)
|
|
goto drop;
|
|
|
|
req = inet6_reqsk_alloc(&tcp6_request_sock_ops);
|
|
if (req == NULL)
|
|
goto drop;
|
|
|
|
#ifdef CONFIG_TCP_MD5SIG
|
|
tcp_rsk(req)->af_specific = &tcp_request_sock_ipv6_ops;
|
|
#endif
|
|
|
|
tcp_clear_options(&tmp_opt);
|
|
tmp_opt.mss_clamp = IPV6_MIN_MTU - sizeof(struct tcphdr) - sizeof(struct ipv6hdr);
|
|
tmp_opt.user_mss = tp->rx_opt.user_mss;
|
|
|
|
tcp_parse_options(skb, &tmp_opt, 0);
|
|
|
|
tmp_opt.tstamp_ok = tmp_opt.saw_tstamp;
|
|
tcp_openreq_init(req, &tmp_opt, skb);
|
|
|
|
treq = inet6_rsk(req);
|
|
ipv6_addr_copy(&treq->rmt_addr, &skb->nh.ipv6h->saddr);
|
|
ipv6_addr_copy(&treq->loc_addr, &skb->nh.ipv6h->daddr);
|
|
TCP_ECN_create_request(req, skb->h.th);
|
|
treq->pktopts = NULL;
|
|
if (ipv6_opt_accepted(sk, skb) ||
|
|
np->rxopt.bits.rxinfo || np->rxopt.bits.rxoinfo ||
|
|
np->rxopt.bits.rxhlim || np->rxopt.bits.rxohlim) {
|
|
atomic_inc(&skb->users);
|
|
treq->pktopts = skb;
|
|
}
|
|
treq->iif = sk->sk_bound_dev_if;
|
|
|
|
/* So that link locals have meaning */
|
|
if (!sk->sk_bound_dev_if &&
|
|
ipv6_addr_type(&treq->rmt_addr) & IPV6_ADDR_LINKLOCAL)
|
|
treq->iif = inet6_iif(skb);
|
|
|
|
if (isn == 0)
|
|
isn = tcp_v6_init_sequence(skb);
|
|
|
|
tcp_rsk(req)->snt_isn = isn;
|
|
|
|
security_inet_conn_request(sk, skb, req);
|
|
|
|
if (tcp_v6_send_synack(sk, req, NULL))
|
|
goto drop;
|
|
|
|
inet6_csk_reqsk_queue_hash_add(sk, req, TCP_TIMEOUT_INIT);
|
|
return 0;
|
|
|
|
drop:
|
|
if (req)
|
|
reqsk_free(req);
|
|
|
|
return 0; /* don't send reset */
|
|
}
|
|
|
|
static struct sock * tcp_v6_syn_recv_sock(struct sock *sk, struct sk_buff *skb,
|
|
struct request_sock *req,
|
|
struct dst_entry *dst)
|
|
{
|
|
struct inet6_request_sock *treq = inet6_rsk(req);
|
|
struct ipv6_pinfo *newnp, *np = inet6_sk(sk);
|
|
struct tcp6_sock *newtcp6sk;
|
|
struct inet_sock *newinet;
|
|
struct tcp_sock *newtp;
|
|
struct sock *newsk;
|
|
struct ipv6_txoptions *opt;
|
|
#ifdef CONFIG_TCP_MD5SIG
|
|
struct tcp_md5sig_key *key;
|
|
#endif
|
|
|
|
if (skb->protocol == htons(ETH_P_IP)) {
|
|
/*
|
|
* v6 mapped
|
|
*/
|
|
|
|
newsk = tcp_v4_syn_recv_sock(sk, skb, req, dst);
|
|
|
|
if (newsk == NULL)
|
|
return NULL;
|
|
|
|
newtcp6sk = (struct tcp6_sock *)newsk;
|
|
inet_sk(newsk)->pinet6 = &newtcp6sk->inet6;
|
|
|
|
newinet = inet_sk(newsk);
|
|
newnp = inet6_sk(newsk);
|
|
newtp = tcp_sk(newsk);
|
|
|
|
memcpy(newnp, np, sizeof(struct ipv6_pinfo));
|
|
|
|
ipv6_addr_set(&newnp->daddr, 0, 0, htonl(0x0000FFFF),
|
|
newinet->daddr);
|
|
|
|
ipv6_addr_set(&newnp->saddr, 0, 0, htonl(0x0000FFFF),
|
|
newinet->saddr);
|
|
|
|
ipv6_addr_copy(&newnp->rcv_saddr, &newnp->saddr);
|
|
|
|
inet_csk(newsk)->icsk_af_ops = &ipv6_mapped;
|
|
newsk->sk_backlog_rcv = tcp_v4_do_rcv;
|
|
#ifdef CONFIG_TCP_MD5SIG
|
|
newtp->af_specific = &tcp_sock_ipv6_mapped_specific;
|
|
#endif
|
|
|
|
newnp->pktoptions = NULL;
|
|
newnp->opt = NULL;
|
|
newnp->mcast_oif = inet6_iif(skb);
|
|
newnp->mcast_hops = skb->nh.ipv6h->hop_limit;
|
|
|
|
/*
|
|
* No need to charge this sock to the relevant IPv6 refcnt debug socks count
|
|
* here, tcp_create_openreq_child now does this for us, see the comment in
|
|
* that function for the gory details. -acme
|
|
*/
|
|
|
|
/* It is tricky place. Until this moment IPv4 tcp
|
|
worked with IPv6 icsk.icsk_af_ops.
|
|
Sync it now.
|
|
*/
|
|
tcp_sync_mss(newsk, inet_csk(newsk)->icsk_pmtu_cookie);
|
|
|
|
return newsk;
|
|
}
|
|
|
|
opt = np->opt;
|
|
|
|
if (sk_acceptq_is_full(sk))
|
|
goto out_overflow;
|
|
|
|
if (np->rxopt.bits.osrcrt == 2 &&
|
|
opt == NULL && treq->pktopts) {
|
|
struct inet6_skb_parm *rxopt = IP6CB(treq->pktopts);
|
|
if (rxopt->srcrt)
|
|
opt = ipv6_invert_rthdr(sk, (struct ipv6_rt_hdr *)(treq->pktopts->nh.raw + rxopt->srcrt));
|
|
}
|
|
|
|
if (dst == NULL) {
|
|
struct in6_addr *final_p = NULL, final;
|
|
struct flowi fl;
|
|
|
|
memset(&fl, 0, sizeof(fl));
|
|
fl.proto = IPPROTO_TCP;
|
|
ipv6_addr_copy(&fl.fl6_dst, &treq->rmt_addr);
|
|
if (opt && opt->srcrt) {
|
|
struct rt0_hdr *rt0 = (struct rt0_hdr *) opt->srcrt;
|
|
ipv6_addr_copy(&final, &fl.fl6_dst);
|
|
ipv6_addr_copy(&fl.fl6_dst, rt0->addr);
|
|
final_p = &final;
|
|
}
|
|
ipv6_addr_copy(&fl.fl6_src, &treq->loc_addr);
|
|
fl.oif = sk->sk_bound_dev_if;
|
|
fl.fl_ip_dport = inet_rsk(req)->rmt_port;
|
|
fl.fl_ip_sport = inet_sk(sk)->sport;
|
|
security_req_classify_flow(req, &fl);
|
|
|
|
if (ip6_dst_lookup(sk, &dst, &fl))
|
|
goto out;
|
|
|
|
if (final_p)
|
|
ipv6_addr_copy(&fl.fl6_dst, final_p);
|
|
|
|
if ((xfrm_lookup(&dst, &fl, sk, 0)) < 0)
|
|
goto out;
|
|
}
|
|
|
|
newsk = tcp_create_openreq_child(sk, req, skb);
|
|
if (newsk == NULL)
|
|
goto out;
|
|
|
|
/*
|
|
* No need to charge this sock to the relevant IPv6 refcnt debug socks
|
|
* count here, tcp_create_openreq_child now does this for us, see the
|
|
* comment in that function for the gory details. -acme
|
|
*/
|
|
|
|
newsk->sk_gso_type = SKB_GSO_TCPV6;
|
|
__ip6_dst_store(newsk, dst, NULL, NULL);
|
|
|
|
newtcp6sk = (struct tcp6_sock *)newsk;
|
|
inet_sk(newsk)->pinet6 = &newtcp6sk->inet6;
|
|
|
|
newtp = tcp_sk(newsk);
|
|
newinet = inet_sk(newsk);
|
|
newnp = inet6_sk(newsk);
|
|
|
|
memcpy(newnp, np, sizeof(struct ipv6_pinfo));
|
|
|
|
ipv6_addr_copy(&newnp->daddr, &treq->rmt_addr);
|
|
ipv6_addr_copy(&newnp->saddr, &treq->loc_addr);
|
|
ipv6_addr_copy(&newnp->rcv_saddr, &treq->loc_addr);
|
|
newsk->sk_bound_dev_if = treq->iif;
|
|
|
|
/* Now IPv6 options...
|
|
|
|
First: no IPv4 options.
|
|
*/
|
|
newinet->opt = NULL;
|
|
|
|
/* Clone RX bits */
|
|
newnp->rxopt.all = np->rxopt.all;
|
|
|
|
/* Clone pktoptions received with SYN */
|
|
newnp->pktoptions = NULL;
|
|
if (treq->pktopts != NULL) {
|
|
newnp->pktoptions = skb_clone(treq->pktopts, GFP_ATOMIC);
|
|
kfree_skb(treq->pktopts);
|
|
treq->pktopts = NULL;
|
|
if (newnp->pktoptions)
|
|
skb_set_owner_r(newnp->pktoptions, newsk);
|
|
}
|
|
newnp->opt = NULL;
|
|
newnp->mcast_oif = inet6_iif(skb);
|
|
newnp->mcast_hops = skb->nh.ipv6h->hop_limit;
|
|
|
|
/* Clone native IPv6 options from listening socket (if any)
|
|
|
|
Yes, keeping reference count would be much more clever,
|
|
but we make one more one thing there: reattach optmem
|
|
to newsk.
|
|
*/
|
|
if (opt) {
|
|
newnp->opt = ipv6_dup_options(newsk, opt);
|
|
if (opt != np->opt)
|
|
sock_kfree_s(sk, opt, opt->tot_len);
|
|
}
|
|
|
|
inet_csk(newsk)->icsk_ext_hdr_len = 0;
|
|
if (newnp->opt)
|
|
inet_csk(newsk)->icsk_ext_hdr_len = (newnp->opt->opt_nflen +
|
|
newnp->opt->opt_flen);
|
|
|
|
tcp_mtup_init(newsk);
|
|
tcp_sync_mss(newsk, dst_mtu(dst));
|
|
newtp->advmss = dst_metric(dst, RTAX_ADVMSS);
|
|
tcp_initialize_rcv_mss(newsk);
|
|
|
|
newinet->daddr = newinet->saddr = newinet->rcv_saddr = LOOPBACK4_IPV6;
|
|
|
|
#ifdef CONFIG_TCP_MD5SIG
|
|
/* Copy over the MD5 key from the original socket */
|
|
if ((key = tcp_v6_md5_do_lookup(sk, &newnp->daddr)) != NULL) {
|
|
/* We're using one, so create a matching key
|
|
* on the newsk structure. If we fail to get
|
|
* memory, then we end up not copying the key
|
|
* across. Shucks.
|
|
*/
|
|
char *newkey = kmemdup(key->key, key->keylen, GFP_ATOMIC);
|
|
if (newkey != NULL)
|
|
tcp_v6_md5_do_add(newsk, &inet6_sk(sk)->daddr,
|
|
newkey, key->keylen);
|
|
}
|
|
#endif
|
|
|
|
__inet6_hash(&tcp_hashinfo, newsk);
|
|
inet_inherit_port(&tcp_hashinfo, sk, newsk);
|
|
|
|
return newsk;
|
|
|
|
out_overflow:
|
|
NET_INC_STATS_BH(LINUX_MIB_LISTENOVERFLOWS);
|
|
out:
|
|
NET_INC_STATS_BH(LINUX_MIB_LISTENDROPS);
|
|
if (opt && opt != np->opt)
|
|
sock_kfree_s(sk, opt, opt->tot_len);
|
|
dst_release(dst);
|
|
return NULL;
|
|
}
|
|
|
|
static __sum16 tcp_v6_checksum_init(struct sk_buff *skb)
|
|
{
|
|
if (skb->ip_summed == CHECKSUM_COMPLETE) {
|
|
if (!tcp_v6_check(skb->h.th,skb->len,&skb->nh.ipv6h->saddr,
|
|
&skb->nh.ipv6h->daddr,skb->csum)) {
|
|
skb->ip_summed = CHECKSUM_UNNECESSARY;
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
skb->csum = ~csum_unfold(tcp_v6_check(skb->h.th,skb->len,&skb->nh.ipv6h->saddr,
|
|
&skb->nh.ipv6h->daddr, 0));
|
|
|
|
if (skb->len <= 76) {
|
|
return __skb_checksum_complete(skb);
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
/* The socket must have it's spinlock held when we get
|
|
* here.
|
|
*
|
|
* We have a potential double-lock case here, so even when
|
|
* doing backlog processing we use the BH locking scheme.
|
|
* This is because we cannot sleep with the original spinlock
|
|
* held.
|
|
*/
|
|
static int tcp_v6_do_rcv(struct sock *sk, struct sk_buff *skb)
|
|
{
|
|
struct ipv6_pinfo *np = inet6_sk(sk);
|
|
struct tcp_sock *tp;
|
|
struct sk_buff *opt_skb = NULL;
|
|
|
|
/* Imagine: socket is IPv6. IPv4 packet arrives,
|
|
goes to IPv4 receive handler and backlogged.
|
|
From backlog it always goes here. Kerboom...
|
|
Fortunately, tcp_rcv_established and rcv_established
|
|
handle them correctly, but it is not case with
|
|
tcp_v6_hnd_req and tcp_v6_send_reset(). --ANK
|
|
*/
|
|
|
|
if (skb->protocol == htons(ETH_P_IP))
|
|
return tcp_v4_do_rcv(sk, skb);
|
|
|
|
#ifdef CONFIG_TCP_MD5SIG
|
|
if (tcp_v6_inbound_md5_hash (sk, skb))
|
|
goto discard;
|
|
#endif
|
|
|
|
if (sk_filter(sk, skb))
|
|
goto discard;
|
|
|
|
/*
|
|
* socket locking is here for SMP purposes as backlog rcv
|
|
* is currently called with bh processing disabled.
|
|
*/
|
|
|
|
/* Do Stevens' IPV6_PKTOPTIONS.
|
|
|
|
Yes, guys, it is the only place in our code, where we
|
|
may make it not affecting IPv4.
|
|
The rest of code is protocol independent,
|
|
and I do not like idea to uglify IPv4.
|
|
|
|
Actually, all the idea behind IPV6_PKTOPTIONS
|
|
looks not very well thought. For now we latch
|
|
options, received in the last packet, enqueued
|
|
by tcp. Feel free to propose better solution.
|
|
--ANK (980728)
|
|
*/
|
|
if (np->rxopt.all)
|
|
opt_skb = skb_clone(skb, GFP_ATOMIC);
|
|
|
|
if (sk->sk_state == TCP_ESTABLISHED) { /* Fast path */
|
|
TCP_CHECK_TIMER(sk);
|
|
if (tcp_rcv_established(sk, skb, skb->h.th, skb->len))
|
|
goto reset;
|
|
TCP_CHECK_TIMER(sk);
|
|
if (opt_skb)
|
|
goto ipv6_pktoptions;
|
|
return 0;
|
|
}
|
|
|
|
if (skb->len < (skb->h.th->doff<<2) || tcp_checksum_complete(skb))
|
|
goto csum_err;
|
|
|
|
if (sk->sk_state == TCP_LISTEN) {
|
|
struct sock *nsk = tcp_v6_hnd_req(sk, skb);
|
|
if (!nsk)
|
|
goto discard;
|
|
|
|
/*
|
|
* Queue it on the new socket if the new socket is active,
|
|
* otherwise we just shortcircuit this and continue with
|
|
* the new socket..
|
|
*/
|
|
if(nsk != sk) {
|
|
if (tcp_child_process(sk, nsk, skb))
|
|
goto reset;
|
|
if (opt_skb)
|
|
__kfree_skb(opt_skb);
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
TCP_CHECK_TIMER(sk);
|
|
if (tcp_rcv_state_process(sk, skb, skb->h.th, skb->len))
|
|
goto reset;
|
|
TCP_CHECK_TIMER(sk);
|
|
if (opt_skb)
|
|
goto ipv6_pktoptions;
|
|
return 0;
|
|
|
|
reset:
|
|
tcp_v6_send_reset(sk, skb);
|
|
discard:
|
|
if (opt_skb)
|
|
__kfree_skb(opt_skb);
|
|
kfree_skb(skb);
|
|
return 0;
|
|
csum_err:
|
|
TCP_INC_STATS_BH(TCP_MIB_INERRS);
|
|
goto discard;
|
|
|
|
|
|
ipv6_pktoptions:
|
|
/* Do you ask, what is it?
|
|
|
|
1. skb was enqueued by tcp.
|
|
2. skb is added to tail of read queue, rather than out of order.
|
|
3. socket is not in passive state.
|
|
4. Finally, it really contains options, which user wants to receive.
|
|
*/
|
|
tp = tcp_sk(sk);
|
|
if (TCP_SKB_CB(opt_skb)->end_seq == tp->rcv_nxt &&
|
|
!((1 << sk->sk_state) & (TCPF_CLOSE | TCPF_LISTEN))) {
|
|
if (np->rxopt.bits.rxinfo || np->rxopt.bits.rxoinfo)
|
|
np->mcast_oif = inet6_iif(opt_skb);
|
|
if (np->rxopt.bits.rxhlim || np->rxopt.bits.rxohlim)
|
|
np->mcast_hops = opt_skb->nh.ipv6h->hop_limit;
|
|
if (ipv6_opt_accepted(sk, opt_skb)) {
|
|
skb_set_owner_r(opt_skb, sk);
|
|
opt_skb = xchg(&np->pktoptions, opt_skb);
|
|
} else {
|
|
__kfree_skb(opt_skb);
|
|
opt_skb = xchg(&np->pktoptions, NULL);
|
|
}
|
|
}
|
|
|
|
if (opt_skb)
|
|
kfree_skb(opt_skb);
|
|
return 0;
|
|
}
|
|
|
|
static int tcp_v6_rcv(struct sk_buff **pskb)
|
|
{
|
|
struct sk_buff *skb = *pskb;
|
|
struct tcphdr *th;
|
|
struct sock *sk;
|
|
int ret;
|
|
|
|
if (skb->pkt_type != PACKET_HOST)
|
|
goto discard_it;
|
|
|
|
/*
|
|
* Count it even if it's bad.
|
|
*/
|
|
TCP_INC_STATS_BH(TCP_MIB_INSEGS);
|
|
|
|
if (!pskb_may_pull(skb, sizeof(struct tcphdr)))
|
|
goto discard_it;
|
|
|
|
th = skb->h.th;
|
|
|
|
if (th->doff < sizeof(struct tcphdr)/4)
|
|
goto bad_packet;
|
|
if (!pskb_may_pull(skb, th->doff*4))
|
|
goto discard_it;
|
|
|
|
if ((skb->ip_summed != CHECKSUM_UNNECESSARY &&
|
|
tcp_v6_checksum_init(skb)))
|
|
goto bad_packet;
|
|
|
|
th = skb->h.th;
|
|
TCP_SKB_CB(skb)->seq = ntohl(th->seq);
|
|
TCP_SKB_CB(skb)->end_seq = (TCP_SKB_CB(skb)->seq + th->syn + th->fin +
|
|
skb->len - th->doff*4);
|
|
TCP_SKB_CB(skb)->ack_seq = ntohl(th->ack_seq);
|
|
TCP_SKB_CB(skb)->when = 0;
|
|
TCP_SKB_CB(skb)->flags = ipv6_get_dsfield(skb->nh.ipv6h);
|
|
TCP_SKB_CB(skb)->sacked = 0;
|
|
|
|
sk = __inet6_lookup(&tcp_hashinfo, &skb->nh.ipv6h->saddr, th->source,
|
|
&skb->nh.ipv6h->daddr, ntohs(th->dest),
|
|
inet6_iif(skb));
|
|
|
|
if (!sk)
|
|
goto no_tcp_socket;
|
|
|
|
process:
|
|
if (sk->sk_state == TCP_TIME_WAIT)
|
|
goto do_time_wait;
|
|
|
|
if (!xfrm6_policy_check(sk, XFRM_POLICY_IN, skb))
|
|
goto discard_and_relse;
|
|
|
|
if (sk_filter(sk, skb))
|
|
goto discard_and_relse;
|
|
|
|
skb->dev = NULL;
|
|
|
|
bh_lock_sock_nested(sk);
|
|
ret = 0;
|
|
if (!sock_owned_by_user(sk)) {
|
|
#ifdef CONFIG_NET_DMA
|
|
struct tcp_sock *tp = tcp_sk(sk);
|
|
if (tp->ucopy.dma_chan)
|
|
ret = tcp_v6_do_rcv(sk, skb);
|
|
else
|
|
#endif
|
|
{
|
|
if (!tcp_prequeue(sk, skb))
|
|
ret = tcp_v6_do_rcv(sk, skb);
|
|
}
|
|
} else
|
|
sk_add_backlog(sk, skb);
|
|
bh_unlock_sock(sk);
|
|
|
|
sock_put(sk);
|
|
return ret ? -1 : 0;
|
|
|
|
no_tcp_socket:
|
|
if (!xfrm6_policy_check(NULL, XFRM_POLICY_IN, skb))
|
|
goto discard_it;
|
|
|
|
if (skb->len < (th->doff<<2) || tcp_checksum_complete(skb)) {
|
|
bad_packet:
|
|
TCP_INC_STATS_BH(TCP_MIB_INERRS);
|
|
} else {
|
|
tcp_v6_send_reset(NULL, skb);
|
|
}
|
|
|
|
discard_it:
|
|
|
|
/*
|
|
* Discard frame
|
|
*/
|
|
|
|
kfree_skb(skb);
|
|
return 0;
|
|
|
|
discard_and_relse:
|
|
sock_put(sk);
|
|
goto discard_it;
|
|
|
|
do_time_wait:
|
|
if (!xfrm6_policy_check(NULL, XFRM_POLICY_IN, skb)) {
|
|
inet_twsk_put(inet_twsk(sk));
|
|
goto discard_it;
|
|
}
|
|
|
|
if (skb->len < (th->doff<<2) || tcp_checksum_complete(skb)) {
|
|
TCP_INC_STATS_BH(TCP_MIB_INERRS);
|
|
inet_twsk_put(inet_twsk(sk));
|
|
goto discard_it;
|
|
}
|
|
|
|
switch (tcp_timewait_state_process(inet_twsk(sk), skb, th)) {
|
|
case TCP_TW_SYN:
|
|
{
|
|
struct sock *sk2;
|
|
|
|
sk2 = inet6_lookup_listener(&tcp_hashinfo,
|
|
&skb->nh.ipv6h->daddr,
|
|
ntohs(th->dest), inet6_iif(skb));
|
|
if (sk2 != NULL) {
|
|
struct inet_timewait_sock *tw = inet_twsk(sk);
|
|
inet_twsk_deschedule(tw, &tcp_death_row);
|
|
inet_twsk_put(tw);
|
|
sk = sk2;
|
|
goto process;
|
|
}
|
|
/* Fall through to ACK */
|
|
}
|
|
case TCP_TW_ACK:
|
|
tcp_v6_timewait_ack(sk, skb);
|
|
break;
|
|
case TCP_TW_RST:
|
|
goto no_tcp_socket;
|
|
case TCP_TW_SUCCESS:;
|
|
}
|
|
goto discard_it;
|
|
}
|
|
|
|
static int tcp_v6_remember_stamp(struct sock *sk)
|
|
{
|
|
/* Alas, not yet... */
|
|
return 0;
|
|
}
|
|
|
|
static struct inet_connection_sock_af_ops ipv6_specific = {
|
|
.queue_xmit = inet6_csk_xmit,
|
|
.send_check = tcp_v6_send_check,
|
|
.rebuild_header = inet6_sk_rebuild_header,
|
|
.conn_request = tcp_v6_conn_request,
|
|
.syn_recv_sock = tcp_v6_syn_recv_sock,
|
|
.remember_stamp = tcp_v6_remember_stamp,
|
|
.net_header_len = sizeof(struct ipv6hdr),
|
|
.setsockopt = ipv6_setsockopt,
|
|
.getsockopt = ipv6_getsockopt,
|
|
.addr2sockaddr = inet6_csk_addr2sockaddr,
|
|
.sockaddr_len = sizeof(struct sockaddr_in6),
|
|
#ifdef CONFIG_COMPAT
|
|
.compat_setsockopt = compat_ipv6_setsockopt,
|
|
.compat_getsockopt = compat_ipv6_getsockopt,
|
|
#endif
|
|
};
|
|
|
|
#ifdef CONFIG_TCP_MD5SIG
|
|
static struct tcp_sock_af_ops tcp_sock_ipv6_specific = {
|
|
.md5_lookup = tcp_v6_md5_lookup,
|
|
.calc_md5_hash = tcp_v6_calc_md5_hash,
|
|
.md5_add = tcp_v6_md5_add_func,
|
|
.md5_parse = tcp_v6_parse_md5_keys,
|
|
};
|
|
#endif
|
|
|
|
/*
|
|
* TCP over IPv4 via INET6 API
|
|
*/
|
|
|
|
static struct inet_connection_sock_af_ops ipv6_mapped = {
|
|
.queue_xmit = ip_queue_xmit,
|
|
.send_check = tcp_v4_send_check,
|
|
.rebuild_header = inet_sk_rebuild_header,
|
|
.conn_request = tcp_v6_conn_request,
|
|
.syn_recv_sock = tcp_v6_syn_recv_sock,
|
|
.remember_stamp = tcp_v4_remember_stamp,
|
|
.net_header_len = sizeof(struct iphdr),
|
|
.setsockopt = ipv6_setsockopt,
|
|
.getsockopt = ipv6_getsockopt,
|
|
.addr2sockaddr = inet6_csk_addr2sockaddr,
|
|
.sockaddr_len = sizeof(struct sockaddr_in6),
|
|
#ifdef CONFIG_COMPAT
|
|
.compat_setsockopt = compat_ipv6_setsockopt,
|
|
.compat_getsockopt = compat_ipv6_getsockopt,
|
|
#endif
|
|
};
|
|
|
|
#ifdef CONFIG_TCP_MD5SIG
|
|
static struct tcp_sock_af_ops tcp_sock_ipv6_mapped_specific = {
|
|
.md5_lookup = tcp_v4_md5_lookup,
|
|
.calc_md5_hash = tcp_v4_calc_md5_hash,
|
|
.md5_add = tcp_v6_md5_add_func,
|
|
.md5_parse = tcp_v6_parse_md5_keys,
|
|
};
|
|
#endif
|
|
|
|
/* NOTE: A lot of things set to zero explicitly by call to
|
|
* sk_alloc() so need not be done here.
|
|
*/
|
|
static int tcp_v6_init_sock(struct sock *sk)
|
|
{
|
|
struct inet_connection_sock *icsk = inet_csk(sk);
|
|
struct tcp_sock *tp = tcp_sk(sk);
|
|
|
|
skb_queue_head_init(&tp->out_of_order_queue);
|
|
tcp_init_xmit_timers(sk);
|
|
tcp_prequeue_init(tp);
|
|
|
|
icsk->icsk_rto = TCP_TIMEOUT_INIT;
|
|
tp->mdev = TCP_TIMEOUT_INIT;
|
|
|
|
/* So many TCP implementations out there (incorrectly) count the
|
|
* initial SYN frame in their delayed-ACK and congestion control
|
|
* algorithms that we must have the following bandaid to talk
|
|
* efficiently to them. -DaveM
|
|
*/
|
|
tp->snd_cwnd = 2;
|
|
|
|
/* See draft-stevens-tcpca-spec-01 for discussion of the
|
|
* initialization of these values.
|
|
*/
|
|
tp->snd_ssthresh = 0x7fffffff;
|
|
tp->snd_cwnd_clamp = ~0;
|
|
tp->mss_cache = 536;
|
|
|
|
tp->reordering = sysctl_tcp_reordering;
|
|
|
|
sk->sk_state = TCP_CLOSE;
|
|
|
|
icsk->icsk_af_ops = &ipv6_specific;
|
|
icsk->icsk_ca_ops = &tcp_init_congestion_ops;
|
|
icsk->icsk_sync_mss = tcp_sync_mss;
|
|
sk->sk_write_space = sk_stream_write_space;
|
|
sock_set_flag(sk, SOCK_USE_WRITE_QUEUE);
|
|
|
|
#ifdef CONFIG_TCP_MD5SIG
|
|
tp->af_specific = &tcp_sock_ipv6_specific;
|
|
#endif
|
|
|
|
sk->sk_sndbuf = sysctl_tcp_wmem[1];
|
|
sk->sk_rcvbuf = sysctl_tcp_rmem[1];
|
|
|
|
atomic_inc(&tcp_sockets_allocated);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int tcp_v6_destroy_sock(struct sock *sk)
|
|
{
|
|
#ifdef CONFIG_TCP_MD5SIG
|
|
/* Clean up the MD5 key list */
|
|
if (tcp_sk(sk)->md5sig_info)
|
|
tcp_v6_clear_md5_list(sk);
|
|
#endif
|
|
tcp_v4_destroy_sock(sk);
|
|
return inet6_destroy_sock(sk);
|
|
}
|
|
|
|
/* Proc filesystem TCPv6 sock list dumping. */
|
|
static void get_openreq6(struct seq_file *seq,
|
|
struct sock *sk, struct request_sock *req, int i, int uid)
|
|
{
|
|
int ttd = req->expires - jiffies;
|
|
struct in6_addr *src = &inet6_rsk(req)->loc_addr;
|
|
struct in6_addr *dest = &inet6_rsk(req)->rmt_addr;
|
|
|
|
if (ttd < 0)
|
|
ttd = 0;
|
|
|
|
seq_printf(seq,
|
|
"%4d: %08X%08X%08X%08X:%04X %08X%08X%08X%08X:%04X "
|
|
"%02X %08X:%08X %02X:%08lX %08X %5d %8d %d %d %p\n",
|
|
i,
|
|
src->s6_addr32[0], src->s6_addr32[1],
|
|
src->s6_addr32[2], src->s6_addr32[3],
|
|
ntohs(inet_sk(sk)->sport),
|
|
dest->s6_addr32[0], dest->s6_addr32[1],
|
|
dest->s6_addr32[2], dest->s6_addr32[3],
|
|
ntohs(inet_rsk(req)->rmt_port),
|
|
TCP_SYN_RECV,
|
|
0,0, /* could print option size, but that is af dependent. */
|
|
1, /* timers active (only the expire timer) */
|
|
jiffies_to_clock_t(ttd),
|
|
req->retrans,
|
|
uid,
|
|
0, /* non standard timer */
|
|
0, /* open_requests have no inode */
|
|
0, req);
|
|
}
|
|
|
|
static void get_tcp6_sock(struct seq_file *seq, struct sock *sp, int i)
|
|
{
|
|
struct in6_addr *dest, *src;
|
|
__u16 destp, srcp;
|
|
int timer_active;
|
|
unsigned long timer_expires;
|
|
struct inet_sock *inet = inet_sk(sp);
|
|
struct tcp_sock *tp = tcp_sk(sp);
|
|
const struct inet_connection_sock *icsk = inet_csk(sp);
|
|
struct ipv6_pinfo *np = inet6_sk(sp);
|
|
|
|
dest = &np->daddr;
|
|
src = &np->rcv_saddr;
|
|
destp = ntohs(inet->dport);
|
|
srcp = ntohs(inet->sport);
|
|
|
|
if (icsk->icsk_pending == ICSK_TIME_RETRANS) {
|
|
timer_active = 1;
|
|
timer_expires = icsk->icsk_timeout;
|
|
} else if (icsk->icsk_pending == ICSK_TIME_PROBE0) {
|
|
timer_active = 4;
|
|
timer_expires = icsk->icsk_timeout;
|
|
} else if (timer_pending(&sp->sk_timer)) {
|
|
timer_active = 2;
|
|
timer_expires = sp->sk_timer.expires;
|
|
} else {
|
|
timer_active = 0;
|
|
timer_expires = jiffies;
|
|
}
|
|
|
|
seq_printf(seq,
|
|
"%4d: %08X%08X%08X%08X:%04X %08X%08X%08X%08X:%04X "
|
|
"%02X %08X:%08X %02X:%08lX %08X %5d %8d %lu %d %p %u %u %u %u %d\n",
|
|
i,
|
|
src->s6_addr32[0], src->s6_addr32[1],
|
|
src->s6_addr32[2], src->s6_addr32[3], srcp,
|
|
dest->s6_addr32[0], dest->s6_addr32[1],
|
|
dest->s6_addr32[2], dest->s6_addr32[3], destp,
|
|
sp->sk_state,
|
|
tp->write_seq-tp->snd_una,
|
|
(sp->sk_state == TCP_LISTEN) ? sp->sk_ack_backlog : (tp->rcv_nxt - tp->copied_seq),
|
|
timer_active,
|
|
jiffies_to_clock_t(timer_expires - jiffies),
|
|
icsk->icsk_retransmits,
|
|
sock_i_uid(sp),
|
|
icsk->icsk_probes_out,
|
|
sock_i_ino(sp),
|
|
atomic_read(&sp->sk_refcnt), sp,
|
|
icsk->icsk_rto,
|
|
icsk->icsk_ack.ato,
|
|
(icsk->icsk_ack.quick << 1 ) | icsk->icsk_ack.pingpong,
|
|
tp->snd_cwnd, tp->snd_ssthresh>=0xFFFF?-1:tp->snd_ssthresh
|
|
);
|
|
}
|
|
|
|
static void get_timewait6_sock(struct seq_file *seq,
|
|
struct inet_timewait_sock *tw, int i)
|
|
{
|
|
struct in6_addr *dest, *src;
|
|
__u16 destp, srcp;
|
|
struct inet6_timewait_sock *tw6 = inet6_twsk((struct sock *)tw);
|
|
int ttd = tw->tw_ttd - jiffies;
|
|
|
|
if (ttd < 0)
|
|
ttd = 0;
|
|
|
|
dest = &tw6->tw_v6_daddr;
|
|
src = &tw6->tw_v6_rcv_saddr;
|
|
destp = ntohs(tw->tw_dport);
|
|
srcp = ntohs(tw->tw_sport);
|
|
|
|
seq_printf(seq,
|
|
"%4d: %08X%08X%08X%08X:%04X %08X%08X%08X%08X:%04X "
|
|
"%02X %08X:%08X %02X:%08lX %08X %5d %8d %d %d %p\n",
|
|
i,
|
|
src->s6_addr32[0], src->s6_addr32[1],
|
|
src->s6_addr32[2], src->s6_addr32[3], srcp,
|
|
dest->s6_addr32[0], dest->s6_addr32[1],
|
|
dest->s6_addr32[2], dest->s6_addr32[3], destp,
|
|
tw->tw_substate, 0, 0,
|
|
3, jiffies_to_clock_t(ttd), 0, 0, 0, 0,
|
|
atomic_read(&tw->tw_refcnt), tw);
|
|
}
|
|
|
|
#ifdef CONFIG_PROC_FS
|
|
static int tcp6_seq_show(struct seq_file *seq, void *v)
|
|
{
|
|
struct tcp_iter_state *st;
|
|
|
|
if (v == SEQ_START_TOKEN) {
|
|
seq_puts(seq,
|
|
" sl "
|
|
"local_address "
|
|
"remote_address "
|
|
"st tx_queue rx_queue tr tm->when retrnsmt"
|
|
" uid timeout inode\n");
|
|
goto out;
|
|
}
|
|
st = seq->private;
|
|
|
|
switch (st->state) {
|
|
case TCP_SEQ_STATE_LISTENING:
|
|
case TCP_SEQ_STATE_ESTABLISHED:
|
|
get_tcp6_sock(seq, v, st->num);
|
|
break;
|
|
case TCP_SEQ_STATE_OPENREQ:
|
|
get_openreq6(seq, st->syn_wait_sk, v, st->num, st->uid);
|
|
break;
|
|
case TCP_SEQ_STATE_TIME_WAIT:
|
|
get_timewait6_sock(seq, v, st->num);
|
|
break;
|
|
}
|
|
out:
|
|
return 0;
|
|
}
|
|
|
|
static struct file_operations tcp6_seq_fops;
|
|
static struct tcp_seq_afinfo tcp6_seq_afinfo = {
|
|
.owner = THIS_MODULE,
|
|
.name = "tcp6",
|
|
.family = AF_INET6,
|
|
.seq_show = tcp6_seq_show,
|
|
.seq_fops = &tcp6_seq_fops,
|
|
};
|
|
|
|
int __init tcp6_proc_init(void)
|
|
{
|
|
return tcp_proc_register(&tcp6_seq_afinfo);
|
|
}
|
|
|
|
void tcp6_proc_exit(void)
|
|
{
|
|
tcp_proc_unregister(&tcp6_seq_afinfo);
|
|
}
|
|
#endif
|
|
|
|
struct proto tcpv6_prot = {
|
|
.name = "TCPv6",
|
|
.owner = THIS_MODULE,
|
|
.close = tcp_close,
|
|
.connect = tcp_v6_connect,
|
|
.disconnect = tcp_disconnect,
|
|
.accept = inet_csk_accept,
|
|
.ioctl = tcp_ioctl,
|
|
.init = tcp_v6_init_sock,
|
|
.destroy = tcp_v6_destroy_sock,
|
|
.shutdown = tcp_shutdown,
|
|
.setsockopt = tcp_setsockopt,
|
|
.getsockopt = tcp_getsockopt,
|
|
.sendmsg = tcp_sendmsg,
|
|
.recvmsg = tcp_recvmsg,
|
|
.backlog_rcv = tcp_v6_do_rcv,
|
|
.hash = tcp_v6_hash,
|
|
.unhash = tcp_unhash,
|
|
.get_port = tcp_v6_get_port,
|
|
.enter_memory_pressure = tcp_enter_memory_pressure,
|
|
.sockets_allocated = &tcp_sockets_allocated,
|
|
.memory_allocated = &tcp_memory_allocated,
|
|
.memory_pressure = &tcp_memory_pressure,
|
|
.orphan_count = &tcp_orphan_count,
|
|
.sysctl_mem = sysctl_tcp_mem,
|
|
.sysctl_wmem = sysctl_tcp_wmem,
|
|
.sysctl_rmem = sysctl_tcp_rmem,
|
|
.max_header = MAX_TCP_HEADER,
|
|
.obj_size = sizeof(struct tcp6_sock),
|
|
.twsk_prot = &tcp6_timewait_sock_ops,
|
|
.rsk_prot = &tcp6_request_sock_ops,
|
|
#ifdef CONFIG_COMPAT
|
|
.compat_setsockopt = compat_tcp_setsockopt,
|
|
.compat_getsockopt = compat_tcp_getsockopt,
|
|
#endif
|
|
};
|
|
|
|
static struct inet6_protocol tcpv6_protocol = {
|
|
.handler = tcp_v6_rcv,
|
|
.err_handler = tcp_v6_err,
|
|
.gso_send_check = tcp_v6_gso_send_check,
|
|
.gso_segment = tcp_tso_segment,
|
|
.flags = INET6_PROTO_NOPOLICY|INET6_PROTO_FINAL,
|
|
};
|
|
|
|
static struct inet_protosw tcpv6_protosw = {
|
|
.type = SOCK_STREAM,
|
|
.protocol = IPPROTO_TCP,
|
|
.prot = &tcpv6_prot,
|
|
.ops = &inet6_stream_ops,
|
|
.capability = -1,
|
|
.no_check = 0,
|
|
.flags = INET_PROTOSW_PERMANENT |
|
|
INET_PROTOSW_ICSK,
|
|
};
|
|
|
|
void __init tcpv6_init(void)
|
|
{
|
|
/* register inet6 protocol */
|
|
if (inet6_add_protocol(&tcpv6_protocol, IPPROTO_TCP) < 0)
|
|
printk(KERN_ERR "tcpv6_init: Could not register protocol\n");
|
|
inet6_register_protosw(&tcpv6_protosw);
|
|
|
|
if (inet_csk_ctl_sock_create(&tcp6_socket, PF_INET6, SOCK_RAW,
|
|
IPPROTO_TCP) < 0)
|
|
panic("Failed to create the TCPv6 control socket.\n");
|
|
}
|