From 2620aa3d362063eb7dbfe3ba43f6c888ae464d0e Mon Sep 17 00:00:00 2001
From: =?UTF-8?q?Joan=20Sol=C3=A0?= <jsola@iri.upc.edu>
Date: Tue, 16 Jun 2020 22:43:12 +0200
Subject: [PATCH] Add asser for repeated timestamp in trajectory
---
src/trajectory/trajectory_base.cpp | 6 +++---
1 file changed, 3 insertions(+), 3 deletions(-)
diff --git a/src/trajectory/trajectory_base.cpp b/src/trajectory/trajectory_base.cpp
index 3e78796c9..023a64a5c 100644
--- a/src/trajectory/trajectory_base.cpp
+++ b/src/trajectory/trajectory_base.cpp
@@ -5,8 +5,6 @@ namespace wolf {
TrajectoryBase::TrajectoryBase() :
NodeBase("TRAJECTORY", "TrajectoryBase")
- // last_key_frame_ptr_(nullptr),
- // last_key_or_aux_frame_ptr_(nullptr)
{
// WOLF_DEBUG("constructed T");
frame_list_ = FrameList();
@@ -20,7 +18,9 @@ TrajectoryBase::~TrajectoryBase()
FrameBasePtr TrajectoryBase::addFrame(FrameBasePtr _frame_ptr)
{
// add to list
- frame_list_.insert(std::pair<TimeStamp, FrameBasePtr>(_frame_ptr->getTimeStamp(), _frame_ptr));
+ assert(frame_list_.count(_frame_ptr->getTimeStamp()) == 0 && "Trying to add a keyframe with the same timestamp of an existing one");
+
+ frame_list_.emplace(_frame_ptr->getTimeStamp(), _frame_ptr);
return _frame_ptr;
}
--
GitLab