diff --git a/source/RobotAPI/components/units/RobotUnit/util/ControlThreadOutputBuffer.cpp b/source/RobotAPI/components/units/RobotUnit/util/ControlThreadOutputBuffer.cpp index f67b581dfbf35a5c64a11c7323458fbb291e0d37..3e5403add3438d030bdae38f302c2728169074dd 100644 --- a/source/RobotAPI/components/units/RobotUnit/util/ControlThreadOutputBuffer.cpp +++ b/source/RobotAPI/components/units/RobotUnit/util/ControlThreadOutputBuffer.cpp @@ -420,12 +420,14 @@ namespace armarx return resultPlace; }; + //copy sensor values sensors.reserve(other.sensors.size()); for (const SensorValueBase* sv : other.sensors) { - sensors.emplace_back(sv->_placementConstruct(getAlignedPlace(sv->_sizeof(), sv->_alignof()))); + sensors.emplace_back(sv->_placementCopyConstruct(getAlignedPlace(sv->_sizeof(), sv->_alignof()))); } + //copy control targets control.reserve(other.control.size()); for (const auto& cdctargs : other.control) { @@ -434,8 +436,7 @@ namespace armarx ctargs.reserve(cdctargs.size()); for (const ControlTargetBase* ct : cdctargs) { - ctargs.emplace_back(ct->_placementConstruct(getAlignedPlace(ct->_sizeof(), ct->_alignof()))); - ctargs.back()->reset(); + ctargs.emplace_back(ct->_placementCopyConstruct(getAlignedPlace(ct->_sizeof(), ct->_alignof()))); } } }