use crate::math::{Isometry, Real};
use crate::shape::HalfSpace;
use crate::shape::SupportMap;
use na;
pub fn distance_halfspace_support_map<G: ?Sized + SupportMap>(
pos12: &Isometry<Real>,
halfspace: &HalfSpace,
other: &G,
) -> Real {
let deepest = other.support_point_toward(pos12, &-halfspace.normal);
halfspace.normal.dot(&deepest.coords).max(na::zero())
}
pub fn distance_support_map_halfspace<G: ?Sized + SupportMap>(
pos12: &Isometry<Real>,
other: &G,
halfspace: &HalfSpace,
) -> Real {
distance_halfspace_support_map(&pos12.inverse(), halfspace, other)
}