#ifndef VECTOR_H
#define VECTOR_H

#include <cmath>
#include <iostream>

namespace vb01{
	struct Vector4{
		Vector4(){};
		Vector4(float x, float y, float z, float w){
			this->x = x;
			this->y = y;
			this->z = z;
			this->w = w;
		}
		Vector4 operator-(const Vector4 &v){return Vector4(x - v.x, y - v.y, z - v.z, w - v.w);}
		Vector4 operator+(const Vector4 &v){return Vector4(x + v.x, y + v.y, z + v.z, w + v.w);}
		template<typename T>Vector4 operator+(T s){return Vector4(x + s, y + s, z + s, w + s);}
		template<typename T>Vector4 operator-(T s){return Vector4(x - s, y - s, z - s, w - s);}
		template<typename T>Vector4 operator*(T s){return Vector4(x * s, y * s, z * s, w * s);}
		template<typename T>Vector4 operator/(T s){return Vector4(x / s, y / s, z / s, w / s);}

		float x, y, z, w;
		static const Vector4 VEC_IJKL, VEC_I, VEC_J, VEC_K, VEC_L, VEC_ZERO;
	};

	struct Vector3{
		Vector3(){};
		Vector3(float x, float y, float z){
			this->x = x;
			this->y = y;
			this->z = z;
		}
		bool operator!=(const Vector3 &v){return x != v.x || y != v.y || z != v.z;}
		bool operator==(const Vector3 &v){return x == v.x && y == v.y && z == v.z;}
		Vector3 operator-(){return Vector3(-x, -y, -z);}
		Vector3 operator-(const Vector3 &v){return Vector3(x - v.x, y - v.y, z - v.z);}
		Vector3 operator+(const Vector3 &v){return Vector3(x + v.x, y + v.y, z + v.z);}
		template<typename T>Vector3 operator+(T s){return Vector3(x + s, y + s, z + s);}
		template<typename T>Vector3 operator-(T s){return Vector3(x - s, y - s, z - s);}
		template<typename T>Vector3 operator*(T s){return Vector3(x * s, y * s, z * s);}
		template<typename T>Vector3 operator/(T s){return Vector3(x / s, y / s, z / s);}
		float getLengthSq(){return x * x + y * y + z * z;}
		float getLength(){return std::sqrt(getLengthSq());}
		float dot(Vector3 v){return x * v.x + y * v.y + z * v.z;}
		float getAngleBetween(Vector3 v){
			float dotProd = dot(v);
			if(dotProd > 1.0)
				dotProd = 1.0;
			else if(dotProd < -1)
				dotProd = -1;
			return std::acos(dotProd);
		}
		float getDistanceFrom(Vector3 v){return (v - *this).getLength();}
		Vector3 norm(){return (*this != Vector3::VEC_ZERO ? *this / getLength() : Vector3::VEC_ZERO);}
		Vector3 cross(Vector3 v){return Vector3(y * v.z - v.y * z, z * v.x - x * v.z, x * v.y - v.x * y);}

		float x, y, z;
		static const Vector3 VEC_IJK, VEC_I, VEC_J, VEC_K, VEC_ZERO;
	};

	struct Vector2{
		Vector2(){};
		Vector2(float x, float y){
			this->x = x;
			this->y = y;
		}
		bool operator!=(const Vector2 &v){return x != v.x || y != v.y;}
		bool operator==(const Vector2 &v){return x == v.x && y == v.y;}
		Vector2 operator-(const Vector2 &v){return Vector2(x - v.x, y - v.y);}
		Vector2 operator+(const Vector2 &v){return Vector2(x + v.x, y + v.y);}
		template<typename T>Vector2 operator+(T s){return Vector2(x + s, y + s);}
		template<typename T>Vector2 operator-(T s){return Vector2(x - s, y - s);}
		template<typename T>Vector2 operator*(T s){return Vector2(x * s, y * s);}
		template<typename T>Vector2 operator/(T s){return Vector2(x / s, y / s);}
		float getLengthSq(){return x * x + y * y;}
		float getLength(){return std::sqrt(getLengthSq());}
		float dot(Vector2 v){return x * v.x + y * v.y;}
		float getAngleBetween(Vector2 v){return std::acos(dot(v));}
		float getDistanceFrom(Vector2 v){return (v - *this).getLength();}
		Vector2 norm(){return *this / getLength();}

		float x, y;
		static const Vector2 VEC_IJ, VEC_I, VEC_J, VEC_ZERO;
	};
}

#endif