Skip to content

Commit

Permalink
Treat TriMesh as solid in project_local_point_and_get_feature with = …
Browse files Browse the repository at this point in the history
…dim2
  • Loading branch information
wlinna committed May 1, 2024
1 parent 75ade55 commit 71ebce2
Show file tree
Hide file tree
Showing 3 changed files with 33 additions and 1 deletion.
1 change: 1 addition & 0 deletions crates/parry2d/tests/query/mod.rs
Original file line number Diff line number Diff line change
@@ -1 +1,2 @@
mod point_composite_shape;
mod point_triangle;
26 changes: 26 additions & 0 deletions crates/parry2d/tests/query/point_composite_shape.rs
Original file line number Diff line number Diff line change
@@ -0,0 +1,26 @@
use na::Point2;
use parry2d::{query::PointQuery, shape::TriMesh};

#[test]
fn project_local_point_and_get_feature_gets_the_enclosing_triangle() {
let vertices = vec![
Point2::new(0.0, 1.0),
Point2::new(0.0, 0.0),
Point2::new(1.0, 0.0),
Point2::new(1.0, 1.0),
];

let mesh = TriMesh::new(vertices, vec![[0, 1, 2], [3, 0, 2]]);
let query_pt = Point2::new(0.6, 0.6); // Inside the top-right triangle (index 1)

let (proj, feat) = mesh.project_local_point_and_get_feature(&query_pt);

let correct_tri_idx = 1;
let correct_tri = mesh.triangle(correct_tri_idx);

let is_inside_correct = correct_tri.contains_local_point(&query_pt);

assert!(is_inside_correct);
assert_eq!(proj.is_inside, is_inside_correct);
assert_eq!(feat.unwrap_face(), correct_tri_idx);
}
7 changes: 6 additions & 1 deletion src/query/point/point_composite_shape.rs
Original file line number Diff line number Diff line change
Expand Up @@ -61,8 +61,13 @@ impl PointQuery for TriMesh {
return (proj, feature_id);
}

#[cfg(feature = "dim3")]
let solid = false;
#[cfg(feature = "dim2")]
let solid = true;

let mut visitor =
PointCompositeShapeProjWithFeatureBestFirstVisitor::new(self, point, false);
PointCompositeShapeProjWithFeatureBestFirstVisitor::new(self, point, solid);
let (proj, (id, _feature)) = self.qbvh().traverse_best_first(&mut visitor).unwrap().1;
let feature_id = FeatureId::Face(id);
(proj, feature_id)
Expand Down

0 comments on commit 71ebce2

Please sign in to comment.