Head

GCC Code Coverage Report

Directory:	./		Exec	Total	Coverage
File:	usr.sbin/switchctl/../switchd/ofp10.c	Lines:	0	177	0.0 %
Date:	2017-11-07	Branches:	0	90	0.0 %


/*	$OpenBSD: ofp10.c,v 1.19 2016/12/02 14:39:46 rzalamena Exp $	*/

/*
 * Copyright (c) 2013-2016 Reyk Floeter <reyk@openbsd.org>
 *
 * Permission to use, copy, modify, and distribute this software for any
 * purpose with or without fee is hereby granted, provided that the above
 * copyright notice and this permission notice appear in all copies.
 *
 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
 * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
 * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
 * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
 */

#include <sys/types.h>
#include <sys/queue.h>
#include <sys/socket.h>

#include <net/if.h>
#include <net/if_arp.h>
#include <net/ofp.h>

#include <netinet/in.h>
#include <netinet/if_ether.h>
#include <netinet/tcp.h>

#include <stdio.h>
#include <stdlib.h>
#include <unistd.h>
#include <string.h>
#include <fcntl.h>
#include <imsg.h>
#include <event.h>

#include "ofp10.h"
#include "switchd.h"
#include "ofp_map.h"


int	 ofp10_packet_match(struct packet *, struct ofp10_match *, unsigned int);

int	 ofp10_features_reply(struct switchd *, struct switch_connection *,
	    struct ofp_header *, struct ibuf *);
int	 ofp10_validate_features_reply(struct switchd *,
	    struct sockaddr_storage *, struct sockaddr_storage *,
	    struct ofp_header *, struct ibuf *);
int	 ofp10_echo_request(struct switchd *, struct switch_connection *,
	    struct ofp_header *, struct ibuf *);
int	 ofp10_validate_error(struct switchd *,
	    struct sockaddr_storage *, struct sockaddr_storage *,
	    struct ofp_header *, struct ibuf *);
int	 ofp10_error(struct switchd *, struct switch_connection *,
	    struct ofp_header *, struct ibuf *);
int	 ofp10_validate_packet_in(struct switchd *,
	    struct sockaddr_storage *, struct sockaddr_storage *,
	    struct ofp_header *, struct ibuf *);
int	 ofp10_packet_in(struct switchd *, struct switch_connection *,
	    struct ofp_header *, struct ibuf *);
int	 ofp10_validate_packet_out(struct switchd *,
	    struct sockaddr_storage *, struct sockaddr_storage *,
	    struct ofp_header *, struct ibuf *);

struct ofp_callback ofp10_callbacks[] = {
	{ OFP10_T_HELLO,		ofp10_hello, ofp_validate_hello },
	{ OFP10_T_ERROR,		NULL, ofp10_validate_error },
	{ OFP10_T_ECHO_REQUEST,		ofp10_echo_request, NULL },
	{ OFP10_T_ECHO_REPLY,		NULL, NULL },
	{ OFP10_T_EXPERIMENTER,		NULL, NULL },
	{ OFP10_T_FEATURES_REQUEST,	NULL, NULL },
	{ OFP10_T_FEATURES_REPLY,	ofp10_features_reply,
					ofp10_validate_features_reply },
	{ OFP10_T_GET_CONFIG_REQUEST,	NULL, NULL },
	{ OFP10_T_GET_CONFIG_REPLY,	NULL, NULL },
	{ OFP10_T_SET_CONFIG,		NULL, NULL },
	{ OFP10_T_PACKET_IN,		ofp10_packet_in, ofp10_validate_packet_in },
	{ OFP10_T_FLOW_REMOVED,		NULL, NULL },
	{ OFP10_T_PORT_STATUS,		NULL, NULL },
	{ OFP10_T_PACKET_OUT,		NULL, ofp10_validate_packet_out },
	{ OFP10_T_FLOW_MOD,		NULL, NULL },
	{ OFP10_T_PORT_MOD,		NULL, NULL },
	{ OFP10_T_STATS_REQUEST,	NULL, NULL },
	{ OFP10_T_STATS_REPLY,		NULL, NULL },
	{ OFP10_T_BARRIER_REQUEST,	NULL, NULL },
	{ OFP10_T_BARRIER_REPLY,	NULL, NULL },
	{ OFP10_T_QUEUE_GET_CONFIG_REQUEST, NULL, NULL },
	{ OFP10_T_QUEUE_GET_CONFIG_REPLY, NULL, NULL }
};

int
ofp10_validate(struct switchd *sc,
    struct sockaddr_storage *src, struct sockaddr_storage *dst,
    struct ofp_header *oh, struct ibuf *ibuf)
{
	uint8_t	type;

	if (ofp_validate_header(sc, src, dst, oh, OFP_V_1_0) != 0) {
		log_debug("\tinvalid header");
		return (-1);
	}
	if (ibuf == NULL) {
		/* The response packet buffer is optional */
		return (0);
	}
	type = oh->oh_type;
	if (ofp10_callbacks[type].validate != NULL &&
	    ofp10_callbacks[type].validate(sc, src, dst, oh, ibuf) != 0) {
		log_debug("\tinvalid packet");
		return (-1);
	}
	return (0);
}

int
ofp10_validate_packet_in(struct switchd *sc,
    struct sockaddr_storage *src, struct sockaddr_storage *dst,
    struct ofp_header *oh, struct ibuf *ibuf)
{
	struct ofp10_packet_in	*pin;
	uint8_t			*p;
	size_t			 len, plen;
	off_t			 off;

	off = 0;
	if ((pin = ibuf_seek(ibuf, off, sizeof(*pin))) == NULL)
		return (-1);
	log_debug("\tbuffer %d port %s "
	    "length %u reason %u",
	    ntohl(pin->pin_buffer_id),
	    print_map(ntohs(pin->pin_port), ofp10_port_map),
	    ntohs(pin->pin_total_len),
	    pin->pin_reason);
	off += sizeof(*pin);

	len = ntohs(pin->pin_total_len);
	plen = ibuf_length(ibuf) - off;

	if (plen < len) {
		log_debug("\ttruncated packet %zu < %zu", plen, len);

		/* Buffered packets can be truncated */
		if (pin->pin_buffer_id != OFP_PKTOUT_NO_BUFFER)
			len = plen;
		else
			return (-1);
	}
	if ((p = ibuf_seek(ibuf, off, len)) == NULL)
		return (-1);
	if (sc->sc_tap != -1)
		(void)write(sc->sc_tap, p, len);

	return (0);
}

int
ofp10_validate_packet_out(struct switchd *sc,
    struct sockaddr_storage *src, struct sockaddr_storage *dst,
    struct ofp_header *oh, struct ibuf *ibuf)
{
	struct ofp10_packet_out		*pout;
	size_t				 len;
	off_t				 off;
	struct ofp_action_header	*ah;
	struct ofp10_action_output	*ao;

	off = 0;
	if ((pout = ibuf_seek(ibuf, off, sizeof(*pout))) == NULL) {
		log_debug("%s: seek failed: length %zd",
		    __func__, ibuf_length(ibuf));
		return (-1);
	}
	log_debug("\tbuffer %d port %s "
	    "actions length %u",
	    ntohl(pout->pout_buffer_id),
	    print_map(ntohs(pout->pout_port), ofp10_port_map),
	    ntohs(pout->pout_actions_len));
	len = ntohs(pout->pout_actions_len);

	off += sizeof(*pout);
	while ((ah = ibuf_seek(ibuf, off, len)) != NULL &&
	    ntohs(ah->ah_len) >= (uint16_t)sizeof(*ah)) {
		switch (ntohs(ah->ah_type)) {
		case OFP10_ACTION_OUTPUT:
			ao = (struct ofp10_action_output *)ah;
			log_debug("\t\taction type %s length %d "
			    "port %s max length %d",
			    print_map(ntohs(ao->ao_type), ofp10_action_map),
			    ntohs(ao->ao_len),
			    print_map(ntohs(ao->ao_port), ofp10_port_map),
			    ntohs(ao->ao_max_len));
			break;
		default:
			log_debug("\t\taction type %s length %d",
			    print_map(ntohs(ah->ah_type), ofp10_action_map),
			    ntohs(ah->ah_len));
			break;
		}
		if (pout->pout_buffer_id == (uint32_t)-1)
			break;
		off += ntohs(ah->ah_len);
	}

	return (0);
}

int
ofp10_validate_error(struct switchd *sc,
    struct sockaddr_storage *src, struct sockaddr_storage *dst,
    struct ofp_header *oh, struct ibuf *ibuf)
{
	struct ofp_error		*err;
	off_t				 off;
	const char			*code;

	off = 0;
	if ((err = ibuf_seek(ibuf, off, sizeof(*err))) == NULL) {
		log_debug("%s: seek failed: length %zd",
		    __func__, ibuf_length(ibuf));
		return (-1);
	}

	switch (ntohs(err->err_type)) {
	case OFP10_ERRTYPE_FLOW_MOD_FAILED:
		code = print_map(ntohs(err->err_code), ofp10_errflowmod_map);
		break;
	default:
		code = NULL;
		break;
	}

	log_debug("\terror type %s code %u%s%s",
	    print_map(ntohs(err->err_type), ofp10_errtype_map),
	    ntohs(err->err_code),
	    code == NULL ? "" : ": ",
	    code == NULL ? "" : code);

	return (0);
}

int
ofp10_input(struct switchd *sc, struct switch_connection *con,
    struct ofp_header *oh, struct ibuf *ibuf)
{
	if (ofp10_validate(sc, &con->con_peer, &con->con_local, oh, ibuf) != 0)
		return (-1);

	if (ofp10_callbacks[oh->oh_type].cb == NULL) {
		log_debug("message not supported: %s",
		    print_map(oh->oh_type, ofp10_t_map));
		return (-1);
	}
	if (ofp10_callbacks[oh->oh_type].cb(sc, con, oh, ibuf) != 0)
		return (-1);

	return (0);
}

int
ofp10_hello(struct switchd *sc, struct switch_connection *con,
    struct ofp_header *oh, struct ibuf *ibuf)
{
	if (switch_add(con) == NULL) {
		log_debug("%s: failed to add switch", __func__);
		return (-1);
	}

	if (ofp_recv_hello(sc, con, oh, ibuf) == -1)
		return (-1);

	return (ofp_nextstate(sc, con, OFP_STATE_FEATURE_WAIT));
}

int
ofp10_features_reply(struct switchd *sc, struct switch_connection *con,
    struct ofp_header *oh, struct ibuf *ibuf)
{
	return (ofp_nextstate(sc, con, OFP_STATE_ESTABLISHED));
}

int
ofp10_validate_features_reply(struct switchd *sc,
    struct sockaddr_storage *src, struct sockaddr_storage *dst,
    struct ofp_header *oh, struct ibuf *ibuf)
{
	struct ofp_switch_features	*swf;
	struct ofp10_phy_port		*swp;
	off_t				 poff;
	int				 portslen;
	char				*mac;

	if ((swf = ibuf_seek(ibuf, 0, sizeof(*swf))) == NULL)
		return (-1);

	log_debug("\tdatapath_id %#016llx nbuffers %u ntables %d "
	    "capabilities %#08x actions %#08x",
	    be64toh(swf->swf_datapath_id), ntohl(swf->swf_nbuffers),
	    swf->swf_ntables, ntohl(swf->swf_capabilities),
	    ntohl(swf->swf_actions));

	poff = sizeof(*swf);
	portslen = ntohs(oh->oh_length) - sizeof(*swf);
	if (portslen <= 0)
		return (0);

	while (portslen > 0) {
		if ((swp = ibuf_seek(ibuf, poff, sizeof(*swp))) == NULL)
			return (-1);

		mac = ether_ntoa((void *)swp->swp_macaddr);
		log_debug("no %s macaddr %s name %s config %#08x state %#08x "
		    "cur %#08x advertised %#08x supported %#08x peer %#08x",
		    print_map(ntohs(swp->swp_number), ofp10_port_map), mac,
		    swp->swp_name, swp->swp_config, swp->swp_state,
		    swp->swp_cur, swp->swp_advertised, swp->swp_supported,
		    swp->swp_peer);

		portslen -= sizeof(*swp);
		poff += sizeof(*swp);
	}

	return (0);
}

int
ofp10_echo_request(struct switchd *sc, struct switch_connection *con,
    struct ofp_header *oh, struct ibuf *ibuf)
{
	/* Echo reply */
	oh->oh_type = OFP10_T_ECHO_REPLY;
	if (ofp10_validate(sc, &con->con_local, &con->con_peer, oh, NULL) != 0)
		return (-1);
	ofp_output(con, oh, NULL);

	return (0);
}

int
ofp10_packet_match(struct packet *pkt, struct ofp10_match *m, uint32_t flags)
{
	struct ether_header	*eh = pkt->pkt_eh;

	bzero(m, sizeof(*m));
	m->m_wildcards = htonl(~flags);

	if ((flags & (OFP10_WILDCARD_DL_SRC|OFP10_WILDCARD_DL_DST)) &&
	    (eh == NULL))
		return (-1);

	if (flags & OFP10_WILDCARD_DL_SRC)
		memcpy(m->m_dl_src, eh->ether_shost, ETHER_ADDR_LEN);
	if (flags & OFP10_WILDCARD_DL_DST)
		memcpy(m->m_dl_dst, eh->ether_dhost, ETHER_ADDR_LEN);

	return (0);
}

int
ofp10_packet_in(struct switchd *sc, struct switch_connection *con,
    struct ofp_header *ih, struct ibuf *ibuf)
{
	struct ofp10_packet_in		*pin;
	struct ofp10_packet_out		*pout;
	struct ofp10_action_output	*ao;
	struct ofp10_flow_mod		*fm;
	struct ofp_header		*oh;
	struct packet			 pkt;
	struct ibuf			*obuf = NULL;
	int				 ret = -1;
	size_t				 len;
	uint32_t			 srcport, dstport;
	int				 addflow = 0;
	int				 addpacket = 0;

	if ((pin = ibuf_getdata(ibuf, sizeof(*pin))) == NULL)
		return (-1);

	bzero(&pkt, sizeof(pkt));
	len = ntohs(pin->pin_total_len);
	srcport = ntohs(pin->pin_port);

	if (packet_input(sc, con->con_switch,
	    srcport, &dstport, ibuf, len, &pkt) == -1 ||
	    (dstport > OFP10_PORT_MAX &&
	    dstport != OFP10_PORT_LOCAL &&
	    dstport != OFP10_PORT_CONTROLLER)) {
		/* fallback to flooding */
		dstport = OFP10_PORT_FLOOD;
	} else if (srcport == dstport) {
		/*
		 * silently drop looping packet
		 * (don't use OFP10_PORT_INPUT here)
		 */
		dstport = OFP10_PORT_ANY;
	} else {
		addflow = 1;
	}

	if ((obuf = ibuf_static()) == NULL)
		goto done;

 again:
	if (addflow) {
		if ((fm = ibuf_advance(obuf, sizeof(*fm))) == NULL)
			goto done;

		ofp10_packet_match(&pkt, &fm->fm_match, OFP10_WILDCARD_DL_DST);

		oh = &fm->fm_oh;
		fm->fm_cookie = 0; /* XXX should we set a cookie? */
		fm->fm_command = htons(OFP_FLOWCMD_ADD);
		fm->fm_idle_timeout = htons(sc->sc_cache_timeout);
		fm->fm_hard_timeout = 0; /* permanent */
		fm->fm_priority = 0;
		fm->fm_buffer_id = pin->pin_buffer_id;
		fm->fm_flags = htons(OFP_FLOWFLAG_SEND_FLOW_REMOVED);
		if (pin->pin_buffer_id == htonl(OFP_PKTOUT_NO_BUFFER))
			addpacket = 1;
	} else {
		if ((pout = ibuf_advance(obuf, sizeof(*pout))) == NULL)
			goto done;

		oh = &pout->pout_oh;
		pout->pout_buffer_id = pin->pin_buffer_id;
		pout->pout_port = pin->pin_port;
		pout->pout_actions_len = htons(sizeof(*ao));

		if (pin->pin_buffer_id == htonl(OFP_PKTOUT_NO_BUFFER))
			addpacket = 1;
	}

	if ((ao = ibuf_advance(obuf, sizeof(*ao))) == NULL)
		goto done;
	ao->ao_type = htons(OFP_ACTION_OUTPUT);
	ao->ao_len =  htons(sizeof(*ao));
	ao->ao_port = htons((uint16_t)dstport);
	ao->ao_max_len = 0;

	/* Add optional packet payload to packet-out. */
	if (addflow == 0 && addpacket &&
	    imsg_add(obuf, pkt.pkt_buf, pkt.pkt_len) == -1)
		goto done;

	/* Set output header */
	memcpy(oh, ih, sizeof(*oh));
	oh->oh_length = htons(ibuf_length(obuf));
	oh->oh_type = addflow ? OFP10_T_FLOW_MOD : OFP10_T_PACKET_OUT;
	oh->oh_xid = htonl(con->con_xidnxt++);

	if (ofp10_validate(sc, &con->con_local, &con->con_peer, oh, obuf) != 0)
		goto done;

	ofp_output(con, NULL, obuf);

	if (addflow && addpacket) {
		/* loop to output the packet again */
		addflow = 0;
		if ((obuf = ibuf_static()) == NULL)
			goto done;
		goto again;
	}

	ret = 0;
 done:
	ibuf_release(obuf);
	return (ret);
}


Generated by: GCOVR (Version 3.3)

Line	Branch	Exec	Source
1			/* $OpenBSD: ofp10.c,v 1.19 2016/12/02 14:39:46 rzalamena Exp $ */
2
3			/*
4			* Copyright (c) 2013-2016 Reyk Floeter <reyk@openbsd.org>
5			*
6			* Permission to use, copy, modify, and distribute this software for any
7			* purpose with or without fee is hereby granted, provided that the above
8			* copyright notice and this permission notice appear in all copies.
9			*
10			* THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
11			* WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
12			* MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
13			* ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
14			* WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
15			* ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
16			* OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
17			*/
18
19			#include <sys/types.h>
20			#include <sys/queue.h>
21			#include <sys/socket.h>
22
23			#include <net/if.h>
24			#include <net/if_arp.h>
25			#include <net/ofp.h>
26
27			#include <netinet/in.h>
28			#include <netinet/if_ether.h>
29			#include <netinet/tcp.h>
30
31			#include <stdio.h>
32			#include <stdlib.h>
33			#include <unistd.h>
34			#include <string.h>
35			#include <fcntl.h>
36			#include <imsg.h>
37			#include <event.h>
38
39			#include "ofp10.h"
40			#include "switchd.h"
41			#include "ofp_map.h"
42
43
44			int ofp10_packet_match(struct packet , struct ofp10_match , unsigned int);
45
46			int ofp10_features_reply(struct switchd , struct switch_connection ,
47			struct ofp_header , struct ibuf );
48			int ofp10_validate_features_reply(struct switchd *,
49			struct sockaddr_storage , struct sockaddr_storage ,
50			struct ofp_header , struct ibuf );
51			int ofp10_echo_request(struct switchd , struct switch_connection ,
52			struct ofp_header , struct ibuf );
53			int ofp10_validate_error(struct switchd *,
54			struct sockaddr_storage , struct sockaddr_storage ,
55			struct ofp_header , struct ibuf );
56			int ofp10_error(struct switchd , struct switch_connection ,
57			struct ofp_header , struct ibuf );
58			int ofp10_validate_packet_in(struct switchd *,
59			struct sockaddr_storage , struct sockaddr_storage ,
60			struct ofp_header , struct ibuf );
61			int ofp10_packet_in(struct switchd , struct switch_connection ,
62			struct ofp_header , struct ibuf );
63			int ofp10_validate_packet_out(struct switchd *,
64			struct sockaddr_storage , struct sockaddr_storage ,
65			struct ofp_header , struct ibuf );
66
67			struct ofp_callback ofp10_callbacks[] = {
68			{ OFP10_T_HELLO, ofp10_hello, ofp_validate_hello },
69			{ OFP10_T_ERROR, NULL, ofp10_validate_error },
70			{ OFP10_T_ECHO_REQUEST, ofp10_echo_request, NULL },
71			{ OFP10_T_ECHO_REPLY, NULL, NULL },
72			{ OFP10_T_EXPERIMENTER, NULL, NULL },
73			{ OFP10_T_FEATURES_REQUEST, NULL, NULL },
74			{ OFP10_T_FEATURES_REPLY, ofp10_features_reply,
75			ofp10_validate_features_reply },
76			{ OFP10_T_GET_CONFIG_REQUEST, NULL, NULL },
77			{ OFP10_T_GET_CONFIG_REPLY, NULL, NULL },
78			{ OFP10_T_SET_CONFIG, NULL, NULL },
79			{ OFP10_T_PACKET_IN, ofp10_packet_in, ofp10_validate_packet_in },
80			{ OFP10_T_FLOW_REMOVED, NULL, NULL },
81			{ OFP10_T_PORT_STATUS, NULL, NULL },
82			{ OFP10_T_PACKET_OUT, NULL, ofp10_validate_packet_out },
83			{ OFP10_T_FLOW_MOD, NULL, NULL },
84			{ OFP10_T_PORT_MOD, NULL, NULL },
85			{ OFP10_T_STATS_REQUEST, NULL, NULL },
86			{ OFP10_T_STATS_REPLY, NULL, NULL },
87			{ OFP10_T_BARRIER_REQUEST, NULL, NULL },
88			{ OFP10_T_BARRIER_REPLY, NULL, NULL },
89			{ OFP10_T_QUEUE_GET_CONFIG_REQUEST, NULL, NULL },
90			{ OFP10_T_QUEUE_GET_CONFIG_REPLY, NULL, NULL }
91			};
92
93			int
94			ofp10_validate(struct switchd *sc,
95			struct sockaddr_storage src, struct sockaddr_storage dst,
96			struct ofp_header oh, struct ibuf ibuf)
97			{
98			uint8_t type;
99
100			if (ofp_validate_header(sc, src, dst, oh, OFP_V_1_0) != 0) {
101			log_debug("\tinvalid header");
102			return (-1);
103			}
104			if (ibuf == NULL) {
105			/* The response packet buffer is optional */
106			return (0);
107			}
108			type = oh->oh_type;
109			if (ofp10_callbacks[type].validate != NULL &&
110			ofp10_callbacks[type].validate(sc, src, dst, oh, ibuf) != 0) {
111			log_debug("\tinvalid packet");
112			return (-1);
113			}
114			return (0);
115			}
116
117			int
118			ofp10_validate_packet_in(struct switchd *sc,
119			struct sockaddr_storage src, struct sockaddr_storage dst,
120			struct ofp_header oh, struct ibuf ibuf)
121			{
122			struct ofp10_packet_in *pin;
123			uint8_t *p;
124			size_t len, plen;
125			off_t off;
126
127			off = 0;
128			if ((pin = ibuf_seek(ibuf, off, sizeof(*pin))) == NULL)
129			return (-1);
130			log_debug("\tbuffer %d port %s "
131			"length %u reason %u",
132			ntohl(pin->pin_buffer_id),
133			print_map(ntohs(pin->pin_port), ofp10_port_map),
134			ntohs(pin->pin_total_len),
135			pin->pin_reason);
136			off += sizeof(*pin);
137
138			len = ntohs(pin->pin_total_len);
139			plen = ibuf_length(ibuf) - off;
140
141			if (plen < len) {
142			log_debug("\ttruncated packet %zu < %zu", plen, len);
143
144			/* Buffered packets can be truncated */
145			if (pin->pin_buffer_id != OFP_PKTOUT_NO_BUFFER)
146			len = plen;
147			else
148			return (-1);
149			}
150			if ((p = ibuf_seek(ibuf, off, len)) == NULL)
151			return (-1);
152			if (sc->sc_tap != -1)
153			(void)write(sc->sc_tap, p, len);
154
155			return (0);
156			}
157
158			int
159			ofp10_validate_packet_out(struct switchd *sc,
160			struct sockaddr_storage src, struct sockaddr_storage dst,
161			struct ofp_header oh, struct ibuf ibuf)
162			{
163			struct ofp10_packet_out *pout;
164			size_t len;
165			off_t off;
166			struct ofp_action_header *ah;
167			struct ofp10_action_output *ao;
168
169			off = 0;
170			if ((pout = ibuf_seek(ibuf, off, sizeof(*pout))) == NULL) {
171			log_debug("%s: seek failed: length %zd",
172			__func__, ibuf_length(ibuf));
173			return (-1);
174			}
175			log_debug("\tbuffer %d port %s "
176			"actions length %u",
177			ntohl(pout->pout_buffer_id),
178			print_map(ntohs(pout->pout_port), ofp10_port_map),
179			ntohs(pout->pout_actions_len));
180			len = ntohs(pout->pout_actions_len);
181
182			off += sizeof(*pout);
183			while ((ah = ibuf_seek(ibuf, off, len)) != NULL &&
184			ntohs(ah->ah_len) >= (uint16_t)sizeof(*ah)) {
185			switch (ntohs(ah->ah_type)) {
186			case OFP10_ACTION_OUTPUT:
187			ao = (struct ofp10_action_output *)ah;
188			log_debug("\t\taction type %s length %d "
189			"port %s max length %d",
190			print_map(ntohs(ao->ao_type), ofp10_action_map),
191			ntohs(ao->ao_len),
192			print_map(ntohs(ao->ao_port), ofp10_port_map),
193			ntohs(ao->ao_max_len));
194			break;
195			default:
196			log_debug("\t\taction type %s length %d",
197			print_map(ntohs(ah->ah_type), ofp10_action_map),
198			ntohs(ah->ah_len));
199			break;
200			}
201			if (pout->pout_buffer_id == (uint32_t)-1)
202			break;
203			off += ntohs(ah->ah_len);
204			}
205
206			return (0);
207			}
208
209			int
210			ofp10_validate_error(struct switchd *sc,
211			struct sockaddr_storage src, struct sockaddr_storage dst,
212			struct ofp_header oh, struct ibuf ibuf)
213			{
214			struct ofp_error *err;
215			off_t off;
216			const char *code;
217
218			off = 0;
219			if ((err = ibuf_seek(ibuf, off, sizeof(*err))) == NULL) {
220			log_debug("%s: seek failed: length %zd",
221			__func__, ibuf_length(ibuf));
222			return (-1);
223			}
224
225			switch (ntohs(err->err_type)) {
226			case OFP10_ERRTYPE_FLOW_MOD_FAILED:
227			code = print_map(ntohs(err->err_code), ofp10_errflowmod_map);
228			break;
229			default:
230			code = NULL;
231			break;
232			}
233
234			log_debug("\terror type %s code %u%s%s",
235			print_map(ntohs(err->err_type), ofp10_errtype_map),
236			ntohs(err->err_code),
237			code == NULL ? "" : ": ",
238			code == NULL ? "" : code);
239
240			return (0);
241			}
242
243			int
244			ofp10_input(struct switchd sc, struct switch_connection con,
245			struct ofp_header oh, struct ibuf ibuf)
246			{
247			if (ofp10_validate(sc, &con->con_peer, &con->con_local, oh, ibuf) != 0)
248			return (-1);
249
250			if (ofp10_callbacks[oh->oh_type].cb == NULL) {
251			log_debug("message not supported: %s",
252			print_map(oh->oh_type, ofp10_t_map));
253			return (-1);
254			}
255			if (ofp10_callbacks[oh->oh_type].cb(sc, con, oh, ibuf) != 0)
256			return (-1);
257
258			return (0);
259			}
260
261			int
262			ofp10_hello(struct switchd sc, struct switch_connection con,
263			struct ofp_header oh, struct ibuf ibuf)
264			{
265			if (switch_add(con) == NULL) {
266			log_debug("%s: failed to add switch", __func__);
267			return (-1);
268			}
269
270			if (ofp_recv_hello(sc, con, oh, ibuf) == -1)
271			return (-1);
272
273			return (ofp_nextstate(sc, con, OFP_STATE_FEATURE_WAIT));
274			}
275
276			int
277			ofp10_features_reply(struct switchd sc, struct switch_connection con,
278			struct ofp_header oh, struct ibuf ibuf)
279			{
280			return (ofp_nextstate(sc, con, OFP_STATE_ESTABLISHED));
281			}
282
283			int
284			ofp10_validate_features_reply(struct switchd *sc,
285			struct sockaddr_storage src, struct sockaddr_storage dst,
286			struct ofp_header oh, struct ibuf ibuf)
287			{
288			struct ofp_switch_features *swf;
289			struct ofp10_phy_port *swp;
290			off_t poff;
291			int portslen;
292			char *mac;
293
294			if ((swf = ibuf_seek(ibuf, 0, sizeof(*swf))) == NULL)
295			return (-1);
296
297			log_debug("\tdatapath_id %#016llx nbuffers %u ntables %d "
298			"capabilities %#08x actions %#08x",
299			be64toh(swf->swf_datapath_id), ntohl(swf->swf_nbuffers),
300			swf->swf_ntables, ntohl(swf->swf_capabilities),
301			ntohl(swf->swf_actions));
302
303			poff = sizeof(*swf);
304			portslen = ntohs(oh->oh_length) - sizeof(*swf);
305			if (portslen <= 0)
306			return (0);
307
308			while (portslen > 0) {
309			if ((swp = ibuf_seek(ibuf, poff, sizeof(*swp))) == NULL)
310			return (-1);
311
312			mac = ether_ntoa((void *)swp->swp_macaddr);
313			log_debug("no %s macaddr %s name %s config %#08x state %#08x "
314			"cur %#08x advertised %#08x supported %#08x peer %#08x",
315			print_map(ntohs(swp->swp_number), ofp10_port_map), mac,
316			swp->swp_name, swp->swp_config, swp->swp_state,
317			swp->swp_cur, swp->swp_advertised, swp->swp_supported,
318			swp->swp_peer);
319
320			portslen -= sizeof(*swp);
321			poff += sizeof(*swp);
322			}
323
324			return (0);
325			}
326
327			int
328			ofp10_echo_request(struct switchd sc, struct switch_connection con,
329			struct ofp_header oh, struct ibuf ibuf)
330			{
331			/* Echo reply */
332			oh->oh_type = OFP10_T_ECHO_REPLY;
333			if (ofp10_validate(sc, &con->con_local, &con->con_peer, oh, NULL) != 0)
334			return (-1);
335			ofp_output(con, oh, NULL);
336
337			return (0);
338			}
339
340			int
341			ofp10_packet_match(struct packet pkt, struct ofp10_match m, uint32_t flags)
342			{
343			struct ether_header *eh = pkt->pkt_eh;
344
345			bzero(m, sizeof(*m));
346			m->m_wildcards = htonl(~flags);
347
348			if ((flags & (OFP10_WILDCARD_DL_SRC\|OFP10_WILDCARD_DL_DST)) &&
349			(eh == NULL))
350			return (-1);
351
352			if (flags & OFP10_WILDCARD_DL_SRC)
353			memcpy(m->m_dl_src, eh->ether_shost, ETHER_ADDR_LEN);
354			if (flags & OFP10_WILDCARD_DL_DST)
355			memcpy(m->m_dl_dst, eh->ether_dhost, ETHER_ADDR_LEN);
356
357			return (0);
358			}
359
360			int
361			ofp10_packet_in(struct switchd sc, struct switch_connection con,
362			struct ofp_header ih, struct ibuf ibuf)
363			{
364			struct ofp10_packet_in *pin;
365			struct ofp10_packet_out *pout;
366			struct ofp10_action_output *ao;
367			struct ofp10_flow_mod *fm;
368			struct ofp_header *oh;
369			struct packet pkt;
370			struct ibuf *obuf = NULL;
371			int ret = -1;
372			size_t len;
373			uint32_t srcport, dstport;
374			int addflow = 0;
375			int addpacket = 0;
376
377			if ((pin = ibuf_getdata(ibuf, sizeof(*pin))) == NULL)
378			return (-1);
379
380			bzero(&pkt, sizeof(pkt));
381			len = ntohs(pin->pin_total_len);
382			srcport = ntohs(pin->pin_port);
383
384			if (packet_input(sc, con->con_switch,
385			srcport, &dstport, ibuf, len, &pkt) == -1 \|\|
386			(dstport > OFP10_PORT_MAX &&
387			dstport != OFP10_PORT_LOCAL &&
388			dstport != OFP10_PORT_CONTROLLER)) {
389			/* fallback to flooding */
390			dstport = OFP10_PORT_FLOOD;
391			} else if (srcport == dstport) {
392			/*
393			* silently drop looping packet
394			* (don't use OFP10_PORT_INPUT here)
395			*/
396			dstport = OFP10_PORT_ANY;
397			} else {
398			addflow = 1;
399			}
400
401			if ((obuf = ibuf_static()) == NULL)
402			goto done;
403
404			again:
405			if (addflow) {
406			if ((fm = ibuf_advance(obuf, sizeof(*fm))) == NULL)
407			goto done;
408
409			ofp10_packet_match(&pkt, &fm->fm_match, OFP10_WILDCARD_DL_DST);
410
411			oh = &fm->fm_oh;
412			fm->fm_cookie = 0; /* XXX should we set a cookie? */
413			fm->fm_command = htons(OFP_FLOWCMD_ADD);
414			fm->fm_idle_timeout = htons(sc->sc_cache_timeout);
415			fm->fm_hard_timeout = 0; /* permanent */
416			fm->fm_priority = 0;
417			fm->fm_buffer_id = pin->pin_buffer_id;
418			fm->fm_flags = htons(OFP_FLOWFLAG_SEND_FLOW_REMOVED);
419			if (pin->pin_buffer_id == htonl(OFP_PKTOUT_NO_BUFFER))
420			addpacket = 1;
421			} else {
422			if ((pout = ibuf_advance(obuf, sizeof(*pout))) == NULL)
423			goto done;
424
425			oh = &pout->pout_oh;
426			pout->pout_buffer_id = pin->pin_buffer_id;
427			pout->pout_port = pin->pin_port;
428			pout->pout_actions_len = htons(sizeof(*ao));
429
430			if (pin->pin_buffer_id == htonl(OFP_PKTOUT_NO_BUFFER))
431			addpacket = 1;
432			}
433
434			if ((ao = ibuf_advance(obuf, sizeof(*ao))) == NULL)
435			goto done;
436			ao->ao_type = htons(OFP_ACTION_OUTPUT);
437			ao->ao_len = htons(sizeof(*ao));
438			ao->ao_port = htons((uint16_t)dstport);
439			ao->ao_max_len = 0;
440
441			/* Add optional packet payload to packet-out. */
442			if (addflow == 0 && addpacket &&
443			imsg_add(obuf, pkt.pkt_buf, pkt.pkt_len) == -1)
444			goto done;
445
446			/* Set output header */
447			memcpy(oh, ih, sizeof(*oh));
448			oh->oh_length = htons(ibuf_length(obuf));
449			oh->oh_type = addflow ? OFP10_T_FLOW_MOD : OFP10_T_PACKET_OUT;
450			oh->oh_xid = htonl(con->con_xidnxt++);
451
452			if (ofp10_validate(sc, &con->con_local, &con->con_peer, oh, obuf) != 0)
453			goto done;
454
455			ofp_output(con, NULL, obuf);
456
457			if (addflow && addpacket) {
458			/* loop to output the packet again */
459			addflow = 0;
460			if ((obuf = ibuf_static()) == NULL)
461			goto done;
462			goto again;
463			}
464
465			ret = 0;
466			done:
467			ibuf_release(obuf);
468			return (ret);
469			}