From 55ae0b7a2c2930da99569be556bc3dc8c0d8b658 Mon Sep 17 00:00:00 2001
From: Simon Ottenhaus <simon.ottenhaus@kit.edu>
Date: Thu, 28 May 2020 11:14:03 +0200
Subject: [PATCH] re-added SimpleDiffIKProvider

---
 source/RobotAPI/libraries/diffik/SimpleDiffIK.h | 15 +++++++++++++++
 1 file changed, 15 insertions(+)

diff --git a/source/RobotAPI/libraries/diffik/SimpleDiffIK.h b/source/RobotAPI/libraries/diffik/SimpleDiffIK.h
index 2adcf162d..e51be9921 100644
--- a/source/RobotAPI/libraries/diffik/SimpleDiffIK.h
+++ b/source/RobotAPI/libraries/diffik/SimpleDiffIK.h
@@ -111,4 +111,19 @@ namespace armarx
         ///@brief Use this to check a trajectory of waypoints
         static Reachability CalculateReachability(const std::vector<Eigen::Matrix4f> targets, const Eigen::VectorXf& initialJV, VirtualRobot::RobotNodeSetPtr rns, VirtualRobot::RobotNodePtr tcp = VirtualRobot::RobotNodePtr(), Parameters params = Parameters());
     };
+
+    class SimpleDiffIKProvider :
+        public DiffIKProvider
+    {
+    public:
+        SimpleDiffIKProvider(VirtualRobot::RobotNodeSetPtr rns, VirtualRobot::RobotNodePtr tcp = VirtualRobot::RobotNodePtr(), SimpleDiffIK::Parameters params = SimpleDiffIK::Parameters());
+        DiffIKResult SolveAbsolute(const Eigen::Matrix4f& targetPose);
+        DiffIKResult SolveRelative(const Eigen::Matrix4f& targetPose, const Eigen::VectorXf& startJointValues);
+
+    private:
+        VirtualRobot::RobotNodeSetPtr rns;
+        VirtualRobot::RobotNodePtr tcp;
+        SimpleDiffIK::Parameters params;
+    };
 }
+
-- 
GitLab