chiark - git - mdw - tripe/blob - server/peer.c

   1 /* -*-c-*-
   2  *
   3  * Communication with the peer
   4  *
   5  * (c) 2001 Straylight/Edgeware
   6  */
   7
   8 /*----- Licensing notice --------------------------------------------------*
   9  *
  10  * This file is part of Trivial IP Encryption (TrIPE).
  11  *
  12  * TrIPE is free software; you can redistribute it and/or modify
  13  * it under the terms of the GNU General Public License as published by
  14  * the Free Software Foundation; either version 2 of the License, or
  15  * (at your option) any later version.
  16  *
  17  * TrIPE is distributed in the hope that it will be useful,
  18  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  19  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  20  * GNU General Public License for more details.
  21  *
  22  * You should have received a copy of the GNU General Public License
  23  * along with TrIPE; if not, write to the Free Software Foundation,
  24  * Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
  25  */
  26
  27 /*----- Header files ------------------------------------------------------*/
  28
  29 #include "tripe.h"
  30
  31 /*----- Static variables --------------------------------------------------*/
  32
  33 static sym_table byname;
  34 static addrmap byaddr;
  35 static sel_file sock;
  36 static unsigned nmobile;
  37
  38 /*----- Tunnel table ------------------------------------------------------*/
  39
  40 const tunnel_ops *tunnels[] = {
  41 #ifdef TUN_LINUX
  42   &tun_linux,
  43 #endif
  44 #ifdef TUN_BSD
  45   &tun_bsd,
  46 #endif
  47 #ifdef TUN_UNET
  48   &tun_unet,
  49 #endif
  50   &tun_slip,
  51   0
  52 }, *tun_default;
  53
  54 /*----- Main code ---------------------------------------------------------*/
  55
  56 /* --- @p_pingtype@ --- *
  57  *
  58  * Arguments:   @unsigned msg@ = message type
  59  *
  60  * Returns:     String to describe the message.
  61  */
  62
  63 static const char *p_pingtype(unsigned msg)
  64 {
  65   switch (msg & MSG_TYPEMASK) {
  66     case MISC_PING:
  67     case MISC_PONG:
  68       return "transport-ping";
  69     case MISC_EPING:
  70     case MISC_EPONG:
  71       return "encrypted-ping";
  72     default:
  73       abort();
  74   }
  75 }
  76
  77 /* --- @p_ponged@ --- *
  78  *
  79  * Arguments:   @peer *p@ = peer packet arrived from
  80  *              @unsigned msg@ = message type
  81  *              @buf *b@ = buffer containing payload
  82  *
  83  * Returns:     ---
  84  *
  85  * Use:         Processes a ping response.
  86  */
  87
  88 static void p_ponged(peer *p, unsigned msg, buf *b)
  89 {
  90   uint32 id;
  91   const octet *magic;
  92   ping *pg;
  93
  94   IF_TRACING(T_PEER, {
  95     trace(T_PEER, "peer: received %s reply from %s",
  96           p_pingtype(msg), p->spec.name);
  97     trace_block(T_PACKET, "peer: ping contents", BBASE(b), BSZ(b));
  98   })
  99
 100   if (buf_getu32(b, &id) ||
 101       (magic = buf_get(b, sizeof(pg->magic))) == 0 ||
 102       BLEFT(b)) {
 103     a_warn("PEER", "?PEER", p, "malformed-%s", p_pingtype(msg), A_END);
 104     return;
 105   }
 106
 107   for (pg = p->pings; pg; pg = pg->next) {
 108     if (pg->id == id)
 109       goto found;
 110   }
 111   a_warn("PEER",
 112          "?PEER", p,
 113          "unexpected-%s", p_pingtype(msg),
 114          "0x%08lx", (unsigned long)id,
 115          A_END);
 116   return;
 117
 118 found:
 119   if (memcmp(magic, pg->magic, sizeof(pg->magic)) != 0) {
 120     a_warn("PEER", "?PEER", p, "corrupt-%s", p_pingtype(msg), A_END);
 121     return;
 122   }
 123   p_pingdone(pg, PING_OK);
 124 }
 125
 126 /* --- @p_rxupdstats@ --- *
 127  *
 128  * Arguments:   @peer *p@ = peer to update
 129  *              @size_t n@ = size of incoming packet
 130  *
 131  * Returns:     ---
 132  *
 133  * Use:         Updates the peer's incoming packet statistics.
 134  */
 135
 136 static void p_rxupdstats(peer *p, size_t n)
 137 {
 138   p->st.t_last = time(0);
 139   p->st.n_in++;
 140   p->st.sz_in += n;
 141 }
 142
 143 /* --- @p_encrypt@ --- *
 144  *
 145  * Arguments:   @peer *p@ = peer to encrypt message to
 146  *              @int ty@ message type to send
 147  *              @buf *bin, *bout@ = input and output buffers
 148  *
 149  * Returns:     ---
 150  *
 151  * Use:         Convenience function for packet encryption.  Forces
 152  *              renegotiation when necessary.  Check for the output buffer
 153  *              being broken to find out whether the encryption was
 154  *              successful.
 155  */
 156
 157 static int p_encrypt(peer *p, int ty, buf *bin, buf *bout)
 158 {
 159   int err = ksl_encrypt(&p->ks, ty, bin, bout);
 160
 161   if (err == KSERR_REGEN) {
 162     kx_start(&p->kx, 1);
 163     err = 0;
 164   }
 165   if (!BOK(bout))
 166     err = -1;
 167   return (err);
 168 }
 169
 170 /* --- @p_decrypt@ --- *
 171  *
 172  * Arguments:   @peer **pp@ = pointer to peer to decrypt message from
 173  *              @addr *a@ = address the packet arrived on
 174  *              @size_t n@ = size of original incoming packet
 175  *              @int ty@ = message type to expect
 176  *              @buf *bin, *bout@ = input and output buffers
 177  *
 178  * Returns:     Zero on success; nonzero on error.
 179  *
 180  * Use:         Convenience function for packet decryption.  Reports errors
 181  *              and updates statistics appropriately.
 182  *
 183  *              If @*pp@ is null on entry and there are mobile peers then we
 184  *              see if any of them can decrypt the packet.  If so, we record
 185  *              @*a@ as the peer's new address and send a notification.
 186  */
 187
 188 static int p_decrypt(peer **pp, addr *a, size_t n,
 189                      int ty, buf *bin, buf *bout)
 190 {
 191   peer *p;
 192   peer_byaddr *pa;
 193   int err = KSERR_DECRYPT;
 194   unsigned f;
 195
 196   if (*pp) {
 197     p = *pp;
 198     T( trace(T_PEER, "peer: decrypting packet from known peer `%s'",
 199              p_name(p)); )
 200     err = ksl_decrypt(&p->ks, ty, bin, bout);
 201   } else {
 202     p = 0;
 203     if (nmobile) {
 204       T( trace(T_PEER, "peer: unknown source: trying mobile peers..."); )
 205       FOREACH_PEER(q, {
 206         if (!(q->spec.f & PSF_MOBILE)) continue;
 207         if ((err = ksl_decrypt(&q->ks, ty, bin, bout)) == KSERR_DECRYPT) {
 208           T( trace(T_PEER, "peer: peer `%s' failed to decrypt",
 209                    p_name(q)); )
 210           continue;
 211         } else {
 212           p = *pp = q;
 213           IF_TRACING(T_PEER, {
 214             if (!err)
 215               trace(T_PEER, "peer: peer `%s' reports success", p_name(p));
 216             else {
 217               trace(T_PEER, "peer: peer `%s' reports decryption error %d",
 218                     p_name(p), err);
 219             }
 220           })
 221           break;
 222         }
 223       });
 224     }
 225     if (!p) {
 226       a_warn("PEER", "-", "unexpected-source", "?ADDR", a, A_END);
 227       return (-1);
 228     }
 229     if (!err) {
 230       T( trace(T_PEER, "peer: updating address for `%s'", p_name(p)); )
 231       pa = am_find(&byaddr, a, sizeof(peer_byaddr), &f); assert(!f);
 232       am_remove(&byaddr, p->byaddr);
 233       p->byaddr = pa;
 234       pa->p = p;
 235       p->spec.sa = *a;
 236       a_notify("NEWADDR", "?PEER", p, "?ADDR", a, A_END);
 237     }
 238   }
 239   p_rxupdstats(p, n);
 240   if (err) {
 241     if (p) p->st.n_reject++;
 242     a_warn("PEER", "?PEER", p, "decrypt-failed",
 243            "error-code", "%d", err, A_END);
 244     return (-1);
 245   }
 246   if (!BOK(bout))
 247     return (-1);
 248   return (0);
 249 }
 250
 251 /* --- @p_read@ --- *
 252  *
 253  * Arguments:   @int fd@ = file descriptor to read from
 254  *              @unsigned mode@ = what happened
 255  *              @void *v@ = an uninteresting pointer
 256  *
 257  * Returns:     ---
 258  *
 259  * Use:         Reads a packet from somewhere.
 260  */
 261
 262 static void p_read(int fd, unsigned mode, void *v)
 263 {
 264   peer *p = 0;
 265   addr a;
 266   size_t sz;
 267   ssize_t n;
 268   int ch;
 269   buf b, bb;
 270
 271   /* --- Read the data --- */
 272
 273   TIMER;
 274   sz = sizeof(addr);
 275   n = recvfrom(fd, buf_i, sizeof(buf_i), 0, &a.sa, &sz);
 276   if (n < 0) {
 277     a_warn("PEER", "-", "socket-read-error", "?ERRNO", A_END);
 278     return;
 279   }
 280
 281   /* --- If the packet is a greeting, don't check peers --- */
 282
 283   if (n && buf_i[0] == (MSG_MISC | MISC_GREET)) {
 284     IF_TRACING(T_PEER, {
 285       trace(T_PEER, "peer: greeting received from INET %s %u",
 286             inet_ntoa(a.sin.sin_addr),
 287             (unsigned)ntohs(a.sin.sin_port));
 288       trace_block(T_PACKET, "peer: greeting contents", buf_i, n);
 289     })
 290     buf_init(&b, buf_i, n);
 291     buf_getbyte(&b);
 292     if (c_check(&b) || BLEFT(&b)) {
 293       a_warn("PEER", "-", "invalid-greeting", A_END);
 294       return;
 295     }
 296     a_notify("GREET",
 297              "?B64", buf_i + 1, (size_t)(n - 1),
 298              "?ADDR", &a,
 299              A_END);
 300     return;
 301   }
 302
 303   /* --- Find the appropriate peer --- *
 304    *
 305    * At this stage, don't worry too much about whether we actually found it.
 306    */
 307
 308   p = p_findbyaddr(&a);
 309
 310   IF_TRACING(T_PEER, {
 311     if (p) {
 312       trace(T_PEER,
 313             "peer: packet received from `%s' from address INET %s %d",
 314             p_name(p), inet_ntoa(a.sin.sin_addr), ntohs(a.sin.sin_port));
 315     } else {
 316       trace(T_PEER, "peer: packet received from unknown address INET %s %d",
 317             inet_ntoa(a.sin.sin_addr), ntohs(a.sin.sin_port));
 318     }
 319     trace_block(T_PACKET, "peer: packet contents", buf_i, n);
 320   })
 321
 322   /* --- Pick the packet apart --- */
 323
 324   buf_init(&b, buf_i, n);
 325   if ((ch = buf_getbyte(&b)) < 0) {
 326     a_warn("PEER", "?PEER", p, "bad-packet", "no-type", A_END);
 327     return;
 328   }
 329   switch (ch & MSG_CATMASK) {
 330     case MSG_PACKET:
 331       if (ch & MSG_TYPEMASK) {
 332         a_warn("PEER",
 333                "?PEER", p,
 334                "bad-packet",
 335                "unknown-type", "0x%02x", ch,
 336                A_END);
 337         if (p) p->st.n_reject++;
 338         return;
 339       }
 340       buf_init(&bb, buf_o, sizeof(buf_o));
 341       if (p_decrypt(&p, &a, n, MSG_PACKET, &b, &bb))
 342         return;
 343       if (BOK(&bb)) {
 344         p->st.n_ipin++;
 345         p->st.sz_ipin += BSZ(&b);
 346         p->t->ops->inject(p->t, &bb);
 347       } else {
 348         p->st.n_reject++;
 349         a_warn("PEER", "?PEER", p, "packet-build-failed", A_END);
 350       }
 351       break;
 352     case MSG_KEYEXCH:
 353       if (!p) goto unexp;
 354       p_rxupdstats(p, n);
 355       kx_message(&p->kx, ch & MSG_TYPEMASK, &b);
 356       break;
 357     case MSG_MISC:
 358       switch (ch & MSG_TYPEMASK) {
 359         case MISC_NOP:
 360           if (!p) goto unexp;
 361           p_rxupdstats(p, n);
 362           T( trace(T_PEER, "peer: received NOP packet"); )
 363           break;
 364         case MISC_PING:
 365           if (!p) goto unexp;
 366           p_rxupdstats(p, n);
 367           buf_put(p_txstart(p, MSG_MISC | MISC_PONG), BCUR(&b), BLEFT(&b));
 368           p_txend(p);
 369           break;
 370         case MISC_PONG:
 371           if (!p) goto unexp;
 372           p_rxupdstats(p, n);
 373           p_ponged(p, MISC_PONG, &b);
 374           break;
 375         case MISC_EPING:
 376           buf_init(&bb, buf_t, sizeof(buf_t));
 377           if (p_decrypt(&p, &a, n, ch, &b, &bb))
 378             return;
 379           if (BOK(&bb)) {
 380             buf_flip(&bb);
 381             p_encrypt(p, MSG_MISC | MISC_EPONG, &bb,
 382                       p_txstart(p, MSG_MISC | MISC_EPONG));
 383             p_txend(p);
 384           }
 385           break;
 386         case MISC_EPONG:
 387           buf_init(&bb, buf_t, sizeof(buf_t));
 388           if (p_decrypt(&p, &a, n, ch, &b, &bb))
 389             return;
 390           if (BOK(&bb)) {
 391             buf_flip(&bb);
 392             p_ponged(p, MISC_EPONG, &bb);
 393           }
 394           break;
 395       }
 396       break;
 397     default:
 398       if (p) p->st.n_reject++;
 399       a_warn("PEER",
 400              "?PEER", p,
 401              "bad-packet",
 402              "unknown-category", "0x%02x", ch,
 403              A_END);
 404       break;
 405     unexp:
 406       a_warn("PEER", "-", "unexpected-source", "?ADDR", &a, A_END);
 407       break;
 408   }
 409 }
 410
 411 /* --- @p_txstart@ --- *
 412  *
 413  * Arguments:   @peer *p@ = pointer to peer block
 414  *              @unsigned msg@ = message type code
 415  *
 416  * Returns:     A pointer to a buffer to write to.
 417  *
 418  * Use:         Starts sending to a peer.  Only one send can happen at a
 419  *              time.
 420  */
 421
 422 buf *p_txstart(peer *p, unsigned msg)
 423 {
 424   buf_init(&p->b, buf_o, sizeof(buf_o));
 425   buf_putbyte(&p->b, msg);
 426   return (&p->b);
 427 }
 428
 429 /* --- @p_txend@ --- *
 430  *
 431  * Arguments:   @peer *p@ = pointer to peer block
 432  *
 433  * Returns:     ---
 434  *
 435  * Use:         Sends a packet to the peer.
 436  */
 437
 438 static void p_setkatimer(peer *);
 439
 440 static int p_dotxend(peer *p)
 441 {
 442   if (!BOK(&p->b)) {
 443     a_warn("PEER", "?PEER", p, "packet-build-failed", A_END);
 444     return (0);
 445   }
 446   IF_TRACING(T_PEER, trace_block(T_PACKET, "peer: sending packet",
 447                                  BBASE(&p->b), BLEN(&p->b)); )
 448   if (sendto(sock.fd, BBASE(&p->b), BLEN(&p->b),
 449              0, &p->spec.sa.sa, p->spec.sasz) < 0) {
 450     a_warn("PEER", "?PEER", p, "socket-write-error", "?ERRNO", A_END);
 451     return (0);
 452   } else {
 453     p->st.n_out++;
 454     p->st.sz_out += BLEN(&p->b);
 455     return (1);
 456   }
 457 }
 458
 459 void p_txend(peer *p)
 460 {
 461   if (p_dotxend(p) && p->spec.t_ka) {
 462     sel_rmtimer(&p->tka);
 463     p_setkatimer(p);
 464   }
 465 }
 466
 467 /* --- @p_pingwrite@ --- *
 468  *
 469  * Arguments:   @ping *p@ = ping structure
 470  *              @buf *b@ = buffer to write in
 471  *
 472  * Returns:     ---
 473  *
 474  * Use:         Fills in a ping structure and writes the packet payload.
 475  */
 476
 477 static void p_pingwrite(ping *p, buf *b)
 478 {
 479   static uint32 seq = 0;
 480
 481   p->id = U32(seq++);
 482   GR_FILL(&rand_global, p->magic, sizeof(p->magic));
 483   buf_putu32(b, p->id);
 484   buf_put(b, p->magic, sizeof(p->magic));
 485 }
 486
 487 /* --- @p_pingdone@ --- *
 488  *
 489  * Arguments:   @ping *p@ = ping structure
 490  *              @int rc@ = return code to pass on
 491  *
 492  * Returns:     ---
 493  *
 494  * Use:         Disposes of a ping structure, maybe sending a notification.
 495  */
 496
 497 void p_pingdone(ping *p, int rc)
 498 {
 499   if (p->prev) p->prev->next = p->next;
 500   else p->p->pings = p->next;
 501   if (p->next) p->next->prev = p->prev;
 502   if (rc != PING_TIMEOUT) sel_rmtimer(&p->t);
 503   T( trace(T_PEER, "peer: ping 0x%08lx done (rc = %d)",
 504            (unsigned long)p->id, rc); )
 505   if (rc >= 0) p->func(rc, p->arg);
 506 }
 507
 508 /* --- @p_pingtimeout@ --- *
 509  *
 510  * Arguments:   @struct timeval *now@ = the time now
 511  *              @void *pv@ = pointer to ping block
 512  *
 513  * Returns:     ---
 514  *
 515  * Use:         Called when a ping times out.
 516  */
 517
 518 static void p_pingtimeout(struct timeval *now, void *pv)
 519 {
 520   ping *p = pv;
 521
 522   T( trace(T_PEER, "peer: ping 0x%08lx timed out", (unsigned long)p->id); )
 523   p_pingdone(p, PING_TIMEOUT);
 524 }
 525
 526 /* --- @p_pingsend@ --- *
 527  *
 528  * Arguments:   @peer *p@ = destination peer
 529  *              @ping *pg@ = structure to fill in
 530  *              @unsigned type@ = message type
 531  *              @unsigned long timeout@ = how long to wait before giving up
 532  *              @void (*func)(int, void *)@ = callback function
 533  *              @void *arg@ = argument for callback
 534  *
 535  * Returns:     Zero if successful, nonzero if it failed.
 536  *
 537  * Use:         Sends a ping to a peer.  Call @func@ with a nonzero argument
 538  *              if we get an answer within the timeout, or zero if no answer.
 539  */
 540
 541 int p_pingsend(peer *p, ping *pg, unsigned type,
 542                unsigned long timeout,
 543                void (*func)(int, void *), void *arg)
 544 {
 545   buf *b, bb;
 546   struct timeval tv;
 547
 548   switch (type) {
 549     case MISC_PING:
 550       pg->msg = MISC_PONG;
 551       b = p_txstart(p, MSG_MISC | MISC_PING);
 552       p_pingwrite(pg, b);
 553       p_txend(p);
 554       break;
 555     case MISC_EPING:
 556       pg->msg = MISC_EPONG;
 557       b = p_txstart(p, MSG_MISC | MISC_EPING);
 558       buf_init(&bb, buf_t, sizeof(buf_t));
 559       p_pingwrite(pg, &bb);
 560       buf_flip(&bb);
 561       p_encrypt(p, MSG_MISC | MISC_EPING, &bb, b);
 562       if (!BOK(b))
 563         return (-1);
 564       p_txend(p);
 565       break;
 566     default:
 567       abort();
 568       break;
 569   }
 570
 571   pg->next = p->pings;
 572   pg->prev = 0;
 573   pg->p = p;
 574   pg->func = func;
 575   pg->arg = arg;
 576   if (p->pings) p->pings->prev = pg;
 577   p->pings = pg;
 578   gettimeofday(&tv, 0);
 579   tv.tv_sec += timeout;
 580   sel_addtimer(&sel, &pg->t, &tv, p_pingtimeout, pg);
 581   T( trace(T_PEER, "peer: send %s 0x%08lx to %s",
 582            p_pingtype(type), (unsigned long)pg->id, p->spec.name); )
 583   return (0);
 584 }
 585
 586 /* --- @p_greet@ --- *
 587  *
 588  * Arguments:   @peer *p@ = peer to send to
 589  *              @const void *c@ = pointer to challenge
 590  *              @size_t sz@ = size of challenge
 591  *
 592  * Returns:     ---
 593  *
 594  * Use:         Sends a greeting packet.
 595  */
 596
 597 void p_greet(peer *p, const void *c, size_t sz)
 598 {
 599   buf *b = p_txstart(p, MSG_MISC | MISC_GREET);
 600   buf_put(b, c, sz);
 601   p_txend(p);
 602 }
 603
 604 /* --- @p_tun@ --- *
 605  *
 606  * Arguments:   @peer *p@ = pointer to peer block
 607  *              @buf *b@ = buffer containing incoming packet
 608  *
 609  * Returns:     ---
 610  *
 611  * Use:         Handles a packet which needs to be sent to a peer.
 612  */
 613
 614 void p_tun(peer *p, buf *b)
 615 {
 616   buf *bb = p_txstart(p, MSG_PACKET);
 617
 618   TIMER;
 619   p_encrypt(p, MSG_PACKET, b, bb);
 620   if (BOK(bb) && BLEN(bb)) {
 621     p->st.n_ipout++;
 622     p->st.sz_ipout += BLEN(bb);
 623     p_txend(p);
 624   }
 625 }
 626
 627 /* --- @p_keyreload@ --- *
 628  *
 629  * Arguments:   ---
 630  *
 631  * Returns:     ---
 632  *
 633  * Use:         Forces a check of the daemon's keyring files.
 634  */
 635
 636 void p_keyreload(void)
 637 {
 638   if (km_reload())
 639     FOREACH_PEER(p, { kx_newkeys(&p->kx); });
 640 }
 641
 642 /* --- @p_interval@ --- *
 643  *
 644  * Arguments:   ---
 645  *
 646  * Returns:     ---
 647  *
 648  * Use:         Called periodically to do tidying.
 649  */
 650
 651 void p_interval(void)
 652 {
 653   p_keyreload();
 654   FOREACH_PEER(p, { ksl_prune(&p->ks); });
 655 }
 656
 657 /* --- @p_stats@ --- *
 658  *
 659  * Arguments:   @peer *p@ = pointer to a peer block
 660  *
 661  * Returns:     A pointer to the peer's statistics.
 662  */
 663
 664 stats *p_stats(peer *p) { return (&p->st); }
 665
 666 /* --- @p_ifname@ --- *
 667  *
 668  * Arguments:   @peer *p@ = pointer to a peer block
 669  *
 670  * Returns:     A pointer to the peer's interface name.
 671  */
 672
 673 const char *p_ifname(peer *p) { return (p->ifname); }
 674
 675 /* --- @p_setifname@ --- *
 676  *
 677  * Arguments:   @peer *p@ = pointer to a peer block
 678  *              @const char *name@ = pointer to the new name
 679  *
 680  * Returns:     ---
 681  *
 682  * Use:         Changes the name held for a peer's interface.
 683  */
 684
 685 void p_setifname(peer *p, const char *name)
 686 {
 687   xfree(p->ifname);
 688   p->ifname = xstrdup(name);
 689   if (p->spec.tops->setifname)
 690     p->spec.tops->setifname(p->t, name);
 691 }
 692
 693 /* --- @p_addr@ --- *
 694  *
 695  * Arguments:   @peer *p@ = pointer to a peer block
 696  *
 697  * Returns:     A pointer to the peer's address.
 698  */
 699
 700 const addr *p_addr(peer *p) { return (&p->spec.sa); }
 701
 702 /* --- @p_init@ --- *
 703  *
 704  * Arguments:   @struct in_addr addr@ = address to bind to
 705  *              @unsigned port@ = port number to listen to
 706  *
 707  * Returns:     ---
 708  *
 709  * Use:         Initializes the peer system; creates the socket.
 710  */
 711
 712 void p_init(struct in_addr addr, unsigned port)
 713 {
 714   int fd;
 715   struct sockaddr_in sin;
 716   int len = PKBUFSZ;
 717
 718   /* --- Note on socket buffer sizes --- *
 719    *
 720    * For some bizarre reason, Linux 2.2 (at least) doubles the socket buffer
 721    * sizes I pass to @setsockopt@.  I'm not putting special-case code here
 722    * for Linux: BSD (at least TCPv2) does what I tell it rather than second-
 723    * guessing me.
 724    */
 725
 726   if ((fd = socket(PF_INET, SOCK_DGRAM, 0)) < 0)
 727     die(EXIT_FAILURE, "socket creation failed: %s", strerror(errno));
 728   BURN(sin);
 729   sin.sin_family = AF_INET;
 730   sin.sin_addr = addr;
 731   sin.sin_port = htons(port);
 732   if (bind(fd, (struct sockaddr *)&sin, sizeof(sin)))
 733     die(EXIT_FAILURE, "bind failed: %s", strerror(errno));
 734   if (setsockopt(fd, SOL_SOCKET, SO_RCVBUF, &len, sizeof(len)) ||
 735       setsockopt(fd, SOL_SOCKET, SO_SNDBUF, &len, sizeof(len))) {
 736     die(EXIT_FAILURE, "failed to set socket buffer sizes: %s",
 737         strerror(errno));
 738   }
 739   fdflags(fd, O_NONBLOCK, O_NONBLOCK, FD_CLOEXEC, FD_CLOEXEC);
 740   sel_initfile(&sel, &sock, fd, SEL_READ, p_read, 0);
 741   sel_addfile(&sock);
 742   T( trace(T_PEER, "peer: created socket"); )
 743
 744   sym_create(&byname);
 745   am_create(&byaddr);
 746 }
 747
 748 /* --- @p_port@ --- *
 749  *
 750  * Arguments:   ---
 751  *
 752  * Returns:     Port number used for socket.
 753  */
 754
 755 unsigned p_port(void)
 756 {
 757   addr a;
 758   size_t sz = sizeof(addr);
 759
 760   if (getsockname(sock.fd, &a.sa, &sz))
 761     die(EXIT_FAILURE, "couldn't read port number: %s", strerror(errno));
 762   assert(a.sa.sa_family == AF_INET);
 763   return (ntohs(a.sin.sin_port));
 764 }
 765
 766 /* --- @p_keepalive@ --- *
 767  *
 768  * Arguments:   @struct timeval *now@ = the current time
 769  *              @void *pv@ = peer to wake up
 770  *
 771  * Returns:     ---
 772  *
 773  * Use:         Sends a keepalive ping message to its peer.
 774  */
 775
 776 static void p_keepalive(struct timeval *now, void *pv)
 777 {
 778   peer *p = pv;
 779   p_txstart(p, MSG_MISC | MISC_NOP); p_dotxend(p);
 780   T( trace(T_PEER, "peer: sent keepalive to %s", p->spec.name); )
 781   p_setkatimer(p);
 782 }
 783
 784 /* --- @p_setkatimer@ --- *
 785  *
 786  * Arguments:   @peer *p@ = peer to set
 787  *
 788  * Returns:     ---
 789  *
 790  * Use:         Resets the keepalive timer thing.
 791  */
 792
 793 static void p_setkatimer(peer *p)
 794 {
 795   struct timeval tv;
 796
 797   if (!p->spec.t_ka)
 798     return;
 799   gettimeofday(&tv, 0);
 800   tv.tv_sec += p->spec.t_ka;
 801   sel_addtimer(&sel, &p->tka, &tv, p_keepalive, p);
 802 }
 803
 804 /* --- @p_create@ --- *
 805  *
 806  * Arguments:   @peerspec *spec@ = information about this peer
 807  *
 808  * Returns:     Pointer to the peer block, or null if it failed.
 809  *
 810  * Use:         Creates a new named peer block.  No peer is actually attached
 811  *              by this point.
 812  */
 813
 814 peer *p_create(peerspec *spec)
 815 {
 816   peer *p = CREATE(peer);
 817   const tunnel_ops *tops = spec->tops;
 818   int fd;
 819   unsigned f;
 820
 821   p->byname = sym_find(&byname, spec->name, -1, sizeof(peer_byname), &f);
 822   if (f) goto tidy_0;
 823   p->byaddr = am_find(&byaddr, &spec->sa, sizeof(peer_byaddr), &f);
 824   if (f) goto tidy_1;
 825   p->byname->p = p->byaddr->p = p;
 826
 827   T( trace(T_PEER, "peer: creating new peer `%s'", spec->name); )
 828   p->spec = *spec;
 829   p->spec.name = (/*unconst*/ char *)SYM_NAME(p->byname);
 830   if (spec->tag)
 831     p->spec.tag = xstrdup(spec->tag);
 832   p->ks = 0;
 833   p->pings = 0;
 834   p->ifname = 0;
 835   memset(&p->st, 0, sizeof(stats));
 836   p->st.t_start = time(0);
 837   if (!(tops->flags & TUNF_PRIVOPEN))
 838     fd = -1;
 839   else if ((fd = ps_tunfd(tops, &p->ifname)) < 0)
 840     goto tidy_2;
 841   if ((p->t = tops->create(p, fd, &p->ifname)) == 0)
 842     goto tidy_3;
 843   T( trace(T_TUNNEL, "peer: attached interface %s to peer `%s'",
 844            p->ifname, p_name(p)); )
 845   p_setkatimer(p);
 846   if (kx_init(&p->kx, p, &p->ks, p->spec.f & PSF_KXMASK))
 847     goto tidy_4;
 848   a_notify("ADD",
 849            "?PEER", p,
 850            "%s", p->ifname,
 851            "?ADDR", &p->spec.sa,
 852            A_END);
 853   if (!(p->spec.f & KXF_CORK)) {
 854     a_notify("KXSTART", "?PEER", p, A_END);
 855     /* Couldn't tell anyone before */
 856   }
 857   if (p->spec.f & PSF_MOBILE) nmobile++;
 858   return (p);
 859
 860 tidy_4:
 861   if (spec->t_ka)
 862     sel_rmtimer(&p->tka);
 863   xfree(p->ifname);
 864   p->t->ops->destroy(p->t);
 865 tidy_3:
 866   if (fd >= 0) close(fd);
 867 tidy_2:
 868   am_remove(&byaddr, p->byaddr);
 869   if (p->spec.tag) xfree(p->spec.tag);
 870 tidy_1:
 871   sym_remove(&byname, p->byname);
 872 tidy_0:
 873   DESTROY(p);
 874   return (0);
 875 }
 876
 877 /* --- @p_name@ --- *
 878  *
 879  * Arguments:   @peer *p@ = pointer to a peer block
 880  *
 881  * Returns:     A pointer to the peer's name.
 882  */
 883
 884 const char *p_name(peer *p)
 885   { if (p) return (p->spec.name); else return ("-"); }
 886
 887 /* --- @p_tag@ --- *
 888  *
 889  * Arguments:   @peer *p@ = pointer to a peer block
 890  *
 891  * Returns:     A pointer to the peer's public key tag.
 892  */
 893
 894 const char *p_tag(peer *p)
 895   { return (p->spec.tag ? p->spec.tag : p->spec.name); }
 896
 897 /* --- @p_spec@ --- *
 898  *
 899  * Arguments:   @peer *p@ = pointer to a peer block
 900  *
 901  * Returns:     Pointer to the peer's specification
 902  */
 903
 904 const peerspec *p_spec(peer *p) { return (&p->spec); }
 905
 906 /* --- @p_findbyaddr@ --- *
 907  *
 908  * Arguments:   @const addr *a@ = address to look up
 909  *
 910  * Returns:     Pointer to the peer block, or null if not found.
 911  *
 912  * Use:         Finds a peer by address.
 913  */
 914
 915 peer *p_findbyaddr(const addr *a)
 916 {
 917   peer_byaddr *pa;
 918
 919   if ((pa = am_find(&byaddr, a, 0, 0)) != 0) {
 920     assert(pa->p);
 921     return (pa->p);
 922   }
 923   return (0);
 924 }
 925
 926 /* --- @p_find@ --- *
 927  *
 928  * Arguments:   @const char *name@ = name to look up
 929  *
 930  * Returns:     Pointer to the peer block, or null if not found.
 931  *
 932  * Use:         Finds a peer by name.
 933  */
 934
 935 peer *p_find(const char *name)
 936 {
 937   peer_byname *pn;
 938
 939   if ((pn = sym_find(&byname, name, -1, 0, 0)) != 0)
 940     return (pn->p);
 941   return (0);
 942 }
 943
 944 /* --- @p_destroy@ --- *
 945  *
 946  * Arguments:   @peer *p@ = pointer to a peer
 947  *
 948  * Returns:     ---
 949  *
 950  * Use:         Destroys a peer.
 951  */
 952
 953 void p_destroy(peer *p)
 954 {
 955   ping *pg, *ppg;
 956
 957   T( trace(T_PEER, "peer: destroying peer `%s'", p->spec.name); )
 958   a_notify("KILL", "%s", p->spec.name, A_END);
 959   ksl_free(&p->ks);
 960   kx_free(&p->kx);
 961   if (p->spec.f & PSF_MOBILE)
 962     nmobile--;
 963   if (p->ifname)
 964     xfree(p->ifname);
 965   if (p->spec.tag)
 966     xfree(p->spec.tag);
 967   p->t->ops->destroy(p->t);
 968   if (p->spec.t_ka)
 969     sel_rmtimer(&p->tka);
 970   for (pg = p->pings; pg; pg = ppg) {
 971     ppg = pg->next;
 972     p_pingdone(pg, PING_PEERDIED);
 973   }
 974   sym_remove(&byname, p->byname);
 975   am_remove(&byaddr, p->byaddr);
 976   DESTROY(p);
 977 }
 978
 979 /* --- @p_mkiter@ --- *
 980  *
 981  * Arguments:   @peer_iter *i@ = pointer to an iterator
 982  *
 983  * Returns:     ---
 984  *
 985  * Use:         Initializes the iterator.
 986  */
 987
 988 void p_mkiter(peer_iter *i) { sym_mkiter(&i->i, &byname); }
 989
 990 /* --- @p_next@ --- *
 991  *
 992  * Arguments:   @peer_iter *i@ = pointer to an iterator
 993  *
 994  * Returns:     Next peer, or null if at the end.
 995  *
 996  * Use:         Returns the next peer.
 997  */
 998
 999 peer *p_next(peer_iter *i)
1000 {
1001   peer_byname *pn;
1002
1003   if ((pn = sym_next(&i->i)) == 0)
1004     return (0);
1005   return (pn->p);
1006 }
1007
1008 /*----- That's all, folks -------------------------------------------------*/