lib/flow.c

   1 /* Copyright (c) 2008 The Board of Trustees of The Leland Stanford
   2  * Junior University
   3  *
   4  * We are making the OpenFlow specification and associated documentation
   5  * (Software) available for public use and benefit with the expectation
   6  * that others will use, modify and enhance the Software and contribute
   7  * those enhancements back to the community. However, since we would
   8  * like to make the Software available for broadest use, with as few
   9  * restrictions as possible permission is hereby granted, free of
  10  * charge, to any person obtaining a copy of this Software to deal in
  11  * the Software under the copyrights without restriction, including
  12  * without limitation the rights to use, copy, modify, merge, publish,
  13  * distribute, sublicense, and/or sell copies of the Software, and to
  14  * permit persons to whom the Software is furnished to do so, subject to
  15  * the following conditions:
  16  *
  17  * The above copyright notice and this permission notice shall be
  18  * included in all copies or substantial portions of the Software.
  19  *
  20  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
  21  * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
  22  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
  23  * NONINFRINGEMENT.  IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
  24  * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
  25  * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
  26  * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
  27  * SOFTWARE.
  28  *
  29  * The name and trademarks of copyright holder(s) may NOT be used in
  30  * advertising or publicity pertaining to the Software or any
  31  * derivatives without specific, written prior permission.
  32  */
  33 #include <config.h>
  34 #include <sys/types.h>
  35 #include "flow.h"
  36 #include <inttypes.h>
  37 #include <netinet/in.h>
  38 #include <string.h>
  39 #include "hash.h"
  40 #include "ofpbuf.h"
  41 #include "openflow/openflow.h"
  42 #include "packets.h"
  43
  44 #include "vlog.h"
  45 #define THIS_MODULE VLM_flow
  46
  47 static struct ip_header *
  48 pull_ip(struct ofpbuf *packet)
  49 {
  50     if (packet->size >= IP_HEADER_LEN) {
  51         struct ip_header *ip = packet->data;
  52         int ip_len = IP_IHL(ip->ip_ihl_ver) * 4;
  53         if (ip_len >= IP_HEADER_LEN && packet->size >= ip_len) {
  54             return ofpbuf_pull(packet, ip_len);
  55         }
  56     }
  57     return NULL;
  58 }
  59
  60 static struct tcp_header *
  61 pull_tcp(struct ofpbuf *packet)
  62 {
  63     if (packet->size >= TCP_HEADER_LEN) {
  64         struct tcp_header *tcp = packet->data;
  65         int tcp_len = TCP_OFFSET(tcp->tcp_ctl) * 4;
  66         if (tcp_len >= TCP_HEADER_LEN && packet->size >= tcp_len) {
  67             return ofpbuf_pull(packet, tcp_len);
  68         }
  69     }
  70     return NULL;
  71 }
  72
  73 static struct udp_header *
  74 pull_udp(struct ofpbuf *packet)
  75 {
  76     return ofpbuf_try_pull(packet, UDP_HEADER_LEN);
  77 }
  78
  79 static struct icmp_header *
  80 pull_icmp(struct ofpbuf *packet)
  81 {
  82     return ofpbuf_try_pull(packet, ICMP_HEADER_LEN);
  83 }
  84
  85 static struct eth_header *
  86 pull_eth(struct ofpbuf *packet)
  87 {
  88     return ofpbuf_try_pull(packet, ETH_HEADER_LEN);
  89 }
  90
  91 static struct vlan_header *
  92 pull_vlan(struct ofpbuf *packet)
  93 {
  94     return ofpbuf_try_pull(packet, VLAN_HEADER_LEN);
  95 }
  96
  97 /* Returns 1 if 'packet' is an IP fragment, 0 otherwise. */
  98 int
  99 flow_extract(struct ofpbuf *packet, uint16_t in_port, struct flow *flow)
 100 {
 101     struct ofpbuf b = *packet;
 102     struct eth_header *eth;
 103     int retval = 0;
 104
 105     memset(flow, 0, sizeof *flow);
 106     flow->dl_vlan = htons(OFP_VLAN_NONE);
 107     flow->in_port = htons(in_port);
 108
 109     packet->l2 = b.data;
 110     packet->l3 = NULL;
 111     packet->l4 = NULL;
 112     packet->l7 = NULL;
 113
 114     eth = pull_eth(&b);
 115     if (eth) {
 116         if (ntohs(eth->eth_type) >= OFP_DL_TYPE_ETH2_CUTOFF) {
 117             /* This is an Ethernet II frame */
 118             flow->dl_type = eth->eth_type;
 119         } else {
 120             /* This is an 802.2 frame */
 121             struct llc_snap_header *h = ofpbuf_at(&b, 0, sizeof *h);
 122             if (h == NULL) {
 123                 return 0;
 124             }
 125             if (h->llc.llc_dsap == LLC_DSAP_SNAP
 126                 && h->llc.llc_ssap == LLC_SSAP_SNAP
 127                 && h->llc.llc_cntl == LLC_CNTL_SNAP
 128                 && !memcmp(h->snap.snap_org, SNAP_ORG_ETHERNET,
 129                            sizeof h->snap.snap_org)) {
 130                 flow->dl_type = h->snap.snap_type;
 131                 ofpbuf_pull(&b, sizeof *h);
 132             } else {
 133                 flow->dl_type = htons(OFP_DL_TYPE_NOT_ETH_TYPE);
 134                 ofpbuf_pull(&b, sizeof(struct llc_header));
 135             }
 136         }
 137
 138         /* Check for a VLAN tag */
 139         if (flow->dl_type == htons(ETH_TYPE_VLAN)) {
 140             struct vlan_header *vh = pull_vlan(&b);
 141             if (vh) {
 142                 flow->dl_type = vh->vlan_next_type;
 143                 flow->dl_vlan = vh->vlan_tci & htons(VLAN_VID_MASK);
 144             }
 145         }
 146         memcpy(flow->dl_src, eth->eth_src, ETH_ADDR_LEN);
 147         memcpy(flow->dl_dst, eth->eth_dst, ETH_ADDR_LEN);
 148
 149         packet->l3 = b.data;
 150         if (flow->dl_type == htons(ETH_TYPE_IP)) {
 151             const struct ip_header *nh = pull_ip(&b);
 152             if (nh) {
 153                 flow->nw_src = nh->ip_src;
 154                 flow->nw_dst = nh->ip_dst;
 155                 flow->nw_proto = nh->ip_proto;
 156                 packet->l4 = b.data;
 157                 if (!IP_IS_FRAGMENT(nh->ip_frag_off)) {
 158                     if (flow->nw_proto == IP_TYPE_TCP) {
 159                         const struct tcp_header *tcp = pull_tcp(&b);
 160                         if (tcp) {
 161                             flow->tp_src = tcp->tcp_src;
 162                             flow->tp_dst = tcp->tcp_dst;
 163                             packet->l7 = b.data;
 164                         } else {
 165                             /* Avoid tricking other code into thinking that
 166                              * this packet has an L4 header. */
 167                             flow->nw_proto = 0;
 168                         }
 169                     } else if (flow->nw_proto == IP_TYPE_UDP) {
 170                         const struct udp_header *udp = pull_udp(&b);
 171                         if (udp) {
 172                             flow->tp_src = udp->udp_src;
 173                             flow->tp_dst = udp->udp_dst;
 174                             packet->l7 = b.data;
 175                         } else {
 176                             /* Avoid tricking other code into thinking that
 177                              * this packet has an L4 header. */
 178                             flow->nw_proto = 0;
 179                         }
 180                     } else if (flow->nw_proto == IP_TYPE_ICMP) {
 181                         const struct icmp_header *icmp = pull_icmp(&b);
 182                         if (icmp) {
 183                             flow->icmp_type = htons(icmp->icmp_type);
 184                             flow->icmp_code = htons(icmp->icmp_code);
 185                             packet->l7 = b.data;
 186                         } else {
 187                             /* Avoid tricking other code into thinking that
 188                              * this packet has an L4 header. */
 189                             flow->nw_proto = 0;
 190                         }
 191                     }
 192                 } else {
 193                     retval = 1;
 194                 }
 195             }
 196         }
 197     }
 198     return retval;
 199 }
 200
 201 void
 202 flow_print(FILE *stream, const struct flow *flow)
 203 {
 204     fprintf(stream,
 205             "port%04x:vlan%04x mac"ETH_ADDR_FMT"->"ETH_ADDR_FMT" "
 206             "proto%04x ip"IP_FMT"->"IP_FMT" port%d->%d",
 207             ntohs(flow->in_port), ntohs(flow->dl_vlan),
 208             ETH_ADDR_ARGS(flow->dl_src), ETH_ADDR_ARGS(flow->dl_dst),
 209             ntohs(flow->dl_type),
 210             IP_ARGS(&flow->nw_src), IP_ARGS(&flow->nw_dst),
 211             ntohs(flow->tp_src), ntohs(flow->tp_dst));
 212 }
 213
 214 int
 215 flow_compare(const struct flow *a, const struct flow *b)
 216 {
 217     return memcmp(a, b, sizeof *a);
 218 }
 219
 220 unsigned long int
 221 flow_hash(const struct flow *flow, uint32_t basis)
 222 {
 223     return hash_fnv(flow, sizeof *flow, basis);
 224 }