Merge pull request #67 from ultrainstinct30/VariableThresh

Made threshold in getPointBehindBall function variable

Author: thebhatman

utils/math_functions.py

@@ -245,9 +245,9 @@ def stan_inverse(self,y,x):
 		return atan2(y,x)+3.14159265
 
 
-def getPointBehindTheBall(point ,theta):
-  x = point.x -(3.5 * BOT_RADIUS) *(math.cos(theta))
-  y = point.y -(3.5 * BOT_RADIUS) *(math.sin(theta))
+def getPointBehindTheBall(point ,theta, factor=3.5):
+  x = point.x +(factor * BOT_RADIUS) *(math.cos(theta))
+  y = point.y +(factor * BOT_RADIUS) *(math.sin(theta))
   return Vector2D(int(x), int(y))
 
 def vicinity_points(point1, point2, thresh=10):