CaryCoders
standalone sx1276 demo program
Fork of
SX1276_GPS
by 
CaryCoders
Diff: ping_pong.cpp
- Revision:
- 29:0ea07cc7124b
- Child:
- 31:2c813f321db7
diff -r fbcd3bac0cd7 -r 0ea07cc7124b ping_pong.cpp
--- /dev/null Thu Jan 01 00:00:00 1970 +0000
+++ b/ping_pong.cpp Tue Jun 16 11:53:20 2015 +0000
@@ -0,0 +1,283 @@
+#include "mbed.h"
+#include "sx1276-hal.h"
+#include "main.h"
+#include "debug.h"
+#include "vt100.h"
+#include "serial_api.h"
+
+void start_ping_pong(void)
+{
+ //char pcbuf[64];
+ int len = get_kbd_str(pcbuf, PCBUF_SIZE);
+ if (len < 0) {
+ //xctrl.cls();
+ fflush(stdout);
+ Radio.Rx( RX_TIMEOUT_VALUE );
+ Radio.Tx( TX_TIMEOUT_VALUE );
+ Radio.Sleep( );
+ debug("Ping pong app ended\r\n");
+ app = APP_CONSOLE;
+ // red = 1; green = 1; blue = 1;
+ print_help();
+ printf("> ");
+ fflush(stdout);
+ return;
+ }
+ else
+ {
+ ping_pong();
+ }
+}
+
+void ping_pong(void)
+{
+ static uint8_t i;
+ // static bool isMaster = true;
+ vt100 ctrl;
+ static int xmit_count = 0;
+
+ //ctrl.cls();
+
+ strcpy((char *)PingMsg,"PING");
+ strcpy((char *)PongMsg,"PONG");
+
+
+ switch( State )
+ {
+ case RX:
+ //ctrl.cls();
+ led = !led;
+ if( isMaster == true )
+ {
+ //debug("master is true \r\n");
+ if( BufferSize > 0 )
+ {
+ if( strncmp( ( const char* )BufferRx, ( const char* )PongMsg, 4 ) == 0 )
+ {
+ //debug( "...Pong\r\n" );
+ debug( "master mode, ...received %s, ", BufferRx );
+ // Send the next PING frame
+ ++xmit_count;
+ strcpy((char *)PingMsg, "PING_");
+ strcat((char *)PingMsg, itoa(xmit_count,10));
+ strcpy( ( char* )BufferTx, ( char* )PingMsg );
+ debug( "send %s\r\n", BufferTx );
+ // We fill the buffer with numbers for the payload
+ int msgLen=strlen((char *)BufferTx);
+ for( i = msgLen; i < BufferSize; i++ )
+ {
+ BufferTx[i] = i - msgLen;
+ }
+ // wait_ms( 10 );
+ wait_ms(100);
+ // ctrl.cls();
+ Radio.Send( BufferTx, BufferSize );
+ }
+ else if( strncmp( ( const char* )BufferRx, ( const char* )PingMsg, 4 ) == 0 )
+ { // A master already exists then become a slave
+
+ if (AlwaysMaster)
+ return;
+ isMaster = false;
+ // Send the next PONG frame
+ ++xmit_count;
+ debug( "master mode, become a slave, ...received %s, ", BufferRx );
+ strcpy((char *)PongMsg, "PONG_");
+ strcat((char *)PongMsg, itoa(xmit_count,10));
+ strcpy( ( char* )BufferTx, ( char* )PongMsg );
+ debug( "send %s\r\n", BufferTx );
+ // We fill the buffer with numbers for the payload
+ int msgLen=strlen((char *)BufferTx);
+ for( i = msgLen; i < BufferSize; i++ )
+ {
+ BufferTx[i] = i - msgLen;
+ }
+ wait_ms( 10 );
+ Radio.Send( BufferTx, BufferSize );
+ }
+ else // valid reception but neither a PING or a PONG message
+ { // Set device as master an start again
+ if (AlwaysSlave == false)
+ isMaster = true;
+ debug( "...received %s, but it was not a PING or a PONG\r\n", BufferRx );
+ Radio.Rx( RX_TIMEOUT_VALUE );
+ }
+ }
+ }
+ else
+ {
+ //debug("master is false \r\n");
+
+ if( BufferSize > 0 )
+ {
+ if( strncmp( ( const char* )BufferRx, ( const char* )PingMsg, 4 ) == 0 )
+ {
+ //red = !red;
+ // red = !red; green = 1; blue = 1;
+ // ctrl.cls();
+ debug( "slave mode, ...received %s, ", BufferRx );
+
+ // Send the reply to the PING string
+ ++xmit_count;
+ strcpy((char *)PongMsg, "PONG_");
+ strcat((char *)PongMsg, itoa(xmit_count,10));
+ strcpy( ( char* )BufferTx, ( char* )PongMsg );
+ debug( "send %s \r\n", BufferTx );
+ // We fill the buffer with numbers for the payload
+ int msgLen=strlen((char *)BufferTx);
+ for( i = msgLen; i < BufferSize; i++ )
+ {
+ BufferTx[i] = i - msgLen;
+ }
+ wait_ms( 10 );
+ Radio.Send( BufferTx, BufferSize );
+ }
+ else // valid reception but not a PING as expected
+ { // Set device as master and start again
+ debug( "...received %s, but was expecting %s\r\n", BufferRx, (const char *)PingMsg );
+ if (AlwaysSlave == false)
+ isMaster = true;
+ Radio.Rx( RX_TIMEOUT_VALUE );
+ }
+ }
+ }
+ State = LOWPOWER;
+ break;
+ case TX:
+ // red = !red;
+ // red = !red; green = 1; blue = 1;
+ int i;
+
+ if( isMaster == true )
+ {
+ //x ctrl.cls();
+ //x ctrl.putStr( 1,1,"Ping...\r\n" );
+ printf("Ping..\r\n");
+ }
+ else
+ {
+
+ //x ctrl.cls();
+ // ctrl.putStr( 1,1,"Pong...\r\n" );
+ printf("Pong..\r\n");
+ }
+ // Radio.Tx( TX_TIMEOUT_VALUE );
+ Radio.Rx( RX_TIMEOUT_VALUE );
+ State = LOWPOWER;
+ break;
+ case RX_TIMEOUT:
+ if( isMaster == true )
+ {
+ // Send the next PING frame
+ ++xmit_count;
+ strcpy((char *)PingMsg, "PING_");
+ strcat((char *)PingMsg, itoa(xmit_count,10));
+ strcpy( ( char* )BufferTx, ( char* )PingMsg );
+ debug( "master mode, rx timeout, send %s\r\n", BufferTx );
+ int msgLen=strlen((char *)BufferTx);
+ #if 0
+ for( i = msgLen; i < BufferSize; i++ )
+ {
+ BufferTx[i] = i - msgLen;
+ }
+ #else
+ BufferSize = msgLen;
+ #endif
+
+ /* initialize random seed: */
+ srand ( randomSeed() );
+ // generate a random wait time
+ int mywait = (5*(rand()%10 +1));
+ debug("wait %d ms before sending\r\n", mywait);
+ wait_ms(mywait);
+ Radio.Send( BufferTx, BufferSize );
+ // use the random wait time to occasionaly switch modes.
+ // this helps break out of endless cycles when both sides are
+ // in master mode
+ if ((mywait % 10) == 0)
+ {
+ if (AlwaysMaster == false)
+ isMaster = false;
+ }
+
+ }
+ else
+ { /* initialize random seed: */
+ debug("rx timeout in slave mode\r\n");
+ srand ( randomSeed() );
+ // generate a random wait time
+ int mywait = (5*(rand()%10 +1));
+ if ((mywait % 10) == 0)
+ {
+ if (AlwaysSlave == false)
+ {
+ isMaster = true;
+ debug("switch to master mode\r\n");
+ }
+ }
+ Radio.Rx( RX_TIMEOUT_VALUE );
+ }
+ State = LOWPOWER;
+ break;
+ case RX_ERROR:
+ // We have received a Packet with a CRC error, send reply as if packet was correct
+ if( isMaster == true )
+ {
+ // Send the next PING frame
+ ++xmit_count;
+ strcpy((char *)PingMsg, "PING_");
+ strcat((char *)PingMsg, itoa(xmit_count,10));
+ strcpy( ( char* )BufferTx, ( char* )PingMsg );
+ debug( "master mode, rx error, send %s\r\n", BufferTx );
+ int msgLen=strlen((char *)BufferTx);
+ for( i = msgLen; i < BufferSize; i++ )
+ {
+ BufferTx[i] = i - msgLen;
+ }
+ wait_ms( 10 );
+ Radio.Send( BufferTx, BufferSize );
+ }
+ else
+ {
+ // Send the next PONG frame
+ ++xmit_count;
+ strcpy((char *)PongMsg, "PONG_");
+ strcat((char *)PongMsg, itoa(xmit_count,10));
+ strcpy( ( char* )BufferTx, ( char* )PongMsg );
+ debug( "slave mode, rx error, send %s\r\n", BufferTx );
+ int msgLen=strlen((char *)BufferTx);
+ for( i = msgLen; i < BufferSize; i++ )
+ {
+ BufferTx[i] = i - msgLen;
+ }
+ //wait_ms( 10 );
+ wait_ms(100);
+ // ctrl.cls();
+ Radio.Send( BufferTx, BufferSize );
+ }
+ State = LOWPOWER;
+ break;
+ case TX_TIMEOUT:
+ debug("tx timeout\r\n");
+ Radio.Tx( TX_TIMEOUT_VALUE );
+ State = LOWPOWER;
+ break;
+ case LOWPOWER:
+ static int j=0;
+ //if ((j%100000) == 0)
+ if ((j%10000) == 0)
+ {
+ debug("low power state %d\r\n", j);
+ j=1;
+ }
+ else
+ j++;
+ // wait_ms( 250 );
+ wait_ms (5);
+ break;
+ default:
+ debug("state is set to low power\r\n");
+ State = LOWPOWER;
+ break;
+ }
+}