diff --git a/Runtime/Utils/RosConvertor.cs b/Runtime/Utils/RosConvertor.cs index 9ac1c9c..a7a7c7f 100644 --- a/Runtime/Utils/RosConvertor.cs +++ b/Runtime/Utils/RosConvertor.cs @@ -39,6 +39,11 @@ public static geometry_msgs.msg.Vector3 ToRosAngular(this Vector3 v) return new geometry_msgs.msg.Vector3() { x = -v.z, y = v.x, z = -v.y }; } + public static Vector3 FromRosAngular(this geometry_msgs.msg.Vector3 v) + { + return new Vector3((float)v.y, (float)-v.z, (float)-v.x); + } + public static Quaternion FromRos(this geometry_msgs.msg.Quaternion q) { return new Quaternion((float)q.y, (float)-q.z, (float)-q.x, (float)q.w);