From 7cb6856415178e09a01c4e38e712f65c56143400 Mon Sep 17 00:00:00 2001
From: Andrew Meadows <andrew@highfidelity.io>
Date: Tue, 22 Apr 2014 10:44:41 -0700
Subject: [PATCH] Adding some collision tests for sphere-vs-AACube

---
 tests/physics/src/ShapeColliderTests.cpp | 113 +++++++++++++++++++++++
 tests/physics/src/ShapeColliderTests.h   |   3 +
 2 files changed, 116 insertions(+)

diff --git a/tests/physics/src/ShapeColliderTests.cpp b/tests/physics/src/ShapeColliderTests.cpp
index f9e76bac0b..fe1d79b456 100644
--- a/tests/physics/src/ShapeColliderTests.cpp
+++ b/tests/physics/src/ShapeColliderTests.cpp
@@ -699,6 +699,116 @@ void ShapeColliderTests::capsuleTouchesCapsule() {
     }
 }
 
+void ShapeColliderTests::sphereTouchesAACube() {
+    CollisionList collisions(16);
+    
+    glm::vec3 cubeCenter(1.23f, 4.56f, 7.89f);
+    float cubeSide = 2.0f;
+
+    float sphereRadius = 1.0f;
+    glm::vec3 sphereCenter(0.f);
+    SphereShape sphere(sphereRadius, sphereCenter);
+
+    float sphereOffset = (0.5f * cubeSide + sphereRadius - 0.25f);
+
+    // top
+    sphereCenter = cubeCenter + sphereOffset * yAxis;
+    sphere.setPosition(sphereCenter);
+    if (!ShapeCollider::sphereAACube(&sphere, cubeCenter, cubeSide, collisions)){
+        std::cout << __FILE__ << ":" << __LINE__ << " ERROR: sphere should collide with cube" << std::endl;
+    }
+    
+    // bottom
+    sphereCenter = cubeCenter - sphereOffset * yAxis;
+    sphere.setPosition(sphereCenter);
+    if (!ShapeCollider::sphereAACube(&sphere, cubeCenter, cubeSide, collisions)){
+        std::cout << __FILE__ << ":" << __LINE__ << " ERROR: sphere should collide with cube" << std::endl;
+    }
+
+    // left
+    sphereCenter = cubeCenter + sphereOffset * xAxis;
+    sphere.setPosition(sphereCenter);
+    if (!ShapeCollider::sphereAACube(&sphere, cubeCenter, cubeSide, collisions)){
+        std::cout << __FILE__ << ":" << __LINE__ << " ERROR: sphere should collide with cube" << std::endl;
+    }
+
+    // right
+    sphereCenter = cubeCenter - sphereOffset * xAxis;
+    sphere.setPosition(sphereCenter);
+    if (!ShapeCollider::sphereAACube(&sphere, cubeCenter, cubeSide, collisions)){
+        std::cout << __FILE__ << ":" << __LINE__ << " ERROR: sphere should collide with cube" << std::endl;
+    }
+
+    // forward
+    sphereCenter = cubeCenter + sphereOffset * zAxis;
+    sphere.setPosition(sphereCenter);
+    if (!ShapeCollider::sphereAACube(&sphere, cubeCenter, cubeSide, collisions)){
+        std::cout << __FILE__ << ":" << __LINE__ << " ERROR: sphere should collide with cube" << std::endl;
+    }
+
+    // back
+    sphereCenter = cubeCenter - sphereOffset * zAxis;
+    sphere.setPosition(sphereCenter);
+    if (!ShapeCollider::sphereAACube(&sphere, cubeCenter, cubeSide, collisions)){
+        std::cout << __FILE__ << ":" << __LINE__ << " ERROR: sphere should collide with cube" << std::endl;
+    }
+}
+
+void ShapeColliderTests::sphereMissesAACube() {
+    CollisionList collisions(16);
+    
+    glm::vec3 cubeCenter(1.23f, 4.56f, 7.89f);
+    float cubeSide = 2.0f;
+
+    float sphereRadius = 1.0f;
+    glm::vec3 sphereCenter(0.0f);
+    SphereShape sphere(sphereRadius, sphereCenter);
+
+    float sphereOffset = (0.5f * cubeSide + sphereRadius + 0.25f);
+
+    // top
+    sphereCenter = cubeCenter + sphereOffset * yAxis;
+    sphere.setPosition(sphereCenter);
+    if (ShapeCollider::sphereAACube(&sphere, cubeCenter, cubeSide, collisions)){
+        std::cout << __FILE__ << ":" << __LINE__ << " ERROR: sphere should NOT collide with cube" << std::endl;
+    }
+    
+    // bottom
+    sphereCenter = cubeCenter - sphereOffset * yAxis;
+    sphere.setPosition(sphereCenter);
+    if (ShapeCollider::sphereAACube(&sphere, cubeCenter, cubeSide, collisions)){
+        std::cout << __FILE__ << ":" << __LINE__ << " ERROR: sphere should NOT collide with cube" << std::endl;
+    }
+
+    // left
+    sphereCenter = cubeCenter + sphereOffset * xAxis;
+    sphere.setPosition(sphereCenter);
+    if (ShapeCollider::sphereAACube(&sphere, cubeCenter, cubeSide, collisions)){
+        std::cout << __FILE__ << ":" << __LINE__ << " ERROR: sphere should NOT collide with cube" << std::endl;
+    }
+
+    // right
+    sphereCenter = cubeCenter - sphereOffset * xAxis;
+    sphere.setPosition(sphereCenter);
+    if (ShapeCollider::sphereAACube(&sphere, cubeCenter, cubeSide, collisions)){
+        std::cout << __FILE__ << ":" << __LINE__ << " ERROR: sphere should NOT collide with cube" << std::endl;
+    }
+
+    // forward
+    sphereCenter = cubeCenter + sphereOffset * zAxis;
+    sphere.setPosition(sphereCenter);
+    if (ShapeCollider::sphereAACube(&sphere, cubeCenter, cubeSide, collisions)){
+        std::cout << __FILE__ << ":" << __LINE__ << " ERROR: sphere should NOT collide with cube" << std::endl;
+    }
+
+    // back
+    sphereCenter = cubeCenter - sphereOffset * zAxis;
+    sphere.setPosition(sphereCenter);
+    if (ShapeCollider::sphereAACube(&sphere, cubeCenter, cubeSide, collisions)){
+        std::cout << __FILE__ << ":" << __LINE__ << " ERROR: sphere should NOT collide with cube" << std::endl;
+    }
+}
+
 
 void ShapeColliderTests::runAllTests() {
     sphereMissesSphere();
@@ -709,4 +819,7 @@ void ShapeColliderTests::runAllTests() {
 
     capsuleMissesCapsule();
     capsuleTouchesCapsule();
+
+    sphereTouchesAACube();
+    sphereMissesAACube();
 }
diff --git a/tests/physics/src/ShapeColliderTests.h b/tests/physics/src/ShapeColliderTests.h
index 1d468a65d2..a94f5050ff 100644
--- a/tests/physics/src/ShapeColliderTests.h
+++ b/tests/physics/src/ShapeColliderTests.h
@@ -23,6 +23,9 @@ namespace ShapeColliderTests {
     void capsuleMissesCapsule();
     void capsuleTouchesCapsule();
 
+    void sphereTouchesAACube();
+    void sphereMissesAACube();
+
     void runAllTests(); 
 }