private static float CalculateAttractorRadius(Manipulator manipulator, float weight, float goalThreshold) { return(goalThreshold * weight / manipulator.DistanceTo(manipulator.Goal)); /*(float)Math.Pow(weight / manipulator.DistanceTo(manipulator.Goal), 2);*/ }
private static float CalculateAttractorWeight(Manipulator manipulator, Vector3 point) { return(manipulator.DistanceTo(point) + manipulator.Goal.DistanceTo(point)); }