mirror of
https://github.com/nasa/trick.git
synced 2024-12-22 06:27:49 +00:00
120 lines
2.8 KiB
C++
120 lines
2.8 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/tsyncpci0") { }
|
|
|
|
/**
|
|
@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
|
|
TSYNC_HWTimeSecondsObj hwTime;
|
|
|
|
/* Send Get Seconds Time message */
|
|
TSYNC_ERROR err = TSYNC_HW_getTimeSec(pBoard, &hwTime);
|
|
|
|
if (err != TSYNC_SUCCESS) {
|
|
printf(" Error: %s.\n", tsync_strerror(err));
|
|
return 0;
|
|
}
|
|
return hwTime.time.seconds * 1000000LL + (hwTime.time.ns /1000);
|
|
|
|
#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
|
|
return 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 ;
|
|
}
|
|
|