#include <simgear/math/SGMath.hxx>
#include "SGSmplstat.hxx"
-const int SG_MAX_SUBSYSTEM_EXCEPTIONS = 4;\f
+const int SG_MAX_SUBSYSTEM_EXCEPTIONS = 4;
+
+using std::string;
+
////////////////////////////////////////////////////////////////////////
// Implementation of SGSubsystem
////////////////////////////////////////////////////////////////////////
+SGSubsystemTimingCb SGSubsystem::reportTimingCb = NULL;
+void* SGSubsystem::reportTimingUserData = NULL;
SGSubsystem::SGSubsystem ()
: _suspended(false)
{
}
+SGSubsystem::InitStatus
+SGSubsystem::incrementalInit ()
+{
+ init();
+ return INIT_DONE;
+}
+
void
SGSubsystem::postinit ()
{
return _suspended;
}
-
-void
-SGSubsystem::printTimingInformation ()
-{
- SGTimeStamp startTime;
- for ( eventTimeVecIterator i = timingInfo.begin();
- i != timingInfo.end();
- ++i) {
- if (i == timingInfo.begin()) {
- startTime = i->getTime();
- } else {
- SGTimeStamp endTime = i->getTime();
- SG_LOG(SG_GENERAL, SG_ALERT, "- Getting to timestamp : "
- << i->getName() << " takes " << endTime - startTime
- << " sec.");
- startTime = endTime;
- }
- }
-}
-
-
-
void SGSubsystem::stamp(const string& name)
{
timingInfo.push_back(TimingInfo(name, SGTimeStamp::now()));
}
-\f
////////////////////////////////////////////////////////////////////////
// Implementation of SGSubsystemGroup.
////////////////////////////////////////////////////////////////////////
virtual ~Member ();
virtual void update (double delta_time_sec);
- void printTimingInformation(double time);
- void printTimingStatistics(double minMaxTime=0.0,double minJitter=0.0);
- void updateExecutionTime(double time);
- double getTimeWarningThreshold();
- void collectDebugTiming (bool collect) { collectTimeStats = collect; };
-
+
+ void reportTiming(void) { if (reportTimingCb) reportTimingCb(reportTimingUserData, name, &timeStat); }
+ void updateExecutionTime(double time) { timeStat += time;}
+
SampleStatistic timeStat;
std::string name;
- SGSubsystem * subsystem;
+ SGSharedPtr<SGSubsystem> subsystem;
double min_step_sec;
double elapsed_sec;
bool collectTimeStats;
int exceptionCount;
+ int initTime;
};
SGSubsystemGroup::SGSubsystemGroup () :
_fixedUpdateTime(-1.0),
- _updateTimeRemainder(0.0)
+ _updateTimeRemainder(0.0),
+ _initPosition(0)
{
}
SGSubsystemGroup::~SGSubsystemGroup ()
{
- printTimingStatistics();
-
// reverse order to prevent order dependency problems
- for (unsigned int i = _members.size(); i > 0; i--)
+ for( size_t i = _members.size(); i > 0; i-- )
{
delete _members[i-1];
}
void
SGSubsystemGroup::init ()
{
- for (unsigned int i = 0; i < _members.size(); i++)
+ for( size_t i = 0; i < _members.size(); i++ )
_members[i]->subsystem->init();
}
+SGSubsystem::InitStatus
+SGSubsystemGroup::incrementalInit()
+{
+ if (_initPosition >= _members.size())
+ return INIT_DONE;
+
+ SGTimeStamp st;
+ st.stamp();
+ InitStatus memberStatus = _members[_initPosition]->subsystem->incrementalInit();
+ _members[_initPosition]->initTime += st.elapsedMSec();
+
+ if (memberStatus == INIT_DONE)
+ ++_initPosition;
+
+ return INIT_CONTINUE;
+}
+
void
SGSubsystemGroup::postinit ()
{
- for (unsigned int i = 0; i < _members.size(); i++)
+ for( size_t i = 0; i < _members.size(); i++ )
_members[i]->subsystem->postinit();
}
void
SGSubsystemGroup::reinit ()
{
- for (unsigned int i = 0; i < _members.size(); i++)
+ for( size_t i = 0; i < _members.size(); i++ )
_members[i]->subsystem->reinit();
}
SGSubsystemGroup::shutdown ()
{
// reverse order to prevent order dependency problems
- for (unsigned int i = _members.size(); i > 0; i--)
+ for( size_t i = _members.size(); i > 0; i-- )
_members[i-1]->subsystem->shutdown();
+ _initPosition = 0;
}
void
SGSubsystemGroup::bind ()
{
- for (unsigned int i = 0; i < _members.size(); i++)
+ for( size_t i = 0; i < _members.size(); i++ )
_members[i]->subsystem->bind();
}
SGSubsystemGroup::unbind ()
{
// reverse order to prevent order dependency problems
- for (unsigned int i = _members.size(); i > 0; i--)
+ for( size_t i = _members.size(); i > 0; i-- )
_members[i-1]->subsystem->unbind();
}
delta_time_sec = _fixedUpdateTime;
}
+ bool recordTime = (reportTimingCb != NULL);
+ SGTimeStamp timeStamp;
while (loopCount-- > 0) {
- for (unsigned int i = 0; i < _members.size(); i++)
+ for( size_t i = 0; i < _members.size(); i++ )
{
- SGTimeStamp timeStamp = SGTimeStamp::now();
- _members[i]->update(delta_time_sec); // indirect call
- timeStamp = SGTimeStamp::now() - timeStamp;
- double b = timeStamp.toUSecs();
- _members[i]->updateExecutionTime(b);
- double threshold = _members[i]->getTimeWarningThreshold();
- if (( b > threshold ) && (b > 10000)) {
- _members[i]->printTimingInformation(b);
- }
+ if (recordTime)
+ timeStamp = SGTimeStamp::now();
+
+ _members[i]->update(delta_time_sec); // indirect call
+
+ if ((recordTime)&&(reportTimingCb))
+ {
+ timeStamp = SGTimeStamp::now() - timeStamp;
+ _members[i]->updateExecutionTime(timeStamp.toUSecs());
+ }
}
} // of multiple update loop
}
-void
-SGSubsystemGroup::collectDebugTiming(bool collect)
-{
- for (unsigned int i = 0; i < _members.size(); i++)
- {
- _members[i]->collectDebugTiming(collect);
- }
-}
-
-void
-SGSubsystemGroup::printTimingStatistics(double minMaxTime,double minJitter)
+void
+SGSubsystemGroup::reportTiming(void)
{
- for (unsigned int i = _members.size(); i > 0; i--)
+ for( size_t i = _members.size(); i > 0; i-- )
{
- _members[i-1]->printTimingStatistics(minMaxTime, minJitter);
- _members[i-1]->timeStat.reset();
+ _members[i-1]->reportTiming();
}
}
void
SGSubsystemGroup::suspend ()
{
- for (unsigned int i = 0; i < _members.size(); i++)
+ for( size_t i = 0; i < _members.size(); i++ )
_members[i]->subsystem->suspend();
}
void
SGSubsystemGroup::resume ()
{
- for (unsigned int i = 0; i < _members.size(); i++)
+ for( size_t i = 0; i < _members.size(); i++ )
_members[i]->subsystem->resume();
}
+string_list
+SGSubsystemGroup::member_names() const
+{
+ string_list result;
+ for( size_t i = 0; i < _members.size(); i++ )
+ result.push_back( _members[i]->name );
+
+ return result;
+}
+
bool
SGSubsystemGroup::is_suspended () const
{
void
SGSubsystemGroup::remove_subsystem (const string &name)
{
- for (unsigned int i = 0; i < _members.size(); i++) {
- if (name == _members[i]->name) {
- _members.erase(_members.begin() + i);
+ MemberVec::iterator it = _members.begin();
+ for (; it != _members.end(); ++it) {
+ if (name == (*it)->name) {
+ delete *it;
+ _members.erase(it);
return;
}
}
+
+ SG_LOG(SG_GENERAL, SG_WARN, "remove_subsystem: missing:" << name);
+}
+
+//------------------------------------------------------------------------------
+void SGSubsystemGroup::clearSubsystems()
+{
+ for( MemberVec::iterator it = _members.begin();
+ it != _members.end();
+ ++it )
+ delete *it;
+ _members.clear();
}
void
_fixedUpdateTime = dt;
}
-/**
- * Print timing statistics.
- * Only show data if jitter exceeds minJitter or
- * maximum time exceeds minMaxTime.
- */
-void
-SGSubsystemGroup::Member::printTimingStatistics(double minMaxTime,double minJitter)
-{
- if (collectTimeStats) {
- double minTime = timeStat.min() / 1000;
- double maxTime = timeStat.max() / 1000;
- double meanTime = timeStat.mean() / 1000;
- double stddev = timeStat.stdDev() / 1000;
-
- if ((maxTime - minTime >= minJitter)||
- (maxTime >= minMaxTime))
- {
- char buffer[256];
- snprintf(buffer, 256, "Timing summary for %20s.\n"
- "- mean time: %04.2f ms.\n"
- "- min time : %04.2f ms.\n"
- "- max time : %04.2f ms.\n"
- "- stddev : %04.2f ms.\n", name.c_str(), meanTime, minTime, maxTime, stddev);
- SG_LOG(SG_GENERAL, SG_ALERT, buffer);
- }
- }
-}
-
-
bool
SGSubsystemGroup::has_subsystem (const string &name) const
{
SGSubsystemGroup::Member *
SGSubsystemGroup::get_member (const string &name, bool create)
{
- for (unsigned int i = 0; i < _members.size(); i++) {
+ for( size_t i = 0; i < _members.size(); i++ ) {
if (_members[i]->name == name)
return _members[i];
}
}
-\f
////////////////////////////////////////////////////////////////////////
// Implementation of SGSubsystemGroup::Member
////////////////////////////////////////////////////////////////////////
subsystem(0),
min_step_sec(0),
elapsed_sec(0),
- collectTimeStats(false),
- exceptionCount(0)
+ exceptionCount(0),
+ initTime(0)
{
}
SGSubsystemGroup::Member::~Member ()
{
- delete subsystem;
}
void
}
-void
-SGSubsystemGroup::Member::printTimingInformation(double time)
-{
- if (collectTimeStats) {
- SG_LOG(SG_GENERAL, SG_ALERT, "Subsystem Timing Alert, subsystem \"" << name << "\": " << time/1000.0 << "ms");
- subsystem->printTimingInformation();
- }
-}
-
-double SGSubsystemGroup::Member::getTimeWarningThreshold()
-{
- return (timeStat.mean() + 3 * timeStat.stdDev());
-}
-
-void SGSubsystemGroup::Member::updateExecutionTime(double time)
-{
- if (collectTimeStats) {
- timeStat += time;
- }
-}
-
-
-
-
-\f
////////////////////////////////////////////////////////////////////////
// Implementation of SGSubsystemMgr.
////////////////////////////////////////////////////////////////////////
-SGSubsystemMgr::SGSubsystemMgr ()
+SGSubsystemMgr::SGSubsystemMgr () :
+ _initPosition(0)
{
for (int i = 0; i < MAX_GROUPS; i++) {
_groups[i] = new SGSubsystemGroup;
_groups[i]->init();
}
+SGSubsystem::InitStatus
+SGSubsystemMgr::incrementalInit()
+{
+ if (_initPosition >= MAX_GROUPS)
+ return INIT_DONE;
+
+ InitStatus memberStatus = _groups[_initPosition]->incrementalInit();
+ if (memberStatus == INIT_DONE)
+ ++_initPosition;
+
+ return INIT_CONTINUE;
+}
+
void
SGSubsystemMgr::postinit ()
{
// reverse order to prevent order dependency problems
for (int i = MAX_GROUPS-1; i >= 0; i--)
_groups[i]->shutdown();
+
+ _initPosition = 0;
}
}
}
-void
-SGSubsystemMgr::collectDebugTiming(bool collect)
-{
- for (int i = 0; i < MAX_GROUPS; i++) {
- _groups[i]->collectDebugTiming(collect);
- }
-}
-
void
SGSubsystemMgr::suspend ()
{
SGSubsystemMgr::add (const char * name, SGSubsystem * subsystem,
GroupType group, double min_time_sec)
{
- SG_LOG(SG_GENERAL, SG_INFO, "Adding subsystem " << name);
+ SG_LOG(SG_GENERAL, SG_DEBUG, "Adding subsystem " << name);
get_group(group)->set_subsystem(name, subsystem, min_time_sec);
if (_subsystem_map.find(name) != _subsystem_map.end()) {
SG_LOG(SG_GENERAL, SG_ALERT, "Adding duplicate subsystem " << name);
- throw sg_exception("duplicate subsystem");
+ throw sg_exception("duplicate subsystem:" + std::string(name));
}
_subsystem_map[name] = subsystem;
}
-SGSubsystem*
+void
SGSubsystemMgr::remove(const char* name)
{
SubsystemDict::iterator s =_subsystem_map.find(name);
if (s == _subsystem_map.end()) {
- return NULL;
+ return;
}
- SGSubsystem* sub = s->second;
_subsystem_map.erase(s);
// tedious part - we don't know which group the subsystem belongs too
for (int i = 0; i < MAX_GROUPS; i++) {
- if (_groups[i]->get_subsystem(name) == sub) {
+ if (_groups[i]->get_subsystem(name) != NULL) {
_groups[i]->remove_subsystem(name);
break;
}
} // of groups iteration
-
- return sub;
}
return s->second;
}
+/** Trigger the timing callback to report data for all subsystems. */
void
-SGSubsystemMgr::printTimingStatistics(double minMaxTime,double minJitter)
+SGSubsystemMgr::reportTiming()
{
for (int i = 0; i < MAX_GROUPS; i++) {
- _groups[i]->printTimingStatistics(minMaxTime, minJitter);
+ _groups[i]->reportTiming();
} // of groups iteration
}