fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-05-17 05:37:35 +08:00
Code Issues Packages Projects Releases Wiki Activity

Do += -= and scalar *= /= in place

Browse Source
This commit is contained in:
Julian Kent
2020-06-30 15:47:23 +02:00
committed by Daniel Agar
parent f529358e9a
commit f3cf615023
1 changed files with 20 additions and 6 deletions
Download Patch File Download Diff File Expand all files Collapse all files
matrix/Matrix.hpp
+20 -6
View File
@@ -238,13 +238,21 @@ public:
void operator+=(const Matrix<Type, M, N> &other)
{
Matrix<Type, M, N> &self = *this;
self = self + other;
for (size_t i = 0; i < M; i++) {
for (size_t j = 0; j < N; j++) {
self(i, j) += other(i, j);
}
}
}
void operator-=(const Matrix<Type, M, N> &other)
{
Matrix<Type, M, N> &self = *this;
self = self - other;
for (size_t i = 0; i < M; i++) {
for (size_t j = 0; j < N; j++) {
self(i, j) -= other(i, j);
}
}
}
template<size_t P>
@@ -302,7 +310,7 @@ public:
for (size_t i = 0; i < M; i++) {
for (size_t j = 0; j < N; j++) {
self(i, j) = self(i, j) * scalar;
self(i, j) *= scalar;
}
}
}
@@ -310,17 +318,23 @@ public:
void operator/=(Type scalar)
{
Matrix<Type, M, N> &self = *this;
self = self * (Type(1) / scalar);
self *= (Type(1) / scalar);
}
inline void operator+=(Type scalar)
{
*this = (*this) + scalar;
Matrix<Type, M, N> &self = *this;
for (size_t i = 0; i < M; i++) {
for (size_t j = 0; j < N; j++) {
self(i, j) += scalar;
}
}
}
inline void operator-=(Type scalar)
{
*this = (*this) - scalar;
Matrix<Type, M, N> &self = *this;
self += (-scalar);
}
bool operator==(const Matrix<Type, M, N> &other) const