Mirror
/
ardupilot
mirror of https://github.com/ArduPilot/ardupilot
5
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

AP_Math: added more operators to VectorN

This commit is contained in:
Andrew Tridgell 2014-02-19 09:21:59 +11:00
parent 869e41fd03
commit 599c3a8abf
1 changed files with 77 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

77
libraries/AP_Math/vectorN.h
View File

@ -60,6 +60,83 @@ public:
memset(_v, 0, sizeof(T)*N);
}
// negation
VectorN<T,N> operator -(void) const {
VectorN<T,N> v2;
for (uint8_t i=0; i<N; i++) {
v2[i] = - _v[i];
}
return v2;
}
// addition
VectorN<T,N> operator +(const VectorN<T,N> &v) const {
VectorN<T,N> v2;
for (uint8_t i=0; i<N; i++) {
v2[i] = _v[i] + v[i];
}
return v2;
}
// subtraction
VectorN<T,N> operator -(const VectorN<T,N> &v) const {
VectorN<T,N> v2;
for (uint8_t i=0; i<N; i++) {
v2[i] = _v[i] - v[i];
}
return v2;
}
// uniform scaling
VectorN<T,N> operator *(const T num) const {
VectorN<T,N> v2;
for (uint8_t i=0; i<N; i++) {
v2[i] = _v[i] * num;
}
return v2;
}
// uniform scaling
VectorN<T,N> operator /(const T num) const {
VectorN<T,N> v2;
for (uint8_t i=0; i<N; i++) {
v2[i] = _v[i] / num;
}
return v2;
}
// addition
VectorN<T,N> &operator +=(const VectorN<T,N> &v) {
for (uint8_t i=0; i<N; i++) {
_v[i] += v[i];
}
return *this;
}
// subtraction
VectorN<T,N> &operator -=(const VectorN<T,N> &v) {
for (uint8_t i=0; i<N; i++) {
_v[i] -= v[i];
}
return *this;
}
// uniform scaling
VectorN<T,N> &operator *=(const T num) {
for (uint8_t i=0; i<N; i++) {
_v[i] *= num;
}
return *this;
}
// uniform scaling
VectorN<T,N> &operator /=(const T num) {
for (uint8_t i=0; i<N; i++) {
_v[i] /= num;
}
return *this;
}
private:
T _v[N];
};