1/* $NetBSD: ieee8023ad_lacp_debug.c,v 1.6 2011/07/17 20:54:52 joerg 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.6 2011/07/17 20:54:52 joerg 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