1 /*
2  * Copyright (c) 2016 Chelsio Communications, Inc. All rights reserved.
3  *
4  * This software is available to you under a choice of one of two
5  * licenses.  You may choose to be licensed under the terms of the GNU
6  * General Public License (GPL) Version 2, available from the file
7  * COPYING in the main directory of this source tree, or the
8  * OpenIB.org BSD license below:
9  *
10  *     Redistribution and use in source and binary forms, with or
11  *     without modification, are permitted provided that the following
12  *     conditions are met:
13  *
14  *      - Redistributions of source code must retain the above
15  *	  copyright notice, this list of conditions and the following
16  *	  disclaimer.
17  *
18  *      - Redistributions in binary form must reproduce the above
19  *	  copyright notice, this list of conditions and the following
20  *	  disclaimer in the documentation and/or other materials
21  *	  provided with the distribution.
22  *
23  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
24  * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
25  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
26  * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
27  * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
28  * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
29  * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
30  * SOFTWARE.
31  */
32 
33 #include <linux/tcp.h>
34 #include <linux/ipv6.h>
35 #include <net/inet_ecn.h>
36 #include <net/route.h>
37 #include <net/ip6_route.h>
38 
39 #include "libcxgb_cm.h"
40 
41 void
cxgb_get_4tuple(struct cpl_pass_accept_req * req,enum chip_type type,int * iptype,__u8 * local_ip,__u8 * peer_ip,__be16 * local_port,__be16 * peer_port)42 cxgb_get_4tuple(struct cpl_pass_accept_req *req, enum chip_type type,
43 		int *iptype, __u8 *local_ip, __u8 *peer_ip,
44 		__be16 *local_port, __be16 *peer_port)
45 {
46 	int eth_len = (CHELSIO_CHIP_VERSION(type) <= CHELSIO_T5) ?
47 		      ETH_HDR_LEN_G(be32_to_cpu(req->hdr_len)) :
48 		      T6_ETH_HDR_LEN_G(be32_to_cpu(req->hdr_len));
49 	int ip_len = (CHELSIO_CHIP_VERSION(type) <= CHELSIO_T5) ?
50 		     IP_HDR_LEN_G(be32_to_cpu(req->hdr_len)) :
51 		     T6_IP_HDR_LEN_G(be32_to_cpu(req->hdr_len));
52 	struct iphdr *ip = (struct iphdr *)((u8 *)(req + 1) + eth_len);
53 	struct ipv6hdr *ip6 = (struct ipv6hdr *)((u8 *)(req + 1) + eth_len);
54 	struct tcphdr *tcp = (struct tcphdr *)
55 			     ((u8 *)(req + 1) + eth_len + ip_len);
56 
57 	if (ip->version == 4) {
58 		pr_debug("%s saddr 0x%x daddr 0x%x sport %u dport %u\n",
59 			 __func__, ntohl(ip->saddr), ntohl(ip->daddr),
60 			 ntohs(tcp->source), ntohs(tcp->dest));
61 		*iptype = 4;
62 		memcpy(peer_ip, &ip->saddr, 4);
63 		memcpy(local_ip, &ip->daddr, 4);
64 	} else {
65 		pr_debug("%s saddr %pI6 daddr %pI6 sport %u dport %u\n",
66 			 __func__, ip6->saddr.s6_addr, ip6->daddr.s6_addr,
67 			 ntohs(tcp->source), ntohs(tcp->dest));
68 		*iptype = 6;
69 		memcpy(peer_ip, ip6->saddr.s6_addr, 16);
70 		memcpy(local_ip, ip6->daddr.s6_addr, 16);
71 	}
72 	*peer_port = tcp->source;
73 	*local_port = tcp->dest;
74 }
75 EXPORT_SYMBOL(cxgb_get_4tuple);
76 
77 static bool
cxgb_our_interface(struct cxgb4_lld_info * lldi,struct net_device * (* get_real_dev)(struct net_device *),struct net_device * egress_dev)78 cxgb_our_interface(struct cxgb4_lld_info *lldi,
79 		   struct net_device *(*get_real_dev)(struct net_device *),
80 		   struct net_device *egress_dev)
81 {
82 	int i;
83 
84 	egress_dev = get_real_dev(egress_dev);
85 	for (i = 0; i < lldi->nports; i++)
86 		if (lldi->ports[i] == egress_dev)
87 			return true;
88 	return false;
89 }
90 
91 struct dst_entry *
cxgb_find_route(struct cxgb4_lld_info * lldi,struct net_device * (* get_real_dev)(struct net_device *),__be32 local_ip,__be32 peer_ip,__be16 local_port,__be16 peer_port,u8 tos)92 cxgb_find_route(struct cxgb4_lld_info *lldi,
93 		struct net_device *(*get_real_dev)(struct net_device *),
94 		__be32 local_ip, __be32 peer_ip, __be16 local_port,
95 		__be16 peer_port, u8 tos)
96 {
97 	struct rtable *rt;
98 	struct flowi4 fl4;
99 	struct neighbour *n;
100 
101 	rt = ip_route_output_ports(&init_net, &fl4, NULL, peer_ip, local_ip,
102 				   peer_port, local_port, IPPROTO_TCP,
103 				   tos & ~INET_ECN_MASK, 0);
104 	if (IS_ERR(rt))
105 		return NULL;
106 	n = dst_neigh_lookup(&rt->dst, &peer_ip);
107 	if (!n)
108 		return NULL;
109 	if (!cxgb_our_interface(lldi, get_real_dev, n->dev) &&
110 	    !(n->dev->flags & IFF_LOOPBACK)) {
111 		neigh_release(n);
112 		dst_release(&rt->dst);
113 		return NULL;
114 	}
115 	neigh_release(n);
116 	return &rt->dst;
117 }
118 EXPORT_SYMBOL(cxgb_find_route);
119 
120 struct dst_entry *
cxgb_find_route6(struct cxgb4_lld_info * lldi,struct net_device * (* get_real_dev)(struct net_device *),__u8 * local_ip,__u8 * peer_ip,__be16 local_port,__be16 peer_port,u8 tos,__u32 sin6_scope_id)121 cxgb_find_route6(struct cxgb4_lld_info *lldi,
122 		 struct net_device *(*get_real_dev)(struct net_device *),
123 		 __u8 *local_ip, __u8 *peer_ip, __be16 local_port,
124 		 __be16 peer_port, u8 tos, __u32 sin6_scope_id)
125 {
126 	struct dst_entry *dst = NULL;
127 
128 	if (IS_ENABLED(CONFIG_IPV6)) {
129 		struct flowi6 fl6;
130 
131 		memset(&fl6, 0, sizeof(fl6));
132 		memcpy(&fl6.daddr, peer_ip, 16);
133 		memcpy(&fl6.saddr, local_ip, 16);
134 		if (ipv6_addr_type(&fl6.daddr) & IPV6_ADDR_LINKLOCAL)
135 			fl6.flowi6_oif = sin6_scope_id;
136 		dst = ip6_route_output(&init_net, NULL, &fl6);
137 		if (dst->error ||
138 		    (!cxgb_our_interface(lldi, get_real_dev,
139 					 ip6_dst_idev(dst)->dev) &&
140 		     !(ip6_dst_idev(dst)->dev->flags & IFF_LOOPBACK))) {
141 			dst_release(dst);
142 			return NULL;
143 		}
144 	}
145 
146 	return dst;
147 }
148 EXPORT_SYMBOL(cxgb_find_route6);
149