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