best calibration without ba

This commit is contained in:
gfuse
2021-10-14 19:17:09 +02:00
parent a4e5c86932
commit 86ab38e13f
7 changed files with 9 additions and 2471 deletions
+1 -1
View File
@@ -41,7 +41,7 @@ add_service_files(FILES
generate_messages(DEPENDENCIES std_msgs)
catkin_package(
DEPENDS Eigen OpenCV Boost
CATKIN_DEPENDS roscpp roslib image_transport cv_bridge tf geometry_msgs message_runtime
CATKIN_DEPENDS roscpp roslib image_transport cv_bridge tf geometry_msgs message_runtime getOdom stop start
INCLUDE_DIRS include
)
# Include dirs
File diff suppressed because it is too large Load Diff
+3
View File
@@ -31,4 +31,7 @@
<run_depend>tf</run_depend>
<run_depend>geometry_msgs</run_depend>
<run_depend>message_runtime</run_depend>
<run_depend>getOdom</run_depend>
<run_depend>start</run_depend>
<run_depend>stop</run_depend>
</package>
+2 -2
View File
@@ -8,9 +8,9 @@ vio:
init_min_disparity: 10
structureoptim_max_pts: 50
kfselect_mindist: 0.01
poseoptim_thresh: 4.0
poseoptim_thresh: 1.5
ACC_ekf: 0.2 #acc white noise in continuous in EKF
GYO_ekf: 0.5 #gyro white noise in continuous in EKF
GYO_ekf: 0.1 #gyro white noise in continuous in EKF
VO_ekf_translation: 1.0 #VO noise in EKF
VO_ekf_orientation: 1.0 #VO noise in EKF
CMD_ekf_translation: 0.1 #control vector noise in EKF
+1 -1
View File
@@ -75,7 +75,7 @@ InitResult KltHomographyInit::addSecondFrame(FramePtr frame_cur)
}
computeHomography(frame_cur,
features_ref_, px_cur_,
frame_ref_->cam_->errorMultiplier2(), Config::poseOptimThresh(),
frame_ref_->cam_->errorMultiplier2(), 3.0*Config::poseOptimThresh(),
inliers_, xyz_in_cur_, T_cur_from_ref_);
if(inliers_.size() < Config::initMinInliers()){
#if VIO_DEBUG
+2 -2
View File
@@ -165,11 +165,11 @@ void Point::optimize(const size_t n_iter)
if(vk::norm_max(dp) <= EPS)
break;
}
n_failed_reproj_=0;
for(auto it=obs_.begin(); it!=obs_.end(); ++it) {
Vector2d e = vk::project2d((*it)->f) - vk::project2d((*it)->frame->w2f(pos_));
e /= (1<<(*it)->level);
if (e.squaredNorm() > 8.0*vio::Config::poseOptimThresh()/ (*it)->frame->cam_->errorMultiplier2())
if (e.squaredNorm() > 2.0*vio::Config::poseOptimThresh()/ (*it)->frame->cam_->errorMultiplier2())
n_failed_reproj_++;
}
if(n_failed_reproj_<0.50*obs_.size())