Home | History | Annotate | Line # | Download | only in agr
ieee8023ad_marker.c revision 1.1 
      1 /*	$NetBSD: ieee8023ad_marker.c,v 1.1 2005/03/18 11:11:50 yamt Exp $	*/
      2 
      3 /*-
      4  * Copyright (c)2005 YAMAMOTO Takashi,
      5  * All rights reserved.
      6  *
      7  * Redistribution and use in source and binary forms, with or without
      8  * modification, are permitted provided that the following conditions
      9  * are met:
     10  * 1. Redistributions of source code must retain the above copyright
     11  *    notice, this list of conditions and the following disclaimer.
     12  * 2. Redistributions in binary form must reproduce the above copyright
     13  *    notice, this list of conditions and the following disclaimer in the
     14  *    documentation and/or other materials provided with the distribution.
     15  *
     16  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
     17  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     18  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     19  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
     20  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     21  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     22  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     23  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     24  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     25  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     26  * SUCH DAMAGE.
     27  */
     28 
     29 #include <sys/cdefs.h>
     30 __KERNEL_RCSID(0, "$NetBSD: ieee8023ad_marker.c,v 1.1 2005/03/18 11:11:50 yamt Exp $");
     31 
     32 #include <sys/param.h>
     33 #include <sys/mbuf.h>
     34 #include <sys/systm.h>
     35 
     36 #include <net/if.h>
     37 #include <net/if_ether.h>
     38 
     39 #include <net/agr/if_agrvar_impl.h>
     40 #include <net/agr/ieee8023_slowprotocols.h>
     41 #include <net/agr/ieee8023_tlv.h>
     42 #include <net/agr/ieee8023ad.h>
     43 #include <net/agr/ieee8023ad_marker.h>
     44 
     45 static const struct tlv_template marker_info_tlv_template[] = {
     46 	{ MARKER_TYPE_INFO, 16 },
     47 	{ 0, 0 },
     48 };
     49 
     50 static const struct tlv_template marker_response_tlv_template[] = {
     51 	{ MARKER_TYPE_RESPONSE, 16 },
     52 	{ 0, 0 },
     53 };
     54 
     55 int
     56 ieee8023ad_marker_input(struct ifnet *ifp, struct mbuf *m)
     57 {
     58 	struct markerdu *mdu;
     59 	struct agr_port *port;
     60 	int error = 0;
     61 
     62 	port = ifp->if_agrprivate; /* XXX race with agr_remport. */
     63 	KASSERT(port);
     64 	if (__predict_false(port->port_flags & AGRPORT_DETACHING)) {
     65 		goto bad;
     66 	}
     67 
     68 	if (m->m_pkthdr.len != sizeof(*mdu)) {
     69 		goto bad;
     70 	}
     71 
     72 	if ((m->m_flags & M_MCAST) == 0) {
     73 		goto bad;
     74 	}
     75 
     76 	if (m->m_len < sizeof(*mdu)) {
     77 		m = m_pullup(m, sizeof(*mdu));
     78 		if (m == NULL) {
     79 			return ENOMEM;
     80 		}
     81 	}
     82 
     83 	mdu = mtod(m, struct markerdu *);
     84 
     85 	if (memcmp(&mdu->mdu_eh.ether_dhost,
     86 	    &ethermulticastaddr_slowprotocols, ETHER_ADDR_LEN)) {
     87 		goto bad;
     88 	}
     89 
     90 	KASSERT(mdu->mdu_sph.sph_subtype == SLOWPROTOCOLS_SUBTYPE_MARKER);
     91 	if (mdu->mdu_sph.sph_version != 1) {
     92 		goto bad;
     93 	}
     94 
     95 	switch (mdu->mdu_tlv.tlv_type) {
     96 	case MARKER_TYPE_INFO:
     97 		if (tlv_check(mdu, sizeof(*mdu), &mdu->mdu_tlv,
     98 		    marker_info_tlv_template, TRUE)) {
     99 			goto bad;
    100 		}
    101 		mdu->mdu_tlv.tlv_type = MARKER_TYPE_RESPONSE;
    102 		memcpy(&mdu->mdu_eh.ether_dhost,
    103 		    &ethermulticastaddr_slowprotocols, ETHER_ADDR_LEN);
    104 		memcpy(&mdu->mdu_eh.ether_shost,
    105 		    &port->port_origlladdr, ETHER_ADDR_LEN);
    106 		error = agr_xmit_frame(ifp, m);
    107 		break;
    108 
    109 	case MARKER_TYPE_RESPONSE:
    110 		if (tlv_check(mdu, sizeof(*mdu), &mdu->mdu_tlv,
    111 		    marker_response_tlv_template, TRUE)) {
    112 			goto bad;
    113 		}
    114 		/*
    115 		 * we are not interested in responses as
    116 		 * we don't have a marker sender.
    117 		 */
    118 		/* FALLTHROUGH */
    119 	default:
    120 		goto bad;
    121 	}
    122 
    123 	return error;
    124 
    125 bad:
    126 	m_freem(m);
    127 	return EINVAL;
    128 }
    129