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;
}
}
