[Top][All Lists]
[Date Prev][Date Next][Thread Prev][Thread Next][Date Index][Thread Index]
[Toon-members] tag/tag constantvelocity.h
From: |
Gerhard Reitmayr |
Subject: |
[Toon-members] tag/tag constantvelocity.h |
Date: |
Thu, 02 Apr 2009 14:20:15 +0000 |
CVSROOT: /cvsroot/toon
Module name: tag
Changes by: Gerhard Reitmayr <gerhard> 09/04/02 14:20:15
Modified files:
tag : constantvelocity.h
Log message:
minimal cleanup
CVSWeb URLs:
http://cvs.savannah.gnu.org/viewcvs/tag/tag/constantvelocity.h?cvsroot=toon&r1=1.3&r2=1.4
Patches:
Index: constantvelocity.h
===================================================================
RCS file: /cvsroot/toon/tag/tag/constantvelocity.h,v
retrieving revision 1.3
retrieving revision 1.4
diff -u -b -r1.3 -r1.4
--- constantvelocity.h 14 Dec 2006 14:00:46 -0000 1.3
+++ constantvelocity.h 2 Apr 2009 14:20:14 -0000 1.4
@@ -21,14 +21,14 @@
reset();
}
- inline void reset(void){
+ void reset(void){
pose = TooN::SE3();
TooN::Zero(angularVelocity);
TooN::Zero(velocity);
TooN::Identity(covariance);
}
- inline void resetVelocity(void){
+ void resetVelocity(void){
TooN::Zero(angularVelocity);
TooN::Zero(velocity);
}
@@ -67,7 +67,7 @@
}
// Jacobian has pos, rot, vel, angularVel in this order
- inline const TooN::Matrix<State::STATE_DIMENSION> & getJacobian(const
State & state, const double dt) {
+ const TooN::Matrix<State::STATE_DIMENSION> & getJacobian(const State &
state, const double dt) {
jacobian(0,6) = dt;
jacobian(1,7) = dt;
jacobian(2,8) = dt;
@@ -77,7 +77,7 @@
return jacobian;
}
- inline void updateState( State & state, const double dt ){
+ void updateState( State & state, const double dt ){
// full velocity vector
TooN::Vector<6> vel;
vel.slice<0,3>() = state.velocity;
@@ -91,7 +91,7 @@
state.angularVelocity *= attenuation;
}
- inline const TooN::Matrix<State::STATE_DIMENSION> & getNoiseCovariance(
const double dt ){
+ const TooN::Matrix<State::STATE_DIMENSION> & getNoiseCovariance( const
double dt ){
const double dt2 = dt * dt * 0.5;
const double dt3 = dt * dt * dt * 0.3333333333333;
for(unsigned int i = 0; i < 6; i++){
@@ -102,7 +102,7 @@
return noise;
}
- inline void updateFromMeasurement( State & state, const
TooN::Vector<State::STATE_DIMENSION> & innovation ){
+ void updateFromMeasurement( State & state, const
TooN::Vector<State::STATE_DIMENSION> & innovation ){
state.pose = TooN::SE3::exp(innovation.slice<0,6>()) * state.pose;
state.velocity = state.velocity + innovation.slice<6,3>();
state.angularVelocity = state.angularVelocity +
innovation.slice<9,3>();
[Prev in Thread] |
Current Thread |
[Next in Thread] |
- [Toon-members] tag/tag constantvelocity.h,
Gerhard Reitmayr <=