aau-cns / cnspy_trajectory_evaluation Goto Github PK
View Code? Open in Web Editor NEWA python3 package for evaluating trajectories for different error metrics.
License: GNU General Public License v3.0
A python3 package for evaluating trajectories for different error metrics.
License: GNU General Public License v3.0
I was taking a look at the weird OpenVINS NEES results, in your paper and I believe it is because you are using the "global" orientation error state as compared to the outputed "local" error-state covariance. See the ATE error and the NEES error computation in the two files below which compute the global error (to my understanding):
https://github.com/aau-cns/cnspy_trajectory_evaluation/blob/main/cnspy_trajectory_evaluation/AbsoluteTrajectoryError.py#L152
https://github.com/aau-cns/cnspy_trajectory_evaluation/blob/main/cnspy_trajectory_evaluation/TrajectoryNEES.py#L156
Additionally, it seems that the estimated trajectory is transformed as compared to the groundtruth. Ideally, this means that a covariance propagation should be performed since this is changing the underlying error state location. I think this will be an issue for the position and global orientation error state methods. The way to get around this is to just align the groundtruth to the estimate instead (this might not be that big of an effect at the end of the day).
https://github.com/aau-cns/cnspy_trajectory_evaluation/blob/main/cnspy_trajectory_evaluation/AlignedTrajectories.py#L42
OpenVINS outputs the covariance in the local error state for the q_GtoI JPL quaternion orientation:
https://github.com/rpng/open_vins/blob/master/ov_msckf/src/ros/ROS1Visualizer.cpp#L524-L534
or in SO(3) terms it is:
(I-skew(theta)) * R_GtoI_hat = R_GtoI_true
or in your notation:
(I-skew(theta)) * R_B_G_est = R_B_G_true
As an example, one can inspect the codebase to see how we performed evaluation for NEES:
https://github.com/rpng/open_vins/blob/master/ov_eval/src/calc/ResultTrajectory.cpp#L254-L265
Hope this helps.
A declarative, efficient, and flexible JavaScript library for building user interfaces.
๐ Vue.js is a progressive, incrementally-adoptable JavaScript framework for building UI on the web.
TypeScript is a superset of JavaScript that compiles to clean JavaScript output.
An Open Source Machine Learning Framework for Everyone
The Web framework for perfectionists with deadlines.
A PHP framework for web artisans
Bring data to life with SVG, Canvas and HTML. ๐๐๐
JavaScript (JS) is a lightweight interpreted programming language with first-class functions.
Some thing interesting about web. New door for the world.
A server is a program made to process requests and deliver data to clients.
Machine learning is a way of modeling and interpreting data that allows a piece of software to respond intelligently.
Some thing interesting about visualization, use data art
Some thing interesting about game, make everyone happy.
We are working to build community through open source technology. NB: members must have two-factor auth.
Open source projects and samples from Microsoft.
Google โค๏ธ Open Source for everyone.
Alibaba Open Source for everyone
Data-Driven Documents codes.
China tencent open source team.