interfisch
/
rf24-pio
1
0
Fork 0
Code Issues Pull Requests Projects Releases Wiki Activity

Added self-healing ping offset to leaf node. Made timeout more parallelized

This commit is contained in:
maniacbug 2011-05-13 20:16:54 -07:00
parent 52ab9e0081
commit 7b71380278
1 changed files with 50 additions and 31 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

73
examples/starping_relay/starping_relay.pde
View File

@ -163,8 +163,11 @@ void payload_printf(const char* name, const payload_t& pl)
// Setup/loop shared statics
//
static unsigned long last_ping_time;
const unsigned long ping_delay = 2000;
static unsigned long last_ping_sent_at;
static bool waiting_for_pong = false;
const unsigned long ping_delay = 2000; // ms
const unsigned long pong_timeout = 250; // ms
const unsigned long ping_phase_shift = 100; // ms
void setup(void)
{
@ -305,9 +308,10 @@ void loop(void)
{
// Is it time to ping again?
unsigned long now = millis();
if ( now - last_ping_time >= ping_delay )
if ( now - last_ping_sent_at >= ping_delay )
{
last_ping_time = now;
last_ping_sent_at = now;
waiting_for_pong = true;
// First, stop listening so we can talk.
radio.stopListening();
@ -315,40 +319,55 @@ void loop(void)
// Take the time, and send it to the base. This will block until complete
payload_t ping(node_address,0,millis());
// Print details.
printf("%lu ",millis());
payload_printf("PING",ping);
payload_printf(">PING",ping);
bool ok = radio.write( &ping, sizeof(payload_t) );
if (ok)
printf(" ok ");
printf(" ok\n\r");
else
printf(" failed ");
printf(" failed\n\r");
// Now, continue listening
radio.startListening();
}
// Wait here until we get a response, or timeout (250ms)
unsigned long started_waiting_at = millis();
bool timeout = false;
while ( ! radio.available() && ! timeout )
if (millis() - started_waiting_at > 250 )
timeout = true;
// Did we get a pong?
if ( radio.available() )
{
// Not waiting anymore, got one.
waiting_for_pong = false;
// Describe the results
if ( timeout )
// Dump the payloads until we've gotten everything
payload_t payload;
boolean done = false;
while (!done)
{
printf("Failed, response timed out.\n\r");
}
else
{
// Grab the response, compare, and send to debugging spew
payload_t pong;
radio.read( &pong, sizeof(payload_t) );
// Fetch the payload, and see if this was the last one.
done = radio.read( &payload, sizeof(payload_t) );
// Spew it
payload_printf(" ...PONG",pong);
printf(" Round-trip delay: %lu\n\r",millis()-pong.time);
// Print details.
printf("%lu ",millis());
payload_printf(">PONG",payload);
printf(" Round-trip delay: %lu\n\r",millis()-payload.time);
}
}
// Have we timed out waiting for our pong?
if ( waiting_for_pong && ( millis() - last_ping_sent_at > pong_timeout ) )
{
// Not waiting anymore, timed out.
waiting_for_pong = false;
// Timeouts usually happen because of collisions with other nodes
// getting a pong just as we are trying to get a ping. The best thing
// to do right now is offset our ping timing to search for a slot
// that's not occupied.
last_ping_sent_at += ping_phase_shift;
// Print details
printf("TIMED OUT.\n\r");
}
}
//
@ -413,9 +432,9 @@ void loop(void)
// Is it time to ping again?
unsigned long now = millis();
if ( now - last_ping_time >= ping_delay )
if ( now - last_ping_sent_at >= ping_delay )
{
last_ping_time = now;
last_ping_sent_at = now;
// First, stop listening so we can talk.
radio.stopListening();