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 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 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 * 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 * 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