do calibration

GPU_version/vio/param/vo_fast.yaml

@@ -8,11 +8,10 @@ vio:
   init_min_disparity: 10
   structureoptim_max_pts: 50
   kfselect_mindist: 0.01
-  poseoptim_thresh: 1.75
-  init_min_inliers: 40
+  poseoptim_thresh: 3.0
   ACC_ekf: 0.2          #acc white noise in continuous in EKF
   GYO_ekf: 0.5         #gyro white noise in continuous in EKF
   VO_ekf_translation: 1.0              #VO noise  in EKF
-  VO_ekf_orientation: 0.5              #VO noise  in EKF
+  VO_ekf_orientation: 1.0              #VO noise  in EKF
   CMD_ekf_translation: 0.1  #control vector noise in EKF
   CMD_ekf_orientation: 0.01  #control vector noise in EKF

GPU_version/vio/src/global_optimizer.cpp

@@ -143,7 +143,7 @@ namespace vio {
                    // }
                 }
             }
-            if(optimizer.vertices().empty()){
+            if(optimizer.vertices().empty() || optimizer.vertices().size()<1){
                 ba_mux_.unlock();
                 continue;
             }