/*
 *  Player - One Hell of a Robot Server
 *     Brian Gerkey, Kasper Stoy, Richard Vaughan, & Andrew Howard
 *
 *  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 of the License, or
 *  (at your option) any later version.
 *
 *  This program is distributed in the hope that it will be useful,
 *  but WITHOUT ANY WARRANTY; without even the implied warranty of
 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 *  GNU General Public License for more details.
 *
 *  You should have received a copy of the GNU General Public License
 *  along with this program; if not, write to the Free Software
 *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
 *
 */
///////////////////////////////////////////////////////////////////////////
//
// Desc: Stage (simulator) time
// Author: Richard Vaughan
// Date: 7 May 2003
// CVS: $Id: stg_time.cc,v 1.2 2008-01-15 01:25:42 rtv Exp $
//
///////////////////////////////////////////////////////////////////////////

#include <math.h>

#include "p_driver.h"
using namespace Stg;

// Constructor
StTime::StTime( StgDriver* driver )
{
  assert(driver);
  this->driver = driver;
  return;
}

// Destructor
StTime::~StTime()
{
  return;
}

// Get the simulator time
int StTime::GetTime(struct timeval* time)
{
  PRINT_DEBUG( "get time" );

  assert( this->driver );

  World* world = driver->world;

  stg_usec_t usec = world->SimTimeNow();
  time->tv_sec  = (int)floor(usec/million);
  time->tv_usec = (int)rint(fmod(usec,million) * million);

  PRINT_DEBUG2( "time now %ld sec %ld usec", time->tv_sec, time->tv_usec );

  return 0;
}

int StTime::GetTimeDouble(double* time)
{
  PRINT_DEBUG( "get time (double)" );

  assert( this->driver );

  World* world = driver->world;

  *time = world->SimTimeNow() / million;

  PRINT_DEBUG1( "time now %f sec ", *time);

  return 0;
}
