mirror of
https://github.com/nasa/trick.git
synced 2024-12-24 07:16:41 +00:00
101 lines
2.2 KiB
C++
101 lines
2.2 KiB
C++
|
|
#include <iostream>
|
|
#include <sstream>
|
|
|
|
#include <fcntl.h>
|
|
#include <iomanip>
|
|
#include <errno.h>
|
|
#include <unistd.h>
|
|
|
|
#include "trick/DebugPause.hh"
|
|
#include "trick/message_proto.h"
|
|
#include "trick/message_type.h"
|
|
#include "trick/exec_proto.h"
|
|
#include "trick/exec_proto.hh"
|
|
|
|
|
|
Trick::DebugPause * the_debug_pause = NULL ;
|
|
|
|
Trick::DebugPause::DebugPause() {
|
|
debug_pause_flag = false ;
|
|
the_debug_pause = this ;
|
|
}
|
|
|
|
int Trick::DebugPause::debug_pause(Trick::JobData * curr_job) {
|
|
|
|
// The target job was copied to sup_class_data in Trick::ScheduledJobQueueInstrument::call()
|
|
Trick::JobData * target_job = (Trick::JobData *)curr_job->sup_class_data ;
|
|
int sem_ret ;
|
|
|
|
if ( target_job != NULL ) {
|
|
|
|
// Pause for all job classes that are not initialization or for init jobs greater than phase 1.
|
|
if ( target_job->job_class_name.compare("initialization") or target_job->phase > 1 ) {
|
|
|
|
message_publish(MSG_NORMAL, "%12.6f pausing before %s\n" , exec_get_sim_time() ,
|
|
target_job->name.c_str() ) ;
|
|
|
|
do {
|
|
sem_ret = sem_wait(debug_sem);
|
|
} while ((sem_ret < 0) && (errno == EINTR));
|
|
|
|
if (sem_ret != 0) {
|
|
perror("Call to sem_wait");
|
|
fflush(stderr);
|
|
}
|
|
}
|
|
}
|
|
|
|
|
|
return(0) ;
|
|
|
|
}
|
|
|
|
int Trick::DebugPause::debug_signal() {
|
|
|
|
sem_post(debug_sem);
|
|
return(0) ;
|
|
|
|
}
|
|
|
|
int Trick::DebugPause::debug_pause_on() {
|
|
|
|
std::stringstream sem_name_stream ;
|
|
|
|
if ( debug_pause_flag == true ) {
|
|
return(0) ;
|
|
}
|
|
|
|
debug_pause_flag = true ;
|
|
|
|
sem_name_stream << "debugstepmaphore_" << getpid() ;
|
|
sem_name = sem_name_stream.str() ;
|
|
|
|
debug_sem = sem_open(sem_name.c_str(), O_CREAT, S_IRWXU , 0);
|
|
|
|
exec_instrument_before("trick_instruments.debug_pause.debug_pause") ;
|
|
|
|
//TODO: turn off real-time clock if on.
|
|
|
|
return(0) ;
|
|
|
|
}
|
|
|
|
int Trick::DebugPause::debug_pause_off() {
|
|
|
|
if ( debug_pause_flag == false ) {
|
|
return(0) ;
|
|
}
|
|
debug_pause_flag = false ;
|
|
|
|
exec_instrument_remove("trick_instruments.debug_pause.debug_pause") ;
|
|
|
|
debug_signal() ;
|
|
|
|
sem_unlink(sem_name.c_str()) ;
|
|
|
|
//TODO: turn back on real-time clock if on before debug_pause started.
|
|
return(0);
|
|
|
|
}
|