123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406 |
- /* Copyright 2004 Linux Networx */
- #ifdef PROTO_LACP
- #if 0
- #include "nic.h"
- #include "timer.h"
- #endif
-
- #define LACP_DEBUG 0
-
- /* Structure definitions originally taken from the linux bond_3ad driver */
-
- #define SLOW_DST_MAC "\x01\x80\xc2\x00\x00\x02"
- static const char slow_dest[] = SLOW_DST_MAC;
-
-
- #define SLOW_SUBTYPE_LACP 1
- #define SLOW_SUBTYPE_MARKER 2
-
- struct slow_header {
- uint8_t subtype;
- };
-
- struct lacp_info {
- uint16_t system_priority;
- uint8_t system[ETH_ALEN];
- uint16_t key;
- uint16_t port_priority;
- uint16_t port;
- uint8_t state;
- uint8_t reserved[3];
- } PACKED;
-
- #define LACP_CMP_LEN (2 + 6 + 2 + 2 + 2)
- #define LACP_CP_LEN (2 + 6 + 2 + 2 + 2 + 1)
-
- /* Link Aggregation Control Protocol(LACP) data unit structure(43.4.2.2 in the 802.3ad standard) */
- struct slow_lacp {
- uint8_t subtype; /* = LACP(= 0x01) */
- uint8_t version_number;
- uint8_t tlv_type_actor_info; /* = actor information(type/length/value) */
- #define LACP_TLV_TERMINATOR 0
- #define LACP_TLV_ACTOR 1
- #define LACP_TLV_PARTNER 2
- #define LACP_TLV_COLLECTOR 3
- uint8_t actor_information_length; /* = 20 */
- struct lacp_info actor;
- uint8_t tlv_type_partner_info; /* = partner information */
- uint8_t partner_information_length; /* = 20 */
- struct lacp_info partner;
- uint8_t tlv_type_collector_info; /* = collector information */
- uint8_t collector_information_length; /* = 16 */
- uint16_t collector_max_delay;
- uint8_t reserved_12[12];
- uint8_t tlv_type_terminator; /* = terminator */
- uint8_t terminator_length; /* = 0 */
- uint8_t reserved_50[50]; /* = 0 */
- } PACKED;
-
- /* Marker Protocol Data Unit(PDU) structure(43.5.3.2 in the 802.3ad standard) */
- struct slow_marker {
- uint8_t subtype; /* = 0x02 (marker PDU) */
- uint8_t version_number; /* = 0x01 */
- uint8_t tlv_type;
- #define MARKER_TLV_TERMINATOR 0 /* marker terminator */
- #define MARKER_TLV_INFO 1 /* marker information */
- #define MARKER_TLV_RESPONSE 2 /* marker response information */
- uint8_t marker_length; /* = 0x16 */
- uint16_t requester_port; /* The number assigned to the port by the requester */
- uint8_t requester_system[ETH_ALEN]; /* The requester's system id */
- uint32_t requester_transaction_id; /* The transaction id allocated by the requester, */
- uint16_t pad; /* = 0 */
- uint8_t tlv_type_terminator; /* = 0x00 */
- uint8_t terminator_length; /* = 0x00 */
- uint8_t reserved_90[90]; /* = 0 */
- } PACKED;
-
- union slow_union {
- struct slow_header header;
- struct slow_lacp lacp;
- struct slow_marker marker;
- };
-
- #define FAST_PERIODIC_TIME (1*TICKS_PER_SEC)
- #define SLOW_PERIODIC_TIME (30*TICKS_PER_SEC)
- #define SHORT_TIMEOUT_TIME (3*FAST_PERIODIC_TIME)
- #define LONG_TIMEOUT_TIME (3*SLOW_PERIODIC_TIME)
- #define CHURN_DETECTION_TIME (60*TICKS_PER_SEC)
- #define AGGREGATE_WAIT_TIME (2*TICKS_PER_SEC)
-
- #define LACP_ACTIVITY (1 << 0)
- #define LACP_TIMEOUT (1 << 1)
- #define LACP_AGGREGATION (1 << 2)
- #define LACP_SYNCHRONIZATION (1 << 3)
- #define LACP_COLLECTING (1 << 4)
- #define LACP_DISTRIBUTING (1 << 5)
- #define LACP_DEFAULTED (1 << 6)
- #define LACP_EXPIRED (1 << 7)
-
- #define UNSELECTED 0
- #define STANDBY 1
- #define SELECTED 2
-
-
- struct lacp_state {
- struct slow_lacp pkt;
- unsigned long current_while_timer; /* Time when the LACP information expires */
- unsigned long periodic_timer; /* Time when I need to send my partner an update */
- };
-
- static struct lacp_state lacp;
-
-
- #if LACP_DEBUG > 0
- static void print_lacp_state(uint8_t state)
- {
- printf("%hhx", state);
- if (state & LACP_ACTIVITY) {
- printf(" Activity");
- }
- if (state & LACP_TIMEOUT) {
- printf(" Timeout");
- }
- if (state & LACP_AGGREGATION) {
- printf(" Aggregation");
- }
- if (state & LACP_SYNCHRONIZATION) {
- printf(" Syncronization");
- }
- if (state & LACP_COLLECTING) {
- printf(" Collecting");
- }
- if (state & LACP_DISTRIBUTING) {
- printf(" Distributing");
- }
- if (state & LACP_DEFAULTED) {
- printf(" Defaulted");
- }
- if (state & LACP_EXPIRED) {
- printf(" Expired");
- }
- printf("\n");
- }
-
- static inline void print_lacpdu(struct slow_lacp *pkt)
- {
- printf("subtype version: %hhx %hhx\n",
- pkt->subtype, pkt->version_number);
- printf("actor_tlv %hhx", pkt->tlv_type_actor_info);
- printf(" len: %hhx (\n", pkt->actor_information_length);
- printf(" sys_pri: %hx", ntohs(pkt->actor.system_priority));
- printf(" mac: %!", pkt->actor.system);
- printf(" key: %hx", ntohs(pkt->actor.key));
- printf(" port_pri: %hx", ntohs(pkt->actor.port_priority));
- printf(" port: %hx\n", ntohs(pkt->actor.port));
- printf(" state: ");
- print_lacp_state(pkt->actor.state);
- #if LACP_DEBUG > 1
- printf(" reserved: %hhx %hhx %hhx\n",
- pkt->actor.reserved[0], pkt->actor.reserved[1], pkt->actor.reserved[2]);
- #endif
- printf(")\n");
- printf("partner_tlv: %hhx", pkt->tlv_type_partner_info);
- printf(" len: %hhx (\n", pkt->partner_information_length);
- printf(" sys_pri: %hx", ntohs(pkt->partner.system_priority));
- printf(" mac: %!", pkt->partner.system);
- printf(" key: %hx", ntohs(pkt->partner.key));
- printf(" port_pri: %hx", ntohs(pkt->partner.port_priority));
- printf(" port: %hx\n", ntohs(pkt->partner.port));
- printf(" state: ");
- print_lacp_state(pkt->partner.state);
- #if LACP_DEBUG > 1
- printf(" reserved: %hhx %hhx %hhx\n",
- pkt->partner.reserved[0], pkt->partner.reserved[1], pkt->partner.reserved[2]);
- #endif
- printf(")\n");
- printf("collector_tlv: %hhx ", pkt->tlv_type_collector_info);
- printf(" len: %hhx (", pkt->collector_information_length);
- printf(" max_delay: %hx", ntohs(pkt->collector_max_delay));
- #if LACP_DEBUG > 1
- printf("reserved_12: %hhx %hhx %hhx %hhx %hhx %hhx %hhx %hhx %hhx %hhx %hhx %hhx\n",
- pkt->reserved_12[0], pkt->reserved_12[1], pkt->reserved_12[2],
- pkt->reserved_12[3], pkt->reserved_12[4], pkt->reserved_12[5],
- pkt->reserved_12[6], pkt->reserved_12[7], pkt->reserved_12[8],
- pkt->reserved_12[9], pkt->reserved_12[10], pkt->reserved_12[11]);
- #endif
- printf(" )\n");
- printf("terminator_tlv: %hhx", pkt->tlv_type_terminator);
- printf(" len: %hhx ()\n", pkt->terminator_length);
- }
-
- static inline unsigned long lacp_timer_val(unsigned long now, unsigned long when)
- {
- return when?(when - now)/TICKS_PER_SEC : 0;
- }
- static void print_lacp(const char *which, struct slow_lacp *pkt, unsigned long now)
- {
- printf("%s\n", which);
- print_lacpdu(pkt);
- printf("timers: c %ds p %ds\n",
- lacp_timer_val(now, lacp.current_while_timer),
- lacp_timer_val(now, lacp.periodic_timer)
- );
- printf("\n");
- }
- #else /* LACP_DEBUG */
- #define print_lacp(which, pkt, now) do {} while(0)
- #endif /* LACP_DEBUG */
-
- static void lacp_init_state(const uint8_t *mac)
- {
- memset(&lacp, 0, sizeof(lacp));
-
- /* Initialize the packet constants */
- lacp.pkt.subtype = 1;
- lacp.pkt.version_number = 1;
-
-
- /* The default state of my interface */
- lacp.pkt.tlv_type_actor_info = LACP_TLV_ACTOR;
- lacp.pkt.actor_information_length = 0x14;
- lacp.pkt.actor.system_priority = htons(1);
- memcpy(lacp.pkt.actor.system, mac, ETH_ALEN);
- lacp.pkt.actor.key = htons(1);
- lacp.pkt.actor.port = htons(1);
- lacp.pkt.actor.port_priority = htons(1);
- lacp.pkt.actor.state =
- LACP_SYNCHRONIZATION |
- LACP_COLLECTING |
- LACP_DISTRIBUTING |
- LACP_DEFAULTED;
-
- /* Set my partner defaults */
- lacp.pkt.tlv_type_partner_info = LACP_TLV_PARTNER;
- lacp.pkt.partner_information_length = 0x14;
- lacp.pkt.partner.system_priority = htons(1);
- /* memset(lacp.pkt.parnter_system, 0, ETH_ALEN); */
- lacp.pkt.partner.key = htons(1);
- lacp.pkt.partner.port = htons(1);
- lacp.pkt.partner.port_priority = htons(1);
- lacp.pkt.partner.state =
- LACP_ACTIVITY |
- LACP_SYNCHRONIZATION |
- LACP_COLLECTING |
- LACP_DISTRIBUTING |
- LACP_DEFAULTED;
-
- lacp.pkt.tlv_type_collector_info = LACP_TLV_COLLECTOR;
- lacp.pkt.collector_information_length = 0x10;
- lacp.pkt.collector_max_delay = htons(0x8000); /* ???? */
-
- lacp.pkt.tlv_type_terminator = LACP_TLV_TERMINATOR;
- lacp.pkt.terminator_length = 0;
- }
-
- #define LACP_NTT_MASK (LACP_ACTIVITY | LACP_TIMEOUT | \
- LACP_SYNCHRONIZATION | LACP_AGGREGATION)
-
- static inline int lacp_update_ntt(struct slow_lacp *pkt)
- {
- int ntt = 0;
- if ((memcmp(&pkt->partner, &lacp.pkt.actor, LACP_CMP_LEN) != 0) ||
- ((pkt->partner.state & LACP_NTT_MASK) !=
- (lacp.pkt.actor.state & LACP_NTT_MASK)))
- {
- ntt = 1;
- }
- return ntt;
- }
-
- static inline void lacp_record_pdu(struct slow_lacp *pkt)
- {
- memcpy(&lacp.pkt.partner, &pkt->actor, LACP_CP_LEN);
-
- lacp.pkt.actor.state &= ~LACP_DEFAULTED;
- lacp.pkt.partner.state &= ~LACP_SYNCHRONIZATION;
- if ((memcmp(&pkt->partner, &lacp.pkt.actor, LACP_CMP_LEN) == 0) &&
- ((pkt->partner.state & LACP_AGGREGATION) ==
- (lacp.pkt.actor.state & LACP_AGGREGATION)))
- {
- lacp.pkt.partner.state |= LACP_SYNCHRONIZATION;
- }
- if (!(pkt->actor.state & LACP_AGGREGATION)) {
- lacp.pkt.partner.state |= LACP_SYNCHRONIZATION;
- }
-
- /* ACTIVITY? */
- }
-
- static inline int lacp_timer_expired(unsigned long now, unsigned long when)
- {
- return when && (now > when);
- }
-
- static inline void lacp_start_periodic_timer(unsigned long now)
- {
- if ((lacp.pkt.partner.state & LACP_ACTIVITY) ||
- (lacp.pkt.actor.state & LACP_ACTIVITY)) {
- lacp.periodic_timer = now +
- (((lacp.pkt.partner.state & LACP_TIMEOUT)?
- FAST_PERIODIC_TIME : SLOW_PERIODIC_TIME));
- }
- }
-
- static inline void lacp_start_current_while_timer(unsigned long now)
- {
- lacp.current_while_timer = now +
- ((lacp.pkt.actor.state & LACP_TIMEOUT) ?
- SHORT_TIMEOUT_TIME : LONG_TIMEOUT_TIME);
-
- lacp.pkt.actor.state &= ~LACP_EXPIRED;
- }
-
- static void send_lacp_reports(unsigned long now, int ntt)
- {
- if (memcmp(nic.node_addr, lacp.pkt.actor.system, ETH_ALEN) != 0) {
- lacp_init_state(nic.node_addr);
- }
- /* If the remote information has expired I need to take action */
- if (lacp_timer_expired(now, lacp.current_while_timer)) {
- if (!(lacp.pkt.actor.state & LACP_EXPIRED)) {
- lacp.pkt.partner.state &= ~LACP_SYNCHRONIZATION;
- lacp.pkt.partner.state |= LACP_TIMEOUT;
- lacp.pkt.actor.state |= LACP_EXPIRED;
- lacp.current_while_timer = now + SHORT_TIMEOUT_TIME;
- ntt = 1;
- }
- else {
- lacp_init_state(nic.node_addr);
- }
- }
- /* If the periodic timer has expired I need to transmit */
- if (lacp_timer_expired(now, lacp.periodic_timer)) {
- ntt = 1;
- /* Reset by lacp_start_periodic_timer */
- }
- if (ntt) {
- eth_transmit(slow_dest, ETH_P_SLOW, sizeof(lacp.pkt), &lacp.pkt);
-
- /* Restart the periodic timer */
- lacp_start_periodic_timer(now);
-
- print_lacp("Trasmitted", &lacp.pkt, now);
- }
- }
-
- static inline void send_eth_slow_reports(unsigned long now)
- {
- send_lacp_reports(now, 0);
- }
-
- static inline void process_eth_slow(unsigned short ptype, unsigned long now)
- {
- union slow_union *pkt;
- if ((ptype != ETH_P_SLOW) ||
- (nic.packetlen < (ETH_HLEN + sizeof(pkt->header)))) {
- return;
- }
- pkt = (union slow_union *)&nic.packet[ETH_HLEN];
- if ((pkt->header.subtype == SLOW_SUBTYPE_LACP) &&
- (nic.packetlen >= ETH_HLEN + sizeof(pkt->lacp))) {
- int ntt;
- if (memcmp(nic.node_addr, lacp.pkt.actor.system, ETH_ALEN) != 0) {
- lacp_init_state(nic.node_addr);
- }
- /* As long as nic.packet is 2 byte aligned all is good */
- print_lacp("Received", &pkt->lacp, now);
- /* I don't actually implement the MUX or SELECT
- * machines.
- *
- * What logically happens when the client and I
- * disagree about an aggregator is the current
- * aggregtator is unselected. The MUX machine places
- * me in DETACHED. The SELECT machine runs and
- * reslects the same aggregator. If I go through
- * these steps fast enough an outside observer can not
- * notice this.
- *
- * Since the process will not generate any noticeable
- * effect it does not need an implmenetation. This
- * keeps the code simple and the code and binary
- * size down.
- */
- /* lacp_update_selected(&pkt->lacp); */
- ntt = lacp_update_ntt(&pkt->lacp);
- lacp_record_pdu(&pkt->lacp);
- lacp_start_current_while_timer(now);
- send_lacp_reports(now, ntt);
- }
- /* If we receive a marker information packet return it */
- else if ((pkt->header.subtype == SLOW_SUBTYPE_MARKER) &&
- (nic.packetlen >= ETH_HLEN + sizeof(pkt->marker)) &&
- (pkt->marker.tlv_type == MARKER_TLV_INFO) &&
- (pkt->marker.marker_length == 0x16))
- {
- pkt->marker.tlv_type = MARKER_TLV_RESPONSE;
- eth_transmit(slow_dest, ETH_P_SLOW,
- sizeof(pkt->marker), &pkt->marker);
- }
-
- }
- #else
-
- #define send_eth_slow_reports(now) do {} while(0)
- #define process_eth_slow(ptype, now) do {} while(0)
-
- #endif
|