Home | History | Annotate | Line # | Download | only in agr 
      1 /*	$NetBSD: ieee8023ad_marker.c,v 1.6 2021/11/30 01:17:02 yamaguchi 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.6 2021/11/30 01:17:02 yamaguchi Exp $");
     31 
     32 #include <sys/param.h>
     33 #include <sys/callout.h>
     34 #include <sys/mbuf.h>
     35 #include <sys/systm.h>
     36 
     37 #include <net/if.h>
     38 #include <net/if_ether.h>
     39 #include <net/ether_slowprotocols.h>
     40 
     41 #include <net/agr/if_agrvar_impl.h>
     42 #include <net/agr/ieee8023_tlv.h>
     43 #include <net/agr/ieee8023ad.h>
     44 #include <net/agr/ieee8023ad_marker.h>
     45 
     46 static const struct tlv_template marker_info_tlv_template[] = {
     47 	{ MARKER_TYPE_INFO, 16 },
     48 	{ 0, 0 },
     49 };
     50 
     51 static const struct tlv_template marker_response_tlv_template[] = {
     52 	{ MARKER_TYPE_RESPONSE, 16 },
     53 	{ 0, 0 },
     54 };
     55 
     56 int
     57 ieee8023ad_marker_input(struct ifnet *ifp, struct mbuf *m)
     58 {
     59 	struct markerdu *mdu;
     60 	struct agr_port *port;
     61 	int error = 0;
     62 
     63 	port = ifp->if_lagg; /* XXX race with agr_remport. */
     64 	KASSERT(port);
     65 	if (__predict_false(port->port_flags & AGRPORT_DETACHING)) {
     66 		goto bad;
     67 	}
     68 
     69 	if (m->m_pkthdr.len != sizeof(*mdu)) {
     70 		goto bad;
     71 	}
     72 
     73 	if ((m->m_flags & M_MCAST) == 0) {
     74 		goto bad;
     75 	}
     76 
     77 	if (m->m_len < sizeof(*mdu)) {
     78 		m = m_pullup(m, sizeof(*mdu));
     79 		if (m == NULL) {
     80 			return ENOMEM;
     81 		}
     82 	}
     83 
     84 	mdu = mtod(m, struct markerdu *);
     85 
     86 	if (memcmp(&mdu->mdu_eh.ether_dhost,
     87 	    &ethermulticastaddr_slowprotocols, ETHER_ADDR_LEN)) {
     88 		goto bad;
     89 	}
     90 
     91 	KASSERT(mdu->mdu_sph.sph_subtype == SLOWPROTOCOLS_SUBTYPE_MARKER);
     92 	if (mdu->mdu_sph.sph_version != 1) {
     93 		goto bad;
     94 	}
     95 
     96 	switch (mdu->mdu_tlv.tlv_type) {
     97 	case MARKER_TYPE_INFO:
     98 		if (tlv_check(mdu, sizeof(*mdu), &mdu->mdu_tlv,
     99 		    marker_info_tlv_template, true)) {
    100 			goto bad;
    101 		}
    102 		mdu->mdu_tlv.tlv_type = MARKER_TYPE_RESPONSE;
    103 		memcpy(&mdu->mdu_eh.ether_dhost,
    104 		    &ethermulticastaddr_slowprotocols, ETHER_ADDR_LEN);
    105 		memcpy(&mdu->mdu_eh.ether_shost,
    106 		    &port->port_origlladdr, ETHER_ADDR_LEN);
    107 		error = agr_xmit_frame(ifp, m);
    108 		break;
    109 
    110 	case MARKER_TYPE_RESPONSE:
    111 		if (tlv_check(mdu, sizeof(*mdu), &mdu->mdu_tlv,
    112 		    marker_response_tlv_template, true)) {
    113 			goto bad;
    114 		}
    115 		/*
    116 		 * we are not interested in responses as
    117 		 * we don't have a marker sender.
    118 		 */
    119 		/* FALLTHROUGH */
    120 	default:
    121 		goto bad;
    122 	}
    123 
    124 	return error;
    125 
    126 bad:
    127 	m_freem(m);
    128 	return EINVAL;
    129 }
    130