30 #ifndef WFMATH_VECTOR_FUNCS_H
31 #define WFMATH_VECTOR_FUNCS_H
33 #include <wfmath/vector.h>
34 #include <wfmath/rotmatrix.h>
35 #include <wfmath/zero.h>
48 for(
int i = 0; i < dim; ++i) {
49 m_elem[i] = v.m_elem[i];
56 for(
int i = 0; i < dim; ++i) {
57 m_elem[i] = p.elements()[i];
74 for(
int i = 0; i < dim; ++i) {
75 m_elem[i] = v.m_elem[i];
82 bool Vector<dim>::isEqualTo(
const Vector<dim>& v,
CoordType epsilon)
const
84 double delta = _ScaleEpsilon(m_elem, v.m_elem, dim, epsilon);
86 for(
int i = 0; i < dim; ++i) {
87 if(std::fabs(m_elem[i] - v.m_elem[i]) > delta) {
96 Vector<dim>& operator+=(Vector<dim>& v1,
const Vector<dim>& v2)
98 v1.m_valid = v1.m_valid && v2.m_valid;
100 for(
int i = 0; i < dim; ++i) {
101 v1.m_elem[i] += v2.m_elem[i];
108 Vector<dim>& operator-=(Vector<dim>& v1,
const Vector<dim>& v2)
110 v1.m_valid = v1.m_valid && v2.m_valid;
112 for(
int i = 0; i < dim; ++i) {
113 v1.m_elem[i] -= v2.m_elem[i];
120 Vector<dim>& operator*=(Vector<dim>& v,
CoordType d)
122 for(
int i = 0; i < dim; ++i) {
130 Vector<dim>& operator/=(Vector<dim>& v,
CoordType d)
132 for(
int i = 0; i < dim; ++i) {
141 Vector<dim> operator-(
const Vector<dim>& v)
145 ans.m_valid = v.m_valid;
147 for(
int i = 0; i < dim; ++i) {
148 ans.m_elem[i] = -v.m_elem[i];
159 assert(
"need nonzero length vector" && mag > norm / std::numeric_limits<CoordType>::max());
161 return (*
this *= norm / mag);
169 for(
int i = 0; i < dim; ++i) {
193 assert(axis1 >= 0 && axis2 >= 0 && axis1 < dim && axis2 < dim && axis1 != axis2);
195 CoordType tmp1 = m_elem[axis1], tmp2 = m_elem[axis2];
197 ctheta = std::cos(theta);
199 m_elem[axis1] = tmp1 * ctheta - tmp2 * stheta;
200 m_elem[axis2] = tmp2 * ctheta + tmp1 * stheta;
210 return operator=(
Prod(*
this, m.
rotation(v1, v2, theta)));
216 return *
this =
Prod(*
this, m);
225 double delta = _ScaleEpsilon(v1.m_elem, v2.m_elem, dim);
229 for(
int i = 0; i < dim; ++i) {
230 ans += v1.m_elem[i] * v2.m_elem[i];
233 return (std::fabs(ans) >= delta) ? ans : 0;
241 for(
int i = 0; i < dim; ++i) {
243 ans += m_elem[i] * m_elem[i];
254 for(
int i = 0; i < dim; ++i) {
255 CoordType val1 = std::fabs(v1[i]), val2 = std::fabs(v2[i]);
266 (void) std::frexp(max1, &exp1);
267 (void) std::frexp(max2, &exp2);
269 return std::fabs(Dot(v1, v2)) < std::ldexp(numeric_constants<CoordType>::epsilon(), exp1 + exp2);
301 {
return std::fabs(m_elem[0]);}
304 {m_elem[0] = x; m_elem[1] = y;}
305 template<> Vector<3>::Vector(CoordType x, CoordType y, CoordType z) : m_valid(true)
306 {m_elem[0] = x; m_elem[1] = y; m_elem[2] = z;}
308 template<> Vector<2>& Vector<2>::rotate(CoordType theta)
309 {
return rotate(0, 1, theta);}
311 template<> Vector<3>& Vector<3>::rotateX(CoordType theta)
312 {
return rotate(1, 2, theta);}
313 template<> Vector<3>& Vector<3>::rotateY(CoordType theta)
314 {
return rotate(2, 0, theta);}
315 template<> Vector<3>& Vector<3>::rotateZ(CoordType theta)
316 {
return rotate(0, 1, theta);}
321 #endif // WFMATH_VECTOR_FUNCS_H