Run VINS-Mono and save its result as a .tum output for evo analysis

-
1. Install prerequisites [1]

*Solution for the eigen installation problem: reinstall eigen

$ git clone https://gitlab.com/libeigen/eigen.git
...
...
$ sudo make install

*check current eigen version:

$ pkg-config --modversion eigen3 (3.2.2 or later strongly recommended, 3.1.0 or later required.)


2. Build VINS-Mono on ROS

*Remember  to recompile Ceres with the same Eigen version as you plan to use in the VINS-mono project. In my case, since the Ceres was compiled once in the maplab project with different Eigen version, a problem with the Eigen version confliction was reported as following picture.


Solution: assign the desired Eigen path and recompile maplab ($ catkin build maplab)


After solving the problem mentioned above, you should be good to go...

cd ~/catkin_ws/src git
clone https://github.com/HKUST-Aerial-Robotics/VINS-Mono.git
cd ../ catkin_make
source ~/catkin_ws/devel/setup.bash


3. Run VINS-Mono using EuRoC dataset

$ roslaunch vins_estimator euroc.launch

load the config file: file -> Open Config-> YOUR_VINS_FOLDER/config/vins_rviz_config.rviz

$ rosbag play YOUR_PATH_TO_DATASET/MH_01_easy.bag


4. Save results as a .tum format

(1) Modify the content of  pose_graph.cpp in the functions updatePath(), addKeyFrame() as follows:


(2) Set the pose_graph_save_path, output_path in the config file (.../config/euroc/euroc_config.yaml). After playing MH_01 bag, input s in vins_estimator terminal, then enter. The current pose graph will be saved.

(3) Modify the output: vins_result_loop.csv as a .txt file. 

5. Check and plot result by evo

$ workon evaluation
$ evo_traj tum vins_result_loop.txt -p

$ deactivate

6. Save the analytical result as a .zip file.

ex: $ evo_ape tum gt_offset.tum VINS_Mono.txt -va --plot --plot_mode xz --save_results results/VINS_Mono.zip




Reference:
[1] http://ceres-solver.org/installation.html#linux
[2] https://github.com/HKUST-Aerial-Robotics/VINS-Mono

留言

張貼留言

這個網誌中的熱門文章

Useful PX4 Parameters

-
1. For setting companion link SYS_COMPANION (Before ver. 1.9.0) MAV_0_CONFIG, MAV_0_MODE (After ver. 1.9.0) 2. EKF2 configuration EKF2_AID_MASK EKF2_HGT_MODE EKF2_EV_DELAY (Reduce this parameter if high rate external vision is available) EKF2_EV_POS_X, EKF2_EV_POS_Y, EKF2_EV_POS_Z 3. Offboard mode parameters ( The vehicle will exit the mode if target setpoints are not received at a rate of > 2Hz ) COM_OBL_RC_ACT (Default: position mode, I set land mode) COM_OBL_ACT COM_OF_LOSS_T 4. Position loss failsafe COM_POSCTL_NAVL 5. Land mode MPC_LAND_SPEED COM_DISARM_LAND: Time-out for auto disarm after landing. (Default: 0, I set 3.) 6. TBD Reference: [1]  https://dev.px4.io/en/advanced/parameter_reference.html [2]  https://dev.px4.io/en/ros/external_position_estimation.html#tuning-EKF2_EV_DELAY [3]  https://docs.px4.io/en/config/safety.html#qgc_safety_setup
閱讀完整內容

Tuing PID parameters in QGroundcontrol (2)

-
圖片
Based on tips for tuning PX4 PID parameters written in my previous post [1] or even using the default values directly, you will be able to fly your vehicle freely in manual or stabilized flight mode.   However, if you are using an unique vehicle (usually assembly by yourself and only equipped with sensors you desire) and struggling for finding the best PID parameters for your applications. I think following 8 tips will help you to get ideal PID parameters.  This is the vehicle I made based on LHI QAV250 fiber frame, with TX2, high-speed camera, etc.[2]  Tip1:  Tuning order: Rate controller -> attitude controller -> position controller The PX4 controllers are layered [3], which means a higher-level controller passes its results to a lower-level controller. Thus the PID tuning needs to be done from lowest-level controller to highest-level controller. Tip2:  Check if  PWM_MIN  is set correctly. Remove propellers Arm the vehic...
閱讀完整內容

Matlab Pixhawk Support Package installation (Windows)

-
圖片
1. Download the pixhawk support package [1] 2. Open MATLAB R2017b and navigate to the file location. 3. Click "PX4PSP_v3_0_4_351_R2017b" and install it 4. Create a folder for firmware download path (ex: D/PX4) 5. Setting bash environment for windows 10 [2]  (1) Active "Windows subsystem for linux" (2) Download and install Ubuntu (3) Using the terminal like in Ubuntu environment ex: 6. Install all necessary toolchain with " windows_bash_nuttx.sh " [3] or using Cygwin Toolchian [4] or [5] (python27 would show in following folder) 7. Key in command " PixhawkPSP(' D:\PX4 ') " in the Matlab 8. Make sure windows 10 bash and python path are correct => Validate paths 9. Download firmware to the folder we specify before and then validate firmware. 10. Selecting cmake configuration [6] 11. Build firmware *Error: make command not found   Solution: [7] T...
閱讀完整內容