ieee8023ad_lacp_sm_mux.c revision 1.2 1 1.2 yamt /* $NetBSD: ieee8023ad_lacp_sm_mux.c,v 1.2 2005/08/12 10:02:31 yamt Exp $ */
2 1.1 yamt
3 1.1 yamt /*-
4 1.1 yamt * Copyright (c)2005 YAMAMOTO Takashi,
5 1.1 yamt * All rights reserved.
6 1.1 yamt *
7 1.1 yamt * Redistribution and use in source and binary forms, with or without
8 1.1 yamt * modification, are permitted provided that the following conditions
9 1.1 yamt * are met:
10 1.1 yamt * 1. Redistributions of source code must retain the above copyright
11 1.1 yamt * notice, this list of conditions and the following disclaimer.
12 1.1 yamt * 2. Redistributions in binary form must reproduce the above copyright
13 1.1 yamt * notice, this list of conditions and the following disclaimer in the
14 1.1 yamt * documentation and/or other materials provided with the distribution.
15 1.1 yamt *
16 1.1 yamt * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
17 1.1 yamt * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
18 1.1 yamt * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
19 1.1 yamt * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
20 1.1 yamt * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
21 1.1 yamt * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
22 1.1 yamt * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
23 1.1 yamt * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
24 1.1 yamt * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
25 1.1 yamt * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
26 1.1 yamt * SUCH DAMAGE.
27 1.1 yamt */
28 1.1 yamt
29 1.1 yamt #include <sys/cdefs.h>
30 1.2 yamt __KERNEL_RCSID(0, "$NetBSD: ieee8023ad_lacp_sm_mux.c,v 1.2 2005/08/12 10:02:31 yamt Exp $");
31 1.1 yamt
32 1.1 yamt #include <sys/param.h>
33 1.2 yamt #include <sys/callout.h>
34 1.1 yamt #include <sys/mbuf.h>
35 1.1 yamt #include <sys/systm.h>
36 1.1 yamt
37 1.1 yamt #include <net/if.h>
38 1.1 yamt #include <net/if_ether.h>
39 1.1 yamt
40 1.1 yamt #include <net/agr/ieee8023_slowprotocols.h>
41 1.1 yamt #include <net/agr/ieee8023_tlv.h>
42 1.1 yamt #include <net/agr/ieee8023ad_lacp.h>
43 1.1 yamt #include <net/agr/ieee8023ad_lacp_impl.h>
44 1.1 yamt #include <net/agr/ieee8023ad_lacp_sm.h>
45 1.1 yamt #include <net/agr/ieee8023ad_lacp_debug.h>
46 1.1 yamt
47 1.1 yamt /* mux machine */
48 1.1 yamt
49 1.1 yamt void
50 1.1 yamt lacp_sm_mux(struct lacp_port *lp)
51 1.1 yamt {
52 1.1 yamt enum lacp_mux_state new_state;
53 1.1 yamt boolean_t p_sync =
54 1.1 yamt (lp->lp_partner.lip_state & LACP_STATE_SYNC) != 0;
55 1.1 yamt boolean_t p_collecting =
56 1.1 yamt (lp->lp_partner.lip_state & LACP_STATE_COLLECTING) != 0;
57 1.1 yamt enum lacp_selected selected = lp->lp_selected;
58 1.1 yamt struct lacp_aggregator *la;
59 1.1 yamt
60 1.1 yamt /* LACP_DPRINTF((lp, "%s: state %d\n", __func__, lp->lp_mux_state)); */
61 1.1 yamt
62 1.1 yamt re_eval:
63 1.1 yamt la = lp->lp_aggregator;
64 1.1 yamt KASSERT(lp->lp_mux_state == LACP_MUX_DETACHED || la != NULL);
65 1.1 yamt new_state = lp->lp_mux_state;
66 1.1 yamt switch (lp->lp_mux_state) {
67 1.1 yamt case LACP_MUX_DETACHED:
68 1.1 yamt if (selected != LACP_UNSELECTED) {
69 1.1 yamt new_state = LACP_MUX_WAITING;
70 1.1 yamt }
71 1.1 yamt break;
72 1.1 yamt case LACP_MUX_WAITING:
73 1.1 yamt KASSERT(la->la_pending > 0 ||
74 1.1 yamt !LACP_TIMER_ISARMED(lp, LACP_TIMER_WAIT_WHILE));
75 1.1 yamt if (selected == LACP_SELECTED && la->la_pending == 0) {
76 1.1 yamt new_state = LACP_MUX_ATTACHED;
77 1.1 yamt } else if (selected == LACP_UNSELECTED) {
78 1.1 yamt new_state = LACP_MUX_DETACHED;
79 1.1 yamt }
80 1.1 yamt break;
81 1.1 yamt case LACP_MUX_ATTACHED:
82 1.1 yamt if (selected == LACP_SELECTED && p_sync) {
83 1.1 yamt new_state = LACP_MUX_COLLECTING;
84 1.1 yamt } else if (selected != LACP_SELECTED) {
85 1.1 yamt new_state = LACP_MUX_DETACHED;
86 1.1 yamt }
87 1.1 yamt break;
88 1.1 yamt case LACP_MUX_COLLECTING:
89 1.1 yamt if (selected == LACP_SELECTED && p_sync && p_collecting) {
90 1.1 yamt new_state = LACP_MUX_DISTRIBUTING;
91 1.1 yamt } else if (selected != LACP_SELECTED || !p_sync) {
92 1.1 yamt new_state = LACP_MUX_ATTACHED;
93 1.1 yamt }
94 1.1 yamt break;
95 1.1 yamt case LACP_MUX_DISTRIBUTING:
96 1.1 yamt if (selected != LACP_SELECTED || !p_sync || !p_collecting) {
97 1.1 yamt new_state = LACP_MUX_COLLECTING;
98 1.1 yamt }
99 1.1 yamt break;
100 1.1 yamt default:
101 1.1 yamt panic("%s: unknown state", __func__);
102 1.1 yamt }
103 1.1 yamt
104 1.1 yamt if (lp->lp_mux_state == new_state) {
105 1.1 yamt return;
106 1.1 yamt }
107 1.1 yamt
108 1.1 yamt switch (new_state) {
109 1.1 yamt case LACP_MUX_DETACHED:
110 1.1 yamt lp->lp_state &= ~LACP_STATE_SYNC;
111 1.1 yamt lacp_disable_distributing(lp);
112 1.1 yamt lacp_disable_collecting(lp);
113 1.1 yamt lacp_sm_assert_ntt(lp);
114 1.1 yamt /* cancel timer */
115 1.1 yamt if (LACP_TIMER_ISARMED(lp, LACP_TIMER_WAIT_WHILE)) {
116 1.1 yamt KASSERT(la->la_pending > 0);
117 1.1 yamt la->la_pending--;
118 1.1 yamt }
119 1.1 yamt LACP_TIMER_DISARM(lp, LACP_TIMER_WAIT_WHILE);
120 1.1 yamt lacp_unselect(lp);
121 1.1 yamt break;
122 1.1 yamt case LACP_MUX_WAITING:
123 1.1 yamt LACP_TIMER_ARM(lp, LACP_TIMER_WAIT_WHILE,
124 1.1 yamt LACP_AGGREGATE_WAIT_TIME);
125 1.1 yamt la->la_pending++;
126 1.1 yamt break;
127 1.1 yamt case LACP_MUX_ATTACHED:
128 1.1 yamt lp->lp_state |= LACP_STATE_SYNC;
129 1.1 yamt lacp_disable_collecting(lp);
130 1.1 yamt lacp_sm_assert_ntt(lp);
131 1.1 yamt break;
132 1.1 yamt case LACP_MUX_COLLECTING:
133 1.1 yamt lacp_enable_collecting(lp);
134 1.1 yamt lp->lp_state |= LACP_STATE_COLLECTING;
135 1.1 yamt lacp_disable_distributing(lp);
136 1.1 yamt lacp_sm_assert_ntt(lp);
137 1.1 yamt break;
138 1.1 yamt case LACP_MUX_DISTRIBUTING:
139 1.1 yamt lacp_enable_distributing(lp);
140 1.1 yamt break;
141 1.1 yamt default:
142 1.1 yamt panic("%s: unknown state", __func__);
143 1.1 yamt }
144 1.1 yamt
145 1.1 yamt LACP_DPRINTF((lp, "mux_state %d -> %d\n", lp->lp_mux_state, new_state));
146 1.1 yamt
147 1.1 yamt lp->lp_mux_state = new_state;
148 1.1 yamt goto re_eval;
149 1.1 yamt }
150 1.1 yamt
151 1.1 yamt void
152 1.1 yamt lacp_sm_mux_timer(struct lacp_port *lp)
153 1.1 yamt {
154 1.1 yamt struct lacp_aggregator *la = lp->lp_aggregator;
155 1.1 yamt #if defined(LACP_DEBUG)
156 1.1 yamt char buf[LACP_LAGIDSTR_MAX+1];
157 1.1 yamt #endif
158 1.1 yamt
159 1.1 yamt KASSERT(la);
160 1.1 yamt KASSERT(la->la_pending > 0);
161 1.1 yamt
162 1.1 yamt LACP_DPRINTF((lp, "%s: aggregator %s, pending %d -> %d\n", __func__,
163 1.1 yamt lacp_format_lagid(&la->la_actor, &la->la_partner,
164 1.1 yamt buf, sizeof(buf)),
165 1.1 yamt la->la_pending, la->la_pending - 1));
166 1.1 yamt
167 1.1 yamt la->la_pending--;
168 1.1 yamt }
169