ieee8023ad_lacp_sm_mux.c revision 1.1 1 1.1 yamt /* $NetBSD: ieee8023ad_lacp_sm_mux.c,v 1.1 2005/03/18 11:11:50 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.1 yamt __KERNEL_RCSID(0, "$NetBSD: ieee8023ad_lacp_sm_mux.c,v 1.1 2005/03/18 11:11:50 yamt Exp $");
31 1.1 yamt
32 1.1 yamt #include <sys/param.h>
33 1.1 yamt #include <sys/mbuf.h>
34 1.1 yamt #include <sys/systm.h>
35 1.1 yamt
36 1.1 yamt #include <net/if.h>
37 1.1 yamt #include <net/if_ether.h>
38 1.1 yamt
39 1.1 yamt #include <net/agr/ieee8023_slowprotocols.h>
40 1.1 yamt #include <net/agr/ieee8023_tlv.h>
41 1.1 yamt #include <net/agr/ieee8023ad_lacp.h>
42 1.1 yamt #include <net/agr/ieee8023ad_lacp_impl.h>
43 1.1 yamt #include <net/agr/ieee8023ad_lacp_sm.h>
44 1.1 yamt #include <net/agr/ieee8023ad_lacp_debug.h>
45 1.1 yamt
46 1.1 yamt /* mux machine */
47 1.1 yamt
48 1.1 yamt void
49 1.1 yamt lacp_sm_mux(struct lacp_port *lp)
50 1.1 yamt {
51 1.1 yamt enum lacp_mux_state new_state;
52 1.1 yamt boolean_t p_sync =
53 1.1 yamt (lp->lp_partner.lip_state & LACP_STATE_SYNC) != 0;
54 1.1 yamt boolean_t p_collecting =
55 1.1 yamt (lp->lp_partner.lip_state & LACP_STATE_COLLECTING) != 0;
56 1.1 yamt enum lacp_selected selected = lp->lp_selected;
57 1.1 yamt struct lacp_aggregator *la;
58 1.1 yamt
59 1.1 yamt /* LACP_DPRINTF((lp, "%s: state %d\n", __func__, lp->lp_mux_state)); */
60 1.1 yamt
61 1.1 yamt re_eval:
62 1.1 yamt la = lp->lp_aggregator;
63 1.1 yamt KASSERT(lp->lp_mux_state == LACP_MUX_DETACHED || la != NULL);
64 1.1 yamt new_state = lp->lp_mux_state;
65 1.1 yamt switch (lp->lp_mux_state) {
66 1.1 yamt case LACP_MUX_DETACHED:
67 1.1 yamt if (selected != LACP_UNSELECTED) {
68 1.1 yamt new_state = LACP_MUX_WAITING;
69 1.1 yamt }
70 1.1 yamt break;
71 1.1 yamt case LACP_MUX_WAITING:
72 1.1 yamt KASSERT(la->la_pending > 0 ||
73 1.1 yamt !LACP_TIMER_ISARMED(lp, LACP_TIMER_WAIT_WHILE));
74 1.1 yamt if (selected == LACP_SELECTED && la->la_pending == 0) {
75 1.1 yamt new_state = LACP_MUX_ATTACHED;
76 1.1 yamt } else if (selected == LACP_UNSELECTED) {
77 1.1 yamt new_state = LACP_MUX_DETACHED;
78 1.1 yamt }
79 1.1 yamt break;
80 1.1 yamt case LACP_MUX_ATTACHED:
81 1.1 yamt if (selected == LACP_SELECTED && p_sync) {
82 1.1 yamt new_state = LACP_MUX_COLLECTING;
83 1.1 yamt } else if (selected != LACP_SELECTED) {
84 1.1 yamt new_state = LACP_MUX_DETACHED;
85 1.1 yamt }
86 1.1 yamt break;
87 1.1 yamt case LACP_MUX_COLLECTING:
88 1.1 yamt if (selected == LACP_SELECTED && p_sync && p_collecting) {
89 1.1 yamt new_state = LACP_MUX_DISTRIBUTING;
90 1.1 yamt } else if (selected != LACP_SELECTED || !p_sync) {
91 1.1 yamt new_state = LACP_MUX_ATTACHED;
92 1.1 yamt }
93 1.1 yamt break;
94 1.1 yamt case LACP_MUX_DISTRIBUTING:
95 1.1 yamt if (selected != LACP_SELECTED || !p_sync || !p_collecting) {
96 1.1 yamt new_state = LACP_MUX_COLLECTING;
97 1.1 yamt }
98 1.1 yamt break;
99 1.1 yamt default:
100 1.1 yamt panic("%s: unknown state", __func__);
101 1.1 yamt }
102 1.1 yamt
103 1.1 yamt if (lp->lp_mux_state == new_state) {
104 1.1 yamt return;
105 1.1 yamt }
106 1.1 yamt
107 1.1 yamt switch (new_state) {
108 1.1 yamt case LACP_MUX_DETACHED:
109 1.1 yamt lp->lp_state &= ~LACP_STATE_SYNC;
110 1.1 yamt lacp_disable_distributing(lp);
111 1.1 yamt lacp_disable_collecting(lp);
112 1.1 yamt lacp_sm_assert_ntt(lp);
113 1.1 yamt /* cancel timer */
114 1.1 yamt if (LACP_TIMER_ISARMED(lp, LACP_TIMER_WAIT_WHILE)) {
115 1.1 yamt KASSERT(la->la_pending > 0);
116 1.1 yamt la->la_pending--;
117 1.1 yamt }
118 1.1 yamt LACP_TIMER_DISARM(lp, LACP_TIMER_WAIT_WHILE);
119 1.1 yamt lacp_unselect(lp);
120 1.1 yamt break;
121 1.1 yamt case LACP_MUX_WAITING:
122 1.1 yamt LACP_TIMER_ARM(lp, LACP_TIMER_WAIT_WHILE,
123 1.1 yamt LACP_AGGREGATE_WAIT_TIME);
124 1.1 yamt la->la_pending++;
125 1.1 yamt break;
126 1.1 yamt case LACP_MUX_ATTACHED:
127 1.1 yamt lp->lp_state |= LACP_STATE_SYNC;
128 1.1 yamt lacp_disable_collecting(lp);
129 1.1 yamt lacp_sm_assert_ntt(lp);
130 1.1 yamt break;
131 1.1 yamt case LACP_MUX_COLLECTING:
132 1.1 yamt lacp_enable_collecting(lp);
133 1.1 yamt lp->lp_state |= LACP_STATE_COLLECTING;
134 1.1 yamt lacp_disable_distributing(lp);
135 1.1 yamt lacp_sm_assert_ntt(lp);
136 1.1 yamt break;
137 1.1 yamt case LACP_MUX_DISTRIBUTING:
138 1.1 yamt lacp_enable_distributing(lp);
139 1.1 yamt break;
140 1.1 yamt default:
141 1.1 yamt panic("%s: unknown state", __func__);
142 1.1 yamt }
143 1.1 yamt
144 1.1 yamt LACP_DPRINTF((lp, "mux_state %d -> %d\n", lp->lp_mux_state, new_state));
145 1.1 yamt
146 1.1 yamt lp->lp_mux_state = new_state;
147 1.1 yamt goto re_eval;
148 1.1 yamt }
149 1.1 yamt
150 1.1 yamt void
151 1.1 yamt lacp_sm_mux_timer(struct lacp_port *lp)
152 1.1 yamt {
153 1.1 yamt struct lacp_aggregator *la = lp->lp_aggregator;
154 1.1 yamt #if defined(LACP_DEBUG)
155 1.1 yamt char buf[LACP_LAGIDSTR_MAX+1];
156 1.1 yamt #endif
157 1.1 yamt
158 1.1 yamt KASSERT(la);
159 1.1 yamt KASSERT(la->la_pending > 0);
160 1.1 yamt
161 1.1 yamt LACP_DPRINTF((lp, "%s: aggregator %s, pending %d -> %d\n", __func__,
162 1.1 yamt lacp_format_lagid(&la->la_actor, &la->la_partner,
163 1.1 yamt buf, sizeof(buf)),
164 1.1 yamt la->la_pending, la->la_pending - 1));
165 1.1 yamt
166 1.1 yamt la->la_pending--;
167 1.1 yamt }
168