diff --git a/vtm/src/org/oscim/utils/FastMath.java b/vtm/src/org/oscim/utils/FastMath.java
index 98945b8b..fca6bf15 100644
--- a/vtm/src/org/oscim/utils/FastMath.java
+++ b/vtm/src/org/oscim/utils/FastMath.java
@@ -96,4 +96,12 @@ public class FastMath {
 	public static boolean absMaxCmp(int value1, int value2, int cmp) {
 		return value1 < -cmp || value1 > cmp || value2 < -cmp || value2 > cmp;
 	}
+
+	public static boolean withinSquaredDist(int dx, int dy, int distance) {
+		return dx * dx + dy * dy < distance;
+	}
+
+	public static boolean withinSquaredDist(float dx, float dy, float distance) {
+		return dx * dx + dy * dy < distance;
+	}
 }