Neale Ranns | e403113 | 2020-10-26 13:00:06 +0000 | [diff] [blame] | 1 | /* |
| 2 | * Copyright (c) 2016 Cisco and/or its affiliates. |
| 3 | * Licensed under the Apache License, Version 2.0 (the "License"); |
| 4 | * you may not use this file except in compliance with the License. |
| 5 | * You may obtain a copy of the License at: |
| 6 | * |
| 7 | * http://www.apache.org/licenses/LICENSE-2.0 |
| 8 | * |
| 9 | * Unless required by applicable law or agreed to in writing, software |
| 10 | * distributed under the License is distributed on an "AS IS" BASIS, |
| 11 | * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. |
| 12 | * See the License for the specific language governing permissions and |
| 13 | * limitations under the License. |
| 14 | */ |
| 15 | /* |
| 16 | * ip/ip6.h: ip6 main include file |
| 17 | * |
| 18 | * Copyright (c) 2008 Eliot Dresselhaus |
| 19 | * |
| 20 | * Permission is hereby granted, free of charge, to any person obtaining |
| 21 | * a copy of this software and associated documentation files (the |
| 22 | * "Software"), to deal in the Software without restriction, including |
| 23 | * without limitation the rights to use, copy, modify, merge, publish, |
| 24 | * distribute, sublicense, and/or sell copies of the Software, and to |
| 25 | * permit persons to whom the Software is furnished to do so, subject to |
| 26 | * the following conditions: |
| 27 | * |
| 28 | * The above copyright notice and this permission notice shall be |
| 29 | * included in all copies or substantial portions of the Software. |
| 30 | * |
| 31 | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, |
| 32 | * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF |
| 33 | * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND |
| 34 | * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE |
| 35 | * LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION |
| 36 | * OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION |
| 37 | * WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. |
| 38 | */ |
| 39 | |
| 40 | #ifndef included_ip_ip6_inlines_h |
| 41 | #define included_ip_ip6_inlines_h |
| 42 | |
| 43 | #include <vnet/ip/ip6_packet.h> |
| 44 | #include <vnet/ip/ip6_hop_by_hop_packet.h> |
| 45 | |
| 46 | /* Compute flow hash. We'll use it to select which Sponge to use for this |
| 47 | flow. And other things. */ |
| 48 | always_inline u32 |
| 49 | ip6_compute_flow_hash (const ip6_header_t * ip, |
| 50 | flow_hash_config_t flow_hash_config) |
| 51 | { |
| 52 | tcp_header_t *tcp; |
| 53 | u64 a, b, c; |
| 54 | u64 t1, t2; |
| 55 | uword is_tcp_udp = 0; |
| 56 | u8 protocol = ip->protocol; |
| 57 | |
| 58 | if (PREDICT_TRUE |
| 59 | ((ip->protocol == IP_PROTOCOL_TCP) |
| 60 | || (ip->protocol == IP_PROTOCOL_UDP))) |
| 61 | { |
| 62 | is_tcp_udp = 1; |
| 63 | tcp = (void *) (ip + 1); |
| 64 | } |
| 65 | else if (ip->protocol == IP_PROTOCOL_IP6_HOP_BY_HOP_OPTIONS) |
| 66 | { |
| 67 | ip6_hop_by_hop_header_t *hbh = (ip6_hop_by_hop_header_t *) (ip + 1); |
| 68 | if ((hbh->protocol == IP_PROTOCOL_TCP) || |
| 69 | (hbh->protocol == IP_PROTOCOL_UDP)) |
| 70 | { |
| 71 | is_tcp_udp = 1; |
| 72 | tcp = (tcp_header_t *) ((u8 *) hbh + ((hbh->length + 1) << 3)); |
| 73 | } |
| 74 | protocol = hbh->protocol; |
| 75 | } |
| 76 | |
| 77 | t1 = (ip->src_address.as_u64[0] ^ ip->src_address.as_u64[1]); |
| 78 | t1 = (flow_hash_config & IP_FLOW_HASH_SRC_ADDR) ? t1 : 0; |
| 79 | |
| 80 | t2 = (ip->dst_address.as_u64[0] ^ ip->dst_address.as_u64[1]); |
| 81 | t2 = (flow_hash_config & IP_FLOW_HASH_DST_ADDR) ? t2 : 0; |
| 82 | |
| 83 | a = (flow_hash_config & IP_FLOW_HASH_REVERSE_SRC_DST) ? t2 : t1; |
| 84 | b = (flow_hash_config & IP_FLOW_HASH_REVERSE_SRC_DST) ? t1 : t2; |
| 85 | |
| 86 | t1 = is_tcp_udp ? tcp->src : 0; |
| 87 | t2 = is_tcp_udp ? tcp->dst : 0; |
| 88 | |
| 89 | t1 = (flow_hash_config & IP_FLOW_HASH_SRC_PORT) ? t1 : 0; |
| 90 | t2 = (flow_hash_config & IP_FLOW_HASH_DST_PORT) ? t2 : 0; |
| 91 | |
| 92 | if (flow_hash_config & IP_FLOW_HASH_SYMMETRIC) |
| 93 | { |
| 94 | if (b < a) |
| 95 | { |
| 96 | c = a; |
| 97 | a = b; |
| 98 | b = c; |
| 99 | } |
| 100 | if (t2 < t1) |
| 101 | { |
| 102 | t2 += t1; |
| 103 | t1 = t2 - t1; |
| 104 | t2 = t2 - t1; |
| 105 | } |
| 106 | } |
| 107 | |
| 108 | b ^= (flow_hash_config & IP_FLOW_HASH_PROTO) ? protocol : 0; |
Neale Ranns | 3d5f08a | 2021-01-22 16:12:38 +0000 | [diff] [blame] | 109 | c = ((flow_hash_config & IP_FLOW_HASH_REVERSE_SRC_DST) ? ((t1 << 16) | t2) : |
| 110 | ((t2 << 16) | t1)); |
| 111 | t1 = ((u64) ip_flow_hash_router_id << 32); |
| 112 | t1 |= |
| 113 | ((flow_hash_config & IP_FLOW_HASH_FL) ? ip6_flow_label_network_order (ip) : |
| 114 | 0); |
| 115 | c ^= t1; |
Neale Ranns | e403113 | 2020-10-26 13:00:06 +0000 | [diff] [blame] | 116 | |
| 117 | hash_mix64 (a, b, c); |
| 118 | return (u32) c; |
| 119 | } |
| 120 | |
| 121 | /* ip6_locate_header |
| 122 | * |
| 123 | * This function is to search for the header specified by the protocol number |
| 124 | * in find_hdr_type. |
| 125 | * This is used to locate a specific IPv6 extension header |
| 126 | * or to find transport layer header. |
| 127 | * 1. If the find_hdr_type < 0 then it finds and returns the protocol number and |
| 128 | * offset stored in *offset of the transport or ESP header in the chain if |
| 129 | * found. |
| 130 | * 2. If a header with find_hdr_type > 0 protocol number is found then the |
| 131 | * offset is stored in *offset and protocol number of the header is |
| 132 | * returned. |
| 133 | * 3. If find_hdr_type is not found or packet is malformed or |
| 134 | * it is a non-first fragment -1 is returned. |
| 135 | */ |
| 136 | always_inline int |
Ole Troan | 03092c1 | 2021-11-23 15:55:39 +0100 | [diff] [blame] | 137 | ip6_locate_header (vlib_buffer_t *b, ip6_header_t *ip, int find_hdr_type, |
| 138 | u32 *offset) |
Neale Ranns | e403113 | 2020-10-26 13:00:06 +0000 | [diff] [blame] | 139 | { |
Ole Troan | 03092c1 | 2021-11-23 15:55:39 +0100 | [diff] [blame] | 140 | ip6_ext_hdr_chain_t hdr_chain; |
| 141 | int res = ip6_ext_header_walk (b, ip, find_hdr_type, &hdr_chain); |
| 142 | if (res >= 0) |
Neale Ranns | e403113 | 2020-10-26 13:00:06 +0000 | [diff] [blame] | 143 | { |
Ole Troan | 03092c1 | 2021-11-23 15:55:39 +0100 | [diff] [blame] | 144 | *offset = hdr_chain.eh[res].offset; |
| 145 | return hdr_chain.eh[res].protocol; |
Neale Ranns | e403113 | 2020-10-26 13:00:06 +0000 | [diff] [blame] | 146 | } |
Ole Troan | 03092c1 | 2021-11-23 15:55:39 +0100 | [diff] [blame] | 147 | return -1; |
Neale Ranns | e403113 | 2020-10-26 13:00:06 +0000 | [diff] [blame] | 148 | } |
| 149 | |
| 150 | |
| 151 | /** |
| 152 | * Push IPv6 header to buffer |
| 153 | * |
| 154 | * @param vm - vlib_main |
| 155 | * @param b - buffer to write the header to |
| 156 | * @param src - source IP |
| 157 | * @param dst - destination IP |
| 158 | * @param prot - payload proto |
| 159 | * @param flow_label - flow label |
| 160 | * |
| 161 | * @return - pointer to start of IP header |
| 162 | */ |
| 163 | always_inline void * |
| 164 | vlib_buffer_push_ip6_custom (vlib_main_t * vm, vlib_buffer_t * b, |
| 165 | ip6_address_t * src, ip6_address_t * dst, |
| 166 | int proto, u32 flow_label) |
| 167 | { |
| 168 | ip6_header_t *ip6h; |
| 169 | u16 payload_length; |
| 170 | |
| 171 | /* make some room */ |
| 172 | ip6h = vlib_buffer_push_uninit (b, sizeof (ip6_header_t)); |
| 173 | ASSERT (flow_label < 1 << 20); |
| 174 | ip6h->ip_version_traffic_class_and_flow_label = |
| 175 | clib_host_to_net_u32 ((0x6 << 28) | flow_label); |
| 176 | |
| 177 | /* calculate ip6 payload length */ |
| 178 | payload_length = vlib_buffer_length_in_chain (vm, b); |
| 179 | payload_length -= sizeof (*ip6h); |
| 180 | |
| 181 | ip6h->payload_length = clib_host_to_net_u16 (payload_length); |
| 182 | |
| 183 | ip6h->hop_limit = 0xff; |
| 184 | ip6h->protocol = proto; |
| 185 | clib_memcpy_fast (ip6h->src_address.as_u8, src->as_u8, |
| 186 | sizeof (ip6h->src_address)); |
| 187 | clib_memcpy_fast (ip6h->dst_address.as_u8, dst->as_u8, |
| 188 | sizeof (ip6h->src_address)); |
| 189 | vnet_buffer (b)->l3_hdr_offset = (u8 *) ip6h - b->data; |
| 190 | b->flags |= VNET_BUFFER_F_IS_IP6 | VNET_BUFFER_F_L3_HDR_OFFSET_VALID; |
| 191 | |
| 192 | return ip6h; |
| 193 | } |
| 194 | |
| 195 | /** |
| 196 | * Push IPv6 header to buffer |
| 197 | * |
| 198 | * @param vm - vlib_main |
| 199 | * @param b - buffer to write the header to |
| 200 | * @param src - source IP |
| 201 | * @param dst - destination IP |
| 202 | * @param prot - payload proto |
| 203 | * |
| 204 | * @return - pointer to start of IP header |
| 205 | */ |
| 206 | always_inline void * |
| 207 | vlib_buffer_push_ip6 (vlib_main_t * vm, vlib_buffer_t * b, |
| 208 | ip6_address_t * src, ip6_address_t * dst, int proto) |
| 209 | { |
| 210 | return vlib_buffer_push_ip6_custom (vm, b, src, dst, proto, |
| 211 | 0 /* flow label */ ); |
| 212 | |
| 213 | } |
| 214 | |
| 215 | #endif /* included_ip_ip6_h */ |
| 216 | |
| 217 | /* |
| 218 | * fd.io coding-style-patch-verification: ON |
| 219 | * |
| 220 | * Local Variables: |
| 221 | * eval: (c-set-style "gnu") |
| 222 | * End: |
| 223 | */ |