simpleble 0.0.1

data/vendor/simpleble/simpledbus/src/base/Connection.cpp

@@ -0,0 +1,222 @@
+#include <simpledbus/base/Connection.h>
+#include <simpledbus/base/Exceptions.h>
+#include <simpledbus/base/Logging.h>
+#include <chrono>
+#include <thread>
+
+
+
+using namespace SimpleDBus;
+
+Connection::Connection(DBusBusType dbus_bus_type) : _dbus_bus_type(dbus_bus_type) {}
+
+Connection::~Connection() {
+    if (_initialized) {
+        uninit();
+    }
+}
+
+void Connection::init() {
+    if (_initialized) {
+        return;
+    }
+
+    std::lock_guard<std::recursive_mutex> lock(_mutex);
+
+    ::DBusError err;
+    dbus_error_init(&err);
+
+    dbus_threads_init_default();
+    _conn = dbus_bus_get(_dbus_bus_type, &err);
+    if (dbus_error_is_set(&err)) {
+        std::string err_name = err.name;
+        std::string err_message = err.message;
+        dbus_error_free(&err);
+        throw Exception::DBusException(err_name, err_message);
+    }
+    _initialized = true;
+}
+
+void Connection::uninit() {
+    if (!_initialized) {
+        return;
+    }
+
+    std::lock_guard<std::recursive_mutex> lock(_mutex);
+
+    // In order to prevent a crash on any third party environment
+    // we need to flush the connection queue.
+    SimpleDBus::Message message;
+    do {
+        std::this_thread::sleep_for(std::chrono::milliseconds(10));
+        read_write();
+        message = pop_message();
+    } while (message.is_valid());
+
+    dbus_connection_unref(_conn);
+    _initialized = false;
+}
+
+bool Connection::is_initialized() { return _initialized; }
+
+void Connection::add_match(std::string rule) {
+    if (!_initialized) {
+        throw Exception::NotInitialized();
+    }
+
+    std::lock_guard<std::recursive_mutex> lock(_mutex);
+
+    ::DBusError err;
+    dbus_error_init(&err);
+
+    dbus_bus_add_match(_conn, rule.c_str(), &err);
+    dbus_connection_flush(_conn);
+    if (dbus_error_is_set(&err)) {
+        std::string err_name = err.name;
+        std::string err_message = err.message;
+        dbus_error_free(&err);
+        throw Exception::DBusException(err_name, err_message);
+    }
+}
+
+void Connection::remove_match(std::string rule) {
+    if (!_initialized) {
+        throw Exception::NotInitialized();
+    }
+
+    std::lock_guard<std::recursive_mutex> lock(_mutex);
+
+    ::DBusError err;
+    dbus_error_init(&err);
+
+    dbus_bus_remove_match(_conn, rule.c_str(), &err);
+    dbus_connection_flush(_conn);
+    if (dbus_error_is_set(&err)) {
+        std::string err_name = err.name;
+        std::string err_message = err.message;
+        dbus_error_free(&err);
+        throw Exception::DBusException(err_name, err_message);
+    }
+}
+
+void Connection::read_write() {
+    // TODO: DEPRECATE
+    if (!_initialized) {
+        throw Exception::NotInitialized();
+    }
+
+    std::lock_guard<std::recursive_mutex> lock(_mutex);
+
+    // Non blocking read of the next available message
+    dbus_connection_read_write(_conn, 0);
+}
+
+void Connection::read_write_dispatch() {
+    if (!_initialized) {
+        throw Exception::NotInitialized();
+    }
+
+    std::lock_guard<std::recursive_mutex> lock(_mutex);
+
+    // Non-blocking read of the next available message
+    dbus_connection_read_write(_conn, 0);
+
+    // Dispatch incoming messages
+    while (dbus_connection_dispatch(_conn) == DBUS_DISPATCH_DATA_REMAINS) {}
+}
+
+Message Connection::pop_message() {
+    // TODO: DEPRECATE
+    if (!_initialized) {
+        throw Exception::NotInitialized();
+    }
+
+    std::lock_guard<std::recursive_mutex> lock(_mutex);
+
+    DBusMessage* msg = dbus_connection_pop_message(_conn);
+    return Message::from_acquired(msg);
+}
+
+void Connection::send(Message& msg) {
+    if (!_initialized) {
+        throw Exception::NotInitialized();
+    }
+
+    std::lock_guard<std::recursive_mutex> lock(_mutex);
+
+    uint32_t msg_serial = 0;
+    dbus_connection_send(_conn, msg, &msg_serial);
+    dbus_connection_flush(_conn);
+}
+
+Message Connection::send_with_reply_and_block(Message& msg) {
+    if (!_initialized) {
+        throw Exception::NotInitialized();
+    }
+
+    std::lock_guard<std::recursive_mutex> lock(_mutex);
+
+    ::DBusError err;
+    dbus_error_init(&err);
+    DBusMessage* msg_tmp = dbus_connection_send_with_reply_and_block(_conn, msg, -1, &err);
+
+    if (dbus_error_is_set(&err)) {
+        std::string err_name = err.name;
+        std::string err_message = err.message;
+        dbus_error_free(&err);
+        throw Exception::SendFailed(err_name, err_message, msg.to_string());
+    }
+
+    return Message::from_acquired(msg_tmp);
+}
+
+std::string Connection::unique_name() {
+    if (!_initialized) {
+        throw Exception::NotInitialized();
+    }
+
+    std::lock_guard<std::recursive_mutex> lock(_mutex);
+
+    return std::string(dbus_bus_get_unique_name(_conn));
+}
+
+bool Connection::register_object_path(const std::string& path, std::function<void(Message&)> handler) {
+    if (!_initialized) {
+        return false;
+    }
+
+    std::lock_guard<std::recursive_mutex> lock(_mutex);
+    if (_message_handlers.find(path) == _message_handlers.end()) {
+        DBusObjectPathVTable vtable = {0};
+        vtable.message_function = &Connection::static_message_handler;
+        dbus_connection_register_object_path(_conn, path.c_str(), &vtable, this);
+        _message_handlers[path] = std::move(handler);
+    }
+
+    return true;
+}
+
+bool Connection::unregister_object_path(const std::string& path) {
+    std::lock_guard<std::recursive_mutex> lock(_mutex);
+    auto it = _message_handlers.find(path);
+    if (it != _message_handlers.end()) {
+        dbus_connection_unregister_object_path(_conn, path.c_str());
+        _message_handlers.erase(it);
+    }
+
+    return true;
+}
+
+DBusHandlerResult Connection::static_message_handler(DBusConnection* connection, DBusMessage* message, void* user_data) {
+    Connection* conn = static_cast<Connection*>(user_data);
+    Message msg = Message::from_retained(message);
+    std::string path = msg.get_path();
+
+    std::lock_guard<std::recursive_mutex> lock(conn->_mutex);
+    auto it = conn->_message_handlers.find(path);
+    if (it != conn->_message_handlers.end()) {
+        it->second(msg);
+    }
+
+    return DBUS_HANDLER_RESULT_HANDLED;
+}

data/vendor/simpleble/simpledbus/src/base/Exceptions.cpp

@@ -0,0 +1,39 @@
+#include <simpledbus/base/Exceptions.h>
+
+#include <fmt/core.h>
+
+namespace SimpleDBus {
+
+namespace Exception {
+
+NotInitialized::NotInitialized() {}
+
+const char* NotInitialized::what() const noexcept { return "Object not initialized."; }
+
+DBusException::DBusException(const std::string& err_name, const std::string& err_message) {
+    _message = fmt::format("{}: {}", err_name, err_message);
+}
+
+const char* DBusException::what() const noexcept { return _message.c_str(); }
+
+SendFailed::SendFailed(const std::string& err_name, const std::string& err_message, const std::string& msg_str) {
+    _message = fmt::format("{}: {}\n{}", err_name, err_message, msg_str);
+}
+
+const char* SendFailed::what() const noexcept { return _message.c_str(); }
+
+InterfaceNotFoundException::InterfaceNotFoundException(const std::string& path, const std::string& interface) {
+    _message = fmt::format("Path {} does not contain interface {}", path, interface);
+}
+
+const char* InterfaceNotFoundException::what() const noexcept { return _message.c_str(); }
+
+PathNotFoundException::PathNotFoundException(const std::string& path, const std::string& subpath) {
+    _message = fmt::format("Path {} does not contain sub-path {}", path, subpath);
+}
+
+const char* PathNotFoundException::what() const noexcept { return _message.c_str(); }
+
+}  // namespace Exception
+
+}  // namespace SimpleDBus