summaryrefslogtreecommitdiffstats
path: root/src/vZ
diff options
context:
space:
mode:
Diffstat (limited to 'src/vZ')
-rw-r--r--src/vZ/EquationSystem.hpp44
-rw-r--r--src/vZ/Vector.hpp228
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