site: transport peers: Delete or demote unsuitable peers addresses
[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
223#define MAX_MOBILE_PEERS_MAX 5 /* send at most this many copies, compiled max */
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,
dd9209d1 252 const struct comm_addr *configured_addr /* 0 if none or not found */,
a96fda35 253 const struct comm_addr *incoming_packet_addr /* 0 if none */);
8b21a212
IJ
254
255/* Called if we are the responder in a key setup, when the resolve
256 * completes. transport_compute_setupinit_peers will hvae been called
257 * earlier. If _complete is called, we are still doing the key setup
258 * (and we should use the new values for both the rest of the key
259 * setup and the ongoing data exchange); if _tardy is called, the key
260 * setup is done (either completed or not) and only the data peers are
261 * relevant */
90d7e3ad
IJ
262static void transport_resolve_complete(struct site *st,
263 const struct comm_addr *a);
264static void transport_resolve_complete_tardy(struct site *st,
265 const struct comm_addr *ca_use);
446353cd
IJ
266
267static void transport_xmit(struct site *st, transport_peers *peers,
268 struct buffer_if *buf, bool_t candebug);
269
270 /***** END of transport peers declarations *****/
271
272
19e9a588
IJ
273struct data_key {
274 struct transform_inst_if *transform;
275 uint64_t key_timeout; /* End of life of current key */
276 uint32_t remote_session_id;
277};
278
2fe58dfd
SE
279struct site {
280 closure_t cl;
281 struct site_if ops;
282/* configuration information */
283 string_t localname;
284 string_t remotename;
0391d9ee 285 bool_t local_mobile, peer_mobile; /* Mobile client support */
446353cd 286 int32_t transport_peers_max;
ff05a229 287 string_t tunname; /* localname<->remotename by default, used in logs */
2fe58dfd 288 string_t address; /* DNS name for bootstrapping, optional */
ff05a229 289 int remoteport; /* Port for bootstrapping, optional */
3ed1846a 290 uint32_t mtu_target;
2fe58dfd 291 struct netlink_if *netlink;
59533c16
IJ
292 struct comm_if **comms;
293 int ncomms;
2fe58dfd
SE
294 struct resolver_if *resolver;
295 struct log_if *log;
296 struct random_if *random;
297 struct rsaprivkey_if *privkey;
2fe58dfd 298 struct rsapubkey_if *pubkey;
5b5f297f
IJ
299 struct transform_if **transforms;
300 int ntransforms;
2fe58dfd
SE
301 struct dh_if *dh;
302 struct hash_if *hash;
2fe58dfd 303
58650a70 304 uint32_t index; /* Index of this site */
09a385fb 305 uint32_t local_capabilities;
1caa23ff 306 int32_t setup_retries; /* How many times to send setup packets */
e7f8ec2a 307 int32_t setup_retry_interval; /* Initial timeout for setup packets */
4a8aed08 308 int32_t wait_timeout; /* How long to wait if setup unsuccessful */
446353cd 309 int32_t mobile_peer_expiry; /* How long to remember 2ary addresses */
4a8aed08
IJ
310 int32_t key_lifetime; /* How long a key lasts once set up */
311 int32_t key_renegotiate_time; /* If we see traffic (or a keepalive)
9d3a4132
SE
312 after this time, initiate a new
313 key exchange */
2fe58dfd 314
2fe58dfd
SE
315 bool_t setup_priority; /* Do we have precedence if both sites emit
316 message 1 simultaneously? */
317 uint32_t log_events;
318
319/* runtime information */
320 uint32_t state;
321 uint64_t now; /* Most recently seen time */
dd9209d1 322 bool_t allow_send_prod;
5c19b79c 323 bool_t resolving;
2fe58dfd 324
ff05a229 325 /* The currently established session */
19e9a588 326 struct data_key current;
02b0959b 327 struct data_key auxiliary_key;
bd98cd6b 328 bool_t auxiliary_is_new;
ff05a229 329 uint64_t renegotiate_key_time; /* When we can negotiate a new key */
bd98cd6b 330 uint64_t auxiliary_renegotiate_key_time;
446353cd 331 transport_peers peers; /* Current address(es) of peer for data traffic */
2fe58dfd 332
ff05a229
SE
333 /* The current key setup protocol exchange. We can only be
334 involved in one of these at a time. There's a potential for
335 denial of service here (the attacker keeps sending a setup
336 packet; we keep trying to continue the exchange, and have to
337 timeout before we can listen for another setup packet); perhaps
338 we should keep a list of 'bad' sources for setup packets. */
09a385fb 339 uint32_t remote_capabilities;
3ed1846a 340 uint16_t remote_adv_mtu;
5b5f297f 341 struct transform_if *chosen_transform;
2fe58dfd 342 uint32_t setup_session_id;
446353cd 343 transport_peers setup_peers;
2fe58dfd
SE
344 uint8_t localN[NONCELEN]; /* Nonces for key exchange */
345 uint8_t remoteN[NONCELEN];
346 struct buffer_if buffer; /* Current outgoing key exchange packet */
05f39b4d 347 struct buffer_if scratch;
4a8aed08 348 int32_t retries; /* Number of retries remaining */
2fe58dfd
SE
349 uint64_t timeout; /* Timeout for current state */
350 uint8_t *dhsecret;
351 uint8_t *sharedsecret;
5b5f297f 352 uint32_t sharedsecretlen, sharedsecretallocd;
2fe58dfd
SE
353 struct transform_inst_if *new_transform; /* For key setup/verify */
354};
355
8368df34
IJ
356static uint32_t event_log_priority(struct site *st, uint32_t event)
357{
358 if (!(event&st->log_events))
359 return 0;
360 switch(event) {
361 case LOG_UNEXPECTED: return M_INFO;
362 case LOG_SETUP_INIT: return M_INFO;
363 case LOG_SETUP_TIMEOUT: return M_NOTICE;
364 case LOG_ACTIVATE_KEY: return M_INFO;
365 case LOG_TIMEOUT_KEY: return M_INFO;
366 case LOG_SEC: return M_SECURITY;
367 case LOG_STATE: return M_DEBUG;
368 case LOG_DROP: return M_DEBUG;
369 case LOG_DUMP: return M_DEBUG;
370 case LOG_ERROR: return M_ERR;
371 case LOG_PEER_ADDRS: return M_DEBUG;
372 default: return M_ERR;
373 }
374}
375
0237c848
IJ
376static void vslog(struct site *st, uint32_t event, cstring_t msg, va_list ap)
377FORMAT(printf,3,0);
378static void vslog(struct site *st, uint32_t event, cstring_t msg, va_list ap)
2fe58dfd 379{
b2a56f7c 380 uint32_t class;
2fe58dfd 381
8368df34
IJ
382 class=event_log_priority(st, event);
383 if (class) {
e5d8c16e
IJ
384 slilog_part(st->log,class,"%s: ",st->tunname);
385 vslilog_part(st->log,class,msg,ap);
386 slilog_part(st->log,class,"\n");
2fe58dfd 387 }
2fe58dfd
SE
388}
389
0237c848
IJ
390static void slog(struct site *st, uint32_t event, cstring_t msg, ...)
391FORMAT(printf,3,4);
392static void slog(struct site *st, uint32_t event, cstring_t msg, ...)
393{
394 va_list ap;
395 va_start(ap,msg);
396 vslog(st,event,msg,ap);
397 va_end(ap);
398}
399
4f3c75ac
IJ
400static void logtimeout(struct site *st, const char *fmt, ...)
401FORMAT(printf,2,3);
402static void logtimeout(struct site *st, const char *fmt, ...)
403{
e9c9020e
IJ
404 uint32_t class=event_log_priority(st,LOG_SETUP_TIMEOUT);
405 if (!class)
406 return;
407
4f3c75ac
IJ
408 va_list ap;
409 va_start(ap,fmt);
e9c9020e
IJ
410
411 slilog_part(st->log,class,"%s: ",st->tunname);
412 vslilog_part(st->log,class,fmt,ap);
413
414 const char *delim;
415 int i;
416 for (i=0, delim=" (tried ";
417 i<st->setup_peers.npeers;
418 i++, delim=", ") {
419 transport_peer *peer=&st->setup_peers.peers[i];
420 const char *s=comm_addr_to_string(&peer->addr);
421 slilog_part(st->log,class,"%s%s",delim,s);
422 }
423
424 slilog_part(st->log,class,")\n");
4f3c75ac
IJ
425 va_end(ap);
426}
427
9d3a4132 428static void set_link_quality(struct site *st);
1d388569
IJ
429static void delete_keys(struct site *st, cstring_t reason, uint32_t loglevel);
430static void delete_one_key(struct site *st, struct data_key *key,
431 const char *reason /* may be 0 meaning don't log*/,
432 const char *which /* ignored if !reasonn */,
433 uint32_t loglevel /* ignored if !reasonn */);
dd9209d1
IJ
434static bool_t initiate_key_setup(struct site *st, cstring_t reason,
435 const struct comm_addr *prod_hint);
2fe58dfd
SE
436static void enter_state_run(struct site *st);
437static bool_t enter_state_resolve(struct site *st);
ff05a229 438static bool_t enter_new_state(struct site *st,uint32_t next);
2fe58dfd 439static void enter_state_wait(struct site *st);
05f39b4d 440static void activate_new_key(struct site *st);
2fe58dfd 441
0afd257e
IJ
442static bool_t is_transform_valid(struct transform_inst_if *transform)
443{
fcad4b0b 444 return transform && transform->valid(transform->st);
0afd257e
IJ
445}
446
3d8d8f4e
IJ
447static bool_t current_valid(struct site *st)
448{
0afd257e
IJ
449 return is_transform_valid(st->current.transform);
450}
451
452#define DEFINE_CALL_TRANSFORM(fwdrev) \
453static int call_transform_##fwdrev(struct site *st, \
454 struct transform_inst_if *transform, \
455 struct buffer_if *buf, \
456 const char **errmsg) \
457{ \
fcad4b0b
IJ
458 if (!is_transform_valid(transform)) { \
459 *errmsg="transform not set up"; \
460 return 1; \
461 } \
0afd257e 462 return transform->fwdrev(transform->st,buf,errmsg); \
3d8d8f4e
IJ
463}
464
0afd257e
IJ
465DEFINE_CALL_TRANSFORM(forwards)
466DEFINE_CALL_TRANSFORM(reverse)
467
468static void dispose_transform(struct transform_inst_if **transform_var)
469{
0afd257e 470 struct transform_inst_if *transform=*transform_var;
fcad4b0b
IJ
471 if (transform) {
472 transform->delkey(transform->st);
473 transform->destroy(transform->st);
474 }
475 *transform_var = 0;
0afd257e
IJ
476}
477
2fe58dfd
SE
478#define CHECK_AVAIL(b,l) do { if ((b)->size<(l)) return False; } while(0)
479#define CHECK_EMPTY(b) do { if ((b)->size!=0) return False; } while(0)
480#define CHECK_TYPE(b,t) do { uint32_t type; \
481 CHECK_AVAIL((b),4); \
59635212 482 type=buf_unprepend_uint32((b)); \
2fe58dfd
SE
483 if (type!=(t)) return False; } while(0)
484
3ed1846a
IJ
485static _Bool type_is_msg34(uint32_t type)
486{
487 return
488 type == LABEL_MSG3 ||
489 type == LABEL_MSG3BIS ||
490 type == LABEL_MSG4;
491}
492
1737eeef
IJ
493struct parsedname {
494 int32_t len;
495 uint8_t *name;
09a385fb 496 struct buffer_if extrainfo;
1737eeef
IJ
497};
498
2fe58dfd
SE
499struct msg {
500 uint8_t *hashstart;
501 uint32_t dest;
502 uint32_t source;
1737eeef
IJ
503 struct parsedname remote;
504 struct parsedname local;
09a385fb 505 uint32_t remote_capabilities;
3ed1846a 506 uint16_t remote_mtu;
5b5f297f 507 int capab_transformnum;
2fe58dfd
SE
508 uint8_t *nR;
509 uint8_t *nL;
1caa23ff 510 int32_t pklen;
3e8addad 511 char *pk;
1caa23ff
IJ
512 int32_t hashlen;
513 int32_t siglen;
3e8addad 514 char *sig;
2fe58dfd
SE
515};
516
5b5f297f 517static void set_new_transform(struct site *st, char *pk)
0afd257e 518{
5b5f297f
IJ
519 /* Make room for the shared key */
520 st->sharedsecretlen=st->chosen_transform->keylen?:st->dh->ceil_len;
521 assert(st->sharedsecretlen);
522 if (st->sharedsecretlen > st->sharedsecretallocd) {
523 st->sharedsecretallocd=st->sharedsecretlen;
524 st->sharedsecret=realloc(st->sharedsecret,st->sharedsecretallocd);
525 }
526 if (!st->sharedsecret) fatal_perror("site:sharedsecret");
527
528 /* Generate the shared key */
529 st->dh->makeshared(st->dh->st,st->dhsecret,st->dh->len,pk,
530 st->sharedsecret,st->sharedsecretlen);
531
532 /* Set up the transform */
533 struct transform_if *generator=st->chosen_transform;
fcad4b0b
IJ
534 struct transform_inst_if *generated=generator->create(generator->st);
535 generated->setkey(generated->st,st->sharedsecret,
536 st->sharedsecretlen,st->setup_priority);
537 dispose_transform(&st->new_transform);
538 st->new_transform=generated;
5b5f297f
IJ
539
540 slog(st,LOG_SETUP_INIT,"key exchange negotiated transform"
541 " %d (capabilities ours=%#"PRIx32" theirs=%#"PRIx32")",
542 st->chosen_transform->capab_transformnum,
543 st->local_capabilities, st->remote_capabilities);
0afd257e
IJ
544}
545
09a385fb
IJ
546struct xinfoadd {
547 int32_t lenpos, afternul;
548};
549static void append_string_xinfo_start(struct buffer_if *buf,
550 struct xinfoadd *xia,
551 const char *str)
552 /* Helps construct one of the names with additional info as found
553 * in MSG1..4. Call this function first, then append all the
554 * desired extra info (not including the nul byte) to the buffer,
555 * then call append_string_xinfo_done. */
556{
557 xia->lenpos = buf->size;
558 buf_append_string(buf,str);
559 buf_append_uint8(buf,0);
560 xia->afternul = buf->size;
561}
562static void append_string_xinfo_done(struct buffer_if *buf,
563 struct xinfoadd *xia)
564{
565 /* we just need to adjust the string length */
566 if (buf->size == xia->afternul) {
567 /* no extra info, strip the nul too */
568 buf_unappend_uint8(buf);
569 } else {
570 put_uint16(buf->start+xia->lenpos, buf->size-(xia->lenpos+2));
571 }
572}
573
ff05a229
SE
574/* Build any of msg1 to msg4. msg5 and msg6 are built from the inside
575 out using a transform of config data supplied by netlink */
fe5e9cc4 576static bool_t generate_msg(struct site *st, uint32_t type, cstring_t what)
2fe58dfd
SE
577{
578 void *hst;
3b83c932 579 uint8_t *hash;
2fe58dfd
SE
580 string_t dhpub, sig;
581
582 st->retries=st->setup_retries;
583 BUF_ALLOC(&st->buffer,what);
584 buffer_init(&st->buffer,0);
59635212
SE
585 buf_append_uint32(&st->buffer,
586 (type==LABEL_MSG1?0:st->setup_session_id));
58650a70 587 buf_append_uint32(&st->buffer,st->index);
59635212 588 buf_append_uint32(&st->buffer,type);
09a385fb
IJ
589
590 struct xinfoadd xia;
591 append_string_xinfo_start(&st->buffer,&xia,st->localname);
592 if ((st->local_capabilities & CAPAB_EARLY) || (type != LABEL_MSG1)) {
593 buf_append_uint32(&st->buffer,st->local_capabilities);
594 }
3ed1846a
IJ
595 if (type_is_msg34(type)) {
596 buf_append_uint16(&st->buffer,st->mtu_target);
597 }
09a385fb
IJ
598 append_string_xinfo_done(&st->buffer,&xia);
599
2fe58dfd 600 buf_append_string(&st->buffer,st->remotename);
4f28e77e 601 BUF_ADD_OBJ(append,&st->buffer,st->localN);
2fe58dfd 602 if (type==LABEL_MSG1) return True;
4f28e77e 603 BUF_ADD_OBJ(append,&st->buffer,st->remoteN);
2fe58dfd 604 if (type==LABEL_MSG2) return True;
3b83c932
SE
605
606 if (hacky_par_mid_failnow()) return False;
607
5b5f297f
IJ
608 if (type==LABEL_MSG3BIS)
609 buf_append_uint8(&st->buffer,st->chosen_transform->capab_transformnum);
610
2fe58dfd
SE
611 dhpub=st->dh->makepublic(st->dh->st,st->dhsecret,st->dh->len);
612 buf_append_string(&st->buffer,dhpub);
613 free(dhpub);
3b83c932 614 hash=safe_malloc(st->hash->len, "generate_msg");
2fe58dfd
SE
615 hst=st->hash->init();
616 st->hash->update(hst,st->buffer.start,st->buffer.size);
617 st->hash->final(hst,hash);
618 sig=st->privkey->sign(st->privkey->st,hash,st->hash->len);
619 buf_append_string(&st->buffer,sig);
620 free(sig);
3b83c932 621 free(hash);
2fe58dfd
SE
622 return True;
623}
624
1737eeef
IJ
625static bool_t unpick_name(struct buffer_if *msg, struct parsedname *nm)
626{
627 CHECK_AVAIL(msg,2);
628 nm->len=buf_unprepend_uint16(msg);
629 CHECK_AVAIL(msg,nm->len);
630 nm->name=buf_unprepend(msg,nm->len);
631 uint8_t *nul=memchr(nm->name,0,nm->len);
632 if (!nul) {
09a385fb 633 buffer_readonly_view(&nm->extrainfo,0,0);
1737eeef 634 } else {
09a385fb 635 buffer_readonly_view(&nm->extrainfo, nul+1, msg->start-(nul+1));
1737eeef
IJ
636 nm->len=nul-nm->name;
637 }
638 return True;
639}
640
2fe58dfd
SE
641static bool_t unpick_msg(struct site *st, uint32_t type,
642 struct buffer_if *msg, struct msg *m)
643{
5b5f297f 644 m->capab_transformnum=-1;
2fe58dfd
SE
645 m->hashstart=msg->start;
646 CHECK_AVAIL(msg,4);
59635212 647 m->dest=buf_unprepend_uint32(msg);
2fe58dfd 648 CHECK_AVAIL(msg,4);
59635212 649 m->source=buf_unprepend_uint32(msg);
2fe58dfd 650 CHECK_TYPE(msg,type);
1737eeef 651 if (!unpick_name(msg,&m->remote)) return False;
09a385fb 652 m->remote_capabilities=0;
3ed1846a 653 m->remote_mtu=0;
09a385fb
IJ
654 if (m->remote.extrainfo.size) {
655 CHECK_AVAIL(&m->remote.extrainfo,4);
656 m->remote_capabilities=buf_unprepend_uint32(&m->remote.extrainfo);
657 }
3ed1846a
IJ
658 if (type_is_msg34(type) && m->remote.extrainfo.size) {
659 CHECK_AVAIL(&m->remote.extrainfo,2);
660 m->remote_mtu=buf_unprepend_uint16(&m->remote.extrainfo);
661 }
1737eeef 662 if (!unpick_name(msg,&m->local)) return False;
dd9209d1
IJ
663 if (type==LABEL_PROD) {
664 CHECK_EMPTY(msg);
665 return True;
666 }
2fe58dfd
SE
667 CHECK_AVAIL(msg,NONCELEN);
668 m->nR=buf_unprepend(msg,NONCELEN);
669 if (type==LABEL_MSG1) {
670 CHECK_EMPTY(msg);
671 return True;
672 }
673 CHECK_AVAIL(msg,NONCELEN);
674 m->nL=buf_unprepend(msg,NONCELEN);
675 if (type==LABEL_MSG2) {
676 CHECK_EMPTY(msg);
677 return True;
678 }
5b5f297f
IJ
679 if (type==LABEL_MSG3BIS) {
680 CHECK_AVAIL(msg,1);
681 m->capab_transformnum = buf_unprepend_uint8(msg);
682 } else {
683 m->capab_transformnum = CAPAB_TRANSFORMNUM_ANCIENT;
684 }
2fe58dfd 685 CHECK_AVAIL(msg,2);
59635212 686 m->pklen=buf_unprepend_uint16(msg);
2fe58dfd
SE
687 CHECK_AVAIL(msg,m->pklen);
688 m->pk=buf_unprepend(msg,m->pklen);
689 m->hashlen=msg->start-m->hashstart;
690 CHECK_AVAIL(msg,2);
59635212 691 m->siglen=buf_unprepend_uint16(msg);
2fe58dfd
SE
692 CHECK_AVAIL(msg,m->siglen);
693 m->sig=buf_unprepend(msg,m->siglen);
694 CHECK_EMPTY(msg);
695 return True;
696}
697
1737eeef
IJ
698static bool_t name_matches(const struct parsedname *nm, const char *expected)
699{
700 int expected_len=strlen(expected);
701 return
702 nm->len == expected_len &&
703 !memcmp(nm->name, expected, expected_len);
704}
705
ff05a229 706static bool_t check_msg(struct site *st, uint32_t type, struct msg *m,
fe5e9cc4 707 cstring_t *error)
ff05a229
SE
708{
709 if (type==LABEL_MSG1) return True;
710
711 /* Check that the site names and our nonce have been sent
712 back correctly, and then store our peer's nonce. */
1737eeef 713 if (!name_matches(&m->remote,st->remotename)) {
ff05a229
SE
714 *error="wrong remote site name";
715 return False;
716 }
1737eeef 717 if (!name_matches(&m->local,st->localname)) {
ff05a229
SE
718 *error="wrong local site name";
719 return False;
720 }
721 if (memcmp(m->nL,st->localN,NONCELEN)!=0) {
722 *error="wrong locally-generated nonce";
723 return False;
724 }
725 if (type==LABEL_MSG2) return True;
5ad34db2 726 if (!consttime_memeq(m->nR,st->remoteN,NONCELEN)!=0) {
ff05a229
SE
727 *error="wrong remotely-generated nonce";
728 return False;
729 }
09a385fb
IJ
730 /* MSG3 has complicated rules about capabilities, which are
731 * handled in process_msg3. */
5b5f297f 732 if (type==LABEL_MSG3 || type==LABEL_MSG3BIS) return True;
09a385fb
IJ
733 if (m->remote_capabilities!=st->remote_capabilities) {
734 *error="remote capabilities changed";
735 return False;
736 }
ff05a229
SE
737 if (type==LABEL_MSG4) return True;
738 *error="unknown message type";
739 return False;
740}
741
2fe58dfd
SE
742static bool_t generate_msg1(struct site *st)
743{
744 st->random->generate(st->random->st,NONCELEN,st->localN);
745 return generate_msg(st,LABEL_MSG1,"site:MSG1");
746}
747
748static bool_t process_msg1(struct site *st, struct buffer_if *msg1,
7e29719e 749 const struct comm_addr *src, struct msg *m)
2fe58dfd 750{
2fe58dfd
SE
751 /* We've already determined we're in an appropriate state to
752 process an incoming MSG1, and that the MSG1 has correct values
753 of A and B. */
754
7e29719e 755 st->setup_session_id=m->source;
09a385fb 756 st->remote_capabilities=m->remote_capabilities;
7e29719e 757 memcpy(st->remoteN,m->nR,NONCELEN);
2fe58dfd
SE
758 return True;
759}
760
761static bool_t generate_msg2(struct site *st)
762{
763 st->random->generate(st->random->st,NONCELEN,st->localN);
764 return generate_msg(st,LABEL_MSG2,"site:MSG2");
765}
766
767static bool_t process_msg2(struct site *st, struct buffer_if *msg2,
a15faeb2 768 const struct comm_addr *src)
2fe58dfd
SE
769{
770 struct msg m;
fe5e9cc4 771 cstring_t err;
2fe58dfd
SE
772
773 if (!unpick_msg(st,LABEL_MSG2,msg2,&m)) return False;
ff05a229
SE
774 if (!check_msg(st,LABEL_MSG2,&m,&err)) {
775 slog(st,LOG_SEC,"msg2: %s",err);
2fe58dfd
SE
776 return False;
777 }
778 st->setup_session_id=m.source;
09a385fb 779 st->remote_capabilities=m.remote_capabilities;
5b5f297f
IJ
780
781 /* Select the transform to use */
782
783 uint32_t remote_transforms = st->remote_capabilities & CAPAB_TRANSFORM_MASK;
784 if (!remote_transforms)
785 /* old secnets only had this one transform */
786 remote_transforms = 1UL << CAPAB_TRANSFORMNUM_ANCIENT;
787
788 struct transform_if *ti;
789 int i;
790 for (i=0; i<st->ntransforms; i++) {
791 ti=st->transforms[i];
792 if ((1UL << ti->capab_transformnum) & remote_transforms)
793 goto transform_found;
794 }
795 slog(st,LOG_ERROR,"no transforms in common"
796 " (us %#"PRIx32"; them: %#"PRIx32")",
797 st->local_capabilities & CAPAB_TRANSFORM_MASK,
798 remote_transforms);
799 return False;
800 transform_found:
801 st->chosen_transform=ti;
802
2fe58dfd
SE
803 memcpy(st->remoteN,m.nR,NONCELEN);
804 return True;
805}
806
807static bool_t generate_msg3(struct site *st)
808{
809 /* Now we have our nonce and their nonce. Think of a secret key,
810 and create message number 3. */
811 st->random->generate(st->random->st,st->dh->len,st->dhsecret);
5b5f297f
IJ
812 return generate_msg(st,
813 (st->remote_capabilities & CAPAB_TRANSFORM_MASK
814 ? LABEL_MSG3BIS : LABEL_MSG3),
815 "site:MSG3");
2fe58dfd
SE
816}
817
e001e8c0
IJ
818static bool_t process_msg3_msg4(struct site *st, struct msg *m)
819{
820 uint8_t *hash;
821 void *hst;
822
823 /* Check signature and store g^x mod m */
824 hash=safe_malloc(st->hash->len, "process_msg3_msg4");
825 hst=st->hash->init();
826 st->hash->update(hst,m->hashstart,m->hashlen);
827 st->hash->final(hst,hash);
828 /* Terminate signature with a '0' - cheating, but should be ok */
829 m->sig[m->siglen]=0;
830 if (!st->pubkey->check(st->pubkey->st,hash,st->hash->len,m->sig)) {
831 slog(st,LOG_SEC,"msg3/msg4 signature failed check!");
832 free(hash);
833 return False;
834 }
835 free(hash);
836
3ed1846a
IJ
837 st->remote_adv_mtu=m->remote_mtu;
838
e001e8c0
IJ
839 return True;
840}
841
2fe58dfd 842static bool_t process_msg3(struct site *st, struct buffer_if *msg3,
5b5f297f 843 const struct comm_addr *src, uint32_t msgtype)
2fe58dfd
SE
844{
845 struct msg m;
fe5e9cc4 846 cstring_t err;
2fe58dfd 847
5b5f297f
IJ
848 assert(msgtype==LABEL_MSG3 || msgtype==LABEL_MSG3BIS);
849
850 if (!unpick_msg(st,msgtype,msg3,&m)) return False;
851 if (!check_msg(st,msgtype,&m,&err)) {
ff05a229 852 slog(st,LOG_SEC,"msg3: %s",err);
2fe58dfd
SE
853 return False;
854 }
09a385fb
IJ
855 uint32_t capab_adv_late = m.remote_capabilities
856 & ~st->remote_capabilities & CAPAB_EARLY;
857 if (capab_adv_late) {
858 slog(st,LOG_SEC,"msg3 impermissibly adds early capability flag(s)"
859 " %#"PRIx32" (was %#"PRIx32", now %#"PRIx32")",
860 capab_adv_late, st->remote_capabilities, m.remote_capabilities);
861 return False;
862 }
863 st->remote_capabilities|=m.remote_capabilities;
ff05a229 864
5b5f297f
IJ
865 struct transform_if *ti;
866 int i;
867 for (i=0; i<st->ntransforms; i++) {
868 ti=st->transforms[i];
869 if (ti->capab_transformnum == m.capab_transformnum)
870 goto transform_found;
871 }
872 slog(st,LOG_SEC,"peer chose unknown-to-us transform %d!",
873 m.capab_transformnum);
874 return False;
875 transform_found:
876 st->chosen_transform=ti;
877
e001e8c0 878 if (!process_msg3_msg4(st,&m))
2fe58dfd 879 return False;
2fe58dfd
SE
880
881 /* Terminate their DH public key with a '0' */
882 m.pk[m.pklen]=0;
883 /* Invent our DH secret key */
884 st->random->generate(st->random->st,st->dh->len,st->dhsecret);
885
5b5f297f
IJ
886 /* Generate the shared key and set up the transform */
887 set_new_transform(st,m.pk);
2fe58dfd
SE
888
889 return True;
890}
891
892static bool_t generate_msg4(struct site *st)
893{
894 /* We have both nonces, their public key and our private key. Generate
895 our public key, sign it and send it to them. */
896 return generate_msg(st,LABEL_MSG4,"site:MSG4");
897}
898
899static bool_t process_msg4(struct site *st, struct buffer_if *msg4,
a15faeb2 900 const struct comm_addr *src)
2fe58dfd
SE
901{
902 struct msg m;
fe5e9cc4 903 cstring_t err;
2fe58dfd
SE
904
905 if (!unpick_msg(st,LABEL_MSG4,msg4,&m)) return False;
ff05a229
SE
906 if (!check_msg(st,LABEL_MSG4,&m,&err)) {
907 slog(st,LOG_SEC,"msg4: %s",err);
2fe58dfd
SE
908 return False;
909 }
910
e001e8c0 911 if (!process_msg3_msg4(st,&m))
2fe58dfd 912 return False;
2fe58dfd
SE
913
914 /* Terminate their DH public key with a '0' */
915 m.pk[m.pklen]=0;
5b5f297f
IJ
916
917 /* Generate the shared key and set up the transform */
918 set_new_transform(st,m.pk);
2fe58dfd
SE
919
920 return True;
921}
922
2fe58dfd
SE
923struct msg0 {
924 uint32_t dest;
925 uint32_t source;
926 uint32_t type;
927};
928
929static bool_t unpick_msg0(struct site *st, struct buffer_if *msg0,
930 struct msg0 *m)
931{
932 CHECK_AVAIL(msg0,4);
59635212 933 m->dest=buf_unprepend_uint32(msg0);
2fe58dfd 934 CHECK_AVAIL(msg0,4);
59635212 935 m->source=buf_unprepend_uint32(msg0);
2fe58dfd 936 CHECK_AVAIL(msg0,4);
59635212 937 m->type=buf_unprepend_uint32(msg0);
2fe58dfd
SE
938 return True;
939 /* Leaves transformed part of buffer untouched */
940}
941
ff05a229
SE
942static bool_t generate_msg5(struct site *st)
943{
fe5e9cc4 944 cstring_t transform_err;
ff05a229
SE
945
946 BUF_ALLOC(&st->buffer,"site:MSG5");
947 /* We are going to add four words to the message */
3abd18e8 948 buffer_init(&st->buffer,calculate_max_start_pad());
ff05a229
SE
949 /* Give the netlink code an opportunity to put its own stuff in the
950 message (configuration information, etc.) */
ff05a229 951 buf_prepend_uint32(&st->buffer,LABEL_MSG5);
0afd257e
IJ
952 if (call_transform_forwards(st,st->new_transform,
953 &st->buffer,&transform_err))
954 return False;
ff05a229 955 buf_prepend_uint32(&st->buffer,LABEL_MSG5);
58650a70 956 buf_prepend_uint32(&st->buffer,st->index);
ff05a229
SE
957 buf_prepend_uint32(&st->buffer,st->setup_session_id);
958
959 st->retries=st->setup_retries;
960 return True;
961}
962
2fe58dfd 963static bool_t process_msg5(struct site *st, struct buffer_if *msg5,
c90cc2a7
IJ
964 const struct comm_addr *src,
965 struct transform_inst_if *transform)
2fe58dfd
SE
966{
967 struct msg0 m;
fe5e9cc4 968 cstring_t transform_err;
2fe58dfd
SE
969
970 if (!unpick_msg0(st,msg5,&m)) return False;
971
0afd257e 972 if (call_transform_reverse(st,transform,msg5,&transform_err)) {
2fe58dfd 973 /* There's a problem */
59635212 974 slog(st,LOG_SEC,"process_msg5: transform: %s",transform_err);
2fe58dfd
SE
975 return False;
976 }
977 /* Buffer should now contain untransformed PING packet data */
978 CHECK_AVAIL(msg5,4);
59635212 979 if (buf_unprepend_uint32(msg5)!=LABEL_MSG5) {
ff05a229 980 slog(st,LOG_SEC,"MSG5/PING packet contained wrong label");
2fe58dfd
SE
981 return False;
982 }
ff7cdc9e
IJ
983 /* Older versions of secnet used to write some config data here
984 * which we ignore. So we don't CHECK_EMPTY */
2fe58dfd
SE
985 return True;
986}
987
c90cc2a7
IJ
988static void create_msg6(struct site *st, struct transform_inst_if *transform,
989 uint32_t session_id)
2fe58dfd 990{
fe5e9cc4 991 cstring_t transform_err;
2fe58dfd
SE
992
993 BUF_ALLOC(&st->buffer,"site:MSG6");
ff05a229 994 /* We are going to add four words to the message */
3abd18e8 995 buffer_init(&st->buffer,calculate_max_start_pad());
794f2398
SE
996 /* Give the netlink code an opportunity to put its own stuff in the
997 message (configuration information, etc.) */
ff05a229 998 buf_prepend_uint32(&st->buffer,LABEL_MSG6);
0afd257e
IJ
999 int problem = call_transform_forwards(st,transform,
1000 &st->buffer,&transform_err);
1001 assert(!problem);
59635212 1002 buf_prepend_uint32(&st->buffer,LABEL_MSG6);
58650a70 1003 buf_prepend_uint32(&st->buffer,st->index);
c90cc2a7
IJ
1004 buf_prepend_uint32(&st->buffer,session_id);
1005}
2fe58dfd 1006
c90cc2a7
IJ
1007static bool_t generate_msg6(struct site *st)
1008{
0afd257e
IJ
1009 if (!is_transform_valid(st->new_transform))
1010 return False;
c90cc2a7 1011 create_msg6(st,st->new_transform,st->setup_session_id);
ff05a229 1012 st->retries=1; /* Peer will retransmit MSG5 if this packet gets lost */
2fe58dfd
SE
1013 return True;
1014}
1015
1016static bool_t process_msg6(struct site *st, struct buffer_if *msg6,
a15faeb2 1017 const struct comm_addr *src)
2fe58dfd
SE
1018{
1019 struct msg0 m;
fe5e9cc4 1020 cstring_t transform_err;
2fe58dfd
SE
1021
1022 if (!unpick_msg0(st,msg6,&m)) return False;
1023
0afd257e 1024 if (call_transform_reverse(st,st->new_transform,msg6,&transform_err)) {
2fe58dfd 1025 /* There's a problem */
59635212 1026 slog(st,LOG_SEC,"process_msg6: transform: %s",transform_err);
2fe58dfd
SE
1027 return False;
1028 }
1029 /* Buffer should now contain untransformed PING packet data */
1030 CHECK_AVAIL(msg6,4);
59635212
SE
1031 if (buf_unprepend_uint32(msg6)!=LABEL_MSG6) {
1032 slog(st,LOG_SEC,"MSG6/PONG packet contained invalid data");
2fe58dfd
SE
1033 return False;
1034 }
ff7cdc9e
IJ
1035 /* Older versions of secnet used to write some config data here
1036 * which we ignore. So we don't CHECK_EMPTY */
2fe58dfd
SE
1037 return True;
1038}
1039
48b97423
IJ
1040static bool_t decrypt_msg0(struct site *st, struct buffer_if *msg0,
1041 const struct comm_addr *src)
2fe58dfd 1042{
02b0959b 1043 cstring_t transform_err, auxkey_err, newkey_err="n/a";
065e1922
IJ
1044 struct msg0 m;
1045 uint32_t problem;
2fe58dfd 1046
2fe58dfd
SE
1047 if (!unpick_msg0(st,msg0,&m)) return False;
1048
05f39b4d
IJ
1049 /* Keep a copy so we can try decrypting it with multiple keys */
1050 buffer_copy(&st->scratch, msg0);
1051
0afd257e
IJ
1052 problem = call_transform_reverse(st,st->current.transform,
1053 msg0,&transform_err);
02b0959b 1054 if (!problem) {
bd98cd6b
IJ
1055 if (!st->auxiliary_is_new)
1056 delete_one_key(st,&st->auxiliary_key,
1057 "peer has used new key","auxiliary key",LOG_SEC);
02b0959b
IJ
1058 return True;
1059 }
48b97423
IJ
1060 if (problem==2)
1061 goto skew;
07e4774c 1062
02b0959b 1063 buffer_copy(msg0, &st->scratch);
fcad4b0b
IJ
1064 problem = call_transform_reverse(st,st->auxiliary_key.transform,
1065 msg0,&auxkey_err);
02b0959b
IJ
1066 if (problem==0) {
1067 slog(st,LOG_DROP,"processing packet which uses auxiliary key");
bd98cd6b
IJ
1068 if (st->auxiliary_is_new) {
1069 /* We previously timed out in state SENTMSG5 but it turns
1070 * out that our peer did in fact get our MSG5 and is
1071 * using the new key. So we should switch to it too. */
1072 /* This is a bit like activate_new_key. */
1073 struct data_key t;
1074 t=st->current;
1075 st->current=st->auxiliary_key;
1076 st->auxiliary_key=t;
1077
1078 delete_one_key(st,&st->auxiliary_key,"peer has used new key",
1079 "previous key",LOG_SEC);
1080 st->auxiliary_is_new=0;
1081 st->renegotiate_key_time=st->auxiliary_renegotiate_key_time;
1082 }
02b0959b
IJ
1083 return True;
1084 }
48b97423
IJ
1085 if (problem==2)
1086 goto skew;
02b0959b 1087
05f39b4d
IJ
1088 if (st->state==SITE_SENTMSG5) {
1089 buffer_copy(msg0, &st->scratch);
0afd257e
IJ
1090 problem = call_transform_reverse(st,st->new_transform,
1091 msg0,&newkey_err);
48b97423 1092 if (!problem) {
05f39b4d
IJ
1093 /* It looks like we didn't get the peer's MSG6 */
1094 /* This is like a cut-down enter_new_state(SITE_RUN) */
1095 slog(st,LOG_STATE,"will enter state RUN (MSG0 with new key)");
1096 BUF_FREE(&st->buffer);
1097 st->timeout=0;
1098 activate_new_key(st);
1099 return True; /* do process the data in this packet */
1100 }
48b97423
IJ
1101 if (problem==2)
1102 goto skew;
05f39b4d
IJ
1103 }
1104
02b0959b
IJ
1105 slog(st,LOG_SEC,"transform: %s (aux: %s, new: %s)",
1106 transform_err,auxkey_err,newkey_err);
dd9209d1 1107 initiate_key_setup(st,"incoming message would not decrypt",0);
48b97423
IJ
1108 send_nak(src,m.dest,m.source,m.type,msg0,"message would not decrypt");
1109 return False;
1110
1111 skew:
1112 slog(st,LOG_DROP,"transform: %s (merely skew)",transform_err);
065e1922
IJ
1113 return False;
1114}
1115
1116static bool_t process_msg0(struct site *st, struct buffer_if *msg0,
1117 const struct comm_addr *src)
1118{
1119 uint32_t type;
1120
48b97423 1121 if (!decrypt_msg0(st,msg0,src))
065e1922
IJ
1122 return False;
1123
2fe58dfd 1124 CHECK_AVAIL(msg0,4);
59635212 1125 type=buf_unprepend_uint32(msg0);
2fe58dfd 1126 switch(type) {
794f2398
SE
1127 case LABEL_MSG7:
1128 /* We must forget about the current session. */
1d388569 1129 delete_keys(st,"request from peer",LOG_SEC);
794f2398 1130 return True;
2fe58dfd
SE
1131 case LABEL_MSG9:
1132 /* Deliver to netlink layer */
469fd1d9 1133 st->netlink->deliver(st->netlink->st,msg0);
446353cd 1134 transport_data_msgok(st,src);
837cf01e
IJ
1135 /* See whether we should start negotiating a new key */
1136 if (st->now > st->renegotiate_key_time)
dd9209d1 1137 initiate_key_setup(st,"incoming packet in renegotiation window",0);
2fe58dfd 1138 return True;
2fe58dfd 1139 default:
ff05a229
SE
1140 slog(st,LOG_SEC,"incoming encrypted message of type %08x "
1141 "(unknown)",type);
2fe58dfd
SE
1142 break;
1143 }
1144 return False;
1145}
1146
1147static void dump_packet(struct site *st, struct buffer_if *buf,
a15faeb2 1148 const struct comm_addr *addr, bool_t incoming)
2fe58dfd 1149{
0a6cbade
IJ
1150 uint32_t dest=get_uint32(buf->start);
1151 uint32_t source=get_uint32(buf->start+4);
1152 uint32_t msgtype=get_uint32(buf->start+8);
2fe58dfd
SE
1153
1154 if (st->log_events & LOG_DUMP)
040ee979
SE
1155 slilog(st->log,M_DEBUG,"%s: %s: %08x<-%08x: %08x:",
1156 st->tunname,incoming?"incoming":"outgoing",
1157 dest,source,msgtype);
2fe58dfd
SE
1158}
1159
1160static uint32_t site_status(void *st)
1161{
1162 return 0;
1163}
1164
1165static bool_t send_msg(struct site *st)
1166{
1167 if (st->retries>0) {
446353cd 1168 transport_xmit(st, &st->setup_peers, &st->buffer, True);
e7f8ec2a 1169 st->timeout=st->now+st->setup_retry_interval;
2fe58dfd
SE
1170 st->retries--;
1171 return True;
bd98cd6b 1172 } else if (st->state==SITE_SENTMSG5) {
4f3c75ac 1173 logtimeout(st,"timed out sending MSG5, stashing new key");
bd98cd6b
IJ
1174 /* We stash the key we have produced, in case it turns out that
1175 * our peer did see our MSG5 after all and starts using it. */
1176 /* This is a bit like some of activate_new_key */
1177 struct transform_inst_if *t;
1178 t=st->auxiliary_key.transform;
1179 st->auxiliary_key.transform=st->new_transform;
1180 st->new_transform=t;
0afd257e 1181 dispose_transform(&st->new_transform);
bd98cd6b 1182
bd98cd6b
IJ
1183 st->auxiliary_is_new=1;
1184 st->auxiliary_key.key_timeout=st->now+st->key_lifetime;
1185 st->auxiliary_renegotiate_key_time=st->now+st->key_renegotiate_time;
1186 st->auxiliary_key.remote_session_id=st->setup_session_id;
1187
1188 enter_state_wait(st);
1189 return False;
2fe58dfd 1190 } else {
4f3c75ac 1191 logtimeout(st,"timed out sending key setup packet "
3454dce4 1192 "(in state %s)",state_name(st->state));
2fe58dfd
SE
1193 enter_state_wait(st);
1194 return False;
1195 }
1196}
1197
1198static void site_resolve_callback(void *sst, struct in_addr *address)
1199{
1200 struct site *st=sst;
446353cd 1201 struct comm_addr ca_buf, *ca_use;
2fe58dfd 1202
5c19b79c
IJ
1203 st->resolving=False;
1204
2fe58dfd 1205 if (address) {
446353cd 1206 FILLZERO(ca_buf);
59533c16 1207 ca_buf.comm=st->comms[0];
446353cd
IJ
1208 ca_buf.sin.sin_family=AF_INET;
1209 ca_buf.sin.sin_port=htons(st->remoteport);
1210 ca_buf.sin.sin_addr=*address;
1211 ca_use=&ca_buf;
4ac8a7d2
IJ
1212 slog(st,LOG_STATE,"resolution of %s completed: %s",
1213 st->address, comm_addr_to_string(ca_use));;
2fe58dfd 1214 } else {
2fe58dfd 1215 slog(st,LOG_ERROR,"resolution of %s failed",st->address);
446353cd
IJ
1216 ca_use=0;
1217 }
c22c3541
IJ
1218
1219 switch (st->state) {
1220 case SITE_RESOLVE:
1221 if (transport_compute_setupinit_peers(st,ca_use,0)) {
1222 enter_new_state(st,SITE_SENTMSG1);
1223 } else {
1224 /* Can't figure out who to try to to talk to */
1225 slog(st,LOG_SETUP_INIT,
1226 "key exchange failed: cannot find peer address");
1227 enter_state_run(st);
1228 }
1229 break;
1230 case SITE_SENTMSG1: case SITE_SENTMSG2:
1231 case SITE_SENTMSG3: case SITE_SENTMSG4:
1232 case SITE_SENTMSG5:
1233 if (ca_use) {
1234 /* We start using the address immediately for data too.
1235 * It's best to store it in st->peers now because we might
1236 * go via SENTMSG5, WAIT, and a MSG0, straight into using
1237 * the new key (without updating the data peer addrs). */
90d7e3ad 1238 transport_resolve_complete(st,ca_use);
c22c3541
IJ
1239 } else if (st->local_mobile) {
1240 /* We can't let this rest because we may have a peer
1241 * address which will break in the future. */
1242 slog(st,LOG_SETUP_INIT,"resolution of %s failed: "
1243 "abandoning key exchange",st->address);
1244 enter_state_wait(st);
1245 } else {
1246 slog(st,LOG_SETUP_INIT,"resolution of %s failed: "
1247 " continuing to use source address of peer's packets"
1248 " for key exchange and ultimately data",
1249 st->address);
1250 }
1251 break;
1252 case SITE_RUN:
1253 if (ca_use) {
1254 slog(st,LOG_SETUP_INIT,"resolution of %s completed tardily,"
1255 " updating peer address(es)",st->address);
90d7e3ad 1256 transport_resolve_complete_tardy(st,ca_use);
c22c3541
IJ
1257 } else if (st->local_mobile) {
1258 /* Not very good. We should queue (another) renegotiation
1259 * so that we can update the peer address. */
1260 st->key_renegotiate_time=st->now+st->wait_timeout;
1261 } else {
1262 slog(st,LOG_SETUP_INIT,"resolution of %s failed: "
1263 " continuing to use source address of peer's packets",
1264 st->address);
1265 }
1266 break;
1267 case SITE_WAIT:
1268 case SITE_STOP:
1269 /* oh well */
1270 break;
2fe58dfd
SE
1271 }
1272}
1273
dd9209d1
IJ
1274static bool_t initiate_key_setup(struct site *st, cstring_t reason,
1275 const struct comm_addr *prod_hint)
9d3a4132 1276{
77effe1d 1277 /* Reentrancy hazard: can call enter_new_state/enter_state_* */
9d3a4132 1278 if (st->state!=SITE_RUN) return False;
794f2398 1279 slog(st,LOG_SETUP_INIT,"initiating key exchange (%s)",reason);
9d3a4132 1280 if (st->address) {
794f2398 1281 slog(st,LOG_SETUP_INIT,"resolving peer address");
9d3a4132 1282 return enter_state_resolve(st);
dd9209d1 1283 } else if (transport_compute_setupinit_peers(st,0,prod_hint)) {
ff05a229 1284 return enter_new_state(st,SITE_SENTMSG1);
9d3a4132 1285 }
ff05a229 1286 slog(st,LOG_SETUP_INIT,"key exchange failed: no address for peer");
9d3a4132
SE
1287 return False;
1288}
1289
2fe58dfd
SE
1290static void activate_new_key(struct site *st)
1291{
1292 struct transform_inst_if *t;
1293
02b0959b
IJ
1294 /* We have three transform instances, which we swap between old,
1295 active and setup */
1296 t=st->auxiliary_key.transform;
1297 st->auxiliary_key.transform=st->current.transform;
19e9a588 1298 st->current.transform=st->new_transform;
2fe58dfd 1299 st->new_transform=t;
0afd257e 1300 dispose_transform(&st->new_transform);
2fe58dfd 1301
2fe58dfd 1302 st->timeout=0;
bd98cd6b 1303 st->auxiliary_is_new=0;
02b0959b 1304 st->auxiliary_key.key_timeout=st->current.key_timeout;
19e9a588 1305 st->current.key_timeout=st->now+st->key_lifetime;
ff05a229 1306 st->renegotiate_key_time=st->now+st->key_renegotiate_time;
446353cd 1307 transport_peers_copy(st,&st->peers,&st->setup_peers);
19e9a588 1308 st->current.remote_session_id=st->setup_session_id;
2fe58dfd 1309
3ed1846a
IJ
1310 /* Compute the inter-site MTU. This is min( our_mtu, their_mtu ).
1311 * But their mtu be unspecified, in which case we just use ours. */
1312 uint32_t intersite_mtu=
1313 MIN(st->mtu_target, st->remote_adv_mtu ?: ~(uint32_t)0);
1314 st->netlink->set_mtu(st->netlink->st,intersite_mtu);
1315
1316 slog(st,LOG_ACTIVATE_KEY,"new key activated"
1317 " (mtu ours=%"PRId32" theirs=%"PRId32" intersite=%"PRId32")",
1318 st->mtu_target, st->remote_adv_mtu, intersite_mtu);
9d3a4132 1319 enter_state_run(st);
2fe58dfd
SE
1320}
1321
1d388569
IJ
1322static void delete_one_key(struct site *st, struct data_key *key,
1323 cstring_t reason, cstring_t which, uint32_t loglevel)
1324{
0afd257e 1325 if (!is_transform_valid(key->transform)) return;
1d388569 1326 if (reason) slog(st,loglevel,"%s deleted (%s)",which,reason);
0afd257e 1327 dispose_transform(&key->transform);
1d388569
IJ
1328 key->key_timeout=0;
1329}
1330
1331static void delete_keys(struct site *st, cstring_t reason, uint32_t loglevel)
794f2398 1332{
3d8d8f4e 1333 if (current_valid(st)) {
794f2398
SE
1334 slog(st,loglevel,"session closed (%s)",reason);
1335
1d388569 1336 delete_one_key(st,&st->current,0,0,0);
794f2398
SE
1337 set_link_quality(st);
1338 }
02b0959b 1339 delete_one_key(st,&st->auxiliary_key,0,0,0);
794f2398
SE
1340}
1341
2fe58dfd
SE
1342static void state_assert(struct site *st, bool_t ok)
1343{
4f5e39ec 1344 if (!ok) fatal("site:state_assert");
2fe58dfd
SE
1345}
1346
1347static void enter_state_stop(struct site *st)
1348{
1349 st->state=SITE_STOP;
1350 st->timeout=0;
1d388569 1351 delete_keys(st,"entering state STOP",LOG_TIMEOUT_KEY);
0afd257e 1352 dispose_transform(&st->new_transform);
2fe58dfd
SE
1353}
1354
9d3a4132
SE
1355static void set_link_quality(struct site *st)
1356{
1357 uint32_t quality;
3d8d8f4e 1358 if (current_valid(st))
9d3a4132
SE
1359 quality=LINK_QUALITY_UP;
1360 else if (st->state==SITE_WAIT || st->state==SITE_STOP)
1361 quality=LINK_QUALITY_DOWN;
1362 else if (st->address)
1363 quality=LINK_QUALITY_DOWN_CURRENT_ADDRESS;
446353cd 1364 else if (transport_peers_valid(&st->peers))
9d3a4132
SE
1365 quality=LINK_QUALITY_DOWN_STALE_ADDRESS;
1366 else
1367 quality=LINK_QUALITY_DOWN;
1368
469fd1d9 1369 st->netlink->set_quality(st->netlink->st,quality);
9d3a4132
SE
1370}
1371
2fe58dfd
SE
1372static void enter_state_run(struct site *st)
1373{
1374 slog(st,LOG_STATE,"entering state RUN");
1375 st->state=SITE_RUN;
1376 st->timeout=0;
9d3a4132 1377
ff05a229 1378 st->setup_session_id=0;
446353cd 1379 transport_peers_clear(st,&st->setup_peers);
4f28e77e
IJ
1380 FILLZERO(st->localN);
1381 FILLZERO(st->remoteN);
0afd257e 1382 dispose_transform(&st->new_transform);
ff05a229 1383 memset(st->dhsecret,0,st->dh->len);
7c9ca4bd 1384 memset(st->sharedsecret,0,st->sharedsecretlen);
9d3a4132 1385 set_link_quality(st);
2fe58dfd
SE
1386}
1387
5c19b79c
IJ
1388static bool_t ensure_resolving(struct site *st)
1389{
1390 /* Reentrancy hazard: may call site_resolve_callback and hence
1391 * enter_new_state, enter_state_* and generate_msg*. */
1392 if (st->resolving)
1393 return True;
1394
4ac8a7d2
IJ
1395 assert(st->address);
1396
5c19b79c
IJ
1397 /* resolver->request might reentrantly call site_resolve_callback
1398 * which will clear st->resolving, so we need to set it beforehand
1399 * rather than afterwards; also, it might return False, in which
1400 * case we have to clear ->resolving again. */
1401 st->resolving=True;
1402 bool_t ok = st->resolver->request(st->resolver->st,st->address,
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 */
30834eab 1682 transport_compute_setupinit_peers(st,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
2095static int transport_peer_compar(const void *av, const void *bv) {
2096 const transport_peer *a=av;
2097 const transport_peer *b=bv;
2098 /* put most recent first in the array */
2099 if (timercmp(&a->last, &b->last, <)) return +1;
2100 if (timercmp(&a->last, &b->last, >)) return -11;
2101 return 0;
2102}
2103
2104static void transport_peers_expire(struct site *st, transport_peers *peers) {
2105 /* peers must be sorted first */
2106 int previous_peers=peers->npeers;
2107 struct timeval oldest;
2108 oldest.tv_sec = tv_now->tv_sec - st->mobile_peer_expiry;
2109 oldest.tv_usec = tv_now->tv_usec;
2110 while (peers->npeers>1 &&
2111 timercmp(&peers->peers[peers->npeers-1].last, &oldest, <))
2112 peers->npeers--;
2113 if (peers->npeers != previous_peers)
2114 transport_peers_debug(st,peers,"expire", 0,0,0);
2115}
2116
2117static void transport_record_peer(struct site *st, transport_peers *peers,
2118 const struct comm_addr *addr, const char *m) {
2119 int slot, changed=0;
2120
2121 for (slot=0; slot<peers->npeers; slot++)
2122 if (!memcmp(&peers->peers[slot].addr, addr, sizeof(*addr)))
2123 goto found;
2124
2125 changed=1;
2126 if (peers->npeers==st->transport_peers_max)
925c5ca8 2127 slot=st->transport_peers_max-1;
446353cd
IJ
2128 else
2129 slot=peers->npeers++;
2130
2131 found:
2132 peers->peers[slot].addr=*addr;
2133 peers->peers[slot].last=*tv_now;
2134
2135 if (peers->npeers>1)
2136 qsort(peers->peers, peers->npeers,
2137 sizeof(*peers->peers), transport_peer_compar);
2138
2139 if (changed || peers->npeers!=1)
2140 transport_peers_debug(st,peers,m, 1,addr,0);
2141 transport_peers_expire(st, peers);
2142}
2143
2144static bool_t transport_compute_setupinit_peers(struct site *st,
dd9209d1 2145 const struct comm_addr *configured_addr /* 0 if none or not found */,
a96fda35 2146 const struct comm_addr *incoming_packet_addr /* 0 if none */) {
446353cd 2147
a96fda35 2148 if (!configured_addr && !incoming_packet_addr &&
dd9209d1 2149 !transport_peers_valid(&st->peers))
446353cd
IJ
2150 return False;
2151
2152 slog(st,LOG_SETUP_INIT,
dd9209d1
IJ
2153 "using:%s%s %d old peer address(es)",
2154 configured_addr ? " configured address;" : "",
a96fda35 2155 incoming_packet_addr ? " incoming packet address;" : "",
779837e1 2156 st->peers.npeers);
446353cd 2157
0391d9ee 2158 /* Non-mobile peers have st->peers.npeers==0 or ==1, since they
446353cd
IJ
2159 * have transport_peers_max==1. The effect is that this code
2160 * always uses the configured address if supplied, or otherwise
dd9209d1
IJ
2161 * the address of the incoming PROD, or the existing data peer if
2162 * one exists; this is as desired. */
446353cd
IJ
2163
2164 transport_peers_copy(st,&st->setup_peers,&st->peers);
2165
a96fda35
IJ
2166 if (incoming_packet_addr)
2167 transport_record_peer(st,&st->setup_peers,incoming_packet_addr,
2168 "incoming");
dd9209d1 2169
446353cd
IJ
2170 if (configured_addr)
2171 transport_record_peer(st,&st->setup_peers,configured_addr,"setupinit");
2172
2173 assert(transport_peers_valid(&st->setup_peers));
2174 return True;
2175}
2176
2177static void transport_setup_msgok(struct site *st, const struct comm_addr *a) {
2178 if (st->peer_mobile)
2179 transport_record_peer(st,&st->setup_peers,a,"setupmsg");
2180}
2181static void transport_data_msgok(struct site *st, const struct comm_addr *a) {
2182 if (st->peer_mobile)
2183 transport_record_peer(st,&st->peers,a,"datamsg");
2184}
2185
2186static int transport_peers_valid(transport_peers *peers) {
2187 return peers->npeers;
2188}
2189static void transport_peers_clear(struct site *st, transport_peers *peers) {
2190 peers->npeers= 0;
2191 transport_peers_debug(st,peers,"clear",0,0,0);
2192}
2193static void transport_peers_copy(struct site *st, transport_peers *dst,
2194 const transport_peers *src) {
2195 dst->npeers=src->npeers;
4f28e77e 2196 COPY_ARRAY(dst->peers, src->peers, dst->npeers);
446353cd 2197 transport_peers_debug(st,dst,"copy",
a620a048 2198 src->npeers, &src->peers->addr, sizeof(*src->peers));
446353cd
IJ
2199}
2200
90d7e3ad
IJ
2201static void transport_resolve_complete(struct site *st,
2202 const struct comm_addr *ca_use) {
2203 transport_record_peer(st,&st->peers,ca_use,"resolved data");
2204 transport_record_peer(st,&st->setup_peers,ca_use,"resolved setup");
2205}
2206
2207static void transport_resolve_complete_tardy(struct site *st,
2208 const struct comm_addr *ca_use) {
2209 transport_record_peer(st,&st->peers,ca_use,"resolved tardily");
2210}
2211
027a218f
IJ
2212static void transport_peers__copy_by_mask(transport_peer *out, int *nout_io,
2213 unsigned mask,
2214 const transport_peers *inp) {
2215 /* out and in->peers may be the same region, or nonoverlapping */
2216 const transport_peer *in=inp->peers;
2217 int slot;
2218 for (slot=0; slot<inp->npeers; slot++) {
2219 if (!(mask & (1U << slot)))
2220 continue;
2221 if (!(out==in && slot==*nout_io))
2222 COPY_OBJ(out[*nout_io], in[slot]);
2223 (*nout_io)++;
2224 }
2225}
2226
446353cd
IJ
2227void transport_xmit(struct site *st, transport_peers *peers,
2228 struct buffer_if *buf, bool_t candebug) {
2229 int slot;
2230 transport_peers_expire(st, peers);
027a218f
IJ
2231 unsigned failed=0; /* bitmask */
2232 assert(MAX_MOBILE_PEERS_MAX < sizeof(unsigned)*CHAR_BIT);
2233
2234 int nfailed=0;
446353cd
IJ
2235 for (slot=0; slot<peers->npeers; slot++) {
2236 transport_peer *peer=&peers->peers[slot];
2237 if (candebug)
2238 dump_packet(st, buf, &peer->addr, False);
027a218f
IJ
2239 bool_t ok =
2240 peer->addr.comm->sendmsg(peer->addr.comm->st, buf, &peer->addr);
2241 if (!ok) {
2242 failed |= 1U << slot;
2243 nfailed++;
2244 }
2245 if (ok && !st->peer_mobile)
2246 break;
2247 }
2248 /* Now we need to demote/delete failing addrs: if we are mobile we
2249 * merely demote them; otherwise we delete them. */
2250 if (st->local_mobile) {
2251 unsigned expected = ((1U << nfailed)-1) << (peers->npeers-nfailed);
2252 /* `expected' has all the failures at the end already */
2253 if (failed != expected) {
2254 int fslot=0;
2255 transport_peer failedpeers[nfailed];
2256 transport_peers__copy_by_mask(failedpeers, &fslot, failed,peers);
2257 assert(fslot == nfailed);
2258 int wslot=0;
2259 transport_peers__copy_by_mask(peers->peers,&wslot,~failed,peers);
2260 assert(wslot+nfailed == peers->npeers);
2261 COPY_ARRAY(peers->peers+wslot, failedpeers, nfailed);
2262 }
2263 } else {
2264 if (failed && peers->npeers > 1) {
2265 int wslot=0;
2266 transport_peers__copy_by_mask(peers->peers,&wslot,~failed,peers);
2267 peers->npeers=wslot;
2268 }
446353cd
IJ
2269 }
2270}
2271
2272/***** END of transport peers declarations *****/