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.2 (Berkeley) 06/08/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 nsp *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 ((struct sockaddr_ns *) &ro->ro_dst)->sns_addr = 130 sns->sns_addr; 131 rtalloc(ro); 132 if (ro->ro_rt == 0) 133 ia = (struct ns_ifaddr *) 0; 134 else 135 for (ia = ns_ifaddr; ia; ia = ia->ia_next) 136 if (ia->ia_ifp == ifp) 137 break; 138 } 139 if (ia == 0) 140 ia = ns_ifaddr; 141 if (ia == 0) 142 return (EADDRNOTAVAIL); 143 } 144 ifaddr = (struct sockaddr_ns *)&ia->ia_addr; 145 nsp->nsp_laddr.x_net = ifaddr->sns_addr.x_net; 146 nsp->nsp_lastnet = sns->sns_addr.x_net; 147 } 148 if (ns_pcblookup(&sns->sns_addr, nsp->nsp_lport, 0)) 149 return (EADDRINUSE); 150 if (ns_nullhost(nsp->nsp_laddr)) { 151 if (nsp->nsp_lport == 0) 152 ns_pcbbind(nsp, (struct mbuf *)0); 153 nsp->nsp_laddr.x_host = ns_thishost; 154 } 155 nsp->nsp_faddr = sns->sns_addr; 156 /* Includes nsp->nsp_fport = sns->sns_port; */ 157 return (0); 158 } 159 160 ns_pcbdisconnect(nsp) 161 struct nspcb *nsp; 162 { 163 164 nsp->nsp_faddr = zerons_addr; 165 if (nsp->nsp_socket->so_state & SS_NOFDREF) 166 ns_pcbdetach(nsp); 167 } 168 169 ns_pcbdetach(nsp) 170 struct nspcb *nsp; 171 { 172 struct socket *so = nsp->nsp_socket; 173 174 so->so_pcb = 0; 175 sofree(so); 176 if (nsp->nsp_route.ro_rt) 177 rtfree(nsp->nsp_route.ro_rt); 178 remque(nsp); 179 (void) m_free(dtom(nsp)); 180 } 181 182 ns_setsockaddr(nsp, nam) 183 register struct nspcb *nsp; 184 struct mbuf *nam; 185 { 186 register struct sockaddr_ns *sns = mtod(nam, struct sockaddr_ns *); 187 188 nam->m_len = sizeof (*sns); 189 sns = mtod(nam, struct sockaddr_ns *); 190 bzero((caddr_t)sns, sizeof (*sns)); 191 sns->sns_family = AF_NS; 192 sns->sns_addr = nsp->nsp_laddr; 193 } 194 195 ns_setpeeraddr(nsp, nam) 196 register struct nspcb *nsp; 197 struct mbuf *nam; 198 { 199 register struct sockaddr_ns *sns = mtod(nam, struct sockaddr_ns *); 200 201 nam->m_len = sizeof (*sns); 202 sns = mtod(nam, struct sockaddr_ns *); 203 bzero((caddr_t)sns, sizeof (*sns)); 204 sns->sns_family = AF_NS; 205 sns->sns_addr = nsp->nsp_faddr; 206 } 207 208 /* 209 * Pass some notification to all connections of a protocol 210 * associated with address dst. Call the 211 * protocol specific routine to handle each connection. 212 * Also pass an extra paramter via the nspcb. (which may in fact 213 * be a parameter list!) 214 */ 215 ns_pcbnotify(dst, errno, notify, param) 216 register struct ns_addr *dst; 217 long param; 218 int errno, (*notify)(); 219 { 220 register struct nspcb *nsp, *oinp; 221 int s = splimp(); 222 223 for (nsp = (&nspcb)->nsp_next; nsp != (&nspcb);) { 224 if (!ns_hosteq(*dst,nsp->nsp_faddr)) { 225 next: 226 nsp = nsp->nsp_next; 227 continue; 228 } 229 if (nsp->nsp_socket == 0) 230 goto next; 231 if (errno) 232 nsp->nsp_socket->so_error = errno; 233 oinp = nsp; 234 nsp = nsp->nsp_next; 235 oinp->nsp_notify_param = param; 236 (*notify)(oinp); 237 } 238 splx(s); 239 } 240 241 /* 242 * After a routing change, flush old routing 243 * and allocate a (hopefully) better one. 244 */ 245 ns_rtchange(nsp) 246 struct nspcb *nsp; 247 { 248 if (nsp->nsp_route.ro_rt) { 249 rtfree(nsp->nsp_route.ro_rt); 250 nsp->nsp_route.ro_rt = 0; 251 /* 252 * A new route can be allocated the next time 253 * output is attempted. 254 */ 255 } 256 /* SHOULD NOTIFY HIGHER-LEVEL PROTOCOLS */ 257 } 258 259 struct nspcb * 260 ns_pcblookup(faddr, lport, wildp) 261 struct ns_addr *faddr; 262 u_short lport; 263 { 264 register struct nspcb *nsp, *match = 0; 265 int matchwild = 3, wildcard; 266 u_short fport; 267 268 fport = faddr->x_port; 269 for (nsp = (&nspcb)->nsp_next; nsp != (&nspcb); nsp = nsp->nsp_next) { 270 if (nsp->nsp_lport != lport) 271 continue; 272 wildcard = 0; 273 if (ns_nullhost(nsp->nsp_faddr)) { 274 if (!ns_nullhost(*faddr)) 275 wildcard++; 276 } else { 277 if (ns_nullhost(*faddr)) 278 wildcard++; 279 else { 280 if (!ns_hosteq(nsp->nsp_faddr, *faddr)) 281 continue; 282 if( nsp->nsp_fport != fport) { 283 if(nsp->nsp_fport != 0) 284 continue; 285 else 286 wildcard++; 287 } 288 } 289 } 290 if (wildcard && wildp==0) 291 continue; 292 if (wildcard < matchwild) { 293 match = nsp; 294 matchwild = wildcard; 295 if (wildcard == 0) 296 break; 297 } 298 } 299 return (match); 300 } 301