/*
   orxonox - the future of 3D-vertical-scrollers

   Copyright (C) 2004 orx

   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, or (at your option)
   any later version.

   ### File Specific:
   main-programmer: Christian Meyer
   co-programmer: Benjamin Grauer
*/
#define DEBUG_SPECIAL_MODULE DEBUG_MODULE_WORLD_ENTITY

#include "camera.h"
#include "key_mapper.h"
#include "glincl.h"
#include "vector.h"
#include "state.h"
#include "shell_command.h"
#include "targets.h"
#include <iostream.h>



ObjectListDefinition(Camera);


/**
 *  creates a Camera
*/
Camera::Camera()
{
  this->registerObject(this, Camera::_objectList);
  this->setName("camera");
  this->target = new CameraTarget();

  this->subscribeEvent(ES_GAME, KeyMapper::PEV_VIEW0);
  this->subscribeEvent(ES_GAME, KeyMapper::PEV_VIEW1);
  this->subscribeEvent(ES_GAME, KeyMapper::PEV_VIEW2);
  this->subscribeEvent(ES_GAME, KeyMapper::PEV_VIEW3);
  this->subscribeEvent(ES_GAME, KeyMapper::PEV_VIEW4);
  this->subscribeEvent(ES_GAME, KeyMapper::PEV_VIEW5);

  this->setFovy(90);
  this->setAspectRatio(1.2f);
  this->setClipRegion(.1, 10000);

  this->setViewMode(Camera::ViewNormal);

  this->setParentMode(PNODE_ALL);
}

/**
 *  default destructor
*/
Camera::~Camera()
{}

/**
 *  focuses the Camera onto a Target
 * @param target the new PNode the Camera should look at.
*/
void Camera::lookAt(PNode* target)
{
  this->target->setParent(target);
}

/**
 * @returns The PNode of the Target (from there you can get position and so on
*/
PNode* Camera::getTargetNode() const
{
  return (PNode*)this->target;
}

void Camera::setTargetNode(PNode* target)
{
  this->target->setParent(target);
}

/**
 *  sets a new AspectRatio
 * @param aspectRatio the new aspect ratio to set (width / height)
*/
void Camera::setAspectRatio(float aspectRatio)
{
  this->aspectRatio = aspectRatio;
}

/**
 * Sets a new clipping region
 * @param nearClip The near clip plane
 * @param farClip The far clip plane
*/
void Camera::setClipRegion(float nearClip, float farClip)
{
  this->nearClip = nearClip;
  this->farClip = farClip;
}

/**
 *  sets the new VideoMode and initializes iteration to it.
 * @param mode the mode to change to.
*/
void Camera::setViewMode(ViewMode mode)
{
  currentMode = mode;
  switch (mode)
  {
    default:
    case Camera::ViewNormal:
      this->toFovy = 60.0;
      this->setRelCoorSoft(-10, 5, 0);
      this->target->setRelCoorSoft(0,0,0);
      break;
    case Camera::ViewBehind:
      break;
    case Camera::ViewFront:
      this->toFovy = 120.0;
      this->setRelCoorSoft(4, 0, 0, 5);
      this->target->setRelCoorSoft(Vector(10,0,0), 5);
      break;
    case Camera::ViewLeft:
      this->toFovy = 90;
      this->setRelCoorSoft(0, 1, -10, .5);
      this->target->setRelCoorSoft(0,0,0);
      break;
    case Camera::ViewRight:
      this->toFovy = 90;
      this->setRelCoorSoft(Vector(0, 1, 10));
      this->target->setRelCoorSoft(0,0,0);
      break;
    case Camera::ViewTop:
      this->toFovy= 120;
      this->setRelCoorSoft(Vector(30, 50, 0));
      this->target->setRelCoorSoft(35,0,0);
  }
}


/**
 *  Updates the position of the camera.
 * @param dt: The time that elapsed.
*/
void Camera::tick(float dt)
{
  //update frustum plane
  this->viewVector = (this->target->getAbsCoor() - this->getAbsCoor()).getNormalized();
  this->frustumPlane = Plane(this->viewVector, this->getAbsCoor() + this->viewVector * 0.1);
  this->upVector =  this->getAbsDirV();

  // iteration for fovy
  float tmpFovy = (this->toFovy - this->fovy);
  if (tmpFovy > 0.01)
    this->fovy += tmpFovy * fabsf(dt);




  //iterate(float dt, translate, target)
  target->translate(dt);
}


/**
 *  initialize rendering perspective according to this camera
 *
 * This is called immediately before the rendering cycle starts, it sets all global
 * rendering options as well as the GL_PROJECTION matrix according to the camera.
 */
void Camera::apply ()
{
  // switching to Projection Matrix
  glMatrixMode (GL_PROJECTION);
  glLoadIdentity ();

  gluPerspective(this->fovy,
                 this->aspectRatio,
                 this->nearClip,
                 this->farClip);


    // setting up the perspective
  // speed-up feature
  glMatrixMode (GL_MODELVIEW);
  glLoadIdentity();


}

void Camera::project()
{
  Vector cameraPosition = this->getAbsCoor();
  Vector targetPosition = this->target->getAbsCoor();

        //Setting the Camera Eye, lookAt and up Vectors
  gluLookAt(cameraPosition.x, cameraPosition.y, cameraPosition.z,
            targetPosition.x, targetPosition.y, targetPosition.z,
            this->upVector.x, this->upVector.y, this->upVector.z);
}


/**
 *  processes an event
 * @param event: the event to process
*/
void Camera::process(const Event &event)
{
  if( event.type == KeyMapper::PEV_VIEW0)
  {
    this->setViewMode(Camera::ViewNormal);
  }
  else if( event.type == KeyMapper::PEV_VIEW1)
  {
    this->setViewMode(Camera::ViewBehind);
  }
  else if( event.type == KeyMapper::PEV_VIEW2)
  {
    this->setViewMode(Camera::ViewFront);
  }
  else if( event.type == KeyMapper::PEV_VIEW3)
  {
    this->setViewMode(Camera::ViewLeft);
  }
  else if( event.type == KeyMapper::PEV_VIEW4)
  {
    this->setViewMode(Camera::ViewRight);
  }
  else if( event.type == KeyMapper::PEV_VIEW5)
  {
    this->setViewMode(Camera::ViewTop);
  }
}




void Camera::glLookAt(float eyex, float eyey, float eyez, float centerx, float centery, float centerz, float upx, float upy, float upz)
{
  //Vector* eye=new Vector(eyex, eyey, eyez);
  Vector* center=new Vector (centerx, centery, centerz);
  Vector* up=new Vector(upx, upy, upz);

  center->x-=eyex;
  center->y-=eyey;
  center->z-=eyez;

  center->normalize();
  up->normalize();
  Vector* s = VectorProd(center, up);
  Vector* u = VectorProd(s, center);
  GLfloat Matrix[]={s->x, s->y, s->z, 0, u->x, u->y, u->z, 0, -center->x, -center->y, -center->z, 0, 0, 0, 0, 1};

  glMultMatrixf(Matrix);
  glTranslated(-eyex, -eyey, -eyez);
  delete center;
  delete up;
  delete s;
  delete u;

}




Vector* Camera::VectorProd(Vector* v1, Vector* v2)
{
Vector* temp= new Vector();
temp->x=v1->y * v2->z - v1->z * v2->y;
temp->y=v1->z * v2->x - v1->x * v2->z;
temp->z=v1->x * v2->y - v1->y * v2->x;
return temp;
}














///////////////////
// CAMERA-TARGET //
///////////////////
//REATE_FACTORY(CameraTarget);


ObjectListDefinition(CameraTarget);

SHELL_COMMAND(det, CameraTarget, detach);
SHELL_COMMAND(tes, CameraTarget, test);
SHELL_COMMAND(tr, CameraTarget,trans);
SHELL_COMMAND(t2, CameraTarget,test2);





CameraTarget::CameraTarget()
{
  this->registerObject(this, CameraTarget::_objectList);
  //  this->setParentMode(PNODE_MOVEMENT);
  this->speed=1;
  translateTo.x=0;
  translateTo.y=0;
  translateTo.z=0;
  rotateBy.x=0;
  rotateBy.y=0;
  rotateBy.z=0;
  target=createStick();

}


void CameraTarget::detach()
{
  glLoadIdentity();

//Movemet
  State::getCameraNode()->setParentSoft(PNode::getNullParent());

//LookAt
 // State::getCameraTargetNode()->setParentSoft(PNode::getNullParent());
}

PNode* CameraTarget::createStick()
{
  return new Targets();
}


void CameraTarget::atach(PNode* object)
{
  State::getCameraNode()->setParentSoft(object);
  State::getCameraTargetNode()->setParentSoft(object);
}


Vector CameraTarget::iterate(float dt, const Vector* target, const Vector* cam)
{


  Vector tmpVec;
  tmpVec= (*target - *cam);
  tmpVec.normalize();
  return  tmpVec;

}


void CameraTarget::translate(float dt)
{
  if (fabs(translateTo.len()  - (target->getAbsCoor()).len()) >= 11 )
 {

   Vector tmpVec= iterate(dt,  &translateTo,  &(State::getCameraNode()->getAbsCoor()));
    glLoadIdentity();
    target->shiftCoor(speed*tmpVec.x, speed*tmpVec.y, speed*tmpVec.z);
    // cout << "%%" << tmpVec.x << "%%";

  }
}

Vector * CameraTarget::rotate(Vector* newPos, float speed)
{

}

void CameraTarget::jump(float x, float y, float z)
{
target->setAbsCoor(x,y,z);
}


void CameraTarget::trans(float x, float y, float z)
{
  Vector tmpVec=Vector(x,y,z);
  translateNow(&tmpVec);
}

void CameraTarget::translateNow(Vector* vec)
{
translateTo=*vec;
}

void CameraTarget::changeSpeed(float speed)
{
  if (speed!=0)
this->speed=speed;
  return;
}


void CameraTarget::test()
{
  glLoadIdentity();

atach(target);

//tar->setRelCoorSoft(1000,1000,1000);


  //Vector* vec=new Vector(5000,5000,5000);
  //translateNow(vec);
  //glMatrixMode (GL_MODELVIEW);
  //glLoadIdentity();
  //glTranslatef(100, 100, 100);
 // State::getCamera()->getTargetNode()->setRelCoor(100,100,100);
}


void CameraTarget::test2()
{
  trans(-200, 0, 0);
  //target->setAbsCoor(target->getAbsCoorX()-200, target->getAbsCoorY(), target->getAbsCoorZ());
}