1 /* 2 * Copyright (c) 1984, 1985 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.6 (Berkeley) 02/03/86 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 register struct sockaddr_ns *sns = mtod(nam, struct sockaddr_ns *); 98 register struct ns_addr *dst; 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 (!ns_neteq(nsp->nsp_lastdst, sns->sns_addr))) { 108 register struct route *ro; 109 struct ifnet *ifp; 110 ro = &nsp->nsp_route; 111 dst = &satons_addr(ro->ro_dst); 112 113 ia = ns_iaonnetof(&sns->sns_addr); 114 if (ia == 0) { 115 /* 116 * If route is known or can be allocated now, 117 * our src addr is taken from the i/f, else punt. 118 */ 119 if (ro->ro_rt && 120 !ns_hosteq(*dst, sns->sns_addr)) { 121 RTFREE(ro->ro_rt); 122 ro->ro_rt = (struct rtentry *)0; 123 } 124 if ((ro->ro_rt == (struct rtentry *)0) || 125 (ifp = ro->ro_rt->rt_ifp) == (struct ifnet *)0) { 126 /* No route yet, so try to acquire one */ 127 ro->ro_dst.sa_family = AF_NS; 128 *dst = sns->sns_addr; 129 dst->x_port = 0; 130 rtalloc(ro); 131 if (ro->ro_rt == 0) 132 ifp = (struct ifnet *)0; 133 else 134 ifp = ro->ro_rt->rt_ifp; 135 } 136 if (ifp) { 137 for (ia = ns_ifaddr; ia; ia = ia->ia_next) 138 if (ia->ia_ifp == ifp) 139 break; 140 } 141 if (ia == 0) 142 ia = ns_ifaddr; 143 if (ia == 0) 144 return (EADDRNOTAVAIL); 145 } else if (ro->ro_rt) { 146 if (ns_neteq(*dst, sns->sns_addr)) { 147 /* 148 * This assume that we have no GH 149 * type routes. 150 */ 151 if (ro->ro_rt->rt_flags & RTF_HOST) { 152 if (!ns_hosteq(*dst, sns->sns_addr)) 153 goto re_route; 154 155 } 156 if ((ro->ro_rt->rt_flags & RTF_GATEWAY) == 0) { 157 dst->x_host = sns->sns_addr.x_host; 158 } 159 /* 160 * Otherwise, we go through the same gateway 161 * and dst is already set up. 162 */ 163 } else { 164 re_route: 165 RTFREE(ro->ro_rt); 166 ro->ro_rt = (struct rtentry *)0; 167 } 168 } 169 nsp->nsp_laddr.x_net = satons_addr(ia->ia_addr).x_net; 170 nsp->nsp_lastdst = sns->sns_addr; 171 } 172 if (ns_pcblookup(&sns->sns_addr, nsp->nsp_lport, 0)) 173 return (EADDRINUSE); 174 if (ns_nullhost(nsp->nsp_laddr)) { 175 if (nsp->nsp_lport == 0) 176 (void) ns_pcbbind(nsp, (struct mbuf *)0); 177 nsp->nsp_laddr.x_host = ns_thishost; 178 } 179 nsp->nsp_faddr = sns->sns_addr; 180 /* Includes nsp->nsp_fport = sns->sns_port; */ 181 return (0); 182 } 183 184 ns_pcbdisconnect(nsp) 185 struct nspcb *nsp; 186 { 187 188 nsp->nsp_faddr = zerons_addr; 189 if (nsp->nsp_socket->so_state & SS_NOFDREF) 190 ns_pcbdetach(nsp); 191 } 192 193 ns_pcbdetach(nsp) 194 struct nspcb *nsp; 195 { 196 struct socket *so = nsp->nsp_socket; 197 198 so->so_pcb = 0; 199 sofree(so); 200 if (nsp->nsp_route.ro_rt) 201 rtfree(nsp->nsp_route.ro_rt); 202 remque(nsp); 203 (void) m_free(dtom(nsp)); 204 } 205 206 ns_setsockaddr(nsp, nam) 207 register struct nspcb *nsp; 208 struct mbuf *nam; 209 { 210 register struct sockaddr_ns *sns = mtod(nam, struct sockaddr_ns *); 211 212 nam->m_len = sizeof (*sns); 213 sns = mtod(nam, struct sockaddr_ns *); 214 bzero((caddr_t)sns, sizeof (*sns)); 215 sns->sns_family = AF_NS; 216 sns->sns_addr = nsp->nsp_laddr; 217 } 218 219 ns_setpeeraddr(nsp, nam) 220 register struct nspcb *nsp; 221 struct mbuf *nam; 222 { 223 register struct sockaddr_ns *sns = mtod(nam, struct sockaddr_ns *); 224 225 nam->m_len = sizeof (*sns); 226 sns = mtod(nam, struct sockaddr_ns *); 227 bzero((caddr_t)sns, sizeof (*sns)); 228 sns->sns_family = AF_NS; 229 sns->sns_addr = nsp->nsp_faddr; 230 } 231 232 /* 233 * Pass some notification to all connections of a protocol 234 * associated with address dst. Call the 235 * protocol specific routine to handle each connection. 236 * Also pass an extra paramter via the nspcb. (which may in fact 237 * be a parameter list!) 238 */ 239 ns_pcbnotify(dst, errno, notify, param) 240 register struct ns_addr *dst; 241 long param; 242 int errno, (*notify)(); 243 { 244 register struct nspcb *nsp, *oinp; 245 int s = splimp(); 246 247 for (nsp = (&nspcb)->nsp_next; nsp != (&nspcb);) { 248 if (!ns_hosteq(*dst,nsp->nsp_faddr)) { 249 next: 250 nsp = nsp->nsp_next; 251 continue; 252 } 253 if (nsp->nsp_socket == 0) 254 goto next; 255 if (errno) 256 nsp->nsp_socket->so_error = errno; 257 oinp = nsp; 258 nsp = nsp->nsp_next; 259 oinp->nsp_notify_param = param; 260 (*notify)(oinp); 261 } 262 splx(s); 263 } 264 265 /* 266 * After a routing change, flush old routing 267 * and allocate a (hopefully) better one. 268 */ 269 ns_rtchange(nsp) 270 struct nspcb *nsp; 271 { 272 if (nsp->nsp_route.ro_rt) { 273 rtfree(nsp->nsp_route.ro_rt); 274 nsp->nsp_route.ro_rt = 0; 275 /* 276 * A new route can be allocated the next time 277 * output is attempted. 278 */ 279 } 280 /* SHOULD NOTIFY HIGHER-LEVEL PROTOCOLS */ 281 } 282 283 struct nspcb * 284 ns_pcblookup(faddr, lport, wildp) 285 struct ns_addr *faddr; 286 u_short lport; 287 { 288 register struct nspcb *nsp, *match = 0; 289 int matchwild = 3, wildcard; 290 u_short fport; 291 292 fport = faddr->x_port; 293 for (nsp = (&nspcb)->nsp_next; nsp != (&nspcb); nsp = nsp->nsp_next) { 294 if (nsp->nsp_lport != lport) 295 continue; 296 wildcard = 0; 297 if (ns_nullhost(nsp->nsp_faddr)) { 298 if (!ns_nullhost(*faddr)) 299 wildcard++; 300 } else { 301 if (ns_nullhost(*faddr)) 302 wildcard++; 303 else { 304 if (!ns_hosteq(nsp->nsp_faddr, *faddr)) 305 continue; 306 if( nsp->nsp_fport != fport) { 307 if(nsp->nsp_fport != 0) 308 continue; 309 else 310 wildcard++; 311 } 312 } 313 } 314 if (wildcard && wildp==0) 315 continue; 316 if (wildcard < matchwild) { 317 match = nsp; 318 matchwild = wildcard; 319 if (wildcard == 0) 320 break; 321 } 322 } 323 return (match); 324 } 325