[unix-history] / usr / src / sys / net / if.c

/*
 * Copyright (c) 1980, 1986 Regents of the University of California.
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms are permitted
 * provided that the above copyright notice and this paragraph are
 * duplicated in all such forms and that any documentation,
 * advertising materials, and other materials related to such
 * distribution and use acknowledge that the software was developed
 * by the University of California, Berkeley.  The name of the
 * University may not be used to endorse or promote products derived
 * from this software without specific prior written permission.
 * THIS SOFTWARE IS PROVIDED ``AS IS'' AND WITHOUT ANY EXPRESS OR
 * IMPLIED WARRANTIES, INCLUDING, WITHOUT LIMITATION, THE IMPLIED
 * WARRANTIES OF MERCHANTIBILITY AND FITNESS FOR A PARTICULAR PURPOSE.
 *
 *	@(#)if.c	7.11 (Berkeley) %G%
 */

#include "param.h"
#include "mbuf.h"
#include "systm.h"
#include "socket.h"
#include "socketvar.h"
#include "protosw.h"
#include "user.h"
#include "kernel.h"
#include "ioctl.h"
#include "errno.h"

#include "if.h"
#include "af.h"
#include "if_dl.h"

#include "ether.h"

int	ifqmaxlen = IFQ_MAXLEN;

/*
 * Network interface utility routines.
 *
 * Routines with ifa_ifwith* names take sockaddr *'s as
 * parameters.
 */

ifinit()
{
	register struct ifnet *ifp;

	for (ifp = ifnet; ifp; ifp = ifp->if_next)
		if (ifp->if_snd.ifq_maxlen == 0)
			ifp->if_snd.ifq_maxlen = ifqmaxlen;
	if_slowtimo();
}

#ifdef vax
/*
 * Call each interface on a Unibus reset.
 */
ifubareset(uban)
	int uban;
{
	register struct ifnet *ifp;

	for (ifp = ifnet; ifp; ifp = ifp->if_next)
		if (ifp->if_reset)
			(*ifp->if_reset)(ifp->if_unit, uban);
}
#endif

int if_index = 0;
/*
 * Attach an interface to the
 * list of "active" interfaces.
 */
if_attach(ifp)
	struct ifnet *ifp;
{
	register struct ifnet **p = &ifnet;
	unsigned socksize, ifasize;
	int namelen, unitlen;
	char workbuf[16];
	register struct sockaddr_dl *sdl;
	register struct ifaddr *ifa;
	extern link_rtrequest();

	while (*p)
		p = &((*p)->if_next);
	*p = ifp;
	ifp->if_index = ++if_index;
	/*
	 * create a Link Level name for this device
	 */
	sprint_d(workbuf, ifp->if_unit);
	namelen = strlen(ifp->if_name);
	unitlen = strlen(workbuf);
#define _offsetof(t, m) ((int)((caddr_t)&((t *)0)->m))
	socksize = _offsetof(struct sockaddr_dl, sdl_data[0]) +
			       unitlen + namelen + ifp->if_addrlen;
#define ROUNDUP(a) (1 + (((a) - 1) | (sizeof(long) - 1)))
	socksize = ROUNDUP(socksize);
	ifasize = sizeof(*ifa) + 2 * socksize;
	ifa = (struct ifaddr *)malloc(ifasize, M_IFADDR, M_WAITOK);
	if (ifa == 0)
		return;
	bzero((caddr_t)ifa, ifasize);
	sdl = (struct sockaddr_dl *)(ifa + 1);
	ifa->ifa_addr = (struct sockaddr *)sdl;
	ifa->ifa_ifp = ifp;
	sdl->sdl_len = socksize;
	sdl->sdl_family = AF_LINK;
	bcopy(ifp->if_name, sdl->sdl_data, namelen);
	bcopy((caddr_t)workbuf, namelen + (caddr_t)sdl->sdl_data, unitlen);
	sdl->sdl_nlen = (namelen += unitlen);
	sdl->sdl_index = ifp->if_index;
	sdl = (struct sockaddr_dl *)(socksize + (caddr_t)sdl);
	ifa->ifa_netmask = (struct sockaddr *)sdl;
	sdl->sdl_len = socksize - ifp->if_addrlen;
	while (namelen != 0)
		sdl->sdl_data[--namelen] = 0xff;
	ifa->ifa_next = ifp->if_addrlist;
	ifa->ifa_rtrequest = link_rtrequest;
	ifp->if_addrlist = ifa;
}
/*
 * Locate an interface based on a complete address.
 */
/*ARGSUSED*/
struct ifaddr *
ifa_ifwithaddr(addr)
	register struct sockaddr *addr;
{
	register struct ifnet *ifp;
	register struct ifaddr *ifa;

#define	equal(a1, a2) \
  (bcmp((caddr_t)(a1), (caddr_t)(a2), ((struct sockaddr *)(a1))->sa_len) == 0)
	for (ifp = ifnet; ifp; ifp = ifp->if_next)
	    for (ifa = ifp->if_addrlist; ifa; ifa = ifa->ifa_next) {
		if (ifa->ifa_addr->sa_family != addr->sa_family)
			continue;
		if (equal(addr, ifa->ifa_addr))
			return (ifa);
		if ((ifp->if_flags & IFF_BROADCAST) &&
		    equal(&ifa->ifa_broadaddr, addr))
			return (ifa);
	}
	return ((struct ifaddr *)0);
}
/*
 * Locate the point to point interface with a given destination address.
 */
/*ARGSUSED*/
struct ifaddr *
ifa_ifwithdstaddr(addr)
	register struct sockaddr *addr;
{
	register struct ifnet *ifp;
	register struct ifaddr *ifa;

	for (ifp = ifnet; ifp; ifp = ifp->if_next) 
	    if (ifp->if_flags & IFF_POINTOPOINT)
		for (ifa = ifp->if_addrlist; ifa; ifa = ifa->ifa_next) {
			if (ifa->ifa_addr->sa_family != addr->sa_family)
				continue;
			if (equal(addr, ifa->ifa_dstaddr))
				return (ifa);
	}
	return ((struct ifaddr *)0);
}

/*
 * Find an interface on a specific network.  If many, choice
 * is first found.
 */
struct ifaddr *
ifa_ifwithnet(addr)
	struct sockaddr *addr;
{
	register struct ifnet *ifp;
	register struct ifaddr *ifa;
	register char *cp, *cp2, *cp3;
	register char *cplim;
	u_int af = addr->sa_family;

	if (af >= AF_MAX)
		return (0);
	for (ifp = ifnet; ifp; ifp = ifp->if_next)
	    for (ifa = ifp->if_addrlist; ifa; ifa = ifa->ifa_next) {
		if (ifa->ifa_addr->sa_family != af || ifa->ifa_netmask == 0)
			continue;
		cp = addr->sa_data;
		cp2 = ifa->ifa_addr->sa_data;
		cp3 = ifa->ifa_netmask->sa_data;
		cplim = ifa->ifa_netmask->sa_len + (char *)ifa->ifa_netmask;
		for (; cp3 < cplim; cp3++)
			if ((*cp++ ^ *cp2++) & *cp3)
				break;
		if (cp3 == cplim)
			return (ifa);
	    }
	return ((struct ifaddr *)0);
}

/*
 * Find an interface using a specific address family
 */
struct ifaddr *
ifa_ifwithaf(af)
	register int af;
{
	register struct ifnet *ifp;
	register struct ifaddr *ifa;

	for (ifp = ifnet; ifp; ifp = ifp->if_next)
	    for (ifa = ifp->if_addrlist; ifa; ifa = ifa->ifa_next)
		if (ifa->ifa_addr->sa_family == af)
			return (ifa);
	return ((struct ifaddr *)0);
}

#include "route.h"
/*
 * Default action when installing a route with a Link Level gateway.
 * Lookup an appropriate real ifa to point to.
 * This should be moved to /sys/net/link.c eventually.
 */
link_rtrequest(cmd, rt, sa)
register struct rtentry *rt;
struct sockaddr *sa;
{
	register struct ifaddr *ifa;
	struct sockaddr *dst;
	struct ifnet *ifp, *oldifnet = ifnet;

	if (cmd != RTM_ADD || ((ifa = rt->rt_ifa) == 0) ||
	    ((ifp = ifa->ifa_ifp) == 0) || ((dst = rt_key(rt)) == 0))
		return;
	ifnet = ifp;
	if (((ifa = ifa_ifwithnet(dst)) && ifa->ifa_ifp == ifp) ||
	    ((ifa = ifa_ifwithaf(dst->sa_family)) && ifa->ifa_ifp == ifp)) {
		ifnet = oldifnet;
		rt->rt_ifa = ifa;
		if (ifa->ifa_rtrequest && ifa->ifa_rtrequest != link_rtrequest)
			ifa->ifa_rtrequest(cmd, rt, sa);
	} else
		ifnet = oldifnet;
}

/*
 * Mark an interface down and notify protocols of
 * the transition.
 * NOTE: must be called at splnet or eqivalent.
 */
if_down(ifp)
	register struct ifnet *ifp;
{
	register struct ifaddr *ifa;

	ifp->if_flags &= ~IFF_UP;
	for (ifa = ifp->if_addrlist; ifa; ifa = ifa->ifa_next)
		pfctlinput(PRC_IFDOWN, ifa->ifa_addr);
	if_qflush(&ifp->if_snd);
}

/*
 * Flush an interface queue.
 */
if_qflush(ifq)
	register struct ifqueue *ifq;
{
	register struct mbuf *m, *n;

	n = ifq->ifq_head;
	while (m = n) {
		n = m->m_act;
		m_freem(m);
	}
	ifq->ifq_head = 0;
	ifq->ifq_tail = 0;
	ifq->ifq_len = 0;
}

/*
 * Handle interface watchdog timer routines.  Called
 * from softclock, we decrement timers (if set) and
 * call the appropriate interface routine on expiration.
 */
if_slowtimo()
{
	register struct ifnet *ifp;
	int s = splimp();

	for (ifp = ifnet; ifp; ifp = ifp->if_next) {
		if (ifp->if_timer == 0 || --ifp->if_timer)
			continue;
		if (ifp->if_watchdog)
			(*ifp->if_watchdog)(ifp->if_unit);
	}
	splx(s);
	timeout(if_slowtimo, (caddr_t)0, hz / IFNET_SLOWHZ);
}

/*
 * Map interface name to
 * interface structure pointer.
 */
struct ifnet *
ifunit(name)
	register char *name;
{
	register char *cp;
	register struct ifnet *ifp;
	int unit;
	unsigned len;
	char *ep, c;

	for (cp = name; cp < name + IFNAMSIZ && *cp; cp++)
		if (*cp >= '0' && *cp <= '9')
			break;
	if (*cp == '\0' || cp == name + IFNAMSIZ)
		return ((struct ifnet *)0);
	/*
	 * Save first char of unit, and pointer to it,
	 * so we can put a null there to avoid matching
	 * initial substrings of interface names.
	 */
	len = cp - name + 1;
	c = *cp;
	ep = cp;
	for (unit = 0; *cp >= '0' && *cp <= '9'; )
		unit = unit * 10 + *cp++ - '0';
	*ep = 0;
	for (ifp = ifnet; ifp; ifp = ifp->if_next) {
		if (bcmp(ifp->if_name, name, len))
			continue;
		if (unit == ifp->if_unit)
			break;
	}
	*ep = c;
	return (ifp);
}

/*
 * Interface ioctls.
 */
ifioctl(so, cmd, data)
	struct socket *so;
	int cmd;
	caddr_t data;
{
	register struct ifnet *ifp;
	register struct ifreq *ifr;
	int error;

	switch (cmd) {

	case SIOCGIFCONF:
	case OSIOCGIFCONF:
		return (ifconf(cmd, data));

#if defined(INET) && NETHER > 0
	case SIOCSARP:
	case SIOCDARP:
		if (error = suser(u.u_cred, &u.u_acflag))
			return (error);
		/* FALL THROUGH */
	case SIOCGARP:
	case OSIOCGARP:
		return (arpioctl(cmd, data));
#endif
	}
	ifr = (struct ifreq *)data;
	ifp = ifunit(ifr->ifr_name);
	if (ifp == 0)
		return (ENXIO);
	switch (cmd) {

	case SIOCGIFFLAGS:
		ifr->ifr_flags = ifp->if_flags;
		break;

	case SIOCGIFMETRIC:
		ifr->ifr_metric = ifp->if_metric;
		break;

	case SIOCSIFFLAGS:
		if (error = suser(u.u_cred, &u.u_acflag))
			return (error);
		if (ifp->if_flags & IFF_UP && (ifr->ifr_flags & IFF_UP) == 0) {
			int s = splimp();
			if_down(ifp);
			splx(s);
		}
		ifp->if_flags = (ifp->if_flags & IFF_CANTCHANGE) |
			(ifr->ifr_flags &~ IFF_CANTCHANGE);
		if (ifp->if_ioctl)
			(void) (*ifp->if_ioctl)(ifp, cmd, data);
		break;

	case SIOCSIFMETRIC:
		if (error = suser(u.u_cred, &u.u_acflag))
			return (error);
		ifp->if_metric = ifr->ifr_metric;
		break;

	default:
		if (so->so_proto == 0)
			return (EOPNOTSUPP);
#ifndef COMPAT_43
		return ((*so->so_proto->pr_usrreq)(so, PRU_CONTROL,
			cmd, data, ifp));
#else
	    {
		int ocmd = cmd;

		switch (cmd) {

		case SIOCSIFDSTADDR:
		case SIOCSIFADDR:
		case SIOCSIFBRDADDR:
		case SIOCSIFNETMASK:
#if BYTE_ORDER != BIG_ENDIAN
			if (ifr->ifr_addr.sa_family == 0 &&
			    ifr->ifr_addr.sa_len < 16) {
				ifr->ifr_addr.sa_family = ifr->ifr_addr.sa_len;
				ifr->ifr_addr.sa_len = 16;
			}
#else
			if (ifr->ifr_addr.sa_len == 0)
				ifr->ifr_addr.sa_len = 16;
#endif
			break;

		case OSIOCGIFADDR:
			cmd = SIOCGIFADDR;
			break;

		case OSIOCGIFDSTADDR:
			cmd = SIOCGIFDSTADDR;
			break;

		case OSIOCGIFBRDADDR:
			cmd = SIOCGIFBRDADDR;
			break;

		case OSIOCGIFNETMASK:
			cmd = SIOCGIFNETMASK;
		}
		error =  ((*so->so_proto->pr_usrreq)(so, PRU_CONTROL,
							    cmd, data, ifp));
		switch (ocmd) {

		case OSIOCGIFADDR:
		case OSIOCGIFDSTADDR:
		case OSIOCGIFBRDADDR:
		case OSIOCGIFNETMASK:
			*(u_short *)&ifr->ifr_addr = ifr->ifr_addr.sa_family;
		}
		return (error);

	    }
#endif
	}
	return (0);
}

/*
 * Return interface configuration
 * of system.  List may be used
 * in later ioctl's (above) to get
 * other information.
 */
/*ARGSUSED*/
ifconf(cmd, data)
	int cmd;
	caddr_t data;
{
	register struct ifconf *ifc = (struct ifconf *)data;
	register struct ifnet *ifp = ifnet;
	register struct ifaddr *ifa;
	register char *cp, *ep;
	struct ifreq ifr, *ifrp;
	int space = ifc->ifc_len, error = 0;

	ifrp = ifc->ifc_req;
	ep = ifr.ifr_name + sizeof (ifr.ifr_name) - 2;
	for (; space > sizeof (ifr) && ifp; ifp = ifp->if_next) {
		bcopy(ifp->if_name, ifr.ifr_name, sizeof (ifr.ifr_name) - 2);
		for (cp = ifr.ifr_name; cp < ep && *cp; cp++)
			;
		*cp++ = '0' + ifp->if_unit; *cp = '\0';
		if ((ifa = ifp->if_addrlist) == 0) {
			bzero((caddr_t)&ifr.ifr_addr, sizeof(ifr.ifr_addr));
			error = copyout((caddr_t)&ifr, (caddr_t)ifrp, sizeof (ifr));
			if (error)
				break;
			space -= sizeof (ifr), ifrp++;
		} else 
		    for ( ; space > sizeof (ifr) && ifa; ifa = ifa->ifa_next) {
			register struct sockaddr *sa = ifa->ifa_addr;
#ifdef COMPAT_43
			if (cmd == OSIOCGIFCONF) {
				struct osockaddr *osa =
					 (struct osockaddr *)&ifr.ifr_addr;
				ifr.ifr_addr = *sa;
				osa->sa_family = sa->sa_family;
				error = copyout((caddr_t)&ifr, (caddr_t)ifrp,
						sizeof (ifr));
				ifrp++;
			} else
#endif
			if (sa->sa_len <= sizeof(*sa)) {
				ifr.ifr_addr = *sa;
				error = copyout((caddr_t)&ifr, (caddr_t)ifrp,
						sizeof (ifr));
				ifrp++;
			} else {
				space -= sa->sa_len - sizeof(*sa);
				if (space < sizeof (ifr))
					break;
				error = copyout((caddr_t)&ifr, (caddr_t)ifrp,
						sizeof (ifr.ifr_name));
				if (error == 0)
				    error = copyout((caddr_t)sa,
				      (caddr_t)&ifrp->ifr_addr, sa->sa_len);
				ifrp = (struct ifreq *)
					(sa->sa_len + (caddr_t)&ifrp->ifr_addr);
			}
			if (error)
				break;
			space -= sizeof (ifr);
		}
	}
	ifc->ifc_len -= space;
	return (error);
}

static sprint_d(cp, n)
register char *cp;
u_short n;
{
	register int q, m;
	do {
	    if (n >= 10000) m = 10000;
		else if (n >= 1000) m = 1000;
		else if (n >= 100) m = 100;
		else if (n >= 10) m = 10;
		else m = 1;
	    q = n / m;
	    n -= m * q;
	    if (q > 9) q = 10; /* For crays with more than 100K interfaces */
	    *cp++ = "0123456789Z"[q];
	} while (n > 0);
	*cp++ = 0;
}
Commit	Line	Data
cb1c44c2	1	/*
1810611d	2	* Copyright (c) 1980, 1986 Regents of the University of California.
5b519e94	3	* All rights reserved.
cb1c44c2	4	*
5b519e94	5	* Redistribution and use in source and binary forms are permitted
50c7758a KB	6	* provided that the above copyright notice and this paragraph are
	7	* duplicated in all such forms and that any documentation,
	8	* advertising materials, and other materials related to such
	9	* distribution and use acknowledge that the software was developed
	10	* by the University of California, Berkeley. The name of the
	11	* University may not be used to endorse or promote products derived
	12	* from this software without specific prior written permission.
	13	* THIS SOFTWARE IS PROVIDED ``AS IS'' AND WITHOUT ANY EXPRESS OR
	14	* IMPLIED WARRANTIES, INCLUDING, WITHOUT LIMITATION, THE IMPLIED
	15	* WARRANTIES OF MERCHANTIBILITY AND FITNESS FOR A PARTICULAR PURPOSE.
5b519e94	16	*
f2eb28c8	17	* @(#)if.c 7.11 (Berkeley) %G%
cb1c44c2	18	*/
1bfd8df7	19
a0369dcf	20	#include "param.h"
ce355163	21	#include "mbuf.h"
a0369dcf JB	22	#include "systm.h"
a0369dcf JB	23	#include "socket.h"
f211a0b7	24	#include "socketvar.h"
a0369dcf	25	#include "protosw.h"
a0369dcf JB	26	#include "user.h"
	27	#include "kernel.h"
	28	#include "ioctl.h"
	29	#include "errno.h"
	30
	31	#include "if.h"
	32	#include "af.h"
02e54a34	33	#include "if_dl.h"
1bfd8df7	34
17fcfec5 MK	35	#include "ether.h"
17fcfec5 MK	36
1e977657 BJ	37	int ifqmaxlen = IFQ_MAXLEN;
1e977657 BJ	38
ee787340 SL	39	/*
	40	* Network interface utility routines.
	41	*
f211a0b7 MK	42	* Routines with ifa_ifwith* names take sockaddr *'s as
f211a0b7 MK	43	* parameters.
ee787340 SL	44	*/
ee787340 SL	45
85ce71f2 BJ	46	ifinit()
	47	{
	48	register struct ifnet *ifp;
	49
	50	for (ifp = ifnet; ifp; ifp = ifp->if_next)
aad26eac MK	51	if (ifp->if_snd.ifq_maxlen == 0)
aad26eac MK	52	ifp->if_snd.ifq_maxlen = ifqmaxlen;
5248a70b	53	if_slowtimo();
85ce71f2 BJ	54	}
85ce71f2 BJ	55
a62dd253	56	#ifdef vax
ee787340 SL	57	/*
	58	* Call each interface on a Unibus reset.
	59	*/
85ce71f2 BJ	60	ifubareset(uban)
	61	int uban;
	62	{
	63	register struct ifnet *ifp;
	64
	65	for (ifp = ifnet; ifp; ifp = ifp->if_next)
8af3ca7c	66	if (ifp->if_reset)
9d6a72e7	67	(*ifp->if_reset)(ifp->if_unit, uban);
85ce71f2	68	}
14fa60f2	69	#endif
85ce71f2	70
02e54a34	71	int if_index = 0;
ee787340 SL	72	/*
	73	* Attach an interface to the
	74	* list of "active" interfaces.
	75	*/
405c9168 BJ	76	if_attach(ifp)
	77	struct ifnet *ifp;
	78	{
c4af8b24	79	register struct ifnet **p = &ifnet;
02e54a34 KS	80	unsigned socksize, ifasize;
	81	int namelen, unitlen;
	82	char workbuf[16];
	83	register struct sockaddr_dl *sdl;
	84	register struct ifaddr *ifa;
f2eb28c8	85	extern link_rtrequest();
405c9168	86
c4af8b24 BJ	87	while (*p)
	88	p = &((*p)->if_next);
	89	*p = ifp;
02e54a34	90	ifp->if_index = ++if_index;
f2eb28c8 KS	91	/*
	92	* create a Link Level name for this device
	93	*/
02e54a34 KS	94	sprint_d(workbuf, ifp->if_unit);
	95	namelen = strlen(ifp->if_name);
	96	unitlen = strlen(workbuf);
	97	#define _offsetof(t, m) ((int)((caddr_t)&((t *)0)->m))
	98	socksize = _offsetof(struct sockaddr_dl, sdl_data[0]) +
	99	unitlen + namelen + ifp->if_addrlen;
	100	#define ROUNDUP(a) (1 + (((a) - 1) \| (sizeof(long) - 1)))
	101	socksize = ROUNDUP(socksize);
	102	ifasize = sizeof(ifa) + 2 socksize;
	103	ifa = (struct ifaddr *)malloc(ifasize, M_IFADDR, M_WAITOK);
	104	if (ifa == 0)
	105	return;
	106	bzero((caddr_t)ifa, ifasize);
	107	sdl = (struct sockaddr_dl *)(ifa + 1);
	108	ifa->ifa_addr = (struct sockaddr *)sdl;
	109	ifa->ifa_ifp = ifp;
	110	sdl->sdl_len = socksize;
	111	sdl->sdl_family = AF_LINK;
	112	bcopy(ifp->if_name, sdl->sdl_data, namelen);
	113	bcopy((caddr_t)workbuf, namelen + (caddr_t)sdl->sdl_data, unitlen);
	114	sdl->sdl_nlen = (namelen += unitlen);
	115	sdl->sdl_index = ifp->if_index;
	116	sdl = (struct sockaddr_dl *)(socksize + (caddr_t)sdl);
	117	ifa->ifa_netmask = (struct sockaddr *)sdl;
	118	sdl->sdl_len = socksize - ifp->if_addrlen;
	119	while (namelen != 0)
	120	sdl->sdl_data[--namelen] = 0xff;
	121	ifa->ifa_next = ifp->if_addrlist;
f2eb28c8	122	ifa->ifa_rtrequest = link_rtrequest;
02e54a34	123	ifp->if_addrlist = ifa;
405c9168	124	}
ee787340 SL	125	/*
	126	* Locate an interface based on a complete address.
	127	*/
4ad99bae	128	/ARGSUSED/
f211a0b7 MK	129	struct ifaddr *
f211a0b7 MK	130	ifa_ifwithaddr(addr)
202403f4	131	register struct sockaddr *addr;
1bfd8df7 BJ	132	{
1bfd8df7 BJ	133	register struct ifnet *ifp;
f211a0b7	134	register struct ifaddr *ifa;
1bfd8df7	135
ee787340	136	#define equal(a1, a2) \
202403f4	137	(bcmp((caddr_t)(a1), (caddr_t)(a2), ((struct sockaddr *)(a1))->sa_len) == 0)
f211a0b7 MK	138	for (ifp = ifnet; ifp; ifp = ifp->if_next)
f211a0b7 MK	139	for (ifa = ifp->if_addrlist; ifa; ifa = ifa->ifa_next) {
202403f4	140	if (ifa->ifa_addr->sa_family != addr->sa_family)
ee787340	141	continue;
202403f4	142	if (equal(addr, ifa->ifa_addr))
f211a0b7	143	return (ifa);
ee787340	144	if ((ifp->if_flags & IFF_BROADCAST) &&
f211a0b7 MK	145	equal(&ifa->ifa_broadaddr, addr))
f211a0b7 MK	146	return (ifa);
ee787340	147	}
f211a0b7	148	return ((struct ifaddr *)0);
1bfd8df7	149	}
ae674e00 KS	150	/*
	151	* Locate the point to point interface with a given destination address.
	152	*/
	153	/ARGSUSED/
	154	struct ifaddr *
	155	ifa_ifwithdstaddr(addr)
202403f4	156	register struct sockaddr *addr;
ae674e00 KS	157	{
	158	register struct ifnet *ifp;
	159	register struct ifaddr *ifa;
	160
	161	for (ifp = ifnet; ifp; ifp = ifp->if_next)
	162	if (ifp->if_flags & IFF_POINTOPOINT)
	163	for (ifa = ifp->if_addrlist; ifa; ifa = ifa->ifa_next) {
202403f4	164	if (ifa->ifa_addr->sa_family != addr->sa_family)
ae674e00	165	continue;
202403f4	166	if (equal(addr, ifa->ifa_dstaddr))
ae674e00 KS	167	return (ifa);
	168	}
	169	return ((struct ifaddr *)0);
	170	}
1bfd8df7	171
ee787340 SL	172	/*
	173	* Find an interface on a specific network. If many, choice
	174	* is first found.
	175	*/
f211a0b7 MK	176	struct ifaddr *
f211a0b7 MK	177	ifa_ifwithnet(addr)
202403f4	178	struct sockaddr *addr;
ee787340 SL	179	{
ee787340 SL	180	register struct ifnet *ifp;
f211a0b7	181	register struct ifaddr *ifa;
202403f4 KS	182	register char cp, cp2, *cp3;
	183	register char *cplim;
	184	u_int af = addr->sa_family;
ee787340	185
e65dcd4c SL	186	if (af >= AF_MAX)
e65dcd4c SL	187	return (0);
f211a0b7 MK	188	for (ifp = ifnet; ifp; ifp = ifp->if_next)
f211a0b7 MK	189	for (ifa = ifp->if_addrlist; ifa; ifa = ifa->ifa_next) {
202403f4	190	if (ifa->ifa_addr->sa_family != af \|\| ifa->ifa_netmask == 0)
ee787340	191	continue;
202403f4 KS	192	cp = addr->sa_data;
	193	cp2 = ifa->ifa_addr->sa_data;
	194	cp3 = ifa->ifa_netmask->sa_data;
	195	cplim = ifa->ifa_netmask->sa_len + (char *)ifa->ifa_netmask;
	196	for (; cp3 < cplim; cp3++)
	197	if ((cp++ ^ cp2++) & *cp3)
	198	break;
	199	if (cp3 == cplim)
f211a0b7	200	return (ifa);
202403f4	201	}
f211a0b7	202	return ((struct ifaddr *)0);
1bfd8df7 BJ	203	}
1bfd8df7 BJ	204
ee787340 SL	205	/*
	206	* Find an interface using a specific address family
	207	*/
f211a0b7 MK	208	struct ifaddr *
f211a0b7 MK	209	ifa_ifwithaf(af)
ee787340	210	register int af;
8a13b737	211	{
ee787340	212	register struct ifnet *ifp;
f211a0b7	213	register struct ifaddr *ifa;
8a13b737	214
ee787340	215	for (ifp = ifnet; ifp; ifp = ifp->if_next)
f211a0b7	216	for (ifa = ifp->if_addrlist; ifa; ifa = ifa->ifa_next)
202403f4	217	if (ifa->ifa_addr->sa_family == af)
f211a0b7 MK	218	return (ifa);
f211a0b7 MK	219	return ((struct ifaddr *)0);
8a13b737	220	}
f2eb28c8 KS	221
	222	#include "route.h"
	223	/*
	224	* Default action when installing a route with a Link Level gateway.
	225	* Lookup an appropriate real ifa to point to.
	226	* This should be moved to /sys/net/link.c eventually.
	227	*/
	228	link_rtrequest(cmd, rt, sa)
	229	register struct rtentry *rt;
	230	struct sockaddr *sa;
	231	{
	232	register struct ifaddr *ifa;
	233	struct sockaddr *dst;
	234	struct ifnet ifp, oldifnet = ifnet;
	235
	236	if (cmd != RTM_ADD \|\| ((ifa = rt->rt_ifa) == 0) \|\|
	237	((ifp = ifa->ifa_ifp) == 0) \|\| ((dst = rt_key(rt)) == 0))
	238	return;
	239	ifnet = ifp;
	240	if (((ifa = ifa_ifwithnet(dst)) && ifa->ifa_ifp == ifp) \|\|
	241	((ifa = ifa_ifwithaf(dst->sa_family)) && ifa->ifa_ifp == ifp)) {
	242	ifnet = oldifnet;
	243	rt->rt_ifa = ifa;
	244	if (ifa->ifa_rtrequest && ifa->ifa_rtrequest != link_rtrequest)
	245	ifa->ifa_rtrequest(cmd, rt, sa);
	246	} else
	247	ifnet = oldifnet;
	248	}
f1b2fa5b	249
72e4f44e SL	250	/*
	251	* Mark an interface down and notify protocols of
	252	* the transition.
af0b24db	253	* NOTE: must be called at splnet or eqivalent.
72e4f44e SL	254	*/
	255	if_down(ifp)
	256	register struct ifnet *ifp;
	257	{
f211a0b7	258	register struct ifaddr *ifa;
5248a70b	259
72e4f44e	260	ifp->if_flags &= ~IFF_UP;
f211a0b7	261	for (ifa = ifp->if_addrlist; ifa; ifa = ifa->ifa_next)
202403f4	262	pfctlinput(PRC_IFDOWN, ifa->ifa_addr);
ce355163 MK	263	if_qflush(&ifp->if_snd);
	264	}
	265
	266	/*
	267	* Flush an interface queue.
	268	*/
	269	if_qflush(ifq)
	270	register struct ifqueue *ifq;
	271	{
	272	register struct mbuf m, n;
	273
	274	n = ifq->ifq_head;
	275	while (m = n) {
	276	n = m->m_act;
	277	m_freem(m);
	278	}
	279	ifq->ifq_head = 0;
	280	ifq->ifq_tail = 0;
	281	ifq->ifq_len = 0;
72e4f44e	282	}
de602274 SL	283
	284	/*
	285	* Handle interface watchdog timer routines. Called
	286	* from softclock, we decrement timers (if set) and
	287	* call the appropriate interface routine on expiration.
	288	*/
	289	if_slowtimo()
	290	{
	291	register struct ifnet *ifp;
202403f4	292	int s = splimp();
de602274	293
af0b24db SL	294	for (ifp = ifnet; ifp; ifp = ifp->if_next) {
	295	if (ifp->if_timer == 0 \|\| --ifp->if_timer)
	296	continue;
	297	if (ifp->if_watchdog)
de602274	298	(*ifp->if_watchdog)(ifp->if_unit);
af0b24db	299	}
202403f4	300	splx(s);
6e7edb25	301	timeout(if_slowtimo, (caddr_t)0, hz / IFNET_SLOWHZ);
de602274	302	}
0c33c832 SL	303
0c33c832 SL	304	/*
a62dd253 SL	305	* Map interface name to
a62dd253 SL	306	* interface structure pointer.
0c33c832	307	*/
a62dd253 SL	308	struct ifnet *
	309	ifunit(name)
	310	register char *name;
0c33c832	311	{
0c33c832	312	register char *cp;
a62dd253 SL	313	register struct ifnet *ifp;
a62dd253 SL	314	int unit;
725d9baf MK	315	unsigned len;
725d9baf MK	316	char *ep, c;
0c33c832	317
a62dd253	318	for (cp = name; cp < name + IFNAMSIZ && *cp; cp++)
0c33c832 SL	319	if (cp >= '0' && cp <= '9')
0c33c832 SL	320	break;
a62dd253 SL	321	if (*cp == '\0' \|\| cp == name + IFNAMSIZ)
a62dd253 SL	322	return ((struct ifnet *)0);
725d9baf MK	323	/*
	324	* Save first char of unit, and pointer to it,
	325	* so we can put a null there to avoid matching
	326	* initial substrings of interface names.
	327	*/
	328	len = cp - name + 1;
	329	c = *cp;
	330	ep = cp;
	331	for (unit = 0; cp >= '0' && cp <= '9'; )
	332	unit = unit * 10 + *cp++ - '0';
	333	*ep = 0;
0c33c832	334	for (ifp = ifnet; ifp; ifp = ifp->if_next) {
725d9baf	335	if (bcmp(ifp->if_name, name, len))
0c33c832 SL	336	continue;
0c33c832 SL	337	if (unit == ifp->if_unit)
a62dd253	338	break;
0c33c832	339	}
725d9baf	340	*ep = c;
a62dd253 SL	341	return (ifp);
	342	}
	343
	344	/*
	345	* Interface ioctls.
	346	*/
f211a0b7 MK	347	ifioctl(so, cmd, data)
f211a0b7 MK	348	struct socket *so;
a62dd253 SL	349	int cmd;
	350	caddr_t data;
	351	{
	352	register struct ifnet *ifp;
	353	register struct ifreq *ifr;
06c16dfa	354	int error;
0c33c832	355
0c33c832 SL	356	switch (cmd) {
0c33c832 SL	357
a62dd253	358	case SIOCGIFCONF:
202403f4	359	case OSIOCGIFCONF:
a62dd253	360	return (ifconf(cmd, data));
0c33c832	361
799358ac	362	#if defined(INET) && NETHER > 0
17fcfec5 MK	363	case SIOCSARP:
17fcfec5 MK	364	case SIOCDARP:
06c16dfa KM	365	if (error = suser(u.u_cred, &u.u_acflag))
06c16dfa KM	366	return (error);
17fcfec5 MK	367	/* FALL THROUGH */
17fcfec5 MK	368	case SIOCGARP:
202403f4	369	case OSIOCGARP:
17fcfec5 MK	370	return (arpioctl(cmd, data));
17fcfec5 MK	371	#endif
a62dd253 SL	372	}
	373	ifr = (struct ifreq *)data;
	374	ifp = ifunit(ifr->ifr_name);
	375	if (ifp == 0)
	376	return (ENXIO);
	377	switch (cmd) {
0c33c832	378
0c33c832 SL	379	case SIOCGIFFLAGS:
	380	ifr->ifr_flags = ifp->if_flags;
	381	break;
	382
484ee22e MK	383	case SIOCGIFMETRIC:
	384	ifr->ifr_metric = ifp->if_metric;
	385	break;
	386
81889e84	387	case SIOCSIFFLAGS:
06c16dfa KM	388	if (error = suser(u.u_cred, &u.u_acflag))
06c16dfa KM	389	return (error);
81889e84 SL	390	if (ifp->if_flags & IFF_UP && (ifr->ifr_flags & IFF_UP) == 0) {
	391	int s = splimp();
	392	if_down(ifp);
	393	splx(s);
	394	}
f211a0b7 MK	395	ifp->if_flags = (ifp->if_flags & IFF_CANTCHANGE) \|
f211a0b7 MK	396	(ifr->ifr_flags &~ IFF_CANTCHANGE);
aad26eac MK	397	if (ifp->if_ioctl)
aad26eac MK	398	(void) (*ifp->if_ioctl)(ifp, cmd, data);
81889e84 SL	399	break;
81889e84 SL	400
484ee22e	401	case SIOCSIFMETRIC:
06c16dfa KM	402	if (error = suser(u.u_cred, &u.u_acflag))
06c16dfa KM	403	return (error);
484ee22e MK	404	ifp->if_metric = ifr->ifr_metric;
	405	break;
	406
0c33c832	407	default:
f211a0b7	408	if (so->so_proto == 0)
a62dd253	409	return (EOPNOTSUPP);
202403f4	410	#ifndef COMPAT_43
f211a0b7 MK	411	return ((*so->so_proto->pr_usrreq)(so, PRU_CONTROL,
f211a0b7 MK	412	cmd, data, ifp));
202403f4 KS	413	#else
202403f4 KS	414	{
35c34494	415	int ocmd = cmd;
202403f4 KS	416
	417	switch (cmd) {
	418
	419	case SIOCSIFDSTADDR:
	420	case SIOCSIFADDR:
	421	case SIOCSIFBRDADDR:
	422	case SIOCSIFNETMASK:
	423	#if BYTE_ORDER != BIG_ENDIAN
	424	if (ifr->ifr_addr.sa_family == 0 &&
	425	ifr->ifr_addr.sa_len < 16) {
	426	ifr->ifr_addr.sa_family = ifr->ifr_addr.sa_len;
	427	ifr->ifr_addr.sa_len = 16;
	428	}
	429	#else
	430	if (ifr->ifr_addr.sa_len == 0)
	431	ifr->ifr_addr.sa_len = 16;
	432	#endif
	433	break;
	434
	435	case OSIOCGIFADDR:
	436	cmd = SIOCGIFADDR;
	437	break;
	438
	439	case OSIOCGIFDSTADDR:
	440	cmd = SIOCGIFDSTADDR;
	441	break;
	442
	443	case OSIOCGIFBRDADDR:
	444	cmd = SIOCGIFBRDADDR;
	445	break;
	446
	447	case OSIOCGIFNETMASK:
	448	cmd = SIOCGIFNETMASK;
	449	}
	450	error = ((*so->so_proto->pr_usrreq)(so, PRU_CONTROL,
	451	cmd, data, ifp));
	452	switch (ocmd) {
	453
	454	case OSIOCGIFADDR:
	455	case OSIOCGIFDSTADDR:
	456	case OSIOCGIFBRDADDR:
	457	case OSIOCGIFNETMASK:
	458	(u_short )&ifr->ifr_addr = ifr->ifr_addr.sa_family;
	459	}
	460	return (error);
	461
	462	}
	463	#endif
0c33c832 SL	464	}
	465	return (0);
	466	}
	467
	468	/*
	469	* Return interface configuration
	470	* of system. List may be used
	471	* in later ioctl's (above) to get
	472	* other information.
	473	*/
9e9695c7	474	/ARGSUSED/
0c33c832 SL	475	ifconf(cmd, data)
	476	int cmd;
	477	caddr_t data;
	478	{
	479	register struct ifconf ifc = (struct ifconf )data;
	480	register struct ifnet *ifp = ifnet;
f211a0b7	481	register struct ifaddr *ifa;
9b956fa5 SL	482	register char cp, ep;
9b956fa5 SL	483	struct ifreq ifr, *ifrp;
0c33c832 SL	484	int space = ifc->ifc_len, error = 0;
0c33c832 SL	485
9b956fa5 SL	486	ifrp = ifc->ifc_req;
9b956fa5 SL	487	ep = ifr.ifr_name + sizeof (ifr.ifr_name) - 2;
0c33c832	488	for (; space > sizeof (ifr) && ifp; ifp = ifp->if_next) {
9b956fa5 SL	489	bcopy(ifp->if_name, ifr.ifr_name, sizeof (ifr.ifr_name) - 2);
9b956fa5 SL	490	for (cp = ifr.ifr_name; cp < ep && *cp; cp++)
0c33c832	491	;
9b956fa5	492	cp++ = '0' + ifp->if_unit; cp = '\0';
f211a0b7 MK	493	if ((ifa = ifp->if_addrlist) == 0) {
	494	bzero((caddr_t)&ifr.ifr_addr, sizeof(ifr.ifr_addr));
	495	error = copyout((caddr_t)&ifr, (caddr_t)ifrp, sizeof (ifr));
	496	if (error)
	497	break;
	498	space -= sizeof (ifr), ifrp++;
	499	} else
	500	for ( ; space > sizeof (ifr) && ifa; ifa = ifa->ifa_next) {
202403f4 KS	501	register struct sockaddr *sa = ifa->ifa_addr;
	502	#ifdef COMPAT_43
	503	if (cmd == OSIOCGIFCONF) {
	504	struct osockaddr *osa =
	505	(struct osockaddr *)&ifr.ifr_addr;
	506	ifr.ifr_addr = *sa;
	507	osa->sa_family = sa->sa_family;
	508	error = copyout((caddr_t)&ifr, (caddr_t)ifrp,
	509	sizeof (ifr));
	510	ifrp++;
	511	} else
	512	#endif
	513	if (sa->sa_len <= sizeof(*sa)) {
	514	ifr.ifr_addr = *sa;
	515	error = copyout((caddr_t)&ifr, (caddr_t)ifrp,
	516	sizeof (ifr));
	517	ifrp++;
	518	} else {
	519	space -= sa->sa_len - sizeof(*sa);
	520	if (space < sizeof (ifr))
	521	break;
	522	error = copyout((caddr_t)&ifr, (caddr_t)ifrp,
	523	sizeof (ifr.ifr_name));
	524	if (error == 0)
	525	error = copyout((caddr_t)sa,
	526	(caddr_t)&ifrp->ifr_addr, sa->sa_len);
	527	ifrp = (struct ifreq *)
	528	(sa->sa_len + (caddr_t)&ifrp->ifr_addr);
	529	}
f211a0b7 MK	530	if (error)
f211a0b7 MK	531	break;
202403f4	532	space -= sizeof (ifr);
f211a0b7	533	}
0c33c832 SL	534	}
	535	ifc->ifc_len -= space;
	536	return (error);
	537	}
02e54a34 KS	538
	539	static sprint_d(cp, n)
	540	register char *cp;
	541	u_short n;
	542	{
	543	register int q, m;
	544	do {
	545	if (n >= 10000) m = 10000;
	546	else if (n >= 1000) m = 1000;
	547	else if (n >= 100) m = 100;
	548	else if (n >= 10) m = 10;
	549	else m = 1;
	550	q = n / m;
	551	n -= m * q;
	552	if (q > 9) q = 10; /* For crays with more than 100K interfaces */
	553	*cp++ = "0123456789Z"[q];
	554	} while (n > 0);
	555	*cp++ = 0;
	556	}