clean up

2026-10-26 21:51:13 +01:00 · 2026-02-14 14:32:43 +01:00
parent 2e1d461026
commit fbf0d02d9c
8 changed files with 5 additions and 27 deletions
@@ -0,0 +1,67 @@
+#include "CAN_interface.hpp"
+#include "spdlog/spdlog.h"
+
+CAN_Interface::CAN_Interface(QObject *parent) : QObject(parent), m_canDevice(nullptr)
+{
+    if (!QCanBus::instance()->plugins().contains(QStringLiteral("socketcan")))
+    {
+        SPDLOG_CRITICAL("Runtime error: CAN Interface: socketcan plugin not found");
+        throw std::runtime_error("CAN Interface: socketcan plugin not found");
+    }
+}
+
+CAN_Interface::~CAN_Interface()
+{
+    m_canDevice->disconnectDevice();
+    delete m_canDevice;
+}
+
+void CAN_Interface::connect_to_dev(QString dev)
+{
+    QString errorString;
+    m_canDevice = QCanBus::instance()->createDevice(QStringLiteral("socketcan"), dev, &errorString);
+    if (!m_canDevice)
+    {
+        // Error handling goes here
+        SPDLOG_CRITICAL("Runtime error: CAN Interface: {}", errorString.toStdString());
+        throw std::runtime_error("CAN Interface: " + errorString.toStdString());
+    }
+
+    connect(m_canDevice, &QCanBusDevice::errorOccurred, this,
+            [=, this](QCanBusDevice::CanBusError error) { processErrors(error); });
+
+    m_canDevice->connectDevice();
+    connect(m_canDevice, &QCanBusDevice::framesReceived, this, [this] {
+        for (QCanBusFrame &frame : m_canDevice->readAllFrames())
+        {
+            emit frame_received(frame);
+        }
+    });
+}
+
+void CAN_Interface::send_frame(const QCanBusFrame frame)
+{
+    if (m_canDevice == nullptr)
+    {
+        SPDLOG_CRITICAL("CAN dev = nullptr");
+        return;
+    }
+    m_canDevice->writeFrame(frame);
+    emit frame_send(frame);
+}
+
+void CAN_Interface::processErrors(QCanBusDevice::CanBusError error) const
+{
+    switch (error)
+    {
+    case QCanBusDevice::ReadError:
+    case QCanBusDevice::WriteError:
+    case QCanBusDevice::ConnectionError:
+    case QCanBusDevice::ConfigurationError:
+    case QCanBusDevice::UnknownError:
+        SPDLOG_CRITICAL("CAN Interface: {} {}", qt_getEnumName(error), m_canDevice->errorString().toStdString());
+        break;
+    default:
+        break;
+    }
+}