BSD 4_3_Net_1 release

[unix-history] / sys / netns / ns_pcb.c

/*
* Copyright (c) 1984, 1985, 1986, 1987 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.
*
*      @(#)ns_pcb.c    7.5 (Berkeley) 6/29/88
*/

#include "param.h"
#include "systm.h"
#include "dir.h"
#include "user.h"
#include "mbuf.h"
#include "socket.h"
#include "socketvar.h"
#include "../net/if.h"
#include "../net/route.h"
#include "protosw.h"

#include "ns.h"
#include "ns_if.h"
#include "ns_pcb.h"

struct  ns_addr zerons_addr;

ns_pcballoc(so, head)
       struct socket *so;
       struct nspcb *head;
{
       struct mbuf *m;
       register struct nspcb *nsp;

       m = m_getclr(M_DONTWAIT, MT_PCB);
       if (m == NULL)
               return (ENOBUFS);
       nsp = mtod(m, struct nspcb *);
       nsp->nsp_socket = so;
       insque(nsp, head);
       so->so_pcb = (caddr_t)nsp;
       return (0);
}
       
ns_pcbbind(nsp, nam)
       register struct nspcb *nsp;
       struct mbuf *nam;
{
       register struct sockaddr_ns *sns;
       u_short lport = 0;

       if(nsp->nsp_lport || !ns_nullhost(nsp->nsp_laddr))
               return (EINVAL);
       if (nam == 0)
               goto noname;
       sns = mtod(nam, struct sockaddr_ns *);
       if (nam->m_len != sizeof (*sns))
               return (EINVAL);
       if (!ns_nullhost(sns->sns_addr)) {
               int tport = sns->sns_port;

               sns->sns_port = 0;              /* yech... */
               if (ifa_ifwithaddr((struct sockaddr *)sns) == 0)
                       return (EADDRNOTAVAIL);
               sns->sns_port = tport;
       }
       lport = sns->sns_port;
       if (lport) {
               u_short aport = ntohs(lport);

               if (aport < NSPORT_RESERVED && u.u_uid != 0)
                       return (EACCES);
               if (ns_pcblookup(&zerons_addr, lport, 0))
                       return (EADDRINUSE);
       }
       nsp->nsp_laddr = sns->sns_addr;
noname:
       if (lport == 0)
               do {
                       if (nspcb.nsp_lport++ < NSPORT_RESERVED)
                               nspcb.nsp_lport = NSPORT_RESERVED;
                       lport = htons(nspcb.nsp_lport);
               } while (ns_pcblookup(&zerons_addr, lport, 0));
       nsp->nsp_lport = lport;
       return (0);
}

/*
* Connect from a socket to a specified address.
* Both address and port must be specified in argument sns.
* If don't have a local address for this socket yet,
* then pick one.
*/
ns_pcbconnect(nsp, nam)
       struct nspcb *nsp;
       struct mbuf *nam;
{
       struct ns_ifaddr *ia;
       register struct sockaddr_ns *sns = mtod(nam, struct sockaddr_ns *);
       register struct ns_addr *dst;

       if (nam->m_len != sizeof (*sns))
               return (EINVAL);
       if (sns->sns_family != AF_NS)
               return (EAFNOSUPPORT);
       if (sns->sns_port==0 || ns_nullhost(sns->sns_addr))
               return (EADDRNOTAVAIL);
       if (ns_nullhost(nsp->nsp_laddr)) {
               register struct route *ro;
               struct ifnet *ifp;
               /* 
                * If route is known or can be allocated now,
                * our src addr is taken from the i/f, else punt.
                */
               ro = &nsp->nsp_route;
               dst = &satons_addr(ro->ro_dst);

               ia = (struct ns_ifaddr *)0;
               if (ro->ro_rt) {
                   if ((!ns_neteq(nsp->nsp_lastdst, sns->sns_addr)) ||
                       ((ifp = ro->ro_rt->rt_ifp) &&
                        (ifp->if_flags & IFF_POINTOPOINT) &&
                        (!ns_hosteq(nsp->nsp_lastdst, sns->sns_addr))) ||
                       (nsp->nsp_socket->so_options & SO_DONTROUTE)) {
                               RTFREE(ro->ro_rt);
                               ro->ro_rt = (struct rtentry *)0;
                       }
               }
               if ((nsp->nsp_socket->so_options & SO_DONTROUTE) == 0 && /*XXX*/
                   (ro->ro_rt == (struct rtentry *)0 ||
                    ro->ro_rt->rt_ifp == (struct ifnet *)0)) {
                           /* No route yet, so try to acquire one */
                           ro->ro_dst.sa_family = AF_NS;
                           *dst = sns->sns_addr;
                           dst->x_port = 0;
                           rtalloc(ro);
               }
               /*
                * If we found a route, use the address
                * corresponding to the outgoing interface
                */
               if (ro->ro_rt && (ifp = ro->ro_rt->rt_ifp))
                       for (ia = ns_ifaddr; ia; ia = ia->ia_next)
                               if (ia->ia_ifp == ifp)
                                       break;
               if (ia == 0) {
                       u_short fport = sns->sns_addr.x_port;
                       sns->sns_addr.x_port = 0;
                       ia = (struct ns_ifaddr *)
                               ifa_ifwithdstaddr((struct sockaddr *)sns);
                       sns->sns_addr.x_port = fport;
                       if (ia == 0)
                               ia = ns_iaonnetof(&sns->sns_addr);
                       if (ia == 0)
                               ia = ns_ifaddr;
                       if (ia == 0)
                               return (EADDRNOTAVAIL);
               }
               nsp->nsp_laddr.x_net = satons_addr(ia->ia_addr).x_net;
               nsp->nsp_lastdst = sns->sns_addr;
       }
       if (ns_pcblookup(&sns->sns_addr, nsp->nsp_lport, 0))
               return (EADDRINUSE);
       if (ns_nullhost(nsp->nsp_laddr)) {
               if (nsp->nsp_lport == 0)
                       (void) ns_pcbbind(nsp, (struct mbuf *)0);
               nsp->nsp_laddr.x_host = ns_thishost;
       }
       nsp->nsp_faddr = sns->sns_addr;
       /* Includes nsp->nsp_fport = sns->sns_port; */
       return (0);
}

ns_pcbdisconnect(nsp)
       struct nspcb *nsp;
{

       nsp->nsp_faddr = zerons_addr;
       if (nsp->nsp_socket->so_state & SS_NOFDREF)
               ns_pcbdetach(nsp);
}

ns_pcbdetach(nsp)
       struct nspcb *nsp;
{
       struct socket *so = nsp->nsp_socket;

       so->so_pcb = 0;
       sofree(so);
       if (nsp->nsp_route.ro_rt)
               rtfree(nsp->nsp_route.ro_rt);
       remque(nsp);
       (void) m_free(dtom(nsp));
}

ns_setsockaddr(nsp, nam)
       register struct nspcb *nsp;
       struct mbuf *nam;
{
       register struct sockaddr_ns *sns = mtod(nam, struct sockaddr_ns *);
       
       nam->m_len = sizeof (*sns);
       sns = mtod(nam, struct sockaddr_ns *);
       bzero((caddr_t)sns, sizeof (*sns));
       sns->sns_family = AF_NS;
       sns->sns_addr = nsp->nsp_laddr;
}

ns_setpeeraddr(nsp, nam)
       register struct nspcb *nsp;
       struct mbuf *nam;
{
       register struct sockaddr_ns *sns = mtod(nam, struct sockaddr_ns *);
       
       nam->m_len = sizeof (*sns);
       sns = mtod(nam, struct sockaddr_ns *);
       bzero((caddr_t)sns, sizeof (*sns));
       sns->sns_family = AF_NS;
       sns->sns_addr  = nsp->nsp_faddr;
}

/*
* Pass some notification to all connections of a protocol
* associated with address dst.  Call the
* protocol specific routine to handle each connection.
* Also pass an extra paramter via the nspcb. (which may in fact
* be a parameter list!)
*/
ns_pcbnotify(dst, errno, notify, param)
       register struct ns_addr *dst;
       long param;
       int errno, (*notify)();
{
       register struct nspcb *nsp, *oinp;
       int s = splimp();

       for (nsp = (&nspcb)->nsp_next; nsp != (&nspcb);) {
               if (!ns_hosteq(*dst,nsp->nsp_faddr)) {
       next:
                       nsp = nsp->nsp_next;
                       continue;
               }
               if (nsp->nsp_socket == 0)
                       goto next;
               if (errno) 
                       nsp->nsp_socket->so_error = errno;
               oinp = nsp;
               nsp = nsp->nsp_next;
               oinp->nsp_notify_param = param;
               (*notify)(oinp);
       }
       splx(s);
}

#ifdef notdef
/*
* After a routing change, flush old routing
* and allocate a (hopefully) better one.
*/
ns_rtchange(nsp)
       struct nspcb *nsp;
{
       if (nsp->nsp_route.ro_rt) {
               rtfree(nsp->nsp_route.ro_rt);
               nsp->nsp_route.ro_rt = 0;
               /*
                * A new route can be allocated the next time
                * output is attempted.
                */
       }
       /* SHOULD NOTIFY HIGHER-LEVEL PROTOCOLS */
}
#endif

struct nspcb *
ns_pcblookup(faddr, lport, wildp)
       struct ns_addr *faddr;
       u_short lport;
{
       register struct nspcb *nsp, *match = 0;
       int matchwild = 3, wildcard;
       u_short fport;

       fport = faddr->x_port;
       for (nsp = (&nspcb)->nsp_next; nsp != (&nspcb); nsp = nsp->nsp_next) {
               if (nsp->nsp_lport != lport)
                       continue;
               wildcard = 0;
               if (ns_nullhost(nsp->nsp_faddr)) {
                       if (!ns_nullhost(*faddr))
                               wildcard++;
               } else {
                       if (ns_nullhost(*faddr))
                               wildcard++;
                       else {
                               if (!ns_hosteq(nsp->nsp_faddr, *faddr))
                                       continue;
                               if( nsp->nsp_fport != fport) {
                                       if(nsp->nsp_fport != 0)
                                               continue;
                                       else
                                               wildcard++;
                               }
                       }
               }
               if (wildcard && wildp==0)
                       continue;
               if (wildcard < matchwild) {
                       match = nsp;
                       matchwild = wildcard;
                       if (wildcard == 0)
                               break;
               }
       }
       return (match);
}