if_srt.c revision 1.2.2.5
1 1.2.2.5 yamt /* $NetBSD: if_srt.c,v 1.2.2.5 2008/01/21 09:47:06 yamt Exp $ */ 2 1.2.2.2 yamt /* This file is in the public domain. */ 3 1.2.2.2 yamt 4 1.2.2.5 yamt #include <sys/cdefs.h> 5 1.2.2.5 yamt __KERNEL_RCSID(0, "$NetBSD: if_srt.c,v 1.2.2.5 2008/01/21 09:47:06 yamt Exp $"); 6 1.2.2.5 yamt 7 1.2.2.2 yamt #include "opt_inet.h" 8 1.2.2.2 yamt 9 1.2.2.2 yamt #if !defined(INET) && !defined(INET6) 10 1.2.2.2 yamt #error "srt without INET/INET6?" 11 1.2.2.2 yamt #endif 12 1.2.2.2 yamt 13 1.2.2.2 yamt #ifndef SRT_MAXUNIT 14 1.2.2.2 yamt #define SRT_MAXUNIT 255 15 1.2.2.2 yamt #endif 16 1.2.2.2 yamt 17 1.2.2.3 yamt /* include-file bug workarounds */ 18 1.2.2.3 yamt #include <sys/types.h> /* sys/conf.h */ 19 1.2.2.3 yamt #include <sys/resource.h> /* sys/resourcevar.h (uvm/uvm_param.h, sys/mbuf.h) */ 20 1.2.2.3 yamt #include <netinet/in.h> /* netinet/ip.h */ 21 1.2.2.3 yamt #include <sys/param.h> /* sys/mbuf.h */ 22 1.2.2.3 yamt #include <netinet/in_systm.h> /* netinet/ip.h */ 23 1.2.2.3 yamt 24 1.2.2.2 yamt #include <sys/conf.h> 25 1.2.2.2 yamt #include <sys/mbuf.h> 26 1.2.2.2 yamt #include <sys/errno.h> 27 1.2.2.2 yamt #include <sys/fcntl.h> 28 1.2.2.2 yamt #include <sys/param.h> 29 1.2.2.2 yamt #include <sys/ioctl.h> 30 1.2.2.2 yamt #include <netinet/ip.h> 31 1.2.2.2 yamt #include <netinet/ip6.h> 32 1.2.2.2 yamt #include <net/if_types.h> 33 1.2.2.2 yamt #include <machine/stdarg.h> 34 1.2.2.2 yamt 35 1.2.2.2 yamt #include "if_srt.h" 36 1.2.2.2 yamt #include "bpfilter.h" 37 1.2.2.2 yamt 38 1.2.2.2 yamt /* until we know what to pass to bpfattach.... */ 39 1.2.2.2 yamt #undef NBPFILTER 40 1.2.2.2 yamt #define NBPFILTER 0 41 1.2.2.2 yamt 42 1.2.2.2 yamt typedef struct srt_rt RT; 43 1.2.2.2 yamt typedef struct softc SOFTC; 44 1.2.2.2 yamt 45 1.2.2.2 yamt struct softc { 46 1.2.2.2 yamt struct ifnet intf; /* XXX interface botch */ 47 1.2.2.2 yamt int unit; 48 1.2.2.2 yamt int nrt; 49 1.2.2.2 yamt RT **rts; 50 1.2.2.2 yamt unsigned int flags; /* SSF_* values from if_srt.h */ 51 1.2.2.2 yamt #define SSF_UCHG (SSF_MTULOCK) /* userland-changeable bits */ 52 1.2.2.2 yamt unsigned int kflags; /* bits private to this file */ 53 1.2.2.2 yamt #define SKF_CDEVOPEN 0x00000001 54 1.2.2.2 yamt } ; 55 1.2.2.2 yamt 56 1.2.2.2 yamt static SOFTC *softcv[SRT_MAXUNIT+1]; 57 1.2.2.2 yamt static unsigned int global_flags; 58 1.2.2.2 yamt 59 1.2.2.2 yamt /* Internal routines. */ 60 1.2.2.2 yamt 61 1.2.2.2 yamt static unsigned int ipv4_masks[33] 62 1.2.2.2 yamt = { 0x00000000, /* /0 */ 63 1.2.2.2 yamt 0x80000000, 0xc0000000, 0xe0000000, 0xf0000000, /* /1 - /4 */ 64 1.2.2.2 yamt 0xf8000000, 0xfc000000, 0xfe000000, 0xff000000, /* /5 - /8 */ 65 1.2.2.2 yamt 0xff800000, 0xffc00000, 0xffe00000, 0xfff00000, /* /9 - /12 */ 66 1.2.2.2 yamt 0xfff80000, 0xfffc0000, 0xfffe0000, 0xffff0000, /* /13 - /16 */ 67 1.2.2.2 yamt 0xffff8000, 0xffffc000, 0xffffe000, 0xfffff000, /* /17 - /20 */ 68 1.2.2.2 yamt 0xfffff800, 0xfffffc00, 0xfffffe00, 0xffffff00, /* /21 - /24 */ 69 1.2.2.2 yamt 0xffffff80, 0xffffffc0, 0xffffffe0, 0xfffffff0, /* /25 - /28 */ 70 1.2.2.2 yamt 0xfffffff8, 0xfffffffc, 0xfffffffe, 0xffffffff /* /29 - /32 */ }; 71 1.2.2.2 yamt 72 1.2.2.2 yamt static void update_mtu(SOFTC *sc) 73 1.2.2.2 yamt { 74 1.2.2.2 yamt int mtu; 75 1.2.2.2 yamt int i; 76 1.2.2.2 yamt RT *r; 77 1.2.2.2 yamt 78 1.2.2.2 yamt if (sc->flags & SSF_MTULOCK) return; 79 1.2.2.2 yamt mtu = 65535; 80 1.2.2.2 yamt for (i=sc->nrt-1;i>=0;i--) 81 1.2.2.2 yamt { r = sc->rts[i]; 82 1.2.2.2 yamt if (r->u.dstifp->if_mtu < mtu) mtu = r->u.dstifp->if_mtu; 83 1.2.2.2 yamt } 84 1.2.2.2 yamt sc->intf.if_mtu = mtu; 85 1.2.2.2 yamt } 86 1.2.2.2 yamt 87 1.2.2.2 yamt static RT *find_rt(SOFTC *sc, int af, ...) 88 1.2.2.2 yamt { 89 1.2.2.2 yamt int i; 90 1.2.2.2 yamt RT *r; 91 1.2.2.2 yamt struct in_addr ia; 92 1.2.2.2 yamt struct in6_addr ia6; 93 1.2.2.2 yamt va_list ap; 94 1.2.2.2 yamt 95 1.2.2.2 yamt ia.s_addr = 0; ia6.s6_addr[0] = 0; /* shut up incorrect -Wuninitialized */ 96 1.2.2.2 yamt va_start(ap,af); 97 1.2.2.2 yamt switch (af) 98 1.2.2.2 yamt { case AF_INET: 99 1.2.2.2 yamt ia = va_arg(ap,struct in_addr); 100 1.2.2.2 yamt break; 101 1.2.2.2 yamt case AF_INET6: 102 1.2.2.2 yamt ia6 = va_arg(ap,struct in6_addr); 103 1.2.2.2 yamt break; 104 1.2.2.2 yamt default: 105 1.2.2.2 yamt panic("if_srt find_rt: impossible address family"); 106 1.2.2.2 yamt break; 107 1.2.2.2 yamt } 108 1.2.2.2 yamt va_end(ap); 109 1.2.2.2 yamt for (i=0;i<sc->nrt;i++) 110 1.2.2.2 yamt { r = sc->rts[i]; 111 1.2.2.2 yamt if (r->af != af) continue; 112 1.2.2.2 yamt switch (af) 113 1.2.2.2 yamt { case AF_INET: 114 1.2.2.2 yamt if ((ia.s_addr & ipv4_masks[r->srcmask]) == r->srcmatch.v4.s_addr) return(r); 115 1.2.2.2 yamt break; 116 1.2.2.2 yamt case AF_INET6: 117 1.2.2.2 yamt if ((r->srcmask >= 8) && bcmp(&ia6,&r->srcmatch.v6,r->srcmask/8)) continue; 118 1.2.2.2 yamt if ( (r->srcmask % 8) && 119 1.2.2.2 yamt ( ( ia6.s6_addr[r->srcmask/8] ^ 120 1.2.2.2 yamt r->srcmatch.v6.s6_addr[r->srcmask/8] ) & 121 1.2.2.2 yamt 0xff & (0xff00 >> (r->srcmask%8)) ) ) continue; 122 1.2.2.2 yamt return(r); 123 1.2.2.2 yamt break; 124 1.2.2.2 yamt default: 125 1.2.2.2 yamt panic("if_srt find_rt: impossible address family 2"); 126 1.2.2.2 yamt break; 127 1.2.2.2 yamt } 128 1.2.2.2 yamt } 129 1.2.2.2 yamt return(0); 130 1.2.2.2 yamt } 131 1.2.2.2 yamt 132 1.2.2.2 yamt /* Network device interface. */ 133 1.2.2.2 yamt 134 1.2.2.4 yamt static int srt_if_ioctl(struct ifnet *intf, u_long cmd, void *data) 135 1.2.2.2 yamt { 136 1.2.2.2 yamt struct ifaddr *ifa; 137 1.2.2.2 yamt struct ifreq *ifr; 138 1.2.2.2 yamt int s; 139 1.2.2.2 yamt int err; 140 1.2.2.2 yamt 141 1.2.2.2 yamt err = 0; 142 1.2.2.2 yamt s = splnet(); 143 1.2.2.2 yamt switch (cmd) 144 1.2.2.2 yamt { case SIOCSIFADDR: 145 1.2.2.2 yamt case SIOCSIFDSTADDR: 146 1.2.2.2 yamt ifa = (void *) data; 147 1.2.2.2 yamt switch (ifa->ifa_addr->sa_family) 148 1.2.2.2 yamt { 149 1.2.2.2 yamt #ifdef INET 150 1.2.2.2 yamt case AF_INET: 151 1.2.2.2 yamt #endif 152 1.2.2.2 yamt #ifdef INET6 153 1.2.2.2 yamt case AF_INET6: 154 1.2.2.2 yamt #endif 155 1.2.2.2 yamt break; 156 1.2.2.2 yamt default: 157 1.2.2.2 yamt err = EAFNOSUPPORT; 158 1.2.2.2 yamt break; 159 1.2.2.2 yamt } 160 1.2.2.2 yamt /* XXX do we need to do more here for either of these? */ 161 1.2.2.2 yamt break; 162 1.2.2.2 yamt case SIOCSIFMTU: 163 1.2.2.2 yamt ifr = (void *) data; 164 1.2.2.2 yamt ((SOFTC *)intf->if_softc)->intf.if_mtu = ifr->ifr_mtu; 165 1.2.2.2 yamt break; 166 1.2.2.2 yamt case SIOCGIFMTU: 167 1.2.2.2 yamt ifr = (void *) data; 168 1.2.2.2 yamt ifr->ifr_mtu = intf->if_mtu; 169 1.2.2.2 yamt break; 170 1.2.2.2 yamt default: 171 1.2.2.2 yamt err = EINVAL; 172 1.2.2.2 yamt break; 173 1.2.2.2 yamt } 174 1.2.2.2 yamt splx(s); 175 1.2.2.2 yamt return(err); 176 1.2.2.2 yamt } 177 1.2.2.2 yamt 178 1.2.2.2 yamt static int srt_if_output( 179 1.2.2.2 yamt struct ifnet *intf, 180 1.2.2.2 yamt struct mbuf *m, 181 1.2.2.3 yamt const struct sockaddr *to, 182 1.2.2.2 yamt struct rtentry *rtp ) 183 1.2.2.2 yamt { 184 1.2.2.2 yamt SOFTC *sc; 185 1.2.2.2 yamt RT *r; 186 1.2.2.2 yamt 187 1.2.2.2 yamt sc = intf->if_softc; 188 1.2.2.2 yamt if (! (intf->if_flags & IFF_UP)) 189 1.2.2.2 yamt { m_freem(m); 190 1.2.2.2 yamt return(ENETDOWN); 191 1.2.2.2 yamt } 192 1.2.2.2 yamt switch (to->sa_family) 193 1.2.2.2 yamt { 194 1.2.2.2 yamt #ifdef INET 195 1.2.2.2 yamt case AF_INET: 196 1.2.2.2 yamt #endif 197 1.2.2.2 yamt { struct ip *ip; 198 1.2.2.2 yamt ip = mtod(m,struct ip *); 199 1.2.2.2 yamt r = find_rt(sc,AF_INET,ip->ip_src); 200 1.2.2.2 yamt } 201 1.2.2.2 yamt break; 202 1.2.2.2 yamt #ifdef INET6 203 1.2.2.2 yamt case AF_INET6: 204 1.2.2.2 yamt #endif 205 1.2.2.2 yamt { struct ip6_hdr *ip; 206 1.2.2.2 yamt ip = mtod(m,struct ip6_hdr *); 207 1.2.2.2 yamt r = find_rt(sc,AF_INET6,ip->ip6_src); 208 1.2.2.2 yamt } 209 1.2.2.2 yamt break; 210 1.2.2.2 yamt default: 211 1.2.2.2 yamt IF_DROP(&intf->if_snd); 212 1.2.2.2 yamt m_freem(m); 213 1.2.2.2 yamt return(EAFNOSUPPORT); 214 1.2.2.2 yamt break; 215 1.2.2.2 yamt } 216 1.2.2.2 yamt /* XXX Do we need to bpf_tap? Or do higher layers now handle that? */ 217 1.2.2.2 yamt /* if_gif.c seems to imply the latter. */ 218 1.2.2.2 yamt intf->if_opackets ++; 219 1.2.2.2 yamt if (! r) 220 1.2.2.2 yamt { intf->if_oerrors ++; 221 1.2.2.2 yamt m_freem(m); 222 1.2.2.2 yamt return(0); 223 1.2.2.2 yamt } 224 1.2.2.2 yamt if (! (m->m_flags & M_PKTHDR)) 225 1.2.2.2 yamt { printf("srt_if_output no PKTHDR\n"); 226 1.2.2.2 yamt m_freem(m); 227 1.2.2.2 yamt return(0); 228 1.2.2.2 yamt } 229 1.2.2.2 yamt intf->if_obytes += m->m_pkthdr.len; 230 1.2.2.2 yamt if (! (r->u.dstifp->if_flags & IFF_UP)) 231 1.2.2.2 yamt { m_freem(m); 232 1.2.2.2 yamt return(0); /* XXX ENETDOWN? */ 233 1.2.2.2 yamt } 234 1.2.2.2 yamt /* XXX is 0 the right last arg here? */ 235 1.2.2.2 yamt return((*r->u.dstifp->if_output)(r->u.dstifp,m,&r->dst.sa,0)); 236 1.2.2.2 yamt } 237 1.2.2.2 yamt 238 1.2.2.2 yamt static int srt_clone_create(struct if_clone *cl, int unit) 239 1.2.2.2 yamt { 240 1.2.2.2 yamt SOFTC *sc; 241 1.2.2.2 yamt 242 1.2.2.2 yamt if ((unit < 0) || (unit > SRT_MAXUNIT)) return(ENXIO); 243 1.2.2.2 yamt if (softcv[unit]) return(EBUSY); 244 1.2.2.2 yamt sc = malloc(sizeof(SOFTC),M_DEVBUF,M_WAIT); 245 1.2.2.2 yamt bzero(&sc->intf,sizeof(sc->intf)); /* XXX */ 246 1.2.2.2 yamt sc->unit = unit; 247 1.2.2.2 yamt sc->nrt = 0; 248 1.2.2.2 yamt sc->rts = 0; 249 1.2.2.2 yamt sc->flags = 0; 250 1.2.2.2 yamt sc->kflags = 0; 251 1.2.2.2 yamt snprintf(&sc->intf.if_xname[0],sizeof(sc->intf.if_xname),"%s%d",cl->ifc_name,unit); 252 1.2.2.2 yamt sc->intf.if_softc = sc; 253 1.2.2.2 yamt sc->intf.if_mtu = 65535; 254 1.2.2.2 yamt sc->intf.if_flags = IFF_POINTOPOINT; 255 1.2.2.2 yamt sc->intf.if_type = IFT_OTHER; 256 1.2.2.2 yamt sc->intf.if_ioctl = &srt_if_ioctl; 257 1.2.2.2 yamt sc->intf.if_output = &srt_if_output; 258 1.2.2.2 yamt sc->intf.if_dlt = DLT_RAW; 259 1.2.2.2 yamt if_attach(&sc->intf); 260 1.2.2.2 yamt if_alloc_sadl(&sc->intf); 261 1.2.2.2 yamt #if NBPFILTER > 0 /* see comment near top */ 262 1.2.2.2 yamt bpfattach(&sc->intf,0/*???*/,0/*???*/); 263 1.2.2.2 yamt #endif 264 1.2.2.2 yamt softcv[unit] = sc; 265 1.2.2.2 yamt return(0); 266 1.2.2.2 yamt } 267 1.2.2.2 yamt 268 1.2.2.2 yamt static int srt_clone_destroy(struct ifnet *intf) 269 1.2.2.2 yamt { 270 1.2.2.2 yamt SOFTC *sc; 271 1.2.2.2 yamt 272 1.2.2.2 yamt sc = intf->if_softc; 273 1.2.2.2 yamt if ((intf->if_flags & IFF_UP) || (sc->kflags & SKF_CDEVOPEN)) return(EBUSY); 274 1.2.2.2 yamt #if NBPFILTER > 0 275 1.2.2.2 yamt bpfdetach(intf); 276 1.2.2.2 yamt #endif 277 1.2.2.2 yamt if_detach(intf); 278 1.2.2.2 yamt if ((sc->unit < 0) || (sc->unit > SRT_MAXUNIT)) 279 1.2.2.2 yamt { panic("srt_clone_destroy: impossible unit %d\n",sc->unit); 280 1.2.2.2 yamt } 281 1.2.2.2 yamt if (softcv[sc->unit] != sc) 282 1.2.2.2 yamt { panic("srt_clone_destroy: bad backpointer ([%d]=%p not %p)\n", 283 1.2.2.2 yamt sc->unit,(void *)softcv[sc->unit],(void *)sc); 284 1.2.2.2 yamt } 285 1.2.2.2 yamt softcv[sc->unit] = 0; 286 1.2.2.2 yamt free(sc,M_DEVBUF); 287 1.2.2.2 yamt return(0); 288 1.2.2.2 yamt } 289 1.2.2.2 yamt 290 1.2.2.2 yamt struct if_clone srt_clone = 291 1.2.2.2 yamt IF_CLONE_INITIALIZER("srt",&srt_clone_create,&srt_clone_destroy); 292 1.2.2.2 yamt 293 1.2.2.2 yamt extern void srtattach(void); 294 1.2.2.2 yamt void srtattach(void) 295 1.2.2.2 yamt { 296 1.2.2.2 yamt int i; 297 1.2.2.2 yamt 298 1.2.2.2 yamt for (i=SRT_MAXUNIT;i>=0;i--) softcv[i] = 0; 299 1.2.2.2 yamt global_flags = 0; 300 1.2.2.2 yamt if_clone_attach(&srt_clone); 301 1.2.2.2 yamt } 302 1.2.2.2 yamt 303 1.2.2.2 yamt /* Special-device interface. */ 304 1.2.2.2 yamt 305 1.2.2.2 yamt static int srt_open(dev_t dev, int flag, int mode, struct lwp *l) 306 1.2.2.2 yamt { 307 1.2.2.2 yamt int unit; 308 1.2.2.2 yamt SOFTC *sc; 309 1.2.2.2 yamt 310 1.2.2.2 yamt unit = minor(dev); 311 1.2.2.2 yamt if ((unit < 0) || (unit > SRT_MAXUNIT)) return(ENXIO); 312 1.2.2.2 yamt sc = softcv[unit]; 313 1.2.2.2 yamt if (! sc) return(ENXIO); 314 1.2.2.2 yamt sc->kflags |= SKF_CDEVOPEN; 315 1.2.2.2 yamt return(0); 316 1.2.2.2 yamt } 317 1.2.2.2 yamt 318 1.2.2.2 yamt static int srt_close(dev_t dev, int flag, int mode, struct lwp *l) 319 1.2.2.2 yamt { 320 1.2.2.2 yamt int unit; 321 1.2.2.2 yamt SOFTC *sc; 322 1.2.2.2 yamt 323 1.2.2.2 yamt unit = minor(dev); 324 1.2.2.2 yamt if ((unit < 0) || (unit > SRT_MAXUNIT)) return(ENXIO); 325 1.2.2.2 yamt sc = softcv[unit]; 326 1.2.2.2 yamt if (! sc) return(ENXIO); 327 1.2.2.2 yamt sc->kflags &= ~SKF_CDEVOPEN; 328 1.2.2.2 yamt return(0); 329 1.2.2.2 yamt } 330 1.2.2.2 yamt 331 1.2.2.2 yamt static int srt_ioctl( 332 1.2.2.2 yamt dev_t dev, 333 1.2.2.2 yamt u_long cmd, 334 1.2.2.4 yamt void *data, 335 1.2.2.2 yamt int flag, 336 1.2.2.2 yamt struct lwp *l ) 337 1.2.2.2 yamt { 338 1.2.2.2 yamt SOFTC *sc; 339 1.2.2.2 yamt RT *dr; 340 1.2.2.2 yamt RT *scr; 341 1.2.2.2 yamt struct ifnet *intf; 342 1.2.2.2 yamt char nbuf[IFNAMSIZ]; 343 1.2.2.2 yamt 344 1.2.2.2 yamt sc = softcv[minor(dev)]; 345 1.2.2.2 yamt if (! sc) panic("srt_ioctl: softc disappeared"); 346 1.2.2.2 yamt switch (cmd) 347 1.2.2.2 yamt { case SRT_GETNRT: 348 1.2.2.2 yamt if (! (flag & FREAD)) return(EBADF); 349 1.2.2.2 yamt *(unsigned int *)data = sc->nrt; 350 1.2.2.2 yamt return(0); 351 1.2.2.2 yamt break; 352 1.2.2.2 yamt case SRT_GETRT: 353 1.2.2.2 yamt if (! (flag & FREAD)) return(EBADF); 354 1.2.2.2 yamt dr = (RT *) data; 355 1.2.2.2 yamt if (dr->inx >= sc->nrt) return(EDOM); 356 1.2.2.2 yamt scr = sc->rts[dr->inx]; 357 1.2.2.2 yamt dr->af = scr->af; 358 1.2.2.2 yamt dr->srcmatch = scr->srcmatch; 359 1.2.2.2 yamt dr->srcmask = scr->srcmask; 360 1.2.2.2 yamt strncpy(&dr->u.dstifn[0],&scr->u.dstifp->if_xname[0],IFNAMSIZ); 361 1.2.2.2 yamt memcpy(&dr->dst,&scr->dst,scr->dst.sa.sa_len); 362 1.2.2.2 yamt return(0); 363 1.2.2.2 yamt break; 364 1.2.2.2 yamt case SRT_SETRT: 365 1.2.2.2 yamt if (! (flag & FWRITE)) return(EBADF); 366 1.2.2.2 yamt dr = (RT *) data; 367 1.2.2.2 yamt if (dr->inx > sc->nrt) return(EDOM); 368 1.2.2.2 yamt strncpy(&nbuf[0],&dr->u.dstifn[0],IFNAMSIZ); 369 1.2.2.2 yamt nbuf[IFNAMSIZ-1] = '\0'; 370 1.2.2.2 yamt if (dr->dst.sa.sa_family != dr->af) return(EIO); 371 1.2.2.2 yamt switch (dr->af) 372 1.2.2.2 yamt { 373 1.2.2.2 yamt #ifdef INET 374 1.2.2.2 yamt case AF_INET: 375 1.2.2.2 yamt if (dr->dst.sa.sa_len != sizeof(dr->dst.sin)) return(EIO); 376 1.2.2.2 yamt if (dr->srcmask > 32) return(EIO); 377 1.2.2.2 yamt break; 378 1.2.2.2 yamt #endif 379 1.2.2.2 yamt #ifdef INET6 380 1.2.2.2 yamt case AF_INET6: 381 1.2.2.2 yamt if (dr->dst.sa.sa_len != sizeof(dr->dst.sin6)) return(EIO); 382 1.2.2.2 yamt if (dr->srcmask > 128) return(EIO); 383 1.2.2.2 yamt break; 384 1.2.2.2 yamt #endif 385 1.2.2.2 yamt break; 386 1.2.2.2 yamt default: 387 1.2.2.2 yamt return(EAFNOSUPPORT); 388 1.2.2.2 yamt break; 389 1.2.2.2 yamt } 390 1.2.2.2 yamt intf = ifunit(&nbuf[0]); 391 1.2.2.2 yamt if (intf == 0) return(ENXIO); /* needs translation */ 392 1.2.2.2 yamt if (dr->inx == sc->nrt) 393 1.2.2.2 yamt { RT **tmp; 394 1.2.2.2 yamt tmp = malloc((sc->nrt+1)*sizeof(*tmp),M_DEVBUF,M_WAITOK); 395 1.2.2.2 yamt if (tmp == 0) return(ENOBUFS); 396 1.2.2.2 yamt tmp[sc->nrt] = 0; 397 1.2.2.2 yamt if (sc->nrt > 0) 398 1.2.2.2 yamt { memcpy(tmp,sc->rts,sc->nrt*sizeof(*tmp)); 399 1.2.2.2 yamt free(sc->rts,M_DEVBUF); 400 1.2.2.2 yamt } 401 1.2.2.2 yamt sc->rts = tmp; 402 1.2.2.2 yamt sc->nrt ++; 403 1.2.2.2 yamt } 404 1.2.2.2 yamt scr = sc->rts[dr->inx]; 405 1.2.2.2 yamt if (scr == 0) 406 1.2.2.2 yamt { scr = malloc(sizeof(RT),M_DEVBUF,M_WAITOK); 407 1.2.2.2 yamt if (scr == 0) return(ENOBUFS); 408 1.2.2.2 yamt scr->inx = dr->inx; 409 1.2.2.2 yamt scr->af = AF_UNSPEC; 410 1.2.2.2 yamt sc->rts[dr->inx] = scr; 411 1.2.2.2 yamt } 412 1.2.2.2 yamt scr->af = dr->af; 413 1.2.2.2 yamt scr->srcmatch = dr->srcmatch; 414 1.2.2.2 yamt scr->srcmask = dr->srcmask; 415 1.2.2.2 yamt scr->u.dstifp = intf; 416 1.2.2.2 yamt memcpy(&scr->dst,&dr->dst,dr->dst.sa.sa_len); 417 1.2.2.2 yamt update_mtu(sc); 418 1.2.2.2 yamt return(0); 419 1.2.2.2 yamt break; 420 1.2.2.2 yamt case SRT_DELRT: 421 1.2.2.2 yamt { unsigned int i; 422 1.2.2.2 yamt if (! (flag & FWRITE)) return(EBADF); 423 1.2.2.2 yamt i = *(unsigned int *)data; 424 1.2.2.2 yamt if (i >= sc->nrt) return(EDOM); 425 1.2.2.2 yamt scr = sc->rts[i]; 426 1.2.2.2 yamt sc->rts[i] = 0; 427 1.2.2.2 yamt free(scr,M_DEVBUF); 428 1.2.2.2 yamt sc->nrt --; 429 1.2.2.2 yamt if (i < sc->nrt) memcpy(sc->rts+i,sc->rts+i+1,(sc->nrt-i)*sizeof(*sc->rts)); 430 1.2.2.2 yamt if (sc->nrt == 0) 431 1.2.2.2 yamt { free(sc->rts,M_DEVBUF); 432 1.2.2.2 yamt sc->rts = 0; 433 1.2.2.2 yamt sc->intf.if_flags &= ~IFF_UP; 434 1.2.2.2 yamt } 435 1.2.2.2 yamt } 436 1.2.2.2 yamt update_mtu(sc); 437 1.2.2.2 yamt return(0); 438 1.2.2.2 yamt break; 439 1.2.2.2 yamt case SRT_SFLAGS: 440 1.2.2.2 yamt { unsigned int f; 441 1.2.2.2 yamt if (! (flag & FWRITE)) return(EBADF); 442 1.2.2.2 yamt f = *(unsigned int *)data & SSF_UCHG; 443 1.2.2.2 yamt global_flags = (global_flags & ~SSF_UCHG) | (f & SSF_GLOBAL); 444 1.2.2.2 yamt sc->flags = (sc->flags & ~SSF_UCHG) | (f & ~SSF_GLOBAL); 445 1.2.2.2 yamt } 446 1.2.2.2 yamt return(0); 447 1.2.2.2 yamt break; 448 1.2.2.2 yamt case SRT_GFLAGS: 449 1.2.2.2 yamt if (! (flag & FREAD)) return(EBADF); 450 1.2.2.2 yamt *(unsigned int *)data = sc->flags | global_flags; 451 1.2.2.2 yamt return(0); 452 1.2.2.2 yamt break; 453 1.2.2.2 yamt case SRT_SGFLAGS: 454 1.2.2.2 yamt { unsigned int o; 455 1.2.2.2 yamt unsigned int n; 456 1.2.2.2 yamt if ((flag & (FWRITE|FREAD)) != (FWRITE|FREAD)) return(EBADF); 457 1.2.2.2 yamt o = sc->flags | global_flags; 458 1.2.2.2 yamt n = *(unsigned int *)data & SSF_UCHG; 459 1.2.2.2 yamt global_flags = (global_flags & ~SSF_UCHG) | (n & SSF_GLOBAL); 460 1.2.2.2 yamt sc->flags = (sc->flags & ~SSF_UCHG) | (n & ~SSF_GLOBAL); 461 1.2.2.2 yamt *(unsigned int *)data = o; 462 1.2.2.2 yamt } 463 1.2.2.2 yamt return(0); 464 1.2.2.2 yamt break; 465 1.2.2.2 yamt case SRT_DEBUG: 466 1.2.2.2 yamt return(0); 467 1.2.2.2 yamt break; 468 1.2.2.2 yamt } 469 1.2.2.2 yamt return(ENOTTY); 470 1.2.2.2 yamt } 471 1.2.2.2 yamt 472 1.2.2.2 yamt const struct cdevsw srt_cdevsw 473 1.2.2.2 yamt = { &srt_open, 474 1.2.2.2 yamt &srt_close, 475 1.2.2.2 yamt nullread, 476 1.2.2.2 yamt nullwrite, 477 1.2.2.2 yamt &srt_ioctl, 478 1.2.2.2 yamt nullstop, 479 1.2.2.2 yamt notty, 480 1.2.2.2 yamt nullpoll, 481 1.2.2.2 yamt nommap, 482 1.2.2.2 yamt nullkqfilter, 483 1.2.2.2 yamt D_OTHER }; 484
Indexes created Fri Oct 03 02:09:57 GMT 2025