xref: /titanic_51/usr/src/uts/common/io/aggr/aggr_grp.c (revision de3d2ce46fc25c7b67ccbae4afe5f15e5357568f)
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 2009 Sun Microsystems, Inc.  All rights reserved.
23  * Use is subject to license terms.
24  */
25 
26 /*
27  * IEEE 802.3ad Link Aggregation -- Link Aggregation Groups.
28  *
29  * An instance of the structure aggr_grp_t is allocated for each
30  * link aggregation group. When created, aggr_grp_t objects are
31  * entered into the aggr_grp_hash hash table maintained by the modhash
32  * module. The hash key is the linkid associated with the link
33  * aggregation group.
34  *
35  * A set of MAC ports are associated with each association group.
36  */
37 
38 #include <sys/types.h>
39 #include <sys/sysmacros.h>
40 #include <sys/conf.h>
41 #include <sys/cmn_err.h>
42 #include <sys/disp.h>
43 #include <sys/list.h>
44 #include <sys/ksynch.h>
45 #include <sys/kmem.h>
46 #include <sys/stream.h>
47 #include <sys/modctl.h>
48 #include <sys/ddi.h>
49 #include <sys/sunddi.h>
50 #include <sys/atomic.h>
51 #include <sys/stat.h>
52 #include <sys/modhash.h>
53 #include <sys/id_space.h>
54 #include <sys/strsun.h>
55 #include <sys/dlpi.h>
56 #include <sys/mac_provider.h>
57 #include <sys/dls.h>
58 #include <sys/vlan.h>
59 #include <sys/aggr.h>
60 #include <sys/aggr_impl.h>
61 
62 static int aggr_m_start(void *);
63 static void aggr_m_stop(void *);
64 static int aggr_m_promisc(void *, boolean_t);
65 static int aggr_m_multicst(void *, boolean_t, const uint8_t *);
66 static int aggr_m_unicst(void *, const uint8_t *);
67 static int aggr_m_stat(void *, uint_t, uint64_t *);
68 static void aggr_m_ioctl(void *, queue_t *, mblk_t *);
69 static boolean_t aggr_m_capab_get(void *, mac_capab_t, void *);
70 static int aggr_m_setprop(void *, const char *, mac_prop_id_t, uint_t,
71     const void *);
72 static int aggr_m_getprop(void *, const char *, mac_prop_id_t, uint_t,
73     uint_t, void *, uint_t *);
74 
75 
76 static aggr_port_t *aggr_grp_port_lookup(aggr_grp_t *, datalink_id_t);
77 static int aggr_grp_rem_port(aggr_grp_t *, aggr_port_t *, boolean_t *,
78     boolean_t *);
79 
80 static void aggr_grp_capab_set(aggr_grp_t *);
81 static boolean_t aggr_grp_capab_check(aggr_grp_t *, aggr_port_t *);
82 static uint_t aggr_grp_max_sdu(aggr_grp_t *);
83 static uint32_t aggr_grp_max_margin(aggr_grp_t *);
84 static boolean_t aggr_grp_sdu_check(aggr_grp_t *, aggr_port_t *);
85 static boolean_t aggr_grp_margin_check(aggr_grp_t *, aggr_port_t *);
86 
87 static int aggr_add_pseudo_rx_group(aggr_port_t *, aggr_pseudo_rx_group_t *);
88 static void aggr_rem_pseudo_rx_group(aggr_port_t *, aggr_pseudo_rx_group_t *);
89 static int aggr_pseudo_disable_intr(mac_intr_handle_t);
90 static int aggr_pseudo_enable_intr(mac_intr_handle_t);
91 static int aggr_pseudo_start_ring(mac_ring_driver_t, uint64_t);
92 static void aggr_pseudo_stop_ring(mac_ring_driver_t);
93 static int aggr_addmac(void *, const uint8_t *);
94 static int aggr_remmac(void *, const uint8_t *);
95 static mblk_t *aggr_rx_poll(void *, int);
96 static void aggr_fill_ring(void *, mac_ring_type_t, const int,
97     const int, mac_ring_info_t *, mac_ring_handle_t);
98 static void aggr_fill_group(void *, mac_ring_type_t, const int,
99     mac_group_info_t *, mac_group_handle_t);
100 
101 static kmem_cache_t	*aggr_grp_cache;
102 static mod_hash_t	*aggr_grp_hash;
103 static krwlock_t	aggr_grp_lock;
104 static uint_t		aggr_grp_cnt;
105 static id_space_t	*key_ids;
106 
107 #define	GRP_HASHSZ		64
108 #define	GRP_HASH_KEY(linkid)	((mod_hash_key_t)(uintptr_t)linkid)
109 #define	AGGR_PORT_NAME_DELIMIT '-'
110 
111 static uchar_t aggr_zero_mac[] = {0, 0, 0, 0, 0, 0};
112 
113 #define	AGGR_M_CALLBACK_FLAGS	\
114 	(MC_IOCTL | MC_GETCAPAB | MC_SETPROP | MC_GETPROP)
115 
116 static mac_callbacks_t aggr_m_callbacks = {
117 	AGGR_M_CALLBACK_FLAGS,
118 	aggr_m_stat,
119 	aggr_m_start,
120 	aggr_m_stop,
121 	aggr_m_promisc,
122 	aggr_m_multicst,
123 	NULL,
124 	aggr_m_tx,
125 	aggr_m_ioctl,
126 	aggr_m_capab_get,
127 	NULL,
128 	NULL,
129 	aggr_m_setprop,
130 	aggr_m_getprop
131 };
132 
133 /*ARGSUSED*/
134 static int
135 aggr_grp_constructor(void *buf, void *arg, int kmflag)
136 {
137 	aggr_grp_t *grp = buf;
138 
139 	bzero(grp, sizeof (*grp));
140 	mutex_init(&grp->lg_lacp_lock, NULL, MUTEX_DEFAULT, NULL);
141 	cv_init(&grp->lg_lacp_cv, NULL, CV_DEFAULT, NULL);
142 	rw_init(&grp->lg_tx_lock, NULL, RW_DRIVER, NULL);
143 	mutex_init(&grp->lg_port_lock, NULL, MUTEX_DEFAULT, NULL);
144 	cv_init(&grp->lg_port_cv, NULL, CV_DEFAULT, NULL);
145 	grp->lg_link_state = LINK_STATE_UNKNOWN;
146 	return (0);
147 }
148 
149 /*ARGSUSED*/
150 static void
151 aggr_grp_destructor(void *buf, void *arg)
152 {
153 	aggr_grp_t *grp = buf;
154 
155 	if (grp->lg_tx_ports != NULL) {
156 		kmem_free(grp->lg_tx_ports,
157 		    grp->lg_tx_ports_size * sizeof (aggr_port_t *));
158 	}
159 
160 	mutex_destroy(&grp->lg_lacp_lock);
161 	cv_destroy(&grp->lg_lacp_cv);
162 	mutex_destroy(&grp->lg_port_lock);
163 	cv_destroy(&grp->lg_port_cv);
164 	rw_destroy(&grp->lg_tx_lock);
165 }
166 
167 void
168 aggr_grp_init(void)
169 {
170 	aggr_grp_cache = kmem_cache_create("aggr_grp_cache",
171 	    sizeof (aggr_grp_t), 0, aggr_grp_constructor,
172 	    aggr_grp_destructor, NULL, NULL, NULL, 0);
173 
174 	aggr_grp_hash = mod_hash_create_idhash("aggr_grp_hash",
175 	    GRP_HASHSZ, mod_hash_null_valdtor);
176 	rw_init(&aggr_grp_lock, NULL, RW_DEFAULT, NULL);
177 	aggr_grp_cnt = 0;
178 
179 	/*
180 	 * Allocate an id space to manage key values (when key is not
181 	 * specified). The range of the id space will be from
182 	 * (AGGR_MAX_KEY + 1) to UINT16_MAX, because the LACP protocol
183 	 * uses a 16-bit key.
184 	 */
185 	key_ids = id_space_create("aggr_key_ids", AGGR_MAX_KEY + 1, UINT16_MAX);
186 	ASSERT(key_ids != NULL);
187 }
188 
189 void
190 aggr_grp_fini(void)
191 {
192 	id_space_destroy(key_ids);
193 	rw_destroy(&aggr_grp_lock);
194 	mod_hash_destroy_idhash(aggr_grp_hash);
195 	kmem_cache_destroy(aggr_grp_cache);
196 }
197 
198 uint_t
199 aggr_grp_count(void)
200 {
201 	uint_t	count;
202 
203 	rw_enter(&aggr_grp_lock, RW_READER);
204 	count = aggr_grp_cnt;
205 	rw_exit(&aggr_grp_lock);
206 	return (count);
207 }
208 
209 /*
210  * Since both aggr_port_notify_cb() and aggr_port_timer_thread() functions
211  * requires the mac perimeter, this function holds a reference of the aggr
212  * and aggr won't call mac_unregister() until this reference drops to 0.
213  */
214 void
215 aggr_grp_port_hold(aggr_port_t *port)
216 {
217 	aggr_grp_t	*grp = port->lp_grp;
218 
219 	AGGR_PORT_REFHOLD(port);
220 	mutex_enter(&grp->lg_port_lock);
221 	grp->lg_port_ref++;
222 	mutex_exit(&grp->lg_port_lock);
223 }
224 
225 /*
226  * Release the reference of the grp and inform aggr_grp_delete() calling
227  * mac_unregister() is now safe.
228  */
229 void
230 aggr_grp_port_rele(aggr_port_t *port)
231 {
232 	aggr_grp_t	*grp = port->lp_grp;
233 
234 	mutex_enter(&grp->lg_port_lock);
235 	if (--grp->lg_port_ref == 0)
236 		cv_signal(&grp->lg_port_cv);
237 	mutex_exit(&grp->lg_port_lock);
238 	AGGR_PORT_REFRELE(port);
239 }
240 
241 /*
242  * Wait for the port's lacp timer thread and the port's notification callback
243  * to exit.
244  */
245 void
246 aggr_grp_port_wait(aggr_grp_t *grp)
247 {
248 	mutex_enter(&grp->lg_port_lock);
249 	if (grp->lg_port_ref != 0)
250 		cv_wait(&grp->lg_port_cv, &grp->lg_port_lock);
251 	mutex_exit(&grp->lg_port_lock);
252 }
253 
254 /*
255  * Attach a port to a link aggregation group.
256  *
257  * A port is attached to a link aggregation group once its speed
258  * and link state have been verified.
259  *
260  * Returns B_TRUE if the group link state or speed has changed. If
261  * it's the case, the caller must notify the MAC layer via a call
262  * to mac_link().
263  */
264 boolean_t
265 aggr_grp_attach_port(aggr_grp_t *grp, aggr_port_t *port)
266 {
267 	boolean_t link_state_changed = B_FALSE;
268 
269 	ASSERT(MAC_PERIM_HELD(grp->lg_mh));
270 	ASSERT(MAC_PERIM_HELD(port->lp_mh));
271 
272 	if (port->lp_state == AGGR_PORT_STATE_ATTACHED)
273 		return (B_FALSE);
274 
275 	/*
276 	 * Validate the MAC port link speed and update the group
277 	 * link speed if needed.
278 	 */
279 	if (port->lp_ifspeed == 0 ||
280 	    port->lp_link_state != LINK_STATE_UP ||
281 	    port->lp_link_duplex != LINK_DUPLEX_FULL) {
282 		/*
283 		 * Can't attach a MAC port with unknown link speed,
284 		 * down link, or not in full duplex mode.
285 		 */
286 		return (B_FALSE);
287 	}
288 
289 	if (grp->lg_ifspeed == 0) {
290 		/*
291 		 * The group inherits the speed of the first link being
292 		 * attached.
293 		 */
294 		grp->lg_ifspeed = port->lp_ifspeed;
295 		link_state_changed = B_TRUE;
296 	} else if (grp->lg_ifspeed != port->lp_ifspeed) {
297 		/*
298 		 * The link speed of the MAC port must be the same as
299 		 * the group link speed, as per 802.3ad. Since it is
300 		 * not, the attach is cancelled.
301 		 */
302 		return (B_FALSE);
303 	}
304 
305 	grp->lg_nattached_ports++;
306 
307 	/*
308 	 * Update the group link state.
309 	 */
310 	if (grp->lg_link_state != LINK_STATE_UP) {
311 		grp->lg_link_state = LINK_STATE_UP;
312 		grp->lg_link_duplex = LINK_DUPLEX_FULL;
313 		link_state_changed = B_TRUE;
314 	}
315 
316 	/*
317 	 * Update port's state.
318 	 */
319 	port->lp_state = AGGR_PORT_STATE_ATTACHED;
320 
321 	aggr_grp_multicst_port(port, B_TRUE);
322 
323 	/*
324 	 * Set port's receive callback
325 	 */
326 	mac_rx_set(port->lp_mch, aggr_recv_cb, port);
327 
328 	/*
329 	 * If LACP is OFF, the port can be used to send data as soon
330 	 * as its link is up and verified to be compatible with the
331 	 * aggregation.
332 	 *
333 	 * If LACP is active or passive, notify the LACP subsystem, which
334 	 * will enable sending on the port following the LACP protocol.
335 	 */
336 	if (grp->lg_lacp_mode == AGGR_LACP_OFF)
337 		aggr_send_port_enable(port);
338 	else
339 		aggr_lacp_port_attached(port);
340 
341 	return (link_state_changed);
342 }
343 
344 boolean_t
345 aggr_grp_detach_port(aggr_grp_t *grp, aggr_port_t *port)
346 {
347 	boolean_t link_state_changed = B_FALSE;
348 
349 	ASSERT(MAC_PERIM_HELD(grp->lg_mh));
350 	ASSERT(MAC_PERIM_HELD(port->lp_mh));
351 
352 	/* update state */
353 	if (port->lp_state != AGGR_PORT_STATE_ATTACHED)
354 		return (B_FALSE);
355 
356 	mac_rx_clear(port->lp_mch);
357 
358 	aggr_grp_multicst_port(port, B_FALSE);
359 
360 	if (grp->lg_lacp_mode == AGGR_LACP_OFF)
361 		aggr_send_port_disable(port);
362 	else
363 		aggr_lacp_port_detached(port);
364 
365 	port->lp_state = AGGR_PORT_STATE_STANDBY;
366 
367 	grp->lg_nattached_ports--;
368 	if (grp->lg_nattached_ports == 0) {
369 		/* the last attached MAC port of the group is being detached */
370 		grp->lg_ifspeed = 0;
371 		grp->lg_link_state = LINK_STATE_DOWN;
372 		grp->lg_link_duplex = LINK_DUPLEX_UNKNOWN;
373 		link_state_changed = B_TRUE;
374 	}
375 
376 	return (link_state_changed);
377 }
378 
379 /*
380  * Update the MAC addresses of the constituent ports of the specified
381  * group. This function is invoked:
382  * - after creating a new aggregation group.
383  * - after adding new ports to an aggregation group.
384  * - after removing a port from a group when the MAC address of
385  *   that port was used for the MAC address of the group.
386  * - after the MAC address of a port changed when the MAC address
387  *   of that port was used for the MAC address of the group.
388  *
389  * Return true if the link state of the aggregation changed, for example
390  * as a result of a failure changing the MAC address of one of the
391  * constituent ports.
392  */
393 boolean_t
394 aggr_grp_update_ports_mac(aggr_grp_t *grp)
395 {
396 	aggr_port_t *cport;
397 	boolean_t link_state_changed = B_FALSE;
398 	mac_perim_handle_t mph;
399 
400 	ASSERT(MAC_PERIM_HELD(grp->lg_mh));
401 
402 	for (cport = grp->lg_ports; cport != NULL;
403 	    cport = cport->lp_next) {
404 		mac_perim_enter_by_mh(cport->lp_mh, &mph);
405 		if (aggr_port_unicst(cport) != 0) {
406 			if (aggr_grp_detach_port(grp, cport))
407 				link_state_changed = B_TRUE;
408 		} else {
409 			/*
410 			 * If a port was detached because of a previous
411 			 * failure changing the MAC address, the port is
412 			 * reattached when it successfully changes the MAC
413 			 * address now, and this might cause the link state
414 			 * of the aggregation to change.
415 			 */
416 			if (aggr_grp_attach_port(grp, cport))
417 				link_state_changed = B_TRUE;
418 		}
419 		mac_perim_exit(mph);
420 	}
421 	return (link_state_changed);
422 }
423 
424 /*
425  * Invoked when the MAC address of a port has changed. If the port's
426  * MAC address was used for the group MAC address, set mac_addr_changedp
427  * to B_TRUE to indicate to the caller that it should send a MAC_NOTE_UNICST
428  * notification. If the link state changes due to detach/attach of
429  * the constituent port, set link_state_changedp to B_TRUE to indicate
430  * to the caller that it should send a MAC_NOTE_LINK notification. In both
431  * cases, it is the responsibility of the caller to invoke notification
432  * functions after releasing the the port lock.
433  */
434 void
435 aggr_grp_port_mac_changed(aggr_grp_t *grp, aggr_port_t *port,
436     boolean_t *mac_addr_changedp, boolean_t *link_state_changedp)
437 {
438 	ASSERT(MAC_PERIM_HELD(grp->lg_mh));
439 	ASSERT(MAC_PERIM_HELD(port->lp_mh));
440 	ASSERT(mac_addr_changedp != NULL);
441 	ASSERT(link_state_changedp != NULL);
442 
443 	*mac_addr_changedp = B_FALSE;
444 	*link_state_changedp = B_FALSE;
445 
446 	if (grp->lg_addr_fixed) {
447 		/*
448 		 * The group is using a fixed MAC address or an automatic
449 		 * MAC address has not been set.
450 		 */
451 		return;
452 	}
453 
454 	if (grp->lg_mac_addr_port == port) {
455 		/*
456 		 * The MAC address of the port was assigned to the group
457 		 * MAC address. Update the group MAC address.
458 		 */
459 		bcopy(port->lp_addr, grp->lg_addr, ETHERADDRL);
460 		*mac_addr_changedp = B_TRUE;
461 	} else {
462 		/*
463 		 * Update the actual port MAC address to the MAC address
464 		 * of the group.
465 		 */
466 		if (aggr_port_unicst(port) != 0) {
467 			*link_state_changedp = aggr_grp_detach_port(grp, port);
468 		} else {
469 			/*
470 			 * If a port was detached because of a previous
471 			 * failure changing the MAC address, the port is
472 			 * reattached when it successfully changes the MAC
473 			 * address now, and this might cause the link state
474 			 * of the aggregation to change.
475 			 */
476 			*link_state_changedp = aggr_grp_attach_port(grp, port);
477 		}
478 	}
479 }
480 
481 /*
482  * Add a port to a link aggregation group.
483  */
484 static int
485 aggr_grp_add_port(aggr_grp_t *grp, datalink_id_t port_linkid, boolean_t force,
486     aggr_port_t **pp)
487 {
488 	aggr_port_t *port, **cport;
489 	mac_perim_handle_t mph;
490 	int err;
491 
492 	/*
493 	 * lg_mh could be NULL when the function is called during the creation
494 	 * of the aggregation.
495 	 */
496 	ASSERT(grp->lg_mh == NULL || MAC_PERIM_HELD(grp->lg_mh));
497 
498 	/* create new port */
499 	err = aggr_port_create(grp, port_linkid, force, &port);
500 	if (err != 0)
501 		return (err);
502 
503 	mac_perim_enter_by_mh(port->lp_mh, &mph);
504 
505 	/* add port to list of group constituent ports */
506 	cport = &grp->lg_ports;
507 	while (*cport != NULL)
508 		cport = &((*cport)->lp_next);
509 	*cport = port;
510 
511 	/*
512 	 * Back reference to the group it is member of. A port always
513 	 * holds a reference to its group to ensure that the back
514 	 * reference is always valid.
515 	 */
516 	port->lp_grp = grp;
517 	AGGR_GRP_REFHOLD(grp);
518 	grp->lg_nports++;
519 
520 	aggr_lacp_init_port(port);
521 	mac_perim_exit(mph);
522 
523 	if (pp != NULL)
524 		*pp = port;
525 
526 	return (0);
527 }
528 
529 /*
530  * Add a pseudo Rx ring for the given HW ring handle.
531  */
532 static int
533 aggr_add_pseudo_rx_ring(aggr_port_t *port,
534     aggr_pseudo_rx_group_t *rx_grp, mac_ring_handle_t hw_rh)
535 {
536 	aggr_pseudo_rx_ring_t	*ring;
537 	int			err;
538 	int			j;
539 
540 	for (j = 0; j < MAX_RINGS_PER_GROUP; j++) {
541 		ring = rx_grp->arg_rings + j;
542 		if (!(ring->arr_flags & MAC_PSEUDO_RING_INUSE))
543 			break;
544 	}
545 
546 	/*
547 	 * No slot for this new Rx ring.
548 	 */
549 	if (j == MAX_RINGS_PER_GROUP)
550 		return (EIO);
551 
552 	ring->arr_flags |= MAC_PSEUDO_RING_INUSE;
553 	ring->arr_hw_rh = hw_rh;
554 	ring->arr_port = port;
555 	rx_grp->arg_ring_cnt++;
556 
557 	/*
558 	 * The group is already registered, dynamically add a new ring to the
559 	 * mac group.
560 	 */
561 	mac_hwring_setup(hw_rh, (mac_resource_handle_t)ring);
562 	if ((err = mac_group_add_ring(rx_grp->arg_gh, j)) != 0) {
563 		ring->arr_flags &= ~MAC_PSEUDO_RING_INUSE;
564 		ring->arr_hw_rh = NULL;
565 		ring->arr_port = NULL;
566 		rx_grp->arg_ring_cnt--;
567 		mac_hwring_teardown(hw_rh);
568 	}
569 	return (err);
570 }
571 
572 /*
573  * Remove the pseudo Rx ring of the given HW ring handle.
574  */
575 static void
576 aggr_rem_pseudo_rx_ring(aggr_pseudo_rx_group_t *rx_grp, mac_ring_handle_t hw_rh)
577 {
578 	aggr_pseudo_rx_ring_t	*ring;
579 	int			j;
580 
581 	for (j = 0; j < MAX_RINGS_PER_GROUP; j++) {
582 		ring = rx_grp->arg_rings + j;
583 		if (!(ring->arr_flags & MAC_PSEUDO_RING_INUSE) ||
584 		    ring->arr_hw_rh != hw_rh) {
585 			continue;
586 		}
587 
588 		mac_group_rem_ring(rx_grp->arg_gh, ring->arr_rh);
589 
590 		ring->arr_flags &= ~MAC_PSEUDO_RING_INUSE;
591 		ring->arr_hw_rh = NULL;
592 		ring->arr_port = NULL;
593 		rx_grp->arg_ring_cnt--;
594 		mac_hwring_teardown(hw_rh);
595 		break;
596 	}
597 }
598 
599 /*
600  * This function is called to create pseudo rings over the hardware rings of
601  * the underlying device. Note that there is a 1:1 mapping between the pseudo
602  * RX rings of the aggr and the hardware rings of the underlying port.
603  */
604 static int
605 aggr_add_pseudo_rx_group(aggr_port_t *port, aggr_pseudo_rx_group_t *rx_grp)
606 {
607 	aggr_grp_t		*grp = port->lp_grp;
608 	mac_ring_handle_t	hw_rh[MAX_RINGS_PER_GROUP];
609 	aggr_unicst_addr_t	*addr, *a;
610 	mac_perim_handle_t	pmph;
611 	int			hw_rh_cnt, i = 0, j;
612 	int			err = 0;
613 
614 	ASSERT(MAC_PERIM_HELD(grp->lg_mh));
615 	mac_perim_enter_by_mh(port->lp_mh, &pmph);
616 
617 	/*
618 	 * This function must be called after the aggr registers its mac
619 	 * and its RX group has been initialized.
620 	 */
621 	ASSERT(rx_grp->arg_gh != NULL);
622 
623 	/*
624 	 * Get the list the the underlying HW rings.
625 	 */
626 	hw_rh_cnt = mac_hwrings_get(port->lp_mch, &port->lp_hwgh, hw_rh);
627 
628 	if (port->lp_hwgh != NULL) {
629 		/*
630 		 * Quiesce the HW ring and the mac srs on the ring. Note
631 		 * that the HW ring will be restarted when the pseudo ring
632 		 * is started. At that time all the packets will be
633 		 * directly passed up to the pseudo RX ring and handled
634 		 * by mac srs created over the pseudo RX ring.
635 		 */
636 		mac_rx_client_quiesce(port->lp_mch);
637 		mac_srs_perm_quiesce(port->lp_mch, B_TRUE);
638 	}
639 
640 	/*
641 	 * Add all the unicast addresses to the newly added port.
642 	 */
643 	for (addr = rx_grp->arg_macaddr; addr != NULL; addr = addr->aua_next) {
644 		if ((err = aggr_port_addmac(port, addr->aua_addr)) != 0)
645 			break;
646 	}
647 
648 	for (i = 0; err == 0 && i < hw_rh_cnt; i++)
649 		err = aggr_add_pseudo_rx_ring(port, rx_grp, hw_rh[i]);
650 
651 	if (err != 0) {
652 		for (j = 0; j < i; j++)
653 			aggr_rem_pseudo_rx_ring(rx_grp, hw_rh[j]);
654 
655 		for (a = rx_grp->arg_macaddr; a != addr; a = a->aua_next)
656 			aggr_port_remmac(port, a->aua_addr);
657 
658 		if (port->lp_hwgh != NULL) {
659 			mac_srs_perm_quiesce(port->lp_mch, B_FALSE);
660 			mac_rx_client_restart(port->lp_mch);
661 			port->lp_hwgh = NULL;
662 		}
663 	} else {
664 		port->lp_grp_added = B_TRUE;
665 	}
666 done:
667 	mac_perim_exit(pmph);
668 	return (err);
669 }
670 
671 /*
672  * This function is called by aggr to remove pseudo RX rings over the
673  * HW rings of the underlying port.
674  */
675 static void
676 aggr_rem_pseudo_rx_group(aggr_port_t *port, aggr_pseudo_rx_group_t *rx_grp)
677 {
678 	aggr_grp_t		*grp = port->lp_grp;
679 	mac_ring_handle_t	hw_rh[MAX_RINGS_PER_GROUP];
680 	aggr_unicst_addr_t	*addr;
681 	mac_group_handle_t	hwgh;
682 	mac_perim_handle_t	pmph;
683 	int			hw_rh_cnt, i;
684 
685 	ASSERT(MAC_PERIM_HELD(grp->lg_mh));
686 	mac_perim_enter_by_mh(port->lp_mh, &pmph);
687 
688 	if (!port->lp_grp_added)
689 		goto done;
690 
691 	ASSERT(rx_grp->arg_gh != NULL);
692 	hw_rh_cnt = mac_hwrings_get(port->lp_mch, &hwgh, hw_rh);
693 
694 	/*
695 	 * If hw_rh_cnt is 0, it means that the underlying port does not
696 	 * support RX rings. Directly return in this case.
697 	 */
698 	for (i = 0; i < hw_rh_cnt; i++)
699 		aggr_rem_pseudo_rx_ring(rx_grp, hw_rh[i]);
700 
701 	for (addr = rx_grp->arg_macaddr; addr != NULL; addr = addr->aua_next)
702 		aggr_port_remmac(port, addr->aua_addr);
703 
704 	if (port->lp_hwgh != NULL) {
705 		port->lp_hwgh = NULL;
706 
707 		/*
708 		 * First clear the permanent-quiesced flag of the RX srs then
709 		 * restart the HW ring and the mac srs on the ring. Note that
710 		 * the HW ring and associated SRS will soon been removed when
711 		 * the port is removed from the aggr.
712 		 */
713 		mac_srs_perm_quiesce(port->lp_mch, B_FALSE);
714 		mac_rx_client_restart(port->lp_mch);
715 	}
716 
717 	port->lp_grp_added = B_FALSE;
718 done:
719 	mac_perim_exit(pmph);
720 }
721 
722 static int
723 aggr_pseudo_disable_intr(mac_intr_handle_t ih)
724 {
725 	aggr_pseudo_rx_ring_t *rr_ring = (aggr_pseudo_rx_ring_t *)ih;
726 	return (mac_hwring_disable_intr(rr_ring->arr_hw_rh));
727 }
728 
729 static int
730 aggr_pseudo_enable_intr(mac_intr_handle_t ih)
731 {
732 	aggr_pseudo_rx_ring_t *rr_ring = (aggr_pseudo_rx_ring_t *)ih;
733 	return (mac_hwring_enable_intr(rr_ring->arr_hw_rh));
734 }
735 
736 static int
737 aggr_pseudo_start_ring(mac_ring_driver_t arg, uint64_t mr_gen)
738 {
739 	aggr_pseudo_rx_ring_t *rr_ring = (aggr_pseudo_rx_ring_t *)arg;
740 	int err;
741 
742 	err = mac_hwring_start(rr_ring->arr_hw_rh);
743 	if (err == 0)
744 		rr_ring->arr_gen = mr_gen;
745 	return (err);
746 }
747 
748 static void
749 aggr_pseudo_stop_ring(mac_ring_driver_t arg)
750 {
751 	aggr_pseudo_rx_ring_t *rr_ring = (aggr_pseudo_rx_ring_t *)arg;
752 	mac_hwring_stop(rr_ring->arr_hw_rh);
753 }
754 
755 /*
756  * Add one or more ports to an existing link aggregation group.
757  */
758 int
759 aggr_grp_add_ports(datalink_id_t linkid, uint_t nports, boolean_t force,
760     laioc_port_t *ports)
761 {
762 	int rc, i, nadded = 0;
763 	aggr_grp_t *grp = NULL;
764 	aggr_port_t *port;
765 	boolean_t link_state_changed = B_FALSE;
766 	mac_perim_handle_t mph, pmph;
767 
768 	/* get group corresponding to linkid */
769 	rw_enter(&aggr_grp_lock, RW_READER);
770 	if (mod_hash_find(aggr_grp_hash, GRP_HASH_KEY(linkid),
771 	    (mod_hash_val_t *)&grp) != 0) {
772 		rw_exit(&aggr_grp_lock);
773 		return (ENOENT);
774 	}
775 	AGGR_GRP_REFHOLD(grp);
776 
777 	/*
778 	 * Hold the perimeter so that the aggregation won't be destroyed.
779 	 */
780 	mac_perim_enter_by_mh(grp->lg_mh, &mph);
781 	rw_exit(&aggr_grp_lock);
782 
783 	/* add the specified ports to group */
784 	for (i = 0; i < nports; i++) {
785 		/* add port to group */
786 		if ((rc = aggr_grp_add_port(grp, ports[i].lp_linkid,
787 		    force, &port)) != 0) {
788 			goto bail;
789 		}
790 		ASSERT(port != NULL);
791 		nadded++;
792 
793 		/* check capabilities */
794 		if (!aggr_grp_capab_check(grp, port) ||
795 		    !aggr_grp_sdu_check(grp, port) ||
796 		    !aggr_grp_margin_check(grp, port)) {
797 			rc = ENOTSUP;
798 			goto bail;
799 		}
800 
801 		/*
802 		 * Create the pseudo ring for each HW ring of the underlying
803 		 * port.
804 		 */
805 		rc = aggr_add_pseudo_rx_group(port, &grp->lg_rx_group);
806 		if (rc != 0)
807 			goto bail;
808 
809 		mac_perim_enter_by_mh(port->lp_mh, &pmph);
810 
811 		/* set LACP mode */
812 		aggr_port_lacp_set_mode(grp, port);
813 
814 		/* start port if group has already been started */
815 		if (grp->lg_started) {
816 			rc = aggr_port_start(port);
817 			if (rc != 0) {
818 				mac_perim_exit(pmph);
819 				goto bail;
820 			}
821 
822 			/*
823 			 * Turn on the promiscuous mode over the port when it
824 			 * is requested to be turned on to receive the
825 			 * non-primary address over a port, or the promiscous
826 			 * mode is enabled over the aggr.
827 			 */
828 			if (grp->lg_promisc || port->lp_prom_addr != NULL) {
829 				rc = aggr_port_promisc(port, B_TRUE);
830 				if (rc != 0) {
831 					mac_perim_exit(pmph);
832 					goto bail;
833 				}
834 			}
835 		}
836 		mac_perim_exit(pmph);
837 
838 		/*
839 		 * Attach each port if necessary.
840 		 */
841 		if (aggr_port_notify_link(grp, port))
842 			link_state_changed = B_TRUE;
843 
844 		/*
845 		 * Initialize the callback functions for this port.
846 		 */
847 		aggr_port_init_callbacks(port);
848 	}
849 
850 	/* update the MAC address of the constituent ports */
851 	if (aggr_grp_update_ports_mac(grp))
852 		link_state_changed = B_TRUE;
853 
854 	if (link_state_changed)
855 		mac_link_update(grp->lg_mh, grp->lg_link_state);
856 
857 bail:
858 	if (rc != 0) {
859 		/* stop and remove ports that have been added */
860 		for (i = 0; i < nadded; i++) {
861 			port = aggr_grp_port_lookup(grp, ports[i].lp_linkid);
862 			ASSERT(port != NULL);
863 			if (grp->lg_started) {
864 				mac_perim_enter_by_mh(port->lp_mh, &pmph);
865 				(void) aggr_port_promisc(port, B_FALSE);
866 				aggr_port_stop(port);
867 				mac_perim_exit(pmph);
868 			}
869 			aggr_rem_pseudo_rx_group(port, &grp->lg_rx_group);
870 			(void) aggr_grp_rem_port(grp, port, NULL, NULL);
871 		}
872 	}
873 
874 	mac_perim_exit(mph);
875 	AGGR_GRP_REFRELE(grp);
876 	return (rc);
877 }
878 
879 static int
880 aggr_grp_modify_common(aggr_grp_t *grp, uint8_t update_mask, uint32_t policy,
881     boolean_t mac_fixed, const uchar_t *mac_addr, aggr_lacp_mode_t lacp_mode,
882     aggr_lacp_timer_t lacp_timer)
883 {
884 	boolean_t mac_addr_changed = B_FALSE;
885 	boolean_t link_state_changed = B_FALSE;
886 	mac_perim_handle_t pmph;
887 
888 	ASSERT(MAC_PERIM_HELD(grp->lg_mh));
889 
890 	/* validate fixed address if specified */
891 	if ((update_mask & AGGR_MODIFY_MAC) && mac_fixed &&
892 	    ((bcmp(aggr_zero_mac, mac_addr, ETHERADDRL) == 0) ||
893 	    (mac_addr[0] & 0x01))) {
894 		return (EINVAL);
895 	}
896 
897 	/* update policy if requested */
898 	if (update_mask & AGGR_MODIFY_POLICY)
899 		aggr_send_update_policy(grp, policy);
900 
901 	/* update unicast MAC address if requested */
902 	if (update_mask & AGGR_MODIFY_MAC) {
903 		if (mac_fixed) {
904 			/* user-supplied MAC address */
905 			grp->lg_mac_addr_port = NULL;
906 			if (bcmp(mac_addr, grp->lg_addr, ETHERADDRL) != 0) {
907 				bcopy(mac_addr, grp->lg_addr, ETHERADDRL);
908 				mac_addr_changed = B_TRUE;
909 			}
910 		} else if (grp->lg_addr_fixed) {
911 			/* switch from user-supplied to automatic */
912 			aggr_port_t *port = grp->lg_ports;
913 
914 			mac_perim_enter_by_mh(port->lp_mh, &pmph);
915 			bcopy(port->lp_addr, grp->lg_addr, ETHERADDRL);
916 			grp->lg_mac_addr_port = port;
917 			mac_addr_changed = B_TRUE;
918 			mac_perim_exit(pmph);
919 		}
920 		grp->lg_addr_fixed = mac_fixed;
921 	}
922 
923 	if (mac_addr_changed)
924 		link_state_changed = aggr_grp_update_ports_mac(grp);
925 
926 	if (update_mask & AGGR_MODIFY_LACP_MODE)
927 		aggr_lacp_update_mode(grp, lacp_mode);
928 
929 	if (update_mask & AGGR_MODIFY_LACP_TIMER)
930 		aggr_lacp_update_timer(grp, lacp_timer);
931 
932 	if (link_state_changed)
933 		mac_link_update(grp->lg_mh, grp->lg_link_state);
934 
935 	if (mac_addr_changed)
936 		mac_unicst_update(grp->lg_mh, grp->lg_addr);
937 
938 	return (0);
939 }
940 
941 /*
942  * Update properties of an existing link aggregation group.
943  */
944 int
945 aggr_grp_modify(datalink_id_t linkid, uint8_t update_mask, uint32_t policy,
946     boolean_t mac_fixed, const uchar_t *mac_addr, aggr_lacp_mode_t lacp_mode,
947     aggr_lacp_timer_t lacp_timer)
948 {
949 	aggr_grp_t *grp = NULL;
950 	mac_perim_handle_t mph;
951 	int err;
952 
953 	/* get group corresponding to linkid */
954 	rw_enter(&aggr_grp_lock, RW_READER);
955 	if (mod_hash_find(aggr_grp_hash, GRP_HASH_KEY(linkid),
956 	    (mod_hash_val_t *)&grp) != 0) {
957 		rw_exit(&aggr_grp_lock);
958 		return (ENOENT);
959 	}
960 	AGGR_GRP_REFHOLD(grp);
961 
962 	/*
963 	 * Hold the perimeter so that the aggregation won't be destroyed.
964 	 */
965 	mac_perim_enter_by_mh(grp->lg_mh, &mph);
966 	rw_exit(&aggr_grp_lock);
967 
968 	err = aggr_grp_modify_common(grp, update_mask, policy, mac_fixed,
969 	    mac_addr, lacp_mode, lacp_timer);
970 
971 	mac_perim_exit(mph);
972 	AGGR_GRP_REFRELE(grp);
973 	return (err);
974 }
975 
976 /*
977  * Create a new link aggregation group upon request from administrator.
978  * Returns 0 on success, an errno on failure.
979  */
980 int
981 aggr_grp_create(datalink_id_t linkid, uint32_t key, uint_t nports,
982     laioc_port_t *ports, uint32_t policy, boolean_t mac_fixed, boolean_t force,
983     uchar_t *mac_addr, aggr_lacp_mode_t lacp_mode, aggr_lacp_timer_t lacp_timer)
984 {
985 	aggr_grp_t *grp = NULL;
986 	aggr_port_t *port;
987 	mac_register_t *mac;
988 	boolean_t link_state_changed;
989 	mac_perim_handle_t mph;
990 	int err;
991 	int i;
992 
993 	/* need at least one port */
994 	if (nports == 0)
995 		return (EINVAL);
996 
997 	rw_enter(&aggr_grp_lock, RW_WRITER);
998 
999 	/* does a group with the same linkid already exist? */
1000 	err = mod_hash_find(aggr_grp_hash, GRP_HASH_KEY(linkid),
1001 	    (mod_hash_val_t *)&grp);
1002 	if (err == 0) {
1003 		rw_exit(&aggr_grp_lock);
1004 		return (EEXIST);
1005 	}
1006 
1007 	grp = kmem_cache_alloc(aggr_grp_cache, KM_SLEEP);
1008 
1009 	grp->lg_refs = 1;
1010 	grp->lg_closing = B_FALSE;
1011 	grp->lg_force = force;
1012 	grp->lg_linkid = linkid;
1013 	grp->lg_ifspeed = 0;
1014 	grp->lg_link_state = LINK_STATE_UNKNOWN;
1015 	grp->lg_link_duplex = LINK_DUPLEX_UNKNOWN;
1016 	grp->lg_started = B_FALSE;
1017 	grp->lg_promisc = B_FALSE;
1018 	grp->lg_lacp_done = B_FALSE;
1019 	grp->lg_lacp_head = grp->lg_lacp_tail = NULL;
1020 	grp->lg_lacp_rx_thread = thread_create(NULL, 0,
1021 	    aggr_lacp_rx_thread, grp, 0, &p0, TS_RUN, minclsyspri);
1022 	bzero(&grp->lg_rx_group, sizeof (aggr_pseudo_rx_group_t));
1023 	aggr_lacp_init_grp(grp);
1024 
1025 	/* add MAC ports to group */
1026 	grp->lg_ports = NULL;
1027 	grp->lg_nports = 0;
1028 	grp->lg_nattached_ports = 0;
1029 	grp->lg_ntx_ports = 0;
1030 
1031 	/*
1032 	 * If key is not specified by the user, allocate the key.
1033 	 */
1034 	if ((key == 0) && ((key = (uint32_t)id_alloc(key_ids)) == 0)) {
1035 		err = ENOMEM;
1036 		goto bail;
1037 	}
1038 	grp->lg_key = key;
1039 
1040 	for (i = 0; i < nports; i++) {
1041 		err = aggr_grp_add_port(grp, ports[i].lp_linkid, force, NULL);
1042 		if (err != 0)
1043 			goto bail;
1044 	}
1045 
1046 	/*
1047 	 * If no explicit MAC address was specified by the administrator,
1048 	 * set it to the MAC address of the first port.
1049 	 */
1050 	grp->lg_addr_fixed = mac_fixed;
1051 	if (grp->lg_addr_fixed) {
1052 		/* validate specified address */
1053 		if (bcmp(aggr_zero_mac, mac_addr, ETHERADDRL) == 0) {
1054 			err = EINVAL;
1055 			goto bail;
1056 		}
1057 		bcopy(mac_addr, grp->lg_addr, ETHERADDRL);
1058 	} else {
1059 		bcopy(grp->lg_ports->lp_addr, grp->lg_addr, ETHERADDRL);
1060 		grp->lg_mac_addr_port = grp->lg_ports;
1061 	}
1062 
1063 	/* set the initial group capabilities */
1064 	aggr_grp_capab_set(grp);
1065 
1066 	if ((mac = mac_alloc(MAC_VERSION)) == NULL) {
1067 		err = ENOMEM;
1068 		goto bail;
1069 	}
1070 	mac->m_type_ident = MAC_PLUGIN_IDENT_ETHER;
1071 	mac->m_driver = grp;
1072 	mac->m_dip = aggr_dip;
1073 	mac->m_instance = grp->lg_key > AGGR_MAX_KEY ? (uint_t)-1 : grp->lg_key;
1074 	mac->m_src_addr = grp->lg_addr;
1075 	mac->m_callbacks = &aggr_m_callbacks;
1076 	mac->m_min_sdu = 0;
1077 	mac->m_max_sdu = grp->lg_max_sdu = aggr_grp_max_sdu(grp);
1078 	mac->m_margin = aggr_grp_max_margin(grp);
1079 	mac->m_v12n = MAC_VIRT_LEVEL1;
1080 	err = mac_register(mac, &grp->lg_mh);
1081 	mac_free(mac);
1082 	if (err != 0)
1083 		goto bail;
1084 
1085 	if ((err = dls_devnet_create(grp->lg_mh, grp->lg_linkid)) != 0) {
1086 		(void) mac_unregister(grp->lg_mh);
1087 		grp->lg_mh = NULL;
1088 		goto bail;
1089 	}
1090 
1091 	mac_perim_enter_by_mh(grp->lg_mh, &mph);
1092 
1093 	/*
1094 	 * Update the MAC address of the constituent ports.
1095 	 * None of the port is attached at this time, the link state of the
1096 	 * aggregation will not change.
1097 	 */
1098 	link_state_changed = aggr_grp_update_ports_mac(grp);
1099 	ASSERT(!link_state_changed);
1100 
1101 	/* update outbound load balancing policy */
1102 	aggr_send_update_policy(grp, policy);
1103 
1104 	/* set LACP mode */
1105 	aggr_lacp_set_mode(grp, lacp_mode, lacp_timer);
1106 
1107 	/*
1108 	 * Attach each port if necessary.
1109 	 */
1110 	for (port = grp->lg_ports; port != NULL; port = port->lp_next) {
1111 		/*
1112 		 * Create the pseudo ring for each HW ring of the underlying
1113 		 * port. Note that this is done after the aggr registers the
1114 		 * mac.
1115 		 */
1116 		VERIFY(aggr_add_pseudo_rx_group(port, &grp->lg_rx_group) == 0);
1117 		if (aggr_port_notify_link(grp, port))
1118 			link_state_changed = B_TRUE;
1119 
1120 		/*
1121 		 * Initialize the callback functions for this port.
1122 		 */
1123 		aggr_port_init_callbacks(port);
1124 	}
1125 
1126 	if (link_state_changed)
1127 		mac_link_update(grp->lg_mh, grp->lg_link_state);
1128 
1129 	/* add new group to hash table */
1130 	err = mod_hash_insert(aggr_grp_hash, GRP_HASH_KEY(linkid),
1131 	    (mod_hash_val_t)grp);
1132 	ASSERT(err == 0);
1133 	aggr_grp_cnt++;
1134 
1135 	mac_perim_exit(mph);
1136 	rw_exit(&aggr_grp_lock);
1137 	return (0);
1138 
1139 bail:
1140 
1141 	grp->lg_closing = B_TRUE;
1142 
1143 	port = grp->lg_ports;
1144 	while (port != NULL) {
1145 		aggr_port_t *cport;
1146 
1147 		cport = port->lp_next;
1148 		aggr_port_delete(port);
1149 		port = cport;
1150 	}
1151 
1152 	/*
1153 	 * Inform the lacp_rx thread to exit.
1154 	 */
1155 	mutex_enter(&grp->lg_lacp_lock);
1156 	grp->lg_lacp_done = B_TRUE;
1157 	cv_signal(&grp->lg_lacp_cv);
1158 	while (grp->lg_lacp_rx_thread != NULL)
1159 		cv_wait(&grp->lg_lacp_cv, &grp->lg_lacp_lock);
1160 	mutex_exit(&grp->lg_lacp_lock);
1161 
1162 	rw_exit(&aggr_grp_lock);
1163 	AGGR_GRP_REFRELE(grp);
1164 	return (err);
1165 }
1166 
1167 /*
1168  * Return a pointer to the member of a group with specified linkid.
1169  */
1170 static aggr_port_t *
1171 aggr_grp_port_lookup(aggr_grp_t *grp, datalink_id_t linkid)
1172 {
1173 	aggr_port_t *port;
1174 
1175 	ASSERT(MAC_PERIM_HELD(grp->lg_mh));
1176 
1177 	for (port = grp->lg_ports; port != NULL; port = port->lp_next) {
1178 		if (port->lp_linkid == linkid)
1179 			break;
1180 	}
1181 
1182 	return (port);
1183 }
1184 
1185 /*
1186  * Stop, detach and remove a port from a link aggregation group.
1187  */
1188 static int
1189 aggr_grp_rem_port(aggr_grp_t *grp, aggr_port_t *port,
1190     boolean_t *mac_addr_changedp, boolean_t *link_state_changedp)
1191 {
1192 	int rc = 0;
1193 	aggr_port_t **pport;
1194 	boolean_t mac_addr_changed = B_FALSE;
1195 	boolean_t link_state_changed = B_FALSE;
1196 	mac_perim_handle_t mph;
1197 	uint64_t val;
1198 	uint_t i;
1199 	uint_t stat;
1200 
1201 	ASSERT(MAC_PERIM_HELD(grp->lg_mh));
1202 	ASSERT(grp->lg_nports > 1);
1203 	ASSERT(!grp->lg_closing);
1204 
1205 	/* unlink port */
1206 	for (pport = &grp->lg_ports; *pport != port;
1207 	    pport = &(*pport)->lp_next) {
1208 		if (*pport == NULL) {
1209 			rc = ENOENT;
1210 			goto done;
1211 		}
1212 	}
1213 	*pport = port->lp_next;
1214 
1215 	mac_perim_enter_by_mh(port->lp_mh, &mph);
1216 
1217 	/*
1218 	 * If the MAC address of the port being removed was assigned
1219 	 * to the group, update the group MAC address
1220 	 * using the MAC address of a different port.
1221 	 */
1222 	if (!grp->lg_addr_fixed && grp->lg_mac_addr_port == port) {
1223 		/*
1224 		 * Set the MAC address of the group to the
1225 		 * MAC address of its first port.
1226 		 */
1227 		bcopy(grp->lg_ports->lp_addr, grp->lg_addr, ETHERADDRL);
1228 		grp->lg_mac_addr_port = grp->lg_ports;
1229 		mac_addr_changed = B_TRUE;
1230 	}
1231 
1232 	link_state_changed = aggr_grp_detach_port(grp, port);
1233 
1234 	/*
1235 	 * Add the counter statistics of the ports while it was aggregated
1236 	 * to the group's residual statistics.  This is done by obtaining
1237 	 * the current counter from the underlying MAC then subtracting the
1238 	 * value of the counter at the moment it was added to the
1239 	 * aggregation.
1240 	 */
1241 	for (i = 0; i < MAC_NSTAT; i++) {
1242 		stat = i + MAC_STAT_MIN;
1243 		if (!MAC_STAT_ISACOUNTER(stat))
1244 			continue;
1245 		val = aggr_port_stat(port, stat);
1246 		val -= port->lp_stat[i];
1247 		grp->lg_stat[i] += val;
1248 	}
1249 	for (i = 0; i < ETHER_NSTAT; i++) {
1250 		stat = i + MACTYPE_STAT_MIN;
1251 		if (!ETHER_STAT_ISACOUNTER(stat))
1252 			continue;
1253 		val = aggr_port_stat(port, stat);
1254 		val -= port->lp_ether_stat[i];
1255 		grp->lg_ether_stat[i] += val;
1256 	}
1257 
1258 	grp->lg_nports--;
1259 	mac_perim_exit(mph);
1260 
1261 	aggr_port_delete(port);
1262 
1263 	/*
1264 	 * If the group MAC address has changed, update the MAC address of
1265 	 * the remaining constituent ports according to the new MAC
1266 	 * address of the group.
1267 	 */
1268 	if (mac_addr_changed && aggr_grp_update_ports_mac(grp))
1269 		link_state_changed = B_TRUE;
1270 
1271 done:
1272 	if (mac_addr_changedp != NULL)
1273 		*mac_addr_changedp = mac_addr_changed;
1274 	if (link_state_changedp != NULL)
1275 		*link_state_changedp = link_state_changed;
1276 
1277 	return (rc);
1278 }
1279 
1280 /*
1281  * Remove one or more ports from an existing link aggregation group.
1282  */
1283 int
1284 aggr_grp_rem_ports(datalink_id_t linkid, uint_t nports, laioc_port_t *ports)
1285 {
1286 	int rc = 0, i;
1287 	aggr_grp_t *grp = NULL;
1288 	aggr_port_t *port;
1289 	boolean_t mac_addr_update = B_FALSE, mac_addr_changed;
1290 	boolean_t link_state_update = B_FALSE, link_state_changed;
1291 	mac_perim_handle_t mph, pmph;
1292 
1293 	/* get group corresponding to linkid */
1294 	rw_enter(&aggr_grp_lock, RW_READER);
1295 	if (mod_hash_find(aggr_grp_hash, GRP_HASH_KEY(linkid),
1296 	    (mod_hash_val_t *)&grp) != 0) {
1297 		rw_exit(&aggr_grp_lock);
1298 		return (ENOENT);
1299 	}
1300 	AGGR_GRP_REFHOLD(grp);
1301 
1302 	/*
1303 	 * Hold the perimeter so that the aggregation won't be destroyed.
1304 	 */
1305 	mac_perim_enter_by_mh(grp->lg_mh, &mph);
1306 	rw_exit(&aggr_grp_lock);
1307 
1308 	/* we need to keep at least one port per group */
1309 	if (nports >= grp->lg_nports) {
1310 		rc = EINVAL;
1311 		goto bail;
1312 	}
1313 
1314 	/* first verify that all the groups are valid */
1315 	for (i = 0; i < nports; i++) {
1316 		if (aggr_grp_port_lookup(grp, ports[i].lp_linkid) == NULL) {
1317 			/* port not found */
1318 			rc = ENOENT;
1319 			goto bail;
1320 		}
1321 	}
1322 
1323 	/* clear the promiscous mode for the specified ports */
1324 	for (i = 0; i < nports && rc == 0; i++) {
1325 		/* lookup port */
1326 		port = aggr_grp_port_lookup(grp, ports[i].lp_linkid);
1327 		ASSERT(port != NULL);
1328 
1329 		mac_perim_enter_by_mh(port->lp_mh, &pmph);
1330 		rc = aggr_port_promisc(port, B_FALSE);
1331 		mac_perim_exit(pmph);
1332 	}
1333 	if (rc != 0) {
1334 		for (i = 0; i < nports; i++) {
1335 			port = aggr_grp_port_lookup(grp,
1336 			    ports[i].lp_linkid);
1337 			ASSERT(port != NULL);
1338 
1339 			/*
1340 			 * Turn the promiscuous mode back on if it is required
1341 			 * to receive the non-primary address over a port, or
1342 			 * the promiscous mode is enabled over the aggr.
1343 			 */
1344 			mac_perim_enter_by_mh(port->lp_mh, &pmph);
1345 			if (port->lp_started && (grp->lg_promisc ||
1346 			    port->lp_prom_addr != NULL)) {
1347 				(void) aggr_port_promisc(port, B_TRUE);
1348 			}
1349 			mac_perim_exit(pmph);
1350 		}
1351 		goto bail;
1352 	}
1353 
1354 	/* remove the specified ports from group */
1355 	for (i = 0; i < nports; i++) {
1356 		/* lookup port */
1357 		port = aggr_grp_port_lookup(grp, ports[i].lp_linkid);
1358 		ASSERT(port != NULL);
1359 
1360 		/* stop port if group has already been started */
1361 		if (grp->lg_started) {
1362 			mac_perim_enter_by_mh(port->lp_mh, &pmph);
1363 			aggr_port_stop(port);
1364 			mac_perim_exit(pmph);
1365 		}
1366 
1367 		aggr_rem_pseudo_rx_group(port, &grp->lg_rx_group);
1368 		/* remove port from group */
1369 		rc = aggr_grp_rem_port(grp, port, &mac_addr_changed,
1370 		    &link_state_changed);
1371 		ASSERT(rc == 0);
1372 		mac_addr_update = mac_addr_update || mac_addr_changed;
1373 		link_state_update = link_state_update || link_state_changed;
1374 	}
1375 
1376 bail:
1377 	if (mac_addr_update)
1378 		mac_unicst_update(grp->lg_mh, grp->lg_addr);
1379 	if (link_state_update)
1380 		mac_link_update(grp->lg_mh, grp->lg_link_state);
1381 
1382 	mac_perim_exit(mph);
1383 	AGGR_GRP_REFRELE(grp);
1384 
1385 	return (rc);
1386 }
1387 
1388 int
1389 aggr_grp_delete(datalink_id_t linkid)
1390 {
1391 	aggr_grp_t *grp = NULL;
1392 	aggr_port_t *port, *cport;
1393 	datalink_id_t tmpid;
1394 	mod_hash_val_t val;
1395 	mac_perim_handle_t mph, pmph;
1396 	int err;
1397 
1398 	rw_enter(&aggr_grp_lock, RW_WRITER);
1399 
1400 	if (mod_hash_find(aggr_grp_hash, GRP_HASH_KEY(linkid),
1401 	    (mod_hash_val_t *)&grp) != 0) {
1402 		rw_exit(&aggr_grp_lock);
1403 		return (ENOENT);
1404 	}
1405 
1406 	/*
1407 	 * Note that dls_devnet_destroy() must be called before lg_lock is
1408 	 * held. Otherwise, it will deadlock if another thread is in
1409 	 * aggr_m_stat() and thus has a kstat_hold() on the kstats that
1410 	 * dls_devnet_destroy() needs to delete.
1411 	 */
1412 	if ((err = dls_devnet_destroy(grp->lg_mh, &tmpid, B_TRUE)) != 0) {
1413 		rw_exit(&aggr_grp_lock);
1414 		return (err);
1415 	}
1416 	ASSERT(linkid == tmpid);
1417 
1418 	/*
1419 	 * Unregister from the MAC service module. Since this can
1420 	 * fail if a client hasn't closed the MAC port, we gracefully
1421 	 * fail the operation.
1422 	 */
1423 	if ((err = mac_disable(grp->lg_mh)) != 0) {
1424 		(void) dls_devnet_create(grp->lg_mh, linkid);
1425 		rw_exit(&aggr_grp_lock);
1426 		return (err);
1427 	}
1428 	(void) mod_hash_remove(aggr_grp_hash, GRP_HASH_KEY(linkid), &val);
1429 	ASSERT(grp == (aggr_grp_t *)val);
1430 
1431 	ASSERT(aggr_grp_cnt > 0);
1432 	aggr_grp_cnt--;
1433 	rw_exit(&aggr_grp_lock);
1434 
1435 	/*
1436 	 * Inform the lacp_rx thread to exit.
1437 	 */
1438 	mutex_enter(&grp->lg_lacp_lock);
1439 	grp->lg_lacp_done = B_TRUE;
1440 	cv_signal(&grp->lg_lacp_cv);
1441 	while (grp->lg_lacp_rx_thread != NULL)
1442 		cv_wait(&grp->lg_lacp_cv, &grp->lg_lacp_lock);
1443 	mutex_exit(&grp->lg_lacp_lock);
1444 
1445 	mac_perim_enter_by_mh(grp->lg_mh, &mph);
1446 
1447 	grp->lg_closing = B_TRUE;
1448 	/* detach and free MAC ports associated with group */
1449 	port = grp->lg_ports;
1450 	while (port != NULL) {
1451 		cport = port->lp_next;
1452 		mac_perim_enter_by_mh(port->lp_mh, &pmph);
1453 		if (grp->lg_started)
1454 			aggr_port_stop(port);
1455 		(void) aggr_grp_detach_port(grp, port);
1456 		mac_perim_exit(pmph);
1457 		aggr_rem_pseudo_rx_group(port, &grp->lg_rx_group);
1458 		aggr_port_delete(port);
1459 		port = cport;
1460 	}
1461 
1462 	mac_perim_exit(mph);
1463 
1464 	/*
1465 	 * Wait for the port's lacp timer thread and its notification callback
1466 	 * to exit before calling mac_unregister() since both needs to access
1467 	 * the mac perimeter of the grp.
1468 	 */
1469 	aggr_grp_port_wait(grp);
1470 
1471 	VERIFY(mac_unregister(grp->lg_mh) == 0);
1472 	grp->lg_mh = NULL;
1473 
1474 	AGGR_GRP_REFRELE(grp);
1475 	return (0);
1476 }
1477 
1478 void
1479 aggr_grp_free(aggr_grp_t *grp)
1480 {
1481 	ASSERT(grp->lg_refs == 0);
1482 	ASSERT(grp->lg_port_ref == 0);
1483 	if (grp->lg_key > AGGR_MAX_KEY) {
1484 		id_free(key_ids, grp->lg_key);
1485 		grp->lg_key = 0;
1486 	}
1487 	kmem_cache_free(aggr_grp_cache, grp);
1488 }
1489 
1490 int
1491 aggr_grp_info(datalink_id_t linkid, void *fn_arg,
1492     aggr_grp_info_new_grp_fn_t new_grp_fn,
1493     aggr_grp_info_new_port_fn_t new_port_fn)
1494 {
1495 	aggr_grp_t	*grp;
1496 	aggr_port_t	*port;
1497 	mac_perim_handle_t mph, pmph;
1498 	int		rc = 0;
1499 
1500 	rw_enter(&aggr_grp_lock, RW_READER);
1501 
1502 	if (mod_hash_find(aggr_grp_hash, GRP_HASH_KEY(linkid),
1503 	    (mod_hash_val_t *)&grp) != 0) {
1504 		rw_exit(&aggr_grp_lock);
1505 		return (ENOENT);
1506 	}
1507 	AGGR_GRP_REFHOLD(grp);
1508 
1509 	mac_perim_enter_by_mh(grp->lg_mh, &mph);
1510 	rw_exit(&aggr_grp_lock);
1511 
1512 	rc = new_grp_fn(fn_arg, grp->lg_linkid,
1513 	    (grp->lg_key > AGGR_MAX_KEY) ? 0 : grp->lg_key, grp->lg_addr,
1514 	    grp->lg_addr_fixed, grp->lg_force, grp->lg_tx_policy,
1515 	    grp->lg_nports, grp->lg_lacp_mode, grp->aggr.PeriodicTimer);
1516 
1517 	if (rc != 0)
1518 		goto bail;
1519 
1520 	for (port = grp->lg_ports; port != NULL; port = port->lp_next) {
1521 		mac_perim_enter_by_mh(port->lp_mh, &pmph);
1522 		rc = new_port_fn(fn_arg, port->lp_linkid, port->lp_addr,
1523 		    port->lp_state, &port->lp_lacp.ActorOperPortState);
1524 		mac_perim_exit(pmph);
1525 
1526 		if (rc != 0)
1527 			goto bail;
1528 	}
1529 
1530 bail:
1531 	mac_perim_exit(mph);
1532 	AGGR_GRP_REFRELE(grp);
1533 	return (rc);
1534 }
1535 
1536 /*ARGSUSED*/
1537 static void
1538 aggr_m_ioctl(void *arg, queue_t *q, mblk_t *mp)
1539 {
1540 	miocnak(q, mp, 0, ENOTSUP);
1541 }
1542 
1543 static int
1544 aggr_grp_stat(aggr_grp_t *grp, uint_t stat, uint64_t *val)
1545 {
1546 	aggr_port_t	*port;
1547 	uint_t		stat_index;
1548 
1549 	/* We only aggregate counter statistics. */
1550 	if (IS_MAC_STAT(stat) && !MAC_STAT_ISACOUNTER(stat) ||
1551 	    IS_MACTYPE_STAT(stat) && !ETHER_STAT_ISACOUNTER(stat)) {
1552 		return (ENOTSUP);
1553 	}
1554 
1555 	/*
1556 	 * Counter statistics for a group are computed by aggregating the
1557 	 * counters of the members MACs while they were aggregated, plus
1558 	 * the residual counter of the group itself, which is updated each
1559 	 * time a MAC is removed from the group.
1560 	 */
1561 	*val = 0;
1562 	for (port = grp->lg_ports; port != NULL; port = port->lp_next) {
1563 		/* actual port statistic */
1564 		*val += aggr_port_stat(port, stat);
1565 		/*
1566 		 * minus the port stat when it was added, plus any residual
1567 		 * amount for the group.
1568 		 */
1569 		if (IS_MAC_STAT(stat)) {
1570 			stat_index = stat - MAC_STAT_MIN;
1571 			*val -= port->lp_stat[stat_index];
1572 			*val += grp->lg_stat[stat_index];
1573 		} else if (IS_MACTYPE_STAT(stat)) {
1574 			stat_index = stat - MACTYPE_STAT_MIN;
1575 			*val -= port->lp_ether_stat[stat_index];
1576 			*val += grp->lg_ether_stat[stat_index];
1577 		}
1578 	}
1579 	return (0);
1580 }
1581 
1582 static int
1583 aggr_m_stat(void *arg, uint_t stat, uint64_t *val)
1584 {
1585 	aggr_grp_t		*grp = arg;
1586 	mac_perim_handle_t	mph;
1587 	int			rval = 0;
1588 
1589 	mac_perim_enter_by_mh(grp->lg_mh, &mph);
1590 
1591 	switch (stat) {
1592 	case MAC_STAT_IFSPEED:
1593 		*val = grp->lg_ifspeed;
1594 		break;
1595 
1596 	case ETHER_STAT_LINK_DUPLEX:
1597 		*val = grp->lg_link_duplex;
1598 		break;
1599 
1600 	default:
1601 		/*
1602 		 * For all other statistics, we return the aggregated stat
1603 		 * from the underlying ports.  aggr_grp_stat() will set
1604 		 * rval appropriately if the statistic isn't a counter.
1605 		 */
1606 		rval = aggr_grp_stat(grp, stat, val);
1607 	}
1608 
1609 	mac_perim_exit(mph);
1610 	return (rval);
1611 }
1612 
1613 static int
1614 aggr_m_start(void *arg)
1615 {
1616 	aggr_grp_t *grp = arg;
1617 	aggr_port_t *port;
1618 	mac_perim_handle_t mph, pmph;
1619 
1620 	mac_perim_enter_by_mh(grp->lg_mh, &mph);
1621 
1622 	/*
1623 	 * Attempts to start all configured members of the group.
1624 	 * Group members will be attached when their link-up notification
1625 	 * is received.
1626 	 */
1627 	for (port = grp->lg_ports; port != NULL; port = port->lp_next) {
1628 		mac_perim_enter_by_mh(port->lp_mh, &pmph);
1629 		if (aggr_port_start(port) != 0) {
1630 			mac_perim_exit(pmph);
1631 			continue;
1632 		}
1633 
1634 		/*
1635 		 * Turn on the promiscuous mode if it is required to receive
1636 		 * the non-primary address over a port, or the promiscous
1637 		 * mode is enabled over the aggr.
1638 		 */
1639 		if (grp->lg_promisc || port->lp_prom_addr != NULL) {
1640 			if (aggr_port_promisc(port, B_TRUE) != 0)
1641 				aggr_port_stop(port);
1642 		}
1643 		mac_perim_exit(pmph);
1644 	}
1645 
1646 	grp->lg_started = B_TRUE;
1647 
1648 	mac_perim_exit(mph);
1649 	return (0);
1650 }
1651 
1652 static void
1653 aggr_m_stop(void *arg)
1654 {
1655 	aggr_grp_t *grp = arg;
1656 	aggr_port_t *port;
1657 	mac_perim_handle_t mph, pmph;
1658 
1659 	mac_perim_enter_by_mh(grp->lg_mh, &mph);
1660 
1661 	for (port = grp->lg_ports; port != NULL; port = port->lp_next) {
1662 		mac_perim_enter_by_mh(port->lp_mh, &pmph);
1663 
1664 		/* reset port promiscuous mode */
1665 		(void) aggr_port_promisc(port, B_FALSE);
1666 
1667 		aggr_port_stop(port);
1668 		mac_perim_exit(pmph);
1669 	}
1670 
1671 	grp->lg_started = B_FALSE;
1672 	mac_perim_exit(mph);
1673 }
1674 
1675 static int
1676 aggr_m_promisc(void *arg, boolean_t on)
1677 {
1678 	aggr_grp_t *grp = arg;
1679 	aggr_port_t *port;
1680 	boolean_t link_state_changed = B_FALSE;
1681 	mac_perim_handle_t mph, pmph;
1682 
1683 	AGGR_GRP_REFHOLD(grp);
1684 	mac_perim_enter_by_mh(grp->lg_mh, &mph);
1685 
1686 	ASSERT(!grp->lg_closing);
1687 
1688 	if (on == grp->lg_promisc)
1689 		goto bail;
1690 
1691 	for (port = grp->lg_ports; port != NULL; port = port->lp_next) {
1692 		int	err = 0;
1693 
1694 		mac_perim_enter_by_mh(port->lp_mh, &pmph);
1695 		AGGR_PORT_REFHOLD(port);
1696 		if (!on && (port->lp_prom_addr == NULL))
1697 			err = aggr_port_promisc(port, B_FALSE);
1698 		else if (on && port->lp_started)
1699 			err = aggr_port_promisc(port, B_TRUE);
1700 
1701 		if (err != 0) {
1702 			if (aggr_grp_detach_port(grp, port))
1703 				link_state_changed = B_TRUE;
1704 		} else {
1705 			/*
1706 			 * If a port was detached because of a previous
1707 			 * failure changing the promiscuity, the port
1708 			 * is reattached when it successfully changes
1709 			 * the promiscuity now, and this might cause
1710 			 * the link state of the aggregation to change.
1711 			 */
1712 			if (aggr_grp_attach_port(grp, port))
1713 				link_state_changed = B_TRUE;
1714 		}
1715 		mac_perim_exit(pmph);
1716 		AGGR_PORT_REFRELE(port);
1717 	}
1718 
1719 	grp->lg_promisc = on;
1720 
1721 	if (link_state_changed)
1722 		mac_link_update(grp->lg_mh, grp->lg_link_state);
1723 
1724 bail:
1725 	mac_perim_exit(mph);
1726 	AGGR_GRP_REFRELE(grp);
1727 
1728 	return (0);
1729 }
1730 
1731 static void
1732 aggr_grp_port_rename(const char *new_name, void *arg)
1733 {
1734 	/*
1735 	 * aggr port's mac client name is the format of "aggr link name" plus
1736 	 * AGGR_PORT_NAME_DELIMIT plus "underneath link name".
1737 	 */
1738 	int aggr_len, link_len, clnt_name_len, i;
1739 	char *str_end, *str_st, *str_del;
1740 	char aggr_name[MAXNAMELEN];
1741 	char link_name[MAXNAMELEN];
1742 	char *clnt_name;
1743 	aggr_grp_t *aggr_grp = arg;
1744 	aggr_port_t *aggr_port = aggr_grp->lg_ports;
1745 
1746 	for (i = 0; i < aggr_grp->lg_nports; i++) {
1747 		clnt_name = mac_client_name(aggr_port->lp_mch);
1748 		clnt_name_len = strlen(clnt_name);
1749 		str_st = clnt_name;
1750 		str_end = &(clnt_name[clnt_name_len]);
1751 		str_del = strchr(str_st, AGGR_PORT_NAME_DELIMIT);
1752 		ASSERT(str_del != NULL);
1753 		aggr_len = (intptr_t)((uintptr_t)str_del - (uintptr_t)str_st);
1754 		link_len = (intptr_t)((uintptr_t)str_end - (uintptr_t)str_del);
1755 		bzero(aggr_name, MAXNAMELEN);
1756 		bzero(link_name, MAXNAMELEN);
1757 		bcopy(clnt_name, aggr_name, aggr_len);
1758 		bcopy(str_del, link_name, link_len + 1);
1759 		bzero(clnt_name, MAXNAMELEN);
1760 		(void) snprintf(clnt_name, MAXNAMELEN, "%s%s", new_name,
1761 		    link_name);
1762 
1763 		(void) mac_rename_primary(aggr_port->lp_mh, NULL);
1764 		aggr_port = aggr_port->lp_next;
1765 	}
1766 }
1767 
1768 /*
1769  * Initialize the capabilities that are advertised for the group
1770  * according to the capabilities of the constituent ports.
1771  */
1772 static boolean_t
1773 aggr_m_capab_get(void *arg, mac_capab_t cap, void *cap_data)
1774 {
1775 	aggr_grp_t *grp = arg;
1776 
1777 	switch (cap) {
1778 	case MAC_CAPAB_HCKSUM: {
1779 		uint32_t *hcksum_txflags = cap_data;
1780 		*hcksum_txflags = grp->lg_hcksum_txflags;
1781 		break;
1782 	}
1783 	case MAC_CAPAB_LSO: {
1784 		mac_capab_lso_t *cap_lso = cap_data;
1785 
1786 		if (grp->lg_lso) {
1787 			*cap_lso = grp->lg_cap_lso;
1788 			break;
1789 		} else {
1790 			return (B_FALSE);
1791 		}
1792 	}
1793 	case MAC_CAPAB_NO_NATIVEVLAN:
1794 		return (!grp->lg_vlan);
1795 	case MAC_CAPAB_NO_ZCOPY:
1796 		return (!grp->lg_zcopy);
1797 	case MAC_CAPAB_RINGS: {
1798 		mac_capab_rings_t *cap_rings = cap_data;
1799 
1800 		if (cap_rings->mr_type == MAC_RING_TYPE_RX) {
1801 			cap_rings->mr_group_type = MAC_GROUP_TYPE_STATIC;
1802 			cap_rings->mr_rnum = grp->lg_rx_group.arg_ring_cnt;
1803 			cap_rings->mr_rget = aggr_fill_ring;
1804 
1805 			/*
1806 			 * An aggregation advertises only one (pseudo) RX
1807 			 * group, which virtualizes the main/primary group of
1808 			 * the underlying devices.
1809 			 */
1810 			cap_rings->mr_gnum = 1;
1811 			cap_rings->mr_gget = aggr_fill_group;
1812 			cap_rings->mr_gaddring = NULL;
1813 			cap_rings->mr_gremring = NULL;
1814 		} else {
1815 			return (B_FALSE);
1816 		}
1817 		break;
1818 	}
1819 	case MAC_CAPAB_AGGR:
1820 	{
1821 		mac_capab_aggr_t *aggr_cap;
1822 
1823 		if (cap_data != NULL) {
1824 			aggr_cap = cap_data;
1825 			aggr_cap->mca_rename_fn = aggr_grp_port_rename;
1826 			aggr_cap->mca_unicst = aggr_m_unicst;
1827 		}
1828 		return (B_TRUE);
1829 	}
1830 	default:
1831 		return (B_FALSE);
1832 	}
1833 	return (B_TRUE);
1834 }
1835 
1836 /*
1837  * Callback funtion for MAC layer to register groups.
1838  */
1839 static void
1840 aggr_fill_group(void *arg, mac_ring_type_t rtype, const int index,
1841     mac_group_info_t *infop, mac_group_handle_t gh)
1842 {
1843 	aggr_grp_t *grp = arg;
1844 	aggr_pseudo_rx_group_t *rx_group;
1845 
1846 	ASSERT(rtype == MAC_RING_TYPE_RX && index == 0);
1847 	rx_group = &grp->lg_rx_group;
1848 	rx_group->arg_gh = gh;
1849 	rx_group->arg_grp = grp;
1850 
1851 	infop->mgi_driver = (mac_group_driver_t)rx_group;
1852 	infop->mgi_start = NULL;
1853 	infop->mgi_stop = NULL;
1854 	infop->mgi_addmac = aggr_addmac;
1855 	infop->mgi_remmac = aggr_remmac;
1856 	infop->mgi_count = rx_group->arg_ring_cnt;
1857 }
1858 
1859 /*
1860  * Callback funtion for MAC layer to register all rings.
1861  */
1862 static void
1863 aggr_fill_ring(void *arg, mac_ring_type_t rtype, const int rg_index,
1864     const int index, mac_ring_info_t *infop, mac_ring_handle_t rh)
1865 {
1866 	aggr_grp_t	*grp = arg;
1867 
1868 	switch (rtype) {
1869 	case MAC_RING_TYPE_RX: {
1870 		aggr_pseudo_rx_group_t	*rx_group = &grp->lg_rx_group;
1871 		aggr_pseudo_rx_ring_t	*rx_ring;
1872 		mac_intr_t		aggr_mac_intr;
1873 
1874 		ASSERT(rg_index == 0);
1875 
1876 		ASSERT((index >= 0) && (index < rx_group->arg_ring_cnt));
1877 		rx_ring = rx_group->arg_rings + index;
1878 		rx_ring->arr_rh = rh;
1879 
1880 		/*
1881 		 * Entrypoint to enable interrupt (disable poll) and
1882 		 * disable interrupt (enable poll).
1883 		 */
1884 		aggr_mac_intr.mi_handle = (mac_intr_handle_t)rx_ring;
1885 		aggr_mac_intr.mi_enable = aggr_pseudo_enable_intr;
1886 		aggr_mac_intr.mi_disable = aggr_pseudo_disable_intr;
1887 
1888 		infop->mri_driver = (mac_ring_driver_t)rx_ring;
1889 		infop->mri_start = aggr_pseudo_start_ring;
1890 		infop->mri_stop = aggr_pseudo_stop_ring;
1891 
1892 		infop->mri_intr = aggr_mac_intr;
1893 		infop->mri_poll = aggr_rx_poll;
1894 		break;
1895 	}
1896 	default:
1897 		break;
1898 	}
1899 }
1900 
1901 static mblk_t *
1902 aggr_rx_poll(void *arg, int bytes_to_pickup)
1903 {
1904 	aggr_pseudo_rx_ring_t *rr_ring = arg;
1905 	aggr_port_t *port = rr_ring->arr_port;
1906 	aggr_grp_t *grp = port->lp_grp;
1907 	mblk_t *mp_chain, *mp, **mpp;
1908 
1909 	mp_chain = mac_hwring_poll(rr_ring->arr_hw_rh, bytes_to_pickup);
1910 
1911 	if (grp->lg_lacp_mode == AGGR_LACP_OFF)
1912 		return (mp_chain);
1913 
1914 	mpp = &mp_chain;
1915 	while ((mp = *mpp) != NULL) {
1916 		if (MBLKL(mp) >= sizeof (struct ether_header)) {
1917 			struct ether_header *ehp;
1918 
1919 			ehp = (struct ether_header *)mp->b_rptr;
1920 			if (ntohs(ehp->ether_type) == ETHERTYPE_SLOW) {
1921 				*mpp = mp->b_next;
1922 				mp->b_next = NULL;
1923 				aggr_recv_lacp(port,
1924 				    (mac_resource_handle_t)rr_ring, mp);
1925 				continue;
1926 			}
1927 		}
1928 
1929 		if (!port->lp_collector_enabled) {
1930 			*mpp = mp->b_next;
1931 			mp->b_next = NULL;
1932 			freemsg(mp);
1933 			continue;
1934 		}
1935 		mpp = &mp->b_next;
1936 	}
1937 	return (mp_chain);
1938 }
1939 
1940 static int
1941 aggr_addmac(void *arg, const uint8_t *mac_addr)
1942 {
1943 	aggr_pseudo_rx_group_t	*rx_group = (aggr_pseudo_rx_group_t *)arg;
1944 	aggr_unicst_addr_t	*addr, **pprev;
1945 	aggr_grp_t		*grp = rx_group->arg_grp;
1946 	aggr_port_t		*port, *p;
1947 	mac_perim_handle_t	mph;
1948 	int			err = 0;
1949 
1950 	mac_perim_enter_by_mh(grp->lg_mh, &mph);
1951 
1952 	if (bcmp(mac_addr, grp->lg_addr, ETHERADDRL) == 0) {
1953 		mac_perim_exit(mph);
1954 		return (0);
1955 	}
1956 
1957 	/*
1958 	 * Insert this mac address into the list of mac addresses owned by
1959 	 * the aggregation pseudo group.
1960 	 */
1961 	pprev = &rx_group->arg_macaddr;
1962 	while ((addr = *pprev) != NULL) {
1963 		if (bcmp(mac_addr, addr->aua_addr, ETHERADDRL) == 0) {
1964 			mac_perim_exit(mph);
1965 			return (EEXIST);
1966 		}
1967 		pprev = &addr->aua_next;
1968 	}
1969 	addr = kmem_alloc(sizeof (aggr_unicst_addr_t), KM_SLEEP);
1970 	bcopy(mac_addr, addr->aua_addr, ETHERADDRL);
1971 	addr->aua_next = NULL;
1972 	*pprev = addr;
1973 
1974 	for (port = grp->lg_ports; port != NULL; port = port->lp_next)
1975 		if ((err = aggr_port_addmac(port, mac_addr)) != 0)
1976 			break;
1977 
1978 	if (err != 0) {
1979 		for (p = grp->lg_ports; p != port; p = p->lp_next)
1980 			aggr_port_remmac(p, mac_addr);
1981 
1982 		*pprev = NULL;
1983 		kmem_free(addr, sizeof (aggr_unicst_addr_t));
1984 	}
1985 
1986 	mac_perim_exit(mph);
1987 	return (err);
1988 }
1989 
1990 static int
1991 aggr_remmac(void *arg, const uint8_t *mac_addr)
1992 {
1993 	aggr_pseudo_rx_group_t	*rx_group = (aggr_pseudo_rx_group_t *)arg;
1994 	aggr_unicst_addr_t	*addr, **pprev;
1995 	aggr_grp_t		*grp = rx_group->arg_grp;
1996 	aggr_port_t		*port;
1997 	mac_perim_handle_t	mph;
1998 	int			err = 0;
1999 
2000 	mac_perim_enter_by_mh(grp->lg_mh, &mph);
2001 
2002 	if (bcmp(mac_addr, grp->lg_addr, ETHERADDRL) == 0) {
2003 		mac_perim_exit(mph);
2004 		return (0);
2005 	}
2006 
2007 	/*
2008 	 * Insert this mac address into the list of mac addresses owned by
2009 	 * the aggregation pseudo group.
2010 	 */
2011 	pprev = &rx_group->arg_macaddr;
2012 	while ((addr = *pprev) != NULL) {
2013 		if (bcmp(mac_addr, addr->aua_addr, ETHERADDRL) != 0) {
2014 			pprev = &addr->aua_next;
2015 			continue;
2016 		}
2017 		break;
2018 	}
2019 	if (addr == NULL) {
2020 		mac_perim_exit(mph);
2021 		return (EINVAL);
2022 	}
2023 
2024 	for (port = grp->lg_ports; port != NULL; port = port->lp_next)
2025 		aggr_port_remmac(port, mac_addr);
2026 
2027 	*pprev = addr->aua_next;
2028 	kmem_free(addr, sizeof (aggr_unicst_addr_t));
2029 
2030 	mac_perim_exit(mph);
2031 	return (err);
2032 }
2033 
2034 /*
2035  * Add or remove the multicast addresses that are defined for the group
2036  * to or from the specified port.
2037  *
2038  * Note that aggr_grp_multicst_port(..., B_TRUE) is called when the port
2039  * is started and attached, and aggr_grp_multicst_port(..., B_FALSE) is
2040  * called when the port is either stopped or detached.
2041  */
2042 void
2043 aggr_grp_multicst_port(aggr_port_t *port, boolean_t add)
2044 {
2045 	aggr_grp_t *grp = port->lp_grp;
2046 
2047 	ASSERT(MAC_PERIM_HELD(port->lp_mh));
2048 	ASSERT(MAC_PERIM_HELD(grp->lg_mh));
2049 
2050 	if (!port->lp_started || port->lp_state != AGGR_PORT_STATE_ATTACHED)
2051 		return;
2052 
2053 	mac_multicast_refresh(grp->lg_mh, aggr_port_multicst, port, add);
2054 }
2055 
2056 static int
2057 aggr_m_multicst(void *arg, boolean_t add, const uint8_t *addrp)
2058 {
2059 	aggr_grp_t *grp = arg;
2060 	aggr_port_t *port = NULL;
2061 	mac_perim_handle_t mph;
2062 	int err = 0, cerr;
2063 
2064 	mac_perim_enter_by_mh(grp->lg_mh, &mph);
2065 	for (port = grp->lg_ports; port != NULL; port = port->lp_next) {
2066 		if (port->lp_state != AGGR_PORT_STATE_ATTACHED ||
2067 		    !port->lp_started) {
2068 			continue;
2069 		}
2070 		cerr = aggr_port_multicst(port, add, addrp);
2071 		if (cerr != 0 && err == 0)
2072 			err = cerr;
2073 	}
2074 	mac_perim_exit(mph);
2075 	return (err);
2076 }
2077 
2078 static int
2079 aggr_m_unicst(void *arg, const uint8_t *macaddr)
2080 {
2081 	aggr_grp_t *grp = arg;
2082 	mac_perim_handle_t mph;
2083 	int err;
2084 
2085 	mac_perim_enter_by_mh(grp->lg_mh, &mph);
2086 	err = aggr_grp_modify_common(grp, AGGR_MODIFY_MAC, 0, B_TRUE, macaddr,
2087 	    0, 0);
2088 	mac_perim_exit(mph);
2089 	return (err);
2090 }
2091 
2092 /*
2093  * Initialize the capabilities that are advertised for the group
2094  * according to the capabilities of the constituent ports.
2095  */
2096 static void
2097 aggr_grp_capab_set(aggr_grp_t *grp)
2098 {
2099 	uint32_t cksum;
2100 	aggr_port_t *port;
2101 	mac_capab_lso_t cap_lso;
2102 
2103 	ASSERT(grp->lg_mh == NULL);
2104 	ASSERT(grp->lg_ports != NULL);
2105 
2106 	grp->lg_hcksum_txflags = (uint32_t)-1;
2107 	grp->lg_zcopy = B_TRUE;
2108 	grp->lg_vlan = B_TRUE;
2109 
2110 	grp->lg_lso = B_TRUE;
2111 	grp->lg_cap_lso.lso_flags = (t_uscalar_t)-1;
2112 	grp->lg_cap_lso.lso_basic_tcp_ipv4.lso_max = (t_uscalar_t)-1;
2113 
2114 	for (port = grp->lg_ports; port != NULL; port = port->lp_next) {
2115 		if (!mac_capab_get(port->lp_mh, MAC_CAPAB_HCKSUM, &cksum))
2116 			cksum = 0;
2117 		grp->lg_hcksum_txflags &= cksum;
2118 
2119 		grp->lg_vlan &=
2120 		    !mac_capab_get(port->lp_mh, MAC_CAPAB_NO_NATIVEVLAN, NULL);
2121 
2122 		grp->lg_zcopy &=
2123 		    !mac_capab_get(port->lp_mh, MAC_CAPAB_NO_ZCOPY, NULL);
2124 
2125 		grp->lg_lso &=
2126 		    mac_capab_get(port->lp_mh, MAC_CAPAB_LSO, &cap_lso);
2127 		if (grp->lg_lso) {
2128 			grp->lg_cap_lso.lso_flags &= cap_lso.lso_flags;
2129 			if (grp->lg_cap_lso.lso_basic_tcp_ipv4.lso_max >
2130 			    cap_lso.lso_basic_tcp_ipv4.lso_max)
2131 				grp->lg_cap_lso.lso_basic_tcp_ipv4.lso_max =
2132 				    cap_lso.lso_basic_tcp_ipv4.lso_max;
2133 		}
2134 	}
2135 }
2136 
2137 /*
2138  * Checks whether the capabilities of the port being added are compatible
2139  * with the current capabilities of the aggregation.
2140  */
2141 static boolean_t
2142 aggr_grp_capab_check(aggr_grp_t *grp, aggr_port_t *port)
2143 {
2144 	uint32_t hcksum_txflags;
2145 
2146 	ASSERT(grp->lg_ports != NULL);
2147 
2148 	if (((!mac_capab_get(port->lp_mh, MAC_CAPAB_NO_NATIVEVLAN, NULL)) &
2149 	    grp->lg_vlan) != grp->lg_vlan) {
2150 		return (B_FALSE);
2151 	}
2152 
2153 	if (((!mac_capab_get(port->lp_mh, MAC_CAPAB_NO_ZCOPY, NULL)) &
2154 	    grp->lg_zcopy) != grp->lg_zcopy) {
2155 		return (B_FALSE);
2156 	}
2157 
2158 	if (!mac_capab_get(port->lp_mh, MAC_CAPAB_HCKSUM, &hcksum_txflags)) {
2159 		if (grp->lg_hcksum_txflags != 0)
2160 			return (B_FALSE);
2161 	} else if ((hcksum_txflags & grp->lg_hcksum_txflags) !=
2162 	    grp->lg_hcksum_txflags) {
2163 		return (B_FALSE);
2164 	}
2165 
2166 	if (grp->lg_lso) {
2167 		mac_capab_lso_t cap_lso;
2168 
2169 		if (mac_capab_get(port->lp_mh, MAC_CAPAB_LSO, &cap_lso)) {
2170 			if ((grp->lg_cap_lso.lso_flags & cap_lso.lso_flags) !=
2171 			    grp->lg_cap_lso.lso_flags)
2172 				return (B_FALSE);
2173 			if (grp->lg_cap_lso.lso_basic_tcp_ipv4.lso_max >
2174 			    cap_lso.lso_basic_tcp_ipv4.lso_max)
2175 				return (B_FALSE);
2176 		} else {
2177 			return (B_FALSE);
2178 		}
2179 	}
2180 
2181 	return (B_TRUE);
2182 }
2183 
2184 /*
2185  * Returns the maximum SDU according to the SDU of the constituent ports.
2186  */
2187 static uint_t
2188 aggr_grp_max_sdu(aggr_grp_t *grp)
2189 {
2190 	uint_t max_sdu = (uint_t)-1;
2191 	aggr_port_t *port;
2192 
2193 	ASSERT(grp->lg_ports != NULL);
2194 
2195 	for (port = grp->lg_ports; port != NULL; port = port->lp_next) {
2196 		uint_t port_sdu_max;
2197 
2198 		mac_sdu_get(port->lp_mh, NULL, &port_sdu_max);
2199 		if (max_sdu > port_sdu_max)
2200 			max_sdu = port_sdu_max;
2201 	}
2202 
2203 	return (max_sdu);
2204 }
2205 
2206 /*
2207  * Checks if the maximum SDU of the specified port is compatible
2208  * with the maximum SDU of the specified aggregation group, returns
2209  * B_TRUE if it is, B_FALSE otherwise.
2210  */
2211 static boolean_t
2212 aggr_grp_sdu_check(aggr_grp_t *grp, aggr_port_t *port)
2213 {
2214 	uint_t port_sdu_max;
2215 
2216 	mac_sdu_get(port->lp_mh, NULL, &port_sdu_max);
2217 	return (port_sdu_max >= grp->lg_max_sdu);
2218 }
2219 
2220 /*
2221  * Returns the maximum margin according to the margin of the constituent ports.
2222  */
2223 static uint32_t
2224 aggr_grp_max_margin(aggr_grp_t *grp)
2225 {
2226 	uint32_t margin = UINT32_MAX;
2227 	aggr_port_t *port;
2228 
2229 	ASSERT(grp->lg_mh == NULL);
2230 	ASSERT(grp->lg_ports != NULL);
2231 
2232 	for (port = grp->lg_ports; port != NULL; port = port->lp_next) {
2233 		if (margin > port->lp_margin)
2234 			margin = port->lp_margin;
2235 	}
2236 
2237 	grp->lg_margin = margin;
2238 	return (margin);
2239 }
2240 
2241 /*
2242  * Checks if the maximum margin of the specified port is compatible
2243  * with the maximum margin of the specified aggregation group, returns
2244  * B_TRUE if it is, B_FALSE otherwise.
2245  */
2246 static boolean_t
2247 aggr_grp_margin_check(aggr_grp_t *grp, aggr_port_t *port)
2248 {
2249 	if (port->lp_margin >= grp->lg_margin)
2250 		return (B_TRUE);
2251 
2252 	/*
2253 	 * See whether the current margin value is allowed to be changed to
2254 	 * the new value.
2255 	 */
2256 	if (!mac_margin_update(grp->lg_mh, port->lp_margin))
2257 		return (B_FALSE);
2258 
2259 	grp->lg_margin = port->lp_margin;
2260 	return (B_TRUE);
2261 }
2262 
2263 /*
2264  * Set MTU on individual ports of an aggregation group
2265  */
2266 static int
2267 aggr_set_port_sdu(aggr_grp_t *grp, aggr_port_t *port, uint32_t sdu,
2268     uint32_t *old_mtu)
2269 {
2270 	boolean_t 		removed = B_FALSE;
2271 	mac_perim_handle_t	mph;
2272 	mac_diag_t		diag;
2273 	int			err, rv, retry = 0;
2274 
2275 	if (port->lp_mah != NULL) {
2276 		(void) mac_unicast_remove(port->lp_mch, port->lp_mah);
2277 		port->lp_mah = NULL;
2278 		removed = B_TRUE;
2279 	}
2280 	err = mac_set_mtu(port->lp_mh, sdu, old_mtu);
2281 try_again:
2282 	if (removed && (rv = mac_unicast_add(port->lp_mch, NULL,
2283 	    MAC_UNICAST_PRIMARY | MAC_UNICAST_DISABLE_TX_VID_CHECK,
2284 	    &port->lp_mah, 0, &diag)) != 0) {
2285 		/*
2286 		 * following is a workaround for a bug in 'bge' driver.
2287 		 * See CR 6794654 for more information and this work around
2288 		 * will be removed once the CR is fixed.
2289 		 */
2290 		if (rv == EIO && retry++ < 3) {
2291 			delay(2 * hz);
2292 			goto try_again;
2293 		}
2294 		/*
2295 		 * if mac_unicast_add() failed while setting the MTU,
2296 		 * detach the port from the group.
2297 		 */
2298 		mac_perim_enter_by_mh(port->lp_mh, &mph);
2299 		(void) aggr_grp_detach_port(grp, port);
2300 		mac_perim_exit(mph);
2301 		cmn_err(CE_WARN, "Unable to restart the port %s while "
2302 		    "setting MTU. Detaching the port from the aggregation.",
2303 		    mac_client_name(port->lp_mch));
2304 	}
2305 	return (err);
2306 }
2307 
2308 static int
2309 aggr_sdu_update(aggr_grp_t *grp, uint32_t sdu)
2310 {
2311 	int			err = 0, i, rv;
2312 	aggr_port_t		*port;
2313 	uint32_t		*mtu;
2314 
2315 	ASSERT(MAC_PERIM_HELD(grp->lg_mh));
2316 
2317 	/*
2318 	 * If the MTU being set is equal to aggr group's maximum
2319 	 * allowable value, then there is nothing to change
2320 	 */
2321 	if (sdu == grp->lg_max_sdu)
2322 		return (0);
2323 
2324 	/* 0 is aggr group's min sdu */
2325 	if (sdu == 0)
2326 		return (EINVAL);
2327 
2328 	mtu = kmem_alloc(sizeof (uint32_t) * grp->lg_nports, KM_SLEEP);
2329 	for (port = grp->lg_ports, i = 0; port != NULL && err == 0;
2330 	    port = port->lp_next, i++) {
2331 		err = aggr_set_port_sdu(grp, port, sdu, mtu + i);
2332 	}
2333 	if (err != 0) {
2334 		/* recover from error: reset the mtus of the ports */
2335 		aggr_port_t *tmp;
2336 
2337 		for (tmp = grp->lg_ports, i = 0; tmp != port;
2338 		    tmp = tmp->lp_next, i++) {
2339 			(void) aggr_set_port_sdu(grp, tmp, *(mtu + i), NULL);
2340 		}
2341 		goto bail;
2342 	}
2343 	grp->lg_max_sdu = aggr_grp_max_sdu(grp);
2344 	rv = mac_maxsdu_update(grp->lg_mh, grp->lg_max_sdu);
2345 	ASSERT(rv == 0);
2346 bail:
2347 	kmem_free(mtu, sizeof (uint32_t) * grp->lg_nports);
2348 	return (err);
2349 }
2350 
2351 /*
2352  * Callback functions for set/get of properties
2353  */
2354 /*ARGSUSED*/
2355 static int
2356 aggr_m_setprop(void *m_driver, const char *pr_name, mac_prop_id_t pr_num,
2357     uint_t pr_valsize, const void *pr_val)
2358 {
2359 	int 		err = ENOTSUP;
2360 	aggr_grp_t 	*grp = m_driver;
2361 
2362 	switch (pr_num) {
2363 	case MAC_PROP_MTU: {
2364 		uint32_t 	mtu;
2365 
2366 		if (pr_valsize < sizeof (mtu)) {
2367 			err = EINVAL;
2368 			break;
2369 		}
2370 		bcopy(pr_val, &mtu, sizeof (mtu));
2371 		err = aggr_sdu_update(grp, mtu);
2372 		break;
2373 	}
2374 	default:
2375 		break;
2376 	}
2377 	return (err);
2378 }
2379 
2380 int
2381 aggr_grp_possible_mtu_range(aggr_grp_t *grp, mac_propval_range_t *range)
2382 {
2383 	mac_propval_range_t		*vals;
2384 	mac_propval_uint32_range_t	*ur;
2385 	aggr_port_t			*port;
2386 	mac_perim_handle_t		mph;
2387 	mac_prop_t 			macprop;
2388 	uint_t 				perm, i;
2389 	uint32_t 			min = 0, max = (uint32_t)-1;
2390 	int 				err = 0;
2391 
2392 	ASSERT(MAC_PERIM_HELD(grp->lg_mh));
2393 
2394 	vals = kmem_alloc(sizeof (mac_propval_range_t) * grp->lg_nports,
2395 	    KM_SLEEP);
2396 	macprop.mp_id = MAC_PROP_MTU;
2397 	macprop.mp_name = "mtu";
2398 	macprop.mp_flags = MAC_PROP_POSSIBLE;
2399 
2400 	for (port = grp->lg_ports, i = 0; port != NULL;
2401 	    port = port->lp_next, i++) {
2402 		mac_perim_enter_by_mh(port->lp_mh, &mph);
2403 		err = mac_get_prop(port->lp_mh, &macprop, vals + i,
2404 		    sizeof (mac_propval_range_t), &perm);
2405 		mac_perim_exit(mph);
2406 		if (err != 0)
2407 			break;
2408 	}
2409 	/*
2410 	 * if any of the underlying ports does not support changing MTU then
2411 	 * just return ENOTSUP
2412 	 */
2413 	if (port != NULL) {
2414 		ASSERT(err != 0);
2415 		goto done;
2416 	}
2417 	range->mpr_count = 1;
2418 	range->mpr_type = MAC_PROPVAL_UINT32;
2419 	for (i = 0; i < grp->lg_nports; i++) {
2420 		ur = &((vals + i)->range_uint32[0]);
2421 		/*
2422 		 * Take max of the min, for range_min; that is the minimum
2423 		 * MTU value for an aggregation is the maximum of the
2424 		 * minimum values of all the underlying ports
2425 		 */
2426 		if (ur->mpur_min > min)
2427 			min = ur->mpur_min;
2428 		/* Take min of the max, for range_max */
2429 		if (ur->mpur_max < max)
2430 			max = ur->mpur_max;
2431 	}
2432 	range->range_uint32[0].mpur_min = min;
2433 	range->range_uint32[0].mpur_max = max;
2434 done:
2435 	kmem_free(vals, sizeof (mac_propval_range_t) * grp->lg_nports);
2436 	return (err);
2437 }
2438 
2439 /*ARGSUSED*/
2440 static int
2441 aggr_m_getprop(void *m_driver, const char *pr_name, mac_prop_id_t pr_num,
2442     uint_t pr_flags, uint_t pr_valsize, void *pr_val, uint_t *perm)
2443 {
2444 	mac_propval_range_t 	range;
2445 	int 			err = ENOTSUP;
2446 	aggr_grp_t		*grp = m_driver;
2447 
2448 	switch (pr_num) {
2449 	case MAC_PROP_MTU:
2450 		if (!(pr_flags & MAC_PROP_POSSIBLE))
2451 			return (ENOTSUP);
2452 		if (pr_valsize < sizeof (mac_propval_range_t))
2453 			return (EINVAL);
2454 		if ((err = aggr_grp_possible_mtu_range(grp, &range)) != 0)
2455 			return (err);
2456 		bcopy(&range, pr_val, sizeof (range));
2457 		return (0);
2458 	}
2459 	return (err);
2460 }
2461