xref: /illumos-gate/usr/src/uts/common/io/dld/dld_str.c (revision 5e1743f0d6a1d79ccc247d50153ad830fa07768b)
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 (c) 2005, 2010, Oracle and/or its affiliates. All rights reserved.
23  */
24 
25 /*
26  * Data-Link Driver
27  */
28 
29 #include	<inet/common.h>
30 #include	<sys/strsubr.h>
31 #include	<sys/stropts.h>
32 #include	<sys/strsun.h>
33 #include	<sys/vlan.h>
34 #include	<sys/dld_impl.h>
35 #include	<sys/cpuvar.h>
36 #include	<sys/callb.h>
37 #include	<sys/list.h>
38 #include	<sys/mac_client.h>
39 #include	<sys/mac_client_priv.h>
40 #include	<sys/mac_flow.h>
41 
42 static int	str_constructor(void *, void *, int);
43 static void	str_destructor(void *, void *);
44 static mblk_t	*str_unitdata_ind(dld_str_t *, mblk_t *, boolean_t);
45 static void	str_notify_promisc_on_phys(dld_str_t *);
46 static void	str_notify_promisc_off_phys(dld_str_t *);
47 static void	str_notify_phys_addr(dld_str_t *, uint_t, const uint8_t *);
48 static void	str_notify_link_up(dld_str_t *);
49 static void	str_notify_link_down(dld_str_t *);
50 static void	str_notify_capab_reneg(dld_str_t *);
51 static void	str_notify_speed(dld_str_t *, uint32_t);
52 
53 static void	ioc_native(dld_str_t *,  mblk_t *);
54 static void	ioc_margin(dld_str_t *, mblk_t *);
55 static void	ioc_raw(dld_str_t *, mblk_t *);
56 static void	ioc_fast(dld_str_t *,  mblk_t *);
57 static void	ioc_lowlink(dld_str_t *,  mblk_t *);
58 static void	ioc(dld_str_t *, mblk_t *);
59 static void	dld_ioc(dld_str_t *, mblk_t *);
60 static void	dld_wput_nondata(dld_str_t *, mblk_t *);
61 
62 static void	str_mdata_raw_put(dld_str_t *, mblk_t *);
63 static mblk_t	*i_dld_ether_header_update_tag(mblk_t *, uint_t, uint16_t,
64     link_tagmode_t);
65 static mblk_t	*i_dld_ether_header_strip_tag(mblk_t *, boolean_t);
66 
67 static uint32_t		str_count;
68 static kmem_cache_t	*str_cachep;
69 static mod_hash_t	*str_hashp;
70 
71 #define	STR_HASHSZ		64
72 #define	STR_HASH_KEY(key)	((mod_hash_key_t)(uintptr_t)(key))
73 
74 #define	dld_taskq	system_taskq
75 
76 static kmutex_t		dld_taskq_lock;
77 static kcondvar_t	dld_taskq_cv;
78 static list_t		dld_taskq_list;		/* List of dld_str_t */
79 boolean_t		dld_taskq_quit;
80 boolean_t		dld_taskq_done;
81 
82 static void		dld_taskq_dispatch(void);
83 
84 /*
85  * Some notes on entry points, flow-control, queueing.
86  *
87  * This driver exports the traditional STREAMS put entry point as well as
88  * the non-STREAMS fast-path transmit routine which is provided to IP via
89  * the DL_CAPAB_POLL negotiation.  The put procedure handles all control
90  * and data operations, while the fast-path routine deals only with M_DATA
91  * fast-path packets.  Regardless of the entry point, all outbound packets
92  * will end up in DLD_TX(), where they will be delivered to the MAC layer.
93  *
94  * The transmit logic operates in the following way: All packets coming
95  * into DLD will be sent to the MAC layer through DLD_TX(). Flow-control
96  * happens when the MAC layer indicates the packets couldn't be
97  * transmitted due to 1) lack of resources (e.g. running out of
98  * descriptors),  or 2) reaching the allowed bandwidth limit for this
99  * particular flow. The indication comes in the form of a Tx cookie that
100  * identifies the blocked ring. In such case, DLD will place a
101  * dummy message on its write-side STREAMS queue so that the queue is
102  * marked as "full". Any subsequent packets arriving at the driver will
103  * still be sent to the MAC layer where it either gets queued in the Tx
104  * SRS or discarded it if queue limit is exceeded. The write-side STREAMS
105  * queue gets enabled when MAC layer notifies DLD through MAC_NOTE_TX.
106  * When the write service procedure runs, it will remove the dummy
107  * message from the write-side STREAMS queue; in effect this will trigger
108  * backenabling. The sizes of q_hiwat and q_lowat are set to 1 and 0,
109  * respectively, due to the above reasons.
110  *
111  * All non-data operations, both DLPI and ioctls are single threaded on a per
112  * dld_str_t endpoint. This is done using a taskq so that the control operation
113  * has kernel context and can cv_wait for resources. In addition all set type
114  * operations that involve mac level state modification are serialized on a
115  * per mac end point using the perimeter mechanism provided by the mac layer.
116  * This serializes all mac clients trying to modify a single mac end point over
117  * the entire sequence of mac calls made by that client as an atomic unit. The
118  * mac framework locking is described in mac.c. A critical element is that
119  * DLD/DLS does not hold any locks across the mac perimeter.
120  *
121  * dld_finddevinfo() returns the dev_info_t * corresponding to a particular
122  * dev_t. It searches str_hashp (a table of dld_str_t's) for streams that
123  * match dev_t. If a stream is found and it is attached, its dev_info_t *
124  * is returned. If the mac handle is non-null, it can be safely accessed
125  * below. The mac handle won't be freed until the mac_unregister which
126  * won't happen until the driver detaches. The DDI framework ensures that
127  * the detach won't happen while a getinfo is in progress.
128  */
129 typedef struct i_dld_str_state_s {
130 	major_t		ds_major;
131 	minor_t		ds_minor;
132 	int		ds_instance;
133 	dev_info_t	*ds_dip;
134 } i_dld_str_state_t;
135 
136 /* ARGSUSED */
137 static uint_t
138 i_dld_str_walker(mod_hash_key_t key, mod_hash_val_t *val, void *arg)
139 {
140 	i_dld_str_state_t	*statep = arg;
141 	dld_str_t		*dsp = (dld_str_t *)val;
142 	mac_handle_t		mh;
143 
144 	if (statep->ds_major != dsp->ds_major)
145 		return (MH_WALK_CONTINUE);
146 
147 	ASSERT(statep->ds_minor != 0);
148 	mh = dsp->ds_mh;
149 
150 	if (statep->ds_minor == dsp->ds_minor) {
151 		/*
152 		 * Clone: a clone minor is unique. we can terminate the
153 		 * walk if we find a matching stream -- even if we fail
154 		 * to obtain the devinfo.
155 		 */
156 		if (mh != NULL) {
157 			statep->ds_dip = mac_devinfo_get(mh);
158 			statep->ds_instance = DLS_MINOR2INST(mac_minor(mh));
159 		}
160 		return (MH_WALK_TERMINATE);
161 	}
162 	return (MH_WALK_CONTINUE);
163 }
164 
165 static dev_info_t *
166 dld_finddevinfo(dev_t dev)
167 {
168 	dev_info_t		*dip;
169 	i_dld_str_state_t	state;
170 
171 	if (getminor(dev) == 0)
172 		return (NULL);
173 
174 	/*
175 	 * See if it's a minor node of a link
176 	 */
177 	if ((dip = dls_link_devinfo(dev)) != NULL)
178 		return (dip);
179 
180 	state.ds_minor = getminor(dev);
181 	state.ds_major = getmajor(dev);
182 	state.ds_dip = NULL;
183 	state.ds_instance = -1;
184 
185 	mod_hash_walk(str_hashp, i_dld_str_walker, &state);
186 	return (state.ds_dip);
187 }
188 
189 int
190 dld_devt_to_instance(dev_t dev)
191 {
192 	minor_t			minor;
193 	i_dld_str_state_t	state;
194 
195 	/*
196 	 * GLDv3 numbers DLPI style 1 node as the instance number + 1.
197 	 * Minor number 0 is reserved for the DLPI style 2 unattached
198 	 * node.
199 	 */
200 
201 	if ((minor = getminor(dev)) == 0)
202 		return (-1);
203 
204 	/*
205 	 * Check for unopened style 1 node.
206 	 * Note that this doesn't *necessarily* work for legacy
207 	 * devices, but this code is only called within the
208 	 * getinfo(9e) implementation for true GLDv3 devices, so it
209 	 * doesn't matter.
210 	 */
211 	if (minor > 0 && minor <= DLS_MAX_MINOR) {
212 		return (DLS_MINOR2INST(minor));
213 	}
214 
215 	state.ds_minor = getminor(dev);
216 	state.ds_major = getmajor(dev);
217 	state.ds_dip = NULL;
218 	state.ds_instance = -1;
219 
220 	mod_hash_walk(str_hashp, i_dld_str_walker, &state);
221 	return (state.ds_instance);
222 }
223 
224 /*
225  * devo_getinfo: getinfo(9e)
226  *
227  * NB: This may be called for a provider before the provider's
228  * instances are attached.  Hence, if a particular provider needs a
229  * special mapping (the mac instance != ddi_get_instance()), then it
230  * may need to provide its own implmentation using the
231  * mac_devt_to_instance() function, and translating the returned mac
232  * instance to a devinfo instance.  For dev_t's where the minor number
233  * is too large (i.e. > MAC_MAX_MINOR), the provider can call this
234  * function indirectly via the mac_getinfo() function.
235  */
236 /*ARGSUSED*/
237 int
238 dld_getinfo(dev_info_t *dip, ddi_info_cmd_t cmd, void *arg, void **resp)
239 {
240 	dev_info_t	*devinfo;
241 	minor_t		minor = getminor((dev_t)arg);
242 	int		rc = DDI_FAILURE;
243 
244 	switch (cmd) {
245 	case DDI_INFO_DEVT2DEVINFO:
246 		if ((devinfo = dld_finddevinfo((dev_t)arg)) != NULL) {
247 			*(dev_info_t **)resp = devinfo;
248 			rc = DDI_SUCCESS;
249 		}
250 		break;
251 	case DDI_INFO_DEVT2INSTANCE:
252 		if (minor > 0 && minor <= DLS_MAX_MINOR) {
253 			*resp = (void *)(uintptr_t)DLS_MINOR2INST(minor);
254 			rc = DDI_SUCCESS;
255 		} else if (minor > DLS_MAX_MINOR &&
256 		    (devinfo = dld_finddevinfo((dev_t)arg)) != NULL) {
257 			*resp = (void *)(uintptr_t)ddi_get_instance(devinfo);
258 			rc = DDI_SUCCESS;
259 		}
260 		break;
261 	}
262 	return (rc);
263 }
264 
265 void *
266 dld_str_private(queue_t *q)
267 {
268 	return (((dld_str_t *)(q->q_ptr))->ds_private);
269 }
270 
271 int
272 dld_str_open(queue_t *rq, dev_t *devp, void *private)
273 {
274 	dld_str_t	*dsp;
275 	major_t		major;
276 	minor_t		minor;
277 	int		err;
278 
279 	major = getmajor(*devp);
280 	minor = getminor(*devp);
281 
282 	/*
283 	 * Create a new dld_str_t for the stream. This will grab a new minor
284 	 * number that will be handed back in the cloned dev_t.  Creation may
285 	 * fail if we can't allocate the dummy mblk used for flow-control.
286 	 */
287 	dsp = dld_str_create(rq, DLD_DLPI, major,
288 	    ((minor == 0) ? DL_STYLE2 : DL_STYLE1));
289 	if (dsp == NULL)
290 		return (ENOSR);
291 
292 	ASSERT(dsp->ds_dlstate == DL_UNATTACHED);
293 	dsp->ds_private = private;
294 	if (minor != 0) {
295 		/*
296 		 * Style 1 open
297 		 */
298 		if ((err = dld_str_attach(dsp, (t_uscalar_t)minor - 1)) != 0)
299 			goto failed;
300 
301 		ASSERT(dsp->ds_dlstate == DL_UNBOUND);
302 	} else {
303 		(void) qassociate(rq, -1);
304 	}
305 
306 	/*
307 	 * Enable the queue srv(9e) routine.
308 	 */
309 	qprocson(rq);
310 
311 	/*
312 	 * Construct a cloned dev_t to hand back.
313 	 */
314 	*devp = makedevice(getmajor(*devp), dsp->ds_minor);
315 	return (0);
316 
317 failed:
318 	dld_str_destroy(dsp);
319 	return (err);
320 }
321 
322 int
323 dld_str_close(queue_t *rq)
324 {
325 	dld_str_t	*dsp = rq->q_ptr;
326 
327 	/*
328 	 * All modules on top have been popped off. So there can't be any
329 	 * threads from the top.
330 	 */
331 	ASSERT(dsp->ds_datathr_cnt == 0);
332 
333 	/*
334 	 * Wait until pending DLPI requests are processed.
335 	 */
336 	mutex_enter(&dsp->ds_lock);
337 	while (dsp->ds_dlpi_pending)
338 		cv_wait(&dsp->ds_dlpi_pending_cv, &dsp->ds_lock);
339 	mutex_exit(&dsp->ds_lock);
340 
341 
342 	/*
343 	 * This stream was open to a provider node. Check to see
344 	 * if it has been cleanly shut down.
345 	 */
346 	if (dsp->ds_dlstate != DL_UNATTACHED) {
347 		/*
348 		 * The stream is either open to a style 1 provider or
349 		 * this is not clean shutdown. Detach from the PPA.
350 		 * (This is still ok even in the style 1 case).
351 		 */
352 		dld_str_detach(dsp);
353 	}
354 
355 	dld_str_destroy(dsp);
356 	return (0);
357 }
358 
359 /*
360  * qi_qopen: open(9e)
361  */
362 /*ARGSUSED*/
363 int
364 dld_open(queue_t *rq, dev_t *devp, int flag, int sflag, cred_t *credp)
365 {
366 	if (sflag == MODOPEN)
367 		return (ENOTSUP);
368 
369 	/*
370 	 * This is a cloning driver and therefore each queue should only
371 	 * ever get opened once.
372 	 */
373 	if (rq->q_ptr != NULL)
374 		return (EBUSY);
375 
376 	return (dld_str_open(rq, devp, NULL));
377 }
378 
379 /*
380  * qi_qclose: close(9e)
381  */
382 /* ARGSUSED */
383 int
384 dld_close(queue_t *rq, int flags __unused, cred_t *credp __unused)
385 {
386 	/*
387 	 * Disable the queue srv(9e) routine.
388 	 */
389 	qprocsoff(rq);
390 
391 	return (dld_str_close(rq));
392 }
393 
394 /*
395  * qi_qputp: put(9e)
396  */
397 void
398 dld_wput(queue_t *wq, mblk_t *mp)
399 {
400 	dld_str_t *dsp = (dld_str_t *)wq->q_ptr;
401 	dld_str_mode_t	mode;
402 
403 	switch (DB_TYPE(mp)) {
404 	case M_DATA:
405 		mutex_enter(&dsp->ds_lock);
406 		mode = dsp->ds_mode;
407 		if ((dsp->ds_dlstate != DL_IDLE) ||
408 		    (mode != DLD_FASTPATH && mode != DLD_RAW)) {
409 			mutex_exit(&dsp->ds_lock);
410 			freemsg(mp);
411 			break;
412 		}
413 
414 		DLD_DATATHR_INC(dsp);
415 		mutex_exit(&dsp->ds_lock);
416 		if (mode == DLD_FASTPATH) {
417 			if (dsp->ds_mip->mi_media == DL_ETHER &&
418 			    (MBLKL(mp) < sizeof (struct ether_header))) {
419 				freemsg(mp);
420 			} else {
421 				(void) str_mdata_fastpath_put(dsp, mp, 0, 0);
422 			}
423 		} else {
424 			str_mdata_raw_put(dsp, mp);
425 		}
426 		DLD_DATATHR_DCR(dsp);
427 		break;
428 	case M_PROTO:
429 	case M_PCPROTO: {
430 		t_uscalar_t	prim;
431 
432 		if (MBLKL(mp) < sizeof (t_uscalar_t))
433 			break;
434 
435 		prim = ((union DL_primitives *)mp->b_rptr)->dl_primitive;
436 
437 		if (prim == DL_UNITDATA_REQ) {
438 			proto_unitdata_req(dsp, mp);
439 		} else {
440 			dld_wput_nondata(dsp, mp);
441 		}
442 		break;
443 	}
444 
445 	case M_IOCTL:
446 		dld_wput_nondata(dsp, mp);
447 		break;
448 
449 	case M_FLUSH:
450 		if (*mp->b_rptr & FLUSHW) {
451 			DLD_CLRQFULL(dsp);
452 			*mp->b_rptr &= ~FLUSHW;
453 		}
454 
455 		if (*mp->b_rptr & FLUSHR) {
456 			qreply(wq, mp);
457 		} else {
458 			freemsg(mp);
459 		}
460 		break;
461 
462 	default:
463 		freemsg(mp);
464 		break;
465 	}
466 }
467 
468 /*
469  * qi_srvp: srv(9e)
470  */
471 void
472 dld_wsrv(queue_t *wq)
473 {
474 	dld_str_t	*dsp = wq->q_ptr;
475 
476 	DLD_CLRQFULL(dsp);
477 }
478 
479 void
480 dld_init_ops(struct dev_ops *ops, const char *name)
481 {
482 	struct streamtab *stream;
483 	struct qinit *rq, *wq;
484 	struct module_info *modinfo;
485 
486 	modinfo = kmem_zalloc(sizeof (struct module_info), KM_SLEEP);
487 	modinfo->mi_idname = kmem_zalloc(FMNAMESZ, KM_SLEEP);
488 	(void) snprintf(modinfo->mi_idname, FMNAMESZ, "%s", name);
489 	modinfo->mi_minpsz = 0;
490 	modinfo->mi_maxpsz = 64*1024;
491 	modinfo->mi_hiwat  = 1;
492 	modinfo->mi_lowat = 0;
493 
494 	rq = kmem_zalloc(sizeof (struct qinit), KM_SLEEP);
495 	rq->qi_qopen = dld_open;
496 	rq->qi_qclose = dld_close;
497 	rq->qi_minfo = modinfo;
498 
499 	wq = kmem_zalloc(sizeof (struct qinit), KM_SLEEP);
500 	wq->qi_putp = (pfi_t)dld_wput;
501 	wq->qi_srvp = (pfi_t)dld_wsrv;
502 	wq->qi_minfo = modinfo;
503 
504 	stream = kmem_zalloc(sizeof (struct streamtab), KM_SLEEP);
505 	stream->st_rdinit = rq;
506 	stream->st_wrinit = wq;
507 	ops->devo_cb_ops->cb_str = stream;
508 
509 	if (ops->devo_getinfo == NULL)
510 		ops->devo_getinfo = &dld_getinfo;
511 }
512 
513 void
514 dld_fini_ops(struct dev_ops *ops)
515 {
516 	struct streamtab *stream;
517 	struct qinit *rq, *wq;
518 	struct module_info *modinfo;
519 
520 	stream = ops->devo_cb_ops->cb_str;
521 	rq = stream->st_rdinit;
522 	wq = stream->st_wrinit;
523 	modinfo = rq->qi_minfo;
524 	ASSERT(wq->qi_minfo == modinfo);
525 
526 	kmem_free(stream, sizeof (struct streamtab));
527 	kmem_free(wq, sizeof (struct qinit));
528 	kmem_free(rq, sizeof (struct qinit));
529 	kmem_free(modinfo->mi_idname, FMNAMESZ);
530 	kmem_free(modinfo, sizeof (struct module_info));
531 }
532 
533 /*
534  * Initialize this module's data structures.
535  */
536 void
537 dld_str_init(void)
538 {
539 	/*
540 	 * Create dld_str_t object cache.
541 	 */
542 	str_cachep = kmem_cache_create("dld_str_cache", sizeof (dld_str_t),
543 	    0, str_constructor, str_destructor, NULL, NULL, NULL, 0);
544 	ASSERT(str_cachep != NULL);
545 
546 	/*
547 	 * Create a hash table for maintaining dld_str_t's.
548 	 * The ds_minor field (the clone minor number) of a dld_str_t
549 	 * is used as a key for this hash table because this number is
550 	 * globally unique (allocated from "dls_minor_arena").
551 	 */
552 	str_hashp = mod_hash_create_idhash("dld_str_hash", STR_HASHSZ,
553 	    mod_hash_null_valdtor);
554 
555 	mutex_init(&dld_taskq_lock, NULL, MUTEX_DRIVER, NULL);
556 	cv_init(&dld_taskq_cv, NULL, CV_DRIVER, NULL);
557 
558 	dld_taskq_quit = B_FALSE;
559 	dld_taskq_done = B_FALSE;
560 	list_create(&dld_taskq_list, sizeof (dld_str_t),
561 	    offsetof(dld_str_t, ds_tqlist));
562 	(void) thread_create(NULL, 0, dld_taskq_dispatch, NULL, 0,
563 	    &p0, TS_RUN, minclsyspri);
564 }
565 
566 /*
567  * Tear down this module's data structures.
568  */
569 int
570 dld_str_fini(void)
571 {
572 	/*
573 	 * Make sure that there are no objects in use.
574 	 */
575 	if (str_count != 0)
576 		return (EBUSY);
577 
578 	/*
579 	 * Ask the dld_taskq thread to quit and wait for it to be done
580 	 */
581 	mutex_enter(&dld_taskq_lock);
582 	dld_taskq_quit = B_TRUE;
583 	cv_signal(&dld_taskq_cv);
584 	while (!dld_taskq_done)
585 		cv_wait(&dld_taskq_cv, &dld_taskq_lock);
586 	mutex_exit(&dld_taskq_lock);
587 	list_destroy(&dld_taskq_list);
588 	/*
589 	 * Destroy object cache.
590 	 */
591 	kmem_cache_destroy(str_cachep);
592 	mod_hash_destroy_idhash(str_hashp);
593 	return (0);
594 }
595 
596 /*
597  * Create a new dld_str_t object.
598  */
599 dld_str_t *
600 dld_str_create(queue_t *rq, uint_t type, major_t major, t_uscalar_t style)
601 {
602 	dld_str_t	*dsp;
603 	int		err;
604 
605 	/*
606 	 * Allocate an object from the cache.
607 	 */
608 	atomic_inc_32(&str_count);
609 	dsp = kmem_cache_alloc(str_cachep, KM_SLEEP);
610 
611 	/*
612 	 * Allocate the dummy mblk for flow-control.
613 	 */
614 	dsp->ds_tx_flow_mp = allocb(1, BPRI_HI);
615 	if (dsp->ds_tx_flow_mp == NULL) {
616 		kmem_cache_free(str_cachep, dsp);
617 		atomic_dec_32(&str_count);
618 		return (NULL);
619 	}
620 	dsp->ds_type = type;
621 	dsp->ds_major = major;
622 	dsp->ds_style = style;
623 
624 	/*
625 	 * Initialize the queue pointers.
626 	 */
627 	ASSERT(RD(rq) == rq);
628 	dsp->ds_rq = rq;
629 	dsp->ds_wq = WR(rq);
630 	rq->q_ptr = WR(rq)->q_ptr = (void *)dsp;
631 
632 	/*
633 	 * We want explicit control over our write-side STREAMS queue
634 	 * where the dummy mblk gets added/removed for flow-control.
635 	 */
636 	noenable(WR(rq));
637 
638 	err = mod_hash_insert(str_hashp, STR_HASH_KEY(dsp->ds_minor),
639 	    (mod_hash_val_t)dsp);
640 	ASSERT(err == 0);
641 	return (dsp);
642 }
643 
644 /*
645  * Destroy a dld_str_t object.
646  */
647 void
648 dld_str_destroy(dld_str_t *dsp)
649 {
650 	queue_t		*rq;
651 	queue_t		*wq;
652 	mod_hash_val_t	val;
653 
654 	/*
655 	 * Clear the queue pointers.
656 	 */
657 	rq = dsp->ds_rq;
658 	wq = dsp->ds_wq;
659 	ASSERT(wq == WR(rq));
660 	rq->q_ptr = wq->q_ptr = NULL;
661 	dsp->ds_rq = dsp->ds_wq = NULL;
662 
663 	ASSERT(dsp->ds_dlstate == DL_UNATTACHED);
664 	ASSERT(dsp->ds_sap == 0);
665 	ASSERT(dsp->ds_mh == NULL);
666 	ASSERT(dsp->ds_mch == NULL);
667 	ASSERT(dsp->ds_promisc == 0);
668 	ASSERT(dsp->ds_mph == NULL);
669 	ASSERT(dsp->ds_mip == NULL);
670 	ASSERT(dsp->ds_mnh == NULL);
671 
672 	ASSERT(dsp->ds_polling == B_FALSE);
673 	ASSERT(dsp->ds_direct == B_FALSE);
674 	ASSERT(dsp->ds_lso == B_FALSE);
675 	ASSERT(dsp->ds_lso_max == 0);
676 	ASSERT(dsp->ds_passivestate != DLD_ACTIVE);
677 
678 	/*
679 	 * Reinitialize all the flags.
680 	 */
681 	dsp->ds_notifications = 0;
682 	dsp->ds_passivestate = DLD_UNINITIALIZED;
683 	dsp->ds_mode = DLD_UNITDATA;
684 	dsp->ds_native = B_FALSE;
685 	dsp->ds_nonip = B_FALSE;
686 
687 	ASSERT(dsp->ds_datathr_cnt == 0);
688 	ASSERT(dsp->ds_pending_head == NULL);
689 	ASSERT(dsp->ds_pending_tail == NULL);
690 	ASSERT(!dsp->ds_dlpi_pending);
691 
692 	ASSERT(dsp->ds_dlp == NULL);
693 	ASSERT(dsp->ds_dmap == NULL);
694 	ASSERT(dsp->ds_rx == NULL);
695 	ASSERT(dsp->ds_rx_arg == NULL);
696 	ASSERT(dsp->ds_next == NULL);
697 	ASSERT(dsp->ds_head == NULL);
698 
699 	/*
700 	 * Free the dummy mblk if exists.
701 	 */
702 	if (dsp->ds_tx_flow_mp != NULL) {
703 		freeb(dsp->ds_tx_flow_mp);
704 		dsp->ds_tx_flow_mp = NULL;
705 	}
706 
707 	(void) mod_hash_remove(str_hashp, STR_HASH_KEY(dsp->ds_minor), &val);
708 	ASSERT(dsp == (dld_str_t *)val);
709 
710 	/*
711 	 * Free the object back to the cache.
712 	 */
713 	kmem_cache_free(str_cachep, dsp);
714 	atomic_dec_32(&str_count);
715 }
716 
717 /*
718  * kmem_cache contructor function: see kmem_cache_create(9f).
719  */
720 /*ARGSUSED*/
721 static int
722 str_constructor(void *buf, void *cdrarg, int kmflags)
723 {
724 	dld_str_t	*dsp = buf;
725 
726 	bzero(buf, sizeof (dld_str_t));
727 
728 	/*
729 	 * Allocate a new minor number.
730 	 */
731 	if ((dsp->ds_minor = mac_minor_hold(kmflags == KM_SLEEP)) == 0)
732 		return (-1);
733 
734 	/*
735 	 * Initialize the DLPI state machine.
736 	 */
737 	dsp->ds_dlstate = DL_UNATTACHED;
738 
739 	mutex_init(&dsp->ds_lock, NULL, MUTEX_DRIVER, NULL);
740 	cv_init(&dsp->ds_datathr_cv, NULL, CV_DRIVER, NULL);
741 	cv_init(&dsp->ds_dlpi_pending_cv, NULL, CV_DRIVER, NULL);
742 
743 	return (0);
744 }
745 
746 /*
747  * kmem_cache destructor function.
748  */
749 /*ARGSUSED*/
750 static void
751 str_destructor(void *buf, void *cdrarg)
752 {
753 	dld_str_t	*dsp = buf;
754 
755 	/*
756 	 * Release the minor number.
757 	 */
758 	mac_minor_rele(dsp->ds_minor);
759 
760 	ASSERT(dsp->ds_tx_flow_mp == NULL);
761 
762 	mutex_destroy(&dsp->ds_lock);
763 	cv_destroy(&dsp->ds_datathr_cv);
764 	cv_destroy(&dsp->ds_dlpi_pending_cv);
765 }
766 
767 /*
768  * Update the priority bits and VID (may need to insert tag if mp points
769  * to an untagged packet.
770  * If vid is VLAN_ID_NONE, use the VID encoded in the packet.
771  */
772 static mblk_t *
773 i_dld_ether_header_update_tag(mblk_t *mp, uint_t pri, uint16_t vid,
774     link_tagmode_t tagmode)
775 {
776 	mblk_t *hmp;
777 	struct ether_vlan_header *evhp;
778 	struct ether_header *ehp;
779 	uint16_t old_tci = 0;
780 	size_t len;
781 
782 	ASSERT(pri != 0 || vid != VLAN_ID_NONE);
783 
784 	evhp = (struct ether_vlan_header *)mp->b_rptr;
785 	if (ntohs(evhp->ether_tpid) == ETHERTYPE_VLAN) {
786 		/*
787 		 * Tagged packet, update the priority bits.
788 		 */
789 		len = sizeof (struct ether_vlan_header);
790 
791 		if ((DB_REF(mp) > 1) || (MBLKL(mp) < len)) {
792 			/*
793 			 * In case some drivers only check the db_ref
794 			 * count of the first mblk, we pullup the
795 			 * message into a single mblk.
796 			 */
797 			hmp = msgpullup(mp, -1);
798 			if ((hmp == NULL) || (MBLKL(hmp) < len)) {
799 				freemsg(hmp);
800 				return (NULL);
801 			} else {
802 				freemsg(mp);
803 				mp = hmp;
804 			}
805 		}
806 
807 		evhp = (struct ether_vlan_header *)mp->b_rptr;
808 		old_tci = ntohs(evhp->ether_tci);
809 	} else {
810 		/*
811 		 * Untagged packet.  Two factors will cause us to insert a
812 		 * VLAN header:
813 		 * - This is a VLAN link (vid is specified)
814 		 * - The link supports user priority tagging and the priority
815 		 *   is non-zero.
816 		 */
817 		if (vid == VLAN_ID_NONE && tagmode == LINK_TAGMODE_VLANONLY)
818 			return (mp);
819 
820 		hmp = allocb(sizeof (struct ether_vlan_header), BPRI_MED);
821 		if (hmp == NULL)
822 			return (NULL);
823 
824 		evhp = (struct ether_vlan_header *)hmp->b_rptr;
825 		ehp = (struct ether_header *)mp->b_rptr;
826 
827 		/*
828 		 * Copy the MAC addresses and typelen
829 		 */
830 		bcopy(ehp, evhp, (ETHERADDRL * 2));
831 		evhp->ether_type = ehp->ether_type;
832 		evhp->ether_tpid = htons(ETHERTYPE_VLAN);
833 
834 		hmp->b_wptr += sizeof (struct ether_vlan_header);
835 		mp->b_rptr += sizeof (struct ether_header);
836 
837 		/*
838 		 * Free the original message if it's now empty. Link the
839 		 * rest of the messages to the header message.
840 		 */
841 		if (MBLKL(mp) == 0) {
842 			hmp->b_cont = mp->b_cont;
843 			freeb(mp);
844 		} else {
845 			hmp->b_cont = mp;
846 		}
847 		mp = hmp;
848 	}
849 
850 	if (pri == 0)
851 		pri = VLAN_PRI(old_tci);
852 	if (vid == VLAN_ID_NONE)
853 		vid = VLAN_ID(old_tci);
854 	evhp->ether_tci = htons(VLAN_TCI(pri, VLAN_CFI(old_tci), vid));
855 	return (mp);
856 }
857 
858 /*
859  * M_DATA put (IP fast-path mode)
860  */
861 mac_tx_cookie_t
862 str_mdata_fastpath_put(dld_str_t *dsp, mblk_t *mp, uintptr_t f_hint,
863     uint16_t flag)
864 {
865 	boolean_t is_ethernet = (dsp->ds_mip->mi_media == DL_ETHER);
866 	mblk_t *newmp;
867 	uint_t pri;
868 	mac_tx_cookie_t cookie;
869 
870 	if (is_ethernet) {
871 		/*
872 		 * Update the priority bits to the assigned priority.
873 		 */
874 		pri = (VLAN_MBLKPRI(mp) == 0) ? dsp->ds_pri : VLAN_MBLKPRI(mp);
875 
876 		if (pri != 0) {
877 			newmp = i_dld_ether_header_update_tag(mp, pri,
878 			    VLAN_ID_NONE, dsp->ds_dlp->dl_tagmode);
879 			if (newmp == NULL)
880 				goto discard;
881 			mp = newmp;
882 		}
883 	}
884 
885 	if ((cookie = DLD_TX(dsp, mp, f_hint, flag)) != NULL) {
886 		DLD_SETQFULL(dsp);
887 	}
888 	return (cookie);
889 
890 discard:
891 	/* TODO: bump kstat? */
892 	freemsg(mp);
893 	return (NULL);
894 }
895 
896 /*
897  * M_DATA put (DLIOCRAW mode)
898  */
899 static void
900 str_mdata_raw_put(dld_str_t *dsp, mblk_t *mp)
901 {
902 	boolean_t is_ethernet = (dsp->ds_mip->mi_media == DL_ETHER);
903 	mblk_t *bp, *newmp;
904 	size_t size;
905 	mac_header_info_t mhi;
906 	uint_t pri, vid, dvid;
907 	uint_t max_sdu;
908 
909 	/*
910 	 * Certain MAC type plugins provide an illusion for raw DLPI
911 	 * consumers.  They pretend that the MAC layer is something that
912 	 * it's not for the benefit of observability tools.  For example,
913 	 * mac_wifi pretends that it's Ethernet for such consumers.
914 	 * Here, unless native mode is enabled, we call into the MAC layer so
915 	 * that this illusion can be maintained.  The plugin will optionally
916 	 * transform the MAC header here into something that can be passed
917 	 * down.  The header goes from raw mode to "cooked" mode.
918 	 */
919 	if (!dsp->ds_native) {
920 		if ((newmp = mac_header_cook(dsp->ds_mh, mp)) == NULL)
921 			goto discard;
922 		mp = newmp;
923 	}
924 
925 	size = MBLKL(mp);
926 
927 	/*
928 	 * Check the packet is not too big and that any remaining
929 	 * fragment list is composed entirely of M_DATA messages. (We
930 	 * know the first fragment was M_DATA otherwise we could not
931 	 * have got here).
932 	 */
933 	for (bp = mp->b_cont; bp != NULL; bp = bp->b_cont) {
934 		if (DB_TYPE(bp) != M_DATA)
935 			goto discard;
936 		size += MBLKL(bp);
937 	}
938 
939 	if (mac_vlan_header_info(dsp->ds_mh, mp, &mhi) != 0)
940 		goto discard;
941 
942 	mac_sdu_get(dsp->ds_mh, NULL, &max_sdu);
943 	/*
944 	 * If LSO is enabled, check the size against lso_max. Otherwise,
945 	 * compare the packet size with max_sdu.
946 	 */
947 	max_sdu = dsp->ds_lso ? dsp->ds_lso_max : max_sdu;
948 	if (size > max_sdu + mhi.mhi_hdrsize)
949 		goto discard;
950 
951 	if (is_ethernet) {
952 		dvid = mac_client_vid(dsp->ds_mch);
953 
954 		/*
955 		 * Discard the packet if this is a VLAN stream but the VID in
956 		 * the packet is not correct.
957 		 */
958 		vid = VLAN_ID(mhi.mhi_tci);
959 		if ((dvid != VLAN_ID_NONE) && (vid != VLAN_ID_NONE))
960 			goto discard;
961 
962 		/*
963 		 * Discard the packet if this packet is a tagged packet
964 		 * but both pri and VID are 0.
965 		 */
966 		pri = VLAN_PRI(mhi.mhi_tci);
967 		if (mhi.mhi_istagged && !mhi.mhi_ispvid && pri == 0 &&
968 		    vid == VLAN_ID_NONE)
969 			goto discard;
970 
971 		/*
972 		 * Update the priority bits to the per-stream priority if
973 		 * priority is not set in the packet. Update the VID for
974 		 * packets on a VLAN stream.
975 		 */
976 		pri = (pri == 0) ? dsp->ds_pri : 0;
977 		if ((pri != 0) || (dvid != VLAN_ID_NONE)) {
978 			if ((newmp = i_dld_ether_header_update_tag(mp, pri,
979 			    dvid, dsp->ds_dlp->dl_tagmode)) == NULL) {
980 				goto discard;
981 			}
982 			mp = newmp;
983 		}
984 	}
985 
986 	if (DLD_TX(dsp, mp, 0, 0) != NULL) {
987 		/* Turn on flow-control for dld */
988 		DLD_SETQFULL(dsp);
989 	}
990 	return;
991 
992 discard:
993 	/* TODO: bump kstat? */
994 	freemsg(mp);
995 }
996 
997 /*
998  * Process DL_ATTACH_REQ (style 2) or open(2) (style 1).
999  */
1000 int
1001 dld_str_attach(dld_str_t *dsp, t_uscalar_t ppa)
1002 {
1003 	dev_t			dev;
1004 	int			err;
1005 	const char		*drvname;
1006 	mac_perim_handle_t	mph = NULL;
1007 	boolean_t		qassociated = B_FALSE;
1008 	dls_link_t		*dlp = NULL;
1009 	dls_dl_handle_t		ddp = NULL;
1010 
1011 	if ((drvname = ddi_major_to_name(dsp->ds_major)) == NULL)
1012 		return (EINVAL);
1013 
1014 	if (dsp->ds_style == DL_STYLE2 && ppa > DLS_MAX_PPA)
1015 		return (ENOTSUP);
1016 
1017 	/*
1018 	 * /dev node access. This will still be supported for backward
1019 	 * compatibility reason.
1020 	 */
1021 	if ((dsp->ds_style == DL_STYLE2) && (strcmp(drvname, "aggr") != 0) &&
1022 	    (strcmp(drvname, "vnic") != 0)) {
1023 		if (qassociate(dsp->ds_wq, DLS_PPA2INST(ppa)) != 0)
1024 			return (EINVAL);
1025 		qassociated = B_TRUE;
1026 	}
1027 
1028 	dev = makedevice(dsp->ds_major, (minor_t)ppa + 1);
1029 	if ((err = dls_devnet_hold_by_dev(dev, &ddp)) != 0)
1030 		goto failed;
1031 
1032 	if ((err = mac_perim_enter_by_macname(dls_devnet_mac(ddp), &mph)) != 0)
1033 		goto failed;
1034 
1035 	/*
1036 	 * Open a channel.
1037 	 */
1038 	if ((err = dls_link_hold(dls_devnet_mac(ddp), &dlp)) != 0)
1039 		goto failed;
1040 
1041 	if ((err = dls_open(dlp, ddp, dsp)) != 0)
1042 		goto failed;
1043 
1044 	/*
1045 	 * Set the default packet priority.
1046 	 */
1047 	dsp->ds_pri = 0;
1048 
1049 	/*
1050 	 * Add a notify function so that the we get updates from the MAC.
1051 	 */
1052 	dsp->ds_mnh = mac_notify_add(dsp->ds_mh, str_notify, dsp);
1053 	dsp->ds_dlstate = DL_UNBOUND;
1054 	mac_perim_exit(mph);
1055 	return (0);
1056 
1057 failed:
1058 	if (dlp != NULL)
1059 		dls_link_rele(dlp);
1060 	if (mph != NULL)
1061 		mac_perim_exit(mph);
1062 	if (ddp != NULL)
1063 		dls_devnet_rele(ddp);
1064 	if (qassociated)
1065 		(void) qassociate(dsp->ds_wq, -1);
1066 
1067 	return (err);
1068 }
1069 
1070 /*
1071  * Process DL_DETACH_REQ (style 2) or close(2) (style 1). Can also be called
1072  * from close(2) for style 2.
1073  */
1074 void
1075 dld_str_detach(dld_str_t *dsp)
1076 {
1077 	mac_perim_handle_t	mph;
1078 	int			err;
1079 
1080 	ASSERT(dsp->ds_datathr_cnt == 0);
1081 
1082 	mac_perim_enter_by_mh(dsp->ds_mh, &mph);
1083 	/*
1084 	 * Remove the notify function.
1085 	 *
1086 	 * Note that we cannot wait for the notification callback to be removed
1087 	 * since it could cause the deadlock with str_notify() since they both
1088 	 * need the mac perimeter. Continue if we cannot remove the
1089 	 * notification callback right now and wait after we leave the
1090 	 * perimeter.
1091 	 */
1092 	err = mac_notify_remove(dsp->ds_mnh, B_FALSE);
1093 	dsp->ds_mnh = NULL;
1094 
1095 	/*
1096 	 * Disable the capabilities
1097 	 */
1098 	dld_capabilities_disable(dsp);
1099 
1100 	/*
1101 	 * Clear LSO flags.
1102 	 */
1103 	dsp->ds_lso = B_FALSE;
1104 	dsp->ds_lso_max = 0;
1105 
1106 	dls_close(dsp);
1107 	mac_perim_exit(mph);
1108 
1109 	/*
1110 	 * Now we leave the mac perimeter. If mac_notify_remove() failed
1111 	 * because the notification callback was in progress, wait for
1112 	 * it to finish before we proceed.
1113 	 */
1114 	if (err != 0)
1115 		mac_notify_remove_wait(dsp->ds_mh);
1116 
1117 	/*
1118 	 * An unreferenced tagged (non-persistent) vlan gets destroyed
1119 	 * automatically in the call to dls_devnet_rele.
1120 	 */
1121 	dls_devnet_rele(dsp->ds_ddh);
1122 
1123 	dsp->ds_sap = 0;
1124 	dsp->ds_mh = NULL;
1125 	dsp->ds_mch = NULL;
1126 	dsp->ds_mip = NULL;
1127 
1128 	if (dsp->ds_style == DL_STYLE2)
1129 		(void) qassociate(dsp->ds_wq, -1);
1130 
1131 	/*
1132 	 * Re-initialize the DLPI state machine.
1133 	 */
1134 	dsp->ds_dlstate = DL_UNATTACHED;
1135 }
1136 
1137 /*
1138  * This function is only called for VLAN streams. In raw mode, we strip VLAN
1139  * tags before sending packets up to the DLS clients, with the exception of
1140  * special priority tagged packets, in that case, we set the VID to 0.
1141  * mp must be a VLAN tagged packet.
1142  */
1143 static mblk_t *
1144 i_dld_ether_header_strip_tag(mblk_t *mp, boolean_t keep_pri)
1145 {
1146 	mblk_t *newmp;
1147 	struct ether_vlan_header *evhp;
1148 	uint16_t tci, new_tci;
1149 
1150 	ASSERT(MBLKL(mp) >= sizeof (struct ether_vlan_header));
1151 	if (DB_REF(mp) > 1) {
1152 		newmp = copymsg(mp);
1153 		if (newmp == NULL)
1154 			return (NULL);
1155 		freemsg(mp);
1156 		mp = newmp;
1157 	}
1158 	evhp = (struct ether_vlan_header *)mp->b_rptr;
1159 
1160 	tci = ntohs(evhp->ether_tci);
1161 	if (VLAN_PRI(tci) == 0 || !keep_pri) {
1162 		/*
1163 		 * Priority is 0, strip the tag.
1164 		 */
1165 		ovbcopy(mp->b_rptr, mp->b_rptr + VLAN_TAGSZ, 2 * ETHERADDRL);
1166 		mp->b_rptr += VLAN_TAGSZ;
1167 	} else {
1168 		/*
1169 		 * Priority is not 0, update the VID to 0.
1170 		 */
1171 		new_tci = VLAN_TCI(VLAN_PRI(tci), VLAN_CFI(tci), VLAN_ID_NONE);
1172 		evhp->ether_tci = htons(new_tci);
1173 	}
1174 	return (mp);
1175 }
1176 
1177 /*
1178  * Raw mode receive function.
1179  */
1180 /*ARGSUSED*/
1181 void
1182 dld_str_rx_raw(void *arg, mac_resource_handle_t mrh, mblk_t *mp,
1183     mac_header_info_t *mhip)
1184 {
1185 	dld_str_t *dsp = (dld_str_t *)arg;
1186 	boolean_t is_ethernet = (dsp->ds_mip->mi_media == DL_ETHER);
1187 	mblk_t *next, *newmp;
1188 
1189 	ASSERT(mp != NULL);
1190 	do {
1191 		/*
1192 		 * Get the pointer to the next packet in the chain and then
1193 		 * clear b_next before the packet gets passed on.
1194 		 */
1195 		next = mp->b_next;
1196 		mp->b_next = NULL;
1197 
1198 		/*
1199 		 * Wind back b_rptr to point at the MAC header.
1200 		 */
1201 		ASSERT(mp->b_rptr >= DB_BASE(mp) + mhip->mhi_hdrsize);
1202 		mp->b_rptr -= mhip->mhi_hdrsize;
1203 
1204 		/*
1205 		 * Certain MAC type plugins provide an illusion for raw
1206 		 * DLPI consumers.  They pretend that the MAC layer is
1207 		 * something that it's not for the benefit of observability
1208 		 * tools.  For example, mac_wifi pretends that it's Ethernet
1209 		 * for such consumers.	Here, unless native mode is enabled,
1210 		 * we call into the MAC layer so that this illusion can be
1211 		 * maintained.	The plugin will optionally transform the MAC
1212 		 * header here into something that can be passed up to raw
1213 		 * consumers.  The header goes from "cooked" mode to raw mode.
1214 		 */
1215 		if (!dsp->ds_native) {
1216 			newmp = mac_header_uncook(dsp->ds_mh, mp);
1217 			if (newmp == NULL) {
1218 				freemsg(mp);
1219 				goto next;
1220 			}
1221 			mp = newmp;
1222 		}
1223 
1224 		/*
1225 		 * Strip the VLAN tag for VLAN streams.
1226 		 */
1227 		if (is_ethernet &&
1228 		    mac_client_vid(dsp->ds_mch) != VLAN_ID_NONE) {
1229 			/*
1230 			 * The priority should be kept only for VLAN
1231 			 * data-links.
1232 			 */
1233 			newmp = i_dld_ether_header_strip_tag(mp,
1234 			    mac_client_is_vlan_vnic(dsp->ds_mch));
1235 			if (newmp == NULL) {
1236 				freemsg(mp);
1237 				goto next;
1238 			}
1239 			mp = newmp;
1240 		}
1241 
1242 		/*
1243 		 * Pass the packet on.
1244 		 */
1245 		if (canputnext(dsp->ds_rq))
1246 			putnext(dsp->ds_rq, mp);
1247 		else
1248 			freemsg(mp);
1249 
1250 next:
1251 		/*
1252 		 * Move on to the next packet in the chain.
1253 		 */
1254 		mp = next;
1255 	} while (mp != NULL);
1256 }
1257 
1258 /*
1259  * Fast-path receive function.
1260  */
1261 /*ARGSUSED*/
1262 void
1263 dld_str_rx_fastpath(void *arg, mac_resource_handle_t mrh, mblk_t *mp,
1264     mac_header_info_t *mhip)
1265 {
1266 	dld_str_t *dsp = (dld_str_t *)arg;
1267 	mblk_t *next;
1268 	size_t offset = 0;
1269 
1270 	/*
1271 	 * MAC header stripping rules:
1272 	 *    - Tagged packets:
1273 	 *	a. VLAN streams. Strip the whole VLAN header including the tag.
1274 	 *	b. Physical streams
1275 	 *	- VLAN packets (non-zero VID). The stream must be either a
1276 	 *	  DL_PROMISC_SAP listener or a ETHERTYPE_VLAN listener.
1277 	 *	  Strip the Ethernet header but keep the VLAN header.
1278 	 *	- Special tagged packets (zero VID)
1279 	 *	  * The stream is either a DL_PROMISC_SAP listener or a
1280 	 *	    ETHERTYPE_VLAN listener, strip the Ethernet header but
1281 	 *	    keep the VLAN header.
1282 	 *	  * Otherwise, strip the whole VLAN header.
1283 	 *    - Untagged packets. Strip the whole MAC header.
1284 	 */
1285 	if (mhip->mhi_istagged &&
1286 	    (mac_client_vid(dsp->ds_mch) == VLAN_ID_NONE) &&
1287 	    ((dsp->ds_sap == ETHERTYPE_VLAN) ||
1288 	    (dsp->ds_promisc & DLS_PROMISC_SAP))) {
1289 		offset = VLAN_TAGSZ;
1290 	}
1291 
1292 	ASSERT(mp != NULL);
1293 	do {
1294 		/*
1295 		 * Get the pointer to the next packet in the chain and then
1296 		 * clear b_next before the packet gets passed on.
1297 		 */
1298 		next = mp->b_next;
1299 		mp->b_next = NULL;
1300 
1301 		/*
1302 		 * Wind back b_rptr to point at the VLAN header.
1303 		 */
1304 		ASSERT(mp->b_rptr >= DB_BASE(mp) + offset);
1305 		mp->b_rptr -= offset;
1306 
1307 		/*
1308 		 * Pass the packet on.
1309 		 */
1310 		if (canputnext(dsp->ds_rq))
1311 			putnext(dsp->ds_rq, mp);
1312 		else
1313 			freemsg(mp);
1314 		/*
1315 		 * Move on to the next packet in the chain.
1316 		 */
1317 		mp = next;
1318 	} while (mp != NULL);
1319 }
1320 
1321 /*
1322  * Default receive function (send DL_UNITDATA_IND messages).
1323  */
1324 /*ARGSUSED*/
1325 void
1326 dld_str_rx_unitdata(void *arg, mac_resource_handle_t mrh, mblk_t *mp,
1327     mac_header_info_t *mhip)
1328 {
1329 	dld_str_t		*dsp = (dld_str_t *)arg;
1330 	mblk_t			*ud_mp;
1331 	mblk_t			*next;
1332 	size_t			offset = 0;
1333 	boolean_t		strip_vlan = B_TRUE;
1334 
1335 	/*
1336 	 * See MAC header stripping rules in the dld_str_rx_fastpath() function.
1337 	 */
1338 	if (mhip->mhi_istagged &&
1339 	    (mac_client_vid(dsp->ds_mch) == VLAN_ID_NONE) &&
1340 	    ((dsp->ds_sap == ETHERTYPE_VLAN) ||
1341 	    (dsp->ds_promisc & DLS_PROMISC_SAP))) {
1342 		offset = VLAN_TAGSZ;
1343 		strip_vlan = B_FALSE;
1344 	}
1345 
1346 	ASSERT(mp != NULL);
1347 	do {
1348 		/*
1349 		 * Get the pointer to the next packet in the chain and then
1350 		 * clear b_next before the packet gets passed on.
1351 		 */
1352 		next = mp->b_next;
1353 		mp->b_next = NULL;
1354 
1355 		/*
1356 		 * Wind back b_rptr to point at the MAC header.
1357 		 */
1358 		ASSERT(mp->b_rptr >= DB_BASE(mp) + mhip->mhi_hdrsize);
1359 		mp->b_rptr -= mhip->mhi_hdrsize;
1360 
1361 		/*
1362 		 * Create the DL_UNITDATA_IND M_PROTO.
1363 		 */
1364 		if ((ud_mp = str_unitdata_ind(dsp, mp, strip_vlan)) == NULL) {
1365 			freemsgchain(mp);
1366 			return;
1367 		}
1368 
1369 		/*
1370 		 * Advance b_rptr to point at the payload (or the VLAN header).
1371 		 */
1372 		mp->b_rptr += (mhip->mhi_hdrsize - offset);
1373 
1374 		/*
1375 		 * Prepend the DL_UNITDATA_IND.
1376 		 */
1377 		ud_mp->b_cont = mp;
1378 
1379 		/*
1380 		 * Send the message.
1381 		 */
1382 		if (canputnext(dsp->ds_rq))
1383 			putnext(dsp->ds_rq, ud_mp);
1384 		else
1385 			freemsg(ud_mp);
1386 
1387 		/*
1388 		 * Move on to the next packet in the chain.
1389 		 */
1390 		mp = next;
1391 	} while (mp != NULL);
1392 }
1393 
1394 /*
1395  * DL_NOTIFY_IND: DL_NOTE_SDU_SIZE
1396  */
1397 static void
1398 str_notify_sdu_size(dld_str_t *dsp, uint_t max_sdu, uint_t multicast_sdu)
1399 {
1400 	mblk_t		*mp;
1401 	dl_notify_ind_t *dlip;
1402 
1403 	if (!(dsp->ds_notifications & (DL_NOTE_SDU_SIZE|DL_NOTE_SDU_SIZE2)))
1404 		return;
1405 
1406 	if ((mp = mexchange(dsp->ds_wq, NULL, sizeof (dl_notify_ind_t),
1407 	    M_PROTO, 0)) == NULL)
1408 		return;
1409 
1410 	bzero(mp->b_rptr, sizeof (dl_notify_ind_t));
1411 	dlip = (dl_notify_ind_t *)mp->b_rptr;
1412 	dlip->dl_primitive = DL_NOTIFY_IND;
1413 	if (dsp->ds_notifications & DL_NOTE_SDU_SIZE2) {
1414 		dlip->dl_notification = DL_NOTE_SDU_SIZE2;
1415 		dlip->dl_data1 = max_sdu;
1416 		dlip->dl_data2 = multicast_sdu;
1417 	} else {
1418 		dlip->dl_notification = DL_NOTE_SDU_SIZE;
1419 		dlip->dl_data = max_sdu;
1420 	}
1421 
1422 	qreply(dsp->ds_wq, mp);
1423 }
1424 
1425 /*
1426  * Generate DL_NOTIFY_IND messages to notify the DLPI consumer of the
1427  * current state of the interface.
1428  */
1429 void
1430 dld_str_notify_ind(dld_str_t *dsp)
1431 {
1432 	mac_notify_type_t	type;
1433 
1434 	for (type = 0; type < MAC_NNOTE; type++)
1435 		str_notify(dsp, type);
1436 }
1437 
1438 typedef struct dl_unitdata_ind_wrapper {
1439 	dl_unitdata_ind_t	dl_unitdata;
1440 	uint8_t			dl_dest_addr[MAXMACADDRLEN + sizeof (uint16_t)];
1441 	uint8_t			dl_src_addr[MAXMACADDRLEN + sizeof (uint16_t)];
1442 } dl_unitdata_ind_wrapper_t;
1443 
1444 /*
1445  * Create a DL_UNITDATA_IND M_PROTO message.
1446  */
1447 static mblk_t *
1448 str_unitdata_ind(dld_str_t *dsp, mblk_t *mp, boolean_t strip_vlan)
1449 {
1450 	mblk_t				*nmp;
1451 	dl_unitdata_ind_wrapper_t	*dlwp;
1452 	dl_unitdata_ind_t		*dlp;
1453 	mac_header_info_t		mhi;
1454 	uint_t				addr_length;
1455 	uint8_t				*daddr;
1456 	uint8_t				*saddr;
1457 
1458 	/*
1459 	 * Get the packet header information.
1460 	 */
1461 	if (mac_vlan_header_info(dsp->ds_mh, mp, &mhi) != 0)
1462 		return (NULL);
1463 
1464 	/*
1465 	 * Allocate a message large enough to contain the wrapper structure
1466 	 * defined above.
1467 	 */
1468 	if ((nmp = mexchange(dsp->ds_wq, NULL,
1469 	    sizeof (dl_unitdata_ind_wrapper_t), M_PROTO,
1470 	    DL_UNITDATA_IND)) == NULL)
1471 		return (NULL);
1472 
1473 	dlwp = (dl_unitdata_ind_wrapper_t *)nmp->b_rptr;
1474 
1475 	dlp = &(dlwp->dl_unitdata);
1476 	ASSERT(dlp == (dl_unitdata_ind_t *)nmp->b_rptr);
1477 	ASSERT(dlp->dl_primitive == DL_UNITDATA_IND);
1478 
1479 	/*
1480 	 * Copy in the destination address.
1481 	 */
1482 	addr_length = dsp->ds_mip->mi_addr_length;
1483 	daddr = dlwp->dl_dest_addr;
1484 	dlp->dl_dest_addr_offset = (uintptr_t)daddr - (uintptr_t)dlp;
1485 	bcopy(mhi.mhi_daddr, daddr, addr_length);
1486 
1487 	/*
1488 	 * Set the destination DLSAP to the SAP value encoded in the packet.
1489 	 */
1490 	if (mhi.mhi_istagged && !strip_vlan)
1491 		*(uint16_t *)(daddr + addr_length) = ETHERTYPE_VLAN;
1492 	else
1493 		*(uint16_t *)(daddr + addr_length) = mhi.mhi_bindsap;
1494 	dlp->dl_dest_addr_length = addr_length + sizeof (uint16_t);
1495 
1496 	/*
1497 	 * If the destination address was multicast or broadcast then the
1498 	 * dl_group_address field should be non-zero.
1499 	 */
1500 	dlp->dl_group_address = (mhi.mhi_dsttype == MAC_ADDRTYPE_MULTICAST) ||
1501 	    (mhi.mhi_dsttype == MAC_ADDRTYPE_BROADCAST);
1502 
1503 	/*
1504 	 * Copy in the source address if one exists.  Some MAC types (DL_IB
1505 	 * for example) may not have access to source information.
1506 	 */
1507 	if (mhi.mhi_saddr == NULL) {
1508 		dlp->dl_src_addr_offset = dlp->dl_src_addr_length = 0;
1509 	} else {
1510 		saddr = dlwp->dl_src_addr;
1511 		dlp->dl_src_addr_offset = (uintptr_t)saddr - (uintptr_t)dlp;
1512 		bcopy(mhi.mhi_saddr, saddr, addr_length);
1513 
1514 		/*
1515 		 * Set the source DLSAP to the packet ethertype.
1516 		 */
1517 		*(uint16_t *)(saddr + addr_length) = mhi.mhi_origsap;
1518 		dlp->dl_src_addr_length = addr_length + sizeof (uint16_t);
1519 	}
1520 
1521 	return (nmp);
1522 }
1523 
1524 /*
1525  * DL_NOTIFY_IND: DL_NOTE_PROMISC_ON_PHYS
1526  */
1527 static void
1528 str_notify_promisc_on_phys(dld_str_t *dsp)
1529 {
1530 	mblk_t		*mp;
1531 	dl_notify_ind_t	*dlip;
1532 
1533 	if (!(dsp->ds_notifications & DL_NOTE_PROMISC_ON_PHYS))
1534 		return;
1535 
1536 	if ((mp = mexchange(dsp->ds_wq, NULL, sizeof (dl_notify_ind_t),
1537 	    M_PROTO, 0)) == NULL)
1538 		return;
1539 
1540 	bzero(mp->b_rptr, sizeof (dl_notify_ind_t));
1541 	dlip = (dl_notify_ind_t *)mp->b_rptr;
1542 	dlip->dl_primitive = DL_NOTIFY_IND;
1543 	dlip->dl_notification = DL_NOTE_PROMISC_ON_PHYS;
1544 
1545 	qreply(dsp->ds_wq, mp);
1546 }
1547 
1548 /*
1549  * DL_NOTIFY_IND: DL_NOTE_PROMISC_OFF_PHYS
1550  */
1551 static void
1552 str_notify_promisc_off_phys(dld_str_t *dsp)
1553 {
1554 	mblk_t		*mp;
1555 	dl_notify_ind_t	*dlip;
1556 
1557 	if (!(dsp->ds_notifications & DL_NOTE_PROMISC_OFF_PHYS))
1558 		return;
1559 
1560 	if ((mp = mexchange(dsp->ds_wq, NULL, sizeof (dl_notify_ind_t),
1561 	    M_PROTO, 0)) == NULL)
1562 		return;
1563 
1564 	bzero(mp->b_rptr, sizeof (dl_notify_ind_t));
1565 	dlip = (dl_notify_ind_t *)mp->b_rptr;
1566 	dlip->dl_primitive = DL_NOTIFY_IND;
1567 	dlip->dl_notification = DL_NOTE_PROMISC_OFF_PHYS;
1568 
1569 	qreply(dsp->ds_wq, mp);
1570 }
1571 
1572 /*
1573  * DL_NOTIFY_IND: DL_NOTE_PHYS_ADDR
1574  */
1575 static void
1576 str_notify_phys_addr(dld_str_t *dsp, uint_t addr_type, const uint8_t *addr)
1577 {
1578 	mblk_t		*mp;
1579 	dl_notify_ind_t	*dlip;
1580 	uint_t		addr_length;
1581 	uint16_t	ethertype;
1582 
1583 	if (!(dsp->ds_notifications & DL_NOTE_PHYS_ADDR))
1584 		return;
1585 
1586 	addr_length = dsp->ds_mip->mi_addr_length;
1587 	if ((mp = mexchange(dsp->ds_wq, NULL,
1588 	    sizeof (dl_notify_ind_t) + addr_length + sizeof (uint16_t),
1589 	    M_PROTO, 0)) == NULL)
1590 		return;
1591 
1592 	bzero(mp->b_rptr, sizeof (dl_notify_ind_t));
1593 	dlip = (dl_notify_ind_t *)mp->b_rptr;
1594 	dlip->dl_primitive = DL_NOTIFY_IND;
1595 	dlip->dl_notification = DL_NOTE_PHYS_ADDR;
1596 	dlip->dl_data = addr_type;
1597 	dlip->dl_addr_offset = sizeof (dl_notify_ind_t);
1598 	dlip->dl_addr_length = addr_length + sizeof (uint16_t);
1599 
1600 	bcopy(addr, &dlip[1], addr_length);
1601 
1602 	ethertype = (dsp->ds_sap < ETHERTYPE_802_MIN) ? 0 : dsp->ds_sap;
1603 	*(uint16_t *)((uchar_t *)(dlip + 1) + addr_length) = ethertype;
1604 
1605 	qreply(dsp->ds_wq, mp);
1606 }
1607 
1608 /*
1609  * DL_NOTIFY_IND: DL_NOTE_LINK_UP
1610  */
1611 static void
1612 str_notify_link_up(dld_str_t *dsp)
1613 {
1614 	mblk_t		*mp;
1615 	dl_notify_ind_t	*dlip;
1616 
1617 	if (!(dsp->ds_notifications & DL_NOTE_LINK_UP))
1618 		return;
1619 
1620 	if ((mp = mexchange(dsp->ds_wq, NULL, sizeof (dl_notify_ind_t),
1621 	    M_PROTO, 0)) == NULL)
1622 		return;
1623 
1624 	bzero(mp->b_rptr, sizeof (dl_notify_ind_t));
1625 	dlip = (dl_notify_ind_t *)mp->b_rptr;
1626 	dlip->dl_primitive = DL_NOTIFY_IND;
1627 	dlip->dl_notification = DL_NOTE_LINK_UP;
1628 
1629 	qreply(dsp->ds_wq, mp);
1630 }
1631 
1632 /*
1633  * DL_NOTIFY_IND: DL_NOTE_LINK_DOWN
1634  */
1635 static void
1636 str_notify_link_down(dld_str_t *dsp)
1637 {
1638 	mblk_t		*mp;
1639 	dl_notify_ind_t	*dlip;
1640 
1641 	if (!(dsp->ds_notifications & DL_NOTE_LINK_DOWN))
1642 		return;
1643 
1644 	if ((mp = mexchange(dsp->ds_wq, NULL, sizeof (dl_notify_ind_t),
1645 	    M_PROTO, 0)) == NULL)
1646 		return;
1647 
1648 	bzero(mp->b_rptr, sizeof (dl_notify_ind_t));
1649 	dlip = (dl_notify_ind_t *)mp->b_rptr;
1650 	dlip->dl_primitive = DL_NOTIFY_IND;
1651 	dlip->dl_notification = DL_NOTE_LINK_DOWN;
1652 
1653 	qreply(dsp->ds_wq, mp);
1654 }
1655 
1656 /*
1657  * DL_NOTIFY_IND: DL_NOTE_SPEED
1658  */
1659 static void
1660 str_notify_speed(dld_str_t *dsp, uint32_t speed)
1661 {
1662 	mblk_t		*mp;
1663 	dl_notify_ind_t	*dlip;
1664 
1665 	if (!(dsp->ds_notifications & DL_NOTE_SPEED))
1666 		return;
1667 
1668 	if ((mp = mexchange(dsp->ds_wq, NULL, sizeof (dl_notify_ind_t),
1669 	    M_PROTO, 0)) == NULL)
1670 		return;
1671 
1672 	bzero(mp->b_rptr, sizeof (dl_notify_ind_t));
1673 	dlip = (dl_notify_ind_t *)mp->b_rptr;
1674 	dlip->dl_primitive = DL_NOTIFY_IND;
1675 	dlip->dl_notification = DL_NOTE_SPEED;
1676 	dlip->dl_data = speed;
1677 
1678 	qreply(dsp->ds_wq, mp);
1679 }
1680 
1681 /*
1682  * DL_NOTIFY_IND: DL_NOTE_CAPAB_RENEG
1683  */
1684 static void
1685 str_notify_capab_reneg(dld_str_t *dsp)
1686 {
1687 	mblk_t		*mp;
1688 	dl_notify_ind_t	*dlip;
1689 
1690 	if (!(dsp->ds_notifications & DL_NOTE_CAPAB_RENEG))
1691 		return;
1692 
1693 	if ((mp = mexchange(dsp->ds_wq, NULL, sizeof (dl_notify_ind_t),
1694 	    M_PROTO, 0)) == NULL)
1695 		return;
1696 
1697 	bzero(mp->b_rptr, sizeof (dl_notify_ind_t));
1698 	dlip = (dl_notify_ind_t *)mp->b_rptr;
1699 	dlip->dl_primitive = DL_NOTIFY_IND;
1700 	dlip->dl_notification = DL_NOTE_CAPAB_RENEG;
1701 
1702 	qreply(dsp->ds_wq, mp);
1703 }
1704 
1705 /*
1706  * DL_NOTIFY_IND: DL_NOTE_FASTPATH_FLUSH
1707  */
1708 static void
1709 str_notify_fastpath_flush(dld_str_t *dsp)
1710 {
1711 	mblk_t		*mp;
1712 	dl_notify_ind_t	*dlip;
1713 
1714 	if (!(dsp->ds_notifications & DL_NOTE_FASTPATH_FLUSH))
1715 		return;
1716 
1717 	if ((mp = mexchange(dsp->ds_wq, NULL, sizeof (dl_notify_ind_t),
1718 	    M_PROTO, 0)) == NULL)
1719 		return;
1720 
1721 	bzero(mp->b_rptr, sizeof (dl_notify_ind_t));
1722 	dlip = (dl_notify_ind_t *)mp->b_rptr;
1723 	dlip->dl_primitive = DL_NOTIFY_IND;
1724 	dlip->dl_notification = DL_NOTE_FASTPATH_FLUSH;
1725 
1726 	qreply(dsp->ds_wq, mp);
1727 }
1728 
1729 static void
1730 str_notify_allowed_ips(dld_str_t *dsp)
1731 {
1732 	mblk_t		*mp;
1733 	dl_notify_ind_t	*dlip;
1734 	size_t		mp_size;
1735 	mac_protect_t	*mrp;
1736 
1737 	if (!(dsp->ds_notifications & DL_NOTE_ALLOWED_IPS))
1738 		return;
1739 
1740 	mp_size = sizeof (mac_protect_t) + sizeof (dl_notify_ind_t);
1741 	if ((mp = mexchange(dsp->ds_wq, NULL, mp_size, M_PROTO, 0)) == NULL)
1742 		return;
1743 
1744 	mrp = mac_protect_get(dsp->ds_mh);
1745 	bzero(mp->b_rptr, mp_size);
1746 	dlip = (dl_notify_ind_t *)mp->b_rptr;
1747 	dlip->dl_primitive = DL_NOTIFY_IND;
1748 	dlip->dl_notification = DL_NOTE_ALLOWED_IPS;
1749 	dlip->dl_data = 0;
1750 	dlip->dl_addr_offset = sizeof (dl_notify_ind_t);
1751 	dlip->dl_addr_length = sizeof (mac_protect_t);
1752 	bcopy(mrp, mp->b_rptr + sizeof (dl_notify_ind_t),
1753 	    sizeof (mac_protect_t));
1754 
1755 	qreply(dsp->ds_wq, mp);
1756 }
1757 
1758 /*
1759  * MAC notification callback.
1760  */
1761 void
1762 str_notify(void *arg, mac_notify_type_t type)
1763 {
1764 	dld_str_t		*dsp = (dld_str_t *)arg;
1765 	queue_t			*q = dsp->ds_wq;
1766 	mac_handle_t		mh = dsp->ds_mh;
1767 	mac_client_handle_t	mch = dsp->ds_mch;
1768 	uint8_t			addr[MAXMACADDRLEN];
1769 
1770 	switch (type) {
1771 	case MAC_NOTE_TX:
1772 		qenable(q);
1773 		break;
1774 
1775 	case MAC_NOTE_DEVPROMISC:
1776 		/*
1777 		 * Send the appropriate DL_NOTIFY_IND.
1778 		 */
1779 		if (mac_promisc_get(mh))
1780 			str_notify_promisc_on_phys(dsp);
1781 		else
1782 			str_notify_promisc_off_phys(dsp);
1783 		break;
1784 
1785 	case MAC_NOTE_UNICST:
1786 		/*
1787 		 * This notification is sent whenever the MAC unicast
1788 		 * address changes.
1789 		 */
1790 		mac_unicast_primary_get(mh, addr);
1791 
1792 		/*
1793 		 * Send the appropriate DL_NOTIFY_IND.
1794 		 */
1795 		str_notify_phys_addr(dsp, DL_CURR_PHYS_ADDR, addr);
1796 		break;
1797 
1798 	case MAC_NOTE_DEST:
1799 		/*
1800 		 * Only send up DL_NOTE_DEST_ADDR if the link has a
1801 		 * destination address.
1802 		 */
1803 		if (mac_dst_get(dsp->ds_mh, addr))
1804 			str_notify_phys_addr(dsp, DL_CURR_DEST_ADDR, addr);
1805 		break;
1806 
1807 	case MAC_NOTE_LOWLINK:
1808 	case MAC_NOTE_LINK:
1809 		/*
1810 		 * LOWLINK refers to the actual link status. For links that
1811 		 * are not part of a bridge instance LOWLINK and LINK state
1812 		 * are the same. But for a link part of a bridge instance
1813 		 * LINK state refers to the aggregate link status: "up" when
1814 		 * at least one link part of the bridge is up and is "down"
1815 		 * when all links part of the bridge are down.
1816 		 *
1817 		 * Clients can request to be notified of the LOWLINK state
1818 		 * using the DLIOCLOWLINK ioctl. Clients such as the bridge
1819 		 * daemon request lowlink state changes and upper layer clients
1820 		 * receive notifications of the aggregate link state changes
1821 		 * which is the default when requesting LINK UP/DOWN state
1822 		 * notifications.
1823 		 */
1824 
1825 		/*
1826 		 * Check that the notification type matches the one that we
1827 		 * want.  If we want lower-level link notifications, and this
1828 		 * is upper, or if we want upper and this is lower, then
1829 		 * ignore.
1830 		 */
1831 		if ((type == MAC_NOTE_LOWLINK) != dsp->ds_lowlink)
1832 			break;
1833 		/*
1834 		 * This notification is sent every time the MAC driver
1835 		 * updates the link state.
1836 		 */
1837 		switch (mac_client_stat_get(mch, dsp->ds_lowlink ?
1838 		    MAC_STAT_LOWLINK_STATE : MAC_STAT_LINK_STATE)) {
1839 		case LINK_STATE_UP: {
1840 			uint64_t speed;
1841 			/*
1842 			 * The link is up so send the appropriate
1843 			 * DL_NOTIFY_IND.
1844 			 */
1845 			str_notify_link_up(dsp);
1846 
1847 			speed = mac_stat_get(mh, MAC_STAT_IFSPEED);
1848 			str_notify_speed(dsp, (uint32_t)(speed / 1000ull));
1849 			break;
1850 		}
1851 		case LINK_STATE_DOWN:
1852 			/*
1853 			 * The link is down so send the appropriate
1854 			 * DL_NOTIFY_IND.
1855 			 */
1856 			str_notify_link_down(dsp);
1857 			break;
1858 
1859 		default:
1860 			break;
1861 		}
1862 		break;
1863 
1864 	case MAC_NOTE_CAPAB_CHG:
1865 		/*
1866 		 * This notification is sent whenever the MAC resources
1867 		 * change or capabilities change. We need to renegotiate
1868 		 * the capabilities. Send the appropriate DL_NOTIFY_IND.
1869 		 */
1870 		str_notify_capab_reneg(dsp);
1871 		break;
1872 
1873 	case MAC_NOTE_SDU_SIZE: {
1874 		uint_t  max_sdu;
1875 		uint_t	multicast_sdu;
1876 		mac_sdu_get2(dsp->ds_mh, NULL, &max_sdu, &multicast_sdu);
1877 		str_notify_sdu_size(dsp, max_sdu, multicast_sdu);
1878 		break;
1879 	}
1880 
1881 	case MAC_NOTE_FASTPATH_FLUSH:
1882 		str_notify_fastpath_flush(dsp);
1883 		break;
1884 
1885 	/* Unused notifications */
1886 	case MAC_NOTE_MARGIN:
1887 		break;
1888 
1889 	case MAC_NOTE_ALLOWED_IPS:
1890 		str_notify_allowed_ips(dsp);
1891 		break;
1892 
1893 	default:
1894 		ASSERT(B_FALSE);
1895 		break;
1896 	}
1897 }
1898 
1899 /*
1900  * This function is called via a taskq mechansim to process all control
1901  * messages on a per 'dsp' end point.
1902  */
1903 static void
1904 dld_wput_nondata_task(void *arg)
1905 {
1906 	dld_str_t	*dsp = arg;
1907 	mblk_t		*mp;
1908 
1909 	mutex_enter(&dsp->ds_lock);
1910 	while (dsp->ds_pending_head != NULL) {
1911 		mp = dsp->ds_pending_head;
1912 		dsp->ds_pending_head = mp->b_next;
1913 		mp->b_next = NULL;
1914 		if (dsp->ds_pending_head == NULL)
1915 			dsp->ds_pending_tail = NULL;
1916 		mutex_exit(&dsp->ds_lock);
1917 
1918 		switch (DB_TYPE(mp)) {
1919 		case M_PROTO:
1920 		case M_PCPROTO:
1921 			dld_proto(dsp, mp);
1922 			break;
1923 		case M_IOCTL:
1924 			dld_ioc(dsp, mp);
1925 			break;
1926 		default:
1927 			ASSERT(0);
1928 		}
1929 
1930 		mutex_enter(&dsp->ds_lock);
1931 	}
1932 	ASSERT(dsp->ds_pending_tail == NULL);
1933 	dsp->ds_dlpi_pending = 0;
1934 	cv_broadcast(&dsp->ds_dlpi_pending_cv);
1935 	mutex_exit(&dsp->ds_lock);
1936 }
1937 
1938 /*
1939  * Kernel thread to handle taskq dispatch failures in dld_wput_data. This
1940  * thread is started at boot time.
1941  */
1942 static void
1943 dld_taskq_dispatch(void)
1944 {
1945 	callb_cpr_t	cprinfo;
1946 	dld_str_t	*dsp;
1947 
1948 	CALLB_CPR_INIT(&cprinfo, &dld_taskq_lock, callb_generic_cpr,
1949 	    "dld_taskq_dispatch");
1950 	mutex_enter(&dld_taskq_lock);
1951 
1952 	while (!dld_taskq_quit) {
1953 		dsp = list_head(&dld_taskq_list);
1954 		while (dsp != NULL) {
1955 			list_remove(&dld_taskq_list, dsp);
1956 			mutex_exit(&dld_taskq_lock);
1957 			VERIFY(taskq_dispatch(dld_taskq, dld_wput_nondata_task,
1958 			    dsp, TQ_SLEEP) != 0);
1959 			mutex_enter(&dld_taskq_lock);
1960 			dsp = list_head(&dld_taskq_list);
1961 		}
1962 
1963 		CALLB_CPR_SAFE_BEGIN(&cprinfo);
1964 		cv_wait(&dld_taskq_cv, &dld_taskq_lock);
1965 		CALLB_CPR_SAFE_END(&cprinfo, &dld_taskq_lock);
1966 	}
1967 
1968 	dld_taskq_done = B_TRUE;
1969 	cv_signal(&dld_taskq_cv);
1970 	CALLB_CPR_EXIT(&cprinfo);
1971 	thread_exit();
1972 }
1973 
1974 /*
1975  * All control operations are serialized on the 'dsp' and are also funneled
1976  * through a taskq mechanism to ensure that subsequent processing has kernel
1977  * context and can safely use cv_wait.
1978  *
1979  * Mechanisms to handle taskq dispatch failures
1980  *
1981  * The only way to be sure that taskq dispatch does not fail is to either
1982  * specify TQ_SLEEP or to use a static taskq and prepopulate it with
1983  * some number of entries and make sure that the number of outstanding requests
1984  * are less than that number. We can't use TQ_SLEEP since we don't know the
1985  * context. Nor can we bound the total number of 'dsp' end points. So we are
1986  * unable to use either of the above schemes, and are forced to deal with
1987  * taskq dispatch failures. Note that even dynamic taskq could fail in
1988  * dispatch if TQ_NOSLEEP is specified, since this flag is translated
1989  * eventually to KM_NOSLEEP and kmem allocations could fail in the taskq
1990  * framework.
1991  *
1992  * We maintain a queue of 'dsp's that encountered taskq dispatch failure.
1993  * We also have a single global thread to retry the taskq dispatch. This
1994  * thread loops in 'dld_taskq_dispatch' and retries the taskq dispatch, but
1995  * uses TQ_SLEEP to ensure eventual success of the dispatch operation.
1996  */
1997 static void
1998 dld_wput_nondata(dld_str_t *dsp, mblk_t *mp)
1999 {
2000 	ASSERT(mp->b_next == NULL);
2001 	mutex_enter(&dsp->ds_lock);
2002 	if (dsp->ds_pending_head != NULL) {
2003 		ASSERT(dsp->ds_dlpi_pending);
2004 		dsp->ds_pending_tail->b_next = mp;
2005 		dsp->ds_pending_tail = mp;
2006 		mutex_exit(&dsp->ds_lock);
2007 		return;
2008 	}
2009 	ASSERT(dsp->ds_pending_tail == NULL);
2010 	dsp->ds_pending_head = dsp->ds_pending_tail = mp;
2011 	/*
2012 	 * At this point if ds_dlpi_pending is set, it implies that the taskq
2013 	 * thread is still active and is processing the last message, though
2014 	 * the pending queue has been emptied.
2015 	 */
2016 	if (dsp->ds_dlpi_pending) {
2017 		mutex_exit(&dsp->ds_lock);
2018 		return;
2019 	}
2020 
2021 	dsp->ds_dlpi_pending = 1;
2022 	mutex_exit(&dsp->ds_lock);
2023 
2024 	if (taskq_dispatch(dld_taskq, dld_wput_nondata_task, dsp,
2025 	    TQ_NOSLEEP) != 0)
2026 		return;
2027 
2028 	mutex_enter(&dld_taskq_lock);
2029 	list_insert_tail(&dld_taskq_list, dsp);
2030 	cv_signal(&dld_taskq_cv);
2031 	mutex_exit(&dld_taskq_lock);
2032 }
2033 
2034 /*
2035  * Process an M_IOCTL message.
2036  */
2037 static void
2038 dld_ioc(dld_str_t *dsp, mblk_t *mp)
2039 {
2040 	uint_t			cmd;
2041 
2042 	cmd = ((struct iocblk *)mp->b_rptr)->ioc_cmd;
2043 	ASSERT(dsp->ds_type == DLD_DLPI);
2044 
2045 	switch (cmd) {
2046 	case DLIOCNATIVE:
2047 		ioc_native(dsp, mp);
2048 		break;
2049 	case DLIOCMARGININFO:
2050 		ioc_margin(dsp, mp);
2051 		break;
2052 	case DLIOCRAW:
2053 		ioc_raw(dsp, mp);
2054 		break;
2055 	case DLIOCHDRINFO:
2056 		ioc_fast(dsp, mp);
2057 		break;
2058 	case DLIOCLOWLINK:
2059 		ioc_lowlink(dsp, mp);
2060 		break;
2061 	default:
2062 		ioc(dsp, mp);
2063 	}
2064 }
2065 
2066 /*
2067  * DLIOCNATIVE
2068  */
2069 static void
2070 ioc_native(dld_str_t *dsp, mblk_t *mp)
2071 {
2072 	queue_t *q = dsp->ds_wq;
2073 	const mac_info_t *mip = dsp->ds_mip;
2074 
2075 	/*
2076 	 * Native mode can be enabled if it's disabled and if the
2077 	 * native media type is different.
2078 	 */
2079 	if (!dsp->ds_native && mip->mi_media != mip->mi_nativemedia)
2080 		dsp->ds_native = B_TRUE;
2081 
2082 	if (dsp->ds_native)
2083 		miocack(q, mp, 0, mip->mi_nativemedia);
2084 	else
2085 		miocnak(q, mp, 0, ENOTSUP);
2086 }
2087 
2088 /*
2089  * DLIOCMARGININFO
2090  */
2091 static void
2092 ioc_margin(dld_str_t *dsp, mblk_t *mp)
2093 {
2094 	queue_t *q = dsp->ds_wq;
2095 	uint32_t margin;
2096 	int err;
2097 
2098 	if (dsp->ds_dlstate == DL_UNATTACHED) {
2099 		err = EINVAL;
2100 		goto failed;
2101 	}
2102 	if ((err = miocpullup(mp, sizeof (uint32_t))) != 0)
2103 		goto failed;
2104 
2105 	mac_margin_get(dsp->ds_mh, &margin);
2106 	*((uint32_t *)mp->b_cont->b_rptr) = margin;
2107 	miocack(q, mp, sizeof (uint32_t), 0);
2108 	return;
2109 
2110 failed:
2111 	miocnak(q, mp, 0, err);
2112 }
2113 
2114 /*
2115  * DLIOCRAW
2116  */
2117 static void
2118 ioc_raw(dld_str_t *dsp, mblk_t *mp)
2119 {
2120 	queue_t *q = dsp->ds_wq;
2121 	mac_perim_handle_t	mph;
2122 
2123 	if (dsp->ds_mh == NULL) {
2124 		dsp->ds_mode = DLD_RAW;
2125 		miocack(q, mp, 0, 0);
2126 		return;
2127 	}
2128 
2129 	mac_perim_enter_by_mh(dsp->ds_mh, &mph);
2130 	if (dsp->ds_polling || dsp->ds_direct) {
2131 		mac_perim_exit(mph);
2132 		miocnak(q, mp, 0, EPROTO);
2133 		return;
2134 	}
2135 
2136 	if (dsp->ds_mode != DLD_RAW && dsp->ds_dlstate == DL_IDLE) {
2137 		/*
2138 		 * Set the receive callback.
2139 		 */
2140 		dls_rx_set(dsp, dld_str_rx_raw, dsp);
2141 	}
2142 
2143 	/*
2144 	 * Note that raw mode is enabled.
2145 	 */
2146 	dsp->ds_mode = DLD_RAW;
2147 	mac_perim_exit(mph);
2148 
2149 	miocack(q, mp, 0, 0);
2150 }
2151 
2152 /*
2153  * DLIOCHDRINFO
2154  */
2155 static void
2156 ioc_fast(dld_str_t *dsp, mblk_t *mp)
2157 {
2158 	dl_unitdata_req_t *dlp;
2159 	off_t		off;
2160 	size_t		len;
2161 	const uint8_t	*addr;
2162 	uint16_t	sap;
2163 	mblk_t		*nmp;
2164 	mblk_t		*hmp;
2165 	uint_t		addr_length;
2166 	queue_t		*q = dsp->ds_wq;
2167 	int		err;
2168 	mac_perim_handle_t	mph;
2169 
2170 	if (dld_opt & DLD_OPT_NO_FASTPATH) {
2171 		err = ENOTSUP;
2172 		goto failed;
2173 	}
2174 
2175 	/*
2176 	 * DLIOCHDRINFO should only come from IP. The one initiated from
2177 	 * user-land should not be allowed.
2178 	 */
2179 	if (((struct iocblk *)mp->b_rptr)->ioc_cr != kcred) {
2180 		err = EINVAL;
2181 		goto failed;
2182 	}
2183 
2184 	nmp = mp->b_cont;
2185 	if (nmp == NULL || MBLKL(nmp) < sizeof (dl_unitdata_req_t) ||
2186 	    (dlp = (dl_unitdata_req_t *)nmp->b_rptr,
2187 	    dlp->dl_primitive != DL_UNITDATA_REQ)) {
2188 		err = EINVAL;
2189 		goto failed;
2190 	}
2191 
2192 	off = dlp->dl_dest_addr_offset;
2193 	len = dlp->dl_dest_addr_length;
2194 
2195 	if (!MBLKIN(nmp, off, len)) {
2196 		err = EINVAL;
2197 		goto failed;
2198 	}
2199 
2200 	if (dsp->ds_dlstate != DL_IDLE) {
2201 		err = ENOTSUP;
2202 		goto failed;
2203 	}
2204 
2205 	addr_length = dsp->ds_mip->mi_addr_length;
2206 	if (len != addr_length + sizeof (uint16_t)) {
2207 		err = EINVAL;
2208 		goto failed;
2209 	}
2210 
2211 	addr = nmp->b_rptr + off;
2212 	sap = *(uint16_t *)(nmp->b_rptr + off + addr_length);
2213 
2214 	if ((hmp = dls_header(dsp, addr, sap, 0, NULL)) == NULL) {
2215 		err = ENOMEM;
2216 		goto failed;
2217 	}
2218 
2219 	/*
2220 	 * This ioctl might happen concurrently with a direct call to dld_capab
2221 	 * that tries to enable direct and/or poll capabilities. Since the
2222 	 * stack does not serialize them, we do so here to avoid mixing
2223 	 * the callbacks.
2224 	 */
2225 	mac_perim_enter_by_mh(dsp->ds_mh, &mph);
2226 	if (dsp->ds_mode != DLD_FASTPATH) {
2227 		/*
2228 		 * Set the receive callback (unless polling is enabled).
2229 		 */
2230 		if (!dsp->ds_polling && !dsp->ds_direct)
2231 			dls_rx_set(dsp, dld_str_rx_fastpath, dsp);
2232 
2233 		/*
2234 		 * Note that fast-path mode is enabled.
2235 		 */
2236 		dsp->ds_mode = DLD_FASTPATH;
2237 	}
2238 	mac_perim_exit(mph);
2239 
2240 	freemsg(nmp->b_cont);
2241 	nmp->b_cont = hmp;
2242 
2243 	miocack(q, mp, MBLKL(nmp) + MBLKL(hmp), 0);
2244 	return;
2245 failed:
2246 	miocnak(q, mp, 0, err);
2247 }
2248 
2249 /*
2250  * DLIOCLOWLINK: request actual link state changes. When the
2251  * link is part of a bridge instance the client receives actual
2252  * link state changes and not the aggregate link status. Used by
2253  * the bridging daemon (bridged) for proper RSTP operation.
2254  */
2255 static void
2256 ioc_lowlink(dld_str_t *dsp, mblk_t *mp)
2257 {
2258 	queue_t *q = dsp->ds_wq;
2259 	int err;
2260 
2261 	if ((err = miocpullup(mp, sizeof (int))) != 0) {
2262 		miocnak(q, mp, 0, err);
2263 	} else {
2264 		/* LINTED: alignment */
2265 		dsp->ds_lowlink = *(boolean_t *)mp->b_cont->b_rptr;
2266 		miocack(q, mp, 0, 0);
2267 	}
2268 }
2269 
2270 /*
2271  * Catch-all handler.
2272  */
2273 static void
2274 ioc(dld_str_t *dsp, mblk_t *mp)
2275 {
2276 	queue_t	*q = dsp->ds_wq;
2277 
2278 	if (dsp->ds_dlstate == DL_UNATTACHED) {
2279 		miocnak(q, mp, 0, EINVAL);
2280 		return;
2281 	}
2282 	mac_ioctl(dsp->ds_mh, q, mp);
2283 }
2284