Merge branch 'pangolin-deprecated' into 'master'
some typos See merge request basalt/basalt!27
This commit is contained in:
		
						commit
						0012722df7
					
				@ -325,9 +325,9 @@ class SplineOptimization {
 | 
				
			|||||||
 | 
					
 | 
				
			||||||
    ccd.pose_var_inv = pose_var_inv;
 | 
					    ccd.pose_var_inv = pose_var_inv;
 | 
				
			||||||
    ccd.gyro_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 =
 | 
					    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;
 | 
					    ccd.mocap_var_inv = pose_var_inv;
 | 
				
			||||||
  }
 | 
					  }
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
				
			|||||||
@ -264,7 +264,7 @@ class BundleAdjustmentBase {
 | 
				
			|||||||
    Vec4 worldPoint = mySVD.matrixV().col(3);
 | 
					    Vec4 worldPoint = mySVD.matrixV().col(3);
 | 
				
			||||||
    worldPoint /= worldPoint.template head<3>().norm();
 | 
					    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;
 | 
					    if (f0.dot(worldPoint.template head<3>()) < 0) worldPoint *= -1;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
    return worldPoint;
 | 
					    return worldPoint;
 | 
				
			||||||
 | 
				
			|||||||
@ -113,9 +113,9 @@ void KeypointVioEstimator::initialize(const Eigen::Vector3d& bg,
 | 
				
			|||||||
    IntegratedImuMeasurement::Ptr meas;
 | 
					    IntegratedImuMeasurement::Ptr meas;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
    const Eigen::Vector3d accel_cov =
 | 
					    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 =
 | 
					    const Eigen::Vector3d gyro_cov =
 | 
				
			||||||
        calib.dicreete_time_gyro_noise_std().array().square();
 | 
					        calib.dicrete_time_gyro_noise_std().array().square();
 | 
				
			||||||
 | 
					
 | 
				
			||||||
    ImuData::Ptr data;
 | 
					    ImuData::Ptr data;
 | 
				
			||||||
    imu_data_queue.pop(data);
 | 
					    imu_data_queue.pop(data);
 | 
				
			||||||
 | 
				
			|||||||
@ -595,9 +595,9 @@ void compute_projections() {
 | 
				
			|||||||
 | 
					
 | 
				
			||||||
void gen_data() {
 | 
					void gen_data() {
 | 
				
			||||||
  std::normal_distribution<> gyro_noise_dist{
 | 
					  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{
 | 
					  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<> gyro_bias_dist{0, calib.gyro_bias_std[0]};
 | 
				
			||||||
  std::normal_distribution<> accel_bias_dist{0, calib.accel_bias_std[0]};
 | 
					  std::normal_distribution<> accel_bias_dist{0, calib.accel_bias_std[0]};
 | 
				
			||||||
 | 
				
			|||||||
							
								
								
									
										2
									
								
								thirdparty/basalt-headers
									
									
									
									
										vendored
									
									
								
							
							
								
								
								
								
								
								
									
									
								
							
						
						
									
										2
									
								
								thirdparty/basalt-headers
									
									
									
									
										vendored
									
									
								
							@ -1 +1 @@
 | 
				
			|||||||
Subproject commit d169d697f8902ca684e41887eee3bedf91176e56
 | 
					Subproject commit 12b6290f01aa49c15cfec4d8ed8f347323678297
 | 
				
			||||||
		Loading…
	
	
			
			x
			
			
		
	
		Reference in New Issue
	
	Block a user