diff options
| -rw-r--r-- | src/math/vector2f.cc | 17 | ||||
| -rw-r--r-- | src/math/vector2f.h | 6 |
2 files changed, 23 insertions, 0 deletions
diff --git a/src/math/vector2f.cc b/src/math/vector2f.cc index 809269e..2b5ff9e 100644 --- a/src/math/vector2f.cc +++ b/src/math/vector2f.cc @@ -63,4 +63,21 @@ Vector2f &Vector2f::operator-=(const Vector2f &other) return (*this); } +float distance(const Vector2f& first, const Vector2f& second) +{ + float r = 0; + for (int i=0; i < 2; i++) + r += (first[i]-second[i])*(first[i]-second[i]); + + return (sqrtf(r)); +} + +float distancesquared(const Vector2f& first, const Vector2f& second) +{ + float r = 0; + for (int i=0; i < 2; i++) + r += (first[i]-second[i])*(first[i]-second[i]); + return (r); +} + } diff --git a/src/math/vector2f.h b/src/math/vector2f.h index ee2d044..6258d85 100644 --- a/src/math/vector2f.h +++ b/src/math/vector2f.h @@ -109,6 +109,12 @@ private: float coord[2]; }; +/// distance between two vectors +float distance(const Vector2f& first, const Vector2f& second); + +/// distance between two vectors squared +float distancesquared(const Vector2f& first, const Vector2f& second); + } #endif // __INCLUDED_MATH_VECTOR2F_H__ |