fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-10-23 08:33:34 +08:00
Code Issues Packages Projects Releases Wiki Activity

Added support for attitude_estimator_q functions.

Browse Source
This commit is contained in:
James Goppert
2016-03-15 06:35:13 -04:00
parent 6c04605531
commit 0e14e11183
5 changed files with 29 additions and 3 deletions
Download Patch File Download Diff File Expand all files Collapse all files
matrix/Matrix.hpp
+16
View File
@@ -342,6 +342,22 @@ public:
}
}
void setRow(size_t i, const Matrix<Type, N, 1> &row)
{
Matrix<Type, M, N> &self = *this;
for (size_t j = 0; j < N; j++) {
self(i, j) = row(j, 0);
}
}
void setCol(size_t j, const Matrix<Type, M, 1> &col)
{
Matrix<Type, M, N> &self = *this;
for (size_t i = 0; i < M; i++) {
self(i, j) = col(i, 1);
}
}
void setZero()
{
memset(_data, 0, sizeof(_data));