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

A wrong commit of last smartRangeFactor.m Now fixed.

release/4.3a0
lvzhaoyang 2014-12-07 00:41:12 -05:00
parent a8811beb31
commit 240a9592b9
1 changed files with 2 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

4
matlab/unstable_examples/SmartRangeFactorExample.m
View File

@ -82,8 +82,8 @@ for ind_pose = 2:7
key_prev = poseKey(ind_pose-1); key_prev = poseKey(ind_pose-1);
key_curr = poseKey(ind_pose); key_curr = poseKey(ind_pose);
prev_pose = smartValues.at(key_prev); prev_pose = smartValues.atPose2(key_prev);
curr_pose = smartValues.at(key_curr); curr_pose = smartValues.atPose2(key_curr);
GTDeltaPose = prev_pose.between(curr_pose); GTDeltaPose = prev_pose.between(curr_pose);
noisePose = Pose2([t_noise*rand; t_noise*rand; r_noise*rand]); noisePose = Pose2([t_noise*rand; t_noise*rand; r_noise*rand]);
NoisyDeltaPose = GTDeltaPose.compose(noisePose); NoisyDeltaPose = GTDeltaPose.compose(noisePose);