Skip to main content

scan_points_with_normals

Function scan_points_with_normals 

Source
pub fn scan_points_with_normals(
    scan_body: &[Vector2<f64>],
    pose: Pose2D,
    normal_neighbor_distance: f64,
    voxel_size: f64,
) -> (Vec<Vector2<f64>>, Vec<Vector2<f64>>)
Expand description

Transforms a beam-ordered body-frame scan to pose and attaches normals.

Points without a reliable normal are dropped; voxel_size > 0 keeps one point per voxel. Returns (points, normals) in the frame of pose.