pub struct FastICPOdometry { /* private fields */ }
Expand description

A faster version of ICPOdometry which is used in KinectFusion implementation Partial list of differences:

  • Works in parallel
  • Written in universal intrinsics
  • Filters points by angle
  • Interpolates points and normals
  • Doesn’t use masks or min/max depth filtering
  • Doesn’t use random subsets of points
  • Supports only Rt transform type
  • Supports only 4-float vectors as input type

Implementations§

source§

impl FastICPOdometry

source

pub fn default() -> Result<FastICPOdometry>

source

pub fn new( camera_matrix: &Mat, max_dist_diff: f32, angle_threshold: f32, sigma_depth: f32, sigma_spatial: f32, kernel_size: i32, iter_counts: &Vector<i32> ) -> Result<FastICPOdometry>

Constructor.

Parameters
  • cameraMatrix: Camera matrix
  • maxDistDiff: Correspondences between pixels of two given frames will be filtered out if their depth difference is larger than maxDepthDiff
  • angleThreshold: Correspondence will be filtered out if an angle between their normals is bigger than threshold
  • sigmaDepth: Depth sigma in meters for bilateral smooth
  • sigmaSpatial: Spatial sigma in pixels for bilateral smooth
  • kernelSize: Kernel size in pixels for bilateral smooth
  • iterCounts: Count of iterations on each pyramid level
C++ default parameters
  • max_dist_diff: Odometry::DEFAULT_MAX_DEPTH_DIFF()
  • angle_threshold: (float)(30.*CV_PI/180.)
  • sigma_depth: 0.04f
  • sigma_spatial: 4.5f
  • kernel_size: 7
  • iter_counts: std::vector()
source

pub fn create( camera_matrix: &Mat, max_dist_diff: f32, angle_threshold: f32, sigma_depth: f32, sigma_spatial: f32, kernel_size: i32, iter_counts: &Vector<i32> ) -> Result<Ptr<FastICPOdometry>>

C++ default parameters
  • max_dist_diff: Odometry::DEFAULT_MAX_DEPTH_DIFF()
  • angle_threshold: (float)(30.*CV_PI/180.)
  • sigma_depth: 0.04f
  • sigma_spatial: 4.5f
  • kernel_size: 7
  • iter_counts: std::vector()

Trait Implementations§

source§

impl AlgorithmTrait for FastICPOdometry

source§

fn as_raw_mut_Algorithm(&mut self) -> *mut c_void

source§

fn clear(&mut self) -> Result<()>

Clears the algorithm state
source§

fn read(&mut self, fn_: &FileNode) -> Result<()>

Reads algorithm parameters from a file storage
source§

impl AlgorithmTraitConst for FastICPOdometry

source§

fn as_raw_Algorithm(&self) -> *const c_void

source§

fn write(&self, fs: &mut FileStorage) -> Result<()>

Stores algorithm parameters in a file storage
source§

fn write_1(&self, fs: &mut FileStorage, name: &str) -> Result<()>

Stores algorithm parameters in a file storage Read more
source§

fn write_with_name(&self, fs: &Ptr<FileStorage>, name: &str) -> Result<()>

@deprecated Read more
source§

fn empty(&self) -> Result<bool>

Returns true if the Algorithm is empty (e.g. in the very beginning or after unsuccessful read
source§

fn save(&self, filename: &str) -> Result<()>

Saves the algorithm to a file. In order to make this method work, the derived class must implement Algorithm::write(FileStorage& fs).
source§

fn get_default_name(&self) -> Result<String>

Returns the algorithm string identifier. This string is used as top level xml/yml node tag when the object is saved to a file or string.
source§

impl Boxed for FastICPOdometry

source§

unsafe fn from_raw(ptr: *mut c_void) -> Self

Wrap the specified raw pointer Read more
source§

fn into_raw(self) -> *mut c_void

Return an the underlying raw pointer while consuming this wrapper. Read more
source§

fn as_raw(&self) -> *const c_void

Return the underlying raw pointer. Read more
source§

fn as_raw_mut(&mut self) -> *mut c_void

Return the underlying mutable raw pointer Read more
source§

impl Debug for FastICPOdometry

source§

fn fmt(&self, f: &mut Formatter<'_>) -> Result

Formats the value using the given formatter. Read more
source§

impl Drop for FastICPOdometry

source§

fn drop(&mut self)

Executes the destructor for this type. Read more
source§

impl FastICPOdometryTrait for FastICPOdometry

source§

fn as_raw_mut_FastICPOdometry(&mut self) -> *mut c_void

source§

fn set_camera_matrix(&mut self, val: &Mat) -> Result<()>

source§

fn set_max_dist_diff(&mut self, val: f32) -> Result<()>

source§

fn set_angle_threshold(&mut self, f: f32) -> Result<()>

source§

fn set_sigma_depth(&mut self, f: f32) -> Result<()>

source§

fn set_sigma_spatial(&mut self, f: f32) -> Result<()>

source§

fn set_kernel_size(&mut self, f: i32) -> Result<()>

source§

fn set_iteration_counts(&mut self, val: &Mat) -> Result<()>

source§

fn set_transform_type(&mut self, val: i32) -> Result<()>

source§

impl FastICPOdometryTraitConst for FastICPOdometry

source§

impl From<FastICPOdometry> for Algorithm

source§

fn from(s: FastICPOdometry) -> Self

Converts to this type from the input type.
source§

impl From<FastICPOdometry> for Odometry

source§

fn from(s: FastICPOdometry) -> Self

Converts to this type from the input type.
source§

impl OdometryTrait for FastICPOdometry

source§

fn as_raw_mut_Odometry(&mut self) -> *mut c_void

source§

fn set_camera_matrix(&mut self, val: &Mat) -> Result<()>

See also Read more
source§

fn set_transform_type(&mut self, val: i32) -> Result<()>

See also Read more
source§

impl OdometryTraitConst for FastICPOdometry

source§

fn as_raw_Odometry(&self) -> *const c_void

source§

fn compute( &self, src_image: &Mat, src_depth: &Mat, src_mask: &Mat, dst_image: &Mat, dst_depth: &Mat, dst_mask: &Mat, rt: &mut impl ToOutputArray, init_rt: &Mat ) -> Result<bool>

Method to compute a transformation from the source frame to the destination one. Some odometry algorithms do not used some data of frames (eg. ICP does not use images). In such case corresponding arguments can be set as empty Mat. The method returns true if all internal computations were possible (e.g. there were enough correspondences, system of equations has a solution, etc) and resulting transformation satisfies some test if it’s provided by the Odometry inheritor implementation (e.g. thresholds for maximum translation and rotation). Read more
source§

fn compute2( &self, src_frame: &mut Ptr<OdometryFrame>, dst_frame: &mut Ptr<OdometryFrame>, rt: &mut impl ToOutputArray, init_rt: &Mat ) -> Result<bool>

One more method to compute a transformation from the source frame to the destination one. It is designed to save on computing the frame data (image pyramids, normals, etc.). Read more
source§

fn prepare_frame_cache( &self, frame: &mut Ptr<OdometryFrame>, cache_type: i32 ) -> Result<Size>

Prepare a cache for the frame. The function checks the precomputed/passed data (throws the error if this data does not satisfy) and computes all remaining cache data needed for the frame. Returned size is a resolution of the prepared frame. Read more
source§

fn get_camera_matrix(&self) -> Result<Mat>

See also Read more
source§

fn get_transform_type(&self) -> Result<i32>

See also Read more
source§

impl TryFrom<Odometry> for FastICPOdometry

§

type Error = Error

The type returned in the event of a conversion error.
source§

fn try_from(s: Odometry) -> Result<Self>

Performs the conversion.
source§

impl Send for FastICPOdometry

Auto Trait Implementations§

Blanket Implementations§

source§

impl<T> Any for Twhere T: 'static + ?Sized,

source§

fn type_id(&self) -> TypeId

Gets the TypeId of self. Read more
source§

impl<T> Borrow<T> for Twhere T: ?Sized,

source§

fn borrow(&self) -> &T

Immutably borrows from an owned value. Read more
source§

impl<T> BorrowMut<T> for Twhere T: ?Sized,

source§

fn borrow_mut(&mut self) -> &mut T

Mutably borrows from an owned value. Read more
source§

impl<T> From<T> for T

source§

fn from(t: T) -> T

Returns the argument unchanged.

source§

impl<T, U> Into<U> for Twhere U: From<T>,

source§

fn into(self) -> U

Calls U::from(self).

That is, this conversion is whatever the implementation of From<T> for U chooses to do.

source§

impl<T, U> TryFrom<U> for Twhere U: Into<T>,

§

type Error = Infallible

The type returned in the event of a conversion error.
source§

fn try_from(value: U) -> Result<T, <T as TryFrom<U>>::Error>

Performs the conversion.
source§

impl<T, U> TryInto<U> for Twhere U: TryFrom<T>,

§

type Error = <U as TryFrom<T>>::Error

The type returned in the event of a conversion error.
source§

fn try_into(self) -> Result<U, <U as TryFrom<T>>::Error>

Performs the conversion.