Merge branch 'master' of gitlab.vision.in.tum.de:slam/basalt
This commit is contained in:
commit
8524056e0c
|
@ -325,9 +325,9 @@ class SplineOptimization {
|
|||
|
||||
ccd.pose_var_inv = pose_var_inv;
|
||||
ccd.gyro_var_inv =
|
||||
calib->dicreete_time_gyro_noise_std().array().square().inverse();
|
||||
calib->dicrete_time_gyro_noise_std().array().square().inverse();
|
||||
ccd.accel_var_inv =
|
||||
calib->dicreete_time_accel_noise_std().array().square().inverse();
|
||||
calib->dicrete_time_accel_noise_std().array().square().inverse();
|
||||
ccd.mocap_var_inv = pose_var_inv;
|
||||
}
|
||||
|
||||
|
|
|
@ -264,7 +264,7 @@ class BundleAdjustmentBase {
|
|||
Vec4 worldPoint = mySVD.matrixV().col(3);
|
||||
worldPoint /= worldPoint.template head<3>().norm();
|
||||
|
||||
// Enforse same direction of bearing vector and initial point
|
||||
// Enforce same direction of bearing vector and initial point
|
||||
if (f0.dot(worldPoint.template head<3>()) < 0) worldPoint *= -1;
|
||||
|
||||
return worldPoint;
|
||||
|
|
|
@ -113,9 +113,9 @@ void KeypointVioEstimator::initialize(const Eigen::Vector3d& bg,
|
|||
IntegratedImuMeasurement::Ptr meas;
|
||||
|
||||
const Eigen::Vector3d accel_cov =
|
||||
calib.dicreete_time_accel_noise_std().array().square();
|
||||
calib.dicrete_time_accel_noise_std().array().square();
|
||||
const Eigen::Vector3d gyro_cov =
|
||||
calib.dicreete_time_gyro_noise_std().array().square();
|
||||
calib.dicrete_time_gyro_noise_std().array().square();
|
||||
|
||||
ImuData::Ptr data;
|
||||
imu_data_queue.pop(data);
|
||||
|
|
|
@ -595,9 +595,9 @@ void compute_projections() {
|
|||
|
||||
void gen_data() {
|
||||
std::normal_distribution<> gyro_noise_dist{
|
||||
0, calib.dicreete_time_gyro_noise_std()[0]};
|
||||
0, calib.dicrete_time_gyro_noise_std()[0]};
|
||||
std::normal_distribution<> accel_noise_dist{
|
||||
0, calib.dicreete_time_accel_noise_std()[0]};
|
||||
0, calib.dicrete_time_accel_noise_std()[0]};
|
||||
|
||||
std::normal_distribution<> gyro_bias_dist{0, calib.gyro_bias_std[0]};
|
||||
std::normal_distribution<> accel_bias_dist{0, calib.accel_bias_std[0]};
|
||||
|
|
|
@ -1 +1 @@
|
|||
Subproject commit d169d697f8902ca684e41887eee3bedf91176e56
|
||||
Subproject commit 12b6290f01aa49c15cfec4d8ed8f347323678297
|
Loading…
Reference in New Issue