1 /* 2 * Copyright (c) 1982 Regents of the University of California. 3 * All rights reserved. The Berkeley software License Agreement 4 * specifies the terms and conditions for redistribution. 5 * 6 * @(#)ns_pcb.c 6.4 (Berkeley) 08/09/85 7 */ 8 9 #include "param.h" 10 #include "systm.h" 11 #include "dir.h" 12 #include "user.h" 13 #include "mbuf.h" 14 #include "socket.h" 15 #include "socketvar.h" 16 #include "../net/if.h" 17 #include "../net/route.h" 18 #include "protosw.h" 19 20 #include "ns.h" 21 #include "ns_if.h" 22 #include "ns_pcb.h" 23 24 struct ns_addr zerons_addr; 25 26 ns_pcballoc(so, head) 27 struct socket *so; 28 struct nspcb *head; 29 { 30 struct mbuf *m; 31 register struct nspcb *nsp; 32 33 m = m_getclr(M_DONTWAIT, MT_PCB); 34 if (m == NULL) 35 return (ENOBUFS); 36 nsp = mtod(m, struct nspcb *); 37 nsp->nsp_socket = so; 38 insque(nsp, head); 39 so->so_pcb = (caddr_t)nsp; 40 return (0); 41 } 42 43 ns_pcbbind(nsp, nam) 44 register struct nspcb *nsp; 45 struct mbuf *nam; 46 { 47 register struct sockaddr_ns *sns; 48 u_short lport = 0; 49 50 if(nsp->nsp_lport || !ns_nullhost(nsp->nsp_laddr)) 51 return (EINVAL); 52 if (nam == 0) 53 goto noname; 54 sns = mtod(nam, struct sockaddr_ns *); 55 if (nam->m_len != sizeof (*sns)) 56 return (EINVAL); 57 if (!ns_nullhost(sns->sns_addr)) { 58 int tport = sns->sns_port; 59 60 sns->sns_port = 0; /* yech... */ 61 if (ifa_ifwithaddr((struct sockaddr *)sns) == 0) 62 return (EADDRNOTAVAIL); 63 sns->sns_port = tport; 64 } 65 lport = sns->sns_port; 66 if (lport) { 67 u_short aport = ntohs(lport); 68 69 if (aport < NSPORT_RESERVED && u.u_uid != 0) 70 return (EACCES); 71 if (ns_pcblookup(&zerons_addr, lport, 0)) 72 return (EADDRINUSE); 73 } 74 nsp->nsp_laddr = sns->sns_addr; 75 noname: 76 if (lport == 0) 77 do { 78 if (nspcb.nsp_lport++ < NSPORT_RESERVED) 79 nspcb.nsp_lport = NSPORT_RESERVED; 80 lport = htons(nspcb.nsp_lport); 81 } while (ns_pcblookup(&zerons_addr, lport, 0)); 82 nsp->nsp_lport = lport; 83 return (0); 84 } 85 86 /* 87 * Connect from a socket to a specified address. 88 * Both address and port must be specified in argument sns. 89 * If don't have a local address for this socket yet, 90 * then pick one. 91 */ 92 ns_pcbconnect(nsp, nam) 93 struct nspcb *nsp; 94 struct mbuf *nam; 95 { 96 struct ns_ifaddr *ia; 97 struct sockaddr_ns *ifaddr; 98 register struct sockaddr_ns *sns = mtod(nam, struct sockaddr_ns *); 99 100 if (nam->m_len != sizeof (*sns)) 101 return (EINVAL); 102 if (sns->sns_family != AF_NS) 103 return (EAFNOSUPPORT); 104 if (sns->sns_port==0 || ns_nullhost(sns->sns_addr)) 105 return (EADDRNOTAVAIL); 106 if (ns_nullhost(nsp->nsp_laddr) && 107 ((*(long *)&nsp->nsp_lastnet)!=ns_netof(sns->sns_addr))) { 108 ia = (struct ns_ifaddr *)ifa_ifwithnet((struct sockaddr *)sns); 109 if (ia == 0) { 110 register struct route *ro; 111 struct ifnet *ifp; 112 113 /* 114 * If route is known or can be allocated now, 115 * our src addr is taken from the i/f, else punt. 116 */ 117 ro = &nsp->nsp_route; 118 #define satosns(sa) ((struct sockaddr_ns *)(sa)) 119 if (ro->ro_rt && 120 !ns_hosteq(satosns(&ro->ro_dst)->sns_addr, 121 sns->sns_addr)) { 122 RTFREE(ro->ro_rt); 123 ro->ro_rt = (struct rtentry *)0; 124 } 125 if ((ro->ro_rt == (struct rtentry *)0) || 126 (ifp = ro->ro_rt->rt_ifp) == (struct ifnet *)0) { 127 /* No route yet, so try to acquire one */ 128 ro->ro_dst.sa_family = AF_NS; 129 satosns(&ro->ro_dst)->sns_addr = 130 sns->sns_addr; 131 rtalloc(ro); 132 if (ro->ro_rt == 0) 133 ifp = (struct ifnet *)0; 134 else 135 ifp = ro->ro_rt->rt_ifp; 136 } 137 if (ifp) { 138 for (ia = ns_ifaddr; ia; ia = ia->ia_next) 139 if (ia->ia_ifp == ifp) 140 break; 141 } 142 if (ia == 0) 143 ia = ns_ifaddr; 144 if (ia == 0) 145 return (EADDRNOTAVAIL); 146 } 147 ifaddr = satosns(&ia->ia_addr); 148 nsp->nsp_laddr.x_net = ifaddr->sns_addr.x_net; 149 nsp->nsp_lastnet = sns->sns_addr.x_net; 150 } 151 if (ns_pcblookup(&sns->sns_addr, nsp->nsp_lport, 0)) 152 return (EADDRINUSE); 153 if (ns_nullhost(nsp->nsp_laddr)) { 154 if (nsp->nsp_lport == 0) 155 (void) ns_pcbbind(nsp, (struct mbuf *)0); 156 nsp->nsp_laddr.x_host = ns_thishost; 157 } 158 nsp->nsp_faddr = sns->sns_addr; 159 /* Includes nsp->nsp_fport = sns->sns_port; */ 160 return (0); 161 } 162 163 ns_pcbdisconnect(nsp) 164 struct nspcb *nsp; 165 { 166 167 nsp->nsp_faddr = zerons_addr; 168 if (nsp->nsp_socket->so_state & SS_NOFDREF) 169 ns_pcbdetach(nsp); 170 } 171 172 ns_pcbdetach(nsp) 173 struct nspcb *nsp; 174 { 175 struct socket *so = nsp->nsp_socket; 176 177 so->so_pcb = 0; 178 sofree(so); 179 if (nsp->nsp_route.ro_rt) 180 rtfree(nsp->nsp_route.ro_rt); 181 remque(nsp); 182 (void) m_free(dtom(nsp)); 183 } 184 185 ns_setsockaddr(nsp, nam) 186 register struct nspcb *nsp; 187 struct mbuf *nam; 188 { 189 register struct sockaddr_ns *sns = mtod(nam, struct sockaddr_ns *); 190 191 nam->m_len = sizeof (*sns); 192 sns = mtod(nam, struct sockaddr_ns *); 193 bzero((caddr_t)sns, sizeof (*sns)); 194 sns->sns_family = AF_NS; 195 sns->sns_addr = nsp->nsp_laddr; 196 } 197 198 ns_setpeeraddr(nsp, nam) 199 register struct nspcb *nsp; 200 struct mbuf *nam; 201 { 202 register struct sockaddr_ns *sns = mtod(nam, struct sockaddr_ns *); 203 204 nam->m_len = sizeof (*sns); 205 sns = mtod(nam, struct sockaddr_ns *); 206 bzero((caddr_t)sns, sizeof (*sns)); 207 sns->sns_family = AF_NS; 208 sns->sns_addr = nsp->nsp_faddr; 209 } 210 211 /* 212 * Pass some notification to all connections of a protocol 213 * associated with address dst. Call the 214 * protocol specific routine to handle each connection. 215 * Also pass an extra paramter via the nspcb. (which may in fact 216 * be a parameter list!) 217 */ 218 ns_pcbnotify(dst, errno, notify, param) 219 register struct ns_addr *dst; 220 long param; 221 int errno, (*notify)(); 222 { 223 register struct nspcb *nsp, *oinp; 224 int s = splimp(); 225 226 for (nsp = (&nspcb)->nsp_next; nsp != (&nspcb);) { 227 if (!ns_hosteq(*dst,nsp->nsp_faddr)) { 228 next: 229 nsp = nsp->nsp_next; 230 continue; 231 } 232 if (nsp->nsp_socket == 0) 233 goto next; 234 if (errno) 235 nsp->nsp_socket->so_error = errno; 236 oinp = nsp; 237 nsp = nsp->nsp_next; 238 oinp->nsp_notify_param = param; 239 (*notify)(oinp); 240 } 241 splx(s); 242 } 243 244 /* 245 * After a routing change, flush old routing 246 * and allocate a (hopefully) better one. 247 */ 248 ns_rtchange(nsp) 249 struct nspcb *nsp; 250 { 251 if (nsp->nsp_route.ro_rt) { 252 rtfree(nsp->nsp_route.ro_rt); 253 nsp->nsp_route.ro_rt = 0; 254 /* 255 * A new route can be allocated the next time 256 * output is attempted. 257 */ 258 } 259 /* SHOULD NOTIFY HIGHER-LEVEL PROTOCOLS */ 260 } 261 262 struct nspcb * 263 ns_pcblookup(faddr, lport, wildp) 264 struct ns_addr *faddr; 265 u_short lport; 266 { 267 register struct nspcb *nsp, *match = 0; 268 int matchwild = 3, wildcard; 269 u_short fport; 270 271 fport = faddr->x_port; 272 for (nsp = (&nspcb)->nsp_next; nsp != (&nspcb); nsp = nsp->nsp_next) { 273 if (nsp->nsp_lport != lport) 274 continue; 275 wildcard = 0; 276 if (ns_nullhost(nsp->nsp_faddr)) { 277 if (!ns_nullhost(*faddr)) 278 wildcard++; 279 } else { 280 if (ns_nullhost(*faddr)) 281 wildcard++; 282 else { 283 if (!ns_hosteq(nsp->nsp_faddr, *faddr)) 284 continue; 285 if( nsp->nsp_fport != fport) { 286 if(nsp->nsp_fport != 0) 287 continue; 288 else 289 wildcard++; 290 } 291 } 292 } 293 if (wildcard && wildp==0) 294 continue; 295 if (wildcard < matchwild) { 296 match = nsp; 297 matchwild = wildcard; 298 if (wildcard == 0) 299 break; 300 } 301 } 302 return (match); 303 } 304