diff --git a/source/RobotAPI/libraries/armem_robot_state/server/proprioception/converters/Armar6Converter.cpp b/source/RobotAPI/libraries/armem_robot_state/server/proprioception/converters/Armar6Converter.cpp index 6c7171a746e0815d2fca648f2b91e0faa31a669e..cb1192954cf52fedeec2040e161c72fae15479c6 100644 --- a/source/RobotAPI/libraries/armem_robot_state/server/proprioception/converters/Armar6Converter.cpp +++ b/source/RobotAPI/libraries/armem_robot_state/server/proprioception/converters/Armar6Converter.cpp @@ -6,6 +6,8 @@ #include <RobotAPI/libraries/RobotUnitDataStreamingReceiver/RobotUnitDataStreamingReceiver.h> #include <RobotAPI/libraries/aron/core/navigator/data/container/Dict.h> +#include <RobotAPI/libraries/armem_robot_state/server/proprioception/aron_conversions.h> + #include "ConverterTools.h" @@ -40,7 +42,7 @@ namespace armarx::armem::server::robot_state::proprioception void Armar6Converter::process( - arondto::Proprioception dto, + arondto::Proprioception& dto, const std::string& entryName, const ConverterValue& value) { @@ -70,8 +72,7 @@ namespace armarx::armem::server::robot_state::proprioception { // Joint bool processed = processJointEntry(dto.joints, split, value); - - if (!processed) + if (not processed) { // Fallback: Put in extra. const std::vector<std::string> comps{simox::alg::advanced(split.begin(), 1), split.end()}; @@ -86,6 +87,8 @@ namespace armarx::armem::server::robot_state::proprioception dto.extraLongs[key] = getValueAs<long>(value); break; default: + ARMARX_DEBUG << "Cannot handle extra field '" << key << "' of type " + << RobotUnitDataStreaming::DataEntryNames.to_name(value.entry.type); break; } } @@ -201,7 +204,7 @@ namespace armarx::armem::server::robot_state::proprioception } else { - ARMARX_DEBUG << "Ignoring unhandled field: '" << simox::alg::join(split, ".") << "'"; + // ARMARX_DEBUG << "Ignoring unhandled field: '" << simox::alg::join(split, ".") << "'"; return false; } } diff --git a/source/RobotAPI/libraries/armem_robot_state/server/proprioception/converters/Armar6Converter.h b/source/RobotAPI/libraries/armem_robot_state/server/proprioception/converters/Armar6Converter.h index f7a0da8f3d166fda4b497fd960398ffd861dfc61..03c0a05d0387cae6faba1a0a779ba874a3006730 100644 --- a/source/RobotAPI/libraries/armem_robot_state/server/proprioception/converters/Armar6Converter.h +++ b/source/RobotAPI/libraries/armem_robot_state/server/proprioception/converters/Armar6Converter.h @@ -33,7 +33,7 @@ namespace armarx::armem::server::robot_state::proprioception protected: - void process(arondto::Proprioception dto, const std::string& entryName, const ConverterValue& value); + void process(arondto::Proprioception& dto, const std::string& entryName, const ConverterValue& value);