public void put(RigidBodyTransform newestTransform, long timeStamp) { TimeStampedTransform3D recycledTimestampedTransformFromBuffer = buffer[currentIndex]; recycledTimestampedTransformFromBuffer.setTimeStamp(timeStamp); recycledTimestampedTransformFromBuffer.setTransform3D(newestTransform); newestTimestamp = timeStamp; currentIndex++; if (currentIndex >= size) { currentIndex = 0; filledBufferAtleastOnce = true; } if (oldestTimeStamp == Long.MAX_VALUE) { oldestTimeStamp = newestTimestamp; } else if(filledBufferAtleastOnce) { oldestTimeStamp = buffer[currentIndex].getTimeStamp(); } }
public void put(RigidBodyTransform newestTransform, long timeStamp) { TimeStampedTransform3D recycledTimestampedTransformFromBuffer = buffer[currentIndex]; recycledTimestampedTransformFromBuffer.setTimeStamp(timeStamp); recycledTimestampedTransformFromBuffer.setTransform3D(newestTransform); newestTimestamp = timeStamp; currentIndex++; if (currentIndex >= size) { currentIndex = 0; filledBufferAtleastOnce = true; } if (oldestTimeStamp == Long.MAX_VALUE) { oldestTimeStamp = newestTimestamp; } else if(filledBufferAtleastOnce) { oldestTimeStamp = buffer[currentIndex].getTimeStamp(); } }
public void set(TimeStampedTransform3D other) { setTransform3D(other.getTransform3D()); setTimeStamp(other.getTimeStamp()); }
public void set(TimeStampedTransform3D other) { setTransform3D(other.getTransform3D()); setTimeStamp(other.getTimeStamp()); }
public synchronized void addRawTransformAndTimestamp(long timestamp, RigidBodyTransform transform3D) { transforms[currentIndex].setTimeStamp(timestamp); transforms[currentIndex].setTransform3D(transform3D); newestTimestamp = timestamp; currentIndex++; if (currentIndex >= size) { currentIndex = 0; } if (transforms[currentIndex].getTimeStamp() == Long.MIN_VALUE) { oldestTimestamp = newestTimestamp; } else { oldestTimestamp = transforms[currentIndex].getTimeStamp(); } }
public synchronized void addTimeStampedTransform(TimeStampedTransform3D timeStampedTransform3D) { transforms[currentIndex].setTransform3D(timeStampedTransform3D.getTransform3D()); transforms[currentIndex].setTimeStamp(timeStampedTransform3D.getTimeStamp()); newestTimestamp = timeStampedTransform3D.getTimeStamp(); currentIndex++; if (currentIndex >= size) { currentIndex = 0; } if (transforms[currentIndex].getTimeStamp() == Long.MIN_VALUE) { oldestTimestamp = newestTimestamp; } else { oldestTimestamp = transforms[currentIndex].getTimeStamp(); } }
firstTimeStampedTransform.setTransform3D(EuclidCoreRandomTools.nextRigidBodyTransform(random)); secondTimeStampedTransform.setTransform3D(EuclidCoreRandomTools.nextRigidBodyTransform(random));
@ContinuousIntegrationTest(estimatedDuration = 0.0) @Test(timeout = 30000) public void testSetters() { TimeStampedTransform3D toBeTested = new TimeStampedTransform3D(); RigidBodyTransform expectedTransform = new RigidBodyTransform(); long expectedTimestamp = 0; assertEquals("Timestamp is different from what was expected", expectedTimestamp, toBeTested.getTimeStamp()); assertTrue("Transform is different from what was expected", expectedTransform.epsilonEquals(toBeTested.getTransform3D(), EPSILON)); Random random = new Random(3213620L); expectedTimestamp = RandomNumbers.nextInt(random, 132, 51568418); toBeTested.setTimeStamp(expectedTimestamp); assertEquals("Timestamp is different from what was expected", expectedTimestamp, toBeTested.getTimeStamp()); assertTrue("Transform is different from what was expected", expectedTransform.epsilonEquals(toBeTested.getTransform3D(), EPSILON)); expectedTransform = EuclidCoreRandomTools.nextRigidBodyTransform(random); toBeTested.setTransform3D(expectedTransform); assertEquals("Timestamp is different from what was expected", expectedTimestamp, toBeTested.getTimeStamp()); assertTrue("Transform is different from what was expected", expectedTransform.epsilonEquals(toBeTested.getTransform3D(), EPSILON)); expectedTimestamp = RandomNumbers.nextInt(random, 132, 51568418); expectedTransform = EuclidCoreRandomTools.nextRigidBodyTransform(random); TimeStampedTransform3D expectedTimeStampedTransform = new TimeStampedTransform3D(expectedTransform, expectedTimestamp); toBeTested.set(expectedTimeStampedTransform); assertEquals("Timestamp is different from what was expected", expectedTimeStampedTransform.getTimeStamp(), toBeTested.getTimeStamp()); assertTrue("Transform is different from what was expected", expectedTimeStampedTransform.getTransform3D().epsilonEquals(toBeTested.getTransform3D(), EPSILON)); }