[mirror_ubuntu-artful-kernel.git] / net / openvswitch / flow.c

/*
 * Copyright (c) 2007-2013 Nicira, Inc.
 *
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of version 2 of the GNU General Public
 * License as published by the Free Software Foundation.
 *
 * This program is distributed in the hope that it will be useful, but
 * WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
 * General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
 * 02110-1301, USA
 */

#include "flow.h"
#include "datapath.h"
#include <linux/uaccess.h>
#include <linux/netdevice.h>
#include <linux/etherdevice.h>
#include <linux/if_ether.h>
#include <linux/if_vlan.h>
#include <net/llc_pdu.h>
#include <linux/kernel.h>
#include <linux/jhash.h>
#include <linux/jiffies.h>
#include <linux/llc.h>
#include <linux/module.h>
#include <linux/in.h>
#include <linux/rcupdate.h>
#include <linux/if_arp.h>
#include <linux/ip.h>
#include <linux/ipv6.h>
#include <linux/sctp.h>
#include <linux/smp.h>
#include <linux/tcp.h>
#include <linux/udp.h>
#include <linux/icmp.h>
#include <linux/icmpv6.h>
#include <linux/rculist.h>
#include <net/ip.h>
#include <net/ip_tunnels.h>
#include <net/ipv6.h>
#include <net/ndisc.h>

u64 ovs_flow_used_time(unsigned long flow_jiffies)
{
	struct timespec cur_ts;
	u64 cur_ms, idle_ms;

	ktime_get_ts(&cur_ts);
	idle_ms = jiffies_to_msecs(jiffies - flow_jiffies);
	cur_ms = (u64)cur_ts.tv_sec * MSEC_PER_SEC +
		 cur_ts.tv_nsec / NSEC_PER_MSEC;

	return cur_ms - idle_ms;
}

#define TCP_FLAGS_BE16(tp) (*(__be16 *)&tcp_flag_word(tp) & htons(0x0FFF))

void ovs_flow_stats_update(struct sw_flow *flow, struct sk_buff *skb)
{
	struct flow_stats *stats;
	__be16 tcp_flags = 0;
	int node = numa_node_id();

	stats = rcu_dereference(flow->stats[node]);

	if (likely(flow->key.ip.proto == IPPROTO_TCP)) {
		if (likely(flow->key.eth.type == htons(ETH_P_IP)))
			tcp_flags = flow->key.ipv4.tp.flags;
		else if (likely(flow->key.eth.type == htons(ETH_P_IPV6)))
			tcp_flags = flow->key.ipv6.tp.flags;
	}
	/* Check if already have node-specific stats. */
	if (likely(stats)) {
		spin_lock(&stats->lock);
		/* Mark if we write on the pre-allocated stats. */
		if (node == 0 && unlikely(flow->stats_last_writer != node))
			flow->stats_last_writer = node;
	} else {
		stats = rcu_dereference(flow->stats[0]); /* Pre-allocated. */
		spin_lock(&stats->lock);

		/* If the current NUMA-node is the only writer on the
		 * pre-allocated stats keep using them.
		 */
		if (unlikely(flow->stats_last_writer != node)) {
			/* A previous locker may have already allocated the
			 * stats, so we need to check again.  If node-specific
			 * stats were already allocated, we update the pre-
			 * allocated stats as we have already locked them.
			 */
			if (likely(flow->stats_last_writer != NUMA_NO_NODE)
			    && likely(!rcu_dereference(flow->stats[node]))) {
				/* Try to allocate node-specific stats. */
				struct flow_stats *new_stats;

				new_stats =
					kmem_cache_alloc_node(flow_stats_cache,
							      GFP_THISNODE |
							      __GFP_NOMEMALLOC,
							      node);
				if (likely(new_stats)) {
					new_stats->used = jiffies;
					new_stats->packet_count = 1;
					new_stats->byte_count = skb->len;
					new_stats->tcp_flags = tcp_flags;
					spin_lock_init(&new_stats->lock);

					rcu_assign_pointer(flow->stats[node],
							   new_stats);
					goto unlock;
				}
			}
			flow->stats_last_writer = node;
		}
	}

	stats->used = jiffies;
	stats->packet_count++;
	stats->byte_count += skb->len;
	stats->tcp_flags |= tcp_flags;
unlock:
	spin_unlock(&stats->lock);
}

void ovs_flow_stats_get(struct sw_flow *flow, struct ovs_flow_stats *ovs_stats,
			unsigned long *used, __be16 *tcp_flags)
{
	int node;

	*used = 0;
	*tcp_flags = 0;
	memset(ovs_stats, 0, sizeof(*ovs_stats));

	for_each_node(node) {
		struct flow_stats *stats = rcu_dereference(flow->stats[node]);

		if (stats) {
			/* Local CPU may write on non-local stats, so we must
			 * block bottom-halves here.
			 */
			spin_lock_bh(&stats->lock);
			if (!*used || time_after(stats->used, *used))
				*used = stats->used;
			*tcp_flags |= stats->tcp_flags;
			ovs_stats->n_packets += stats->packet_count;
			ovs_stats->n_bytes += stats->byte_count;
			spin_unlock_bh(&stats->lock);
		}
	}
}

void ovs_flow_stats_clear(struct sw_flow *flow)
{
	int node;

	for_each_node(node) {
		struct flow_stats *stats = rcu_dereference(flow->stats[node]);

		if (stats) {
			spin_lock_bh(&stats->lock);
			stats->used = 0;
			stats->packet_count = 0;
			stats->byte_count = 0;
			stats->tcp_flags = 0;
			spin_unlock_bh(&stats->lock);
		}
	}
}

static int check_header(struct sk_buff *skb, int len)
{
	if (unlikely(skb->len < len))
		return -EINVAL;
	if (unlikely(!pskb_may_pull(skb, len)))
		return -ENOMEM;
	return 0;
}

static bool arphdr_ok(struct sk_buff *skb)
{
	return pskb_may_pull(skb, skb_network_offset(skb) +
				  sizeof(struct arp_eth_header));
}

static int check_iphdr(struct sk_buff *skb)
{
	unsigned int nh_ofs = skb_network_offset(skb);
	unsigned int ip_len;
	int err;

	err = check_header(skb, nh_ofs + sizeof(struct iphdr));
	if (unlikely(err))
		return err;

	ip_len = ip_hdrlen(skb);
	if (unlikely(ip_len < sizeof(struct iphdr) ||
		     skb->len < nh_ofs + ip_len))
		return -EINVAL;

	skb_set_transport_header(skb, nh_ofs + ip_len);
	return 0;
}

static bool tcphdr_ok(struct sk_buff *skb)
{
	int th_ofs = skb_transport_offset(skb);
	int tcp_len;

	if (unlikely(!pskb_may_pull(skb, th_ofs + sizeof(struct tcphdr))))
		return false;

	tcp_len = tcp_hdrlen(skb);
	if (unlikely(tcp_len < sizeof(struct tcphdr) ||
		     skb->len < th_ofs + tcp_len))
		return false;

	return true;
}

static bool udphdr_ok(struct sk_buff *skb)
{
	return pskb_may_pull(skb, skb_transport_offset(skb) +
				  sizeof(struct udphdr));
}

static bool sctphdr_ok(struct sk_buff *skb)
{
	return pskb_may_pull(skb, skb_transport_offset(skb) +
				  sizeof(struct sctphdr));
}

static bool icmphdr_ok(struct sk_buff *skb)
{
	return pskb_may_pull(skb, skb_transport_offset(skb) +
				  sizeof(struct icmphdr));
}

static int parse_ipv6hdr(struct sk_buff *skb, struct sw_flow_key *key)
{
	unsigned int nh_ofs = skb_network_offset(skb);
	unsigned int nh_len;
	int payload_ofs;
	struct ipv6hdr *nh;
	uint8_t nexthdr;
	__be16 frag_off;
	int err;

	err = check_header(skb, nh_ofs + sizeof(*nh));
	if (unlikely(err))
		return err;

	nh = ipv6_hdr(skb);
	nexthdr = nh->nexthdr;
	payload_ofs = (u8 *)(nh + 1) - skb->data;

	key->ip.proto = NEXTHDR_NONE;
	key->ip.tos = ipv6_get_dsfield(nh);
	key->ip.ttl = nh->hop_limit;
	key->ipv6.label = *(__be32 *)nh & htonl(IPV6_FLOWINFO_FLOWLABEL);
	key->ipv6.addr.src = nh->saddr;
	key->ipv6.addr.dst = nh->daddr;

	payload_ofs = ipv6_skip_exthdr(skb, payload_ofs, &nexthdr, &frag_off);
	if (unlikely(payload_ofs < 0))
		return -EINVAL;

	if (frag_off) {
		if (frag_off & htons(~0x7))
			key->ip.frag = OVS_FRAG_TYPE_LATER;
		else
			key->ip.frag = OVS_FRAG_TYPE_FIRST;
	}

	nh_len = payload_ofs - nh_ofs;
	skb_set_transport_header(skb, nh_ofs + nh_len);
	key->ip.proto = nexthdr;
	return nh_len;
}

static bool icmp6hdr_ok(struct sk_buff *skb)
{
	return pskb_may_pull(skb, skb_transport_offset(skb) +
				  sizeof(struct icmp6hdr));
}

static int parse_vlan(struct sk_buff *skb, struct sw_flow_key *key)
{
	struct qtag_prefix {
		__be16 eth_type; /* ETH_P_8021Q */
		__be16 tci;
	};
	struct qtag_prefix *qp;

	if (unlikely(skb->len < sizeof(struct qtag_prefix) + sizeof(__be16)))
		return 0;

	if (unlikely(!pskb_may_pull(skb, sizeof(struct qtag_prefix) +
					 sizeof(__be16))))
		return -ENOMEM;

	qp = (struct qtag_prefix *) skb->data;
	key->eth.tci = qp->tci | htons(VLAN_TAG_PRESENT);
	__skb_pull(skb, sizeof(struct qtag_prefix));

	return 0;
}

static __be16 parse_ethertype(struct sk_buff *skb)
{
	struct llc_snap_hdr {
		u8  dsap;  /* Always 0xAA */
		u8  ssap;  /* Always 0xAA */
		u8  ctrl;
		u8  oui[3];
		__be16 ethertype;
	};
	struct llc_snap_hdr *llc;
	__be16 proto;

	proto = *(__be16 *) skb->data;
	__skb_pull(skb, sizeof(__be16));

	if (ntohs(proto) >= ETH_P_802_3_MIN)
		return proto;

	if (skb->len < sizeof(struct llc_snap_hdr))
		return htons(ETH_P_802_2);

	if (unlikely(!pskb_may_pull(skb, sizeof(struct llc_snap_hdr))))
		return htons(0);

	llc = (struct llc_snap_hdr *) skb->data;
	if (llc->dsap != LLC_SAP_SNAP ||
	    llc->ssap != LLC_SAP_SNAP ||
	    (llc->oui[0] | llc->oui[1] | llc->oui[2]) != 0)
		return htons(ETH_P_802_2);

	__skb_pull(skb, sizeof(struct llc_snap_hdr));

	if (ntohs(llc->ethertype) >= ETH_P_802_3_MIN)
		return llc->ethertype;

	return htons(ETH_P_802_2);
}

static int parse_icmpv6(struct sk_buff *skb, struct sw_flow_key *key,
			int nh_len)
{
	struct icmp6hdr *icmp = icmp6_hdr(skb);

	/* The ICMPv6 type and code fields use the 16-bit transport port
	 * fields, so we need to store them in 16-bit network byte order.
	 */
	key->ipv6.tp.src = htons(icmp->icmp6_type);
	key->ipv6.tp.dst = htons(icmp->icmp6_code);

	if (icmp->icmp6_code == 0 &&
	    (icmp->icmp6_type == NDISC_NEIGHBOUR_SOLICITATION ||
	     icmp->icmp6_type == NDISC_NEIGHBOUR_ADVERTISEMENT)) {
		int icmp_len = skb->len - skb_transport_offset(skb);
		struct nd_msg *nd;
		int offset;

		/* In order to process neighbor discovery options, we need the
		 * entire packet.
		 */
		if (unlikely(icmp_len < sizeof(*nd)))
			return 0;

		if (unlikely(skb_linearize(skb)))
			return -ENOMEM;

		nd = (struct nd_msg *)skb_transport_header(skb);
		key->ipv6.nd.target = nd->target;

		icmp_len -= sizeof(*nd);
		offset = 0;
		while (icmp_len >= 8) {
			struct nd_opt_hdr *nd_opt =
				 (struct nd_opt_hdr *)(nd->opt + offset);
			int opt_len = nd_opt->nd_opt_len * 8;

			if (unlikely(!opt_len || opt_len > icmp_len))
				return 0;

			/* Store the link layer address if the appropriate
			 * option is provided.  It is considered an error if
			 * the same link layer option is specified twice.
			 */
			if (nd_opt->nd_opt_type == ND_OPT_SOURCE_LL_ADDR
			    && opt_len == 8) {
				if (unlikely(!is_zero_ether_addr(key->ipv6.nd.sll)))
					goto invalid;
				ether_addr_copy(key->ipv6.nd.sll,
						&nd->opt[offset+sizeof(*nd_opt)]);
			} else if (nd_opt->nd_opt_type == ND_OPT_TARGET_LL_ADDR
				   && opt_len == 8) {
				if (unlikely(!is_zero_ether_addr(key->ipv6.nd.tll)))
					goto invalid;
				ether_addr_copy(key->ipv6.nd.tll,
						&nd->opt[offset+sizeof(*nd_opt)]);
			}

			icmp_len -= opt_len;
			offset += opt_len;
		}
	}

	return 0;

invalid:
	memset(&key->ipv6.nd.target, 0, sizeof(key->ipv6.nd.target));
	memset(key->ipv6.nd.sll, 0, sizeof(key->ipv6.nd.sll));
	memset(key->ipv6.nd.tll, 0, sizeof(key->ipv6.nd.tll));

	return 0;
}

/**
 * ovs_flow_extract - extracts a flow key from an Ethernet frame.
 * @skb: sk_buff that contains the frame, with skb->data pointing to the
 * Ethernet header
 * @in_port: port number on which @skb was received.
 * @key: output flow key
 *
 * The caller must ensure that skb->len >= ETH_HLEN.
 *
 * Returns 0 if successful, otherwise a negative errno value.
 *
 * Initializes @skb header pointers as follows:
 *
 *    - skb->mac_header: the Ethernet header.
 *
 *    - skb->network_header: just past the Ethernet header, or just past the
 *      VLAN header, to the first byte of the Ethernet payload.
 *
 *    - skb->transport_header: If key->eth.type is ETH_P_IP or ETH_P_IPV6
 *      on output, then just past the IP header, if one is present and
 *      of a correct length, otherwise the same as skb->network_header.
 *      For other key->eth.type values it is left untouched.
 */
int ovs_flow_extract(struct sk_buff *skb, u16 in_port, struct sw_flow_key *key)
{
	int error;
	struct ethhdr *eth;

	memset(key, 0, sizeof(*key));

	key->phy.priority = skb->priority;
	if (OVS_CB(skb)->tun_key)
		memcpy(&key->tun_key, OVS_CB(skb)->tun_key, sizeof(key->tun_key));
	key->phy.in_port = in_port;
	key->phy.skb_mark = skb->mark;

	skb_reset_mac_header(skb);

	/* Link layer.  We are guaranteed to have at least the 14 byte Ethernet
	 * header in the linear data area.
	 */
	eth = eth_hdr(skb);
	ether_addr_copy(key->eth.src, eth->h_source);
	ether_addr_copy(key->eth.dst, eth->h_dest);

	__skb_pull(skb, 2 * ETH_ALEN);
	/* We are going to push all headers that we pull, so no need to
	 * update skb->csum here.
	 */

	if (vlan_tx_tag_present(skb))
		key->eth.tci = htons(skb->vlan_tci);
	else if (eth->h_proto == htons(ETH_P_8021Q))
		if (unlikely(parse_vlan(skb, key)))
			return -ENOMEM;

	key->eth.type = parse_ethertype(skb);
	if (unlikely(key->eth.type == htons(0)))
		return -ENOMEM;

	skb_reset_network_header(skb);
	__skb_push(skb, skb->data - skb_mac_header(skb));

	/* Network layer. */
	if (key->eth.type == htons(ETH_P_IP)) {
		struct iphdr *nh;
		__be16 offset;

		error = check_iphdr(skb);
		if (unlikely(error)) {
			if (error == -EINVAL) {
				skb->transport_header = skb->network_header;
				error = 0;
			}
			return error;
		}

		nh = ip_hdr(skb);
		key->ipv4.addr.src = nh->saddr;
		key->ipv4.addr.dst = nh->daddr;

		key->ip.proto = nh->protocol;
		key->ip.tos = nh->tos;
		key->ip.ttl = nh->ttl;

		offset = nh->frag_off & htons(IP_OFFSET);
		if (offset) {
			key->ip.frag = OVS_FRAG_TYPE_LATER;
			return 0;
		}
		if (nh->frag_off & htons(IP_MF) ||
			 skb_shinfo(skb)->gso_type & SKB_GSO_UDP)
			key->ip.frag = OVS_FRAG_TYPE_FIRST;

		/* Transport layer. */
		if (key->ip.proto == IPPROTO_TCP) {
			if (tcphdr_ok(skb)) {
				struct tcphdr *tcp = tcp_hdr(skb);
				key->ipv4.tp.src = tcp->source;
				key->ipv4.tp.dst = tcp->dest;
				key->ipv4.tp.flags = TCP_FLAGS_BE16(tcp);
			}
		} else if (key->ip.proto == IPPROTO_UDP) {
			if (udphdr_ok(skb)) {
				struct udphdr *udp = udp_hdr(skb);
				key->ipv4.tp.src = udp->source;
				key->ipv4.tp.dst = udp->dest;
			}
		} else if (key->ip.proto == IPPROTO_SCTP) {
			if (sctphdr_ok(skb)) {
				struct sctphdr *sctp = sctp_hdr(skb);
				key->ipv4.tp.src = sctp->source;
				key->ipv4.tp.dst = sctp->dest;
			}
		} else if (key->ip.proto == IPPROTO_ICMP) {
			if (icmphdr_ok(skb)) {
				struct icmphdr *icmp = icmp_hdr(skb);
				/* The ICMP type and code fields use the 16-bit
				 * transport port fields, so we need to store
				 * them in 16-bit network byte order. */
				key->ipv4.tp.src = htons(icmp->type);
				key->ipv4.tp.dst = htons(icmp->code);
			}
		}

	} else if ((key->eth.type == htons(ETH_P_ARP) ||
		   key->eth.type == htons(ETH_P_RARP)) && arphdr_ok(skb)) {
		struct arp_eth_header *arp;

		arp = (struct arp_eth_header *)skb_network_header(skb);

		if (arp->ar_hrd == htons(ARPHRD_ETHER)
				&& arp->ar_pro == htons(ETH_P_IP)
				&& arp->ar_hln == ETH_ALEN
				&& arp->ar_pln == 4) {

			/* We only match on the lower 8 bits of the opcode. */
			if (ntohs(arp->ar_op) <= 0xff)
				key->ip.proto = ntohs(arp->ar_op);
			memcpy(&key->ipv4.addr.src, arp->ar_sip, sizeof(key->ipv4.addr.src));
			memcpy(&key->ipv4.addr.dst, arp->ar_tip, sizeof(key->ipv4.addr.dst));
			ether_addr_copy(key->ipv4.arp.sha, arp->ar_sha);
			ether_addr_copy(key->ipv4.arp.tha, arp->ar_tha);
		}
	} else if (key->eth.type == htons(ETH_P_IPV6)) {
		int nh_len;             /* IPv6 Header + Extensions */

		nh_len = parse_ipv6hdr(skb, key);
		if (unlikely(nh_len < 0)) {
			if (nh_len == -EINVAL) {
				skb->transport_header = skb->network_header;
				error = 0;
			} else {
				error = nh_len;
			}
			return error;
		}

		if (key->ip.frag == OVS_FRAG_TYPE_LATER)
			return 0;
		if (skb_shinfo(skb)->gso_type & SKB_GSO_UDP)
			key->ip.frag = OVS_FRAG_TYPE_FIRST;

		/* Transport layer. */
		if (key->ip.proto == NEXTHDR_TCP) {
			if (tcphdr_ok(skb)) {
				struct tcphdr *tcp = tcp_hdr(skb);
				key->ipv6.tp.src = tcp->source;
				key->ipv6.tp.dst = tcp->dest;
				key->ipv6.tp.flags = TCP_FLAGS_BE16(tcp);
			}
		} else if (key->ip.proto == NEXTHDR_UDP) {
			if (udphdr_ok(skb)) {
				struct udphdr *udp = udp_hdr(skb);
				key->ipv6.tp.src = udp->source;
				key->ipv6.tp.dst = udp->dest;
			}
		} else if (key->ip.proto == NEXTHDR_SCTP) {
			if (sctphdr_ok(skb)) {
				struct sctphdr *sctp = sctp_hdr(skb);
				key->ipv6.tp.src = sctp->source;
				key->ipv6.tp.dst = sctp->dest;
			}
		} else if (key->ip.proto == NEXTHDR_ICMP) {
			if (icmp6hdr_ok(skb)) {
				error = parse_icmpv6(skb, key, nh_len);
				if (error)
					return error;
			}
		}
	}

	return 0;
}
Commit	Line	Data
ccb1352e	1	/*
03f0d916	2	* Copyright (c) 2007-2013 Nicira, Inc.
ccb1352e JG	3	*
	4	* This program is free software; you can redistribute it and/or
	5	* modify it under the terms of version 2 of the GNU General Public
	6	* License as published by the Free Software Foundation.
	7	*
	8	* This program is distributed in the hope that it will be useful, but
	9	* WITHOUT ANY WARRANTY; without even the implied warranty of
	10	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
	11	* General Public License for more details.
	12	*
	13	* You should have received a copy of the GNU General Public License
	14	* along with this program; if not, write to the Free Software
	15	* Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
	16	* 02110-1301, USA
	17	*/
	18
	19	#include "flow.h"
	20	#include "datapath.h"
	21	#include <linux/uaccess.h>
	22	#include <linux/netdevice.h>
	23	#include <linux/etherdevice.h>
	24	#include <linux/if_ether.h>
	25	#include <linux/if_vlan.h>
	26	#include <net/llc_pdu.h>
	27	#include <linux/kernel.h>
	28	#include <linux/jhash.h>
	29	#include <linux/jiffies.h>
	30	#include <linux/llc.h>
	31	#include <linux/module.h>
	32	#include <linux/in.h>
	33	#include <linux/rcupdate.h>
	34	#include <linux/if_arp.h>
ccb1352e JG	35	#include <linux/ip.h>
ccb1352e JG	36	#include <linux/ipv6.h>
a175a723	37	#include <linux/sctp.h>
e298e505	38	#include <linux/smp.h>
ccb1352e JG	39	#include <linux/tcp.h>
	40	#include <linux/udp.h>
	41	#include <linux/icmp.h>
	42	#include <linux/icmpv6.h>
	43	#include <linux/rculist.h>
	44	#include <net/ip.h>
7d5437c7	45	#include <net/ip_tunnels.h>
ccb1352e JG	46	#include <net/ipv6.h>
	47	#include <net/ndisc.h>
	48
e6445719	49	u64 ovs_flow_used_time(unsigned long flow_jiffies)
03f0d916	50	{
e6445719 PS	51	struct timespec cur_ts;
e6445719 PS	52	u64 cur_ms, idle_ms;
03f0d916	53
e6445719 PS	54	ktime_get_ts(&cur_ts);
	55	idle_ms = jiffies_to_msecs(jiffies - flow_jiffies);
	56	cur_ms = (u64)cur_ts.tv_sec * MSEC_PER_SEC +
	57	cur_ts.tv_nsec / NSEC_PER_MSEC;
03f0d916	58
e6445719	59	return cur_ms - idle_ms;
5828cd9a AZ	60	}
5828cd9a AZ	61
df23e9f6	62	#define TCP_FLAGS_BE16(tp) ((__be16 )&tcp_flag_word(tp) & htons(0x0FFF))
03f0d916	63
e298e505	64	void ovs_flow_stats_update(struct sw_flow flow, struct sk_buff skb)
03f0d916	65	{
e298e505	66	struct flow_stats *stats;
df23e9f6	67	__be16 tcp_flags = 0;
63e7959c	68	int node = numa_node_id();
03f0d916	69
63e7959c	70	stats = rcu_dereference(flow->stats[node]);
e298e505	71
88d73f6c JR	72	if (likely(flow->key.ip.proto == IPPROTO_TCP)) {
	73	if (likely(flow->key.eth.type == htons(ETH_P_IP)))
	74	tcp_flags = flow->key.ipv4.tp.flags;
	75	else if (likely(flow->key.eth.type == htons(ETH_P_IPV6)))
	76	tcp_flags = flow->key.ipv6.tp.flags;
03f0d916	77	}
63e7959c JR	78	/* Check if already have node-specific stats. */
	79	if (likely(stats)) {
	80	spin_lock(&stats->lock);
	81	/* Mark if we write on the pre-allocated stats. */
	82	if (node == 0 && unlikely(flow->stats_last_writer != node))
	83	flow->stats_last_writer = node;
	84	} else {
	85	stats = rcu_dereference(flow->stats[0]); /* Pre-allocated. */
	86	spin_lock(&stats->lock);
	87
	88	/* If the current NUMA-node is the only writer on the
	89	* pre-allocated stats keep using them.
	90	*/
	91	if (unlikely(flow->stats_last_writer != node)) {
	92	/* A previous locker may have already allocated the
	93	* stats, so we need to check again. If node-specific
	94	* stats were already allocated, we update the pre-
	95	* allocated stats as we have already locked them.
	96	*/
	97	if (likely(flow->stats_last_writer != NUMA_NO_NODE)
	98	&& likely(!rcu_dereference(flow->stats[node]))) {
	99	/* Try to allocate node-specific stats. */
	100	struct flow_stats *new_stats;
	101
	102	new_stats =
	103	kmem_cache_alloc_node(flow_stats_cache,
	104	GFP_THISNODE \|
	105	__GFP_NOMEMALLOC,
	106	node);
	107	if (likely(new_stats)) {
	108	new_stats->used = jiffies;
	109	new_stats->packet_count = 1;
	110	new_stats->byte_count = skb->len;
	111	new_stats->tcp_flags = tcp_flags;
	112	spin_lock_init(&new_stats->lock);
	113
	114	rcu_assign_pointer(flow->stats[node],
	115	new_stats);
	116	goto unlock;
	117	}
	118	}
	119	flow->stats_last_writer = node;
	120	}
	121	}
	122
e298e505 PS	123	stats->used = jiffies;
	124	stats->packet_count++;
	125	stats->byte_count += skb->len;
	126	stats->tcp_flags \|= tcp_flags;
63e7959c	127	unlock:
e298e505 PS	128	spin_unlock(&stats->lock);
	129	}
	130
	131	void ovs_flow_stats_get(struct sw_flow flow, struct ovs_flow_stats ovs_stats,
	132	unsigned long used, __be16 tcp_flags)
	133	{
63e7959c	134	int node;
e298e505 PS	135
	136	*used = 0;
	137	*tcp_flags = 0;
	138	memset(ovs_stats, 0, sizeof(*ovs_stats));
	139
63e7959c JR	140	for_each_node(node) {
	141	struct flow_stats *stats = rcu_dereference(flow->stats[node]);
	142
	143	if (stats) {
	144	/* Local CPU may write on non-local stats, so we must
	145	* block bottom-halves here.
	146	*/
	147	spin_lock_bh(&stats->lock);
	148	if (!used \|\| time_after(stats->used, used))
	149	*used = stats->used;
	150	*tcp_flags \|= stats->tcp_flags;
	151	ovs_stats->n_packets += stats->packet_count;
	152	ovs_stats->n_bytes += stats->byte_count;
	153	spin_unlock_bh(&stats->lock);
	154	}
e298e505	155	}
e298e505 PS	156	}
	157
	158	void ovs_flow_stats_clear(struct sw_flow *flow)
	159	{
63e7959c JR	160	int node;
	161
	162	for_each_node(node) {
	163	struct flow_stats *stats = rcu_dereference(flow->stats[node]);
	164
	165	if (stats) {
	166	spin_lock_bh(&stats->lock);
	167	stats->used = 0;
	168	stats->packet_count = 0;
	169	stats->byte_count = 0;
	170	stats->tcp_flags = 0;
	171	spin_unlock_bh(&stats->lock);
	172	}
	173	}
03f0d916 AZ	174	}
03f0d916 AZ	175
ccb1352e JG	176	static int check_header(struct sk_buff *skb, int len)
	177	{
	178	if (unlikely(skb->len < len))
	179	return -EINVAL;
	180	if (unlikely(!pskb_may_pull(skb, len)))
	181	return -ENOMEM;
	182	return 0;
	183	}
	184
	185	static bool arphdr_ok(struct sk_buff *skb)
	186	{
	187	return pskb_may_pull(skb, skb_network_offset(skb) +
	188	sizeof(struct arp_eth_header));
	189	}
	190
	191	static int check_iphdr(struct sk_buff *skb)
	192	{
	193	unsigned int nh_ofs = skb_network_offset(skb);
	194	unsigned int ip_len;
	195	int err;
	196
	197	err = check_header(skb, nh_ofs + sizeof(struct iphdr));
	198	if (unlikely(err))
	199	return err;
	200
	201	ip_len = ip_hdrlen(skb);
	202	if (unlikely(ip_len < sizeof(struct iphdr) \|\|
	203	skb->len < nh_ofs + ip_len))
	204	return -EINVAL;
	205
	206	skb_set_transport_header(skb, nh_ofs + ip_len);
	207	return 0;
	208	}
	209
	210	static bool tcphdr_ok(struct sk_buff *skb)
	211	{
	212	int th_ofs = skb_transport_offset(skb);
	213	int tcp_len;
	214
	215	if (unlikely(!pskb_may_pull(skb, th_ofs + sizeof(struct tcphdr))))
	216	return false;
	217
	218	tcp_len = tcp_hdrlen(skb);
	219	if (unlikely(tcp_len < sizeof(struct tcphdr) \|\|
	220	skb->len < th_ofs + tcp_len))
	221	return false;
	222
	223	return true;
	224	}
	225
	226	static bool udphdr_ok(struct sk_buff *skb)
	227	{
	228	return pskb_may_pull(skb, skb_transport_offset(skb) +
	229	sizeof(struct udphdr));
	230	}
	231
a175a723 JS	232	static bool sctphdr_ok(struct sk_buff *skb)
	233	{
	234	return pskb_may_pull(skb, skb_transport_offset(skb) +
	235	sizeof(struct sctphdr));
	236	}
	237
ccb1352e JG	238	static bool icmphdr_ok(struct sk_buff *skb)
	239	{
	240	return pskb_may_pull(skb, skb_transport_offset(skb) +
	241	sizeof(struct icmphdr));
	242	}
	243
03f0d916	244	static int parse_ipv6hdr(struct sk_buff skb, struct sw_flow_key key)
ccb1352e JG	245	{
	246	unsigned int nh_ofs = skb_network_offset(skb);
	247	unsigned int nh_len;
	248	int payload_ofs;
	249	struct ipv6hdr *nh;
	250	uint8_t nexthdr;
	251	__be16 frag_off;
	252	int err;
	253
ccb1352e JG	254	err = check_header(skb, nh_ofs + sizeof(*nh));
	255	if (unlikely(err))
	256	return err;
	257
	258	nh = ipv6_hdr(skb);
	259	nexthdr = nh->nexthdr;
	260	payload_ofs = (u8 *)(nh + 1) - skb->data;
	261
	262	key->ip.proto = NEXTHDR_NONE;
	263	key->ip.tos = ipv6_get_dsfield(nh);
	264	key->ip.ttl = nh->hop_limit;
	265	key->ipv6.label = (__be32 )nh & htonl(IPV6_FLOWINFO_FLOWLABEL);
	266	key->ipv6.addr.src = nh->saddr;
	267	key->ipv6.addr.dst = nh->daddr;
	268
	269	payload_ofs = ipv6_skip_exthdr(skb, payload_ofs, &nexthdr, &frag_off);
	270	if (unlikely(payload_ofs < 0))
	271	return -EINVAL;
	272
	273	if (frag_off) {
	274	if (frag_off & htons(~0x7))
	275	key->ip.frag = OVS_FRAG_TYPE_LATER;
	276	else
	277	key->ip.frag = OVS_FRAG_TYPE_FIRST;
	278	}
	279
	280	nh_len = payload_ofs - nh_ofs;
	281	skb_set_transport_header(skb, nh_ofs + nh_len);
	282	key->ip.proto = nexthdr;
	283	return nh_len;
	284	}
	285
	286	static bool icmp6hdr_ok(struct sk_buff *skb)
	287	{
	288	return pskb_may_pull(skb, skb_transport_offset(skb) +
	289	sizeof(struct icmp6hdr));
	290	}
	291
ccb1352e JG	292	static int parse_vlan(struct sk_buff skb, struct sw_flow_key key)
	293	{
	294	struct qtag_prefix {
	295	__be16 eth_type; /* ETH_P_8021Q */
	296	__be16 tci;
	297	};
	298	struct qtag_prefix *qp;
	299
	300	if (unlikely(skb->len < sizeof(struct qtag_prefix) + sizeof(__be16)))
	301	return 0;
	302
	303	if (unlikely(!pskb_may_pull(skb, sizeof(struct qtag_prefix) +
	304	sizeof(__be16))))
	305	return -ENOMEM;
	306
	307	qp = (struct qtag_prefix *) skb->data;
	308	key->eth.tci = qp->tci \| htons(VLAN_TAG_PRESENT);
	309	__skb_pull(skb, sizeof(struct qtag_prefix));
	310
	311	return 0;
	312	}
	313
	314	static __be16 parse_ethertype(struct sk_buff *skb)
	315	{
	316	struct llc_snap_hdr {
	317	u8 dsap; /* Always 0xAA */
	318	u8 ssap; /* Always 0xAA */
	319	u8 ctrl;
	320	u8 oui[3];
	321	__be16 ethertype;
	322	};
	323	struct llc_snap_hdr *llc;
	324	__be16 proto;
	325
	326	proto = (__be16 ) skb->data;
	327	__skb_pull(skb, sizeof(__be16));
	328
e5c5d22e	329	if (ntohs(proto) >= ETH_P_802_3_MIN)
ccb1352e JG	330	return proto;
	331
	332	if (skb->len < sizeof(struct llc_snap_hdr))
	333	return htons(ETH_P_802_2);
	334
	335	if (unlikely(!pskb_may_pull(skb, sizeof(struct llc_snap_hdr))))
	336	return htons(0);
	337
	338	llc = (struct llc_snap_hdr *) skb->data;
	339	if (llc->dsap != LLC_SAP_SNAP \|\|
	340	llc->ssap != LLC_SAP_SNAP \|\|
	341	(llc->oui[0] \| llc->oui[1] \| llc->oui[2]) != 0)
	342	return htons(ETH_P_802_2);
	343
	344	__skb_pull(skb, sizeof(struct llc_snap_hdr));
17b682a0	345
e5c5d22e	346	if (ntohs(llc->ethertype) >= ETH_P_802_3_MIN)
17b682a0 RL	347	return llc->ethertype;
	348
	349	return htons(ETH_P_802_2);
ccb1352e JG	350	}
	351
	352	static int parse_icmpv6(struct sk_buff skb, struct sw_flow_key key,
03f0d916	353	int nh_len)
ccb1352e JG	354	{
ccb1352e JG	355	struct icmp6hdr *icmp = icmp6_hdr(skb);
ccb1352e JG	356
	357	/* The ICMPv6 type and code fields use the 16-bit transport port
	358	* fields, so we need to store them in 16-bit network byte order.
	359	*/
	360	key->ipv6.tp.src = htons(icmp->icmp6_type);
	361	key->ipv6.tp.dst = htons(icmp->icmp6_code);
ccb1352e JG	362
	363	if (icmp->icmp6_code == 0 &&
	364	(icmp->icmp6_type == NDISC_NEIGHBOUR_SOLICITATION \|\|
	365	icmp->icmp6_type == NDISC_NEIGHBOUR_ADVERTISEMENT)) {
	366	int icmp_len = skb->len - skb_transport_offset(skb);
	367	struct nd_msg *nd;
	368	int offset;
	369
ccb1352e JG	370	/* In order to process neighbor discovery options, we need the
	371	* entire packet.
	372	*/
	373	if (unlikely(icmp_len < sizeof(*nd)))
03f0d916 AZ	374	return 0;
	375
	376	if (unlikely(skb_linearize(skb)))
	377	return -ENOMEM;
ccb1352e JG	378
	379	nd = (struct nd_msg *)skb_transport_header(skb);
	380	key->ipv6.nd.target = nd->target;
ccb1352e JG	381
	382	icmp_len -= sizeof(*nd);
	383	offset = 0;
	384	while (icmp_len >= 8) {
	385	struct nd_opt_hdr *nd_opt =
	386	(struct nd_opt_hdr *)(nd->opt + offset);
	387	int opt_len = nd_opt->nd_opt_len * 8;
	388
	389	if (unlikely(!opt_len \|\| opt_len > icmp_len))
03f0d916	390	return 0;
ccb1352e JG	391
	392	/* Store the link layer address if the appropriate
	393	* option is provided. It is considered an error if
	394	* the same link layer option is specified twice.
	395	*/
	396	if (nd_opt->nd_opt_type == ND_OPT_SOURCE_LL_ADDR
	397	&& opt_len == 8) {
	398	if (unlikely(!is_zero_ether_addr(key->ipv6.nd.sll)))
	399	goto invalid;
8c63ff09 JP	400	ether_addr_copy(key->ipv6.nd.sll,
8c63ff09 JP	401	&nd->opt[offset+sizeof(*nd_opt)]);
ccb1352e JG	402	} else if (nd_opt->nd_opt_type == ND_OPT_TARGET_LL_ADDR
	403	&& opt_len == 8) {
	404	if (unlikely(!is_zero_ether_addr(key->ipv6.nd.tll)))
	405	goto invalid;
8c63ff09 JP	406	ether_addr_copy(key->ipv6.nd.tll,
8c63ff09 JP	407	&nd->opt[offset+sizeof(*nd_opt)]);
ccb1352e JG	408	}
	409
	410	icmp_len -= opt_len;
	411	offset += opt_len;
	412	}
	413	}
	414
03f0d916	415	return 0;
ccb1352e JG	416
	417	invalid:
	418	memset(&key->ipv6.nd.target, 0, sizeof(key->ipv6.nd.target));
	419	memset(key->ipv6.nd.sll, 0, sizeof(key->ipv6.nd.sll));
	420	memset(key->ipv6.nd.tll, 0, sizeof(key->ipv6.nd.tll));
	421
03f0d916	422	return 0;
ccb1352e JG	423	}
	424
	425	/**
	426	* ovs_flow_extract - extracts a flow key from an Ethernet frame.
	427	* @skb: sk_buff that contains the frame, with skb->data pointing to the
	428	* Ethernet header
	429	* @in_port: port number on which @skb was received.
	430	* @key: output flow key
ccb1352e JG	431	*
	432	* The caller must ensure that skb->len >= ETH_HLEN.
	433	*
	434	* Returns 0 if successful, otherwise a negative errno value.
	435	*
	436	* Initializes @skb header pointers as follows:
	437	*
	438	* - skb->mac_header: the Ethernet header.
	439	*
	440	* - skb->network_header: just past the Ethernet header, or just past the
	441	* VLAN header, to the first byte of the Ethernet payload.
	442	*
34d94f21	443	* - skb->transport_header: If key->eth.type is ETH_P_IP or ETH_P_IPV6
ccb1352e JG	444	* on output, then just past the IP header, if one is present and
ccb1352e JG	445	* of a correct length, otherwise the same as skb->network_header.
34d94f21	446	* For other key->eth.type values it is left untouched.
ccb1352e	447	*/
03f0d916	448	int ovs_flow_extract(struct sk_buff skb, u16 in_port, struct sw_flow_key key)
ccb1352e	449	{
03f0d916	450	int error;
ccb1352e JG	451	struct ethhdr *eth;
	452
	453	memset(key, 0, sizeof(*key));
	454
	455	key->phy.priority = skb->priority;
7d5437c7 PS	456	if (OVS_CB(skb)->tun_key)
7d5437c7 PS	457	memcpy(&key->tun_key, OVS_CB(skb)->tun_key, sizeof(key->tun_key));
ccb1352e	458	key->phy.in_port = in_port;
39c7caeb	459	key->phy.skb_mark = skb->mark;
ccb1352e JG	460
	461	skb_reset_mac_header(skb);
	462
	463	/* Link layer. We are guaranteed to have at least the 14 byte Ethernet
	464	* header in the linear data area.
	465	*/
	466	eth = eth_hdr(skb);
8c63ff09 JP	467	ether_addr_copy(key->eth.src, eth->h_source);
8c63ff09 JP	468	ether_addr_copy(key->eth.dst, eth->h_dest);
ccb1352e JG	469
ccb1352e JG	470	__skb_pull(skb, 2 * ETH_ALEN);
b34df5e8 PS	471	/* We are going to push all headers that we pull, so no need to
	472	* update skb->csum here.
	473	*/
ccb1352e JG	474
	475	if (vlan_tx_tag_present(skb))
	476	key->eth.tci = htons(skb->vlan_tci);
	477	else if (eth->h_proto == htons(ETH_P_8021Q))
	478	if (unlikely(parse_vlan(skb, key)))
	479	return -ENOMEM;
	480
	481	key->eth.type = parse_ethertype(skb);
	482	if (unlikely(key->eth.type == htons(0)))
	483	return -ENOMEM;
	484
	485	skb_reset_network_header(skb);
	486	__skb_push(skb, skb->data - skb_mac_header(skb));
	487
	488	/* Network layer. */
	489	if (key->eth.type == htons(ETH_P_IP)) {
	490	struct iphdr *nh;
	491	__be16 offset;
	492
ccb1352e JG	493	error = check_iphdr(skb);
	494	if (unlikely(error)) {
	495	if (error == -EINVAL) {
	496	skb->transport_header = skb->network_header;
	497	error = 0;
	498	}
03f0d916	499	return error;
ccb1352e JG	500	}
	501
	502	nh = ip_hdr(skb);
	503	key->ipv4.addr.src = nh->saddr;
	504	key->ipv4.addr.dst = nh->daddr;
	505
	506	key->ip.proto = nh->protocol;
	507	key->ip.tos = nh->tos;
	508	key->ip.ttl = nh->ttl;
	509
	510	offset = nh->frag_off & htons(IP_OFFSET);
	511	if (offset) {
	512	key->ip.frag = OVS_FRAG_TYPE_LATER;
03f0d916	513	return 0;
ccb1352e JG	514	}
	515	if (nh->frag_off & htons(IP_MF) \|\|
	516	skb_shinfo(skb)->gso_type & SKB_GSO_UDP)
	517	key->ip.frag = OVS_FRAG_TYPE_FIRST;
	518
	519	/* Transport layer. */
	520	if (key->ip.proto == IPPROTO_TCP) {
ccb1352e JG	521	if (tcphdr_ok(skb)) {
	522	struct tcphdr *tcp = tcp_hdr(skb);
	523	key->ipv4.tp.src = tcp->source;
	524	key->ipv4.tp.dst = tcp->dest;
5eb26b15	525	key->ipv4.tp.flags = TCP_FLAGS_BE16(tcp);
ccb1352e JG	526	}
ccb1352e JG	527	} else if (key->ip.proto == IPPROTO_UDP) {
ccb1352e JG	528	if (udphdr_ok(skb)) {
	529	struct udphdr *udp = udp_hdr(skb);
	530	key->ipv4.tp.src = udp->source;
	531	key->ipv4.tp.dst = udp->dest;
	532	}
a175a723 JS	533	} else if (key->ip.proto == IPPROTO_SCTP) {
	534	if (sctphdr_ok(skb)) {
	535	struct sctphdr *sctp = sctp_hdr(skb);
	536	key->ipv4.tp.src = sctp->source;
	537	key->ipv4.tp.dst = sctp->dest;
	538	}
ccb1352e	539	} else if (key->ip.proto == IPPROTO_ICMP) {
ccb1352e JG	540	if (icmphdr_ok(skb)) {
	541	struct icmphdr *icmp = icmp_hdr(skb);
	542	/* The ICMP type and code fields use the 16-bit
	543	* transport port fields, so we need to store
	544	* them in 16-bit network byte order. */
	545	key->ipv4.tp.src = htons(icmp->type);
	546	key->ipv4.tp.dst = htons(icmp->code);
	547	}
	548	}
	549
c0618533 MM	550	} else if ((key->eth.type == htons(ETH_P_ARP) \|\|
c0618533 MM	551	key->eth.type == htons(ETH_P_RARP)) && arphdr_ok(skb)) {
ccb1352e JG	552	struct arp_eth_header *arp;
	553
	554	arp = (struct arp_eth_header *)skb_network_header(skb);
	555
	556	if (arp->ar_hrd == htons(ARPHRD_ETHER)
	557	&& arp->ar_pro == htons(ETH_P_IP)
	558	&& arp->ar_hln == ETH_ALEN
	559	&& arp->ar_pln == 4) {
	560
	561	/* We only match on the lower 8 bits of the opcode. */
	562	if (ntohs(arp->ar_op) <= 0xff)
	563	key->ip.proto = ntohs(arp->ar_op);
d04d3829 MM	564	memcpy(&key->ipv4.addr.src, arp->ar_sip, sizeof(key->ipv4.addr.src));
d04d3829 MM	565	memcpy(&key->ipv4.addr.dst, arp->ar_tip, sizeof(key->ipv4.addr.dst));
8c63ff09 JP	566	ether_addr_copy(key->ipv4.arp.sha, arp->ar_sha);
8c63ff09 JP	567	ether_addr_copy(key->ipv4.arp.tha, arp->ar_tha);
ccb1352e JG	568	}
	569	} else if (key->eth.type == htons(ETH_P_IPV6)) {
	570	int nh_len; /* IPv6 Header + Extensions */
	571
03f0d916	572	nh_len = parse_ipv6hdr(skb, key);
ccb1352e	573	if (unlikely(nh_len < 0)) {
03f0d916	574	if (nh_len == -EINVAL) {
ccb1352e	575	skb->transport_header = skb->network_header;
03f0d916 AZ	576	error = 0;
03f0d916 AZ	577	} else {
ccb1352e	578	error = nh_len;
03f0d916 AZ	579	}
03f0d916 AZ	580	return error;
ccb1352e JG	581	}
	582
	583	if (key->ip.frag == OVS_FRAG_TYPE_LATER)
03f0d916	584	return 0;
ccb1352e JG	585	if (skb_shinfo(skb)->gso_type & SKB_GSO_UDP)
	586	key->ip.frag = OVS_FRAG_TYPE_FIRST;
	587
	588	/* Transport layer. */
	589	if (key->ip.proto == NEXTHDR_TCP) {
ccb1352e JG	590	if (tcphdr_ok(skb)) {
	591	struct tcphdr *tcp = tcp_hdr(skb);
	592	key->ipv6.tp.src = tcp->source;
	593	key->ipv6.tp.dst = tcp->dest;
5eb26b15	594	key->ipv6.tp.flags = TCP_FLAGS_BE16(tcp);
ccb1352e JG	595	}
ccb1352e JG	596	} else if (key->ip.proto == NEXTHDR_UDP) {
ccb1352e JG	597	if (udphdr_ok(skb)) {
	598	struct udphdr *udp = udp_hdr(skb);
	599	key->ipv6.tp.src = udp->source;
	600	key->ipv6.tp.dst = udp->dest;
	601	}
a175a723 JS	602	} else if (key->ip.proto == NEXTHDR_SCTP) {
	603	if (sctphdr_ok(skb)) {
	604	struct sctphdr *sctp = sctp_hdr(skb);
	605	key->ipv6.tp.src = sctp->source;
	606	key->ipv6.tp.dst = sctp->dest;
	607	}
ccb1352e	608	} else if (key->ip.proto == NEXTHDR_ICMP) {
ccb1352e	609	if (icmp6hdr_ok(skb)) {
03f0d916 AZ	610	error = parse_icmpv6(skb, key, nh_len);
	611	if (error)
	612	return error;
ccb1352e JG	613	}
	614	}
	615	}
	616
03f0d916	617	return 0;
ccb1352e	618	}