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

Add helpers based on Slice: row(), col(), xy()

Browse Source
This commit is contained in:
Julian Kent
2019-09-16 16:11:08 +02:00
parent 82d565f4d9
commit b817e8677d
5 changed files with 102 additions and 13 deletions
Download Patch File Download Diff File Expand all files Collapse all files
matrix/Matrix.hpp
+25 -10
View File
@@ -381,20 +381,35 @@ public:
return Slice<Type, P, Q, M, N>(x0, y0, this);
}
void setRow(size_t i, const Matrix<Type, N, 1> &row)
const Slice<Type, 1, N, M, N> row(size_t i) const
{
Matrix<Type, M, N> &self = *this;
for (size_t j = 0; j < N; j++) {
self(i, j) = row(j, 0);
}
return slice<1, N>(i,0);
}
void setCol(size_t j, const Matrix<Type, M, 1> &col)
Slice<Type, 1, N, M, N> row(size_t i)
{
Matrix<Type, M, N> &self = *this;
for (size_t i = 0; i < M; i++) {
self(i, j) = col(i, 0);
}
return slice<1, N>(i,0);
}
const Slice<Type, M, 1, M, N> col(size_t j) const
{
return slice<M, 1>(0,j);
}
Slice<Type, M, 1, M, N> col(size_t j)
{
return slice<M, 1>(0,j);
}
void setRow(size_t i, const Matrix<Type, N, 1> &row_in)
{
slice<1,N>(i,0) = row_in.transpose();
}
void setCol(size_t j, const Matrix<Type, M, 1> &column)
{
slice<M,1>(0,j) = column;
}
void setZero()