xref: /titanic_53/usr/src/uts/common/io/strplumb.c (revision a9ddc71cf44cc99898f13a788230a7f50977d628)

/*
 * CDDL HEADER START
 *
 * The contents of this file are subject to the terms of the
 * Common Development and Distribution License (the "License").
 * You may not use this file except in compliance with the License.
 *
 * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE
 * or http://www.opensolaris.org/os/licensing.
 * See the License for the specific language governing permissions
 * and limitations under the License.
 *
 * When distributing Covered Code, include this CDDL HEADER in each
 * file and include the License file at usr/src/OPENSOLARIS.LICENSE.
 * If applicable, add the following below this CDDL HEADER, with the
 * fields enclosed by brackets "[]" replaced with your own identifying
 * information: Portions Copyright [yyyy] [name of copyright owner]
 *
 * CDDL HEADER END
 */
/*
 * Copyright 2007 Sun Microsystems, Inc.  All rights reserved.
 * Use is subject to license terms.
 */

#pragma ident	"%Z%%M%	%I%	%E% SMI"

#include	<sys/param.h>
#include	<sys/types.h>
#include	<sys/user.h>
#include	<sys/vfs.h>
#include	<sys/vnode.h>
#include	<sys/file.h>
#include	<sys/stream.h>
#include	<sys/stropts.h>
#include	<sys/strsubr.h>
#include	<sys/dlpi.h>
#include	<sys/vnode.h>
#include	<sys/socket.h>
#include	<sys/sockio.h>
#include	<net/if.h>

#include	<sys/cred.h>
#include	<sys/sysmacros.h>

#include	<sys/sad.h>
#include	<sys/kstr.h>
#include	<sys/bootconf.h>
#include	<sys/bootprops.h>

#include	<sys/errno.h>
#include	<sys/modctl.h>
#include	<sys/sunddi.h>
#include	<sys/sunldi.h>
#include	<sys/esunddi.h>
#include	<sys/promif.h>

#include	<netinet/in.h>
#include	<netinet/ip6.h>
#include	<netinet/icmp6.h>
#include	<netinet/sctp.h>
#include	<inet/common.h>
#include	<inet/ip.h>
#include	<inet/ip6.h>
#include	<inet/tcp.h>
#include	<inet/sctp_ip.h>

#include	<sys/strlog.h>
#include	<sys/log.h>
#include	<sys/ethernet.h>
#include	<sys/ddi_implfuncs.h>

#include	<sys/dld.h>

/*
 * Debug Macros
 */
int	strplumbdebug = 0;

#define	DBG0(_f) \
	if (strplumbdebug != 0) \
		printf("strplumb: " _f)

#define	DBG1(_f, _a) \
	if (strplumbdebug != 0) \
		printf("strplumb: " _f, (_a))

#define	DBG2(_f, _a, _b) \
	if (strplumbdebug != 0) \
		printf("strplumb: " _f, (_a), (_b))

#define	DBG3(_f, _a, _b, _c) \
	if (strplumbdebug != 0) \
		printf("strplumb: " _f, (_a), (_b), (_c))

/*
 * Module linkage information for the kernel.
 */
#define	STRPLUMB_IDENT	"STREAMS Plumbing Module v%I%"

static struct modlmisc modlmisc = {
	&mod_miscops,
	STRPLUMB_IDENT
};

static struct modlinkage modlinkage = {
	MODREV_1,
	&modlmisc,
	NULL
};

int
_init(void)
{
	return (mod_install(&modlinkage));
}

int
_fini(void)
{
	return (mod_remove(&modlinkage));
}

int
_info(struct modinfo *modinfop)
{
	return (mod_info(&modlinkage, modinfop));
}

#define	ARP		"arp"
#define	TCP		"tcp"
#define	TCP6		"tcp6"
#define	UDP		"udp"
#define	UDP6		"udp6"
#define	SCTP		"sctp"
#define	SCTP6		"sctp6"
#define	ICMP		"icmp"
#define	ICMP6		"icmp6"
#define	IP		"ip"
#define	IP6		"ip6"
#define	TIMOD		"timod"

#define	UDPDEV		"/devices/pseudo/udp@0:udp"
#define	TCP6DEV		"/devices/pseudo/tcp6@0:tcp6"
#define	SCTP6DEV	"/devices/pseudo/sctp6@0:sctp6"
#define	IP6DEV		"/devices/pseudo/ip6@0:ip6"

typedef struct strplumb_modspec {
	char	*sm_type;
	char	*sm_name;
} strplumb_modspec_t;

static strplumb_modspec_t	strplumb_modlist[] = {
	{ "drv", DLD_DRIVER_NAME },
	{ "drv", IP },
	{ "drv", IP6 },
	{ "drv", TCP },
	{ "drv", TCP6 },
	{ "drv", UDP },
	{ "drv", UDP6 },
	{ "drv", SCTP },
	{ "drv", SCTP6 },
	{ "drv", ICMP },
	{ "drv", ICMP6 },
	{ "drv", ARP },
	{ "strmod", TIMOD }
};

/*
 * Called from swapgeneric.c:loadrootmodules() in the network boot case.
 */
int
strplumb_load(void)
{
	uint_t			i;
	strplumb_modspec_t	*p;

	DBG0("loading modules\n");

	for (i = 0, p = strplumb_modlist;
	    i < sizeof (strplumb_modlist) / sizeof (strplumb_modlist[0]);
	    i++, p++) {
		if (modloadonly(p->sm_type, p->sm_name) < 0) {
			printf("strplumb: failed to load %s/%s\n",
			    p->sm_type, p->sm_name);
			return (EFAULT);
		}
	}

	return (0);
}

static int
strplumb_init(void)
{
	uint_t			i;
	strplumb_modspec_t	*p;
	int			err;

	DBG0("initializing modules\n");

	for (i = 0, p = strplumb_modlist;
	    i < sizeof (strplumb_modlist) / sizeof (strplumb_modlist[0]);
	    i++, p++) {
		if (strcmp(p->sm_type, "drv") == 0)
			err = (i_ddi_attach_pseudo_node(p->sm_name) != NULL) ?
			    0 : EFAULT;
		else
			err = (modload(p->sm_type, p->sm_name) < 0) ?
			    EFAULT : 0;

		if (err != 0)  {
			printf("strplumb: failed to initialize %s/%s\n",
			    p->sm_type, p->sm_name);
			return (err);
		}
	}

	return (0);
}

static int
strplumb_autopush(void)
{
	major_t		maj;
	minor_t		min;
	char		*mods[5];
	uint_t		anchor = 1;
	int		err;

	min = (minor_t)-1;
	mods[1] = NULL;

	/*
	 * UDP
	 */
	DBG0("setting up udp autopush\n");

	mods[0] = UDP;

	maj = ddi_name_to_major(UDP);
	if ((err = kstr_autopush(SET_AUTOPUSH, &maj, &min, NULL, &anchor,
	    mods)) != 0) {
		printf("strplumb: kstr_autopush(SET/UDP) failed: %d\n", err);
		return (err);
	}

	maj = ddi_name_to_major(UDP6);
	if ((err = kstr_autopush(SET_AUTOPUSH, &maj, &min, NULL, &anchor,
	    mods)) != 0) {
		printf("strplumb: kstr_autopush(SET/UDP6) failed: %d\n", err);
		return (err);
	}

	/*
	 * ICMP
	 */
	DBG0("setting up icmp autopush\n");

	mods[0] = ICMP;

	maj = ddi_name_to_major(ICMP);
	if ((err = kstr_autopush(SET_AUTOPUSH, &maj, &min, NULL, NULL,
	    mods)) != 0) {
		printf("strplumb: kstr_autopush(SET/ICMP) failed: %d\n", err);
		return (err);
	}

	maj = ddi_name_to_major(ICMP6);
	if ((err = kstr_autopush(SET_AUTOPUSH, &maj, &min, NULL, NULL,
	    mods)) != 0) {
		printf("strplumb: kstr_autopush(SET/ICMP6) failed: %d\n", err);
		return (err);
	}

	/*
	 * ARP
	 */
	DBG0("setting up arp autopush\n");

	mods[0] = ARP;

	maj = ddi_name_to_major(ARP);
	if ((err = kstr_autopush(SET_AUTOPUSH, &maj, &min, NULL, &anchor,
	    mods)) != 0) {
		printf("strplumb: kstr_autopush(SET/ARP) failed: %d\n", err);
		return (err);
	}

	return (0);
}

static int
strplumb_sctpq(ldi_ident_t li)
{
	ldi_handle_t	lh = NULL;
	int		err;
	int		rval;

	DBG0("configuring SCTP default queue\n");

	if ((err = ldi_open_by_name(SCTP6DEV, FREAD|FWRITE, CRED(), &lh,
	    li)) != 0) {
		printf("strplumb: open of SCTP6DEV failed: %d\n", err);
		return (err);
	}

	if ((err = ldi_ioctl(lh, SCTP_IOC_DEFAULT_Q, (intptr_t)0, FKIOCTL,
	    CRED(), &rval)) != 0) {
		printf("strplumb: failed to set SCTP default queue: %d\n",
		    err);
		(void) ldi_close(lh, FREAD|FWRITE, CRED());
		return (err);
	}

	return (0);
}

static int
strplumb_tcpq(ldi_ident_t li)
{
	ldi_handle_t	lh = NULL;
	ldi_handle_t	ip_lh = NULL;
	int		err;
	int		rval;

	DBG0("configuring TCP default queue\n");

	/*
	 * We open IP6DEV here because we need to have it open to in
	 * order to open TCP6DEV successfully.
	 */
	if ((err = ldi_open_by_name(IP6DEV, FREAD|FWRITE, CRED(), &ip_lh,
	    li)) != 0) {
		printf("strplumb: open of IP6DEV failed: %d\n", err);
		return (err);
	}

	/*
	 * We set the tcp default queue to IPv6 because IPv4 falls back to
	 * IPv6 when it can't find a client, but IPv6 does not fall back to
	 * IPv4.
	 */
	if ((err = ldi_open_by_name(TCP6DEV, FREAD|FWRITE, CRED(), &lh,
	    li)) != 0) {
		printf("strplumb: open of TCP6DEV failed: %d\n", err);
		goto done;
	}

	if ((err = ldi_ioctl(lh, TCP_IOC_DEFAULT_Q, (intptr_t)0, FKIOCTL,
	    CRED(), &rval)) != 0) {
		printf("strplumb: failed to set TCP default queue: %d\n",
		    err);
		goto done;
	}

done:
	(void) ldi_close(ip_lh, FREAD|FWRITE, CRED());
	return (err);
}

/*
 * Can be set in /etc/system in the case of local booting. See comment below.
 */
char	*ndev_name = 0;
int	ndev_unit = 0;

/*
 * If we booted diskless then strplumb() will have been called from
 * swapgeneric.c:rootconf(). All we can do in that case is plumb the
 * network device that we booted from.
 *
 * If we booted from a local disk, we will have been called from main(),
 * and normally we defer the plumbing of interfaces until network/physical.
 * This can be overridden by setting "ndev_name" in /etc/system.
 */
static int
resolve_boot_path(void)
{
	char			*devpath = NULL;
	dev_info_t		*dip;
	const char		*driver;
	int			instance;

	if (strncmp(rootfs.bo_fstype, "nfs", 3) == 0)
		devpath = rootfs.bo_name;
#ifndef __sparc
	else
		devpath = strplumb_get_netdev_path();
#endif

	if (devpath != NULL) {
		DBG1("resolving boot-path: %s\n", devpath);

		/*
		 * Hold the devi since this is the root device.
		 */
		if ((dip = e_ddi_hold_devi_by_path(devpath, 0)) == NULL) {
			printf("strplumb: unable to hold root device: %s\n",
			    devpath);
			return (ENXIO);
		}

		driver = ddi_driver_name(dip);
		instance = ddi_get_instance(dip);
	} else {
		if (ndev_name == NULL)
			return (ENODEV);

		DBG2("using ndev_name (%s) ndev_unit (%d)\n", ndev_name,
		    ndev_unit);

		if (i_ddi_attach_hw_nodes(ndev_name) != DDI_SUCCESS) {
			printf("strplumb: cannot load ndev_name '%s'\n",
			    ndev_name);
			return (ENXIO);
		}

		driver = ndev_name;
		instance = ndev_unit;
	}

	(void) snprintf(rootfs.bo_devname, BO_MAXOBJNAME,
	    "/devices/pseudo/clone@0:%s", driver);
	(void) snprintf(rootfs.bo_ifname, BO_MAXOBJNAME, "%s%d",
	    driver, instance);
	rootfs.bo_ppa = instance;
	return (0);
}

static int
getifflags(ldi_handle_t lh, struct lifreq *lifrp)
{
	struct strioctl	iocb;
	int		rval;

	iocb.ic_cmd = SIOCGLIFFLAGS;
	iocb.ic_timout = 15;
	iocb.ic_len = sizeof (struct lifreq);
	iocb.ic_dp = (char *)lifrp;

	return (ldi_ioctl(lh, I_STR, (intptr_t)&iocb, FKIOCTL, CRED(), &rval));

}

static int
setifname(ldi_handle_t lh, struct lifreq *lifrp)
{
	struct strioctl	iocb;
	int		rval;

	iocb.ic_cmd = SIOCSLIFNAME;
	iocb.ic_timout = 15;
	iocb.ic_len = sizeof (struct lifreq);
	iocb.ic_dp = (char *)lifrp;

	return (ldi_ioctl(lh, I_STR, (intptr_t)&iocb, FKIOCTL, CRED(), &rval));
}

static int
strplumb_dev(ldi_ident_t li)
{
	ldi_handle_t	lh = NULL;
	ldi_handle_t	mux_lh = NULL;
	int		err;
	struct lifreq	lifr;
	struct ifreq	ifr;
	int		rval;

	bzero(&lifr, sizeof (struct lifreq));
	bzero(&ifr, sizeof (ifr));

	/*
	 * Now set up the links. Ultimately, we should have two streams
	 * permanently linked underneath UDP (which is actually IP with UDP
	 * autopushed). One stream consists of the ARP-[ifname] combination,
	 * while the other consists of ARP-IP-[ifname]. The second combination
	 * seems a little weird, but is linked underneath UDP just to keep it
	 * around.
	 *
	 * We pin underneath UDP here to match what is done in ifconfig(1m);
	 * otherwise, ifconfig will be unable to unplumb the stream (the major
	 * number and mux id must both match for a successful I_PUNLINK).
	 *
	 * There are subtleties in the plumbing which make it essential to
	 * follow the logic used in ifconfig(1m) very closely.
	 */

	/*
	 * Plumb UDP-ARP-IP-<dev>
	 */

	if ((err = ldi_open_by_name(rootfs.bo_devname, FREAD|FWRITE, CRED(),
	    &lh, li)) != 0) {
		printf("strplumb: open %s failed: %d\n", rootfs.bo_devname,
		    err);
		goto done;
	}


	if ((err = ldi_ioctl(lh, I_PUSH, (intptr_t)IP, FKIOCTL, CRED(),
	    &rval)) != 0) {
		printf("strplumb: push IP failed: %d\n", err);
		goto done;
	}

	if ((err = getifflags(lh, &lifr)) != 0)
		goto done;

	lifr.lifr_flags |= IFF_IPV4;
	lifr.lifr_flags &= ~IFF_IPV6;

	if ((err = ldi_ioctl(lh, I_PUSH, (intptr_t)ARP, FKIOCTL, CRED(),
	    &rval)) != 0) {
		printf("strplumb: push ARP failed: %d\n", err);
		goto done;
	}

	(void) strlcpy(lifr.lifr_name, rootfs.bo_ifname,
	    sizeof (lifr.lifr_name));
	lifr.lifr_ppa = rootfs.bo_ppa;

	if ((err = setifname(lh, &lifr)) != 0)
		goto done;

	/* Get the flags and check if ARP is needed */
	if ((err = getifflags(lh, &lifr)) != 0) {
		printf("strplumb: getifflags %s IP failed, error %d\n",
		    lifr.lifr_name, err);
		goto done;
	}

	/* Pop out ARP if not needed */
	if (lifr.lifr_flags & IFF_NOARP) {
		err = ldi_ioctl(lh, I_POP, (intptr_t)0, FKIOCTL, CRED(),
		    &rval);
		if (err != 0) {
			printf("strplumb: pop ARP failed, error %d\n", err);
			goto done;
		}
	}

	if ((err = ldi_open_by_name(UDPDEV, FREAD|FWRITE, CRED(), &mux_lh,
	    li)) != 0) {
		printf("strplumb: open of UDPDEV failed: %d\n", err);
		goto done;
	}

	if ((err = ldi_ioctl(mux_lh, I_PLINK, (intptr_t)lh,
	    FREAD|FWRITE|FNOCTTY|FKIOCTL, CRED(),
	    &(ifr.ifr_ip_muxid))) != 0) {
		printf("strplumb: plink UDP-ARP-IP-%s failed: %d\n",
		    rootfs.bo_ifname, err);
		goto done;
	}

	DBG2("UDP-ARP-IP-%s muxid: %d\n", rootfs.bo_ifname, ifr.ifr_ip_muxid);

	(void) ldi_close(lh, FREAD|FWRITE, CRED());
	lh = NULL;

	/*
	 * Plumb UDP-ARP-<dev>
	 */

	if ((err = ldi_open_by_name(rootfs.bo_devname, FREAD|FWRITE, CRED(),
	    &lh, li)) != 0) {
		printf("strplumb: open %s failed: %d\n", rootfs.bo_devname,
		    err);
		goto done;
	}

	if ((err = ldi_ioctl(lh, I_PUSH, (intptr_t)ARP, FKIOCTL, CRED(),
	    &rval)) != 0) {
		printf("strplumb: push ARP failed: %d\n", err);
		goto done;
	}

	if ((err = setifname(lh, &lifr)) != 0)
		goto done;

	if ((err = ldi_ioctl(mux_lh, I_PLINK, (intptr_t)lh,
	    FREAD|FWRITE|FNOCTTY|FKIOCTL, CRED(),
	    &(ifr.ifr_arp_muxid))) != 0) {
		printf("strplumb: plink UDP-ARP-%s failed: %d\n",
		    rootfs.bo_ifname, err);
		goto done;
	}

	DBG2("UDP-ARP-%s muxid: %d\n", rootfs.bo_ifname, ifr.ifr_arp_muxid);

	/*
	 * Cache the mux ids.
	 */
	(void) strlcpy(ifr.ifr_name, rootfs.bo_ifname, sizeof (ifr.ifr_name));

	if ((err = ldi_ioctl(mux_lh, SIOCSIFMUXID, (intptr_t)&ifr, FKIOCTL,
	    CRED(), &rval)) != 0) {
		printf("strplumb: SIOCSIFMUXID failed: %d\n", err);
		goto done;
	}

done:
	if (lh != NULL)
		(void) ldi_close(lh, FREAD|FWRITE, CRED());

	if (mux_lh != NULL)
		(void) ldi_close(mux_lh, FREAD|FWRITE, CRED());

	return (err);
}

/*
 * Do streams plumbing for internet protocols.
 */
int
strplumb(void)
{
	ldi_ident_t	li;
	int		err;

	if ((err = strplumb_init()) != 0)
		return (err);

	if ((err = strplumb_autopush()) != 0)
		return (err);

	if ((err = ldi_ident_from_mod(&modlinkage, &li)) != 0)
		return (err);

	/*
	 * Setup the TCP and SCTP default queues for the global stack.
	 * tcp/sctp_stack_init will do this for additional stack instances.
	 */
	if ((err = strplumb_sctpq(li)) != 0)
		goto done;

	if ((err = strplumb_tcpq(li)) != 0)
		goto done;

	if ((err = resolve_boot_path()) != 0)
		goto done;

	DBG1("rootfs.bo_devname: %s\n", rootfs.bo_devname);
	DBG1("rootfs.bo_ifname: %s\n", rootfs.bo_ifname);
	DBG1("rootfs.bo_ppa: %d\n", rootfs.bo_ppa);

	if ((err = strplumb_dev(li)) != 0)
		goto done;

done:
	ldi_ident_release(li);

	return (err);
}

/* multiboot:  diskless boot interface discovery */

#ifndef	__sparc

static uchar_t boot_macaddr[16];
static int boot_maclen;
static uchar_t *getmacaddr(dev_info_t *dip, int *maclen);
static int matchmac(dev_info_t *dip, void *arg);
int dl_attach(ldi_handle_t lh, int unit);
int dl_bind(ldi_handle_t lh, uint_t sap, uint_t max_conn,
    uint_t service, uint_t conn_mgmt);
int dl_phys_addr(ldi_handle_t lh, struct ether_addr *eaddr);

#endif  /* !__sparc */

char *
strplumb_get_netdev_path(void)
{
#ifndef	__sparc
	char *macstr, *devpath = NULL;
	uchar_t *bootp;
	uint_t bootp_len, len;

	if (ddi_prop_lookup_string(DDI_DEV_T_ANY, ddi_root_node(),
	    DDI_PROP_DONTPASS, BP_BOOT_MAC, &macstr) == DDI_SUCCESS) {
		/*
		 * hard coded ether mac len for booting floppy on
		 * machines with old cards
		 */
		boot_maclen = ether_aton(macstr, boot_macaddr);
		if (boot_maclen != 6) {
			cmn_err(CE_WARN,
			    "malformed boot_mac property, %d bytes",
			    boot_maclen);
		}
		ddi_prop_free(macstr);
	} else if (ddi_prop_lookup_byte_array(DDI_DEV_T_ANY, ddi_root_node(),
	    DDI_PROP_DONTPASS, BP_BOOTP_RESPONSE, &bootp, &bootp_len)
	    == DDI_SUCCESS) {

		/*
		 * These offsets are defined by dhcp standard
		 * Should use structure offsets
		 */
		boot_maclen = *(bootp + 2);
		ASSERT(boot_maclen <= 16);
		(void) bcopy(bootp + 28, boot_macaddr, boot_maclen);

		/* encode to ascii string to match what sparc OBP exports */
		dhcack = kmem_zalloc(bootp_len * 2 + IFNAMSIZ + 2, KM_SLEEP);
		(void) octet_to_hexascii(bootp, bootp_len, dhcack + IFNAMSIZ,
		    &len);
		ASSERT(len < bootp_len * 2 + 2);
		ddi_prop_free(bootp);
	} else
		return (NULL);

	ddi_walk_devs(ddi_root_node(), matchmac, (void *)&devpath);
	return (devpath);

#else
	return (NULL);
#endif  /* !__sparc */
}

#ifndef __sparc

/*
 * Get boot path from the boot_mac address
 */
/*ARGSUSED*/
static int
matchmac(dev_info_t *dip, void *arg)
{
	char **devpathp = (char **)arg;
	char *model_str;
	uchar_t *macaddr;
	int maclen;

	/* XXX Should use "device-type" per IEEE 1275 */
	if (ddi_prop_lookup_string(DDI_DEV_T_ANY, dip, 0,
	    "model", &model_str) != DDI_SUCCESS)
		return (DDI_WALK_CONTINUE);

	if (strcmp(model_str, "Ethernet controller") != 0) {
		ddi_prop_free(model_str);
		return (DDI_WALK_CONTINUE);
	}
	ddi_prop_free(model_str);

	/* We have a network device now */
	if (i_ddi_attach_node_hierarchy(dip) != DDI_SUCCESS) {
		return (DDI_WALK_CONTINUE);
	}

	ASSERT(boot_maclen != 0);
	macaddr = getmacaddr(dip, &maclen);
	if (macaddr == NULL)
		return (DDI_WALK_CONTINUE);

	if (maclen != boot_maclen ||
	    bcmp(macaddr, boot_macaddr, maclen) != 0) {
		kmem_free(macaddr, maclen);
		return (DDI_WALK_CONTINUE);
	}

	/* found hardware with the mac address */
	(void) localetheraddr((struct ether_addr *)macaddr, NULL);
	kmem_free(macaddr, maclen);

	*devpathp = kmem_alloc(MAXPATHLEN, KM_SLEEP);
	(void) ddi_pathname(dip, *devpathp);

	/* fill in the name portion of dhcack */
	if (dhcack)
		(void) snprintf(dhcack, IFNAMSIZ, "%s%d",
		    ddi_driver_name(dip), i_ddi_devi_get_ppa(dip));
	return (DDI_WALK_TERMINATE);
}

static uchar_t *
getmacaddr_gldv3(char *drv, int inst, int *maclenp)
{
	char ifname[16];
	mac_handle_t mh;
	uchar_t *macaddr;

	(void) snprintf(ifname, sizeof (ifname), "%s%d", drv, inst);
	if (mac_open(ifname, inst, &mh) < 0) {
		return (NULL);
	}
	*maclenp = sizeof (struct ether_addr);
	macaddr = kmem_alloc(*maclenp, KM_SLEEP);
	mac_unicst_get(mh, macaddr);
	mac_close(mh);

	return (macaddr);
}

static uchar_t *
getmacaddr(dev_info_t *dip, int *maclenp)
{
	int rc, ppa;
	ldi_ident_t li;
	ldi_handle_t lh;
	char *drv_name = (char *)ddi_driver_name(dip);
	char *clonepath;
	uchar_t *macaddr = NULL;

	/* a simpler way to get mac address for GLDv3 drivers */
	if (GLDV3_DRV(ddi_name_to_major(drv_name))) {
		return (getmacaddr_gldv3(drv_name, ddi_get_instance(dip),
		    maclenp));
	}

	if (rc = ldi_ident_from_mod(&modlinkage, &li)) {
		cmn_err(CE_WARN,
		    "getmacaddr: ldi_ident_from_mod failed: %d\n", rc);
		return (NULL);
	}

	clonepath = kmem_alloc(MAXPATHLEN, KM_SLEEP);
	(void) snprintf(clonepath, MAXPATHLEN,
	    "/devices/pseudo/clone@0:%s", drv_name);

	rc = ldi_open_by_name(clonepath, FREAD|FWRITE, CRED(), &lh, li);
	ldi_ident_release(li);
	if (rc) {
		cmn_err(CE_WARN,
		    "getmacaddr: ldi_open_by_name(%s) failed: %d\n",
		    clonepath, rc);
		kmem_free(clonepath, MAXPATHLEN);
		return (NULL);
	}
	kmem_free(clonepath, MAXPATHLEN);

	ppa = i_ddi_devi_get_ppa(dip);
	if ((dl_attach(lh, ppa) != 0) ||
	    (dl_bind(lh, ETHERTYPE_IP, 0, DL_CLDLS, 0) != 0)) {
		(void) ldi_close(lh, FREAD|FWRITE, CRED());
		cmn_err(CE_WARN,
		    "getmacaddr: dl_attach/bind(%s%d) failed: %d\n",
		    drv_name, ppa, rc);
		return (NULL);
	}
	*maclenp = sizeof (struct ether_addr);
	macaddr = kmem_alloc(*maclenp, KM_SLEEP);
	if (dl_phys_addr(lh, (struct ether_addr *)macaddr) != 0) {
		kmem_free(macaddr, *maclenp);
		macaddr = NULL;
		*maclenp = 0;
		cmn_err(CE_WARN,
		    "getmacaddr: dl_macaddr(%s%d) failed: %d\n",
		    drv_name, ppa, rc);
	}
	(void) ldi_close(lh, FREAD|FWRITE, CRED());
	return (macaddr);
}

#endif	/* !__sparc */

int
dl_attach(ldi_handle_t lh, int unit)
{
	dl_attach_req_t *attach_req;
	dl_error_ack_t *error_ack;
	union DL_primitives *dl_prim;
	mblk_t *mp;
	int error;

	if ((mp = allocb(sizeof (dl_attach_req_t), BPRI_MED)) == NULL) {
		cmn_err(CE_WARN, "dl_attach: allocb failed");
		return (ENOSR);
	}
	mp->b_datap->db_type = M_PROTO;
	mp->b_wptr += sizeof (dl_attach_req_t);

	attach_req = (dl_attach_req_t *)mp->b_rptr;
	attach_req->dl_primitive = DL_ATTACH_REQ;
	attach_req->dl_ppa = unit;

	(void) ldi_putmsg(lh, mp);
	if ((error = ldi_getmsg(lh, &mp, (timestruc_t *)NULL)) != 0) {
		printf("dl_attach: ldi_getmsg failed: %d\n", error);
		return (error);
	}

	dl_prim = (union DL_primitives *)mp->b_rptr;
	switch (dl_prim->dl_primitive) {
	case DL_OK_ACK:
		if ((mp->b_wptr-mp->b_rptr) < sizeof (dl_ok_ack_t)) {
			printf("dl_attach: DL_OK_ACK protocol error\n");
			break;
		}
		if (((dl_ok_ack_t *)dl_prim)->dl_correct_primitive !=
		    DL_ATTACH_REQ) {
			printf("dl_attach: DL_OK_ACK rtnd prim %u\n",
			    ((dl_ok_ack_t *)dl_prim)->dl_correct_primitive);
			break;
		}
		freemsg(mp);
		return (0);

	case DL_ERROR_ACK:
		if ((mp->b_wptr-mp->b_rptr) < sizeof (dl_error_ack_t)) {
			printf("dl_attach: DL_ERROR_ACK protocol error\n");
			break;
		}

		error_ack = (dl_error_ack_t *)dl_prim;
		switch (error_ack->dl_errno) {
		case DL_BADPPA:
			printf("dl_attach: DL_ERROR_ACK bad PPA\n");
			break;

		case DL_ACCESS:
			printf("dl_attach: DL_ERROR_ACK access error\n");
			break;

		default:
			printf("dl_attach: DLPI error %u\n",
			    error_ack->dl_errno);
			break;
		}
		break;

	default:
		printf("dl_attach: bad ACK header %u\n", dl_prim->dl_primitive);
		break;
	}

	/*
	 * Error return only.
	 */
	freemsg(mp);
	return (-1);
}

int
dl_bind(ldi_handle_t lh, uint_t sap, uint_t max_conn, uint_t service,
	uint_t conn_mgmt)
{
	dl_bind_req_t *bind_req;
	dl_error_ack_t *error_ack;
	union DL_primitives *dl_prim;
	mblk_t *mp;
	int error;

	if ((mp = allocb(sizeof (dl_bind_req_t), BPRI_MED)) == NULL) {
		cmn_err(CE_WARN, "dl_bind: allocb failed");
		return (ENOSR);
	}
	mp->b_datap->db_type = M_PROTO;

	bind_req = (dl_bind_req_t *)mp->b_wptr;
	mp->b_wptr += sizeof (dl_bind_req_t);
	bind_req->dl_primitive = DL_BIND_REQ;
	bind_req->dl_sap = sap;
	bind_req->dl_max_conind = max_conn;
	bind_req->dl_service_mode = service;
	bind_req->dl_conn_mgmt = conn_mgmt;
	bind_req->dl_xidtest_flg = 0;

	(void) ldi_putmsg(lh, mp);
	if ((error = ldi_getmsg(lh, &mp, (timestruc_t *)NULL)) != 0) {
		printf("dl_bind: ldi_getmsg failed: %d\n", error);
		return (error);
	}

	dl_prim = (union DL_primitives *)mp->b_rptr;
	switch (dl_prim->dl_primitive) {
	case DL_BIND_ACK:
		if ((mp->b_wptr-mp->b_rptr) < sizeof (dl_bind_ack_t)) {
			printf("dl_bind: DL_BIND_ACK protocol error\n");
			break;
		}
		if (((dl_bind_ack_t *)dl_prim)->dl_sap != sap) {
			printf("dl_bind: DL_BIND_ACK bad sap %u\n",
			    ((dl_bind_ack_t *)dl_prim)->dl_sap);
			break;
		}
		freemsg(mp);
		return (0);

	case DL_ERROR_ACK:
		if ((mp->b_wptr-mp->b_rptr) < sizeof (dl_error_ack_t)) {
			printf("dl_bind: DL_ERROR_ACK protocol error\n");
			break;
		}

		error_ack = (dl_error_ack_t *)dl_prim;
		printf("dl_bind: DLPI error %u\n", error_ack->dl_errno);
		break;

	default:
		printf("dl_bind: bad ACK header %u\n", dl_prim->dl_primitive);
		break;
	}

	/*
	 * Error return only.
	 */
	freemsg(mp);
	return (-1);
}

int
dl_phys_addr(ldi_handle_t lh, struct ether_addr *eaddr)
{
	dl_phys_addr_req_t *phys_addr_req;
	dl_phys_addr_ack_t *phys_addr_ack;
	dl_error_ack_t *error_ack;
	union DL_primitives *dl_prim;
	mblk_t *mp;
	int error;
	uchar_t *addrp;
	timestruc_t tv;

	if ((mp = allocb(sizeof (dl_phys_addr_req_t), BPRI_MED)) ==
	    (mblk_t *)NULL) {
		cmn_err(CE_WARN, "dl_phys_addr: allocb failed");
		return (ENOSR);
	}
	mp->b_datap->db_type = M_PROTO;
	mp->b_wptr += sizeof (dl_phys_addr_req_t);

	phys_addr_req = (dl_phys_addr_req_t *)mp->b_rptr;
	phys_addr_req->dl_primitive = DL_PHYS_ADDR_REQ;
	phys_addr_req->dl_addr_type = DL_CURR_PHYS_ADDR;

	/*
	 * In case some provider doesn't implement or nack the
	 * request just wait for 15 seconds.
	 */
	tv.tv_sec = 15;
	tv.tv_nsec = 0;

	(void) ldi_putmsg(lh, mp);
	error = ldi_getmsg(lh, &mp, &tv);
	if (error == ETIME) {
		printf("dl_phys_addr: timed out\n");
		return (-1);
	} else if (error != 0) {
		printf("dl_phys_addr: ldi_getmsg failed: %d\n", error);
		return (error);
	}

	dl_prim = (union DL_primitives *)mp->b_rptr;
	switch (dl_prim->dl_primitive) {
	case DL_PHYS_ADDR_ACK:
		if ((mp->b_wptr-mp->b_rptr) < sizeof (dl_phys_addr_ack_t)) {
			printf("dl_phys_addr: "
				"DL_PHYS_ADDR_ACK protocol error\n");
			break;
		}
		phys_addr_ack = &dl_prim->physaddr_ack;
		if (phys_addr_ack->dl_addr_length != sizeof (*eaddr)) {
			printf("dl_phys_addr: DL_PHYS_ADDR_ACK bad len %u\n",
				phys_addr_ack->dl_addr_length);
			break;
		}
		if (phys_addr_ack->dl_addr_length +
		    phys_addr_ack->dl_addr_offset > (mp->b_wptr-mp->b_rptr)) {
			printf("dl_phys_addr: DL_PHYS_ADDR_ACK bad len %u\n",
				phys_addr_ack->dl_addr_length);
			break;
		}
		addrp = mp->b_rptr + phys_addr_ack->dl_addr_offset;
		bcopy(addrp, eaddr, sizeof (*eaddr));
		freemsg(mp);
		return (0);

	case DL_ERROR_ACK:
		if ((mp->b_wptr-mp->b_rptr) < sizeof (dl_error_ack_t)) {
			printf("dl_phys_addr: DL_ERROR_ACK protocol error\n");
			break;
		}

		error_ack = (dl_error_ack_t *)dl_prim;
		printf("dl_phys_addr: DLPI error %u\n",
		    error_ack->dl_errno);
		break;

	default:
		printf("dl_phys_addr: bad ACK header %u\n",
			dl_prim->dl_primitive);
		break;
	}

	/*
	 * Error return only.
	 */
	freemsg(mp);
	return (-1);
}