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