trick/trick_source/sim_services/Clock/src/TPROCTEClock.cpp

129 lines
3.3 KiB
C++
Raw Normal View History

2015-02-26 15:02:31 +00:00
/*
PURPOSE:
( gettimeofday clock )
PROGRAMMERS:
(((Alex Lin) (NASA) (Feb 2012) (--) (--)))
*/
#include <stdio.h>
#include "sim_services/Clock/include/TPROCTEClock.hh"
#include "sim_services/Message/include/message_proto.h"
#include "sim_services/Message/include/message_type.h"
2015-02-26 15:02:31 +00:00
#include "sim_services/include/release.h"
/**
@details
-# Calls the base Clock constructor
-# Sets the default device name
*/
Trick::TPROCTEClock::TPROCTEClock() : Clock(1000000, "TPROCTE") , dev_name("/dev/tpropci0") { }
/**
@details
-# This function is empty
*/
Trick::TPROCTEClock::~TPROCTEClock() { }
/**
@details
-# Opens the TPRO device
-# Returns error if unable to open device
-# Waits to be first user.
*/
int Trick::TPROCTEClock::clock_init() {
#ifdef _TPRO_CTE
unsigned char rv;
/* Open the TPRO/TSAT device */
rv = TPRO_open(&pBoard, (char *)dev_name.c_str());
/* If unable to open the TPRO/TSAT device... */
if (rv != TPRO_SUCCESS) {
printf (" Could Not Open '%s'!! [%d]\n", dev_name.c_str(), rv);
return (1);
}
/* Wait until this handle is the first user of the device. */
if (TPRO_setPropDelayCorr(pBoard, NULL) != TPRO_SUCCESS) {
printf(" Waiting to become first user...\n");
while (TPRO_setPropDelayCorr(pBoard, NULL) != TPRO_SUCCESS);
}
set_global_clock() ;
return 0 ;
#else
message_publish(MSG_ERROR, "TPRO CTE card was not enabled when Trick was compiled.\n\
Please run ${TRICK_HOME}/configure --tprocte=<directory holding CTE>, and recompile Trick\n");
return -1 ;
#endif
}
/**
@details
-# Gets the TPRO time.
-# If sucessful convert the TPRO time to tics
*/
long long Trick::TPROCTEClock::wall_clock_time() {
#ifdef _TPRO_CTE
unsigned char rv;
TPRO_TimeObj tproTime;
long long curr_time ;
/* Get the TPRO/TSAT current time */
rv = TPRO_getTime(pBoard, &tproTime);
/* If unable to get the TPRO/TSAT current time... */
if (rv != TPRO_SUCCESS) {
printf (" Could not retrieve time from '%s'!! [%d]\n", dev_name.c_str(), rv);
return 0 ;
} else {
curr_time = (long long)(tproTime.days * 86400LL * 1000000LL) ;
curr_time += (long long)(tproTime.hours * 3600LL * 1000000LL) ;
curr_time += (long long)(tproTime.minutes * 60LL * 1000000LL) ;
curr_time += (long long)(tproTime.seconds * 1000000LL) ;
curr_time += (long long)((tproTime.secsDouble - tproTime.seconds) * 1000000LL) ;
}
return (curr_time);
#else
message_publish(MSG_ERROR, "TPRO CTE card was not enabled at compile time\n");
return 0 ;
#endif
}
/**
@details
-# Get the current real time.
-# While the current real time is less than the requested time
-# Release the processor momentarily
-# Get the current real time.
*/
long long Trick::TPROCTEClock::clock_spin(long long req_time) {
#ifdef _TPRO_CTE
Trick::Clock::clock_spin(req_time) ;
#else
message_publish(MSG_ERROR, "TPRO CTE card was not enabled at compile time\n");
return req_time ;
#endif
}
/**
@details
-# This function is empty
*/
int Trick::TPROCTEClock::clock_stop() {
#ifdef _TPRO_CTE
unsigned char rv ;
rv = TPRO_close(pBoard);
/* If unable to close the TPRO/TSAT device... */
if (rv != TPRO_SUCCESS) {
printf (" Could Not Close Board!! [%d]\n", rv);
}
#endif
return 0 ;
}