const int SG_MAX_SUBSYSTEM_EXCEPTIONS = 4;
+using std::string;
+
////////////////////////////////////////////////////////////////////////
// Implementation of SGSubsystem
////////////////////////////////////////////////////////////////////////
{
}
+SGSubsystem::InitStatus
+SGSubsystem::incrementalInit ()
+{
+ init();
+ return INIT_DONE;
+}
+
void
SGSubsystem::postinit ()
{
timingInfo.push_back(TimingInfo(name, SGTimeStamp::now()));
}
-\f
////////////////////////////////////////////////////////////////////////
// Implementation of SGSubsystemGroup.
////////////////////////////////////////////////////////////////////////
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 ()
{
// 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++ )
{
- bool recordTime = (reportTimingCb != NULL);
if (recordTime)
timeStamp = SGTimeStamp::now();
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]->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
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),
- exceptionCount(0)
+ exceptionCount(0),
+ initTime(0)
{
}
SGSubsystemGroup::Member::~Member ()
{
- delete subsystem;
}
void
////////////////////////////////////////////////////////////////////////
-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;
}
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;
}