summaryrefslogtreecommitdiff
path: root/src/body.cpp
diff options
context:
space:
mode:
authorMartin Miller2017-03-27 13:01:36 -0500
committerMartin Miller2017-03-27 13:01:36 -0500
commitdea8e97a10ba23fc0aeb98ac57106540936c73f4 (patch)
tree02bd6ad4206a13061a3d3f61a6d30fe2d221c81f /src/body.cpp
parentf172db4323c271aa16b883f8a3c571614c53691c (diff)
downloadrefslam-dea8e97a10ba23fc0aeb98ac57106540936c73f4.zip
refslam-dea8e97a10ba23fc0aeb98ac57106540936c73f4.tar.gz
Change Body::update to Body::dx
Update was too vague since a lot of things get updated. dx more clearly refers to the incremental update after a Kalman update.
Diffstat (limited to 'src/body.cpp')
-rw-r--r--src/body.cpp9
1 files changed, 5 insertions, 4 deletions
diff --git a/src/body.cpp b/src/body.cpp
index 1fd66d4..e6afe8a 100644
--- a/src/body.cpp
+++ b/src/body.cpp
@@ -20,21 +20,22 @@
/*
*--------------------------------------------------------------------------------------
* Class: Body
- * Method: Body :: update
+ * Method: Body :: dx
* Description: Increments the state by dx after a Kalman update.
*--------------------------------------------------------------------------------------
*/
void
-Body::update ( const Matrix<double,9,1> &dx )
+Body::dx ( const Matrix<double,9,1> &del )
{
- X += dx;
+ X += del;
+ // Constrain the height
if (X[2]<-1.) {
X[2]=-1.;
} else if (X[2]>-0.2) {
X[2]=-0.2;
}
return ;
-} /* ----- end of method Body::update ----- */
+} /* ----- end of method Body::dx ----- */
void
Body::vel ( const Matrix<double,3,1> &v )