12345qiupeng
/
gtsam
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

matrix definition on same line

release/4.3a0
Luca 2014-12-09 19:05:14 -05:00
parent b96a463b10
commit 57d83be48a
1 changed files with 2 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

4
gtsam/navigation/PreintegrationBase.h
View File

@ -127,10 +127,10 @@ public:
} }
deltaVij_ += temp; deltaVij_ += temp;
Matrix3 R_i; Matrix3 R_i, F_angles_angles;
if (F) R_i = deltaRij(); // has to be executed before updateIntegratedRotationAndDeltaT as that updates deltaRij if (F) R_i = deltaRij(); // has to be executed before updateIntegratedRotationAndDeltaT as that updates deltaRij
Matrix3 F_angles_angles;
updateIntegratedRotationAndDeltaT(incrR,deltaT, F ? &F_angles_angles : 0); updateIntegratedRotationAndDeltaT(incrR,deltaT, F ? &F_angles_angles : 0);
if(F){ if(F){
Matrix3 F_vel_angles = - R_i * skewSymmetric(correctedAcc) * deltaT; Matrix3 F_vel_angles = - R_i * skewSymmetric(correctedAcc) * deltaT;
// pos vel angle // pos vel angle