#include "BsRigidbody.h"
#include "BsPhysics.h"

namespace BansheeEngine
{
	Rigidbody::Rigidbody(UINT32 priority)
		:mPriority(priority)
	{
		gPhysics().registerRigidbody(this, priority);
	}

	Rigidbody::~Rigidbody()
	{
		// It is assumed that child colliders will keep the parent Rigidbody alive, so we don't need to clear their parents
		gPhysics().unregisterRigidbody(mPhysicsId, mPriority);
	}

	void Rigidbody::addCollider(FCollider* collider)
	{
		mColliders.push_back(collider);
	}

	void Rigidbody::removeCollider(FCollider* collider)
	{
		auto iterFind = std::find(mColliders.begin(), mColliders.end(), collider);
		if (iterFind != mColliders.end())
			mColliders.erase(iterFind);
	}

	void Rigidbody::setIsActive(bool value)
	{
		mIsActive = value;
	}

	void Rigidbody::setFlags(Flag flags)
	{
		if (mFlags == flags)
			return;

		mFlags = flags;
		_updateMassDistribution();
	}

	void Rigidbody::_setPriority(UINT32 priority)
	{
		gPhysics().updatePriority(mPhysicsId, mPriority, priority);

		mPriority = priority;
	}

	SPtr<Rigidbody> Rigidbody::create(const Vector3& position, const Quaternion& rotation)
	{
		return gPhysics().createRigidbody(position, rotation);
	}
}