Mirrors/overte
3
0
Fork 0
mirror of https://github.com/overte-org/overte.git synced 2025-08-08 01:59:59 +02:00
Code Issues Projects Releases Packages Wiki Activity Actions

more capsuleCapsule tests

Browse source
This commit is contained in:
Andrew Meadows 2014-02-25 11:38:08 -08:00
parent 362708be60
commit f0e1a6ccd3
1 changed files with 141 additions and 40 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

109
tests/physics/src/ShapeColliderTests.cpp
View file

@ -460,9 +460,10 @@ void ShapeColliderTests::capsuleTouchesCapsule() {
CapsuleShape capsuleA(radiusA, halfHeightA); CapsuleShape capsuleA(radiusA, halfHeightA);
CapsuleShape capsuleB(radiusB, halfHeightB); CapsuleShape capsuleB(radiusB, halfHeightB);
// side by side
capsuleB.setPosition((0.95f * totalRadius) * xAxis);
CollisionInfo collision; CollisionInfo collision;
{ // side by side
capsuleB.setPosition((0.99f * totalRadius) * xAxis);
if (!ShapeCollider::shapeShape(&capsuleA, &capsuleB, collision)) if (!ShapeCollider::shapeShape(&capsuleA, &capsuleB, collision))
{ {
std::cout << __FILE__ << ":" << __LINE__ std::cout << __FILE__ << ":" << __LINE__
@ -475,9 +476,11 @@ void ShapeColliderTests::capsuleTouchesCapsule() {
<< " ERROR: capsule and capsule should touch" << " ERROR: capsule and capsule should touch"
<< std::endl; << std::endl;
} }
}
// end to end { // end to end
capsuleB.setPosition((0.99f * totalHalfLength) * yAxis); capsuleB.setPosition((0.99f * totalHalfLength) * yAxis);
if (!ShapeCollider::shapeShape(&capsuleA, &capsuleB, collision)) if (!ShapeCollider::shapeShape(&capsuleA, &capsuleB, collision))
{ {
std::cout << __FILE__ << ":" << __LINE__ std::cout << __FILE__ << ":" << __LINE__
@ -490,11 +493,13 @@ void ShapeColliderTests::capsuleTouchesCapsule() {
<< " ERROR: capsule and capsule should touch" << " ERROR: capsule and capsule should touch"
<< std::endl; << std::endl;
} }
}
// rotate B and move it to the side { // rotate B and move it to the side
glm::quat rotation = glm::angleAxis(rightAngle, zAxis); glm::quat rotation = glm::angleAxis(rightAngle, zAxis);
capsuleB.setRotation(rotation); capsuleB.setRotation(rotation);
capsuleB.setPosition((0.99f * (totalRadius + capsuleB.getHalfHeight())) * xAxis); capsuleB.setPosition((0.99f * (totalRadius + capsuleB.getHalfHeight())) * xAxis);
if (!ShapeCollider::shapeShape(&capsuleA, &capsuleB, collision)) if (!ShapeCollider::shapeShape(&capsuleA, &capsuleB, collision))
{ {
std::cout << __FILE__ << ":" << __LINE__ std::cout << __FILE__ << ":" << __LINE__
@ -509,6 +514,102 @@ void ShapeColliderTests::capsuleTouchesCapsule() {
} }
} }
{ // again, but this time check collision details
float overlap = 0.1f;
glm::quat rotation = glm::angleAxis(rightAngle, zAxis);
capsuleB.setRotation(rotation);
glm::vec3 positionB = ((totalRadius + capsuleB.getHalfHeight()) - overlap) * xAxis;
capsuleB.setPosition(positionB);
// capsuleA vs capsuleB
if (!ShapeCollider::shapeShape(&capsuleA, &capsuleB, collision))
{
std::cout << __FILE__ << ":" << __LINE__
<< " ERROR: capsule and capsule should touch"
<< std::endl;
}
glm::vec3 expectedPenetration = overlap * xAxis;
float inaccuracy = glm::length(collision._penetration - expectedPenetration);
if (fabs(inaccuracy) > EPSILON) {
std::cout << __FILE__ << ":" << __LINE__
<< " ERROR: bad penetration: expected = " << expectedPenetration
<< " actual = " << collision._penetration
<< std::endl;
}
glm::vec3 expectedContactPoint = capsuleA.getPosition() + radiusA * xAxis;
inaccuracy = glm::length(collision._contactPoint - expectedContactPoint);
if (fabs(inaccuracy) > EPSILON) {
std::cout << __FILE__ << ":" << __LINE__
<< " ERROR: bad contactPoint: expected = " << expectedContactPoint
<< " actual = " << collision._contactPoint
<< std::endl;
}
// capsuleB vs capsuleA
if (!ShapeCollider::shapeShape(&capsuleB, &capsuleA, collision))
{
std::cout << __FILE__ << ":" << __LINE__
<< " ERROR: capsule and capsule should touch"
<< std::endl;
}
expectedPenetration = - overlap * xAxis;
inaccuracy = glm::length(collision._penetration - expectedPenetration);
if (fabs(inaccuracy) > EPSILON) {
std::cout << __FILE__ << ":" << __LINE__
<< " ERROR: bad penetration: expected = " << expectedPenetration
<< " actual = " << collision._penetration
<< std::endl;
}
expectedContactPoint = capsuleB.getPosition() - (radiusB + halfHeightB) * xAxis;
inaccuracy = glm::length(collision._contactPoint - expectedContactPoint);
if (fabs(inaccuracy) > EPSILON) {
std::cout << __FILE__ << ":" << __LINE__
<< " ERROR: bad contactPoint: expected = " << expectedContactPoint
<< " actual = " << collision._contactPoint
<< std::endl;
}
}
{ // collide cylinder wall against cylinder wall
float overlap = 0.137f;
float shift = 0.317f * halfHeightA;
glm::quat rotation = glm::angleAxis(rightAngle, zAxis);
capsuleB.setRotation(rotation);
glm::vec3 positionB = (totalRadius - overlap) * zAxis + shift * yAxis;
capsuleB.setPosition(positionB);
// capsuleA vs capsuleB
if (!ShapeCollider::shapeShape(&capsuleA, &capsuleB, collision))
{
std::cout << __FILE__ << ":" << __LINE__
<< " ERROR: capsule and capsule should touch"
<< std::endl;
}
glm::vec3 expectedPenetration = overlap * zAxis;
float inaccuracy = glm::length(collision._penetration - expectedPenetration);
if (fabs(inaccuracy) > EPSILON) {
std::cout << __FILE__ << ":" << __LINE__
<< " ERROR: bad penetration: expected = " << expectedPenetration
<< " actual = " << collision._penetration
<< std::endl;
}
glm::vec3 expectedContactPoint = capsuleA.getPosition() + radiusA * zAxis + shift * yAxis;
inaccuracy = glm::length(collision._contactPoint - expectedContactPoint);
if (fabs(inaccuracy) > EPSILON) {
std::cout << __FILE__ << ":" << __LINE__
<< " ERROR: bad contactPoint: expected = " << expectedContactPoint
<< " actual = " << collision._contactPoint
<< std::endl;
}
}
}
void ShapeColliderTests::runAllTests() { void ShapeColliderTests::runAllTests() {
sphereMissesSphere(); sphereMissesSphere();