1 /*
2 * CDDL HEADER START
3 *
4 * The contents of this file are subject to the terms of the
5 * Common Development and Distribution License (the "License").
6 * You may not use this file except in compliance with the License.
7 *
8 * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE
9 * or http://www.opensolaris.org/os/licensing.
10 * See the License for the specific language governing permissions
11 * and limitations under the License.
12 *
13 * When distributing Covered Code, include this CDDL HEADER in each
14 * file and include the License file at usr/src/OPENSOLARIS.LICENSE.
15 * If applicable, add the following below this CDDL HEADER, with the
16 * fields enclosed by brackets "[]" replaced with your own identifying
17 * information: Portions Copyright [yyyy] [name of copyright owner]
18 *
19 * CDDL HEADER END
20 */
21 /*
22 * Copyright 2008 Sun Microsystems, Inc. All rights reserved.
23 * Use is subject to license terms.
24 * Copyright 2012 OmniTI Computer Consulting, Inc All rights reserved.
25 * Copyright 2018 Joyent, Inc.
26 */
27
28 /*
29 * IEEE 802.3ad Link Aggregation - Receive
30 *
31 * Implements the collector function.
32 * Manages the RX resources exposed by a link aggregation group.
33 */
34
35 #include <sys/sysmacros.h>
36 #include <sys/ddi.h>
37 #include <sys/sunddi.h>
38 #include <sys/strsun.h>
39 #include <sys/strsubr.h>
40 #include <sys/byteorder.h>
41 #include <sys/aggr.h>
42 #include <sys/aggr_impl.h>
43
44 static void
45 aggr_mac_rx(mac_handle_t lg_mh, mac_resource_handle_t mrh, mblk_t *mp)
46 {
47 if (mrh == NULL) {
48 mac_rx(lg_mh, mrh, mp);
49 } else {
50 aggr_pseudo_rx_ring_t *ring = (aggr_pseudo_rx_ring_t *)mrh;
51 mac_rx_ring(lg_mh, ring->arr_rh, mp, ring->arr_gen);
52 }
53 }
54
55 void
56 aggr_recv_lacp(aggr_port_t *port, mac_resource_handle_t mrh, mblk_t *mp)
57 {
58 aggr_grp_t *grp = port->lp_grp;
59
60 /* In promiscuous mode, pass copy of packet up. */
61 if (grp->lg_promisc) {
62 mblk_t *nmp = copymsg(mp);
63
64 if (nmp != NULL)
65 aggr_mac_rx(grp->lg_mh, mrh, nmp);
66 }
67
68 aggr_lacp_rx_enqueue(port, mp);
69 }
70
71 /*
72 * Callback function invoked by MAC service module when packets are
73 * made available by a MAC port, both in promisc_on mode and not.
74 */
75 /* ARGSUSED */
76 static void
77 aggr_recv_path_cb(void *arg, mac_resource_handle_t mrh, mblk_t *mp,
78 boolean_t loopback)
79 {
80 aggr_port_t *port = (aggr_port_t *)arg;
81 aggr_grp_t *grp = port->lp_grp;
82
83 if (grp->lg_lacp_mode == AGGR_LACP_OFF) {
84 aggr_mac_rx(grp->lg_mh, mrh, mp);
85 } else {
86 mblk_t *cmp, *last, *head;
87 struct ether_header *ehp;
88 uint16_t sap;
89
90 /* filter out slow protocol packets (LACP & Marker) */
91 last = NULL;
92 head = cmp = mp;
93 while (cmp != NULL) {
94 if (MBLKL(cmp) < sizeof (struct ether_header)) {
95 /* packet too short */
96 if (head == cmp) {
97 /* no packets accumulated */
98 head = cmp->b_next;
99 cmp->b_next = NULL;
100 freemsg(cmp);
101 cmp = head;
102 } else {
103 /* send up accumulated packets */
104 last->b_next = NULL;
105 if (port->lp_collector_enabled) {
106 aggr_mac_rx(grp->lg_mh, mrh,
107 head);
108 } else {
109 freemsgchain(head);
110 }
111 head = cmp->b_next;
112 cmp->b_next = NULL;
113 freemsg(cmp);
114 cmp = head;
115 last = NULL;
116 }
117 continue;
118 }
119 ehp = (struct ether_header *)cmp->b_rptr;
120
121 sap = ntohs(ehp->ether_type);
122 if (sap == ETHERTYPE_SLOW) {
123 /*
124 * LACP or Marker packet. Send up pending
125 * chain, and send LACP/Marker packet
126 * to LACP subsystem.
127 */
128 if (head == cmp) {
129 /* first packet of chain */
130 ASSERT(last == NULL);
131 head = cmp->b_next;
132 cmp->b_next = NULL;
133 aggr_recv_lacp(port, mrh, cmp);
134 cmp = head;
135 } else {
136 /* previously accumulated packets */
137 ASSERT(last != NULL);
138 /* send up non-LACP packets */
139 last->b_next = NULL;
140 if (port->lp_collector_enabled) {
141 aggr_mac_rx(grp->lg_mh, mrh,
142 head);
143 } else {
144 freemsgchain(head);
145 }
146 /* unlink and pass up LACP packets */
147 head = cmp->b_next;
148 cmp->b_next = NULL;
149 aggr_recv_lacp(port, mrh, cmp);
150 cmp = head;
151 last = NULL;
152 }
153 } else {
154 last = cmp;
155 cmp = cmp->b_next;
156 }
157 }
158 if (head != NULL) {
159 if (port->lp_collector_enabled)
160 aggr_mac_rx(grp->lg_mh, mrh, head);
161 else
162 freemsgchain(head);
163 }
164 }
165 }
166
167 void
168 aggr_recv_cb(void *arg, mac_resource_handle_t mrh, mblk_t *mp,
169 boolean_t loopback)
170 {
171 aggr_recv_path_cb(arg, mrh, mp, loopback);
172 }