Diff: main.cpp

Revision:

1:5be48a9550c3

Parent:

0:3982c0e9eda1

Child:

2:926b93a68399

--- a/main.cpp	Mon Jul 06 03:17:33 2015 +0000
+++ b/main.cpp	Mon Jul 06 04:03:48 2015 +0000
@@ -18,19 +18,21 @@
 RF24Network network(radio);
 
 // Address of our node
-const uint16_t this_node = 0;
+const uint16_t this_node = 1;
 
 // Address of the other node
-const uint16_t other_node = 1;
+const uint16_t other_node = 0;
 
 // How often to send 'hello world to the other unit
 const unsigned long interval = 100; //ms
 
 // When did we last send?
 unsigned long last_sent;
+Timer t;
 
 // How many have we sent already
 unsigned long packets_sent;
+Timer t_packet;
 
 // Structure of our payload
 struct payload_t
@@ -53,7 +55,8 @@
     radio.begin();
     network.begin(/*channel*/ 90, /*node address*/ this_node);
     wait_ms(2000);
-    
+    t.start();
+    t_packet.start();
     while(1)
     {
         // Pump the network regularly
@@ -68,6 +71,33 @@
             network.read(header_rx,&payload_rx,sizeof(payload_rx));
             pc.printf("Received packet # %d at %d ms, message: V4 %f, %f, %f, %f \n",payload_rx.counter,payload_rx.ms, payload_rx.vector_4d[0],payload_rx.vector_4d[1],payload_rx.vector_4d[2],payload_rx.vector_4d[3]);
         }
+        
+        /* If it's time to send a message, send it! */
+        unsigned long now = t.read_ms();
+        if ( now >= interval  )
+        {
+            t.reset();
+
+            pc.printf("Sending...");
+            //payload_t payload_tx = { millis(), packets_sent++, "Hello from node 0" };
+            payload_t payload_tx;
+            payload_tx.ms = t_packet.read_ms();
+            payload_tx.counter = packets_sent++;
+            for(int i=0;i<=3;i++)
+            {
+                payload_tx.vector_4d[i] = i + 1.00f;
+            }
+    
+    
+            RF24NetworkHeader header_tx(/*to node*/ other_node);
+            bool ok = network.write(header_tx,&payload_tx,sizeof(payload_tx));
+            if (ok)
+            pc.printf("ok.\n");
+            else
+            pc.printf("failed.\n");
+        } 
+        
+        
     }
         
 }
\ No newline at end of file