parry2d/query/distance/
distance_cuboid_cuboid.rs

1use crate::math::{Pose, Real};
2use crate::query::ClosestPoints;
3use crate::shape::Cuboid;
4
5/// Distance between two cuboids.
6#[inline]
7pub fn distance_cuboid_cuboid(pos12: &Pose, cuboid1: &Cuboid, cuboid2: &Cuboid) -> Real {
8    match crate::query::details::closest_points_cuboid_cuboid(pos12, cuboid1, cuboid2, Real::MAX) {
9        ClosestPoints::WithinMargin(p1, p2) => (p1 - (pos12 * p2)).length(),
10        _ => 0.0,
11    }
12}