mirror of
https://github.com/nasa/trick.git
synced 2024-12-22 06:27:49 +00:00
129 lines
3.2 KiB
C++
129 lines
3.2 KiB
C++
/*
|
|
PURPOSE:
|
|
( gettimeofday clock )
|
|
PROGRAMMERS:
|
|
(((Alex Lin) (NASA) (Feb 2012) (--) (--)))
|
|
*/
|
|
|
|
#include <stdio.h>
|
|
|
|
#include "trick/TPROCTEClock.hh"
|
|
#include "trick/message_proto.h"
|
|
#include "trick/message_type.h"
|
|
#include "trick/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 --with-tpro=<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 ;
|
|
}
|
|
|