sys/net/sppp/if_spppsubr.c

   1 /*
   2  * Synchronous PPP/Cisco link level subroutines.
   3  * Keepalive protocol implemented in both Cisco and PPP modes.
   4  *
   5  * Copyright (C) 1994-1996 Cronyx Engineering Ltd.
   6  * Author: Serge Vakulenko, <vak@cronyx.ru>
   7  *
   8  * Heavily revamped to conform to RFC 1661.
   9  * Copyright (C) 1997, 2001 Joerg Wunsch.
  10  *
  11  * This software is distributed with NO WARRANTIES, not even the implied
  12  * warranties for MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.
  13  *
  14  * Authors grant any other persons or organisations permission to use
  15  * or modify this software as long as this message is kept with the software,
  16  * all derivative works or modified versions.
  17  *
  18  * From: Version 2.4, Thu Apr 30 17:17:21 MSD 1997
  19  *
  20  * $FreeBSD: src/sys/net/if_spppsubr.c,v 1.59.2.13 2002/07/03 15:44:41 joerg Exp $
  21  * $DragonFly: src/sys/net/sppp/if_spppsubr.c,v 1.15 2004/06/04 07:45:46 hmp Exp $
  22  */
  23
  24 #include <sys/param.h>
  25
  26 #if defined(__DragonFly__)
  27 #include "opt_inet.h"
  28 #include "opt_inet6.h"
  29 #include "opt_ipx.h"
  30 #endif
  31
  32 #ifdef NetBSD1_3
  33 #  if NetBSD1_3 > 6
  34 #      include "opt_inet.h"
  35 #      include "opt_inet6.h"
  36 #      include "opt_iso.h"
  37 #  endif
  38 #endif
  39
  40 #include <sys/systm.h>
  41 #include <sys/kernel.h>
  42 #include <sys/module.h>
  43 #include <sys/sockio.h>
  44 #include <sys/socket.h>
  45 #include <sys/syslog.h>
  46 #if defined(__DragonFly__)
  47 #include <sys/random.h>
  48 #endif
  49 #include <sys/malloc.h>
  50 #include <sys/mbuf.h>
  51
  52 #if defined (__OpenBSD__)
  53 #include <sys/md5k.h>
  54 #else
  55 #include <sys/md5.h>
  56 #endif
  57
  58 #include <net/if.h>
  59 #include <net/netisr.h>
  60 #include <net/if_types.h>
  61 #include <net/route.h>
  62 #include <netinet/in.h>
  63 #include <netinet/in_systm.h>
  64 #include <netinet/ip.h>
  65 #include <net/slcompress.h>
  66
  67 #if defined (__NetBSD__) || defined (__OpenBSD__)
  68 #include <machine/cpu.h> /* XXX for softnet */
  69 #endif
  70
  71 #include <machine/stdarg.h>
  72
  73 #include <netinet/in.h>
  74 #include <netinet/in_systm.h>
  75 #include <netinet/in_var.h>
  76
  77 #ifdef INET
  78 #include <netinet/ip.h>
  79 #include <netinet/tcp.h>
  80 #endif
  81
  82 #if defined (__DragonFly__) || defined (__OpenBSD__)
  83 # include <netinet/if_ether.h>
  84 #else
  85 # include <net/ethertypes.h>
  86 #endif
  87
  88 #ifdef IPX
  89 #include <netproto/ipx/ipx.h>
  90 #include <netproto/ipx/ipx_if.h>
  91 #endif
  92
  93 #ifdef NS
  94 #include <netns/ns.h>
  95 #include <netns/ns_if.h>
  96 #endif
  97
  98 #include "if_sppp.h"
  99
 100 #if defined(__DragonFly__)
 101 # define UNTIMEOUT(fun, arg, handle) untimeout(fun, arg, handle)
 102 # define TIMEOUT(fun, arg1, arg2, handle) handle = timeout(fun, arg1, arg2)
 103 # define IOCTL_CMD_T    u_long
 104 #else
 105 # define UNTIMEOUT(fun, arg, handle) untimeout(fun, arg)
 106 # define TIMEOUT(fun, arg1, arg2, handle) timeout(fun, arg1, arg2)
 107 # define IOCTL_CMD_T    int
 108 #endif
 109
 110 #define MAXALIVECNT     3               /* max. alive packets */
 111
 112 /*
 113  * Interface flags that can be set in an ifconfig command.
 114  *
 115  * Setting link0 will make the link passive, i.e. it will be marked
 116  * as being administrative openable, but won't be opened to begin
 117  * with.  Incoming calls will be answered, or subsequent calls with
 118  * -link1 will cause the administrative open of the LCP layer.
 119  *
 120  * Setting link1 will cause the link to auto-dial only as packets
 121  * arrive to be sent.
 122  *
 123  * Setting IFF_DEBUG will syslog the option negotiation and state
 124  * transitions at level kern.debug.  Note: all logs consistently look
 125  * like
 126  *
 127  *   <if-name><unit>: <proto-name> <additional info...>
 128  *
 129  * with <if-name><unit> being something like "bppp0", and <proto-name>
 130  * being one of "lcp", "ipcp", "cisco", "chap", "pap", etc.
 131  */
 132
 133 #define IFF_PASSIVE     IFF_LINK0       /* wait passively for connection */
 134 #define IFF_AUTO        IFF_LINK1       /* auto-dial on output */
 135 #define IFF_CISCO       IFF_LINK2       /* auto-dial on output */
 136
 137 #define PPP_ALLSTATIONS 0xff            /* All-Stations broadcast address */
 138 #define PPP_UI          0x03            /* Unnumbered Information */
 139 #define PPP_IP          0x0021          /* Internet Protocol */
 140 #define PPP_ISO         0x0023          /* ISO OSI Protocol */
 141 #define PPP_XNS         0x0025          /* Xerox NS Protocol */
 142 #define PPP_IPX         0x002b          /* Novell IPX Protocol */
 143 #define PPP_VJ_COMP     0x002d          /* VJ compressed TCP/IP */
 144 #define PPP_VJ_UCOMP    0x002f          /* VJ uncompressed TCP/IP */
 145 #define PPP_IPV6        0x0057          /* Internet Protocol Version 6 */
 146 #define PPP_LCP         0xc021          /* Link Control Protocol */
 147 #define PPP_PAP         0xc023          /* Password Authentication Protocol */
 148 #define PPP_CHAP        0xc223          /* Challenge-Handshake Auth Protocol */
 149 #define PPP_IPCP        0x8021          /* Internet Protocol Control Protocol */
 150 #define PPP_IPV6CP      0x8057          /* IPv6 Control Protocol */
 151
 152 #define CONF_REQ        1               /* PPP configure request */
 153 #define CONF_ACK        2               /* PPP configure acknowledge */
 154 #define CONF_NAK        3               /* PPP configure negative ack */
 155 #define CONF_REJ        4               /* PPP configure reject */
 156 #define TERM_REQ        5               /* PPP terminate request */
 157 #define TERM_ACK        6               /* PPP terminate acknowledge */
 158 #define CODE_REJ        7               /* PPP code reject */
 159 #define PROTO_REJ       8               /* PPP protocol reject */
 160 #define ECHO_REQ        9               /* PPP echo request */
 161 #define ECHO_REPLY      10              /* PPP echo reply */
 162 #define DISC_REQ        11              /* PPP discard request */
 163
 164 #define LCP_OPT_MRU             1       /* maximum receive unit */
 165 #define LCP_OPT_ASYNC_MAP       2       /* async control character map */
 166 #define LCP_OPT_AUTH_PROTO      3       /* authentication protocol */
 167 #define LCP_OPT_QUAL_PROTO      4       /* quality protocol */
 168 #define LCP_OPT_MAGIC           5       /* magic number */
 169 #define LCP_OPT_RESERVED        6       /* reserved */
 170 #define LCP_OPT_PROTO_COMP      7       /* protocol field compression */
 171 #define LCP_OPT_ADDR_COMP       8       /* address/control field compression */
 172
 173 #define IPCP_OPT_ADDRESSES      1       /* both IP addresses; deprecated */
 174 #define IPCP_OPT_COMPRESSION    2       /* IP compression protocol (VJ) */
 175 #define IPCP_OPT_ADDRESS        3       /* local IP address */
 176
 177 #define IPV6CP_OPT_IFID 1       /* interface identifier */
 178 #define IPV6CP_OPT_COMPRESSION  2       /* IPv6 compression protocol */
 179
 180 #define IPCP_COMP_VJ            0x2d    /* Code for VJ compression */
 181
 182 #define PAP_REQ                 1       /* PAP name/password request */
 183 #define PAP_ACK                 2       /* PAP acknowledge */
 184 #define PAP_NAK                 3       /* PAP fail */
 185
 186 #define CHAP_CHALLENGE          1       /* CHAP challenge request */
 187 #define CHAP_RESPONSE           2       /* CHAP challenge response */
 188 #define CHAP_SUCCESS            3       /* CHAP response ok */
 189 #define CHAP_FAILURE            4       /* CHAP response failed */
 190
 191 #define CHAP_MD5                5       /* hash algorithm - MD5 */
 192
 193 #define CISCO_MULTICAST         0x8f    /* Cisco multicast address */
 194 #define CISCO_UNICAST           0x0f    /* Cisco unicast address */
 195 #define CISCO_KEEPALIVE         0x8035  /* Cisco keepalive protocol */
 196 #define CISCO_ADDR_REQ          0       /* Cisco address request */
 197 #define CISCO_ADDR_REPLY        1       /* Cisco address reply */
 198 #define CISCO_KEEPALIVE_REQ     2       /* Cisco keepalive request */
 199
 200 /* states are named and numbered according to RFC 1661 */
 201 #define STATE_INITIAL   0
 202 #define STATE_STARTING  1
 203 #define STATE_CLOSED    2
 204 #define STATE_STOPPED   3
 205 #define STATE_CLOSING   4
 206 #define STATE_STOPPING  5
 207 #define STATE_REQ_SENT  6
 208 #define STATE_ACK_RCVD  7
 209 #define STATE_ACK_SENT  8
 210 #define STATE_OPENED    9
 211
 212 struct ppp_header {
 213         u_char address;
 214         u_char control;
 215         u_short protocol;
 216 } __attribute__((__packed__));
 217 #define PPP_HEADER_LEN          sizeof (struct ppp_header)
 218
 219 struct lcp_header {
 220         u_char type;
 221         u_char ident;
 222         u_short len;
 223 } __attribute__((__packed__));
 224 #define LCP_HEADER_LEN          sizeof (struct lcp_header)
 225
 226 struct cisco_packet {
 227         u_long type;
 228         u_long par1;
 229         u_long par2;
 230         u_short rel;
 231         u_short time0;
 232         u_short time1;
 233 } __attribute__((__packed__));
 234 #define CISCO_PACKET_LEN        sizeof (struct cisco_packet)
 235
 236 /*
 237  * We follow the spelling and capitalization of RFC 1661 here, to make
 238  * it easier comparing with the standard.  Please refer to this RFC in
 239  * case you can't make sense out of these abbreviation; it will also
 240  * explain the semantics related to the various events and actions.
 241  */
 242 struct cp {
 243         u_short proto;          /* PPP control protocol number */
 244         u_char protoidx;        /* index into state table in struct sppp */
 245         u_char flags;
 246 #define CP_LCP          0x01    /* this is the LCP */
 247 #define CP_AUTH         0x02    /* this is an authentication protocol */
 248 #define CP_NCP          0x04    /* this is a NCP */
 249 #define CP_QUAL         0x08    /* this is a quality reporting protocol */
 250         const char *name;       /* name of this control protocol */
 251         /* event handlers */
 252         void    (*Up)(struct sppp *sp);
 253         void    (*Down)(struct sppp *sp);
 254         void    (*Open)(struct sppp *sp);
 255         void    (*Close)(struct sppp *sp);
 256         void    (*TO)(void *sp);
 257         int     (*RCR)(struct sppp *sp, struct lcp_header *h, int len);
 258         void    (*RCN_rej)(struct sppp *sp, struct lcp_header *h, int len);
 259         void    (*RCN_nak)(struct sppp *sp, struct lcp_header *h, int len);
 260         /* actions */
 261         void    (*tlu)(struct sppp *sp);
 262         void    (*tld)(struct sppp *sp);
 263         void    (*tls)(struct sppp *sp);
 264         void    (*tlf)(struct sppp *sp);
 265         void    (*scr)(struct sppp *sp);
 266 };
 267
 268 static struct sppp *spppq;
 269 #if defined(__DragonFly__)
 270 static struct callout_handle keepalive_ch;
 271 #endif
 272
 273 #if defined(__FreeBSD__) && __FreeBSD__ >= 3 && !defined(__DragonFly__)
 274 #define SPP_FMT         "%s%d: "
 275 #define SPP_ARGS(ifp)   (ifp)->if_name, (ifp)->if_unit
 276 #else
 277 #define SPP_FMT         "%s: "
 278 #define SPP_ARGS(ifp)   (ifp)->if_xname
 279 #endif
 280
 281 #ifdef INET
 282 /*
 283  * The following disgusting hack gets around the problem that IP TOS
 284  * can't be set yet.  We want to put "interactive" traffic on a high
 285  * priority queue.  To decide if traffic is interactive, we check that
 286  * a) it is TCP and b) one of its ports is telnet, rlogin or ftp control.
 287  *
 288  * XXX is this really still necessary?  - joerg -
 289  */
 290 static u_short interactive_ports[8] = {
 291         0,      513,    0,      0,
 292         0,      21,     0,      23,
 293 };
 294 #define INTERACTIVE(p) (interactive_ports[(p) & 7] == (p))
 295 #endif
 296
 297 /* almost every function needs these */
 298 #define STDDCL                                                  \
 299         struct ifnet *ifp = &sp->pp_if;                         \
 300         int debug = ifp->if_flags & IFF_DEBUG
 301
 302 static int sppp_output(struct ifnet *ifp, struct mbuf *m,
 303                        struct sockaddr *dst, struct rtentry *rt);
 304
 305 static void sppp_cisco_send(struct sppp *sp, int type, long par1, long par2);
 306 static void sppp_cisco_input(struct sppp *sp, struct mbuf *m);
 307
 308 static void sppp_cp_input(const struct cp *cp, struct sppp *sp,
 309                           struct mbuf *m);
 310 static void sppp_cp_send(struct sppp *sp, u_short proto, u_char type,
 311                          u_char ident, u_short len, void *data);
 312 /* static void sppp_cp_timeout(void *arg); */
 313 static void sppp_cp_change_state(const struct cp *cp, struct sppp *sp,
 314                                  int newstate);
 315 static void sppp_auth_send(const struct cp *cp,
 316                            struct sppp *sp, unsigned int type, unsigned int id,
 317                            ...);
 318
 319 static void sppp_up_event(const struct cp *cp, struct sppp *sp);
 320 static void sppp_down_event(const struct cp *cp, struct sppp *sp);
 321 static void sppp_open_event(const struct cp *cp, struct sppp *sp);
 322 static void sppp_close_event(const struct cp *cp, struct sppp *sp);
 323 static void sppp_to_event(const struct cp *cp, struct sppp *sp);
 324
 325 static void sppp_null(struct sppp *sp);
 326
 327 static void sppp_lcp_init(struct sppp *sp);
 328 static void sppp_lcp_up(struct sppp *sp);
 329 static void sppp_lcp_down(struct sppp *sp);
 330 static void sppp_lcp_open(struct sppp *sp);
 331 static void sppp_lcp_close(struct sppp *sp);
 332 static void sppp_lcp_TO(void *sp);
 333 static int sppp_lcp_RCR(struct sppp *sp, struct lcp_header *h, int len);
 334 static void sppp_lcp_RCN_rej(struct sppp *sp, struct lcp_header *h, int len);
 335 static void sppp_lcp_RCN_nak(struct sppp *sp, struct lcp_header *h, int len);
 336 static void sppp_lcp_tlu(struct sppp *sp);
 337 static void sppp_lcp_tld(struct sppp *sp);
 338 static void sppp_lcp_tls(struct sppp *sp);
 339 static void sppp_lcp_tlf(struct sppp *sp);
 340 static void sppp_lcp_scr(struct sppp *sp);
 341 static void sppp_lcp_check_and_close(struct sppp *sp);
 342 static int sppp_ncp_check(struct sppp *sp);
 343
 344 static void sppp_ipcp_init(struct sppp *sp);
 345 static void sppp_ipcp_up(struct sppp *sp);
 346 static void sppp_ipcp_down(struct sppp *sp);
 347 static void sppp_ipcp_open(struct sppp *sp);
 348 static void sppp_ipcp_close(struct sppp *sp);
 349 static void sppp_ipcp_TO(void *sp);
 350 static int sppp_ipcp_RCR(struct sppp *sp, struct lcp_header *h, int len);
 351 static void sppp_ipcp_RCN_rej(struct sppp *sp, struct lcp_header *h, int len);
 352 static void sppp_ipcp_RCN_nak(struct sppp *sp, struct lcp_header *h, int len);
 353 static void sppp_ipcp_tlu(struct sppp *sp);
 354 static void sppp_ipcp_tld(struct sppp *sp);
 355 static void sppp_ipcp_tls(struct sppp *sp);
 356 static void sppp_ipcp_tlf(struct sppp *sp);
 357 static void sppp_ipcp_scr(struct sppp *sp);
 358
 359 static void sppp_ipv6cp_init(struct sppp *sp);
 360 static void sppp_ipv6cp_up(struct sppp *sp);
 361 static void sppp_ipv6cp_down(struct sppp *sp);
 362 static void sppp_ipv6cp_open(struct sppp *sp);
 363 static void sppp_ipv6cp_close(struct sppp *sp);
 364 static void sppp_ipv6cp_TO(void *sp);
 365 static int sppp_ipv6cp_RCR(struct sppp *sp, struct lcp_header *h, int len);
 366 static void sppp_ipv6cp_RCN_rej(struct sppp *sp, struct lcp_header *h, int len);
 367 static void sppp_ipv6cp_RCN_nak(struct sppp *sp, struct lcp_header *h, int len);
 368 static void sppp_ipv6cp_tlu(struct sppp *sp);
 369 static void sppp_ipv6cp_tld(struct sppp *sp);
 370 static void sppp_ipv6cp_tls(struct sppp *sp);
 371 static void sppp_ipv6cp_tlf(struct sppp *sp);
 372 static void sppp_ipv6cp_scr(struct sppp *sp);
 373
 374 static void sppp_pap_input(struct sppp *sp, struct mbuf *m);
 375 static void sppp_pap_init(struct sppp *sp);
 376 static void sppp_pap_open(struct sppp *sp);
 377 static void sppp_pap_close(struct sppp *sp);
 378 static void sppp_pap_TO(void *sp);
 379 static void sppp_pap_my_TO(void *sp);
 380 static void sppp_pap_tlu(struct sppp *sp);
 381 static void sppp_pap_tld(struct sppp *sp);
 382 static void sppp_pap_scr(struct sppp *sp);
 383
 384 static void sppp_chap_input(struct sppp *sp, struct mbuf *m);
 385 static void sppp_chap_init(struct sppp *sp);
 386 static void sppp_chap_open(struct sppp *sp);
 387 static void sppp_chap_close(struct sppp *sp);
 388 static void sppp_chap_TO(void *sp);
 389 static void sppp_chap_tlu(struct sppp *sp);
 390 static void sppp_chap_tld(struct sppp *sp);
 391 static void sppp_chap_scr(struct sppp *sp);
 392
 393 static const char *sppp_auth_type_name(u_short proto, u_char type);
 394 static const char *sppp_cp_type_name(u_char type);
 395 static const char *sppp_dotted_quad(u_long addr);
 396 static const char *sppp_ipcp_opt_name(u_char opt);
 397 #ifdef INET6
 398 static const char *sppp_ipv6cp_opt_name(u_char opt);
 399 #endif
 400 static const char *sppp_lcp_opt_name(u_char opt);
 401 static const char *sppp_phase_name(enum ppp_phase phase);
 402 static const char *sppp_proto_name(u_short proto);
 403 static const char *sppp_state_name(int state);
 404 static int sppp_params(struct sppp *sp, u_long cmd, void *data);
 405 static int sppp_strnlen(u_char *p, int max);
 406 static void sppp_get_ip_addrs(struct sppp *sp, u_long *src, u_long *dst,
 407                               u_long *srcmask);
 408 static void sppp_keepalive(void *dummy);
 409 static void sppp_phase_network(struct sppp *sp);
 410 static void sppp_print_bytes(const u_char *p, u_short len);
 411 static void sppp_print_string(const char *p, u_short len);
 412 static void sppp_qflush(struct ifqueue *ifq);
 413 static void sppp_set_ip_addr(struct sppp *sp, u_long src);
 414 #ifdef INET6
 415 static void sppp_get_ip6_addrs(struct sppp *sp, struct in6_addr *src,
 416                                struct in6_addr *dst, struct in6_addr *srcmask);
 417 #ifdef IPV6CP_MYIFID_DYN
 418 static void sppp_set_ip6_addr(struct sppp *sp, const struct in6_addr *src);
 419 static void sppp_gen_ip6_addr(struct sppp *sp, const struct in6_addr *src);
 420 #endif
 421 static void sppp_suggest_ip6_addr(struct sppp *sp, struct in6_addr *src);
 422 #endif
 423
 424 /* our control protocol descriptors */
 425 static const struct cp lcp = {
 426         PPP_LCP, IDX_LCP, CP_LCP, "lcp",
 427         sppp_lcp_up, sppp_lcp_down, sppp_lcp_open, sppp_lcp_close,
 428         sppp_lcp_TO, sppp_lcp_RCR, sppp_lcp_RCN_rej, sppp_lcp_RCN_nak,
 429         sppp_lcp_tlu, sppp_lcp_tld, sppp_lcp_tls, sppp_lcp_tlf,
 430         sppp_lcp_scr
 431 };
 432
 433 static const struct cp ipcp = {
 434         PPP_IPCP, IDX_IPCP, CP_NCP, "ipcp",
 435         sppp_ipcp_up, sppp_ipcp_down, sppp_ipcp_open, sppp_ipcp_close,
 436         sppp_ipcp_TO, sppp_ipcp_RCR, sppp_ipcp_RCN_rej, sppp_ipcp_RCN_nak,
 437         sppp_ipcp_tlu, sppp_ipcp_tld, sppp_ipcp_tls, sppp_ipcp_tlf,
 438         sppp_ipcp_scr
 439 };
 440
 441 static const struct cp ipv6cp = {
 442         PPP_IPV6CP, IDX_IPV6CP,
 443 #ifdef INET6    /*don't run IPv6CP if there's no IPv6 support*/
 444         CP_NCP,
 445 #else
 446         0,
 447 #endif
 448         "ipv6cp",
 449         sppp_ipv6cp_up, sppp_ipv6cp_down, sppp_ipv6cp_open, sppp_ipv6cp_close,
 450         sppp_ipv6cp_TO, sppp_ipv6cp_RCR, sppp_ipv6cp_RCN_rej, sppp_ipv6cp_RCN_nak,
 451         sppp_ipv6cp_tlu, sppp_ipv6cp_tld, sppp_ipv6cp_tls, sppp_ipv6cp_tlf,
 452         sppp_ipv6cp_scr
 453 };
 454
 455 static const struct cp pap = {
 456         PPP_PAP, IDX_PAP, CP_AUTH, "pap",
 457         sppp_null, sppp_null, sppp_pap_open, sppp_pap_close,
 458         sppp_pap_TO, 0, 0, 0,
 459         sppp_pap_tlu, sppp_pap_tld, sppp_null, sppp_null,
 460         sppp_pap_scr
 461 };
 462
 463 static const struct cp chap = {
 464         PPP_CHAP, IDX_CHAP, CP_AUTH, "chap",
 465         sppp_null, sppp_null, sppp_chap_open, sppp_chap_close,
 466         sppp_chap_TO, 0, 0, 0,
 467         sppp_chap_tlu, sppp_chap_tld, sppp_null, sppp_null,
 468         sppp_chap_scr
 469 };
 470
 471 static const struct cp *cps[IDX_COUNT] = {
 472         &lcp,                   /* IDX_LCP */
 473         &ipcp,                  /* IDX_IPCP */
 474         &ipv6cp,                /* IDX_IPV6CP */
 475         &pap,                   /* IDX_PAP */
 476         &chap,                  /* IDX_CHAP */
 477 };
 478
 479 static int
 480 sppp_modevent(module_t mod, int type, void *unused)
 481 {
 482         switch (type) {
 483         case MOD_LOAD:
 484                 break;
 485         case MOD_UNLOAD:
 486                 return EACCES;
 487                 break;
 488         default:
 489                 break;
 490         }
 491         return 0;
 492 }
 493 static moduledata_t spppmod = {
 494         "sppp",
 495         sppp_modevent,
 496         0
 497 };
 498 MODULE_VERSION(sppp, 1);
 499 DECLARE_MODULE(sppp, spppmod, SI_SUB_DRIVERS, SI_ORDER_ANY);
 500
 501 /*
 502  * Exported functions, comprising our interface to the lower layer.
 503  */
 504
 505 /*
 506  * Process the received packet.
 507  */
 508 void
 509 sppp_input(struct ifnet *ifp, struct mbuf *m)
 510 {
 511         struct ppp_header *h;
 512         int isr = -1;
 513         struct sppp *sp = (struct sppp *)ifp;
 514         u_char *iphdr;
 515         int hlen, vjlen, do_account = 0;
 516         int debug = ifp->if_flags & IFF_DEBUG;
 517
 518         if (ifp->if_flags & IFF_UP)
 519                 /* Count received bytes, add FCS and one flag */
 520                 ifp->if_ibytes += m->m_pkthdr.len + 3;
 521
 522         if (m->m_pkthdr.len <= PPP_HEADER_LEN) {
 523                 /* Too small packet, drop it. */
 524                 if (debug)
 525                         log(LOG_DEBUG,
 526                             SPP_FMT "input packet is too small, %d bytes\n",
 527                             SPP_ARGS(ifp), m->m_pkthdr.len);
 528           drop:
 529                 m_freem (m);
 530           drop2:
 531                 ++ifp->if_ierrors;
 532                 ++ifp->if_iqdrops;
 533                 return;
 534         }
 535
 536         /* Get PPP header. */
 537         h = mtod (m, struct ppp_header*);
 538         m_adj (m, PPP_HEADER_LEN);
 539
 540         switch (h->address) {
 541         case PPP_ALLSTATIONS:
 542                 if (h->control != PPP_UI)
 543                         goto invalid;
 544                 if (sp->pp_mode == IFF_CISCO) {
 545                         if (debug)
 546                                 log(LOG_DEBUG,
 547                                     SPP_FMT "PPP packet in Cisco mode "
 548                                     "<addr=0x%x ctrl=0x%x proto=0x%x>\n",
 549                                     SPP_ARGS(ifp),
 550                                     h->address, h->control, ntohs(h->protocol));
 551                         goto drop;
 552                 }
 553                 switch (ntohs (h->protocol)) {
 554                 default:
 555                         if (debug)
 556                                 log(LOG_DEBUG,
 557                                     SPP_FMT "rejecting protocol "
 558                                     "<addr=0x%x ctrl=0x%x proto=0x%x>\n",
 559                                     SPP_ARGS(ifp),
 560                                     h->address, h->control, ntohs(h->protocol));
 561                         if (sp->state[IDX_LCP] == STATE_OPENED)
 562                                 sppp_cp_send (sp, PPP_LCP, PROTO_REJ,
 563                                         ++sp->pp_seq[IDX_LCP], m->m_pkthdr.len + 2,
 564                                         &h->protocol);
 565                         ++ifp->if_noproto;
 566                         goto drop;
 567                 case PPP_LCP:
 568                         sppp_cp_input(&lcp, sp, m);
 569                         m_freem (m);
 570                         return;
 571                 case PPP_PAP:
 572                         if (sp->pp_phase >= PHASE_AUTHENTICATE)
 573                                 sppp_pap_input(sp, m);
 574                         m_freem (m);
 575                         return;
 576                 case PPP_CHAP:
 577                         if (sp->pp_phase >= PHASE_AUTHENTICATE)
 578                                 sppp_chap_input(sp, m);
 579                         m_freem (m);
 580                         return;
 581 #ifdef INET
 582                 case PPP_IPCP:
 583                         if (sp->pp_phase == PHASE_NETWORK)
 584                                 sppp_cp_input(&ipcp, sp, m);
 585                         m_freem (m);
 586                         return;
 587                 case PPP_IP:
 588                         if (sp->state[IDX_IPCP] == STATE_OPENED) {
 589                                 isr = NETISR_IP;
 590                         }
 591                         do_account++;
 592                         break;
 593                 case PPP_VJ_COMP:
 594                         if (sp->state[IDX_IPCP] == STATE_OPENED) {
 595                                 if ((vjlen =
 596                                      sl_uncompress_tcp_core(mtod(m, u_char *),
 597                                                             m->m_len, m->m_len,
 598                                                             TYPE_COMPRESSED_TCP,
 599                                                             sp->pp_comp,
 600                                                             &iphdr, &hlen)) <= 0) {
 601                                         if (debug)
 602                                                 log(LOG_INFO,
 603                             SPP_FMT "VJ uncompress failed on compressed packet\n",
 604                                                     SPP_ARGS(ifp));
 605                                         goto drop;
 606                                 }
 607
 608                                 /*
 609                                  * Trim the VJ header off the packet, and prepend
 610                                  * the uncompressed IP header (which will usually
 611                                  * end up in two chained mbufs since there's not
 612                                  * enough leading space in the existing mbuf).
 613                                  */
 614                                 m_adj(m, vjlen);
 615                                 M_PREPEND(m, hlen, MB_DONTWAIT);
 616                                 if (m == NULL)
 617                                         goto drop2;
 618                                 bcopy(iphdr, mtod(m, u_char *), hlen);
 619
 620                                 isr = NETISR_IP;
 621                         }
 622                         do_account++;
 623                         break;
 624                 case PPP_VJ_UCOMP:
 625                         if (sp->state[IDX_IPCP] == STATE_OPENED) {
 626                                 if (sl_uncompress_tcp_core(mtod(m, u_char *),
 627                                                            m->m_len, m->m_len,
 628                                                            TYPE_UNCOMPRESSED_TCP,
 629                                                            sp->pp_comp,
 630                                                            &iphdr, &hlen) != 0) {
 631                                         if (debug)
 632                                                 log(LOG_INFO,
 633                             SPP_FMT "VJ uncompress failed on uncompressed packet\n",
 634                                                     SPP_ARGS(ifp));
 635                                         goto drop;
 636                                 }
 637                                 isr = NETISR_IP;
 638                         }
 639                         do_account++;
 640                         break;
 641 #endif
 642 #ifdef INET6
 643                 case PPP_IPV6CP:
 644                         if (sp->pp_phase == PHASE_NETWORK)
 645                             sppp_cp_input(&ipv6cp, sp, m);
 646                         m_freem (m);
 647                         return;
 648
 649                 case PPP_IPV6:
 650                         if (sp->state[IDX_IPV6CP] == STATE_OPENED) {
 651                                 isr = NETISR_IPV6;
 652                         }
 653                         do_account++;
 654                         break;
 655 #endif
 656 #ifdef IPX
 657                 case PPP_IPX:
 658                         /* IPX IPXCP not implemented yet */
 659                         if (sp->pp_phase == PHASE_NETWORK) {
 660                                 isr = NETISR_IPX;
 661                         }
 662                         do_account++;
 663                         break;
 664 #endif
 665 #ifdef NS
 666                 case PPP_XNS:
 667                         /* XNS IDPCP not implemented yet */
 668                         if (sp->pp_phase == PHASE_NETWORK) {
 669                                 isr = NETISR_NS;
 670                         }
 671                         do_account++;
 672                         break;
 673 #endif
 674                 }
 675                 break;
 676         case CISCO_MULTICAST:
 677         case CISCO_UNICAST:
 678                 /* Don't check the control field here (RFC 1547). */
 679                 if (sp->pp_mode != IFF_CISCO) {
 680                         if (debug)
 681                                 log(LOG_DEBUG,
 682                                     SPP_FMT "Cisco packet in PPP mode "
 683                                     "<addr=0x%x ctrl=0x%x proto=0x%x>\n",
 684                                     SPP_ARGS(ifp),
 685                                     h->address, h->control, ntohs(h->protocol));
 686                         goto drop;
 687                 }
 688                 switch (ntohs (h->protocol)) {
 689                 default:
 690                         ++ifp->if_noproto;
 691                         goto invalid;
 692                 case CISCO_KEEPALIVE:
 693                         sppp_cisco_input ((struct sppp*) ifp, m);
 694                         m_freem (m);
 695                         return;
 696 #ifdef INET
 697                 case ETHERTYPE_IP:
 698                         isr = NETISR_IP;
 699                         do_account++;
 700                         break;
 701 #endif
 702 #ifdef INET6
 703                 case ETHERTYPE_IPV6:
 704                         isr = NETISR_IPV6;
 705                         do_account++;
 706                         break;
 707 #endif
 708 #ifdef IPX
 709                 case ETHERTYPE_IPX:
 710                         isr = NETISR_IPX;
 711                         do_account++;
 712                         break;
 713 #endif
 714 #ifdef NS
 715                 case ETHERTYPE_NS:
 716                         isr = NETISR_NS
 717                         do_account++;
 718                         break;
 719 #endif
 720                 }
 721                 break;
 722         default:        /* Invalid PPP packet. */
 723           invalid:
 724                 if (debug)
 725                         log(LOG_DEBUG,
 726                             SPP_FMT "invalid input packet "
 727                             "<addr=0x%x ctrl=0x%x proto=0x%x>\n",
 728                             SPP_ARGS(ifp),
 729                             h->address, h->control, ntohs(h->protocol));
 730                 goto drop;
 731         }
 732
 733         if (! (ifp->if_flags & IFF_UP) || isr < 0)
 734                 goto drop;
 735
 736         /* Check queue. */
 737
 738         netisr_dispatch(isr, m);
 739         if (do_account)
 740                 /*
 741                  * Do only account for network packets, not for control
 742                  * packets.  This is used by some subsystems to detect
 743                  * idle lines.
 744                  */
 745                 sp->pp_last_recv = time_second;
 746 }
 747
 748 /*
 749  * Enqueue transmit packet.
 750  */
 751 static int
 752 sppp_output(struct ifnet *ifp, struct mbuf *m,
 753             struct sockaddr *dst, struct rtentry *rt)
 754 {
 755         struct sppp *sp = (struct sppp*) ifp;
 756         struct ppp_header *h;
 757         struct ifqueue *ifq = NULL;
 758         int s, rv = 0;
 759         int ipproto = PPP_IP;
 760         int debug = ifp->if_flags & IFF_DEBUG;
 761
 762         s = splimp();
 763
 764         if ((ifp->if_flags & IFF_UP) == 0 ||
 765             (ifp->if_flags & (IFF_RUNNING | IFF_AUTO)) == 0) {
 766 #ifdef INET6
 767           drop:
 768 #endif
 769                 m_freem (m);
 770                 splx (s);
 771                 return (ENETDOWN);
 772         }
 773
 774         if ((ifp->if_flags & (IFF_RUNNING | IFF_AUTO)) == IFF_AUTO) {
 775 #ifdef INET6
 776                 /*
 777                  * XXX
 778                  *
 779                  * Hack to prevent the initialization-time generated
 780                  * IPv6 multicast packet to erroneously cause a
 781                  * dialout event in case IPv6 has been
 782                  * administratively disabled on that interface.
 783                  */
 784                 if (dst->sa_family == AF_INET6 &&
 785                     !(sp->confflags & CONF_ENABLE_IPV6))
 786                         goto drop;
 787 #endif
 788                 /*
 789                  * Interface is not yet running, but auto-dial.  Need
 790                  * to start LCP for it.
 791                  */
 792                 ifp->if_flags |= IFF_RUNNING;
 793                 splx(s);
 794                 lcp.Open(sp);
 795                 s = splimp();
 796         }
 797
 798         ifq = &ifp->if_snd;
 799 #ifdef INET
 800         if (dst->sa_family == AF_INET) {
 801                 /* XXX Check mbuf length here? */
 802                 struct ip *ip = mtod (m, struct ip*);
 803                 struct tcphdr *tcp = (struct tcphdr*) ((long*)ip + ip->ip_hl);
 804
 805                 /*
 806                  * When using dynamic local IP address assignment by using
 807                  * 0.0.0.0 as a local address, the first TCP session will
 808                  * not connect because the local TCP checksum is computed
 809                  * using 0.0.0.0 which will later become our real IP address
 810                  * so the TCP checksum computed at the remote end will
 811                  * become invalid. So we
 812                  * - don't let packets with src ip addr 0 thru
 813                  * - we flag TCP packets with src ip 0 as an error
 814                  */
 815
 816                 if(ip->ip_src.s_addr == INADDR_ANY)     /* -hm */
 817                 {
 818                         m_freem(m);
 819                         splx(s);
 820                         if(ip->ip_p == IPPROTO_TCP)
 821                                 return(EADDRNOTAVAIL);
 822                         else
 823                                 return(0);
 824                 }
 825
 826                 /*
 827                  * Put low delay, telnet, rlogin and ftp control packets
 828                  * in front of the queue.
 829                  */
 830                 if (IF_QFULL (&sp->pp_fastq))
 831                         ;
 832                 else if (ip->ip_tos & IPTOS_LOWDELAY)
 833                         ifq = &sp->pp_fastq;
 834                 else if (m->m_len < sizeof *ip + sizeof *tcp)
 835                         ;
 836                 else if (ip->ip_p != IPPROTO_TCP)
 837                         ;
 838                 else if (INTERACTIVE (ntohs (tcp->th_sport)))
 839                         ifq = &sp->pp_fastq;
 840                 else if (INTERACTIVE (ntohs (tcp->th_dport)))
 841                         ifq = &sp->pp_fastq;
 842
 843                 /*
 844                  * Do IP Header compression
 845                  */
 846                 if (sp->pp_mode != IFF_CISCO && (sp->ipcp.flags & IPCP_VJ) &&
 847                     ip->ip_p == IPPROTO_TCP)
 848                         switch (sl_compress_tcp(m, ip, sp->pp_comp,
 849                                                 sp->ipcp.compress_cid)) {
 850                         case TYPE_COMPRESSED_TCP:
 851                                 ipproto = PPP_VJ_COMP;
 852                                 break;
 853                         case TYPE_UNCOMPRESSED_TCP:
 854                                 ipproto = PPP_VJ_UCOMP;
 855                                 break;
 856                         case TYPE_IP:
 857                                 ipproto = PPP_IP;
 858                                 break;
 859                         default:
 860                                 m_freem(m);
 861                                 splx(s);
 862                                 return (EINVAL);
 863                         }
 864         }
 865 #endif
 866
 867 #ifdef INET6
 868         if (dst->sa_family == AF_INET6) {
 869                 /* XXX do something tricky here? */
 870         }
 871 #endif
 872
 873         /*
 874          * Prepend general data packet PPP header. For now, IP only.
 875          */
 876         M_PREPEND (m, PPP_HEADER_LEN, MB_DONTWAIT);
 877         if (! m) {
 878                 if (debug)
 879                         log(LOG_DEBUG, SPP_FMT "no memory for transmit header\n",
 880                                 SPP_ARGS(ifp));
 881                 ++ifp->if_oerrors;
 882                 splx (s);
 883                 return (ENOBUFS);
 884         }
 885         /*
 886          * May want to check size of packet
 887          * (albeit due to the implementation it's always enough)
 888          */
 889         h = mtod (m, struct ppp_header*);
 890         if (sp->pp_mode == IFF_CISCO) {
 891                 h->address = CISCO_UNICAST;        /* unicast address */
 892                 h->control = 0;
 893         } else {
 894                 h->address = PPP_ALLSTATIONS;        /* broadcast address */
 895                 h->control = PPP_UI;                 /* Unnumbered Info */
 896         }
 897
 898         switch (dst->sa_family) {
 899 #ifdef INET
 900         case AF_INET:   /* Internet Protocol */
 901                 if (sp->pp_mode == IFF_CISCO)
 902                         h->protocol = htons (ETHERTYPE_IP);
 903                 else {
 904                         /*
 905                          * Don't choke with an ENETDOWN early.  It's
 906                          * possible that we just started dialing out,
 907                          * so don't drop the packet immediately.  If
 908                          * we notice that we run out of buffer space
 909                          * below, we will however remember that we are
 910                          * not ready to carry IP packets, and return
 911                          * ENETDOWN, as opposed to ENOBUFS.
 912                          */
 913                         h->protocol = htons(ipproto);
 914                         if (sp->state[IDX_IPCP] != STATE_OPENED)
 915                                 rv = ENETDOWN;
 916                 }
 917                 break;
 918 #endif
 919 #ifdef INET6
 920         case AF_INET6:   /* Internet Protocol */
 921                 if (sp->pp_mode == IFF_CISCO)
 922                         h->protocol = htons (ETHERTYPE_IPV6);
 923                 else {
 924                         /*
 925                          * Don't choke with an ENETDOWN early.  It's
 926                          * possible that we just started dialing out,
 927                          * so don't drop the packet immediately.  If
 928                          * we notice that we run out of buffer space
 929                          * below, we will however remember that we are
 930                          * not ready to carry IP packets, and return
 931                          * ENETDOWN, as opposed to ENOBUFS.
 932                          */
 933                         h->protocol = htons(PPP_IPV6);
 934                         if (sp->state[IDX_IPV6CP] != STATE_OPENED)
 935                                 rv = ENETDOWN;
 936                 }
 937                 break;
 938 #endif
 939 #ifdef NS
 940         case AF_NS:     /* Xerox NS Protocol */
 941                 h->protocol = htons (sp->pp_mode == IFF_CISCO ?
 942                         ETHERTYPE_NS : PPP_XNS);
 943                 break;
 944 #endif
 945 #ifdef IPX
 946         case AF_IPX:     /* Novell IPX Protocol */
 947                 h->protocol = htons (sp->pp_mode == IFF_CISCO ?
 948                         ETHERTYPE_IPX : PPP_IPX);
 949                 break;
 950 #endif
 951         default:
 952                 m_freem (m);
 953                 ++ifp->if_oerrors;
 954                 splx (s);
 955                 return (EAFNOSUPPORT);
 956         }
 957
 958         /*
 959          * Queue message on interface, and start output if interface
 960          * not yet active.
 961          */
 962         if (IF_QFULL (ifq)) {
 963                 IF_DROP (&ifp->if_snd);
 964                 m_freem (m);
 965                 ++ifp->if_oerrors;
 966                 splx (s);
 967                 return (rv? rv: ENOBUFS);
 968         }
 969         IF_ENQUEUE (ifq, m);
 970         if (! (ifp->if_flags & IFF_OACTIVE))
 971                 (*ifp->if_start) (ifp);
 972
 973         /*
 974          * Count output packets and bytes.
 975          * The packet length includes header, FCS and 1 flag,
 976          * according to RFC 1333.
 977          */
 978         ifp->if_obytes += m->m_pkthdr.len + 3;
 979         splx (s);
 980         /*
 981          * Unlike in sppp_input(), we can always bump the timestamp
 982          * here since sppp_output() is only called on behalf of
 983          * network-layer traffic; control-layer traffic is handled
 984          * by sppp_cp_send().
 985          */
 986         sp->pp_last_sent = time_second;
 987         return (0);
 988 }
 989
 990 void
 991 sppp_attach(struct ifnet *ifp)
 992 {
 993         struct sppp *sp = (struct sppp*) ifp;
 994
 995         /* Initialize keepalive handler. */
 996         if (! spppq)
 997                 TIMEOUT(sppp_keepalive, 0, hz * 10, keepalive_ch);
 998
 999         /* Insert new entry into the keepalive list. */
1000         sp->pp_next = spppq;
1001         spppq = sp;
1002
1003         sp->pp_if.if_mtu = PP_MTU;
1004         sp->pp_if.if_flags = IFF_POINTOPOINT | IFF_MULTICAST;
1005         sp->pp_if.if_type = IFT_PPP;
1006         sp->pp_if.if_output = sppp_output;
1007 #if 0
1008         sp->pp_flags = PP_KEEPALIVE;
1009 #endif
1010         sp->pp_if.if_snd.ifq_maxlen = 32;
1011         sp->pp_fastq.ifq_maxlen = 32;
1012         sp->pp_cpq.ifq_maxlen = 20;
1013         sp->pp_loopcnt = 0;
1014         sp->pp_alivecnt = 0;
1015         bzero(&sp->pp_seq[0], sizeof(sp->pp_seq));
1016         bzero(&sp->pp_rseq[0], sizeof(sp->pp_rseq));
1017         sp->pp_phase = PHASE_DEAD;
1018         sp->pp_up = lcp.Up;
1019         sp->pp_down = lcp.Down;
1020         sp->pp_last_recv = sp->pp_last_sent = time_second;
1021         sp->confflags = 0;
1022 #ifdef INET
1023         sp->confflags |= CONF_ENABLE_VJ;
1024 #endif
1025 #ifdef INET6
1026         sp->confflags |= CONF_ENABLE_IPV6;
1027 #endif
1028         sp->pp_comp = malloc(sizeof(struct slcompress), M_TEMP, M_WAITOK);
1029         sl_compress_init(sp->pp_comp, -1);
1030         sppp_lcp_init(sp);
1031         sppp_ipcp_init(sp);
1032         sppp_ipv6cp_init(sp);
1033         sppp_pap_init(sp);
1034         sppp_chap_init(sp);
1035 }
1036
1037 void
1038 sppp_detach(struct ifnet *ifp)
1039 {
1040         struct sppp **q, *p, *sp = (struct sppp*) ifp;
1041         int i;
1042
1043         /* Remove the entry from the keepalive list. */
1044         for (q = &spppq; (p = *q); q = &p->pp_next)
1045                 if (p == sp) {
1046                         *q = p->pp_next;
1047                         break;
1048                 }
1049
1050         /* Stop keepalive handler. */
1051         if (! spppq)
1052                 UNTIMEOUT(sppp_keepalive, 0, keepalive_ch);
1053
1054         for (i = 0; i < IDX_COUNT; i++)
1055                 UNTIMEOUT((cps[i])->TO, (void *)sp, sp->ch[i]);
1056         UNTIMEOUT(sppp_pap_my_TO, (void *)sp, sp->pap_my_to_ch);
1057 }
1058
1059 /*
1060  * Flush the interface output queue.
1061  */
1062 void
1063 sppp_flush(struct ifnet *ifp)
1064 {
1065         struct sppp *sp = (struct sppp*) ifp;
1066
1067         sppp_qflush (&sp->pp_if.if_snd);
1068         sppp_qflush (&sp->pp_fastq);
1069         sppp_qflush (&sp->pp_cpq);
1070 }
1071
1072 /*
1073  * Check if the output queue is empty.
1074  */
1075 int
1076 sppp_isempty(struct ifnet *ifp)
1077 {
1078         struct sppp *sp = (struct sppp*) ifp;
1079         int empty, s;
1080
1081         s = splimp();
1082         empty = !sp->pp_fastq.ifq_head && !sp->pp_cpq.ifq_head &&
1083                 !sp->pp_if.if_snd.ifq_head;
1084         splx(s);
1085         return (empty);
1086 }
1087
1088 /*
1089  * Get next packet to send.
1090  */
1091 struct mbuf *
1092 sppp_dequeue(struct ifnet *ifp)
1093 {
1094         struct sppp *sp = (struct sppp*) ifp;
1095         struct mbuf *m;
1096         int s;
1097
1098         s = splimp();
1099         /*
1100          * Process only the control protocol queue until we have at
1101          * least one NCP open.
1102          *
1103          * Do always serve all three queues in Cisco mode.
1104          */
1105         IF_DEQUEUE(&sp->pp_cpq, m);
1106         if (m == NULL &&
1107             (sppp_ncp_check(sp) || sp->pp_mode == IFF_CISCO)) {
1108                 IF_DEQUEUE(&sp->pp_fastq, m);
1109                 if (m == NULL)
1110                         IF_DEQUEUE (&sp->pp_if.if_snd, m);
1111         }
1112         splx(s);
1113         return m;
1114 }
1115
1116 /*
1117  * Pick the next packet, do not remove it from the queue.
1118  */
1119 struct mbuf *
1120 sppp_pick(struct ifnet *ifp)
1121 {
1122         struct sppp *sp = (struct sppp*)ifp;
1123         struct mbuf *m;
1124         int s;
1125
1126         s= splimp ();
1127
1128         m = sp->pp_cpq.ifq_head;
1129         if (m == NULL &&
1130             (sp->pp_phase == PHASE_NETWORK || sp->pp_mode == IFF_CISCO))
1131                 if ((m = sp->pp_fastq.ifq_head) == NULL)
1132                         m = sp->pp_if.if_snd.ifq_head;
1133         splx (s);
1134         return (m);
1135 }
1136
1137 /*
1138  * Process an ioctl request.  Called on low priority level.
1139  */
1140 int
1141 sppp_ioctl(struct ifnet *ifp, IOCTL_CMD_T cmd, void *data)
1142 {
1143         struct ifreq *ifr = (struct ifreq*) data;
1144         struct sppp *sp = (struct sppp*) ifp;
1145         int s, rv, going_up, going_down, newmode;
1146
1147         s = splimp();
1148         rv = 0;
1149         switch (cmd) {
1150         case SIOCAIFADDR:
1151         case SIOCSIFDSTADDR:
1152                 break;
1153
1154         case SIOCSIFADDR:
1155                 /* set the interface "up" when assigning an IP address */
1156                 ifp->if_flags |= IFF_UP;
1157                 /* fall through... */
1158
1159         case SIOCSIFFLAGS:
1160                 going_up = ifp->if_flags & IFF_UP &&
1161                         (ifp->if_flags & IFF_RUNNING) == 0;
1162                 going_down = (ifp->if_flags & IFF_UP) == 0 &&
1163                         ifp->if_flags & IFF_RUNNING;
1164
1165                 newmode = ifp->if_flags & IFF_PASSIVE;
1166                 if (!newmode)
1167                         newmode = ifp->if_flags & IFF_AUTO;
1168                 if (!newmode)
1169                         newmode = ifp->if_flags & IFF_CISCO;
1170                 ifp->if_flags &= ~(IFF_PASSIVE | IFF_AUTO | IFF_CISCO);
1171                 ifp->if_flags |= newmode;
1172
1173                 if (newmode != sp->pp_mode) {
1174                         going_down = 1;
1175                         if (!going_up)
1176                                 going_up = ifp->if_flags & IFF_RUNNING;
1177                 }
1178
1179                 if (going_down) {
1180                         if (sp->pp_mode != IFF_CISCO)
1181                                 lcp.Close(sp);
1182                         else if (sp->pp_tlf)
1183                                 (sp->pp_tlf)(sp);
1184                         sppp_flush(ifp);
1185                         ifp->if_flags &= ~IFF_RUNNING;
1186                         sp->pp_mode = newmode;
1187                 }
1188
1189                 if (going_up) {
1190                         if (sp->pp_mode != IFF_CISCO)
1191                                 lcp.Close(sp);
1192                         sp->pp_mode = newmode;
1193                         if (sp->pp_mode == 0) {
1194                                 ifp->if_flags |= IFF_RUNNING;
1195                                 lcp.Open(sp);
1196                         }
1197                         if (sp->pp_mode == IFF_CISCO) {
1198                                 if (sp->pp_tls)
1199                                         (sp->pp_tls)(sp);
1200                                 ifp->if_flags |= IFF_RUNNING;
1201                         }
1202                 }
1203
1204                 break;
1205
1206 #ifdef SIOCSIFMTU
1207 #ifndef ifr_mtu
1208 #define ifr_mtu ifr_metric
1209 #endif
1210         case SIOCSIFMTU:
1211                 if (ifr->ifr_mtu < 128 || ifr->ifr_mtu > sp->lcp.their_mru)
1212                         return (EINVAL);
1213                 ifp->if_mtu = ifr->ifr_mtu;
1214                 break;
1215 #endif
1216 #ifdef SLIOCSETMTU
1217         case SLIOCSETMTU:
1218                 if (*(short*)data < 128 || *(short*)data > sp->lcp.their_mru)
1219                         return (EINVAL);
1220                 ifp->if_mtu = *(short*)data;
1221                 break;
1222 #endif
1223 #ifdef SIOCGIFMTU
1224         case SIOCGIFMTU:
1225                 ifr->ifr_mtu = ifp->if_mtu;
1226                 break;
1227 #endif
1228 #ifdef SLIOCGETMTU
1229         case SLIOCGETMTU:
1230                 *(short*)data = ifp->if_mtu;
1231                 break;
1232 #endif
1233         case SIOCADDMULTI:
1234         case SIOCDELMULTI:
1235                 break;
1236
1237         case SIOCGIFGENERIC:
1238         case SIOCSIFGENERIC:
1239                 rv = sppp_params(sp, cmd, data);
1240                 break;
1241
1242         default:
1243                 rv = ENOTTY;
1244         }
1245         splx(s);
1246         return rv;
1247 }
1248
1249 /*
1250  * Cisco framing implementation.
1251  */
1252
1253 /*
1254  * Handle incoming Cisco keepalive protocol packets.
1255  */
1256 static void
1257 sppp_cisco_input(struct sppp *sp, struct mbuf *m)
1258 {
1259         STDDCL;
1260         struct cisco_packet *h;
1261         u_long me, mymask;
1262
1263         if (m->m_pkthdr.len < CISCO_PACKET_LEN) {
1264                 if (debug)
1265                         log(LOG_DEBUG,
1266                             SPP_FMT "cisco invalid packet length: %d bytes\n",
1267                             SPP_ARGS(ifp), m->m_pkthdr.len);
1268                 return;
1269         }
1270         h = mtod (m, struct cisco_packet*);
1271         if (debug)
1272                 log(LOG_DEBUG,
1273                     SPP_FMT "cisco input: %d bytes "
1274                     "<0x%lx 0x%lx 0x%lx 0x%x 0x%x-0x%x>\n",
1275                     SPP_ARGS(ifp), m->m_pkthdr.len,
1276                     (u_long)ntohl (h->type), (u_long)h->par1, (u_long)h->par2, (u_int)h->rel,
1277                     (u_int)h->time0, (u_int)h->time1);
1278         switch (ntohl (h->type)) {
1279         default:
1280                 if (debug)
1281                         addlog(SPP_FMT "cisco unknown packet type: 0x%lx\n",
1282                                SPP_ARGS(ifp), (u_long)ntohl (h->type));
1283                 break;
1284         case CISCO_ADDR_REPLY:
1285                 /* Reply on address request, ignore */
1286                 break;
1287         case CISCO_KEEPALIVE_REQ:
1288                 sp->pp_alivecnt = 0;
1289                 sp->pp_rseq[IDX_LCP] = ntohl (h->par1);
1290                 if (sp->pp_seq[IDX_LCP] == sp->pp_rseq[IDX_LCP]) {
1291                         /* Local and remote sequence numbers are equal.
1292                          * Probably, the line is in loopback mode. */
1293                         if (sp->pp_loopcnt >= MAXALIVECNT) {
1294                                 printf (SPP_FMT "loopback\n",
1295                                         SPP_ARGS(ifp));
1296                                 sp->pp_loopcnt = 0;
1297                                 if (ifp->if_flags & IFF_UP) {
1298                                         if_down (ifp);
1299                                         sppp_qflush (&sp->pp_cpq);
1300                                 }
1301                         }
1302                         ++sp->pp_loopcnt;
1303
1304                         /* Generate new local sequence number */
1305 #if defined(__DragonFly__)
1306                         sp->pp_seq[IDX_LCP] = random();
1307 #else
1308                         sp->pp_seq[IDX_LCP] ^= time.tv_sec ^ time.tv_usec;
1309 #endif
1310                         break;
1311                 }
1312                 sp->pp_loopcnt = 0;
1313                 if (! (ifp->if_flags & IFF_UP) &&
1314                     (ifp->if_flags & IFF_RUNNING)) {
1315                         if_up(ifp);
1316                         printf (SPP_FMT "up\n", SPP_ARGS(ifp));
1317                 }
1318                 break;
1319         case CISCO_ADDR_REQ:
1320                 sppp_get_ip_addrs(sp, &me, 0, &mymask);
1321                 if (me != 0L)
1322                         sppp_cisco_send(sp, CISCO_ADDR_REPLY, me, mymask);
1323                 break;
1324         }
1325 }
1326
1327 /*
1328  * Send Cisco keepalive packet.
1329  */
1330 static void
1331 sppp_cisco_send(struct sppp *sp, int type, long par1, long par2)
1332 {
1333         STDDCL;
1334         struct ppp_header *h;
1335         struct cisco_packet *ch;
1336         struct mbuf *m;
1337 #if defined(__DragonFly__)
1338         struct timeval tv;
1339 #else
1340         u_long t = (time.tv_sec - boottime.tv_sec) * 1000;
1341 #endif
1342
1343 #if defined(__DragonFly__)
1344         getmicrouptime(&tv);
1345 #endif
1346
1347         MGETHDR (m, MB_DONTWAIT, MT_DATA);
1348         if (! m)
1349                 return;
1350         m->m_pkthdr.len = m->m_len = PPP_HEADER_LEN + CISCO_PACKET_LEN;
1351         m->m_pkthdr.rcvif = 0;
1352
1353         h = mtod (m, struct ppp_header*);
1354         h->address = CISCO_MULTICAST;
1355         h->control = 0;
1356         h->protocol = htons (CISCO_KEEPALIVE);
1357
1358         ch = (struct cisco_packet*) (h + 1);
1359         ch->type = htonl (type);
1360         ch->par1 = htonl (par1);
1361         ch->par2 = htonl (par2);
1362         ch->rel = -1;
1363
1364 #if defined(__DragonFly__)
1365         ch->time0 = htons ((u_short) (tv.tv_sec >> 16));
1366         ch->time1 = htons ((u_short) tv.tv_sec);
1367 #else
1368         ch->time0 = htons ((u_short) (t >> 16));
1369         ch->time1 = htons ((u_short) t);
1370 #endif
1371
1372         if (debug)
1373                 log(LOG_DEBUG,
1374                     SPP_FMT "cisco output: <0x%lx 0x%lx 0x%lx 0x%x 0x%x-0x%x>\n",
1375                         SPP_ARGS(ifp), (u_long)ntohl (ch->type), (u_long)ch->par1,
1376                         (u_long)ch->par2, (u_int)ch->rel, (u_int)ch->time0, (u_int)ch->time1);
1377
1378         if (IF_QFULL (&sp->pp_cpq)) {
1379                 IF_DROP (&sp->pp_fastq);
1380                 IF_DROP (&ifp->if_snd);
1381                 m_freem (m);
1382         } else
1383                 IF_ENQUEUE (&sp->pp_cpq, m);
1384         if (! (ifp->if_flags & IFF_OACTIVE))
1385                 (*ifp->if_start) (ifp);
1386         ifp->if_obytes += m->m_pkthdr.len + 3;
1387 }
1388
1389 /*
1390  * PPP protocol implementation.
1391  */
1392
1393 /*
1394  * Send PPP control protocol packet.
1395  */
1396 static void
1397 sppp_cp_send(struct sppp *sp, u_short proto, u_char type,
1398              u_char ident, u_short len, void *data)
1399 {
1400         STDDCL;
1401         struct ppp_header *h;
1402         struct lcp_header *lh;
1403         struct mbuf *m;
1404
1405         if (len > MHLEN - PPP_HEADER_LEN - LCP_HEADER_LEN)
1406                 len = MHLEN - PPP_HEADER_LEN - LCP_HEADER_LEN;
1407         MGETHDR (m, MB_DONTWAIT, MT_DATA);
1408         if (! m)
1409                 return;
1410         m->m_pkthdr.len = m->m_len = PPP_HEADER_LEN + LCP_HEADER_LEN + len;
1411         m->m_pkthdr.rcvif = 0;
1412
1413         h = mtod (m, struct ppp_header*);
1414         h->address = PPP_ALLSTATIONS;        /* broadcast address */
1415         h->control = PPP_UI;                 /* Unnumbered Info */
1416         h->protocol = htons (proto);         /* Link Control Protocol */
1417
1418         lh = (struct lcp_header*) (h + 1);
1419         lh->type = type;
1420         lh->ident = ident;
1421         lh->len = htons (LCP_HEADER_LEN + len);
1422         if (len)
1423                 bcopy (data, lh+1, len);
1424
1425         if (debug) {
1426                 log(LOG_DEBUG, SPP_FMT "%s output <%s id=0x%x len=%d",
1427                     SPP_ARGS(ifp),
1428                     sppp_proto_name(proto),
1429                     sppp_cp_type_name (lh->type), lh->ident,
1430                     ntohs (lh->len));
1431                 sppp_print_bytes ((u_char*) (lh+1), len);
1432                 addlog(">\n");
1433         }
1434         if (IF_QFULL (&sp->pp_cpq)) {
1435                 IF_DROP (&sp->pp_fastq);
1436                 IF_DROP (&ifp->if_snd);
1437                 m_freem (m);
1438                 ++ifp->if_oerrors;
1439         } else
1440                 IF_ENQUEUE (&sp->pp_cpq, m);
1441         if (! (ifp->if_flags & IFF_OACTIVE))
1442                 (*ifp->if_start) (ifp);
1443         ifp->if_obytes += m->m_pkthdr.len + 3;
1444 }
1445
1446 /*
1447  * Handle incoming PPP control protocol packets.
1448  */
1449 static void
1450 sppp_cp_input(const struct cp *cp, struct sppp *sp, struct mbuf *m)
1451 {
1452         STDDCL;
1453         struct lcp_header *h;
1454         int len = m->m_pkthdr.len;
1455         int rv;
1456         u_char *p;
1457
1458         if (len < 4) {
1459                 if (debug)
1460                         log(LOG_DEBUG,
1461                             SPP_FMT "%s invalid packet length: %d bytes\n",
1462                             SPP_ARGS(ifp), cp->name, len);
1463                 return;
1464         }
1465         h = mtod (m, struct lcp_header*);
1466         if (debug) {
1467                 log(LOG_DEBUG,
1468                     SPP_FMT "%s input(%s): <%s id=0x%x len=%d",
1469                     SPP_ARGS(ifp), cp->name,
1470                     sppp_state_name(sp->state[cp->protoidx]),
1471                     sppp_cp_type_name (h->type), h->ident, ntohs (h->len));
1472                 sppp_print_bytes ((u_char*) (h+1), len-4);
1473                 addlog(">\n");
1474         }
1475         if (len > ntohs (h->len))
1476                 len = ntohs (h->len);
1477         p = (u_char *)(h + 1);
1478         switch (h->type) {
1479         case CONF_REQ:
1480                 if (len < 4) {
1481                         if (debug)
1482                                 addlog(SPP_FMT "%s invalid conf-req length %d\n",
1483                                        SPP_ARGS(ifp), cp->name,
1484                                        len);
1485                         ++ifp->if_ierrors;
1486                         break;
1487                 }
1488                 /* handle states where RCR doesn't get a SCA/SCN */
1489                 switch (sp->state[cp->protoidx]) {
1490                 case STATE_CLOSING:
1491                 case STATE_STOPPING:
1492                         return;
1493                 case STATE_CLOSED:
1494                         sppp_cp_send(sp, cp->proto, TERM_ACK, h->ident,
1495                                      0, 0);
1496                         return;
1497                 }
1498                 rv = (cp->RCR)(sp, h, len);
1499                 switch (sp->state[cp->protoidx]) {
1500                 case STATE_OPENED:
1501                         (cp->tld)(sp);
1502                         (cp->scr)(sp);
1503                         /* fall through... */
1504                 case STATE_ACK_SENT:
1505                 case STATE_REQ_SENT:
1506                         /*
1507                          * sppp_cp_change_state() have the side effect of
1508                          * restarting the timeouts. We want to avoid that
1509                          * if the state don't change, otherwise we won't
1510                          * ever timeout and resend a configuration request
1511                          * that got lost.
1512                          */
1513                         if (sp->state[cp->protoidx] == (rv ? STATE_ACK_SENT:
1514                             STATE_REQ_SENT))
1515                                 break;
1516                         sppp_cp_change_state(cp, sp, rv?
1517                                              STATE_ACK_SENT: STATE_REQ_SENT);
1518                         break;
1519                 case STATE_STOPPED:
1520                         sp->rst_counter[cp->protoidx] = sp->lcp.max_configure;
1521                         (cp->scr)(sp);
1522                         sppp_cp_change_state(cp, sp, rv?
1523                                              STATE_ACK_SENT: STATE_REQ_SENT);
1524                         break;
1525                 case STATE_ACK_RCVD:
1526                         if (rv) {
1527                                 sppp_cp_change_state(cp, sp, STATE_OPENED);
1528                                 if (debug)
1529                                         log(LOG_DEBUG, SPP_FMT "%s tlu\n",
1530                                             SPP_ARGS(ifp),
1531                                             cp->name);
1532                                 (cp->tlu)(sp);
1533                         } else
1534                                 sppp_cp_change_state(cp, sp, STATE_ACK_RCVD);
1535                         break;
1536                 default:
1537                         printf(SPP_FMT "%s illegal %s in state %s\n",
1538                                SPP_ARGS(ifp), cp->name,
1539                                sppp_cp_type_name(h->type),
1540                                sppp_state_name(sp->state[cp->protoidx]));
1541                         ++ifp->if_ierrors;
1542                 }
1543                 break;
1544         case CONF_ACK:
1545                 if (h->ident != sp->confid[cp->protoidx]) {
1546                         if (debug)
1547                                 addlog(SPP_FMT "%s id mismatch 0x%x != 0x%x\n",
1548                                        SPP_ARGS(ifp), cp->name,
1549                                        h->ident, sp->confid[cp->protoidx]);
1550                         ++ifp->if_ierrors;
1551                         break;
1552                 }
1553                 switch (sp->state[cp->protoidx]) {
1554                 case STATE_CLOSED:
1555                 case STATE_STOPPED:
1556                         sppp_cp_send(sp, cp->proto, TERM_ACK, h->ident, 0, 0);
1557                         break;
1558                 case STATE_CLOSING:
1559                 case STATE_STOPPING:
1560                         break;
1561                 case STATE_REQ_SENT:
1562                         sp->rst_counter[cp->protoidx] = sp->lcp.max_configure;
1563                         sppp_cp_change_state(cp, sp, STATE_ACK_RCVD);
1564                         break;
1565                 case STATE_OPENED:
1566                         (cp->tld)(sp);
1567                         /* fall through */
1568                 case STATE_ACK_RCVD:
1569                         (cp->scr)(sp);
1570                         sppp_cp_change_state(cp, sp, STATE_REQ_SENT);
1571                         break;
1572                 case STATE_ACK_SENT:
1573                         sp->rst_counter[cp->protoidx] = sp->lcp.max_configure;
1574                         sppp_cp_change_state(cp, sp, STATE_OPENED);
1575                         if (debug)
1576                                 log(LOG_DEBUG, SPP_FMT "%s tlu\n",
1577                                        SPP_ARGS(ifp), cp->name);
1578                         (cp->tlu)(sp);
1579                         break;
1580                 default:
1581                         printf(SPP_FMT "%s illegal %s in state %s\n",
1582                                SPP_ARGS(ifp), cp->name,
1583                                sppp_cp_type_name(h->type),
1584                                sppp_state_name(sp->state[cp->protoidx]));
1585                         ++ifp->if_ierrors;
1586                 }
1587                 break;
1588         case CONF_NAK:
1589         case CONF_REJ:
1590                 if (h->ident != sp->confid[cp->protoidx]) {
1591                         if (debug)
1592                                 addlog(SPP_FMT "%s id mismatch 0x%x != 0x%x\n",
1593                                        SPP_ARGS(ifp), cp->name,
1594                                        h->ident, sp->confid[cp->protoidx]);
1595                         ++ifp->if_ierrors;
1596                         break;
1597                 }
1598                 if (h->type == CONF_NAK)
1599                         (cp->RCN_nak)(sp, h, len);
1600                 else /* CONF_REJ */
1601                         (cp->RCN_rej)(sp, h, len);
1602
1603                 switch (sp->state[cp->protoidx]) {
1604                 case STATE_CLOSED:
1605                 case STATE_STOPPED:
1606                         sppp_cp_send(sp, cp->proto, TERM_ACK, h->ident, 0, 0);
1607                         break;
1608                 case STATE_REQ_SENT:
1609                 case STATE_ACK_SENT:
1610                         sp->rst_counter[cp->protoidx] = sp->lcp.max_configure;
1611                         /*
1612                          * Slow things down a bit if we think we might be
1613                          * in loopback. Depend on the timeout to send the
1614                          * next configuration request.
1615                          */
1616                         if (sp->pp_loopcnt)
1617                                 break;
1618                         (cp->scr)(sp);
1619                         break;
1620                 case STATE_OPENED:
1621                         (cp->tld)(sp);
1622                         /* fall through */
1623                 case STATE_ACK_RCVD:
1624                         sppp_cp_change_state(cp, sp, STATE_REQ_SENT);
1625                         (cp->scr)(sp);
1626                         break;
1627                 case STATE_CLOSING:
1628                 case STATE_STOPPING:
1629                         break;
1630                 default:
1631                         printf(SPP_FMT "%s illegal %s in state %s\n",
1632                                SPP_ARGS(ifp), cp->name,
1633                                sppp_cp_type_name(h->type),
1634                                sppp_state_name(sp->state[cp->protoidx]));
1635                         ++ifp->if_ierrors;
1636                 }
1637                 break;
1638
1639         case TERM_REQ:
1640                 switch (sp->state[cp->protoidx]) {
1641                 case STATE_ACK_RCVD:
1642                 case STATE_ACK_SENT:
1643                         sppp_cp_change_state(cp, sp, STATE_REQ_SENT);
1644                         /* fall through */
1645                 case STATE_CLOSED:
1646                 case STATE_STOPPED:
1647                 case STATE_CLOSING:
1648                 case STATE_STOPPING:
1649                 case STATE_REQ_SENT:
1650                   sta:
1651                         /* Send Terminate-Ack packet. */
1652                         if (debug)
1653                                 log(LOG_DEBUG, SPP_FMT "%s send terminate-ack\n",
1654                                     SPP_ARGS(ifp), cp->name);
1655                         sppp_cp_send(sp, cp->proto, TERM_ACK, h->ident, 0, 0);
1656                         break;
1657                 case STATE_OPENED:
1658                         (cp->tld)(sp);
1659                         sp->rst_counter[cp->protoidx] = 0;
1660                         sppp_cp_change_state(cp, sp, STATE_STOPPING);
1661                         goto sta;
1662                         break;
1663                 default:
1664                         printf(SPP_FMT "%s illegal %s in state %s\n",
1665                                SPP_ARGS(ifp), cp->name,
1666                                sppp_cp_type_name(h->type),
1667                                sppp_state_name(sp->state[cp->protoidx]));
1668                         ++ifp->if_ierrors;
1669                 }
1670                 break;
1671         case TERM_ACK:
1672                 switch (sp->state[cp->protoidx]) {
1673                 case STATE_CLOSED:
1674                 case STATE_STOPPED:
1675                 case STATE_REQ_SENT:
1676                 case STATE_ACK_SENT:
1677                         break;
1678                 case STATE_CLOSING:
1679                         sppp_cp_change_state(cp, sp, STATE_CLOSED);
1680                         (cp->tlf)(sp);
1681                         break;
1682                 case STATE_STOPPING:
1683                         sppp_cp_change_state(cp, sp, STATE_STOPPED);
1684                         (cp->tlf)(sp);
1685                         break;
1686                 case STATE_ACK_RCVD:
1687                         sppp_cp_change_state(cp, sp, STATE_REQ_SENT);
1688                         break;
1689                 case STATE_OPENED:
1690                         (cp->tld)(sp);
1691                         (cp->scr)(sp);
1692                         sppp_cp_change_state(cp, sp, STATE_ACK_RCVD);
1693                         break;
1694                 default:
1695                         printf(SPP_FMT "%s illegal %s in state %s\n",
1696                                SPP_ARGS(ifp), cp->name,
1697                                sppp_cp_type_name(h->type),
1698                                sppp_state_name(sp->state[cp->protoidx]));
1699                         ++ifp->if_ierrors;
1700                 }
1701                 break;
1702         case CODE_REJ:
1703                 /* XXX catastrophic rejects (RXJ-) aren't handled yet. */
1704                 log(LOG_INFO,
1705                     SPP_FMT "%s: ignoring RXJ (%s) for proto 0x%x, "
1706                     "danger will robinson\n",
1707                     SPP_ARGS(ifp), cp->name,
1708                     sppp_cp_type_name(h->type), ntohs(*((u_short *)p)));
1709                 switch (sp->state[cp->protoidx]) {
1710                 case STATE_CLOSED:
1711                 case STATE_STOPPED:
1712                 case STATE_REQ_SENT:
1713                 case STATE_ACK_SENT:
1714                 case STATE_CLOSING:
1715                 case STATE_STOPPING:
1716                 case STATE_OPENED:
1717                         break;
1718                 case STATE_ACK_RCVD:
1719                         sppp_cp_change_state(cp, sp, STATE_REQ_SENT);
1720                         break;
1721                 default:
1722                         printf(SPP_FMT "%s illegal %s in state %s\n",
1723                                SPP_ARGS(ifp), cp->name,
1724                                sppp_cp_type_name(h->type),
1725                                sppp_state_name(sp->state[cp->protoidx]));
1726                         ++ifp->if_ierrors;
1727                 }
1728                 break;
1729         case PROTO_REJ:
1730             {
1731                 int catastrophic;
1732                 const struct cp *upper;
1733                 int i;
1734                 u_int16_t proto;
1735
1736                 catastrophic = 0;
1737                 upper = NULL;
1738                 proto = ntohs(*((u_int16_t *)p));
1739                 for (i = 0; i < IDX_COUNT; i++) {
1740                         if (cps[i]->proto == proto) {
1741                                 upper = cps[i];
1742                                 break;
1743                         }
1744                 }
1745                 if (upper == NULL)
1746                         catastrophic++;
1747
1748                 if (catastrophic || debug)
1749                         log(catastrophic? LOG_INFO: LOG_DEBUG,
1750                             SPP_FMT "%s: RXJ%c (%s) for proto 0x%x (%s/%s)\n",
1751                             SPP_ARGS(ifp), cp->name, catastrophic ? '-' : '+',
1752                             sppp_cp_type_name(h->type), proto,
1753                             upper ? upper->name : "unknown",
1754                             upper ? sppp_state_name(sp->state[upper->protoidx]) : "?");
1755
1756                 /*
1757                  * if we got RXJ+ against conf-req, the peer does not implement
1758                  * this particular protocol type.  terminate the protocol.
1759                  */
1760                 if (upper && !catastrophic) {
1761                         if (sp->state[upper->protoidx] == STATE_REQ_SENT) {
1762                                 upper->Close(sp);
1763                                 break;
1764                         }
1765                 }
1766
1767                 /* XXX catastrophic rejects (RXJ-) aren't handled yet. */
1768                 switch (sp->state[cp->protoidx]) {
1769                 case STATE_CLOSED:
1770                 case STATE_STOPPED:
1771                 case STATE_REQ_SENT:
1772                 case STATE_ACK_SENT:
1773                 case STATE_CLOSING:
1774                 case STATE_STOPPING:
1775                 case STATE_OPENED:
1776                         break;
1777                 case STATE_ACK_RCVD:
1778                         sppp_cp_change_state(cp, sp, STATE_REQ_SENT);
1779                         break;
1780                 default:
1781                         printf(SPP_FMT "%s illegal %s in state %s\n",
1782                                SPP_ARGS(ifp), cp->name,
1783                                sppp_cp_type_name(h->type),
1784                                sppp_state_name(sp->state[cp->protoidx]));
1785                         ++ifp->if_ierrors;
1786                 }
1787                 break;
1788             }
1789         case DISC_REQ:
1790                 if (cp->proto != PPP_LCP)
1791                         goto illegal;
1792                 /* Discard the packet. */
1793                 break;
1794         case ECHO_REQ:
1795                 if (cp->proto != PPP_LCP)
1796                         goto illegal;
1797                 if (sp->state[cp->protoidx] != STATE_OPENED) {
1798                         if (debug)
1799                                 addlog(SPP_FMT "lcp echo req but lcp closed\n",
1800                                        SPP_ARGS(ifp));
1801                         ++ifp->if_ierrors;
1802                         break;
1803                 }
1804                 if (len < 8) {
1805                         if (debug)
1806                                 addlog(SPP_FMT "invalid lcp echo request "
1807                                        "packet length: %d bytes\n",
1808                                        SPP_ARGS(ifp), len);
1809                         break;
1810                 }
1811                 if ((sp->lcp.opts & (1 << LCP_OPT_MAGIC)) &&
1812                     ntohl (*(long*)(h+1)) == sp->lcp.magic) {
1813                         /* Line loopback mode detected. */
1814                         printf(SPP_FMT "loopback\n", SPP_ARGS(ifp));
1815                         sp->pp_loopcnt = MAXALIVECNT * 5;
1816                         if_down (ifp);
1817                         sppp_qflush (&sp->pp_cpq);
1818
1819                         /* Shut down the PPP link. */
1820                         /* XXX */
1821                         lcp.Down(sp);
1822                         lcp.Up(sp);
1823                         break;
1824                 }
1825                 *(long*)(h+1) = htonl (sp->lcp.magic);
1826                 if (debug)
1827                         addlog(SPP_FMT "got lcp echo req, sending echo rep\n",
1828                                SPP_ARGS(ifp));
1829                 sppp_cp_send (sp, PPP_LCP, ECHO_REPLY, h->ident, len-4, h+1);
1830                 break;
1831         case ECHO_REPLY:
1832                 if (cp->proto != PPP_LCP)
1833                         goto illegal;
1834                 if (h->ident != sp->lcp.echoid) {
1835                         ++ifp->if_ierrors;
1836                         break;
1837                 }
1838                 if (len < 8) {
1839                         if (debug)
1840                                 addlog(SPP_FMT "lcp invalid echo reply "
1841                                        "packet length: %d bytes\n",
1842                                        SPP_ARGS(ifp), len);
1843                         break;
1844                 }
1845                 if (debug)
1846                         addlog(SPP_FMT "lcp got echo rep\n",
1847                                SPP_ARGS(ifp));
1848                 if (!(sp->lcp.opts & (1 << LCP_OPT_MAGIC)) ||
1849                     ntohl (*(long*)(h+1)) != sp->lcp.magic)
1850                         sp->pp_alivecnt = 0;
1851                 break;
1852         default:
1853                 /* Unknown packet type -- send Code-Reject packet. */
1854           illegal:
1855                 if (debug)
1856                         addlog(SPP_FMT "%s send code-rej for 0x%x\n",
1857                                SPP_ARGS(ifp), cp->name, h->type);
1858                 sppp_cp_send(sp, cp->proto, CODE_REJ,
1859                              ++sp->pp_seq[cp->protoidx], m->m_pkthdr.len, h);
1860                 ++ifp->if_ierrors;
1861         }
1862 }
1863
1864
1865 /*
1866  * The generic part of all Up/Down/Open/Close/TO event handlers.
1867  * Basically, the state transition handling in the automaton.
1868  */
1869 static void
1870 sppp_up_event(const struct cp *cp, struct sppp *sp)
1871 {
1872         STDDCL;
1873
1874         if (debug)
1875                 log(LOG_DEBUG, SPP_FMT "%s up(%s)\n",
1876                     SPP_ARGS(ifp), cp->name,
1877                     sppp_state_name(sp->state[cp->protoidx]));
1878
1879         switch (sp->state[cp->protoidx]) {
1880         case STATE_INITIAL:
1881                 sppp_cp_change_state(cp, sp, STATE_CLOSED);
1882                 break;
1883         case STATE_STARTING:
1884                 sp->rst_counter[cp->protoidx] = sp->lcp.max_configure;
1885                 (cp->scr)(sp);
1886                 sppp_cp_change_state(cp, sp, STATE_REQ_SENT);
1887                 break;
1888         default:
1889                 printf(SPP_FMT "%s illegal up in state %s\n",
1890                        SPP_ARGS(ifp), cp->name,
1891                        sppp_state_name(sp->state[cp->protoidx]));
1892         }
1893 }
1894
1895 static void
1896 sppp_down_event(const struct cp *cp, struct sppp *sp)
1897 {
1898         STDDCL;
1899
1900         if (debug)
1901                 log(LOG_DEBUG, SPP_FMT "%s down(%s)\n",
1902                     SPP_ARGS(ifp), cp->name,
1903                     sppp_state_name(sp->state[cp->protoidx]));
1904
1905         switch (sp->state[cp->protoidx]) {
1906         case STATE_CLOSED:
1907         case STATE_CLOSING:
1908                 sppp_cp_change_state(cp, sp, STATE_INITIAL);
1909                 break;
1910         case STATE_STOPPED:
1911                 sppp_cp_change_state(cp, sp, STATE_STARTING);
1912                 (cp->tls)(sp);
1913                 break;
1914         case STATE_STOPPING:
1915         case STATE_REQ_SENT:
1916         case STATE_ACK_RCVD:
1917         case STATE_ACK_SENT:
1918                 sppp_cp_change_state(cp, sp, STATE_STARTING);
1919                 break;
1920         case STATE_OPENED:
1921                 (cp->tld)(sp);
1922                 sppp_cp_change_state(cp, sp, STATE_STARTING);
1923                 break;
1924         default:
1925                 printf(SPP_FMT "%s illegal down in state %s\n",
1926                        SPP_ARGS(ifp), cp->name,
1927                        sppp_state_name(sp->state[cp->protoidx]));
1928         }
1929 }
1930
1931
1932 static void
1933 sppp_open_event(const struct cp *cp, struct sppp *sp)
1934 {
1935         STDDCL;
1936
1937         if (debug)
1938                 log(LOG_DEBUG, SPP_FMT "%s open(%s)\n",
1939                     SPP_ARGS(ifp), cp->name,
1940                     sppp_state_name(sp->state[cp->protoidx]));
1941
1942         switch (sp->state[cp->protoidx]) {
1943         case STATE_INITIAL:
1944                 sppp_cp_change_state(cp, sp, STATE_STARTING);
1945                 (cp->tls)(sp);
1946                 break;
1947         case STATE_STARTING:
1948                 break;
1949         case STATE_CLOSED:
1950                 sp->rst_counter[cp->protoidx] = sp->lcp.max_configure;
1951                 (cp->scr)(sp);
1952                 sppp_cp_change_state(cp, sp, STATE_REQ_SENT);
1953                 break;
1954         case STATE_STOPPED:
1955                 /*
1956                  * Try escaping stopped state.  This seems to bite
1957                  * people occasionally, in particular for IPCP,
1958                  * presumably following previous IPCP negotiation
1959                  * aborts.  Somehow, we must have missed a Down event
1960                  * which would have caused a transition into starting
1961                  * state, so as a bandaid we force the Down event now.
1962                  * This effectively implements (something like the)
1963                  * `restart' option mentioned in the state transition
1964                  * table of RFC 1661.
1965                  */
1966                 sppp_cp_change_state(cp, sp, STATE_STARTING);
1967                 (cp->tls)(sp);
1968                 break;
1969         case STATE_STOPPING:
1970         case STATE_REQ_SENT:
1971         case STATE_ACK_RCVD:
1972         case STATE_ACK_SENT:
1973         case STATE_OPENED:
1974                 break;
1975         case STATE_CLOSING:
1976                 sppp_cp_change_state(cp, sp, STATE_STOPPING);
1977                 break;
1978         }
1979 }
1980
1981
1982 static void
1983 sppp_close_event(const struct cp *cp, struct sppp *sp)
1984 {
1985         STDDCL;
1986
1987         if (debug)
1988                 log(LOG_DEBUG, SPP_FMT "%s close(%s)\n",
1989                     SPP_ARGS(ifp), cp->name,
1990                     sppp_state_name(sp->state[cp->protoidx]));
1991
1992         switch (sp->state[cp->protoidx]) {
1993         case STATE_INITIAL:
1994         case STATE_CLOSED:
1995         case STATE_CLOSING:
1996                 break;
1997         case STATE_STARTING:
1998                 sppp_cp_change_state(cp, sp, STATE_INITIAL);
1999                 (cp->tlf)(sp);
2000                 break;
2001         case STATE_STOPPED:
2002                 sppp_cp_change_state(cp, sp, STATE_CLOSED);
2003                 break;
2004         case STATE_STOPPING:
2005                 sppp_cp_change_state(cp, sp, STATE_CLOSING);
2006                 break;
2007         case STATE_OPENED:
2008                 (cp->tld)(sp);
2009                 /* fall through */
2010         case STATE_REQ_SENT:
2011         case STATE_ACK_RCVD:
2012         case STATE_ACK_SENT:
2013                 sp->rst_counter[cp->protoidx] = sp->lcp.max_terminate;
2014                 sppp_cp_send(sp, cp->proto, TERM_REQ,
2015                              ++sp->pp_seq[cp->protoidx], 0, 0);
2016                 sppp_cp_change_state(cp, sp, STATE_CLOSING);
2017                 break;
2018         }
2019 }
2020
2021 static void
2022 sppp_to_event(const struct cp *cp, struct sppp *sp)
2023 {
2024         STDDCL;
2025         int s;
2026
2027         s = splimp();
2028         if (debug)
2029                 log(LOG_DEBUG, SPP_FMT "%s TO(%s) rst_counter = %d\n",
2030                     SPP_ARGS(ifp), cp->name,
2031                     sppp_state_name(sp->state[cp->protoidx]),
2032                     sp->rst_counter[cp->protoidx]);
2033
2034         if (--sp->rst_counter[cp->protoidx] < 0)
2035                 /* TO- event */
2036                 switch (sp->state[cp->protoidx]) {
2037                 case STATE_CLOSING:
2038                         sppp_cp_change_state(cp, sp, STATE_CLOSED);
2039                         (cp->tlf)(sp);
2040                         break;
2041                 case STATE_STOPPING:
2042                         sppp_cp_change_state(cp, sp, STATE_STOPPED);
2043                         (cp->tlf)(sp);
2044                         break;
2045                 case STATE_REQ_SENT:
2046                 case STATE_ACK_RCVD:
2047                 case STATE_ACK_SENT:
2048                         sppp_cp_change_state(cp, sp, STATE_STOPPED);
2049                         (cp->tlf)(sp);
2050                         break;
2051                 }
2052         else
2053                 /* TO+ event */
2054                 switch (sp->state[cp->protoidx]) {
2055                 case STATE_CLOSING:
2056                 case STATE_STOPPING:
2057                         sppp_cp_send(sp, cp->proto, TERM_REQ,
2058                                      ++sp->pp_seq[cp->protoidx], 0, 0);
2059                         TIMEOUT(cp->TO, (void *)sp, sp->lcp.timeout,
2060                             sp->ch[cp->protoidx]);
2061                         break;
2062                 case STATE_REQ_SENT:
2063                 case STATE_ACK_RCVD:
2064                         (cp->scr)(sp);
2065                         /* sppp_cp_change_state() will restart the timer */
2066                         sppp_cp_change_state(cp, sp, STATE_REQ_SENT);
2067                         break;
2068                 case STATE_ACK_SENT:
2069                         (cp->scr)(sp);
2070                         TIMEOUT(cp->TO, (void *)sp, sp->lcp.timeout,
2071                             sp->ch[cp->protoidx]);
2072                         break;
2073                 }
2074
2075         splx(s);
2076 }
2077
2078 /*
2079  * Change the state of a control protocol in the state automaton.
2080  * Takes care of starting/stopping the restart timer.
2081  */
2082 void
2083 sppp_cp_change_state(const struct cp *cp, struct sppp *sp, int newstate)
2084 {
2085         sp->state[cp->protoidx] = newstate;
2086
2087         UNTIMEOUT(cp->TO, (void *)sp, sp->ch[cp->protoidx]);
2088         switch (newstate) {
2089         case STATE_INITIAL:
2090         case STATE_STARTING:
2091         case STATE_CLOSED:
2092         case STATE_STOPPED:
2093         case STATE_OPENED:
2094                 break;
2095         case STATE_CLOSING:
2096         case STATE_STOPPING:
2097         case STATE_REQ_SENT:
2098         case STATE_ACK_RCVD:
2099         case STATE_ACK_SENT:
2100                 TIMEOUT(cp->TO, (void *)sp, sp->lcp.timeout,
2101                     sp->ch[cp->protoidx]);
2102                 break;
2103         }
2104 }
2105
2106 /*
2107  *--------------------------------------------------------------------------*
2108  *                                                                          *
2109  *                         The LCP implementation.                          *
2110  *                                                                          *
2111  *--------------------------------------------------------------------------*
2112  */
2113 static void
2114 sppp_lcp_init(struct sppp *sp)
2115 {
2116         sp->lcp.opts = (1 << LCP_OPT_MAGIC);
2117         sp->lcp.magic = 0;
2118         sp->state[IDX_LCP] = STATE_INITIAL;
2119         sp->fail_counter[IDX_LCP] = 0;
2120         sp->pp_seq[IDX_LCP] = 0;
2121         sp->pp_rseq[IDX_LCP] = 0;
2122         sp->lcp.protos = 0;
2123         sp->lcp.mru = sp->lcp.their_mru = PP_MTU;
2124
2125         /* Note that these values are  relevant for all control protocols */
2126         sp->lcp.timeout = 3 * hz;
2127         sp->lcp.max_terminate = 2;
2128         sp->lcp.max_configure = 10;
2129         sp->lcp.max_failure = 10;
2130 #if defined(__DragonFly__)
2131         callout_handle_init(&sp->ch[IDX_LCP]);
2132 #endif
2133 }
2134
2135 static void
2136 sppp_lcp_up(struct sppp *sp)
2137 {
2138         STDDCL;
2139
2140         sp->pp_alivecnt = 0;
2141         sp->lcp.opts = (1 << LCP_OPT_MAGIC);
2142         sp->lcp.magic = 0;
2143         sp->lcp.protos = 0;
2144         sp->lcp.mru = sp->lcp.their_mru = PP_MTU;
2145         /*
2146          * If this interface is passive or dial-on-demand, and we are
2147          * still in Initial state, it means we've got an incoming
2148          * call.  Activate the interface.
2149          */
2150         if ((ifp->if_flags & (IFF_AUTO | IFF_PASSIVE)) != 0) {
2151                 if (debug)
2152                         log(LOG_DEBUG,
2153                             SPP_FMT "Up event", SPP_ARGS(ifp));
2154                 ifp->if_flags |= IFF_RUNNING;
2155                 if (sp->state[IDX_LCP] == STATE_INITIAL) {
2156                         if (debug)
2157                                 addlog("(incoming call)\n");
2158                         sp->pp_flags |= PP_CALLIN;
2159                         lcp.Open(sp);
2160                 } else if (debug)
2161                         addlog("\n");
2162         } else if ((ifp->if_flags & (IFF_AUTO | IFF_PASSIVE)) == 0 &&
2163                    (sp->state[IDX_LCP] == STATE_INITIAL)) {
2164                 ifp->if_flags |= IFF_RUNNING;
2165                 lcp.Open(sp);
2166         }
2167
2168         sppp_up_event(&lcp, sp);
2169 }
2170
2171 static void
2172 sppp_lcp_down(struct sppp *sp)
2173 {
2174         STDDCL;
2175
2176         sppp_down_event(&lcp, sp);
2177
2178         /*
2179          * If this is neither a dial-on-demand nor a passive
2180          * interface, simulate an ``ifconfig down'' action, so the
2181          * administrator can force a redial by another ``ifconfig
2182          * up''.  XXX For leased line operation, should we immediately
2183          * try to reopen the connection here?
2184          */
2185         if ((ifp->if_flags & (IFF_AUTO | IFF_PASSIVE)) == 0) {
2186                 log(LOG_INFO,
2187                     SPP_FMT "Down event, taking interface down.\n",
2188                     SPP_ARGS(ifp));
2189                 if_down(ifp);
2190         } else {
2191                 if (debug)
2192                         log(LOG_DEBUG,
2193                             SPP_FMT "Down event (carrier loss)\n",
2194                             SPP_ARGS(ifp));
2195                 sp->pp_flags &= ~PP_CALLIN;
2196                 if (sp->state[IDX_LCP] != STATE_INITIAL)
2197                         lcp.Close(sp);
2198                 ifp->if_flags &= ~IFF_RUNNING;
2199         }
2200 }
2201
2202 static void
2203 sppp_lcp_open(struct sppp *sp)
2204 {
2205         /*
2206          * If we are authenticator, negotiate LCP_AUTH
2207          */
2208         if (sp->hisauth.proto != 0)
2209                 sp->lcp.opts |= (1 << LCP_OPT_AUTH_PROTO);
2210         else
2211                 sp->lcp.opts &= ~(1 << LCP_OPT_AUTH_PROTO);
2212         sp->pp_flags &= ~PP_NEEDAUTH;
2213         sppp_open_event(&lcp, sp);
2214 }
2215
2216 static void
2217 sppp_lcp_close(struct sppp *sp)
2218 {
2219         sppp_close_event(&lcp, sp);
2220 }
2221
2222 static void
2223 sppp_lcp_TO(void *cookie)
2224 {
2225         sppp_to_event(&lcp, (struct sppp *)cookie);
2226 }
2227
2228 /*
2229  * Analyze a configure request.  Return true if it was agreeable, and
2230  * caused action sca, false if it has been rejected or nak'ed, and
2231  * caused action scn.  (The return value is used to make the state
2232  * transition decision in the state automaton.)
2233  */
2234 static int
2235 sppp_lcp_RCR(struct sppp *sp, struct lcp_header *h, int len)
2236 {
2237         STDDCL;
2238         u_char *buf, *r, *p;
2239         int origlen, rlen;
2240         u_long nmagic;
2241         u_short authproto;
2242
2243         len -= 4;
2244         origlen = len;
2245         buf = r = malloc (len, M_TEMP, M_INTWAIT);
2246
2247         if (debug)
2248                 log(LOG_DEBUG, SPP_FMT "lcp parse opts: ",
2249                     SPP_ARGS(ifp));
2250
2251         /* pass 1: check for things that need to be rejected */
2252         p = (void*) (h+1);
2253         for (rlen=0; len>1 && p[1]; len-=p[1], p+=p[1]) {
2254                 if (debug)
2255                         addlog(" %s ", sppp_lcp_opt_name(*p));
2256                 switch (*p) {
2257                 case LCP_OPT_MAGIC:
2258                         /* Magic number. */
2259                         if (len >= 6 && p[1] == 6)
2260                                 continue;
2261                         if (debug)
2262                                 addlog("[invalid] ");
2263                         break;
2264                 case LCP_OPT_ASYNC_MAP:
2265                         /* Async control character map. */
2266                         if (len >= 6 && p[1] == 6)
2267                                 continue;
2268                         if (debug)
2269                                 addlog("[invalid] ");
2270                         break;
2271                 case LCP_OPT_MRU:
2272                         /* Maximum receive unit. */
2273                         if (len >= 4 && p[1] == 4)
2274                                 continue;
2275                         if (debug)
2276                                 addlog("[invalid] ");
2277                         break;
2278                 case LCP_OPT_AUTH_PROTO:
2279                         if (len < 4) {
2280                                 if (debug)
2281                                         addlog("[invalid] ");
2282                                 break;
2283                         }
2284                         authproto = (p[2] << 8) + p[3];
2285                         if (authproto == PPP_CHAP && p[1] != 5) {
2286                                 if (debug)
2287                                         addlog("[invalid chap len] ");
2288                                 break;
2289                         }
2290                         if (sp->myauth.proto == 0) {
2291                                 /* we are not configured to do auth */
2292                                 if (debug)
2293                                         addlog("[not configured] ");
2294                                 break;
2295                         }
2296                         /*
2297                          * Remote want us to authenticate, remember this,
2298                          * so we stay in PHASE_AUTHENTICATE after LCP got
2299                          * up.
2300                          */
2301                         sp->pp_flags |= PP_NEEDAUTH;
2302                         continue;
2303                 default:
2304                         /* Others not supported. */
2305                         if (debug)
2306                                 addlog("[rej] ");
2307                         break;
2308                 }
2309                 /* Add the option to rejected list. */
2310                 bcopy (p, r, p[1]);
2311                 r += p[1];
2312                 rlen += p[1];
2313         }
2314         if (rlen) {
2315                 if (debug)
2316                         addlog(" send conf-rej\n");
2317                 sppp_cp_send (sp, PPP_LCP, CONF_REJ, h->ident, rlen, buf);
2318                 return 0;
2319         } else if (debug)
2320                 addlog("\n");
2321
2322         /*
2323          * pass 2: check for option values that are unacceptable and
2324          * thus require to be nak'ed.
2325          */
2326         if (debug)
2327                 log(LOG_DEBUG, SPP_FMT "lcp parse opt values: ",
2328                     SPP_ARGS(ifp));
2329
2330         p = (void*) (h+1);
2331         len = origlen;
2332         for (rlen=0; len>1 && p[1]; len-=p[1], p+=p[1]) {
2333                 if (debug)
2334                         addlog(" %s ", sppp_lcp_opt_name(*p));
2335                 switch (*p) {
2336                 case LCP_OPT_MAGIC:
2337                         /* Magic number -- extract. */
2338                         nmagic = (u_long)p[2] << 24 |
2339                                 (u_long)p[3] << 16 | p[4] << 8 | p[5];
2340                         if (nmagic != sp->lcp.magic) {
2341                                 sp->pp_loopcnt = 0;
2342                                 if (debug)
2343                                         addlog("0x%lx ", nmagic);
2344                                 continue;
2345                         }
2346                         if (debug && sp->pp_loopcnt < MAXALIVECNT*5)
2347                                 addlog("[glitch] ");
2348                         ++sp->pp_loopcnt;
2349                         /*
2350                          * We negate our magic here, and NAK it.  If
2351                          * we see it later in an NAK packet, we
2352                          * suggest a new one.
2353                          */
2354                         nmagic = ~sp->lcp.magic;
2355                         /* Gonna NAK it. */
2356                         p[2] = nmagic >> 24;
2357                         p[3] = nmagic >> 16;
2358                         p[4] = nmagic >> 8;
2359                         p[5] = nmagic;
2360                         break;
2361
2362                 case LCP_OPT_ASYNC_MAP:
2363                         /*
2364                          * Async control character map -- just ignore it.
2365                          *
2366                          * Quote from RFC 1662, chapter 6:
2367                          * To enable this functionality, synchronous PPP
2368                          * implementations MUST always respond to the
2369                          * Async-Control-Character-Map Configuration
2370                          * Option with the LCP Configure-Ack.  However,
2371                          * acceptance of the Configuration Option does
2372                          * not imply that the synchronous implementation
2373                          * will do any ACCM mapping.  Instead, all such
2374                          * octet mapping will be performed by the
2375                          * asynchronous-to-synchronous converter.
2376                          */
2377                         continue;
2378
2379                 case LCP_OPT_MRU:
2380                         /*
2381                          * Maximum receive unit.  Always agreeable,
2382                          * but ignored by now.
2383                          */
2384                         sp->lcp.their_mru = p[2] * 256 + p[3];
2385                         if (debug)
2386                                 addlog("%lu ", sp->lcp.their_mru);
2387                         continue;
2388
2389                 case LCP_OPT_AUTH_PROTO:
2390                         authproto = (p[2] << 8) + p[3];
2391                         if (sp->myauth.proto != authproto) {
2392                                 /* not agreed, nak */
2393                                 if (debug)
2394                                         addlog("[mine %s != his %s] ",
2395                                                sppp_proto_name(sp->hisauth.proto),
2396                                                sppp_proto_name(authproto));
2397                                 p[2] = sp->myauth.proto >> 8;
2398                                 p[3] = sp->myauth.proto;
2399                                 break;
2400                         }
2401                         if (authproto == PPP_CHAP && p[4] != CHAP_MD5) {
2402                                 if (debug)
2403                                         addlog("[chap not MD5] ");
2404                                 p[4] = CHAP_MD5;
2405                                 break;
2406                         }
2407                         continue;
2408                 }
2409                 /* Add the option to nak'ed list. */
2410                 bcopy (p, r, p[1]);
2411                 r += p[1];
2412                 rlen += p[1];
2413         }
2414         if (rlen) {
2415                 /*
2416                  * Local and remote magics equal -- loopback?
2417                  */
2418                 if (sp->pp_loopcnt >= MAXALIVECNT*5) {
2419                         if (sp->pp_loopcnt == MAXALIVECNT*5)
2420                                 printf (SPP_FMT "loopback\n",
2421                                         SPP_ARGS(ifp));
2422                         if (ifp->if_flags & IFF_UP) {
2423                                 if_down(ifp);
2424                                 sppp_qflush(&sp->pp_cpq);
2425                                 /* XXX ? */
2426                                 lcp.Down(sp);
2427                                 lcp.Up(sp);
2428                         }
2429                 } else if (++sp->fail_counter[IDX_LCP] >= sp->lcp.max_failure) {
2430                         if (debug)
2431                                 addlog(" max_failure (%d) exceeded, "
2432                                        "send conf-rej\n",
2433                                        sp->lcp.max_failure);
2434                         sppp_cp_send(sp, PPP_LCP, CONF_REJ, h->ident, rlen, buf);
2435                 } else {
2436                         if (debug)
2437                                 addlog(" send conf-nak\n");
2438                         sppp_cp_send (sp, PPP_LCP, CONF_NAK, h->ident, rlen, buf);
2439                 }
2440         } else {
2441                 if (debug)
2442                         addlog(" send conf-ack\n");
2443                 sp->fail_counter[IDX_LCP] = 0;
2444                 sp->pp_loopcnt = 0;
2445                 sppp_cp_send (sp, PPP_LCP, CONF_ACK,
2446                               h->ident, origlen, h+1);
2447         }
2448
2449         free (buf, M_TEMP);
2450         return (rlen == 0);
2451 }
2452
2453 /*
2454  * Analyze the LCP Configure-Reject option list, and adjust our
2455  * negotiation.
2456  */
2457 static void
2458 sppp_lcp_RCN_rej(struct sppp *sp, struct lcp_header *h, int len)
2459 {
2460         STDDCL;
2461         u_char *buf, *p;
2462
2463         len -= 4;
2464         buf = malloc (len, M_TEMP, M_INTWAIT);
2465
2466         if (debug)
2467                 log(LOG_DEBUG, SPP_FMT "lcp rej opts: ",
2468                     SPP_ARGS(ifp));
2469
2470         p = (void*) (h+1);
2471         for (; len > 1 && p[1]; len -= p[1], p += p[1]) {
2472                 if (debug)
2473                         addlog(" %s ", sppp_lcp_opt_name(*p));
2474                 switch (*p) {
2475                 case LCP_OPT_MAGIC:
2476                         /* Magic number -- can't use it, use 0 */
2477                         sp->lcp.opts &= ~(1 << LCP_OPT_MAGIC);
2478                         sp->lcp.magic = 0;
2479                         break;
2480                 case LCP_OPT_MRU:
2481                         /*
2482                          * Should not be rejected anyway, since we only
2483                          * negotiate a MRU if explicitly requested by
2484                          * peer.
2485                          */
2486                         sp->lcp.opts &= ~(1 << LCP_OPT_MRU);
2487                         break;
2488                 case LCP_OPT_AUTH_PROTO:
2489                         /*
2490                          * Peer doesn't want to authenticate himself,
2491                          * deny unless this is a dialout call, and
2492                          * AUTHFLAG_NOCALLOUT is set.
2493                          */
2494                         if ((sp->pp_flags & PP_CALLIN) == 0 &&
2495                             (sp->hisauth.flags & AUTHFLAG_NOCALLOUT) != 0) {
2496                                 if (debug)
2497                                         addlog("[don't insist on auth "
2498                                                "for callout]");
2499                                 sp->lcp.opts &= ~(1 << LCP_OPT_AUTH_PROTO);
2500                                 break;
2501                         }
2502                         if (debug)
2503                                 addlog("[access denied]\n");
2504                         lcp.Close(sp);
2505                         break;
2506                 }
2507         }
2508         if (debug)
2509                 addlog("\n");
2510         free (buf, M_TEMP);
2511         return;
2512 }
2513
2514 /*
2515  * Analyze the LCP Configure-NAK option list, and adjust our
2516  * negotiation.
2517  */
2518 static void
2519 sppp_lcp_RCN_nak(struct sppp *sp, struct lcp_header *h, int len)
2520 {
2521         STDDCL;
2522         u_char *buf, *p;
2523         u_long magic;
2524
2525         len -= 4;
2526         buf = malloc (len, M_TEMP, M_INTWAIT);
2527
2528         if (debug)
2529                 log(LOG_DEBUG, SPP_FMT "lcp nak opts: ",
2530                     SPP_ARGS(ifp));
2531
2532         p = (void*) (h+1);
2533         for (; len > 1 && p[1]; len -= p[1], p += p[1]) {
2534                 if (debug)
2535                         addlog(" %s ", sppp_lcp_opt_name(*p));
2536                 switch (*p) {
2537                 case LCP_OPT_MAGIC:
2538                         /* Magic number -- renegotiate */
2539                         if ((sp->lcp.opts & (1 << LCP_OPT_MAGIC)) &&
2540                             len >= 6 && p[1] == 6) {
2541                                 magic = (u_long)p[2] << 24 |
2542                                         (u_long)p[3] << 16 | p[4] << 8 | p[5];
2543                                 /*
2544                                  * If the remote magic is our negated one,
2545                                  * this looks like a loopback problem.
2546                                  * Suggest a new magic to make sure.
2547                                  */
2548                                 if (magic == ~sp->lcp.magic) {
2549                                         if (debug)
2550                                                 addlog("magic glitch ");
2551 #if defined(__DragonFly__)
2552                                         sp->lcp.magic = random();
2553 #else
2554                                         sp->lcp.magic = time.tv_sec + time.tv_usec;
2555 #endif
2556                                 } else {
2557                                         sp->lcp.magic = magic;
2558                                         if (debug)
2559                                                 addlog("%lu ", magic);
2560                                 }
2561                         }
2562                         break;
2563                 case LCP_OPT_MRU:
2564                         /*
2565                          * Peer wants to advise us to negotiate an MRU.
2566                          * Agree on it if it's reasonable, or use
2567                          * default otherwise.
2568                          */
2569                         if (len >= 4 && p[1] == 4) {
2570                                 u_int mru = p[2] * 256 + p[3];
2571                                 if (debug)
2572                                         addlog("%d ", mru);
2573                                 if (mru < PP_MTU || mru > PP_MAX_MRU)
2574                                         mru = PP_MTU;
2575                                 sp->lcp.mru = mru;
2576                                 sp->lcp.opts |= (1 << LCP_OPT_MRU);
2577                         }
2578                         break;
2579                 case LCP_OPT_AUTH_PROTO:
2580                         /*
2581                          * Peer doesn't like our authentication method,
2582                          * deny.
2583                          */
2584                         if (debug)
2585                                 addlog("[access denied]\n");
2586                         lcp.Close(sp);
2587                         break;
2588                 }
2589         }
2590         if (debug)
2591                 addlog("\n");
2592         free (buf, M_TEMP);
2593         return;
2594 }
2595
2596 static void
2597 sppp_lcp_tlu(struct sppp *sp)
2598 {
2599         STDDCL;
2600         int i;
2601         u_long mask;
2602
2603         /* XXX ? */
2604         if (! (ifp->if_flags & IFF_UP) &&
2605             (ifp->if_flags & IFF_RUNNING)) {
2606                 /* Coming out of loopback mode. */
2607                 if_up(ifp);
2608                 printf (SPP_FMT "up\n", SPP_ARGS(ifp));
2609         }
2610
2611         for (i = 0; i < IDX_COUNT; i++)
2612                 if ((cps[i])->flags & CP_QUAL)
2613                         (cps[i])->Open(sp);
2614
2615         if ((sp->lcp.opts & (1 << LCP_OPT_AUTH_PROTO)) != 0 ||
2616             (sp->pp_flags & PP_NEEDAUTH) != 0)
2617                 sp->pp_phase = PHASE_AUTHENTICATE;
2618         else
2619                 sp->pp_phase = PHASE_NETWORK;
2620
2621         if (debug)
2622                 log(LOG_DEBUG, SPP_FMT "phase %s\n", SPP_ARGS(ifp),
2623                     sppp_phase_name(sp->pp_phase));
2624
2625         /*
2626          * Open all authentication protocols.  This is even required
2627          * if we already proceeded to network phase, since it might be
2628          * that remote wants us to authenticate, so we might have to
2629          * send a PAP request.  Undesired authentication protocols
2630          * don't do anything when they get an Open event.
2631          */
2632         for (i = 0; i < IDX_COUNT; i++)
2633                 if ((cps[i])->flags & CP_AUTH)
2634                         (cps[i])->Open(sp);
2635
2636         if (sp->pp_phase == PHASE_NETWORK) {
2637                 /* Notify all NCPs. */
2638                 for (i = 0; i < IDX_COUNT; i++)
2639                         if (((cps[i])->flags & CP_NCP) &&
2640                             /*
2641                              * XXX
2642                              * Hack to administratively disable IPv6 if
2643                              * not desired.  Perhaps we should have another
2644                              * flag for this, but right now, we can make
2645                              * all struct cp's read/only.
2646                              */
2647                             (cps[i] != &ipv6cp ||
2648                              (sp->confflags & CONF_ENABLE_IPV6)))
2649                                 (cps[i])->Open(sp);
2650         }
2651
2652         /* Send Up events to all started protos. */
2653         for (i = 0, mask = 1; i < IDX_COUNT; i++, mask <<= 1)
2654                 if ((sp->lcp.protos & mask) && ((cps[i])->flags & CP_LCP) == 0)
2655                         (cps[i])->Up(sp);
2656
2657         /* notify low-level driver of state change */
2658         if (sp->pp_chg)
2659                 sp->pp_chg(sp, (int)sp->pp_phase);
2660
2661         if (sp->pp_phase == PHASE_NETWORK)
2662                 /* if no NCP is starting, close down */
2663                 sppp_lcp_check_and_close(sp);
2664 }
2665
2666 static void
2667 sppp_lcp_tld(struct sppp *sp)
2668 {
2669         STDDCL;
2670         int i;
2671         u_long mask;
2672
2673         sp->pp_phase = PHASE_TERMINATE;
2674
2675         if (debug)
2676                 log(LOG_DEBUG, SPP_FMT "phase %s\n", SPP_ARGS(ifp),
2677                     sppp_phase_name(sp->pp_phase));
2678
2679         /*
2680          * Take upper layers down.  We send the Down event first and
2681          * the Close second to prevent the upper layers from sending
2682          * ``a flurry of terminate-request packets'', as the RFC
2683          * describes it.
2684          */
2685         for (i = 0, mask = 1; i < IDX_COUNT; i++, mask <<= 1)
2686                 if ((sp->lcp.protos & mask) && ((cps[i])->flags & CP_LCP) == 0) {
2687                         (cps[i])->Down(sp);
2688                         (cps[i])->Close(sp);
2689                 }
2690 }
2691
2692 static void
2693 sppp_lcp_tls(struct sppp *sp)
2694 {
2695         STDDCL;
2696
2697         sp->pp_phase = PHASE_ESTABLISH;
2698
2699         if (debug)
2700                 log(LOG_DEBUG, SPP_FMT "phase %s\n", SPP_ARGS(ifp),
2701                     sppp_phase_name(sp->pp_phase));
2702
2703         /* Notify lower layer if desired. */
2704         if (sp->pp_tls)
2705                 (sp->pp_tls)(sp);
2706         else
2707                 (sp->pp_up)(sp);
2708 }
2709
2710 static void
2711 sppp_lcp_tlf(struct sppp *sp)
2712 {
2713         STDDCL;
2714
2715         sp->pp_phase = PHASE_DEAD;
2716         if (debug)
2717                 log(LOG_DEBUG, SPP_FMT "phase %s\n", SPP_ARGS(ifp),
2718                     sppp_phase_name(sp->pp_phase));
2719
2720         /* Notify lower layer if desired. */
2721         if (sp->pp_tlf)
2722                 (sp->pp_tlf)(sp);
2723         else
2724                 (sp->pp_down)(sp);
2725 }
2726
2727 static void
2728 sppp_lcp_scr(struct sppp *sp)
2729 {
2730         char opt[6 /* magicnum */ + 4 /* mru */ + 5 /* chap */];
2731         int i = 0;
2732         u_short authproto;
2733
2734         if (sp->lcp.opts & (1 << LCP_OPT_MAGIC)) {
2735                 if (! sp->lcp.magic)
2736 #if defined(__DragonFly__)
2737                         sp->lcp.magic = random();
2738 #else
2739                         sp->lcp.magic = time.tv_sec + time.tv_usec;
2740 #endif
2741                 opt[i++] = LCP_OPT_MAGIC;
2742                 opt[i++] = 6;
2743                 opt[i++] = sp->lcp.magic >> 24;
2744                 opt[i++] = sp->lcp.magic >> 16;
2745                 opt[i++] = sp->lcp.magic >> 8;
2746                 opt[i++] = sp->lcp.magic;
2747         }
2748
2749         if (sp->lcp.opts & (1 << LCP_OPT_MRU)) {
2750                 opt[i++] = LCP_OPT_MRU;
2751                 opt[i++] = 4;
2752                 opt[i++] = sp->lcp.mru >> 8;
2753                 opt[i++] = sp->lcp.mru;
2754         }
2755
2756         if (sp->lcp.opts & (1 << LCP_OPT_AUTH_PROTO)) {
2757                 authproto = sp->hisauth.proto;
2758                 opt[i++] = LCP_OPT_AUTH_PROTO;
2759                 opt[i++] = authproto == PPP_CHAP? 5: 4;
2760                 opt[i++] = authproto >> 8;
2761                 opt[i++] = authproto;
2762                 if (authproto == PPP_CHAP)
2763                         opt[i++] = CHAP_MD5;
2764         }
2765
2766         sp->confid[IDX_LCP] = ++sp->pp_seq[IDX_LCP];
2767         sppp_cp_send (sp, PPP_LCP, CONF_REQ, sp->confid[IDX_LCP], i, &opt);
2768 }
2769
2770 /*
2771  * Check the open NCPs, return true if at least one NCP is open.
2772  */
2773 static int
2774 sppp_ncp_check(struct sppp *sp)
2775 {
2776         int i, mask;
2777
2778         for (i = 0, mask = 1; i < IDX_COUNT; i++, mask <<= 1)
2779                 if ((sp->lcp.protos & mask) && (cps[i])->flags & CP_NCP)
2780                         return 1;
2781         return 0;
2782 }
2783
2784 /*
2785  * Re-check the open NCPs and see if we should terminate the link.
2786  * Called by the NCPs during their tlf action handling.
2787  */
2788 static void
2789 sppp_lcp_check_and_close(struct sppp *sp)
2790 {
2791
2792         if (sp->pp_phase < PHASE_NETWORK)
2793                 /* don't bother, we are already going down */
2794                 return;
2795
2796         if (sppp_ncp_check(sp))
2797                 return;
2798
2799         lcp.Close(sp);
2800 }
2801
2802 /*
2803  *--------------------------------------------------------------------------*
2804  *                                                                          *
2805  *                        The IPCP implementation.                          *
2806  *                                                                          *
2807  *--------------------------------------------------------------------------*
2808  */
2809
2810 static void
2811 sppp_ipcp_init(struct sppp *sp)
2812 {
2813         sp->ipcp.opts = 0;
2814         sp->ipcp.flags = 0;
2815         sp->state[IDX_IPCP] = STATE_INITIAL;
2816         sp->fail_counter[IDX_IPCP] = 0;
2817         sp->pp_seq[IDX_IPCP] = 0;
2818         sp->pp_rseq[IDX_IPCP] = 0;
2819 #if defined(__DragonFly__)
2820         callout_handle_init(&sp->ch[IDX_IPCP]);
2821 #endif
2822 }
2823
2824 static void
2825 sppp_ipcp_up(struct sppp *sp)
2826 {
2827         sppp_up_event(&ipcp, sp);
2828 }
2829
2830 static void
2831 sppp_ipcp_down(struct sppp *sp)
2832 {
2833         sppp_down_event(&ipcp, sp);
2834 }
2835
2836 static void
2837 sppp_ipcp_open(struct sppp *sp)
2838 {
2839         STDDCL;
2840         u_long myaddr, hisaddr;
2841
2842         sp->ipcp.flags &= ~(IPCP_HISADDR_SEEN | IPCP_MYADDR_SEEN |
2843                             IPCP_MYADDR_DYN | IPCP_VJ);
2844         sp->ipcp.opts = 0;
2845
2846         sppp_get_ip_addrs(sp, &myaddr, &hisaddr, 0);
2847         /*
2848          * If we don't have his address, this probably means our
2849          * interface doesn't want to talk IP at all.  (This could
2850          * be the case if somebody wants to speak only IPX, for
2851          * example.)  Don't open IPCP in this case.
2852          */
2853         if (hisaddr == 0L) {
2854                 /* XXX this message should go away */
2855                 if (debug)
2856                         log(LOG_DEBUG, SPP_FMT "ipcp_open(): no IP interface\n",
2857                             SPP_ARGS(ifp));
2858                 return;
2859         }
2860         if (myaddr == 0L) {
2861                 /*
2862                  * I don't have an assigned address, so i need to
2863                  * negotiate my address.
2864                  */
2865                 sp->ipcp.flags |= IPCP_MYADDR_DYN;
2866                 sp->ipcp.opts |= (1 << IPCP_OPT_ADDRESS);
2867         } else
2868                 sp->ipcp.flags |= IPCP_MYADDR_SEEN;
2869         if (sp->confflags & CONF_ENABLE_VJ) {
2870                 sp->ipcp.opts |= (1 << IPCP_OPT_COMPRESSION);
2871                 sp->ipcp.max_state = MAX_STATES - 1;
2872                 sp->ipcp.compress_cid = 1;
2873         }
2874         sppp_open_event(&ipcp, sp);
2875 }
2876
2877 static void
2878 sppp_ipcp_close(struct sppp *sp)
2879 {
2880         sppp_close_event(&ipcp, sp);
2881         if (sp->ipcp.flags & IPCP_MYADDR_DYN)
2882                 /*
2883                  * My address was dynamic, clear it again.
2884                  */
2885                 sppp_set_ip_addr(sp, 0L);
2886 }
2887
2888 static void
2889 sppp_ipcp_TO(void *cookie)
2890 {
2891         sppp_to_event(&ipcp, (struct sppp *)cookie);
2892 }
2893
2894 /*
2895  * Analyze a configure request.  Return true if it was agreeable, and
2896  * caused action sca, false if it has been rejected or nak'ed, and
2897  * caused action scn.  (The return value is used to make the state
2898  * transition decision in the state automaton.)
2899  */
2900 static int
2901 sppp_ipcp_RCR(struct sppp *sp, struct lcp_header *h, int len)
2902 {
2903         u_char *buf, *r, *p;
2904         struct ifnet *ifp = &sp->pp_if;
2905         int rlen, origlen, debug = ifp->if_flags & IFF_DEBUG;
2906         u_long hisaddr, desiredaddr;
2907         int gotmyaddr = 0;
2908         int desiredcomp;
2909
2910         len -= 4;
2911         origlen = len;
2912         /*
2913          * Make sure to allocate a buf that can at least hold a
2914          * conf-nak with an `address' option.  We might need it below.
2915          */
2916         buf = r = malloc ((len < 6? 6: len), M_TEMP, M_INTWAIT);
2917
2918         /* pass 1: see if we can recognize them */
2919         if (debug)
2920                 log(LOG_DEBUG, SPP_FMT "ipcp parse opts: ",
2921                     SPP_ARGS(ifp));
2922         p = (void*) (h+1);
2923         for (rlen=0; len>1 && p[1]; len-=p[1], p+=p[1]) {
2924                 if (debug)
2925                         addlog(" %s ", sppp_ipcp_opt_name(*p));
2926                 switch (*p) {
2927                 case IPCP_OPT_COMPRESSION:
2928                         if (!(sp->confflags & CONF_ENABLE_VJ)) {
2929                                 /* VJ compression administratively disabled */
2930                                 if (debug)
2931                                         addlog("[locally disabled] ");
2932                                 break;
2933                         }
2934                         /*
2935                          * In theory, we should only conf-rej an
2936                          * option that is shorter than RFC 1618
2937                          * requires (i.e. < 4), and should conf-nak
2938                          * anything else that is not VJ.  However,
2939                          * since our algorithm always uses the
2940                          * original option to NAK it with new values,
2941                          * things would become more complicated.  In
2942                          * pratice, the only commonly implemented IP
2943                          * compression option is VJ anyway, so the
2944                          * difference is negligible.
2945                          */
2946                         if (len >= 6 && p[1] == 6) {
2947                                 /*
2948                                  * correctly formed compression option
2949                                  * that could be VJ compression
2950                                  */
2951                                 continue;
2952                         }
2953                         if (debug)
2954                                 addlog("optlen %d [invalid/unsupported] ",
2955                                     p[1]);
2956                         break;
2957                 case IPCP_OPT_ADDRESS:
2958                         if (len >= 6 && p[1] == 6) {
2959                                 /* correctly formed address option */
2960                                 continue;
2961                         }
2962                         if (debug)
2963                                 addlog("[invalid] ");
2964                         break;
2965                 default:
2966                         /* Others not supported. */
2967                         if (debug)
2968                                 addlog("[rej] ");
2969                         break;
2970                 }
2971                 /* Add the option to rejected list. */
2972                 bcopy (p, r, p[1]);
2973                 r += p[1];
2974                 rlen += p[1];
2975         }
2976         if (rlen) {
2977                 if (debug)
2978                         addlog(" send conf-rej\n");
2979                 sppp_cp_send (sp, PPP_IPCP, CONF_REJ, h->ident, rlen, buf);
2980                 return 0;
2981         } else if (debug)
2982                 addlog("\n");
2983
2984         /* pass 2: parse option values */
2985         sppp_get_ip_addrs(sp, 0, &hisaddr, 0);
2986         if (debug)
2987                 log(LOG_DEBUG, SPP_FMT "ipcp parse opt values: ",
2988                        SPP_ARGS(ifp));
2989         p = (void*) (h+1);
2990         len = origlen;
2991         for (rlen=0; len>1 && p[1]; len-=p[1], p+=p[1]) {
2992                 if (debug)
2993                         addlog(" %s ", sppp_ipcp_opt_name(*p));
2994                 switch (*p) {
2995                 case IPCP_OPT_COMPRESSION:
2996                         desiredcomp = p[2] << 8 | p[3];
2997                         /* We only support VJ */
2998                         if (desiredcomp == IPCP_COMP_VJ) {
2999                                 if (debug)
3000                                         addlog("VJ [ack] ");
3001                                 sp->ipcp.flags |= IPCP_VJ;
3002                                 sl_compress_init(sp->pp_comp, p[4]);
3003                                 sp->ipcp.max_state = p[4];
3004                                 sp->ipcp.compress_cid = p[5];
3005                                 continue;
3006                         }
3007                         if (debug)
3008                                 addlog("compproto %#04x [not supported] ",
3009                                     desiredcomp);
3010                         p[2] = IPCP_COMP_VJ >> 8;
3011                         p[3] = IPCP_COMP_VJ;
3012                         p[4] = sp->ipcp.max_state;
3013                         p[5] = sp->ipcp.compress_cid;
3014                         break;
3015                 case IPCP_OPT_ADDRESS:
3016                         /* This is the address he wants in his end */
3017                         desiredaddr = p[2] << 24 | p[3] << 16 |
3018                                 p[4] << 8 | p[5];
3019                         if (desiredaddr == hisaddr ||
3020                             (hisaddr >= 1 && hisaddr <= 254 && desiredaddr != 0)) {
3021                                 /*
3022                                  * Peer's address is same as our value,
3023                                  * or we have set it to 0.0.0.* to
3024                                  * indicate that we do not really care,
3025                                  * this is agreeable.  Gonna conf-ack
3026                                  * it.
3027                                  */
3028                                 if (debug)
3029                                         addlog("%s [ack] ",
3030                                                 sppp_dotted_quad(hisaddr));
3031                                 /* record that we've seen it already */
3032                                 sp->ipcp.flags |= IPCP_HISADDR_SEEN;
3033                                 continue;
3034                         }
3035                         /*
3036                          * The address wasn't agreeable.  This is either
3037                          * he sent us 0.0.0.0, asking to assign him an
3038                          * address, or he send us another address not
3039                          * matching our value.  Either case, we gonna
3040                          * conf-nak it with our value.
3041                          * XXX: we should "rej" if hisaddr == 0
3042                          */
3043                         if (debug) {
3044                                 if (desiredaddr == 0)
3045                                         addlog("[addr requested] ");
3046                                 else
3047                                         addlog("%s [not agreed] ",
3048                                                 sppp_dotted_quad(desiredaddr));
3049
3050                         }
3051                         p[2] = hisaddr >> 24;
3052                         p[3] = hisaddr >> 16;
3053                         p[4] = hisaddr >> 8;
3054                         p[5] = hisaddr;
3055                         break;
3056                 }
3057                 /* Add the option to nak'ed list. */
3058                 bcopy (p, r, p[1]);
3059                 r += p[1];
3060                 rlen += p[1];
3061         }
3062
3063         /*
3064          * If we are about to conf-ack the request, but haven't seen
3065          * his address so far, gonna conf-nak it instead, with the
3066          * `address' option present and our idea of his address being
3067          * filled in there, to request negotiation of both addresses.
3068          *
3069          * XXX This can result in an endless req - nak loop if peer
3070          * doesn't want to send us his address.  Q: What should we do
3071          * about it?  XXX  A: implement the max-failure counter.
3072          */
3073         if (rlen == 0 && !(sp->ipcp.flags & IPCP_HISADDR_SEEN) && !gotmyaddr) {
3074                 buf[0] = IPCP_OPT_ADDRESS;
3075                 buf[1] = 6;
3076                 buf[2] = hisaddr >> 24;
3077                 buf[3] = hisaddr >> 16;
3078                 buf[4] = hisaddr >> 8;
3079                 buf[5] = hisaddr;
3080                 rlen = 6;
3081                 if (debug)
3082                         addlog("still need hisaddr ");
3083         }
3084
3085         if (rlen) {
3086                 if (debug)
3087                         addlog(" send conf-nak\n");
3088                 sppp_cp_send (sp, PPP_IPCP, CONF_NAK, h->ident, rlen, buf);
3089         } else {
3090                 if (debug)
3091                         addlog(" send conf-ack\n");
3092                 sppp_cp_send (sp, PPP_IPCP, CONF_ACK,
3093                               h->ident, origlen, h+1);
3094         }
3095
3096         free (buf, M_TEMP);
3097         return (rlen == 0);
3098 }
3099
3100 /*
3101  * Analyze the IPCP Configure-Reject option list, and adjust our
3102  * negotiation.
3103  */
3104 static void
3105 sppp_ipcp_RCN_rej(struct sppp *sp, struct lcp_header *h, int len)
3106 {
3107         u_char *buf, *p;
3108         struct ifnet *ifp = &sp->pp_if;
3109         int debug = ifp->if_flags & IFF_DEBUG;
3110
3111         len -= 4;
3112         buf = malloc (len, M_TEMP, M_INTWAIT);
3113
3114         if (debug)
3115                 log(LOG_DEBUG, SPP_FMT "ipcp rej opts: ",
3116                     SPP_ARGS(ifp));
3117
3118         p = (void*) (h+1);
3119         for (; len > 1 && p[1]; len -= p[1], p += p[1]) {
3120                 if (debug)
3121                         addlog(" %s ", sppp_ipcp_opt_name(*p));
3122                 switch (*p) {
3123                 case IPCP_OPT_COMPRESSION:
3124                         sp->ipcp.opts &= ~(1 << IPCP_OPT_COMPRESSION);
3125                         break;
3126                 case IPCP_OPT_ADDRESS:
3127                         /*
3128                          * Peer doesn't grok address option.  This is
3129                          * bad.  XXX  Should we better give up here?
3130                          * XXX We could try old "addresses" option...
3131                          */
3132                         sp->ipcp.opts &= ~(1 << IPCP_OPT_ADDRESS);
3133                         break;
3134                 }
3135         }
3136         if (debug)
3137                 addlog("\n");
3138         free (buf, M_TEMP);
3139         return;
3140 }
3141
3142 /*
3143  * Analyze the IPCP Configure-NAK option list, and adjust our
3144  * negotiation.
3145  */
3146 static void
3147 sppp_ipcp_RCN_nak(struct sppp *sp, struct lcp_header *h, int len)
3148 {
3149         u_char *buf, *p;
3150         struct ifnet *ifp = &sp->pp_if;
3151         int debug = ifp->if_flags & IFF_DEBUG;
3152         int desiredcomp;
3153         u_long wantaddr;
3154
3155         len -= 4;
3156         buf = malloc (len, M_TEMP, M_INTWAIT);
3157
3158         if (debug)
3159                 log(LOG_DEBUG, SPP_FMT "ipcp nak opts: ",
3160                     SPP_ARGS(ifp));
3161
3162         p = (void*) (h+1);
3163         for (; len > 1 && p[1]; len -= p[1], p += p[1]) {
3164                 if (debug)
3165                         addlog(" %s ", sppp_ipcp_opt_name(*p));
3166                 switch (*p) {
3167                 case IPCP_OPT_COMPRESSION:
3168                         if (len >= 6 && p[1] == 6) {
3169                                 desiredcomp = p[2] << 8 | p[3];
3170                                 if (debug)
3171                                         addlog("[wantcomp %#04x] ",
3172                                                 desiredcomp);
3173                                 if (desiredcomp == IPCP_COMP_VJ) {
3174                                         sl_compress_init(sp->pp_comp, p[4]);
3175                                         sp->ipcp.max_state = p[4];
3176                                         sp->ipcp.compress_cid = p[5];
3177                                         if (debug)
3178                                                 addlog("[agree] ");
3179                                 } else
3180                                         sp->ipcp.opts &=
3181                                                 ~(1 << IPCP_OPT_COMPRESSION);
3182                         }
3183                         break;
3184                 case IPCP_OPT_ADDRESS:
3185                         /*
3186                          * Peer doesn't like our local IP address.  See
3187                          * if we can do something for him.  We'll drop
3188                          * him our address then.
3189                          */
3190                         if (len >= 6 && p[1] == 6) {
3191                                 wantaddr = p[2] << 24 | p[3] << 16 |
3192                                         p[4] << 8 | p[5];
3193                                 sp->ipcp.opts |= (1 << IPCP_OPT_ADDRESS);
3194                                 if (debug)
3195                                         addlog("[wantaddr %s] ",
3196                                                sppp_dotted_quad(wantaddr));
3197                                 /*
3198                                  * When doing dynamic address assignment,
3199                                  * we accept his offer.  Otherwise, we
3200                                  * ignore it and thus continue to negotiate
3201                                  * our already existing value.
3202                                  * XXX: Bogus, if he said no once, he'll
3203                                  * just say no again, might as well die.
3204                                  */
3205                                 if (sp->ipcp.flags & IPCP_MYADDR_DYN) {
3206                                         sppp_set_ip_addr(sp, wantaddr);
3207                                         if (debug)
3208                                                 addlog("[agree] ");
3209                                         sp->ipcp.flags |= IPCP_MYADDR_SEEN;
3210                                 }
3211                         }
3212                         break;
3213                 }
3214         }
3215         if (debug)
3216                 addlog("\n");
3217         free (buf, M_TEMP);
3218         return;
3219 }
3220
3221 static void
3222 sppp_ipcp_tlu(struct sppp *sp)
3223 {
3224         /* we are up - notify isdn daemon */
3225         if (sp->pp_con)
3226                 sp->pp_con(sp);
3227 }
3228
3229 static void
3230 sppp_ipcp_tld(struct sppp *sp)
3231 {
3232 }
3233
3234 static void
3235 sppp_ipcp_tls(struct sppp *sp)
3236 {
3237         /* indicate to LCP that it must stay alive */
3238         sp->lcp.protos |= (1 << IDX_IPCP);
3239 }
3240
3241 static void
3242 sppp_ipcp_tlf(struct sppp *sp)
3243 {
3244         /* we no longer need LCP */
3245         sp->lcp.protos &= ~(1 << IDX_IPCP);
3246         sppp_lcp_check_and_close(sp);
3247 }
3248
3249 static void
3250 sppp_ipcp_scr(struct sppp *sp)
3251 {
3252         char opt[6 /* compression */ + 6 /* address */];
3253         u_long ouraddr;
3254         int i = 0;
3255
3256         if (sp->ipcp.opts & (1 << IPCP_OPT_COMPRESSION)) {
3257                 opt[i++] = IPCP_OPT_COMPRESSION;
3258                 opt[i++] = 6;
3259                 opt[i++] = IPCP_COMP_VJ >> 8;
3260                 opt[i++] = IPCP_COMP_VJ;
3261                 opt[i++] = sp->ipcp.max_state;
3262                 opt[i++] = sp->ipcp.compress_cid;
3263         }
3264         if (sp->ipcp.opts & (1 << IPCP_OPT_ADDRESS)) {
3265                 sppp_get_ip_addrs(sp, &ouraddr, 0, 0);
3266                 opt[i++] = IPCP_OPT_ADDRESS;
3267                 opt[i++] = 6;
3268                 opt[i++] = ouraddr >> 24;
3269                 opt[i++] = ouraddr >> 16;
3270                 opt[i++] = ouraddr >> 8;
3271                 opt[i++] = ouraddr;
3272         }
3273
3274         sp->confid[IDX_IPCP] = ++sp->pp_seq[IDX_IPCP];
3275         sppp_cp_send(sp, PPP_IPCP, CONF_REQ, sp->confid[IDX_IPCP], i, &opt);
3276 }
3277
3278 /*
3279  *--------------------------------------------------------------------------*
3280  *                                                                          *
3281  *                      The IPv6CP implementation.                          *
3282  *                                                                          *
3283  *--------------------------------------------------------------------------*
3284  */
3285
3286 #ifdef INET6
3287 static void
3288 sppp_ipv6cp_init(struct sppp *sp)
3289 {
3290         sp->ipv6cp.opts = 0;
3291         sp->ipv6cp.flags = 0;
3292         sp->state[IDX_IPV6CP] = STATE_INITIAL;
3293         sp->fail_counter[IDX_IPV6CP] = 0;
3294         sp->pp_seq[IDX_IPV6CP] = 0;
3295         sp->pp_rseq[IDX_IPV6CP] = 0;
3296 #if defined(__NetBSD__)
3297         callout_init(&sp->ch[IDX_IPV6CP]);
3298 #endif
3299 #if defined(__DragonFly__)
3300         callout_handle_init(&sp->ch[IDX_IPV6CP]);
3301 #endif
3302 }
3303
3304 static void
3305 sppp_ipv6cp_up(struct sppp *sp)
3306 {
3307         sppp_up_event(&ipv6cp, sp);
3308 }
3309
3310 static void
3311 sppp_ipv6cp_down(struct sppp *sp)
3312 {
3313         sppp_down_event(&ipv6cp, sp);
3314 }
3315
3316 static void
3317 sppp_ipv6cp_open(struct sppp *sp)
3318 {
3319         STDDCL;
3320         struct in6_addr myaddr, hisaddr;
3321
3322 #ifdef IPV6CP_MYIFID_DYN
3323         sp->ipv6cp.flags &= ~(IPV6CP_MYIFID_SEEN|IPV6CP_MYIFID_DYN);
3324 #else
3325         sp->ipv6cp.flags &= ~IPV6CP_MYIFID_SEEN;
3326 #endif
3327
3328         sppp_get_ip6_addrs(sp, &myaddr, &hisaddr, 0);
3329         /*
3330          * If we don't have our address, this probably means our
3331          * interface doesn't want to talk IPv6 at all.  (This could
3332          * be the case if somebody wants to speak only IPX, for
3333          * example.)  Don't open IPv6CP in this case.
3334          */
3335         if (IN6_IS_ADDR_UNSPECIFIED(&myaddr)) {
3336                 /* XXX this message should go away */
3337                 if (debug)
3338                         log(LOG_DEBUG, SPP_FMT "ipv6cp_open(): no IPv6 interface\n",
3339                             SPP_ARGS(ifp));
3340                 return;
3341         }
3342
3343         sp->ipv6cp.flags |= IPV6CP_MYIFID_SEEN;
3344         sp->ipv6cp.opts |= (1 << IPV6CP_OPT_IFID);
3345         sppp_open_event(&ipv6cp, sp);
3346 }
3347
3348 static void
3349 sppp_ipv6cp_close(struct sppp *sp)
3350 {
3351         sppp_close_event(&ipv6cp, sp);
3352 }
3353
3354 static void
3355 sppp_ipv6cp_TO(void *cookie)
3356 {
3357         sppp_to_event(&ipv6cp, (struct sppp *)cookie);
3358 }
3359
3360 /*
3361  * Analyze a configure request.  Return true if it was agreeable, and
3362  * caused action sca, false if it has been rejected or nak'ed, and
3363  * caused action scn.  (The return value is used to make the state
3364  * transition decision in the state automaton.)
3365  */
3366 static int
3367 sppp_ipv6cp_RCR(struct sppp *sp, struct lcp_header *h, int len)
3368 {
3369         u_char *buf, *r, *p;
3370         struct ifnet *ifp = &sp->pp_if;
3371         int rlen, origlen, debug = ifp->if_flags & IFF_DEBUG;
3372         struct in6_addr myaddr, desiredaddr, suggestaddr;
3373         int ifidcount;
3374         int type;
3375         int collision, nohisaddr;
3376
3377         len -= 4;
3378         origlen = len;
3379         /*
3380          * Make sure to allocate a buf that can at least hold a
3381          * conf-nak with an `address' option.  We might need it below.
3382          */
3383         buf = r = malloc ((len < 6? 6: len), M_TEMP, M_INTWAIT);
3384
3385         /* pass 1: see if we can recognize them */
3386         if (debug)
3387                 log(LOG_DEBUG, SPP_FMT "ipv6cp parse opts:",
3388                     SPP_ARGS(ifp));
3389         p = (void*) (h+1);
3390         ifidcount = 0;
3391         for (rlen=0; len>1 && p[1]; len-=p[1], p+=p[1]) {
3392                 if (debug)
3393                         addlog(" %s", sppp_ipv6cp_opt_name(*p));
3394                 switch (*p) {
3395                 case IPV6CP_OPT_IFID:
3396                         if (len >= 10 && p[1] == 10 && ifidcount == 0) {
3397                                 /* correctly formed address option */
3398                                 ifidcount++;
3399                                 continue;
3400                         }
3401                         if (debug)
3402                                 addlog(" [invalid]");
3403                         break;
3404 #ifdef notyet
3405                 case IPV6CP_OPT_COMPRESSION:
3406                         if (len >= 4 && p[1] >= 4) {
3407                                 /* correctly formed compress option */
3408                                 continue;
3409                         }
3410                         if (debug)
3411                                 addlog(" [invalid]");
3412                         break;
3413 #endif
3414                 default:
3415                         /* Others not supported. */
3416                         if (debug)
3417                                 addlog(" [rej]");
3418                         break;
3419                 }
3420                 /* Add the option to rejected list. */
3421                 bcopy (p, r, p[1]);
3422                 r += p[1];
3423                 rlen += p[1];
3424         }
3425         if (rlen) {
3426                 if (debug)
3427                         addlog(" send conf-rej\n");
3428                 sppp_cp_send (sp, PPP_IPV6CP, CONF_REJ, h->ident, rlen, buf);
3429                 goto end;
3430         } else if (debug)
3431                 addlog("\n");
3432
3433         /* pass 2: parse option values */
3434         sppp_get_ip6_addrs(sp, &myaddr, 0, 0);
3435         if (debug)
3436                 log(LOG_DEBUG, SPP_FMT "ipv6cp parse opt values: ",
3437                     SPP_ARGS(ifp));
3438         p = (void*) (h+1);
3439         len = origlen;
3440         type = CONF_ACK;
3441         for (rlen=0; len>1 && p[1]; len-=p[1], p+=p[1]) {
3442                 if (debug)
3443                         addlog(" %s", sppp_ipv6cp_opt_name(*p));
3444                 switch (*p) {
3445 #ifdef notyet
3446                 case IPV6CP_OPT_COMPRESSION:
3447                         continue;
3448 #endif
3449                 case IPV6CP_OPT_IFID:
3450                         bzero(&desiredaddr, sizeof(desiredaddr));
3451                         bcopy(&p[2], &desiredaddr.s6_addr[8], 8);
3452                         collision = (bcmp(&desiredaddr.s6_addr[8],
3453                                           &myaddr.s6_addr[8], 8) == 0);
3454                         nohisaddr = IN6_IS_ADDR_UNSPECIFIED(&desiredaddr);
3455
3456                         desiredaddr.s6_addr16[0] = htons(0xfe80);
3457                         desiredaddr.s6_addr16[1] = htons(sp->pp_if.if_index);
3458
3459                         if (!collision && !nohisaddr) {
3460                                 /* no collision, hisaddr known - Conf-Ack */
3461                                 type = CONF_ACK;
3462
3463                                 if (debug) {
3464                                         addlog(" %s [%s]",
3465                                                ip6_sprintf(&desiredaddr),
3466                                                sppp_cp_type_name(type));
3467                                 }
3468                                 continue;
3469                         }
3470
3471                         bzero(&suggestaddr, sizeof(&suggestaddr));
3472                         if (collision && nohisaddr) {
3473                                 /* collision, hisaddr unknown - Conf-Rej */
3474                                 type = CONF_REJ;
3475                                 bzero(&p[2], 8);
3476                         } else {
3477                                 /*
3478                                  * - no collision, hisaddr unknown, or
3479                                  * - collision, hisaddr known
3480                                  * Conf-Nak, suggest hisaddr
3481                                  */
3482                                 type = CONF_NAK;
3483                                 sppp_suggest_ip6_addr(sp, &suggestaddr);
3484                                 bcopy(&suggestaddr.s6_addr[8], &p[2], 8);
3485                         }
3486                         if (debug)
3487                                 addlog(" %s [%s]", ip6_sprintf(&desiredaddr),
3488                                        sppp_cp_type_name(type));
3489                         break;
3490                 }
3491                 /* Add the option to nak'ed list. */
3492                 bcopy (p, r, p[1]);
3493                 r += p[1];
3494                 rlen += p[1];
3495         }
3496
3497         if (rlen == 0 && type == CONF_ACK) {
3498                 if (debug)
3499                         addlog(" send %s\n", sppp_cp_type_name(type));
3500                 sppp_cp_send (sp, PPP_IPV6CP, type, h->ident, origlen, h+1);
3501         } else {
3502 #ifdef DIAGNOSTIC
3503                 if (type == CONF_ACK)
3504                         panic("IPv6CP RCR: CONF_ACK with non-zero rlen");
3505 #endif
3506
3507                 if (debug) {
3508                         addlog(" send %s suggest %s\n",
3509                                sppp_cp_type_name(type), ip6_sprintf(&suggestaddr));
3510                 }
3511                 sppp_cp_send (sp, PPP_IPV6CP, type, h->ident, rlen, buf);
3512         }
3513
3514  end:
3515         free (buf, M_TEMP);
3516         return (rlen == 0);
3517 }
3518
3519 /*
3520  * Analyze the IPv6CP Configure-Reject option list, and adjust our
3521  * negotiation.
3522  */
3523 static void
3524 sppp_ipv6cp_RCN_rej(struct sppp *sp, struct lcp_header *h, int len)
3525 {
3526         u_char *buf, *p;
3527         struct ifnet *ifp = &sp->pp_if;
3528         int debug = ifp->if_flags & IFF_DEBUG;
3529
3530         len -= 4;
3531         buf = malloc (len, M_TEMP, M_INTWAIT);
3532
3533         if (debug)
3534                 log(LOG_DEBUG, SPP_FMT "ipv6cp rej opts:",
3535                     SPP_ARGS(ifp));
3536
3537         p = (void*) (h+1);
3538         for (; len > 1 && p[1]; len -= p[1], p += p[1]) {
3539                 if (debug)
3540                         addlog(" %s", sppp_ipv6cp_opt_name(*p));
3541                 switch (*p) {
3542                 case IPV6CP_OPT_IFID:
3543                         /*
3544                          * Peer doesn't grok address option.  This is
3545                          * bad.  XXX  Should we better give up here?
3546                          */
3547                         sp->ipv6cp.opts &= ~(1 << IPV6CP_OPT_IFID);
3548                         break;
3549 #ifdef notyet
3550                 case IPV6CP_OPT_COMPRESS:
3551                         sp->ipv6cp.opts &= ~(1 << IPV6CP_OPT_COMPRESS);
3552                         break;
3553 #endif
3554                 }
3555         }
3556         if (debug)
3557                 addlog("\n");
3558         free (buf, M_TEMP);
3559         return;
3560 }
3561
3562 /*
3563  * Analyze the IPv6CP Configure-NAK option list, and adjust our
3564  * negotiation.
3565  */
3566 static void
3567 sppp_ipv6cp_RCN_nak(struct sppp *sp, struct lcp_header *h, int len)
3568 {
3569         u_char *buf, *p;
3570         struct ifnet *ifp = &sp->pp_if;
3571         int debug = ifp->if_flags & IFF_DEBUG;
3572         struct in6_addr suggestaddr;
3573
3574         len -= 4;
3575         buf = malloc (len, M_TEMP, M_INTWAIT);
3576
3577         if (debug)
3578                 log(LOG_DEBUG, SPP_FMT "ipv6cp nak opts:",
3579                     SPP_ARGS(ifp));
3580
3581         p = (void*) (h+1);
3582         for (; len > 1 && p[1]; len -= p[1], p += p[1]) {
3583                 if (debug)
3584                         addlog(" %s", sppp_ipv6cp_opt_name(*p));
3585                 switch (*p) {
3586                 case IPV6CP_OPT_IFID:
3587                         /*
3588                          * Peer doesn't like our local ifid.  See
3589                          * if we can do something for him.  We'll drop
3590                          * him our address then.
3591                          */
3592                         if (len < 10 || p[1] != 10)
3593                                 break;
3594                         bzero(&suggestaddr, sizeof(suggestaddr));
3595                         suggestaddr.s6_addr16[0] = htons(0xfe80);
3596                         suggestaddr.s6_addr16[1] = htons(sp->pp_if.if_index);
3597                         bcopy(&p[2], &suggestaddr.s6_addr[8], 8);
3598
3599                         sp->ipv6cp.opts |= (1 << IPV6CP_OPT_IFID);
3600                         if (debug)
3601                                 addlog(" [suggestaddr %s]",
3602                                        ip6_sprintf(&suggestaddr));
3603 #ifdef IPV6CP_MYIFID_DYN
3604                         /*
3605                          * When doing dynamic address assignment,
3606                          * we accept his offer.
3607                          */
3608                         if (sp->ipv6cp.flags & IPV6CP_MYIFID_DYN) {
3609                                 struct in6_addr lastsuggest;
3610                                 /*
3611                                  * If <suggested myaddr from peer> equals to
3612                                  * <hisaddr we have suggested last time>,
3613                                  * we have a collision.  generate new random
3614                                  * ifid.
3615                                  */
3616                                 sppp_suggest_ip6_addr(&lastsuggest);
3617                                 if (IN6_ARE_ADDR_EQUAL(&suggestaddr,
3618                                                        lastsuggest)) {
3619                                         if (debug)
3620                                                 addlog(" [random]");
3621                                         sppp_gen_ip6_addr(sp, &suggestaddr);
3622                                 }
3623                                 sppp_set_ip6_addr(sp, &suggestaddr, 0);
3624                                 if (debug)
3625                                         addlog(" [agree]");
3626                                 sp->ipv6cp.flags |= IPV6CP_MYIFID_SEEN;
3627                         }
3628 #else
3629                         /*
3630                          * Since we do not do dynamic address assignment,
3631                          * we ignore it and thus continue to negotiate
3632                          * our already existing value.  This can possibly
3633                          * go into infinite request-reject loop.
3634                          *
3635                          * This is not likely because we normally use
3636                          * ifid based on MAC-address.
3637                          * If you have no ethernet card on the node, too bad.
3638                          * XXX should we use fail_counter?
3639                          */
3640 #endif
3641                         break;
3642 #ifdef notyet
3643                 case IPV6CP_OPT_COMPRESS:
3644                         /*
3645                          * Peer wants different compression parameters.
3646                          */
3647                         break;
3648 #endif
3649                 }
3650         }
3651         if (debug)
3652                 addlog("\n");
3653         free (buf, M_TEMP);
3654         return;
3655 }
3656 static void
3657 sppp_ipv6cp_tlu(struct sppp *sp)
3658 {
3659         /* we are up - notify isdn daemon */
3660         if (sp->pp_con)
3661                 sp->pp_con(sp);
3662 }
3663
3664 static void
3665 sppp_ipv6cp_tld(struct sppp *sp)
3666 {
3667 }
3668
3669 static void
3670 sppp_ipv6cp_tls(struct sppp *sp)
3671 {
3672         /* indicate to LCP that it must stay alive */
3673         sp->lcp.protos |= (1 << IDX_IPV6CP);
3674 }
3675
3676 static void
3677 sppp_ipv6cp_tlf(struct sppp *sp)
3678 {
3679
3680 #if 0   /* need #if 0 to close IPv6CP properly */
3681         /* we no longer need LCP */
3682         sp->lcp.protos &= ~(1 << IDX_IPV6CP);
3683         sppp_lcp_check_and_close(sp);
3684 #endif
3685 }
3686
3687 static void
3688 sppp_ipv6cp_scr(struct sppp *sp)
3689 {
3690         char opt[10 /* ifid */ + 4 /* compression, minimum */];
3691         struct in6_addr ouraddr;
3692         int i = 0;
3693
3694         if (sp->ipv6cp.opts & (1 << IPV6CP_OPT_IFID)) {
3695                 sppp_get_ip6_addrs(sp, &ouraddr, 0, 0);
3696                 opt[i++] = IPV6CP_OPT_IFID;
3697                 opt[i++] = 10;
3698                 bcopy(&ouraddr.s6_addr[8], &opt[i], 8);
3699                 i += 8;
3700         }
3701
3702 #ifdef notyet
3703         if (sp->ipv6cp.opts & (1 << IPV6CP_OPT_COMPRESSION)) {
3704                 opt[i++] = IPV6CP_OPT_COMPRESSION;
3705                 opt[i++] = 4;
3706                 opt[i++] = 0;   /* TBD */
3707                 opt[i++] = 0;   /* TBD */
3708                 /* variable length data may follow */
3709         }
3710 #endif
3711
3712         sp->confid[IDX_IPV6CP] = ++sp->pp_seq[IDX_IPV6CP];
3713         sppp_cp_send(sp, PPP_IPV6CP, CONF_REQ, sp->confid[IDX_IPV6CP], i, &opt);
3714 }
3715 #else /*INET6*/
3716 static void sppp_ipv6cp_init(struct sppp *sp)
3717 {
3718 }
3719
3720 static void sppp_ipv6cp_up(struct sppp *sp)
3721 {
3722 }
3723
3724 static void sppp_ipv6cp_down(struct sppp *sp)
3725 {
3726 }
3727
3728
3729 static void sppp_ipv6cp_open(struct sppp *sp)
3730 {
3731 }
3732
3733 static void sppp_ipv6cp_close(struct sppp *sp)
3734 {
3735 }
3736
3737 static void sppp_ipv6cp_TO(void *sp)
3738 {
3739 }
3740
3741 static int sppp_ipv6cp_RCR(struct sppp *sp, struct lcp_header *h, int len)
3742 {
3743         return 0;
3744 }
3745
3746 static void sppp_ipv6cp_RCN_rej(struct sppp *sp, struct lcp_header *h, int len)
3747 {
3748 }
3749
3750 static void sppp_ipv6cp_RCN_nak(struct sppp *sp, struct lcp_header *h, int len)
3751 {
3752 }
3753
3754 static void sppp_ipv6cp_tlu(struct sppp *sp)
3755 {
3756 }
3757
3758 static void sppp_ipv6cp_tld(struct sppp *sp)
3759 {
3760 }
3761
3762 static void sppp_ipv6cp_tls(struct sppp *sp)
3763 {
3764 }
3765
3766 static void sppp_ipv6cp_tlf(struct sppp *sp)
3767 {
3768 }
3769
3770 static void sppp_ipv6cp_scr(struct sppp *sp)
3771 {
3772 }
3773 #endif /*INET6*/
3774
3775 /*
3776  *--------------------------------------------------------------------------*
3777  *                                                                          *
3778  *                        The CHAP implementation.                          *
3779  *                                                                          *
3780  *--------------------------------------------------------------------------*
3781  */
3782
3783 /*
3784  * The authentication protocols don't employ a full-fledged state machine as
3785  * the control protocols do, since they do have Open and Close events, but
3786  * not Up and Down, nor are they explicitly terminated.  Also, use of the
3787  * authentication protocols may be different in both directions (this makes
3788  * sense, think of a machine that never accepts incoming calls but only
3789  * calls out, it doesn't require the called party to authenticate itself).
3790  *
3791  * Our state machine for the local authentication protocol (we are requesting
3792  * the peer to authenticate) looks like:
3793  *
3794  *                                                  RCA-
3795  *            +--------------------------------------------+
3796  *            V                                     scn,tld|
3797  *        +--------+                           Close   +---------+ RCA+
3798  *        |        |<----------------------------------|         |------+
3799  *   +--->| Closed |                            TO*    | Opened  | sca  |
3800  *   |    |        |-----+                     +-------|         |<-----+
3801  *   |    +--------+ irc |                     |       +---------+
3802  *   |      ^            |                     |           ^
3803  *   |      |            |                     |           |
3804  *   |      |            |                     |           |
3805  *   |   TO-|            |                     |           |
3806  *   |      |tld  TO+    V                     |           |
3807  *   |      |   +------->+                     |           |
3808  *   |      |   |        |                     |           |
3809  *   |    +--------+     V                     |           |
3810  *   |    |        |<----+<--------------------+           |
3811  *   |    | Req-   | scr                                   |
3812  *   |    | Sent   |                                       |
3813  *   |    |        |                                       |
3814  *   |    +--------+                                       |
3815  *   | RCA- |   | RCA+                                     |
3816  *   +------+   +------------------------------------------+
3817  *   scn,tld      sca,irc,ict,tlu
3818  *
3819  *
3820  *   with:
3821  *
3822  *      Open:   LCP reached authentication phase
3823  *      Close:  LCP reached terminate phase
3824  *
3825  *      RCA+:   received reply (pap-req, chap-response), acceptable
3826  *      RCN:    received reply (pap-req, chap-response), not acceptable
3827  *      TO+:    timeout with restart counter >= 0
3828  *      TO-:    timeout with restart counter < 0
3829  *      TO*:    reschedule timeout for CHAP
3830  *
3831  *      scr:    send request packet (none for PAP, chap-challenge)
3832  *      sca:    send ack packet (pap-ack, chap-success)
3833  *      scn:    send nak packet (pap-nak, chap-failure)
3834  *      ict:    initialize re-challenge timer (CHAP only)
3835  *
3836  *      tlu:    this-layer-up, LCP reaches network phase
3837  *      tld:    this-layer-down, LCP enters terminate phase
3838  *
3839  * Note that in CHAP mode, after sending a new challenge, while the state
3840  * automaton falls back into Req-Sent state, it doesn't signal a tld
3841  * event to LCP, so LCP remains in network phase.  Only after not getting
3842  * any response (or after getting an unacceptable response), CHAP closes,
3843  * causing LCP to enter terminate phase.
3844  *
3845  * With PAP, there is no initial request that can be sent.  The peer is
3846  * expected to send one based on the successful negotiation of PAP as
3847  * the authentication protocol during the LCP option negotiation.
3848  *
3849  * Incoming authentication protocol requests (remote requests
3850  * authentication, we are peer) don't employ a state machine at all,
3851  * they are simply answered.  Some peers [Ascend P50 firmware rev
3852  * 4.50] react allergically when sending IPCP requests while they are
3853  * still in authentication phase (thereby violating the standard that
3854  * demands that these NCP packets are to be discarded), so we keep
3855  * track of the peer demanding us to authenticate, and only proceed to
3856  * phase network once we've seen a positive acknowledge for the
3857  * authentication.
3858  */
3859
3860 /*
3861  * Handle incoming CHAP packets.
3862  */
3863 void
3864 sppp_chap_input(struct sppp *sp, struct mbuf *m)
3865 {
3866         STDDCL;
3867         struct lcp_header *h;
3868         int len, x;
3869         u_char *value, *name, digest[AUTHKEYLEN], dsize;
3870         int value_len, name_len;
3871         MD5_CTX ctx;
3872
3873         len = m->m_pkthdr.len;
3874         if (len < 4) {
3875                 if (debug)
3876                         log(LOG_DEBUG,
3877                             SPP_FMT "chap invalid packet length: %d bytes\n",
3878                             SPP_ARGS(ifp), len);
3879                 return;
3880         }
3881         h = mtod (m, struct lcp_header*);
3882         if (len > ntohs (h->len))
3883                 len = ntohs (h->len);
3884
3885         switch (h->type) {
3886         /* challenge, failure and success are his authproto */
3887         case CHAP_CHALLENGE:
3888                 value = 1 + (u_char*)(h+1);
3889                 value_len = value[-1];
3890                 name = value + value_len;
3891                 name_len = len - value_len - 5;
3892                 if (name_len < 0) {
3893                         if (debug) {
3894                                 log(LOG_DEBUG,
3895                                     SPP_FMT "chap corrupted challenge "
3896                                     "<%s id=0x%x len=%d",
3897                                     SPP_ARGS(ifp),
3898                                     sppp_auth_type_name(PPP_CHAP, h->type),
3899                                     h->ident, ntohs(h->len));
3900                                 sppp_print_bytes((u_char*) (h+1), len-4);
3901                                 addlog(">\n");
3902                         }
3903                         break;
3904                 }
3905
3906                 if (debug) {
3907                         log(LOG_DEBUG,
3908                             SPP_FMT "chap input <%s id=0x%x len=%d name=",
3909                             SPP_ARGS(ifp),
3910                             sppp_auth_type_name(PPP_CHAP, h->type), h->ident,
3911                             ntohs(h->len));
3912                         sppp_print_string((char*) name, name_len);
3913                         addlog(" value-size=%d value=", value_len);
3914                         sppp_print_bytes(value, value_len);
3915                         addlog(">\n");
3916                 }
3917
3918                 /* Compute reply value. */
3919                 MD5Init(&ctx);
3920                 MD5Update(&ctx, &h->ident, 1);
3921                 MD5Update(&ctx, sp->myauth.secret,
3922                           sppp_strnlen(sp->myauth.secret, AUTHKEYLEN));
3923                 MD5Update(&ctx, value, value_len);
3924                 MD5Final(digest, &ctx);
3925                 dsize = sizeof digest;
3926
3927                 sppp_auth_send(&chap, sp, CHAP_RESPONSE, h->ident,
3928                                sizeof dsize, (const char *)&dsize,
3929                                sizeof digest, digest,
3930                                (size_t)sppp_strnlen(sp->myauth.name, AUTHNAMELEN),
3931                                sp->myauth.name,
3932                                0);
3933                 break;
3934
3935         case CHAP_SUCCESS:
3936                 if (debug) {
3937                         log(LOG_DEBUG, SPP_FMT "chap success",
3938                             SPP_ARGS(ifp));
3939                         if (len > 4) {
3940                                 addlog(": ");
3941                                 sppp_print_string((char*)(h + 1), len - 4);
3942                         }
3943                         addlog("\n");
3944                 }
3945                 x = splimp();
3946                 sp->pp_flags &= ~PP_NEEDAUTH;
3947                 if (sp->myauth.proto == PPP_CHAP &&
3948                     (sp->lcp.opts & (1 << LCP_OPT_AUTH_PROTO)) &&
3949                     (sp->lcp.protos & (1 << IDX_CHAP)) == 0) {
3950                         /*
3951                          * We are authenticator for CHAP but didn't
3952                          * complete yet.  Leave it to tlu to proceed
3953                          * to network phase.
3954                          */
3955                         splx(x);
3956                         break;
3957                 }
3958                 splx(x);
3959                 sppp_phase_network(sp);
3960                 break;
3961
3962         case CHAP_FAILURE:
3963                 if (debug) {
3964                         log(LOG_INFO, SPP_FMT "chap failure",
3965                             SPP_ARGS(ifp));
3966                         if (len > 4) {
3967                                 addlog(": ");
3968                                 sppp_print_string((char*)(h + 1), len - 4);
3969                         }
3970                         addlog("\n");
3971                 } else
3972                         log(LOG_INFO, SPP_FMT "chap failure\n",
3973                             SPP_ARGS(ifp));
3974                 /* await LCP shutdown by authenticator */
3975                 break;
3976
3977         /* response is my authproto */
3978         case CHAP_RESPONSE:
3979                 value = 1 + (u_char*)(h+1);
3980                 value_len = value[-1];
3981                 name = value + value_len;
3982                 name_len = len - value_len - 5;
3983                 if (name_len < 0) {
3984                         if (debug) {
3985                                 log(LOG_DEBUG,
3986                                     SPP_FMT "chap corrupted response "
3987                                     "<%s id=0x%x len=%d",
3988                                     SPP_ARGS(ifp),
3989                                     sppp_auth_type_name(PPP_CHAP, h->type),
3990                                     h->ident, ntohs(h->len));
3991                                 sppp_print_bytes((u_char*)(h+1), len-4);
3992                                 addlog(">\n");
3993                         }
3994                         break;
3995                 }
3996                 if (h->ident != sp->confid[IDX_CHAP]) {
3997                         if (debug)
3998                                 log(LOG_DEBUG,
3999                                     SPP_FMT "chap dropping response for old ID "
4000                                     "(got %d, expected %d)\n",
4001                                     SPP_ARGS(ifp),
4002                                     h->ident, sp->confid[IDX_CHAP]);
4003                         break;
4004                 }
4005                 if (name_len != sppp_strnlen(sp->hisauth.name, AUTHNAMELEN)
4006                     || bcmp(name, sp->hisauth.name, name_len) != 0) {
4007                         log(LOG_INFO, SPP_FMT "chap response, his name ",
4008                             SPP_ARGS(ifp));
4009                         sppp_print_string(name, name_len);
4010                         addlog(" != expected ");
4011                         sppp_print_string(sp->hisauth.name,
4012                                           sppp_strnlen(sp->hisauth.name, AUTHNAMELEN));
4013                         addlog("\n");
4014                 }
4015                 if (debug) {
4016                         log(LOG_DEBUG, SPP_FMT "chap input(%s) "
4017                             "<%s id=0x%x len=%d name=",
4018                             SPP_ARGS(ifp),
4019                             sppp_state_name(sp->state[IDX_CHAP]),
4020                             sppp_auth_type_name(PPP_CHAP, h->type),
4021                             h->ident, ntohs (h->len));
4022                         sppp_print_string((char*)name, name_len);
4023                         addlog(" value-size=%d value=", value_len);
4024                         sppp_print_bytes(value, value_len);
4025                         addlog(">\n");
4026                 }
4027                 if (value_len != AUTHKEYLEN) {
4028                         if (debug)
4029                                 log(LOG_DEBUG,
4030                                     SPP_FMT "chap bad hash value length: "
4031                                     "%d bytes, should be %d\n",
4032                                     SPP_ARGS(ifp), value_len,
4033                                     AUTHKEYLEN);
4034                         break;
4035                 }
4036
4037                 MD5Init(&ctx);
4038                 MD5Update(&ctx, &h->ident, 1);
4039                 MD5Update(&ctx, sp->hisauth.secret,
4040                           sppp_strnlen(sp->hisauth.secret, AUTHKEYLEN));
4041                 MD5Update(&ctx, sp->myauth.challenge, AUTHKEYLEN);
4042                 MD5Final(digest, &ctx);
4043
4044 #define FAILMSG "Failed..."
4045 #define SUCCMSG "Welcome!"
4046
4047                 if (value_len != sizeof digest ||
4048                     bcmp(digest, value, value_len) != 0) {
4049                         /* action scn, tld */
4050                         sppp_auth_send(&chap, sp, CHAP_FAILURE, h->ident,
4051                                        sizeof(FAILMSG) - 1, (u_char *)FAILMSG,
4052                                        0);
4053                         chap.tld(sp);
4054                         break;
4055                 }
4056                 /* action sca, perhaps tlu */
4057                 if (sp->state[IDX_CHAP] == STATE_REQ_SENT ||
4058                     sp->state[IDX_CHAP] == STATE_OPENED)
4059                         sppp_auth_send(&chap, sp, CHAP_SUCCESS, h->ident,
4060                                        sizeof(SUCCMSG) - 1, (u_char *)SUCCMSG,
4061                                        0);
4062                 if (sp->state[IDX_CHAP] == STATE_REQ_SENT) {
4063                         sppp_cp_change_state(&chap, sp, STATE_OPENED);
4064                         chap.tlu(sp);
4065                 }
4066                 break;
4067
4068         default:
4069                 /* Unknown CHAP packet type -- ignore. */
4070                 if (debug) {
4071                         log(LOG_DEBUG, SPP_FMT "chap unknown input(%s) "
4072                             "<0x%x id=0x%xh len=%d",
4073                             SPP_ARGS(ifp),
4074                             sppp_state_name(sp->state[IDX_CHAP]),
4075                             h->type, h->ident, ntohs(h->len));
4076                         sppp_print_bytes((u_char*)(h+1), len-4);
4077                         addlog(">\n");
4078                 }
4079                 break;
4080
4081         }
4082 }
4083
4084 static void
4085 sppp_chap_init(struct sppp *sp)
4086 {
4087         /* Chap doesn't have STATE_INITIAL at all. */
4088         sp->state[IDX_CHAP] = STATE_CLOSED;
4089         sp->fail_counter[IDX_CHAP] = 0;
4090         sp->pp_seq[IDX_CHAP] = 0;
4091         sp->pp_rseq[IDX_CHAP] = 0;
4092 #if defined(__DragonFly__)
4093         callout_handle_init(&sp->ch[IDX_CHAP]);
4094 #endif
4095 }
4096
4097 static void
4098 sppp_chap_open(struct sppp *sp)
4099 {
4100         if (sp->myauth.proto == PPP_CHAP &&
4101             (sp->lcp.opts & (1 << LCP_OPT_AUTH_PROTO)) != 0) {
4102                 /* we are authenticator for CHAP, start it */
4103                 chap.scr(sp);
4104                 sp->rst_counter[IDX_CHAP] = sp->lcp.max_configure;
4105                 sppp_cp_change_state(&chap, sp, STATE_REQ_SENT);
4106         }
4107         /* nothing to be done if we are peer, await a challenge */
4108 }
4109
4110 static void
4111 sppp_chap_close(struct sppp *sp)
4112 {
4113         if (sp->state[IDX_CHAP] != STATE_CLOSED)
4114                 sppp_cp_change_state(&chap, sp, STATE_CLOSED);
4115 }
4116
4117 static void
4118 sppp_chap_TO(void *cookie)
4119 {
4120         struct sppp *sp = (struct sppp *)cookie;
4121         STDDCL;
4122         int s;
4123
4124         s = splimp();
4125         if (debug)
4126                 log(LOG_DEBUG, SPP_FMT "chap TO(%s) rst_counter = %d\n",
4127                     SPP_ARGS(ifp),
4128                     sppp_state_name(sp->state[IDX_CHAP]),
4129                     sp->rst_counter[IDX_CHAP]);
4130
4131         if (--sp->rst_counter[IDX_CHAP] < 0)
4132                 /* TO- event */
4133                 switch (sp->state[IDX_CHAP]) {
4134                 case STATE_REQ_SENT:
4135                         chap.tld(sp);
4136                         sppp_cp_change_state(&chap, sp, STATE_CLOSED);
4137                         break;
4138                 }
4139         else
4140                 /* TO+ (or TO*) event */
4141                 switch (sp->state[IDX_CHAP]) {
4142                 case STATE_OPENED:
4143                         /* TO* event */
4144                         sp->rst_counter[IDX_CHAP] = sp->lcp.max_configure;
4145                         /* fall through */
4146                 case STATE_REQ_SENT:
4147                         chap.scr(sp);
4148                         /* sppp_cp_change_state() will restart the timer */
4149                         sppp_cp_change_state(&chap, sp, STATE_REQ_SENT);
4150                         break;
4151                 }
4152
4153         splx(s);
4154 }
4155
4156 static void
4157 sppp_chap_tlu(struct sppp *sp)
4158 {
4159         STDDCL;
4160         int i, x;
4161
4162         i = 0;
4163         sp->rst_counter[IDX_CHAP] = sp->lcp.max_configure;
4164
4165         /*
4166          * Some broken CHAP implementations (Conware CoNet, firmware
4167          * 4.0.?) don't want to re-authenticate their CHAP once the
4168          * initial challenge-response exchange has taken place.
4169          * Provide for an option to avoid rechallenges.
4170          */
4171         if ((sp->hisauth.flags & AUTHFLAG_NORECHALLENGE) == 0) {
4172                 /*
4173                  * Compute the re-challenge timeout.  This will yield
4174                  * a number between 300 and 810 seconds.
4175                  */
4176                 i = 300 + ((unsigned)(random() & 0xff00) >> 7);
4177                 TIMEOUT(chap.TO, (void *)sp, i * hz, sp->ch[IDX_CHAP]);
4178         }
4179
4180         if (debug) {
4181                 log(LOG_DEBUG,
4182                     SPP_FMT "chap %s, ",
4183                     SPP_ARGS(ifp),
4184                     sp->pp_phase == PHASE_NETWORK? "reconfirmed": "tlu");
4185                 if ((sp->hisauth.flags & AUTHFLAG_NORECHALLENGE) == 0)
4186                         addlog("next re-challenge in %d seconds\n", i);
4187                 else
4188                         addlog("re-challenging supressed\n");
4189         }
4190
4191         x = splimp();
4192         /* indicate to LCP that we need to be closed down */
4193         sp->lcp.protos |= (1 << IDX_CHAP);
4194
4195         if (sp->pp_flags & PP_NEEDAUTH) {
4196                 /*
4197                  * Remote is authenticator, but his auth proto didn't
4198                  * complete yet.  Defer the transition to network
4199                  * phase.
4200                  */
4201                 splx(x);
4202                 return;
4203         }
4204         splx(x);
4205
4206         /*
4207          * If we are already in phase network, we are done here.  This
4208          * is the case if this is a dummy tlu event after a re-challenge.
4209          */
4210         if (sp->pp_phase != PHASE_NETWORK)
4211                 sppp_phase_network(sp);
4212 }
4213
4214 static void
4215 sppp_chap_tld(struct sppp *sp)
4216 {
4217         STDDCL;
4218
4219         if (debug)
4220                 log(LOG_DEBUG, SPP_FMT "chap tld\n", SPP_ARGS(ifp));
4221         UNTIMEOUT(chap.TO, (void *)sp, sp->ch[IDX_CHAP]);
4222         sp->lcp.protos &= ~(1 << IDX_CHAP);
4223
4224         lcp.Close(sp);
4225 }
4226
4227 static void
4228 sppp_chap_scr(struct sppp *sp)
4229 {
4230         u_long *ch, seed;
4231         u_char clen;
4232
4233         /* Compute random challenge. */
4234         ch = (u_long *)sp->myauth.challenge;
4235 #if defined(__DragonFly__)
4236         read_random(&seed, sizeof seed);
4237 #else
4238         {
4239         struct timeval tv;
4240         microtime(&tv);
4241         seed = tv.tv_sec ^ tv.tv_usec;
4242         }
4243 #endif
4244         ch[0] = seed ^ random();
4245         ch[1] = seed ^ random();
4246         ch[2] = seed ^ random();
4247         ch[3] = seed ^ random();
4248         clen = AUTHKEYLEN;
4249
4250         sp->confid[IDX_CHAP] = ++sp->pp_seq[IDX_CHAP];
4251
4252         sppp_auth_send(&chap, sp, CHAP_CHALLENGE, sp->confid[IDX_CHAP],
4253                        sizeof clen, (const char *)&clen,
4254                        (size_t)AUTHKEYLEN, sp->myauth.challenge,
4255                        (size_t)sppp_strnlen(sp->myauth.name, AUTHNAMELEN),
4256                        sp->myauth.name,
4257                        0);
4258 }
4259
4260 /*
4261  *--------------------------------------------------------------------------*
4262  *                                                                          *
4263  *                        The PAP implementation.                           *
4264  *                                                                          *
4265  *--------------------------------------------------------------------------*
4266  */
4267 /*
4268  * For PAP, we need to keep a little state also if we are the peer, not the
4269  * authenticator.  This is since we don't get a request to authenticate, but
4270  * have to repeatedly authenticate ourself until we got a response (or the
4271  * retry counter is expired).
4272  */
4273
4274 /*
4275  * Handle incoming PAP packets.  */
4276 static void
4277 sppp_pap_input(struct sppp *sp, struct mbuf *m)
4278 {
4279         STDDCL;
4280         struct lcp_header *h;
4281         int len, x;
4282         u_char *name, *passwd, mlen;
4283         int name_len, passwd_len;
4284
4285         len = m->m_pkthdr.len;
4286         if (len < 5) {
4287                 if (debug)
4288                         log(LOG_DEBUG,
4289                             SPP_FMT "pap invalid packet length: %d bytes\n",
4290                             SPP_ARGS(ifp), len);
4291                 return;
4292         }
4293         h = mtod (m, struct lcp_header*);
4294         if (len > ntohs (h->len))
4295                 len = ntohs (h->len);
4296         switch (h->type) {
4297         /* PAP request is my authproto */
4298         case PAP_REQ:
4299                 name = 1 + (u_char*)(h+1);
4300                 name_len = name[-1];
4301                 passwd = name + name_len + 1;
4302                 if (name_len > len - 6 ||
4303                     (passwd_len = passwd[-1]) > len - 6 - name_len) {
4304                         if (debug) {
4305                                 log(LOG_DEBUG, SPP_FMT "pap corrupted input "
4306                                     "<%s id=0x%x len=%d",
4307                                     SPP_ARGS(ifp),
4308                                     sppp_auth_type_name(PPP_PAP, h->type),
4309                                     h->ident, ntohs(h->len));
4310                                 sppp_print_bytes((u_char*)(h+1), len-4);
4311                                 addlog(">\n");
4312                         }
4313                         break;
4314                 }
4315                 if (debug) {
4316                         log(LOG_DEBUG, SPP_FMT "pap input(%s) "
4317                             "<%s id=0x%x len=%d name=",
4318                             SPP_ARGS(ifp),
4319                             sppp_state_name(sp->state[IDX_PAP]),
4320                             sppp_auth_type_name(PPP_PAP, h->type),
4321                             h->ident, ntohs(h->len));
4322                         sppp_print_string((char*)name, name_len);
4323                         addlog(" passwd=");
4324                         sppp_print_string((char*)passwd, passwd_len);
4325                         addlog(">\n");
4326                 }
4327                 if (name_len != sppp_strnlen(sp->hisauth.name, AUTHNAMELEN) ||
4328                     passwd_len != sppp_strnlen(sp->hisauth.secret, AUTHKEYLEN) ||
4329                     bcmp(name, sp->hisauth.name, name_len) != 0 ||
4330                     bcmp(passwd, sp->hisauth.secret, passwd_len) != 0) {
4331                         /* action scn, tld */
4332                         mlen = sizeof(FAILMSG) - 1;
4333                         sppp_auth_send(&pap, sp, PAP_NAK, h->ident,
4334                                        sizeof mlen, (const char *)&mlen,
4335                                        sizeof(FAILMSG) - 1, (u_char *)FAILMSG,
4336                                        0);
4337                         pap.tld(sp);
4338                         break;
4339                 }
4340                 /* action sca, perhaps tlu */
4341                 if (sp->state[IDX_PAP] == STATE_REQ_SENT ||
4342                     sp->state[IDX_PAP] == STATE_OPENED) {
4343                         mlen = sizeof(SUCCMSG) - 1;
4344                         sppp_auth_send(&pap, sp, PAP_ACK, h->ident,
4345                                        sizeof mlen, (const char *)&mlen,
4346                                        sizeof(SUCCMSG) - 1, (u_char *)SUCCMSG,
4347                                        0);
4348                 }
4349                 if (sp->state[IDX_PAP] == STATE_REQ_SENT) {
4350                         sppp_cp_change_state(&pap, sp, STATE_OPENED);
4351                         pap.tlu(sp);
4352                 }
4353                 break;
4354
4355         /* ack and nak are his authproto */
4356         case PAP_ACK:
4357                 UNTIMEOUT(sppp_pap_my_TO, (void *)sp, sp->pap_my_to_ch);
4358                 if (debug) {
4359                         log(LOG_DEBUG, SPP_FMT "pap success",
4360                             SPP_ARGS(ifp));
4361                         name_len = *((char *)h);
4362                         if (len > 5 && name_len) {
4363                                 addlog(": ");
4364                                 sppp_print_string((char*)(h+1), name_len);
4365                         }
4366                         addlog("\n");
4367                 }
4368                 x = splimp();
4369                 sp->pp_flags &= ~PP_NEEDAUTH;
4370                 if (sp->myauth.proto == PPP_PAP &&
4371                     (sp->lcp.opts & (1 << LCP_OPT_AUTH_PROTO)) &&
4372                     (sp->lcp.protos & (1 << IDX_PAP)) == 0) {
4373                         /*
4374                          * We are authenticator for PAP but didn't
4375                          * complete yet.  Leave it to tlu to proceed
4376                          * to network phase.
4377                          */
4378                         splx(x);
4379                         break;
4380                 }
4381                 splx(x);
4382                 sppp_phase_network(sp);
4383                 break;
4384
4385         case PAP_NAK:
4386                 UNTIMEOUT(sppp_pap_my_TO, (void *)sp, sp->pap_my_to_ch);
4387                 if (debug) {
4388                         log(LOG_INFO, SPP_FMT "pap failure",
4389                             SPP_ARGS(ifp));
4390                         name_len = *((char *)h);
4391                         if (len > 5 && name_len) {
4392                                 addlog(": ");
4393                                 sppp_print_string((char*)(h+1), name_len);
4394                         }
4395                         addlog("\n");
4396                 } else
4397                         log(LOG_INFO, SPP_FMT "pap failure\n",
4398                             SPP_ARGS(ifp));
4399                 /* await LCP shutdown by authenticator */
4400                 break;
4401
4402         default:
4403                 /* Unknown PAP packet type -- ignore. */
4404                 if (debug) {
4405                         log(LOG_DEBUG, SPP_FMT "pap corrupted input "
4406                             "<0x%x id=0x%x len=%d",
4407                             SPP_ARGS(ifp),
4408                             h->type, h->ident, ntohs(h->len));
4409                         sppp_print_bytes((u_char*)(h+1), len-4);
4410                         addlog(">\n");
4411                 }
4412                 break;
4413
4414         }
4415 }
4416
4417 static void
4418 sppp_pap_init(struct sppp *sp)
4419 {
4420         /* PAP doesn't have STATE_INITIAL at all. */
4421         sp->state[IDX_PAP] = STATE_CLOSED;
4422         sp->fail_counter[IDX_PAP] = 0;
4423         sp->pp_seq[IDX_PAP] = 0;
4424         sp->pp_rseq[IDX_PAP] = 0;
4425 #if defined(__DragonFly__)
4426         callout_handle_init(&sp->ch[IDX_PAP]);
4427         callout_handle_init(&sp->pap_my_to_ch);
4428 #endif
4429 }
4430
4431 static void
4432 sppp_pap_open(struct sppp *sp)
4433 {
4434         if (sp->hisauth.proto == PPP_PAP &&
4435             (sp->lcp.opts & (1 << LCP_OPT_AUTH_PROTO)) != 0) {
4436                 /* we are authenticator for PAP, start our timer */
4437                 sp->rst_counter[IDX_PAP] = sp->lcp.max_configure;
4438                 sppp_cp_change_state(&pap, sp, STATE_REQ_SENT);
4439         }
4440         if (sp->myauth.proto == PPP_PAP) {
4441                 /* we are peer, send a request, and start a timer */
4442                 pap.scr(sp);
4443                 TIMEOUT(sppp_pap_my_TO, (void *)sp, sp->lcp.timeout,
4444                     sp->pap_my_to_ch);
4445         }
4446 }
4447
4448 static void
4449 sppp_pap_close(struct sppp *sp)
4450 {
4451         if (sp->state[IDX_PAP] != STATE_CLOSED)
4452                 sppp_cp_change_state(&pap, sp, STATE_CLOSED);
4453 }
4454
4455 /*
4456  * That's the timeout routine if we are authenticator.  Since the
4457  * authenticator is basically passive in PAP, we can't do much here.
4458  */
4459 static void
4460 sppp_pap_TO(void *cookie)
4461 {
4462         struct sppp *sp = (struct sppp *)cookie;
4463         STDDCL;
4464         int s;
4465
4466         s = splimp();
4467         if (debug)
4468                 log(LOG_DEBUG, SPP_FMT "pap TO(%s) rst_counter = %d\n",
4469                     SPP_ARGS(ifp),
4470                     sppp_state_name(sp->state[IDX_PAP]),
4471                     sp->rst_counter[IDX_PAP]);
4472
4473         if (--sp->rst_counter[IDX_PAP] < 0)
4474                 /* TO- event */
4475                 switch (sp->state[IDX_PAP]) {
4476                 case STATE_REQ_SENT:
4477                         pap.tld(sp);
4478                         sppp_cp_change_state(&pap, sp, STATE_CLOSED);
4479                         break;
4480                 }
4481         else
4482                 /* TO+ event, not very much we could do */
4483                 switch (sp->state[IDX_PAP]) {
4484                 case STATE_REQ_SENT:
4485                         /* sppp_cp_change_state() will restart the timer */
4486                         sppp_cp_change_state(&pap, sp, STATE_REQ_SENT);
4487                         break;
4488                 }
4489
4490         splx(s);
4491 }
4492
4493 /*
4494  * That's the timeout handler if we are peer.  Since the peer is active,
4495  * we need to retransmit our PAP request since it is apparently lost.
4496  * XXX We should impose a max counter.
4497  */
4498 static void
4499 sppp_pap_my_TO(void *cookie)
4500 {
4501         struct sppp *sp = (struct sppp *)cookie;
4502         STDDCL;
4503
4504         if (debug)
4505                 log(LOG_DEBUG, SPP_FMT "pap peer TO\n",
4506                     SPP_ARGS(ifp));
4507
4508         pap.scr(sp);
4509 }
4510
4511 static void
4512 sppp_pap_tlu(struct sppp *sp)
4513 {
4514         STDDCL;
4515         int x;
4516
4517         sp->rst_counter[IDX_PAP] = sp->lcp.max_configure;
4518
4519         if (debug)
4520                 log(LOG_DEBUG, SPP_FMT "%s tlu\n",
4521                     SPP_ARGS(ifp), pap.name);
4522
4523         x = splimp();
4524         /* indicate to LCP that we need to be closed down */
4525         sp->lcp.protos |= (1 << IDX_PAP);
4526
4527         if (sp->pp_flags & PP_NEEDAUTH) {
4528                 /*
4529                  * Remote is authenticator, but his auth proto didn't
4530                  * complete yet.  Defer the transition to network
4531                  * phase.
4532                  */
4533                 splx(x);
4534                 return;
4535         }
4536         splx(x);
4537         sppp_phase_network(sp);
4538 }
4539
4540 static void
4541 sppp_pap_tld(struct sppp *sp)
4542 {
4543         STDDCL;
4544
4545         if (debug)
4546                 log(LOG_DEBUG, SPP_FMT "pap tld\n", SPP_ARGS(ifp));
4547         UNTIMEOUT(pap.TO, (void *)sp, sp->ch[IDX_PAP]);
4548         UNTIMEOUT(sppp_pap_my_TO, (void *)sp, sp->pap_my_to_ch);
4549         sp->lcp.protos &= ~(1 << IDX_PAP);
4550
4551         lcp.Close(sp);
4552 }
4553
4554 static void
4555 sppp_pap_scr(struct sppp *sp)
4556 {
4557         u_char idlen, pwdlen;
4558
4559         sp->confid[IDX_PAP] = ++sp->pp_seq[IDX_PAP];
4560         pwdlen = sppp_strnlen(sp->myauth.secret, AUTHKEYLEN);
4561         idlen = sppp_strnlen(sp->myauth.name, AUTHNAMELEN);
4562
4563         sppp_auth_send(&pap, sp, PAP_REQ, sp->confid[IDX_PAP],
4564                        sizeof idlen, (const char *)&idlen,
4565                        (size_t)idlen, sp->myauth.name,
4566                        sizeof pwdlen, (const char *)&pwdlen,
4567                        (size_t)pwdlen, sp->myauth.secret,
4568                        0);
4569 }
4570
4571 /*
4572  * Random miscellaneous functions.
4573  */
4574
4575 /*
4576  * Send a PAP or CHAP proto packet.
4577  *
4578  * Varadic function, each of the elements for the ellipsis is of type
4579  * ``size_t mlen, const u_char *msg''.  Processing will stop iff
4580  * mlen == 0.
4581  * NOTE: never declare variadic functions with types subject to type
4582  * promotion (i.e. u_char). This is asking for big trouble depending
4583  * on the architecture you are on...
4584  */
4585
4586 static void
4587 sppp_auth_send(const struct cp *cp, struct sppp *sp,
4588                unsigned int type, unsigned int id,
4589                ...)
4590 {
4591         STDDCL;
4592         struct ppp_header *h;
4593         struct lcp_header *lh;
4594         struct mbuf *m;
4595         u_char *p;
4596         int len;
4597         unsigned int mlen;
4598         const char *msg;
4599         __va_list ap;
4600
4601         MGETHDR (m, MB_DONTWAIT, MT_DATA);
4602         if (! m)
4603                 return;
4604         m->m_pkthdr.rcvif = 0;
4605
4606         h = mtod (m, struct ppp_header*);
4607         h->address = PPP_ALLSTATIONS;           /* broadcast address */
4608         h->control = PPP_UI;                    /* Unnumbered Info */
4609         h->protocol = htons(cp->proto);
4610
4611         lh = (struct lcp_header*)(h + 1);
4612         lh->type = type;
4613         lh->ident = id;
4614         p = (u_char*) (lh+1);
4615
4616         __va_start(ap, id);
4617         len = 0;
4618
4619         while ((mlen = (unsigned int)__va_arg(ap, size_t)) != 0) {
4620                 msg = __va_arg(ap, const char *);
4621                 len += mlen;
4622                 if (len > MHLEN - PPP_HEADER_LEN - LCP_HEADER_LEN) {
4623                         __va_end(ap);
4624                         m_freem(m);
4625                         return;
4626                 }
4627
4628                 bcopy(msg, p, mlen);
4629                 p += mlen;
4630         }
4631         __va_end(ap);
4632
4633         m->m_pkthdr.len = m->m_len = PPP_HEADER_LEN + LCP_HEADER_LEN + len;
4634         lh->len = htons (LCP_HEADER_LEN + len);
4635
4636         if (debug) {
4637                 log(LOG_DEBUG, SPP_FMT "%s output <%s id=0x%x len=%d",
4638                     SPP_ARGS(ifp), cp->name,
4639                     sppp_auth_type_name(cp->proto, lh->type),
4640                     lh->ident, ntohs(lh->len));
4641                 sppp_print_bytes((u_char*) (lh+1), len);
4642                 addlog(">\n");
4643         }
4644         if (IF_QFULL (&sp->pp_cpq)) {
4645                 IF_DROP (&sp->pp_fastq);
4646                 IF_DROP (&ifp->if_snd);
4647                 m_freem (m);
4648                 ++ifp->if_oerrors;
4649         } else
4650                 IF_ENQUEUE (&sp->pp_cpq, m);
4651         if (! (ifp->if_flags & IFF_OACTIVE))
4652                 (*ifp->if_start) (ifp);
4653         ifp->if_obytes += m->m_pkthdr.len + 3;
4654 }
4655
4656 /*
4657  * Flush interface queue.
4658  */
4659 static void
4660 sppp_qflush(struct ifqueue *ifq)
4661 {
4662         struct mbuf *m, *n;
4663
4664         n = ifq->ifq_head;
4665         while ((m = n)) {
4666                 n = m->m_nextpkt;
4667                 m_freem (m);
4668         }
4669         ifq->ifq_head = 0;
4670         ifq->ifq_tail = 0;
4671         ifq->ifq_len = 0;
4672 }
4673
4674 /*
4675  * Send keepalive packets, every 10 seconds.
4676  */
4677 static void
4678 sppp_keepalive(void *dummy)
4679 {
4680         struct sppp *sp;
4681         int s;
4682
4683         s = splimp();
4684         for (sp=spppq; sp; sp=sp->pp_next) {
4685                 struct ifnet *ifp = &sp->pp_if;
4686
4687                 /* Keepalive mode disabled or channel down? */
4688                 if (! (sp->pp_flags & PP_KEEPALIVE) ||
4689                     ! (ifp->if_flags & IFF_RUNNING))
4690                         continue;
4691
4692                 /* No keepalive in PPP mode if LCP not opened yet. */
4693                 if (sp->pp_mode != IFF_CISCO &&
4694                     sp->pp_phase < PHASE_AUTHENTICATE)
4695                         continue;
4696
4697                 if (sp->pp_alivecnt == MAXALIVECNT) {
4698                         /* No keepalive packets got.  Stop the interface. */
4699                         printf (SPP_FMT "down\n", SPP_ARGS(ifp));
4700                         if_down (ifp);
4701                         sppp_qflush (&sp->pp_cpq);
4702                         if (sp->pp_mode != IFF_CISCO) {
4703                                 /* XXX */
4704                                 /* Shut down the PPP link. */
4705                                 lcp.Down(sp);
4706                                 /* Initiate negotiation. XXX */
4707                                 lcp.Up(sp);
4708                         }
4709                 }
4710                 if (sp->pp_alivecnt <= MAXALIVECNT)
4711                         ++sp->pp_alivecnt;
4712                 if (sp->pp_mode == IFF_CISCO)
4713                         sppp_cisco_send (sp, CISCO_KEEPALIVE_REQ,
4714                                  ++sp->pp_seq[IDX_LCP], sp->pp_rseq[IDX_LCP]);
4715                 else if (sp->pp_phase >= PHASE_AUTHENTICATE) {
4716                         long nmagic = htonl (sp->lcp.magic);
4717                         sp->lcp.echoid = ++sp->pp_seq[IDX_LCP];
4718                         sppp_cp_send (sp, PPP_LCP, ECHO_REQ,
4719                                 sp->lcp.echoid, 4, &nmagic);
4720                 }
4721         }
4722         splx(s);
4723         TIMEOUT(sppp_keepalive, 0, hz * 10, keepalive_ch);
4724 }
4725
4726 /*
4727  * Get both IP addresses.
4728  */
4729 static void
4730 sppp_get_ip_addrs(struct sppp *sp, u_long *src, u_long *dst, u_long *srcmask)
4731 {
4732         struct ifnet *ifp = &sp->pp_if;
4733         struct ifaddr *ifa;
4734         struct sockaddr_in *si, *sm;
4735         u_long ssrc, ddst;
4736
4737         sm = NULL;
4738         ssrc = ddst = 0L;
4739         /*
4740          * Pick the first AF_INET address from the list,
4741          * aliases don't make any sense on a p2p link anyway.
4742          */
4743         si = 0;
4744 #if defined(__DragonFly__)
4745         TAILQ_FOREACH(ifa, &ifp->if_addrhead, ifa_link)
4746 #elif defined(__NetBSD__) || defined (__OpenBSD__)
4747         for (ifa = ifp->if_addrlist.tqh_first;
4748              ifa;
4749              ifa = ifa->ifa_list.tqe_next)
4750 #else
4751         for (ifa = ifp->if_addrlist;
4752              ifa;
4753              ifa = ifa->ifa_next)
4754 #endif
4755                 if (ifa->ifa_addr->sa_family == AF_INET) {
4756                         si = (struct sockaddr_in *)ifa->ifa_addr;
4757                         sm = (struct sockaddr_in *)ifa->ifa_netmask;
4758                         if (si)
4759                                 break;
4760                 }
4761         if (ifa) {
4762                 if (si && si->sin_addr.s_addr) {
4763                         ssrc = si->sin_addr.s_addr;
4764                         if (srcmask)
4765                                 *srcmask = ntohl(sm->sin_addr.s_addr);
4766                 }
4767
4768                 si = (struct sockaddr_in *)ifa->ifa_dstaddr;
4769                 if (si && si->sin_addr.s_addr)
4770                         ddst = si->sin_addr.s_addr;
4771         }
4772
4773         if (dst) *dst = ntohl(ddst);
4774         if (src) *src = ntohl(ssrc);
4775 }
4776
4777 /*
4778  * Set my IP address.  Must be called at splimp.
4779  */
4780 static void
4781 sppp_set_ip_addr(struct sppp *sp, u_long src)
4782 {
4783         STDDCL;
4784         struct ifaddr *ifa;
4785         struct sockaddr_in *si;
4786         struct in_ifaddr *ia;
4787
4788         /*
4789          * Pick the first AF_INET address from the list,
4790          * aliases don't make any sense on a p2p link anyway.
4791          */
4792         si = 0;
4793 #if defined(__DragonFly__)
4794         TAILQ_FOREACH(ifa, &ifp->if_addrhead, ifa_link)
4795 #elif defined(__NetBSD__) || defined (__OpenBSD__)
4796         for (ifa = ifp->if_addrlist.tqh_first;
4797              ifa;
4798              ifa = ifa->ifa_list.tqe_next)
4799 #else
4800         for (ifa = ifp->if_addrlist;
4801              ifa;
4802              ifa = ifa->ifa_next)
4803 #endif
4804         {
4805                 if (ifa->ifa_addr->sa_family == AF_INET)
4806                 {
4807                         si = (struct sockaddr_in *)ifa->ifa_addr;
4808                         if (si)
4809                                 break;
4810                 }
4811         }
4812
4813         if (ifa && si)
4814         {
4815                 int error;
4816 #if __NetBSD_Version__ >= 103080000
4817                 struct sockaddr_in new_sin = *si;
4818
4819                 new_sin.sin_addr.s_addr = htonl(src);
4820                 error = in_ifinit(ifp, ifatoia(ifa), &new_sin, 1);
4821                 if(debug && error)
4822                 {
4823                         log(LOG_DEBUG, SPP_FMT "sppp_set_ip_addr: in_ifinit "
4824                         " failed, error=%d\n", SPP_ARGS(ifp), error);
4825                 }
4826 #else
4827                 /* delete old route */
4828                 error = rtinit(ifa, (int)RTM_DELETE, RTF_HOST);
4829                 if(debug && error)
4830                 {
4831                         log(LOG_DEBUG, SPP_FMT "sppp_set_ip_addr: rtinit DEL failed, error=%d\n",
4832                                 SPP_ARGS(ifp), error);
4833                 }
4834
4835                 /* set new address */
4836                 si->sin_addr.s_addr = htonl(src);
4837                 ia = ifatoia(ifa);
4838                 LIST_REMOVE(ia, ia_hash);
4839                 LIST_INSERT_HEAD(INADDR_HASH(si->sin_addr.s_addr), ia, ia_hash);
4840
4841                 /* add new route */
4842                 error = rtinit(ifa, (int)RTM_ADD, RTF_HOST);
4843                 if (debug && error)
4844                 {
4845                         log(LOG_DEBUG, SPP_FMT "sppp_set_ip_addr: rtinit ADD failed, error=%d",
4846                                 SPP_ARGS(ifp), error);
4847                 }
4848 #endif
4849         }
4850 }
4851
4852 #ifdef INET6
4853 /*
4854  * Get both IPv6 addresses.
4855  */
4856 static void
4857 sppp_get_ip6_addrs(struct sppp *sp, struct in6_addr *src, struct in6_addr *dst,
4858                    struct in6_addr *srcmask)
4859 {
4860         struct ifnet *ifp = &sp->pp_if;
4861         struct ifaddr *ifa;
4862         struct sockaddr_in6 *si, *sm;
4863         struct in6_addr ssrc, ddst;
4864
4865         sm = NULL;
4866         bzero(&ssrc, sizeof(ssrc));
4867         bzero(&ddst, sizeof(ddst));
4868         /*
4869          * Pick the first link-local AF_INET6 address from the list,
4870          * aliases don't make any sense on a p2p link anyway.
4871          */
4872 #if defined(__DragonFly__)
4873         for (ifa = ifp->if_addrhead.tqh_first, si = 0;
4874              ifa;
4875              ifa = ifa->ifa_link.tqe_next)
4876 #elif defined(__NetBSD__) || defined (__OpenBSD__)
4877         for (ifa = ifp->if_addrlist.tqh_first, si = 0;
4878              ifa;
4879              ifa = ifa->ifa_list.tqe_next)
4880 #else
4881         for (ifa = ifp->if_addrlist, si = 0;
4882              ifa;
4883              ifa = ifa->ifa_next)
4884 #endif
4885                 if (ifa->ifa_addr->sa_family == AF_INET6) {
4886                         si = (struct sockaddr_in6 *)ifa->ifa_addr;
4887                         sm = (struct sockaddr_in6 *)ifa->ifa_netmask;
4888                         if (si && IN6_IS_ADDR_LINKLOCAL(&si->sin6_addr))
4889                                 break;
4890                 }
4891         if (ifa) {
4892                 if (si && !IN6_IS_ADDR_UNSPECIFIED(&si->sin6_addr)) {
4893                         bcopy(&si->sin6_addr, &ssrc, sizeof(ssrc));
4894                         if (srcmask) {
4895                                 bcopy(&sm->sin6_addr, srcmask,
4896                                       sizeof(*srcmask));
4897                         }
4898                 }
4899
4900                 si = (struct sockaddr_in6 *)ifa->ifa_dstaddr;
4901                 if (si && !IN6_IS_ADDR_UNSPECIFIED(&si->sin6_addr))
4902                         bcopy(&si->sin6_addr, &ddst, sizeof(ddst));
4903         }
4904
4905         if (dst)
4906                 bcopy(&ddst, dst, sizeof(*dst));
4907         if (src)
4908                 bcopy(&ssrc, src, sizeof(*src));
4909 }
4910
4911 #ifdef IPV6CP_MYIFID_DYN
4912 /*
4913  * Generate random ifid.
4914  */
4915 static void
4916 sppp_gen_ip6_addr(struct sppp *sp, struct in6_addr *addr)
4917 {
4918         /* TBD */
4919 }
4920
4921 /*
4922  * Set my IPv6 address.  Must be called at splimp.
4923  */
4924 static void
4925 sppp_set_ip6_addr(struct sppp *sp, const struct in6_addr *src)
4926 {
4927         STDDCL;
4928         struct ifaddr *ifa;
4929         struct sockaddr_in6 *sin6;
4930
4931         /*
4932          * Pick the first link-local AF_INET6 address from the list,
4933          * aliases don't make any sense on a p2p link anyway.
4934          */
4935
4936         sin6 = NULL;
4937 #if defined(__DragonFly__)
4938         for (ifa = ifp->if_addrhead.tqh_first;
4939              ifa;
4940              ifa = ifa->ifa_link.tqe_next)
4941 #elif defined(__NetBSD__) || defined (__OpenBSD__)
4942         for (ifa = ifp->if_addrlist.tqh_first;
4943              ifa;
4944              ifa = ifa->ifa_list.tqe_next)
4945 #else
4946         for (ifa = ifp->if_addrlist; ifa; ifa = ifa->ifa_next)
4947 #endif
4948         {
4949                 if (ifa->ifa_addr->sa_family == AF_INET6)
4950                 {
4951                         sin6 = (struct sockaddr_in6 *)ifa->ifa_addr;
4952                         if (sin6 && IN6_IS_ADDR_LINKLOCAL(&sin6->sin6_addr))
4953                                 break;
4954                 }
4955         }
4956
4957         if (ifa && sin6)
4958         {
4959                 int error;
4960                 struct sockaddr_in6 new_sin6 = *sin6;
4961
4962                 bcopy(src, &new_sin6.sin6_addr, sizeof(new_sin6.sin6_addr));
4963                 error = in6_ifinit(ifp, ifatoia6(ifa), &new_sin6, 1);
4964                 if (debug && error)
4965                 {
4966                         log(LOG_DEBUG, SPP_FMT "sppp_set_ip6_addr: in6_ifinit "
4967                             " failed, error=%d\n", SPP_ARGS(ifp), error);
4968                 }
4969         }
4970 }
4971 #endif
4972
4973 /*
4974  * Suggest a candidate address to be used by peer.
4975  */
4976 static void
4977 sppp_suggest_ip6_addr(struct sppp *sp, struct in6_addr *suggest)
4978 {
4979         struct in6_addr myaddr;
4980         struct timeval tv;
4981
4982         sppp_get_ip6_addrs(sp, &myaddr, 0, 0);
4983
4984         myaddr.s6_addr[8] &= ~0x02;     /* u bit to "local" */
4985         microtime(&tv);
4986         if ((tv.tv_usec & 0xff) == 0 && (tv.tv_sec & 0xff) == 0) {
4987                 myaddr.s6_addr[14] ^= 0xff;
4988                 myaddr.s6_addr[15] ^= 0xff;
4989         } else {
4990                 myaddr.s6_addr[14] ^= (tv.tv_usec & 0xff);
4991                 myaddr.s6_addr[15] ^= (tv.tv_sec & 0xff);
4992         }
4993         if (suggest)
4994                 bcopy(&myaddr, suggest, sizeof(myaddr));
4995 }
4996 #endif /*INET6*/
4997
4998 static int
4999 sppp_params(struct sppp *sp, u_long cmd, void *data)
5000 {
5001         u_long subcmd;
5002         struct ifreq *ifr = (struct ifreq *)data;
5003         struct spppreq *spr;
5004         int rv = 0;
5005
5006         spr = malloc(sizeof(struct spppreq), M_TEMP, M_INTWAIT);
5007
5008         /*
5009          * ifr->ifr_data is supposed to point to a struct spppreq.
5010          * Check the cmd word first before attempting to fetch all the
5011          * data.
5012          */
5013         if ((subcmd = fuword(ifr->ifr_data)) == -1) {
5014                 rv = EFAULT;
5015                 goto quit;
5016         }
5017
5018         if (copyin((caddr_t)ifr->ifr_data, spr, sizeof(struct spppreq)) != 0) {
5019                 rv = EFAULT;
5020                 goto quit;
5021         }
5022
5023         switch (subcmd) {
5024         case (int)SPPPIOGDEFS:
5025                 if (cmd != SIOCGIFGENERIC) {
5026                         rv = EINVAL;
5027                         break;
5028                 }
5029                 /*
5030                  * We copy over the entire current state, but clean
5031                  * out some of the stuff we don't wanna pass up.
5032                  * Remember, SIOCGIFGENERIC is unprotected, and can be
5033                  * called by any user.  No need to ever get PAP or
5034                  * CHAP secrets back to userland anyway.
5035                  */
5036                 spr->defs.pp_phase = sp->pp_phase;
5037                 spr->defs.enable_vj = (sp->confflags & CONF_ENABLE_VJ) != 0;
5038                 spr->defs.enable_ipv6 = (sp->confflags & CONF_ENABLE_IPV6) != 0;
5039                 spr->defs.lcp = sp->lcp;
5040                 spr->defs.ipcp = sp->ipcp;
5041                 spr->defs.ipv6cp = sp->ipv6cp;
5042                 spr->defs.myauth = sp->myauth;
5043                 spr->defs.hisauth = sp->hisauth;
5044                 bzero(spr->defs.myauth.secret, AUTHKEYLEN);
5045                 bzero(spr->defs.myauth.challenge, AUTHKEYLEN);
5046                 bzero(spr->defs.hisauth.secret, AUTHKEYLEN);
5047                 bzero(spr->defs.hisauth.challenge, AUTHKEYLEN);
5048                 /*
5049                  * Fixup the LCP timeout value to milliseconds so
5050                  * spppcontrol doesn't need to bother about the value
5051                  * of "hz".  We do the reverse calculation below when
5052                  * setting it.
5053                  */
5054                 spr->defs.lcp.timeout = sp->lcp.timeout * 1000 / hz;
5055                 rv = copyout(spr, (caddr_t)ifr->ifr_data,
5056                              sizeof(struct spppreq));
5057                 break;
5058
5059         case (int)SPPPIOSDEFS:
5060                 if (cmd != SIOCSIFGENERIC) {
5061                         rv = EINVAL;
5062                         break;
5063                 }
5064                 /*
5065                  * We have a very specific idea of which fields we
5066                  * allow being passed back from userland, so to not
5067                  * clobber our current state.  For one, we only allow
5068                  * setting anything if LCP is in dead or establish
5069                  * phase.  Once the authentication negotiations
5070                  * started, the authentication settings must not be
5071                  * changed again.  (The administrator can force an
5072                  * ifconfig down in order to get LCP back into dead
5073                  * phase.)
5074                  *
5075                  * Also, we only allow for authentication parameters to be
5076                  * specified.
5077                  *
5078                  * XXX Should allow to set or clear pp_flags.
5079                  *
5080                  * Finally, if the respective authentication protocol to
5081                  * be used is set differently than 0, but the secret is
5082                  * passed as all zeros, we don't trash the existing secret.
5083                  * This allows an administrator to change the system name
5084                  * only without clobbering the secret (which he didn't get
5085                  * back in a previous SPPPIOGDEFS call).  However, the
5086                  * secrets are cleared if the authentication protocol is
5087                  * reset to 0.  */
5088                 if (sp->pp_phase != PHASE_DEAD &&
5089                     sp->pp_phase != PHASE_ESTABLISH) {
5090                         rv = EBUSY;
5091                         break;
5092                 }
5093
5094                 if ((spr->defs.myauth.proto != 0 && spr->defs.myauth.proto != PPP_PAP &&
5095                      spr->defs.myauth.proto != PPP_CHAP) ||
5096                     (spr->defs.hisauth.proto != 0 && spr->defs.hisauth.proto != PPP_PAP &&
5097                      spr->defs.hisauth.proto != PPP_CHAP)) {
5098                         rv = EINVAL;
5099                         break;
5100                 }
5101
5102                 if (spr->defs.myauth.proto == 0)
5103                         /* resetting myauth */
5104                         bzero(&sp->myauth, sizeof sp->myauth);
5105                 else {
5106                         /* setting/changing myauth */
5107                         sp->myauth.proto = spr->defs.myauth.proto;
5108                         bcopy(spr->defs.myauth.name, sp->myauth.name, AUTHNAMELEN);
5109                         if (spr->defs.myauth.secret[0] != '\0')
5110                                 bcopy(spr->defs.myauth.secret, sp->myauth.secret,
5111                                       AUTHKEYLEN);
5112                 }
5113                 if (spr->defs.hisauth.proto == 0)
5114                         /* resetting hisauth */
5115                         bzero(&sp->hisauth, sizeof sp->hisauth);
5116                 else {
5117                         /* setting/changing hisauth */
5118                         sp->hisauth.proto = spr->defs.hisauth.proto;
5119                         sp->hisauth.flags = spr->defs.hisauth.flags;
5120                         bcopy(spr->defs.hisauth.name, sp->hisauth.name, AUTHNAMELEN);
5121                         if (spr->defs.hisauth.secret[0] != '\0')
5122                                 bcopy(spr->defs.hisauth.secret, sp->hisauth.secret,
5123                                       AUTHKEYLEN);
5124                 }
5125                 /* set LCP restart timer timeout */
5126                 if (spr->defs.lcp.timeout != 0)
5127                         sp->lcp.timeout = spr->defs.lcp.timeout * hz / 1000;
5128                 /* set VJ enable and IPv6 disable flags */
5129 #ifdef INET
5130                 if (spr->defs.enable_vj)
5131                         sp->confflags |= CONF_ENABLE_VJ;
5132                 else
5133                         sp->confflags &= ~CONF_ENABLE_VJ;
5134 #endif
5135 #ifdef INET6
5136                 if (spr->defs.enable_ipv6)
5137                         sp->confflags |= CONF_ENABLE_IPV6;
5138                 else
5139                         sp->confflags &= ~CONF_ENABLE_IPV6;
5140 #endif
5141                 break;
5142
5143         default:
5144                 rv = EINVAL;
5145         }
5146
5147  quit:
5148         free(spr, M_TEMP);
5149
5150         return (rv);
5151 }
5152
5153 static void
5154 sppp_phase_network(struct sppp *sp)
5155 {
5156         STDDCL;
5157         int i;
5158         u_long mask;
5159
5160         sp->pp_phase = PHASE_NETWORK;
5161
5162         if (debug)
5163                 log(LOG_DEBUG, SPP_FMT "phase %s\n", SPP_ARGS(ifp),
5164                     sppp_phase_name(sp->pp_phase));
5165
5166         /* Notify NCPs now. */
5167         for (i = 0; i < IDX_COUNT; i++)
5168                 if ((cps[i])->flags & CP_NCP)
5169                         (cps[i])->Open(sp);
5170
5171         /* Send Up events to all NCPs. */
5172         for (i = 0, mask = 1; i < IDX_COUNT; i++, mask <<= 1)
5173                 if ((sp->lcp.protos & mask) && ((cps[i])->flags & CP_NCP))
5174                         (cps[i])->Up(sp);
5175
5176         /* if no NCP is starting, all this was in vain, close down */
5177         sppp_lcp_check_and_close(sp);
5178 }
5179
5180
5181 static const char *
5182 sppp_cp_type_name(u_char type)
5183 {
5184         static char buf[12];
5185         switch (type) {
5186         case CONF_REQ:   return "conf-req";
5187         case CONF_ACK:   return "conf-ack";
5188         case CONF_NAK:   return "conf-nak";
5189         case CONF_REJ:   return "conf-rej";
5190         case TERM_REQ:   return "term-req";
5191         case TERM_ACK:   return "term-ack";
5192         case CODE_REJ:   return "code-rej";
5193         case PROTO_REJ:  return "proto-rej";
5194         case ECHO_REQ:   return "echo-req";
5195         case ECHO_REPLY: return "echo-reply";
5196         case DISC_REQ:   return "discard-req";
5197         }
5198         snprintf (buf, sizeof(buf), "cp/0x%x", type);
5199         return buf;
5200 }
5201
5202 static const char *
5203 sppp_auth_type_name(u_short proto, u_char type)
5204 {
5205         static char buf[12];
5206         switch (proto) {
5207         case PPP_CHAP:
5208                 switch (type) {
5209                 case CHAP_CHALLENGE:    return "challenge";
5210                 case CHAP_RESPONSE:     return "response";
5211                 case CHAP_SUCCESS:      return "success";
5212                 case CHAP_FAILURE:      return "failure";
5213                 }
5214         case PPP_PAP:
5215                 switch (type) {
5216                 case PAP_REQ:           return "req";
5217                 case PAP_ACK:           return "ack";
5218                 case PAP_NAK:           return "nak";
5219                 }
5220         }
5221         snprintf (buf, sizeof(buf), "auth/0x%x", type);
5222         return buf;
5223 }
5224
5225 static const char *
5226 sppp_lcp_opt_name(u_char opt)
5227 {
5228         static char buf[12];
5229         switch (opt) {
5230         case LCP_OPT_MRU:               return "mru";
5231         case LCP_OPT_ASYNC_MAP:         return "async-map";
5232         case LCP_OPT_AUTH_PROTO:        return "auth-proto";
5233         case LCP_OPT_QUAL_PROTO:        return "qual-proto";
5234         case LCP_OPT_MAGIC:             return "magic";
5235         case LCP_OPT_PROTO_COMP:        return "proto-comp";
5236         case LCP_OPT_ADDR_COMP:         return "addr-comp";
5237         }
5238         snprintf (buf, sizeof(buf), "lcp/0x%x", opt);
5239         return buf;
5240 }
5241
5242 static const char *
5243 sppp_ipcp_opt_name(u_char opt)
5244 {
5245         static char buf[12];
5246         switch (opt) {
5247         case IPCP_OPT_ADDRESSES:        return "addresses";
5248         case IPCP_OPT_COMPRESSION:      return "compression";
5249         case IPCP_OPT_ADDRESS:          return "address";
5250         }
5251         snprintf (buf, sizeof(buf), "ipcp/0x%x", opt);
5252         return buf;
5253 }
5254
5255 #ifdef INET6
5256 static const char *
5257 sppp_ipv6cp_opt_name(u_char opt)
5258 {
5259         static char buf[12];
5260         switch (opt) {
5261         case IPV6CP_OPT_IFID:           return "ifid";
5262         case IPV6CP_OPT_COMPRESSION:    return "compression";
5263         }
5264         sprintf (buf, "0x%x", opt);
5265         return buf;
5266 }
5267 #endif
5268
5269 static const char *
5270 sppp_state_name(int state)
5271 {
5272         switch (state) {
5273         case STATE_INITIAL:     return "initial";
5274         case STATE_STARTING:    return "starting";
5275         case STATE_CLOSED:      return "closed";
5276         case STATE_STOPPED:     return "stopped";
5277         case STATE_CLOSING:     return "closing";
5278         case STATE_STOPPING:    return "stopping";
5279         case STATE_REQ_SENT:    return "req-sent";
5280         case STATE_ACK_RCVD:    return "ack-rcvd";
5281         case STATE_ACK_SENT:    return "ack-sent";
5282         case STATE_OPENED:      return "opened";
5283         }
5284         return "illegal";
5285 }
5286
5287 static const char *
5288 sppp_phase_name(enum ppp_phase phase)
5289 {
5290         switch (phase) {
5291         case PHASE_DEAD:        return "dead";
5292         case PHASE_ESTABLISH:   return "establish";
5293         case PHASE_TERMINATE:   return "terminate";
5294         case PHASE_AUTHENTICATE: return "authenticate";
5295         case PHASE_NETWORK:     return "network";
5296         }
5297         return "illegal";
5298 }
5299
5300 static const char *
5301 sppp_proto_name(u_short proto)
5302 {
5303         static char buf[12];
5304         switch (proto) {
5305         case PPP_LCP:   return "lcp";
5306         case PPP_IPCP:  return "ipcp";
5307         case PPP_PAP:   return "pap";
5308         case PPP_CHAP:  return "chap";
5309         case PPP_IPV6CP: return "ipv6cp";
5310         }
5311         snprintf(buf, sizeof(buf), "proto/0x%x", (unsigned)proto);
5312         return buf;
5313 }
5314
5315 static void
5316 sppp_print_bytes(const u_char *p, u_short len)
5317 {
5318         if (len)
5319                 addlog(" %*D", len, p, "-");
5320 }
5321
5322 static void
5323 sppp_print_string(const char *p, u_short len)
5324 {
5325         u_char c;
5326
5327         while (len-- > 0) {
5328                 c = *p++;
5329                 /*
5330                  * Print only ASCII chars directly.  RFC 1994 recommends
5331                  * using only them, but we don't rely on it.  */
5332                 if (c < ' ' || c > '~')
5333                         addlog("\\x%x", c);
5334                 else
5335                         addlog("%c", c);
5336         }
5337 }
5338
5339 static const char *
5340 sppp_dotted_quad(u_long addr)
5341 {
5342         static char s[16];
5343         sprintf(s, "%d.%d.%d.%d",
5344                 (int)((addr >> 24) & 0xff),
5345                 (int)((addr >> 16) & 0xff),
5346                 (int)((addr >> 8) & 0xff),
5347                 (int)(addr & 0xff));
5348         return s;
5349 }
5350
5351 static int
5352 sppp_strnlen(u_char *p, int max)
5353 {
5354         int len;
5355
5356         for (len = 0; len < max && *p; ++p)
5357                 ++len;
5358         return len;
5359 }
5360
5361 /* a dummy, used to drop uninteresting events */
5362 static void
5363 sppp_null(struct sppp *unused)
5364 {
5365         /* do just nothing */
5366 }