修改
This commit is contained in:
@@ -6,44 +6,36 @@
|
||||
#include <thread>
|
||||
#include <atomic>
|
||||
#include <mutex>
|
||||
#include <chrono>
|
||||
#include <fmt/core.h>
|
||||
|
||||
// Unified device manager (Serial )
|
||||
// Unified device manager (Serial only)
|
||||
class UnifiedDeviceManager {
|
||||
private:
|
||||
// Device instances
|
||||
std::unique_ptr<SerialComm> m_serial;
|
||||
std::unique_ptr<CameraManager> m_camera;
|
||||
|
||||
// Thread management
|
||||
|
||||
std::thread m_serialReconnectThread;
|
||||
std::atomic<bool> m_serialConnected;
|
||||
std::atomic<bool> m_shouldStop;
|
||||
|
||||
|
||||
std::mutex m_serialMutex;
|
||||
|
||||
|
||||
int m_retryIntervalMs;
|
||||
|
||||
// Serial reconnect thread
|
||||
|
||||
void serialReconnectThreadFunc();
|
||||
|
||||
public:
|
||||
UnifiedDeviceManager(int retryIntervalMs = 500);
|
||||
~UnifiedDeviceManager();
|
||||
|
||||
// Control methods
|
||||
|
||||
void start();
|
||||
void stop();
|
||||
|
||||
// Status check
|
||||
|
||||
bool isSerialConnected() const { return m_serialConnected.load(); }
|
||||
|
||||
|
||||
// Serial operations (thread-safe)
|
||||
bool sendData(const char* data, size_t length);
|
||||
int receiveData(uint8_t* buffer, size_t maxLength);
|
||||
|
||||
// Camera operations (thread-safe)
|
||||
bool grabFrame(cv::Mat& frame);
|
||||
const char* getCameraName() const;
|
||||
};
|
||||
|
||||
#endif // UNIFIED_MANAGER_HPP
|
||||
|
||||
@@ -2,7 +2,6 @@
|
||||
|
||||
UnifiedDeviceManager::UnifiedDeviceManager(int retryIntervalMs)
|
||||
: m_serial(std::make_unique<SerialComm>())
|
||||
, m_camera(std::make_unique<CameraManager>(retryIntervalMs))
|
||||
, m_serialConnected(false)
|
||||
, m_shouldStop(false)
|
||||
, m_retryIntervalMs(retryIntervalMs)
|
||||
@@ -16,81 +15,69 @@ UnifiedDeviceManager::~UnifiedDeviceManager() {
|
||||
|
||||
void UnifiedDeviceManager::serialReconnectThreadFunc() {
|
||||
fmt::print("[I][Managr]: Serial reconnect thread started\n");
|
||||
|
||||
|
||||
while (!m_shouldStop.load()) {
|
||||
if (!m_serialConnected.load()) {
|
||||
fmt::print("[I][Managr]: Attempting to connect serial port...\n");
|
||||
|
||||
|
||||
std::lock_guard<std::mutex> lock(m_serialMutex);
|
||||
|
||||
|
||||
if (m_serial->findFirstTtyUSB() && m_serial->openPort()) {
|
||||
m_serialConnected.store(true);
|
||||
fmt::print("[I][Managr]: Serial port connected successfully\n");
|
||||
} else {
|
||||
fmt::print("[W][Managr]: Serial connection failed, retry in {}ms\n",
|
||||
fmt::print("[W][Managr]: Serial connection failed, retry in {}ms\n",
|
||||
m_retryIntervalMs);
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
std::this_thread::sleep_for(std::chrono::milliseconds(m_retryIntervalMs));
|
||||
}
|
||||
|
||||
|
||||
fmt::print("[I][Managr]: Serial reconnect thread stopped\n");
|
||||
}
|
||||
|
||||
void UnifiedDeviceManager::start() {
|
||||
fmt::print("[I][Managr]: Starting unified device manager\n");
|
||||
|
||||
|
||||
m_shouldStop.store(false);
|
||||
|
||||
// Start serial reconnect thread
|
||||
|
||||
if (!m_serialReconnectThread.joinable()) {
|
||||
m_serialReconnectThread = std::thread(&UnifiedDeviceManager::serialReconnectThreadFunc, this);
|
||||
}
|
||||
|
||||
// Start camera manager (it has its own reconnect thread)
|
||||
m_camera->start();
|
||||
|
||||
|
||||
fmt::print("[I][Managr]: Unified device manager started\n");
|
||||
}
|
||||
|
||||
void UnifiedDeviceManager::stop() {
|
||||
fmt::print("[I][Managr]: Stopping unified device manager\n");
|
||||
|
||||
|
||||
m_shouldStop.store(true);
|
||||
|
||||
// Stop camera manager
|
||||
m_camera->stop();
|
||||
|
||||
// Stop serial thread
|
||||
|
||||
if (m_serialReconnectThread.joinable()) {
|
||||
m_serialReconnectThread.join();
|
||||
|
||||
|
||||
std::lock_guard<std::mutex> lock(m_serialMutex);
|
||||
m_serial->closePort();
|
||||
m_serialConnected.store(false);
|
||||
}
|
||||
|
||||
fmt::print("[I][Managr]: Unified device manager stopped\n");
|
||||
}
|
||||
|
||||
bool UnifiedDeviceManager::isCameraConnected() const {
|
||||
return m_camera->isConnected();
|
||||
fmt::print("[I][Managr]: Unified device manager stopped\n");
|
||||
}
|
||||
|
||||
bool UnifiedDeviceManager::sendData(const char* data, size_t length) {
|
||||
if (!m_serialConnected.load()) {
|
||||
return false;
|
||||
}
|
||||
|
||||
|
||||
std::lock_guard<std::mutex> lock(m_serialMutex);
|
||||
|
||||
|
||||
if (!m_serial->sendData(data, length)) {
|
||||
m_serialConnected.store(false);
|
||||
fmt::print("[W][Managr]: Serial send failed, marked as disconnected\n");
|
||||
return false;
|
||||
}
|
||||
|
||||
|
||||
return true;
|
||||
}
|
||||
|
||||
@@ -98,15 +85,7 @@ int UnifiedDeviceManager::receiveData(uint8_t* buffer, size_t maxLength) {
|
||||
if (!m_serialConnected.load()) {
|
||||
return -1;
|
||||
}
|
||||
|
||||
|
||||
std::lock_guard<std::mutex> lock(m_serialMutex);
|
||||
return m_serial->receiveData(buffer, maxLength);
|
||||
}
|
||||
|
||||
bool UnifiedDeviceManager::grabFrame(cv::Mat& frame) {
|
||||
return m_camera->grabFrame(frame);
|
||||
}
|
||||
|
||||
const char* UnifiedDeviceManager::getCameraName() const {
|
||||
return m_camera->getCameraName();
|
||||
}
|
||||
Reference in New Issue
Block a user