event based mote interfaces + reimplemented cross level functionality for TR1001
This commit is contained in:
parent
c59fc91487
commit
1c22bf5151
|
@ -26,7 +26,7 @@
|
|||
* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
|
||||
* SUCH DAMAGE.
|
||||
*
|
||||
* $Id: SkyByteRadio.java,v 1.11 2009/05/04 15:34:00 fros4943 Exp $
|
||||
* $Id: SkyByteRadio.java,v 1.12 2009/05/26 14:33:30 fros4943 Exp $
|
||||
*/
|
||||
|
||||
package se.sics.cooja.mspmote.interfaces;
|
||||
|
@ -74,7 +74,6 @@ public class SkyByteRadio extends Radio implements CustomDataRadio {
|
|||
private boolean isTransmitting = false;
|
||||
|
||||
private boolean isReceiving = false;
|
||||
// private boolean hasFailedReception = false;
|
||||
|
||||
private CC2420RadioByte lastOutgoingByte = null;
|
||||
|
||||
|
@ -84,10 +83,6 @@ public class SkyByteRadio extends Radio implements CustomDataRadio {
|
|||
|
||||
private RadioPacket lastIncomingPacket = null;
|
||||
|
||||
// private int mode;
|
||||
|
||||
//TODO: HW on/off
|
||||
|
||||
public SkyByteRadio(Mote mote) {
|
||||
this.mote = (SkyMote) mote;
|
||||
this.cc2420 = this.mote.skyNode.radio;
|
||||
|
@ -167,15 +162,14 @@ public class SkyByteRadio extends Radio implements CustomDataRadio {
|
|||
|
||||
private byte[] crossBufferedData = null;
|
||||
|
||||
private TimeEvent receiveCrosslevelDataEvent = new TimeEvent(0) {
|
||||
private TimeEvent deliverPacketDataEvent = new TimeEvent(0) {
|
||||
public void execute(long t) {
|
||||
|
||||
if (crossBufferedData == null) {
|
||||
return;
|
||||
}
|
||||
|
||||
/*logger.info("Radio is now ready to receive the incoming data");*/
|
||||
|
||||
/*logger.info("Delivering buffered packet data now: " + mote.getSimulation().getSimulationTime());*/
|
||||
for (byte b: crossBufferedData) {
|
||||
cc2420.receivedByte(b);
|
||||
}
|
||||
|
@ -185,31 +179,32 @@ public class SkyByteRadio extends Radio implements CustomDataRadio {
|
|||
|
||||
private StateListener cc2420StateListener = new StateListener() {
|
||||
public void newState(RadioState state) {
|
||||
if (cc2420.getState() == CC2420.RadioState.RX_SFD_SEARCH) {
|
||||
if (cc2420.getState() != CC2420.RadioState.RX_SFD_SEARCH) {
|
||||
return;
|
||||
}
|
||||
|
||||
cc2420.setStateListener(null);
|
||||
|
||||
if (crossBufferedData == null) {
|
||||
return;
|
||||
}
|
||||
|
||||
/* Receive data very soon (just wait for a radio flush) */
|
||||
mote.getSimulation().scheduleEvent(
|
||||
receiveCrosslevelDataEvent,
|
||||
mote.getSimulation().getSimulationTime()+1
|
||||
);
|
||||
/*logger.info("Radio was turned on! Short delay before transmitting buffered data: " + mote.getSimulation().getSimulationTime());*/
|
||||
|
||||
}
|
||||
/* Deliver data after the radio drivers flush */
|
||||
mote.getSimulation().scheduleEvent(
|
||||
deliverPacketDataEvent,
|
||||
mote.getSimulation().getSimulationTime()+Simulation.MILLISECOND/3
|
||||
);
|
||||
}
|
||||
};
|
||||
|
||||
public void setReceivedPacket(RadioPacket packet) {
|
||||
lastIncomingPacket = packet;
|
||||
|
||||
/* TODO Receiving all bytes at the same time ok? */
|
||||
byte[] packetData = CC2420RadioPacketConverter.fromCoojaToCC2420(packet);
|
||||
|
||||
if (cc2420.getState() != CC2420.RadioState.RX_SFD_SEARCH) {
|
||||
/*logger.info("Radio is not currently active. Let's wait some...");*/
|
||||
/*logger.info("Radio is turned off. Buffering data.");*/
|
||||
|
||||
crossBufferedData = packetData;
|
||||
cc2420.setStateListener(cc2420StateListener);
|
||||
|
@ -218,6 +213,7 @@ public class SkyByteRadio extends Radio implements CustomDataRadio {
|
|||
return;
|
||||
}
|
||||
|
||||
/* Delivering data immediately */
|
||||
for (byte b: packetData) {
|
||||
cc2420.receivedByte(b);
|
||||
}
|
||||
|
|
|
@ -26,7 +26,7 @@
|
|||
* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
|
||||
* SUCH DAMAGE.
|
||||
*
|
||||
* $Id: TR1001Radio.java,v 1.12 2009/04/16 14:28:12 fros4943 Exp $
|
||||
* $Id: TR1001Radio.java,v 1.13 2009/05/26 14:33:30 fros4943 Exp $
|
||||
*/
|
||||
|
||||
package se.sics.cooja.mspmote.interfaces;
|
||||
|
@ -52,19 +52,23 @@ import se.sics.cooja.mspmote.ESBMote;
|
|||
* @author Fredrik Osterlind
|
||||
*/
|
||||
@ClassDescription("TR1001 Radio")
|
||||
public class TR1001Radio extends Radio implements USARTListener, CustomDataRadio {
|
||||
public class TR1001Radio extends Radio implements USARTListener,
|
||||
CustomDataRadio {
|
||||
private static Logger logger = Logger.getLogger(TR1001Radio.class);
|
||||
|
||||
/**
|
||||
* Minimum delay in CPU cycles between each byte fed to USART.
|
||||
* Delay used when feeding packet data to radio chip (us). 416us corresponds
|
||||
* to 19200 bit/s with encoding.
|
||||
*/
|
||||
public static final long CYCLES_BETWEEN_BYTES = 1200; /* ~19.200 bps */
|
||||
public static final long DELAY_BETWEEN_BYTES = 3 * 416;
|
||||
|
||||
private ESBMote mote;
|
||||
|
||||
private boolean radioOn = true;
|
||||
|
||||
private boolean transmitting = false;
|
||||
private boolean isTransmitting = false;
|
||||
|
||||
private boolean isReceiving = false;
|
||||
|
||||
private boolean isInterfered = false;
|
||||
|
||||
|
@ -74,7 +78,7 @@ public class TR1001Radio extends Radio implements USARTListener, CustomDataRadio
|
|||
|
||||
private USART radioUSART = null;
|
||||
|
||||
private RadioPacket packetToMote = null;
|
||||
private RadioPacket lastIncomingPacket = null;
|
||||
|
||||
private RadioPacket packetFromMote = null;
|
||||
|
||||
|
@ -83,27 +87,15 @@ public class TR1001Radio extends Radio implements USARTListener, CustomDataRadio
|
|||
|
||||
private int outgoingDataLength = 0;
|
||||
|
||||
private int ticksSinceLastSend = -1;
|
||||
|
||||
/* Incoming byte-to-packet data buffer */
|
||||
private Vector<Byte> bufferedBytes = new Vector<Byte>();
|
||||
|
||||
private Vector<Long> bufferedByteDelays = new Vector<Long>();
|
||||
private int millisSinceLastSend = -1;
|
||||
|
||||
/* Outgoing byte data buffer */
|
||||
private TR1001RadioByte tr1001ByteFromMote = null;
|
||||
|
||||
private TR1001RadioByte tr1001ByteToMote = null;
|
||||
private TR1001RadioByte lastIncomingByte = null;
|
||||
|
||||
private long transmissionStartCycles = -1;
|
||||
|
||||
/* Incoming byte data buffer */
|
||||
private byte lastDeliveredByte = -1;
|
||||
|
||||
private long lastDeliveredByteTimestamp = -1;
|
||||
|
||||
private long lastDeliveredByteDelay = -1;
|
||||
|
||||
private TR1001RadioPacketConverter tr1001PacketConverter = null;
|
||||
|
||||
private double signalStrength = 0;
|
||||
|
@ -133,28 +125,34 @@ public class TR1001Radio extends Radio implements USARTListener, CustomDataRadio
|
|||
}
|
||||
|
||||
public RadioPacket getLastPacketReceived() {
|
||||
return packetToMote;
|
||||
return lastIncomingPacket;
|
||||
}
|
||||
|
||||
public void setReceivedPacket(RadioPacket packet) {
|
||||
packetToMote = packet;
|
||||
if (packetToMote.getPacketData() == null || packetToMote.getPacketData().length == 0) {
|
||||
logger.fatal("Received null packet");
|
||||
return;
|
||||
}
|
||||
|
||||
if (isInterfered) {
|
||||
logger.fatal("Received packet when interfered");
|
||||
return;
|
||||
}
|
||||
lastIncomingPacket = packet;
|
||||
|
||||
/* Convert to TR1001 packet data */
|
||||
TR1001RadioByte[] tr1001bytes = TR1001RadioPacketConverter.fromCoojaToTR1001(packetToMote);
|
||||
|
||||
/* Feed to the CPU "slowly" */
|
||||
for (TR1001RadioByte b : tr1001bytes) {
|
||||
receiveCustomData(b);
|
||||
TR1001RadioByte[] byteArr = TR1001RadioPacketConverter.fromCoojaToTR1001(packet);
|
||||
final ArrayList<TR1001RadioByte> byteList = new ArrayList<TR1001RadioByte>();
|
||||
for (TR1001RadioByte b : byteArr) {
|
||||
byteList.add(b);
|
||||
}
|
||||
|
||||
/* Feed incoming bytes to radio "slowly" via time events */
|
||||
TimeEvent receiveCrosslevelDataEvent = new TimeEvent(0) {
|
||||
public void execute(long t) {
|
||||
/* Stop receiving data when buffer is empty */
|
||||
if (byteList.isEmpty() || isInterfered) {
|
||||
return;
|
||||
}
|
||||
|
||||
TR1001RadioByte b = byteList.remove(0);
|
||||
radioUSART.byteReceived(b.getByte());
|
||||
|
||||
mote.getSimulation().scheduleEvent(this, t + DELAY_BETWEEN_BYTES);
|
||||
}
|
||||
};
|
||||
receiveCrosslevelDataEvent.execute(mote.getSimulation().getSimulationTime());
|
||||
}
|
||||
|
||||
/* Custom data radio support */
|
||||
|
@ -163,84 +161,32 @@ public class TR1001Radio extends Radio implements USARTListener, CustomDataRadio
|
|||
}
|
||||
|
||||
public Object getLastCustomDataReceived() {
|
||||
return tr1001ByteToMote;
|
||||
return lastIncomingByte;
|
||||
}
|
||||
|
||||
public void receiveCustomData(Object data) {
|
||||
if (data instanceof TR1001RadioByte) {
|
||||
tr1001ByteToMote = ((TR1001RadioByte) data);
|
||||
|
||||
bufferedBytes.add(tr1001ByteToMote.getByte());
|
||||
bufferedByteDelays.add(tr1001ByteToMote.getDelay());
|
||||
}
|
||||
}
|
||||
|
||||
/**
|
||||
* @return True if undelivered bytes exist.
|
||||
*/
|
||||
public boolean hasPendingBytes() {
|
||||
return bufferedBytes.size() > 0;
|
||||
}
|
||||
|
||||
/**
|
||||
* If non-delivered bytes exist, tries to deliver one byte to the CPU by
|
||||
* checking USART receive flag.
|
||||
*
|
||||
* @param cycles
|
||||
* Current CPU cycles
|
||||
*/
|
||||
public void tryDeliverNextByte(long cycles) {
|
||||
// Check that pending bytes exist
|
||||
if (!hasPendingBytes()) {
|
||||
return;
|
||||
}
|
||||
|
||||
// Check if time to deliver byte
|
||||
long nextByteDelay = bufferedByteDelays.firstElement();
|
||||
if (cycles - lastDeliveredByteDelay < nextByteDelay) {
|
||||
return;
|
||||
}
|
||||
|
||||
lastDeliveredByte = bufferedBytes.firstElement();
|
||||
|
||||
bufferedBytes.remove(0);
|
||||
bufferedByteDelays.remove(0);
|
||||
lastIncomingByte = ((TR1001RadioByte) data);
|
||||
|
||||
if (radioUSART.isReceiveFlagCleared()) {
|
||||
//logger.info(nextByteDelay + " < "
|
||||
// + (cycles - receptionStartedCycles)
|
||||
// + ":\tDelivering 0x" + Utils.hex8(lastDeliveredByte) + " (TODO="
|
||||
// + bufferedBytes.size() + ")");
|
||||
radioUSART.byteReceived(lastDeliveredByte);
|
||||
/*logger.info("----- TR1001 RECEIVED BYTE -----");*/
|
||||
radioUSART.byteReceived(lastIncomingByte.getByte());
|
||||
} else {
|
||||
/*logger.fatal(nextByteDelay + " < "
|
||||
+ (cycles - receptionStartedCycles)
|
||||
+ ":\tDROPPING 0x" + Utils.hex8(lastDeliveredByte) + " (TODO="
|
||||
+ bufferedBytes.size() + ")");*/
|
||||
logger.warn("----- TR1001 RECEIVED BYTE DROPPED -----");
|
||||
}
|
||||
}
|
||||
lastDeliveredByteDelay = cycles;
|
||||
|
||||
// /* TODO BUG: Resends last byte, interrupt lost somewhere? */
|
||||
// else if (cycles > lastDeliveredByteTimestamp + CYCLES_BETWEEN_BYTES) {
|
||||
// logger.warn("0x" + Utils.hex16((int) cycles) + ":\tRedelivering 0x"
|
||||
// + Utils.hex8(lastDeliveredByte) + " (TODO=" + bufferedBytes.size()
|
||||
// + ")");
|
||||
// radioUSART.byteReceived(lastDeliveredByte);
|
||||
// lastDeliveredByteTimestamp = cycles;
|
||||
// }
|
||||
}
|
||||
|
||||
/* USART listener support */
|
||||
public void dataReceived(USART source, int data) {
|
||||
if (outgoingDataLength == 0 && !isTransmitting()) {
|
||||
/* New transmission discovered */
|
||||
/*logger.debug("----- NEW TR1001 TRANSMISSION DETECTED -----");*/
|
||||
/*logger.info("----- NEW TR1001 TRANSMISSION DETECTED -----");*/
|
||||
tr1001PacketConverter = new TR1001RadioPacketConverter();
|
||||
|
||||
transmitting = true;
|
||||
isTransmitting = true;
|
||||
|
||||
transmissionStartCycles = mote.getCPU().cycles;
|
||||
lastDeliveredByteTimestamp = transmissionStartCycles;
|
||||
|
||||
lastEvent = RadioEvent.TRANSMISSION_STARTED;
|
||||
lastEventTime = mote.getSimulation().getSimulationTime();
|
||||
|
@ -249,33 +195,35 @@ public class TR1001Radio extends Radio implements USARTListener, CustomDataRadio
|
|||
}
|
||||
|
||||
// Remember recent radio activity
|
||||
ticksSinceLastSend = 0;
|
||||
mote.getSimulation().scheduleEvent(followupTransmissionEvent, mote.getSimulation().getSimulationTime()+1);
|
||||
millisSinceLastSend = 0;
|
||||
mote.getSimulation().scheduleEvent(
|
||||
followupTransmissionEvent,
|
||||
mote.getSimulation().getSimulationTime() + Simulation.MILLISECOND);
|
||||
|
||||
if (outgoingDataLength >= outgoingData.length) {
|
||||
logger.fatal("Ignoring byte due to buffer overflow");
|
||||
logger.warn("----- TR1001 DROPPING OUTGOING BYTE (buffer overflow) -----");
|
||||
return;
|
||||
}
|
||||
|
||||
// Deliver byte to radio medium as custom data
|
||||
/*logger.debug("----- TR1001 DELIVERED BYTE -----");*/
|
||||
/* logger.debug("----- TR1001 SENT BYTE -----"); */
|
||||
lastEvent = RadioEvent.CUSTOM_DATA_TRANSMITTED;
|
||||
tr1001ByteFromMote = new TR1001RadioByte((byte) data, mote.getCPU().cycles - lastDeliveredByteTimestamp);
|
||||
tr1001ByteFromMote = new TR1001RadioByte((byte) data);
|
||||
this.setChanged();
|
||||
this.notifyObservers();
|
||||
|
||||
lastDeliveredByteTimestamp = mote.getCPU().cycles;
|
||||
outgoingData[outgoingDataLength++] = tr1001ByteFromMote;
|
||||
|
||||
// Feed to application level immediately
|
||||
boolean finished = tr1001PacketConverter.fromTR1001ToCoojaAccumulated(tr1001ByteFromMote);
|
||||
boolean finished = tr1001PacketConverter
|
||||
.fromTR1001ToCoojaAccumulated(tr1001ByteFromMote);
|
||||
if (finished) {
|
||||
/* Transmission finished - deliver packet immediately */
|
||||
if (tr1001PacketConverter.accumulatedConversionIsOk()) {
|
||||
packetFromMote = tr1001PacketConverter.getAccumulatedConvertedCoojaPacket();
|
||||
|
||||
/* Notify observers of new prepared packet */
|
||||
/*logger.debug("----- TR1001 DELIVERED PACKET -----");*/
|
||||
/* logger.info("----- TR1001 DELIVERED PACKET -----"); */
|
||||
lastEvent = RadioEvent.PACKET_TRANSMITTED;
|
||||
this.setChanged();
|
||||
this.notifyObservers();
|
||||
|
@ -283,15 +231,15 @@ public class TR1001Radio extends Radio implements USARTListener, CustomDataRadio
|
|||
|
||||
// Reset counters and wait for next packet
|
||||
outgoingDataLength = 0;
|
||||
ticksSinceLastSend = -1;
|
||||
millisSinceLastSend = -1;
|
||||
|
||||
// Signal we are done transmitting
|
||||
transmitting = false;
|
||||
isTransmitting = false;
|
||||
lastEvent = RadioEvent.TRANSMISSION_FINISHED;
|
||||
this.setChanged();
|
||||
this.notifyObservers();
|
||||
|
||||
/*logger.debug("----- TR1001 TRANSMISSION ENDED -----");*/
|
||||
/* logger.info("----- TR1001 TRANSMISSION ENDED -----"); */
|
||||
}
|
||||
}
|
||||
|
||||
|
@ -300,11 +248,11 @@ public class TR1001Radio extends Radio implements USARTListener, CustomDataRadio
|
|||
|
||||
/* General radio support */
|
||||
public boolean isTransmitting() {
|
||||
return transmitting;
|
||||
return isTransmitting;
|
||||
}
|
||||
|
||||
public boolean isReceiving() {
|
||||
return hasPendingBytes();
|
||||
return isReceiving;
|
||||
}
|
||||
|
||||
public boolean isInterfered() {
|
||||
|
@ -317,18 +265,14 @@ public class TR1001Radio extends Radio implements USARTListener, CustomDataRadio
|
|||
|
||||
public void signalReceptionStart() {
|
||||
lastEvent = RadioEvent.RECEPTION_STARTED;
|
||||
/*receptionStartedCycles = mspMote.getCPU().cycles;*/
|
||||
isReceiving = true;
|
||||
this.setChanged();
|
||||
this.notifyObservers();
|
||||
}
|
||||
|
||||
public void signalReceptionEnd() {
|
||||
// TODO Should be done according to serial port instead
|
||||
// TODO Compare times with OS abstraction level
|
||||
if (isInterfered()) {
|
||||
isInterfered = false;
|
||||
return;
|
||||
}
|
||||
isReceiving = false;
|
||||
lastEvent = RadioEvent.RECEPTION_FINISHED;
|
||||
this.setChanged();
|
||||
this.notifyObservers();
|
||||
|
@ -341,12 +285,11 @@ public class TR1001Radio extends Radio implements USARTListener, CustomDataRadio
|
|||
public void interfereAnyReception() {
|
||||
if (!isInterfered()) {
|
||||
isInterfered = true;
|
||||
lastIncomingPacket = null;
|
||||
|
||||
bufferedBytes.clear();
|
||||
bufferedByteDelays.clear();
|
||||
|
||||
lastEvent = RadioEvent.RECEPTION_INTERFERED;
|
||||
lastEventTime = mote.getSimulation().getSimulationTime();
|
||||
lastEvent = RadioEvent.RECEPTION_INTERFERED;
|
||||
/*logger.info("----- TR1001 RECEPTION INTERFERED -----");*/
|
||||
this.setChanged();
|
||||
this.notifyObservers();
|
||||
}
|
||||
|
@ -382,19 +325,19 @@ public class TR1001Radio extends Radio implements USARTListener, CustomDataRadio
|
|||
public void execute(long t) {
|
||||
|
||||
if (isTransmitting()) {
|
||||
ticksSinceLastSend++;
|
||||
millisSinceLastSend++;
|
||||
|
||||
// Detect transmission end due to inactivity
|
||||
if (ticksSinceLastSend > 4) {
|
||||
if (millisSinceLastSend > 5) {
|
||||
/* Dropping packet due to inactivity */
|
||||
packetFromMote = null;
|
||||
|
||||
/* Reset counters and wait for next packet */
|
||||
outgoingDataLength = 0;
|
||||
ticksSinceLastSend = -1;
|
||||
millisSinceLastSend = -1;
|
||||
|
||||
/* Signal we are done transmitting */
|
||||
transmitting = false;
|
||||
isTransmitting = false;
|
||||
lastEvent = RadioEvent.TRANSMISSION_FINISHED;
|
||||
TR1001Radio.this.setChanged();
|
||||
TR1001Radio.this.notifyObservers();
|
||||
|
@ -403,7 +346,7 @@ public class TR1001Radio extends Radio implements USARTListener, CustomDataRadio
|
|||
}
|
||||
|
||||
/* Reschedule as long as node is transmitting */
|
||||
mote.getSimulation().scheduleEvent(this, t+1);
|
||||
mote.getSimulation().scheduleEvent(this, t + Simulation.MILLISECOND);
|
||||
}
|
||||
}
|
||||
};
|
||||
|
@ -440,7 +383,9 @@ public class TR1001Radio extends Radio implements USARTListener, CustomDataRadio
|
|||
|
||||
updateButton.addActionListener(new ActionListener() {
|
||||
public void actionPerformed(ActionEvent e) {
|
||||
powerLabel.setText(getCurrentOutputPower() + " dBm (indicator=" + getCurrentOutputPowerIndicator() + "/" + getOutputPowerIndicatorMax() + ")");
|
||||
powerLabel.setText(getCurrentOutputPower() + " dBm (indicator="
|
||||
+ getCurrentOutputPowerIndicator() + "/"
|
||||
+ getOutputPowerIndicatorMax() + ")");
|
||||
ssLabel.setText(getCurrentSignalStrength() + " dBm");
|
||||
}
|
||||
});
|
||||
|
@ -460,7 +405,9 @@ public class TR1001Radio extends Radio implements USARTListener, CustomDataRadio
|
|||
|
||||
lastEventLabel.setText(lastEvent + " @ time=" + lastEventTime);
|
||||
|
||||
powerLabel.setText(getCurrentOutputPower() + " dBm (indicator=" + getCurrentOutputPowerIndicator() + "/" + getOutputPowerIndicatorMax() + ")");
|
||||
powerLabel.setText(getCurrentOutputPower() + " dBm (indicator="
|
||||
+ getCurrentOutputPowerIndicator() + "/"
|
||||
+ getOutputPowerIndicatorMax() + ")");
|
||||
ssLabel.setText(getCurrentSignalStrength() + " dBm");
|
||||
}
|
||||
});
|
||||
|
|
|
@ -26,7 +26,7 @@
|
|||
* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
|
||||
* SUCH DAMAGE.
|
||||
*
|
||||
* $Id: TR1001RadioByte.java,v 1.1 2008/03/18 13:08:26 fros4943 Exp $
|
||||
* $Id: TR1001RadioByte.java,v 1.2 2009/05/26 14:33:30 fros4943 Exp $
|
||||
*/
|
||||
|
||||
package se.sics.cooja.mspmote.interfaces;
|
||||
|
@ -40,14 +40,11 @@ public class TR1001RadioByte {
|
|||
|
||||
private byte b;
|
||||
|
||||
private long delay;
|
||||
|
||||
/**
|
||||
* Creates new TR1001 radio byte
|
||||
*/
|
||||
public TR1001RadioByte(byte b, long delay) {
|
||||
public TR1001RadioByte(byte b) {
|
||||
this.b = b;
|
||||
this.delay = delay;
|
||||
}
|
||||
|
||||
/**
|
||||
|
@ -57,11 +54,4 @@ public class TR1001RadioByte {
|
|||
return b;
|
||||
}
|
||||
|
||||
/**
|
||||
* @return Cycle delay since previous byte
|
||||
*/
|
||||
public long getDelay() {
|
||||
return delay;
|
||||
}
|
||||
|
||||
}
|
||||
|
|
|
@ -26,14 +26,16 @@
|
|||
* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
|
||||
* SUCH DAMAGE.
|
||||
*
|
||||
* $Id: TR1001RadioPacketConverter.java,v 1.3 2008/03/18 16:55:44 fros4943 Exp $
|
||||
* $Id: TR1001RadioPacketConverter.java,v 1.4 2009/05/26 14:33:30 fros4943 Exp $
|
||||
*/
|
||||
|
||||
package se.sics.cooja.mspmote.interfaces;
|
||||
|
||||
import java.util.ArrayList;
|
||||
import org.apache.log4j.Logger;
|
||||
|
||||
import se.sics.cooja.COOJARadioPacket;
|
||||
import se.sics.cooja.ConvertedRadioPacket;
|
||||
import se.sics.cooja.RadioPacket;
|
||||
|
||||
/**
|
||||
|
@ -66,6 +68,7 @@ public class TR1001RadioPacketConverter {
|
|||
|
||||
final static int ESB_FOOTER_LENGTH = 2;
|
||||
|
||||
private ArrayList<TR1001RadioByte> originalData = new ArrayList<TR1001RadioByte>();
|
||||
|
||||
private enum AccumulatedConversionState {
|
||||
TR1001_PREAMBLE, TR1001_SYNCH, ESB_LEN1, ESB_LEN2, ESB_DATA, ESB_CRC1, ESB_CRC2, ESB_POST,
|
||||
|
@ -141,7 +144,7 @@ public class TR1001RadioPacketConverter {
|
|||
|
||||
TR1001RadioByte[] tr1001Bytes = new TR1001RadioByte[tr1001Frame.length];
|
||||
for (int i=0; i < tr1001Frame.length; i++) {
|
||||
tr1001Bytes[i] = new TR1001RadioByte(tr1001Frame[i], TR1001Radio.CYCLES_BETWEEN_BYTES);
|
||||
tr1001Bytes[i] = new TR1001RadioByte(tr1001Frame[i]);
|
||||
}
|
||||
return tr1001Bytes;
|
||||
}
|
||||
|
@ -160,7 +163,7 @@ public class TR1001RadioPacketConverter {
|
|||
* @param tr1001DataLength TR1001 specified packet length
|
||||
* @return COOJA radio packet
|
||||
*/
|
||||
public static RadioPacket fromTR1001ToCooja(TR1001RadioByte[] tr1001Bytes, int tr1001DataLength) {
|
||||
public static ConvertedRadioPacket fromTR1001ToCooja(TR1001RadioByte[] tr1001Bytes, int tr1001DataLength) {
|
||||
|
||||
byte[] tr1001Data = new byte[tr1001Bytes.length];
|
||||
for (int i=0; i < tr1001Bytes.length; i++) {
|
||||
|
@ -192,11 +195,11 @@ public class TR1001RadioPacketConverter {
|
|||
System.arraycopy(decodedData, ESB_HEADER_LENGTH, packetData, 0,
|
||||
dataLength);
|
||||
|
||||
return new COOJARadioPacket(packetData);
|
||||
return new ConvertedRadioPacket(packetData, tr1001Data);
|
||||
}
|
||||
|
||||
logger.fatal("Error when converting emulated to application level, returning null packet");
|
||||
return null;
|
||||
logger.warn("No cross-level conversion available: TR1001 GCR decoding failed");
|
||||
return new ConvertedRadioPacket(new byte[0], tr1001Data);
|
||||
}
|
||||
|
||||
/**
|
||||
|
@ -241,6 +244,7 @@ public class TR1001RadioPacketConverter {
|
|||
*/
|
||||
public boolean fromTR1001ToCoojaAccumulated(TR1001RadioByte tr1001Byte) {
|
||||
byte b = tr1001Byte.getByte();
|
||||
originalData.add(tr1001Byte);
|
||||
|
||||
if (accumulatedConversionState == AccumulatedConversionState.TR1001_PREAMBLE) {
|
||||
if (b == (byte) 0xaa || b == (byte) 0xff) {
|
||||
|
@ -311,12 +315,18 @@ public class TR1001RadioPacketConverter {
|
|||
/**
|
||||
* @return Converted data (application level)
|
||||
*/
|
||||
public RadioPacket getAccumulatedConvertedCoojaPacket() {
|
||||
public ConvertedRadioPacket getAccumulatedConvertedCoojaPacket() {
|
||||
byte[] dataArrayByte = new byte[accumulatedConversionDataArray.length];
|
||||
for (int i=0; i < accumulatedConversionDataArray.length; i++) {
|
||||
dataArrayByte[i] = (byte) accumulatedConversionDataArray[i];
|
||||
}
|
||||
return new COOJARadioPacket(dataArrayByte);
|
||||
|
||||
byte[] originalArr = new byte[originalData.size()];
|
||||
for (int i=0; i < originalArr.length; i++) {
|
||||
originalArr[i] = (byte) originalData.get(i).getByte();
|
||||
}
|
||||
|
||||
return new ConvertedRadioPacket(dataArrayByte, originalArr);
|
||||
}
|
||||
|
||||
/**
|
||||
|
|
Loading…
Reference in a new issue