/* 
   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: ...
*/

#include "track.h"

using namespace std;

/**
	\brief creates a null Track part
*/
Track::Track ()
{
	ID = 0;
	offset = NULL;
	end = NULL;
	nextID = 0;
}

/**
	\brief creates a functional base Track part
	\param number: the ID if this Track part
	\param next: the ID of the next Track part
	\param start: pointer to an anchor point (Vector) representing the offset of this part
	\param finish: pointer to an anchor point (Vector) representing the end of this part
*/
Track::Track (Uint32 number, Uint32 next, Vector* start, Vector* finish)
{
	ID = number;
	offset = start;
	end = finish;
	nextID = next;
}

/**
	\brief removes the Track part from memory
*/
Track::~Track ()
{
}

void Track::init()
{
  
}


/**
   \brief calculate a camera Placement from a "look at"-Location
   \param lookat: the Location the camera should be centered on
   \param camplc: pointer to a buffer where the new camera Placement should be put into
   
   Theoretically you can place the camera wherever you want, but for the sake of 
   common sense I suggest that you at least try to keep the thing that should be looked
   at inside camera boundaries.
*/
void Track::map_camera (Location* lookat, Placement* camplc)
{
  Line trace(*offset, *end - *offset);
  float l = trace.len ();
  
  //	camplc->r = *offset + Vector(0,0,0.5);
  //	camplc->w = Quaternion (trace.a, Vector(0,0,1));
  float r = (lookat->dist)*PI / l;
  camplc->r = trace.r + (trace.a * ((lookat->dist-18.0) / l)) + Vector(0,0,3.0);
  
  Vector w(0.0,0.0,0.0);
  w=Vector(0,0,0) - ((trace.r + (trace.a * ((lookat->dist) / l)) - camplc->r));
  //Vector up(0.0,sin(r),cos(r)); // corrupt...
  Vector up(0.0, 0.0, 1.0);

  camplc->w = Quaternion(w, up);

  //printf("\n------\nup vector: [%f, %f, %f]\n", up.x, up.y, up.z);
  //printf("direction: [%f, %f, %f]\n", w.x, w.y, w.z);
  //printf("quaternion: w[ %f ], v[ %f, %f, %f ]\n", camplc->w.w, camplc->w.v.x, camplc->w.v.y, camplc->w.v.z);
}

/**
   \brief calculate a Placement from a given Location
   \param loc: the Location the entity is in
   \param plc: a pointer to a buffer where the corresponding Placement should be put
   into
   \return: true if track changes - false if track stays
   
   There are no limitations to how you transform a Location into a Placement, but for 
   the sake of placement compatibility between track parts you should make sure that 
   the resulting Placement at dist == 0 is equal to the offset Vector and the Placement
   at dist == len() is equal to the end Vector. Elseway there will be ugly artifacts 
   when transfering between track parts.
*/
bool Track::map_coords (Location* loc, Placement* plc)
{
	Line trace(*offset, *end - *offset);
	float l = trace.len ();
	
	/* change to the next track? */
	if( loc->dist > l)
	{
		loc->dist -= l;
		loc->part = nextID;
		//FIXME: loc->track = this;
		return true;
	}
	
	/* this quaternion represents the rotation from start-vector (0,0,1) to the direction of
	 * the track */
	Quaternion dir(trace.a, Vector(0,0,1)); 

	plc->r = trace.r + (trace.a * ((loc->dist) / l)) + /*dir.apply*/(loc->pos);
	plc->w = dir * loc->rot;
	
	return false;
}

/**
	\brief this is called when a WorldEntity enters a Track part
	\param entity: pointer to the WorldEntity in question
	
	You can do stuff like add or remove effects, do some coordinate finetuning 
	or whatever in here.
*/
void Track::post_enter (WorldEntity* entity)
{
}

/**
	\brief this is called when a WorldEntity leaves a Track part
	\param entity: pointer to the WorldEntity in question
	
	You can do stuff like add or remove effects, do some coordinate finetuning 
	or whatever in here.
*/
void Track::post_leave (WorldEntity* entity)
{
}

/**
	\brief this is called every frame
	\param deltaT: amount of time passed since the last frame in seconds
	
	Do time based or polling scripts here. 
*/
void Track::tick (float deltaT)
{
}