diff options
author | Martin Miller | 2017-03-25 16:13:37 -0500 |
---|---|---|
committer | Martin Miller | 2017-03-25 16:13:37 -0500 |
commit | 5cefa66fd4782e2ecf50770888e9ae043b79c1b9 (patch) | |
tree | d52be9f2324e0db37ee152f78ff424452d68a217 | |
parent | 8d6334e96eb381efc1a59ccfab67827d423d3cfe (diff) | |
download | refslam-5cefa66fd4782e2ecf50770888e9ae043b79c1b9.zip refslam-5cefa66fd4782e2ecf50770888e9ae043b79c1b9.tar.gz |
Update Body::S
Change variable name to reflect that we are only using Pxx and not the
full P matrix.
-rw-r--r-- | src/body.cpp | 4 | ||||
-rw-r--r-- | src/body.h | 2 |
2 files changed, 3 insertions, 3 deletions
diff --git a/src/body.cpp b/src/body.cpp index a5c572a..83838a5 100644 --- a/src/body.cpp +++ b/src/body.cpp @@ -47,10 +47,10 @@ Body::vel ( const Matrix<double,3,1> &v ) *-------------------------------------------------------------------------------------- */ Matrix<double,1,1> -Body::S ( const Matrix<double,9,9> &P ) +Body::S ( const Matrix<double,9,9> &Pxx ) { Matrix<double,1,1> S; - S << P(2,2); + S << Pxx(2,2); return S+R(); } /* ----- end of method Body::S ----- */ @@ -38,7 +38,7 @@ class Body const Quaterniond &q, const double dt); Matrix<double,9,9> Q(double dt); Matrix<double,1,1> R(); - Matrix<double,1,1> S(const Matrix<double,9,9> &P); + Matrix<double,1,1> S(const Matrix<double,9,9> &Pxx); Matrix<double,3,3> skewSymmetric(const Vector3d &x); void unicsv(); |