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

small change

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

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

@ -48,21 +48,19 @@ end
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%% %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
numTests = 10 numTests = 10
% for testInd=1:numTests for testInd=1:numTests
% accelFixed = 2*rand(3,1)-ones(3,1); navFrameRotating = 0;
% imuSimulator.coriolisExample accelFixed = 2*rand(3,1)-ones(3,1);
% posFinError(testInd) = norm(axisPositionsError(:,end))/trajectoryLengthFixedFrameGT*100 imuSimulator.coriolisExample
% rotFinError(testInd) = norm(rotationsErrorVectors(:,end)) posFinError(testInd) = norm(axisPositionsError(:,end))/trajectoryLengthFixedFrameGT*100
% velFinError(testInd) = norm(axisVelocityError(:,end)) rotFinError(testInd) = norm(rotationsErrorVectors(:,end))
% end velFinError(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;
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
for testInd=1:numTests
accelFixed = 2*rand(3,1)-ones(3,1);
imuSimulator.coriolisExample imuSimulator.coriolisExample
posFinErrorRot(testInd) = norm(axisPositionsError(:,end))/trajLen*100 posFinErrorRot(testInd) = norm(axisPositionsError(:,end))/trajLen*100
rotFinErrorRot(testInd) = norm(rotationsErrorVectors(:,end)) rotFinErrorRot(testInd) = norm(rotationsErrorVectors(:,end))
velFinErrorRot(testInd) = norm(axisVelocityError(:,end)) velFinErrorRot(testInd) = norm(axisVelocityError(:,end))
end end