1 // L2TPNS Clustering Stuff
3 char const *cvs_id_cluster
= "$Id: cluster.c,v 1.10 2004/08/02 06:06:28 fred_nerk Exp $";
8 #include <sys/socket.h>
9 #include <netinet/in.h>
10 #include <arpa/inet.h>
11 #include <sys/ioctl.h>
31 * All cluster packets have the same format.
33 * One or more instances of
35 * a 32 bit 'extra' data dependant on the 'type'.
36 * zero or more bytes of structure data, dependant on the type.
41 int cluster_sockfd
= 0; // The filedescriptor for the cluster communications port.
43 ipt my_address
= 0; // The network address of my ethernet port.
44 static int walk_session_number
= 0; // The next session to send when doing the slow table walk.
45 static int walk_tunnel_number
= 0; // The next tunnel to send when doing the slow table walk.
47 #define MAX_HEART_SIZE (8192) // Maximum size of heartbeat packet. Must be less than max IP packet size :)
48 #define MAX_CHANGES (MAX_HEART_SIZE/(sizeof(sessiont) + sizeof(int) ) - 2) // Assumes a session is the biggest type!
53 } cluster_changes
[MAX_CHANGES
]; // Queue of changed structures that need to go out when next heartbeat.
58 char data
[MAX_HEART_SIZE
];
59 } past_hearts
[HB_HISTORY_SIZE
]; // Ring buffer of heartbeats that we've recently sent out. Needed so
60 // we can re-transmit if needed.
67 } peers
[CLUSTER_MAX_SIZE
]; // List of all the peers we've heard from.
68 static int num_peers
; // Number of peers in list.
70 int rle_decompress(u8
** src_p
, int ssize
, u8
*dst
, int dsize
);
71 int rle_compress(u8
** src_p
, int ssize
, u8
*dst
, int dsize
);
74 // Create a listening socket
76 // This joins the cluster multi-cast group.
80 struct sockaddr_in addr
;
81 struct sockaddr_in interface_addr
;
86 config
->cluster_undefined_sessions
= MAXSESSION
-1;
87 config
->cluster_undefined_tunnels
= MAXTUNNEL
-1;
89 if (!config
->cluster_address
)
91 if (!*config
->cluster_interface
)
94 cluster_sockfd
= socket(AF_INET
, SOCK_DGRAM
, IPPROTO_UDP
);
96 memset(&addr
, 0, sizeof(addr
));
97 addr
.sin_family
= AF_INET
;
98 addr
.sin_port
= htons(CLUSTERPORT
);
99 addr
.sin_addr
.s_addr
= INADDR_ANY
;
100 setsockopt(cluster_sockfd
, SOL_SOCKET
, SO_REUSEADDR
, &addr
, sizeof(addr
));
102 if (bind(cluster_sockfd
, (void *) &addr
, sizeof(addr
)) < 0)
104 log(0, 0, 0, 0, "Failed to bind cluster socket: %s\n", strerror(errno
));
108 strcpy(ifr
.ifr_name
, config
->cluster_interface
);
109 if (ioctl(cluster_sockfd
, SIOCGIFADDR
, &ifr
) < 0)
111 log(0, 0, 0, 0, "Failed to get interface address for (%s): %s\n", config
->cluster_interface
, strerror(errno
));
115 memcpy(&interface_addr
, &ifr
.ifr_addr
, sizeof(interface_addr
));
116 my_address
= interface_addr
.sin_addr
.s_addr
;
118 // Join multicast group.
119 mreq
.imr_multiaddr
.s_addr
= config
->cluster_address
;
120 mreq
.imr_interface
= interface_addr
.sin_addr
;
123 opt
= 0; // Turn off multicast loopback.
124 setsockopt(cluster_sockfd
, IPPROTO_IP
, IP_MULTICAST_LOOP
, &opt
, sizeof(opt
));
126 if (setsockopt(cluster_sockfd
, IPPROTO_IP
, IP_ADD_MEMBERSHIP
, &mreq
, sizeof(mreq
)) < 0)
128 log(0, 0, 0, 0, "Failed to setsockopt (join mcast group): %s\n", strerror(errno
));
132 if (setsockopt (cluster_sockfd
, IPPROTO_IP
, IP_MULTICAST_IF
, &interface_addr
, sizeof(interface_addr
)) < 0)
134 log(0, 0, 0, 0, "Failed to setsockopt (set mcast interface): %s\n", strerror(errno
));
138 config
->cluster_last_hb
= TIME
;
139 config
->cluster_seq_number
= -1;
141 return cluster_sockfd
;
146 // Send a chunk of data to the entire cluster (usually via the multicast
150 int cluster_send_data(void *data
, int datalen
)
152 struct sockaddr_in addr
= {0};
154 if (!cluster_sockfd
) return -1;
155 if (!config
->cluster_address
) return 0;
157 addr
.sin_addr
.s_addr
= config
->cluster_address
;
158 addr
.sin_port
= htons(CLUSTERPORT
);
159 addr
.sin_family
= AF_INET
;
161 log(5,0,0,0, "Cluster send data: %d bytes\n", datalen
);
163 if (sendto(cluster_sockfd
, data
, datalen
, MSG_NOSIGNAL
, (void *) &addr
, sizeof(addr
)) < 0)
165 log(0, 0, 0, 0, "sendto: %s\n", strerror(errno
));
173 // Add a chunk of data to a heartbeat packet.
174 // Maintains the format. Assumes that the caller
175 // has passed in a big enough buffer!
177 static void add_type(char ** p
, int type
, int more
, char * data
, int size
)
179 * ( (u32
*)(*p
) ) = type
;
182 * ( (u32
*)(*p
) ) = more
;
185 if (data
&& size
> 0) {
186 memcpy(*p
, data
, size
);
191 void cluster_uptodate(void)
193 if (config
->cluster_iam_uptodate
)
196 if (config
->cluster_undefined_sessions
|| config
->cluster_undefined_tunnels
)
199 config
->cluster_iam_uptodate
= 1;
201 log(0,0,0,0, "Now uptodate with master.\n");
205 bgp_enable_routing(1);
208 if (config
->send_garp
)
209 send_garp(config
->bind_address
); // Start taking traffic.
213 // Send a unicast UDP packet to a peer with 'data' as the
216 int peer_send_data(u32 peer
, char * data
, int size
)
218 struct sockaddr_in addr
= {0};
220 if (!cluster_sockfd
) return -1;
221 if (!config
->cluster_address
) return 0;
226 addr
.sin_addr
.s_addr
= peer
;
227 addr
.sin_port
= htons(CLUSTERPORT
);
228 addr
.sin_family
= AF_INET
;
230 log_hex(5, "Peer send", data
, size
);
232 if (sendto(cluster_sockfd
, data
, size
, MSG_NOSIGNAL
, (void *) &addr
, sizeof(addr
)) < 0)
234 log(0, 0, 0, 0, "sendto: %s\n", strerror(errno
));
242 // Send a structured message to a peer with a single element of type 'type'.
244 int peer_send_message(u32 peer
, int type
, int more
, char * data
, int size
)
246 char buf
[65536]; // Vast overkill.
249 log(4,0,0,0, "Sending message to peer (type %d, more %d, size %d)\n", type
, more
, size
);
250 add_type(&p
, type
, more
, data
, size
);
252 return peer_send_data(peer
, buf
, (p
-buf
) );
256 // Forward a state changing packet to the master.
258 // The master just processes the payload as if it had
259 // received it off the tap device.
261 int master_forward_packet(char * data
, int size
, u32 addr
, int port
)
263 char buf
[65536]; // Vast overkill.
266 if (!config
->cluster_master_address
) // No election has been held yet. Just skip it.
269 log(4,0,0,0, "Forwarding packet from %s to master (size %d)\n", inet_toa(addr
), size
);
272 add_type(&p
, C_FORWARD
, addr
, (char*) &port
, sizeof(port
) );
273 memcpy(p
, data
, size
);
276 return peer_send_data(config
->cluster_master_address
, buf
, (p
-buf
) );
281 // Forward a throttled packet to the master for handling.
283 // The master just drops the packet into the appropriate
284 // token bucket queue, and lets normal processing take care
287 int master_throttle_packet(int tbfid
, char * data
, int size
)
289 char buf
[65536]; // Vast overkill.
292 if (!config
->cluster_master_address
) // No election has been held yet. Just skip it.
295 log(4,0,0,0, "Throttling packet master (size %d, tbfid %d)\n", size
, tbfid
);
297 add_type(&p
, C_THROTTLE
, tbfid
, data
, size
);
299 return peer_send_data(config
->cluster_master_address
, buf
, (p
-buf
) );
304 // Forward a walled garden packet to the master for handling.
306 // The master just writes the packet straight to the tun
307 // device (where is will normally loop through the
308 // firewall rules, and come back in on the tun device)
310 // (Note that this must be called with the tun header
311 // as the start of the data).
312 int master_garden_packet(sessionidt s
, char *data
, int size
)
314 char buf
[65536]; // Vast overkill.
317 if (!config
->cluster_master_address
) // No election has been held yet. Just skip it.
320 log(4,0,0,0, "Walled garden packet to master (size %d)\n", size
);
322 add_type(&p
, C_GARDEN
, s
, data
, size
);
324 return peer_send_data(config
->cluster_master_address
, buf
, (p
-buf
));
329 // Send a chunk of data as a heartbeat..
330 // We save it in the history buffer as we do so.
332 static void send_heartbeat(int seq
, char * data
, int size
)
336 if (size
> sizeof(past_hearts
[0].data
))
338 log(0,0,0,0, "Tried to heartbeat something larger than the maximum packet!\n");
342 i
= seq
% HB_HISTORY_SIZE
;
343 past_hearts
[i
].seq
= seq
;
344 past_hearts
[i
].size
= size
;
345 memcpy(&past_hearts
[i
].data
, data
, size
); // Save it.
346 cluster_send_data(data
, size
);
350 // Send an 'i am alive' message to every machine in the cluster.
352 void cluster_send_ping(time_t basetime
)
354 char buff
[100 + sizeof(pingt
)];
358 if (config
->cluster_iam_master
&& basetime
) // We're heartbeating so no need to ping.
361 log(5,0,0,0, "Sending cluster ping...\n");
364 x
.addr
= config
->bind_address
;
365 x
.undef
= config
->cluster_undefined_sessions
+ config
->cluster_undefined_tunnels
;
366 x
.basetime
= basetime
;
368 add_type(&p
, C_PING
, basetime
, (char *) &x
, sizeof(x
));
369 cluster_send_data(buff
, (p
-buff
) );
373 // Walk the session counters looking for non-zero ones to send
374 // to the master. We send up to 100 of them at one time.
375 // We examine a maximum of 2000 sessions.
376 // (50k max session should mean that we normally
377 // examine the entire session table every 25 seconds).
379 #define MAX_B_RECS (400)
380 void master_update_counts(void)
383 bytest b
[MAX_B_RECS
+1];
385 if (config
->cluster_iam_master
) // Only happens on the slaves.
388 if (!config
->cluster_master_address
) // If we don't have a master, skip it for a while.
391 i
= MAX_B_RECS
* 5; // Examine max 2000 sessions;
392 if (config
->cluster_highest_sessionid
> i
)
393 i
= config
->cluster_highest_sessionid
;
395 for ( c
= 0; i
> 0 ; --i
) {
396 // Next session to look at.
397 walk_session_number
++;
398 if ( walk_session_number
> config
->cluster_highest_sessionid
)
399 walk_session_number
= 1;
401 if (!sess_count
[walk_session_number
].cin
&& !sess_count
[walk_session_number
].cout
)
402 continue; // Unused. Skip it.
404 b
[c
].sid
= walk_session_number
;
405 b
[c
].in
= sess_count
[walk_session_number
].cin
;
406 b
[c
].out
= sess_count
[walk_session_number
].cout
;
408 if (++c
> MAX_B_RECS
) // Send a max of 400 elements in a packet.
412 sess_count
[walk_session_number
].cin
= sess_count
[walk_session_number
].cout
= 0;
415 if (!c
) // Didn't find any that changes. Get out of here!
419 // Forward the data to the master.
420 log(4,0,0,0, "Sending byte counters to master (%d elements)\n", c
);
421 peer_send_message(config
->cluster_master_address
, C_BYTES
, c
, (char*) &b
, sizeof(b
[0]) * c
);
426 // On the master, check how our slaves are going. If
427 // one of them's not up-to-date we'll heartbeat faster.
428 // If we don't have any of them, then we need to turn
429 // on our own packet handling!
431 void cluster_check_slaves(void)
434 static int have_peers
= 0;
435 int had_peers
= have_peers
;
438 if (!config
->cluster_iam_master
)
439 return; // Only runs on the master...
441 config
->cluster_iam_uptodate
= 1; // cleared in loop below
443 for (i
= have_peers
= 0; i
< num_peers
; i
++)
445 if ((peers
[i
].timestamp
+ config
->cluster_hb_timeout
) < t
)
446 continue; // Stale peer! Skip them.
448 if (!peers
[i
].basetime
)
449 continue; // Shutdown peer! Skip them.
451 if (peers
[i
].uptodate
)
454 if (!peers
[i
].uptodate
)
455 config
->cluster_iam_uptodate
= 0; // Start fast heartbeats
459 // master lost all slaves, need to handle traffic ourself
460 if (bgp_configured
&& had_peers
&& !have_peers
)
461 bgp_enable_routing(1);
462 else if (bgp_configured
&& !had_peers
&& have_peers
)
463 bgp_enable_routing(0);
468 // Check that we have a master. If it's been too
469 // long since we heard from a master then hold an election.
471 void cluster_check_master(void)
473 int i
, count
, tcount
, high_sid
= 0;
476 static int probed
= 0;
478 if (config
->cluster_iam_master
)
479 return; // Only runs on the slaves...
481 // If the master is late (missed 2 hearbeats by a second and a
482 // hair) it may be that the switch has dropped us from the
483 // multicast group, try unicasting one probe to the master
484 // which will hopefully respond with a unicast heartbeat that
485 // will allow us to limp along until the querier next runs.
486 if (TIME
> (config
->cluster_last_hb
+ 2 * config
->cluster_hb_interval
+ 11))
488 if (!probed
&& config
->cluster_master_address
)
491 log(1, 0, 0, 0, "Heartbeat from master %.1fs late, probing...\n",
492 0.1 * (TIME
- (config
->cluster_last_hb
+ config
->cluster_hb_interval
)));
494 peer_send_message(config
->cluster_master_address
,
495 C_LASTSEEN
, config
->cluster_seq_number
, NULL
, 0);
497 } else { // We got a recent heartbeat; reset the probe flag.
501 if (TIME
< (config
->cluster_last_hb
+ config
->cluster_hb_timeout
))
502 return; // Everything's ok!
504 config
->cluster_last_hb
= TIME
+ 1; // Just the one election thanks.
506 log(0,0,0,0, "Master timed out! Holding election...\n");
508 for (i
= 0; i
< num_peers
; i
++)
510 if ((peers
[i
].timestamp
+ config
->cluster_hb_timeout
) < t
)
511 continue; // Stale peer! Skip them.
513 if (!peers
[i
].basetime
)
514 continue; // Shutdown peer! Skip them.
516 if (peers
[i
].basetime
< basetime
) {
517 log(1,0,0,0, "Expecting %s to become master\n", inet_toa(peers
[i
].peer
) );
518 return; // They'll win the election. Get out of here.
521 if (peers
[i
].basetime
== basetime
&&
522 peers
[i
].peer
> my_address
) {
523 log(1,0,0,0, "Expecting %s to become master\n", inet_toa(peers
[i
].peer
) );
524 return; // They'll win the election. Wait for them to come up.
528 // Wow. it's been ages since I last heard a heartbeat
529 // and I'm better than an of my peers so it's time
530 // to become a master!!!
532 config
->cluster_iam_master
= 1;
533 config
->cluster_master_address
= 0;
535 log(0,0,0,0, "I am declaring myself the master!\n");
537 if (config
->cluster_seq_number
== -1)
538 config
->cluster_seq_number
= 0;
541 // Go through and mark all the tunnels as defined.
542 // Count the highest used tunnel number as well.
544 config
->cluster_highest_tunnelid
= 0;
545 for (i
= 0, tcount
= 0; i
< MAXTUNNEL
; ++i
) {
546 if (tunnel
[i
].state
== TUNNELUNDEF
)
547 tunnel
[i
].state
= TUNNELFREE
;
549 if (tunnel
[i
].state
!= TUNNELFREE
&& i
> config
->cluster_highest_tunnelid
)
550 config
->cluster_highest_tunnelid
= i
;
554 // Go through and mark all the sessions as being defined.
555 // reset the idle timeouts.
556 // add temporary byte counters to permanent ones.
557 // Re-string the free list.
558 // Find the ID of the highest session.
561 config
->cluster_highest_sessionid
= 0;
562 for (i
= 0, count
= 0; i
< MAXSESSION
; ++i
) {
563 if (session
[i
].tunnel
== T_UNDEF
) {
564 session
[i
].tunnel
= T_FREE
;
568 if (session
[i
].tunnel
== T_FREE
) { // Unused session. Add to free list.
569 session
[last_free
].next
= i
;
574 // Reset all the idle timeouts..
575 session
[i
].last_packet
= time_now
;
577 // Accumulate un-sent byte counters.
578 session
[i
].cin
+= sess_count
[i
].cin
;
579 session
[i
].cout
+= sess_count
[i
].cout
;
580 session
[i
].total_cin
+= sess_count
[i
].cin
;
581 session
[i
].total_cout
+= sess_count
[i
].cout
;
583 sess_count
[i
].cin
= sess_count
[i
].cout
= 0;
585 session
[i
].radius
= 0; // Reset authentication as the radius blocks aren't up to date.
587 if (session
[i
].sid
>= high_sid
) // This is different to the index into the session table!!!
588 high_sid
= session
[i
].sid
+1;
591 session
[i
].tbf_in
= session
[i
].tbf_out
= 0; // Remove stale pointers from old master.
592 throttle_session(i
, session
[i
].throttle
);
594 // I'm unsure about this. --mo
595 // It's potentially a good thing, but it could send a
597 // if (session[i].throttle)
598 // cluster_send_session(s); // Tell the slaves about the new tbf indexes.
600 if (session
[i
].tunnel
!= T_FREE
&& i
> config
->cluster_highest_sessionid
)
601 config
->cluster_highest_sessionid
= i
;
605 session
[last_free
].next
= 0; // End of chain.
606 last_sid
= high_sid
; // Keep track of the highest used session ID.
610 rebuild_address_pool();
612 // If we're not the very first master, this is a big issue!
614 log(0,0,0,0, "Warning: Fixed %d uninitialized sessions in becoming master!\n", count
);
616 config
->cluster_undefined_sessions
= 0;
617 config
->cluster_undefined_tunnels
= 0;
618 config
->cluster_iam_uptodate
= 1; // assume all peers are up-to-date
620 // FIXME. We need to fix up the tunnel control message
621 // queue here! There's a number of other variables we
622 // should also update.
627 // Check that our session table is validly matching what the
628 // master has in mind.
630 // In particular, if we have too many sessions marked 'undefined'
631 // we fix it up here, and we ensure that the 'first free session'
634 static void cluster_check_sessions(int highsession
, int freesession_ptr
, int hightunnel
)
638 sessionfree
= freesession_ptr
; // Keep the freesession ptr valid.
640 if (config
->cluster_iam_uptodate
)
643 if (highsession
> config
->cluster_undefined_sessions
&& hightunnel
> config
->cluster_undefined_tunnels
)
646 // Clear out defined sessions, counting the number of
648 config
->cluster_undefined_sessions
= 0;
649 for (i
= 1 ; i
< MAXSESSION
; ++i
) {
650 if (i
> highsession
) {
651 session
[i
].tunnel
= 0; // Defined.
654 if (session
[i
].tunnel
!= T_UNDEF
)
656 ++config
->cluster_undefined_sessions
;
659 // Clear out defined tunnels, counting the number of
661 config
->cluster_undefined_tunnels
= 0;
662 for (i
= 1 ; i
< MAXTUNNEL
; ++i
) {
663 if (i
> hightunnel
) {
664 tunnel
[i
].state
= TUNNELFREE
; // Defined.
667 if (tunnel
[i
].state
!= TUNNELUNDEF
)
669 ++config
->cluster_undefined_tunnels
;
673 if (config
->cluster_undefined_sessions
|| config
->cluster_undefined_tunnels
) {
674 log(2,0,0,0, "Cleared undefined sessions/tunnels. %d sess (high %d), %d tunn (high %d)\n",
675 config
->cluster_undefined_sessions
, highsession
, config
->cluster_undefined_tunnels
, hightunnel
);
679 // Are we up to date?
681 if (!config
->cluster_iam_uptodate
)
685 int hb_add_type(char **p
, int type
, int id
)
688 case C_CSESSION
: { // Compressed C_SESSION.
689 u8 c
[sizeof(sessiont
) * 2]; // Bigger than worst case.
690 u8
*d
= (u8
*) &session
[id
];
694 size
= rle_compress( &d
, sizeof(sessiont
), c
, sizeof(c
) );
696 // Did we compress the full structure, and is the size actually
698 if ( (d
- orig
) == sizeof(sessiont
) && size
< sizeof(sessiont
) ) {
699 add_type(p
, C_CSESSION
, id
, (char*) c
, size
);
702 // Failed to compress : Fall through.
704 case C_SESSION
: add_type(p
, C_SESSION
, id
,
705 (char*) &session
[id
], sizeof(sessiont
));
708 case C_CTUNNEL
: { // Compressed C_TUNNEL
709 u8 c
[sizeof(tunnelt
) * 2]; // Bigger than worst case.
710 u8
*d
= (u8
*) &tunnel
[id
];
714 size
= rle_compress( &d
, sizeof(tunnelt
), c
, sizeof(c
) );
716 // Did we compress the full structure, and is the size actually
718 if ( (d
- orig
) == sizeof(tunnelt
) && size
< sizeof(tunnelt
) ) {
719 add_type(p
, C_CTUNNEL
, id
, c
, size
);
722 // Failed to compress : Fall through.
724 case C_TUNNEL
: add_type(p
, C_TUNNEL
, id
,
725 (char*) &tunnel
[id
], sizeof(tunnelt
));
728 log(0,0,0,0, "Found an invalid type in heart queue! (%d)\n", type
);
736 // Send a heartbeat, incidently sending out any queued changes..
738 void cluster_heartbeat()
740 int i
, count
= 0, tcount
= 0;
741 char buff
[MAX_HEART_SIZE
+ sizeof(heartt
) + sizeof(int) ];
745 if (!config
->cluster_iam_master
) // Only the master does this.
748 // Fill out the heartbeat header.
749 memset(&h
, 0, sizeof(h
));
751 h
.version
= HB_VERSION
;
752 h
.seq
= config
->cluster_seq_number
;
753 h
.basetime
= basetime
;
754 h
.clusterid
= config
->bind_address
; // Will this do??
755 h
.basetime
= basetime
;
756 h
.highsession
= config
->cluster_highest_sessionid
;
757 h
.freesession
= sessionfree
;
758 h
.hightunnel
= config
->cluster_highest_tunnelid
;
759 h
.size_sess
= sizeof(sessiont
); // Just in case.
760 h
.size_tunn
= sizeof(tunnelt
);
761 h
.interval
= config
->cluster_hb_interval
;
762 h
.timeout
= config
->cluster_hb_timeout
;
764 add_type(&p
, C_HEARTBEAT
, HB_VERSION
, (char*) &h
, sizeof(h
));
766 for (i
= 0; i
< config
->cluster_num_changes
; ++i
) {
767 hb_add_type(&p
, cluster_changes
[i
].type
, cluster_changes
[i
].id
);
770 if (p
> (buff
+ sizeof(buff
))) { // Did we somehow manage to overun the buffer?
771 log(0,0,0,0, "FATAL: Overran the heartbeat buffer! This is fatal. Exiting. (size %d)\n", p
- buff
);
777 // Fill out the packet with sessions from the session table...
778 // (not forgetting to leave space so we can get some tunnels in too )
779 while ( (p
+ sizeof(u32
) * 2 + sizeof(sessiont
) * 2 ) < (buff
+ MAX_HEART_SIZE
) ) {
781 if (!walk_session_number
) // session #0 isn't valid.
782 ++walk_session_number
;
784 if (count
>= config
->cluster_highest_sessionid
) // If we're a small cluster, don't go wild.
787 hb_add_type(&p
, C_CSESSION
, walk_session_number
);
788 walk_session_number
= (1+walk_session_number
)%(config
->cluster_highest_sessionid
+1); // +1 avoids divide by zero.
790 ++count
; // Count the number of extra sessions we're sending.
794 // Fill out the packet with tunnels from the tunnel table...
795 // This effectively means we walk the tunnel table more quickly
796 // than the session table. This is good because stuffing up a
797 // tunnel is a much bigger deal than stuffing up a session.
799 while ( (p
+ sizeof(u32
) * 2 + sizeof(tunnelt
) ) < (buff
+ MAX_HEART_SIZE
) ) {
801 if (!walk_tunnel_number
) // tunnel #0 isn't valid.
802 ++walk_tunnel_number
;
804 if (tcount
>= config
->cluster_highest_tunnelid
)
807 hb_add_type(&p
, C_CTUNNEL
, walk_tunnel_number
);
808 walk_tunnel_number
= (1+walk_tunnel_number
)%(config
->cluster_highest_tunnelid
+1); // +1 avoids divide by zero.
814 // Did we do something wrong?
815 if (p
> (buff
+ sizeof(buff
))) { // Did we somehow manage to overun the buffer?
816 log(0,0,0,0, "Overran the heartbeat buffer now! This is fatal. Exiting. (size %d)\n", p
- buff
);
821 log(3,0,0,0, "Sending heartbeat #%d with %d changes (%d x-sess, %d x-tunnels, %d highsess, %d hightun size %d)\n",
822 h
.seq
, config
->cluster_num_changes
, count
, tcount
, config
->cluster_highest_sessionid
,
823 config
->cluster_highest_tunnelid
, (p
-buff
));
825 config
->cluster_num_changes
= 0;
827 send_heartbeat(h
.seq
, buff
, (p
-buff
) ); // Send out the heartbeat to the cluster, keeping a copy of it.
829 config
->cluster_seq_number
= (config
->cluster_seq_number
+1)%HB_MAX_SEQ
; // Next seq number to use.
833 // A structure of type 'type' has changed; Add it to the queue to send.
835 int type_changed(int type
, int id
)
839 for (i
= 0 ; i
< config
->cluster_num_changes
; ++i
)
840 if ( cluster_changes
[i
].id
== id
&&
841 cluster_changes
[i
].type
== type
)
842 return 0; // Already marked for change.
844 cluster_changes
[i
].type
= type
;
845 cluster_changes
[i
].id
= id
;
846 ++config
->cluster_num_changes
;
848 if (config
->cluster_num_changes
> MAX_CHANGES
)
849 cluster_heartbeat(); // flush now
855 // A particular session has been changed!
856 int cluster_send_session(int sid
)
858 if (!config
->cluster_iam_master
) {
859 log(0,0,sid
,0, "I'm not a master, but I just tried to change a session!\n");
863 return type_changed(C_CSESSION
, sid
);
866 // A particular tunnel has been changed!
867 int cluster_send_tunnel(int tid
)
869 if (!config
->cluster_iam_master
) {
870 log(0,0,0,tid
, "I'm not a master, but I just tried to change a tunnel!\n");
874 return type_changed(C_CTUNNEL
, tid
);
879 // We're a master, and a slave has just told us that it's
880 // missed a packet. We'll resend it every packet since
881 // the last one it's seen.
883 int cluster_catchup_slave(int seq
, u32 slave
)
888 log(1,0,0,0, "Slave %s sent LASTSEEN with seq %d\n", inet_toa(slave
), seq
);
890 diff
= config
->cluster_seq_number
- seq
; // How many packet do we need to send?
894 if (diff
>= HB_HISTORY_SIZE
) { // Ouch. We don't have the packet to send it!
895 log(0,0,0,0, "A slaved asked for message %d when our seq number is %d. Killing it.\n",
896 seq
, config
->cluster_seq_number
);
897 return peer_send_message(slave
, C_KILL
, seq
, NULL
, 0);// Kill the slave. Nothing else to do.
900 // Now resend every packet that it missed, in order.
901 while (seq
!= config
->cluster_seq_number
) {
902 s
= seq
%HB_HISTORY_SIZE
;
903 if (seq
!= past_hearts
[s
].seq
) {
904 log(0,0,0,0, "Tried to re-send heartbeat for %s but %d doesn't match %d! (%d,%d)\n",
905 inet_toa(slave
), seq
, past_hearts
[s
].seq
, s
, config
->cluster_seq_number
);
906 return -1; // What to do here!?
908 peer_send_data(slave
, past_hearts
[s
].data
, past_hearts
[s
].size
);
909 seq
= (seq
+1)%HB_MAX_SEQ
; // Increment to next seq number.
911 return 0; // All good!
915 // We've heard from another peer! Add it to the list
916 // that we select from at election time.
918 int cluster_add_peer(u32 peer
, time_t basetime
, pingt
*pp
, int size
)
924 // Allow for backward compatability.
925 // Just the ping packet into a new structure to allow
926 // for the possibility that we might have received
927 // more or fewer elements than we were expecting.
928 if (size
> sizeof(p
))
931 memset( (void*) &p
, 0, sizeof(p
) );
932 memcpy( (void*) &p
, (void*) pp
, size
);
935 if (clusterid
!= config
->bind_address
)
938 log(4,0,0,0, "Skipping ping from %s (different cluster)\n", inet_toa(peer
));
942 for (i
= 0; i
< num_peers
; ++i
)
944 if (peers
[i
].peer
!= peer
)
947 // This peer already exists. Just update the timestamp.
948 peers
[i
].basetime
= basetime
;
949 peers
[i
].timestamp
= TIME
;
950 peers
[i
].uptodate
= !p
.undef
;
954 // Is this the master shutting down??
955 if (peer
== config
->cluster_master_address
&& !basetime
) {
956 log(3,0,0,0, "Master %s shutting down...\n", inet_toa(config
->cluster_master_address
));
957 config
->cluster_master_address
= 0;
958 config
->cluster_last_hb
= 0; // Force an election.
959 cluster_check_master();
965 log(4,0,0,0, "Adding %s as a peer\n", inet_toa(peer
));
967 // Not found. Is there a stale slot to re-use?
968 for (i
= 0; i
< num_peers
; ++i
)
970 if (!peers
[i
].basetime
) // Shutdown
973 if ((peers
[i
].timestamp
+ config
->cluster_hb_timeout
* 10) < TIME
) // Stale.
977 if (i
>= CLUSTER_MAX_SIZE
)
980 log(0,0,0,0, "Tried to add %s as a peer, but I already have %d of them!\n", inet_toa(peer
), i
);
984 peers
[i
].peer
= peer
;
985 peers
[i
].basetime
= basetime
;
986 peers
[i
].timestamp
= TIME
;
987 peers
[i
].uptodate
= !p
.undef
;
991 log(1,0,0,0, "Added %s as a new peer. Now %d peers\n", inet_toa(peer
), num_peers
);
997 /* Handle the slave updating the byte counters for the master. */
999 // Note that we don't mark the session as dirty; We rely on
1000 // the slow table walk to propogate this back out to the slaves.
1002 int cluster_handle_bytes(char * data
, int size
)
1008 log(3,0,0,0, "Got byte counter update (size %d)\n", size
);
1010 /* Loop around, adding the byte
1011 counts to each of the sessions. */
1013 while (size
>= sizeof(*b
) ) {
1014 if (b
->sid
> MAXSESSION
) {
1015 log(0,0,0,0, "Got C_BYTES with session #%d!\n", b
->sid
);
1016 return -1; /* Abort processing */
1019 session
[b
->sid
].total_cin
+= b
->in
;
1020 session
[b
->sid
].total_cout
+= b
->out
;
1022 session
[b
->sid
].cin
+= b
->in
;
1023 session
[b
->sid
].cout
+= b
->out
;
1024 session
[b
->sid
].last_packet
= time_now
; // Reset idle timer!
1031 log(0,0,0,0, "Got C_BYTES with %d bytes of trailing junk!\n", size
);
1037 // Handle receiving a session structure in a heartbeat packet.
1039 static int cluster_recv_session(int more
, u8
* p
)
1041 if (more
>= MAXSESSION
) {
1042 log(0,0,0,0, "DANGER: Received a heartbeat session id > MAXSESSION!\n");
1046 if (session
[more
].tunnel
== T_UNDEF
) {
1047 if (config
->cluster_iam_uptodate
) { // Sanity.
1048 log(0,0,0,0, "I thought I was uptodate but I just found an undefined session!\n");
1050 --config
->cluster_undefined_sessions
;
1054 load_session(more
, (sessiont
*) p
); // Copy session into session table..
1056 log(5,0,more
,0, "Received session update (%d undef)\n", config
->cluster_undefined_sessions
);
1058 if (!config
->cluster_iam_uptodate
)
1059 cluster_uptodate(); // Check to see if we're up to date.
1064 static int cluster_recv_tunnel(int more
, u8
*p
)
1066 if (more
>= MAXTUNNEL
) {
1067 log(0,0,0,0, "DANGER: Received a tunnel session id > MAXTUNNEL!\n");
1071 if (tunnel
[more
].state
== TUNNELUNDEF
) {
1072 if (config
->cluster_iam_uptodate
) { // Sanity.
1073 log(0,0,0,0, "I thought I was uptodate but I just found an undefined tunnel!\n");
1075 --config
->cluster_undefined_tunnels
;
1079 memcpy(&tunnel
[more
], p
, sizeof(tunnel
[more
]) );
1082 // Clear tunnel control messages. These are dynamically allocated.
1083 // If we get unlucky, this may cause the tunnel to drop!
1085 tunnel
[more
].controls
= tunnel
[more
].controle
= NULL
;
1086 tunnel
[more
].controlc
= 0;
1088 log(5,0,0,more
, "Received tunnel update\n");
1090 if (!config
->cluster_iam_uptodate
)
1091 cluster_uptodate(); // Check to see if we're up to date.
1098 // Process a heartbeat..
1100 static int cluster_process_heartbeat(u8
* data
, int size
, int more
, u8
* p
, u32 addr
)
1103 int s
= size
- (p
-data
);
1107 # error "need to update cluster_process_heartbeat()"
1110 // we handle version 2+
1111 if (more
< 2 || more
> HB_VERSION
) {
1112 log(0,0,0,0, "Received a heartbeat version that I don't support (%d)!\n", more
);
1113 return -1; // Ignore it??
1116 // Ok. It's a heartbeat packet from a cluster master!
1124 if (h
->clusterid
!= config
->bind_address
)
1125 return -1; // It's not part of our cluster.
1127 if (config
->cluster_iam_master
) { // Sanity...
1128 // Note that this MUST match the election process above!
1130 log(0,0,0,0, "I just got a packet claiming to be from a master but _I_ am the master!\n");
1132 log(0,0,0,0, "Heartbeat from addr %s with zero basetime!\n", inet_toa(addr
) );
1133 return -1; // Skip it.
1135 if (basetime
> h
->basetime
) {
1136 log(0,0,0,0, "They're (%s) an older master than me so I'm gone!\n", inet_toa(addr
));
1140 if (basetime
== h
->basetime
&& my_address
< addr
) { // Tie breaker.
1141 log(0,0,0,0, "They're a higher IP address than me, so I'm gone!\n");
1145 return -1; // Skip it.
1148 if (config
->cluster_seq_number
== -1) // Don't have one. Just align to the master...
1149 config
->cluster_seq_number
= h
->seq
;
1151 config
->cluster_last_hb
= TIME
; // Reset to ensure that we don't become master!!
1153 if (config
->cluster_seq_number
!= h
->seq
) { // Out of sequence heartbeat!
1154 log(1,0,0,0, "HB: Got seq# %d but was expecting %d. asking for resend.\n", h
->seq
, config
->cluster_seq_number
);
1156 peer_send_message(addr
, C_LASTSEEN
, config
->cluster_seq_number
, NULL
, 0);
1158 config
->cluster_last_hb
= TIME
; // Reset to ensure that we don't become master!!
1160 // Just drop the packet. The master will resend it as part of the catchup.
1164 // Save the packet in our buffer.
1165 // This is needed in case we become the master.
1166 config
->cluster_seq_number
= (h
->seq
+1)%HB_MAX_SEQ
;
1167 i
= h
->seq
% HB_HISTORY_SIZE
;
1168 past_hearts
[i
].seq
= h
->seq
;
1169 past_hearts
[i
].size
= size
;
1170 memcpy(&past_hearts
[i
].data
, data
, size
); // Save it.
1173 // Check that we don't have too many undefined sessions, and
1174 // that the free session pointer is correct.
1175 cluster_check_sessions(h
->highsession
, h
->freesession
, h
->hightunnel
);
1177 if (more
> 2) // reserved section of heartt was not initialized prior to v3
1179 if (h
->interval
!= config
->cluster_hb_interval
)
1181 log(2, 0, 0, 0, "Master set ping/heartbeat interval to %u (was %u)\n",
1182 h
->interval
, config
->cluster_hb_interval
);
1184 config
->cluster_hb_interval
= h
->interval
;
1187 if (h
->timeout
!= config
->cluster_hb_timeout
)
1189 log(2, 0, 0, 0, "Master set heartbeat timeout to %u (was %u)\n",
1190 h
->timeout
, config
->cluster_hb_timeout
);
1192 config
->cluster_hb_timeout
= h
->timeout
;
1196 // Ok. process the packet...
1199 type
= * ((u32
*) p
);
1203 more
= * ((u32
*) p
);
1208 case C_CSESSION
: { // Compressed session structure.
1209 u8 c
[ sizeof(sessiont
) + 2];
1213 size
= rle_decompress((u8
**) &p
, s
, c
, sizeof(c
) );
1216 if (size
!= sizeof(sessiont
) ) { // Ouch! Very very bad!
1217 log(0,0,0,0, "DANGER: Received a CSESSION that didn't decompress correctly!\n");
1218 // Now what? Should exit! No-longer up to date!
1222 cluster_recv_session(more
, c
);
1226 if ( s
< sizeof(session
[more
]))
1229 cluster_recv_session(more
, p
);
1231 p
+= sizeof(session
[more
]);
1232 s
-= sizeof(session
[more
]);
1235 case C_CTUNNEL
: { // Compressed tunnel structure.
1236 u8 c
[ sizeof(tunnelt
) + 2];
1240 size
= rle_decompress( (u8
**) &p
, s
, c
, sizeof(c
) );
1243 if (size
!= sizeof(tunnelt
) ) { // Ouch! Very very bad!
1244 log(0,0,0,0, "DANGER: Received a CSESSION that didn't decompress correctly!\n");
1245 // Now what? Should exit! No-longer up to date!
1249 cluster_recv_tunnel(more
, c
);
1254 if ( s
< sizeof(tunnel
[more
]))
1257 cluster_recv_tunnel(more
, p
);
1259 p
+= sizeof(tunnel
[more
]);
1260 s
-= sizeof(tunnel
[more
]);
1263 log(0,0,0,0, "DANGER: I received a heartbeat element where I didn't understand the type! (%d)\n", type
);
1264 return -1; // can't process any more of the packet!!
1267 if (config
->cluster_master_address
!= addr
)
1270 str
= strdup(inet_toa(config
->cluster_master_address
));
1271 log(0,0,0,0, "My master just changed from %s to %s!\n", str
, inet_toa(addr
));
1275 config
->cluster_master_address
= addr
;
1276 config
->cluster_last_hb
= TIME
; // Successfully received a heartbeat!
1280 log(0,0,0,0, "I got an incomplete heartbeat packet! This means I'm probably out of sync!!\n");
1285 // We got a packet on the cluster port!
1286 // Handle pings, lastseens, and heartbeats!
1288 int processcluster(char * data
, int size
, u32 addr
)
1294 if (addr
== my_address
)
1295 return -1; // Ignore it. Something looped back the multicast!
1297 log(5,0,0,0, "Process cluster: %d bytes from %s\n", size
, inet_toa(addr
));
1299 if (s
<= 0) // Any data there??
1305 type
= * ((u32
*) p
);
1309 more
= * ((u32
*) p
);
1314 case C_PING
: // Update the peers table.
1315 return cluster_add_peer(addr
, more
, (pingt
*)p
, s
);
1317 case C_LASTSEEN
: // Catch up a slave (slave missed a packet).
1318 return cluster_catchup_slave(more
, addr
);
1320 case C_FORWARD
: { // Forwarded control packet. pass off to processudp.
1321 struct sockaddr_in a
;
1322 a
.sin_addr
.s_addr
= more
;
1324 a
.sin_port
= * (int*) p
;
1328 if (!config
->cluster_iam_master
) { // huh?
1329 log(0,0,0,0, "I'm not the master, but I got a C_FORWARD from %s?\n", inet_toa(addr
));
1333 log(4,0,0,0, "Got a forwarded packet... (%s:%d)\n", inet_toa(more
), a
.sin_port
);
1335 processudp(p
, s
, &a
);
1338 case C_THROTTLE
: { // Receive a forwarded packet from a slave.
1339 if (!config
->cluster_iam_master
) {
1340 log(0,0,0,0, "I'm not the master, but I got a C_THROTTLE from %s?\n", inet_toa(addr
));
1344 tbf_queue_packet(more
, p
, s
); // The TBF id tells wether it goes in or out.
1348 // Receive a walled garden packet from a slave.
1349 if (!config
->cluster_iam_master
) {
1350 log(0,0,0,0, "I'm not the master, but I got a C_GARDEN from %s?\n", inet_toa(addr
));
1358 return cluster_handle_bytes(p
, s
);
1360 case C_KILL
: // The master asked us to die!? (usually because we're too out of date).
1361 if (config
->cluster_iam_master
) {
1362 log(0,0,0,0, "_I_ am master, but I received a C_KILL from %s! (Seq# %d)\n", inet_toa(addr
), more
);
1365 if (more
!= config
->cluster_seq_number
) {
1366 log(0,0,0,0, "The master asked us to die but the seq number didn't match!?\n");
1370 if (addr
!= config
->cluster_master_address
) {
1371 log(0,0,0,0, "Received a C_KILL from %s which doesn't match config->cluster_master_address (%x)\n",
1372 inet_toa(addr
), config
->cluster_master_address
);
1373 // We can only warn about it. The master might really have switched!
1376 log(0,0,0,0, "Received a valid C_KILL: I'm going to die now.\n");
1378 exit(0); // Lets be paranoid;
1379 return -1; // Just signalling the compiler.
1382 log(4,0,0,0, "Got a heartbeat from %s\n", inet_toa(addr
));
1383 return cluster_process_heartbeat(data
, size
, more
, p
, addr
);
1386 log(0,0,0,0, "Strange type packet received on cluster socket (%d)\n", type
);
1392 log(0,0,0,0, "I got an cluster heartbeat packet! This means I'm probably out of sync!!\n");
1396 //====================================================================================================
1398 int cmd_show_cluster(struct cli_def
*cli
, char *command
, char **argv
, int argc
)
1402 if (CLI_HELP_REQUESTED
)
1403 return CLI_HELP_NO_ARGS
;
1405 cli_print(cli
, "Cluster status : %s", config
->cluster_iam_master
? "Master" : "Slave" );
1406 cli_print(cli
, "My address : %s", inet_toa(my_address
));
1407 cli_print(cli
, "VIP address : %s", inet_toa(config
->bind_address
));
1408 cli_print(cli
, "Multicast address: %s", inet_toa(config
->cluster_address
));
1409 cli_print(cli
, "Multicast i'face : %s", config
->cluster_interface
);
1411 if (!config
->cluster_iam_master
) {
1412 cli_print(cli
, "My master : %s (last heartbeat %.1f seconds old)",
1413 config
->cluster_master_address
? inet_toa(config
->cluster_master_address
) : "Not defined",
1414 0.1 * (TIME
- config
->cluster_last_hb
));
1415 cli_print(cli
, "Uptodate : %s", config
->cluster_iam_uptodate
? "Yes" : "No");
1416 cli_print(cli
, "Next sequence number expected: %d", config
->cluster_seq_number
);
1417 cli_print(cli
, "%d sessions undefined of %d", config
->cluster_undefined_sessions
, config
->cluster_highest_sessionid
);
1418 cli_print(cli
, "%d tunnels undefined of %d", config
->cluster_undefined_tunnels
, config
->cluster_highest_tunnelid
);
1420 cli_print(cli
, "Next heartbeat # : %d", config
->cluster_seq_number
);
1421 cli_print(cli
, "Highest session : %d", config
->cluster_highest_sessionid
);
1422 cli_print(cli
, "Highest tunnel : %d", config
->cluster_highest_tunnelid
);
1423 cli_print(cli
, "%d changes queued for sending", config
->cluster_num_changes
);
1425 cli_print(cli
, "%d peers.", num_peers
);
1428 cli_print(cli
, "%20s %10s %8s", "Address", "Basetime", "Age");
1429 for (i
= 0; i
< num_peers
; ++i
) {
1430 cli_print(cli
, "%20s %10d %8d", inet_toa(peers
[i
].peer
),
1431 peers
[i
].basetime
, TIME
- peers
[i
].timestamp
);
1437 // Simple run-length-encoding compression.
1439 // 1 byte < 128 = count of non-zero bytes following. // Not legal to be zero.
1440 // n non-zero bytes;
1442 // 1 byte > 128 = (count - 128) run of zero bytes. //
1444 // count == 0 indicates end of compressed stream.
1446 // Compress from 'src' into 'dst'. return number of bytes
1448 // Updates *src_p to indicate 1 past last bytes used.
1450 // We could get an extra byte in the zero runs by storing (count-1)
1451 // but I'm playing it safe.
1453 // Worst case is a 50% expansion in space required (trying to
1454 // compress { 0x00, 0x01 } * N )
1455 int rle_compress(u8
** src_p
, int ssize
, u8
*dst
, int dsize
)
1458 int orig_dsize
= dsize
;
1462 while (ssize
> 0 && dsize
> 2) {
1464 x
= dst
++; --dsize
; // Reserve space for count byte..
1466 if (*src
) { // Copy a run of non-zero bytes.
1467 while (*src
&& count
< 127 && ssize
> 0 && dsize
> 1) { // Count number of non-zero bytes.
1472 *x
= count
; // Store number of non-zero bytes. Guarenteed to be non-zero!
1474 } else { // Compress a run of zero bytes.
1475 while (*src
== 0 && count
< 127 && ssize
> 0) {
1484 *dst
++ = 0x0; // Add Stop byte.
1488 return (orig_dsize
- dsize
);
1492 // Decompress the buffer into **p.
1493 // 'psize' is the size of the decompression buffer available.
1495 // Returns the number of bytes decompressed.
1497 // Decompresses from '*src_p' into 'dst'.
1498 // Return the number of dst bytes used.
1499 // Updates the 'src_p' pointer to point to the
1500 // first un-used byte.
1501 int rle_decompress(u8
** src_p
, int ssize
, u8
*dst
, int dsize
)
1504 int orig_dsize
= dsize
;
1505 char * src
= *src_p
;
1507 while (ssize
>0 && dsize
> 0) { // While there's more to decompress, and there's room in the decompress buffer...
1508 count
= *src
++; --ssize
; // get the count byte from the source.
1509 if (count
== 0x0) // End marker reached? If so, finish.
1512 if (count
& 0x80) { // Decompress a run of zeros
1513 for (count
&= 0x7f ; count
> 0 && dsize
> 0; --count
) {
1517 } else { // Copy run of non-zero bytes.
1518 for ( ; count
> 0 && ssize
&& dsize
; --count
) { // Copy non-zero bytes across.
1525 return (orig_dsize
- dsize
);