133 lines
3.8 KiB
C++
133 lines
3.8 KiB
C++
#include <iostream>
|
|
#include <stdexcept>
|
|
#include <opts.h>
|
|
#include <body/body.h>
|
|
#include <body/bodyThread.h>
|
|
#include <componentThread.h>
|
|
#include <deviceManager/deviceManager.h>
|
|
#include <mind.h>
|
|
#include <stimBuffApis/stimBuffApiManager.h>
|
|
|
|
namespace smo {
|
|
namespace body {
|
|
|
|
Body::Body(Mind &parent, const std::shared_ptr<sscl::PuppetThread> &thread)
|
|
: MindComponent(static_cast<sscl::PuppetApplication&>(parent), thread)
|
|
{
|
|
}
|
|
|
|
BodyViralPostingInvoker<void> Body::initializeCReq()
|
|
{
|
|
auto self = sscl::ComponentThread::getSelf();
|
|
if (self->id != SmoThreadId::BODY)
|
|
{
|
|
throw std::runtime_error(std::string(__func__)
|
|
+ ": Must be executed on Body thread");
|
|
}
|
|
|
|
/** EXPLANATION:
|
|
* The ComponentThread instance we pass in here is the one that will be
|
|
* used by Senseapi libs to perform device-independent background
|
|
* operations.
|
|
* For example, liblivoxProto1's BroadcastListener will use this thread
|
|
* to listen for UDP broadcast dgrams from Livox devices.
|
|
*
|
|
* We used to use Marionette, but there's a strong argument for using
|
|
* Body instead since it's meant to handle device-management operations.
|
|
*/
|
|
// Upcast to Mind to access Mind-specific members
|
|
Mind &mind = static_cast<Mind&>(parent);
|
|
stim_buff::StimBuffApiManager::getInstance()
|
|
.loadAllStimBuffApiLibsFromOptions(mind.body.thread);
|
|
|
|
/** EXPLANATION:
|
|
* Consider body::initializeCReq to have been called if even one of its
|
|
* operations was executed at all, whether successfully or
|
|
* unsuccessfully.
|
|
*/
|
|
mind.bodyComponentInitialized = true;
|
|
|
|
std::cout << stim_buff::StimBuffApiManager::getInstance().stringifyLibs()
|
|
<< std::endl;
|
|
|
|
if (OptionParser::getOptions().verbose)
|
|
{
|
|
std::cout << __func__ << ": About to initializeAllStimBuffApiLibs"
|
|
<< '\n';
|
|
}
|
|
co_await stim_buff::StimBuffApiManager::getInstance()
|
|
.initializeAllStimBuffApiLibsCReq();
|
|
|
|
if (OptionParser::getOptions().verbose)
|
|
{
|
|
std::cout << __func__ << ": About to attachAllUnattachedDevicesFromCmdline"
|
|
<< '\n';
|
|
}
|
|
|
|
sscl::MultiOperationResultSet attachResults = co_await
|
|
device::DeviceManager::getInstance()
|
|
.attachAllUnattachedDevicesFromCmdlineCReq();
|
|
std::cout << "Mrntt: attached "
|
|
<< attachResults.nSucceeded << " of " << attachResults.nTotal
|
|
<< " sense devices." << "\n";
|
|
|
|
if (attachResults.nTotal > 0 && attachResults.nSucceeded == 0)
|
|
{
|
|
throw std::runtime_error(
|
|
std::string(__func__)
|
|
+ ": Failed to attach any of "
|
|
+ std::to_string(attachResults.nTotal)
|
|
+ " requested sense devices");
|
|
}
|
|
|
|
co_return;
|
|
}
|
|
|
|
BodyViralPostingInvoker<void> Body::finalizeCReq()
|
|
{
|
|
auto self = sscl::ComponentThread::getSelf();
|
|
if (self->id != SmoThreadId::BODY)
|
|
{
|
|
throw std::runtime_error(std::string(__func__)
|
|
+ ": Must be executed on Body thread");
|
|
}
|
|
|
|
// Upcast to Mind to access Mind-specific members
|
|
Mind &mind = static_cast<Mind&>(parent);
|
|
if (!mind.bodyComponentInitialized)
|
|
{
|
|
std::cout << "Mrntt: Body component not initialized. "
|
|
<< "Skipping finalization." << "\n";
|
|
co_return;
|
|
}
|
|
|
|
std::cout << "Mrntt: About to detach all sense devices." << "\n";
|
|
sscl::MultiOperationResultSet detachResults = co_await
|
|
device::DeviceManager::getInstance().detachAllAttachedDeviceRolesCReq();
|
|
|
|
if (detachResults.nFailed > 0)
|
|
{
|
|
std::cerr << "Mrntt: Failed to detach "
|
|
<< detachResults.nFailed << " of " << detachResults.nTotal
|
|
<< " sense devices." << "\n";
|
|
}
|
|
else
|
|
{
|
|
std::cout << "Mrntt: Successfully detached "
|
|
<< detachResults.nSucceeded << " of " << detachResults.nTotal
|
|
<< " sense devices." << "\n";
|
|
}
|
|
|
|
std::cout << "Mrntt: About to finalize all stim buff api libs." << "\n";
|
|
co_await stim_buff::StimBuffApiManager::getInstance()
|
|
.finalizeAllStimBuffApiLibsCReq();
|
|
|
|
std::cout << "Mrntt: About to unload all stim buff api libs." << "\n";
|
|
stim_buff::StimBuffApiManager::getInstance().unloadAllStimBuffApiLibs();
|
|
|
|
co_return;
|
|
}
|
|
|
|
} // namespace body
|
|
} // namespace smo
|