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) |
46 | int lacpdebug = 0; |
47 | #endif /* defined(LACP_DEBUG) */ |
48 | |
49 | const char * |
50 | lacp_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 | |
64 | const char * |
65 | lacp_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 | |
77 | const char * |
78 | lacp_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 | |
88 | const char * |
89 | lacp_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 | |
102 | const char * |
103 | lacp_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 | |
131 | const char * |
132 | lacp_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 | |
143 | const char * |
144 | lacp_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 | |
153 | void |
154 | lacp_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 | |
174 | void |
175 | lacp_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 | |