resolver: construct comm_addr; honour multiple addresses from the resolver
[secnet] / site.c
CommitLineData
2fe58dfd
SE
1/* site.c - manage communication with a remote network site */
2
469fd1d9
SE
3/* The 'site' code doesn't know anything about the structure of the
4 packets it's transmitting. In fact, under the new netlink
5 configuration scheme it doesn't need to know anything at all about
6 IP addresses, except how to contact its peer. This means it could
7 potentially be used to tunnel other protocols too (IPv6, IPX, plain
8 old Ethernet frames) if appropriate netlink code can be written
9 (and that ought not to be too hard, eg. using the TUN/TAP device to
10 pretend to be an Ethernet interface). */
11
ff05a229
SE
12/* At some point in the future the netlink code will be asked for
13 configuration information to go in the PING/PONG packets at the end
14 of the key exchange. */
15
8689b3a9 16#include "secnet.h"
2fe58dfd 17#include <stdio.h>
469fd1d9 18#include <string.h>
fe5e9cc4 19#include <limits.h>
58650a70 20#include <assert.h>
8689b3a9 21#include <sys/socket.h>
2fe58dfd 22
8689b3a9 23#include <sys/mman.h>
2fe58dfd 24#include "util.h"
59635212 25#include "unaligned.h"
ff05a229 26#include "magic.h"
2fe58dfd
SE
27
28#define SETUP_BUFFER_LEN 2048
29
e7f8ec2a
IJ
30#define DEFAULT_KEY_LIFETIME (3600*1000) /* [ms] */
31#define DEFAULT_KEY_RENEGOTIATE_GAP (5*60*1000) /* [ms] */
2fe58dfd 32#define DEFAULT_SETUP_RETRIES 5
e7f8ec2a
IJ
33#define DEFAULT_SETUP_RETRY_INTERVAL (2*1000) /* [ms] */
34#define DEFAULT_WAIT_TIME (20*1000) /* [ms] */
e57264d6
IJ
35
36#define DEFAULT_MOBILE_KEY_LIFETIME (2*24*3600*1000) /* [ms] */
37#define DEFAULT_MOBILE_KEY_RENEGOTIATE_GAP (12*3600*1000) /* [ms] */
38#define DEFAULT_MOBILE_SETUP_RETRIES 30
39#define DEFAULT_MOBILE_SETUP_RETRY_INTERVAL (1*1000) /* [ms] */
40#define DEFAULT_MOBILE_WAIT_TIME (10*1000) /* [ms] */
41
446353cd
IJ
42#define DEFAULT_MOBILE_PEER_EXPIRY (2*60) /* [s] */
43#define DEFAULT_MOBILE_PEERS_MAX 3 /* send at most this many copies (default) */
2fe58dfd
SE
44
45/* Each site can be in one of several possible states. */
46
47/* States:
48 SITE_STOP - nothing is allowed to happen; tunnel is down;
49 all session keys have been erased
50 -> SITE_RUN upon external instruction
51 SITE_RUN - site up, maybe with valid key
52 -> SITE_RESOLVE upon outgoing packet and no valid key
53 we start name resolution for the other end of the tunnel
54 -> SITE_SENTMSG2 upon valid incoming message 1 and suitable time
55 we send an appropriate message 2
56 SITE_RESOLVE - waiting for name resolution
57 -> SITE_SENTMSG1 upon successful resolution
58 we send an appropriate message 1
59 -> SITE_SENTMSG2 upon valid incoming message 1 (then abort resolution)
60 we abort resolution and
61 -> SITE_WAIT on timeout or resolution failure
62 SITE_SENTMSG1
63 -> SITE_SENTMSG2 upon valid incoming message 1 from higher priority end
64 -> SITE_SENTMSG3 upon valid incoming message 2
65 -> SITE_WAIT on timeout
66 SITE_SENTMSG2
67 -> SITE_SENTMSG4 upon valid incoming message 3
68 -> SITE_WAIT on timeout
69 SITE_SENTMSG3
70 -> SITE_SENTMSG5 upon valid incoming message 4
71 -> SITE_WAIT on timeout
72 SITE_SENTMSG4
73 -> SITE_RUN upon valid incoming message 5
74 -> SITE_WAIT on timeout
75 SITE_SENTMSG5
76 -> SITE_RUN upon valid incoming message 6
77 -> SITE_WAIT on timeout
78 SITE_WAIT - failed to establish key; do nothing for a while
79 -> SITE_RUN on timeout
80 */
81
82#define SITE_STOP 0
83#define SITE_RUN 1
84#define SITE_RESOLVE 2
85#define SITE_SENTMSG1 3
86#define SITE_SENTMSG2 4
87#define SITE_SENTMSG3 5
88#define SITE_SENTMSG4 6
89#define SITE_SENTMSG5 7
90#define SITE_WAIT 8
91
3abd18e8
IJ
92int32_t site_max_start_pad = 4*4;
93
fe5e9cc4 94static cstring_t state_name(uint32_t state)
2fe58dfd
SE
95{
96 switch (state) {
3454dce4
SE
97 case 0: return "STOP";
98 case 1: return "RUN";
99 case 2: return "RESOLVE";
100 case 3: return "SENTMSG1";
101 case 4: return "SENTMSG2";
102 case 5: return "SENTMSG3";
103 case 6: return "SENTMSG4";
104 case 7: return "SENTMSG5";
105 case 8: return "WAIT";
2fe58dfd
SE
106 default: return "*bad state*";
107 }
108}
109
2fe58dfd
SE
110#define NONCELEN 8
111
112#define LOG_UNEXPECTED 0x00000001
113#define LOG_SETUP_INIT 0x00000002
114#define LOG_SETUP_TIMEOUT 0x00000004
115#define LOG_ACTIVATE_KEY 0x00000008
116#define LOG_TIMEOUT_KEY 0x00000010
9d3a4132 117#define LOG_SEC 0x00000020
2fe58dfd
SE
118#define LOG_STATE 0x00000040
119#define LOG_DROP 0x00000080
120#define LOG_DUMP 0x00000100
121#define LOG_ERROR 0x00000400
446353cd 122#define LOG_PEER_ADDRS 0x00000800
2fe58dfd 123
9d3a4132
SE
124static struct flagstr log_event_table[]={
125 { "unexpected", LOG_UNEXPECTED },
126 { "setup-init", LOG_SETUP_INIT },
127 { "setup-timeout", LOG_SETUP_TIMEOUT },
128 { "activate-key", LOG_ACTIVATE_KEY },
129 { "timeout-key", LOG_TIMEOUT_KEY },
130 { "security", LOG_SEC },
131 { "state-change", LOG_STATE },
132 { "packet-drop", LOG_DROP },
133 { "dump-packets", LOG_DUMP },
134 { "errors", LOG_ERROR },
446353cd 135 { "peer-addrs", LOG_PEER_ADDRS },
ff05a229
SE
136 { "default", LOG_SETUP_INIT|LOG_SETUP_TIMEOUT|
137 LOG_ACTIVATE_KEY|LOG_TIMEOUT_KEY|LOG_SEC|LOG_ERROR },
9d3a4132
SE
138 { "all", 0xffffffff },
139 { NULL, 0 }
140};
141
446353cd
IJ
142
143/***** TRANSPORT PEERS declarations *****/
144
145/* Details of "mobile peer" semantics:
f6eff504
IJ
146
147 | Note: this comment is wishful thinking right now. It will be
148 | implemented in subsequent commits.
149
150 - We use the same data structure for the different configurations,
151 but manage it with different algorithms.
446353cd 152
f6eff504
IJ
153 - We record up to mobile_peers_max peer address/port numbers
154 ("peers") for key setup, and separately up to mobile_peers_max
155 for data transfer.
156
157 - In general, we make a new set of addrs (see below) when we start
158 a new key exchange; the key setup addrs become the data transport
159 addrs when key setup complets.
160
161 If our peer is mobile:
162
163 - We send to all recent addresses of incoming packets, plus
164 initially all configured addresses (which we also expire).
165
166 - So, we record addrs of good incoming packets, as follows:
167 1. expire any peers last seen >120s ("mobile-peer-expiry") ago
168 2. add the peer of the just received packet to the applicable list
169 (possibly evicting the oldest entries to make room)
170 NB that we do not expire peers until an incoming packet arrives.
446353cd 171
f6eff504
IJ
172 - If the peer has a configured address or name, we record them the
173 same way, but only as a result of our own initiation of key
174 setup. (We might evict some incoming packet addrs to make room.)
446353cd 175
f6eff504
IJ
176 - The default number of addrs to keep is 3, or 4 if we have a
177 configured name or address. That's space for two configured
178 addresses (one IPv6 and one IPv4), plus two received addresses.
179
180 - Outgoing packets are sent to every recorded address in the
181 applicable list. Any unsupported[1] addresses are deleted from
182 the list right away. (This should only happen to configured
183 addresses, of course, but there is no need to check that.)
184
185 - When we successfully complete a key setup, we merge the key setup
446353cd
IJ
186 peers into the data transfer peers.
187
f6eff504
IJ
188 [1] An unsupported address is one for whose AF we don't have a
189 socket (perhaps because we got EAFNOSUPPORT or some such) or for
190 which sendto gives ENETUNREACH.
191
192 If neither end is mobile:
193
194 - When peer initiated the key exchange, we use the incoming packet
195 address.
196
197 - When we initiate the key exchange, we try configured addresses
198 until we get one which isn't unsupported then fixate on that.
199
200 - When we complete a key setup, we replace the data transport peers
201 with those from the key setup.
446353cd 202
f6eff504 203 If we are mobile:
446353cd 204
f6eff504
IJ
205 - We can't tell when local network setup changes so we can't cache
206 the unsupported addrs and completely remove the spurious calls to
207 sendto, but we can optimise things a bit by deprioritising addrs
208 which seem to be unsupported.
446353cd 209
f6eff504
IJ
210 - Use only configured addresses. (Except, that if our peer
211 initiated a key exchange we use the incoming packet address until
212 our name resolution completes.)
446353cd 213
f6eff504
IJ
214 - When we send a packet, try each address in turn; if addr
215 supported, put that address to the end of the list for future
216 packets, and go onto the next address.
446353cd 217
f6eff504
IJ
218 - When we complete a key setup, we replace the data transport peers
219 with those from the key setup.
446353cd
IJ
220
221 */
222
cc420616 223#define MAX_MOBILE_PEERS_MAX MAX_PEER_ADDRS /* send at most this many copies */
446353cd
IJ
224
225typedef struct {
226 struct timeval last;
227 struct comm_addr addr;
228} transport_peer;
229
230typedef struct {
231/* configuration information */
232/* runtime information */
233 int npeers;
234 transport_peer peers[MAX_MOBILE_PEERS_MAX];
235} transport_peers;
236
8b21a212 237/* Basic operations on transport peer address sets */
446353cd
IJ
238static void transport_peers_clear(struct site *st, transport_peers *peers);
239static int transport_peers_valid(transport_peers *peers);
240static void transport_peers_copy(struct site *st, transport_peers *dst,
241 const transport_peers *src);
242
8b21a212 243/* Record address of incoming setup packet; resp. data packet. */
446353cd
IJ
244static void transport_setup_msgok(struct site *st, const struct comm_addr *a);
245static void transport_data_msgok(struct site *st, const struct comm_addr *a);
8b21a212
IJ
246
247/* Initialise the setup addresses. Called before we send the first
248 * packet in a key exchange. If we are the initiator, as a result of
249 * resolve completing (or being determined not to be relevant) or an
250 * incoming PROD; if we are the responder, as a result of the MSG1. */
446353cd 251static bool_t transport_compute_setupinit_peers(struct site *st,
45a14422
IJ
252 const struct comm_addr *configured_addrs /* 0 if none or not found */,
253 int n_configured_addrs /* 0 if none or not found */,
a96fda35 254 const struct comm_addr *incoming_packet_addr /* 0 if none */);
8b21a212
IJ
255
256/* Called if we are the responder in a key setup, when the resolve
257 * completes. transport_compute_setupinit_peers will hvae been called
258 * earlier. If _complete is called, we are still doing the key setup
259 * (and we should use the new values for both the rest of the key
260 * setup and the ongoing data exchange); if _tardy is called, the key
261 * setup is done (either completed or not) and only the data peers are
262 * relevant */
90d7e3ad 263static void transport_resolve_complete(struct site *st,
45a14422 264 const struct comm_addr *addrs, int naddrs);
90d7e3ad 265static void transport_resolve_complete_tardy(struct site *st,
45a14422 266 const struct comm_addr *addrs, int naddrs);
446353cd
IJ
267
268static void transport_xmit(struct site *st, transport_peers *peers,
269 struct buffer_if *buf, bool_t candebug);
270
271 /***** END of transport peers declarations *****/
272
273
19e9a588
IJ
274struct data_key {
275 struct transform_inst_if *transform;
276 uint64_t key_timeout; /* End of life of current key */
277 uint32_t remote_session_id;
278};
279
2fe58dfd
SE
280struct site {
281 closure_t cl;
282 struct site_if ops;
283/* configuration information */
284 string_t localname;
285 string_t remotename;
0391d9ee 286 bool_t local_mobile, peer_mobile; /* Mobile client support */
446353cd 287 int32_t transport_peers_max;
ff05a229 288 string_t tunname; /* localname<->remotename by default, used in logs */
2fe58dfd 289 string_t address; /* DNS name for bootstrapping, optional */
ff05a229 290 int remoteport; /* Port for bootstrapping, optional */
3ed1846a 291 uint32_t mtu_target;
2fe58dfd 292 struct netlink_if *netlink;
59533c16
IJ
293 struct comm_if **comms;
294 int ncomms;
2fe58dfd
SE
295 struct resolver_if *resolver;
296 struct log_if *log;
297 struct random_if *random;
298 struct rsaprivkey_if *privkey;
2fe58dfd 299 struct rsapubkey_if *pubkey;
5b5f297f
IJ
300 struct transform_if **transforms;
301 int ntransforms;
2fe58dfd
SE
302 struct dh_if *dh;
303 struct hash_if *hash;
2fe58dfd 304
58650a70 305 uint32_t index; /* Index of this site */
09a385fb 306 uint32_t local_capabilities;
1caa23ff 307 int32_t setup_retries; /* How many times to send setup packets */
e7f8ec2a 308 int32_t setup_retry_interval; /* Initial timeout for setup packets */
4a8aed08 309 int32_t wait_timeout; /* How long to wait if setup unsuccessful */
446353cd 310 int32_t mobile_peer_expiry; /* How long to remember 2ary addresses */
4a8aed08
IJ
311 int32_t key_lifetime; /* How long a key lasts once set up */
312 int32_t key_renegotiate_time; /* If we see traffic (or a keepalive)
9d3a4132
SE
313 after this time, initiate a new
314 key exchange */
2fe58dfd 315
2fe58dfd
SE
316 bool_t setup_priority; /* Do we have precedence if both sites emit
317 message 1 simultaneously? */
318 uint32_t log_events;
319
320/* runtime information */
321 uint32_t state;
322 uint64_t now; /* Most recently seen time */
dd9209d1 323 bool_t allow_send_prod;
5c19b79c 324 bool_t resolving;
2fe58dfd 325
ff05a229 326 /* The currently established session */
19e9a588 327 struct data_key current;
02b0959b 328 struct data_key auxiliary_key;
bd98cd6b 329 bool_t auxiliary_is_new;
ff05a229 330 uint64_t renegotiate_key_time; /* When we can negotiate a new key */
bd98cd6b 331 uint64_t auxiliary_renegotiate_key_time;
446353cd 332 transport_peers peers; /* Current address(es) of peer for data traffic */
2fe58dfd 333
ff05a229
SE
334 /* The current key setup protocol exchange. We can only be
335 involved in one of these at a time. There's a potential for
336 denial of service here (the attacker keeps sending a setup
337 packet; we keep trying to continue the exchange, and have to
338 timeout before we can listen for another setup packet); perhaps
339 we should keep a list of 'bad' sources for setup packets. */
09a385fb 340 uint32_t remote_capabilities;
3ed1846a 341 uint16_t remote_adv_mtu;
5b5f297f 342 struct transform_if *chosen_transform;
2fe58dfd 343 uint32_t setup_session_id;
446353cd 344 transport_peers setup_peers;
2fe58dfd
SE
345 uint8_t localN[NONCELEN]; /* Nonces for key exchange */
346 uint8_t remoteN[NONCELEN];
347 struct buffer_if buffer; /* Current outgoing key exchange packet */
05f39b4d 348 struct buffer_if scratch;
4a8aed08 349 int32_t retries; /* Number of retries remaining */
2fe58dfd
SE
350 uint64_t timeout; /* Timeout for current state */
351 uint8_t *dhsecret;
352 uint8_t *sharedsecret;
5b5f297f 353 uint32_t sharedsecretlen, sharedsecretallocd;
2fe58dfd
SE
354 struct transform_inst_if *new_transform; /* For key setup/verify */
355};
356
8368df34
IJ
357static uint32_t event_log_priority(struct site *st, uint32_t event)
358{
359 if (!(event&st->log_events))
360 return 0;
361 switch(event) {
362 case LOG_UNEXPECTED: return M_INFO;
363 case LOG_SETUP_INIT: return M_INFO;
364 case LOG_SETUP_TIMEOUT: return M_NOTICE;
365 case LOG_ACTIVATE_KEY: return M_INFO;
366 case LOG_TIMEOUT_KEY: return M_INFO;
367 case LOG_SEC: return M_SECURITY;
368 case LOG_STATE: return M_DEBUG;
369 case LOG_DROP: return M_DEBUG;
370 case LOG_DUMP: return M_DEBUG;
371 case LOG_ERROR: return M_ERR;
372 case LOG_PEER_ADDRS: return M_DEBUG;
373 default: return M_ERR;
374 }
375}
376
0237c848
IJ
377static void vslog(struct site *st, uint32_t event, cstring_t msg, va_list ap)
378FORMAT(printf,3,0);
379static void vslog(struct site *st, uint32_t event, cstring_t msg, va_list ap)
2fe58dfd 380{
b2a56f7c 381 uint32_t class;
2fe58dfd 382
8368df34
IJ
383 class=event_log_priority(st, event);
384 if (class) {
e5d8c16e
IJ
385 slilog_part(st->log,class,"%s: ",st->tunname);
386 vslilog_part(st->log,class,msg,ap);
387 slilog_part(st->log,class,"\n");
2fe58dfd 388 }
2fe58dfd
SE
389}
390
0237c848
IJ
391static void slog(struct site *st, uint32_t event, cstring_t msg, ...)
392FORMAT(printf,3,4);
393static void slog(struct site *st, uint32_t event, cstring_t msg, ...)
394{
395 va_list ap;
396 va_start(ap,msg);
397 vslog(st,event,msg,ap);
398 va_end(ap);
399}
400
4f3c75ac
IJ
401static void logtimeout(struct site *st, const char *fmt, ...)
402FORMAT(printf,2,3);
403static void logtimeout(struct site *st, const char *fmt, ...)
404{
e9c9020e
IJ
405 uint32_t class=event_log_priority(st,LOG_SETUP_TIMEOUT);
406 if (!class)
407 return;
408
4f3c75ac
IJ
409 va_list ap;
410 va_start(ap,fmt);
e9c9020e
IJ
411
412 slilog_part(st->log,class,"%s: ",st->tunname);
413 vslilog_part(st->log,class,fmt,ap);
414
415 const char *delim;
416 int i;
417 for (i=0, delim=" (tried ";
418 i<st->setup_peers.npeers;
419 i++, delim=", ") {
420 transport_peer *peer=&st->setup_peers.peers[i];
421 const char *s=comm_addr_to_string(&peer->addr);
422 slilog_part(st->log,class,"%s%s",delim,s);
423 }
424
425 slilog_part(st->log,class,")\n");
4f3c75ac
IJ
426 va_end(ap);
427}
428
9d3a4132 429static void set_link_quality(struct site *st);
1d388569
IJ
430static void delete_keys(struct site *st, cstring_t reason, uint32_t loglevel);
431static void delete_one_key(struct site *st, struct data_key *key,
432 const char *reason /* may be 0 meaning don't log*/,
433 const char *which /* ignored if !reasonn */,
434 uint32_t loglevel /* ignored if !reasonn */);
dd9209d1
IJ
435static bool_t initiate_key_setup(struct site *st, cstring_t reason,
436 const struct comm_addr *prod_hint);
2fe58dfd
SE
437static void enter_state_run(struct site *st);
438static bool_t enter_state_resolve(struct site *st);
ff05a229 439static bool_t enter_new_state(struct site *st,uint32_t next);
2fe58dfd 440static void enter_state_wait(struct site *st);
05f39b4d 441static void activate_new_key(struct site *st);
2fe58dfd 442
0afd257e
IJ
443static bool_t is_transform_valid(struct transform_inst_if *transform)
444{
fcad4b0b 445 return transform && transform->valid(transform->st);
0afd257e
IJ
446}
447
3d8d8f4e
IJ
448static bool_t current_valid(struct site *st)
449{
0afd257e
IJ
450 return is_transform_valid(st->current.transform);
451}
452
453#define DEFINE_CALL_TRANSFORM(fwdrev) \
454static int call_transform_##fwdrev(struct site *st, \
455 struct transform_inst_if *transform, \
456 struct buffer_if *buf, \
457 const char **errmsg) \
458{ \
fcad4b0b
IJ
459 if (!is_transform_valid(transform)) { \
460 *errmsg="transform not set up"; \
461 return 1; \
462 } \
0afd257e 463 return transform->fwdrev(transform->st,buf,errmsg); \
3d8d8f4e
IJ
464}
465
0afd257e
IJ
466DEFINE_CALL_TRANSFORM(forwards)
467DEFINE_CALL_TRANSFORM(reverse)
468
469static void dispose_transform(struct transform_inst_if **transform_var)
470{
0afd257e 471 struct transform_inst_if *transform=*transform_var;
fcad4b0b
IJ
472 if (transform) {
473 transform->delkey(transform->st);
474 transform->destroy(transform->st);
475 }
476 *transform_var = 0;
0afd257e
IJ
477}
478
2fe58dfd
SE
479#define CHECK_AVAIL(b,l) do { if ((b)->size<(l)) return False; } while(0)
480#define CHECK_EMPTY(b) do { if ((b)->size!=0) return False; } while(0)
481#define CHECK_TYPE(b,t) do { uint32_t type; \
482 CHECK_AVAIL((b),4); \
59635212 483 type=buf_unprepend_uint32((b)); \
2fe58dfd
SE
484 if (type!=(t)) return False; } while(0)
485
3ed1846a
IJ
486static _Bool type_is_msg34(uint32_t type)
487{
488 return
489 type == LABEL_MSG3 ||
490 type == LABEL_MSG3BIS ||
491 type == LABEL_MSG4;
492}
493
1737eeef
IJ
494struct parsedname {
495 int32_t len;
496 uint8_t *name;
09a385fb 497 struct buffer_if extrainfo;
1737eeef
IJ
498};
499
2fe58dfd
SE
500struct msg {
501 uint8_t *hashstart;
502 uint32_t dest;
503 uint32_t source;
1737eeef
IJ
504 struct parsedname remote;
505 struct parsedname local;
09a385fb 506 uint32_t remote_capabilities;
3ed1846a 507 uint16_t remote_mtu;
5b5f297f 508 int capab_transformnum;
2fe58dfd
SE
509 uint8_t *nR;
510 uint8_t *nL;
1caa23ff 511 int32_t pklen;
3e8addad 512 char *pk;
1caa23ff
IJ
513 int32_t hashlen;
514 int32_t siglen;
3e8addad 515 char *sig;
2fe58dfd
SE
516};
517
5b5f297f 518static void set_new_transform(struct site *st, char *pk)
0afd257e 519{
5b5f297f
IJ
520 /* Make room for the shared key */
521 st->sharedsecretlen=st->chosen_transform->keylen?:st->dh->ceil_len;
522 assert(st->sharedsecretlen);
523 if (st->sharedsecretlen > st->sharedsecretallocd) {
524 st->sharedsecretallocd=st->sharedsecretlen;
525 st->sharedsecret=realloc(st->sharedsecret,st->sharedsecretallocd);
526 }
527 if (!st->sharedsecret) fatal_perror("site:sharedsecret");
528
529 /* Generate the shared key */
530 st->dh->makeshared(st->dh->st,st->dhsecret,st->dh->len,pk,
531 st->sharedsecret,st->sharedsecretlen);
532
533 /* Set up the transform */
534 struct transform_if *generator=st->chosen_transform;
fcad4b0b
IJ
535 struct transform_inst_if *generated=generator->create(generator->st);
536 generated->setkey(generated->st,st->sharedsecret,
537 st->sharedsecretlen,st->setup_priority);
538 dispose_transform(&st->new_transform);
539 st->new_transform=generated;
5b5f297f
IJ
540
541 slog(st,LOG_SETUP_INIT,"key exchange negotiated transform"
542 " %d (capabilities ours=%#"PRIx32" theirs=%#"PRIx32")",
543 st->chosen_transform->capab_transformnum,
544 st->local_capabilities, st->remote_capabilities);
0afd257e
IJ
545}
546
09a385fb
IJ
547struct xinfoadd {
548 int32_t lenpos, afternul;
549};
550static void append_string_xinfo_start(struct buffer_if *buf,
551 struct xinfoadd *xia,
552 const char *str)
553 /* Helps construct one of the names with additional info as found
554 * in MSG1..4. Call this function first, then append all the
555 * desired extra info (not including the nul byte) to the buffer,
556 * then call append_string_xinfo_done. */
557{
558 xia->lenpos = buf->size;
559 buf_append_string(buf,str);
560 buf_append_uint8(buf,0);
561 xia->afternul = buf->size;
562}
563static void append_string_xinfo_done(struct buffer_if *buf,
564 struct xinfoadd *xia)
565{
566 /* we just need to adjust the string length */
567 if (buf->size == xia->afternul) {
568 /* no extra info, strip the nul too */
569 buf_unappend_uint8(buf);
570 } else {
571 put_uint16(buf->start+xia->lenpos, buf->size-(xia->lenpos+2));
572 }
573}
574
ff05a229
SE
575/* Build any of msg1 to msg4. msg5 and msg6 are built from the inside
576 out using a transform of config data supplied by netlink */
fe5e9cc4 577static bool_t generate_msg(struct site *st, uint32_t type, cstring_t what)
2fe58dfd
SE
578{
579 void *hst;
3b83c932 580 uint8_t *hash;
2fe58dfd
SE
581 string_t dhpub, sig;
582
583 st->retries=st->setup_retries;
584 BUF_ALLOC(&st->buffer,what);
585 buffer_init(&st->buffer,0);
59635212
SE
586 buf_append_uint32(&st->buffer,
587 (type==LABEL_MSG1?0:st->setup_session_id));
58650a70 588 buf_append_uint32(&st->buffer,st->index);
59635212 589 buf_append_uint32(&st->buffer,type);
09a385fb
IJ
590
591 struct xinfoadd xia;
592 append_string_xinfo_start(&st->buffer,&xia,st->localname);
593 if ((st->local_capabilities & CAPAB_EARLY) || (type != LABEL_MSG1)) {
594 buf_append_uint32(&st->buffer,st->local_capabilities);
595 }
3ed1846a
IJ
596 if (type_is_msg34(type)) {
597 buf_append_uint16(&st->buffer,st->mtu_target);
598 }
09a385fb
IJ
599 append_string_xinfo_done(&st->buffer,&xia);
600
2fe58dfd 601 buf_append_string(&st->buffer,st->remotename);
4f28e77e 602 BUF_ADD_OBJ(append,&st->buffer,st->localN);
2fe58dfd 603 if (type==LABEL_MSG1) return True;
4f28e77e 604 BUF_ADD_OBJ(append,&st->buffer,st->remoteN);
2fe58dfd 605 if (type==LABEL_MSG2) return True;
3b83c932
SE
606
607 if (hacky_par_mid_failnow()) return False;
608
5b5f297f
IJ
609 if (type==LABEL_MSG3BIS)
610 buf_append_uint8(&st->buffer,st->chosen_transform->capab_transformnum);
611
2fe58dfd
SE
612 dhpub=st->dh->makepublic(st->dh->st,st->dhsecret,st->dh->len);
613 buf_append_string(&st->buffer,dhpub);
614 free(dhpub);
3b83c932 615 hash=safe_malloc(st->hash->len, "generate_msg");
2fe58dfd
SE
616 hst=st->hash->init();
617 st->hash->update(hst,st->buffer.start,st->buffer.size);
618 st->hash->final(hst,hash);
619 sig=st->privkey->sign(st->privkey->st,hash,st->hash->len);
620 buf_append_string(&st->buffer,sig);
621 free(sig);
3b83c932 622 free(hash);
2fe58dfd
SE
623 return True;
624}
625
1737eeef
IJ
626static bool_t unpick_name(struct buffer_if *msg, struct parsedname *nm)
627{
628 CHECK_AVAIL(msg,2);
629 nm->len=buf_unprepend_uint16(msg);
630 CHECK_AVAIL(msg,nm->len);
631 nm->name=buf_unprepend(msg,nm->len);
632 uint8_t *nul=memchr(nm->name,0,nm->len);
633 if (!nul) {
09a385fb 634 buffer_readonly_view(&nm->extrainfo,0,0);
1737eeef 635 } else {
09a385fb 636 buffer_readonly_view(&nm->extrainfo, nul+1, msg->start-(nul+1));
1737eeef
IJ
637 nm->len=nul-nm->name;
638 }
639 return True;
640}
641
2fe58dfd
SE
642static bool_t unpick_msg(struct site *st, uint32_t type,
643 struct buffer_if *msg, struct msg *m)
644{
5b5f297f 645 m->capab_transformnum=-1;
2fe58dfd
SE
646 m->hashstart=msg->start;
647 CHECK_AVAIL(msg,4);
59635212 648 m->dest=buf_unprepend_uint32(msg);
2fe58dfd 649 CHECK_AVAIL(msg,4);
59635212 650 m->source=buf_unprepend_uint32(msg);
2fe58dfd 651 CHECK_TYPE(msg,type);
1737eeef 652 if (!unpick_name(msg,&m->remote)) return False;
09a385fb 653 m->remote_capabilities=0;
3ed1846a 654 m->remote_mtu=0;
09a385fb
IJ
655 if (m->remote.extrainfo.size) {
656 CHECK_AVAIL(&m->remote.extrainfo,4);
657 m->remote_capabilities=buf_unprepend_uint32(&m->remote.extrainfo);
658 }
3ed1846a
IJ
659 if (type_is_msg34(type) && m->remote.extrainfo.size) {
660 CHECK_AVAIL(&m->remote.extrainfo,2);
661 m->remote_mtu=buf_unprepend_uint16(&m->remote.extrainfo);
662 }
1737eeef 663 if (!unpick_name(msg,&m->local)) return False;
dd9209d1
IJ
664 if (type==LABEL_PROD) {
665 CHECK_EMPTY(msg);
666 return True;
667 }
2fe58dfd
SE
668 CHECK_AVAIL(msg,NONCELEN);
669 m->nR=buf_unprepend(msg,NONCELEN);
670 if (type==LABEL_MSG1) {
671 CHECK_EMPTY(msg);
672 return True;
673 }
674 CHECK_AVAIL(msg,NONCELEN);
675 m->nL=buf_unprepend(msg,NONCELEN);
676 if (type==LABEL_MSG2) {
677 CHECK_EMPTY(msg);
678 return True;
679 }
5b5f297f
IJ
680 if (type==LABEL_MSG3BIS) {
681 CHECK_AVAIL(msg,1);
682 m->capab_transformnum = buf_unprepend_uint8(msg);
683 } else {
684 m->capab_transformnum = CAPAB_TRANSFORMNUM_ANCIENT;
685 }
2fe58dfd 686 CHECK_AVAIL(msg,2);
59635212 687 m->pklen=buf_unprepend_uint16(msg);
2fe58dfd
SE
688 CHECK_AVAIL(msg,m->pklen);
689 m->pk=buf_unprepend(msg,m->pklen);
690 m->hashlen=msg->start-m->hashstart;
691 CHECK_AVAIL(msg,2);
59635212 692 m->siglen=buf_unprepend_uint16(msg);
2fe58dfd
SE
693 CHECK_AVAIL(msg,m->siglen);
694 m->sig=buf_unprepend(msg,m->siglen);
695 CHECK_EMPTY(msg);
696 return True;
697}
698
1737eeef
IJ
699static bool_t name_matches(const struct parsedname *nm, const char *expected)
700{
701 int expected_len=strlen(expected);
702 return
703 nm->len == expected_len &&
704 !memcmp(nm->name, expected, expected_len);
705}
706
ff05a229 707static bool_t check_msg(struct site *st, uint32_t type, struct msg *m,
fe5e9cc4 708 cstring_t *error)
ff05a229
SE
709{
710 if (type==LABEL_MSG1) return True;
711
712 /* Check that the site names and our nonce have been sent
713 back correctly, and then store our peer's nonce. */
1737eeef 714 if (!name_matches(&m->remote,st->remotename)) {
ff05a229
SE
715 *error="wrong remote site name";
716 return False;
717 }
1737eeef 718 if (!name_matches(&m->local,st->localname)) {
ff05a229
SE
719 *error="wrong local site name";
720 return False;
721 }
722 if (memcmp(m->nL,st->localN,NONCELEN)!=0) {
723 *error="wrong locally-generated nonce";
724 return False;
725 }
726 if (type==LABEL_MSG2) return True;
5ad34db2 727 if (!consttime_memeq(m->nR,st->remoteN,NONCELEN)!=0) {
ff05a229
SE
728 *error="wrong remotely-generated nonce";
729 return False;
730 }
09a385fb
IJ
731 /* MSG3 has complicated rules about capabilities, which are
732 * handled in process_msg3. */
5b5f297f 733 if (type==LABEL_MSG3 || type==LABEL_MSG3BIS) return True;
09a385fb
IJ
734 if (m->remote_capabilities!=st->remote_capabilities) {
735 *error="remote capabilities changed";
736 return False;
737 }
ff05a229
SE
738 if (type==LABEL_MSG4) return True;
739 *error="unknown message type";
740 return False;
741}
742
2fe58dfd
SE
743static bool_t generate_msg1(struct site *st)
744{
745 st->random->generate(st->random->st,NONCELEN,st->localN);
746 return generate_msg(st,LABEL_MSG1,"site:MSG1");
747}
748
749static bool_t process_msg1(struct site *st, struct buffer_if *msg1,
7e29719e 750 const struct comm_addr *src, struct msg *m)
2fe58dfd 751{
2fe58dfd
SE
752 /* We've already determined we're in an appropriate state to
753 process an incoming MSG1, and that the MSG1 has correct values
754 of A and B. */
755
7e29719e 756 st->setup_session_id=m->source;
09a385fb 757 st->remote_capabilities=m->remote_capabilities;
7e29719e 758 memcpy(st->remoteN,m->nR,NONCELEN);
2fe58dfd
SE
759 return True;
760}
761
762static bool_t generate_msg2(struct site *st)
763{
764 st->random->generate(st->random->st,NONCELEN,st->localN);
765 return generate_msg(st,LABEL_MSG2,"site:MSG2");
766}
767
768static bool_t process_msg2(struct site *st, struct buffer_if *msg2,
a15faeb2 769 const struct comm_addr *src)
2fe58dfd
SE
770{
771 struct msg m;
fe5e9cc4 772 cstring_t err;
2fe58dfd
SE
773
774 if (!unpick_msg(st,LABEL_MSG2,msg2,&m)) return False;
ff05a229
SE
775 if (!check_msg(st,LABEL_MSG2,&m,&err)) {
776 slog(st,LOG_SEC,"msg2: %s",err);
2fe58dfd
SE
777 return False;
778 }
779 st->setup_session_id=m.source;
09a385fb 780 st->remote_capabilities=m.remote_capabilities;
5b5f297f
IJ
781
782 /* Select the transform to use */
783
784 uint32_t remote_transforms = st->remote_capabilities & CAPAB_TRANSFORM_MASK;
785 if (!remote_transforms)
786 /* old secnets only had this one transform */
787 remote_transforms = 1UL << CAPAB_TRANSFORMNUM_ANCIENT;
788
789 struct transform_if *ti;
790 int i;
791 for (i=0; i<st->ntransforms; i++) {
792 ti=st->transforms[i];
793 if ((1UL << ti->capab_transformnum) & remote_transforms)
794 goto transform_found;
795 }
796 slog(st,LOG_ERROR,"no transforms in common"
797 " (us %#"PRIx32"; them: %#"PRIx32")",
798 st->local_capabilities & CAPAB_TRANSFORM_MASK,
799 remote_transforms);
800 return False;
801 transform_found:
802 st->chosen_transform=ti;
803
2fe58dfd
SE
804 memcpy(st->remoteN,m.nR,NONCELEN);
805 return True;
806}
807
808static bool_t generate_msg3(struct site *st)
809{
810 /* Now we have our nonce and their nonce. Think of a secret key,
811 and create message number 3. */
812 st->random->generate(st->random->st,st->dh->len,st->dhsecret);
5b5f297f
IJ
813 return generate_msg(st,
814 (st->remote_capabilities & CAPAB_TRANSFORM_MASK
815 ? LABEL_MSG3BIS : LABEL_MSG3),
816 "site:MSG3");
2fe58dfd
SE
817}
818
e001e8c0
IJ
819static bool_t process_msg3_msg4(struct site *st, struct msg *m)
820{
821 uint8_t *hash;
822 void *hst;
823
824 /* Check signature and store g^x mod m */
825 hash=safe_malloc(st->hash->len, "process_msg3_msg4");
826 hst=st->hash->init();
827 st->hash->update(hst,m->hashstart,m->hashlen);
828 st->hash->final(hst,hash);
829 /* Terminate signature with a '0' - cheating, but should be ok */
830 m->sig[m->siglen]=0;
831 if (!st->pubkey->check(st->pubkey->st,hash,st->hash->len,m->sig)) {
832 slog(st,LOG_SEC,"msg3/msg4 signature failed check!");
833 free(hash);
834 return False;
835 }
836 free(hash);
837
3ed1846a
IJ
838 st->remote_adv_mtu=m->remote_mtu;
839
e001e8c0
IJ
840 return True;
841}
842
2fe58dfd 843static bool_t process_msg3(struct site *st, struct buffer_if *msg3,
5b5f297f 844 const struct comm_addr *src, uint32_t msgtype)
2fe58dfd
SE
845{
846 struct msg m;
fe5e9cc4 847 cstring_t err;
2fe58dfd 848
5b5f297f
IJ
849 assert(msgtype==LABEL_MSG3 || msgtype==LABEL_MSG3BIS);
850
851 if (!unpick_msg(st,msgtype,msg3,&m)) return False;
852 if (!check_msg(st,msgtype,&m,&err)) {
ff05a229 853 slog(st,LOG_SEC,"msg3: %s",err);
2fe58dfd
SE
854 return False;
855 }
09a385fb
IJ
856 uint32_t capab_adv_late = m.remote_capabilities
857 & ~st->remote_capabilities & CAPAB_EARLY;
858 if (capab_adv_late) {
859 slog(st,LOG_SEC,"msg3 impermissibly adds early capability flag(s)"
860 " %#"PRIx32" (was %#"PRIx32", now %#"PRIx32")",
861 capab_adv_late, st->remote_capabilities, m.remote_capabilities);
862 return False;
863 }
864 st->remote_capabilities|=m.remote_capabilities;
ff05a229 865
5b5f297f
IJ
866 struct transform_if *ti;
867 int i;
868 for (i=0; i<st->ntransforms; i++) {
869 ti=st->transforms[i];
870 if (ti->capab_transformnum == m.capab_transformnum)
871 goto transform_found;
872 }
873 slog(st,LOG_SEC,"peer chose unknown-to-us transform %d!",
874 m.capab_transformnum);
875 return False;
876 transform_found:
877 st->chosen_transform=ti;
878
e001e8c0 879 if (!process_msg3_msg4(st,&m))
2fe58dfd 880 return False;
2fe58dfd
SE
881
882 /* Terminate their DH public key with a '0' */
883 m.pk[m.pklen]=0;
884 /* Invent our DH secret key */
885 st->random->generate(st->random->st,st->dh->len,st->dhsecret);
886
5b5f297f
IJ
887 /* Generate the shared key and set up the transform */
888 set_new_transform(st,m.pk);
2fe58dfd
SE
889
890 return True;
891}
892
893static bool_t generate_msg4(struct site *st)
894{
895 /* We have both nonces, their public key and our private key. Generate
896 our public key, sign it and send it to them. */
897 return generate_msg(st,LABEL_MSG4,"site:MSG4");
898}
899
900static bool_t process_msg4(struct site *st, struct buffer_if *msg4,
a15faeb2 901 const struct comm_addr *src)
2fe58dfd
SE
902{
903 struct msg m;
fe5e9cc4 904 cstring_t err;
2fe58dfd
SE
905
906 if (!unpick_msg(st,LABEL_MSG4,msg4,&m)) return False;
ff05a229
SE
907 if (!check_msg(st,LABEL_MSG4,&m,&err)) {
908 slog(st,LOG_SEC,"msg4: %s",err);
2fe58dfd
SE
909 return False;
910 }
911
e001e8c0 912 if (!process_msg3_msg4(st,&m))
2fe58dfd 913 return False;
2fe58dfd
SE
914
915 /* Terminate their DH public key with a '0' */
916 m.pk[m.pklen]=0;
5b5f297f
IJ
917
918 /* Generate the shared key and set up the transform */
919 set_new_transform(st,m.pk);
2fe58dfd
SE
920
921 return True;
922}
923
2fe58dfd
SE
924struct msg0 {
925 uint32_t dest;
926 uint32_t source;
927 uint32_t type;
928};
929
930static bool_t unpick_msg0(struct site *st, struct buffer_if *msg0,
931 struct msg0 *m)
932{
933 CHECK_AVAIL(msg0,4);
59635212 934 m->dest=buf_unprepend_uint32(msg0);
2fe58dfd 935 CHECK_AVAIL(msg0,4);
59635212 936 m->source=buf_unprepend_uint32(msg0);
2fe58dfd 937 CHECK_AVAIL(msg0,4);
59635212 938 m->type=buf_unprepend_uint32(msg0);
2fe58dfd
SE
939 return True;
940 /* Leaves transformed part of buffer untouched */
941}
942
ff05a229
SE
943static bool_t generate_msg5(struct site *st)
944{
fe5e9cc4 945 cstring_t transform_err;
ff05a229
SE
946
947 BUF_ALLOC(&st->buffer,"site:MSG5");
948 /* We are going to add four words to the message */
3abd18e8 949 buffer_init(&st->buffer,calculate_max_start_pad());
ff05a229
SE
950 /* Give the netlink code an opportunity to put its own stuff in the
951 message (configuration information, etc.) */
ff05a229 952 buf_prepend_uint32(&st->buffer,LABEL_MSG5);
0afd257e
IJ
953 if (call_transform_forwards(st,st->new_transform,
954 &st->buffer,&transform_err))
955 return False;
ff05a229 956 buf_prepend_uint32(&st->buffer,LABEL_MSG5);
58650a70 957 buf_prepend_uint32(&st->buffer,st->index);
ff05a229
SE
958 buf_prepend_uint32(&st->buffer,st->setup_session_id);
959
960 st->retries=st->setup_retries;
961 return True;
962}
963
2fe58dfd 964static bool_t process_msg5(struct site *st, struct buffer_if *msg5,
c90cc2a7
IJ
965 const struct comm_addr *src,
966 struct transform_inst_if *transform)
2fe58dfd
SE
967{
968 struct msg0 m;
fe5e9cc4 969 cstring_t transform_err;
2fe58dfd
SE
970
971 if (!unpick_msg0(st,msg5,&m)) return False;
972
0afd257e 973 if (call_transform_reverse(st,transform,msg5,&transform_err)) {
2fe58dfd 974 /* There's a problem */
59635212 975 slog(st,LOG_SEC,"process_msg5: transform: %s",transform_err);
2fe58dfd
SE
976 return False;
977 }
978 /* Buffer should now contain untransformed PING packet data */
979 CHECK_AVAIL(msg5,4);
59635212 980 if (buf_unprepend_uint32(msg5)!=LABEL_MSG5) {
ff05a229 981 slog(st,LOG_SEC,"MSG5/PING packet contained wrong label");
2fe58dfd
SE
982 return False;
983 }
ff7cdc9e
IJ
984 /* Older versions of secnet used to write some config data here
985 * which we ignore. So we don't CHECK_EMPTY */
2fe58dfd
SE
986 return True;
987}
988
c90cc2a7
IJ
989static void create_msg6(struct site *st, struct transform_inst_if *transform,
990 uint32_t session_id)
2fe58dfd 991{
fe5e9cc4 992 cstring_t transform_err;
2fe58dfd
SE
993
994 BUF_ALLOC(&st->buffer,"site:MSG6");
ff05a229 995 /* We are going to add four words to the message */
3abd18e8 996 buffer_init(&st->buffer,calculate_max_start_pad());
794f2398
SE
997 /* Give the netlink code an opportunity to put its own stuff in the
998 message (configuration information, etc.) */
ff05a229 999 buf_prepend_uint32(&st->buffer,LABEL_MSG6);
0afd257e
IJ
1000 int problem = call_transform_forwards(st,transform,
1001 &st->buffer,&transform_err);
1002 assert(!problem);
59635212 1003 buf_prepend_uint32(&st->buffer,LABEL_MSG6);
58650a70 1004 buf_prepend_uint32(&st->buffer,st->index);
c90cc2a7
IJ
1005 buf_prepend_uint32(&st->buffer,session_id);
1006}
2fe58dfd 1007
c90cc2a7
IJ
1008static bool_t generate_msg6(struct site *st)
1009{
0afd257e
IJ
1010 if (!is_transform_valid(st->new_transform))
1011 return False;
c90cc2a7 1012 create_msg6(st,st->new_transform,st->setup_session_id);
ff05a229 1013 st->retries=1; /* Peer will retransmit MSG5 if this packet gets lost */
2fe58dfd
SE
1014 return True;
1015}
1016
1017static bool_t process_msg6(struct site *st, struct buffer_if *msg6,
a15faeb2 1018 const struct comm_addr *src)
2fe58dfd
SE
1019{
1020 struct msg0 m;
fe5e9cc4 1021 cstring_t transform_err;
2fe58dfd
SE
1022
1023 if (!unpick_msg0(st,msg6,&m)) return False;
1024
0afd257e 1025 if (call_transform_reverse(st,st->new_transform,msg6,&transform_err)) {
2fe58dfd 1026 /* There's a problem */
59635212 1027 slog(st,LOG_SEC,"process_msg6: transform: %s",transform_err);
2fe58dfd
SE
1028 return False;
1029 }
1030 /* Buffer should now contain untransformed PING packet data */
1031 CHECK_AVAIL(msg6,4);
59635212
SE
1032 if (buf_unprepend_uint32(msg6)!=LABEL_MSG6) {
1033 slog(st,LOG_SEC,"MSG6/PONG packet contained invalid data");
2fe58dfd
SE
1034 return False;
1035 }
ff7cdc9e
IJ
1036 /* Older versions of secnet used to write some config data here
1037 * which we ignore. So we don't CHECK_EMPTY */
2fe58dfd
SE
1038 return True;
1039}
1040
48b97423
IJ
1041static bool_t decrypt_msg0(struct site *st, struct buffer_if *msg0,
1042 const struct comm_addr *src)
2fe58dfd 1043{
02b0959b 1044 cstring_t transform_err, auxkey_err, newkey_err="n/a";
065e1922
IJ
1045 struct msg0 m;
1046 uint32_t problem;
2fe58dfd 1047
2fe58dfd
SE
1048 if (!unpick_msg0(st,msg0,&m)) return False;
1049
05f39b4d
IJ
1050 /* Keep a copy so we can try decrypting it with multiple keys */
1051 buffer_copy(&st->scratch, msg0);
1052
0afd257e
IJ
1053 problem = call_transform_reverse(st,st->current.transform,
1054 msg0,&transform_err);
02b0959b 1055 if (!problem) {
bd98cd6b
IJ
1056 if (!st->auxiliary_is_new)
1057 delete_one_key(st,&st->auxiliary_key,
1058 "peer has used new key","auxiliary key",LOG_SEC);
02b0959b
IJ
1059 return True;
1060 }
48b97423
IJ
1061 if (problem==2)
1062 goto skew;
07e4774c 1063
02b0959b 1064 buffer_copy(msg0, &st->scratch);
fcad4b0b
IJ
1065 problem = call_transform_reverse(st,st->auxiliary_key.transform,
1066 msg0,&auxkey_err);
02b0959b
IJ
1067 if (problem==0) {
1068 slog(st,LOG_DROP,"processing packet which uses auxiliary key");
bd98cd6b
IJ
1069 if (st->auxiliary_is_new) {
1070 /* We previously timed out in state SENTMSG5 but it turns
1071 * out that our peer did in fact get our MSG5 and is
1072 * using the new key. So we should switch to it too. */
1073 /* This is a bit like activate_new_key. */
1074 struct data_key t;
1075 t=st->current;
1076 st->current=st->auxiliary_key;
1077 st->auxiliary_key=t;
1078
1079 delete_one_key(st,&st->auxiliary_key,"peer has used new key",
1080 "previous key",LOG_SEC);
1081 st->auxiliary_is_new=0;
1082 st->renegotiate_key_time=st->auxiliary_renegotiate_key_time;
1083 }
02b0959b
IJ
1084 return True;
1085 }
48b97423
IJ
1086 if (problem==2)
1087 goto skew;
02b0959b 1088
05f39b4d
IJ
1089 if (st->state==SITE_SENTMSG5) {
1090 buffer_copy(msg0, &st->scratch);
0afd257e
IJ
1091 problem = call_transform_reverse(st,st->new_transform,
1092 msg0,&newkey_err);
48b97423 1093 if (!problem) {
05f39b4d
IJ
1094 /* It looks like we didn't get the peer's MSG6 */
1095 /* This is like a cut-down enter_new_state(SITE_RUN) */
1096 slog(st,LOG_STATE,"will enter state RUN (MSG0 with new key)");
1097 BUF_FREE(&st->buffer);
1098 st->timeout=0;
1099 activate_new_key(st);
1100 return True; /* do process the data in this packet */
1101 }
48b97423
IJ
1102 if (problem==2)
1103 goto skew;
05f39b4d
IJ
1104 }
1105
02b0959b
IJ
1106 slog(st,LOG_SEC,"transform: %s (aux: %s, new: %s)",
1107 transform_err,auxkey_err,newkey_err);
dd9209d1 1108 initiate_key_setup(st,"incoming message would not decrypt",0);
48b97423
IJ
1109 send_nak(src,m.dest,m.source,m.type,msg0,"message would not decrypt");
1110 return False;
1111
1112 skew:
1113 slog(st,LOG_DROP,"transform: %s (merely skew)",transform_err);
065e1922
IJ
1114 return False;
1115}
1116
1117static bool_t process_msg0(struct site *st, struct buffer_if *msg0,
1118 const struct comm_addr *src)
1119{
1120 uint32_t type;
1121
48b97423 1122 if (!decrypt_msg0(st,msg0,src))
065e1922
IJ
1123 return False;
1124
2fe58dfd 1125 CHECK_AVAIL(msg0,4);
59635212 1126 type=buf_unprepend_uint32(msg0);
2fe58dfd 1127 switch(type) {
794f2398
SE
1128 case LABEL_MSG7:
1129 /* We must forget about the current session. */
1d388569 1130 delete_keys(st,"request from peer",LOG_SEC);
794f2398 1131 return True;
2fe58dfd
SE
1132 case LABEL_MSG9:
1133 /* Deliver to netlink layer */
469fd1d9 1134 st->netlink->deliver(st->netlink->st,msg0);
446353cd 1135 transport_data_msgok(st,src);
837cf01e
IJ
1136 /* See whether we should start negotiating a new key */
1137 if (st->now > st->renegotiate_key_time)
dd9209d1 1138 initiate_key_setup(st,"incoming packet in renegotiation window",0);
2fe58dfd 1139 return True;
2fe58dfd 1140 default:
ff05a229
SE
1141 slog(st,LOG_SEC,"incoming encrypted message of type %08x "
1142 "(unknown)",type);
2fe58dfd
SE
1143 break;
1144 }
1145 return False;
1146}
1147
1148static void dump_packet(struct site *st, struct buffer_if *buf,
a15faeb2 1149 const struct comm_addr *addr, bool_t incoming)
2fe58dfd 1150{
0a6cbade
IJ
1151 uint32_t dest=get_uint32(buf->start);
1152 uint32_t source=get_uint32(buf->start+4);
1153 uint32_t msgtype=get_uint32(buf->start+8);
2fe58dfd
SE
1154
1155 if (st->log_events & LOG_DUMP)
040ee979
SE
1156 slilog(st->log,M_DEBUG,"%s: %s: %08x<-%08x: %08x:",
1157 st->tunname,incoming?"incoming":"outgoing",
1158 dest,source,msgtype);
2fe58dfd
SE
1159}
1160
1161static uint32_t site_status(void *st)
1162{
1163 return 0;
1164}
1165
1166static bool_t send_msg(struct site *st)
1167{
1168 if (st->retries>0) {
446353cd 1169 transport_xmit(st, &st->setup_peers, &st->buffer, True);
e7f8ec2a 1170 st->timeout=st->now+st->setup_retry_interval;
2fe58dfd
SE
1171 st->retries--;
1172 return True;
bd98cd6b 1173 } else if (st->state==SITE_SENTMSG5) {
4f3c75ac 1174 logtimeout(st,"timed out sending MSG5, stashing new key");
bd98cd6b
IJ
1175 /* We stash the key we have produced, in case it turns out that
1176 * our peer did see our MSG5 after all and starts using it. */
1177 /* This is a bit like some of activate_new_key */
1178 struct transform_inst_if *t;
1179 t=st->auxiliary_key.transform;
1180 st->auxiliary_key.transform=st->new_transform;
1181 st->new_transform=t;
0afd257e 1182 dispose_transform(&st->new_transform);
bd98cd6b 1183
bd98cd6b
IJ
1184 st->auxiliary_is_new=1;
1185 st->auxiliary_key.key_timeout=st->now+st->key_lifetime;
1186 st->auxiliary_renegotiate_key_time=st->now+st->key_renegotiate_time;
1187 st->auxiliary_key.remote_session_id=st->setup_session_id;
1188
1189 enter_state_wait(st);
1190 return False;
2fe58dfd 1191 } else {
4f3c75ac 1192 logtimeout(st,"timed out sending key setup packet "
3454dce4 1193 "(in state %s)",state_name(st->state));
2fe58dfd
SE
1194 enter_state_wait(st);
1195 return False;
1196 }
1197}
1198
cc420616
IJ
1199static void site_resolve_callback(void *sst, const struct comm_addr *addrs,
1200 int naddrs, int was_naddrs)
2fe58dfd
SE
1201{
1202 struct site *st=sst;
1203
5c19b79c
IJ
1204 st->resolving=False;
1205
cc420616
IJ
1206 if (naddrs) {
1207 slog(st,LOG_STATE,"resolution of %s completed, %d addrs, eg: %s",
1208 st->address, was_naddrs, comm_addr_to_string(&addrs[0]));;
1209 if (naddrs != was_naddrs) {
1210 slog(st,LOG_SETUP_INIT,"resolution of supplied addresses/names"
1211 " yielded too many results (%d > %d), some ignored",
1212 was_naddrs, naddrs);
1213 }
2fe58dfd 1214 } else {
2fe58dfd 1215 slog(st,LOG_ERROR,"resolution of %s failed",st->address);
446353cd 1216 }
c22c3541
IJ
1217
1218 switch (st->state) {
1219 case SITE_RESOLVE:
45a14422 1220 if (transport_compute_setupinit_peers(st,addrs,naddrs,0)) {
c22c3541
IJ
1221 enter_new_state(st,SITE_SENTMSG1);
1222 } else {
1223 /* Can't figure out who to try to to talk to */
1224 slog(st,LOG_SETUP_INIT,
1225 "key exchange failed: cannot find peer address");
1226 enter_state_run(st);
1227 }
1228 break;
1229 case SITE_SENTMSG1: case SITE_SENTMSG2:
1230 case SITE_SENTMSG3: case SITE_SENTMSG4:
1231 case SITE_SENTMSG5:
45a14422 1232 if (naddrs) {
c22c3541
IJ
1233 /* We start using the address immediately for data too.
1234 * It's best to store it in st->peers now because we might
1235 * go via SENTMSG5, WAIT, and a MSG0, straight into using
1236 * the new key (without updating the data peer addrs). */
45a14422 1237 transport_resolve_complete(st,addrs,naddrs);
c22c3541
IJ
1238 } else if (st->local_mobile) {
1239 /* We can't let this rest because we may have a peer
1240 * address which will break in the future. */
1241 slog(st,LOG_SETUP_INIT,"resolution of %s failed: "
1242 "abandoning key exchange",st->address);
1243 enter_state_wait(st);
1244 } else {
1245 slog(st,LOG_SETUP_INIT,"resolution of %s failed: "
1246 " continuing to use source address of peer's packets"
1247 " for key exchange and ultimately data",
1248 st->address);
1249 }
1250 break;
1251 case SITE_RUN:
45a14422 1252 if (naddrs) {
c22c3541
IJ
1253 slog(st,LOG_SETUP_INIT,"resolution of %s completed tardily,"
1254 " updating peer address(es)",st->address);
45a14422 1255 transport_resolve_complete_tardy(st,addrs,naddrs);
c22c3541
IJ
1256 } else if (st->local_mobile) {
1257 /* Not very good. We should queue (another) renegotiation
1258 * so that we can update the peer address. */
1259 st->key_renegotiate_time=st->now+st->wait_timeout;
1260 } else {
1261 slog(st,LOG_SETUP_INIT,"resolution of %s failed: "
1262 " continuing to use source address of peer's packets",
1263 st->address);
1264 }
1265 break;
1266 case SITE_WAIT:
1267 case SITE_STOP:
1268 /* oh well */
1269 break;
2fe58dfd
SE
1270 }
1271}
1272
dd9209d1
IJ
1273static bool_t initiate_key_setup(struct site *st, cstring_t reason,
1274 const struct comm_addr *prod_hint)
9d3a4132 1275{
77effe1d 1276 /* Reentrancy hazard: can call enter_new_state/enter_state_* */
9d3a4132 1277 if (st->state!=SITE_RUN) return False;
794f2398 1278 slog(st,LOG_SETUP_INIT,"initiating key exchange (%s)",reason);
9d3a4132 1279 if (st->address) {
794f2398 1280 slog(st,LOG_SETUP_INIT,"resolving peer address");
9d3a4132 1281 return enter_state_resolve(st);
45a14422 1282 } else if (transport_compute_setupinit_peers(st,0,0,prod_hint)) {
ff05a229 1283 return enter_new_state(st,SITE_SENTMSG1);
9d3a4132 1284 }
ff05a229 1285 slog(st,LOG_SETUP_INIT,"key exchange failed: no address for peer");
9d3a4132
SE
1286 return False;
1287}
1288
2fe58dfd
SE
1289static void activate_new_key(struct site *st)
1290{
1291 struct transform_inst_if *t;
1292
02b0959b
IJ
1293 /* We have three transform instances, which we swap between old,
1294 active and setup */
1295 t=st->auxiliary_key.transform;
1296 st->auxiliary_key.transform=st->current.transform;
19e9a588 1297 st->current.transform=st->new_transform;
2fe58dfd 1298 st->new_transform=t;
0afd257e 1299 dispose_transform(&st->new_transform);
2fe58dfd 1300
2fe58dfd 1301 st->timeout=0;
bd98cd6b 1302 st->auxiliary_is_new=0;
02b0959b 1303 st->auxiliary_key.key_timeout=st->current.key_timeout;
19e9a588 1304 st->current.key_timeout=st->now+st->key_lifetime;
ff05a229 1305 st->renegotiate_key_time=st->now+st->key_renegotiate_time;
446353cd 1306 transport_peers_copy(st,&st->peers,&st->setup_peers);
19e9a588 1307 st->current.remote_session_id=st->setup_session_id;
2fe58dfd 1308
3ed1846a
IJ
1309 /* Compute the inter-site MTU. This is min( our_mtu, their_mtu ).
1310 * But their mtu be unspecified, in which case we just use ours. */
1311 uint32_t intersite_mtu=
1312 MIN(st->mtu_target, st->remote_adv_mtu ?: ~(uint32_t)0);
1313 st->netlink->set_mtu(st->netlink->st,intersite_mtu);
1314
1315 slog(st,LOG_ACTIVATE_KEY,"new key activated"
1316 " (mtu ours=%"PRId32" theirs=%"PRId32" intersite=%"PRId32")",
1317 st->mtu_target, st->remote_adv_mtu, intersite_mtu);
9d3a4132 1318 enter_state_run(st);
2fe58dfd
SE
1319}
1320
1d388569
IJ
1321static void delete_one_key(struct site *st, struct data_key *key,
1322 cstring_t reason, cstring_t which, uint32_t loglevel)
1323{
0afd257e 1324 if (!is_transform_valid(key->transform)) return;
1d388569 1325 if (reason) slog(st,loglevel,"%s deleted (%s)",which,reason);
0afd257e 1326 dispose_transform(&key->transform);
1d388569
IJ
1327 key->key_timeout=0;
1328}
1329
1330static void delete_keys(struct site *st, cstring_t reason, uint32_t loglevel)
794f2398 1331{
3d8d8f4e 1332 if (current_valid(st)) {
794f2398
SE
1333 slog(st,loglevel,"session closed (%s)",reason);
1334
1d388569 1335 delete_one_key(st,&st->current,0,0,0);
794f2398
SE
1336 set_link_quality(st);
1337 }
02b0959b 1338 delete_one_key(st,&st->auxiliary_key,0,0,0);
794f2398
SE
1339}
1340
2fe58dfd
SE
1341static void state_assert(struct site *st, bool_t ok)
1342{
4f5e39ec 1343 if (!ok) fatal("site:state_assert");
2fe58dfd
SE
1344}
1345
1346static void enter_state_stop(struct site *st)
1347{
1348 st->state=SITE_STOP;
1349 st->timeout=0;
1d388569 1350 delete_keys(st,"entering state STOP",LOG_TIMEOUT_KEY);
0afd257e 1351 dispose_transform(&st->new_transform);
2fe58dfd
SE
1352}
1353
9d3a4132
SE
1354static void set_link_quality(struct site *st)
1355{
1356 uint32_t quality;
3d8d8f4e 1357 if (current_valid(st))
9d3a4132
SE
1358 quality=LINK_QUALITY_UP;
1359 else if (st->state==SITE_WAIT || st->state==SITE_STOP)
1360 quality=LINK_QUALITY_DOWN;
1361 else if (st->address)
1362 quality=LINK_QUALITY_DOWN_CURRENT_ADDRESS;
446353cd 1363 else if (transport_peers_valid(&st->peers))
9d3a4132
SE
1364 quality=LINK_QUALITY_DOWN_STALE_ADDRESS;
1365 else
1366 quality=LINK_QUALITY_DOWN;
1367
469fd1d9 1368 st->netlink->set_quality(st->netlink->st,quality);
9d3a4132
SE
1369}
1370
2fe58dfd
SE
1371static void enter_state_run(struct site *st)
1372{
1373 slog(st,LOG_STATE,"entering state RUN");
1374 st->state=SITE_RUN;
1375 st->timeout=0;
9d3a4132 1376
ff05a229 1377 st->setup_session_id=0;
446353cd 1378 transport_peers_clear(st,&st->setup_peers);
4f28e77e
IJ
1379 FILLZERO(st->localN);
1380 FILLZERO(st->remoteN);
0afd257e 1381 dispose_transform(&st->new_transform);
ff05a229 1382 memset(st->dhsecret,0,st->dh->len);
7c9ca4bd 1383 memset(st->sharedsecret,0,st->sharedsecretlen);
9d3a4132 1384 set_link_quality(st);
2fe58dfd
SE
1385}
1386
5c19b79c
IJ
1387static bool_t ensure_resolving(struct site *st)
1388{
1389 /* Reentrancy hazard: may call site_resolve_callback and hence
1390 * enter_new_state, enter_state_* and generate_msg*. */
1391 if (st->resolving)
1392 return True;
1393
4ac8a7d2
IJ
1394 assert(st->address);
1395
5c19b79c
IJ
1396 /* resolver->request might reentrantly call site_resolve_callback
1397 * which will clear st->resolving, so we need to set it beforehand
1398 * rather than afterwards; also, it might return False, in which
1399 * case we have to clear ->resolving again. */
1400 st->resolving=True;
1401 bool_t ok = st->resolver->request(st->resolver->st,st->address,
cc420616 1402 st->remoteport,st->comms[0],
5c19b79c
IJ
1403 site_resolve_callback,st);
1404 if (!ok)
1405 st->resolving=False;
1406
1407 return ok;
1408}
1409
2fe58dfd
SE
1410static bool_t enter_state_resolve(struct site *st)
1411{
77effe1d 1412 /* Reentrancy hazard! See ensure_resolving. */
2fe58dfd
SE
1413 state_assert(st,st->state==SITE_RUN);
1414 slog(st,LOG_STATE,"entering state RESOLVE");
1415 st->state=SITE_RESOLVE;
5c19b79c 1416 return ensure_resolving(st);
2fe58dfd
SE
1417}
1418
ff05a229 1419static bool_t enter_new_state(struct site *st, uint32_t next)
2fe58dfd 1420{
ff05a229 1421 bool_t (*gen)(struct site *st);
3b83c932
SE
1422 int r;
1423
ff05a229
SE
1424 slog(st,LOG_STATE,"entering state %s",state_name(next));
1425 switch(next) {
1426 case SITE_SENTMSG1:
1427 state_assert(st,st->state==SITE_RUN || st->state==SITE_RESOLVE);
1428 gen=generate_msg1;
1429 break;
1430 case SITE_SENTMSG2:
1431 state_assert(st,st->state==SITE_RUN || st->state==SITE_RESOLVE ||
1432 st->state==SITE_SENTMSG1 || st->state==SITE_WAIT);
1433 gen=generate_msg2;
1434 break;
1435 case SITE_SENTMSG3:
1436 state_assert(st,st->state==SITE_SENTMSG1);
1437 BUF_FREE(&st->buffer);
1438 gen=generate_msg3;
1439 break;
1440 case SITE_SENTMSG4:
1441 state_assert(st,st->state==SITE_SENTMSG2);
1442 BUF_FREE(&st->buffer);
1443 gen=generate_msg4;
1444 break;
1445 case SITE_SENTMSG5:
1446 state_assert(st,st->state==SITE_SENTMSG3);
1447 BUF_FREE(&st->buffer);
1448 gen=generate_msg5;
1449 break;
1450 case SITE_RUN:
1451 state_assert(st,st->state==SITE_SENTMSG4);
1452 BUF_FREE(&st->buffer);
1453 gen=generate_msg6;
1454 break;
1455 default:
1456 gen=NULL;
4f5e39ec 1457 fatal("enter_new_state(%s): invalid new state",state_name(next));
ff05a229 1458 break;
2fe58dfd 1459 }
2fe58dfd 1460
3b83c932
SE
1461 if (hacky_par_start_failnow()) return False;
1462
1463 r= gen(st) && send_msg(st);
1464
1465 hacky_par_end(&r,
e7f8ec2a 1466 st->setup_retries, st->setup_retry_interval,
3b83c932
SE
1467 send_msg, st);
1468
1469 if (r) {
ff05a229
SE
1470 st->state=next;
1471 if (next==SITE_RUN) {
1472 BUF_FREE(&st->buffer); /* Never reused */
1473 st->timeout=0; /* Never retransmit */
1474 activate_new_key(st);
1475 }
2fe58dfd
SE
1476 return True;
1477 }
ff05a229
SE
1478 slog(st,LOG_ERROR,"error entering state %s",state_name(next));
1479 st->buffer.free=False; /* Unconditionally use the buffer; it may be
1480 in either state, and enter_state_wait() will
1481 do a BUF_FREE() */
2fe58dfd
SE
1482 enter_state_wait(st);
1483 return False;
1484}
1485
ff05a229 1486/* msg7 tells our peer that we're about to forget our key */
fe5e9cc4 1487static bool_t send_msg7(struct site *st, cstring_t reason)
794f2398 1488{
fe5e9cc4 1489 cstring_t transform_err;
794f2398 1490
3d8d8f4e 1491 if (current_valid(st) && st->buffer.free
446353cd 1492 && transport_peers_valid(&st->peers)) {
794f2398 1493 BUF_ALLOC(&st->buffer,"site:MSG7");
3abd18e8 1494 buffer_init(&st->buffer,calculate_max_start_pad());
794f2398
SE
1495 buf_append_uint32(&st->buffer,LABEL_MSG7);
1496 buf_append_string(&st->buffer,reason);
0afd257e
IJ
1497 if (call_transform_forwards(st, st->current.transform,
1498 &st->buffer, &transform_err))
1499 goto free_out;
794f2398 1500 buf_prepend_uint32(&st->buffer,LABEL_MSG0);
58650a70 1501 buf_prepend_uint32(&st->buffer,st->index);
19e9a588 1502 buf_prepend_uint32(&st->buffer,st->current.remote_session_id);
446353cd 1503 transport_xmit(st,&st->peers,&st->buffer,True);
794f2398 1504 BUF_FREE(&st->buffer);
0afd257e 1505 free_out:
794f2398
SE
1506 return True;
1507 }
1508 return False;
1509}
1510
2fe58dfd
SE
1511/* We go into this state if our peer becomes uncommunicative. Similar to
1512 the "stop" state, we forget all session keys for a while, before
1513 re-entering the "run" state. */
1514static void enter_state_wait(struct site *st)
1515{
1516 slog(st,LOG_STATE,"entering state WAIT");
1517 st->timeout=st->now+st->wait_timeout;
1518 st->state=SITE_WAIT;
9d3a4132 1519 set_link_quality(st);
2fe58dfd
SE
1520 BUF_FREE(&st->buffer); /* will have had an outgoing packet in it */
1521 /* XXX Erase keys etc. */
1522}
1523
dd9209d1
IJ
1524static void generate_prod(struct site *st, struct buffer_if *buf)
1525{
1526 buffer_init(buf,0);
1527 buf_append_uint32(buf,0);
1528 buf_append_uint32(buf,0);
1529 buf_append_uint32(buf,LABEL_PROD);
1530 buf_append_string(buf,st->localname);
1531 buf_append_string(buf,st->remotename);
1532}
1533
1534static void generate_send_prod(struct site *st,
1535 const struct comm_addr *source)
1536{
1537 if (!st->allow_send_prod) return; /* too soon */
1538 if (!(st->state==SITE_RUN || st->state==SITE_RESOLVE ||
1539 st->state==SITE_WAIT)) return; /* we'd ignore peer's MSG1 */
1540
1541 slog(st,LOG_SETUP_INIT,"prodding peer for key exchange");
1542 st->allow_send_prod=0;
1543 generate_prod(st,&st->scratch);
1544 dump_packet(st,&st->scratch,source,False);
1545 source->comm->sendmsg(source->comm->st, &st->scratch, source);
1546}
1547
16f73fa6 1548static inline void site_settimeout(uint64_t timeout, int *timeout_io)
fe5e9cc4
SE
1549{
1550 if (timeout) {
0009e60a
IJ
1551 int64_t offset=timeout-*now;
1552 if (offset<0) offset=0;
fe5e9cc4
SE
1553 if (offset>INT_MAX) offset=INT_MAX;
1554 if (*timeout_io<0 || offset<*timeout_io)
1555 *timeout_io=offset;
1556 }
1557}
1558
2fe58dfd 1559static int site_beforepoll(void *sst, struct pollfd *fds, int *nfds_io,
90a39563 1560 int *timeout_io)
2fe58dfd
SE
1561{
1562 struct site *st=sst;
1563
1564 *nfds_io=0; /* We don't use any file descriptors */
1565 st->now=*now;
1566
1567 /* Work out when our next timeout is. The earlier of 'timeout' or
19e9a588 1568 'current.key_timeout'. A stored value of '0' indicates no timeout
2fe58dfd 1569 active. */
16f73fa6 1570 site_settimeout(st->timeout, timeout_io);
19e9a588 1571 site_settimeout(st->current.key_timeout, timeout_io);
02b0959b 1572 site_settimeout(st->auxiliary_key.key_timeout, timeout_io);
2fe58dfd
SE
1573
1574 return 0; /* success */
1575}
1576
1d388569
IJ
1577static void check_expiry(struct site *st, struct data_key *key,
1578 const char *which)
1579{
1580 if (key->key_timeout && *now>key->key_timeout) {
1581 delete_one_key(st,key,"maximum life exceeded",which,LOG_TIMEOUT_KEY);
1582 }
1583}
1584
2fe58dfd 1585/* NB site_afterpoll will be called before site_beforepoll is ever called */
90a39563 1586static void site_afterpoll(void *sst, struct pollfd *fds, int nfds)
2fe58dfd
SE
1587{
1588 struct site *st=sst;
1589
1590 st->now=*now;
1591 if (st->timeout && *now>st->timeout) {
2fe58dfd 1592 st->timeout=0;
3b83c932
SE
1593 if (st->state>=SITE_SENTMSG1 && st->state<=SITE_SENTMSG5) {
1594 if (!hacky_par_start_failnow())
1595 send_msg(st);
1596 } else if (st->state==SITE_WAIT) {
2fe58dfd
SE
1597 enter_state_run(st);
1598 } else {
1599 slog(st,LOG_ERROR,"site_afterpoll: unexpected timeout, state=%d",
1600 st->state);
1601 }
1602 }
1d388569 1603 check_expiry(st,&st->current,"current key");
02b0959b 1604 check_expiry(st,&st->auxiliary_key,"auxiliary key");
2fe58dfd
SE
1605}
1606
1607/* This function is called by the netlink device to deliver packets
1608 intended for the remote network. The packet is in "raw" wire
1609 format, but is guaranteed to be word-aligned. */
469fd1d9 1610static void site_outgoing(void *sst, struct buffer_if *buf)
2fe58dfd
SE
1611{
1612 struct site *st=sst;
fe5e9cc4 1613 cstring_t transform_err;
2fe58dfd
SE
1614
1615 if (st->state==SITE_STOP) {
1616 BUF_FREE(buf);
1617 return;
1618 }
1619
dd9209d1
IJ
1620 st->allow_send_prod=1;
1621
2fe58dfd
SE
1622 /* In all other states we consider delivering the packet if we have
1623 a valid key and a valid address to send it to. */
3d8d8f4e 1624 if (current_valid(st) && transport_peers_valid(&st->peers)) {
2fe58dfd 1625 /* Transform it and send it */
70dc107b
SE
1626 if (buf->size>0) {
1627 buf_prepend_uint32(buf,LABEL_MSG9);
0afd257e
IJ
1628 if (call_transform_forwards(st, st->current.transform,
1629 buf, &transform_err))
1630 goto free_out;
70dc107b 1631 buf_prepend_uint32(buf,LABEL_MSG0);
58650a70 1632 buf_prepend_uint32(buf,st->index);
19e9a588 1633 buf_prepend_uint32(buf,st->current.remote_session_id);
446353cd 1634 transport_xmit(st,&st->peers,buf,False);
70dc107b 1635 }
0afd257e 1636 free_out:
2fe58dfd
SE
1637 BUF_FREE(buf);
1638 return;
1639 }
1640
70dc107b 1641 slog(st,LOG_DROP,"discarding outgoing packet of size %d",buf->size);
2fe58dfd 1642 BUF_FREE(buf);
dd9209d1 1643 initiate_key_setup(st,"outgoing packet",0);
2fe58dfd
SE
1644}
1645
7e29719e
IJ
1646static bool_t named_for_us(struct site *st, const struct buffer_if *buf_in,
1647 uint32_t type, struct msg *m)
1648 /* For packets which are identified by the local and remote names.
1649 * If it has our name and our peer's name in it it's for us. */
1650{
1651 struct buffer_if buf[1];
1652 buffer_readonly_clone(buf,buf_in);
1653 return unpick_msg(st,type,buf,m)
1654 && name_matches(&m->remote,st->remotename)
1655 && name_matches(&m->local,st->localname);
1656}
1657
2fe58dfd 1658/* This function is called by the communication device to deliver
dd9209d1
IJ
1659 packets from our peers.
1660 It should return True if the packet is recognised as being for
1661 this current site instance (and should therefore not be processed
1662 by other sites), even if the packet was otherwise ignored. */
2fe58dfd 1663static bool_t site_incoming(void *sst, struct buffer_if *buf,
a15faeb2 1664 const struct comm_addr *source)
2fe58dfd
SE
1665{
1666 struct site *st=sst;
20138876
IJ
1667
1668 if (buf->size < 12) return False;
1669
0a6cbade
IJ
1670 uint32_t dest=get_uint32(buf->start);
1671 uint32_t msgtype=get_uint32(buf->start+8);
7e29719e
IJ
1672 struct msg named_msg;
1673
1674 if (msgtype==LABEL_MSG1) {
1675 if (!named_for_us(st,buf,msgtype,&named_msg))
1676 return False;
1677 /* It's a MSG1 addressed to us. Decide what to do about it. */
1678 dump_packet(st,buf,source,True);
1679 if (st->state==SITE_RUN || st->state==SITE_RESOLVE ||
1680 st->state==SITE_WAIT) {
1681 /* We should definitely process it */
45a14422 1682 transport_compute_setupinit_peers(st,0,0,source);
7e29719e
IJ
1683 if (process_msg1(st,buf,source,&named_msg)) {
1684 slog(st,LOG_SETUP_INIT,"key setup initiated by peer");
c22c3541 1685 bool_t entered=enter_new_state(st,SITE_SENTMSG2);
7d8d39dc 1686 if (entered && st->address && st->local_mobile)
c22c3541
IJ
1687 /* We must do this as the very last thing, because
1688 the resolver callback might reenter us. */
1689 ensure_resolving(st);
7e29719e
IJ
1690 } else {
1691 slog(st,LOG_ERROR,"failed to process incoming msg1");
1692 }
1693 BUF_FREE(buf);
1694 return True;
1695 } else if (st->state==SITE_SENTMSG1) {
1696 /* We've just sent a message 1! They may have crossed on
1697 the wire. If we have priority then we ignore the
1698 incoming one, otherwise we process it as usual. */
1699 if (st->setup_priority) {
1700 BUF_FREE(buf);
1701 slog(st,LOG_DUMP,"crossed msg1s; we are higher "
1702 "priority => ignore incoming msg1");
1703 return True;
1704 } else {
1705 slog(st,LOG_DUMP,"crossed msg1s; we are lower "
1706 "priority => use incoming msg1");
1707 if (process_msg1(st,buf,source,&named_msg)) {
1708 BUF_FREE(&st->buffer); /* Free our old message 1 */
c22c3541 1709 transport_setup_msgok(st,source);
ff05a229 1710 enter_new_state(st,SITE_SENTMSG2);
2fe58dfd 1711 } else {
7e29719e
IJ
1712 slog(st,LOG_ERROR,"failed to process an incoming "
1713 "crossed msg1 (we have low priority)");
2fe58dfd
SE
1714 }
1715 BUF_FREE(buf);
1716 return True;
2fe58dfd 1717 }
2fe58dfd 1718 }
7e29719e
IJ
1719 /* The message 1 was received at an unexpected stage of the
1720 key setup. XXX POLICY - what do we do? */
1721 slog(st,LOG_UNEXPECTED,"unexpected incoming message 1");
1722 BUF_FREE(buf);
1723 return True;
2fe58dfd 1724 }
dd9209d1
IJ
1725 if (msgtype==LABEL_PROD) {
1726 if (!named_for_us(st,buf,msgtype,&named_msg))
1727 return False;
1728 dump_packet(st,buf,source,True);
1729 if (st->state!=SITE_RUN) {
1730 slog(st,LOG_DROP,"ignoring PROD when not in state RUN");
1731 } else if (current_valid(st)) {
1732 slog(st,LOG_DROP,"ignoring PROD when we think we have a key");
1733 } else {
1734 initiate_key_setup(st,"peer sent PROD packet",source);
1735 }
1736 BUF_FREE(buf);
1737 return True;
1738 }
58650a70 1739 if (dest==st->index) {
2fe58dfd
SE
1740 /* Explicitly addressed to us */
1741 if (msgtype!=LABEL_MSG0) dump_packet(st,buf,source,True);
1742 switch (msgtype) {
136740e6 1743 case LABEL_NAK:
794f2398
SE
1744 /* If the source is our current peer then initiate a key setup,
1745 because our peer's forgotten the key */
19e9a588 1746 if (get_uint32(buf->start+4)==st->current.remote_session_id) {
dd9209d1 1747 bool_t initiated;
e5e67212 1748 initiated = initiate_key_setup(st,"received a NAK",source);
dd9209d1 1749 if (!initiated) generate_send_prod(st,source);
794f2398
SE
1750 } else {
1751 slog(st,LOG_SEC,"bad incoming NAK");
1752 }
1753 break;
2fe58dfd
SE
1754 case LABEL_MSG0:
1755 process_msg0(st,buf,source);
1756 break;
1757 case LABEL_MSG1:
1758 /* Setup packet: should not have been explicitly addressed
1759 to us */
59635212 1760 slog(st,LOG_SEC,"incoming explicitly addressed msg1");
2fe58dfd
SE
1761 break;
1762 case LABEL_MSG2:
1763 /* Setup packet: expected only in state SENTMSG1 */
1764 if (st->state!=SITE_SENTMSG1) {
1765 slog(st,LOG_UNEXPECTED,"unexpected MSG2");
446353cd
IJ
1766 } else if (process_msg2(st,buf,source)) {
1767 transport_setup_msgok(st,source);
ff05a229 1768 enter_new_state(st,SITE_SENTMSG3);
446353cd 1769 } else {
59635212 1770 slog(st,LOG_SEC,"invalid MSG2");
2fe58dfd
SE
1771 }
1772 break;
1773 case LABEL_MSG3:
5b5f297f 1774 case LABEL_MSG3BIS:
2fe58dfd
SE
1775 /* Setup packet: expected only in state SENTMSG2 */
1776 if (st->state!=SITE_SENTMSG2) {
1777 slog(st,LOG_UNEXPECTED,"unexpected MSG3");
5b5f297f 1778 } else if (process_msg3(st,buf,source,msgtype)) {
446353cd 1779 transport_setup_msgok(st,source);
ff05a229 1780 enter_new_state(st,SITE_SENTMSG4);
446353cd 1781 } else {
59635212 1782 slog(st,LOG_SEC,"invalid MSG3");
2fe58dfd
SE
1783 }
1784 break;
1785 case LABEL_MSG4:
1786 /* Setup packet: expected only in state SENTMSG3 */
1787 if (st->state!=SITE_SENTMSG3) {
1788 slog(st,LOG_UNEXPECTED,"unexpected MSG4");
446353cd
IJ
1789 } else if (process_msg4(st,buf,source)) {
1790 transport_setup_msgok(st,source);
ff05a229 1791 enter_new_state(st,SITE_SENTMSG5);
446353cd 1792 } else {
59635212 1793 slog(st,LOG_SEC,"invalid MSG4");
2fe58dfd
SE
1794 }
1795 break;
1796 case LABEL_MSG5:
4efd681a
SE
1797 /* Setup packet: expected only in state SENTMSG4 */
1798 /* (may turn up in state RUN if our return MSG6 was lost
1799 and the new key has already been activated. In that
05f39b4d
IJ
1800 case we discard it. The peer will realise that we
1801 are using the new key when they see our data packets.
1802 Until then the peer's data packets to us get discarded. */
c90cc2a7
IJ
1803 if (st->state==SITE_SENTMSG4) {
1804 if (process_msg5(st,buf,source,st->new_transform)) {
1805 transport_setup_msgok(st,source);
1806 enter_new_state(st,SITE_RUN);
1807 } else {
1808 slog(st,LOG_SEC,"invalid MSG5");
1809 }
1810 } else if (st->state==SITE_RUN) {
19e9a588 1811 if (process_msg5(st,buf,source,st->current.transform)) {
c90cc2a7
IJ
1812 slog(st,LOG_DROP,"got MSG5, retransmitting MSG6");
1813 transport_setup_msgok(st,source);
19e9a588
IJ
1814 create_msg6(st,st->current.transform,
1815 st->current.remote_session_id);
c90cc2a7
IJ
1816 transport_xmit(st,&st->peers,&st->buffer,True);
1817 BUF_FREE(&st->buffer);
1818 } else {
1819 slog(st,LOG_SEC,"invalid MSG5 (in state RUN)");
1820 }
2fe58dfd 1821 } else {
c90cc2a7 1822 slog(st,LOG_UNEXPECTED,"unexpected MSG5");
2fe58dfd
SE
1823 }
1824 break;
1825 case LABEL_MSG6:
1826 /* Setup packet: expected only in state SENTMSG5 */
1827 if (st->state!=SITE_SENTMSG5) {
1828 slog(st,LOG_UNEXPECTED,"unexpected MSG6");
1829 } else if (process_msg6(st,buf,source)) {
1830 BUF_FREE(&st->buffer); /* Free message 5 */
446353cd 1831 transport_setup_msgok(st,source);
2fe58dfd
SE
1832 activate_new_key(st);
1833 } else {
59635212 1834 slog(st,LOG_SEC,"invalid MSG6");
2fe58dfd
SE
1835 }
1836 break;
2fe58dfd 1837 default:
59635212 1838 slog(st,LOG_SEC,"received message of unknown type 0x%08x",
2fe58dfd
SE
1839 msgtype);
1840 break;
1841 }
1842 BUF_FREE(buf);
1843 return True;
1844 }
1845
1846 return False;
1847}
1848
1849static void site_control(void *vst, bool_t run)
1850{
1851 struct site *st=vst;
1852 if (run) enter_state_run(st);
1853 else enter_state_stop(st);
1854}
1855
794f2398
SE
1856static void site_phase_hook(void *sst, uint32_t newphase)
1857{
1858 struct site *st=sst;
1859
1860 /* The program is shutting down; tell our peer */
1861 send_msg7(st,"shutting down");
1862}
1863
2fe58dfd
SE
1864static list_t *site_apply(closure_t *self, struct cloc loc, dict_t *context,
1865 list_t *args)
1866{
58650a70 1867 static uint32_t index_sequence;
2fe58dfd
SE
1868 struct site *st;
1869 item_t *item;
1870 dict_t *dict;
59533c16 1871 int i;
2fe58dfd
SE
1872
1873 st=safe_malloc(sizeof(*st),"site_apply");
1874
1875 st->cl.description="site";
1876 st->cl.type=CL_SITE;
1877 st->cl.apply=NULL;
1878 st->cl.interface=&st->ops;
1879 st->ops.st=st;
1880 st->ops.control=site_control;
1881 st->ops.status=site_status;
1882
1883 /* First parameter must be a dict */
1884 item=list_elem(args,0);
1885 if (!item || item->type!=t_dict)
1886 cfgfatal(loc,"site","parameter must be a dictionary\n");
1887
1888 dict=item->data.dict;
558fa3fb
SE
1889 st->localname=dict_read_string(dict, "local-name", True, "site", loc);
1890 st->remotename=dict_read_string(dict, "name", True, "site", loc);
dba19f84
IJ
1891
1892 st->peer_mobile=dict_read_bool(dict,"mobile",False,"site",loc,False);
0391d9ee 1893 st->local_mobile=
dba19f84
IJ
1894 dict_read_bool(dict,"local-mobile",False,"site",loc,False);
1895
558fa3fb
SE
1896 /* Sanity check (which also allows the 'sites' file to include
1897 site() closures for all sites including our own): refuse to
1898 talk to ourselves */
1899 if (strcmp(st->localname,st->remotename)==0) {
b2a56f7c 1900 Message(M_DEBUG,"site %s: local-name==name -> ignoring this site\n",
baa06aeb 1901 st->localname);
0391d9ee 1902 if (st->peer_mobile != st->local_mobile)
dba19f84
IJ
1903 cfgfatal(loc,"site","site %s's peer-mobile=%d"
1904 " but our local-mobile=%d\n",
0391d9ee 1905 st->localname, st->peer_mobile, st->local_mobile);
dba19f84
IJ
1906 free(st);
1907 return NULL;
1908 }
0391d9ee 1909 if (st->peer_mobile && st->local_mobile) {
dba19f84
IJ
1910 Message(M_WARNING,"site %s: site is mobile but so are we"
1911 " -> ignoring this site\n", st->remotename);
558fa3fb
SE
1912 free(st);
1913 return NULL;
1914 }
dba19f84 1915
58650a70
RK
1916 assert(index_sequence < 0xffffffffUL);
1917 st->index = ++index_sequence;
09a385fb 1918 st->local_capabilities = 0;
469fd1d9 1919 st->netlink=find_cl_if(dict,"link",CL_NETLINK,True,"site",loc);
59533c16 1920
5b5f297f
IJ
1921#define GET_CLOSURE_LIST(dictkey,things,nthings,CL_TYPE) do{ \
1922 list_t *things##_cfg=dict_lookup(dict,dictkey); \
1923 if (!things##_cfg) \
1924 cfgfatal(loc,"site","closure list \"%s\" not found\n",dictkey); \
1925 st->nthings=list_length(things##_cfg); \
1926 st->things=safe_malloc_ary(sizeof(*st->things),st->nthings,dictkey "s"); \
1927 assert(st->nthings); \
1928 for (i=0; i<st->nthings; i++) { \
1929 item_t *item=list_elem(things##_cfg,i); \
1930 if (item->type!=t_closure) \
1931 cfgfatal(loc,"site","%s is not a closure\n",dictkey); \
1932 closure_t *cl=item->data.closure; \
1933 if (cl->type!=CL_TYPE) \
1934 cfgfatal(loc,"site","%s closure wrong type\n",dictkey); \
1935 st->things[i]=cl->interface; \
1936 } \
1937}while(0)
1938
1939 GET_CLOSURE_LIST("comm",comms,ncomms,CL_COMM);
59533c16 1940
2fe58dfd
SE
1941 st->resolver=find_cl_if(dict,"resolver",CL_RESOLVER,True,"site",loc);
1942 st->log=find_cl_if(dict,"log",CL_LOG,True,"site",loc);
1943 st->random=find_cl_if(dict,"random",CL_RANDOMSRC,True,"site",loc);
1944
2fe58dfd 1945 st->privkey=find_cl_if(dict,"local-key",CL_RSAPRIVKEY,True,"site",loc);
2fe58dfd 1946 st->address=dict_read_string(dict, "address", False, "site", loc);
3454dce4
SE
1947 if (st->address)
1948 st->remoteport=dict_read_number(dict,"port",True,"site",loc,0);
1949 else st->remoteport=0;
2fe58dfd
SE
1950 st->pubkey=find_cl_if(dict,"key",CL_RSAPUBKEY,True,"site",loc);
1951
5b5f297f 1952 GET_CLOSURE_LIST("transform",transforms,ntransforms,CL_TRANSFORM);
2fe58dfd
SE
1953
1954 st->dh=find_cl_if(dict,"dh",CL_DH,True,"site",loc);
1955 st->hash=find_cl_if(dict,"hash",CL_HASH,True,"site",loc);
1956
0391d9ee 1957#define DEFAULT(D) (st->peer_mobile || st->local_mobile \
e57264d6 1958 ? DEFAULT_MOBILE_##D : DEFAULT_##D)
e7f8ec2a 1959#define CFG_NUMBER(k,D) dict_read_number(dict,(k),False,"site",loc,DEFAULT(D));
c27ca22f 1960
e7f8ec2a
IJ
1961 st->key_lifetime= CFG_NUMBER("key-lifetime", KEY_LIFETIME);
1962 st->setup_retries= CFG_NUMBER("setup-retries", SETUP_RETRIES);
1963 st->setup_retry_interval= CFG_NUMBER("setup-timeout", SETUP_RETRY_INTERVAL);
1964 st->wait_timeout= CFG_NUMBER("wait-time", WAIT_TIME);
3ed1846a 1965 st->mtu_target= dict_read_number(dict,"mtu-target",False,"site",loc,0);
e7f8ec2a 1966
446353cd
IJ
1967 st->mobile_peer_expiry= dict_read_number(
1968 dict,"mobile-peer-expiry",False,"site",loc,DEFAULT_MOBILE_PEER_EXPIRY);
1969
1970 st->transport_peers_max= !st->peer_mobile ? 1 : dict_read_number(
1971 dict,"mobile-peers-max",False,"site",loc,DEFAULT_MOBILE_PEERS_MAX);
1972 if (st->transport_peers_max<1 ||
ca0a30fc 1973 st->transport_peers_max>MAX_MOBILE_PEERS_MAX) {
446353cd
IJ
1974 cfgfatal(loc,"site","mobile-peers-max must be in range 1.."
1975 STRING(MAX_MOBILE_PEERS_MAX) "\n");
1976 }
1977
e7f8ec2a 1978 if (st->key_lifetime < DEFAULT(KEY_RENEGOTIATE_GAP)*2)
c27ca22f
IJ
1979 st->key_renegotiate_time=st->key_lifetime/2;
1980 else
e7f8ec2a 1981 st->key_renegotiate_time=st->key_lifetime-DEFAULT(KEY_RENEGOTIATE_GAP);
9d3a4132 1982 st->key_renegotiate_time=dict_read_number(
cce0051f 1983 dict,"renegotiate-time",False,"site",loc,st->key_renegotiate_time);
9d3a4132
SE
1984 if (st->key_renegotiate_time > st->key_lifetime) {
1985 cfgfatal(loc,"site",
1986 "renegotiate-time must be less than key-lifetime\n");
1987 }
9d3a4132
SE
1988
1989 st->log_events=string_list_to_word(dict_lookup(dict,"log-events"),
1990 log_event_table,"site");
2fe58dfd 1991
5c19b79c 1992 st->resolving=False;
dd9209d1
IJ
1993 st->allow_send_prod=0;
1994
4efd681a
SE
1995 st->tunname=safe_malloc(strlen(st->localname)+strlen(st->remotename)+5,
1996 "site_apply");
1997 sprintf(st->tunname,"%s<->%s",st->localname,st->remotename);
1998
2fe58dfd 1999 /* The information we expect to see in incoming messages of type 1 */
59230b9b
IJ
2000 /* fixme: lots of unchecked overflows here, but the results are only
2001 corrupted packets rather than undefined behaviour */
2fe58dfd
SE
2002 st->setup_priority=(strcmp(st->localname,st->remotename)>0);
2003
2004 buffer_new(&st->buffer,SETUP_BUFFER_LEN);
2005
8aaaa634 2006 buffer_new(&st->scratch,SETUP_BUFFER_LEN);
05f39b4d
IJ
2007 BUF_ALLOC(&st->scratch,"site:scratch");
2008
2fe58dfd
SE
2009 /* We are interested in poll(), but only for timeouts. We don't have
2010 any fds of our own. */
2011 register_for_poll(st, site_beforepoll, site_afterpoll, 0, "site");
2012 st->timeout=0;
2013
09a385fb 2014 st->remote_capabilities=0;
5b5f297f 2015 st->chosen_transform=0;
19e9a588 2016 st->current.key_timeout=0;
02b0959b 2017 st->auxiliary_key.key_timeout=0;
446353cd
IJ
2018 transport_peers_clear(st,&st->peers);
2019 transport_peers_clear(st,&st->setup_peers);
2fe58dfd
SE
2020 /* XXX mlock these */
2021 st->dhsecret=safe_malloc(st->dh->len,"site:dhsecret");
5b5f297f
IJ
2022 st->sharedsecretlen=st->sharedsecretallocd=0;
2023 st->sharedsecret=0;
2024
5b5f297f
IJ
2025 for (i=0; i<st->ntransforms; i++) {
2026 struct transform_if *ti=st->transforms[i];
2027 uint32_t capbit = 1UL << ti->capab_transformnum;
2028 if (st->local_capabilities & capbit)
2029 slog(st,LOG_ERROR,"transformnum capability bit"
2030 " %d (%#"PRIx32") reused", ti->capab_transformnum, capbit);
2031 st->local_capabilities |= capbit;
59533c16 2032 }
59533c16 2033
2fe58dfd 2034 /* We need to register the remote networks with the netlink device */
3ed1846a
IJ
2035 uint32_t netlink_mtu; /* local virtual interface mtu */
2036 st->netlink->reg(st->netlink->st, site_outgoing, st, &netlink_mtu);
2037 if (!st->mtu_target)
2038 st->mtu_target=netlink_mtu;
ff05a229 2039
59533c16
IJ
2040 for (i=0; i<st->ncomms; i++)
2041 st->comms[i]->request_notify(st->comms[i]->st, st, site_incoming);
2fe58dfd 2042
fcad4b0b
IJ
2043 st->current.transform=0;
2044 st->auxiliary_key.transform=0;
2045 st->new_transform=0;
bd98cd6b 2046 st->auxiliary_is_new=0;
2fe58dfd
SE
2047
2048 enter_state_stop(st);
2049
794f2398
SE
2050 add_hook(PHASE_SHUTDOWN,site_phase_hook,st);
2051
2fe58dfd
SE
2052 return new_closure(&st->cl);
2053}
2054
2fe58dfd
SE
2055void site_module(dict_t *dict)
2056{
2057 add_closure(dict,"site",site_apply);
2058}
446353cd
IJ
2059
2060
2061/***** TRANSPORT PEERS definitions *****/
2062
2063static void transport_peers_debug(struct site *st, transport_peers *dst,
2064 const char *didwhat,
2065 int nargs, const struct comm_addr *args,
2066 size_t stride) {
2067 int i;
2068 char *argp;
2069
2070 if (!(st->log_events & LOG_PEER_ADDRS))
2071 return; /* an optimisation */
2072
2073 slog(st, LOG_PEER_ADDRS, "peers (%s) %s nargs=%d => npeers=%d",
2074 (dst==&st->peers ? "data" :
2075 dst==&st->setup_peers ? "setup" : "UNKNOWN"),
2076 didwhat, nargs, dst->npeers);
2077
2078 for (i=0, argp=(void*)args;
2079 i<nargs;
2080 i++, (argp+=stride?stride:sizeof(*args))) {
2081 const struct comm_addr *ca=(void*)argp;
2082 slog(st, LOG_PEER_ADDRS, " args: addrs[%d]=%s",
1a448682 2083 i, comm_addr_to_string(ca));
446353cd
IJ
2084 }
2085 for (i=0; i<dst->npeers; i++) {
2086 struct timeval diff;
2087 timersub(tv_now,&dst->peers[i].last,&diff);
2088 const struct comm_addr *ca=&dst->peers[i].addr;
2089 slog(st, LOG_PEER_ADDRS, " peers: addrs[%d]=%s T-%ld.%06ld",
1a448682 2090 i, comm_addr_to_string(ca),
446353cd
IJ
2091 (unsigned long)diff.tv_sec, (unsigned long)diff.tv_usec);
2092 }
2093}
2094
51fc5a74
IJ
2095static bool_t transport_addrs_equal(const struct comm_addr *a,
2096 const struct comm_addr *b) {
2097 return !memcmp(a,b,sizeof(*a));
446353cd
IJ
2098}
2099
2100static void transport_peers_expire(struct site *st, transport_peers *peers) {
2101 /* peers must be sorted first */
2102 int previous_peers=peers->npeers;
2103 struct timeval oldest;
2104 oldest.tv_sec = tv_now->tv_sec - st->mobile_peer_expiry;
2105 oldest.tv_usec = tv_now->tv_usec;
2106 while (peers->npeers>1 &&
2107 timercmp(&peers->peers[peers->npeers-1].last, &oldest, <))
2108 peers->npeers--;
2109 if (peers->npeers != previous_peers)
2110 transport_peers_debug(st,peers,"expire", 0,0,0);
2111}
2112
51fc5a74
IJ
2113static bool_t transport_peer_record_one(struct site *st, transport_peers *peers,
2114 const struct comm_addr *ca,
2115 const struct timeval *tv) {
2116 /* returns false if output is full */
2117 int search;
446353cd 2118
51fc5a74
IJ
2119 if (peers->npeers >= st->transport_peers_max)
2120 return 0;
446353cd 2121
51fc5a74
IJ
2122 for (search=0; search<peers->npeers; search++)
2123 if (transport_addrs_equal(&peers->peers[search].addr, ca))
2124 return 1;
2125
2126 peers->peers[peers->npeers].addr = *ca;
2127 peers->peers[peers->npeers].last = *tv;
2128 peers->npeers++;
2129 return 1;
2130}
2131
2132static void transport_record_peers(struct site *st, transport_peers *peers,
2133 const struct comm_addr *addrs, int naddrs,
2134 const char *m) {
2135 /* We add addrs into peers. The new entries end up at the front
2136 * and displace entries towards the end (perhaps even off the
2137 * end). Any existing matching entries are moved up to the front.
2138 *
2139 * Caller must first call transport_peers_expire. */
2140
2141 if (naddrs==1 && peers->npeers>=1 &&
2142 transport_addrs_equal(&addrs[0], &peers->peers[0].addr)) {
2143 /* optimisation, also avoids debug for trivial updates */
2144 peers->peers[0].last = *tv_now;
2145 return;
2146 }
446353cd 2147
51fc5a74
IJ
2148 int old_npeers=peers->npeers;
2149 transport_peer old_peers[old_npeers];
2150 COPY_ARRAY(old_peers,peers->peers,old_npeers);
446353cd 2151
51fc5a74
IJ
2152 peers->npeers=0;
2153 int i;
2154 for (i=0; i<naddrs; i++) {
2155 if (!transport_peer_record_one(st,peers, &addrs[i], tv_now))
2156 break;
2157 }
2158 for (i=0; i<old_npeers; i++) {
2159 const transport_peer *old=&old_peers[i];
2160 if (!transport_peer_record_one(st,peers, &old->addr, &old->last))
2161 break;
2162 }
446353cd 2163
51fc5a74
IJ
2164 transport_peers_debug(st,peers,m, naddrs,addrs,0);
2165}
2166
2167static void transport_expire_record_peers(struct site *st,
2168 transport_peers *peers,
2169 const struct comm_addr *addrs,
2170 int naddrs, const char *m) {
2171 /* Convenience function */
2172 transport_peers_expire(st,peers);
2173 transport_record_peers(st,peers,addrs,naddrs,m);
446353cd
IJ
2174}
2175
2176static bool_t transport_compute_setupinit_peers(struct site *st,
45a14422
IJ
2177 const struct comm_addr *configured_addrs /* 0 if none or not found */,
2178 int n_configured_addrs /* 0 if none or not found */,
a96fda35 2179 const struct comm_addr *incoming_packet_addr /* 0 if none */) {
45a14422 2180 if (!n_configured_addrs && !incoming_packet_addr &&
dd9209d1 2181 !transport_peers_valid(&st->peers))
446353cd
IJ
2182 return False;
2183
2184 slog(st,LOG_SETUP_INIT,
45a14422
IJ
2185 "using: %d configured addr(s);%s %d old peer addrs(es)",
2186 n_configured_addrs,
a96fda35 2187 incoming_packet_addr ? " incoming packet address;" : "",
779837e1 2188 st->peers.npeers);
446353cd 2189
0391d9ee 2190 /* Non-mobile peers have st->peers.npeers==0 or ==1, since they
446353cd
IJ
2191 * have transport_peers_max==1. The effect is that this code
2192 * always uses the configured address if supplied, or otherwise
dd9209d1
IJ
2193 * the address of the incoming PROD, or the existing data peer if
2194 * one exists; this is as desired. */
446353cd
IJ
2195
2196 transport_peers_copy(st,&st->setup_peers,&st->peers);
51fc5a74 2197 transport_peers_expire(st,&st->setup_peers);
446353cd 2198
a96fda35 2199 if (incoming_packet_addr)
51fc5a74
IJ
2200 transport_record_peers(st,&st->setup_peers,
2201 incoming_packet_addr,1, "incoming");
dd9209d1 2202
45a14422 2203 if (n_configured_addrs)
51fc5a74 2204 transport_record_peers(st,&st->setup_peers,
45a14422 2205 configured_addrs,n_configured_addrs, "setupinit");
446353cd
IJ
2206
2207 assert(transport_peers_valid(&st->setup_peers));
2208 return True;
2209}
2210
2211static void transport_setup_msgok(struct site *st, const struct comm_addr *a) {
2212 if (st->peer_mobile)
51fc5a74 2213 transport_expire_record_peers(st,&st->setup_peers,a,1,"setupmsg");
446353cd
IJ
2214}
2215static void transport_data_msgok(struct site *st, const struct comm_addr *a) {
2216 if (st->peer_mobile)
51fc5a74 2217 transport_expire_record_peers(st,&st->peers,a,1,"datamsg");
446353cd
IJ
2218}
2219
2220static int transport_peers_valid(transport_peers *peers) {
2221 return peers->npeers;
2222}
2223static void transport_peers_clear(struct site *st, transport_peers *peers) {
2224 peers->npeers= 0;
2225 transport_peers_debug(st,peers,"clear",0,0,0);
2226}
2227static void transport_peers_copy(struct site *st, transport_peers *dst,
2228 const transport_peers *src) {
2229 dst->npeers=src->npeers;
4f28e77e 2230 COPY_ARRAY(dst->peers, src->peers, dst->npeers);
446353cd 2231 transport_peers_debug(st,dst,"copy",
a620a048 2232 src->npeers, &src->peers->addr, sizeof(*src->peers));
446353cd
IJ
2233}
2234
90d7e3ad 2235static void transport_resolve_complete(struct site *st,
45a14422
IJ
2236 const struct comm_addr *addrs,
2237 int naddrs) {
2238 transport_expire_record_peers(st,&st->peers,addrs,naddrs,
2239 "resolved data");
2240 transport_expire_record_peers(st,&st->setup_peers,addrs,naddrs,
2241 "resolved setup");
90d7e3ad
IJ
2242}
2243
2244static void transport_resolve_complete_tardy(struct site *st,
45a14422
IJ
2245 const struct comm_addr *addrs,
2246 int naddrs) {
2247 transport_expire_record_peers(st,&st->peers,addrs,naddrs,
2248 "resolved tardily");
90d7e3ad
IJ
2249}
2250
027a218f
IJ
2251static void transport_peers__copy_by_mask(transport_peer *out, int *nout_io,
2252 unsigned mask,
2253 const transport_peers *inp) {
2254 /* out and in->peers may be the same region, or nonoverlapping */
2255 const transport_peer *in=inp->peers;
2256 int slot;
2257 for (slot=0; slot<inp->npeers; slot++) {
2258 if (!(mask & (1U << slot)))
2259 continue;
2260 if (!(out==in && slot==*nout_io))
2261 COPY_OBJ(out[*nout_io], in[slot]);
2262 (*nout_io)++;
2263 }
2264}
2265
446353cd
IJ
2266void transport_xmit(struct site *st, transport_peers *peers,
2267 struct buffer_if *buf, bool_t candebug) {
2268 int slot;
2269 transport_peers_expire(st, peers);
027a218f
IJ
2270 unsigned failed=0; /* bitmask */
2271 assert(MAX_MOBILE_PEERS_MAX < sizeof(unsigned)*CHAR_BIT);
2272
2273 int nfailed=0;
446353cd
IJ
2274 for (slot=0; slot<peers->npeers; slot++) {
2275 transport_peer *peer=&peers->peers[slot];
2276 if (candebug)
2277 dump_packet(st, buf, &peer->addr, False);
027a218f
IJ
2278 bool_t ok =
2279 peer->addr.comm->sendmsg(peer->addr.comm->st, buf, &peer->addr);
2280 if (!ok) {
2281 failed |= 1U << slot;
2282 nfailed++;
2283 }
2284 if (ok && !st->peer_mobile)
2285 break;
2286 }
2287 /* Now we need to demote/delete failing addrs: if we are mobile we
2288 * merely demote them; otherwise we delete them. */
2289 if (st->local_mobile) {
2290 unsigned expected = ((1U << nfailed)-1) << (peers->npeers-nfailed);
2291 /* `expected' has all the failures at the end already */
2292 if (failed != expected) {
2293 int fslot=0;
2294 transport_peer failedpeers[nfailed];
2295 transport_peers__copy_by_mask(failedpeers, &fslot, failed,peers);
2296 assert(fslot == nfailed);
2297 int wslot=0;
2298 transport_peers__copy_by_mask(peers->peers,&wslot,~failed,peers);
2299 assert(wslot+nfailed == peers->npeers);
2300 COPY_ARRAY(peers->peers+wslot, failedpeers, nfailed);
2301 }
2302 } else {
2303 if (failed && peers->npeers > 1) {
2304 int wslot=0;
2305 transport_peers__copy_by_mask(peers->peers,&wslot,~failed,peers);
2306 peers->npeers=wslot;
2307 }
446353cd
IJ
2308 }
2309}
2310
2311/***** END of transport peers declarations *****/