#include "collision/CollisionCircle.h"
#include "collision/CollisionShared.h"
#include "unittest/TestSuite.h"

static void verifyInit(int line, CollisionCircle * circle, void * owner, CollisionObject_collisionCallback collisionCallback, CollisionObject_overlapCallback overlapCallback, Vector2x position, fixed16_16 radius) {
	TestCase_assert(circle != NULL, "Expected non-NULL but got NULL (line %d)", line);
	TestCase_assert(circle->vtable->dispose == CollisionCircle_dispose, "Expected %p but got %p (line %d)", CollisionCircle_dispose, circle->vtable->dispose, line);
	TestCase_assert(circle->owner == owner, "Expected %p but got %p (line %d)", owner, circle->owner, line);
	TestCase_assert(circle->collisionCallback == collisionCallback, "Expected %p but got %p (line %d)", collisionCallback, circle->collisionCallback, line);
	TestCase_assert(circle->overlapCallback == overlapCallback, "Expected %p but got %p (line %d)", overlapCallback, circle->overlapCallback, line);
	TestCase_assert(circle->vtable->interpolate == CollisionCircle_interpolate, "Expected %p but got %p (line %d)", CollisionCircle_interpolate, circle->vtable->interpolate, line);
	TestCase_assert(circle->vtable->isStationary == CollisionCircle_isStationary, "Expected %p but got %p (line %d)", CollisionCircle_isStationary, circle->vtable->isStationary, line);
	TestCase_assert(circle->vtable->getCollisionBounds == CollisionCircle_getCollisionBounds, "Expected %p but got %p (line %d)", CollisionCircle_getCollisionBounds, circle->vtable->getCollisionBounds, line);
	TestCase_assert(circle->position.x == position.x, "Expected 0x%05X but got 0x%05X (line %d)", position.x, circle->position.x, line);
	TestCase_assert(circle->position.y == position.y, "Expected 0x%05X but got 0x%05X (line %d)", position.y, circle->position.y, line);
	TestCase_assert(circle->lastPosition.x == position.x, "Expected 0x%05X but got 0x%05X (line %d)", position.x, circle->lastPosition.x, line);
	TestCase_assert(circle->lastPosition.y == position.y, "Expected 0x%05X but got 0x%05X (line %d)", position.y, circle->lastPosition.y, line);
	TestCase_assert(circle->radius == radius, "Expected 0x%05X but got 0x%05X (line %d)", radius, circle->radius, line);
}

static void testInit() {
	CollisionCircle circle, * circlePtr;
	
	memset(&circle, 0x00, sizeof(circle));
	stemobject_assign_vtable(circle, CollisionCircle);
	CollisionCircle_init(&circle, NULL, NULL, NULL, VECTOR2x_ZERO, 0x00000);
	verifyInit(__LINE__, &circle, NULL, NULL, NULL, VECTOR2x_ZERO, 0x00000);
	CollisionCircle_dispose(&circle);
	
	memset(&circle, 0xFF, sizeof(circle));
	stemobject_assign_vtable(circle, CollisionCircle);
	CollisionCircle_init(&circle, NULL, NULL, NULL, VECTOR2x_ZERO, 0x00000);
	verifyInit(__LINE__, &circle, NULL, NULL, NULL, VECTOR2x_ZERO, 0x00000);
	CollisionCircle_dispose(&circle);
	
	memset(&circle, 0x00, sizeof(circle));
	stemobject_assign_vtable(circle, CollisionCircle);
	CollisionCircle_init(&circle, (void *) 0x1234, (CollisionObject_collisionCallback) 0x2345, (CollisionObject_overlapCallback) 0x6789, VECTOR2x(0x10000, 0x20000), 0x30000);
	verifyInit(__LINE__, &circle, (void *) 0x1234, (CollisionObject_collisionCallback) 0x2345, (CollisionObject_overlapCallback) 0x6789, VECTOR2x(0x10000, 0x20000), 0x30000);
	CollisionCircle_dispose(&circle);
	
	circlePtr = CollisionCircle_create(NULL, NULL, NULL, VECTOR2x_ZERO, 0x00000);
	verifyInit(__LINE__, circlePtr, NULL, NULL, NULL, VECTOR2x_ZERO, 0x00000);
	CollisionCircle_dispose(circlePtr);
	
	circlePtr = CollisionCircle_create((void *) 0x1234, (CollisionObject_collisionCallback) 0x2345, (CollisionObject_overlapCallback) 0x6789, VECTOR2x(0x10000, 0x20000), 0x30000);
	verifyInit(__LINE__, circlePtr, (void *) 0x1234, (CollisionObject_collisionCallback) 0x2345, (CollisionObject_overlapCallback) 0x6789, VECTOR2x(0x10000, 0x20000), 0x30000);
	CollisionCircle_dispose(circlePtr);
}

static void testUpdatePosition() {
	CollisionCircle * circle;
	
	circle = CollisionCircle_create(NULL, NULL, NULL, VECTOR2x(0x10000, 0x20000), 0x00000);
	TestCase_assert(circle->position.x == 0x10000, "Expected 0x10000 but got 0x%05X", circle->position.x);
	TestCase_assert(circle->position.y == 0x20000, "Expected 0x20000 but got 0x%05X", circle->position.y);
	TestCase_assert(circle->lastPosition.x == 0x10000, "Expected 0x10000 but got 0x%05X", circle->lastPosition.x);
	TestCase_assert(circle->lastPosition.y == 0x20000, "Expected 0x20000 but got 0x%05X", circle->lastPosition.y);
	
	CollisionCircle_updatePosition(circle, VECTOR2x(0x00000, 0x00000));
	TestCase_assert(circle->position.x == 0x00000, "Expected 0x00000 but got 0x%05X", circle->position.x);
	TestCase_assert(circle->position.y == 0x00000, "Expected 0x00000 but got 0x%05X", circle->position.y);
	TestCase_assert(circle->lastPosition.x == 0x10000, "Expected 0x10000 but got 0x%05X", circle->lastPosition.x);
	TestCase_assert(circle->lastPosition.y == 0x20000, "Expected 0x20000 but got 0x%05X", circle->lastPosition.y);
	
	CollisionCircle_updatePosition(circle, VECTOR2x(0x08000, 0x0C000));
	TestCase_assert(circle->position.x == 0x08000, "Expected 0x08000 but got 0x%05X", circle->position.x);
	TestCase_assert(circle->position.y == 0x0C000, "Expected 0x0C000 but got 0x%05X", circle->position.y);
	TestCase_assert(circle->lastPosition.x == 0x00000, "Expected 0x00000 but got 0x%05X", circle->lastPosition.x);
	TestCase_assert(circle->lastPosition.y == 0x00000, "Expected 0x00000 but got 0x%05X", circle->lastPosition.y);
	
	CollisionCircle_dispose(circle);
}

static void testInterpolate() {
	CollisionCircle * circle;
	
	circle = CollisionCircle_create(NULL, NULL, NULL, VECTOR2x(0x00000, 0x00000), 0x00000);
	CollisionCircle_updatePosition(circle, VECTOR2x(0x10000, 0x10000));
	CollisionCircle_interpolate(circle, 0x08000);
	
	TestCase_assert(circle->lastPosition.x == 0x08000, "Expected 0x08000 but got 0x%05X", circle->lastPosition.x);
	TestCase_assert(circle->lastPosition.y == 0x08000, "Expected 0x08000 but got 0x%05X", circle->lastPosition.y);
	TestCase_assert(circle->position.x == 0x10000, "Expected 0x10000 but got 0x%05X", circle->position.x);
	TestCase_assert(circle->position.y == 0x10000, "Expected 0x10000 but got 0x%05X", circle->position.y);
	
	CollisionCircle_updatePosition(circle, VECTOR2x(0x20000, 0x30000));
	CollisionCircle_interpolate(circle, 0x04000);
	
	TestCase_assert(circle->lastPosition.x == 0x14000, "Expected 0x14000 but got 0x%05X", circle->lastPosition.x);
	TestCase_assert(circle->lastPosition.y == 0x18000, "Expected 0x18000 but got 0x%05X", circle->lastPosition.y);
	TestCase_assert(circle->position.x == 0x20000, "Expected 0x20000 but got 0x%05X", circle->position.x);
	TestCase_assert(circle->position.y == 0x30000, "Expected 0x30000 but got 0x%05X", circle->position.y);
	
	CollisionCircle_dispose(circle);
}

static void testIsStationary() {
	CollisionCircle * circle;
	bool result;
	
	circle = CollisionCircle_create(NULL, NULL, NULL, VECTOR2x(0x00000, 0x00000), 0x10000);
	result = CollisionCircle_isStationary(circle);
	TestCase_assert(result, "Expected true but got false");
	
	CollisionCircle_updatePosition(circle, VECTOR2x(0x10000, 0x10000));
	result = CollisionCircle_isStationary(circle);
	TestCase_assert(!result, "Expected false but got true");
	
	CollisionCircle_updatePosition(circle, VECTOR2x(0x10000, 0x10000));
	result = CollisionCircle_isStationary(circle);
	TestCase_assert(result, "Expected true but got false");
	
	CollisionCircle_dispose(circle);
}

static void testGetCollisionBounds() {
	CollisionCircle * circle;
	Box6x bounds;
	
	circle = CollisionCircle_create(NULL, NULL, NULL, VECTOR2x_ZERO, 0x10000);
	bounds = CollisionCircle_getCollisionBounds(circle);
	TestCase_assert(bounds.xMin == -0x10000 && bounds.xMax == 0x10000 &&
	                bounds.yMin == -0x10000 && bounds.yMax == 0x10000 &&
	                bounds.zMin == 0x00000 && bounds.zMax == 0x10000,
	                "Expected {0xFFFF0000, 0x10000, 0xFFFF0000, 0x10000, 0x00000, 0x10000} but got {0x%05X, 0x%05X, 0x%05X, 0x%05X, 0x%05X, 0x%05X}",
	                bounds.xMin, bounds.xMax, bounds.yMin, bounds.yMax, bounds.zMin, bounds.zMax);
	
	CollisionCircle_updatePosition(circle, VECTOR2x(0x10000, 0x10000));
	bounds = CollisionCircle_getCollisionBounds(circle);
	TestCase_assert(bounds.xMin == -0x10000 && bounds.xMax == 0x20000 &&
	                bounds.yMin == -0x10000 && bounds.yMax == 0x20000 &&
	                bounds.zMin == 0x00000 && bounds.zMax == 0x10000,
	                "Expected {0xFFFF0000, 0x20000, 0xFFFF0000, 0x20000, 0x00000, 0x10000} but got {0x%05X, 0x%05X, 0x%05X, 0x%05X, 0x%05X, 0x%05X}",
	                bounds.xMin, bounds.xMax, bounds.yMin, bounds.yMax, bounds.zMin, bounds.zMax);
	
	CollisionCircle_updatePosition(circle, VECTOR2x(-0x10000, -0x10000));
	bounds = CollisionCircle_getCollisionBounds(circle);
	TestCase_assert(bounds.xMin == -0x20000 && bounds.xMax == 0x20000 &&
	                bounds.yMin == -0x20000 && bounds.yMax == 0x20000 &&
	                bounds.zMin == 0x00000 && bounds.zMax == 0x10000,
	                "Expected {0xFFFE0000, 0x20000, 0xFFFE0000, 0x20000, 0x00000, 0x10000} but got {0x%05X, 0x%05X, 0x%05X, 0x%05X, 0x%05X, 0x%05X}",
	                bounds.xMin, bounds.xMax, bounds.yMin, bounds.yMax, bounds.zMin, bounds.zMax);
	
	circle->radius = 0x08000;
	bounds = CollisionCircle_getCollisionBounds(circle);
	TestCase_assert(bounds.xMin == -0x18000 && bounds.xMax == 0x18000 &&
	                bounds.yMin == -0x18000 && bounds.yMax == 0x18000 &&
	                bounds.zMin == 0x00000 && bounds.zMax == 0x10000,
	                "Expected {0xFFFE8000, 0x18000, 0xFFFE8000, 0x18000, 0x00000, 0x10000} but got {0x%05X, 0x%05X, 0x%05X, 0x%05X, 0x%05X, 0x%05X}",
	                bounds.xMin, bounds.xMax, bounds.yMin, bounds.yMax, bounds.zMin, bounds.zMax);
	
	CollisionCircle_dispose(circle);
}

TEST_SUITE(CollisionCircleTest,
           testInit,
           testUpdatePosition,
           testInterpolate,
           testIsStationary,
           testGetCollisionBounds)