VNFs/DPPD-PROX/prox_ipv6.c

   1 /*
   2 // Copyright (c) 2020 Intel Corporation
   3 //
   4 // Licensed under the Apache License, Version 2.0 (the "License");
   5 // you may not use this file except in compliance with the License.
   6 // You may obtain a copy of the License at
   7 //
   8 //     http://www.apache.org/licenses/LICENSE-2.0
   9 //
  10 // Unless required by applicable law or agreed to in writing, software
  11 // distributed under the License is distributed on an "AS IS" BASIS,
  12 // WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
  13 // See the License for the specific language governing permissions and
  14 // limitations under the License.
  15 */
  16
  17 #include "task_base.h"
  18 #include "handle_master.h"
  19 #include "prox_cfg.h"
  20 #include "prox_ipv6.h"
  21
  22 struct ipv6_addr null_addr = {{0}};
  23 char ip6_str[40]; // 8 blocks of 2 bytes (4 char) + 1x ":" between blocks
  24
  25 void set_mcast_mac_from_ipv6(prox_rte_ether_addr *mac, struct ipv6_addr *ipv6_addr)
  26 {
  27         mac->addr_bytes[0] = 0x33;
  28         mac->addr_bytes[1] = 0x33;
  29         memcpy(((uint32_t *)&mac->addr_bytes[2]), (uint32_t *)(&ipv6_addr->bytes[12]), sizeof(uint32_t));
  30 }
  31
  32 // Note that this function is not Mthread safe and would result in garbage if called simultaneously from multiple threads
  33 // This function is however only used for debugging, printing errors...
  34 char *IP6_Canonical(struct ipv6_addr *addr)
  35 {
  36         uint8_t *a = (uint8_t *)addr;
  37         char *ptr = ip6_str;
  38         int field = -1, len = 0, stored_field = 0, stored_len = 0;
  39
  40         // Find longest run of consecutive 16-bit 0 fields
  41         for (int i = 0; i < 8; i++) {
  42                 if (((int)a[i * 2] == 0) && ((int)a[i * 2 + 1] == 0)) {
  43                         len++;
  44                         if (field == -1)
  45                                 field = i;      // Store where the first 0 field started
  46                 } else {
  47                         if (len > stored_len) {
  48                                 // the longest run of consecutive 16-bit 0 fields MUST be shortened
  49                                 stored_len = len;
  50                                 stored_field = field;
  51                         }
  52                         len = 0;
  53                         field = -1;
  54                 }
  55         }
  56         if (len > stored_len) {
  57                 // the longest run of consecutive 16-bit 0 fields MUST be shortened
  58                 stored_len = len;
  59                 stored_field = field;
  60         }
  61         if (stored_len <= 1) {
  62                 // The symbol "::" MUST NOT be used to shorten just one 16-bit 0 field.
  63                 stored_len = 0;
  64                 stored_field = -1;
  65         }
  66         for (int i = 0; i < 8; i++) {
  67                 if (i == stored_field) {
  68                         sprintf(ptr, ":");
  69                         ptr++;
  70                         if (i == 0) {
  71                                 sprintf(ptr, ":");
  72                                 ptr++;
  73                         }
  74                         i +=stored_len - 1;     // ++ done in for loop
  75                         continue;
  76                 }
  77                 if ((int)a[i * 2] & 0xF0) {
  78                         sprintf(ptr, "%02x%02x", (int)a[i * 2], (int)a[i * 2 + 1]);
  79                         ptr+=4;
  80                 } else if ((int)a[i * 2] & 0x0F) {
  81                         sprintf(ptr, "%x%02x", (int)a[i * 2] >> 4, (int)a[i * 2] + 1);
  82                         ptr+=3;
  83                 } else if ((int)a[i * 2 + 1] & 0xF0) {
  84                         sprintf(ptr, "%02x", (int)a[i * 2 + 1]);
  85                         ptr+=2;
  86                 } else {
  87                         sprintf(ptr, "%x", ((int)a[i * 2 + 1]) & 0xF);
  88                         ptr++;
  89                 }
  90                 if (i != 7) {
  91                         sprintf(ptr, ":");
  92                         ptr++;
  93                 }
  94         }
  95         return ip6_str;
  96 }
  97
  98 void set_link_local(struct ipv6_addr *ipv6_addr)
  99 {
 100         ipv6_addr->bytes[0] = 0xfe;
 101         ipv6_addr->bytes[1] = 0x80;
 102 }
 103
 104 // Create Extended Unique Identifier (RFC 2373)
 105 // Store it in LSB of IPv6 address
 106 void set_EUI(struct ipv6_addr *ipv6_addr, prox_rte_ether_addr *mac)
 107 {
 108         memcpy(&ipv6_addr->bytes[8], mac, 3);                                           // Copy first 3 bytes of MAC
 109         ipv6_addr->bytes[8] = ipv6_addr->bytes[8] ^ 0x02;                               // Invert Universal/local bit
 110         ipv6_addr->bytes[11] = 0xff;                                                    // Next 2 bytes are 0xfffe
 111         ipv6_addr->bytes[12] = 0xfe;
 112         memcpy(&ipv6_addr->bytes[13], &mac->addr_bytes[3], 3);                          // Copy last 3 bytes
 113         // plog_info("mac = "MAC_BYTES_FMT", eui = "IPv6_BYTES_FMT"\n", MAC_BYTES(mac->addr_bytes), IPv6_BYTES(ipv6_addr->bytes));
 114 }
 115
 116 void create_mac_from_EUI(struct ipv6_addr *ipv6_addr, prox_rte_ether_addr *mac)
 117 {
 118         memcpy(mac, &ipv6_addr->bytes[8], 3);
 119         mac->addr_bytes[0] = mac->addr_bytes[0] ^ 0x02;
 120         memcpy(&mac->addr_bytes[3], &ipv6_addr->bytes[13], 3);
 121 }
 122 void build_router_advertisement(struct rte_mbuf *mbuf, prox_rte_ether_addr *s_addr, struct ipv6_addr *ipv6_s_addr, struct ipv6_addr *router_prefix)
 123 {
 124         prox_rte_ether_hdr *peth = rte_pktmbuf_mtod(mbuf, prox_rte_ether_hdr *);
 125         init_mbuf_seg(mbuf);
 126         mbuf->ol_flags &= ~(PKT_TX_IP_CKSUM|PKT_TX_UDP_CKSUM);  // Software calculates the checksum
 127
 128         memcpy(peth->d_addr.addr_bytes, &prox_cfg.all_nodes_mac_addr, sizeof(prox_rte_ether_addr));
 129         memcpy(peth->s_addr.addr_bytes, s_addr, sizeof(prox_rte_ether_addr));
 130         peth->ether_type = ETYPE_IPv6;
 131
 132         prox_rte_ipv6_hdr *ipv6_hdr = (prox_rte_ipv6_hdr *)(peth + 1);
 133         ipv6_hdr->vtc_flow = 0x00000060;
 134         ipv6_hdr->payload_len = rte_cpu_to_be_16(sizeof(struct icmpv6_RA) + sizeof(struct icmpv6_prefix_option));
 135         ipv6_hdr->proto = ICMPv6;
 136         ipv6_hdr->hop_limits = 255;
 137         memcpy(ipv6_hdr->src_addr, ipv6_s_addr, sizeof(struct ipv6_addr));      // 0 = "Unspecified address" if unknown
 138         memcpy(ipv6_hdr->dst_addr, &prox_cfg.all_nodes_ipv6_mcast_addr, sizeof(struct ipv6_addr));
 139
 140         struct icmpv6_RA *router_advertisement = (struct icmpv6_RA *)(ipv6_hdr + 1);
 141         router_advertisement->type = ICMPv6_RA;
 142         router_advertisement->code = 0;
 143         router_advertisement->hop_limit = 255;
 144         router_advertisement->bits = 0; // M and O bits set to 0 => no dhcpv6
 145         router_advertisement->router_lifespan = rte_cpu_to_be_16(9000);         // 9000 sec
 146         router_advertisement->reachable_timeout = rte_cpu_to_be_32(30000);      // 1 sec
 147         router_advertisement->retrans_timeout = rte_cpu_to_be_32(1000);       // 30 sec
 148
 149         struct icmpv6_option *option = &router_advertisement->options;
 150         option->type = ICMPv6_source_link_layer_address;
 151         option->length = 1;     // 8 bytes
 152         memcpy(&option->data, s_addr, sizeof(prox_rte_ether_addr));
 153
 154         struct icmpv6_prefix_option *prefix_option = (struct icmpv6_prefix_option *)(option + 1);
 155         prefix_option->type = ICMPv6_prefix_information;
 156         prefix_option->length = 4;              // 32 bytes
 157         prefix_option->prefix_length = 64;      // 64 bits in prefix
 158         prefix_option->flag = 0xc0;             // on-link flag & autonamous address-configuration flag are set
 159         prefix_option->valid_lifetime = rte_cpu_to_be_32(86400);        // 1 day
 160         prefix_option->preferred_lifetime = rte_cpu_to_be_32(43200);    // 12 hours
 161         prefix_option->reserved = 0;
 162         memcpy(&prefix_option->prefix, router_prefix, sizeof(struct ipv6_addr));
 163         // Could Add MTU Option
 164         router_advertisement->checksum = 0;
 165         router_advertisement->checksum = rte_ipv6_udptcp_cksum(ipv6_hdr, router_advertisement);
 166
 167         uint16_t pktlen = rte_be_to_cpu_16(ipv6_hdr->payload_len) + sizeof(prox_rte_ipv6_hdr) + sizeof(prox_rte_ether_hdr);
 168         rte_pktmbuf_pkt_len(mbuf) = pktlen;
 169         rte_pktmbuf_data_len(mbuf) = pktlen;
 170 }
 171
 172 void build_router_sollicitation(struct rte_mbuf *mbuf, prox_rte_ether_addr *s_addr, struct ipv6_addr *ipv6_s_addr)
 173 {
 174         prox_rte_ether_hdr *peth = rte_pktmbuf_mtod(mbuf, prox_rte_ether_hdr *);
 175
 176         init_mbuf_seg(mbuf);
 177         mbuf->ol_flags &= ~(PKT_TX_IP_CKSUM|PKT_TX_UDP_CKSUM);  // Software calculates the checksum
 178
 179         memcpy(peth->d_addr.addr_bytes, &prox_cfg.all_routers_mac_addr, sizeof(prox_rte_ether_addr));
 180         memcpy(peth->s_addr.addr_bytes, s_addr, sizeof(prox_rte_ether_addr));
 181         peth->ether_type = ETYPE_IPv6;
 182
 183         prox_rte_ipv6_hdr *ipv6_hdr = (prox_rte_ipv6_hdr *)(peth + 1);
 184         ipv6_hdr->vtc_flow = 0x00000060;
 185         ipv6_hdr->payload_len = rte_cpu_to_be_16(sizeof(struct icmpv6_RS));
 186         ipv6_hdr->proto = ICMPv6;
 187         ipv6_hdr->hop_limits = 255;
 188         memcpy(ipv6_hdr->src_addr, ipv6_s_addr, sizeof(struct ipv6_addr));      // 0 = "Unspecified address" if unknown
 189         memcpy(ipv6_hdr->dst_addr, &prox_cfg.all_routers_ipv6_mcast_addr, sizeof(struct ipv6_addr));
 190
 191         struct icmpv6_RS *router_sollicitation = (struct icmpv6_RS *)(ipv6_hdr + 1);
 192         router_sollicitation->type = ICMPv6_RS;
 193         router_sollicitation->code = 0;
 194         router_sollicitation->options.type = ICMPv6_source_link_layer_address;
 195         router_sollicitation->options.length = 1;       // 8 bytes
 196         memcpy(&router_sollicitation->options.data, s_addr, sizeof(prox_rte_ether_addr));
 197
 198         router_sollicitation->checksum = 0;
 199         router_sollicitation->checksum = rte_ipv6_udptcp_cksum(ipv6_hdr, router_sollicitation);
 200         uint16_t pktlen = rte_be_to_cpu_16(ipv6_hdr->payload_len) + sizeof(prox_rte_ipv6_hdr) + sizeof(prox_rte_ether_hdr);
 201         rte_pktmbuf_pkt_len(mbuf) = pktlen;
 202         rte_pktmbuf_data_len(mbuf) = pktlen;
 203 }
 204
 205 void build_neighbour_sollicitation(struct rte_mbuf *mbuf, prox_rte_ether_addr *s_addr, struct ipv6_addr *dst, struct ipv6_addr *src)
 206 {
 207         prox_rte_ether_hdr *peth = rte_pktmbuf_mtod(mbuf, prox_rte_ether_hdr *);
 208         prox_rte_ether_addr mac_dst;
 209         set_mcast_mac_from_ipv6(&mac_dst, dst);
 210
 211         init_mbuf_seg(mbuf);
 212         mbuf->ol_flags &= ~(PKT_TX_IP_CKSUM|PKT_TX_UDP_CKSUM);  // Software calculates the checksum
 213
 214         memcpy(peth->d_addr.addr_bytes, &mac_dst, sizeof(prox_rte_ether_addr));
 215         memcpy(peth->s_addr.addr_bytes, s_addr, sizeof(prox_rte_ether_addr));
 216         peth->ether_type = ETYPE_IPv6;
 217
 218         prox_rte_ipv6_hdr *ipv6_hdr = (prox_rte_ipv6_hdr *)(peth + 1);
 219         ipv6_hdr->vtc_flow = 0x00000060;
 220         ipv6_hdr->payload_len = rte_cpu_to_be_16(sizeof(struct icmpv6_NS));
 221         ipv6_hdr->proto = ICMPv6;
 222         ipv6_hdr->hop_limits = 255;
 223         memcpy(ipv6_hdr->src_addr, src, 16);
 224         memcpy(ipv6_hdr->dst_addr, dst, 16);
 225
 226         struct icmpv6_NS *neighbour_sollicitation = (struct icmpv6_NS *)(ipv6_hdr + 1);
 227         neighbour_sollicitation->type = ICMPv6_NS;
 228         neighbour_sollicitation->code = 0;
 229         neighbour_sollicitation->reserved = 0;
 230         memcpy(&neighbour_sollicitation->target_address, dst, sizeof(struct ipv6_addr));
 231         neighbour_sollicitation->options.type = ICMPv6_source_link_layer_address;
 232         neighbour_sollicitation->options.length = 1;    // 8 bytes
 233         memcpy(&neighbour_sollicitation->options.data, s_addr, sizeof(prox_rte_ether_addr));
 234         neighbour_sollicitation->checksum = 0;
 235         neighbour_sollicitation->checksum = rte_ipv6_udptcp_cksum(ipv6_hdr, neighbour_sollicitation);
 236
 237         uint16_t pktlen = rte_be_to_cpu_16(ipv6_hdr->payload_len) + sizeof(prox_rte_ipv6_hdr) + sizeof(prox_rte_ether_hdr);
 238         rte_pktmbuf_pkt_len(mbuf) = pktlen;
 239         rte_pktmbuf_data_len(mbuf) = pktlen;
 240 }
 241
 242 void build_neighbour_advertisement(struct task_base *tbase, struct rte_mbuf *mbuf, prox_rte_ether_addr *target, struct ipv6_addr *src_ipv6_addr, int sollicited)
 243 {
 244         struct task_master *task = (struct task_master *)tbase;
 245         prox_rte_ether_hdr *peth = rte_pktmbuf_mtod(mbuf, prox_rte_ether_hdr *);
 246         prox_rte_ipv6_hdr *ipv6_hdr = (prox_rte_ipv6_hdr *)(peth + 1);
 247
 248         uint8_t port_id = get_port(mbuf);
 249
 250         init_mbuf_seg(mbuf);
 251         mbuf->ol_flags &= ~(PKT_TX_IP_CKSUM|PKT_TX_UDP_CKSUM);  // Software calculates the checksum
 252
 253         // If source mac is null, use all_nodes_mac_addr.
 254         if ((!sollicited) || (memcmp(peth->s_addr.addr_bytes, &null_addr, sizeof(struct ipv6_addr)) == 0)) {
 255                 memcpy(peth->d_addr.addr_bytes, &prox_cfg.all_nodes_mac_addr, sizeof(prox_rte_ether_addr));
 256                 memcpy(ipv6_hdr->dst_addr, &prox_cfg.all_nodes_ipv6_mcast_addr, sizeof(struct ipv6_addr));
 257         } else {
 258                 memcpy(peth->d_addr.addr_bytes, peth->s_addr.addr_bytes, sizeof(prox_rte_ether_addr));
 259                 memcpy(ipv6_hdr->dst_addr, ipv6_hdr->src_addr, sizeof(struct ipv6_addr));
 260         }
 261
 262         memcpy(peth->s_addr.addr_bytes, &task->internal_port_table[port_id].mac, sizeof(prox_rte_ether_addr));
 263         peth->ether_type = ETYPE_IPv6;
 264
 265         ipv6_hdr->vtc_flow = 0x00000060;
 266         ipv6_hdr->payload_len = rte_cpu_to_be_16(sizeof(struct icmpv6_NA));
 267         ipv6_hdr->proto = ICMPv6;
 268         ipv6_hdr->hop_limits = 255;
 269         memcpy(ipv6_hdr->src_addr, src_ipv6_addr, sizeof(struct ipv6_addr));
 270
 271         struct icmpv6_NA *neighbour_advertisement = (struct icmpv6_NA *)(ipv6_hdr + 1);
 272         neighbour_advertisement->type = ICMPv6_NA;
 273         neighbour_advertisement->code = 0;
 274         neighbour_advertisement->reserved = 0;
 275         if (task->internal_port_table[port_id].flags & IPV6_ROUTER)
 276                 neighbour_advertisement->bits = 0xC0; // R+S bit set
 277         else
 278                 neighbour_advertisement->bits = 0x40; // S bit set
 279         if (!sollicited) {
 280                 memcpy(&neighbour_advertisement->destination_address, src_ipv6_addr, sizeof(struct ipv6_addr));
 281                 neighbour_advertisement->bits &= 0xBF; // Clear S bit
 282                 neighbour_advertisement->bits |= 0x20; // Overide bit
 283         }
 284         // else neighbour_advertisement->destination_address is already set to neighbour_sollicitation->target_address
 285
 286         struct icmpv6_option *option = &neighbour_advertisement->options;
 287         // Do not think this is necessary
 288         // option->type = ICMPv6_source_link_layer_address;
 289         // option->length = 1;  // 8 bytes
 290         // memcpy(&option->data, &task->internal_port_table[port_id].mac, sizeof(prox_rte_ether_addr));
 291
 292         // option = option + 1;
 293         option->type = ICMPv6_target_link_layer_address;
 294         option->length = 1;     // 8 bytes
 295         memcpy(&option->data, target, sizeof(prox_rte_ether_addr));
 296
 297         neighbour_advertisement->checksum = 0;
 298         neighbour_advertisement->checksum = rte_ipv6_udptcp_cksum(ipv6_hdr, neighbour_advertisement);
 299         uint16_t pktlen = rte_be_to_cpu_16(ipv6_hdr->payload_len) + sizeof(prox_rte_ipv6_hdr) + sizeof(prox_rte_ether_hdr);
 300         rte_pktmbuf_pkt_len(mbuf) = pktlen;
 301         rte_pktmbuf_data_len(mbuf) = pktlen;
 302 }