Skip to content
Snippets Groups Projects
Commit fb0fa3a5 authored by ARMAR-7 User's avatar ARMAR-7 User
Browse files

commenting out print statements

parent 81769858
No related branches found
No related tags found
No related merge requests found
...@@ -125,7 +125,7 @@ namespace VirtualRobot ...@@ -125,7 +125,7 @@ namespace VirtualRobot
void void
RobotNodeFourBar::setJointValueNoUpdate(float q) RobotNodeFourBar::setJointValueNoUpdate(float q)
{ {
std::cout << "RobotNodeFourBar: setting joint value no update " << q << std::endl; // std::cout << "RobotNodeFourBar: setting joint value no update " << q << std::endl;
if (active) if (active)
{ {
...@@ -146,9 +146,9 @@ namespace VirtualRobot ...@@ -146,9 +146,9 @@ namespace VirtualRobot
{ {
// We must update the preceeding node (the passive node). // We must update the preceeding node (the passive node).
// This usually causes issues as the order to update the kinematic chain is strict. // This usually causes issues as the order to update the kinematic chain is strict.
std::cout << "RobotNodeFourBar: setting joint value " << getName() << " " << q << std::endl; // std::cout << "RobotNodeFourBar: setting joint value " << getName() << " " << q << std::endl;
std::cout << "RobotNodeFourBar: active? " << active.has_value() << std::endl; // std::cout << "RobotNodeFourBar: active? " << active.has_value() << std::endl;
// update this node (without the global / internal pose!) // update this node (without the global / internal pose!)
{ {
...@@ -160,7 +160,7 @@ namespace VirtualRobot ...@@ -160,7 +160,7 @@ namespace VirtualRobot
if (active) if (active)
{ {
std::cout << "RobotNodeFourBar: triggering update of passive joint " << std::endl; // std::cout << "RobotNodeFourBar: triggering update of passive joint " << std::endl;
// update all nodes including this one // update all nodes including this one
active->passive->updatePose(true); active->passive->updatePose(true);
...@@ -206,7 +206,7 @@ namespace VirtualRobot ...@@ -206,7 +206,7 @@ namespace VirtualRobot
// Whenever the joint value has changed, the passive joint will be updated. // Whenever the joint value has changed, the passive joint will be updated.
if (active) if (active)
{ {
std::cout << "Initializing active four bar joint" << std::endl; // std::cout << "Initializing active four bar joint" << std::endl;
VR_ASSERT_MESSAGE(not active->passive, "Second must not be initialized yet."); VR_ASSERT_MESSAGE(not active->passive, "Second must not be initialized yet.");
...@@ -284,7 +284,7 @@ namespace VirtualRobot ...@@ -284,7 +284,7 @@ namespace VirtualRobot
VR_ASSERT_MESSAGE(first.has_value() xor active.has_value(), VR_ASSERT_MESSAGE(first.has_value() xor active.has_value(),
std::stringstream() << first.has_value() << " / " << active.has_value()); std::stringstream() << first.has_value() << " / " << active.has_value());
std::cout << "Updating RobotNodeFourBar::updateTransformationMatrices" << std::endl; // std::cout << "Updating RobotNodeFourBar::updateTransformationMatrices" << std::endl;
Eigen::Isometry3f tmp = Eigen::Isometry3f::Identity(); Eigen::Isometry3f tmp = Eigen::Isometry3f::Identity();
...@@ -292,21 +292,21 @@ namespace VirtualRobot ...@@ -292,21 +292,21 @@ namespace VirtualRobot
if (active) if (active)
{ {
std::cout << "active: joint value " << jV << std::endl; // std::cout << "active: joint value " << jV << std::endl;
active->math.update(jV); active->math.update(jV);
tmp = active->math.joint.computeFk(jV).matrix().cast<float>(); tmp = active->math.joint.computeFk(jV).matrix().cast<float>();
} }
else // passive else // passive
{ {
std::cout << "passive: joint value " << jV << std::endl; // std::cout << "passive: joint value " << jV << std::endl;
tmp.linear() = Eigen::AngleAxisf(jV + jointValueOffset, Eigen::Vector3f::UnitZ()) tmp.linear() = Eigen::AngleAxisf(jV + jointValueOffset, Eigen::Vector3f::UnitZ())
.toRotationMatrix(); .toRotationMatrix();
} }
std::cout << "local transformation: " << getName() << tmp.matrix() << std::endl; // std::cout << "local transformation: " << getName() << tmp.matrix() << std::endl;
globalPose = parentPose * localTransformation * tmp.matrix(); globalPose = parentPose * localTransformation * tmp.matrix();
......
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment