1/* $NetBSD: ieee8023ad_lacp_debug.c,v 1.5 2008/12/16 22:35:38 christos 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_lacp_debug.c,v 1.5 2008/12/16 22:35:38 christos Exp $"); 31 32#include <sys/param.h> 33#include <sys/systm.h> 34#include <sys/callout.h> 35 36#include <net/if.h> 37#include <net/if_ether.h> 38 39#include <net/agr/ieee8023_slowprotocols.h> 40#include <net/agr/ieee8023_tlv.h> 41#include <net/agr/ieee8023ad_lacp.h> 42#include <net/agr/ieee8023ad_lacp_impl.h> 43#include <net/agr/ieee8023ad_lacp_debug.h> 44 45#if defined(LACP_DEBUG) 46int lacpdebug = 0; 47#endif /* defined(LACP_DEBUG) */ 48 49const char * 50lacp_format_mac(const uint8_t *mac, char *buf, size_t buflen) 51{ 52 53 snprintf(buf, buflen, "%02X-%02X-%02X-%02X-%02X-%02X", 54 (int)mac[0], 55 (int)mac[1], 56 (int)mac[2], 57 (int)mac[3], 58 (int)mac[4], 59 (int)mac[5]); 60 61 return buf; 62} 63 64const char * 65lacp_format_systemid(const struct lacp_systemid *sysid, 66 char *buf, size_t buflen) 67{ 68 char macbuf[LACP_MACSTR_MAX+1]; 69 70 snprintf(buf, buflen, "%04X,%s", 71 be16toh(sysid->lsi_prio), 72 lacp_format_mac(sysid->lsi_mac, macbuf, sizeof(macbuf))); 73 74 return buf; 75} 76 77const char * 78lacp_format_portid(const struct lacp_portid *portid, char *buf, size_t buflen) 79{ 80 81 snprintf(buf, buflen, "%04X,%04X", 82 be16toh(portid->lpi_prio), 83 be16toh(portid->lpi_portno)); 84 85 return buf; 86} 87 88const char * 89lacp_format_partner(const struct lacp_peerinfo *peer, char *buf, size_t buflen) 90{ 91 char sysid[LACP_SYSTEMIDSTR_MAX+1]; 92 char portid[LACP_PORTIDSTR_MAX+1]; 93 94 snprintf(buf, buflen, "(%s,%04X,%s)", 95 lacp_format_systemid(&peer->lip_systemid, sysid, sizeof(sysid)), 96 be16toh(peer->lip_key), 97 lacp_format_portid(&peer->lip_portid, portid, sizeof(portid))); 98 99 return buf; 100} 101 102const char * 103lacp_format_lagid(const struct lacp_peerinfo *a, 104 const struct lacp_peerinfo *b, char *buf, size_t buflen) 105{ 106 char astr[LACP_PARTNERSTR_MAX+1]; 107 char bstr[LACP_PARTNERSTR_MAX+1]; 108 109#if 0 110 /* 111 * there's a convention to display small numbered peer 112 * in the left. 113 */ 114 115 if (lacp_compare_peerinfo(a, b) > 0) { 116 const struct lacp_peerinfo *t; 117 118 t = a; 119 a = b; 120 b = t; 121 } 122#endif 123 124 snprintf(buf, buflen, "[%s,%s]", 125 lacp_format_partner(a, astr, sizeof(astr)), 126 lacp_format_partner(b, bstr, sizeof(bstr))); 127 128 return buf; 129} 130 131const char * 132lacp_format_lagid_aggregator(const struct lacp_aggregator *la, 133 char *buf, size_t buflen) 134{ 135 136 if (la == NULL) { 137 return "(none)"; 138 } 139 140 return lacp_format_lagid(&la->la_actor, &la->la_partner, buf, buflen); 141} 142 143const char * 144lacp_format_state(uint8_t state, char *buf, size_t buflen) 145{ 146 static const char lacp_state_bits[] = LACP_STATE_BITS; 147 148 snprintb(buf, buflen, lacp_state_bits, state); 149 150 return buf; 151} 152 153void 154lacp_dump_lacpdu(const struct lacpdu *du) 155{ 156 char buf[LACP_PARTNERSTR_MAX+1]; 157 char buf2[LACP_STATESTR_MAX+1]; 158 159 printf("actor=%s\n", 160 lacp_format_partner(&du->ldu_actor, buf, sizeof(buf))); 161 printf("actor.state=%s\n", 162 lacp_format_state(du->ldu_actor.lip_state, buf2, sizeof(buf2))); 163 printf("partner=%s\n", 164 lacp_format_partner(&du->ldu_partner, buf, sizeof(buf))); 165 printf("partner.state=%s\n", 166 lacp_format_state(du->ldu_partner.lip_state, buf2, sizeof(buf2))); 167 168 printf("maxdelay=%d\n", be16toh(du->ldu_collector.lci_maxdelay)); 169} 170 171#if defined(LACP_DEBUG) 172#include <net/agr/if_agrvar_impl.h> 173 174void 175lacp_dprintf(const struct lacp_port *lp, const char *fmt, ...) 176{ 177 va_list va; 178 179 if (lacpdebug == 0) { 180 return; 181 } 182 183 if (lp) { 184 printf("%s: ", lp->lp_agrport->port_ifp->if_xname); 185 } 186 187 va_start(va, fmt); 188 vprintf(fmt, va); 189 va_end(va); 190} 191#endif 192