when adding a link level route from outside the kernel,

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

diff --git a/usr/src/sys/net/if.c b/usr/src/sys/net/if.c
index 3c40175..0b21573 100644 (file)
--- a/usr/src/sys/net/if.c
+++ b/usr/src/sys/net/if.c
@@ -1,17 +1,28 @@
 /*
 /*

- * Copyright (c) 1980 Regents of the University of California.
- * All rights reserved.  The Berkeley software License Agreement
- * specifies the terms and conditions for redistribution.
+ * Copyright (c) 1980, 1986 Regents of the University of California.
+ * All rights reserved.

  *
  *

- *     @(#)if.c        6.8 (Berkeley) %G%
+ * 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.10 (Berkeley) %G%

  */
 
 #include "param.h"
  */
 
 #include "param.h"

+#include "mbuf.h"

 #include "systm.h"
 #include "socket.h"
 #include "socketvar.h"
 #include "protosw.h"
 #include "systm.h"
 #include "socket.h"
 #include "socketvar.h"
 #include "protosw.h"

-#include "dir.h"

 #include "user.h"
 #include "kernel.h"
 #include "ioctl.h"
 #include "user.h"
 #include "kernel.h"
 #include "ioctl.h"


@@ -19,6 +30,7 @@
 
 #include "if.h"
 #include "af.h"
 
 #include "if.h"
 #include "af.h"

+#include "if_dl.h"

 
 #include "ether.h"
 
 
 #include "ether.h"
 


@@ -36,11 +48,8 @@ ifinit()
        register struct ifnet *ifp;
 
        for (ifp = ifnet; ifp; ifp = ifp->if_next)
        register struct ifnet *ifp;
 
        for (ifp = ifnet; ifp; ifp = ifp->if_next)

-               if (ifp->if_init) {
-                       (*ifp->if_init)(ifp->if_unit);
-                       if (ifp->if_snd.ifq_maxlen == 0)
-                               ifp->if_snd.ifq_maxlen = ifqmaxlen;
-               }
+               if (ifp->if_snd.ifq_maxlen == 0)
+                       ifp->if_snd.ifq_maxlen = ifqmaxlen;

        if_slowtimo();
 }
 
        if_slowtimo();
 }
 


@@ -59,6 +68,7 @@ ifubareset(uban)
 }
 #endif
 
 }
 #endif
 

+int if_index = 0;

 /*
  * Attach an interface to the
  * list of "active" interfaces.
 /*
  * Attach an interface to the
  * list of "active" interfaces.


@@ -67,10 +77,46 @@ if_attach(ifp)
        struct ifnet *ifp;
 {
        register struct ifnet **p = &ifnet;
        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;

 
        while (*p)
                p = &((*p)->if_next);
        *p = ifp;
 
        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;
+       ifp->if_addrlist = ifa;

 }
 
 /*
 }
 
 /*


@@ -79,18 +125,18 @@ if_attach(ifp)
 /*ARGSUSED*/
 struct ifaddr *
 ifa_ifwithaddr(addr)
 /*ARGSUSED*/
 struct ifaddr *
 ifa_ifwithaddr(addr)

-       struct sockaddr *addr;
+       register struct sockaddr *addr;

 {
        register struct ifnet *ifp;
        register struct ifaddr *ifa;
 
 #define        equal(a1, a2) \
 {
        register struct ifnet *ifp;
        register struct ifaddr *ifa;
 
 #define        equal(a1, a2) \

-       (bcmp((caddr_t)((a1)->sa_data), (caddr_t)((a2)->sa_data), 14) == 0)
+  (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) {
        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)
+               if (ifa->ifa_addr->sa_family != addr->sa_family)

                        continue;
                        continue;

-               if (equal(&ifa->ifa_addr, addr))
+               if (equal(addr, ifa->ifa_addr))

                        return (ifa);
                if ((ifp->if_flags & IFF_BROADCAST) &&
                    equal(&ifa->ifa_broadaddr, addr))
                        return (ifa);
                if ((ifp->if_flags & IFF_BROADCAST) &&
                    equal(&ifa->ifa_broadaddr, addr))


@@ -104,7 +150,7 @@ ifa_ifwithaddr(addr)
 /*ARGSUSED*/
 struct ifaddr *
 ifa_ifwithdstaddr(addr)
 /*ARGSUSED*/
 struct ifaddr *
 ifa_ifwithdstaddr(addr)

-       struct sockaddr *addr;
+       register struct sockaddr *addr;

 {
        register struct ifnet *ifp;
        register struct ifaddr *ifa;
 {
        register struct ifnet *ifp;
        register struct ifaddr *ifa;


@@ -112,9 +158,9 @@ ifa_ifwithdstaddr(addr)
        for (ifp = ifnet; ifp; ifp = ifp->if_next) 
            if (ifp->if_flags & IFF_POINTOPOINT)
                for (ifa = ifp->if_addrlist; ifa; ifa = ifa->ifa_next) {
        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)
+                       if (ifa->ifa_addr->sa_family != addr->sa_family)

                                continue;
                                continue;

-                       if (equal(&ifa->ifa_dstaddr, addr))
+                       if (equal(addr, ifa->ifa_dstaddr))

                                return (ifa);
        }
        return ((struct ifaddr *)0);
                                return (ifa);
        }
        return ((struct ifaddr *)0);


@@ -126,26 +172,34 @@ ifa_ifwithdstaddr(addr)
  */
 struct ifaddr *
 ifa_ifwithnet(addr)
  */
 struct ifaddr *
 ifa_ifwithnet(addr)

-       register struct sockaddr *addr;
+       struct sockaddr *addr;

 {
        register struct ifnet *ifp;
        register struct ifaddr *ifa;
 {
        register struct ifnet *ifp;
        register struct ifaddr *ifa;

-       register u_int af = addr->sa_family;
-       register int (*netmatch)();
+       register char *cp, *cp2, *cp3;
+       register char *cplim;
+       u_int af = addr->sa_family;

 
        if (af >= AF_MAX)
                return (0);
 
        if (af >= AF_MAX)
                return (0);

-       netmatch = afswitch[af].af_netmatch;

        for (ifp = ifnet; ifp; ifp = ifp->if_next)
            for (ifa = ifp->if_addrlist; ifa; ifa = ifa->ifa_next) {
        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)
+               if (ifa->ifa_addr->sa_family != af || ifa->ifa_netmask == 0)

                        continue;
                        continue;

-               if ((*netmatch)(&ifa->ifa_addr, addr))
+               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 (ifa);

-       }
+           }

        return ((struct ifaddr *)0);
 }
 
        return ((struct ifaddr *)0);
 }
 

+#ifdef notdef

 /*
  * Find an interface using a specific address family
  */
 /*
  * Find an interface using a specific address family
  */


@@ -158,10 +212,11 @@ ifa_ifwithaf(af)
 
        for (ifp = ifnet; ifp; ifp = ifp->if_next)
            for (ifa = ifp->if_addrlist; ifa; ifa = ifa->ifa_next)
 
        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)
+               if (ifa->ifa_addr->sa_family == af)

                        return (ifa);
        return ((struct ifaddr *)0);
 }
                        return (ifa);
        return ((struct ifaddr *)0);
 }

+#endif

 
 /*
  * Mark an interface down and notify protocols of
 
 /*
  * Mark an interface down and notify protocols of


@@ -175,7 +230,26 @@ if_down(ifp)
 
        ifp->if_flags &= ~IFF_UP;
        for (ifa = ifp->if_addrlist; ifa; ifa = ifa->ifa_next)
 
        ifp->if_flags &= ~IFF_UP;
        for (ifa = ifp->if_addrlist; ifa; ifa = ifa->ifa_next)

-               pfctlinput(PRC_IFDOWN, (caddr_t)&ifa->ifa_addr);
+               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;

 }
 
 /*
 }
 
 /*


@@ -186,6 +260,7 @@ if_down(ifp)
 if_slowtimo()
 {
        register struct ifnet *ifp;
 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)
 
        for (ifp = ifnet; ifp; ifp = ifp->if_next) {
                if (ifp->if_timer == 0 || --ifp->if_timer)


@@ -193,6 +268,7 @@ if_slowtimo()
                if (ifp->if_watchdog)
                        (*ifp->if_watchdog)(ifp->if_unit);
        }
                if (ifp->if_watchdog)
                        (*ifp->if_watchdog)(ifp->if_unit);
        }

+       splx(s);

        timeout(if_slowtimo, (caddr_t)0, hz / IFNET_SLOWHZ);
 }
 
        timeout(if_slowtimo, (caddr_t)0, hz / IFNET_SLOWHZ);
 }
 


@@ -207,19 +283,32 @@ ifunit(name)
        register char *cp;
        register struct ifnet *ifp;
        int unit;
        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);
 
        for (cp = name; cp < name + IFNAMSIZ && *cp; cp++)
                if (*cp >= '0' && *cp <= '9')
                        break;
        if (*cp == '\0' || cp == name + IFNAMSIZ)
                return ((struct ifnet *)0);

-       unit = *cp - '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) {
        for (ifp = ifnet; ifp; ifp = ifp->if_next) {

-               if (bcmp(ifp->if_name, name, (unsigned)(cp - name)))
+               if (bcmp(ifp->if_name, name, len))

                        continue;
                if (unit == ifp->if_unit)
                        break;
        }
                        continue;
                if (unit == ifp->if_unit)
                        break;
        }

+       *ep = c;

        return (ifp);
 }
 
        return (ifp);
 }
 


@@ -233,19 +322,22 @@ ifioctl(so, cmd, data)
 {
        register struct ifnet *ifp;
        register struct ifreq *ifr;
 {
        register struct ifnet *ifp;
        register struct ifreq *ifr;

+       int error;

 
        switch (cmd) {
 
        case SIOCGIFCONF:
 
        switch (cmd) {
 
        case SIOCGIFCONF:

+       case OSIOCGIFCONF:

                return (ifconf(cmd, data));
 
 #if defined(INET) && NETHER > 0
        case SIOCSARP:
        case SIOCDARP:
                return (ifconf(cmd, data));
 
 #if defined(INET) && NETHER > 0
        case SIOCSARP:
        case SIOCDARP:

-               if (!suser())
-                       return (u.u_error);
+               if (error = suser(u.u_cred, &u.u_acflag))
+                       return (error);

                /* FALL THROUGH */
        case SIOCGARP:
                /* FALL THROUGH */
        case SIOCGARP:

+       case OSIOCGARP:

                return (arpioctl(cmd, data));
 #endif
        }
                return (arpioctl(cmd, data));
 #endif
        }


@@ -259,7 +351,13 @@ ifioctl(so, cmd, data)
                ifr->ifr_flags = ifp->if_flags;
                break;
 
                ifr->ifr_flags = ifp->if_flags;
                break;
 

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

        case SIOCSIFFLAGS:
        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);
                if (ifp->if_flags & IFF_UP && (ifr->ifr_flags & IFF_UP) == 0) {
                        int s = splimp();
                        if_down(ifp);


@@ -267,13 +365,73 @@ ifioctl(so, cmd, data)
                }
                ifp->if_flags = (ifp->if_flags & IFF_CANTCHANGE) |
                        (ifr->ifr_flags &~ IFF_CANTCHANGE);
                }
                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);
                break;
 
        default:
                if (so->so_proto == 0)
                        return (EOPNOTSUPP);

+#ifndef COMPAT_43

                return ((*so->so_proto->pr_usrreq)(so, PRU_CONTROL,
                        cmd, data, ifp));
                return ((*so->so_proto->pr_usrreq)(so, PRU_CONTROL,
                        cmd, data, ifp));

+#else
+           {
+               int error, 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 (0);
 }


@@ -311,13 +469,59 @@ ifconf(cmd, data)
                        space -= sizeof (ifr), ifrp++;
                } else 
                    for ( ; space > sizeof (ifr) && ifa; ifa = ifa->ifa_next) {
                        space -= sizeof (ifr), ifrp++;
                } else 
                    for ( ; space > sizeof (ifr) && ifa; ifa = ifa->ifa_next) {

-                       ifr.ifr_addr = ifa->ifa_addr;
-                       error = copyout((caddr_t)&ifr, (caddr_t)ifrp, sizeof (ifr));
+                       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;
                        if (error)
                                break;

-                       space -= sizeof (ifr), ifrp++;
+                       space -= sizeof (ifr);

                }
        }
        ifc->ifc_len -= space;
        return (error);
 }
                }
        }
        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;
+}