xref: /titanic_44/usr/src/lib/libdlpi/common/libdlpi.c (revision e7801d59e8ceda0cde8ebdfdddd7582ee2ea96ef)
17c478bd9Sstevel@tonic-gate /*
27c478bd9Sstevel@tonic-gate  * CDDL HEADER START
37c478bd9Sstevel@tonic-gate  *
47c478bd9Sstevel@tonic-gate  * The contents of this file are subject to the terms of the
55e1c24c3Sss150715  * Common Development and Distribution License (the "License").
65e1c24c3Sss150715  * You may not use this file except in compliance with the License.
77c478bd9Sstevel@tonic-gate  *
87c478bd9Sstevel@tonic-gate  * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE
97c478bd9Sstevel@tonic-gate  * or http://www.opensolaris.org/os/licensing.
107c478bd9Sstevel@tonic-gate  * See the License for the specific language governing permissions
117c478bd9Sstevel@tonic-gate  * and limitations under the License.
127c478bd9Sstevel@tonic-gate  *
137c478bd9Sstevel@tonic-gate  * When distributing Covered Code, include this CDDL HEADER in each
147c478bd9Sstevel@tonic-gate  * file and include the License file at usr/src/OPENSOLARIS.LICENSE.
157c478bd9Sstevel@tonic-gate  * If applicable, add the following below this CDDL HEADER, with the
167c478bd9Sstevel@tonic-gate  * fields enclosed by brackets "[]" replaced with your own identifying
177c478bd9Sstevel@tonic-gate  * information: Portions Copyright [yyyy] [name of copyright owner]
187c478bd9Sstevel@tonic-gate  *
197c478bd9Sstevel@tonic-gate  * CDDL HEADER END
207c478bd9Sstevel@tonic-gate  */
217c478bd9Sstevel@tonic-gate /*
22d62bc4baSyz147064  * Copyright 2008 Sun Microsystems, Inc.  All rights reserved.
237c478bd9Sstevel@tonic-gate  * Use is subject to license terms.
247c478bd9Sstevel@tonic-gate  */
257c478bd9Sstevel@tonic-gate 
267c478bd9Sstevel@tonic-gate #pragma ident	"%Z%%M%	%I%	%E% SMI"
277c478bd9Sstevel@tonic-gate 
287c478bd9Sstevel@tonic-gate /*
297c478bd9Sstevel@tonic-gate  * Data-Link Provider Interface (Version 2)
307c478bd9Sstevel@tonic-gate  */
317c478bd9Sstevel@tonic-gate #include <stdio.h>
327c478bd9Sstevel@tonic-gate #include <stdlib.h>
337c478bd9Sstevel@tonic-gate #include <string.h>
347c478bd9Sstevel@tonic-gate #include <sys/types.h>
357c478bd9Sstevel@tonic-gate #include <sys/stat.h>
367c478bd9Sstevel@tonic-gate #include <fcntl.h>
377c478bd9Sstevel@tonic-gate #include <unistd.h>
387c478bd9Sstevel@tonic-gate #include <poll.h>
397c478bd9Sstevel@tonic-gate #include <stropts.h>
407c478bd9Sstevel@tonic-gate #include <sys/dlpi.h>
417c478bd9Sstevel@tonic-gate #include <errno.h>
42c7e4935fSss150715 #include <alloca.h>
437c478bd9Sstevel@tonic-gate #include <sys/sysmacros.h>
447c478bd9Sstevel@tonic-gate #include <ctype.h>
45948f2876Sss150715 #include <net/if_types.h>
46948f2876Sss150715 #include <netinet/arp.h>
47d62bc4baSyz147064 #include <libdladm.h>
48d62bc4baSyz147064 #include <libdllink.h>
497c478bd9Sstevel@tonic-gate #include <libdlpi.h>
50c7e4935fSss150715 #include <libintl.h>
51c7e4935fSss150715 #include <libinetutil.h>
527c478bd9Sstevel@tonic-gate 
53c7e4935fSss150715 #include "libdlpi_impl.h"
547c478bd9Sstevel@tonic-gate 
55d62bc4baSyz147064 static int i_dlpi_open(const char *, int *, uint_t, boolean_t);
56c7e4935fSss150715 static int i_dlpi_style1_open(dlpi_impl_t *);
57c7e4935fSss150715 static int i_dlpi_style2_open(dlpi_impl_t *);
58c7e4935fSss150715 static int i_dlpi_checkstyle(dlpi_impl_t *, t_uscalar_t);
59c7e4935fSss150715 static int i_dlpi_remove_ppa(char *);
60c7e4935fSss150715 static int i_dlpi_attach(dlpi_impl_t *);
61c7e4935fSss150715 static void i_dlpi_passive(dlpi_impl_t *);
627c478bd9Sstevel@tonic-gate 
633ab45760Sss150715 static int i_dlpi_strputmsg(dlpi_impl_t *, const dlpi_msg_t *, const void *,
643ab45760Sss150715     size_t, int);
653ab45760Sss150715 static int i_dlpi_strgetmsg(dlpi_impl_t *, int, dlpi_msg_t *, t_uscalar_t,
663ab45760Sss150715     t_uscalar_t, size_t, void *, size_t *, size_t *);
67c7e4935fSss150715 static int i_dlpi_msg_common(dlpi_impl_t *, const dlpi_msg_t *, dlpi_msg_t *,
68c7e4935fSss150715     size_t, int);
697c478bd9Sstevel@tonic-gate 
70c7e4935fSss150715 static size_t i_dlpi_getprimsize(t_uscalar_t);
71c7e4935fSss150715 static int i_dlpi_multi(dlpi_handle_t, t_uscalar_t, const uint8_t *, size_t);
72c7e4935fSss150715 static int i_dlpi_promisc(dlpi_handle_t, t_uscalar_t, uint_t);
73c7e4935fSss150715 static uint_t i_dlpi_buildsap(uint8_t *, uint_t);
74c7e4935fSss150715 static void i_dlpi_writesap(void *, uint_t, uint_t);
753ab45760Sss150715 static int i_dlpi_notifyind_process(dlpi_impl_t *, dl_notify_ind_t *);
763ab45760Sss150715 static boolean_t i_dlpi_notifyidexists(dlpi_impl_t *, dlpi_notifyent_t *);
773ab45760Sss150715 static void i_dlpi_deletenotifyid(dlpi_impl_t *);
78c7e4935fSss150715 
79d62bc4baSyz147064 struct i_dlpi_walklink_arg {
80d62bc4baSyz147064 	dlpi_walkfunc_t *fn;
81d62bc4baSyz147064 	void *arg;
82d62bc4baSyz147064 };
83d62bc4baSyz147064 
84d62bc4baSyz147064 static int
85d62bc4baSyz147064 i_dlpi_walk_link(const char *name, void *arg)
86d62bc4baSyz147064 {
87d62bc4baSyz147064 	struct i_dlpi_walklink_arg *warg = arg;
88d62bc4baSyz147064 
89d62bc4baSyz147064 	return ((warg->fn(name, warg->arg)) ? DLADM_WALK_TERMINATE :
90d62bc4baSyz147064 	    DLADM_WALK_CONTINUE);
91d62bc4baSyz147064 }
92d62bc4baSyz147064 
93d62bc4baSyz147064 /*ARGSUSED*/
94d62bc4baSyz147064 void
95d62bc4baSyz147064 dlpi_walk(dlpi_walkfunc_t *fn, void *arg, uint_t flags)
96d62bc4baSyz147064 {
97d62bc4baSyz147064 	struct i_dlpi_walklink_arg warg;
98d62bc4baSyz147064 
99d62bc4baSyz147064 	warg.fn = fn;
100d62bc4baSyz147064 	warg.arg = arg;
101d62bc4baSyz147064 
102d62bc4baSyz147064 	(void) dladm_walk(i_dlpi_walk_link, &warg, DATALINK_CLASS_ALL,
103d62bc4baSyz147064 	    DATALINK_ANY_MEDIATYPE, DLADM_OPT_ACTIVE);
104d62bc4baSyz147064 }
105d62bc4baSyz147064 
106c7e4935fSss150715 int
107c7e4935fSss150715 dlpi_open(const char *linkname, dlpi_handle_t *dhp, uint_t flags)
108c7e4935fSss150715 {
109c7e4935fSss150715 	int		retval;
110c7e4935fSss150715 	int		cnt;
111c7e4935fSss150715 	ifspec_t	ifsp;
112c7e4935fSss150715 	dlpi_impl_t  	*dip;
113c7e4935fSss150715 
114c7e4935fSss150715 	/*
115c7e4935fSss150715 	 * Validate linkname, fail if logical unit number (lun) is specified,
116c7e4935fSss150715 	 * otherwise decompose the contents into ifsp.
117c7e4935fSss150715 	 */
118c7e4935fSss150715 	if (linkname == NULL || (strchr(linkname, ':') != NULL) ||
119c7e4935fSss150715 	    !ifparse_ifspec(linkname, &ifsp))
120c7e4935fSss150715 		return (DLPI_ELINKNAMEINVAL);
121c7e4935fSss150715 
122c7e4935fSss150715 	/* Allocate a new dlpi_impl_t. */
123c7e4935fSss150715 	if ((dip = calloc(1, sizeof (dlpi_impl_t))) == NULL)
124c7e4935fSss150715 		return (DL_SYSERR);
125c7e4935fSss150715 
126c7e4935fSss150715 	/* Fill in known/default libdlpi handle values. */
127c7e4935fSss150715 	dip->dli_timeout = DLPI_DEF_TIMEOUT;
128c7e4935fSss150715 	dip->dli_ppa = ifsp.ifsp_ppa;
129c7e4935fSss150715 	dip->dli_mod_cnt = ifsp.ifsp_modcnt;
130c7e4935fSss150715 	dip->dli_oflags = flags;
1313ab45760Sss150715 	dip->dli_notifylistp = NULL;
1323ab45760Sss150715 	dip->dli_note_processing = B_FALSE;
133d62bc4baSyz147064 	if (getenv("DLPI_DEVONLY") != NULL)
134d62bc4baSyz147064 		dip->dli_oflags |= DLPI_DEVONLY;
135c7e4935fSss150715 
136c7e4935fSss150715 	for (cnt = 0; cnt != dip->dli_mod_cnt; cnt++) {
137c7e4935fSss150715 		(void) strlcpy(dip->dli_modlist[cnt], ifsp.ifsp_mods[cnt],
138c7e4935fSss150715 		    DLPI_LINKNAME_MAX);
139c7e4935fSss150715 	}
140c7e4935fSss150715 
141c7e4935fSss150715 	/* Copy linkname provided to the function. */
142c7e4935fSss150715 	if (strlcpy(dip->dli_linkname, linkname, sizeof (dip->dli_linkname)) >=
143c7e4935fSss150715 	    sizeof (dip->dli_linkname)) {
144c7e4935fSss150715 		free(dip);
145c7e4935fSss150715 		return (DLPI_ELINKNAMEINVAL);
146c7e4935fSss150715 	}
147c7e4935fSss150715 
148c7e4935fSss150715 	/* Copy provider name. */
149c7e4935fSss150715 	(void) strlcpy(dip->dli_provider, ifsp.ifsp_devnm,
150c7e4935fSss150715 	    sizeof (dip->dli_provider));
151c7e4935fSss150715 
152c7e4935fSss150715 	/*
153c7e4935fSss150715 	 * Special case: DLPI_SERIAL flag is set to indicate a synchronous
154c7e4935fSss150715 	 * serial line interface (see syncinit(1M), syncstat(1M),
155c7e4935fSss150715 	 * syncloop(1M)), which is not a DLPI link.
156c7e4935fSss150715 	 */
157c7e4935fSss150715 	if (dip->dli_oflags & DLPI_SERIAL) {
158c7e4935fSss150715 		if ((retval = i_dlpi_style2_open(dip)) != DLPI_SUCCESS) {
159c7e4935fSss150715 			free(dip);
160c7e4935fSss150715 			return (retval);
161c7e4935fSss150715 		}
162c7e4935fSss150715 
163c7e4935fSss150715 		*dhp = (dlpi_handle_t)dip;
164c7e4935fSss150715 		return (retval);
165c7e4935fSss150715 	}
166c7e4935fSss150715 
167d62bc4baSyz147064 	if ((retval = i_dlpi_style1_open(dip)) != DLPI_SUCCESS) {
168d62bc4baSyz147064 		if (retval == DLPI_ENOTSTYLE2) {
169d62bc4baSyz147064 			/*
170d62bc4baSyz147064 			 * The error code indicates not to continue the
171d62bc4baSyz147064 			 * style-2 open. Change the error code back to
172d62bc4baSyz147064 			 * DL_SYSERR, so that one would know the cause
173d62bc4baSyz147064 			 * of failure from errno.
174d62bc4baSyz147064 			 */
175d62bc4baSyz147064 			retval = DL_SYSERR;
176d62bc4baSyz147064 		} else {
177d62bc4baSyz147064 			retval = i_dlpi_style2_open(dip);
178d62bc4baSyz147064 		}
179d62bc4baSyz147064 		if (retval != DLPI_SUCCESS) {
180c7e4935fSss150715 			free(dip);
181c7e4935fSss150715 			return (retval);
182c7e4935fSss150715 		}
183c7e4935fSss150715 	}
184c7e4935fSss150715 
185c7e4935fSss150715 	if (dip->dli_oflags & DLPI_PASSIVE)
186c7e4935fSss150715 		i_dlpi_passive(dip);
187c7e4935fSss150715 
188c7e4935fSss150715 	if ((dip->dli_oflags & DLPI_RAW) &&
189c7e4935fSss150715 	    ioctl(dip->dli_fd, DLIOCRAW, 0) < 0) {
190c7e4935fSss150715 		dlpi_close((dlpi_handle_t)dip);
191c7e4935fSss150715 		return (DLPI_ERAWNOTSUP);
192c7e4935fSss150715 	}
193c7e4935fSss150715 
194c7e4935fSss150715 	/*
195c7e4935fSss150715 	 * We intentionally do not care if this request fails, as this
196c7e4935fSss150715 	 * indicates the underlying DLPI device does not support Native mode
197c7e4935fSss150715 	 * (pre-GLDV3 device drivers).
198c7e4935fSss150715 	 */
199c7e4935fSss150715 	if (dip->dli_oflags & DLPI_NATIVE) {
200c7e4935fSss150715 		if ((retval = ioctl(dip->dli_fd, DLIOCNATIVE, 0)) > 0)
201c7e4935fSss150715 			dip->dli_mactype = retval;
202c7e4935fSss150715 	}
203c7e4935fSss150715 
204c7e4935fSss150715 	*dhp = (dlpi_handle_t)dip;
205c7e4935fSss150715 	return (DLPI_SUCCESS);
206c7e4935fSss150715 }
207c7e4935fSss150715 
208c7e4935fSss150715 void
209c7e4935fSss150715 dlpi_close(dlpi_handle_t dh)
210c7e4935fSss150715 {
211c7e4935fSss150715 	dlpi_impl_t	*dip = (dlpi_impl_t *)dh;
2123ab45760Sss150715 	dlpi_notifyent_t *next, *dnp;
213c7e4935fSss150715 
214c7e4935fSss150715 	if (dip != NULL) {
2153ab45760Sss150715 		for (dnp = dip->dli_notifylistp; dnp != NULL; dnp = next) {
2163ab45760Sss150715 			next = dnp->dln_next;
2173ab45760Sss150715 			free(dnp);
2183ab45760Sss150715 		}
2193ab45760Sss150715 
220c7e4935fSss150715 		(void) close(dip->dli_fd);
221c7e4935fSss150715 		free(dip);
222c7e4935fSss150715 	}
223c7e4935fSss150715 }
224c7e4935fSss150715 
225c7e4935fSss150715 /*
226c7e4935fSss150715  * NOTE: The opt argument must be zero and is reserved for future use to extend
227c7e4935fSss150715  * fields to the dlpi_info_t structure (see dlpi_info(3DLPI)).
228c7e4935fSss150715  */
229c7e4935fSss150715 int
230c7e4935fSss150715 dlpi_info(dlpi_handle_t dh, dlpi_info_t *infop, uint_t opt)
231c7e4935fSss150715 {
232c7e4935fSss150715 	int 		retval;
233c7e4935fSss150715 	dlpi_msg_t	req, ack;
234c7e4935fSss150715 	dl_info_ack_t	*infoackp;
235c7e4935fSss150715 	uint8_t		*sapp, *addrp;
236c7e4935fSss150715 	caddr_t		ackendp, datap;
237c7e4935fSss150715 	t_uscalar_t	dataoff, datalen;
238c7e4935fSss150715 	dlpi_impl_t	*dip = (dlpi_impl_t *)dh;
239c7e4935fSss150715 
240c7e4935fSss150715 	if (dip == NULL)
241c7e4935fSss150715 		return (DLPI_EINHANDLE);
242c7e4935fSss150715 
243c7e4935fSss150715 	if (infop == NULL || opt != 0)
244c7e4935fSss150715 		return (DLPI_EINVAL);
245c7e4935fSss150715 
246c7e4935fSss150715 	(void) memset(infop, 0, sizeof (dlpi_info_t));
247c7e4935fSss150715 
248c7e4935fSss150715 	/* Set QoS range parameters to default unsupported value. */
249c7e4935fSss150715 	infop->di_qos_range.dl_qos_type = (t_uscalar_t)DL_UNKNOWN;
250c7e4935fSss150715 	infop->di_qos_range.dl_trans_delay.dl_target_value = DL_UNKNOWN;
251c7e4935fSss150715 	infop->di_qos_range.dl_trans_delay.dl_accept_value = DL_UNKNOWN;
252c7e4935fSss150715 	infop->di_qos_range.dl_priority.dl_min = DL_UNKNOWN;
253c7e4935fSss150715 	infop->di_qos_range.dl_priority.dl_max = DL_UNKNOWN;
254c7e4935fSss150715 	infop->di_qos_range.dl_protection.dl_min = DL_UNKNOWN;
255c7e4935fSss150715 	infop->di_qos_range.dl_protection.dl_max = DL_UNKNOWN;
256c7e4935fSss150715 	infop->di_qos_range.dl_residual_error = DL_UNKNOWN;
257c7e4935fSss150715 
258c7e4935fSss150715 	/* Set QoS parameters to default unsupported value. */
259c7e4935fSss150715 	infop->di_qos_sel.dl_qos_type = (t_uscalar_t)DL_UNKNOWN;
260c7e4935fSss150715 	infop->di_qos_sel.dl_trans_delay = DL_UNKNOWN;
261c7e4935fSss150715 	infop->di_qos_sel.dl_priority = DL_UNKNOWN;
262c7e4935fSss150715 	infop->di_qos_sel.dl_protection = DL_UNKNOWN;
263c7e4935fSss150715 	infop->di_qos_sel.dl_residual_error = DL_UNKNOWN;
264c7e4935fSss150715 
265c7e4935fSss150715 	DLPI_MSG_CREATE(req, DL_INFO_REQ);
266c7e4935fSss150715 	DLPI_MSG_CREATE(ack, DL_INFO_ACK);
267c7e4935fSss150715 
268c7e4935fSss150715 	retval = i_dlpi_msg_common(dip, &req, &ack, DL_INFO_ACK_SIZE, RS_HIPRI);
269c7e4935fSss150715 	if (retval != DLPI_SUCCESS)
270c7e4935fSss150715 		return (retval);
271c7e4935fSss150715 
272c7e4935fSss150715 	infoackp = &(ack.dlm_msg->info_ack);
273c7e4935fSss150715 	if (infoackp->dl_version != DL_VERSION_2)
274c7e4935fSss150715 		return (DLPI_EVERNOTSUP);
275c7e4935fSss150715 
276c7e4935fSss150715 	if (infoackp->dl_service_mode != DL_CLDLS)
277c7e4935fSss150715 		return (DLPI_EMODENOTSUP);
278c7e4935fSss150715 
279c7e4935fSss150715 	dip->dli_style = infoackp->dl_provider_style;
280c7e4935fSss150715 	dip->dli_mactype = infoackp->dl_mac_type;
281c7e4935fSss150715 
282c7e4935fSss150715 	ackendp = (caddr_t)ack.dlm_msg + ack.dlm_msgsz;
283c7e4935fSss150715 
284c7e4935fSss150715 	/* Check and save QoS selection information, if any. */
285c7e4935fSss150715 	datalen = infoackp->dl_qos_length;
286c7e4935fSss150715 	dataoff = infoackp->dl_qos_offset;
287c7e4935fSss150715 	if (dataoff != 0 && datalen != 0) {
288c7e4935fSss150715 		datap = (caddr_t)infoackp + dataoff;
289c7e4935fSss150715 		if (datalen > sizeof (dl_qos_cl_sel1_t) ||
290c7e4935fSss150715 		    dataoff < DL_INFO_ACK_SIZE || datap + datalen > ackendp)
291c7e4935fSss150715 			return (DLPI_EBADMSG);
292c7e4935fSss150715 
293c7e4935fSss150715 		(void) memcpy(&infop->di_qos_sel, datap, datalen);
294c7e4935fSss150715 		if (infop->di_qos_sel.dl_qos_type != DL_QOS_CL_SEL1)
295c7e4935fSss150715 			return (DLPI_EMODENOTSUP);
296c7e4935fSss150715 	}
297c7e4935fSss150715 
298c7e4935fSss150715 	/* Check and save QoS range information, if any. */
299c7e4935fSss150715 	datalen = infoackp->dl_qos_range_length;
300c7e4935fSss150715 	dataoff = infoackp->dl_qos_range_offset;
301c7e4935fSss150715 	if (dataoff != 0 && datalen != 0) {
302c7e4935fSss150715 		datap = (caddr_t)infoackp + dataoff;
303c7e4935fSss150715 		if (datalen > sizeof (dl_qos_cl_range1_t) ||
304c7e4935fSss150715 		    dataoff < DL_INFO_ACK_SIZE || datap + datalen > ackendp)
305c7e4935fSss150715 			return (DLPI_EBADMSG);
306c7e4935fSss150715 
307c7e4935fSss150715 		(void) memcpy(&infop->di_qos_range, datap, datalen);
308c7e4935fSss150715 		if (infop->di_qos_range.dl_qos_type != DL_QOS_CL_RANGE1)
309c7e4935fSss150715 			return (DLPI_EMODENOTSUP);
310c7e4935fSss150715 	}
311c7e4935fSss150715 
312c7e4935fSss150715 	/* Check and save physical address and SAP information. */
313c7e4935fSss150715 	dip->dli_saplen = abs(infoackp->dl_sap_length);
314c7e4935fSss150715 	dip->dli_sapbefore = (infoackp->dl_sap_length > 0);
315c7e4935fSss150715 	infop->di_physaddrlen = infoackp->dl_addr_length - dip->dli_saplen;
316c7e4935fSss150715 
317c7e4935fSss150715 	if (infop->di_physaddrlen > DLPI_PHYSADDR_MAX ||
318c7e4935fSss150715 	    dip->dli_saplen > DLPI_SAPLEN_MAX)
319c7e4935fSss150715 		return (DL_BADADDR);
320c7e4935fSss150715 
321c7e4935fSss150715 	dataoff = infoackp->dl_addr_offset;
322c7e4935fSss150715 	datalen = infoackp->dl_addr_length;
323c7e4935fSss150715 	if (dataoff != 0 && datalen != 0) {
324c7e4935fSss150715 		datap = (caddr_t)infoackp + dataoff;
325c7e4935fSss150715 		if (dataoff < DL_INFO_ACK_SIZE || datap + datalen > ackendp)
326c7e4935fSss150715 			return (DLPI_EBADMSG);
327c7e4935fSss150715 
328c7e4935fSss150715 		sapp = addrp = (uint8_t *)datap;
329c7e4935fSss150715 		if (dip->dli_sapbefore)
330c7e4935fSss150715 			addrp += dip->dli_saplen;
331c7e4935fSss150715 		else
332c7e4935fSss150715 			sapp += infop->di_physaddrlen;
333c7e4935fSss150715 
334c7e4935fSss150715 		(void) memcpy(infop->di_physaddr, addrp, infop->di_physaddrlen);
335c7e4935fSss150715 		infop->di_sap = i_dlpi_buildsap(sapp, dip->dli_saplen);
336c7e4935fSss150715 	}
337c7e4935fSss150715 
338c7e4935fSss150715 	/* Check and save broadcast address information, if any. */
339c7e4935fSss150715 	datalen = infoackp->dl_brdcst_addr_length;
340c7e4935fSss150715 	dataoff = infoackp->dl_brdcst_addr_offset;
341c7e4935fSss150715 	if (dataoff != 0 && datalen != 0) {
342c7e4935fSss150715 		datap = (caddr_t)infoackp + dataoff;
343c7e4935fSss150715 		if (dataoff < DL_INFO_ACK_SIZE || datap + datalen > ackendp)
344c7e4935fSss150715 			return (DLPI_EBADMSG);
345c7e4935fSss150715 		if (datalen != infop->di_physaddrlen)
346c7e4935fSss150715 			return (DL_BADADDR);
347c7e4935fSss150715 
348c7e4935fSss150715 		infop->di_bcastaddrlen = datalen;
349c7e4935fSss150715 		(void) memcpy(infop->di_bcastaddr, datap, datalen);
350c7e4935fSss150715 	}
351c7e4935fSss150715 
352c7e4935fSss150715 	infop->di_max_sdu = infoackp->dl_max_sdu;
353c7e4935fSss150715 	infop->di_min_sdu = infoackp->dl_min_sdu;
354c7e4935fSss150715 	infop->di_state = infoackp->dl_current_state;
355c7e4935fSss150715 	infop->di_mactype = infoackp->dl_mac_type;
356c7e4935fSss150715 
357c7e4935fSss150715 	/* Information retrieved from the handle. */
358c7e4935fSss150715 	(void) strlcpy(infop->di_linkname, dip->dli_linkname,
359c7e4935fSss150715 	    sizeof (infop->di_linkname));
360c7e4935fSss150715 	infop->di_timeout = dip->dli_timeout;
361c7e4935fSss150715 
362c7e4935fSss150715 	return (DLPI_SUCCESS);
363c7e4935fSss150715 }
364c7e4935fSss150715 
365c7e4935fSss150715 /*
366c7e4935fSss150715  * This function parses 'linkname' and stores the 'provider' name and 'PPA'.
367c7e4935fSss150715  */
368c7e4935fSss150715 int
369c7e4935fSss150715 dlpi_parselink(const char *linkname, char *provider, uint_t *ppa)
370c7e4935fSss150715 {
371*e7801d59Ssowmini 	dladm_status_t status;
372c7e4935fSss150715 
373*e7801d59Ssowmini 	status = dladm_parselink(linkname, provider, ppa);
374*e7801d59Ssowmini 
375*e7801d59Ssowmini 	if (status != DLADM_STATUS_OK)
376c7e4935fSss150715 		return (DLPI_ELINKNAMEINVAL);
377c7e4935fSss150715 
378c7e4935fSss150715 	return (DLPI_SUCCESS);
379c7e4935fSss150715 }
380c7e4935fSss150715 
381c7e4935fSss150715 /*
382c7e4935fSss150715  * This function takes a provider name and a PPA and stores a full linkname
383c7e4935fSss150715  * as 'linkname'. If 'provider' already is a full linkname 'provider' name
384c7e4935fSss150715  * is stored in 'linkname'.
385c7e4935fSss150715  */
386c7e4935fSss150715 int
387c7e4935fSss150715 dlpi_makelink(char *linkname, const char *provider, uint_t ppa)
388c7e4935fSss150715 {
389c7e4935fSss150715 	int provlen = strlen(provider);
390c7e4935fSss150715 
391c7e4935fSss150715 	if (linkname == NULL || provlen == 0 || provlen >= DLPI_LINKNAME_MAX)
392c7e4935fSss150715 		return (DLPI_ELINKNAMEINVAL);
393c7e4935fSss150715 
394c7e4935fSss150715 	if (!isdigit(provider[provlen - 1])) {
395c7e4935fSss150715 		(void) snprintf(linkname, DLPI_LINKNAME_MAX, "%s%d", provider,
396c7e4935fSss150715 		    ppa);
397c7e4935fSss150715 	} else {
398c7e4935fSss150715 		(void) strlcpy(linkname, provider, DLPI_LINKNAME_MAX);
399c7e4935fSss150715 	}
400c7e4935fSss150715 
401c7e4935fSss150715 	return (DLPI_SUCCESS);
402c7e4935fSss150715 }
403c7e4935fSss150715 
404c7e4935fSss150715 int
405c7e4935fSss150715 dlpi_bind(dlpi_handle_t dh, uint_t sap, uint_t *boundsap)
406c7e4935fSss150715 {
407c7e4935fSss150715 	int		retval;
408c7e4935fSss150715 	dlpi_msg_t	req, ack;
409c7e4935fSss150715 	dl_bind_req_t	*bindreqp;
410c7e4935fSss150715 	dl_bind_ack_t	*bindackp;
411c7e4935fSss150715 	dlpi_impl_t	*dip = (dlpi_impl_t *)dh;
412c7e4935fSss150715 
413c7e4935fSss150715 	if (dip == NULL)
414c7e4935fSss150715 		return (DLPI_EINHANDLE);
415c7e4935fSss150715 
416c7e4935fSss150715 	DLPI_MSG_CREATE(req, DL_BIND_REQ);
417c7e4935fSss150715 	DLPI_MSG_CREATE(ack, DL_BIND_ACK);
418c7e4935fSss150715 	bindreqp = &(req.dlm_msg->bind_req);
419c7e4935fSss150715 
420c7e4935fSss150715 	/*
421c7e4935fSss150715 	 * If 'sap' is DLPI_ANY_SAP, bind to SAP 2 on token ring, else 0 on
422c7e4935fSss150715 	 * other interface types (SAP 0 has special significance on token ring).
423c7e4935fSss150715 	 */
424c7e4935fSss150715 	if (sap == DLPI_ANY_SAP)
425c7e4935fSss150715 		bindreqp->dl_sap = ((dip->dli_mactype == DL_TPR) ? 2 : 0);
426c7e4935fSss150715 	else
427c7e4935fSss150715 		bindreqp->dl_sap = sap;
428c7e4935fSss150715 
429c7e4935fSss150715 	bindreqp->dl_service_mode = DL_CLDLS;
430c7e4935fSss150715 	bindreqp->dl_conn_mgmt = 0;
431c7e4935fSss150715 	bindreqp->dl_max_conind = 0;
432c7e4935fSss150715 	bindreqp->dl_xidtest_flg = 0;
433c7e4935fSss150715 
434c7e4935fSss150715 	retval = i_dlpi_msg_common(dip, &req, &ack, DL_BIND_ACK_SIZE, 0);
435c7e4935fSss150715 	if (retval != DLPI_SUCCESS)
436c7e4935fSss150715 		return (retval);
437c7e4935fSss150715 
438c7e4935fSss150715 	bindackp = &(ack.dlm_msg->bind_ack);
439c7e4935fSss150715 	/*
440c7e4935fSss150715 	 * Received a DLPI_BIND_ACK, now verify that the bound SAP
441c7e4935fSss150715 	 * is equal to the SAP requested. Some DLPI MAC type may bind
442c7e4935fSss150715 	 * to a different SAP than requested, in this case 'boundsap'
443c7e4935fSss150715 	 * returns the actual bound SAP. For the case where 'boundsap'
444c7e4935fSss150715 	 * is NULL and 'sap' is not DLPI_ANY_SAP, dlpi_bind fails.
445c7e4935fSss150715 	 */
446c7e4935fSss150715 	if (boundsap != NULL) {
447c7e4935fSss150715 		*boundsap = bindackp->dl_sap;
448c7e4935fSss150715 	} else if (sap != DLPI_ANY_SAP && bindackp->dl_sap != sap) {
449c7e4935fSss150715 		if (dlpi_unbind(dh) != DLPI_SUCCESS)
450c7e4935fSss150715 			return (DLPI_FAILURE);
451c7e4935fSss150715 		else
452c7e4935fSss150715 			return (DLPI_EUNAVAILSAP);
453c7e4935fSss150715 	}
454c7e4935fSss150715 
455c7e4935fSss150715 	dip->dli_sap = bindackp->dl_sap;	/* save sap value in handle */
456c7e4935fSss150715 	return (DLPI_SUCCESS);
457c7e4935fSss150715 }
458c7e4935fSss150715 
459c7e4935fSss150715 int
460c7e4935fSss150715 dlpi_unbind(dlpi_handle_t dh)
461c7e4935fSss150715 {
462c7e4935fSss150715 	dlpi_msg_t	req, ack;
463c7e4935fSss150715 	dlpi_impl_t	*dip = (dlpi_impl_t *)dh;
464c7e4935fSss150715 
465c7e4935fSss150715 	if (dip == NULL)
466c7e4935fSss150715 		return (DLPI_EINHANDLE);
467c7e4935fSss150715 
468c7e4935fSss150715 	DLPI_MSG_CREATE(req, DL_UNBIND_REQ);
469c7e4935fSss150715 	DLPI_MSG_CREATE(ack, DL_OK_ACK);
470c7e4935fSss150715 
471c7e4935fSss150715 	return (i_dlpi_msg_common(dip, &req, &ack, DL_OK_ACK_SIZE, 0));
472c7e4935fSss150715 }
473c7e4935fSss150715 
474c7e4935fSss150715 /*
475c7e4935fSss150715  * This function is invoked by dlpi_enabmulti() or dlpi_disabmulti() and
476c7e4935fSss150715  * based on the "op" value, multicast address is enabled/disabled.
477c7e4935fSss150715  */
478c7e4935fSss150715 static int
479c7e4935fSss150715 i_dlpi_multi(dlpi_handle_t dh, t_uscalar_t op, const uint8_t *addrp,
480c7e4935fSss150715     size_t addrlen)
481c7e4935fSss150715 {
482c7e4935fSss150715 	dlpi_msg_t		req, ack;
483c7e4935fSss150715 	dl_enabmulti_req_t	*multireqp;
484c7e4935fSss150715 	dlpi_impl_t		*dip = (dlpi_impl_t *)dh;
485c7e4935fSss150715 
486c7e4935fSss150715 	if (dip == NULL)
487c7e4935fSss150715 		return (DLPI_EINHANDLE);
488c7e4935fSss150715 
489c7e4935fSss150715 	if (addrlen > DLPI_PHYSADDR_MAX)
490c7e4935fSss150715 		return (DLPI_EINVAL);
491c7e4935fSss150715 
492c7e4935fSss150715 	DLPI_MSG_CREATE(req, op);
493c7e4935fSss150715 	DLPI_MSG_CREATE(ack, DL_OK_ACK);
494c7e4935fSss150715 
495c7e4935fSss150715 	multireqp = &(req.dlm_msg->enabmulti_req);
496c7e4935fSss150715 	multireqp->dl_addr_length = addrlen;
497c7e4935fSss150715 	multireqp->dl_addr_offset = sizeof (dl_enabmulti_req_t);
498c7e4935fSss150715 	(void) memcpy(&multireqp[1], addrp, addrlen);
499c7e4935fSss150715 
500c7e4935fSss150715 	return (i_dlpi_msg_common(dip, &req, &ack, DL_OK_ACK_SIZE, 0));
501c7e4935fSss150715 }
502c7e4935fSss150715 
503c7e4935fSss150715 int
504c7e4935fSss150715 dlpi_enabmulti(dlpi_handle_t dh, const void *addrp, size_t addrlen)
505c7e4935fSss150715 {
506c7e4935fSss150715 	return (i_dlpi_multi(dh, DL_ENABMULTI_REQ, addrp, addrlen));
507c7e4935fSss150715 }
508c7e4935fSss150715 
509c7e4935fSss150715 int
510c7e4935fSss150715 dlpi_disabmulti(dlpi_handle_t dh, const void *addrp, size_t addrlen)
511c7e4935fSss150715 {
512c7e4935fSss150715 	return (i_dlpi_multi(dh, DL_DISABMULTI_REQ, addrp, addrlen));
513c7e4935fSss150715 }
514c7e4935fSss150715 
515c7e4935fSss150715 /*
516c7e4935fSss150715  * This function is invoked by dlpi_promiscon() or dlpi_promiscoff(). Based
517c7e4935fSss150715  * on the value of 'op', promiscuous mode is turned on/off at the specified
518c7e4935fSss150715  * 'level'.
519c7e4935fSss150715  */
520c7e4935fSss150715 static int
521c7e4935fSss150715 i_dlpi_promisc(dlpi_handle_t dh, t_uscalar_t op, uint_t level)
522c7e4935fSss150715 {
523c7e4935fSss150715 	dlpi_msg_t		req, ack;
524c7e4935fSss150715 	dl_promiscon_req_t	*promiscreqp;
525c7e4935fSss150715 	dlpi_impl_t		*dip = (dlpi_impl_t *)dh;
526c7e4935fSss150715 
527c7e4935fSss150715 	if (dip == NULL)
528c7e4935fSss150715 		return (DLPI_EINHANDLE);
529c7e4935fSss150715 
530c7e4935fSss150715 	DLPI_MSG_CREATE(req, op);
531c7e4935fSss150715 	DLPI_MSG_CREATE(ack, DL_OK_ACK);
532c7e4935fSss150715 
533c7e4935fSss150715 	promiscreqp = &(req.dlm_msg->promiscon_req);
534c7e4935fSss150715 	promiscreqp->dl_level = level;
535c7e4935fSss150715 
536c7e4935fSss150715 	return (i_dlpi_msg_common(dip, &req, &ack, DL_OK_ACK_SIZE, 0));
537c7e4935fSss150715 }
538c7e4935fSss150715 
539c7e4935fSss150715 int
540c7e4935fSss150715 dlpi_promiscon(dlpi_handle_t dh, uint_t level)
541c7e4935fSss150715 {
542c7e4935fSss150715 	return (i_dlpi_promisc(dh, DL_PROMISCON_REQ, level));
543c7e4935fSss150715 }
544c7e4935fSss150715 
545c7e4935fSss150715 int
546c7e4935fSss150715 dlpi_promiscoff(dlpi_handle_t dh, uint_t level)
547c7e4935fSss150715 {
548c7e4935fSss150715 	return (i_dlpi_promisc(dh, DL_PROMISCOFF_REQ, level));
549c7e4935fSss150715 }
550c7e4935fSss150715 
551c7e4935fSss150715 int
552c7e4935fSss150715 dlpi_get_physaddr(dlpi_handle_t dh, uint_t type, void *addrp, size_t *addrlenp)
553c7e4935fSss150715 {
554c7e4935fSss150715 	int			retval;
555c7e4935fSss150715 	dlpi_msg_t  		req, ack;
556c7e4935fSss150715 	dl_phys_addr_req_t	*physreqp;
557c7e4935fSss150715 	dl_phys_addr_ack_t	*physackp;
558c7e4935fSss150715 	t_uscalar_t		dataoff, datalen;
559c7e4935fSss150715 	caddr_t			datap, physackendp;
560c7e4935fSss150715 	dlpi_impl_t		*dip = (dlpi_impl_t *)dh;
561c7e4935fSss150715 
562c7e4935fSss150715 	if (dip == NULL)
563c7e4935fSss150715 		return (DLPI_EINHANDLE);
564c7e4935fSss150715 
565c7e4935fSss150715 	if (addrlenp == NULL || addrp == NULL || *addrlenp < DLPI_PHYSADDR_MAX)
566c7e4935fSss150715 		return (DLPI_EINVAL);
567c7e4935fSss150715 
568c7e4935fSss150715 	DLPI_MSG_CREATE(req, DL_PHYS_ADDR_REQ);
569c7e4935fSss150715 	DLPI_MSG_CREATE(ack, DL_PHYS_ADDR_ACK);
570c7e4935fSss150715 
571c7e4935fSss150715 	physreqp = &(req.dlm_msg->physaddr_req);
572c7e4935fSss150715 	physreqp->dl_addr_type = type;
573c7e4935fSss150715 
574c7e4935fSss150715 	retval = i_dlpi_msg_common(dip, &req, &ack, DL_PHYS_ADDR_ACK_SIZE, 0);
575c7e4935fSss150715 	if (retval != DLPI_SUCCESS)
576c7e4935fSss150715 		return (retval);
577c7e4935fSss150715 
578c7e4935fSss150715 	/* Received DL_PHYS_ADDR_ACK, store the physical address and length. */
579c7e4935fSss150715 	physackp = &(ack.dlm_msg->physaddr_ack);
580c7e4935fSss150715 	physackendp = (caddr_t)ack.dlm_msg + ack.dlm_msgsz;
581c7e4935fSss150715 	dataoff = physackp->dl_addr_offset;
582c7e4935fSss150715 	datalen = physackp->dl_addr_length;
583c7e4935fSss150715 	if (dataoff != 0 && datalen != 0) {
584c7e4935fSss150715 		datap = (caddr_t)physackp + dataoff;
585c7e4935fSss150715 		if (datalen > DLPI_PHYSADDR_MAX)
586c7e4935fSss150715 			return (DL_BADADDR);
587c7e4935fSss150715 		if (dataoff < DL_PHYS_ADDR_ACK_SIZE ||
588c7e4935fSss150715 		    datap + datalen > physackendp)
589c7e4935fSss150715 			return (DLPI_EBADMSG);
590c7e4935fSss150715 
591c7e4935fSss150715 		*addrlenp = physackp->dl_addr_length;
592c7e4935fSss150715 		(void) memcpy(addrp, datap, datalen);
593c7e4935fSss150715 	} else {
594c7e4935fSss150715 		*addrlenp = datalen;
595c7e4935fSss150715 	}
596c7e4935fSss150715 
597c7e4935fSss150715 	return (DLPI_SUCCESS);
598c7e4935fSss150715 }
599c7e4935fSss150715 
600c7e4935fSss150715 int
601c7e4935fSss150715 dlpi_set_physaddr(dlpi_handle_t dh, uint_t type, const void *addrp,
602c7e4935fSss150715     size_t addrlen)
603c7e4935fSss150715 {
604c7e4935fSss150715 	dlpi_msg_t  		req, ack;
605c7e4935fSss150715 	dl_set_phys_addr_req_t	*setphysreqp;
606c7e4935fSss150715 	dlpi_impl_t		*dip = (dlpi_impl_t *)dh;
607c7e4935fSss150715 
608c7e4935fSss150715 	if (dip == NULL)
609c7e4935fSss150715 		return (DLPI_EINHANDLE);
610c7e4935fSss150715 
611c7e4935fSss150715 	if (addrp == NULL || type != DL_CURR_PHYS_ADDR ||
612c7e4935fSss150715 	    addrlen > DLPI_PHYSADDR_MAX)
613c7e4935fSss150715 		return (DLPI_EINVAL);
614c7e4935fSss150715 
615c7e4935fSss150715 	DLPI_MSG_CREATE(req, DL_SET_PHYS_ADDR_REQ);
616c7e4935fSss150715 	DLPI_MSG_CREATE(ack, DL_OK_ACK);
617c7e4935fSss150715 
618c7e4935fSss150715 	setphysreqp = &(req.dlm_msg->set_physaddr_req);
619c7e4935fSss150715 	setphysreqp->dl_addr_length = addrlen;
620c7e4935fSss150715 	setphysreqp->dl_addr_offset = sizeof (dl_set_phys_addr_req_t);
621c7e4935fSss150715 	(void) memcpy(&setphysreqp[1], addrp, addrlen);
622c7e4935fSss150715 
623c7e4935fSss150715 	return (i_dlpi_msg_common(dip, &req, &ack, DL_OK_ACK_SIZE, 0));
624c7e4935fSss150715 }
625c7e4935fSss150715 
626c7e4935fSss150715 int
627c7e4935fSss150715 dlpi_send(dlpi_handle_t dh, const void *daddrp, size_t daddrlen,
628c7e4935fSss150715     const void *msgbuf, size_t msglen, const dlpi_sendinfo_t *sendp)
629c7e4935fSss150715 {
630c7e4935fSss150715 	dlpi_msg_t		req;
631c7e4935fSss150715 	dl_unitdata_req_t	*udatareqp;
632c7e4935fSss150715 	uint_t			sap;
633c7e4935fSss150715 	dlpi_impl_t		*dip = (dlpi_impl_t *)dh;
634c7e4935fSss150715 
635c7e4935fSss150715 	if (dip == NULL)
636c7e4935fSss150715 		return (DLPI_EINHANDLE);
637c7e4935fSss150715 
638c7e4935fSss150715 	if (dip->dli_oflags & DLPI_RAW)
6393ab45760Sss150715 		return (i_dlpi_strputmsg(dip, NULL, msgbuf, msglen, 0));
640c7e4935fSss150715 
641948f2876Sss150715 	if ((daddrlen > 0 && daddrp == NULL) || daddrlen > DLPI_PHYSADDR_MAX)
642c7e4935fSss150715 		return (DLPI_EINVAL);
643c7e4935fSss150715 
644c7e4935fSss150715 	DLPI_MSG_CREATE(req, DL_UNITDATA_REQ);
645c7e4935fSss150715 	udatareqp = &(req.dlm_msg->unitdata_req);
646c7e4935fSss150715 
647c7e4935fSss150715 	/* Set priority to default priority range. */
648c7e4935fSss150715 	udatareqp->dl_priority.dl_min = 0;
649c7e4935fSss150715 	udatareqp->dl_priority.dl_max = 0;
650c7e4935fSss150715 
651c7e4935fSss150715 	/* Use SAP value if specified otherwise use bound SAP value. */
652c7e4935fSss150715 	if (sendp != NULL) {
653c7e4935fSss150715 		sap = sendp->dsi_sap;
654c7e4935fSss150715 		if (sendp->dsi_prio.dl_min != DL_QOS_DONT_CARE)
655c7e4935fSss150715 			udatareqp->dl_priority.dl_min = sendp->dsi_prio.dl_min;
656c7e4935fSss150715 		if (sendp->dsi_prio.dl_max != DL_QOS_DONT_CARE)
657c7e4935fSss150715 			udatareqp->dl_priority.dl_max = sendp->dsi_prio.dl_max;
658c7e4935fSss150715 	} else {
659c7e4935fSss150715 		sap = dip->dli_sap;
660c7e4935fSss150715 	}
661c7e4935fSss150715 
662c7e4935fSss150715 	udatareqp->dl_dest_addr_length = daddrlen + dip->dli_saplen;
663c7e4935fSss150715 	udatareqp->dl_dest_addr_offset = DL_UNITDATA_REQ_SIZE;
664c7e4935fSss150715 
665c7e4935fSss150715 	/*
666c7e4935fSss150715 	 * Since `daddrp' only has the link-layer destination address,
667c7e4935fSss150715 	 * we must prepend or append the SAP (according to dli_sapbefore)
668c7e4935fSss150715 	 * to make a full DLPI address.
669c7e4935fSss150715 	 */
670c7e4935fSss150715 	if (dip->dli_sapbefore) {
671c7e4935fSss150715 		i_dlpi_writesap(&udatareqp[1], sap, dip->dli_saplen);
672c7e4935fSss150715 		(void) memcpy((caddr_t)&udatareqp[1] + dip->dli_saplen,
673c7e4935fSss150715 		    daddrp, daddrlen);
674c7e4935fSss150715 	} else {
675c7e4935fSss150715 		(void) memcpy(&udatareqp[1], daddrp, daddrlen);
676c7e4935fSss150715 		i_dlpi_writesap((caddr_t)&udatareqp[1] + daddrlen, sap,
677c7e4935fSss150715 		    dip->dli_saplen);
678c7e4935fSss150715 	}
679c7e4935fSss150715 
6803ab45760Sss150715 	return (i_dlpi_strputmsg(dip, &req, msgbuf, msglen, 0));
681c7e4935fSss150715 }
682c7e4935fSss150715 
683c7e4935fSss150715 int
684c7e4935fSss150715 dlpi_recv(dlpi_handle_t dh, void *saddrp, size_t *saddrlenp, void *msgbuf,
685c7e4935fSss150715     size_t *msglenp, int msec, dlpi_recvinfo_t *recvp)
686c7e4935fSss150715 {
687c7e4935fSss150715 	int			retval;
688c7e4935fSss150715 	dlpi_msg_t		ind;
689c7e4935fSss150715 	size_t			totmsglen;
690c7e4935fSss150715 	dl_unitdata_ind_t	*udatap;
691c7e4935fSss150715 	t_uscalar_t		dataoff, datalen;
692c7e4935fSss150715 	caddr_t			datap, indendp;
693c7e4935fSss150715 	dlpi_impl_t		*dip = (dlpi_impl_t *)dh;
694c7e4935fSss150715 
695c7e4935fSss150715 	if (dip == NULL)
696c7e4935fSss150715 		return (DLPI_EINHANDLE);
697c7e4935fSss150715 	/*
698c7e4935fSss150715 	 * If handle is in raw mode ignore everything except total message
699c7e4935fSss150715 	 * length.
700c7e4935fSss150715 	 */
701c7e4935fSss150715 	if (dip->dli_oflags & DLPI_RAW) {
7023ab45760Sss150715 		retval = i_dlpi_strgetmsg(dip, msec, NULL, 0, 0, 0, msgbuf,
7033ab45760Sss150715 		    msglenp, &totmsglen);
704c7e4935fSss150715 
705c7e4935fSss150715 		if (retval == DLPI_SUCCESS && recvp != NULL)
706c7e4935fSss150715 			recvp->dri_totmsglen = totmsglen;
707c7e4935fSss150715 		return (retval);
708c7e4935fSss150715 	}
709c7e4935fSss150715 
710c7e4935fSss150715 	DLPI_MSG_CREATE(ind, DL_UNITDATA_IND);
711c7e4935fSss150715 	udatap = &(ind.dlm_msg->unitdata_ind);
712c7e4935fSss150715 	indendp = (caddr_t)ind.dlm_msg + ind.dlm_msgsz;
713c7e4935fSss150715 
7143ab45760Sss150715 	if ((retval = i_dlpi_strgetmsg(dip, msec, &ind, DL_UNITDATA_IND,
7153ab45760Sss150715 	    DL_UNITDATA_IND, DL_UNITDATA_IND_SIZE, msgbuf,
7163ab45760Sss150715 	    msglenp, &totmsglen)) != DLPI_SUCCESS)
717c7e4935fSss150715 		return (retval);
718c7e4935fSss150715 
719c7e4935fSss150715 	/*
720c7e4935fSss150715 	 * If DLPI link provides source address, store source address in
721c7e4935fSss150715 	 * 'saddrp' and source length in 'saddrlenp', else set saddrlenp to 0.
722c7e4935fSss150715 	 */
723c7e4935fSss150715 	if (saddrp != NULL && saddrlenp != NULL)  {
724c7e4935fSss150715 		if (*saddrlenp < DLPI_PHYSADDR_MAX)
725c7e4935fSss150715 			return (DLPI_EINVAL);
726c7e4935fSss150715 
727c7e4935fSss150715 		dataoff = udatap->dl_src_addr_offset;
728c7e4935fSss150715 		datalen = udatap->dl_src_addr_length;
729c7e4935fSss150715 		if (dataoff != 0 && datalen != 0) {
730c7e4935fSss150715 			datap = (caddr_t)udatap + dataoff;
731c7e4935fSss150715 			if (dataoff < DL_UNITDATA_IND_SIZE ||
732c7e4935fSss150715 			    datap + datalen > indendp)
733c7e4935fSss150715 				return (DLPI_EBADMSG);
734c7e4935fSss150715 
735c7e4935fSss150715 			*saddrlenp = datalen - dip->dli_saplen;
736c7e4935fSss150715 			if (*saddrlenp > DLPI_PHYSADDR_MAX)
737c7e4935fSss150715 				return (DL_BADADDR);
738c7e4935fSss150715 
739c7e4935fSss150715 			if (dip->dli_sapbefore)
740c7e4935fSss150715 				datap += dip->dli_saplen;
741c7e4935fSss150715 			(void) memcpy(saddrp, datap, *saddrlenp);
742c7e4935fSss150715 		} else {
743c7e4935fSss150715 			*saddrlenp = 0;
744c7e4935fSss150715 		}
745c7e4935fSss150715 	}
746c7e4935fSss150715 
747c7e4935fSss150715 	/*
748c7e4935fSss150715 	 * If destination address requested, check and save destination
749c7e4935fSss150715 	 * address, if any.
750c7e4935fSss150715 	 */
751c7e4935fSss150715 	if (recvp != NULL) {
752c7e4935fSss150715 		dataoff = udatap->dl_dest_addr_offset;
753c7e4935fSss150715 		datalen = udatap->dl_dest_addr_length;
754c7e4935fSss150715 		if (dataoff != 0 && datalen != 0) {
755c7e4935fSss150715 			datap = (caddr_t)udatap + dataoff;
756c7e4935fSss150715 			if (dataoff < DL_UNITDATA_IND_SIZE ||
757c7e4935fSss150715 			    datap + datalen > indendp)
758c7e4935fSss150715 				return (DLPI_EBADMSG);
759c7e4935fSss150715 
760c7e4935fSss150715 			recvp->dri_destaddrlen = datalen - dip->dli_saplen;
761c7e4935fSss150715 			if (recvp->dri_destaddrlen > DLPI_PHYSADDR_MAX)
762c7e4935fSss150715 				return (DL_BADADDR);
763c7e4935fSss150715 
764c7e4935fSss150715 			if (dip->dli_sapbefore)
765c7e4935fSss150715 				datap += dip->dli_saplen;
766c7e4935fSss150715 			(void) memcpy(recvp->dri_destaddr, datap,
767c7e4935fSss150715 			    recvp->dri_destaddrlen);
768c7e4935fSss150715 		} else {
769c7e4935fSss150715 			recvp->dri_destaddrlen = 0;
770c7e4935fSss150715 		}
771c7e4935fSss150715 
7725494fa53Sss150715 		recvp->dri_destaddrtype = udatap->dl_group_address;
773c7e4935fSss150715 		recvp->dri_totmsglen = totmsglen;
774c7e4935fSss150715 	}
775c7e4935fSss150715 
776c7e4935fSss150715 	return (DLPI_SUCCESS);
777c7e4935fSss150715 }
778c7e4935fSss150715 
779c7e4935fSss150715 int
7803ab45760Sss150715 dlpi_enabnotify(dlpi_handle_t dh, uint_t notes, dlpi_notifyfunc_t *funcp,
7813ab45760Sss150715     void *arg, dlpi_notifyid_t *id)
7823ab45760Sss150715 {
7833ab45760Sss150715 	int			retval;
7843ab45760Sss150715 	dlpi_msg_t		req, ack;
7853ab45760Sss150715 	dl_notify_req_t		*notifyreqp;
7863ab45760Sss150715 	dlpi_impl_t		*dip = (dlpi_impl_t *)dh;
7873ab45760Sss150715 	dlpi_notifyent_t	*newnotifp;
7883ab45760Sss150715 	dlpi_info_t 		dlinfo;
7893ab45760Sss150715 
7903ab45760Sss150715 	if (dip == NULL)
7913ab45760Sss150715 		return (DLPI_EINHANDLE);
7923ab45760Sss150715 
7933ab45760Sss150715 	retval = dlpi_info((dlpi_handle_t)dip, &dlinfo, 0);
7943ab45760Sss150715 	if (retval != DLPI_SUCCESS)
7953ab45760Sss150715 		return (retval);
7963ab45760Sss150715 	if (dlinfo.di_state != DL_IDLE)
7973ab45760Sss150715 		return (DL_OUTSTATE);
7983ab45760Sss150715 
7993ab45760Sss150715 	if (dip->dli_note_processing)
8003ab45760Sss150715 		return (DLPI_FAILURE);
8013ab45760Sss150715 
8023ab45760Sss150715 	if (funcp == NULL || id == NULL)
8033ab45760Sss150715 		return (DLPI_EINVAL);
8043ab45760Sss150715 
8053ab45760Sss150715 	if ((~DLPI_NOTIFICATION_TYPES & notes) ||
8063ab45760Sss150715 	    !(notes & DLPI_NOTIFICATION_TYPES))
8073ab45760Sss150715 		return (DLPI_ENOTEINVAL);
8083ab45760Sss150715 
8093ab45760Sss150715 	DLPI_MSG_CREATE(req, DL_NOTIFY_REQ);
8103ab45760Sss150715 	DLPI_MSG_CREATE(ack, DL_NOTIFY_ACK);
8113ab45760Sss150715 
8123ab45760Sss150715 	notifyreqp = &(req.dlm_msg->notify_req);
8133ab45760Sss150715 	notifyreqp->dl_notifications = notes;
8143ab45760Sss150715 	notifyreqp->dl_timelimit = 0;
8153ab45760Sss150715 
8163ab45760Sss150715 	retval = i_dlpi_msg_common(dip, &req, &ack, DL_NOTIFY_ACK_SIZE, 0);
8173ab45760Sss150715 	if (retval == DL_NOTSUPPORTED)
8183ab45760Sss150715 		return (DLPI_ENOTENOTSUP);
8193ab45760Sss150715 
8203ab45760Sss150715 	if (retval != DLPI_SUCCESS)
8213ab45760Sss150715 		return (retval);
8223ab45760Sss150715 
8233ab45760Sss150715 	if ((newnotifp = calloc(1, sizeof (dlpi_notifyent_t))) == NULL)
8243ab45760Sss150715 		return (DL_SYSERR);
8253ab45760Sss150715 
8263ab45760Sss150715 	/* Register notification information. */
8273ab45760Sss150715 	newnotifp->dln_fnp = funcp;
8283ab45760Sss150715 	newnotifp->dln_notes = notes;
8293ab45760Sss150715 	newnotifp->arg = arg;
8303ab45760Sss150715 	newnotifp->dln_rm = B_FALSE;
8313ab45760Sss150715 
8323ab45760Sss150715 	/* Insert notification node at head */
8333ab45760Sss150715 	newnotifp->dln_next = dip->dli_notifylistp;
8343ab45760Sss150715 	dip->dli_notifylistp = newnotifp;
8353ab45760Sss150715 
8363ab45760Sss150715 	*id = (dlpi_notifyid_t)newnotifp;
8373ab45760Sss150715 	return (DLPI_SUCCESS);
8383ab45760Sss150715 }
8393ab45760Sss150715 
8403ab45760Sss150715 int
8413ab45760Sss150715 dlpi_disabnotify(dlpi_handle_t dh, dlpi_notifyid_t id, void **argp)
8423ab45760Sss150715 {
8433ab45760Sss150715 	dlpi_impl_t		*dip = (dlpi_impl_t *)dh;
8443ab45760Sss150715 	dlpi_notifyent_t	*remid = (dlpi_notifyent_t *)id;
8453ab45760Sss150715 
8463ab45760Sss150715 	if (dip == NULL)
8473ab45760Sss150715 		return (DLPI_EINHANDLE);
8483ab45760Sss150715 
8493ab45760Sss150715 	/* Walk the notifyentry list to find matching id. */
8503ab45760Sss150715 	if (!(i_dlpi_notifyidexists(dip, remid)))
8513ab45760Sss150715 		return (DLPI_ENOTEIDINVAL);
8523ab45760Sss150715 
8533ab45760Sss150715 	if (argp != NULL)
8543ab45760Sss150715 		*argp = remid->arg;
8553ab45760Sss150715 
8563ab45760Sss150715 	remid->dln_rm = B_TRUE;
8573ab45760Sss150715 	/* Delete node if callbacks are not being processed. */
8583ab45760Sss150715 	if (!dip->dli_note_processing)
8593ab45760Sss150715 		i_dlpi_deletenotifyid(dip);
8603ab45760Sss150715 
8613ab45760Sss150715 	return (DLPI_SUCCESS);
8623ab45760Sss150715 }
8633ab45760Sss150715 
8643ab45760Sss150715 int
865c7e4935fSss150715 dlpi_fd(dlpi_handle_t dh)
866c7e4935fSss150715 {
867c7e4935fSss150715 	dlpi_impl_t	*dip = (dlpi_impl_t *)dh;
868c7e4935fSss150715 
869c7e4935fSss150715 	return (dip != NULL ? dip->dli_fd : -1);
870c7e4935fSss150715 }
871c7e4935fSss150715 
872c7e4935fSss150715 int
873c7e4935fSss150715 dlpi_set_timeout(dlpi_handle_t dh, int sec)
874c7e4935fSss150715 {
875c7e4935fSss150715 	dlpi_impl_t	*dip = (dlpi_impl_t *)dh;
876c7e4935fSss150715 
877c7e4935fSss150715 	if (dip == NULL)
878c7e4935fSss150715 		return (DLPI_EINHANDLE);
879c7e4935fSss150715 
880c7e4935fSss150715 	dip->dli_timeout = sec;
881c7e4935fSss150715 	return (DLPI_SUCCESS);
882c7e4935fSss150715 }
8837c478bd9Sstevel@tonic-gate 
8847c478bd9Sstevel@tonic-gate const char *
885c7e4935fSss150715 dlpi_linkname(dlpi_handle_t dh)
8867c478bd9Sstevel@tonic-gate {
887c7e4935fSss150715 	dlpi_impl_t	*dip = (dlpi_impl_t *)dh;
8887c478bd9Sstevel@tonic-gate 
889c7e4935fSss150715 	return (dip != NULL ? dip->dli_linkname : NULL);
8907c478bd9Sstevel@tonic-gate }
8917c478bd9Sstevel@tonic-gate 
892c7e4935fSss150715 /*
893c7e4935fSss150715  * Returns DLPI style stored in the handle.
894c7e4935fSss150715  * Note: This function is used for test purposes only. Do not remove without
895c7e4935fSss150715  * fixing the DLPI testsuite.
896c7e4935fSss150715  */
897c7e4935fSss150715 uint_t
898c7e4935fSss150715 dlpi_style(dlpi_handle_t dh)
8997c478bd9Sstevel@tonic-gate {
900c7e4935fSss150715 	dlpi_impl_t	*dip = (dlpi_impl_t *)dh;
9017c478bd9Sstevel@tonic-gate 
902c7e4935fSss150715 	return (dip->dli_style);
9037c478bd9Sstevel@tonic-gate }
9047c478bd9Sstevel@tonic-gate 
905948f2876Sss150715 uint_t
906948f2876Sss150715 dlpi_arptype(uint_t dlpitype)
907948f2876Sss150715 {
908948f2876Sss150715 	switch (dlpitype) {
909948f2876Sss150715 
910948f2876Sss150715 	case DL_ETHER:
911948f2876Sss150715 		return (ARPHRD_ETHER);
912948f2876Sss150715 
913948f2876Sss150715 	case DL_FRAME:
914948f2876Sss150715 		return (ARPHRD_FRAME);
915948f2876Sss150715 
916948f2876Sss150715 	case DL_ATM:
917948f2876Sss150715 		return (ARPHRD_ATM);
918948f2876Sss150715 
919948f2876Sss150715 	case DL_IPATM:
920948f2876Sss150715 		return (ARPHRD_IPATM);
921948f2876Sss150715 
922948f2876Sss150715 	case DL_HDLC:
923948f2876Sss150715 		return (ARPHRD_HDLC);
924948f2876Sss150715 
925948f2876Sss150715 	case DL_FC:
926948f2876Sss150715 		return (ARPHRD_FC);
927948f2876Sss150715 
928948f2876Sss150715 	case DL_CSMACD:				/* ieee 802 networks */
929948f2876Sss150715 	case DL_TPB:
930948f2876Sss150715 	case DL_TPR:
931948f2876Sss150715 	case DL_METRO:
932948f2876Sss150715 	case DL_FDDI:
933948f2876Sss150715 		return (ARPHRD_IEEE802);
934948f2876Sss150715 
935948f2876Sss150715 	case DL_IB:
936948f2876Sss150715 		return (ARPHRD_IB);
937948f2876Sss150715 
938948f2876Sss150715 	case DL_IPV4:
939948f2876Sss150715 	case DL_IPV6:
940948f2876Sss150715 		return (ARPHRD_TUNNEL);
941948f2876Sss150715 	}
942948f2876Sss150715 
943948f2876Sss150715 	return (0);
944948f2876Sss150715 }
945948f2876Sss150715 
946948f2876Sss150715 uint_t
947948f2876Sss150715 dlpi_iftype(uint_t dlpitype)
948948f2876Sss150715 {
949948f2876Sss150715 	switch (dlpitype) {
950948f2876Sss150715 
951948f2876Sss150715 	case DL_ETHER:
952948f2876Sss150715 		return (IFT_ETHER);
953948f2876Sss150715 
954948f2876Sss150715 	case DL_ATM:
955948f2876Sss150715 		return (IFT_ATM);
956948f2876Sss150715 
957948f2876Sss150715 	case DL_CSMACD:
958948f2876Sss150715 		return (IFT_ISO88023);
959948f2876Sss150715 
960948f2876Sss150715 	case DL_TPB:
961948f2876Sss150715 		return (IFT_ISO88024);
962948f2876Sss150715 
963948f2876Sss150715 	case DL_TPR:
964948f2876Sss150715 		return (IFT_ISO88025);
965948f2876Sss150715 
966948f2876Sss150715 	case DL_FDDI:
967948f2876Sss150715 		return (IFT_FDDI);
968948f2876Sss150715 
969948f2876Sss150715 	case DL_IB:
970948f2876Sss150715 		return (IFT_IB);
971948f2876Sss150715 
972948f2876Sss150715 	case DL_OTHER:
973948f2876Sss150715 		return (IFT_OTHER);
974948f2876Sss150715 	}
975948f2876Sss150715 
976948f2876Sss150715 	return (0);
977948f2876Sss150715 }
978948f2876Sss150715 
979c7e4935fSss150715 /*
980d62bc4baSyz147064  * This function attempts to open a device under the following namespaces:
981d62bc4baSyz147064  *      /dev/net	- if a data-link with the specified name exists
982d62bc4baSyz147064  *	/dev		- if DLPI_DEVONLY is specified, or if there is no
983d62bc4baSyz147064  *			  data-link with the specified name (could be /dev/ip)
984d62bc4baSyz147064  *
985d62bc4baSyz147064  * In particular, this function is used to open a data-link node, or some
986d62bc4baSyz147064  * special node, such as "/dev/ip" node. It is usually be called firstly
987d62bc4baSyz147064  * with style1 being B_TRUE, and if that fails and the return value is not
988d62bc4baSyz147064  * DLPI_ENOTSTYLE2, the function will again be called with style1 being
989d62bc4baSyz147064  * B_FALSE (style-1 open attempt first, then style-2 open attempt).
990d62bc4baSyz147064  *
991d62bc4baSyz147064  * If DLPI_DEVONLY is specified, both attempt will try to open the /dev node
992d62bc4baSyz147064  * directly.
993d62bc4baSyz147064  *
994d62bc4baSyz147064  * Otherwise, for style-1 attempt, the function will try to open the style-1
995d62bc4baSyz147064  * /dev/net node, and perhaps fallback to open the style-1 /dev node if the
996d62bc4baSyz147064  * give name is not a data-link name (e.g., it is /dev/ip). Note that the
997d62bc4baSyz147064  * fallback and the subsequent style-2 attempt will not happen if:
998d62bc4baSyz147064  * 1. style-1 opening of the /dev/net node succeeds;
999d62bc4baSyz147064  * 2. style-1 opening of the /dev/net node fails with errno other than ENOENT,
1000d62bc4baSyz147064  *    which means that the specific /dev/net node exist, but the attempt fails
1001d62bc4baSyz147064  *    for some other reason;
1002d62bc4baSyz147064  * 3. style-1 openning of the /dev/net fails with ENOENT, but the name is
1003d62bc4baSyz147064  *    a known device name or its VLAN PPA hack name. (for example, assuming
1004d62bc4baSyz147064  *    device bge0 is renamed to net0, opening /dev/net/bge1000 would return
1005d62bc4baSyz147064  *    ENOENT, but we should not fallback to open /dev/bge1000 in this case,
1006d62bc4baSyz147064  *    as VLAN 1 over the bge0 device should be named as net1000.
1007d62bc4baSyz147064  *
1008d62bc4baSyz147064  * DLPI_ENOTSTYLE2 will be returned in case 2 and 3 to indicate not to proceed
1009d62bc4baSyz147064  * the second style-2 open attempt.
1010c7e4935fSss150715  */
10117c478bd9Sstevel@tonic-gate static int
1012d62bc4baSyz147064 i_dlpi_open(const char *provider, int *fd, uint_t flags, boolean_t style1)
10137c478bd9Sstevel@tonic-gate {
1014c7e4935fSss150715 	char		path[MAXPATHLEN];
1015c7e4935fSss150715 	int		oflags;
1016c7e4935fSss150715 
1017d62bc4baSyz147064 	errno = ENOENT;
1018c7e4935fSss150715 	oflags = O_RDWR;
1019c7e4935fSss150715 	if (flags & DLPI_EXCL)
1020c7e4935fSss150715 		oflags |= O_EXCL;
1021c7e4935fSss150715 
1022d62bc4baSyz147064 	if (style1 && !(flags & DLPI_DEVONLY)) {
1023d62bc4baSyz147064 		char		driver[DLPI_LINKNAME_MAX];
1024d62bc4baSyz147064 		char		device[DLPI_LINKNAME_MAX];
1025d62bc4baSyz147064 		datalink_id_t	linkid;
1026d62bc4baSyz147064 		uint_t		ppa;
1027c7e4935fSss150715 
1028d62bc4baSyz147064 		/*
1029d62bc4baSyz147064 		 * This is not a valid style-1 name. It could be "ip" module
1030d62bc4baSyz147064 		 * for example. Fallback to open the /dev node.
1031d62bc4baSyz147064 		 */
1032d62bc4baSyz147064 		if (dlpi_parselink(provider, driver, &ppa) != DLPI_SUCCESS)
1033d62bc4baSyz147064 			goto fallback;
1034d62bc4baSyz147064 
1035d62bc4baSyz147064 		(void) snprintf(path, sizeof (path), "/dev/net/%s", provider);
1036c7e4935fSss150715 		if ((*fd = open(path, oflags)) != -1)
1037c7e4935fSss150715 			return (DLPI_SUCCESS);
1038c7e4935fSss150715 
1039c7e4935fSss150715 		/*
1040d62bc4baSyz147064 		 * We don't fallback to open the /dev node when it returns
1041d62bc4baSyz147064 		 * error codes other than ENOENT. In that case, DLPI_ENOTSTYLE2
1042d62bc4baSyz147064 		 * is returned to indicate not to continue the style-2 open.
1043c7e4935fSss150715 		 */
1044d62bc4baSyz147064 		if (errno != ENOENT)
1045d62bc4baSyz147064 			return (DLPI_ENOTSTYLE2);
1046c7e4935fSss150715 
1047d62bc4baSyz147064 		/*
1048d62bc4baSyz147064 		 * We didn't find the /dev/net node. Then we check whether
1049d62bc4baSyz147064 		 * the given name is a device name or its VLAN PPA hack name
1050d62bc4baSyz147064 		 * of a known link. If the answer is yes, and this link
1051d62bc4baSyz147064 		 * supports vanity naming, then the link (or the VLAN) should
1052d62bc4baSyz147064 		 * also have its /dev/net node but perhaps with another vanity
1053d62bc4baSyz147064 		 * name (for example, when bge0 is renamed to net0). In this
1054d62bc4baSyz147064 		 * case, although attempt to open the /dev/net/<devname> fails,
1055d62bc4baSyz147064 		 * we should not fallback to open the /dev/<devname> node.
1056d62bc4baSyz147064 		 */
1057d62bc4baSyz147064 		(void) snprintf(device, DLPI_LINKNAME_MAX, "%s%d", driver,
1058d62bc4baSyz147064 		    ppa >= 1000 ? ppa % 1000 : ppa);
1059d62bc4baSyz147064 
1060d62bc4baSyz147064 		if (dladm_dev2linkid(device, &linkid) == DLADM_STATUS_OK) {
1061d62bc4baSyz147064 			dladm_phys_attr_t dpa;
1062d62bc4baSyz147064 
1063d62bc4baSyz147064 			if ((dladm_phys_info(linkid, &dpa, DLADM_OPT_ACTIVE)) ==
1064d62bc4baSyz147064 			    DLADM_STATUS_OK && !dpa.dp_novanity) {
1065d62bc4baSyz147064 				return (DLPI_ENOTSTYLE2);
1066d62bc4baSyz147064 			}
1067d62bc4baSyz147064 		}
1068d62bc4baSyz147064 	}
1069d62bc4baSyz147064 
1070d62bc4baSyz147064 fallback:
1071d62bc4baSyz147064 	(void) snprintf(path, sizeof (path), "/dev/%s", provider);
1072c7e4935fSss150715 	if ((*fd = open(path, oflags)) != -1)
1073c7e4935fSss150715 		return (DLPI_SUCCESS);
1074c7e4935fSss150715 
1075c7e4935fSss150715 	return (errno == ENOENT ? DLPI_ENOLINK : DL_SYSERR);
1076c7e4935fSss150715 }
1077c7e4935fSss150715 
1078c7e4935fSss150715 /*
1079c7e4935fSss150715  * Open a style 1 link. PPA is implicitly attached.
1080c7e4935fSss150715  */
1081c7e4935fSss150715 static int
1082c7e4935fSss150715 i_dlpi_style1_open(dlpi_impl_t *dip)
1083c7e4935fSss150715 {
1084c7e4935fSss150715 	int		retval, save_errno;
1085c7e4935fSss150715 	int		fd;
1086c7e4935fSss150715 
1087c7e4935fSss150715 	/*
1088c7e4935fSss150715 	 * In order to support open of syntax like device[.module[.module...]]
1089c7e4935fSss150715 	 * where modules need to be pushed onto the device stream, open only
1090c7e4935fSss150715 	 * device name, otherwise open the full linkname.
1091c7e4935fSss150715 	 */
1092d62bc4baSyz147064 	retval = i_dlpi_open((dip->dli_mod_cnt != 0) ?
1093d62bc4baSyz147064 	    dip->dli_provider : dip->dli_linkname, &fd,
1094d62bc4baSyz147064 	    dip->dli_oflags, B_TRUE);
1095c7e4935fSss150715 
1096c7e4935fSss150715 	if (retval != DLPI_SUCCESS) {
1097c7e4935fSss150715 		dip->dli_mod_pushed = 0;
1098c7e4935fSss150715 		return (retval);
1099c7e4935fSss150715 	}
1100c7e4935fSss150715 	dip->dli_fd = fd;
1101c7e4935fSss150715 
1102c7e4935fSss150715 	/*
1103c7e4935fSss150715 	 * Try to push modules (if any) onto the device stream. If I_PUSH
1104c7e4935fSss150715 	 * fails, we increment count of modules pushed (dli_mod_pushed)
1105c7e4935fSss150715 	 * expecting it is last module to be pushed and thus will be pushed
1106c7e4935fSss150715 	 * in i_dlpi_style2_open().
1107c7e4935fSss150715 	 */
1108c7e4935fSss150715 	for (dip->dli_mod_pushed = 0; dip->dli_mod_pushed < dip->dli_mod_cnt;
1109c7e4935fSss150715 	    dip->dli_mod_pushed++) {
1110c7e4935fSss150715 		if (ioctl(fd, I_PUSH,
1111c7e4935fSss150715 		    dip->dli_modlist[dip->dli_mod_pushed]) == -1) {
1112c7e4935fSss150715 			dip->dli_mod_pushed++;
1113c7e4935fSss150715 			return (DLPI_FAILURE);
1114c7e4935fSss150715 		}
1115c7e4935fSss150715 	}
1116c7e4935fSss150715 
1117c7e4935fSss150715 	if ((retval = i_dlpi_checkstyle(dip, DL_STYLE1)) != DLPI_SUCCESS) {
1118c7e4935fSss150715 		save_errno = errno;
1119c7e4935fSss150715 		(void) close(dip->dli_fd);
1120c7e4935fSss150715 		errno = save_errno;
1121c7e4935fSss150715 		dip->dli_mod_pushed = 0;
1122c7e4935fSss150715 		return (retval);
1123c7e4935fSss150715 	}
1124c7e4935fSss150715 
1125c7e4935fSss150715 	return (DLPI_SUCCESS);
1126c7e4935fSss150715 }
1127c7e4935fSss150715 
1128c7e4935fSss150715 /*
1129c7e4935fSss150715  * Open a style 2 link. PPA must be explicitly attached.
1130c7e4935fSss150715  */
1131c7e4935fSss150715 static int
1132c7e4935fSss150715 i_dlpi_style2_open(dlpi_impl_t *dip)
1133c7e4935fSss150715 {
1134c7e4935fSss150715 	int 		fd;
1135c7e4935fSss150715 	int 		retval, save_errno;
1136c7e4935fSss150715 
1137c7e4935fSss150715 	/*
1138c7e4935fSss150715 	 * If style 1 open failed, we need to determine how far it got and
1139c7e4935fSss150715 	 * finish up the open() call as a style 2 open.
1140c7e4935fSss150715 	 *
1141c7e4935fSss150715 	 * If no modules were pushed (mod_pushed == 0), then we need to
1142c7e4935fSss150715 	 * open it as a style 2 link.
1143c7e4935fSss150715 	 *
1144c7e4935fSss150715 	 * If the pushing of the last module failed, we need to
1145c7e4935fSss150715 	 * try pushing it as a style 2 module. Decrement dli_mod_pushed
1146c7e4935fSss150715 	 * count so it can be pushed onto the stream.
1147c7e4935fSss150715 	 *
1148c7e4935fSss150715 	 * Otherwise we failed during the push of an intermediate module and
1149c7e4935fSss150715 	 * must fail out and close the link.
1150c7e4935fSss150715 	 */
1151c7e4935fSss150715 	if (dip->dli_mod_pushed == 0) {
1152c7e4935fSss150715 		if ((retval = i_dlpi_open(dip->dli_provider, &fd,
1153d62bc4baSyz147064 		    dip->dli_oflags, B_FALSE)) != DLPI_SUCCESS) {
1154c7e4935fSss150715 			return (retval);
1155d62bc4baSyz147064 		}
1156c7e4935fSss150715 		dip->dli_fd = fd;
1157c7e4935fSss150715 	} else if (dip->dli_mod_pushed == dip->dli_mod_cnt) {
1158c7e4935fSss150715 		if (i_dlpi_remove_ppa(dip->dli_modlist[dip->dli_mod_cnt - 1])
1159c7e4935fSss150715 		    != DLPI_SUCCESS)
1160c7e4935fSss150715 			return (DLPI_ELINKNAMEINVAL);
1161c7e4935fSss150715 
1162c7e4935fSss150715 		dip->dli_mod_pushed--;
1163c7e4935fSss150715 		fd = dip->dli_fd;
1164c7e4935fSss150715 	} else {
1165c7e4935fSss150715 		return (DLPI_ELINKNAMEINVAL);
1166c7e4935fSss150715 	}
1167c7e4935fSss150715 
1168c7e4935fSss150715 	/* Try and push modules (if any) onto the device stream. */
1169c7e4935fSss150715 	for (; dip->dli_mod_pushed < dip->dli_mod_cnt; dip->dli_mod_pushed++) {
1170c7e4935fSss150715 		if (ioctl(fd, I_PUSH,
1171c7e4935fSss150715 		    dip->dli_modlist[dip->dli_mod_pushed]) == -1) {
1172c7e4935fSss150715 			retval = DL_SYSERR;
1173c7e4935fSss150715 			goto failure;
1174c7e4935fSss150715 		}
1175c7e4935fSss150715 	}
1176c7e4935fSss150715 
1177c7e4935fSss150715 	/*
1178c7e4935fSss150715 	 * Special case: DLPI_SERIAL flag (synchronous serial lines) is not a
1179c7e4935fSss150715 	 * DLPI link so attach and ignore rest.
1180c7e4935fSss150715 	 */
1181c7e4935fSss150715 	if (dip->dli_oflags & DLPI_SERIAL)
1182c7e4935fSss150715 		goto attach;
1183c7e4935fSss150715 
1184c7e4935fSss150715 	if ((retval = i_dlpi_checkstyle(dip, DL_STYLE2)) != DLPI_SUCCESS)
1185c7e4935fSss150715 		goto failure;
1186c7e4935fSss150715 
1187c7e4935fSss150715 	/*
1188c7e4935fSss150715 	 * Succeeded opening the link and verified it is style2. Now attach to
1189c7e4935fSss150715 	 * PPA only if DLPI_NOATTACH is not set.
1190c7e4935fSss150715 	 */
1191c7e4935fSss150715 	if (dip->dli_oflags & DLPI_NOATTACH)
1192c7e4935fSss150715 		return (DLPI_SUCCESS);
1193c7e4935fSss150715 
1194c7e4935fSss150715 attach:
1195c7e4935fSss150715 	if ((retval = i_dlpi_attach(dip)) != DLPI_SUCCESS)
1196c7e4935fSss150715 		goto failure;
1197c7e4935fSss150715 
1198c7e4935fSss150715 	return (DLPI_SUCCESS);
1199c7e4935fSss150715 
1200c7e4935fSss150715 failure:
1201c7e4935fSss150715 	save_errno = errno;
1202c7e4935fSss150715 	(void) close(dip->dli_fd);
1203c7e4935fSss150715 	errno = save_errno;
1204c7e4935fSss150715 	return (retval);
1205c7e4935fSss150715 }
1206c7e4935fSss150715 
1207c7e4935fSss150715 /*
1208c7e4935fSss150715  * Verify with DLPI that the link is the expected DLPI 'style' device,
1209c7e4935fSss150715  * dlpi_info sets the DLPI style in the DLPI handle.
1210c7e4935fSss150715  */
1211c7e4935fSss150715 static int
1212c7e4935fSss150715 i_dlpi_checkstyle(dlpi_impl_t *dip, t_uscalar_t style)
1213c7e4935fSss150715 {
1214c7e4935fSss150715 	int retval;
1215c7e4935fSss150715 	dlpi_info_t dlinfo;
1216c7e4935fSss150715 
1217c7e4935fSss150715 	retval = dlpi_info((dlpi_handle_t)dip, &dlinfo, 0);
1218c7e4935fSss150715 	if (retval == DLPI_SUCCESS && dip->dli_style != style)
1219c7e4935fSss150715 		retval = DLPI_EBADLINK;
1220c7e4935fSss150715 
1221c7e4935fSss150715 	return (retval);
1222c7e4935fSss150715 }
1223c7e4935fSss150715 
1224c7e4935fSss150715 /*
1225c7e4935fSss150715  * Remove PPA from end of linkname.
1226c7e4935fSss150715  * Return DLPI_SUCCESS if found, else return DLPI_FAILURE.
1227c7e4935fSss150715  */
1228c7e4935fSss150715 static int
1229c7e4935fSss150715 i_dlpi_remove_ppa(char *linkname)
1230c7e4935fSss150715 {
1231c7e4935fSss150715 	int i = strlen(linkname) - 1;
1232c7e4935fSss150715 
1233c7e4935fSss150715 	if (i == -1 || !isdigit(linkname[i--]))
1234c7e4935fSss150715 		return (DLPI_FAILURE);
1235c7e4935fSss150715 
1236c7e4935fSss150715 	while (i >= 0 && isdigit(linkname[i]))
1237c7e4935fSss150715 		i--;
1238c7e4935fSss150715 
1239c7e4935fSss150715 	linkname[i + 1] = '\0';
1240c7e4935fSss150715 	return (DLPI_SUCCESS);
1241c7e4935fSss150715 }
1242c7e4935fSss150715 
1243c7e4935fSss150715 /*
1244c7e4935fSss150715  * For DLPI style 2 providers, an explicit attach of PPA is required.
1245c7e4935fSss150715  */
1246c7e4935fSss150715 static int
1247c7e4935fSss150715 i_dlpi_attach(dlpi_impl_t *dip)
1248c7e4935fSss150715 {
1249c7e4935fSss150715 	dlpi_msg_t		req, ack;
1250c7e4935fSss150715 	dl_attach_req_t		*attachreqp;
1251c7e4935fSss150715 
1252c7e4935fSss150715 	/*
1253c7e4935fSss150715 	 * Special case: DLPI_SERIAL flag (synchronous serial lines)
1254c7e4935fSss150715 	 * is not a DLPI link so ignore DLPI style.
1255c7e4935fSss150715 	 */
1256c7e4935fSss150715 	if (dip->dli_style != DL_STYLE2 && !(dip->dli_oflags & DLPI_SERIAL))
1257c7e4935fSss150715 		return (DLPI_ENOTSTYLE2);
1258c7e4935fSss150715 
1259c7e4935fSss150715 	DLPI_MSG_CREATE(req, DL_ATTACH_REQ);
1260c7e4935fSss150715 	DLPI_MSG_CREATE(ack, DL_OK_ACK);
1261c7e4935fSss150715 
1262c7e4935fSss150715 	attachreqp = &(req.dlm_msg->attach_req);
1263c7e4935fSss150715 	attachreqp->dl_ppa = dip->dli_ppa;
1264c7e4935fSss150715 
1265c7e4935fSss150715 	return (i_dlpi_msg_common(dip, &req, &ack, DL_OK_ACK_SIZE, 0));
1266c7e4935fSss150715 }
1267c7e4935fSss150715 
1268c7e4935fSss150715 /*
1269c7e4935fSss150715  * Enable DLPI passive mode on a DLPI handle. We intentionally do not care
1270c7e4935fSss150715  * if this request fails, as this indicates the underlying DLPI device does
1271c7e4935fSss150715  * not support link aggregation (pre-GLDV3 device drivers), and thus will
1272c7e4935fSss150715  * see the expected behavior without failing with DL_SYSERR/EBUSY when issuing
1273c7e4935fSss150715  * DLPI primitives like DL_BIND_REQ. For further info see dlpi(7p).
1274c7e4935fSss150715  */
1275c7e4935fSss150715 static void
1276c7e4935fSss150715 i_dlpi_passive(dlpi_impl_t *dip)
1277c7e4935fSss150715 {
1278c7e4935fSss150715 	dlpi_msg_t		req, ack;
1279c7e4935fSss150715 
1280c7e4935fSss150715 	DLPI_MSG_CREATE(req, DL_PASSIVE_REQ);
1281c7e4935fSss150715 	DLPI_MSG_CREATE(ack, DL_OK_ACK);
1282c7e4935fSss150715 
1283c7e4935fSss150715 	(void) i_dlpi_msg_common(dip, &req, &ack, DL_OK_ACK_SIZE, 0);
1284c7e4935fSss150715 }
1285c7e4935fSss150715 
1286c7e4935fSss150715 /*
1287c7e4935fSss150715  * Send a dlpi control message and/or data message on a stream. The inputs
1288c7e4935fSss150715  * for this function are:
12893ab45760Sss150715  * 	dlpi_impl_t *dip: internal dlpi handle to open stream
1290c7e4935fSss150715  *	const dlpi_msg_t *dlreqp: request message structure
1291c7e4935fSss150715  *	void *databuf:	data buffer
1292c7e4935fSss150715  *	size_t datalen:	data buffer len
1293c7e4935fSss150715  *	int flags:	flags to set for putmsg()
1294c7e4935fSss150715  * Returns DLPI_SUCCESS if putmsg() succeeds, otherwise DL_SYSERR on failure.
1295c7e4935fSss150715  */
1296c7e4935fSss150715 static int
12973ab45760Sss150715 i_dlpi_strputmsg(dlpi_impl_t *dip, const dlpi_msg_t *dlreqp,
1298c7e4935fSss150715     const void *databuf, size_t datalen, int flags)
1299c7e4935fSss150715 {
1300c7e4935fSss150715 	int		retval;
13013ab45760Sss150715 	int		fd = dip->dli_fd;
13027c478bd9Sstevel@tonic-gate 	struct strbuf	ctl;
13037c478bd9Sstevel@tonic-gate 	struct strbuf   data;
1304c7e4935fSss150715 
1305c7e4935fSss150715 	if (dlreqp != NULL) {
1306c7e4935fSss150715 		ctl.buf = (void *)dlreqp->dlm_msg;
1307c7e4935fSss150715 		ctl.len = dlreqp->dlm_msgsz;
1308c7e4935fSss150715 	}
1309c7e4935fSss150715 
1310c7e4935fSss150715 	data.buf = (void *)databuf;
1311c7e4935fSss150715 	data.len = datalen;
1312c7e4935fSss150715 
1313c7e4935fSss150715 	retval = putmsg(fd, (dlreqp == NULL ? NULL: &ctl),
1314c7e4935fSss150715 	    (databuf == NULL ? NULL : &data), flags);
1315c7e4935fSss150715 
1316c7e4935fSss150715 	return ((retval == 0) ? DLPI_SUCCESS : DL_SYSERR);
1317c7e4935fSss150715 }
1318c7e4935fSss150715 
1319c7e4935fSss150715 /*
1320c7e4935fSss150715  * Get a DLPI control message and/or data message from a stream. The inputs
1321c7e4935fSss150715  * for this function are:
13223ab45760Sss150715  * 	dlpi_impl_t *dip: 	internal dlpi handle
1323c7e4935fSss150715  * 	int msec: 		timeout to wait for message
1324c7e4935fSss150715  *	dlpi_msg_t *dlreplyp:	reply message structure, the message size
1325c7e4935fSss150715  *				member on return stores actual size received
1326c7e4935fSss150715  *	t_uscalar_t dlreqprim: 	requested primitive
1327c7e4935fSss150715  *	t_uscalar_t dlreplyprim:acknowledged primitive in response to request
1328c7e4935fSss150715  *	size_t dlreplyminsz:	minimum size of acknowledged primitive size
1329c7e4935fSss150715  *	void *databuf: 		data buffer
1330c7e4935fSss150715  *	size_t *datalenp:	data buffer len
1331c7e4935fSss150715  *	size_t *totdatalenp: 	total data received. Greater than 'datalenp' if
1332c7e4935fSss150715  *				actual data received is larger than 'databuf'
1333c7e4935fSss150715  * Function returns DLPI_SUCCESS if requested message is retrieved
13343ab45760Sss150715  * otherwise returns error code or timeouts. If a notification arrives on
13353ab45760Sss150715  * the stream the callback is notified. However, error returned during the
13363ab45760Sss150715  * handling of notification is ignored as it would be confusing to actual caller
13373ab45760Sss150715  * of this function.
1338c7e4935fSss150715  */
1339c7e4935fSss150715 static int
13403ab45760Sss150715 i_dlpi_strgetmsg(dlpi_impl_t *dip, int msec, dlpi_msg_t *dlreplyp,
13413ab45760Sss150715     t_uscalar_t dlreqprim, t_uscalar_t dlreplyprim, size_t dlreplyminsz,
13423ab45760Sss150715     void *databuf, size_t *datalenp, size_t *totdatalenp)
1343c7e4935fSss150715 {
1344c7e4935fSss150715 	int			retval;
13457c478bd9Sstevel@tonic-gate 	int			flags = 0;
13463ab45760Sss150715 	int			fd = dip->dli_fd;
1347c7e4935fSss150715 	struct strbuf		ctl, data;
1348c7e4935fSss150715 	struct pollfd		pfd;
1349c7e4935fSss150715 	hrtime_t		start, current;
1350c7e4935fSss150715 	long			bufc[DLPI_CHUNKSIZE / sizeof (long)];
1351c7e4935fSss150715 	long			bufd[DLPI_CHUNKSIZE / sizeof (long)];
1352c7e4935fSss150715 	union DL_primitives	*dlprim;
13533ab45760Sss150715 	dl_notify_ind_t		*dlnotif;
1354c7e4935fSss150715 	boolean_t		infinite = (msec < 0);	/* infinite timeout */
1355c7e4935fSss150715 
1356c7e4935fSss150715 	if ((dlreplyp == NULL && databuf == NULL) ||
1357c7e4935fSss150715 	    (databuf == NULL && datalenp != NULL) ||
1358c7e4935fSss150715 	    (databuf != NULL && datalenp == NULL))
1359c7e4935fSss150715 		return (DLPI_EINVAL);
13607c478bd9Sstevel@tonic-gate 
13617c478bd9Sstevel@tonic-gate 	pfd.fd = fd;
13627c478bd9Sstevel@tonic-gate 	pfd.events = POLLIN | POLLPRI;
13637c478bd9Sstevel@tonic-gate 
1364c7e4935fSss150715 	ctl.buf = (dlreplyp == NULL) ? bufc : (void *)dlreplyp->dlm_msg;
13657c478bd9Sstevel@tonic-gate 	ctl.len = 0;
1366c7e4935fSss150715 	ctl.maxlen = (dlreplyp == NULL) ? sizeof (bufc) : dlreplyp->dlm_msgsz;
13677c478bd9Sstevel@tonic-gate 
1368c7e4935fSss150715 	data.buf = (databuf == NULL) ? bufd : databuf;
13697c478bd9Sstevel@tonic-gate 	data.len = 0;
1370c7e4935fSss150715 	data.maxlen = (databuf == NULL) ? sizeof (bufd): *datalenp;
13717c478bd9Sstevel@tonic-gate 
1372c7e4935fSss150715 	for (;;) {
1373c7e4935fSss150715 		if (!infinite)
1374c7e4935fSss150715 			start = gethrtime() / (NANOSEC / MILLISEC);
13757c478bd9Sstevel@tonic-gate 
1376c7e4935fSss150715 		switch (poll(&pfd, 1, msec)) {
1377c7e4935fSss150715 			default:
1378948f2876Sss150715 				if (pfd.revents & POLLHUP)
1379948f2876Sss150715 					return (DL_SYSERR);
13807c478bd9Sstevel@tonic-gate 				break;
13817c478bd9Sstevel@tonic-gate 			case 0:
1382c7e4935fSss150715 				return (DLPI_ETIMEDOUT);
13837c478bd9Sstevel@tonic-gate 			case -1:
1384c7e4935fSss150715 				return (DL_SYSERR);
13857c478bd9Sstevel@tonic-gate 		}
13867c478bd9Sstevel@tonic-gate 
1387c7e4935fSss150715 		if ((retval = getmsg(fd, &ctl, &data, &flags)) < 0)
1388c7e4935fSss150715 			return (DL_SYSERR);
13897c478bd9Sstevel@tonic-gate 
1390c7e4935fSss150715 		if (totdatalenp != NULL)
1391c7e4935fSss150715 			*totdatalenp = data.len;
13927c478bd9Sstevel@tonic-gate 
13937c478bd9Sstevel@tonic-gate 		/*
1394c7e4935fSss150715 		 * The supplied DLPI_CHUNKSIZE sized buffers are large enough
1395c7e4935fSss150715 		 * to retrieve all valid DLPI responses in one iteration.
1396c7e4935fSss150715 		 * If MORECTL or MOREDATA is set, we are not interested in the
1397c7e4935fSss150715 		 * remainder of the message. Temporary buffers are used to
1398c7e4935fSss150715 		 * drain the remainder of this message.
1399c7e4935fSss150715 		 * The special case we have to account for is if
1400c7e4935fSss150715 		 * a higher priority messages is enqueued  whilst handling
1401c7e4935fSss150715 		 * this condition. We use a change in the flags parameter
1402c7e4935fSss150715 		 * returned by getmsg() to indicate the message has changed.
14037c478bd9Sstevel@tonic-gate 		 */
1404c7e4935fSss150715 		while (retval & (MORECTL | MOREDATA)) {
1405c7e4935fSss150715 			struct strbuf   cscratch, dscratch;
1406c7e4935fSss150715 			int		oflags = flags;
1407c7e4935fSss150715 
1408c7e4935fSss150715 			cscratch.buf = (char *)bufc;
1409c7e4935fSss150715 			dscratch.buf = (char *)bufd;
1410c7e4935fSss150715 			cscratch.len = dscratch.len = 0;
1411c7e4935fSss150715 			cscratch.maxlen = dscratch.maxlen =
1412c7e4935fSss150715 			    sizeof (bufc);
1413c7e4935fSss150715 
1414c7e4935fSss150715 			if ((retval = getmsg(fd, &cscratch, &dscratch,
1415c7e4935fSss150715 			    &flags)) < 0)
1416c7e4935fSss150715 				return (DL_SYSERR);
1417c7e4935fSss150715 
1418c7e4935fSss150715 			if (totdatalenp != NULL)
1419c7e4935fSss150715 				*totdatalenp += dscratch.len;
1420c7e4935fSss150715 			/*
1421c7e4935fSss150715 			 * In the special case of higher priority
1422c7e4935fSss150715 			 * message received, the low priority message
1423c7e4935fSss150715 			 * received earlier is discarded, if no data
1424c7e4935fSss150715 			 * or control message is left.
1425c7e4935fSss150715 			 */
1426c7e4935fSss150715 			if ((flags != oflags) &&
1427c7e4935fSss150715 			    !(retval & (MORECTL | MOREDATA)) &&
1428c7e4935fSss150715 			    (cscratch.len != 0)) {
1429c7e4935fSss150715 				ctl.len = MIN(cscratch.len, DLPI_CHUNKSIZE);
1430c7e4935fSss150715 				if (dlreplyp != NULL)
1431c7e4935fSss150715 					(void) memcpy(dlreplyp->dlm_msg, bufc,
1432c7e4935fSss150715 					    ctl.len);
1433c7e4935fSss150715 				break;
14347c478bd9Sstevel@tonic-gate 			}
14357c478bd9Sstevel@tonic-gate 		}
14367c478bd9Sstevel@tonic-gate 
14377c478bd9Sstevel@tonic-gate 		/*
14383ab45760Sss150715 		 * Check if DL_NOTIFY_IND message received. If there is one,
14393ab45760Sss150715 		 * notify the callback function(s) and continue processing the
14403ab45760Sss150715 		 * requested message.
14413ab45760Sss150715 		 */
14423ab45760Sss150715 		if (dip->dli_notifylistp != NULL &&
14433ab45760Sss150715 		    dlreplyp->dlm_msg->dl_primitive == DL_NOTIFY_IND) {
14443ab45760Sss150715 			if (ctl.len < DL_NOTIFY_IND_SIZE)
14453ab45760Sss150715 				continue;
14463ab45760Sss150715 			dlnotif = &(dlreplyp->dlm_msg->notify_ind);
14473ab45760Sss150715 
14483ab45760Sss150715 			(void) i_dlpi_notifyind_process(dip, dlnotif);
14493ab45760Sss150715 			continue;
14503ab45760Sss150715 		}
14513ab45760Sss150715 
14523ab45760Sss150715 		/*
1453c7e4935fSss150715 		 * If we were expecting a data message, and we got one, set
1454c7e4935fSss150715 		 * *datalenp.  If we aren't waiting on a control message, then
1455c7e4935fSss150715 		 * we're done.
14567c478bd9Sstevel@tonic-gate 		 */
1457c7e4935fSss150715 		if (databuf != NULL && data.len >= 0) {
1458c7e4935fSss150715 			*datalenp = data.len;
1459c7e4935fSss150715 			if (dlreplyp == NULL)
1460c7e4935fSss150715 				break;
14617c478bd9Sstevel@tonic-gate 		}
14627c478bd9Sstevel@tonic-gate 
14637c478bd9Sstevel@tonic-gate 		/*
1464c7e4935fSss150715 		 * If we were expecting a control message, and the message
1465c7e4935fSss150715 		 * we received is at least big enough to be a DLPI message,
1466c7e4935fSss150715 		 * then verify it's a reply to something we sent.  If it
1467c7e4935fSss150715 		 * is a reply to something we sent, also verify its size.
14687c478bd9Sstevel@tonic-gate 		 */
1469c7e4935fSss150715 		if (dlreplyp != NULL && ctl.len >= sizeof (t_uscalar_t)) {
1470c7e4935fSss150715 			dlprim = dlreplyp->dlm_msg;
1471c7e4935fSss150715 			if (dlprim->dl_primitive == dlreplyprim) {
1472c7e4935fSss150715 				if (ctl.len < dlreplyminsz)
1473c7e4935fSss150715 					return (DLPI_EBADMSG);
1474c7e4935fSss150715 				dlreplyp->dlm_msgsz = ctl.len;
1475c7e4935fSss150715 				break;
1476c7e4935fSss150715 			} else if (dlprim->dl_primitive == DL_ERROR_ACK) {
1477c7e4935fSss150715 				if (ctl.len < DL_ERROR_ACK_SIZE)
1478c7e4935fSss150715 					return (DLPI_EBADMSG);
14797c478bd9Sstevel@tonic-gate 
1480c7e4935fSss150715 				/* Is it ours? */
1481c7e4935fSss150715 				if (dlprim->error_ack.dl_error_primitive ==
1482c7e4935fSss150715 				    dlreqprim)
14837c478bd9Sstevel@tonic-gate 					break;
14847c478bd9Sstevel@tonic-gate 			}
14857c478bd9Sstevel@tonic-gate 		}
14867c478bd9Sstevel@tonic-gate 
1487c7e4935fSss150715 		if (!infinite) {
1488c7e4935fSss150715 			current = gethrtime() / (NANOSEC / MILLISEC);
1489c7e4935fSss150715 			msec -= (current - start);
14907c478bd9Sstevel@tonic-gate 
1491c7e4935fSss150715 			if (msec <= 0)
1492c7e4935fSss150715 				return (DLPI_ETIMEDOUT);
14937c478bd9Sstevel@tonic-gate 		}
14947c478bd9Sstevel@tonic-gate 	}
14957c478bd9Sstevel@tonic-gate 
1496c7e4935fSss150715 	return (DLPI_SUCCESS);
14977c478bd9Sstevel@tonic-gate }
14987c478bd9Sstevel@tonic-gate 
14997c478bd9Sstevel@tonic-gate /*
1500c7e4935fSss150715  * Common routine invoked by all DLPI control routines. The inputs for this
1501c7e4935fSss150715  * function are:
1502c7e4935fSss150715  * 	dlpi_impl_t *dip: internal dlpi handle
1503c7e4935fSss150715  *	const dlpi_msg_t *dlreqp: request message structure
1504c7e4935fSss150715  *	dlpi_msg_t *dlreplyp: reply message structure
1505c7e4935fSss150715  *	size_t dlreplyminsz: minimum size of reply primitive
1506c7e4935fSss150715  *	int flags: flags to be set to send a message
1507c7e4935fSss150715  * This routine succeeds if the message is an expected request/acknowledged
15083ab45760Sss150715  * message. However, if DLPI notification has been enabled via
15093ab45760Sss150715  * dlpi_enabnotify(), DL_NOTIFY_IND messages are handled before handling
15103ab45760Sss150715  * expected messages. Otherwise, any other unexpected asynchronous messages will
15113ab45760Sss150715  * be discarded.
15127c478bd9Sstevel@tonic-gate  */
15137c478bd9Sstevel@tonic-gate static int
1514c7e4935fSss150715 i_dlpi_msg_common(dlpi_impl_t *dip, const dlpi_msg_t *dlreqp,
1515c7e4935fSss150715     dlpi_msg_t *dlreplyp, size_t dlreplyminsz, int flags)
1516c7e4935fSss150715 {
1517c7e4935fSss150715 	int		retval;
1518c7e4935fSss150715 	t_uscalar_t	dlreqprim = dlreqp->dlm_msg->dl_primitive;
1519c7e4935fSss150715 	t_uscalar_t 	dlreplyprim = dlreplyp->dlm_msg->dl_primitive;
1520c7e4935fSss150715 
1521c7e4935fSss150715 	/* Put the requested primitive on the stream. */
15223ab45760Sss150715 	retval = i_dlpi_strputmsg(dip, dlreqp, NULL, 0, flags);
1523c7e4935fSss150715 	if (retval != DLPI_SUCCESS)
1524c7e4935fSss150715 		return (retval);
1525c7e4935fSss150715 
1526c7e4935fSss150715 	/* Retrieve acknowledged message for requested primitive. */
15273ab45760Sss150715 	retval = i_dlpi_strgetmsg(dip, (dip->dli_timeout * MILLISEC),
1528c7e4935fSss150715 	    dlreplyp, dlreqprim, dlreplyprim, dlreplyminsz, NULL, NULL, NULL);
1529c7e4935fSss150715 	if (retval != DLPI_SUCCESS)
1530c7e4935fSss150715 		return (retval);
1531c7e4935fSss150715 
1532c7e4935fSss150715 	/*
1533c7e4935fSss150715 	 * If primitive is DL_ERROR_ACK, set errno.
1534c7e4935fSss150715 	 */
1535c7e4935fSss150715 	if (dlreplyp->dlm_msg->dl_primitive == DL_ERROR_ACK) {
1536c7e4935fSss150715 		errno = dlreplyp->dlm_msg->error_ack.dl_unix_errno;
1537c7e4935fSss150715 		retval = dlreplyp->dlm_msg->error_ack.dl_errno;
1538c7e4935fSss150715 	}
1539c7e4935fSss150715 
1540c7e4935fSss150715 	return (retval);
1541c7e4935fSss150715 }
1542c7e4935fSss150715 
1543c7e4935fSss150715 /*
1544c7e4935fSss150715  * DLPI error codes.
1545c7e4935fSss150715  */
1546c7e4935fSss150715 static const char *dlpi_errlist[] = {
1547c7e4935fSss150715 	"bad LSAP selector",				/* DL_BADSAP  0x00 */
1548c7e4935fSss150715 	"DLSAP address in improper format or invalid",	/* DL_BADADDR 0x01 */
1549c7e4935fSss150715 	"improper permissions for request",		/* DL_ACCESS  0x02 */
1550c7e4935fSss150715 	"primitive issued in improper state",		/* DL_OUTSTATE 0x03 */
1551c7e4935fSss150715 	NULL,						/* DL_SYSERR  0x04 */
1552c7e4935fSss150715 	"sequence number not from outstanding DL_CONN_IND",
1553c7e4935fSss150715 							/* DL_BADCORR 0x05 */
1554c7e4935fSss150715 	"user data exceeded provider limit",		/* DL_BADDATA 0x06 */
1555c7e4935fSss150715 	"requested service not supplied by provider",
1556c7e4935fSss150715 						/* DL_UNSUPPORTED 0x07 */
1557c7e4935fSss150715 	"specified PPA was invalid", 			/* DL_BADPPA 0x08 */
1558c7e4935fSss150715 	"primitive received not known by provider",	/* DL_BADPRIM 0x09 */
1559c7e4935fSss150715 	"QoS parameters contained invalid values",
1560c7e4935fSss150715 						/* DL_BADQOSPARAM 0x0a */
1561c7e4935fSss150715 	"QoS structure type is unknown/unsupported",	/* DL_BADQOSTYPE 0x0b */
1562c7e4935fSss150715 	"token used not an active stream", 		/* DL_BADTOKEN 0x0c */
1563c7e4935fSss150715 	"attempted second bind with dl_max_conind",	/* DL_BOUND 0x0d */
1564c7e4935fSss150715 	"physical link initialization failed",		/* DL_INITFAILED 0x0e */
1565c7e4935fSss150715 	"provider couldn't allocate alternate address",	/* DL_NOADDR 0x0f */
1566c7e4935fSss150715 	"physical link not initialized",		/* DL_NOTINIT 0x10 */
1567c7e4935fSss150715 	"previous data unit could not be delivered",
1568c7e4935fSss150715 						/* DL_UNDELIVERABLE 0x11 */
1569c7e4935fSss150715 	"primitive is known but unsupported",
1570c7e4935fSss150715 						/* DL_NOTSUPPORTED 0x12 */
1571c7e4935fSss150715 	"limit exceeded",				/* DL_TOOMANY 0x13 */
1572c7e4935fSss150715 	"promiscuous mode not enabled",			/* DL_NOTENAB 0x14 */
1573c7e4935fSss150715 	"other streams for PPA in post-attached",	/* DL_BUSY 0x15 */
1574c7e4935fSss150715 	"automatic handling XID&TEST unsupported",	/* DL_NOAUTO 0x16 */
1575c7e4935fSss150715 	"automatic handling of XID unsupported",	/* DL_NOXIDAUTO 0x17 */
1576c7e4935fSss150715 	"automatic handling of TEST unsupported",	/* DL_NOTESTAUTO 0x18 */
1577c7e4935fSss150715 	"automatic handling of XID response",		/* DL_XIDAUTO 0x19 */
1578c7e4935fSss150715 	"automatic handling of TEST response", 		/* DL_TESTAUTO 0x1a */
1579c7e4935fSss150715 	"pending outstanding connect indications"	/* DL_PENDING 0x1b */
1580c7e4935fSss150715 };
1581c7e4935fSss150715 
1582c7e4935fSss150715 /*
1583c7e4935fSss150715  * libdlpi error codes.
1584c7e4935fSss150715  */
1585c7e4935fSss150715 static const char *libdlpi_errlist[] = {
1586c7e4935fSss150715 	"DLPI operation succeeded",		/* DLPI_SUCCESS */
1587c7e4935fSss150715 	"invalid argument",			/* DLPI_EINVAL */
1588c7e4935fSss150715 	"invalid DLPI linkname",		/* DLPI_ELINKNAMEINVAL */
1589c7e4935fSss150715 	"DLPI link does not exist",		/* DLPI_ENOLINK */
1590c7e4935fSss150715 	"bad DLPI link",			/* DLPI_EBADLINK */
1591c7e4935fSss150715 	"invalid DLPI handle",			/* DLPI_EINHANDLE */
1592c7e4935fSss150715 	"DLPI operation timed out",		/* DLPI_ETIMEDOUT */
1593c7e4935fSss150715 	"unsupported DLPI version",		/* DLPI_EVERNOTSUP */
1594c7e4935fSss150715 	"unsupported DLPI connection mode",	/* DLPI_EMODENOTSUP */
1595c7e4935fSss150715 	"unavailable DLPI SAP",			/* DLPI_EUNAVAILSAP */
1596c7e4935fSss150715 	"DLPI operation failed",		/* DLPI_FAILURE */
1597c7e4935fSss150715 	"DLPI style-2 node reports style-1",	/* DLPI_ENOTSTYLE2 */
1598c7e4935fSss150715 	"bad DLPI message",			/* DLPI_EBADMSG */
15993ab45760Sss150715 	"DLPI raw mode not supported",		/* DLPI_ERAWNOTSUP */
16003ab45760Sss150715 	"DLPI notification not supported by link",
16013ab45760Sss150715 						/* DLPI_ENOTENOTSUP */
16023ab45760Sss150715 	"invalid DLPI notification type",	/* DLPI_ENOTEINVAL */
16033ab45760Sss150715 	"invalid DLPI notification id"		/* DLPI_ENOTEIDINVAL */
1604c7e4935fSss150715 };
1605c7e4935fSss150715 
1606c7e4935fSss150715 const char *
1607c7e4935fSss150715 dlpi_strerror(int err)
1608c7e4935fSss150715 {
1609c7e4935fSss150715 	if (err == DL_SYSERR)
1610c7e4935fSss150715 		return (strerror(errno));
1611c7e4935fSss150715 	else if (err >= 0 && err < NELEMS(dlpi_errlist))
1612c7e4935fSss150715 		return (dgettext(TEXT_DOMAIN, dlpi_errlist[err]));
16133ab45760Sss150715 	else if (err >= DLPI_SUCCESS && err < DLPI_ERRMAX)
1614c7e4935fSss150715 		return (dgettext(TEXT_DOMAIN, libdlpi_errlist[err -
1615c7e4935fSss150715 		    DLPI_SUCCESS]));
1616c7e4935fSss150715 	else
1617c7e4935fSss150715 		return (dgettext(TEXT_DOMAIN, "Unknown DLPI error"));
1618c7e4935fSss150715 }
1619c7e4935fSss150715 
1620c7e4935fSss150715 /*
1621c7e4935fSss150715  * Each table entry comprises a DLPI/Private mactype and the description.
1622c7e4935fSss150715  */
1623c7e4935fSss150715 static const dlpi_mactype_t dlpi_mactypes[] = {
1624c7e4935fSss150715 	{ DL_CSMACD,		"CSMA/CD"		},
1625c7e4935fSss150715 	{ DL_TPB,		"Token Bus"		},
1626c7e4935fSss150715 	{ DL_TPR,		"Token Ring"		},
1627c7e4935fSss150715 	{ DL_METRO,		"Metro Net"		},
1628c7e4935fSss150715 	{ DL_ETHER,		"Ethernet"		},
1629c7e4935fSss150715 	{ DL_HDLC,		"HDLC"			},
1630c7e4935fSss150715 	{ DL_CHAR,		"Sync Character"	},
1631c7e4935fSss150715 	{ DL_CTCA,		"CTCA"			},
1632c7e4935fSss150715 	{ DL_FDDI,		"FDDI"			},
1633c7e4935fSss150715 	{ DL_FRAME,		"Frame Relay (LAPF)"	},
1634c7e4935fSss150715 	{ DL_MPFRAME,		"MP Frame Relay"	},
1635c7e4935fSss150715 	{ DL_ASYNC,		"Async Character"	},
1636c7e4935fSss150715 	{ DL_IPX25,		"X.25 (Classic IP)"	},
1637c7e4935fSss150715 	{ DL_LOOP,		"Software Loopback"	},
1638c7e4935fSss150715 	{ DL_FC,		"Fiber Channel"		},
1639c7e4935fSss150715 	{ DL_ATM,		"ATM"			},
1640c7e4935fSss150715 	{ DL_IPATM,		"ATM (Classic IP)"	},
1641c7e4935fSss150715 	{ DL_X25,		"X.25 (LAPB)"		},
1642c7e4935fSss150715 	{ DL_ISDN,		"ISDN"			},
1643c7e4935fSss150715 	{ DL_HIPPI,		"HIPPI"			},
1644c7e4935fSss150715 	{ DL_100VG,		"100BaseVG Ethernet"	},
1645c7e4935fSss150715 	{ DL_100VGTPR,		"100BaseVG Token Ring"	},
1646c7e4935fSss150715 	{ DL_ETH_CSMA,		"Ethernet/IEEE 802.3"	},
1647c7e4935fSss150715 	{ DL_100BT,		"100BaseT"		},
1648c7e4935fSss150715 	{ DL_IB,		"Infiniband"		},
1649c7e4935fSss150715 	{ DL_IPV4,		"IPv4 Tunnel"		},
1650c7e4935fSss150715 	{ DL_IPV6,		"IPv6 Tunnel"		},
1651c7e4935fSss150715 	{ DL_WIFI,		"IEEE 802.11"		}
1652c7e4935fSss150715 };
1653c7e4935fSss150715 
1654c7e4935fSss150715 const char *
1655c7e4935fSss150715 dlpi_mactype(uint_t mactype)
16567c478bd9Sstevel@tonic-gate {
16577c478bd9Sstevel@tonic-gate 	int i;
16587c478bd9Sstevel@tonic-gate 
1659c7e4935fSss150715 	for (i = 0; i < NELEMS(dlpi_mactypes); i++) {
1660c7e4935fSss150715 		if (dlpi_mactypes[i].dm_mactype == mactype)
1661c7e4935fSss150715 			return (dlpi_mactypes[i].dm_desc);
16627c478bd9Sstevel@tonic-gate 	}
16637c478bd9Sstevel@tonic-gate 
1664c7e4935fSss150715 	return ("Unknown MAC Type");
16657c478bd9Sstevel@tonic-gate }
16667c478bd9Sstevel@tonic-gate 
1667c7e4935fSss150715 /*
1668c7e4935fSss150715  * Each table entry comprises a DLPI primitive and the maximum buffer
1669c7e4935fSss150715  * size needed, in bytes, for the DLPI message (see <sys/dlpi.h> for details).
1670c7e4935fSss150715  */
1671c7e4935fSss150715 static const dlpi_primsz_t dlpi_primsizes[] = {
1672c7e4935fSss150715 { DL_INFO_REQ,		DL_INFO_REQ_SIZE				},
1673c7e4935fSss150715 { DL_INFO_ACK,		DL_INFO_ACK_SIZE + (2 * DLPI_PHYSADDR_MAX) +
1674c7e4935fSss150715 			DLPI_SAPLEN_MAX + (2 * sizeof (union DL_qos_types))},
1675c7e4935fSss150715 { DL_ATTACH_REQ,	DL_ATTACH_REQ_SIZE				},
1676c7e4935fSss150715 { DL_BIND_REQ,		DL_BIND_REQ_SIZE				},
1677c7e4935fSss150715 { DL_BIND_ACK, 		DL_BIND_ACK_SIZE + DLPI_PHYSADDR_MAX +
1678c7e4935fSss150715 			DLPI_SAPLEN_MAX					},
1679c7e4935fSss150715 { DL_UNBIND_REQ, 	DL_UNBIND_REQ_SIZE				},
1680c7e4935fSss150715 { DL_ENABMULTI_REQ, 	DL_ENABMULTI_REQ_SIZE + DLPI_PHYSADDR_MAX	},
1681c7e4935fSss150715 { DL_DISABMULTI_REQ, 	DL_DISABMULTI_REQ_SIZE + DLPI_PHYSADDR_MAX	},
1682c7e4935fSss150715 { DL_PROMISCON_REQ, 	DL_PROMISCON_REQ_SIZE				},
1683c7e4935fSss150715 { DL_PROMISCOFF_REQ,	DL_PROMISCOFF_REQ_SIZE				},
1684c7e4935fSss150715 { DL_PASSIVE_REQ, 	DL_PASSIVE_REQ_SIZE				},
1685c7e4935fSss150715 { DL_UNITDATA_REQ, 	DL_UNITDATA_REQ_SIZE + DLPI_PHYSADDR_MAX +
1686c7e4935fSss150715 			DLPI_SAPLEN_MAX					},
1687c7e4935fSss150715 { DL_UNITDATA_IND, 	DL_UNITDATA_IND_SIZE + (2 * (DLPI_PHYSADDR_MAX +
1688c7e4935fSss150715 			DLPI_SAPLEN_MAX))				},
1689c7e4935fSss150715 { DL_PHYS_ADDR_REQ, 	DL_PHYS_ADDR_REQ_SIZE				},
1690c7e4935fSss150715 { DL_PHYS_ADDR_ACK, 	DL_PHYS_ADDR_ACK_SIZE + DLPI_PHYSADDR_MAX	},
1691c7e4935fSss150715 { DL_SET_PHYS_ADDR_REQ, DL_SET_PHYS_ADDR_REQ_SIZE + DLPI_PHYSADDR_MAX	},
16923ab45760Sss150715 { DL_OK_ACK,		MAX(DL_ERROR_ACK_SIZE, DL_OK_ACK_SIZE)		},
16933ab45760Sss150715 { DL_NOTIFY_REQ,	DL_NOTIFY_REQ_SIZE				},
16943ab45760Sss150715 { DL_NOTIFY_ACK,	MAX(DL_ERROR_ACK_SIZE, DL_NOTIFY_ACK_SIZE)	},
16953ab45760Sss150715 { DL_NOTIFY_IND,	DL_NOTIFY_IND_SIZE + DLPI_PHYSADDR_MAX +
16963ab45760Sss150715 			DLPI_SAPLEN_MAX					}
1697c7e4935fSss150715 };
1698c7e4935fSss150715 
1699c7e4935fSss150715 /*
1700c7e4935fSss150715  * Refers to the dlpi_primsizes[] table to return corresponding maximum
1701c7e4935fSss150715  * buffer size.
1702c7e4935fSss150715  */
1703c7e4935fSss150715 static size_t
1704c7e4935fSss150715 i_dlpi_getprimsize(t_uscalar_t prim)
1705c7e4935fSss150715 {
1706c7e4935fSss150715 	int	i;
1707c7e4935fSss150715 
1708c7e4935fSss150715 	for (i = 0; i < NELEMS(dlpi_primsizes); i++) {
1709c7e4935fSss150715 		if (dlpi_primsizes[i].dp_prim == prim)
1710c7e4935fSss150715 			return (dlpi_primsizes[i].dp_primsz);
1711c7e4935fSss150715 	}
1712c7e4935fSss150715 
1713c7e4935fSss150715 	return (sizeof (t_uscalar_t));
1714c7e4935fSss150715 }
1715c7e4935fSss150715 
1716c7e4935fSss150715 /*
1717c7e4935fSss150715  * sap values vary in length and are in host byte order, build sap value
1718c7e4935fSss150715  * by writing saplen bytes, so that the sap value is left aligned.
1719c7e4935fSss150715  */
1720c7e4935fSss150715 static uint_t
1721c7e4935fSss150715 i_dlpi_buildsap(uint8_t *sapp, uint_t saplen)
1722c7e4935fSss150715 {
1723c7e4935fSss150715 	int i;
1724c7e4935fSss150715 	uint_t sap = 0;
1725c7e4935fSss150715 
1726c7e4935fSss150715 #ifdef _LITTLE_ENDIAN
1727c7e4935fSss150715 	for (i = saplen - 1; i >= 0; i--) {
1728c7e4935fSss150715 #else
1729c7e4935fSss150715 	for (i = 0; i < saplen; i++) {
1730c7e4935fSss150715 #endif
1731c7e4935fSss150715 		sap <<= 8;
1732c7e4935fSss150715 		sap |= sapp[i];
1733c7e4935fSss150715 	}
1734c7e4935fSss150715 
1735c7e4935fSss150715 	return (sap);
1736c7e4935fSss150715 }
1737c7e4935fSss150715 
1738c7e4935fSss150715 /*
1739c7e4935fSss150715  * Copy sap value to a buffer in host byte order. saplen is the number of
1740c7e4935fSss150715  * bytes to copy.
1741c7e4935fSss150715  */
1742c7e4935fSss150715 static void
1743c7e4935fSss150715 i_dlpi_writesap(void *dstbuf, uint_t sap, uint_t saplen)
1744c7e4935fSss150715 {
1745c7e4935fSss150715 	uint8_t *sapp;
1746c7e4935fSss150715 
1747c7e4935fSss150715 #ifdef _LITTLE_ENDIAN
1748c7e4935fSss150715 	sapp = (uint8_t *)&sap;
1749c7e4935fSss150715 #else
1750c7e4935fSss150715 	sapp = (uint8_t *)&sap + (sizeof (sap) - saplen);
1751c7e4935fSss150715 #endif
1752c7e4935fSss150715 
1753c7e4935fSss150715 	(void) memcpy(dstbuf, sapp, saplen);
17547c478bd9Sstevel@tonic-gate }
17553ab45760Sss150715 
17563ab45760Sss150715 /*
17573ab45760Sss150715  * Fill notification payload and callback each registered functions.
17583ab45760Sss150715  * Delete nodes if any was called while processing.
17593ab45760Sss150715  */
17603ab45760Sss150715 static int
17613ab45760Sss150715 i_dlpi_notifyind_process(dlpi_impl_t *dip, dl_notify_ind_t *dlnotifyindp)
17623ab45760Sss150715 {
17633ab45760Sss150715 	dlpi_notifyinfo_t	notifinfo;
17643ab45760Sss150715 	t_uscalar_t		dataoff, datalen;
17653ab45760Sss150715 	caddr_t			datap;
17663ab45760Sss150715 	dlpi_notifyent_t	*dnp;
17673ab45760Sss150715 	uint_t			note = dlnotifyindp->dl_notification;
17683ab45760Sss150715 	uint_t			deletenode = B_FALSE;
17693ab45760Sss150715 
17703ab45760Sss150715 	notifinfo.dni_note = note;
17713ab45760Sss150715 
17723ab45760Sss150715 	switch (note) {
17733ab45760Sss150715 	case DL_NOTE_SPEED:
17743ab45760Sss150715 		notifinfo.dni_speed = dlnotifyindp->dl_data;
17753ab45760Sss150715 		break;
17763ab45760Sss150715 	case DL_NOTE_SDU_SIZE:
17773ab45760Sss150715 		notifinfo.dni_size = dlnotifyindp->dl_data;
17783ab45760Sss150715 		break;
17793ab45760Sss150715 	case DL_NOTE_PHYS_ADDR:
17803ab45760Sss150715 		dataoff = dlnotifyindp->dl_addr_offset;
17813ab45760Sss150715 		datalen = dlnotifyindp->dl_addr_length;
17823ab45760Sss150715 
17833ab45760Sss150715 		if (dataoff == 0 || datalen == 0)
17843ab45760Sss150715 			return (DLPI_EBADMSG);
17853ab45760Sss150715 
17863ab45760Sss150715 		datap = (caddr_t)dlnotifyindp + dataoff;
17873ab45760Sss150715 		if (dataoff < DL_NOTIFY_IND_SIZE)
17883ab45760Sss150715 			return (DLPI_EBADMSG);
17893ab45760Sss150715 
17903ab45760Sss150715 		notifinfo.dni_physaddrlen = datalen - dip->dli_saplen;
17913ab45760Sss150715 
17923ab45760Sss150715 		if (notifinfo.dni_physaddrlen > DLPI_PHYSADDR_MAX)
17933ab45760Sss150715 			return (DL_BADADDR);
17943ab45760Sss150715 
17953ab45760Sss150715 		(void) memcpy(notifinfo.dni_physaddr, datap,
17963ab45760Sss150715 		    notifinfo.dni_physaddrlen);
17973ab45760Sss150715 		break;
17983ab45760Sss150715 	}
17993ab45760Sss150715 
18003ab45760Sss150715 	dip->dli_note_processing = B_TRUE;
18013ab45760Sss150715 
18023ab45760Sss150715 	for (dnp = dip->dli_notifylistp; dnp != NULL; dnp = dnp->dln_next) {
18033ab45760Sss150715 		if (note & dnp->dln_notes)
18043ab45760Sss150715 			dnp->dln_fnp((dlpi_handle_t)dip, &notifinfo, dnp->arg);
18053ab45760Sss150715 		if (dnp->dln_rm)
18063ab45760Sss150715 			deletenode = B_TRUE;
18073ab45760Sss150715 	}
18083ab45760Sss150715 
18093ab45760Sss150715 	dip->dli_note_processing = B_FALSE;
18103ab45760Sss150715 
18113ab45760Sss150715 	/* Walk the notifyentry list to unregister marked entries. */
18123ab45760Sss150715 	if (deletenode)
18133ab45760Sss150715 		i_dlpi_deletenotifyid(dip);
18143ab45760Sss150715 
18153ab45760Sss150715 	return (DLPI_SUCCESS);
18163ab45760Sss150715 }
18173ab45760Sss150715 /*
18183ab45760Sss150715  * Find registered notification.
18193ab45760Sss150715  */
18203ab45760Sss150715 static boolean_t
18213ab45760Sss150715 i_dlpi_notifyidexists(dlpi_impl_t *dip, dlpi_notifyent_t *id)
18223ab45760Sss150715 {
18233ab45760Sss150715 	dlpi_notifyent_t	*dnp;
18243ab45760Sss150715 
18253ab45760Sss150715 	for (dnp = dip->dli_notifylistp; dnp != NULL; dnp = dnp->dln_next) {
18263ab45760Sss150715 		if (id == dnp)
18273ab45760Sss150715 			return (B_TRUE);
18283ab45760Sss150715 	}
18293ab45760Sss150715 
18303ab45760Sss150715 	return (B_FALSE);
18313ab45760Sss150715 }
18323ab45760Sss150715 
18333ab45760Sss150715 /*
18343ab45760Sss150715  * Walk the list of notifications and deleted nodes marked to be deleted.
18353ab45760Sss150715  */
18363ab45760Sss150715 static void
18373ab45760Sss150715 i_dlpi_deletenotifyid(dlpi_impl_t *dip)
18383ab45760Sss150715 {
18393ab45760Sss150715 	dlpi_notifyent_t	 *prev, *dnp;
18403ab45760Sss150715 
18413ab45760Sss150715 	prev = NULL;
18423ab45760Sss150715 	dnp = dip->dli_notifylistp;
18433ab45760Sss150715 	while (dnp != NULL) {
18443ab45760Sss150715 		if (!dnp->dln_rm) {
18453ab45760Sss150715 			prev = dnp;
18463ab45760Sss150715 			dnp = dnp->dln_next;
18473ab45760Sss150715 		} else if (prev == NULL) {
18483ab45760Sss150715 			dip->dli_notifylistp = dnp->dln_next;
18493ab45760Sss150715 			free(dnp);
18503ab45760Sss150715 			dnp = dip->dli_notifylistp;
18513ab45760Sss150715 		} else {
18523ab45760Sss150715 			prev->dln_next = dnp->dln_next;
18533ab45760Sss150715 			free(dnp);
18543ab45760Sss150715 			dnp = prev->dln_next;
18553ab45760Sss150715 		}
18563ab45760Sss150715 	}
18573ab45760Sss150715 }
1858