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

Fixed float in square matrix.

Browse Source
This commit is contained in:
jgoppert
2015-11-05 11:23:54 -05:00
parent cbe8b4ef6f
commit 5b0ea675c3
1 changed files with 5 additions and 5 deletions
Download Patch File Download Diff File Expand all files Collapse all files
matrix/SquareMatrix.hpp
+5 -5
View File
@@ -36,7 +36,7 @@ public:
{
}
SquareMatrix(const Matrix<float, M, M> &other) :
SquareMatrix(const Matrix<Type, M, M> &other) :
Matrix<Type, M, M>(other)
{
}
@@ -176,16 +176,16 @@ public:
return res;
}
SquareMatrix<Type, M> expm(float dt, size_t n) const
SquareMatrix<Type, M> expm(Type dt, size_t n) const
{
SquareMatrix<float, M> res;
SquareMatrix<Type, M> res;
res.setIdentity();
SquareMatrix<float, M> A_pow = *this;
SquareMatrix<Type, M> A_pow = *this;
size_t k_fact = 1;
size_t k = 1;
while (k < n) {
res += A_pow * (float(pow(dt, k)) / k_fact);
res += A_pow * (Type(pow(dt, k)) / k_fact);
if (k == n) {
break;