X-Git-Url: https://oss.titaniummirror.com/gitweb/?a=blobdiff_plain;f=tos%2Fchips%2Frf230%2FRF230LayerP.nc;h=85058a77ae29271d2bf52797a55947a62ab0623c;hb=e90b80efe22dc89b94b4d032715269849ff6796e;hp=cda1a21615df48d11208c5282af4e3e83927b7ac;hpb=f51909bb40e6fd22e15fc26f0e0b464ee554ccfe;p=tinyos-2.x.git

diff --git a/tos/chips/rf230/RF230LayerP.nc b/tos/chips/rf230/RF230LayerP.nc
index cda1a216..85058a77 100644
--- a/tos/chips/rf230/RF230LayerP.nc
+++ b/tos/chips/rf230/RF230LayerP.nc
@@ -57,14 +57,15 @@ module RF230LayerP
 		interface PacketField<uint8_t> as PacketLinkQuality;
 		interface PacketField<uint8_t> as PacketTransmitPower;
 		interface PacketField<uint8_t> as PacketRSSI;
-		interface PacketTimeStamp<TRF230, uint16_t>;
+		interface PacketField<uint8_t> as PacketTimeSyncOffset;
+
+		interface PacketTimeStamp<TRF230, uint32_t>;
+		interface LocalTime<TRF230>;
 
 		interface RF230Config;
 		interface Tasklet;
 		interface RadioAlarm;
 
-		async event void lastTouch(message_t* msg);
-
 #ifdef RF230_DEBUG
 		interface DiagMsg;
 #endif
@@ -390,6 +391,7 @@ implementation
 		uint8_t length;
 		uint8_t* data;
 		uint8_t header;
+		uint32_t time32;
 
 		if( cmd != CMD_NONE || state != STATE_RX_ON || ! isSpiAcquired() || radioIrq )
 			return EBUSY;
@@ -410,6 +412,8 @@ implementation
 			writeRegister(RF230_PHY_TX_PWR, RF230_TX_AUTO_CRC_ON | txPower);
 		}
 
+		time32 = call LocalTime.get();
+
 		// we have missed an incoming message in this short amount of time
 		if( (readRegister(RF230_TRX_STATUS) & RF230_TRX_STATUS_MASK) != RF230_PLL_ON )
 		{
@@ -446,14 +450,16 @@ implementation
 
 		length -= header;
 
-		// first upload the header
+		// first upload the header to gain some time
 		do {
 			call HplRF230.spiSplitReadWrite(*(data++));
 		}
 		while( --header != 0 );
 
-		call PacketTimeStamp.set(msg, time);
-		signal lastTouch(msg);
+		time32 += (int16_t)(time) - (int16_t)(time32);
+
+		if( call PacketTimeSyncOffset.isSet(msg) )
+			((timesync_footer_t*)(msg->data + call PacketTimeSyncOffset.get(msg)))->time_offset += time32;
 
 		do {
 			call HplRF230.spiSplitReadWrite(*(data++));
@@ -492,6 +498,11 @@ implementation
 		}
 #endif
 
+		if( call PacketTimeSyncOffset.isSet(msg) )
+			((timesync_footer_t*)(msg->data + call PacketTimeSyncOffset.get(msg)))->time_offset -= time32;
+
+		call PacketTimeStamp.set(msg, time32);
+
 		// wait for the TRX_END interrupt
 		state = STATE_BUSY_TX_2_RX_ON;
 		cmd = CMD_TRANSMIT;
@@ -587,7 +598,7 @@ implementation
 			length = call RF230Config.getLength(rxMsg);
 
 			call DiagMsg.str("rx");
-			call DiagMsg.uint16(call PacketTimeStamp.isSet(rxMsg) ? call PacketTimeStamp.get(rxMsg) : 0);
+			call DiagMsg.uint32(call PacketTimeStamp.isValid(rxMsg) ? call PacketTimeStamp.timestamp(rxMsg) : 0);
 			call DiagMsg.uint16(call RadioAlarm.getNow());
 			call DiagMsg.uint8(crc != 0);
 			call DiagMsg.uint8(length);
@@ -623,6 +634,7 @@ implementation
 		if( isSpiAcquired() )
 		{
 			uint16_t time;
+			uint32_t time32;
 			uint8_t irq;
 			uint8_t temp;
 			
@@ -702,7 +714,11 @@ implementation
 					 * CMD_TRANSMIT.
 					 */
 					if( irq == RF230_IRQ_RX_START ) // just to be cautious
-						call PacketTimeStamp.set(rxMsg, time - RX_SFD_DELAY);
+					{
+						time32 = call LocalTime.get();
+						time32 += (int16_t)(time - RX_SFD_DELAY) - (int16_t)(time32);
+						call PacketTimeStamp.set(rxMsg, time32);
+					}
 					else
 						call PacketTimeStamp.clear(rxMsg);