use rapier2d::prelude::*;
use crate::scene_spec::SceneBodyId;
use crate::{NodeKey, Simulation};
#[derive(Clone, Copy, Debug, PartialEq, Eq)]
pub enum Support {
Node(NodeKey),
Scene(SceneBodyId),
}
impl Simulation {
pub fn containments_of(&self, node: NodeKey) -> Vec<SceneBodyId> {
let Some(&handle) = self.bodies_by_node.get(&node) else {
return Vec::new();
};
let Some(body) = self.bodies.get(handle) else {
return Vec::new();
};
let centre = body.translation();
let mut inside: Vec<SceneBodyId> = self
.scene_bodies
.iter()
.filter_map(|(&id, &(scene_handle, ref collider))| {
let scene_body = self.bodies.get(scene_handle)?;
let shape = collider.to_shared_shape();
shape
.contains_point(scene_body.position(), centre)
.then_some(id)
})
.collect();
inside.sort_unstable_by_key(|id| id.0);
inside
}
pub fn supports_of(&self, node: NodeKey) -> Vec<Support> {
let g = self.gravity;
let g_len = (g.x * g.x + g.y * g.y).sqrt();
if g_len < f32::EPSILON {
return Vec::new();
}
let down = Vector::new(g.x / g_len, g.y / g_len);
let Some(&handle) = self.bodies_by_node.get(&node) else {
return Vec::new();
};
let Some(body) = self.bodies.get(handle) else {
return Vec::new();
};
let mut supports = Vec::new();
for &ch in body.colliders() {
for pair in self.narrow_phase.contact_pairs_with(ch) {
if !pair.has_any_active_contact() {
continue;
}
let ours_is_first = pair.collider1 == ch;
let holds_up = pair.manifolds.iter().any(|m| {
let toward_node = if ours_is_first {
-m.data.normal
} else {
m.data.normal
};
toward_node.dot(down) < -0.5
});
if !holds_up {
continue;
}
let other = if ours_is_first {
pair.collider2
} else {
pair.collider1
};
let Some(other_body) = self.colliders.get(other).and_then(|c| c.parent()) else {
continue;
};
if let Some((&key, _)) = self.bodies_by_node.iter().find(|&(_, &h)| h == other_body)
{
supports.push(Support::Node(key));
} else if let Some((&id, _)) = self
.scene_bodies
.iter()
.find(|&(_, &(h, _))| h == other_body)
{
supports.push(Support::Scene(id));
}
}
}
supports.sort_unstable_by_key(|s| match *s {
Support::Node(n) => (0, n.index() as u64),
Support::Scene(id) => (1, id.0),
});
supports.dedup();
supports
}
}