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       p_rxupdstats(p, n);
 232       pa = am_find(&byaddr, a, sizeof(peer_byaddr), &f); assert(!f);
 233       am_remove(&byaddr, p->byaddr);
 234       p->byaddr = pa;
 235       pa->p = p;
 236       p->spec.sa = *a;
 237       a_notify("NEWADDR", "?PEER", p, "?ADDR", a, A_END);
 238     }
 239   }
 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   if (p) p_rxupdstats(p, n);
 325   buf_init(&b, buf_i, n);
 326   if ((ch = buf_getbyte(&b)) < 0) {
 327     a_warn("PEER", "?PEER", p, "bad-packet", "no-type", A_END);
 328     return;
 329   }
 330   switch (ch & MSG_CATMASK) {
 331     case MSG_PACKET:
 332       if (ch & MSG_TYPEMASK) {
 333         a_warn("PEER",
 334                "?PEER", p,
 335                "bad-packet",
 336                "unknown-type", "0x%02x", ch,
 337                A_END);
 338         if (p) p->st.n_reject++;
 339         return;
 340       }
 341       buf_init(&bb, buf_o, sizeof(buf_o));
 342       if (p_decrypt(&p, &a, n, MSG_PACKET, &b, &bb))
 343         return;
 344       if (BOK(&bb)) {
 345         p->st.n_ipin++;
 346         p->st.sz_ipin += BSZ(&b);
 347         p->t->ops->inject(p->t, &bb);
 348       } else {
 349         p->st.n_reject++;
 350         a_warn("PEER", "?PEER", p, "packet-build-failed", A_END);
 351       }
 352       break;
 353     case MSG_KEYEXCH:
 354       if (!p) goto unexp;
 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           T( trace(T_PEER, "peer: received NOP packet"); )
 362           break;
 363         case MISC_PING:
 364           if (!p) goto unexp;
 365           buf_put(p_txstart(p, MSG_MISC | MISC_PONG), BCUR(&b), BLEFT(&b));
 366           p_txend(p);
 367           break;
 368         case MISC_PONG:
 369           if (!p) goto unexp;
 370           p_ponged(p, MISC_PONG, &b);
 371           break;
 372         case MISC_EPING:
 373           buf_init(&bb, buf_t, sizeof(buf_t));
 374           if (p_decrypt(&p, &a, n, ch, &b, &bb))
 375             return;
 376           if (BOK(&bb)) {
 377             buf_flip(&bb);
 378             p_encrypt(p, MSG_MISC | MISC_EPONG, &bb,
 379                       p_txstart(p, MSG_MISC | MISC_EPONG));
 380             p_txend(p);
 381           }
 382           break;
 383         case MISC_EPONG:
 384           buf_init(&bb, buf_t, sizeof(buf_t));
 385           if (p_decrypt(&p, &a, n, ch, &b, &bb))
 386             return;
 387           if (BOK(&bb)) {
 388             buf_flip(&bb);
 389             p_ponged(p, MISC_EPONG, &bb);
 390           }
 391           break;
 392       }
 393       break;
 394     default:
 395       if (p) p->st.n_reject++;
 396       a_warn("PEER",
 397              "?PEER", p,
 398              "bad-packet",
 399              "unknown-category", "0x%02x", ch,
 400              A_END);
 401       break;
 402     unexp:
 403       a_warn("PEER", "-", "unexpected-source", "?ADDR", &a, A_END);
 404       break;
 405   }
 406 }
 407
 408 /* --- @p_txstart@ --- *
 409  *
 410  * Arguments:   @peer *p@ = pointer to peer block
 411  *              @unsigned msg@ = message type code
 412  *
 413  * Returns:     A pointer to a buffer to write to.
 414  *
 415  * Use:         Starts sending to a peer.  Only one send can happen at a
 416  *              time.
 417  */
 418
 419 buf *p_txstart(peer *p, unsigned msg)
 420 {
 421   buf_init(&p->b, buf_o, sizeof(buf_o));
 422   buf_putbyte(&p->b, msg);
 423   return (&p->b);
 424 }
 425
 426 /* --- @p_txend@ --- *
 427  *
 428  * Arguments:   @peer *p@ = pointer to peer block
 429  *
 430  * Returns:     ---
 431  *
 432  * Use:         Sends a packet to the peer.
 433  */
 434
 435 static void p_setkatimer(peer *);
 436
 437 static int p_dotxend(peer *p)
 438 {
 439   if (!BOK(&p->b)) {
 440     a_warn("PEER", "?PEER", p, "packet-build-failed", A_END);
 441     return (0);
 442   }
 443   IF_TRACING(T_PEER, trace_block(T_PACKET, "peer: sending packet",
 444                                  BBASE(&p->b), BLEN(&p->b)); )
 445   if (sendto(sock.fd, BBASE(&p->b), BLEN(&p->b),
 446              0, &p->spec.sa.sa, p->spec.sasz) < 0) {
 447     a_warn("PEER", "?PEER", p, "socket-write-error", "?ERRNO", A_END);
 448     return (0);
 449   } else {
 450     p->st.n_out++;
 451     p->st.sz_out += BLEN(&p->b);
 452     return (1);
 453   }
 454 }
 455
 456 void p_txend(peer *p)
 457 {
 458   if (p_dotxend(p) && p->spec.t_ka) {
 459     sel_rmtimer(&p->tka);
 460     p_setkatimer(p);
 461   }
 462 }
 463
 464 /* --- @p_pingwrite@ --- *
 465  *
 466  * Arguments:   @ping *p@ = ping structure
 467  *              @buf *b@ = buffer to write in
 468  *
 469  * Returns:     ---
 470  *
 471  * Use:         Fills in a ping structure and writes the packet payload.
 472  */
 473
 474 static void p_pingwrite(ping *p, buf *b)
 475 {
 476   static uint32 seq = 0;
 477
 478   p->id = U32(seq++);
 479   GR_FILL(&rand_global, p->magic, sizeof(p->magic));
 480   buf_putu32(b, p->id);
 481   buf_put(b, p->magic, sizeof(p->magic));
 482 }
 483
 484 /* --- @p_pingdone@ --- *
 485  *
 486  * Arguments:   @ping *p@ = ping structure
 487  *              @int rc@ = return code to pass on
 488  *
 489  * Returns:     ---
 490  *
 491  * Use:         Disposes of a ping structure, maybe sending a notification.
 492  */
 493
 494 void p_pingdone(ping *p, int rc)
 495 {
 496   if (p->prev) p->prev->next = p->next;
 497   else p->p->pings = p->next;
 498   if (p->next) p->next->prev = p->prev;
 499   if (rc != PING_TIMEOUT) sel_rmtimer(&p->t);
 500   T( trace(T_PEER, "peer: ping 0x%08lx done (rc = %d)",
 501            (unsigned long)p->id, rc); )
 502   if (rc >= 0) p->func(rc, p->arg);
 503 }
 504
 505 /* --- @p_pingtimeout@ --- *
 506  *
 507  * Arguments:   @struct timeval *now@ = the time now
 508  *              @void *pv@ = pointer to ping block
 509  *
 510  * Returns:     ---
 511  *
 512  * Use:         Called when a ping times out.
 513  */
 514
 515 static void p_pingtimeout(struct timeval *now, void *pv)
 516 {
 517   ping *p = pv;
 518
 519   T( trace(T_PEER, "peer: ping 0x%08lx timed out", (unsigned long)p->id); )
 520   p_pingdone(p, PING_TIMEOUT);
 521 }
 522
 523 /* --- @p_pingsend@ --- *
 524  *
 525  * Arguments:   @peer *p@ = destination peer
 526  *              @ping *pg@ = structure to fill in
 527  *              @unsigned type@ = message type
 528  *              @unsigned long timeout@ = how long to wait before giving up
 529  *              @void (*func)(int, void *)@ = callback function
 530  *              @void *arg@ = argument for callback
 531  *
 532  * Returns:     Zero if successful, nonzero if it failed.
 533  *
 534  * Use:         Sends a ping to a peer.  Call @func@ with a nonzero argument
 535  *              if we get an answer within the timeout, or zero if no answer.
 536  */
 537
 538 int p_pingsend(peer *p, ping *pg, unsigned type,
 539                unsigned long timeout,
 540                void (*func)(int, void *), void *arg)
 541 {
 542   buf *b, bb;
 543   struct timeval tv;
 544
 545   switch (type) {
 546     case MISC_PING:
 547       pg->msg = MISC_PONG;
 548       b = p_txstart(p, MSG_MISC | MISC_PING);
 549       p_pingwrite(pg, b);
 550       p_txend(p);
 551       break;
 552     case MISC_EPING:
 553       pg->msg = MISC_EPONG;
 554       b = p_txstart(p, MSG_MISC | MISC_EPING);
 555       buf_init(&bb, buf_t, sizeof(buf_t));
 556       p_pingwrite(pg, &bb);
 557       buf_flip(&bb);
 558       p_encrypt(p, MSG_MISC | MISC_EPING, &bb, b);
 559       if (!BOK(b))
 560         return (-1);
 561       p_txend(p);
 562       break;
 563     default:
 564       abort();
 565       break;
 566   }
 567
 568   pg->next = p->pings;
 569   pg->prev = 0;
 570   pg->p = p;
 571   pg->func = func;
 572   pg->arg = arg;
 573   if (p->pings) p->pings->prev = pg;
 574   p->pings = pg;
 575   gettimeofday(&tv, 0);
 576   tv.tv_sec += timeout;
 577   sel_addtimer(&sel, &pg->t, &tv, p_pingtimeout, pg);
 578   T( trace(T_PEER, "peer: send %s 0x%08lx to %s",
 579            p_pingtype(type), (unsigned long)pg->id, p->spec.name); )
 580   return (0);
 581 }
 582
 583 /* --- @p_greet@ --- *
 584  *
 585  * Arguments:   @peer *p@ = peer to send to
 586  *              @const void *c@ = pointer to challenge
 587  *              @size_t sz@ = size of challenge
 588  *
 589  * Returns:     ---
 590  *
 591  * Use:         Sends a greeting packet.
 592  */
 593
 594 void p_greet(peer *p, const void *c, size_t sz)
 595 {
 596   buf *b = p_txstart(p, MSG_MISC | MISC_GREET);
 597   buf_put(b, c, sz);
 598   p_txend(p);
 599 }
 600
 601 /* --- @p_tun@ --- *
 602  *
 603  * Arguments:   @peer *p@ = pointer to peer block
 604  *              @buf *b@ = buffer containing incoming packet
 605  *
 606  * Returns:     ---
 607  *
 608  * Use:         Handles a packet which needs to be sent to a peer.
 609  */
 610
 611 void p_tun(peer *p, buf *b)
 612 {
 613   buf *bb = p_txstart(p, MSG_PACKET);
 614
 615   TIMER;
 616   p_encrypt(p, MSG_PACKET, b, bb);
 617   if (BOK(bb) && BLEN(bb)) {
 618     p->st.n_ipout++;
 619     p->st.sz_ipout += BLEN(bb);
 620     p_txend(p);
 621   }
 622 }
 623
 624 /* --- @p_keyreload@ --- *
 625  *
 626  * Arguments:   ---
 627  *
 628  * Returns:     ---
 629  *
 630  * Use:         Forces a check of the daemon's keyring files.
 631  */
 632
 633 void p_keyreload(void)
 634 {
 635   if (km_reload())
 636     FOREACH_PEER(p, { kx_newkeys(&p->kx); });
 637 }
 638
 639 /* --- @p_interval@ --- *
 640  *
 641  * Arguments:   ---
 642  *
 643  * Returns:     ---
 644  *
 645  * Use:         Called periodically to do tidying.
 646  */
 647
 648 void p_interval(void)
 649 {
 650   p_keyreload();
 651   FOREACH_PEER(p, { ksl_prune(&p->ks); });
 652 }
 653
 654 /* --- @p_stats@ --- *
 655  *
 656  * Arguments:   @peer *p@ = pointer to a peer block
 657  *
 658  * Returns:     A pointer to the peer's statistics.
 659  */
 660
 661 stats *p_stats(peer *p) { return (&p->st); }
 662
 663 /* --- @p_ifname@ --- *
 664  *
 665  * Arguments:   @peer *p@ = pointer to a peer block
 666  *
 667  * Returns:     A pointer to the peer's interface name.
 668  */
 669
 670 const char *p_ifname(peer *p) { return (p->ifname); }
 671
 672 /* --- @p_setifname@ --- *
 673  *
 674  * Arguments:   @peer *p@ = pointer to a peer block
 675  *              @const char *name@ = pointer to the new name
 676  *
 677  * Returns:     ---
 678  *
 679  * Use:         Changes the name held for a peer's interface.
 680  */
 681
 682 void p_setifname(peer *p, const char *name)
 683 {
 684   xfree(p->ifname);
 685   p->ifname = xstrdup(name);
 686   if (p->spec.tops->setifname)
 687     p->spec.tops->setifname(p->t, name);
 688 }
 689
 690 /* --- @p_addr@ --- *
 691  *
 692  * Arguments:   @peer *p@ = pointer to a peer block
 693  *
 694  * Returns:     A pointer to the peer's address.
 695  */
 696
 697 const addr *p_addr(peer *p) { return (&p->spec.sa); }
 698
 699 /* --- @p_init@ --- *
 700  *
 701  * Arguments:   @struct in_addr addr@ = address to bind to
 702  *              @unsigned port@ = port number to listen to
 703  *
 704  * Returns:     ---
 705  *
 706  * Use:         Initializes the peer system; creates the socket.
 707  */
 708
 709 void p_init(struct in_addr addr, unsigned port)
 710 {
 711   int fd;
 712   struct sockaddr_in sin;
 713   int len = PKBUFSZ;
 714
 715   /* --- Note on socket buffer sizes --- *
 716    *
 717    * For some bizarre reason, Linux 2.2 (at least) doubles the socket buffer
 718    * sizes I pass to @setsockopt@.  I'm not putting special-case code here
 719    * for Linux: BSD (at least TCPv2) does what I tell it rather than second-
 720    * guessing me.
 721    */
 722
 723   if ((fd = socket(PF_INET, SOCK_DGRAM, 0)) < 0)
 724     die(EXIT_FAILURE, "socket creation failed: %s", strerror(errno));
 725   BURN(sin);
 726   sin.sin_family = AF_INET;
 727   sin.sin_addr = addr;
 728   sin.sin_port = htons(port);
 729   if (bind(fd, (struct sockaddr *)&sin, sizeof(sin)))
 730     die(EXIT_FAILURE, "bind failed: %s", strerror(errno));
 731   if (setsockopt(fd, SOL_SOCKET, SO_RCVBUF, &len, sizeof(len)) ||
 732       setsockopt(fd, SOL_SOCKET, SO_SNDBUF, &len, sizeof(len))) {
 733     die(EXIT_FAILURE, "failed to set socket buffer sizes: %s",
 734         strerror(errno));
 735   }
 736   fdflags(fd, O_NONBLOCK, O_NONBLOCK, FD_CLOEXEC, FD_CLOEXEC);
 737   sel_initfile(&sel, &sock, fd, SEL_READ, p_read, 0);
 738   sel_addfile(&sock);
 739   T( trace(T_PEER, "peer: created socket"); )
 740
 741   sym_create(&byname);
 742   am_create(&byaddr);
 743 }
 744
 745 /* --- @p_port@ --- *
 746  *
 747  * Arguments:   ---
 748  *
 749  * Returns:     Port number used for socket.
 750  */
 751
 752 unsigned p_port(void)
 753 {
 754   addr a;
 755   size_t sz = sizeof(addr);
 756
 757   if (getsockname(sock.fd, &a.sa, &sz))
 758     die(EXIT_FAILURE, "couldn't read port number: %s", strerror(errno));
 759   assert(a.sa.sa_family == AF_INET);
 760   return (ntohs(a.sin.sin_port));
 761 }
 762
 763 /* --- @p_keepalive@ --- *
 764  *
 765  * Arguments:   @struct timeval *now@ = the current time
 766  *              @void *pv@ = peer to wake up
 767  *
 768  * Returns:     ---
 769  *
 770  * Use:         Sends a keepalive ping message to its peer.
 771  */
 772
 773 static void p_keepalive(struct timeval *now, void *pv)
 774 {
 775   peer *p = pv;
 776   p_txstart(p, MSG_MISC | MISC_NOP); p_dotxend(p);
 777   T( trace(T_PEER, "peer: sent keepalive to %s", p->spec.name); )
 778   p_setkatimer(p);
 779 }
 780
 781 /* --- @p_setkatimer@ --- *
 782  *
 783  * Arguments:   @peer *p@ = peer to set
 784  *
 785  * Returns:     ---
 786  *
 787  * Use:         Resets the keepalive timer thing.
 788  */
 789
 790 static void p_setkatimer(peer *p)
 791 {
 792   struct timeval tv;
 793
 794   if (!p->spec.t_ka)
 795     return;
 796   gettimeofday(&tv, 0);
 797   tv.tv_sec += p->spec.t_ka;
 798   sel_addtimer(&sel, &p->tka, &tv, p_keepalive, p);
 799 }
 800
 801 /* --- @p_create@ --- *
 802  *
 803  * Arguments:   @peerspec *spec@ = information about this peer
 804  *
 805  * Returns:     Pointer to the peer block, or null if it failed.
 806  *
 807  * Use:         Creates a new named peer block.  No peer is actually attached
 808  *              by this point.
 809  */
 810
 811 peer *p_create(peerspec *spec)
 812 {
 813   peer *p = CREATE(peer);
 814   const tunnel_ops *tops = spec->tops;
 815   int fd;
 816   unsigned f;
 817
 818   p->byname = sym_find(&byname, spec->name, -1, sizeof(peer_byname), &f);
 819   if (f) goto tidy_0;
 820   p->byaddr = am_find(&byaddr, &spec->sa, sizeof(peer_byaddr), &f);
 821   if (f) goto tidy_1;
 822   p->byname->p = p->byaddr->p = p;
 823
 824   T( trace(T_PEER, "peer: creating new peer `%s'", spec->name); )
 825   p->spec = *spec;
 826   p->spec.name = (/*unconst*/ char *)SYM_NAME(p->byname);
 827   if (spec->tag)
 828     p->spec.tag = xstrdup(spec->tag);
 829   p->ks = 0;
 830   p->pings = 0;
 831   p->ifname = 0;
 832   memset(&p->st, 0, sizeof(stats));
 833   p->st.t_start = time(0);
 834   if (!(tops->flags & TUNF_PRIVOPEN))
 835     fd = -1;
 836   else if ((fd = ps_tunfd(tops, &p->ifname)) < 0)
 837     goto tidy_2;
 838   if ((p->t = tops->create(p, fd, &p->ifname)) == 0)
 839     goto tidy_3;
 840   T( trace(T_TUNNEL, "peer: attached interface %s to peer `%s'",
 841            p->ifname, p_name(p)); )
 842   p_setkatimer(p);
 843   if (kx_init(&p->kx, p, &p->ks, p->spec.f & PSF_KXMASK))
 844     goto tidy_4;
 845   a_notify("ADD",
 846            "?PEER", p,
 847            "%s", p->ifname,
 848            "?ADDR", &p->spec.sa,
 849            A_END);
 850   if (!(p->spec.f & KXF_CORK)) {
 851     a_notify("KXSTART", "?PEER", p, A_END);
 852     /* Couldn't tell anyone before */
 853   }
 854   if (p->spec.f & PSF_MOBILE) nmobile++;
 855   return (p);
 856
 857 tidy_4:
 858   if (spec->t_ka)
 859     sel_rmtimer(&p->tka);
 860   xfree(p->ifname);
 861   p->t->ops->destroy(p->t);
 862 tidy_3:
 863   if (fd >= 0) close(fd);
 864 tidy_2:
 865   am_remove(&byaddr, p->byaddr);
 866   if (p->spec.tag) xfree(p->spec.tag);
 867 tidy_1:
 868   sym_remove(&byname, p->byname);
 869 tidy_0:
 870   DESTROY(p);
 871   return (0);
 872 }
 873
 874 /* --- @p_name@ --- *
 875  *
 876  * Arguments:   @peer *p@ = pointer to a peer block
 877  *
 878  * Returns:     A pointer to the peer's name.
 879  */
 880
 881 const char *p_name(peer *p)
 882   { if (p) return (p->spec.name); else return ("-"); }
 883
 884 /* --- @p_tag@ --- *
 885  *
 886  * Arguments:   @peer *p@ = pointer to a peer block
 887  *
 888  * Returns:     A pointer to the peer's public key tag.
 889  */
 890
 891 const char *p_tag(peer *p)
 892   { return (p->spec.tag ? p->spec.tag : p->spec.name); }
 893
 894 /* --- @p_spec@ --- *
 895  *
 896  * Arguments:   @peer *p@ = pointer to a peer block
 897  *
 898  * Returns:     Pointer to the peer's specification
 899  */
 900
 901 const peerspec *p_spec(peer *p) { return (&p->spec); }
 902
 903 /* --- @p_findbyaddr@ --- *
 904  *
 905  * Arguments:   @const addr *a@ = address to look up
 906  *
 907  * Returns:     Pointer to the peer block, or null if not found.
 908  *
 909  * Use:         Finds a peer by address.
 910  */
 911
 912 peer *p_findbyaddr(const addr *a)
 913 {
 914   peer_byaddr *pa;
 915
 916   if ((pa = am_find(&byaddr, a, 0, 0)) != 0) {
 917     assert(pa->p);
 918     return (pa->p);
 919   }
 920   return (0);
 921 }
 922
 923 /* --- @p_find@ --- *
 924  *
 925  * Arguments:   @const char *name@ = name to look up
 926  *
 927  * Returns:     Pointer to the peer block, or null if not found.
 928  *
 929  * Use:         Finds a peer by name.
 930  */
 931
 932 peer *p_find(const char *name)
 933 {
 934   peer_byname *pn;
 935
 936   if ((pn = sym_find(&byname, name, -1, 0, 0)) != 0)
 937     return (pn->p);
 938   return (0);
 939 }
 940
 941 /* --- @p_destroy@ --- *
 942  *
 943  * Arguments:   @peer *p@ = pointer to a peer
 944  *
 945  * Returns:     ---
 946  *
 947  * Use:         Destroys a peer.
 948  */
 949
 950 void p_destroy(peer *p)
 951 {
 952   ping *pg, *ppg;
 953
 954   T( trace(T_PEER, "peer: destroying peer `%s'", p->spec.name); )
 955   a_notify("KILL", "%s", p->spec.name, A_END);
 956   ksl_free(&p->ks);
 957   kx_free(&p->kx);
 958   if (p->spec.f & PSF_MOBILE)
 959     nmobile--;
 960   if (p->ifname)
 961     xfree(p->ifname);
 962   if (p->spec.tag)
 963     xfree(p->spec.tag);
 964   p->t->ops->destroy(p->t);
 965   if (p->spec.t_ka)
 966     sel_rmtimer(&p->tka);
 967   for (pg = p->pings; pg; pg = ppg) {
 968     ppg = pg->next;
 969     p_pingdone(pg, PING_PEERDIED);
 970   }
 971   sym_remove(&byname, p->byname);
 972   am_remove(&byaddr, p->byaddr);
 973   DESTROY(p);
 974 }
 975
 976 /* --- @p_mkiter@ --- *
 977  *
 978  * Arguments:   @peer_iter *i@ = pointer to an iterator
 979  *
 980  * Returns:     ---
 981  *
 982  * Use:         Initializes the iterator.
 983  */
 984
 985 void p_mkiter(peer_iter *i) { sym_mkiter(&i->i, &byname); }
 986
 987 /* --- @p_next@ --- *
 988  *
 989  * Arguments:   @peer_iter *i@ = pointer to an iterator
 990  *
 991  * Returns:     Next peer, or null if at the end.
 992  *
 993  * Use:         Returns the next peer.
 994  */
 995
 996 peer *p_next(peer_iter *i)
 997 {
 998   peer_byname *pn;
 999
1000   if ((pn = sym_next(&i->i)) == 0)
1001     return (0);
1002   return (pn->p);
1003 }
1004
1005 /*----- That's all, folks -------------------------------------------------*/