charger.cc

Go to the documentation of this file.

#include "stage.hh"
#include "worldfile.hh"
using namespace Stg;

Charger::Charger( World* world ) 
  : world( world ), watts( 1000.0 )
{
  //printf( "Charger constructed" );
}

void Charger::ChargeIfContained( PowerPack* pp, Pose pose )
{
  if( Contains( pose ) )
         Charge( pp );
}

bool Charger::Contains( Pose pose )
{
  return( pose.x >= volume.x.min &&
                         pose.x  < volume.x.max &&
                         pose.y >= volume.y.min &&
                         pose.y  < volume.y.max &&
                         pose.z >= volume.z.min &&
                         pose.z  < volume.z.max );
}
         
void Charger::Charge( PowerPack* pp )
{
  double given = watts * world->interval_sim * 1e-6;
  
  pp->stored += given;
  
  // do not exceed capacity
  pp->stored = MIN( pp->stored, pp->capacity );
  pp->charging = true;
  /*
         printf( "charger %p  at [%.2f %.2f] [%.2f %.2f] [%.2f %.2f] gave pack %p %.3f joules\n",
         this,
         volume.x.min,
         volume.x.max,
         volume.y.min,
         volume.y.max,
         volume.z.min,
         volume.z.max,
         pp, given );
  
  pp->Print( "just charged" );
  */
}

void Charger::Visualize()
{

  glPushMatrix();
  glPolygonMode( GL_FRONT, GL_FILL );
  glColor4f( 1, 0.5,0,0.4 );
  glTranslatef( 0,0,volume.z.min);
  glRectf( volume.x.min, volume.y.min, volume.x.max, volume.y.max );
  
  glTranslatef( 0,0,volume.z.max );
  glRectf( volume.x.min, volume.y.min, volume.x.max, volume.y.max );
  glPopMatrix();

  glPushMatrix();
  glPolygonMode( GL_FRONT, GL_LINE );
  glColor4f( 1, 0.5,0,0.8 );
  glTranslatef( 0,0,volume.z.min);
  glRectf( volume.x.min, volume.y.min, volume.x.max, volume.y.max );
  
  glTranslatef( 0,0,volume.z.max );
  glRectf( volume.x.min, volume.y.min, volume.x.max, volume.y.max );
  glPopMatrix();

  // ?
  //glPolygonMode( GL_FRONT, GL_FILL );
}

void swap( double &a, double &b )
{
  double keep = a;
  a = b;
  b = keep;
}

void Charger::Load( Worldfile* wf, int entity )
{
  if( wf->PropertyExists( entity, "volume" ) )
         {
                volume.x.min = wf->ReadTupleLength( entity, "volume", 0, volume.x.min );
                volume.x.max = wf->ReadTupleLength( entity, "volume", 1, volume.x.max );
                volume.y.min = wf->ReadTupleLength( entity, "volume", 2, volume.y.min );
                volume.y.max = wf->ReadTupleLength( entity, "volume", 3, volume.y.max );
                volume.z.min = wf->ReadTupleLength( entity, "volume", 4, volume.z.min );
                volume.z.max = wf->ReadTupleLength( entity, "volume", 5, volume.z.max );
                
                // force the windings for GL's sake
                if( volume.x.min > volume.x.max )
                  swap( volume.x.min, volume.x.max );
                
                if( volume.y.min > volume.y.max )
                  swap( volume.y.min, volume.y.max );

                if( volume.z.min > volume.z.max )
                  swap( volume.z.min, volume.z.max );
                
         }
  
  watts = wf->ReadFloat( entity, "watts", watts );
}