mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-26 16:53:34 +08:00
RX frames have two timestamps: monotonic - for protocol timings management; utc - for application-level timestamping
This commit is contained in:
@@ -34,7 +34,7 @@ struct RxFrameGenerator
|
||||
uavcan::RxFrame frm;
|
||||
|
||||
frm.iface_index = iface_index;
|
||||
frm.timestamp = timestamp;
|
||||
frm.ts_monotonic = timestamp;
|
||||
|
||||
frm.data_type_id = data_type_id;
|
||||
frm.frame_index = frame_index;
|
||||
@@ -110,14 +110,14 @@ TEST(TransferReceiver, Basic)
|
||||
* Empty
|
||||
*/
|
||||
ASSERT_EQ(TransferReceiver::DEFAULT_TRANSFER_INTERVAL, rcv.getInterval());
|
||||
ASSERT_EQ(0, rcv.getLastTransferTimestamp());
|
||||
ASSERT_EQ(0, rcv.getLastTransferTimestampMonotonic());
|
||||
|
||||
/*
|
||||
* Single frame transfer with zero ts, must be ignored
|
||||
*/
|
||||
CHECK_NOT_COMPLETE(rcv.addFrame(gen(0, "Foo", 0, true, 0, 0)));
|
||||
ASSERT_EQ(TransferReceiver::DEFAULT_TRANSFER_INTERVAL, rcv.getInterval());
|
||||
ASSERT_EQ(0, rcv.getLastTransferTimestamp());
|
||||
ASSERT_EQ(0, rcv.getLastTransferTimestampMonotonic());
|
||||
|
||||
/*
|
||||
* Valid compound transfer
|
||||
@@ -128,7 +128,7 @@ TEST(TransferReceiver, Basic)
|
||||
|
||||
ASSERT_TRUE(matchBufferContent(bufmgr.access(gen.bufmgr_key), "12345678foo"));
|
||||
ASSERT_EQ(TransferReceiver::DEFAULT_TRANSFER_INTERVAL, rcv.getInterval()); // Not initialized yet
|
||||
ASSERT_EQ(100, rcv.getLastTransferTimestamp());
|
||||
ASSERT_EQ(100, rcv.getLastTransferTimestampMonotonic());
|
||||
|
||||
/*
|
||||
* Compound transfer mixed with invalid frames; buffer was not released explicitly
|
||||
@@ -146,7 +146,7 @@ TEST(TransferReceiver, Basic)
|
||||
ASSERT_TRUE(matchBufferContent(bufmgr.access(gen.bufmgr_key), "12345678abcdefgh"));
|
||||
ASSERT_GT(TransferReceiver::DEFAULT_TRANSFER_INTERVAL, rcv.getInterval());
|
||||
ASSERT_LT(TransferReceiver::MIN_TRANSFER_INTERVAL, rcv.getInterval());
|
||||
ASSERT_EQ(1000, rcv.getLastTransferTimestamp());
|
||||
ASSERT_EQ(1000, rcv.getLastTransferTimestampMonotonic());
|
||||
ASSERT_FALSE(rcv.isTimedOut(1000));
|
||||
ASSERT_FALSE(rcv.isTimedOut(5000));
|
||||
ASSERT_TRUE(rcv.isTimedOut(60000000));
|
||||
@@ -160,10 +160,10 @@ TEST(TransferReceiver, Basic)
|
||||
|
||||
ASSERT_FALSE(bufmgr.access(gen.bufmgr_key)); // Buffer must be removed
|
||||
ASSERT_GT(TransferReceiver::DEFAULT_TRANSFER_INTERVAL, rcv.getInterval());
|
||||
ASSERT_EQ(2200, rcv.getLastTransferTimestamp());
|
||||
ASSERT_EQ(2200, rcv.getLastTransferTimestampMonotonic());
|
||||
|
||||
CHECK_SINGLE_FRAME(rcv.addFrame(gen(0, "", 0, true, 3, 2500)));
|
||||
ASSERT_EQ(2500, rcv.getLastTransferTimestamp());
|
||||
ASSERT_EQ(2500, rcv.getLastTransferTimestampMonotonic());
|
||||
|
||||
CHECK_NOT_COMPLETE(rcv.addFrame(gen(0, "", 0, true, 0, 3000))); // Old TID
|
||||
CHECK_NOT_COMPLETE(rcv.addFrame(gen(0, "", 0, true, 15,3100))); // Old TID
|
||||
@@ -172,32 +172,32 @@ TEST(TransferReceiver, Basic)
|
||||
CHECK_NOT_COMPLETE(rcv.addFrame(gen(1, "", 0, true, 15,3400))); // Old TID, wrong iface
|
||||
CHECK_NOT_COMPLETE(rcv.addFrame(gen(1, "", 0, true, 3, 3500))); // Old TID, wrong iface
|
||||
CHECK_SINGLE_FRAME(rcv.addFrame(gen(0, "", 0, true, 8, 3600)));
|
||||
ASSERT_EQ(3600, rcv.getLastTransferTimestamp());
|
||||
ASSERT_EQ(3600, rcv.getLastTransferTimestampMonotonic());
|
||||
|
||||
/*
|
||||
* Timeouts
|
||||
*/
|
||||
CHECK_NOT_COMPLETE(rcv.addFrame(gen(1, "qwe", 0, true, 9, 100000))); // Wrong iface - ignored
|
||||
CHECK_SINGLE_FRAME(rcv.addFrame(gen(1, "qwe", 0, true, 10, 600000))); // Accepted due to iface timeout
|
||||
ASSERT_EQ(600000, rcv.getLastTransferTimestamp());
|
||||
ASSERT_EQ(600000, rcv.getLastTransferTimestampMonotonic());
|
||||
|
||||
CHECK_NOT_COMPLETE(rcv.addFrame(gen(0, "qwe", 0, true, 11, 600100)));// Ignored - old iface 0
|
||||
CHECK_SINGLE_FRAME(rcv.addFrame(gen(1, "qwe", 0, true, 11, 600100)));
|
||||
ASSERT_EQ(600100, rcv.getLastTransferTimestamp());
|
||||
ASSERT_EQ(600100, rcv.getLastTransferTimestampMonotonic());
|
||||
|
||||
CHECK_NOT_COMPLETE(rcv.addFrame(gen(1, "qwe", 0, true, 11, 600100)));// Old TID
|
||||
CHECK_SINGLE_FRAME(rcv.addFrame(gen(0, "qwe", 0, true, 11, 100000000)));// Accepted - global timeout
|
||||
ASSERT_EQ(100000000, rcv.getLastTransferTimestamp());
|
||||
ASSERT_EQ(100000000, rcv.getLastTransferTimestampMonotonic());
|
||||
|
||||
CHECK_SINGLE_FRAME(rcv.addFrame(gen(0, "qwe", 0, true, 12, 100000100)));
|
||||
ASSERT_EQ(100000100, rcv.getLastTransferTimestamp());
|
||||
ASSERT_EQ(100000100, rcv.getLastTransferTimestampMonotonic());
|
||||
|
||||
ASSERT_TRUE(rcv.isTimedOut(900000000));
|
||||
CHECK_NOT_COMPLETE(rcv.addFrame(gen(1, "12345678", 0, false, 11, 900000000)));// Global timeout
|
||||
CHECK_NOT_COMPLETE(rcv.addFrame(gen(0, "12345678", 0, false, 11, 900000100)));// Wrong iface
|
||||
CHECK_NOT_COMPLETE(rcv.addFrame(gen(0, "qwe", 1, true, 11, 900000200)));// Wrong iface
|
||||
CHECK_COMPLETE( rcv.addFrame(gen(1, "qwe", 1, true, 11, 900000200)));
|
||||
ASSERT_EQ(900000000, rcv.getLastTransferTimestamp());
|
||||
ASSERT_EQ(900000000, rcv.getLastTransferTimestampMonotonic());
|
||||
ASSERT_FALSE(rcv.isTimedOut(1000));
|
||||
ASSERT_FALSE(rcv.isTimedOut(900000200));
|
||||
ASSERT_TRUE(rcv.isTimedOut(1000 * 1000000));
|
||||
@@ -231,7 +231,7 @@ TEST(TransferReceiver, OutOfBufferSpace_32bytes)
|
||||
CHECK_NOT_COMPLETE(rcv.addFrame(gen(1, "12345678", 3, false, 10, 100000300))); // 32
|
||||
CHECK_COMPLETE( rcv.addFrame(gen(1, "", 4, true, 10, 100000400))); // 32
|
||||
|
||||
ASSERT_EQ(100000000, rcv.getLastTransferTimestamp());
|
||||
ASSERT_EQ(100000000, rcv.getLastTransferTimestampMonotonic());
|
||||
ASSERT_TRUE(matchBufferContent(bufmgr.access(gen.bufmgr_key), "12345678123456781234567812345678"));
|
||||
|
||||
/*
|
||||
@@ -243,7 +243,7 @@ TEST(TransferReceiver, OutOfBufferSpace_32bytes)
|
||||
CHECK_NOT_COMPLETE(rcv.addFrame(gen(1, "12345678", 3, false, 11, 100001200))); // 32
|
||||
CHECK_NOT_COMPLETE(rcv.addFrame(gen(1, "12345678", 4, true, 11, 100001300))); // 40 // EOT, ignored - lost sync
|
||||
|
||||
ASSERT_EQ(100000000, rcv.getLastTransferTimestamp());
|
||||
ASSERT_EQ(100000000, rcv.getLastTransferTimestampMonotonic());
|
||||
ASSERT_FALSE(bufmgr.access(gen.bufmgr_key)); // Buffer should be removed
|
||||
}
|
||||
|
||||
@@ -262,7 +262,7 @@ TEST(TransferReceiver, UnterminatedTransfer)
|
||||
content += "12345678";
|
||||
}
|
||||
CHECK_COMPLETE(rcv.addFrame(gen(1, "12345678", uavcan::Frame::FRAME_INDEX_MAX, true, 0, 1100)));
|
||||
ASSERT_EQ(1000, rcv.getLastTransferTimestamp());
|
||||
ASSERT_EQ(1000, rcv.getLastTransferTimestampMonotonic());
|
||||
ASSERT_TRUE(matchBufferContent(bufmgr.access(gen.bufmgr_key), content));
|
||||
}
|
||||
|
||||
@@ -281,7 +281,7 @@ TEST(TransferReceiver, OutOfOrderFrames)
|
||||
CHECK_NOT_COMPLETE(rcv.addFrame(gen(1, "--------", 4, true, 10, 100000200))); // Out of order
|
||||
CHECK_COMPLETE( rcv.addFrame(gen(1, "abcd", 2, true, 10, 100000400)));
|
||||
|
||||
ASSERT_EQ(100000000, rcv.getLastTransferTimestamp());
|
||||
ASSERT_EQ(100000000, rcv.getLastTransferTimestampMonotonic());
|
||||
ASSERT_TRUE(matchBufferContent(bufmgr.access(gen.bufmgr_key), "12345678qwertyuiabcd"));
|
||||
}
|
||||
|
||||
@@ -304,7 +304,7 @@ TEST(TransferReceiver, IntervalMeasurement)
|
||||
CHECK_COMPLETE( rcv.addFrame(gen(1, "abcd", 2, true, tid.get(), timestamp)));
|
||||
|
||||
ASSERT_TRUE(matchBufferContent(bufmgr.access(gen.bufmgr_key), "12345678qwertyuiabcd"));
|
||||
ASSERT_EQ(timestamp, rcv.getLastTransferTimestamp());
|
||||
ASSERT_EQ(timestamp, rcv.getLastTransferTimestampMonotonic());
|
||||
|
||||
timestamp += INTERVAL;
|
||||
tid.increment();
|
||||
|
||||
Reference in New Issue
Block a user