//---------------------------------------------------------------------------
#include    "system.hpp"
#include    "classes.hpp"

#include "opengl/glew.h"
#include "opengl/glut.h"

#pragma hdrstop

#include "Camera.h"
#include "Usefull.h"
#include "Globals.h"
#include "Timer.h"
#include "mover.h"
#include "Console.h"
//---------------------------------------------------------------------------
#pragma package(smart_init)

//TViewPyramid TCamera::OrgViewPyramid;
//={vector3(-1,1,1),vector3(1,1,1),vector3(-1,-1,1),vector3(1,-1,1),vector3(0,0,0)};

const vector3 OrgCrossPos= vector3(0,-10,0);

void __fastcall TCamera::Init(vector3 NPos, vector3 NAngle)
{

    pOffset= vector3(-0.0,0,0);
    vUp= vector3(0,1,0);
//    pOffset= vector3(-0.8,0,0);
    CrossPos= OrgCrossPos;
    CrossDist= 10;
    Velocity=vector3(0,0,0);
    OldVelocity= vector3(0,0,0);
    Pitch= NAngle.x;
    Yaw= NAngle.y;
    Roll= NAngle.z;
    Pos= NPos;

//    Type= tp_Follow;
    Type= (Global::bFreeFly ? tp_Free : tp_Follow);
//    Type= tp_Free;
};

void __fastcall TCamera::OnCursorMove(double x, double y)
{
//McZapkie-170402: zeby mysz dzialala zawsze    if (Type==tp_Follow)
 Pitch+=y;
 Yaw+=-x;
 if (Yaw>M_PI)
  Yaw-=2*M_PI;
 else if (Yaw<-M_PI)
  Yaw+=2*M_PI;
 if (Type==tp_Follow) //jeżeli jazda z pojazdem
 {
  Fix(Pitch,-M_PI_4,M_PI_4); //ograniczenie kąta spoglądania w dół i w górę
  //Fix(Yaw,-M_PI,M_PI);
 }
}

void __fastcall TCamera::Update()
{
    //ABu: zmiana i uniezaleznienie predkosci od FPS
    double a= (Console::Pressed(VK_SHIFT)?5.00:1.00);
    if (Console::Pressed(VK_CONTROL))
     a=a*100;
//    OldVelocity=Velocity;
    if (FreeFlyModeFlag==true)
      Type=tp_Free;
    else
      Type=tp_Follow;
    if (Type==tp_Free)
    {
        if (Console::Pressed(Global::Keys[k_MechUp]))   Velocity.y+=a;
        if (Console::Pressed(Global::Keys[k_MechDown])) Velocity.y-=a;
//McZapkie-170402: zeby nie bylo konfliktow
/*
        if (Console::Pressed(VkKeyScan('d')))
            Velocity.x+= a*Timer::GetDeltaTime();
        if (Console::Pressed(VkKeyScan('a')))
            Velocity.x-= a*Timer::GetDeltaTime();
        if (Console::Pressed(VkKeyScan('w')))
            Velocity.z-= a*Timer::GetDeltaTime();
        if (Console::Pressed(VkKeyScan('s')))
            Velocity.z+= a*Timer::GetDeltaTime();

        if (Console::Pressed(VK_NUMPAD4) || Console::Pressed(VK_NUMPAD7) || Console::Pressed(VK_NUMPAD1))
            Yaw+= +1*M_PI*Timer::GetDeltaTime();

        if (Console::Pressed(VK_NUMPAD6) || Console::Pressed(VK_NUMPAD9) || Console::Pressed(VK_NUMPAD3))
            Yaw+= -1*M_PI*Timer::GetDeltaTime();

        if (Pressed(VK_NUMPAD2) || Console::Pressed(VK_NUMPAD1) || Console::Pressed(VK_NUMPAD3))
            Pitch+= -1*M_PI*Timer::GetDeltaTime();

        if (Console::Pressed(VK_NUMPAD8) || Console::Pressed(VK_NUMPAD7) || Console::Pressed(VK_NUMPAD9))
            Pitch+= +1*M_PI*Timer::GetDeltaTime();
        if (Console::Pressed(VkKeyScan('.')))
            Roll+= -1*M_PI*Timer::GetDeltaTime();
        if (Console::Pressed(VkKeyScan(',')))
            Roll+= +1*M_PI*Timer::GetDeltaTime();

        if (Console::Pressed(VK_NUMPAD5))
            Pitch=Roll= 0.0f;
*/

//McZapkie-170402: poruszanie i rozgladanie we free takie samo jak w follow
        if (Console::Pressed(Global::Keys[k_MechRight]))    Velocity.x+=a;
        if (Console::Pressed(Global::Keys[k_MechLeft]))     Velocity.x-=a;
        if (Console::Pressed(Global::Keys[k_MechForward]))  Velocity.z-=a;
        if (Console::Pressed(Global::Keys[k_MechBackward])) Velocity.z+=a;
//gora-dol
        //if (Console::Pressed(VK_NUMPAD9)) Pos.y+=0.1;
        //if (Console::Pressed(VK_NUMPAD3)) Pos.y-=0.1;

//McZapkie: zeby nie hustalo przy malym FPS:
//        Velocity= (Velocity+OldVelocity)/2;
//    matrix4x4 mat;
        vector3 Vec=Velocity;
        Vec.RotateY(Yaw);
        Pos=Pos+Vec*Timer::GetDeltaRenderTime(); //czas bez pauzy
        Velocity=Velocity/2; //płynne hamowanie ruchu
//    double tmp= 10*DeltaTime;
//        Velocity+= -Velocity*10 * Timer::GetDeltaTime();//( tmp<1 ? tmp : 1 );
//        Type= tp_Free;
    }

}

vector3 __fastcall TCamera::GetDirection()
{
    matrix4x4 mat;
    vector3 Vec;
    Vec= vector3(0,0,1);
    Vec.RotateY(Yaw);

    return (Normalize(Vec));
}

//bool __fastcall TCamera::GetMatrix(matrix4x4 &Matrix)
bool __fastcall TCamera::SetMatrix()
{
    glRotated(-Roll*180.0f/M_PI,0,0,1); //po wyłączeniu tego kręci się pojazd, a sceneria nie
    glRotated(-Pitch*180.0f/M_PI,1,0,0);
    glRotated(-Yaw*180.0f/M_PI,0,1,0); //w zewnętrznym widoku: kierunek patrzenia

    if (Type==tp_Follow)
    {
//        gluLookAt(Pos.x+pOffset.x,Pos.y+pOffset.y,Pos.z+pOffset.z,
//                LookAt.x+pOffset.x,LookAt.y+pOffset.y,LookAt.z+pOffset.z,vUp.x,vUp.y,vUp.z);
//        gluLookAt(Pos.x+pOffset.x,Pos.y+pOffset.y,Pos.z+pOffset.z,
//                LookAt.x+pOffset.x,LookAt.y+pOffset.y,LookAt.z+pOffset.z,vUp.x,vUp.y,vUp.z);
     gluLookAt(Pos.x,Pos.y,Pos.z,LookAt.x,LookAt.y,LookAt.z,vUp.x,vUp.y,vUp.z); //Ra: pOffset is zero
//        gluLookAt(Pos.x,Pos.y,Pos.z,Pos.x+Velocity.x,Pos.y+Velocity.y,Pos.z+Velocity.z,0,1,0);
//        return true;
    }

    if (Type==tp_Satelite)
        Pitch= M_PI*0.5;

    if (Type!=tp_Follow)
    {
     glTranslated(-Pos.x,-Pos.y,-Pos.z); //nie zmienia kierunku patrzenia
    }

    Global::SetCameraPosition(Pos); //było +pOffset
    return true;
}

void __fastcall TCamera::SetCabMatrix(vector3 &p)
{//ustawienie widoku z kamery bez przesunięcia robionego przez OpenGL - nie powinno tak trząść
 glRotated(-Roll*180.0f/M_PI,0,0,1);
 glRotated(-Pitch*180.0f/M_PI,1,0,0);
 glRotated(-Yaw*180.0f/M_PI,0,1,0); //w zewnętrznym widoku: kierunek patrzenia
 if (Type==tp_Follow)
  gluLookAt(Pos.x-p.x,Pos.y-p.y,Pos.z-p.z,LookAt.x-p.x,LookAt.y-p.y,LookAt.z-p.z,vUp.x,vUp.y,vUp.z); //Ra: pOffset is zero
}

void __fastcall TCamera::RaLook()
{//zmiana kierunku patrzenia - przelicza Yaw
 vector3 where=LookAt-Pos+vector3(0,3,0); //trochę w górę od szyn
 if ((where.x!=0.0)||(where.z!=0.0))
  Yaw=atan2(-where.x,-where.z); //kąt horyzontalny
 double l=Length3(where);
 if (l>0.0)
  Pitch=asin(where.y/l); //kąt w pionie
};

void __fastcall TCamera::Stop()
{//wyłącznie bezwładnego ruchu po powrocie do kabiny
 Type=tp_Follow;
 Velocity=vector3(0,0,0);
};