pub struct ScanToMapMatcher { /* private fields */ }Expand description
Incremental scan-to-map LiDAR odometry.
Implementations§
Source§impl ScanToMapMatcher
impl ScanToMapMatcher
Sourcepub fn new(config: ScanToMapConfig, initial_pose: Pose2D) -> Self
pub fn new(config: ScanToMapConfig, initial_pose: Pose2D) -> Self
Creates a matcher whose corrected trajectory starts at initial_pose.
Sourcepub fn config(&self) -> &ScanToMapConfig
pub fn config(&self) -> &ScanToMapConfig
Matcher configuration.
Sourcepub fn keyframe_count(&self) -> usize
pub fn keyframe_count(&self) -> usize
Number of keyframe scans currently held in the submap.
Sourcepub fn submap_points(&self) -> Vec<Vector2<f64>> ⓘ
pub fn submap_points(&self) -> Vec<Vector2<f64>> ⓘ
All submap points in the corrected world frame.
Sourcepub fn update(
&mut self,
odom_delta: Pose2D,
scan_body: &[Vector2<f64>],
) -> ScanToMapUpdate
pub fn update( &mut self, odom_delta: Pose2D, scan_body: &[Vector2<f64>], ) -> ScanToMapUpdate
Integrates one odometry step and registers the scan taken at its end.
odom_delta- body-frame motion since the previous call (xforward,yleft,yawcounter-clockwise).scan_body- scan points in the body frame, ordered by beam angle (the order is used to estimate normals).
Trait Implementations§
Source§impl Clone for ScanToMapMatcher
impl Clone for ScanToMapMatcher
Auto Trait Implementations§
impl Freeze for ScanToMapMatcher
impl RefUnwindSafe for ScanToMapMatcher
impl Send for ScanToMapMatcher
impl Sync for ScanToMapMatcher
impl Unpin for ScanToMapMatcher
impl UnsafeUnpin for ScanToMapMatcher
impl UnwindSafe for ScanToMapMatcher
Blanket Implementations§
Source§impl<T> BorrowMut<T> for Twhere
T: ?Sized,
impl<T> BorrowMut<T> for Twhere
T: ?Sized,
Source§fn borrow_mut(&mut self) -> &mut T
fn borrow_mut(&mut self) -> &mut T
Mutably borrows from an owned value. Read more
Source§impl<T> CloneToUninit for Twhere
T: Clone,
impl<T> CloneToUninit for Twhere
T: Clone,
§impl<SS, SP> SupersetOf<SS> for SPwhere
SS: SubsetOf<SP>,
impl<SS, SP> SupersetOf<SS> for SPwhere
SS: SubsetOf<SP>,
§fn to_subset(&self) -> Option<SS>
fn to_subset(&self) -> Option<SS>
The inverse inclusion map: attempts to construct
self from the equivalent element of its
superset. Read more§fn is_in_subset(&self) -> bool
fn is_in_subset(&self) -> bool
Checks if
self is actually part of its subset T (and can be converted to it).§fn to_subset_unchecked(&self) -> SS
fn to_subset_unchecked(&self) -> SS
Use with care! Same as
self.to_subset but without any property checks. Always succeeds.§fn from_subset(element: &SS) -> SP
fn from_subset(element: &SS) -> SP
The inclusion map: converts
self to the equivalent element of its superset.