public void TestPoses() { Random.InitState(0); var p = new Pose(Random.insideUnitSphere, Random.rotation); var v = Random.insideUnitSphere; var w = PoseUtils.WorldFromLocalPoint(p, v); var v2 = PoseUtils.LocalFromWorldPoint(p, w); AssertNear(v, v2, 0.001f); }
public Vector3 LocalFromWorldPoint(Vector3 pnt) { return(PoseUtils.LocalFromWorldPoint(Pose, pnt)); }