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

extra lines.. to be completed

release/4.3a0
Luca 2014-02-17 10:34:02 -05:00
parent 794a22249b
commit 8f39734580
1 changed files with 9 additions and 4 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

13
matlab/unstable_examples/+imuSimulator/coriolisTestMonteCarlo.m
View File

@ -47,14 +47,14 @@ else
end end
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%% %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
numTests = 10 numTests = 20
for testInd=1:numTests for testInd=1:numTests
navFrameRotating = 0; navFrameRotating = 0;
accelFixed = 2*rand(3,1)-ones(3,1); accelFixed = 2*rand(3,1)-ones(3,1);
imuSimulator.coriolisExample imuSimulator.coriolisExample
posFinError(testInd) = norm(axisPositionsError(:,end))/trajectoryLengthFixedFrameGT*100 posFinErrorFixed(testInd) = norm(axisPositionsError(:,end))/trajectoryLengthFixedFrameGT*100
rotFinError(testInd) = norm(rotationsErrorVectors(:,end)) rotFinErrorFixed(testInd) = norm(rotationsErrorVectors(:,end))
velFinError(testInd) = norm(axisVelocityError(:,end)) velFinErrorFixed(testInd) = norm(axisVelocityError(:,end))
% Run the same initial conditions but navigating in the rotating frame % Run the same initial conditions but navigating in the rotating frame
navFrameRotating = 1; navFrameRotating = 1;
imuSimulator.coriolisExample imuSimulator.coriolisExample
@ -63,4 +63,9 @@ for testInd=1:numTests
velFinErrorRot(testInd) = norm(axisVelocityError(:,end)) velFinErrorRot(testInd) = norm(axisVelocityError(:,end))
end end
mean(posFinErrorFixed)
max(posFinErrorFixed)
box(posFinErrorFixed)