r_drawradius

1 files changed, 20 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