r_drawradius

2 files changed, 26 insertions, 3 deletions

diff --git a/src/math/vector3f.cc b/src/math/vector3f.cc
index 3f1f4ac..a9e7e00 100644
--- a/src/math/vector3f.cc
+++ b/src/math/vector3f.cc
@@ -116,7 +116,7 @@ bool Vector3f::operator==(const Vector3f& other) const
 
 float Vector3f::lengthsquared() const
 {
-	double r = 0;
+	float r = 0;
 	for (int i=0; i < 3; i++)
 		r += coord[i]*coord[i];
 	return ((float) r);
@@ -124,11 +124,11 @@ float Vector3f::lengthsquared() const
 
 float Vector3f::length() const
 {
-	double r = 0;
+	float r = 0;
 	for (int i=0; i < 3; i++)
 		r += coord[i]*coord[i];
 
-	return ((float) sqrt(r));
+	return (sqrtf(r));
 }
 
 void Vector3f::normalize()
@@ -171,4 +171,21 @@ float dotproduct(const Vector3f& first, const Vector3f& second)
 	return (r);
 }
 
+float distance(const Vector3f& first, const Vector3f& second)
+{
+	float r = 0;
+	for (int i=0; i < 3; i++)
+		r += (first[i]-second[i])*(first[i]-second[i]);
+
+	return (sqrtf(r));
+}
+
+float distancesquared(const Vector3f& first, const Vector3f& second)
+{
+	float r = 0;
+	for (int i=0; i < 3; i++)
+		r += (first[i]-second[i])*(first[i]-second[i]);
+	return (r);
+}
+
 } // namespace math
diff --git a/src/math/vector3f.h b/src/math/vector3f.h
index 5d1fa41..20e47f2 100644
--- a/src/math/vector3f.h
+++ b/src/math/vector3f.h
@@ -148,6 +148,12 @@ const Vector3f crossproduct(Vector3f const & first, Vector3f const & second);
 /// vector dot product
 float dotproduct(const Vector3f& first, const Vector3f& second);
 
+/// distance between two vectors
+float distance(const Vector3f& first, const Vector3f& second);
+
+/// distance between two vectors squared
+float distancesquared(const Vector3f& first, const Vector3f& second);
+
 } // namespace math
 
 #endif // __INCLUDED_MATH_VECTOR3F_H__