In our previous paper, we investigate the consensus problem with von Mises distribution. We want to extend our analysis to more general distributions, in particular the von Mises-Fisher (vMF) distribution over hyperspheres. In fact, vMF distributions are used in some machine learning algorithms. I...
error.pdf result_2.pdf I implemented the EM based SLAM algorithms. However, in a visual inertial system, we can to take care of other realistic issues besides the theoretical algorithm itself. It will be insightful to compare the optimization based algorithm, since it has been developed for a wh...
Optimization-based SLAM From the pre-optimization (blue line) to the post-optimization (orange line), we can see that the optimization method enables the loop closure effect. The key improvement lies in the better computer vision techniques by discarding possibly erroneous keypoints. Also, the...
Previously, I finished the feature matching and id assignment in the SLAM frontend. Last week, I combine the result with the preintegrated IMU data to formulate an optimization problem. Initial values I initialize the landmark position by triangulate two frames. The selection of these two points...
okvis is a visual odometry. Therefore, the feature matching only occurs within short time window, and the feature matching that enables loop closure is not provided. The following is the overview as well as the result of the feature matching that I implemented. Keyframe selection This part relie...
After surveying several SLAM and visual odometry implementation, I decided to work on okvis with monocular camera setting. I will run an nonlinear optimization on the output of the visual odometry system, which can be regarded as global bundle adjustment with IMU constraints. The output of visua...
For 3D navigation systems, representing the orientation is always annoying. After going through several painful learning and debugging processes, I share some lessons that I learned. The quaterion parameterization There are several ways to represent a 3d orientation. In real system, everyone pre...
It took me a while to really understand the structure of the okvis SLAM system. In order to prevent from studying its structure all over again, it is better for me to put down what I understand so far. The main goal of this post is to bridge the gap between the theoretical understanding and the so...
I implemented the preintegration techniques from this paper. In order to implement the preintegration, the underlying optmization problem structure is also change. To be precise, previously, we optimize all the IMU data point, but now we only optimize the keyframe. The trajectory plot show t...
The SLAM frontend, in my definition, finds the features in the image and assigns the same landmark id to matched images. The overall SLAM performance relies on the quality of observation file provided by the frontend, as well as the optimization problem established by the backend. Frontend The...