示例#1
0
        public double GetAngle(Body b)
        {
            var v1 = _t1.GetVector3D(b);
            var v2 = _t2.GetVector3D(b);

            return(v1.Angle(v2));
        }
示例#2
0
 public static Vector3D Vector3DFromJointTuple(JointTuple t, Body b)
 {
     return(t.GetVector3D(b));
 }