2011-08-08 06:41:05 +00:00
# include "mphlr.h"
2011-08-08 14:41:46 +00:00
# ifdef HAVE_IFADDRS_H
# include <ifaddrs.h>
# endif
2011-08-08 06:41:05 +00:00
int overlay_ready = 0 ;
int overlay_interface_count = 0 ;
overlay_interface overlay_interfaces [ OVERLAY_MAX_INTERFACES ] ;
2011-08-12 07:47:29 +00:00
struct interface_rules {
char * namespec ;
unsigned long long speed_in_bits ;
int port ;
char type ;
char excludeP ;
struct interface_rules * next ;
} ;
struct interface_rules * interface_filter = NULL ;
2011-08-20 09:36:15 +00:00
unsigned int overlay_sequence_number = 0 ;
time_t overlay_sequence_start_time ;
2011-08-15 10:51:00 +00:00
/* Do we need to repeat our abbreviation policy? */
int overlay_interface_repeat_abbreviation_policy [ OVERLAY_MAX_INTERFACES ] = { 1 } ;
2011-08-29 06:50:27 +00:00
long long overlay_gettime_ms ( )
2011-08-20 09:36:15 +00:00
{
struct timeval nowtv ;
if ( gettimeofday ( & nowtv , NULL ) )
return WHY ( " gettimeofday() failed " ) ;
/* Get current time in milliseconds */
long long now = ( nowtv . tv_sec - overlay_sequence_start_time ) * 1000LL ;
now = now + nowtv . tv_usec / 1000 ;
2011-08-29 06:50:27 +00:00
return now ;
}
int overlay_update_sequence_number ( )
{
long long now = overlay_gettime_ms ( ) ;
2011-08-20 09:36:15 +00:00
overlay_sequence_number = now & 0xffffffff ;
return 0 ;
}
2011-08-08 06:41:05 +00:00
int overlay_interface_type ( char * s )
{
if ( ! strcasecmp ( s , " ethernet " ) ) return OVERLAY_INTERFACE_ETHERNET ;
if ( ! strcasecmp ( s , " wifi " ) ) return OVERLAY_INTERFACE_WIFI ;
if ( ! strcasecmp ( s , " other " ) ) return OVERLAY_INTERFACE_UNKNOWN ;
if ( ! strcasecmp ( s , " catear " ) ) return OVERLAY_INTERFACE_PACKETRADIO ;
return WHY ( " Invalid interface type -- consider using 'wifi','ethernet' or 'other' " ) ;
}
int overlay_interface_arg ( char * arg )
{
/* Parse an interface argument, of the form:
2011-08-12 07:47:29 +00:00
< + | - > [ interfacename ] [ = type ]
+ interface tells DNA to sit on that interface
- interface tells DNA to not sit on that interface
+ / - without an interface tells DNA to sit on all interfaces .
The first match rules , so - en0 + tells DNA to use all interfaces , excepting en0
The optional = type specifier tells DNA how to handle the interface in terms of
bandwidth : distance relationship for calculating tick times etc .
The special type = custom allows full specification :
XXX - Settle the custom specification now that we have changed the interface
management .
2011-08-08 06:41:05 +00:00
*/
2011-08-12 07:47:29 +00:00
char sign [ 80 ] = " + " ;
char interface_name [ 80 ] = " " ;
char speed [ 80 ] = " 1m " ;
2011-08-08 06:41:05 +00:00
char typestring [ 80 ] = " wifi " ;
int port = PORT_DNA ;
int type = OVERLAY_INTERFACE_UNKNOWN ;
int n = 0 ;
/* Too long */
if ( strlen ( arg ) > 79 ) return WHY ( " interface specification was >79 characters " ) ;
2011-08-12 07:47:29 +00:00
struct interface_rules * r = calloc ( sizeof ( struct interface_rules ) , 1 ) ;
if ( ! r ) return WHY ( " calloc(struct interface rules),1) failed " ) ;
if ( sscanf ( arg , " %[+-]%n%[^=+-]%n=%[^:]%n:%d%n:%[^:]%n " ,
sign , & n , interface_name , & n , typestring , & n , & port , & n , speed , & n ) > = 1 )
2011-08-08 06:41:05 +00:00
{
2011-08-12 07:47:29 +00:00
if ( n < strlen ( arg ) ) { free ( r ) ; return WHY ( " Extra junk at end of interface specification " ) ; }
if ( strlen ( sign ) > 1 ) { free ( r ) ; return WHY ( " Sign must be + or - " ) ; }
switch ( sign [ 0 ] )
{
case ' + ' : break ;
case ' - ' : r - > excludeP = 1 ; break ;
default :
free ( r ) ;
return WHY ( " Invalid interface list item: Must begin with + or - " ) ;
}
long long speed_in_bits = parse_quantity ( speed ) ;
2011-08-08 06:41:05 +00:00
if ( speed_in_bits < = 1 ) {
2011-08-12 07:47:29 +00:00
free ( r ) ;
2011-08-08 06:41:05 +00:00
return WHY ( " Interfaces must be capable of at least 1 bit per second " ) ;
}
if ( n < strlen ( arg ) ) return WHY ( " Extra stuff at end of interface specification " ) ;
type = overlay_interface_type ( typestring ) ;
2011-08-12 07:47:29 +00:00
if ( type < 0 ) { free ( r ) ; return WHY ( " Invalid interface type in specification " ) ; }
/* Okay, register the interface preference */
r - > namespec = strdup ( interface_name ) ;
r - > speed_in_bits = speed_in_bits ;
r - > port = port ;
r - > type = type ;
r - > next = interface_filter ;
interface_filter = r ;
return 0 ;
2011-08-08 06:41:05 +00:00
}
2011-08-12 07:47:29 +00:00
else { free ( r ) ; return WHY ( " Bad interface specification " ) ; }
2011-08-08 06:41:05 +00:00
}
int overlay_interface_args ( char * arg )
{
/* Parse series of comma-separated interface definitions from a single argument
*/
int i = 0 ;
char interface [ 80 ] ;
int len = 0 ;
for ( i = 0 ; arg [ i ] ; i + + )
{
if ( arg [ i ] = = ' , ' ) {
interface [ len ] = 0 ;
if ( overlay_interface_arg ( interface ) ) return WHY ( " Could not add interface " ) ;
len = 0 ;
} else {
if ( len < 79 ) {
interface [ len + + ] = arg [ i ] ;
interface [ len ] = 0 ;
} else
return WHY ( " Interface definition is too long (each must be <80 characters) " ) ;
}
}
if ( len ) if ( overlay_interface_arg ( interface ) ) return WHY ( " Could not add final interface " ) ;
return 0 ;
}
2011-08-12 07:47:29 +00:00
int overlay_interface_init_socket ( int interface , struct sockaddr_in src_addr , struct sockaddr_in broadcast ,
struct sockaddr_in netmask )
2011-08-08 06:41:05 +00:00
{
2011-08-12 07:47:29 +00:00
# define I(X) overlay_interfaces[interface].X
I ( local_address ) = src_addr ;
I ( broadcast_address ) = broadcast ;
I ( netmask ) = netmask ;
2011-08-14 08:36:39 +00:00
I ( fileP ) = 0 ;
2011-08-08 06:41:05 +00:00
2011-08-20 09:36:15 +00:00
overlay_sequence_start_time = time ( 0 ) ;
2011-08-14 08:36:39 +00:00
I ( fd ) = socket ( PF_INET , SOCK_DGRAM , 0 ) ;
if ( I ( fd ) < 0 ) {
2011-08-08 06:41:05 +00:00
return WHY ( " Could not create UDP socket for interface " ) ;
}
2011-08-12 07:47:29 +00:00
src_addr . sin_family = AF_INET ;
src_addr . sin_port = htons ( I ( port ) ) ;
2011-08-08 06:41:05 +00:00
/* XXX Is this right? Are we really setting the local side address?
I was in a plane when at the time , so couldn ' t Google it .
*/
2011-08-14 08:36:39 +00:00
if ( debug & 4 ) fprintf ( stderr , " src_addr=%08x \n " , ( unsigned int ) src_addr . sin_addr . s_addr ) ;
if ( bind ( I ( fd ) , ( struct sockaddr * ) & src_addr , sizeof ( src_addr ) ) ) {
2011-08-08 06:41:05 +00:00
perror ( " bind() " ) ;
return WHY ( " MP HLR server could not bind to requested UDP port (bind() failed ) " ) ;
}
2011-08-14 08:36:39 +00:00
if ( debug & 4 ) fprintf ( stderr , " Bound to port 0x%04x \n " , src_addr . sin_port ) ;
2011-08-08 06:41:05 +00:00
2011-08-12 07:47:29 +00:00
int broadcastP = 1 ;
2011-08-14 08:36:39 +00:00
if ( setsockopt ( I ( fd ) , SOL_SOCKET , SO_BROADCAST , & broadcastP , sizeof ( broadcastP ) ) < 0 ) {
2011-08-12 07:47:29 +00:00
perror ( " setsockopt " ) ;
return WHY ( " setsockopt() failed " ) ;
}
return 0 ;
2011-09-05 05:31:14 +00:00
# undef I
2011-08-12 07:47:29 +00:00
}
int overlay_interface_init ( char * name , struct sockaddr_in src_addr , struct sockaddr_in broadcast ,
struct sockaddr_in netmask , int speed_in_bits , int port , int type )
{
/* Too many interfaces */
if ( overlay_interface_count > = OVERLAY_MAX_INTERFACES ) return WHY ( " Too many interfaces -- Increase OVERLAY_MAX_INTERFACES " ) ;
# define I(X) overlay_interfaces[overlay_interface_count].X
strcpy ( I ( name ) , name ) ;
2011-08-09 04:45:24 +00:00
/* Pick a reasonable default MTU.
This will ultimately get tuned by the bandwidth and other properties of the interface */
I ( mtu ) = 1200 ;
2011-08-13 11:17:49 +00:00
I ( observed ) = 1 ;
2011-08-08 06:41:05 +00:00
I ( bits_per_second ) = speed_in_bits ;
2011-08-12 07:58:25 +00:00
I ( port ) = port ;
2011-08-08 06:41:05 +00:00
I ( type ) = type ;
2011-08-08 14:41:46 +00:00
I ( tick_ms ) = 500 ;
2011-08-13 11:17:49 +00:00
I ( last_tick_ms ) = 0 ;
I ( fd ) = 0 ;
2011-08-08 14:41:46 +00:00
switch ( type ) {
case OVERLAY_INTERFACE_PACKETRADIO : I ( tick_ms ) = 15000 ; break ;
case OVERLAY_INTERFACE_ETHERNET : I ( tick_ms ) = 500 ; break ;
case OVERLAY_INTERFACE_WIFI : I ( tick_ms ) = 500 ; break ;
}
2011-08-08 06:41:05 +00:00
2011-08-13 11:17:49 +00:00
if ( name [ 0 ] = = ' > ' ) {
2011-08-14 08:36:39 +00:00
I ( fileP ) = 1 ;
2011-08-13 11:17:49 +00:00
I ( fd ) = open ( & name [ 1 ] , O_APPEND | O_NONBLOCK | O_RDWR ) ;
if ( I ( fd ) < 1 )
return WHY ( " could not open dummy interface file for append " ) ;
/* Seek to end of file as initial reading point */
2011-08-14 08:36:39 +00:00
I ( offset ) = lseek ( I ( fd ) , 0 , SEEK_END ) ; /* socket gets reused to hold file offset */
2011-08-13 11:17:49 +00:00
/* XXX later add pretend location information so that we can decide which "packets" to receive
based on closeness */
} else {
if ( overlay_interface_init_socket ( overlay_interface_count , src_addr , broadcast , netmask ) )
return WHY ( " overlay_interface_init_socket() failed " ) ;
}
2011-08-12 07:47:29 +00:00
2011-08-08 06:41:05 +00:00
overlay_interface_count + + ;
2011-09-05 05:31:14 +00:00
# undef I
2011-08-08 06:41:05 +00:00
return 0 ;
}
int overlay_rx_messages ( )
{
int i ;
/* Grab packets, unpackage and dispatch frames to consumers */
/* XXX Okay, so how are we managing out-of-process consumers?
They need some way to register their interest in listening to a port .
*/
2011-08-12 19:05:11 +00:00
unsigned char packet [ 16384 ] ;
int plen = 0 ;
int c [ OVERLAY_MAX_INTERFACES ] ;
int count = 0 ;
/* Look at all interfaces */
for ( i = 0 ; i < overlay_interface_count ; i + + ) { c [ i ] = ( overlay_interfaces [ i ] . observed > 0 ) ; count + = c [ i ] ; }
/* Grab packets from interfaces in round-robin fashion until all have been grabbed,
or until we have spent too long ( maybe 10 ms ? ) */
while ( count > 0 )
for ( i = 0 ; i < overlay_interface_count ; i + + )
{
struct sockaddr src_addr ;
unsigned int addrlen = sizeof ( src_addr ) ;
unsigned char transaction_id [ 8 ] ;
2011-08-14 08:36:39 +00:00
if ( overlay_interfaces [ i ] . fileP ) {
2011-08-13 11:17:49 +00:00
/* Read from dummy interface file */
2011-08-14 08:36:39 +00:00
long long length = lseek ( overlay_interfaces [ i ] . fd , 0 , SEEK_END ) ;
lseek ( overlay_interfaces [ i ] . fd , overlay_interfaces [ i ] . offset , SEEK_SET ) ;
if ( debug & 4 ) fprintf ( stderr , " Reading from interface log at offset %d, end of file at %lld. \n " ,
overlay_interfaces [ i ] . offset , length ) ;
2011-08-14 15:58:27 +00:00
if ( read ( overlay_interfaces [ i ] . fd , packet , 2048 ) = = 2048 )
2011-08-13 11:17:49 +00:00
{
2011-08-14 15:58:27 +00:00
overlay_interfaces [ i ] . offset + = 2048 ;
plen = 2048 - 128 ;
2011-08-13 11:17:49 +00:00
bzero ( & transaction_id [ 0 ] , 8 ) ;
bzero ( & src_addr , sizeof ( src_addr ) ) ;
2011-08-14 15:58:27 +00:00
if ( ( packet [ 0 ] = = 0x01 ) & & ! ( packet [ 1 ] | packet [ 2 ] | packet [ 3 ] ) )
2011-09-03 21:06:39 +00:00
{ if ( ! packetOk ( i , & packet [ 128 ] , plen , transaction_id , & src_addr , addrlen , 1 ) ) WHY ( " Malformed or unsupported packet from dummy interface (packetOK() failed) " ) ; }
2011-08-14 15:58:27 +00:00
else WHY ( " Invalid packet version in dummy interface " ) ;
2011-08-13 11:17:49 +00:00
}
else { c [ i ] = 0 ; count - - ; }
} else {
/* Read from UDP socket */
2011-08-14 08:36:39 +00:00
plen = recvfrom ( overlay_interfaces [ i ] . fd , packet , sizeof ( packet ) , MSG_DONTWAIT ,
2011-08-13 11:17:49 +00:00
& src_addr , & addrlen ) ;
if ( plen < 0 ) { c [ i ] = 0 ; count - - ; } else {
/* We have a frame from this interface */
2011-08-14 08:36:39 +00:00
if ( debug & 4 ) fprintf ( stderr , " Received %d bytes on interface #%d \n " , plen , i ) ;
2011-08-13 11:17:49 +00:00
bzero ( & transaction_id [ 0 ] , 8 ) ;
2011-08-15 10:51:00 +00:00
if ( ! packetOk ( i , packet , plen , transaction_id , & src_addr , addrlen , 1 ) ) WHY ( " Malformed packet " ) ;
2011-08-13 11:17:49 +00:00
}
2011-08-12 19:05:11 +00:00
}
}
2011-08-08 06:41:05 +00:00
2011-08-12 19:05:11 +00:00
return 0 ;
2011-08-08 06:41:05 +00:00
}
int overlay_tx_messages ( )
{
/* Check out the various queues, and add payloads to a new frame and send it out. */
/* XXX We may want to throttle the maximum packets/sec or KB/sec */
/* How are we going to pick and choose things from the various priority queues?
We could simply pick the top item from each queue in round - robin until the
frame is filled . That would be a start . We could certainly get more intelligent
and stuff lots of little frames from a high priority queue in if that makes sense ,
especially if they look like getting delayed a bit . Perhaps we just reserve the first
n bytes for the first queue , the first n + k bytes for the first two queues and so on ?
*/
/* XXX Go through queue and separate into per-interface queues? */
2011-08-13 11:17:49 +00:00
return WHY ( " not implemented " ) ;
2011-08-08 06:41:05 +00:00
}
2011-08-08 14:41:46 +00:00
int overlay_broadcast_ensemble ( int interface_number , unsigned char * bytes , int len )
2011-08-08 06:41:05 +00:00
{
struct sockaddr_in s ;
memset ( & s , ' \0 ' , sizeof ( struct sockaddr_in ) ) ;
2011-08-08 14:41:46 +00:00
s = overlay_interfaces [ interface_number ] . broadcast_address ;
2011-08-08 06:41:05 +00:00
s . sin_family = AF_INET ;
2011-08-14 08:36:39 +00:00
if ( debug & 4 ) fprintf ( stderr , " Port=%d \n " , overlay_interfaces [ interface_number ] . port ) ;
2011-08-08 14:41:46 +00:00
s . sin_port = htons ( overlay_interfaces [ interface_number ] . port ) ;
2011-08-08 06:41:05 +00:00
2011-08-14 08:36:39 +00:00
if ( overlay_interfaces [ interface_number ] . fileP )
2011-08-12 07:47:29 +00:00
{
2011-08-14 15:58:27 +00:00
char buf [ 2048 ] ;
/* Version information */
buf [ 0 ] = 1 ; buf [ 1 ] = 0 ;
buf [ 2 ] = 0 ; buf [ 3 ] = 0 ;
/* bytes 4-5 = half-power beam height (uint16) */
/* bytes 6-7 = half-power beam width (uint16) */
/* bytes 8-11 = range in metres, centre beam (uint32) */
/* bytes 16-47 = sender */
/* bytes 48-79 = next hop */
/* bytes 80-83 = latitude (uint32) */
/* bytes 84-87 = longitude (uint32) */
/* bytes 88-89 = X/Z direction (uint16) */
/* bytes 90-91 = Y direction (uint16) */
/* bytes 92-93 = speed in metres per second (uint16) */
/* bytes 94-97 = TX frequency in Hz, uncorrected for doppler (which must be done at the receiving end to take into account
relative motion ) */
/* bytes 98-109 = coding method (use for doppler response etc) null terminated string */
/* bytes 110-127 reserved for future use */
if ( len > 2048 - 128 ) {
WHY ( " Truncating long packet to fit within 1920 byte limit for dummy interface " ) ;
len = 2048 - 128 ;
}
bzero ( & buf [ 128 + len ] , 2048 - ( 128 + len ) ) ;
bcopy ( bytes , & buf [ 128 ] , len ) ;
if ( write ( overlay_interfaces [ interface_number ] . fd , buf , 2048 ) ! = 2048 )
2011-08-13 11:17:49 +00:00
{
perror ( " write() " ) ;
return WHY ( " write() failed " ) ;
}
else
return 0 ;
2011-08-12 07:47:29 +00:00
}
2011-08-08 06:41:05 +00:00
else
2011-08-13 11:17:49 +00:00
{
2011-08-14 08:36:39 +00:00
if ( sendto ( overlay_interfaces [ interface_number ] . fd , bytes , len , 0 , ( struct sockaddr * ) & s , sizeof ( struct sockaddr_in ) ) < 0 )
2011-08-13 11:17:49 +00:00
{
/* Failed to send */
perror ( " sendto " ) ;
return WHY ( " sendto() failed " ) ;
}
else
/* Sent okay */
return 0 ;
}
2011-08-08 06:41:05 +00:00
}
2011-08-08 14:41:46 +00:00
int overlay_interface_discover ( )
{
# ifdef HAVE_IFADDRS_H
struct ifaddrs * ifaddr , * ifa ;
2011-08-12 07:47:29 +00:00
int family , i ;
2011-08-08 14:41:46 +00:00
if ( getifaddrs ( & ifaddr ) = = - 1 ) {
perror ( " getifaddr() " ) ;
return WHY ( " getifaddrs() failed " ) ;
}
2011-08-12 07:47:29 +00:00
/* Mark all interfaces as not observed, so that we know if we need to cull any */
for ( i = 0 ; i < overlay_interface_count ; i + + ) overlay_interfaces [ i ] . observed - - ;
2011-08-13 11:17:49 +00:00
/* Check through for any virtual dummy interfaces */
struct interface_rules * r = interface_filter ;
while ( r ) {
if ( r - > namespec [ 0 ] = = ' > ' ) {
for ( i = 0 ; i < overlay_interface_count ; i + + ) if ( ! strcasecmp ( overlay_interfaces [ i ] . name , r - > namespec ) ) break ;
if ( i < overlay_interface_count )
/* We already know about this interface, so just update it */
overlay_interfaces [ i ] . observed = 1 ;
else {
/* New interface, so register it */
struct sockaddr_in dummyaddr ;
if ( overlay_interface_init ( r - > namespec , dummyaddr , dummyaddr , dummyaddr ,
1000000 , PORT_DNA , OVERLAY_INTERFACE_WIFI ) )
WHY ( " Could not initialise newly seen interface " ) ;
else
2011-08-14 08:36:39 +00:00
if ( debug & 4 ) fprintf ( stderr , " Registered interface %s \n " , r - > namespec ) ;
2011-08-13 11:17:49 +00:00
}
}
r = r - > next ;
}
/* Check through actual network interfaces */
2011-08-08 14:41:46 +00:00
for ( ifa = ifaddr ; ifa ! = NULL ; ifa = ifa - > ifa_next ) {
family = ifa - > ifa_addr - > sa_family ;
switch ( family ) {
case AF_INET :
{
unsigned char * name = ( unsigned char * ) ifa - > ifa_name ;
2011-08-12 07:47:29 +00:00
struct sockaddr_in local = * ( struct sockaddr_in * ) ifa - > ifa_addr ;
struct sockaddr_in netmask = * ( struct sockaddr_in * ) ifa - > ifa_netmask ;
unsigned int broadcast_bits = local . sin_addr . s_addr | ~ netmask . sin_addr . s_addr ;
struct sockaddr_in broadcast = local ;
broadcast . sin_addr . s_addr = broadcast_bits ;
2011-09-03 21:06:39 +00:00
if ( debug > 3 ) printf ( " %s: %08x %08x %08x \n " , name , local . sin_addr . s_addr , netmask . sin_addr . s_addr , broadcast . sin_addr . s_addr ) ;
2011-08-12 07:47:29 +00:00
/* Now register the interface, or update the existing interface registration */
struct interface_rules * r = interface_filter , * me = NULL ;
while ( r ) {
if ( ! strcasecmp ( ( char * ) name , r - > namespec ) ) me = r ;
if ( ! r - > namespec [ 0 ] ) me = r ;
r = r - > next ;
}
if ( me & & ( ! me - > excludeP ) ) {
2011-08-14 08:36:39 +00:00
if ( debug & 4 ) fprintf ( stderr , " Interface %s is interesting. \n " , name ) ;
2011-08-12 07:47:29 +00:00
/* We should register or update this interface. */
int i ;
for ( i = 0 ; i < overlay_interface_count ; i + + ) if ( ! strcasecmp ( overlay_interfaces [ i ] . name , ( char * ) name ) ) break ;
if ( i < overlay_interface_count ) {
/* We already know about this interface, so just update it */
if ( ( overlay_interfaces [ i ] . local_address . sin_addr . s_addr = = local . sin_addr . s_addr ) & &
( overlay_interfaces [ i ] . broadcast_address . sin_addr . s_addr = = broadcast . sin_addr . s_addr ) & &
( overlay_interfaces [ i ] . netmask . sin_addr . s_addr = = netmask . sin_addr . s_addr ) )
{
/* Mark it as being seen */
overlay_interfaces [ i ] . observed = 1 ;
continue ;
}
else
{
/* Interface has changed */
2011-08-14 08:36:39 +00:00
close ( overlay_interfaces [ i ] . fd ) ;
2011-08-12 07:47:29 +00:00
if ( overlay_interface_init_socket ( i , local , broadcast , netmask ) )
WHY ( " Could not reinitialise changed interface " ) ;
}
}
else {
/* New interface, so register it */
if ( overlay_interface_init ( ( char * ) name , local , broadcast , netmask ,
me - > speed_in_bits , me - > port , me - > type ) )
WHY ( " Could not initialise newly seen interface " ) ;
2011-08-13 11:17:49 +00:00
else
2011-08-14 08:36:39 +00:00
if ( debug & 4 ) fprintf ( stderr , " Registered interface %s \n " , name ) ;
2011-08-12 07:47:29 +00:00
}
}
2011-08-08 14:41:46 +00:00
break ;
}
}
}
2011-08-13 11:17:49 +00:00
freeifaddrs ( ifaddr ) ;
2011-09-05 05:31:14 +00:00
# endif
2011-08-12 07:47:29 +00:00
2011-08-08 14:41:46 +00:00
return 0 ;
}
2011-09-05 03:49:00 +00:00
int overlay_stuff_packet_from_queue ( int i , overlay_buffer * e , int q , long long now , overlay_frame * pax [ ] , int * frame_pax , int frame_max_pax )
2011-09-05 02:49:53 +00:00
{
2011-09-05 03:49:00 +00:00
overlay_frame * * p = & overlay_tx [ q ] . first ;
2011-09-05 02:49:53 +00:00
while ( p & & * p )
{
/* Throw away any stale frames */
overlay_frame * pp = * p ;
if ( ! pp ) break ;
2011-09-05 03:49:00 +00:00
/* XXX Uses hardcoded freshness threshold, when it should get it from the queue */
if ( now > ( ( * p ) - > enqueued_at + overlay_tx [ q ] . latencyTarget ) ) {
2011-09-12 14:19:55 +00:00
/* Stale, so remove from queue. */
2011-09-05 03:49:00 +00:00
/* Get pointer to stale entry */
overlay_frame * stale = * p ;
fprintf ( stderr , " Removing stale frame at %p (now=%lld, expiry=%lld) \n " , stale ,
now , ( ( * p ) - > enqueued_at + overlay_tx [ q ] . latencyTarget ) ) ;
/* Make ->next pointer that points to the stale node skip the stale node */
* p = stale - > next ;
/* If there is an entry after the stale now, make it's prev point to the
node before the stale node */
if ( * p ) ( * p ) - > prev = stale - > prev ;
if ( overlay_tx [ q ] . first = = stale ) overlay_tx [ q ] . first = stale - > next ;
if ( overlay_tx [ q ] . last = = stale ) overlay_tx [ q ] . last = stale - > prev ;
op_free ( stale ) ;
overlay_tx [ q ] . length - - ;
2011-09-05 02:49:53 +00:00
}
else
{
/* XXX Filter for those which should be sent via this interface.
To do that we need to know the nexthop , and the best route to the next hop . */
2011-09-07 01:56:26 +00:00
2011-09-05 02:49:53 +00:00
/* We keep trying to queue frames in case they will fit, as not all frames are of equal size.
This means that lower bit - rate codecs will get higher priority , which is probably not all
bad . The only hard limit is the maximum number of payloads we allow in a frame , which is
set so high as to be irrelevant , even on loopback or gigabit ethernet interface */
if ( * frame_pax > = frame_max_pax ) break ;
if ( ! overlay_frame_package_fmt1 ( * p , e ) )
{
/* Add payload to list of payloads we are sending with this frame so that we can dequeue them
if we send them . */
pax [ ( * frame_pax ) + + ] = * p ;
}
p = & ( * p ) - > next ;
}
}
return 0 ;
}
2011-08-08 14:41:46 +00:00
int overlay_tick_interface ( int i , long long now )
{
int frame_pax = 0 ;
# define MAX_FRAME_PAX 1024
2011-08-17 01:22:17 +00:00
overlay_frame * pax [ MAX_FRAME_PAX ] ;
2011-08-08 14:41:46 +00:00
if ( overlay_interfaces [ i ] . bits_per_second < 1 ) {
/* An interface with no speed budget is for listening only, so doesn't get ticked */
return 0 ;
}
2011-08-14 08:36:39 +00:00
if ( debug & 4 ) fprintf ( stderr , " Ticking interface #%d \n " , i ) ;
2011-08-12 06:34:56 +00:00
2011-08-08 14:41:46 +00:00
/* Get a buffer ready, and limit it's size appropriately.
XXX size limit should be reduced from MTU .
XXX we should also take account of the volume of data likely to be in the TX buffer . */
overlay_buffer * e = ob_new ( overlay_interfaces [ i ] . mtu ) ;
if ( ! e ) return WHY ( " ob_new() failed " ) ;
2011-09-12 19:22:52 +00:00
ob_limitsize ( e , overlay_interfaces [ i ] . mtu / 4 ) ;
2011-08-08 14:41:46 +00:00
/* 0. Setup Serval Mesh frame header. We do not use an explicit length field for these, as the various
component payloads are all self - authenticating , or at least that is the theory . */
unsigned char bytes [ ] = { /* Magic */ ' O ' , 0x10 ,
/* Version */ 0x00 , 0x01 } ;
2011-08-09 04:45:24 +00:00
if ( ob_append_bytes ( e , bytes , 4 ) ) return WHY ( " ob_append_bytes() refused to append magic bytes. " ) ;
2011-08-08 14:41:46 +00:00
/* 1. Send announcement about ourselves, including one SID that we host if we host more than one SID
( the first SID we host becomes our own identity , saving a little bit of data here ) .
*/
overlay_add_selfannouncement ( i , e ) ;
/* 2. Add any queued high-priority isochronous data (i.e. voice) to the frame. */
2011-09-05 03:49:00 +00:00
overlay_stuff_packet_from_queue ( i , e , OQ_ISOCHRONOUS_VOICE , now , pax , & frame_pax , MAX_FRAME_PAX ) ;
2011-08-08 14:41:46 +00:00
2011-09-12 19:22:52 +00:00
ob_limitsize ( e , overlay_interfaces [ i ] . mtu / 2 ) ;
2011-08-08 14:41:46 +00:00
/* 3. Add some mesh reachability reports (unlike BATMAN we announce reachability to peers progressively).
Give priority to newly observed nodes so that good news travels quickly to help roaming .
XXX - Don ' t forget about PONGing reachability reports to allow use of monodirectional links .
*/
2011-09-05 03:49:00 +00:00
overlay_stuff_packet_from_queue ( i , e , OQ_MESH_MANAGEMENT , now , pax , & frame_pax , MAX_FRAME_PAX ) ;
2011-08-08 14:41:46 +00:00
2011-09-12 19:22:52 +00:00
ob_limitsize ( e , overlay_interfaces [ i ] . mtu * 3 / 4 ) ;
2011-09-12 18:03:45 +00:00
overlay_route_add_advertisements ( i , e ) ;
2011-09-12 19:22:52 +00:00
ob_limitsize ( e , overlay_interfaces [ i ] . mtu ) ;
2011-08-08 14:41:46 +00:00
/* 4. XXX Add lower-priority queued data */
/* 5. XXX Fill the packet up to a suitable size with anything that seems a good idea */
/* Now send the frame. This takes the form of a special DNA packet with a different
service code , which we setup earlier . */
2011-08-14 08:36:39 +00:00
if ( debug & 4 ) fprintf ( stderr , " Sending %d bytes \n " , e - > length ) ;
2011-08-08 14:41:46 +00:00
if ( ! overlay_broadcast_ensemble ( i , e - > bytes , e - > length ) )
{
2011-08-20 09:36:15 +00:00
overlay_update_sequence_number ( ) ;
2011-08-14 08:36:39 +00:00
fprintf ( stderr , " Successfully transmitted tick frame #%d on interface #%d (%d bytes) \n " ,
2011-08-20 09:36:15 +00:00
overlay_sequence_number , i , e - > length ) ;
2011-08-08 14:41:46 +00:00
/* De-queue the passengers who were aboard. */
2011-09-05 03:04:54 +00:00
int j , q ;
for ( q = 0 ; q < OQ_MAX ; q + + )
2011-08-08 14:41:46 +00:00
{
2011-09-05 03:04:54 +00:00
overlay_frame * * p = & overlay_tx [ q ] . first ;
for ( j = 0 ; j < frame_pax ; j + + )
{
/* Skip any frames that didn't get queued */
while ( ( * p ) & & ( * p ! = pax [ j ] ) ) p = & ( * p ) - > next ;
/* Now get rid of this frame once we have found it */
if ( * p ) {
2011-09-12 14:19:55 +00:00
fprintf ( stderr , " ** dequeueing pax @ %p \n " , * p ) ;
2011-09-05 03:04:54 +00:00
* p = pax [ j ] - > next ;
if ( pax [ j ] - > next ) pax [ j ] - > next - > prev = pax [ j ] - > prev ;
if ( op_free ( pax [ j ] ) ) WHY ( " op_free() failed " ) ;
2011-09-12 14:19:55 +00:00
overlay_tx [ q ] . length - - ;
2011-09-05 03:04:54 +00:00
}
}
2011-08-08 14:41:46 +00:00
}
return 0 ;
}
2011-08-12 19:05:11 +00:00
else return WHY ( " overlay_broadcast_ensemble() failed " ) ;
2011-08-08 14:41:46 +00:00
}
2011-09-05 03:49:00 +00:00
long long overlay_time_in_ms ( )
2011-08-08 14:41:46 +00:00
{
long long now ;
2011-09-05 03:49:00 +00:00
struct timeval nowtv ;
2011-08-08 14:41:46 +00:00
if ( gettimeofday ( & nowtv , NULL ) )
return WHY ( " gettimeofday() failed " ) ;
2011-09-05 03:49:00 +00:00
2011-08-08 14:41:46 +00:00
/* Get current time in milliseconds */
2011-08-13 11:17:49 +00:00
now = nowtv . tv_sec * 1000LL ;
2011-08-08 14:41:46 +00:00
now = now + nowtv . tv_usec / 1000 ;
2011-09-05 03:49:00 +00:00
return now ;
}
int overlay_check_ticks ( )
{
/* Check if any interface(s) are due for a tick */
int i ;
/* Check for changes to interfaces */
overlay_interface_discover ( ) ;
long long now = overlay_time_in_ms ( ) ;
2011-08-08 14:41:46 +00:00
/* Now check if the next tick time for the interfaces is no later than that time.
If so , trigger a tick on the interface . */
2011-08-14 08:36:39 +00:00
if ( debug & 4 ) fprintf ( stderr , " Examining %d interfaces. \n " , overlay_interface_count ) ;
2011-08-08 14:41:46 +00:00
for ( i = 0 ; i < overlay_interface_count ; i + + )
{
2011-08-12 07:58:25 +00:00
/* Only tick live interfaces */
if ( overlay_interfaces [ i ] . observed > 0 )
2011-08-13 11:17:49 +00:00
{
2011-08-14 08:36:39 +00:00
if ( debug & 4 ) fprintf ( stderr , " Interface %s ticks every %dms, last at %lld. \n " , overlay_interfaces [ i ] . name ,
2011-08-13 11:17:49 +00:00
overlay_interfaces [ i ] . tick_ms , overlay_interfaces [ i ] . last_tick_ms ) ;
if ( now > = overlay_interfaces [ i ] . last_tick_ms + overlay_interfaces [ i ] . tick_ms )
{
/* This interface is due for a tick */
overlay_tick_interface ( i , now ) ;
overlay_interfaces [ i ] . last_tick_ms = now ;
}
}
else
2011-08-14 08:36:39 +00:00
if ( debug & 4 ) fprintf ( stderr , " Interface %s is awol. \n " , overlay_interfaces [ i ] . name ) ;
2011-08-08 14:41:46 +00:00
}
2011-08-12 19:05:11 +00:00
2011-08-08 14:41:46 +00:00
return 0 ;
}
long long overlay_time_until_next_tick ( )
{
/* By default only tick once per day */
long long nexttick = 86400 * 1000 ;
long long now ;
struct timeval tv ;
gettimeofday ( & tv , NULL ) ;
2011-08-13 11:17:49 +00:00
now = tv . tv_sec * 1000LL + tv . tv_usec / 1000 ;
2011-08-08 14:41:46 +00:00
int i ;
2011-08-14 08:36:39 +00:00
if ( debug & 4 ) fprintf ( stderr , " Tick-check on %d interfaces at %lldms \n " , overlay_interface_count , now ) ;
2011-08-08 14:41:46 +00:00
for ( i = 0 ; i < overlay_interface_count ; i + + )
2011-08-13 11:17:49 +00:00
if ( overlay_interfaces [ i ] . observed > 0 )
2011-08-08 14:41:46 +00:00
{
2011-08-14 08:36:39 +00:00
if ( debug & 4 ) fprintf ( stderr , " Interface %s ticks every %dms, last at T-%lldms. \n " , overlay_interfaces [ i ] . name ,
overlay_interfaces [ i ] . tick_ms , now - overlay_interfaces [ i ] . last_tick_ms ) ;
2011-08-13 11:17:49 +00:00
2011-08-08 14:41:46 +00:00
long long thistick = ( overlay_interfaces [ i ] . last_tick_ms + overlay_interfaces [ i ] . tick_ms ) - now ;
if ( thistick < 0 ) thistick = 0 ;
if ( thistick < nexttick ) nexttick = thistick ;
}
return nexttick ;
}