From 0c4d1c50ad5c7ba9d2a3e874fb411284bb9b868a Mon Sep 17 00:00:00 2001 From: Silvio Traversaro Date: Mon, 5 Feb 2024 17:41:15 +0100 Subject: [PATCH] Debug RelativeTransform --- toolbox/library/src/RelativeTransform.cpp | 1 + 1 file changed, 1 insertion(+) diff --git a/toolbox/library/src/RelativeTransform.cpp b/toolbox/library/src/RelativeTransform.cpp index 0b44c3152..86736c5e7 100644 --- a/toolbox/library/src/RelativeTransform.cpp +++ b/toolbox/library/src/RelativeTransform.cpp @@ -226,6 +226,7 @@ bool RelativeTransform::output(const BlockInformation* blockInfo) // Compute the relative transform frame1_H_frame2 = kinDyn->getRelativeTransform(pImpl->frame1Index, pImpl->frame2Index); + std::cerr << "RelativeTransform: frame1_H_frame2: " << frame1_H_frame2.toString() << std::endl; // Get the output signal memory location OutputSignalPtr output = blockInfo->getOutputPortSignal(OutputIndex::Transform);