// Copyright (C) 2009-present, Panagiotis Christopoulos Charitos and contributors.
// All rights reserved.
// Code licensed under the BSD License.
// http://www.anki3d.org/LICENSE

#include <AnKi/Physics/PhysicsPlayerController.h>
#include <AnKi/Physics/PhysicsWorld.h>

namespace anki {

PhysicsPlayerController::PhysicsPlayerController(const PhysicsPlayerControllerInitInfo& init)
	: PhysicsFilteredObject(kClassType)
{
	const btTransform trf = toBt(Transform(init.m_position.xyz0(), Mat3x4::getIdentity(), Vec4(1.0f, 1.0f, 1.0f, 0.0f)));

	m_convexShape.construct(init.m_outerRadius, init.m_height);

	m_ghostObject.construct();
	m_ghostObject->setWorldTransform(trf);
	m_ghostObject->setCollisionShape(m_convexShape.get());
	m_ghostObject->setUserPointer(static_cast<PhysicsObject*>(this));
	setMaterialGroup(PhysicsMaterialBit::kPlayer);
	setMaterialMask(PhysicsMaterialBit::kAll);

	m_controller.construct(m_ghostObject.get(), m_convexShape.get(), init.m_stepHeight, btVector3(0, 1, 0));

	// Need to call this else the player is upside down
	moveToPosition(init.m_position);
}

PhysicsPlayerController::~PhysicsPlayerController()
{
	m_controller.destroy();
	m_ghostObject.destroy();
	m_convexShape.destroy();
}

void PhysicsPlayerController::registerToWorld()
{
	btDynamicsWorld& btworld = PhysicsWorld::getSingleton().getBtWorld();
	btworld.addCollisionObject(m_ghostObject.get(), btBroadphaseProxy::CharacterFilter,
							   btBroadphaseProxy::StaticFilter | btBroadphaseProxy::DefaultFilter);
	btworld.addAction(m_controller.get());
}

void PhysicsPlayerController::unregisterFromWorld()
{
	PhysicsWorld::getSingleton().getBtWorld().removeAction(m_controller.get());
	PhysicsWorld::getSingleton().getBtWorld().removeCollisionObject(m_ghostObject.get());
}

void PhysicsPlayerController::moveToPositionForReal()
{
	if(m_moveToPosition.x() == kMaxF32)
	{
		return;
	}

	btDynamicsWorld& btworld = PhysicsWorld::getSingleton().getBtWorld();

	btworld.getBroadphase()->getOverlappingPairCache()->cleanProxyFromPairs(m_ghostObject->getBroadphaseHandle(), btworld.getDispatcher());

	m_controller->reset(&btworld);
	m_controller->warp(toBt(m_moveToPosition));

	m_moveToPosition.x() = kMaxF32;
}

} // end namespace anki