Skip to content
Snippets Groups Projects
Commit 332fb067 authored by Peter Kaiser's avatar Peter Kaiser
Browse files

HeadIK: Make head target visualization optional

parent 7a92da8d
No related branches found
No related tags found
No related merge requests found
...@@ -121,7 +121,7 @@ namespace armarx ...@@ -121,7 +121,7 @@ namespace armarx
this->targetPosition->frame = targetPosition->frame; this->targetPosition->frame = targetPosition->frame;
FramedPositionPtr globalTarget = FramedPositionPtr::dynamicCast(targetPosition)->toGlobal(robotStateComponentPrx->getSynchronizedRobot()); FramedPositionPtr globalTarget = FramedPositionPtr::dynamicCast(targetPosition)->toGlobal(robotStateComponentPrx->getSynchronizedRobot());
if (drawer) if (drawer && getProperty<bool>("VisualizeIKTarget").getValue())
{ {
drawer->setSphereDebugLayerVisu("HeadViewTarget", drawer->setSphereDebugLayerVisu("HeadViewTarget",
globalTarget, globalTarget,
...@@ -295,7 +295,7 @@ namespace armarx ...@@ -295,7 +295,7 @@ namespace armarx
ARMARX_DEBUG << "Solution found"; ARMARX_DEBUG << "Solution found";
if (drawer && localRobot->hasRobotNode("Cameras")) if (drawer && localRobot->hasRobotNode("Cameras") && getProperty<bool>("VisualizeIKTarget").getValue())
{ {
Vector3Ptr startPos = new Vector3(localRobot->getRobotNode("Cameras")->getGlobalPose()); Vector3Ptr startPos = new Vector3(localRobot->getRobotNode("Cameras")->getGlobalPose());
drawer->setSphereDebugLayerVisu("HeadViewTargetSolution", drawer->setSphereDebugLayerVisu("HeadViewTargetSolution",
......
...@@ -50,6 +50,7 @@ namespace armarx ...@@ -50,6 +50,7 @@ namespace armarx
defineOptionalProperty<std::string>("RobotStateTopicName", "RobotState", "Name of the RobotComponent State topic."); defineOptionalProperty<std::string>("RobotStateTopicName", "RobotState", "Name of the RobotComponent State topic.");
defineOptionalProperty<std::string>("HeadIKUnitTopicName", "HeadIKUnitTopic", "Name of the HeadIKUnit Topic"); defineOptionalProperty<std::string>("HeadIKUnitTopicName", "HeadIKUnitTopic", "Name of the HeadIKUnit Topic");
defineOptionalProperty<std::string>("RobotStateComponentName", "RobotStateComponent", "Name of the RobotStateComponent that should be used"); defineOptionalProperty<std::string>("RobotStateComponentName", "RobotStateComponent", "Name of the RobotStateComponent that should be used");
defineOptionalProperty<bool>("VisualizeIKTarget", true, "Visualize the current IK target using the debug drawer");
defineOptionalProperty<int>("CycleTime", 30, "Cycle time of the tcp control in ms"); defineOptionalProperty<int>("CycleTime", 30, "Cycle time of the tcp control in ms");
} }
}; };
......
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