ipv6cp.c revision 116251
1/*- 2 * Copyright (c) 2001 Brian Somers <brian@Awfulhak.org> 3 * All rights reserved. 4 * 5 * Redistribution and use in source and binary forms, with or without 6 * modification, are permitted provided that the following conditions 7 * are met: 8 * 1. Redistributions of source code must retain the above copyright 9 * notice, this list of conditions and the following disclaimer. 10 * 2. Redistributions in binary form must reproduce the above copyright 11 * notice, this list of conditions and the following disclaimer in the 12 * documentation and/or other materials provided with the distribution. 13 * 14 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 15 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 16 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 17 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 18 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 19 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 20 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 21 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 22 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 23 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 24 * SUCH DAMAGE. 25 * 26 * $FreeBSD: head/usr.sbin/ppp/ipv6cp.c 116251 2003-06-12 07:48:45Z kris $ 27 */ 28 29#include <sys/param.h> 30#include <netinet/in_systm.h> 31#include <netinet/in.h> 32#include <netinet/ip.h> 33#include <sys/socket.h> 34#include <net/route.h> 35#include <net/if.h> 36#include <net/if_types.h> 37#include <net/if_dl.h> 38#include <sys/un.h> 39 40#include <stdarg.h> 41#include <stdio.h> 42#include <stdlib.h> 43#include <string.h> 44#include <termios.h> 45#include <ifaddrs.h> 46 47#include "layer.h" 48#include "defs.h" 49#include "mbuf.h" 50#include "timer.h" 51#include "fsm.h" 52#include "iplist.h" 53#include "throughput.h" 54#include "slcompress.h" 55#include "lqr.h" 56#include "hdlc.h" 57#include "lcp.h" 58#include "ncpaddr.h" 59#include "ip.h" 60#include "ipcp.h" 61#include "ipv6cp.h" 62#include "filter.h" 63#include "descriptor.h" 64#include "ccp.h" 65#include "link.h" 66#include "mp.h" 67#ifndef NORADIUS 68#include "radius.h" 69#endif 70#include "ncp.h" 71#include "bundle.h" 72#include "route.h" 73#include "iface.h" 74#include "log.h" 75#include "proto.h" 76#include "command.h" 77#include "prompt.h" 78#include "async.h" 79#include "physical.h" 80#include "probe.h" 81#include "systems.h" 82 83 84#ifndef NOINET6 85#define IN6ADDR_LINKLOCAL_MCAST_INIT \ 86 {{{ 0xff, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, \ 87 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 }}} 88static const struct in6_addr in6addr_linklocal_mcast = 89 IN6ADDR_LINKLOCAL_MCAST_INIT; 90 91static int ipv6cp_LayerUp(struct fsm *); 92static void ipv6cp_LayerDown(struct fsm *); 93static void ipv6cp_LayerStart(struct fsm *); 94static void ipv6cp_LayerFinish(struct fsm *); 95static void ipv6cp_InitRestartCounter(struct fsm *, int); 96static void ipv6cp_SendConfigReq(struct fsm *); 97static void ipv6cp_SentTerminateReq(struct fsm *); 98static void ipv6cp_SendTerminateAck(struct fsm *, u_char); 99static void ipv6cp_DecodeConfig(struct fsm *, u_char *, u_char *, int, 100 struct fsm_decode *); 101 102static struct fsm_callbacks ipv6cp_Callbacks = { 103 ipv6cp_LayerUp, 104 ipv6cp_LayerDown, 105 ipv6cp_LayerStart, 106 ipv6cp_LayerFinish, 107 ipv6cp_InitRestartCounter, 108 ipv6cp_SendConfigReq, 109 ipv6cp_SentTerminateReq, 110 ipv6cp_SendTerminateAck, 111 ipv6cp_DecodeConfig, 112 fsm_NullRecvResetReq, 113 fsm_NullRecvResetAck 114}; 115 116static void 117SetInterfaceID(u_char *ifid, int userandom) 118{ 119 struct ifaddrs *ifa, *ifap = NULL; 120 struct sockaddr_dl *sdl; 121 const u_long i32_max = 0xffffffff; 122 u_long r1, r2; 123 124 /* configure an interface ID based on Section 4.1 of RFC 2472 */ 125 memset(ifid, 0, IPV6CP_IFIDLEN); 126 127 /* 128 * 1) If an IEEE global identifier (EUI-48 or EUI-64) is 129 * available anywhere on the node, it should be used to construct 130 * the tentative Interface-Identifier due to its uniqueness 131 * properties. 132 */ 133 if (userandom) 134 goto randomid; 135 if (getifaddrs(&ifap) < 0) 136 goto randomid; 137 138 for (ifa = ifap; ifa; ifa = ifa->ifa_next) { 139 char *cp; 140 141 if (ifa->ifa_addr->sa_family != AF_LINK) 142 continue; 143 144 sdl = (struct sockaddr_dl *)ifa->ifa_addr; 145 if (sdl->sdl_alen < 6) 146 continue; 147 /* we're only interested in IEEE hardware addresses */ 148 switch(sdl->sdl_type) { 149 case IFT_ETHER: 150 case IFT_FDDI: 151 /* XXX need more cases? */ 152 break; 153 default: 154 continue; 155 } 156 157 cp = (char *)(sdl->sdl_data + sdl->sdl_nlen); 158 ifid[0] = cp[0]; 159 ifid[0] ^= 0x02; /* reverse the u/l bit*/ 160 ifid[1] = cp[1]; 161 ifid[2] = cp[2]; 162 ifid[3] = 0xff; 163 ifid[4] = 0xfe; 164 ifid[5] = cp[3]; 165 ifid[6] = cp[4]; 166 ifid[7] = cp[5]; 167 168 freeifaddrs(ifap); 169 return; 170 } 171 172 freeifaddrs(ifap); 173 174 /* 175 * 2) If an IEEE global identifier is not available a different source 176 * of uniqueness should be used. 177 * XXX: we skip this case. 178 */ 179 180 /* 181 * 3) If a good source of uniqueness cannot be found, it is 182 * recommended that a random number be generated. In this case the 183 * "u" bit of the interface identifier MUST be set to zero (0). 184 */ 185 randomid: 186 randinit(); 187 r1 = (((u_long)random()) % i32_max) + 1; 188 r2 = (((u_long)random()) % i32_max) + 1; 189 memcpy(ifid, &r1, sizeof(r1)); 190 memcpy(ifid + 4, &r2, sizeof(r2)); 191 ifid[0] &= 0xfd; 192 return; 193} 194 195static int 196ipcp_SetIPv6address(struct ipv6cp *ipv6cp, u_char *myifid, u_char *hisifid) 197{ 198 struct bundle *bundle = ipv6cp->fsm.bundle; 199 struct in6_addr myaddr, hisaddr; 200 struct ncprange myrange, range; 201 struct ncpaddr addr; 202 struct sockaddr_storage ssdst, ssgw, ssmask; 203 struct sockaddr *sadst, *sagw, *samask; 204 205 sadst = (struct sockaddr *)&ssdst; 206 sagw = (struct sockaddr *)&ssgw; 207 samask = (struct sockaddr *)&ssmask; 208 209 memset(&myaddr, '\0', sizeof myaddr); 210 memset(&hisaddr, '\0', sizeof hisaddr); 211 212 myaddr.s6_addr[0] = 0xfe; 213 myaddr.s6_addr[1] = 0x80; 214 memcpy(&myaddr.s6_addr[8], myifid, IPV6CP_IFIDLEN); 215#if 0 216 myaddr.s6_addr[8] |= 0x02; /* set 'universal' bit */ 217#endif 218 219 hisaddr.s6_addr[0] = 0xfe; 220 hisaddr.s6_addr[1] = 0x80; 221 memcpy(&hisaddr.s6_addr[8], hisifid, IPV6CP_IFIDLEN); 222#if 0 223 hisaddr.s6_addr[8] |= 0x02; /* set 'universal' bit */ 224#endif 225 226 ncpaddr_setip6(&ipv6cp->myaddr, &myaddr); 227 ncpaddr_setip6(&ipv6cp->hisaddr, &hisaddr); 228 ncprange_set(&myrange, &ipv6cp->myaddr, 64); 229 230 if (!iface_Add(bundle->iface, &bundle->ncp, &myrange, &ipv6cp->hisaddr, 231 IFACE_ADD_FIRST|IFACE_FORCE_ADD|IFACE_SYSTEM)) 232 return 0; 233 234 if (!Enabled(bundle, OPT_IFACEALIAS)) 235 iface_Clear(bundle->iface, &bundle->ncp, AF_INET6, 236 IFACE_CLEAR_ALIASES|IFACE_SYSTEM); 237 238 ncpaddr_setip6(&addr, &in6addr_linklocal_mcast); 239 ncprange_set(&range, &addr, 32); 240 rt_Set(bundle, RTM_ADD, &range, &ipv6cp->myaddr, 1, 0); 241 242 if (bundle->ncp.cfg.sendpipe > 0 || bundle->ncp.cfg.recvpipe > 0) { 243 ncprange_getsa(&myrange, &ssgw, &ssmask); 244 if (ncpaddr_isset(&ipv6cp->hisaddr)) 245 ncpaddr_getsa(&ipv6cp->hisaddr, &ssdst); 246 else 247 sadst = NULL; 248 rt_Update(bundle, sadst, sagw, samask); 249 } 250 251 if (Enabled(bundle, OPT_SROUTES)) 252 route_Change(bundle, bundle->ncp.route, &ipv6cp->myaddr, &ipv6cp->hisaddr); 253 254#ifndef NORADIUS 255 if (bundle->radius.valid) 256 route_Change(bundle, bundle->radius.routes, &ipv6cp->myaddr, 257 &ipv6cp->hisaddr); 258#endif 259 260 return 1; /* Ok */ 261} 262 263void 264ipv6cp_Init(struct ipv6cp *ipv6cp, struct bundle *bundle, struct link *l, 265 const struct fsm_parent *parent) 266{ 267 static const char * const timer_names[] = 268 {"IPV6CP restart", "IPV6CP openmode", "IPV6CP stopped"}; 269 int n; 270 271 fsm_Init(&ipv6cp->fsm, "IPV6CP", PROTO_IPV6CP, 1, IPV6CP_MAXCODE, LogIPV6CP, 272 bundle, l, parent, &ipv6cp_Callbacks, timer_names); 273 274 ipv6cp->cfg.fsm.timeout = DEF_FSMRETRY; 275 ipv6cp->cfg.fsm.maxreq = DEF_FSMTRIES; 276 ipv6cp->cfg.fsm.maxtrm = DEF_FSMTRIES; 277 278 SetInterfaceID(ipv6cp->my_ifid, 0); 279 do { 280 SetInterfaceID(ipv6cp->his_ifid, 1); 281 } while (memcmp(ipv6cp->his_ifid, ipv6cp->my_ifid, IPV6CP_IFIDLEN) == 0); 282 283 if (probe.ipv6_available) { 284 n = 100; 285 while (n && 286 !ipcp_SetIPv6address(ipv6cp, ipv6cp->my_ifid, ipv6cp->his_ifid)) { 287 do { 288 n--; 289 SetInterfaceID(ipv6cp->my_ifid, 1); 290 } while (n 291 && memcmp(ipv6cp->his_ifid, ipv6cp->my_ifid, IPV6CP_IFIDLEN) == 0); 292 } 293 } 294 295 throughput_init(&ipv6cp->throughput, SAMPLE_PERIOD); 296 memset(ipv6cp->Queue, '\0', sizeof ipv6cp->Queue); 297 ipv6cp_Setup(ipv6cp); 298} 299 300void 301ipv6cp_Destroy(struct ipv6cp *ipv6cp) 302{ 303 throughput_destroy(&ipv6cp->throughput); 304} 305 306void 307ipv6cp_Setup(struct ipv6cp *ipv6cp) 308{ 309 ncpaddr_init(&ipv6cp->myaddr); 310 ncpaddr_init(&ipv6cp->hisaddr); 311 312 ipv6cp->his_reject = 0; 313 ipv6cp->my_reject = 0; 314} 315 316void 317ipv6cp_SetLink(struct ipv6cp *ipv6cp, struct link *l) 318{ 319 ipv6cp->fsm.link = l; 320} 321 322int 323ipv6cp_Show(struct cmdargs const *arg) 324{ 325 struct ipv6cp *ipv6cp = &arg->bundle->ncp.ipv6cp; 326 327 prompt_Printf(arg->prompt, "%s [%s]\n", ipv6cp->fsm.name, 328 State2Nam(ipv6cp->fsm.state)); 329 if (ipv6cp->fsm.state == ST_OPENED) { 330 prompt_Printf(arg->prompt, " His side: %s\n", 331 ncpaddr_ntoa(&ipv6cp->hisaddr)); 332 prompt_Printf(arg->prompt, " My side: %s\n", 333 ncpaddr_ntoa(&ipv6cp->myaddr)); 334 prompt_Printf(arg->prompt, " Queued packets: %lu\n", 335 (unsigned long)ipv6cp_QueueLen(ipv6cp)); 336 } 337 338 prompt_Printf(arg->prompt, "\nDefaults:\n"); 339 prompt_Printf(arg->prompt, " FSM retry = %us, max %u Config" 340 " REQ%s, %u Term REQ%s\n\n", ipv6cp->cfg.fsm.timeout, 341 ipv6cp->cfg.fsm.maxreq, ipv6cp->cfg.fsm.maxreq == 1 ? "" : "s", 342 ipv6cp->cfg.fsm.maxtrm, ipv6cp->cfg.fsm.maxtrm == 1 ? "" : "s"); 343 344 throughput_disp(&ipv6cp->throughput, arg->prompt); 345 346 return 0; 347} 348 349struct mbuf * 350ipv6cp_Input(struct bundle *bundle, struct link *l, struct mbuf *bp) 351{ 352 /* Got PROTO_IPV6CP from link */ 353 m_settype(bp, MB_IPV6CPIN); 354 if (bundle_Phase(bundle) == PHASE_NETWORK) 355 fsm_Input(&bundle->ncp.ipv6cp.fsm, bp); 356 else { 357 if (bundle_Phase(bundle) < PHASE_NETWORK) 358 log_Printf(LogIPV6CP, "%s: Error: Unexpected IPV6CP in phase %s" 359 " (ignored)\n", l->name, bundle_PhaseName(bundle)); 360 m_freem(bp); 361 } 362 return NULL; 363} 364 365void 366ipv6cp_AddInOctets(struct ipv6cp *ipv6cp, int n) 367{ 368 throughput_addin(&ipv6cp->throughput, n); 369} 370 371void 372ipv6cp_AddOutOctets(struct ipv6cp *ipv6cp, int n) 373{ 374 throughput_addout(&ipv6cp->throughput, n); 375} 376 377void 378ipv6cp_IfaceAddrAdded(struct ipv6cp *ipv6cp, const struct iface_addr *addr) 379{ 380} 381 382void 383ipv6cp_IfaceAddrDeleted(struct ipv6cp *ipv6cp, const struct iface_addr *addr) 384{ 385} 386 387int 388ipv6cp_InterfaceUp(struct ipv6cp *ipv6cp) 389{ 390 if (!ipcp_SetIPv6address(ipv6cp, ipv6cp->my_ifid, ipv6cp->his_ifid)) { 391 log_Printf(LogERROR, "ipv6cp_InterfaceUp: unable to set ipv6 address\n"); 392 return 0; 393 } 394 395 if (!iface_SetFlags(ipv6cp->fsm.bundle->iface->name, IFF_UP)) { 396 log_Printf(LogERROR, "ipv6cp_InterfaceUp: Can't set the IFF_UP" 397 " flag on %s\n", ipv6cp->fsm.bundle->iface->name); 398 return 0; 399 } 400 401 return 1; 402} 403 404size_t 405ipv6cp_QueueLen(struct ipv6cp *ipv6cp) 406{ 407 struct mqueue *q; 408 size_t result; 409 410 result = 0; 411 for (q = ipv6cp->Queue; q < ipv6cp->Queue + IPV6CP_QUEUES(ipv6cp); q++) 412 result += q->len; 413 414 return result; 415} 416 417int 418ipv6cp_PushPacket(struct ipv6cp *ipv6cp, struct link *l) 419{ 420 struct bundle *bundle = ipv6cp->fsm.bundle; 421 struct mqueue *queue; 422 struct mbuf *bp; 423 int m_len; 424 u_int32_t secs = 0; 425 unsigned alivesecs = 0; 426 427 if (ipv6cp->fsm.state != ST_OPENED) 428 return 0; 429 430 /* 431 * If ccp is not open but is required, do nothing. 432 */ 433 if (l->ccp.fsm.state != ST_OPENED && ccp_Required(&l->ccp)) { 434 log_Printf(LogPHASE, "%s: Not transmitting... waiting for CCP\n", l->name); 435 return 0; 436 } 437 438 queue = ipv6cp->Queue + IPV6CP_QUEUES(ipv6cp) - 1; 439 do { 440 if (queue->top) { 441 bp = m_dequeue(queue); 442 bp = mbuf_Read(bp, &secs, sizeof secs); 443 bp = m_pullup(bp); 444 m_len = m_length(bp); 445 if (!FilterCheck(MBUF_CTOP(bp), AF_INET6, &bundle->filter.alive, 446 &alivesecs)) { 447 if (secs == 0) 448 secs = alivesecs; 449 bundle_StartIdleTimer(bundle, secs); 450 } 451 link_PushPacket(l, bp, bundle, 0, PROTO_IPV6); 452 ipv6cp_AddOutOctets(ipv6cp, m_len); 453 return 1; 454 } 455 } while (queue-- != ipv6cp->Queue); 456 457 return 0; 458} 459 460static int 461ipv6cp_LayerUp(struct fsm *fp) 462{ 463 /* We're now up */ 464 struct ipv6cp *ipv6cp = fsm2ipv6cp(fp); 465 char tbuff[40]; 466 467 log_Printf(LogIPV6CP, "%s: LayerUp.\n", fp->link->name); 468 if (!ipv6cp_InterfaceUp(ipv6cp)) 469 return 0; 470 471 snprintf(tbuff, sizeof tbuff, "%s", ncpaddr_ntoa(&ipv6cp->myaddr)); 472 log_Printf(LogIPV6CP, "myaddr %s hisaddr = %s\n", 473 tbuff, ncpaddr_ntoa(&ipv6cp->hisaddr)); 474 475 /* XXX: Call radius_Account() */ 476 477 if (!Enabled(fp->bundle, OPT_IPCP)) { 478 /* 479 * XXX this stuff should really live in the FSM. Our config should 480 * associate executable sections in files with events. 481 */ 482 if (system_Select(fp->bundle, tbuff, LINKUPFILE, NULL, NULL) < 0) { 483 if (bundle_GetLabel(fp->bundle)) { 484 if (system_Select(fp->bundle, bundle_GetLabel(fp->bundle), 485 LINKUPFILE, NULL, NULL) < 0) 486 system_Select(fp->bundle, "MYADDR6", LINKUPFILE, NULL, NULL); 487 } else 488 system_Select(fp->bundle, "MYADDR6", LINKUPFILE, NULL, NULL); 489 } 490 } 491 492 fp->more.reqs = fp->more.naks = fp->more.rejs = ipv6cp->cfg.fsm.maxreq * 3; 493 log_DisplayPrompts(); 494 495 return 1; 496} 497 498static void 499ipv6cp_LayerDown(struct fsm *fp) 500{ 501 /* About to come down */ 502 struct ipv6cp *ipv6cp = fsm2ipv6cp(fp); 503 static int recursing; 504 char addr[40]; 505 506 if (!recursing++) { 507 snprintf(addr, sizeof addr, "%s", ncpaddr_ntoa(&ipv6cp->myaddr)); 508 log_Printf(LogIPV6CP, "%s: LayerDown: %s\n", fp->link->name, addr); 509 510 /* XXX: Call radius_Account() */ 511 512 if (!Enabled(fp->bundle, OPT_IPCP)) { 513 /* 514 * XXX this stuff should really live in the FSM. Our config should 515 * associate executable sections in files with events. 516 */ 517 if (system_Select(fp->bundle, addr, LINKDOWNFILE, NULL, NULL) < 0) { 518 if (bundle_GetLabel(fp->bundle)) { 519 if (system_Select(fp->bundle, bundle_GetLabel(fp->bundle), 520 LINKDOWNFILE, NULL, NULL) < 0) 521 system_Select(fp->bundle, "MYADDR6", LINKDOWNFILE, NULL, NULL); 522 } else 523 system_Select(fp->bundle, "MYADDR6", LINKDOWNFILE, NULL, NULL); 524 } 525 } 526 527 ipv6cp_Setup(ipv6cp); 528 } 529 recursing--; 530} 531 532static void 533ipv6cp_LayerStart(struct fsm *fp) 534{ 535 /* We're about to start up ! */ 536 struct ipv6cp *ipv6cp = fsm2ipv6cp(fp); 537 538 log_Printf(LogIPV6CP, "%s: LayerStart.\n", fp->link->name); 539 throughput_start(&ipv6cp->throughput, "IPV6CP throughput", 540 Enabled(fp->bundle, OPT_THROUGHPUT)); 541 fp->more.reqs = fp->more.naks = fp->more.rejs = ipv6cp->cfg.fsm.maxreq * 3; 542 ipv6cp->peer_tokenreq = 0; 543} 544 545static void 546ipv6cp_LayerFinish(struct fsm *fp) 547{ 548 /* We're now down */ 549 struct ipv6cp *ipv6cp = fsm2ipv6cp(fp); 550 551 log_Printf(LogIPV6CP, "%s: LayerFinish.\n", fp->link->name); 552 throughput_stop(&ipv6cp->throughput); 553 throughput_log(&ipv6cp->throughput, LogIPV6CP, NULL); 554} 555 556static void 557ipv6cp_InitRestartCounter(struct fsm *fp, int what) 558{ 559 /* Set fsm timer load */ 560 struct ipv6cp *ipv6cp = fsm2ipv6cp(fp); 561 562 fp->FsmTimer.load = ipv6cp->cfg.fsm.timeout * SECTICKS; 563 switch (what) { 564 case FSM_REQ_TIMER: 565 fp->restart = ipv6cp->cfg.fsm.maxreq; 566 break; 567 case FSM_TRM_TIMER: 568 fp->restart = ipv6cp->cfg.fsm.maxtrm; 569 break; 570 default: 571 fp->restart = 1; 572 break; 573 } 574} 575 576static void 577ipv6cp_SendConfigReq(struct fsm *fp) 578{ 579 /* Send config REQ please */ 580 struct physical *p = link2physical(fp->link); 581 struct ipv6cp *ipv6cp = fsm2ipv6cp(fp); 582 u_char buff[IPV6CP_IFIDLEN+2]; 583 struct fsm_opt *o; 584 585 o = (struct fsm_opt *)buff; 586 587 if ((p && !physical_IsSync(p)) || !REJECTED(ipv6cp, TY_TOKEN)) { 588 memcpy(o->data, ipv6cp->my_ifid, IPV6CP_IFIDLEN); 589 INC_FSM_OPT(TY_TOKEN, IPV6CP_IFIDLEN + 2, o); 590 } 591 592 fsm_Output(fp, CODE_CONFIGREQ, fp->reqid, buff, (u_char *)o - buff, 593 MB_IPV6CPOUT); 594} 595 596static void 597ipv6cp_SentTerminateReq(struct fsm *fp) 598{ 599 /* Term REQ just sent by FSM */ 600} 601 602static void 603ipv6cp_SendTerminateAck(struct fsm *fp, u_char id) 604{ 605 /* Send Term ACK please */ 606 fsm_Output(fp, CODE_TERMACK, id, NULL, 0, MB_IPV6CPOUT); 607} 608 609static const char * 610protoname(int proto) 611{ 612 static const char *cftypes[] = { "IFACEID", "COMPPROTO" }; 613 614 if (proto > 0 && proto <= sizeof cftypes / sizeof *cftypes) 615 return cftypes[proto - 1]; 616 617 return NumStr(proto, NULL, 0); 618} 619 620static void 621ipv6cp_ValidateInterfaceID(struct ipv6cp *ipv6cp, u_char *ifid, 622 struct fsm_decode *dec) 623{ 624 struct fsm_opt opt; 625 u_char zero[IPV6CP_IFIDLEN]; 626 627 memset(zero, 0, IPV6CP_IFIDLEN); 628 629 if (memcmp(ifid, zero, IPV6CP_IFIDLEN) != 0 630 && memcmp(ifid, ipv6cp->my_ifid, IPV6CP_IFIDLEN) != 0) 631 memcpy(ipv6cp->his_ifid, ifid, IPV6CP_IFIDLEN); 632 633 opt.hdr.id = TY_TOKEN; 634 opt.hdr.len = IPV6CP_IFIDLEN + 2; 635 memcpy(opt.data, &ipv6cp->his_ifid, IPV6CP_IFIDLEN); 636 if (memcmp(ifid, ipv6cp->his_ifid, IPV6CP_IFIDLEN) == 0) 637 fsm_ack(dec, &opt); 638 else 639 fsm_nak(dec, &opt); 640} 641 642static void 643ipv6cp_DecodeConfig(struct fsm *fp, u_char *cp, u_char *end, int mode_type, 644 struct fsm_decode *dec) 645{ 646 /* Deal with incoming PROTO_IPV6CP */ 647 struct ipv6cp *ipv6cp = fsm2ipv6cp(fp); 648 int n; 649 char tbuff[100]; 650 u_char ifid[IPV6CP_IFIDLEN], zero[IPV6CP_IFIDLEN]; 651 struct fsm_opt *opt; 652 653 memset(zero, 0, IPV6CP_IFIDLEN); 654 655 while (end - cp >= sizeof(opt->hdr)) { 656 if ((opt = fsm_readopt(&cp)) == NULL) 657 break; 658 659 snprintf(tbuff, sizeof tbuff, " %s[%d]", protoname(opt->hdr.id), 660 opt->hdr.len); 661 662 switch (opt->hdr.id) { 663 case TY_TOKEN: 664 memcpy(ifid, opt->data, IPV6CP_IFIDLEN); 665 log_Printf(LogIPV6CP, "%s 0x%02x%02x%02x%02x%02x%02x%02x%02x\n", tbuff, 666 ifid[0], ifid[1], ifid[2], ifid[3], ifid[4], ifid[5], ifid[6], ifid[7]); 667 668 switch (mode_type) { 669 case MODE_REQ: 670 ipv6cp->peer_tokenreq = 1; 671 ipv6cp_ValidateInterfaceID(ipv6cp, ifid, dec); 672 break; 673 674 case MODE_NAK: 675 if (memcmp(ifid, zero, IPV6CP_IFIDLEN) == 0) { 676 log_Printf(log_IsKept(LogIPV6CP) ? LogIPV6CP : LogPHASE, 677 "0x0000000000000000: Unacceptable IntefaceID!\n"); 678 fsm_Close(&ipv6cp->fsm); 679 } else if (memcmp(ifid, ipv6cp->his_ifid, IPV6CP_IFIDLEN) == 0) { 680 log_Printf(log_IsKept(LogIPV6CP) ? LogIPV6CP : LogPHASE, 681 "0x%02x%02x%02x%02x%02x%02x%02x%02x: " 682 "Unacceptable IntefaceID!\n", 683 ifid[0], ifid[1], ifid[2], ifid[3], 684 ifid[4], ifid[5], ifid[6], ifid[7]); 685 } else if (memcmp(ifid, ipv6cp->my_ifid, IPV6CP_IFIDLEN) != 0) { 686 n = 100; 687 while (n && !ipcp_SetIPv6address(ipv6cp, ifid, ipv6cp->his_ifid)) { 688 do { 689 n--; 690 SetInterfaceID(ifid, 1); 691 } while (n && memcmp(ifid, ipv6cp->his_ifid, IPV6CP_IFIDLEN) == 0); 692 } 693 694 if (n == 0) { 695 log_Printf(log_IsKept(LogIPV6CP) ? LogIPV6CP : LogPHASE, 696 "0x0000000000000000: Unacceptable IntefaceID!\n"); 697 fsm_Close(&ipv6cp->fsm); 698 } else { 699 log_Printf(LogIPV6CP, "%s changing IntefaceID: " 700 "0x%02x%02x%02x%02x%02x%02x%02x%02x " 701 "--> 0x%02x%02x%02x%02x%02x%02x%02x%02x\n", tbuff, 702 ipv6cp->my_ifid[0], ipv6cp->my_ifid[1], 703 ipv6cp->my_ifid[2], ipv6cp->my_ifid[3], 704 ipv6cp->my_ifid[4], ipv6cp->my_ifid[5], 705 ipv6cp->my_ifid[6], ipv6cp->my_ifid[7], 706 ifid[0], ifid[1], ifid[2], ifid[3], 707 ifid[4], ifid[5], ifid[6], ifid[7]); 708 memcpy(ipv6cp->my_ifid, ifid, IPV6CP_IFIDLEN); 709 bundle_AdjustFilters(fp->bundle, &ipv6cp->myaddr, NULL); 710 } 711 } 712 break; 713 714 case MODE_REJ: 715 ipv6cp->his_reject |= (1 << opt->hdr.id); 716 break; 717 } 718 break; 719 720 default: 721 if (mode_type != MODE_NOP) { 722 ipv6cp->my_reject |= (1 << opt->hdr.id); 723 fsm_rej(dec, opt); 724 } 725 break; 726 } 727 } 728 729 if (mode_type != MODE_NOP) { 730 if (mode_type == MODE_REQ && !ipv6cp->peer_tokenreq) { 731 if (dec->rejend == dec->rej && dec->nakend == dec->nak) { 732 /* 733 * Pretend the peer has requested a TOKEN. 734 * We do this to ensure that we only send one NAK if the only 735 * reason for the NAK is because the peer isn't sending a 736 * TY_TOKEN REQ. This stops us from repeatedly trying to tell 737 * the peer that we have to have an IP address on their end. 738 */ 739 ipv6cp->peer_tokenreq = 1; 740 } 741 memset(ifid, 0, IPV6CP_IFIDLEN); 742 ipv6cp_ValidateInterfaceID(ipv6cp, ifid, dec); 743 } 744 fsm_opt_normalise(dec); 745 } 746} 747#endif 748