162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-or-later
262306a36Sopenharmony_ci/*
362306a36Sopenharmony_ci * INET        An implementation of the TCP/IP protocol suite for the LINUX
462306a36Sopenharmony_ci *             operating system.  INET is implemented using the  BSD Socket
562306a36Sopenharmony_ci *             interface as the means of communication with the user level.
662306a36Sopenharmony_ci *
762306a36Sopenharmony_ci *             Support for INET6 connection oriented protocols.
862306a36Sopenharmony_ci *
962306a36Sopenharmony_ci * Authors:    See the TCPv6 sources
1062306a36Sopenharmony_ci */
1162306a36Sopenharmony_ci
1262306a36Sopenharmony_ci#include <linux/module.h>
1362306a36Sopenharmony_ci#include <linux/in6.h>
1462306a36Sopenharmony_ci#include <linux/ipv6.h>
1562306a36Sopenharmony_ci#include <linux/jhash.h>
1662306a36Sopenharmony_ci#include <linux/slab.h>
1762306a36Sopenharmony_ci
1862306a36Sopenharmony_ci#include <net/addrconf.h>
1962306a36Sopenharmony_ci#include <net/inet_connection_sock.h>
2062306a36Sopenharmony_ci#include <net/inet_ecn.h>
2162306a36Sopenharmony_ci#include <net/inet_hashtables.h>
2262306a36Sopenharmony_ci#include <net/ip6_route.h>
2362306a36Sopenharmony_ci#include <net/sock.h>
2462306a36Sopenharmony_ci#include <net/inet6_connection_sock.h>
2562306a36Sopenharmony_ci#include <net/sock_reuseport.h>
2662306a36Sopenharmony_ci
2762306a36Sopenharmony_cistruct dst_entry *inet6_csk_route_req(const struct sock *sk,
2862306a36Sopenharmony_ci				      struct flowi6 *fl6,
2962306a36Sopenharmony_ci				      const struct request_sock *req,
3062306a36Sopenharmony_ci				      u8 proto)
3162306a36Sopenharmony_ci{
3262306a36Sopenharmony_ci	struct inet_request_sock *ireq = inet_rsk(req);
3362306a36Sopenharmony_ci	const struct ipv6_pinfo *np = inet6_sk(sk);
3462306a36Sopenharmony_ci	struct in6_addr *final_p, final;
3562306a36Sopenharmony_ci	struct dst_entry *dst;
3662306a36Sopenharmony_ci
3762306a36Sopenharmony_ci	memset(fl6, 0, sizeof(*fl6));
3862306a36Sopenharmony_ci	fl6->flowi6_proto = proto;
3962306a36Sopenharmony_ci	fl6->daddr = ireq->ir_v6_rmt_addr;
4062306a36Sopenharmony_ci	rcu_read_lock();
4162306a36Sopenharmony_ci	final_p = fl6_update_dst(fl6, rcu_dereference(np->opt), &final);
4262306a36Sopenharmony_ci	rcu_read_unlock();
4362306a36Sopenharmony_ci	fl6->saddr = ireq->ir_v6_loc_addr;
4462306a36Sopenharmony_ci	fl6->flowi6_oif = ireq->ir_iif;
4562306a36Sopenharmony_ci	fl6->flowi6_mark = ireq->ir_mark;
4662306a36Sopenharmony_ci	fl6->fl6_dport = ireq->ir_rmt_port;
4762306a36Sopenharmony_ci	fl6->fl6_sport = htons(ireq->ir_num);
4862306a36Sopenharmony_ci	fl6->flowi6_uid = sk->sk_uid;
4962306a36Sopenharmony_ci	security_req_classify_flow(req, flowi6_to_flowi_common(fl6));
5062306a36Sopenharmony_ci
5162306a36Sopenharmony_ci	dst = ip6_dst_lookup_flow(sock_net(sk), sk, fl6, final_p);
5262306a36Sopenharmony_ci	if (IS_ERR(dst))
5362306a36Sopenharmony_ci		return NULL;
5462306a36Sopenharmony_ci
5562306a36Sopenharmony_ci	return dst;
5662306a36Sopenharmony_ci}
5762306a36Sopenharmony_ciEXPORT_SYMBOL(inet6_csk_route_req);
5862306a36Sopenharmony_ci
5962306a36Sopenharmony_civoid inet6_csk_addr2sockaddr(struct sock *sk, struct sockaddr *uaddr)
6062306a36Sopenharmony_ci{
6162306a36Sopenharmony_ci	struct sockaddr_in6 *sin6 = (struct sockaddr_in6 *) uaddr;
6262306a36Sopenharmony_ci
6362306a36Sopenharmony_ci	sin6->sin6_family = AF_INET6;
6462306a36Sopenharmony_ci	sin6->sin6_addr = sk->sk_v6_daddr;
6562306a36Sopenharmony_ci	sin6->sin6_port	= inet_sk(sk)->inet_dport;
6662306a36Sopenharmony_ci	/* We do not store received flowlabel for TCP */
6762306a36Sopenharmony_ci	sin6->sin6_flowinfo = 0;
6862306a36Sopenharmony_ci	sin6->sin6_scope_id = ipv6_iface_scope_id(&sin6->sin6_addr,
6962306a36Sopenharmony_ci						  sk->sk_bound_dev_if);
7062306a36Sopenharmony_ci}
7162306a36Sopenharmony_ciEXPORT_SYMBOL_GPL(inet6_csk_addr2sockaddr);
7262306a36Sopenharmony_ci
7362306a36Sopenharmony_cistatic inline
7462306a36Sopenharmony_cistruct dst_entry *__inet6_csk_dst_check(struct sock *sk, u32 cookie)
7562306a36Sopenharmony_ci{
7662306a36Sopenharmony_ci	return __sk_dst_check(sk, cookie);
7762306a36Sopenharmony_ci}
7862306a36Sopenharmony_ci
7962306a36Sopenharmony_cistatic struct dst_entry *inet6_csk_route_socket(struct sock *sk,
8062306a36Sopenharmony_ci						struct flowi6 *fl6)
8162306a36Sopenharmony_ci{
8262306a36Sopenharmony_ci	struct inet_sock *inet = inet_sk(sk);
8362306a36Sopenharmony_ci	struct ipv6_pinfo *np = inet6_sk(sk);
8462306a36Sopenharmony_ci	struct in6_addr *final_p, final;
8562306a36Sopenharmony_ci	struct dst_entry *dst;
8662306a36Sopenharmony_ci
8762306a36Sopenharmony_ci	memset(fl6, 0, sizeof(*fl6));
8862306a36Sopenharmony_ci	fl6->flowi6_proto = sk->sk_protocol;
8962306a36Sopenharmony_ci	fl6->daddr = sk->sk_v6_daddr;
9062306a36Sopenharmony_ci	fl6->saddr = np->saddr;
9162306a36Sopenharmony_ci	fl6->flowlabel = np->flow_label;
9262306a36Sopenharmony_ci	IP6_ECN_flow_xmit(sk, fl6->flowlabel);
9362306a36Sopenharmony_ci	fl6->flowi6_oif = sk->sk_bound_dev_if;
9462306a36Sopenharmony_ci	fl6->flowi6_mark = sk->sk_mark;
9562306a36Sopenharmony_ci	fl6->fl6_sport = inet->inet_sport;
9662306a36Sopenharmony_ci	fl6->fl6_dport = inet->inet_dport;
9762306a36Sopenharmony_ci	fl6->flowi6_uid = sk->sk_uid;
9862306a36Sopenharmony_ci	security_sk_classify_flow(sk, flowi6_to_flowi_common(fl6));
9962306a36Sopenharmony_ci
10062306a36Sopenharmony_ci	rcu_read_lock();
10162306a36Sopenharmony_ci	final_p = fl6_update_dst(fl6, rcu_dereference(np->opt), &final);
10262306a36Sopenharmony_ci	rcu_read_unlock();
10362306a36Sopenharmony_ci
10462306a36Sopenharmony_ci	dst = __inet6_csk_dst_check(sk, np->dst_cookie);
10562306a36Sopenharmony_ci	if (!dst) {
10662306a36Sopenharmony_ci		dst = ip6_dst_lookup_flow(sock_net(sk), sk, fl6, final_p);
10762306a36Sopenharmony_ci
10862306a36Sopenharmony_ci		if (!IS_ERR(dst))
10962306a36Sopenharmony_ci			ip6_dst_store(sk, dst, NULL, NULL);
11062306a36Sopenharmony_ci	}
11162306a36Sopenharmony_ci	return dst;
11262306a36Sopenharmony_ci}
11362306a36Sopenharmony_ci
11462306a36Sopenharmony_ciint inet6_csk_xmit(struct sock *sk, struct sk_buff *skb, struct flowi *fl_unused)
11562306a36Sopenharmony_ci{
11662306a36Sopenharmony_ci	struct ipv6_pinfo *np = inet6_sk(sk);
11762306a36Sopenharmony_ci	struct flowi6 fl6;
11862306a36Sopenharmony_ci	struct dst_entry *dst;
11962306a36Sopenharmony_ci	int res;
12062306a36Sopenharmony_ci
12162306a36Sopenharmony_ci	dst = inet6_csk_route_socket(sk, &fl6);
12262306a36Sopenharmony_ci	if (IS_ERR(dst)) {
12362306a36Sopenharmony_ci		WRITE_ONCE(sk->sk_err_soft, -PTR_ERR(dst));
12462306a36Sopenharmony_ci		sk->sk_route_caps = 0;
12562306a36Sopenharmony_ci		kfree_skb(skb);
12662306a36Sopenharmony_ci		return PTR_ERR(dst);
12762306a36Sopenharmony_ci	}
12862306a36Sopenharmony_ci
12962306a36Sopenharmony_ci	rcu_read_lock();
13062306a36Sopenharmony_ci	skb_dst_set_noref(skb, dst);
13162306a36Sopenharmony_ci
13262306a36Sopenharmony_ci	/* Restore final destination back after routing done */
13362306a36Sopenharmony_ci	fl6.daddr = sk->sk_v6_daddr;
13462306a36Sopenharmony_ci
13562306a36Sopenharmony_ci	res = ip6_xmit(sk, skb, &fl6, sk->sk_mark, rcu_dereference(np->opt),
13662306a36Sopenharmony_ci		       np->tclass,  sk->sk_priority);
13762306a36Sopenharmony_ci	rcu_read_unlock();
13862306a36Sopenharmony_ci	return res;
13962306a36Sopenharmony_ci}
14062306a36Sopenharmony_ciEXPORT_SYMBOL_GPL(inet6_csk_xmit);
14162306a36Sopenharmony_ci
14262306a36Sopenharmony_cistruct dst_entry *inet6_csk_update_pmtu(struct sock *sk, u32 mtu)
14362306a36Sopenharmony_ci{
14462306a36Sopenharmony_ci	struct flowi6 fl6;
14562306a36Sopenharmony_ci	struct dst_entry *dst = inet6_csk_route_socket(sk, &fl6);
14662306a36Sopenharmony_ci
14762306a36Sopenharmony_ci	if (IS_ERR(dst))
14862306a36Sopenharmony_ci		return NULL;
14962306a36Sopenharmony_ci	dst->ops->update_pmtu(dst, sk, NULL, mtu, true);
15062306a36Sopenharmony_ci
15162306a36Sopenharmony_ci	dst = inet6_csk_route_socket(sk, &fl6);
15262306a36Sopenharmony_ci	return IS_ERR(dst) ? NULL : dst;
15362306a36Sopenharmony_ci}
15462306a36Sopenharmony_ciEXPORT_SYMBOL_GPL(inet6_csk_update_pmtu);
155