From 0b88bd4721097b6872f9d270d355794cb5f0078a Mon Sep 17 00:00:00 2001
From: Joseph Mirabel <jmirabel@laas.fr>
Date: Mon, 22 May 2017 10:23:33 +0200
Subject: [PATCH] Fix case where robot already exists in
Device::didInsertRobot.
---
src/device.cc | 4 ++++
1 file changed, 4 insertions(+)
diff --git a/src/device.cc b/src/device.cc
index 517d970..9cbf53c 100644
--- a/src/device.cc
+++ b/src/device.cc
@@ -93,6 +93,10 @@ namespace hpp {
}
frameCacheSize_ = model().frames.size();
+ if (has<FrameIndexes_t>(name)) {
+ const FrameIndexes_t& old = get<FrameIndexes_t>(name);
+ newF.insert(newF.begin(), old.begin(), old.end());
+ }
add (name, newF);
createData();
createGeomData();
--
GitLab