fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-10-21 08:03: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/Dcm.hpp
+3 -3
View File
@@ -166,9 +166,9 @@ public:
void renormalize()
{
/* renormalize rows */
for (size_t row = 0; row < 3; row++) {
matrix::Vector3f rvec(this->_data[row]);
this->setRow(row, rvec.normalized());
for (size_t r = 0; r < 3; r++) {
matrix::Vector3<Type> rvec(Matrix<Type,1,3>(this->Matrix<Type,3,3>::row(r)).transpose());
this->Matrix<Type,3,3>::row(r) = rvec.normalized();
}
}
};