X-Git-Url: http://git.localhorst.tv/?a=blobdiff_plain;f=src%2Fgeometry%2FVector.h;h=c6a42fbba069e4b98bdac5acfb5bff9ba2242de5;hb=be3b4e75c82b6e9d2b5c4300138d490ec1a4932a;hp=7c698ff4af0a11d9b707cd0b51503142e016f475;hpb=b27f427bbb6a1a1ee1230bacb4fce0eb3a8af240;p=l2e.git

diff --git a/src/geometry/Vector.h b/src/geometry/Vector.h
index 7c698ff..c6a42fb 100644
--- a/src/geometry/Vector.h
+++ b/src/geometry/Vector.h
@@ -8,6 +8,8 @@
 #ifndef GEOMETRY_VECTOR_H_
 #define GEOMETRY_VECTOR_H_
 
+#include <cmath>
+#include <limits>
 #include <ostream>
 
 namespace geometry {
@@ -27,6 +29,13 @@ public:
 	Scalar X() const { return x; }
 	Scalar Y() const { return y; }
 
+	Scalar Index(Scalar lineLength) const { return Y() * lineLength + X(); }
+	static Vector<Scalar> FromIndex(Scalar index, Scalar lineLength) {
+		return Vector<Scalar>(index % lineLength, index / lineLength);
+	}
+
+	void Lock(const Vector<Scalar> &to);
+
 private:
 	Scalar x, y;
 
@@ -74,6 +83,10 @@ inline Vector<T> operator -(const Vector<T> &v) {
 	return Vector<T>(-v.X(), -v.Y());
 }
 
+template<class T>
+inline Vector<T> operator *(const Vector<T> &v1, const Vector<T> &v2) {
+	return Vector<T>(v1.X() * v2.X(), v1.Y() * v2.Y());
+}
 template<class T>
 inline Vector<T> operator *(const Vector<T> &v, T s) {
 	return Vector<T>(v.X() * s, v.Y() * s);
@@ -83,10 +96,51 @@ inline Vector<T> operator *(T s, const Vector<T> &v) {
 	return Vector<T>(s * v.X(), s * v.Y());
 }
 
+template<class T>
+inline Vector<T> operator /(const Vector<T> &v1, const Vector<T> &v2) {
+	return Vector<T>(v1.X() / v2.X(), v1.Y() / v2.Y());
+}
 template<class T>
 inline Vector<T> operator /(const Vector<T> &v, T s) {
 	return Vector<T>(v.X() / s, v.Y() / s);
 }
+template<class T>
+inline Vector<T> operator /(T s, const Vector<T> &v) {
+	return Vector<T>(s / v.X(), s / v.Y());
+}
+
+template<class T>
+inline Vector<T> operator %(const Vector<T> &v1, const Vector<T> &v2) {
+	return Vector<T>(v1.X() % v2.X(), v1.Y() % v2.Y());
+}
+template<>
+inline Vector<float> operator %(const Vector<float> &v1, const Vector<float> &v2) {
+	return Vector<float>(std::fmod(v1.X(), v2.X()), std::fmod(v1.Y(), v2.Y()));
+}
+template<>
+inline Vector<double> operator %(const Vector<double> &v1, const Vector<double> &v2) {
+	return Vector<double>(std::fmod(v1.X(), v2.X()), std::fmod(v1.Y(), v2.Y()));
+}
+template<>
+inline Vector<long double> operator %(const Vector<long double> &v1, const Vector<long double> &v2) {
+	return Vector<long double>(std::fmod(v1.X(), v2.X()), std::fmod(v1.Y(), v2.Y()));
+}
+template<class T>
+inline Vector<T> operator %(const Vector<T> &v, T s) {
+	return Vector<T>(v.X() % s, v.Y() % s);
+}
+template<>
+inline Vector<float> operator %(const Vector<float> &v, float s) {
+	return Vector<float>(std::fmod(v.X(), s), std::fmod(v.Y(), s));
+}
+template<>
+inline Vector<double> operator %(const Vector<double> &v, double s) {
+	return Vector<double>(std::fmod(v.X(), s), std::fmod(v.Y(), s));
+}
+template<>
+inline Vector<long double> operator %(const Vector<long double> &v, long double s) {
+	return Vector<long double>(std::fmod(v.X(), s), std::fmod(v.Y(), s));
+}
 
 template<class T>
 inline bool operator ==(const Vector<T> &lhs, const Vector<T> &rhs) {
@@ -104,6 +158,26 @@ inline std::ostream &operator <<(std::ostream &out, const Vector<T> &v) {
 	return out;
 }
 
+
+template <class Scalar>
+void Vector<Scalar>::Lock(const Vector<Scalar> &to) {
+	Vector<Scalar> half(to / Scalar(2));
+	Vector<Scalar> dist((*this) % to);
+
+	if (dist.X() > half.X()) {
+		x += (to.X() - dist.X());
+	} else {
+		x -= dist.X();
+	}
+
+	if (dist.Y() > half.Y()) {
+		y += (to.Y() - dist.Y());
+	} else {
+		y -= dist.Y();
+	}
+}
+
+
 }
 
 #endif /* GEOMETRY_VECTOR_H_ */