diff options
Diffstat (limited to 'src/vZ')
| -rw-r--r-- | src/vZ/EquationSystem.hpp | 44 | ||||
| -rw-r--r-- | src/vZ/Vector.hpp | 228 |
2 files changed, 260 insertions, 12 deletions
diff --git a/src/vZ/EquationSystem.hpp b/src/vZ/EquationSystem.hpp index 790676c..5a50f6d 100644 --- a/src/vZ/EquationSystem.hpp +++ b/src/vZ/EquationSystem.hpp @@ -64,6 +64,38 @@ namespace vZ Traits(); }; + // Unary operators + + template <std::size_t N, typename T> + inline EquationSystem<N, T> + operator+(const EquationSystem<N, T>& rhs) + { + return rhs; + } + + template <std::size_t N, typename T> + inline EquationSystem<N, T> + operator-(const EquationSystem<N, T>& rhs) + { + EquationSystem<N, T> res; + for (std::size_t i = 0; i < N; ++i) { + res[i] = -rhs[i]; + } + return res; + } + + template <std::size_t N, typename T> + typename EquationSystem<N, T>::Scalar + abs(const EquationSystem<N, T>& es) + { + typename EquationSystem<N, T>::Scalar ret(0); + for (std::size_t i = 0; i < N; ++i) { + using std::abs; + ret = std::max(ret, abs(es[i])); + } + return ret; + } + // Binary operators template <std::size_t N, typename T> @@ -155,18 +187,6 @@ namespace vZ } return *this; } - - template <std::size_t N, typename T> - typename EquationSystem<N, T>::Scalar - abs(const EquationSystem<N, T>& es) - { - typename EquationSystem<N, T>::Scalar ret(0); - for (std::size_t i = 0; i < N; ++i) { - using std::abs; - ret = std::max(ret, abs(es[i])); - } - return ret; - } } #endif // VZ_EQUATIONSYSTEM_HPP diff --git a/src/vZ/Vector.hpp b/src/vZ/Vector.hpp new file mode 100644 index 0000000..cf3bf0a --- /dev/null +++ b/src/vZ/Vector.hpp @@ -0,0 +1,228 @@ +/************************************************************************* + * Copyright (C) 2009-2010 Tavian Barnes <tavianator@gmail.com> * + * * + * This file is part of The vZ Library. * + * * + * The vZ Library is free software; you can redistribute it and/or * + * modify it under the terms of the GNU Lesser General Public License as * + * published by the Free Software Foundation; either version 3 of the * + * License, or (at your option) any later version. * + * * + * The vZ Library is distributed in the hope that it will be useful, but * + * WITHOUT ANY WARRANTY; without even the implied warranty of * + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU * + * Lesser General Public License for more details. * + * * + * You should have received a copy of the GNU Lesser General Public * + * License along with this program. If not, see * + * <http://www.gnu.org/licenses/>. * + *************************************************************************/ + +#ifndef VZ_VECTOR_HPP +#define VZ_VECTOR_HPP + +#include <algorithm> +#include <cmath> +#include <cstddef> + +namespace vZ +{ + // An N-dimensional vector + template <std::size_t N, typename T = double> + class Vector + { + public: + typedef typename Traits<T>::Scalar Scalar; + + Vector() { } + explicit Vector(T x) { m_values[0] = x; } + Vector(T x, T y) { m_values[0] = x; m_values[1] = y; } + Vector(T x, T y, T z) { m_values[0] = x; m_values[1] = y; m_values[2] = z; } + // Vector(const Vector& v); + // ~Vector(); + + // Vector& operator=(const Vector& v); + + // Component access + + T& operator[](std::size_t i) { return m_values[i]; } + const T& operator[](std::size_t i) const { return m_values[i]; } + + T x() const { return m_values[0]; } + T y() const { return m_values[1]; } + T z() const { return m_values[2]; } + + // Operators + inline Vector& operator+=(const Vector& rhs); + inline Vector& operator-=(const Vector& rhs); + inline Vector& operator*=(Scalar rhs); + inline Vector& operator/=(Scalar rhs); + + private: + T m_values[N]; + }; + + // Disallow 0-sized Vectors + template <typename T> + class Vector<0, T>; + + // Traits specialization + template <std::size_t N, typename T> + class Traits<Vector<N, T> > + { + public: + typedef typename Traits<T>::Scalar Scalar; + + private: + Traits(); + }; + + // Unary operators + + template <std::size_t N, typename T> + inline Vector<N, T> + operator+(const Vector<N, T>& rhs) + { + return rhs; + } + + template <std::size_t N, typename T> + inline Vector<N, T> + operator-(const Vector<N, T>& rhs) + { + Vector<N, T> res; + for (std::size_t i = 0; i < N; ++i) { + res[i] = -rhs[i]; + } + return res; + } + + template <std::size_t N, typename T> + inline typename Vector<N, T>::Scalar + norm(const Vector<N, T>& v) + { + using std::sqrt; + return sqrt(dot(v, v)); + } + + template <std::size_t N, typename T> + inline typename Vector<N, T>::Scalar + abs(const Vector<N, T>& v) + { + return norm(v); + } + + // Binary operators + + template <std::size_t N, typename T> + inline Vector<N, T> + operator+(const Vector<N, T>& lhs, const Vector<N, T>& rhs) + { + Vector<N, T> res = lhs; + res += rhs; + return res; + } + + template <std::size_t N, typename T> + inline Vector<N, T> + operator-(const Vector<N, T>& lhs, const Vector<N, T>& rhs) + { + Vector<N, T> res = lhs; + res -= rhs; + return res; + } + + template <std::size_t N, typename T> + inline Vector<N, T> + operator*(typename Vector<N, T>::Scalar lhs, + const Vector<N, T>& rhs) + { + Vector<N, T> res = rhs; + res *= lhs; + return res; + } + + template <std::size_t N, typename T> + inline Vector<N, T> + operator*(const Vector<N, T>& lhs, + typename Vector<N, T>::Scalar rhs) + { + Vector<N, T> res = lhs; + res *= rhs; + return res; + } + + template <std::size_t N, typename T> + inline Vector<N, T> + operator/(const Vector<N, T>& lhs, + typename Vector<N, T>::Scalar rhs) + { + Vector<N, T> res = lhs; + res /= rhs; + return res; + } + + template <std::size_t N, typename T> + inline typename Vector<N, T>::Scalar + dot(const Vector<N, T>& lhs, const Vector<N, T>& rhs) + { + typename Vector<N, T>::Scalar res(0); + for (std::size_t i = 0; i < N; ++i) { + res += lhs[i]*rhs[i]; + } + return res; + } + + template <typename T> + inline Vector<3, T> + cross(const Vector<3, T>& lhs, const Vector<3, T>& rhs) + { + return Vector<3, T>(lhs.y()*rhs.z() - lhs.z()*rhs.y(), + lhs.z()*rhs.x() - lhs.x()*rhs.z(), + lhs.x()*rhs.y() - lhs.y()*rhs.x()); + } + + // Implementation + + template <std::size_t N, typename T> + inline Vector<N, T>& + Vector<N, T>::operator+=(const Vector<N, T>& rhs) + { + for (std::size_t i = 0; i < N; ++i) { + m_values[i] += rhs.m_values[i]; + } + return *this; + } + + template <std::size_t N, typename T> + inline Vector<N, T>& + Vector<N, T>::operator-=(const Vector<N, T>& rhs) + { + for (std::size_t i = 0; i < N; ++i) { + m_values[i] -= rhs.m_values[i]; + } + return *this; + } + + template <std::size_t N, typename T> + inline Vector<N, T>& + Vector<N, T>::operator*=(typename Vector<N, T>::Scalar rhs) + { + for (std::size_t i = 0; i < N; ++i) { + m_values[i] *= rhs; + } + return *this; + } + + template <std::size_t N, typename T> + inline Vector<N, T>& + Vector<N, T>::operator/=(typename Vector<N, T>::Scalar rhs) + { + for (std::size_t i = 0; i < N; ++i) { + m_values[i] /= rhs; + } + return *this; + } +} + +#endif // VZ_VECTOR_HPP |