source: orxonox.OLD/branches/adm/src/world_entities/npcs/adm_turret.cc @ 10681

/*
* 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: Reto Luechinger
*/


#define DEBUG_SPECIAL_MODULE DEBUG_MODULE_WORLD_ENTITY
#include "adm_turret.h"
#include "weapons/weapon_manager.h"
#include "weapons/weapon.h"
#include "lib/util/loading/factory.h"
#include "world_entities/projectiles/projectile.h"
#include "loading/load_param.h"
#include "debug.h"
#include "loading/load_param_xml.h"

ObjectListDefinition(AdmTurret);
CREATE_FACTORY(AdmTurret);


/**
*  Standard constructor
*/
AdmTurret::AdmTurret ()
{
        this->init();
}

/**
* destructs the turret, deletes allocated memory
*/
AdmTurret::~AdmTurret ()
{
          // will be deleted
}

/**
* Constructor with XML Element
*/
AdmTurret::AdmTurret (const  TiXmlElement* root)
{
        this->init();
        if (root != NULL)
        {
                this->loadParams(root);
        }
}
/**
* XML Loader
*/
void AdmTurret::loadParams(const TiXmlElement* root)
{
        if (root != NULL)
        {
                WorldEntity::loadParams(root);

                LoadParam(root, "target", this, AdmTurret, setTarget)
                        .describe("The filename of the World Entity, that is to be shot at")
                        .defaultValues("");
                
                LoadParam(root, "type", this, AdmTurret, setType)
                        .describe("floor|ceil"); 

                LoadParamXML(root, "Cannons", this, AdmTurret, addCannons)
                        .describe("add cannons to ADM");
                LoadParamXML(root, "Sensor", this, AdmTurret, addSensor)
                        .describe("add sensor to ADM");

        }
//         this->removeNodeFlags( PNODE_ALL );
//         this->addNodeFlags( PNODE_ROTATE_AND_MOVE );
        
        if ( this->isCeil )
        {
          Vector a = this->sensor->getRelCoor();
          this->sensor->setRelCoor( -a.x, -a.y, -a.z );
          a = this->cannons->getRelCoor();
          this->cannons->setRelCoor( -a.x, -a.y, -a.z );
        }
}

/**
* Sets Target onto the World Entity with filename "target", given as String
*/
void AdmTurret::setTarget(const std::string& target)
{
        WorldEntity* targetEntity = WorldEntity::objectList().getObject(target);
        if (targetEntity != NULL) 
        {
                this->myTarget = targetEntity;
        }
        else
        {
                PRINTF(1)("ERROR ADMTURRET : Target %s does not exist\n", target.c_str());
        }
}

void AdmTurret::setType( const std::string& type )
{
  if ( type == "floor" )
  {
    this->isCeil = false;
    return;
  }
  
  if ( type == "ceil" )
  {
    this->isCeil = true;
    return;
  }
  
  //invalid argument
  PRINTF(1)("%s is not a valid type for AdmTurret\n", type.c_str());
  assert("false");
}

void AdmTurret::init()
{
        this->registerObject(this, AdmTurret::_objectList);
        
        this->bodyAngle = this->cannonAngle = 0.0f;
        this->isActive = true;
        this->range = 400;
        this->isCeil = false;
}

void AdmTurret::tick(float dt)
{
  WorldEntity::tick(dt);

  //rotate sensor 2PI/sec
  this->sensor->setAbsDir( this->sensor->getAbsDir() * Quaternion( PI*2*dt, Vector( 0, 1, 0 ) ) );


  Vector playerPos = this->myTarget->getAbsCoor();
  Vector ds = playerPos - ( this->cannons->getAbsCoor() );
  if ( isActive && ds.len() <= range )
    this->moveTowards( ds,  dt);
  else
    this->moveTowards( Vector(0, -1, 0), dt );
}

void AdmTurret::draw() const
{
  WorldEntity::draw();


  glMatrixMode(GL_MODELVIEW);
  glPushMatrix();

  glPushAttrib(GL_ENABLE_BIT);

  glDisable(GL_LIGHTING);
  glDisable(GL_TEXTURE_2D);
  glDisable(GL_BLEND);
  glLineWidth(2.0);


  Vector mp = this->cannons->getAbsCoor();
  Vector op = this->cannons->getAbsDir().apply( Vector(-1, 0, 0) );
  op *= 100;
  op += mp;

  glColor3f(1.0, 0.0, 0.0 );
  glBegin(GL_LINE_STRIP);
    glVertex3f(mp.x, mp.y, mp.z);
    glVertex3f(op.x, op.y, op.z);
  glEnd();

  op = this->myTarget->getAbsCoor() - ( this->cannons->getAbsCoor() );
  op += mp;

  glColor3f(0.0, 1.0, 0.0 );
  glBegin(GL_LINE_STRIP);
    glVertex3f(mp.x, mp.y, mp.z);
    glVertex3f(op.x, op.y, op.z);
  glEnd();
  
  glPopAttrib();
  glPopMatrix();
  
}

void AdmTurret::collidesWith(WorldEntity* entity, const Vector& location)
{
}

void AdmTurret::activate()
{
}

void AdmTurret::deactivate()
{
}

bool AdmTurret::isVisible(const WorldEntity myTarget)
{
return true;
}

float AdmTurret::aim(const WorldEntity Target)
{
return 0;
}

void AdmTurret::fire()
{
        // Projectile* pj =  this->getProjectile();
        // if (pj == NULL) return;

        //pj->setOwner(this->getOwner());
        //pj->setParent(PNode::getNullParent());
        //pj->setVelocity(this->getAbsDir().apply(Vector( , , )) );
        //pj->setAbsCoor(this->getEmissionPoint());
        //pj->setAbsDir(this->getAbsDir());
        //pj->activate();
}

void AdmTurret::addCannons( const TiXmlElement * root )
{
        this->cannons = new WorldEntity();
        this->cannons->setParent(this);
        this->cannons->loadParams( root );

        //this->cannons->addNodeFlags(PNODE_PROHIBIT_DELETE_WITH_PARENT);
        //this->cannons->addNodeFlags(PNODE_PROHIBIT_CHILD_DELETE);
        
        this->cannons->toList( getOMListNumber() );
}

void AdmTurret::addSensor( const TiXmlElement * root )
{
        this->sensor = new WorldEntity();
        this->sensor->setParent(this);
        this->sensor->loadParams( root );

        //this->sensor->addNodeFlags(PNODE_PROHIBIT_DELETE_WITH_PARENT);
        //this->sensor->addNodeFlags(PNODE_PROHIBIT_CHILD_DELETE);
        this->sensor->toList( getOMListNumber() );
}

void AdmTurret::moveTowards( Vector targetDir, float dt )
{
  if ( this->cannons->getParent() != NullParent::getNullParent() )
    this->cannons->setParent( NullParent::getNullParent() );
  
  targetDir.normalize();
  
  float dAngle = dt;
  
  float bestResult = -1.0f;
  Quaternion bestBodyRot;
  Quaternion bestCannonRot;
  float bestBodyAngle = 0.0f;
  float bestCannonAngle = 0.0f;
  
//   Quaternion baseRot(0, Vector);
//   if ( isCeil )
//   {
//     printf( "ceil\n" );
//     baseRot = Quaternion( PI/2, Vector( 0, 0, 1 ) );
//   }
  
  for ( int dBodyAngle = -1; dBodyAngle<2; dBodyAngle++ )
  {
    for ( int dCannonAngle = -1; dCannonAngle<2; dCannonAngle++ )
    {
      float bodyAngle = this->bodyAngle + dBodyAngle*dAngle;
      float cannonAngle = this->cannonAngle + dCannonAngle*dAngle;
      
      while ( bodyAngle > 2*PI )
        bodyAngle -= 2*PI;
      while ( bodyAngle < 0 )
        bodyAngle += 2*PI;
      while ( cannonAngle > 2*PI )
        cannonAngle -= 2*PI;
      while ( cannonAngle < 0 )
        cannonAngle += 2*PI;
      
      Quaternion bodyRot( bodyAngle, Vector( 0, 1, 0 ) );
      Quaternion cannonRot( cannonAngle, Vector( 0, 0, 1) );
      
//       bodyRot = baseRot * bodyRot;
//       cannonRot = baseRot * cannonRot;
      
      float result = (bodyRot * cannonRot).apply( Vector( -1, 0, 0 ) ).dot( targetDir );
      
      if ( result > bestResult )
      {
        bestResult = result;
        bestBodyRot = bodyRot;
        bestBodyAngle = bodyAngle;
        bestCannonRot = cannonRot;
        bestCannonAngle = cannonAngle;
      }
    }
  }
  
  this->bodyAngle = bestBodyAngle;
  this->cannonAngle = bestCannonAngle;
  
  this->setAbsDir( bestBodyRot );
  this->cannons->setAbsDir( bestBodyRot * bestCannonRot );
}