From cee1ef02db343483a1e02c0e83845875c895c223 Mon Sep 17 00:00:00 2001
From: Mirko Waechter <mirko.waechter@kit.edu>
Date: Fri, 14 Sep 2018 11:20:12 +0200
Subject: [PATCH] rad2deg helper function
---
VirtualRobot/math/Helpers.cpp | 9 +++++++++
VirtualRobot/math/Helpers.h | 3 +++
2 files changed, 12 insertions(+)
diff --git a/VirtualRobot/math/Helpers.cpp b/VirtualRobot/math/Helpers.cpp
index 5e9d4bfce..66c19effd 100644
--- a/VirtualRobot/math/Helpers.cpp
+++ b/VirtualRobot/math/Helpers.cpp
@@ -288,3 +288,12 @@ Eigen::VectorXf Helpers::LimitVectorLength(const Eigen::VectorXf& vec, const Eig
return vec / scale;
}
+float Helpers::rad2deg(float rad)
+{
+ return rad * (float)(180.0 / M_PI);
+}
+
+float Helpers::deg2rad(float deg)
+{
+ return deg * (float)(M_PI / 180.0);
+}
diff --git a/VirtualRobot/math/Helpers.h b/VirtualRobot/math/Helpers.h
index 4e30135dd..10e6b9e62 100644
--- a/VirtualRobot/math/Helpers.h
+++ b/VirtualRobot/math/Helpers.h
@@ -67,6 +67,9 @@ namespace math
static Eigen::Matrix3f GetOrientation(const Eigen::Matrix4f& pose);
static Eigen::VectorXf LimitVectorLength(const Eigen::VectorXf& vec, const Eigen::VectorXf& maxLen);
+ static float rad2deg(float rad);
+ static float deg2rad(float deg);
+
private:
};
}
--
GitLab