// Copyright (c) 2018-2019 Kiwano - Nomango
// 
// Permission is hereby granted, free of charge, to any person obtaining a copy
// of this software and associated documentation files (the "Software"), to deal
// in the Software without restriction, including without limitation the rights
// to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
// copies of the Software, and to permit persons to whom the Software is
// furnished to do so, subject to the following conditions:
// 
// The above copyright notice and this permission notice shall be included in
// all copies or substantial portions of the Software.
// 
// THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
// IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
// FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
// AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
// LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
// OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
// THE SOFTWARE.

#include <kiwano-physics/Body.h>
#include <kiwano-physics/World.h>

namespace kiwano
{
	namespace physics
	{

		Body::Body()
			: ignore_rotation_(false)
			, body_(nullptr)
			, actor_(nullptr)
			, world_(nullptr)
		{
		}

		Body::Body(b2Body* body, Actor* actor)
			: Body()
		{
			SetB2Body(body);
			SetActor(actor);
		}

		Body::~Body()
		{
			if (world_)
			{
				world_->RemoveBody(this);
			}
		}

		BodyPtr Body::Create(World* world, Actor* actor)
		{
			BodyPtr body = new Body;
			if (body)
			{
				body->world_ = world;
				if (world)
				{
					b2BodyDef def;
					b2Body* b2body = world->GetB2World()->CreateBody(&def);
					body->SetB2Body(b2body);
				}
				body->SetActor(actor);
				body->UpdateFromActor();
			}
			return body;
		}

		Fixture Body::AddShape(Shape* shape, float density, float friction, float restitution)
		{
			KGE_ASSERT(body_ && world_);

			if (shape)
			{
				return Fixture::Create(this, shape, density, friction, restitution);
			}
			return Fixture();
		}

		Fixture Body::AddCircleShape(float radius, float density)
		{
			return AddShape(&CircleShape(radius), density);
		}

		Fixture Body::AddBoxShape(Vec2 const& size, float density)
		{
			return AddShape(&BoxShape(size), density);
		}

		Fixture Body::AddPolygonShape(Vector<Point> const& vertexs, float density)
		{
			return AddShape(&PolygonShape(vertexs), density);
		}

		Fixture Body::AddEdgeShape(Point const& p1, Point const& p2, float density)
		{
			return AddShape(&EdgeShape(p1, p2), density);
		}

		Fixture Body::AddChainShape(Vector<Point> const& vertexs, bool loop, float density)
		{
			return AddShape(&ChainShape(vertexs, loop), density);
		}

		void Body::RemoveFixture(Fixture const& fixture)
		{
			if (fixture.GetB2Fixture())
			{
				b2Fixture* ptr = const_cast<b2Fixture*>(fixture.GetB2Fixture());
				body_->DestroyFixture(ptr);
			}
		}

		Point Body::GetPosition() const
		{
			KGE_ASSERT(body_ && world_);
			return world_->World2Stage(body_->GetPosition());
		}

		Point Body::GetLocalPoint(Point const& world) const
		{
			KGE_ASSERT(body_ && world_);
			return world_->World2Stage(body_->GetLocalPoint(world_->Stage2World(world)));
		}

		Point Body::GetWorldPoint(Point const& local) const
		{
			KGE_ASSERT(body_ && world_);
			return world_->World2Stage(body_->GetWorldPoint(world_->Stage2World(local)));
		}

		void Body::ApplyForce(Vec2 const& force, Point const& point, bool wake)
		{
			KGE_ASSERT(body_ && world_);
			body_->ApplyForce(b2Vec2(force.x, force.y), world_->Stage2World(point), wake);
		}

		void Body::ApplyForceToCenter(Vec2 const& force, bool wake)
		{
			KGE_ASSERT(body_ && world_);
			body_->ApplyForceToCenter(b2Vec2(force.x, force.y), wake);
		}

		void Body::ApplyTorque(float torque, bool wake)
		{
			KGE_ASSERT(body_ && world_);
			body_->ApplyTorque(torque, wake);
		}

		void Body::SetB2Body(b2Body* body)
		{
			body_ = body;
			if (body_)
			{
				body_->SetUserData(this);
			}
		}

		void Body::UpdateActor()
		{
			if (actor_ && body_)
			{
				if (world_)
				{
					actor_->SetPosition(world_->World2Stage(body_->GetPosition()));
				}
				else
				{
					actor_->SetPosition(World2Stage(body_->GetPosition()));
				}

				if (!ignore_rotation_)
				{
					actor_->SetRotation(math::Radian2Angle(body_->GetAngle()));
				}
			}
		}

		void Body::UpdateFromActor()
		{
			if (actor_ && body_)
			{
				float rotation = ignore_rotation_ ? body_->GetAngle() : math::Angle2Radian(actor_->GetRotation());

				if (world_)
				{
					body_->SetTransform(
						world_->Stage2World(actor_->GetPosition()),
						rotation
					);
				}
				else
				{
					body_->SetTransform(
						Stage2World(actor_->GetPosition()),
						rotation
					);
				}
			}
		}

}
}