From 03fb1aeb554e18c84d72c9d426084e7b1b5d0fd1 Mon Sep 17 00:00:00 2001
From: Raphael Grimm <raphael.grimm@kit.edu>
Date: Wed, 19 Aug 2020 09:16:07 +0200
Subject: [PATCH] Add RobotNameHelper::{Arm,RobotArm}::getPalmCollisionModel

---
 .../RobotStatechartHelpers/RobotNameHelper.cpp      | 13 +++++++++++++
 .../RobotStatechartHelpers/RobotNameHelper.h        |  2 ++
 2 files changed, 15 insertions(+)

diff --git a/source/RobotAPI/libraries/RobotStatechartHelpers/RobotNameHelper.cpp b/source/RobotAPI/libraries/RobotStatechartHelpers/RobotNameHelper.cpp
index 147755199..349eca66f 100644
--- a/source/RobotAPI/libraries/RobotStatechartHelpers/RobotNameHelper.cpp
+++ b/source/RobotAPI/libraries/RobotStatechartHelpers/RobotNameHelper.cpp
@@ -240,6 +240,12 @@ namespace armarx
         return select("HandModelPackage");
     }
 
+    std::string RobotNameHelper::Arm::getPalmCollisionModel() const
+    {
+        ARMARX_TRACE;
+        return select("PalmCollisionModel");
+    }
+
     RobotNameHelper::RobotArm RobotNameHelper::Arm::addRobot(const VirtualRobot::RobotPtr& robot) const
     {
         ARMARX_TRACE;
@@ -285,6 +291,13 @@ namespace armarx
         return robot->getRobotNode(arm.getTCP());
     }
 
+    VirtualRobot::RobotNodePtr RobotNameHelper::RobotArm::getPalmCollisionModel() const
+    {
+        ARMARX_TRACE;
+        ARMARX_CHECK_NOT_NULL(robot);
+        return robot->getRobotNode(arm.getPalmCollisionModel());
+    }
+
     VirtualRobot::RobotNodePtr RobotNameHelper::RobotArm::getHandRootNode() const
     {
         ARMARX_TRACE;
diff --git a/source/RobotAPI/libraries/RobotStatechartHelpers/RobotNameHelper.h b/source/RobotAPI/libraries/RobotStatechartHelpers/RobotNameHelper.h
index 0a4fdd59a..b4db8b858 100644
--- a/source/RobotAPI/libraries/RobotStatechartHelpers/RobotNameHelper.h
+++ b/source/RobotAPI/libraries/RobotStatechartHelpers/RobotNameHelper.h
@@ -76,6 +76,7 @@ namespace armarx
             std::string getHandModelPath() const;
             std::string getAbsoluteHandModelPath() const;
             std::string getHandModelPackage() const;
+            std::string getPalmCollisionModel() const;
             RobotArm addRobot(const VirtualRobot::RobotPtr& robot) const;
 
             Arm(const std::shared_ptr<const RobotNameHelper>& rnh, const std::string& side);
@@ -104,6 +105,7 @@ namespace armarx
             VirtualRobot::RobotNodeSetPtr getTorsoKinematicChain() const;
             VirtualRobot::RobotNodePtr getTCP() const;
             VirtualRobot::RobotNodePtr getHandRootNode() const;
+            VirtualRobot::RobotNodePtr getPalmCollisionModel() const;
             Eigen::Matrix4f getTcp2HandRootTransform() const;
             const Arm& getArm() const;
             const VirtualRobot::RobotPtr& getRobot() const;
-- 
GitLab