Make [at|de]tachAllSenseDevices[FromSpecs] and initializeSalmanoff async

This is the culmination of a lot of changes over the last week. We're
making SMO basically fully async in many areas, and then preparing to
implement the spinqueueing mechanism for locking.

smocore/include/salmanoff.h

@@ -2,12 +2,15 @@
 #define _SALMANOFF_H
 
 #include <memory>
+#include <functional>
 #include <componentThread.h>
 
 namespace smo {
 
-void initializeSalmanoff(std::shared_ptr<ComponentThread>& componentThread);
+typedef std::function<void(bool)> initializeSalmanoffCbFn;
-void shutdownSalmanoff(void);
+typedef initializeSalmanoffCbFn shutdownSalmanoffCbFn;
+void initializeSalmanoff(initializeSalmanoffCbFn callback);
+void shutdownSalmanoff(shutdownSalmanoffCbFn callback);
 
 } // namespace smo
 

smocore/include/senseApis/senseApiManager.h

@@ -8,6 +8,7 @@
 #include <optional>
 #include <functional>
 #include <componentThread.h>
+#include <asynchronousLoop.h>
 #include <senseApis/senseApiLib.h>
 #include <user/deviceAttachmentSpec.h>
 
@@ -52,9 +53,16 @@ public:
     void detachSenseDeviceReq(
         const std::shared_ptr<device::DeviceAttachmentSpec>& spec,
         detachSenseDeviceReqCbFn cb);
-	void attachAllSenseDevicesFromSpecs(void);
+
-	void detachAllSenseDevices(void);
+	typedef std::function<void(AsynchronousLoop &results)>
-	void detachAllSenseDevicesReq(void);
+		attachAllSenseDevicesFromSpecsReqCbFn;
+	typedef std::function<void(AsynchronousLoop &results)>
+		detachAllSenseDevicesReqCbFn;
+
+	void attachAllSenseDevicesFromSpecsReq(
+		attachAllSenseDevicesFromSpecsReqCbFn cb);
+	void detachAllSenseDevicesReq(
+		detachAllSenseDevicesReqCbFn cb);
 
     std::string stringifyLibs() const;
 
@@ -69,6 +77,8 @@ private:
 
 	class AttachSenseDeviceReq;
 	class DetachSenseDeviceReq;
+	class AttachAllSenseDevicesFromSpecsReq;
+	class DetachAllSenseDevicesReq;
 
 public:
     static std::optional<std::string> searchForLibInSmoSearchPaths(

smocore/marionette/marionette.cpp

@@ -5,6 +5,7 @@
 #include <opts.h>
 #include <typeinfo>
 #include <boost/asio/signal_set.hpp>
+#include <asynchronousBridge.h>
 #include <mind.h>
 #include <componentThread.h>
 #include <marionette/marionette.h>
@@ -46,7 +47,7 @@ void ComponentThread::marionetteMain(ComponentThread& self)
     self.initializeTls();
     mrntt::exitCode = EXIT_SUCCESS;
 	static boost::asio::signal_set signals(self.getIoService(), SIGINT);
-	bool callFinalizeReq = false;
+	bool callFinalizeReq = false, callShutdownSalmanoff = false;
 
 	try {
 		// Register SIGINT (Ctrl+C) and SIGSEGV handlers
@@ -88,9 +89,15 @@ void ComponentThread::marionetteMain(ComponentThread& self)
 		self.getIoService().post([]()
 		{
 			// Initialize Salmanoff first
-			initializeSalmanoff(mrntt::mrntt);
+			initializeSalmanoff([](bool success)
+			{
+				if (success) {
 					// Then initialize the global Mind object
 					globalMind->initialize();
+				} else {
+					std::cerr << "Failed to initialize Salmanoff" << std::endl;
+				}
+			});
 		});
 
         std::cout << __func__ << ": Entering event loop" << "\n";
@@ -154,20 +161,38 @@ void ComponentThread::marionetteMain(ComponentThread& self)
 		}
 
 		*out << outUsageMsg << e.what() << std::endl;
-		callFinalizeReq = true;
+		callShutdownSalmanoff = callFinalizeReq = true;
 	}
 	catch (const std::exception& e)
 	{
 		std::cerr << __func__ << ": Exception occurred: " << e.what()
 			<< std::endl;
 		mrntt::exitCode = EXIT_FAILURE;
-		callFinalizeReq = true;
+		callShutdownSalmanoff = callFinalizeReq = true;
 	}
 	catch (...)
 	{
 		std::cerr << __func__ << ": Unknown exception occurred" << std::endl;
 		mrntt::exitCode = EXIT_FAILURE;
-		callFinalizeReq = true;
+		callShutdownSalmanoff = callFinalizeReq = true;
+	}
+
+	if (callShutdownSalmanoff)
+	{
+		shutdownSalmanoff(
+			[](bool success)
+			{
+				if (success) {
+					std::cout << "Salmanoff shutdown completed successfully"
+						<< std::endl;
+				} else {
+					std::cerr << "Salmanoff shutdown failed" << std::endl;
+				}
+				mrntt::mrntt->getIoService().stop();
+			}
+		);
+		self.getIoService().reset();
+		self.getIoService().run();
 	}
 
 	if (callFinalizeReq)
@@ -178,8 +203,6 @@ void ComponentThread::marionetteMain(ComponentThread& self)
 		self.getIoService().reset();
 		self.getIoService().run();
 	}
-
-	shutdownSalmanoff();
 }
 
 } // namespace smo

smocore/marionette/salmanoff.cpp

@@ -1,37 +1,106 @@
 #include <iostream>
 #include <deviceManager/deviceManager.h>
 #include <senseApis/senseApiManager.h>
+#include <asynchronousContinuation.h>
+#include <salmanoff.h>
+
 
 namespace smo {
 
-void initializeSalmanoff(std::shared_ptr<ComponentThread>& componentThread)
+class InitializeSalmanoffReq
+:	public AsynchronousContinuation<initializeSalmanoffCbFn>
+{
+public:
+	InitializeSalmanoffReq(initializeSalmanoffCbFn cb)
+	:	AsynchronousContinuation(std::move(cb))
+	{}
+
+	// Callback methods for the initialization sequence
+	void initializeSalmanoffReq1(
+		std::shared_ptr<InitializeSalmanoffReq> context,
+		smo::AsynchronousLoop &results
+		)
+	{
+		std::cout << __func__ << ": Done. " << results.nSucceeded
+			<< " succeeded, " << results.nFailed << " failed." << std::endl;
+		context->originalCbFn(true);
+	}
+};
+
+void initializeSalmanoff(
+	initializeSalmanoffCbFn callback)
 {
 	std::cout << __func__ << ": Entered." << std::endl;
 
+	std::shared_ptr<ComponentThread> mrntt = ComponentThread::getMrntt();
+	auto request = std::make_shared<InitializeSalmanoffReq>(
+		std::move(callback));
+
 	device::DeviceManager::getInstance().collateAllDapSpecs();
 	device::DeviceManager::getInstance().parseAllDapSpecs();
 	std::cout << device::DeviceManager::stringifyDeviceSpecs() << std::endl;
+
+	/**	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.
+	 *
+	 * Right now we use Marionette, but there's a strong argument for using
+	 * Body instead since it's meant to handle device-management operations.
+	 */
 	sense_api::SenseApiManager::getInstance().loadAllSenseApiLibsFromOptions(
-		componentThread);
+		mrntt);
+
 	std::cout << sense_api::SenseApiManager::getInstance().stringifyLibs()
 		<< std::endl;
-std::cerr << "About to initializeAllSenseApiLibs" << std::endl;
-	sense_api::SenseApiManager::getInstance().initializeAllSenseApiLibs();
-std::cerr << "About to attachAllSenseDevicesFromSpecs" << std::endl;
-	sense_api::SenseApiManager::getInstance().attachAllSenseDevicesFromSpecs();
-std::cerr << "Done attachAllSenseDevicesFromSpecs" << std::endl;
 
-	std::cout << __func__ << ": Done." << std::endl;
+	if (OptionParser::getOptions().verbose) {
+		std::cout << __func__ << ": About to initializeAllSenseApiLibs" << '\n';
+	}
+	sense_api::SenseApiManager::getInstance().initializeAllSenseApiLibs();
+
+	if (OptionParser::getOptions().verbose) {
+		std::cout << __func__ << ": About to attachAllSenseDevicesFromSpecs" << '\n';
+	}
+	sense_api::SenseApiManager::getInstance().attachAllSenseDevicesFromSpecsReq(
+		std::bind(
+			&InitializeSalmanoffReq::initializeSalmanoffReq1,
+			request.get(), request,
+			std::placeholders::_1));
 }
 
-void shutdownSalmanoff(void)
+class ShutdownSalmanoffReq
+:	public InitializeSalmanoffReq
+{
+public:
+	using InitializeSalmanoffReq::InitializeSalmanoffReq;
+
+	// Callback methods for the shutdown sequence
+	void shutdownSalmanoffReq1(
+		std::shared_ptr<ShutdownSalmanoffReq> context,
+		smo::AsynchronousLoop &results
+		)
+	{
+		sense_api::SenseApiManager::getInstance().finalizeAllSenseApiLibs();
+		std::cout << __func__ << ": Done. " << results.nSucceeded
+			<< " succeeded, " << results.nFailed << " failed." << std::endl;
+		context->originalCbFn(true);
+	}
+};
+
+void shutdownSalmanoff(shutdownSalmanoffCbFn callback)
 {
 	std::cout << __func__ << ": Entered." << std::endl;
 
-	sense_api::SenseApiManager::getInstance().detachAllSenseDevicesReq();
+	// Create the shutdown request object to hold state and callbacks
-	sense_api::SenseApiManager::getInstance().finalizeAllSenseApiLibs();
+	auto request = std::make_shared<ShutdownSalmanoffReq>(std::move(callback));
 
-	std::cout << __func__ << ": Done." << std::endl;
+	sense_api::SenseApiManager::getInstance().detachAllSenseDevicesReq(
+		std::bind(
+			&ShutdownSalmanoffReq::shutdownSalmanoffReq1,
+			request.get(), request,
+			std::placeholders::_1));
 }
 
 } // namespace smo

smocore/senseApis/senseApiManager.cpp

@@ -6,6 +6,7 @@
 #include <senseApis/senseApiLib.h>
 #include <opts.h>
 #include <asynchronousBridge.h>
+#include <asynchronousContinuation.h>
 #include <asynchronousLoop.h>
 #include <user/senseApiDesc.h>
 #include <deviceManager/deviceManager.h>
@@ -257,8 +258,6 @@ void SenseApiManager::finalizeAllSenseApiLibs(void)
     }
 }
 
-
-
 void SenseApiManager::attachSenseDeviceReq(
     const std::shared_ptr<device::DeviceAttachmentSpec>& spec,
     attachSenseDeviceReqCbFn cb
@@ -313,17 +312,22 @@ void SenseApiManager::detachSenseDeviceReq(
     lib.senseApiDesc.sal_mgmt_libOps.detachDeviceReq(spec, cb);
 }
 
-void SenseApiManager::attachAllSenseDevicesFromSpecs(void)
+class SenseApiManager::AttachAllSenseDevicesFromSpecsReq
+:	public AsynchronousContinuation<attachAllSenseDevicesFromSpecsReqCbFn>
 {
-	auto self = ComponentThread::getSelf();
+public:
-	AsynchronousBridge bridge(self->getIoService());
+	AttachAllSenseDevicesFromSpecsReq(
-	AsynchronousLoop loop(device::DeviceManager::deviceAttachmentSpecs.size());
+		const unsigned int totalNSpecs,
+		attachAllSenseDevicesFromSpecsReqCbFn cb)
+	: AsynchronousContinuation(std::move(cb)),
+	loop(totalNSpecs)
+	{}
 
-	for (const auto& spec : device::DeviceManager::deviceAttachmentSpecs)
+	// Callback methods for the attachment sequence
-	{
+	void attachAllSenseDevicesFromSpecsReq1(
-		try {
+		std::shared_ptr<AttachAllSenseDevicesFromSpecsReq> context,
-			attachSenseDeviceReq(spec,
+		bool success, std::shared_ptr<device::DeviceAttachmentSpec> spec
-				[spec, &loop, &bridge](bool success) -> void
+		)
 	{
 		if (!success)
 		{
@@ -331,56 +335,61 @@ void SenseApiManager::attachAllSenseDevicesFromSpecs(void)
 				<< spec->deviceIdentifier << "\n";
 		}
 
-				if (!loop.incrementSuccessOrFailureAndTestForCompletionDueTo(
+		if (!context->loop.incrementSuccessOrFailureAndTestForCompletionDueTo(
 			success))
 		{
 			return;
 		}
 
-				std::cout << __func__ << ": " << loop.nSucceeded.load()
+		if (OptionParser::getOptions().verbose)
+		{
+			std::cout << __func__ << ": " << context->loop.nSucceeded.load()
 					<< " devices attached, "
-					<< loop.nFailed.load() << " devices failed\n";
+					<< context->loop.nFailed.load() << " devices failed\n";
-
-				bridge.setAsyncOperationComplete();
-			});
-		} catch (const std::exception& e) {
-			std::cerr << __func__ << ": Exception: " << e.what() << "\n";
-			if (loop.incrementSuccessOrFailureAndTestForCompletionDueTo(false))
-				{ bridge.setAsyncOperationComplete(); }
-		}
 		}
 
-	/* Bridge the async op here. */
+		context->originalCbFn(context->loop);
-	bridge.waitForAsyncOperationCompleteOrIoServiceStopped();
-	if (bridge.exitedBecauseIoServiceStopped())
-	{
-		/* Return early because the io_service is stopped. */
-		return;
 	}
 
-	if (!loop.isComplete())
+public:
-	{
+	AsynchronousLoop loop;
-		throw std::runtime_error(
+};
-			std::string(__func__) + ": Failed to get through all devices");
-	}
 
-	std::cout << __func__ << ": " << loop.nSucceeded.load() << "/"
+void SenseApiManager::attachAllSenseDevicesFromSpecsReq(
-		<< loop.nTotal << " devices attached, "
+	attachAllSenseDevicesFromSpecsReqCbFn cb
-		<< loop.nFailed.load() << "/" << loop.nTotal
+	)
-		<< " devices failed\n";
-}
-
-void SenseApiManager::detachAllSenseDevicesReq(void)
 {
-	auto self = ComponentThread::getSelf();
+	// Create the attachment request object to hold state and callbacks
-	AsynchronousBridge bridge(self->getIoService());
+	auto request = std::make_shared<AttachAllSenseDevicesFromSpecsReq>(
-	AsynchronousLoop loop(device::DeviceManager::deviceAttachmentSpecs.size());
+		device::DeviceManager::deviceAttachmentSpecs.size(), std::move(cb));
 
 	for (const auto& spec : device::DeviceManager::deviceAttachmentSpecs)
 	{
 		try {
-			detachSenseDeviceReq(spec,
+			attachSenseDeviceReq(
-				[spec, &loop, &bridge](bool success) -> void
+				spec,
+				std::bind(
+					&AttachAllSenseDevicesFromSpecsReq::attachAllSenseDevicesFromSpecsReq1,
+					request.get(), request,
+					std::placeholders::_1, std::placeholders::_2));
+		} catch (const std::exception& e) {
+			std::cerr << __func__ << ": Exception: " << e.what() << "\n";
+			if (request->loop.incrementSuccessOrFailureAndTestForCompletionDueTo(false))
+				{ cb(request->loop); }
+		}
+	}
+}
+
+class SenseApiManager::DetachAllSenseDevicesReq
+:	public AttachAllSenseDevicesFromSpecsReq
+{
+public:
+	using AttachAllSenseDevicesFromSpecsReq::AttachAllSenseDevicesFromSpecsReq;
+
+	void detachAllSenseDevicesReq1(
+		std::shared_ptr<DetachAllSenseDevicesReq> context,
+		bool success, std::shared_ptr<device::DeviceAttachmentSpec> spec
+		)
 	{
 		if (!success)
 		{
@@ -388,43 +397,45 @@ void SenseApiManager::detachAllSenseDevicesReq(void)
 				<< spec->deviceIdentifier << "\n";
 		}
 
-				if (!loop.incrementSuccessOrFailureAndTestForCompletionDueTo(
+		if (!context->loop.incrementSuccessOrFailureAndTestForCompletionDueTo(
 			success))
 		{
 			return;
 		}
 
-				std::cout << __func__ << ": " << loop.nSucceeded.load()
+		if (OptionParser::getOptions().verbose)
+		{
+			std::cout << __func__ << ": " << context->loop.nSucceeded.load()
 					<< " devices detached, "
-					<< loop.nFailed.load() << " devices failed\n";
+					<< context->loop.nFailed.load() << " devices failed\n";
+		}
 
-				bridge.setAsyncOperationComplete();
+		context->originalCbFn(context->loop);
-			});
+	}
+};
+
+void SenseApiManager::detachAllSenseDevicesReq(
+	detachAllSenseDevicesReqCbFn cb
+	)
+{
+	auto request = std::make_shared<DetachAllSenseDevicesReq>(
+		device::DeviceManager::deviceAttachmentSpecs.size(), std::move(cb));
+
+	for (const auto& spec : device::DeviceManager::deviceAttachmentSpecs)
+	{
+		try {
+			detachSenseDeviceReq(
+				spec,
+				std::bind(
+					&DetachAllSenseDevicesReq::detachAllSenseDevicesReq1,
+						request.get(), request,
+						std::placeholders::_1, std::placeholders::_2));
 		} catch (const std::exception& e) {
 			std::cerr << __func__ << ": Exception: " << e.what() << "\n";
-			if (loop.incrementSuccessOrFailureAndTestForCompletionDueTo(false))
+			if (request->loop.incrementSuccessOrFailureAndTestForCompletionDueTo(false))
-				{ bridge.setAsyncOperationComplete(); }
+				{ cb(request->loop); }
 		}
 	}
-
-	/* Bridge the async op here. */
-	bridge.waitForAsyncOperationCompleteOrIoServiceStopped();
-	if (bridge.exitedBecauseIoServiceStopped())
-	{
-		/* Return early because the io_service is stopped. */
-		return;
-	}
-
-	if (!loop.isComplete())
-	{
-		throw std::runtime_error(
-			std::string(__func__) + ": Failed to get through all devices");
-	}
-
-	std::cout << __func__ << ": " << loop.nSucceeded.load() << "/"
-		<< loop.nTotal << " devices detached, "
-		<< loop.nFailed.load() << "/" << loop.nTotal
-		<< " devices failed\n";
 }
 
 } // namespace sense_api