+// Written by David Megginson, started 2000-12
+//
+// Copyright (C) 2000 David Megginson, david@megginson.com
+//
+// This program is free software; you can redistribute it and/or
+// modify it under the terms of the GNU General Public License as
+// published by the Free Software Foundation; either version 2 of the
+// License, or (at your option) any later version.
+//
+// This program is distributed in the hope that it will be useful, but
+// WITHOUT ANY WARRANTY; without even the implied warranty of
+// MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
+// General Public License for more details.
+//
+// You should have received a copy of the GNU General Public License
+// along with this program; if not, write to the Free Software
+// Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA.
+//
+// $Id$
+
+#ifdef HAVE_CONFIG_H
+# include <simgear_config.h>
+#endif
#include <simgear/debug/logstream.hxx>
#include <simgear/timing/timestamp.hxx>
#include "subsystem_mgr.hxx"
#include <simgear/math/SGMath.hxx>
+#include "SGSmplstat.hxx"
+const int SG_MAX_SUBSYSTEM_EXCEPTIONS = 4;
+
+using std::string;
-const int SG_MAX_SUBSYSTEM_EXCEPTIONS = 4;\f
////////////////////////////////////////////////////////////////////////
// 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.
////////////////////////////////////////////////////////////////////////
+class SGSubsystemGroup::Member
+{
+private:
+ Member (const Member &member);
+public:
+ Member ();
+ virtual ~Member ();
+
+ virtual void update (double delta_time_sec);
+
+ void reportTiming(void) { if (reportTimingCb) reportTimingCb(reportTimingUserData, name, &timeStat); }
+ void updateExecutionTime(double time) { timeStat += time;}
+
+ SampleStatistic timeStat;
+ std::string name;
+ 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 ()
{
// 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]->printTimingStatistics();
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 = timeStamp - SGTimeStamp::now();
- 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)
+void
+SGSubsystemGroup::reportTiming(void)
{
- for (unsigned int i = 0; i < _members.size(); i++)
+ for( size_t i = _members.size(); i > 0; i-- )
{
- _members[i]->collectDebugTiming(collect);
+ _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::set_fixed_update_time(double dt)
+//------------------------------------------------------------------------------
+void SGSubsystemGroup::clearSubsystems()
{
- _fixedUpdateTime = dt;
+ for( MemberVec::iterator it = _members.begin();
+ it != _members.end();
+ ++it )
+ delete *it;
+ _members.clear();
}
void
-SGSubsystemGroup::Member::printTimingStatistics ()
+SGSubsystemGroup::set_fixed_update_time(double dt)
{
- if (collectTimeStats) {
- double minTime = timeStat.min() / 1000;
- double maxTime = timeStat.max() / 1000;
- double meanTime = timeStat.mean() / 1000;
- double stddev = timeStat.stdDev() / 1000;
-
- 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);
- }
+ _fixedUpdateTime = dt;
}
-
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 : " << time << " " << name);
- 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;
}
-// end of fgfs.cxx
+/** Trigger the timing callback to report data for all subsystems. */
+void
+SGSubsystemMgr::reportTiming()
+{
+ for (int i = 0; i < MAX_GROUPS; i++) {
+ _groups[i]->reportTiming();
+ } // of groups iteration
+}
+
+// end of subsystem_mgr.cxx