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