You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
44 lines
1.2 KiB
44 lines
1.2 KiB
2 years ago
|
#include <catch2/catch.hpp>
|
||
|
|
|
||
|
|
#include <ipc/friction/closest_point.hpp>
|
||
|
|
|
||
|
|
#include <geometry/intersection.hpp>
|
||
|
|
#include <interval/interval.hpp>
|
||
|
|
#include <logger.hpp>
|
||
|
|
#include <utils/not_implemented_error.hpp>
|
||
|
|
|
||
|
|
using namespace ipc;
|
||
|
|
using namespace ipc::rigid;
|
||
|
|
|
||
|
|
TEST_CASE("Point-edge interval intersection", "[intersection]")
|
||
|
|
{
|
||
|
|
typedef VectorMax3<ipc::rigid::Interval> VectorX3I;
|
||
|
|
|
||
|
|
int dim = GENERATE(2, 3);
|
||
|
|
double expected_distance = GENERATE(-10, -1, -1e-12, 0, 1e-12, 1, 10);
|
||
|
|
VectorX3I p = VectorX3I::Zero(dim);
|
||
|
|
p.y() = ipc::rigid::Interval(expected_distance);
|
||
|
|
VectorX3I e0 = VectorX3I::Zero(dim);
|
||
|
|
e0.x() = ipc::rigid::Interval(-10);
|
||
|
|
VectorX3I e1 = VectorX3I::Zero(dim);
|
||
|
|
e1.x() = ipc::rigid::Interval(10);
|
||
|
|
|
||
|
|
bool intersecting = is_point_along_edge(p, e0, e1);
|
||
|
|
CAPTURE(dim, expected_distance);
|
||
|
|
CHECK(intersecting == (abs(expected_distance) <= 1e-12));
|
||
|
|
if (intersecting) {
|
||
|
|
ipc::rigid::Interval alpha = ipc::point_edge_closest_point(p, e0, e1);
|
||
|
|
CHECK(boost::numeric::median(alpha) == Approx(0.5).margin(1e-12));
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
TEST_CASE("Edge-edge intersection", "[intersection]")
|
||
|
|
{
|
||
|
|
// TODO
|
||
|
|
}
|
||
|
|
|
||
|
|
TEST_CASE("Point-triangle intersection", "[intersection]")
|
||
|
|
{
|
||
|
|
// TODO
|
||
|
|
}
|