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.