public static Vector3 ToVector3([NotNull] this Urdf.Vector3f v) { if (v == null) { throw new ArgumentNullException(nameof(v)); } return(new Vector3(v.X, v.Y, v.Z).Ros2Unity()); }
static Quaternion ToQuaternion([NotNull] this Urdf.Vector3f v) { if (v == null) { throw new ArgumentNullException(nameof(v)); } return(new Vector3(v.X, v.Y, v.Z).RosRpy2Unity()); }