void atm_rtrequest(int req, struct rtentry *rt, const struct rt_addrinfo *info) { struct sockaddr *gate = rt->rt_gateway; struct atm_pseudoioctl api; #ifdef NATM const struct sockaddr_in *sin; struct natmpcb *npcb = NULL; const struct atm_pseudohdr *aph; #endif const struct ifnet *ifp = rt->rt_ifp; uint8_t namelen = strlen(ifp->if_xname); uint8_t addrlen = ifp->if_addrlen; if (rt->rt_flags & RTF_GATEWAY) /* link level requests only */ return; switch (req) { case RTM_RESOLVE: /* resolve: only happens when cloning */ printf("atm_rtrequest: RTM_RESOLVE request detected?\n"); break; case RTM_ADD: /* * route added by a command (e.g. ifconfig, route, arp...). * * first check to see if this is not a host route, in which * case we are being called via "ifconfig" to set the address. */ if ((rt->rt_flags & RTF_HOST) == 0) { union { struct sockaddr sa; struct sockaddr_dl sdl; struct sockaddr_storage ss; } u; sockaddr_dl_init(&u.sdl, sizeof(u.ss), ifp->if_index, ifp->if_type, NULL, namelen, NULL, addrlen); rt_setgate(rt, &u.sa); gate = rt->rt_gateway; break; } if ((rt->rt_flags & RTF_CLONING) != 0) { printf("atm_rtrequest: cloning route detected?\n"); break; } if (gate->sa_family != AF_LINK || gate->sa_len < sockaddr_dl_measure(namelen, addrlen)) { log(LOG_DEBUG, "atm_rtrequest: bad gateway value\n"); break; } #ifdef DIAGNOSTIC if (rt->rt_ifp->if_ioctl == NULL) panic("atm null ioctl"); #endif #ifdef NATM /* * let native ATM know we are using this VCI/VPI * (i.e. reserve it) */ sin = satocsin(rt_getkey(rt)); if (sin->sin_family != AF_INET) goto failed; aph = (const struct atm_pseudohdr *)CLLADDR(satosdl(gate)); npcb = npcb_add(NULL, rt->rt_ifp, ATM_PH_VCI(aph), ATM_PH_VPI(aph)); if (npcb == NULL) goto failed; npcb->npcb_flags |= NPCB_IP; npcb->ipaddr.s_addr = sin->sin_addr.s_addr; /* XXX: move npcb to llinfo when ATM ARP is ready */ rt->rt_llinfo = (void *) npcb; rt->rt_flags |= RTF_LLINFO; #endif /* * let the lower level know this circuit is active */ memcpy(&api.aph, CLLADDR(satocsdl(gate)), sizeof(api.aph)); api.rxhand = NULL; if (rt->rt_ifp->if_ioctl(rt->rt_ifp, SIOCATMENA, &api) != 0) { printf("atm: couldn't add VC\n"); goto failed; } satosdl(gate)->sdl_type = rt->rt_ifp->if_type; satosdl(gate)->sdl_index = rt->rt_ifp->if_index; break; failed: #ifdef NATM if (npcb) { npcb_free(npcb, NPCB_DESTROY); rt->rt_llinfo = NULL; rt->rt_flags &= ~RTF_LLINFO; } #endif rtrequest(RTM_DELETE, rt_getkey(rt), NULL, rt_mask(rt), 0, NULL); break; case RTM_DELETE: #ifdef NATM /* * tell native ATM we are done with this VC */ if (rt->rt_flags & RTF_LLINFO) { npcb_free((struct natmpcb *)rt->rt_llinfo, NPCB_DESTROY); rt->rt_llinfo = NULL; rt->rt_flags &= ~RTF_LLINFO; } #endif /* * tell the lower layer to disable this circuit */ memcpy(&api.aph, CLLADDR(satocsdl(gate)), sizeof(api.aph)); api.rxhand = NULL; (void)rt->rt_ifp->if_ioctl(rt->rt_ifp, SIOCATMDIS, &api); break; } }
int main(int argc, char **argv) { struct pvcfwdreq pvcreq; struct pvctxreq pvctxreq, pvctxreq2; char *if_name, *if_name2; char speed[64], speed2[64]; int s; if (argc < 2) usage(); argc--; argv++; if (strcmp(*argv, "add") == 0) { operation = ADD; argc--; argv++; } else if (strcmp(*argv, "delete") == 0) { operation = DELETE; argc--; argv++; } if (strcmp(*argv, "get") == 0) { operation = GET; argc--; argv++; } if (argc > 0) { if_name = *argv; argc--; argv++; if (strncmp(if_name, "pvc", 3) != 0) usage(); if (operation != GET && argc > 0) { if_name2 = *argv; argc--; argv++; if (strncmp(if_name2, "pvc", 3) != 0) usage(); } } else usage(); if ((s = socket(AF_INET, SOCK_DGRAM, 0)) < 0) err(1, "can't open socket"); pvcreq.pvc_ifname[IFNAMSIZ-1] = '\0'; strncpy(pvcreq.pvc_ifname, if_name, IFNAMSIZ-1); if (operation != GET) { pvcreq.pvc_ifname2[IFNAMSIZ-1] = '\0'; strncpy(pvcreq.pvc_ifname2, if_name2, IFNAMSIZ-1); pvcreq.pvc_op = operation; if (ioctl(s, SIOCSPVCFWD, &pvcreq) < 0) err(1, "SIOCSPVCFWD"); if (operation == DELETE) { printf("pvc bridging %s <--> %s deleted\n", pvcreq.pvc_ifname, pvcreq.pvc_ifname2); return (0); } } if (ioctl(s, SIOCGPVCFWD, &pvcreq) < 0) err(1, "SIOCSPVCFWD"); /* * print info */ if (pvcreq.pvc_ifname2[0] == '\0') { printf("pvc bridging is not set on %s\n", pvcreq.pvc_ifname); return (0); } /* * get tx info */ bzero(&pvctxreq, sizeof(pvctxreq)); strncpy(pvctxreq.pvc_ifname, pvcreq.pvc_ifname, IFNAMSIZ-1); if (ioctl(s, SIOCGPVCTX, &pvctxreq) < 0) err(1, "SIOCSPVCTX"); bzero(&pvctxreq2, sizeof(pvctxreq2)); strncpy(pvctxreq2.pvc_ifname, pvcreq.pvc_ifname2, IFNAMSIZ-1); if (ioctl(s, SIOCGPVCTX, &pvctxreq2) < 0) err(1, "SIOCSPVCTX"); pcr2str(pvctxreq.pvc_pcr, speed); pcr2str(pvctxreq2.pvc_pcr, speed2); printf("pvc bridging %s:[%d:%d](%s) <--> %s:[%d:%d](%s)\n", pvcreq.pvc_ifname, ATM_PH_VPI(&pvctxreq.pvc_aph), ATM_PH_VCI(&pvctxreq.pvc_aph), speed, pvcreq.pvc_ifname2, ATM_PH_VPI(&pvctxreq2.pvc_aph), ATM_PH_VCI(&pvctxreq2.pvc_aph), speed2); close(s); return (0); }
/* * Process a received ATM packet; * the packet is in the mbuf chain m. */ void atm_input(struct ifnet *ifp, struct atm_pseudohdr *ah, struct mbuf *m, void *rxhand) { int isr; u_int16_t etype = ETHERTYPE_IP; /* default */ if ((ifp->if_flags & IFF_UP) == 0) { m_freem(m); return; } #ifdef MAC mac_ifnet_create_mbuf(ifp, m); #endif ifp->if_ibytes += m->m_pkthdr.len; if (ng_atm_input_p != NULL) { (*ng_atm_input_p)(ifp, &m, ah, rxhand); if (m == NULL) return; } /* not eaten by ng_atm. Maybe it's a pseudo-harp PDU? */ if (atm_harp_input_p != NULL) { (*atm_harp_input_p)(ifp, &m, ah, rxhand); if (m == NULL) return; } if (rxhand) { #ifdef NATM struct natmpcb *npcb; /* * XXXRW: this use of 'rxhand' is not a very good idea, and * was subject to races even before SMPng due to the release * of spl here. */ NATM_LOCK(); npcb = rxhand; npcb->npcb_inq++; /* count # in queue */ isr = NETISR_NATM; m->m_pkthdr.rcvif = rxhand; /* XXX: overload */ NATM_UNLOCK(); #else printf("atm_input: NATM detected but not " "configured in kernel\n"); goto dropit; #endif } else { /* * handle LLC/SNAP header, if present */ if (ATM_PH_FLAGS(ah) & ATM_PH_LLCSNAP) { struct atmllc *alc; if (m->m_len < sizeof(*alc) && (m = m_pullup(m, sizeof(*alc))) == 0) return; /* failed */ alc = mtod(m, struct atmllc *); if (bcmp(alc, ATMLLC_HDR, 6)) { printf("%s: recv'd invalid LLC/SNAP frame " "[vp=%d,vc=%d]\n", ifp->if_xname, ATM_PH_VPI(ah), ATM_PH_VCI(ah)); m_freem(m); return; } etype = ATM_LLC_TYPE(alc); m_adj(m, sizeof(*alc)); } switch (etype) { #ifdef INET case ETHERTYPE_IP: isr = NETISR_IP; break; #endif #ifdef INET6 case ETHERTYPE_IPV6: isr = NETISR_IPV6; break; #endif default: #ifndef NATM dropit: #endif if (ng_atm_input_orphan_p != NULL) (*ng_atm_input_orphan_p)(ifp, m, ah, rxhand); else m_freem(m); return; } } M_SETFIB(m, ifp->if_fib); netisr_dispatch(isr, m); }
int main(int argc, char **argv) { struct pvctxreq pvcreq; int s, ch; long bandwidth; char *if_name, *cp; int vpi = 0; int vci = 0; int joint_vpi = 0; int joint_vci = 0; int pcr = 0; int llcsnap = ATM_PH_LLCSNAP; int getinfo = 1; int subinterface = 0; int verbose = 1; if (argc < 2) usage(); if_name = argv[1]; if (argc > 2 && isdigit((unsigned char)argv[2][0])) str2vc(argv[2], &vpi, &vci); optind = 3; while ((ch = getopt(argc, argv, "p:b:j:snv")) != -1) { switch (ch) { case 'p': pcr = strtol(optarg, NULL, 0); getinfo = 0; break; case 'b': cp = NULL; bandwidth = strtol(optarg, &cp, 0); if (cp != NULL) { if (*cp == 'K' || *cp == 'k') bandwidth *= 1000; if (*cp == 'M' || *cp == 'm') bandwidth *= 1000000; } pcr = bandwidth / 8 / 48; getinfo = 0; break; case 'j': str2vc(optarg, &joint_vpi, &joint_vci); break; case 'n': llcsnap = 0; break; case 'v': verbose = 1; break; default: usage(); } } if ((s = socket(AF_INET, SOCK_DGRAM, 0)) < 0) err(1, "can't open socket"); pvcreq.pvc_ifname[IFNAMSIZ-1] = '\0'; strncpy(pvcreq.pvc_ifname, if_name, IFNAMSIZ-1); if (strncmp(if_name, "pvc", 3) == 0) /* pvc subinterface */ subinterface = 1; ATM_PH_FLAGS(&pvcreq.pvc_aph) = ATM_PH_AAL5 | llcsnap; ATM_PH_VPI(&pvcreq.pvc_aph) = vpi; ATM_PH_SETVCI(&pvcreq.pvc_aph, vci); ATM_PH_FLAGS(&pvcreq.pvc_joint) = 0; ATM_PH_VPI(&pvcreq.pvc_joint) = joint_vpi; ATM_PH_SETVCI(&pvcreq.pvc_joint, joint_vci); pvcreq.pvc_pcr = pcr; if (getinfo) { if (ioctl(s, SIOCGPVCTX, &pvcreq) < 0) err(1, "SIOCSPVCTX"); } else { if (verbose) { printf("setting pvc tx: interface:%s vc:%d:%d ph=0x%x\n", if_name, vpi, vci, ATM_PH_FLAGS(&pvcreq.pvc_aph)); printf(" joint:%d:%d, setting pcr:%d\n", joint_vpi, joint_vci, pcr); } if (ioctl(s, SIOCSPVCTX, &pvcreq) < 0) err(1, "SIOCSPVCTX"); } pcr = pvcreq.pvc_pcr; /* * print info */ printf(" %s", if_name); if (subinterface) printf(" (bound to %s)", pvcreq.pvc_ifname); printf(": vci:[%d:%d] (", ATM_PH_VPI(&pvcreq.pvc_aph), ATM_PH_VCI(&pvcreq.pvc_aph)); if (ATM_PH_FLAGS(&pvcreq.pvc_aph) & ATM_PH_AAL5) printf("AAL5"); if (ATM_PH_FLAGS(&pvcreq.pvc_aph) & ATM_PH_LLCSNAP) printf("/LLCSNAP"); printf(") "); if (pcr < 0) printf("(invalid)\n"); else if (pcr == 0) printf("pcr:%d(full speed)\n", pcr); else if (pcr < 1000) printf("pcr:%d(%dbps)\n", pcr, pcr * 48 * 8); else if (pcr < 1000000) printf("pcr:%d(%dKbps)\n", pcr, pcr * 48 * 8 / 1000); else printf("pcr:%d(%dMbps)\n", pcr, pcr * 48 * 8 / 1000000); close(s); if (getinfo && pcr < 0) { fprintf(stderr, "can't get pvc info for vci:%d\n", vci); fprintf(stderr, "to setup a vci, use -p or -b option\n"); } return (0); }
/* * atm_rtrequest: handle ATM rt request (in support of generic code) * inputs: "req" = request code * "rt" = route entry * "info" = rt_addrinfo */ void atm_rtrequest(int req, struct rtentry *rt, struct rt_addrinfo *info) { struct sockaddr *gate = rt->rt_gateway; struct atm_pseudoioctl api; #ifdef NATM struct sockaddr_in *sin; struct natmpcb *npcb = NULL; struct atm_pseudohdr *aph; #endif static struct sockaddr_dl null_sdl = {sizeof(null_sdl), AF_LINK}; int error; if (rt->rt_flags & RTF_GATEWAY) /* link level requests only */ return; switch (req) { case RTM_RESOLVE: /* resolve: only happens when cloning */ kprintf("atm_rtrequest: RTM_RESOLVE request detected?\n"); break; case RTM_ADD: /* * route added by a command (e.g. ifconfig, route, arp...). * * first check to see if this is not a host route, in which * case we are being called via "ifconfig" to set the address. */ if ((rt->rt_flags & RTF_HOST) == 0) { rt_setgate(rt,rt_key(rt),(struct sockaddr *)&null_sdl, RTL_DONTREPORT); gate = rt->rt_gateway; SDL(gate)->sdl_type = rt->rt_ifp->if_type; SDL(gate)->sdl_index = rt->rt_ifp->if_index; break; } if ((rt->rt_flags & RTF_CLONING) != 0) { kprintf("atm_rtrequest: cloning route detected?\n"); break; } if (gate->sa_family != AF_LINK || gate->sa_len < sizeof(null_sdl)) { log(LOG_DEBUG, "atm_rtrequest: bad gateway value"); break; } #ifdef DIAGNOSTIC if (rt->rt_ifp->if_ioctl == NULL) panic("atm null ioctl"); #endif #ifdef NATM /* * let native ATM know we are using this VCI/VPI * (i.e. reserve it) */ sin = (struct sockaddr_in *) rt_key(rt); if (sin->sin_family != AF_INET) goto failed; aph = (struct atm_pseudohdr *) LLADDR(SDL(gate)); npcb = npcb_add(NULL, rt->rt_ifp, ATM_PH_VCI(aph), ATM_PH_VPI(aph)); if (npcb == NULL) goto failed; npcb->npcb_flags |= NPCB_IP; npcb->ipaddr.s_addr = sin->sin_addr.s_addr; /* XXX: move npcb to llinfo when ATM ARP is ready */ rt->rt_llinfo = npcb; rt->rt_flags |= RTF_LLINFO; #endif /* * let the lower level know this circuit is active */ bcopy(LLADDR(SDL(gate)), &api.aph, sizeof(api.aph)); api.rxhand = NULL; ifnet_serialize_all(rt->rt_ifp); error = rt->rt_ifp->if_ioctl(rt->rt_ifp, SIOCATMENA, (caddr_t)&api, NULL); ifnet_deserialize_all(rt->rt_ifp); if (error) { kprintf("atm: couldn't add VC\n"); goto failed; } SDL(gate)->sdl_type = rt->rt_ifp->if_type; SDL(gate)->sdl_index = rt->rt_ifp->if_index; break; failed: #ifdef NATM if (npcb) { npcb_free(npcb, NPCB_DESTROY); rt->rt_llinfo = NULL; rt->rt_flags &= ~RTF_LLINFO; } #endif rtrequest(RTM_DELETE, rt_key(rt), NULL, rt_mask(rt), 0, NULL); break; case RTM_DELETE: #ifdef NATM /* * tell native ATM we are done with this VC */ if (rt->rt_flags & RTF_LLINFO) { npcb_free(rt->rt_llinfo, NPCB_DESTROY); rt->rt_llinfo = NULL; rt->rt_flags &= ~RTF_LLINFO; } #endif /* * tell the lower layer to disable this circuit */ bcopy(LLADDR(SDL(gate)), &api.aph, sizeof(api.aph)); api.rxhand = NULL; ifnet_serialize_all(rt->rt_ifp); rt->rt_ifp->if_ioctl(rt->rt_ifp, SIOCATMDIS, (caddr_t)&api, NULL); ifnet_deserialize_all(rt->rt_ifp); break; } }