public double GetAngle(Body b) { var v1 = _t1.GetVector3D(b); var v2 = _t2.GetVector3D(b); return(v1.Angle(v2)); }
public static Vector3D Vector3DFromJointTuple(JointTuple t, Body b) { return(t.GetVector3D(b)); }