/*
 *   ORXONOX - the hottest 3D action shooter ever to exist
 *                    > www.orxonox.net <
 *
 *
 *   License notice:
 *
 *   This program is free software; you can redistribute it and/or
 *   modify it under the terms of the GNU General Public License
 *   as published by the Free Software Foundation; either version 2
 *   of the License, or (at your option) any later version.
 *
 *   This program is distributed in the hope that it will be useful,
 *   but WITHOUT ANY WARRANTY; without even the implied warranty of
 *   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 *   GNU General Public License for more details.
 *
 *   You should have received a copy of the GNU General Public License
 *   along with this program; if not, write to the Free Software
 *   Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301, USA.
 *
 *   Author:
 *      Fabian 'x3n' Landau
 *   Co-authors:
 *      ...
 *
 */

#include "OrxonoxStableHeaders.h"
#include "SpaceShip.h"

#include "util/Math.h"
#include "util/Exception.h"
#include "core/CoreIncludes.h"
#include "core/ConfigValueIncludes.h"
#include "core/XMLPort.h"

namespace orxonox
{
    CreateFactory(SpaceShip);

    SpaceShip::SpaceShip(BaseObject* creator) : Pawn(creator)
    {
        RegisterObject(SpaceShip);

        this->zeroDegree_ = 0;

        this->maxSpeed_ = 0;
        this->maxSecondarySpeed_ = 0;
        this->maxRotation_ = 0;
        this->translationAcceleration_ = 0;
        this->rotationAcceleration_ = 0;
        this->translationDamping_ = 0;

        this->yawRotation_ = 0;
        this->pitchRotation_ = 0;
        this->rollRotation_ = 0;

        this->bInvertYAxis_ = false;

        this->setDestroyWhenPlayerLeft(true);

        // create a phyisical body
        OrxAssert(this->physicalBody_ == 0, " Check why there is already a physical body in the space ship.");
        this->createPhysicalBody();

        this->setConfigValues();
        this->registerVariables();
    }

    SpaceShip::~SpaceShip()
    {
    }

    void SpaceShip::XMLPort(Element& xmlelement, XMLPort::Mode mode)
    {
        SUPER(SpaceShip, XMLPort, xmlelement, mode);

        XMLPortParam(SpaceShip, "maxspeed",          setMaxSpeed,          getMaxSpeed,          xmlelement, mode);
        XMLPortParam(SpaceShip, "maxsecondaryspeed", setMaxSecondarySpeed, getMaxSecondarySpeed, xmlelement, mode);
        XMLPortParam(SpaceShip, "maxrotation",       setMaxRotation,       getMaxRotation,       xmlelement, mode);
        XMLPortParam(SpaceShip, "transacc",          setTransAcc,          getTransAcc,          xmlelement, mode);
        XMLPortParam(SpaceShip, "rotacc",            setRotAcc,            getRotAcc,            xmlelement, mode);
        XMLPortParam(SpaceShip, "transdamp",         setTransDamp,         getTransDamp,         xmlelement, mode);
    }

    void SpaceShip::registerVariables()
    {
        REGISTERDATA(this->maxSpeed_,                network::direction::toclient);
        REGISTERDATA(this->maxSecondarySpeed_,       network::direction::toclient);
        REGISTERDATA(this->maxRotation_,             network::direction::toclient);
        REGISTERDATA(this->translationAcceleration_, network::direction::toclient);
        REGISTERDATA(this->rotationAcceleration_,    network::direction::toclient);
        REGISTERDATA(this->translationDamping_,      network::direction::toclient);
    }

    void SpaceShip::setConfigValues()
    {
        SetConfigValue(bInvertYAxis_, false).description("Set this to true for joystick-like mouse behaviour (mouse up = ship down).");
    }

    void SpaceShip::tick(float dt)
    {
        if (this->isLocallyControlled())
        {
            // #####################################
            // ############# STEERING ##############
            // #####################################

            Vector3 velocity = this->getVelocity();
            if (velocity.x > this->maxSecondarySpeed_)
                velocity.x = this->maxSecondarySpeed_;
            if (velocity.x < -this->maxSecondarySpeed_)
                velocity.x = -this->maxSecondarySpeed_;
            if (velocity.y > this->maxSecondarySpeed_)
                velocity.y = this->maxSecondarySpeed_;
            if (velocity.y < -this->maxSecondarySpeed_)
                velocity.y = -this->maxSecondarySpeed_;
            if (velocity.z > this->maxSecondarySpeed_)
                velocity.z = this->maxSecondarySpeed_;
            if (velocity.z < -this->maxSpeed_)
                velocity.z = -this->maxSpeed_;

            // normalize velocity and acceleration
            for (size_t dimension = 0; dimension < 3; ++dimension)
            {
                if (this->acceleration_[dimension] == 0)
                {
                    if (velocity[dimension] > 0)
                    {
                        velocity[dimension] -= (this->translationDamping_ * dt);
                        if (velocity[dimension] < 0)
                            velocity[dimension] = 0;
                    }
                    else if (velocity[dimension] < 0)
                    {
                        velocity[dimension] += (this->translationDamping_ * dt);
                        if (velocity[dimension] > 0)
                            velocity[dimension] = 0;
                    }
                }
            }

            this->setVelocity(velocity);
        }


        SUPER(SpaceShip, tick, dt);


        if (this->isLocallyControlled())
        {
            this->yaw(this->yawRotation_ * dt);
            if (this->bInvertYAxis_)
                this->pitch(Degree(-this->pitchRotation_ * dt));
            else
                this->pitch(Degree( this->pitchRotation_ * dt));
            this->roll(this->rollRotation_ * dt);

            this->acceleration_.x = 0;
            this->acceleration_.y = 0;
            this->acceleration_.z = 0;

            this->yawRotation_   = this->zeroDegree_;
            this->pitchRotation_ = this->zeroDegree_;
            this->rollRotation_  = this->zeroDegree_;
        }
    }

    void SpaceShip::moveFrontBack(const Vector2& value)
    {
        assert(this->physicalBody_);
        this->physicalBody_->applyCentralForce(btVector3(0.0f, 0.0f, -1.0f/this->physicalBody_->getInvMass() * value.x));
//        this->acceleration_.z = -this->translationAcceleration_ * value.x;
    }

    void SpaceShip::moveRightLeft(const Vector2& value)
    {
        this->physicalBody_->applyCentralForce(btVector3(1.0f/this->physicalBody_->getInvMass() * value.x, 0.0f, 0.0f));
//        this->acceleration_.x = this->translationAcceleration_ * value.x;
    }

    void SpaceShip::moveUpDown(const Vector2& value)
    {
        this->physicalBody_->applyCentralForce(btVector3(0.0f, 1.0f/this->physicalBody_->getInvMass() * value.x, 0.0f));
//        this->acceleration_.y = this->translationAcceleration_ * value.x;
    }

    void SpaceShip::rotateYaw(const Vector2& value)
    {
        Degree temp = value.x * value.x * sgn(value.x) * this->rotationAcceleration_;
        if (temp > this->maxRotation_)
            temp = this->maxRotation_;
        if (temp < -this->maxRotation_)
            temp = -this->maxRotation_;
        this->yawRotation_ = Degree(temp);
    }

    void SpaceShip::rotatePitch(const Vector2& value)
    {
        Degree temp = value.x * value.x * sgn(value.x) * this->rotationAcceleration_;
        if (temp > this->maxRotation_)
            temp = this->maxRotation_;
        if (temp < -this->maxRotation_)
            temp = -this->maxRotation_;
        this->pitchRotation_ = Degree(temp);
    }

    void SpaceShip::rotateRoll(const Vector2& value)
    {
        Degree temp = value.x * value.x * sgn(value.x) * this->rotationAcceleration_;
        if (temp > this->maxRotation_)
            temp = this->maxRotation_;
        if (temp < -this->maxRotation_)
            temp = -this->maxRotation_;
        this->rollRotation_ = Degree(temp);
    }

    void SpaceShip::fire()
    {
    }
}