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