Merge TinyOS 2.1.1 into master.

[tinyos-2.x.git] / apps / tests / TestFtsp / FtspLpl / TestFtspC.nc

diff --git a/apps/tests/TestFtsp/FtspLpl/TestFtspC.nc b/apps/tests/TestFtsp/FtspLpl/TestFtspC.nc
new file mode 100755 (executable)
index 0000000..58b58ee
--- /dev/null
+++ b/apps/tests/TestFtsp/FtspLpl/TestFtspC.nc
@@ -0,0 +1,120 @@
+/*
+ * Copyright (c) 2002, Vanderbilt University
+ * All rights reserved.
+ *
+ * Permission to use, copy, modify, and distribute this software and its
+ * documentation for any purpose, without fee, and without written agreement is
+ * hereby granted, provided that the above copyright notice, the following
+ * two paragraphs and the author appear in all copies of this software.
+ *
+ * IN NO EVENT SHALL THE VANDERBILT UNIVERSITY BE LIABLE TO ANY PARTY FOR
+ * DIRECT, INDIRECT, SPECIAL, INCIDENTAL, OR CONSEQUENTIAL DAMAGES ARISING OUT
+ * OF THE USE OF THIS SOFTWARE AND ITS DOCUMENTATION, EVEN IF THE VANDERBILT
+ * UNIVERSITY HAS BEEN ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ *
+ * THE VANDERBILT UNIVERSITY SPECIFICALLY DISCLAIMS ANY WARRANTIES,
+ * INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY
+ * AND FITNESS FOR A PARTICULAR PURPOSE.  THE SOFTWARE PROVIDED HEREUNDER IS
+ * ON AN "AS IS" BASIS, AND THE VANDERBILT UNIVERSITY HAS NO OBLIGATION TO
+ * PROVIDE MAINTENANCE, SUPPORT, UPDATES, ENHANCEMENTS, OR MODIFICATIONS.
+ *
+ * @author: Miklos Maroti, Brano Kusy (kusy@isis.vanderbilt.edu)
+ * Ported to T2: 3/17/08 by Brano Kusy (branislav.kusy@gmail.com)
+ * Ported for LPL: Thomas Schmid (thomas.schmid@ucla.edu)
+ */
+
+#include "TestFtsp.h"
+#include "RadioCountToLeds.h"
+
+module TestFtspC
+{
+    uses
+    {
+        interface GlobalTime<T32khz>;
+        interface TimeSyncInfo;
+        interface Receive;
+        interface AMSend;
+        interface Packet;
+        interface Leds;
+        interface PacketTimeStamp<T32khz,uint32_t>;
+        interface Boot;
+        interface SplitControl as RadioControl;
+        interface Timer<TMilli> as RandomTimer;
+        interface Random;
+
+        interface TimeSyncPacket<T32khz,uint32_t>;
+
+        interface LowPowerListening;
+
+    }
+}
+
+implementation
+{
+    enum {
+        ACT_TESTFTSP = 0x11,
+    };
+
+    message_t msg;
+    bool locked = FALSE;
+    test_ftsp_msg_t* report;
+
+    event void Boot.booted() {
+        call RadioControl.start();
+    }
+
+    event message_t* Receive.receive(message_t* msgPtr, void* payload, uint8_t len)
+    {
+        if (!(call PacketTimeStamp.isValid(msgPtr))){
+            call Leds.led1Toggle();
+        }
+        if (!locked && call PacketTimeStamp.isValid(msgPtr)) {
+            radio_count_msg_t* rcm = (radio_count_msg_t*)call Packet.getPayload(msgPtr, sizeof(radio_count_msg_t));
+            if(call TimeSyncPacket.isValid(msgPtr)) {
+                uint32_t rxTimestamp = call TimeSyncPacket.eventTime(msgPtr);
+                report = (test_ftsp_msg_t*)call Packet.getPayload(&msg, sizeof(test_ftsp_msg_t));
+
+                report->src_addr = TOS_NODE_ID;
+                report->counter = rcm->counter;
+                report->local_rx_timestamp = rxTimestamp;
+                report->is_synced = call GlobalTime.local2Global(&rxTimestamp);
+                report->global_rx_timestamp = rxTimestamp;
+                report->skew_times_1000000 = (uint32_t)call TimeSyncInfo.getSkew()*1000000UL;
+                report->skew = call TimeSyncInfo.getSkew();
+                report->ftsp_root_addr = call TimeSyncInfo.getRootID();
+                report->ftsp_seq = call TimeSyncInfo.getSeqNum();
+                report->ftsp_table_entries = call TimeSyncInfo.getNumEntries();
+                report->localAverage = call TimeSyncInfo.getSyncPoint();
+                report->offsetAverage = call TimeSyncInfo.getOffset();
+
+                locked = TRUE;
+                call RandomTimer.startOneShot(call Random.rand16() % (64));
+            }
+        }
+
+        return msgPtr;
+    }
+
+    event void RandomTimer.fired()
+    {
+#ifdef LOW_POWER_LISTENING
+        call LowPowerListening.setRemoteWakeupInterval(&msg, LPL_INTERVAL);
+#endif
+        if(locked && (call AMSend.send(4000, &msg, sizeof(test_ftsp_msg_t)) == SUCCESS)){
+            call Leds.led2On();
+        } else {
+            locked = FALSE;
+        }
+    }
+
+    event void AMSend.sendDone(message_t* ptr, error_t success) {
+        locked = FALSE;
+        call Leds.led2Off();
+        return;
+    }
+
+    event void RadioControl.startDone(error_t err) {
+        call LowPowerListening.setLocalWakeupInterval(LPL_INTERVAL);
+    }
+    event void RadioControl.stopDone(error_t error){}
+}