diff --git a/.gitignore b/.gitignore index 4bc67eb..11e28e0 100644 --- a/.gitignore +++ b/.gitignore @@ -1,5 +1,7 @@ /tests/ /build/ +/bin/ /docs/ /.idea/ +/.qtcreator/ *.vision-state.json diff --git a/config.ini b/config.ini index 9b31ffb..da533a2 100644 --- a/config.ini +++ b/config.ini @@ -111,15 +111,14 @@ simulation=false productionEnabled=true [vision] -; Recognition switch only; the M850/M851 photo-position stage always precedes RackPick. -enabled=false +; Master switch for camera recognition and continuous avoidance. +enabled=true contractConfirmed=true photoPoseReadyConfirmed=true -executablePath=E:/QTCode/VisionGuide/VisionGuide_Qt/source/build-ssp-integration/bin/VisionGuide.exe -ipcName=ssp_visionguide_v1 -startupTimeoutMs=15000 -initializeTimeoutMs=60000 -requestTimeoutMs=15000 +initializeTimeoutMs=300000 +requestTimeoutMs=30000 +; When vision is enabled, distance below this value . +warningDistanceMm=300 [visionTrayMap] ; All six physical trays use VisionGuide configuration 1. diff --git a/config/configmanager.cpp b/config/configmanager.cpp index 60cb534..f0cc540 100644 --- a/config/configmanager.cpp +++ b/config/configmanager.cpp @@ -5,6 +5,7 @@ #include #include #include +#include bool VisionConfig::isValid(QString *error) const { @@ -12,9 +13,11 @@ bool VisionConfig::isValid(QString *error) const if (!contractConfirmed || !photoPoseReadyConfirmed) { errors.append("Photo-position PLC contract is not confirmed"); } - if (ipcName.trimmed().isEmpty() || startupTimeoutMs <= 0 - || initializeTimeoutMs <= 0 || requestTimeoutMs <= 5000) { - errors.append("Vision IPC name or timeouts are invalid"); + if (initializeTimeoutMs <= 0 || requestTimeoutMs <= 5000) { + errors.append("Vision timeouts are invalid"); + } + if (!std::isfinite(warningDistanceMm) || warningDistanceMm < 1 || warningDistanceMm > 5000) { + errors.append("Vision warningDistanceMm must be between 1 and 5000 mm"); } if (photoPoseR < 0 || photoPoseR > 32756 || photoPoseR % 2 || graspPoseR < 0 || graspPoseR > 32756 || graspPoseR % 2 @@ -215,11 +218,10 @@ bool ConfigManager::load(const QString &filePath) m_visionConfig.enabled = settings.value("vision/enabled", false).toBool(); m_visionConfig.contractConfirmed = settings.value("vision/contractConfirmed", false).toBool(); m_visionConfig.photoPoseReadyConfirmed = settings.value("vision/photoPoseReadyConfirmed", false).toBool(); - m_visionConfig.executablePath = settings.value("vision/executablePath").toString(); - m_visionConfig.ipcName = settings.value("vision/ipcName", m_visionConfig.ipcName).toString(); - m_visionConfig.startupTimeoutMs = settings.value("vision/startupTimeoutMs", m_visionConfig.startupTimeoutMs).toInt(); + m_visionConfig.sdkRoot = settings.value("vision/sdkRoot").toString(); m_visionConfig.initializeTimeoutMs = settings.value("vision/initializeTimeoutMs", m_visionConfig.initializeTimeoutMs).toInt(); m_visionConfig.requestTimeoutMs = settings.value("vision/requestTimeoutMs", m_visionConfig.requestTimeoutMs).toInt(); + m_visionConfig.warningDistanceMm = settings.value("vision/warningDistanceMm", m_visionConfig.warningDistanceMm).toDouble(); // PLC settings belong to modbus; retain vision keys for existing installations. m_visionConfig.photoPoseR = settings.value("modbus/photoPoseR", settings.value("vision/photoPoseR", 40)).toInt(); m_visionConfig.graspPoseR = settings.value("modbus/graspPoseR", settings.value("vision/graspPoseR", 60)).toInt(); diff --git a/config/configmanager.h b/config/configmanager.h index 20bae5e..dc5ae6c 100644 --- a/config/configmanager.h +++ b/config/configmanager.h @@ -13,11 +13,10 @@ struct VisionConfig bool enabled = false; bool contractConfirmed = false; bool photoPoseReadyConfirmed = false; - QString executablePath; - QString ipcName = "ssp_visionguide_v1"; - int startupTimeoutMs = 15000; - int initializeTimeoutMs = 60000; - int requestTimeoutMs = 15000; + QString sdkRoot; + int initializeTimeoutMs = 300000; + int requestTimeoutMs = 30000; + double warningDistanceMm = 300.0; int photoPoseR = 40; int graspPoseR = 60; bool lowWordFirst = true; diff --git a/pages/dashboardpage.cpp b/pages/dashboardpage.cpp index 744f064..64b7b37 100644 --- a/pages/dashboardpage.cpp +++ b/pages/dashboardpage.cpp @@ -404,6 +404,8 @@ void DashboardPage::attachVisionService(VisionService *service) { connect(productionWorker, &ProductionWorker::visionMeasureRequested, service, &VisionService::measure, Qt::QueuedConnection); + connect(productionWorker, &ProductionWorker::visionGroovesRequested, + service, &VisionService::recognizeGrooves, Qt::QueuedConnection); connect(productionWorker, &ProductionWorker::visionCancelRequested, service, &VisionService::cancel, Qt::QueuedConnection); connect(productionWorker, &ProductionWorker::visionProductionActiveChanged, @@ -412,6 +414,8 @@ void DashboardPage::attachVisionService(VisionService *service) this, &DashboardPage::visionProductionActiveChanged, Qt::QueuedConnection); connect(service, &VisionService::measurementFinished, productionWorker, &ProductionWorker::receiveVisionResult, Qt::QueuedConnection); + connect(service, &VisionService::groovesRecognized, + productionWorker, &ProductionWorker::receiveGroovesResult, Qt::QueuedConnection); connect(service, &VisionService::availabilityChanged, productionWorker, &ProductionWorker::updateVisionAvailability, Qt::QueuedConnection); connect(productionWorker, &ProductionWorker::visionCycleChanged, this, diff --git a/pages/devicepage.cpp b/pages/devicepage.cpp index 9554a32..cc67543 100644 --- a/pages/devicepage.cpp +++ b/pages/devicepage.cpp @@ -66,9 +66,8 @@ void DevicePage::attachVisionService(VisionService *service) void DevicePage::updateVisionStatus(bool ready, const QString &session) { - const bool enabled = ConfigManager::instance().visionConfig().enabled; const QString now = QDateTime::currentDateTime().toString("yyyy-MM-dd HH:mm:ss"); - if (!enabled) { + if (!ConfigManager::instance().visionConfig().enabled) { setRow(7, QStringList() << "视觉引导系统" << "未启用" << "未启用" << "未启用" << now); } else if (session.isEmpty()) { diff --git a/pages/visionpage.cpp b/pages/visionpage.cpp index a68920e..1782a23 100644 --- a/pages/visionpage.cpp +++ b/pages/visionpage.cpp @@ -23,21 +23,17 @@ VisionPage::VisionPage(VisionService *service, QWidget *parent) "QGroupBox#visionControlBox QPushButton:disabled {" " color: #90a4ae; background: #eceff1; border-color: #cfd8dc; }"); - QGroupBox *control = new QGroupBox("视觉程序控制", this); + QGroupBox *control = new QGroupBox("视觉 DLL 控制", this); control->setObjectName("visionControlBox"); QGridLayout *controlLayout = new QGridLayout(control); controlLayout->setHorizontalSpacing(10); controlLayout->setVerticalSpacing(8); - m_start = new QPushButton("启动视觉程序", control); - m_connect = new QPushButton("连接已有视觉程序", control); - m_initialize = new QPushButton("初始化左右相机", control); - m_show = new QPushButton("打开视觉调试窗口", control); - m_disconnect = new QPushButton("断开并释放调试控制", control); + m_start = new QPushButton("加载视觉 DLL", control); + m_initialize = new QPushButton("初始化视觉设备", control); + m_disconnect = new QPushButton("释放视觉资源", control); controlLayout->addWidget(m_start, 0, 0); - controlLayout->addWidget(m_connect, 0, 1); - controlLayout->addWidget(m_initialize, 0, 2); - controlLayout->addWidget(m_show, 1, 0); - controlLayout->addWidget(m_disconnect, 1, 1); + controlLayout->addWidget(m_initialize, 0, 1); + controlLayout->addWidget(m_disconnect, 0, 2); controlLayout->setColumnStretch(0, 1); controlLayout->setColumnStretch(1, 1); controlLayout->setColumnStretch(2, 1); @@ -52,11 +48,11 @@ VisionPage::VisionPage(VisionService *service, QWidget *parent) QGroupBox *status = new QGroupBox("运行状态", this); QVBoxLayout *statusLayout = new QVBoxLayout(status); statusLayout->setSpacing(7); - m_status = new QLabel("视觉进程:未连接", status); + m_status = new QLabel("视觉 DLL:未加载", status); m_initialization = new QLabel("相机初始化:未执行", status); m_initialization->setWordWrap(true); QLabel *parameters = new QLabel( - "左相机 · 高精细化 · 测量截止 5 秒 · MinScore 0.70 · Greediness 0.80 · 中心选择 · 模型原点 · 抓取偏移 4.40 mm", + "左相机 · 高精细化 · 测量截止 30 秒 · MinScore 0.70 · Greediness 0.80 · 中心选择 · 模型原点 · 抓取偏移 4.40 mm", status); parameters->setWordWrap(true); m_cycle = new QLabel("自动流程:未开始", status); @@ -84,30 +80,22 @@ VisionPage::VisionPage(VisionService *service, QWidget *parent) m_poses->setItem(row, col, new QTableWidgetItem("—")); poseLayout->addWidget(m_poses); QLabel *units = new QLabel( - "机器人坐标单位:mm / °。相机姿态沿用 VisionGuide 原始类型;显示抓取目标不代表 PLC 已写入或机器人已接收。", + "机器人坐标单位:mm / °。相机姿态来自视觉 DLL;显示抓取目标不代表 PLC 已写入或机器人已接收。", poses); units->setWordWrap(true); poseLayout->addWidget(units); layout->addWidget(poses, 1); connect(m_start, &QPushButton::clicked, this, [this]() { - beginOperation("start", "正在启动或连接视觉程序…"); + beginOperation("start", "正在加载视觉 DLL…"); m_service->startService(); }); - connect(m_connect, &QPushButton::clicked, this, [this]() { - beginOperation("connect", "正在连接已有视觉程序…"); - m_service->connectService(); - }); connect(m_initialize, &QPushButton::clicked, this, [this]() { - beginOperation("initialize", "正在初始化左右相机…"); + beginOperation("initialize", "正在初始化相机、光源和视觉数据…"); m_service->initialize(); }); - connect(m_show, &QPushButton::clicked, this, [this]() { - beginOperation("show_window", "正在请求显示视觉调试窗口…"); - m_service->showWindow(); - }); connect(m_disconnect, &QPushButton::clicked, this, [this]() { - beginOperation("disconnect", "正在断开视觉控制…"); + beginOperation("disconnect", "正在释放视觉设备和 DLL…"); m_service->disconnectService(); }); connect(service, &VisionService::operationFeedback, this, @@ -119,26 +107,19 @@ VisionPage::VisionPage(VisionService *service, QWidget *parent) refreshControls(); }); connect(service, &VisionService::availabilityChanged, this, [this](bool ready, bool busy, const QString &session) { - m_status->setText(session.isEmpty() ? "视觉进程:未连接" - : QString("视觉进程:在线;初始化%1;资源%2").arg(ready ? "就绪" : "未就绪", busy ? "忙" : "空闲")); + m_status->setText(session.isEmpty() ? "视觉 DLL:未加载" + : QString("视觉 DLL:已加载;设备%1;资源%2") + .arg(ready ? "就绪" : "未就绪", busy ? "忙" : "空闲")); if (session.isEmpty()) invalidateResult(); refreshControls(); }); connect(service, &VisionService::statusChanged, this, [this](const QJsonObject &status) { - if (status.contains("initialization")) { - const QJsonObject initialization = status.value("initialization").toObject(); - QStringList details; - const QStringList cameras = QStringList() << "left" << "right"; - for (const QString &camera : cameras) { - const QJsonObject state = initialization.value(camera).toObject(); - details.append(QString("%1:连接%2 / 参数%3 / 白平衡%4") - .arg(camera == "left" ? "左相机" : "右相机", - state.value("connected").toBool() ? "完成" : "未完成", - state.value("parameters_applied").toBool() ? "完成" : "未完成", - state.value("white_balance_finished").toBool() ? "完成" : "未完成")); - } - m_initialization->setText(details.join(";")); - } + if (status.contains("camera_left_connected")) + m_initialization->setText(QString("左相机:%1;右相机:%2;光源:%3;测量数据:%4") + .arg(status.value("camera_left_connected").toBool() ? "已连接" : "未连接", + status.value("camera_right_connected").toBool() ? "已连接" : "未连接", + status.value("light_connected").toBool() ? "已连接" : "未连接", + status.value("measurement_ready").toBool() ? "已加载" : "未加载")); }); connect(service, &VisionService::requestStarted, this, [this](const QJsonObject &request) { invalidateResult(); @@ -156,9 +137,9 @@ VisionPage::VisionPage(VisionService *service, QWidget *parent) } showPose(1, result.value("camera_pose")); showPose(2, result.value("robot_pose")); - m_result->setText(QString("视觉计算成功;匹配分数 %1;测量 %2 ms;抓取计算 %3 ms;等待生产流程确认提交状态") + m_result->setText(QString("视觉计算成功;匹配分数 %1;总耗时 %2 ms;等待生产流程确认提交状态") .arg(result.value("score").toDouble(), 0, 'f', 3) - .arg(result.value("measure_elapsed_ms").toInt()).arg(result.value("grasp_elapsed_ms").toInt())); + .arg(result.value("elapsed_ms").toInt())); }); refreshControls(); } @@ -215,10 +196,11 @@ void VisionPage::updateCycle(const QJsonObject &cycle) void VisionPage::refreshControls() { - m_start->setEnabled(!m_operationPending || m_pendingOperation != "start"); - m_connect->setEnabled(!m_operationPending || m_pendingOperation != "connect"); + if (!m_service->isEnabled()) m_status->setText("视觉功能:未启用"); + m_start->setEnabled(m_service->isEnabled() + && (!m_operationPending || m_pendingOperation != "start")); m_initialize->setEnabled(m_service->canInitialize() && (!m_operationPending || m_pendingOperation != "initialize")); - m_show->setEnabled(!m_operationPending || m_pendingOperation != "show_window"); - m_disconnect->setEnabled(!m_operationPending || m_pendingOperation != "disconnect"); + m_disconnect->setEnabled(m_service->isEnabled() + && (!m_operationPending || m_pendingOperation != "disconnect")); } diff --git a/pages/visionpage.h b/pages/visionpage.h index 063e72a..cd703e2 100644 --- a/pages/visionpage.h +++ b/pages/visionpage.h @@ -33,9 +33,7 @@ private: QLabel *m_operation; QTableWidget *m_poses; QPushButton *m_start; - QPushButton *m_connect; QPushButton *m_initialize; - QPushButton *m_show; QPushButton *m_disconnect; QString m_pendingOperation; bool m_operationPending; diff --git a/services/productionservice.cpp b/services/productionservice.cpp index 3bff5de..fb87cbf 100644 --- a/services/productionservice.cpp +++ b/services/productionservice.cpp @@ -116,6 +116,7 @@ ProductionService::~ProductionService() m_timer->stop(); m_state = Terminating; m_stopRequested.store(true); + resetPlaceSlotInspection(); ++m_visionGeneration; m_visionSuspended = true; m_actionCancelRequested = false; @@ -238,9 +239,11 @@ void ProductionService::loadVisionRecoveryState() void ProductionService::publishVisionControl() { const bool locked = m_visionNeedsReconcile || (m_state != Idle && m_state != Completed); - const bool maintenance = m_visionNeedsReconcile && !m_shutdownRequested + const bool slotFault = m_currentWorkpiece.processStep == "PLACE_SLOT_INSPECTING" + && (m_state == Error || m_state == ManualConfirm); + const bool maintenance = ((m_visionNeedsReconcile && (m_state == Idle || m_state == ManualConfirm)) + || slotFault) && !m_shutdownRequested && !m_recoveryCheckPending - && (m_state == Idle || m_state == ManualConfirm) && !m_actionStarting && !m_actionPollPending && !m_actionCancelRequested && !m_deviceService->productionActionActive(); emit visionProductionActiveChanged(locked, maintenance); @@ -265,9 +268,8 @@ void ProductionService::reportVision(const QString &phase, const QString &messag if (!m_visionResult.isEmpty()) { cycle.insert("camera_pose", m_visionResult.value("camera_pose")); cycle.insert("parameters", m_visionResult.value("parameters")); - cycle.insert("calibration_fingerprint", m_visionResult.value("calibration_fingerprint")); - cycle.insert("measure_elapsed_ms", m_visionResult.value("measure_elapsed_ms")); - cycle.insert("grasp_elapsed_ms", m_visionResult.value("grasp_elapsed_ms")); + cycle.insert("config_revision", m_visionResult.value("config_revision")); + cycle.insert("elapsed_ms", m_visionResult.value("elapsed_ms")); } emit visionCycleChanged(cycle); } @@ -327,12 +329,12 @@ void ProductionService::advanceVision() { if (m_visionSuspended || m_visionStage == VisionStage::Fault) return; if (!visionCurrent(m_visionGeneration)) { - visionFault("当前工件、视觉进程会话或设备状态已改变"); + visionFault("当前工件、视觉 DLL 会话或设备状态已改变"); return; } const VisionConfig config = ConfigManager::instance().visionConfig(); const qint64 limit = m_visionStage == VisionStage::Measuring - ? qint64(config.requestTimeoutMs) + 2LL * config.initializeTimeoutMs + ? qint64(config.requestTimeoutMs) + 5000LL : ConfigManager::instance().productionConfig().stateTimeoutMs; if (m_visionTimer.isValid() && m_visionTimer.elapsed() > limit) { if (m_visionStage == VisionStage::Measuring) @@ -351,7 +353,7 @@ void ProductionService::beginVisionMeasurement() return; } if (config.visionTrayNo(m_currentTrayNo) < 1 || m_availableVisionSession.isEmpty()) { - skipVision("缺少视觉料盘映射或视觉进程未连接"); + skipVision("缺少视觉料盘映射或视觉 DLL 未就绪"); return; } m_visionSession = m_availableVisionSession; @@ -387,12 +389,11 @@ void ProductionService::beginVisionMeasurement() void ProductionService::onVisionAvailability(bool ready, bool busy, const QString &session) { - Q_UNUSED(ready) Q_UNUSED(busy) - m_availableVisionSession = session; - if (m_visionStage == VisionStage::Measuring && session != m_visionSession + m_availableVisionSession = ready ? session : QString(); + if (m_visionStage == VisionStage::Measuring && m_availableVisionSession != m_visionSession && visionCurrent(m_visionGeneration)) - skipVision("VisionGuide 连接中断或进程会话改变"); + skipVision("视觉 DLL 失去就绪状态或会话改变"); } void ProductionService::publishVisionSnapshot() @@ -424,12 +425,13 @@ void ProductionService::onVisionResult(const QJsonObject &result) } if (result.value("status").toString() != "ok" || !result.value("robot_valid").toBool() || !result.value("camera_valid").toBool() || !target.isValid() || !camera.isValid() - || result.value("source").toString() != "LEFT" || result.value("pose_type").toString() != "model_origin" + || result.value("source").toString() != "LEFT" || result.value("parameters") != m_visionRequest.value("parameters") || result.value("convention") != m_visionRequest.value("convention") || !result.value("score").isDouble() || !std::isfinite(result.value("score").toDouble()) || result.value("score").toDouble() < .70 || result.value("score").toDouble() > 1.0 - || result.value("calibration_fingerprint").toString().isEmpty()) { + || result.value("config_revision").toString().isEmpty() + || !result.value("elapsed_ms").isDouble()) { skipVision("视觉识别失败或结果无效:" + result.value("message").toString()); return; } m_visionResult = result; @@ -511,6 +513,7 @@ void ProductionService::skipVision(const QString &reason) void ProductionService::invalidateVision(const QString &reason) { + resetPlaceSlotInspection(); if (m_visionStage == VisionStage::Idle && !m_visionNeedsReconcile && !m_targetReady) return; m_targetReady = false; ++m_visionGeneration; @@ -1969,6 +1972,7 @@ void ProductionService::resumeRecoveredState(State state) m_lastError.clear(); m_actionError.clear(); m_pauseAfterCurrentAction = false; + if (state == PlaceSlotInspecting) resetPlaceSlotInspection(); m_state = target; m_stateTimer.restart(); publishState(); @@ -2177,6 +2181,8 @@ bool ProductionService::pickTargetValid() const bool ProductionService::setState(State state) { const QString previous = stateName(); + if (m_state == PlaceSlotInspecting && (state != m_state || m_persistenceUncertain)) + resetPlaceSlotInspection(); if (m_persistenceUncertain) { m_timer->stop(); pauseProcessTimer(); @@ -3090,6 +3096,7 @@ void ProductionService::tick() m_timer->stop(); pauseProcessTimer(); m_lastError = persistenceError; + resetPlaceSlotInspection(); m_state = Error; publishState(); emit productionError(persistenceError); @@ -3284,15 +3291,7 @@ bool ProductionService::processProductionStep(State state, QString *error) "PLACE_SLOT_INSPECTING", PlaceSlotInspecting, error); case PlaceSlotInspecting: { - const SlotOccupancyResult result = inspectPlaceSlot(); - if (result == SlotOccupancyResult::Occupied) { - if (error) *error = "目标凹槽检测到有料,禁止放料"; - return false; - } - if (result == SlotOccupancyResult::Unknown) { - if (error) *error = "目标凹槽识别失败或结果不确定,禁止放料"; - return false; - } + if (!inspectPlaceSlot(error)) return false; if (!updateCurrentProcessStep("RACK_PLACING", error)) return false; if (!setState(RackPlacing)) { if (error) *error = m_lastError; return false; } if (m_pauseAfterCurrentAction) return pauseAtActionBoundary(error); @@ -3335,12 +3334,75 @@ bool ProductionService::processProductionStep(State state, QString *error) return true; } -ProductionService::SlotOccupancyResult ProductionService::inspectPlaceSlot() const +bool ProductionService::inspectPlaceSlot(QString *error) { - // TODO: Replace this placeholder with the camera occupancy result. - const bool mockSlotOccupied = false; - return mockSlotOccupied ? SlotOccupancyResult::Occupied - : SlotOccupancyResult::Empty; + const VisionConfig config = ConfigManager::instance().visionConfig(); + if (!config.enabled) { + resetPlaceSlotInspection(); + return true; + } + if (stopRequested() || m_shutdownRequested || m_state != PlaceSlotInspecting) return false; + if (m_availableVisionSession.isEmpty()) { + if (error) *error = "凹槽识别失败:视觉 DLL 未就绪,禁止放料"; + return false; + } + if (m_slotInspectionRequest.isEmpty()) { + const QString id = QUuid::createUuid().toString(QUuid::WithoutBraces); + m_slotInspectionRequest = { + {"request_id", id}, {"server_session_id", m_availableVisionSession}, + {"context", QJsonObject{{"workpiece_id", QString::number(m_currentWorkpiece.id)}, + {"task_id", QString::number(m_runId) + "/RackPlace"}, + {"tray_no", m_currentTrayNo}, {"slot_no", m_currentSlotNo}, + {"generation", id}}}}; + m_slotInspectionTimer.start(); + emit visionGroovesRequested(m_slotInspectionRequest); + return false; + } + const QJsonObject context = m_slotInspectionRequest.value("context").toObject(); + if (m_availableVisionSession != m_slotInspectionRequest.value("server_session_id").toString() + || context.value("workpiece_id").toString() != QString::number(m_currentWorkpiece.id) + || context.value("task_id").toString() != QString::number(m_runId) + "/RackPlace" + || context.value("tray_no").toInt() != m_currentTrayNo + || context.value("slot_no").toInt() != m_currentSlotNo) { + if (error) *error = "凹槽识别上下文已失效,禁止放料"; + return false; + } + if (m_slotInspectionResult.isEmpty()) { + if (m_slotInspectionTimer.elapsed() > qint64(config.requestTimeoutMs) + 5000 && error) + *error = "凹槽识别等待超时,禁止放料"; + return false; + } + const QJsonObject &result = m_slotInspectionResult; + if (result.value("status").toString() != "ok" || !result.value("occupancy_valid").toBool() + || !result.value("grooves").isArray() + || result.value("context") != m_slotInspectionRequest.value("context") + || result.value("server_session_id") != m_slotInspectionRequest.value("server_session_id")) { + if (error) *error = "凹槽识别失败或结果无效,禁止放料:" + result.value("message").toString(); + return false; + } + if (result.value("grooves").toArray().size() > 5) { + if (error) *error = "凹槽识别有料"; + return false; + } + return true; +} + +void ProductionService::onGroovesRecognized(const QJsonObject &result) +{ + if (m_state != PlaceSlotInspecting || stopRequested() || m_shutdownRequested + || m_slotInspectionRequest.isEmpty() || !m_slotInspectionResult.isEmpty() + || result.value("request_id") != m_slotInspectionRequest.value("request_id")) return; + m_slotInspectionResult = result; +} + +void ProductionService::resetPlaceSlotInspection() +{ + const QString id = m_slotInspectionRequest.value("request_id").toString(); + const bool pending = !id.isEmpty() && m_slotInspectionResult.isEmpty(); + m_slotInspectionRequest = QJsonObject(); + m_slotInspectionResult = QJsonObject(); + m_slotInspectionTimer.invalidate(); + if (pending) emit visionCancelRequested(id); } bool ProductionService::recoverFromPlcStep(QString *error) diff --git a/services/productionservice.h b/services/productionservice.h index e60ad35..e99f492 100644 --- a/services/productionservice.h +++ b/services/productionservice.h @@ -96,6 +96,7 @@ public: public slots: void onVisionAvailability(bool ready, bool busy, const QString &session); void onVisionResult(const QJsonObject &result); + void onGroovesRecognized(const QJsonObject &result); void publishVisionSnapshot(); signals: @@ -118,6 +119,7 @@ signals: void alarmOperationBusyChanged(bool busy); void alarmOperationFinished(bool resetRequested, bool success, const QString &message); void visionMeasureRequested(const QJsonObject &request); + void visionGroovesRequested(const QJsonObject &request); void visionCancelRequested(const QString &requestId); void visionCycleChanged(const QJsonObject &cycle); void visionProductionActiveChanged(bool active, bool maintenanceAllowed); @@ -136,9 +138,6 @@ private: enum class VisionStage { Idle, ReadingPose, Measuring, WritingPose, Publishing, Complete, Fault }; - enum class SlotOccupancyResult { - Empty, Occupied, Unknown - }; void prepareVision(); void advanceVision(); void beginVisionMeasurement(); @@ -186,7 +185,8 @@ private: void tickSimulation(); void tickProduction(); bool processProductionStep(State state, QString *error); - SlotOccupancyResult inspectPlaceSlot() const; + bool inspectPlaceSlot(QString *error); + void resetPlaceSlotInspection(); bool recoverFromPlcStep(QString *error); bool processProductionAction(DeviceService::ProductionAction action, bool *completed, QString *error); @@ -307,6 +307,9 @@ private: bool m_visionCommitStarted = false; bool m_visionNeedsReconcile = false; QString m_visionStatePath; + QJsonObject m_slotInspectionRequest; + QJsonObject m_slotInspectionResult; + QElapsedTimer m_slotInspectionTimer; }; Q_DECLARE_METATYPE(ProductionService::State) diff --git a/services/productionworker.cpp b/services/productionworker.cpp index 142c656..2bf7b7a 100644 --- a/services/productionworker.cpp +++ b/services/productionworker.cpp @@ -21,6 +21,7 @@ void ProductionWorker::ensureService() this, &ProductionWorker::snapshotChanged); m_service->setExternalStopFlag(&m_stopRequested); connect(m_service, &ProductionService::visionMeasureRequested, this, &ProductionWorker::visionMeasureRequested); + connect(m_service, &ProductionService::visionGroovesRequested, this, &ProductionWorker::visionGroovesRequested); connect(m_service, &ProductionService::visionCancelRequested, this, &ProductionWorker::visionCancelRequested); connect(m_service, &ProductionService::visionCycleChanged, this, &ProductionWorker::visionCycleChanged); connect(m_service, &ProductionService::visionProductionActiveChanged, this, &ProductionWorker::visionProductionActiveChanged); @@ -77,6 +78,12 @@ void ProductionWorker::receiveVisionResult(const QJsonObject &result) m_service->onVisionResult(result); } +void ProductionWorker::receiveGroovesResult(const QJsonObject &result) +{ + ensureService(); + m_service->onGroovesRecognized(result); +} + void ProductionWorker::requestVisionSnapshot() { ensureService(); diff --git a/services/productionworker.h b/services/productionworker.h index eaf3eb3..2526e3b 100644 --- a/services/productionworker.h +++ b/services/productionworker.h @@ -30,6 +30,7 @@ public slots: void requestShutdown(); void updateVisionAvailability(bool ready, bool busy, const QString &session); void receiveVisionResult(const QJsonObject &result); + void receiveGroovesResult(const QJsonObject &result); void requestVisionSnapshot(); signals: @@ -54,6 +55,7 @@ signals: void alarmOperationFinished(bool resetRequested, bool success, const QString &message); void shutdownReady(); void visionMeasureRequested(const QJsonObject &request); + void visionGroovesRequested(const QJsonObject &request); void visionCancelRequested(const QString &requestId); void visionCycleChanged(const QJsonObject &cycle); void visionProductionActiveChanged(bool active, bool maintenanceAllowed); diff --git a/services/visiondllworker.cpp b/services/visiondllworker.cpp new file mode 100644 index 0000000..d7bfb53 --- /dev/null +++ b/services/visiondllworker.cpp @@ -0,0 +1,333 @@ +#include "visiondllworker.h" + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#ifdef Q_OS_WIN +#include +#endif + +namespace { +QJsonObject readObject(const QString &path, QString *error) +{ + QFile file(path); + if (!file.open(QIODevice::ReadOnly)) { + if (error) *error = QString("无法读取视觉配置:%1").arg(path); + return {}; + } + QJsonParseError parseError; + const QJsonDocument document = QJsonDocument::fromJson(file.readAll(), &parseError); + if (parseError.error != QJsonParseError::NoError || !document.isObject()) { + if (error) *error = QString("视觉配置 JSON 无效:%1").arg(parseError.errorString()); + return {}; + } + return document.object(); +} + +QString operationMessage(const QJsonObject &result) +{ + const QString message = result.value("message").toString(); + return message.isEmpty() ? QStringLiteral("DLL 未返回详细原因") : message; +} +} + +VisionDllWorker::VisionDllWorker(QObject *parent) + : QObject(parent) +{ +} + +HikVisionGuidanceQt::Reply VisionDllWorker::call(const QString &name, + const QJsonObject &request) +{ + const QString requestId = request.value("request_id").toString(); + if (!requestId.isEmpty()) { + QMutexLocker locker(&m_apiMutex); + m_activeOperationId = requestId; + } + const HikVisionGuidanceQt::Reply reply = m_api.call(name, request); + if (!requestId.isEmpty()) { + QMutexLocker locker(&m_apiMutex); + if (m_activeOperationId == requestId) m_activeOperationId.clear(); + } + return reply; +} + +QString VisionDllWorker::replyError(const QString &operation, + const HikVisionGuidanceQt::Reply &reply) const +{ + return QString("%1失败(DLL code=%2):%3") + .arg(operation).arg(reply.code).arg(operationMessage(reply.json)); +} + +void VisionDllWorker::loadSdk(const QString &sdkRoot, int initializeTimeoutMs) +{ + Q_UNUSED(sdkRoot) + if (m_api.isOpen()) { + emit sdkLoaded(true, QJsonObject(), "视觉 DLL 已加载"); + return; + } + + m_sdkRoot = QCoreApplication::applicationDirPath(); + const QString dllPath = QDir(m_sdkRoot).filePath("HikVisionGuidance.dll"); + const QString configPath = QDir(m_sdkRoot).filePath("config/sdk.json"); + if (!QFileInfo::exists(dllPath) || !QFileInfo::exists(configPath)) { + emit sdkLoaded(false, QJsonObject(), + "运行目录下缺少 HikVisionGuidance.dll 或 config/sdk.json"); + return; + } + +#ifdef Q_OS_WIN + DLL_DIRECTORY_COOKIE directoryCookie = AddDllDirectory( + reinterpret_cast(m_sdkRoot.utf16())); + if (!directoryCookie) { + emit sdkLoaded(false, QJsonObject(), + QString("注册视觉 DLL 依赖目录失败(Windows error=%1)") + .arg(GetLastError())); + return; + } + HMODULE bootstrap = LoadLibraryExW(reinterpret_cast(dllPath.utf16()), nullptr, + LOAD_LIBRARY_SEARCH_DLL_LOAD_DIR | LOAD_LIBRARY_SEARCH_DEFAULT_DIRS + | LOAD_LIBRARY_SEARCH_USER_DIRS); + if (!bootstrap) { + RemoveDllDirectory(directoryCookie); + emit sdkLoaded(false, QJsonObject(), + QString("加载视觉 DLL 或其依赖失败(Windows error=%1)") + .arg(GetLastError())); + return; + } +#endif + + const bool loaded = m_api.load(dllPath); +#ifdef Q_OS_WIN + FreeLibrary(bootstrap); + RemoveDllDirectory(directoryCookie); +#endif + if (!loaded || m_api.resolvedCount() != 27) { + m_api.unload(); + emit sdkLoaded(false, QJsonObject(), "加载视觉 DLL 失败:" + m_api.errorString()); + return; + } + const HikVisionGuidanceQt::Reply version = call("GetVersion"); + if (!version.ok() + || version.json.value("abi_version").toInt() != HVG_ABI_VERSION + || version.json.value("architecture").toString() != "windows-x64-msvc" + || version.json.value("export_count").toInt() != 27) { + m_api.unload(); + emit sdkLoaded(false, version.json, "视觉 DLL 的 ABI、架构或导出接口不兼容"); + return; + } + + const QJsonObject overrides{{"modules", QJsonObject{ + {"measurement", true}, {"grooves", true}, {"distance", true}}}}; + const HikVisionGuidanceQt::Reply initialized = m_api.initialize({ + {"config_path", configPath}, + {"connect_cameras", false}, + {"connect_light", false}, + {"load_data", false}, + {"max_time_ms", initializeTimeoutMs}, + {"overrides", overrides} + }); + if (!initialized.ok()) { + m_api.unload(); + emit sdkLoaded(false, initialized.json, replyError("创建视觉上下文", initialized)); + return; + } + { + QMutexLocker locker(&m_apiMutex); + m_concurrentHandle = m_api.handle(); + m_cancelFunction = m_api.function("CancelOperation"); + } + QJsonObject status = version.json; + status.insert("context", initialized.json); + emit sdkLoaded(true, status, "视觉 DLL 已加载,等待初始化设备"); +} + +void VisionDllWorker::initializeDevices(int initializeTimeoutMs) +{ + if (!m_api.isOpen()) { + emit devicesInitialized(false, QJsonObject(), "视觉 DLL 尚未加载"); + return; + } + + QString configError; + const QJsonObject sdkConfig = readObject(QDir(m_sdkRoot).filePath("config/sdk.json"), + &configError); + if (sdkConfig.isEmpty()) { + emit devicesInitialized(false, QJsonObject(), configError); + return; + } + const QJsonObject light = sdkConfig.value("light").toObject(); + QElapsedTimer timer; + timer.start(); + auto timedCall = [this, &timer, initializeTimeoutMs](const QString &name, + QJsonObject request = QJsonObject()) { + const int remaining = initializeTimeoutMs - int(timer.elapsed()); + if (remaining <= 0) { + return HikVisionGuidanceQt::Reply{ + HVG_TIMEOUT, {{"success", false}, {"message", "设备初始化总等待时间已用尽"}}}; + } + request.insert("request_id", "initialize-" + + QUuid::createUuid().toString(QUuid::WithoutBraces)); + request.insert("max_time_ms", remaining); + return call(name, request); + }; + + HikVisionGuidanceQt::Reply reply = timedCall("InitializeCamera", {{"camera", "both"}}); + if (!reply.ok()) { + emit devicesInitialized(false, reply.json, replyError("初始化相机", reply)); + return; + } + m_cameraConnected = true; + + reply = timedCall("InitializeLight"); + if (!reply.ok()) { + rollbackDevices(); + emit devicesInitialized(false, reply.json, replyError("初始化光源", reply)); + return; + } + m_lightConnected = true; + + reply = timedCall("LoadData"); + if (!reply.ok()) { + rollbackDevices(); + emit devicesInitialized(false, reply.json, replyError("加载视觉数据", reply)); + return; + } + reply = timedCall("TurnOnLight", { + {"left_brightness", light.value("ch1").toInt(255)}, + {"right_brightness", light.value("ch2").toInt(255)} + }); + if (!reply.ok()) { + rollbackDevices(); + emit devicesInitialized(false, reply.json, replyError("打开光源", reply)); + return; + } + m_lightOn = true; + + reply = timedCall("StartCamera", {{"camera", "both"}}); + if (!reply.ok()) { + rollbackDevices(); + emit devicesInitialized(false, reply.json, replyError("启动相机采集", reply)); + return; + } + m_cameraStarted = true; + + reply = timedCall("ConfigureCamera", {{"camera", "both"}}); + if (!reply.ok()) { + rollbackDevices(); + emit devicesInitialized(false, reply.json, replyError("配置相机", reply)); + return; + } + + const HikVisionGuidanceQt::Reply status = call("GetStatus"); + QJsonObject result = status.ok() ? status.json : reply.json; + emit devicesInitialized(true, result, "视觉设备初始化完成"); +} + +void VisionDllWorker::measure(const QJsonObject &request) +{ + const QString requestId = request.value("request_id").toString(); + const HikVisionGuidanceQt::Reply reply = call("Measure", request); + emit operationCompleted(requestId, reply.code, reply.json); +} + +void VisionDllWorker::recognizeGrooves(const QJsonObject &request) +{ + const QString requestId = request.value("request_id").toString(); + const HikVisionGuidanceQt::Reply reply = call("RecognizeGrooves", request); + emit operationCompleted(requestId, reply.code, reply.json); +} + +void VisionDllWorker::planAvoidance(const QJsonObject &request) +{ + const QString requestId = request.value("request_id").toString(); + const HikVisionGuidanceQt::Reply reply = call("PlanAvoidance", request); + emit operationCompleted(requestId, reply.code, reply.json); +} + +bool VisionDllWorker::cancelOperation(const QString &requestId, QString *error) +{ + if (requestId.isEmpty()) return false; + QMutexLocker locker(&m_apiMutex); + if (!m_concurrentHandle || !m_cancelFunction) { + if (error) *error = "视觉 DLL 没有可取消的活动上下文"; + return false; + } + QByteArray buffer(int(HVG_RESPONSE_CAPACITY), 0); + uint32_t required = 0; + const QByteArray input = QJsonDocument(QJsonObject{{"request_id", requestId}}) + .toJson(QJsonDocument::Compact); + const int code = m_cancelFunction(m_concurrentHandle, input.constData(), buffer.data(), + uint32_t(buffer.size()), &required); + if (code != HVG_OK) { + if (error) *error = QString("取消视觉操作失败(DLL code=%1)").arg(code); + return false; + } + return true; +} + +bool VisionDllWorker::cancelActiveOperation() +{ + QString requestId; + { + QMutexLocker locker(&m_apiMutex); + requestId = m_activeOperationId; + } + return !requestId.isEmpty() && cancelOperation(requestId); +} + +void VisionDllWorker::rollbackDevices() +{ + if (m_cameraStarted) call("StopCamera", {{"camera", "both"}}); + m_cameraStarted = false; + if (m_cameraConnected) call("DisconnectCamera", {{"camera", "both"}}); + m_cameraConnected = false; + if (m_lightOn) call("TurnOffLight"); + m_lightOn = false; + if (m_lightConnected) call("DisconnectLight"); + m_lightConnected = false; +} + +void VisionDllWorker::clearConcurrentApi() +{ + QMutexLocker locker(&m_apiMutex); + m_concurrentHandle = nullptr; + m_cancelFunction = nullptr; + m_activeOperationId.clear(); +} + +void VisionDllWorker::release(bool quitThread) +{ + QStringList errors; + auto cleanup = [this, &errors](bool enabled, const QString &name, + const QJsonObject &request = QJsonObject()) { + if (!enabled) return; + const HikVisionGuidanceQt::Reply reply = call(name, request); + if (!reply.ok()) errors.append(replyError(name, reply)); + }; + + cleanup(m_cameraStarted, "StopCamera", {{"camera", "both"}}); + m_cameraStarted = false; + cleanup(m_cameraConnected, "DisconnectCamera", {{"camera", "both"}}); + m_cameraConnected = false; + cleanup(m_lightOn, "TurnOffLight"); + m_lightOn = false; + cleanup(m_lightConnected, "DisconnectLight"); + m_lightConnected = false; + if (m_api.isOpen()) { + const HikVisionGuidanceQt::Reply reply = m_api.close(); + if (!reply.ok()) errors.append(replyError("Shutdown", reply)); + } + clearConcurrentApi(); + if (!m_api.unload()) errors.append("卸载 HikVisionGuidance.dll 失败"); + emit released(errors.isEmpty(), errors.isEmpty() ? "视觉资源已释放" : errors.join(";")); + if (quitThread) QThread::currentThread()->quit(); +} diff --git a/services/visiondllworker.h b/services/visiondllworker.h new file mode 100644 index 0000000..02a2ed5 --- /dev/null +++ b/services/visiondllworker.h @@ -0,0 +1,52 @@ +#ifndef VISIONDLLWORKER_H +#define VISIONDLLWORKER_H + +#include "../third_party/hikvision/HikVisionGuidanceQt.h" + +#include +#include +#include + +class VisionDllWorker : public QObject +{ + Q_OBJECT +public: + explicit VisionDllWorker(QObject *parent = nullptr); + bool cancelOperation(const QString &requestId, QString *error = nullptr); + bool cancelActiveOperation(); + +public slots: + void loadSdk(const QString &sdkRoot, int initializeTimeoutMs); + void initializeDevices(int initializeTimeoutMs); + void measure(const QJsonObject &request); + void recognizeGrooves(const QJsonObject &request); + void planAvoidance(const QJsonObject &request); + void release(bool quitThread = false); + +signals: + void sdkLoaded(bool success, const QJsonObject &status, const QString &message); + void devicesInitialized(bool success, const QJsonObject &status, const QString &message); + void operationCompleted(const QString &requestId, int code, const QJsonObject &result); + void released(bool success, const QString &message); + void logMessage(const QString &message); + +private: + HikVisionGuidanceQt::Reply call(const QString &name, + const QJsonObject &request = QJsonObject()); + QString replyError(const QString &operation, const HikVisionGuidanceQt::Reply &reply) const; + void rollbackDevices(); + void clearConcurrentApi(); + + HikVisionGuidanceQt m_api; + QString m_sdkRoot; + bool m_cameraConnected = false; + bool m_cameraStarted = false; + bool m_lightConnected = false; + bool m_lightOn = false; + QMutex m_apiMutex; + HVG_Handle m_concurrentHandle = nullptr; + HVG_Function m_cancelFunction = nullptr; + QString m_activeOperationId; +}; + +#endif // VISIONDLLWORKER_H diff --git a/services/visionservice.cpp b/services/visionservice.cpp index 5b0f093..2cd5c27 100644 --- a/services/visionservice.cpp +++ b/services/visionservice.cpp @@ -1,30 +1,25 @@ #include "visionservice.h" +#include "visiondllworker.h" -#include #include -#include -#include #include -#include -#include -#include -#include +#include +#include #include #include -#include #include namespace { -const quint32 MaxMessageSize = 1024 * 1024; -QString newId() { return QUuid::createUuid().toString(QUuid::WithoutBraces); } +QString newId() +{ + return QUuid::createUuid().toString(QUuid::WithoutBraces); +} bool validPose(const QJsonValue &value) { - if (!value.isArray() || value.toArray().size() != 6) - return false; + if (!value.isArray() || value.toArray().size() != 6) return false; for (const QJsonValue &axis : value.toArray()) { - if (!axis.isDouble() || !std::isfinite(axis.toDouble())) - return false; + if (!axis.isDouble() || !std::isfinite(axis.toDouble())) return false; } return true; } @@ -34,482 +29,441 @@ bool nonnegativeInteger(const QJsonValue &value) return value.isDouble() && std::isfinite(value.toDouble()) && value.toDouble() >= 0 && std::floor(value.toDouble()) == value.toDouble(); } + +QString epochToIso(const QJsonValue &value) +{ + if (!value.isDouble() || !std::isfinite(value.toDouble())) return QString(); + return QDateTime::fromMSecsSinceEpoch(qint64(value.toDouble()), Qt::UTC) + .toString(Qt::ISODateWithMs); +} } VisionService::VisionService(const VisionConfig &config, QObject *parent) - : QObject(parent), m_config(config), m_socket(new QLocalSocket(this)) - , m_process(new QProcess(this)), m_connectTimer(new QTimer(this)) - , m_pollTimer(new QTimer(this)), m_requestTimer(new QTimer(this)) - , m_initializeTimer(new QTimer(this)), m_ready(false), m_busy(false) - , m_productionActive(false), m_diagnostic(false), m_connecting(false) - , m_shuttingDown(false) + : QObject(parent), m_config(config), m_thread(new QThread(this)) + , m_worker(new VisionDllWorker), m_requestTimer(new QTimer(this)) + , m_avoidanceTimer(new QTimer(this)), m_avoidanceTimeout(new QTimer(this)) { qRegisterMetaType("QJsonObject"); - m_connectTimer->setInterval(200); - m_pollTimer->setInterval(1000); m_requestTimer->setSingleShot(true); - m_initializeTimer->setSingleShot(true); - connect(m_connectTimer, &QTimer::timeout, this, &VisionService::connectAttempt); - connect(m_socket, &QLocalSocket::connected, this, [this]() { - m_startIfUnavailable = false; - m_connectTimer->stop(); - m_buffer.clear(); - m_session.clear(); - m_helloId = sendCommand("hello"); - m_lastReply.start(); - m_pollTimer->start(); - }); - connect(m_socket, &QLocalSocket::readyRead, this, &VisionService::readMessages); - connect(m_socket, &QLocalSocket::disconnected, this, [this]() { - if (m_disconnectRequested) { - finishDisconnect(); - return; - } - if (m_connecting) { - // The previous controller may still be disconnecting. Retry hello - // within the original deadline without launching another process. - m_pollTimer->stop(); - m_commands.clear(); - m_helloId.clear(); - m_buffer.clear(); - m_connectTimer->start(); - } else { - failConnection("视觉进程连接已断开"); - } - }); - // Qt 5.14 exposes error(...), not the newer errorOccurred socket signal. - connect(m_socket, QOverload::of(&QLocalSocket::error), - this, [this](QLocalSocket::LocalSocketError error) { - if (m_connecting && m_startIfUnavailable) { - m_startIfUnavailable = false; - if (error == QLocalSocket::ServerNotFoundError || error == QLocalSocket::ConnectionRefusedError) - launchProcess(); - else - failConnection(m_socket->errorString()); - return; - } - if (!m_connecting) - failConnection(m_socket->errorString()); - }); - connect(m_pollTimer, &QTimer::timeout, this, [this]() { - const int limit = m_session.isEmpty() ? m_config.startupTimeoutMs : 5000; - if (m_lastReply.isValid() && m_lastReply.elapsed() > limit) { - failConnection("视觉进程未回应状态查询"); - return; - } - if (!m_session.isEmpty()) { - for (auto it = m_commands.constBegin(); it != m_commands.constEnd(); ++it) { - if (it.value() == "get_status") - return; - } - sendCommand("get_status"); - } + m_avoidanceTimer->setSingleShot(true); + m_avoidanceTimeout->setSingleShot(true); + connect(m_avoidanceTimer, &QTimer::timeout, this, &VisionService::pollAvoidance); + connect(m_avoidanceTimeout, &QTimer::timeout, this, [this]() { + if (m_avoidanceRequestId.isEmpty()) return; + m_avoidanceDiscarded = true; + m_worker->cancelOperation(m_avoidanceRequestId); + logAvoidance("ERROR", "避障检测超时,等待 DLL 结束本次操作后重试"); }); + m_worker->moveToThread(m_thread); + connect(m_thread, &QThread::finished, m_worker, &QObject::deleteLater); + connect(m_worker, &VisionDllWorker::sdkLoaded, + this, &VisionService::onSdkLoaded, Qt::QueuedConnection); + connect(m_worker, &VisionDllWorker::devicesInitialized, + this, &VisionService::onDevicesInitialized, Qt::QueuedConnection); + connect(m_worker, &VisionDllWorker::operationCompleted, + this, &VisionService::onOperationCompleted, Qt::QueuedConnection); + connect(m_worker, &VisionDllWorker::released, + this, &VisionService::onReleased, Qt::QueuedConnection); + connect(m_worker, &VisionDllWorker::logMessage, + this, &VisionService::logMessage, Qt::QueuedConnection); connect(m_requestTimer, &QTimer::timeout, this, [this]() { const QString id = m_request.value("request_id").toString(); - if (!id.isEmpty()) { - m_cancelledRequests.insert(id); - sendCommand("cancel", QJsonObject{{"target_request_id", id}}); - failMeasurement("CLIENT_TIMEOUT", "视觉测量及抓取计算等待超时,结果已作废"); - } - }); - connect(m_initializeTimer, &QTimer::timeout, this, [this]() { - failConnection("视觉初始化等待超时,请核对视觉程序状态后重新连接"); - }); - connect(m_process, &QProcess::errorOccurred, this, [this](QProcess::ProcessError) { - emit logMessage("视觉进程启动/运行失败:" + m_process->errorString()); - if (m_process->state() == QProcess::NotRunning) - failConnection(m_process->errorString()); - }); - connect(m_process, QOverload::of(&QProcess::finished), - this, [this](int code, QProcess::ExitStatus status) { - emit logMessage(QString("视觉子进程已退出,退出码 %1").arg(code)); - // A simultaneous launch can lose the instance lock. Keep waiting for - // the winning process rather than aborting its pending IPC connection. - if (m_connecting && code == 0 && status == QProcess::NormalExit) - return; - if (m_serverProcessId == QString::number(m_process->processId()) || m_connecting) - failConnection("视觉子进程已退出"); - }); - connect(m_process, &QProcess::readyReadStandardError, this, [this]() { - const QString text = QString::fromLocal8Bit(m_process->readAllStandardError()).trimmed(); - if (!text.isEmpty()) emit logMessage(text.left(4096)); - }); - connect(m_process, &QProcess::readyReadStandardOutput, this, [this]() { - m_process->readAllStandardOutput(); + if (id.isEmpty()) return; + m_cancelledRequests.insert(id); + QString cancelError; + m_worker->cancelOperation(id, &cancelError); + if (!cancelError.isEmpty()) emit logMessage(cancelError); + failRequest("CLIENT_TIMEOUT", "视觉识别等待超时,本次结果已作废"); }); + m_thread->start(); } VisionService::~VisionService() { - QElapsedTimer deadline; - deadline.start(); shutdown(); - // Destruction cannot rely on the GUI event loop to deliver shutdown or reap - // the child. Normal operation stays asynchronous; only teardown is bounded. - m_socket->disconnect(this); - m_process->disconnect(this); - while (m_socket->bytesToWrite() > 0 && deadline.elapsed() < 3000) { - if (!m_socket->waitForBytesWritten(int(3000 - deadline.elapsed()))) - break; - } - // This QProcess only owns the child we spawned, never an attached instance. - if (m_process->state() != QProcess::NotRunning - && !m_process->waitForFinished(qMax(0, int(3000 - deadline.elapsed())))) { - m_process->kill(); - m_process->waitForFinished(1000); - } + if (m_thread->isRunning()) m_thread->wait(); } QJsonObject VisionService::standardParameters() { return {{"camera_mode", "left_only"}, {"refinement", "least_squares_high"}, - {"deadline_ms", 5000}, {"min_score", 0.70}, {"greediness", 0.80}, + {"deadline_ms", 30000}, {"min_score", 0.70}, {"greediness", 0.80}, {"yolo_selection", "center"}, {"pose_display", "model_origin"}, {"grasp_offset_mm", 4.40}}; } QJsonObject VisionService::standardConvention() { - return {{"frame", "world"}, {"tool", "TOOL1"}, {"rotation", "Rz(A)Ry(B)Rx(C)"}, - {"linear_unit", "mm"}, {"angular_unit", "deg"}}; + return {{"frame", "world"}, {"tool", "TOOL1"}, + {"rotation", "Rz(A)Ry(B)Rx(C)"}, {"linear_unit", "mm"}, + {"angular_unit", "deg"}}; +} + +bool VisionService::isEnabled() const +{ + return m_config.enabled; +} + +bool VisionService::isReady() const +{ + return isEnabled() && m_ready && !m_session.isEmpty(); +} + +bool VisionService::isBusy() const +{ + return m_loading || m_initializing || m_releasing || m_workerBusy + || !m_avoidanceRequestId.isEmpty(); } -bool VisionService::isReady() const { return m_ready && !m_session.isEmpty(); } -bool VisionService::isBusy() const { return m_busy || !m_request.isEmpty() || !m_initializeId.isEmpty(); } bool VisionService::canInitialize() const { - return !m_session.isEmpty() && !isBusy() && (!m_productionActive || m_maintenanceAllowed); -} -QString VisionService::sessionId() const { return m_session; } - -void VisionService::connectService() -{ - beginConnection("connect", false); + return isEnabled() && !m_session.isEmpty() && !isBusy() + && (!m_productionActive || m_maintenanceAllowed); } -void VisionService::beginConnection(const QString &operation, bool startIfUnavailable) +QString VisionService::sessionId() const { - if (!m_session.isEmpty()) { - emit operationFeedback(operation, "success", "视觉程序已连接"); - return; - } - if (m_connecting || m_socket->state() != QLocalSocket::UnconnectedState) { - emit operationFeedback(operation, "info", "视觉程序正在连接,请稍候"); - return; - } - m_shuttingDown = false; - m_connectionOperation = operation; - m_startIfUnavailable = startIfUnavailable; - m_connecting = true; - m_connectElapsed.start(); - m_connectTimer->start(); - connectAttempt(); -} - -void VisionService::disconnectService() -{ - if (m_productionActive && !m_maintenanceAllowed) { - const QString message = "请先停止生产,再断开视觉控制连接"; - emit logMessage(message); - emit operationFeedback("disconnect", "error", message); - return; - } - if (!m_connecting && m_session.isEmpty() - && m_socket->state() == QLocalSocket::UnconnectedState) { - emit operationFeedback("disconnect", "info", "视觉控制未连接"); - return; - } - m_disconnectRequested = true; - m_disconnectCanceledConnection = m_connecting && m_session.isEmpty(); - if (!m_request.isEmpty()) cancel(m_request.value("request_id").toString()); - m_startIfUnavailable = false; - m_connecting = false; - m_connectTimer->stop(); - m_pollTimer->stop(); - m_socket->disconnectFromServer(); - if (m_socket->state() == QLocalSocket::UnconnectedState) - finishDisconnect(); + return m_session; } void VisionService::startService() { - beginConnection("start", m_process->state() == QProcess::NotRunning); + if (m_shuttingDown) return; + if (!isEnabled()) { + emit operationFeedback("start", "info", "视觉功能未启用(vision/enabled=false)"); + return; + } + m_avoidanceEnabled = true; + m_avoidanceTimer->start(0); + if (!m_session.isEmpty()) { + emit operationFeedback("start", "success", "视觉 DLL 已加载"); + return; + } + if (isBusy()) { + emit operationFeedback("start", "info", "视觉 DLL 正在处理其他操作"); + return; + } + m_loading = true; + publishAvailability(); + QMetaObject::invokeMethod(m_worker, "loadSdk", Qt::QueuedConnection, + Q_ARG(QString, m_config.sdkRoot), + Q_ARG(int, m_config.initializeTimeoutMs)); } -void VisionService::finishDisconnect() +void VisionService::onSdkLoaded(bool success, const QJsonObject &status, + const QString &message) { - const bool canceledConnection = m_disconnectCanceledConnection; - m_disconnectRequested = false; - m_disconnectCanceledConnection = false; - failConnection(canceledConnection ? "视觉连接已取消" - : "视觉控制连接已断开,可在视觉窗口手动调试"); - emit operationFeedback("disconnect", "success", - canceledConnection ? "视觉连接已取消" : "视觉控制已断开"); -} - -void VisionService::launchProcess() -{ - if (!m_connecting || m_shuttingDown) - return; - const QFileInfo executable(m_config.executablePath); - if (!executable.isFile()) { - failConnection("请在 config.ini 配置有效的 VisionGuide executablePath"); - return; - } - QProcessEnvironment environment = QProcessEnvironment::systemEnvironment(); - environment.remove("QT_PLUGIN_PATH"); - environment.remove("QT_QPA_PLATFORM_PLUGIN_PATH"); - environment.remove("QML2_IMPORT_PATH"); - environment.remove("QML_IMPORT_PATH"); - QStringList cleanPath; - for (const QString &entry : environment.value("PATH").split(';', QString::SkipEmptyParts)) { - // Qt kits injected by Creator must not override the MSVC runtime beside the child. - if (!QFileInfo(QDir(entry).filePath("Qt5Core.dll")).exists() - && !entry.contains("mingw", Qt::CaseInsensitive)) - cleanPath.append(entry); - } - cleanPath.prepend(executable.absolutePath()); - environment.insert("PATH", cleanPath.join(';')); - m_process->setProcessEnvironment(environment); - m_process->setWorkingDirectory(executable.absolutePath()); - ++m_processGeneration; - m_connectElapsed.restart(); - m_process->start(executable.absoluteFilePath(), - QStringList() << "--ipc-name" << m_config.ipcName << "--background"); -} - -void VisionService::connectAttempt() -{ - if (m_connectElapsed.elapsed() >= m_config.startupTimeoutMs) { - failConnection("连接视觉进程超时,请核对程序路径和 IPC 名称"); - return; - } - if (m_socket->state() == QLocalSocket::UnconnectedState) - m_socket->connectToServer(m_config.ipcName); -} - -QString VisionService::sendCommand(const QString &type, QJsonObject payload) -{ - const QString id = newId(); - payload.insert("protocol_version", 1); - payload.insert("type", type); - payload.insert("request_id", id); - payload.insert("server_session_id", m_session); - m_commands.insert(id, type); - if (!sendMessage(payload)) { - m_commands.remove(id); - return QString(); - } - return id; -} - -bool VisionService::sendMessage(const QJsonObject &message) -{ - if (m_socket->state() != QLocalSocket::ConnectedState) - return false; - const QByteArray payload = QJsonDocument(message).toJson(QJsonDocument::Compact); - if (payload.isEmpty() || payload.size() > int(MaxMessageSize)) - return false; - QByteArray frame(4, 0); - qToBigEndian(quint32(payload.size()), reinterpret_cast(frame.data())); - frame.append(payload); - return m_socket->write(frame) == frame.size(); -} - -void VisionService::readMessages() -{ - if (m_shuttingDown) { - if (m_socket->isOpen()) m_socket->readAll(); - return; - } - m_buffer.append(m_socket->readAll()); - while (m_buffer.size() >= 4) { - const quint32 size = qFromBigEndian(reinterpret_cast(m_buffer.constData())); - if (size == 0 || size > MaxMessageSize) { - failConnection("视觉通信帧长度无效"); - return; - } - if (m_buffer.size() < int(size) + 4) - return; - QJsonParseError error; - const QJsonDocument document = QJsonDocument::fromJson(m_buffer.mid(4, int(size)), &error); - m_buffer.remove(0, int(size) + 4); - if (error.error != QJsonParseError::NoError || !document.isObject()) { - failConnection("视觉通信 JSON 无效"); - return; - } - handleMessage(document.object()); - if (m_socket->state() != QLocalSocket::ConnectedState) - return; - } -} - -void VisionService::handleMessage(const QJsonObject &message) -{ - const QString type = message.value("type").toString(); - const QString id = message.value("request_id").toString(); - const QString session = message.value("server_session_id").toString(); - const QString status = message.value("status").toString(); - if (message.value("protocol_version").toDouble() != 1 || !message.value("request_id").isString() - || session.isEmpty() || !message.value("ready").isBool() - || !message.value("resource_busy").isBool()) { - failConnection("视觉通信版本或公共字段无效"); - return; - } - if (type == "hello") { - if (id != m_helloId || m_helloId.isEmpty() || !m_session.isEmpty() || status != "ok") { - failConnection("视觉握手响应无效"); - return; - } - m_session = session; - m_serverProcessId = message.value("server_process_id").toString(); - m_commands.remove(id); - m_helloId.clear(); - m_connecting = false; - m_lastReply.restart(); - updateAvailability(message); - emit logMessage("视觉通信已连接,等待初始化/就绪"); - const QString operation = m_connectionOperation; - m_connectionOperation.clear(); - if (!operation.isEmpty()) - emit operationFeedback(operation, "success", "视觉程序已连接"); - return; - } - // The server may publish its initial state immediately after accepting the socket. - // Only hello establishes the session; an earlier status must not establish it. - if (m_session.isEmpty() && type == "status" && id.isEmpty()) - return; - if (session != m_session || m_session.isEmpty()) { - failConnection("视觉进程会话已变化,本次结果不可用"); - return; - } - if (type == "measure") { - if (m_request.isEmpty() || id != m_request.value("request_id").toString()) - return; // Cancelled, timed-out and previous-cycle results cannot become current. - if (status == "accepted") { - m_busy = true; - publishAvailability(); - return; - } - if (status != "ok" && status != "error" && status != "cancelled" && status != "timeout") { - failConnection("未知的视觉测量终态"); - return; - } - m_lastReply.restart(); - updateAvailability(message); - QString error; - if (status == "ok" && !validateResult(message, &error)) { - failMeasurement("INVALID_RESULT", error); - return; - } - finishMeasurement(message); - return; - } - if (type == "status") { - if (!id.isEmpty()) return; + m_loading = false; + if (m_releasing || m_shuttingDown) return; + if (success) { + m_session = newId(); + emit statusChanged(status); + emit logMessage(message); + emit operationFeedback("start", "success", message); } else { - if (!m_commands.contains(id) || m_commands.value(id) != type) - return; - if (status != "accepted") m_commands.remove(id); + m_session.clear(); + m_ready = false; + emit logMessage(message); + emit operationFeedback("start", "error", message); } - m_lastReply.restart(); - updateAvailability(message); - if (type == "initialize" && id == m_initializeId && status != "accepted") { - m_initializeTimer->stop(); - m_initializeId.clear(); - const QString detail = message.value("message").toString(); - const QString text = status == "ok" ? "视觉初始化完成" - : "视觉初始化失败:" + (detail.isEmpty() ? "视觉程序未返回失败原因" : detail); - emit logMessage(text); - emit operationFeedback("initialize", status == "ok" ? "success" : "error", text); - publishAvailability(); + publishAvailability(); + if (m_avoidanceEnabled) { + if (!success) logAvoidance("ERROR", "避障检测未启动:" + message); + m_avoidanceTimer->start(success ? 0 : 5000); } - if (type == "show_window" && id == m_showWindowId && status != "accepted") { - m_showWindowId.clear(); - const QString detail = message.value("message").toString(); - emit operationFeedback("show_window", status == "ok" ? "success" : "error", - status == "ok" ? "显示窗口命令已受理" - : "显示窗口失败:" + (detail.isEmpty() - ? "视觉程序未返回失败原因" : detail)); - } - if (status == "error") - emit logMessage(message.value("error_code").toString() + ":" + message.value("message").toString()); } void VisionService::initialize() { if (!canInitialize()) { - const QString message = "初始化需要已连接、资源空闲且生产已停止"; + const QString message = !isEnabled() ? "视觉功能未启用(vision/enabled=false)" + : "初始化需要 DLL 已加载、资源空闲且生产已停止"; emit logMessage(message); emit operationFeedback("initialize", "error", message); return; } m_ready = false; - m_initializeId = sendCommand("initialize"); - if (m_initializeId.isEmpty()) { - emit operationFeedback("initialize", "error", "发送视觉初始化命令失败"); - } else { - m_initializeTimer->start(m_config.initializeTimeoutMs); - } + m_initializing = true; publishAvailability(); + QMetaObject::invokeMethod(m_worker, "initializeDevices", Qt::QueuedConnection, + Q_ARG(int, m_config.initializeTimeoutMs)); } -void VisionService::measure(const QJsonObject &request) { requestMeasurement(request, false); } -void VisionService::diagnose(const QJsonObject &request) { requestMeasurement(request, true); } - -void VisionService::requestMeasurement(QJsonObject request, bool diagnostic) +void VisionService::onDevicesInitialized(bool success, const QJsonObject &status, + const QString &message) { + m_initializing = false; + if (m_releasing || m_shuttingDown) return; + m_ready = success; + if (!status.isEmpty()) emit statusChanged(status); + emit logMessage(message); + emit operationFeedback("initialize", success ? "success" : "error", message); + publishAvailability(); + if (m_avoidanceEnabled) { + if (!success) logAvoidance("ERROR", "避障设备初始化失败:" + message); + m_avoidanceTimer->start(success ? 0 : 5000); + } +} + +void VisionService::pollAvoidance() +{ + if (!isEnabled() || !m_avoidanceEnabled || m_shuttingDown || m_releasing) return; + if (!std::isfinite(m_config.warningDistanceMm) + || m_config.warningDistanceMm < 1 || m_config.warningDistanceMm > 5000) { + logAvoidance("ERROR", "避障配置无效:vision/warningDistanceMm 必须在 1~5000 mm 范围内"); + return; + } + if (isBusy()) { + m_avoidanceTimer->start(500); + return; + } + if (m_session.isEmpty()) { + startService(); + return; + } + if (!isReady()) { + // Automatic camera recovery does not send PLC or robot commands. + m_initializing = true; + publishAvailability(); + QMetaObject::invokeMethod(m_worker, "initializeDevices", Qt::QueuedConnection, + Q_ARG(int, m_config.initializeTimeoutMs)); + return; + } + m_avoidanceRequestId = newId(); + m_avoidanceDiscarded = false; + const QJsonObject request{{"request_id", m_avoidanceRequestId}, {"input_source", "camera"}, + {"threshold_mm", m_config.warningDistanceMm}, {"max_time_ms", m_config.requestTimeoutMs}}; + publishAvailability(); + QMetaObject::invokeMethod(m_worker, "planAvoidance", Qt::QueuedConnection, + Q_ARG(QJsonObject, request)); + m_avoidanceTimeout->start(m_config.requestTimeoutMs); +} + +void VisionService::finishAvoidance(int code, const QJsonObject &result) +{ + m_avoidanceTimeout->stop(); + const QString requestId = m_avoidanceRequestId; + m_avoidanceRequestId.clear(); + if (!m_avoidanceDiscarded && m_avoidanceEnabled && !m_shuttingDown && !m_releasing) { + const double distance = result.value("distance_mm").toDouble(); + const bool warning = distance < m_config.warningDistanceMm; + if (code != HVG_OK) { + logAvoidance("ERROR", QString("避障检测失败(code=%1):%2") + .arg(code).arg(result.value("message").toString())); + if (code == HVG_NOT_READY || code == HVG_DEVICE_ERROR || code == HVG_CONFIG_ERROR) + m_ready = false; + } else if (result.value("schema_version").toDouble() != 1 + || !result.value("success").toBool() + || !result.value("code").isDouble() || result.value("code").toDouble() != HVG_OK + || result.value("request_id").toString() != requestId + || !result.value("distance_valid").toBool() + || !result.value("distance_mm").isDouble() || !std::isfinite(distance) || distance <= 0 + || result.value("threshold_mm").toDouble() != m_config.warningDistanceMm + || !result.value("warning").isBool() || result.value("warning").toBool() != warning + || result.value("state").toString() != (warning ? "WARNING" : "SAFE")) { + logAvoidance("ERROR", "避障检测结果无效,距离或状态不可用"); + } else { + logAvoidance(warning ? "WARNING" : "SAFE", QString("%1:距离 %2 mm,预警阈值 %3 mm") + .arg(warning ? "避障距离预警" : "避障距离安全") + .arg(distance, 0, 'f', 2).arg(m_config.warningDistanceMm, 0, 'f', 2)); + } + } + publishAvailability(); + if (m_avoidanceEnabled && !m_shuttingDown && !m_releasing) + m_avoidanceTimer->start(isReady() ? 500 : 5000); +} + +void VisionService::logAvoidance(const QString &state, const QString &message) +{ + const QString key = state == "ERROR" ? state + message : state; + if (key == m_avoidanceLogKey) return; + m_avoidanceLogKey = key; + emit avoidanceLog(state == "WARNING" ? "预警" : state == "SAFE" ? "安全" : "失败", message); +} + +void VisionService::measure(const QJsonObject &request) +{ + requestOperation(request, false); +} + +void VisionService::recognizeGrooves(const QJsonObject &request) +{ + requestOperation(request, false, true); +} + +void VisionService::diagnose(const QJsonObject &request) +{ + requestOperation(request, true); +} + +void VisionService::requestOperation(QJsonObject request, bool diagnostic, bool grooves) +{ + const QString type = grooves ? "recognize_grooves" : "measure"; const QString id = request.value("request_id").toString(); - if (!id.isEmpty() && (m_completedRequests.contains(id) - || (!m_request.isEmpty() && m_request.value("request_id").toString() == id))) { + if (!id.isEmpty() && (m_completedRequests.contains(id) || m_activeWorkerRequest == id)) { emit logMessage("忽略重复的视觉请求编号:" + id); return; } + QString error; const QJsonObject context = request.value("context").toObject(); const double tray = context.value("tray_no").toDouble(); - if (id.isEmpty() || m_cancelledRequests.contains(id)) error = "请求编号为空或已取消"; - else if (m_session.isEmpty() || !m_request.isEmpty() || !m_initializeId.isEmpty() - || (m_busy && !m_backendInitializing)) error = "视觉未连接或仍在处理上一任务"; - else if (m_maintenanceAllowed) error = "视觉维护期间只允许初始化,请完成人工核对后再测量"; + if (!isEnabled()) error = "视觉功能未启用(vision/enabled=false)"; + else if (id.isEmpty() || m_cancelledRequests.contains(id)) error = "请求编号为空或已取消"; + else if (!isReady() || m_loading || m_initializing || m_releasing || m_workerBusy) + error = "视觉 DLL 未就绪或仍在处理上一任务"; + else if (m_maintenanceAllowed) error = "视觉维护期间只允许初始化"; else if (diagnostic == m_productionActive) error = "诊断与自动生产不可同时执行"; - else if (!diagnostic && request.value("server_session_id").toString() != m_session) error = "生产请求会话已失效"; - else if (!validPose(request.value("robot_pose"))) error = "拍照位姿须为6个有限数值"; + else if (!diagnostic && request.value("server_session_id").toString() != m_session) + error = "生产请求会话已失效"; + else if (!grooves && !validPose(request.value("robot_pose"))) error = "拍照位姿须为6个有限数值"; else if (context.value("workpiece_id").toString().isEmpty() || context.value("task_id").toString().isEmpty() || context.value("generation").toString().isEmpty() - || tray < 1 || tray > 99 || std::floor(tray) != tray) error = "工件/任务/料盘上下文无效"; - else if (request.value("parameters").toObject() != standardParameters() - || request.value("convention").toObject() != standardConvention()) error = "测量参数或机器人坐标约定不匹配"; - else if (!request.value("require_robot_pose").toBool() + || tray < 1 || tray > 99 || std::floor(tray) != tray) + error = "工件/任务/料盘上下文无效"; + else if (!grooves && (request.value("parameters").toObject() != standardParameters() + || request.value("convention").toObject() != standardConvention())) + error = "测量参数或机器人坐标约定不匹配"; + else if (!grooves && (!request.value("require_robot_pose").toBool() || request.value("pose_source").toString() != (diagnostic ? "diagnostic" : "plc_r40") - || !QDateTime::fromString(request.value("pose_read_at").toString(), Qt::ISODate).isValid()) error = "拍照位姿来源或采集时间无效"; + || !QDateTime::fromString(request.value("pose_read_at").toString(), Qt::ISODate).isValid())) + error = "拍照位姿来源或采集时间无效"; + if (!error.isEmpty()) { if (!id.isEmpty()) m_completedRequests.insert(id); QJsonObject result = request; - result.insert("type", "measure"); + result.insert("type", type); result.insert("status", "error"); result.insert("error_code", "REQUEST_REJECTED"); result.insert("message", error); + result.insert("camera_valid", false); result.insert("robot_valid", false); - emit measurementFinished(result); + result.insert("occupancy_valid", false); + if (grooves) emit groovesRecognized(result); + else emit measurementFinished(result); emit logMessage(error); return; } + request.insert("protocol_version", 1); - request.insert("type", "measure"); + request.insert("type", type); request.insert("server_session_id", m_session); m_request = request; m_diagnostic = diagnostic; - m_busy = true; - emit requestStarted(request); + m_workerBusy = true; + m_activeWorkerRequest = id; + // Foreground recognition takes priority; the worker queues it after the current DLL call. + if (!m_avoidanceRequestId.isEmpty()) { + m_avoidanceDiscarded = true; + m_avoidanceTimeout->stop(); + m_worker->cancelOperation(m_avoidanceRequestId); + } + if (!grooves) emit requestStarted(request); publishAvailability(); - if (!sendMessage(request)) { - failConnection("发送视觉测量请求失败"); + QMetaObject::invokeMethod(m_worker, grooves ? "recognizeGrooves" : "measure", Qt::QueuedConnection, + Q_ARG(QJsonObject, dllRequest(request))); + m_requestTimer->start(m_config.requestTimeoutMs); +} + +QJsonObject VisionService::dllRequest(const QJsonObject &request) const +{ + if (request.value("type").toString() == "recognize_grooves") { + return {{"request_id", request.value("request_id")}, {"mode", "occupancy"}, + {"input_source", "camera"}, {"camera", "left"}, + {"confidence", 0.25}, {"nms", 0.45}, + {"max_time_ms", m_config.requestTimeoutMs}}; + } + const QJsonObject parameters = request.value("parameters").toObject(); + const QJsonObject context = request.value("context").toObject(); + return { + {"request_id", request.value("request_id")}, {"input_source", "camera"}, + {"camera_mode", "left"}, {"max_time_ms", parameters.value("deadline_ms")}, + {"refinement", "high"}, {"min_score", parameters.value("min_score")}, + {"greediness", parameters.value("greediness")}, {"target_selection", 0}, + {"grasp_offset_mm", parameters.value("grasp_offset_mm")}, + {"tray_id", context.value("tray_no")}, {"z_strategy", "plane_xy"}, + {"compute_grasp", true}, + {"robot_pose_at_capture", QJsonObject{ + {"XYZABC_mm_deg", request.value("robot_pose")}, {"frame_id", "world"}, + {"tool_id", "TOOL1"}, {"capture_pose_confirmed", true}, + {"source", request.value("pose_source")} + }} + }; +} + +QJsonObject VisionService::adaptResult(int code, const QJsonObject &dllResult) const +{ + QJsonObject result = m_request; + result.insert("type", "measure"); + result.insert("status", code == HVG_OK ? "ok" : code == HVG_TIMEOUT ? "timeout" + : code == HVG_CANCELLED ? "cancelled" : "error"); + result.insert("error_code", code); + result.insert("message", dllResult.value("message")); + result.insert("camera_valid", dllResult.value("vision_valid")); + result.insert("robot_valid", dllResult.value("grasp_valid")); + result.insert("camera_pose", dllResult.value("object_pose_camera").toObject() + .value("XYZABC_mm_deg")); + result.insert("robot_pose", dllResult.value("robot_grasp_pose").toObject() + .value("XYZABC_mm_deg")); + result.insert("source", dllResult.value("actual_source")); + result.insert("score", dllResult.value("score")); + result.insert("config_revision", dllResult.value("config_revision")); + result.insert("run_id", dllResult.value("run_id")); + result.insert("elapsed_ms", dllResult.value("elapsed_ms")); + const QJsonObject capture = dllResult.value("capture").toObject(); + result.insert("capture_begin", epochToIso(capture.value("begin_epoch_ms"))); + result.insert("capture_end", epochToIso(capture.value("end_epoch_ms"))); + return result; +} + +void VisionService::onOperationCompleted(const QString &requestId, int code, + const QJsonObject &dllResult) +{ + if (!m_avoidanceRequestId.isEmpty() && requestId == m_avoidanceRequestId) { + finishAvoidance(code, dllResult); return; } - m_requestTimer->start(int(qMin(2147483647, qint64(m_config.requestTimeoutMs) + 2LL * m_config.initializeTimeoutMs))); + if (requestId != m_activeWorkerRequest) return; + m_activeWorkerRequest.clear(); + m_workerBusy = false; + if (code == HVG_NOT_READY || code == HVG_DEVICE_ERROR || code == HVG_CONFIG_ERROR) + m_ready = false; + if (m_request.isEmpty() || m_cancelledRequests.contains(requestId)) { + publishAvailability(); + return; + } + if (m_request.value("type").toString() == "recognize_grooves") { + if (code != HVG_OK) { + failRequest(QString::number(code), "凹槽识别调用失败:" + dllResult.value("message").toString()); + return; + } + if (dllResult.value("schema_version").toDouble() != 1 + || !dllResult.value("success").toBool() + || !dllResult.value("code").isDouble() || dllResult.value("code").toDouble() != HVG_OK + || dllResult.value("request_id").toString() != requestId + || !dllResult.value("vision_valid").toBool() + || !dllResult.value("occupancy_valid").toBool() + || !dllResult.value("grooves").isArray()) { + failRequest("INVALID_RESULT", "凹槽识别结果无效,禁止放料"); + return; + } + QJsonObject result = m_request; + result.insert("status", "ok"); + result.insert("occupancy_valid", true); + result.insert("grooves", dllResult.value("grooves")); + finishRequest(result); + return; + } + const QJsonObject result = adaptResult(code, dllResult); + if (code == HVG_OK) { + QString error; + if (!validateResult(result, &error)) { + failRequest("INVALID_RESULT", error); + return; + } + } + finishRequest(result); } bool VisionService::validateResult(const QJsonObject &result, QString *error) const @@ -517,21 +471,19 @@ bool VisionService::validateResult(const QJsonObject &result, QString *error) co const QDateTime begin = QDateTime::fromString(result.value("capture_begin").toString(), Qt::ISODate); const QDateTime end = QDateTime::fromString(result.value("capture_end").toString(), Qt::ISODate); const bool valid = result.value("context").toObject() == m_request.value("context").toObject() - && result.value("camera_valid").isBool() && result.value("camera_valid").toBool() - && result.value("robot_valid").isBool() && result.value("robot_valid").toBool() + && result.value("camera_valid").toBool() && result.value("robot_valid").toBool() && validPose(result.value("camera_pose")) && validPose(result.value("robot_pose")) && result.value("source").toString() == "LEFT" - && result.value("pose_type").toString() == "model_origin" && result.value("parameters").toObject() == m_request.value("parameters").toObject() && result.value("convention").toObject() == m_request.value("convention").toObject() && result.value("score").isDouble() && std::isfinite(result.value("score").toDouble()) && result.value("score").toDouble() >= 0.70 && result.value("score").toDouble() <= 1.0 - && !result.value("calibration_fingerprint").toString().isEmpty() + && !result.value("config_revision").toString().isEmpty() && !result.value("run_id").toString().isEmpty() && begin.isValid() && end.isValid() && begin <= end - && nonnegativeInteger(result.value("measure_elapsed_ms")) - && nonnegativeInteger(result.value("grasp_elapsed_ms")); - if (!valid && error) *error = "视觉结果坐标、上下文、参数或有效性校验失败,禁止提交机器人"; + && nonnegativeInteger(result.value("elapsed_ms")); + if (!valid && error) + *error = "视觉结果坐标、上下文、参数或有效性校验失败,禁止提交机器人"; return valid; } @@ -539,75 +491,90 @@ void VisionService::cancel(const QString &requestId) { if (requestId.isEmpty()) return; m_cancelledRequests.insert(requestId); - if (m_request.value("request_id").toString() != requestId) return; - sendCommand("cancel", QJsonObject{{"target_request_id", requestId}}); - failMeasurement("CANCELLED", "本次视觉结果已取消,等待底层资源释放"); + if (m_activeWorkerRequest != requestId) return; + QString error; + m_worker->cancelOperation(requestId, &error); + if (!error.isEmpty()) emit logMessage(error); + failRequest("CANCELLED", "本次视觉结果已取消,等待 DLL 释放底层资源"); } void VisionService::setProductionActive(bool active, bool maintenanceAllowed) { m_productionActive = active; m_maintenanceAllowed = active && maintenanceAllowed; - if (!m_request.isEmpty() && (m_maintenanceAllowed || (active && m_diagnostic) || (!active && !m_diagnostic))) + if (!m_request.isEmpty() + && (m_maintenanceAllowed || (active && m_diagnostic) || (!active && !m_diagnostic))) cancel(m_request.value("request_id").toString()); publishAvailability(); } -void VisionService::showWindow() +void VisionService::disconnectService() { - if (m_session.isEmpty()) { - emit operationFeedback("show_window", "error", "视觉程序未连接"); + if (m_productionActive && !m_maintenanceAllowed) { + const QString message = "请先停止生产,再释放视觉资源"; + emit logMessage(message); + emit operationFeedback("disconnect", "error", message); return; } - if (!m_showWindowId.isEmpty()) { - emit operationFeedback("show_window", "info", "显示窗口命令正在等待响应"); + beginRelease("disconnect"); +} + +void VisionService::beginRelease(const QString &operation) +{ + m_avoidanceEnabled = false; + m_avoidanceTimer->stop(); + m_avoidanceTimeout->stop(); + m_avoidanceLogKey.clear(); + if (!m_avoidanceRequestId.isEmpty()) { + m_avoidanceDiscarded = true; + m_worker->cancelOperation(m_avoidanceRequestId); + } + if (m_releasing) { + if (!operation.isEmpty()) emit operationFeedback(operation, "info", "视觉资源正在释放"); + if (m_shuttingDown) + QMetaObject::invokeMethod(m_worker, "release", Qt::QueuedConnection, + Q_ARG(bool, true)); return; } - m_showWindowId = sendCommand("show_window"); - if (m_showWindowId.isEmpty()) { - emit operationFeedback("show_window", "error", "发送显示窗口命令失败"); - return; - } - const QString requestId = m_showWindowId; - QTimer::singleShot(qMax(1, m_config.requestTimeoutMs), this, [this, requestId]() { - if (m_showWindowId != requestId) - return; - m_commands.remove(requestId); - m_showWindowId.clear(); - emit operationFeedback("show_window", "error", "等待显示窗口命令响应超时"); - }); + if (!m_activeWorkerRequest.isEmpty()) cancel(m_activeWorkerRequest); + else m_worker->cancelActiveOperation(); + m_requestTimer->stop(); + m_ready = false; + m_session.clear(); + m_releasing = true; + m_releaseOperation = operation; + publishAvailability(); + QMetaObject::invokeMethod(m_worker, "release", Qt::QueuedConnection, + Q_ARG(bool, m_shuttingDown)); +} + +void VisionService::onReleased(bool success, const QString &message) +{ + m_releasing = false; + m_workerBusy = false; + m_initializing = false; + m_loading = false; + m_activeWorkerRequest.clear(); + m_request = QJsonObject(); + m_ready = false; + m_session.clear(); + const QString operation = m_releaseOperation; + m_releaseOperation.clear(); + emit logMessage(message); + if (!operation.isEmpty()) + emit operationFeedback(operation, success ? "success" : "error", message); + publishAvailability(); } void VisionService::shutdown() { if (m_shuttingDown) return; m_shuttingDown = true; - if (!m_request.isEmpty()) cancel(m_request.value("request_id").toString()); - const bool ownsServer = m_process->state() != QProcess::NotRunning - && m_serverProcessId == QString::number(m_process->processId()) && !m_session.isEmpty(); - if (ownsServer) { - sendCommand("shutdown"); - m_socket->flush(); - const quint64 generation = m_processGeneration; - QTimer::singleShot(3000, m_process, [this, generation]() { - if (generation == m_processGeneration && m_process->state() != QProcess::NotRunning) - m_process->kill(); - }); - } - m_startIfUnavailable = false; - m_connecting = false; - m_connectTimer->stop(); - m_pollTimer->stop(); - m_initializeTimer->stop(); - // Keep the owned server's pipe open until it has read shutdown and exited. - // Closing immediately can discard unread data on Windows named pipes. - if (!ownsServer) m_socket->disconnectFromServer(); - m_ready = false; - m_session.clear(); - publishAvailability(); + if (!m_thread->isRunning()) return; + beginRelease(QString()); } -void VisionService::failMeasurement(const QString &code, const QString &message) +void VisionService::failRequest(const QString &code, const QString &message) { if (m_request.isEmpty()) return; QJsonObject result = m_request; @@ -616,59 +583,18 @@ void VisionService::failMeasurement(const QString &code, const QString &message) result.insert("message", message); result.insert("camera_valid", false); result.insert("robot_valid", false); - result.insert("resource_busy", m_busy); - finishMeasurement(result); + result.insert("occupancy_valid", false); + finishRequest(result); } -void VisionService::finishMeasurement(const QJsonObject &result) +void VisionService::finishRequest(const QJsonObject &result) { m_requestTimer->stop(); - m_completedRequests.insert(result.value("request_id").toString()); + const QString requestId = result.value("request_id").toString(); + if (!requestId.isEmpty()) m_completedRequests.insert(requestId); m_request = QJsonObject(); - emit measurementFinished(result); - publishAvailability(); -} - -void VisionService::failConnection(const QString &message) -{ - const bool hadConnection = m_connecting || !m_session.isEmpty() || !m_request.isEmpty(); - const QString connectionOperation = m_connectionOperation; - const bool initializationPending = !m_initializeId.isEmpty(); - const bool showWindowPending = !m_showWindowId.isEmpty(); - m_startIfUnavailable = false; - m_connecting = false; - m_connectTimer->stop(); - m_pollTimer->stop(); - m_initializeTimer->stop(); - m_ready = false; - m_busy = false; - m_initializeId.clear(); - m_connectionOperation.clear(); - m_showWindowId.clear(); - m_commands.clear(); - m_session.clear(); - m_serverProcessId.clear(); - m_buffer.clear(); - failMeasurement("DISCONNECTED", message); - m_socket->abort(); - publishAvailability(); - if (hadConnection && !m_shuttingDown) { - emit logMessage(message); - if (!connectionOperation.isEmpty()) - emit operationFeedback(connectionOperation, "error", message); - if (initializationPending) - emit operationFeedback("initialize", "error", message); - if (showWindowPending) - emit operationFeedback("show_window", "error", message); - } -} - -void VisionService::updateAvailability(const QJsonObject &message) -{ - m_backendInitializing = message.value("initialization_in_progress").toBool(); - m_ready = message.value("ready").toBool(); - m_busy = message.value("resource_busy").toBool(); - emit statusChanged(message); + if (result.value("type").toString() == "recognize_grooves") emit groovesRecognized(result); + else emit measurementFinished(result); publishAvailability(); } diff --git a/services/visionservice.h b/services/visionservice.h index 2caa303..98544ed 100644 --- a/services/visionservice.h +++ b/services/visionservice.h @@ -2,15 +2,14 @@ #define VISIONSERVICE_H #include "../config/configmanager.h" -#include -#include + #include #include #include -class QLocalSocket; -class QProcess; +class QThread; class QTimer; +class VisionDllWorker; class VisionService : public QObject { @@ -20,81 +19,80 @@ public: ~VisionService() override; static QJsonObject standardParameters(); static QJsonObject standardConvention(); + bool isEnabled() const; bool isReady() const; bool isBusy() const; bool canInitialize() const; QString sessionId() const; public slots: - void connectService(); void disconnectService(); void startService(); void initialize(); void measure(const QJsonObject &request); + void recognizeGrooves(const QJsonObject &request); void diagnose(const QJsonObject &request); void cancel(const QString &requestId); void setProductionActive(bool active, bool maintenanceAllowed = false); - void showWindow(); void shutdown(); signals: void measurementFinished(const QJsonObject &result); + void groovesRecognized(const QJsonObject &result); void requestStarted(const QJsonObject &request); void statusChanged(const QJsonObject &status); void availabilityChanged(bool ready, bool busy, const QString &session); void operationFeedback(const QString &operation, const QString &state, const QString &message); void logMessage(const QString &message); + void avoidanceLog(const QString &state, const QString &message); + +private slots: + void onSdkLoaded(bool success, const QJsonObject &status, const QString &message); + void onDevicesInitialized(bool success, const QJsonObject &status, + const QString &message); + void onOperationCompleted(const QString &requestId, int code, + const QJsonObject &result); + void onReleased(bool success, const QString &message); private: - void beginConnection(const QString &operation, bool startIfUnavailable); - void finishDisconnect(); - void launchProcess(); - void connectAttempt(); - void readMessages(); - void handleMessage(const QJsonObject &message); - void requestMeasurement(QJsonObject request, bool diagnostic); - QString sendCommand(const QString &type, QJsonObject payload = QJsonObject()); - bool sendMessage(const QJsonObject &message); - void failConnection(const QString &message); - void failMeasurement(const QString &code, const QString &message); - void finishMeasurement(const QJsonObject &result); - void updateAvailability(const QJsonObject &message); + void requestOperation(QJsonObject request, bool diagnostic, bool grooves = false); + QJsonObject dllRequest(const QJsonObject &request) const; + QJsonObject adaptResult(int code, const QJsonObject &dllResult) const; bool validateResult(const QJsonObject &result, QString *error) const; + void failRequest(const QString &code, const QString &message); + void finishRequest(const QJsonObject &result); void publishAvailability(); + void beginRelease(const QString &operation); + void pollAvoidance(); + void finishAvoidance(int code, const QJsonObject &result); + void logAvoidance(const QString &state, const QString &message); VisionConfig m_config; - QLocalSocket *m_socket; - QProcess *m_process; - QTimer *m_connectTimer; - QTimer *m_pollTimer; + QThread *m_thread; + VisionDllWorker *m_worker; QTimer *m_requestTimer; - QTimer *m_initializeTimer; - QElapsedTimer m_connectElapsed; - QElapsedTimer m_lastReply; - QByteArray m_buffer; + QTimer *m_avoidanceTimer; + QTimer *m_avoidanceTimeout; + QString m_avoidanceRequestId; + QString m_avoidanceLogKey; + bool m_avoidanceEnabled = false; + bool m_avoidanceDiscarded = false; QString m_session; - QString m_serverProcessId; - QString m_helloId; - QString m_initializeId; - QString m_connectionOperation; - QString m_showWindowId; - QHash m_commands; + QString m_releaseOperation; + QString m_activeWorkerRequest; + QJsonObject m_request; QSet m_cancelledRequests; QSet m_completedRequests; - QJsonObject m_request; - bool m_ready; - bool m_busy; - bool m_backendInitializing = false; - bool m_productionActive; + bool m_ready = false; + bool m_loading = false; + bool m_initializing = false; + bool m_releasing = false; + bool m_workerBusy = false; + bool m_productionActive = false; bool m_maintenanceAllowed = false; - bool m_diagnostic; - bool m_connecting; - bool m_startIfUnavailable = false; - bool m_disconnectRequested = false; - bool m_disconnectCanceledConnection = false; - quint64 m_processGeneration = 0; - bool m_shuttingDown; + bool m_diagnostic = false; + bool m_shuttingDown = false; }; #endif // VISIONSERVICE_H diff --git a/ssp.pro b/ssp.pro index 7945e91..a4e9316 100644 --- a/ssp.pro +++ b/ssp.pro @@ -2,7 +2,20 @@ QT += core gui sql serialbus network greaterThan(QT_MAJOR_VERSION, 4): QT += widgets -CONFIG += c++11 +CONFIG += c++17 + +win32-msvc { + QMAKE_CXXFLAGS += /utf-8 + + CONFIG(release, debug|release) { + DESTDIR = $$PWD/bin + HVG_DEPLOY_SCRIPT = $$shell_quote($$shell_path($$PWD/tools/Deploy-Bin.ps1)) + HVG_PROJECT_ROOT = $$shell_quote($$shell_path($$PWD)) + QMAKE_POST_LINK = powershell.exe -NoProfile -ExecutionPolicy Bypass -File $$HVG_DEPLOY_SCRIPT -ProjectRoot $$HVG_PROJECT_ROOT -RuntimeOnly + } else { + DESTDIR = $$PWD/bin/debug + } +} # The following define makes your compiler emit warnings if you use # any Qt feature that has been marked deprecated (the exact warnings @@ -45,6 +58,7 @@ SOURCES += \ services/productionworker.cpp \ services/qualityservice.cpp \ services/trayservice.cpp \ + services/visiondllworker.cpp \ services/workpieceservice.cpp \ services/visionservice.cpp \ widget.cpp @@ -84,8 +98,11 @@ HEADERS += \ services/productionworker.h \ services/qualityservice.h \ services/trayservice.h \ + services/visiondllworker.h \ services/workpieceservice.h \ services/visionservice.h \ + third_party/hikvision/HikVisionGuidance.h \ + third_party/hikvision/HikVisionGuidanceQt.h \ widget.h FORMS += \ @@ -101,7 +118,8 @@ RESOURCES += \ layout/layout.qrc DISTFILES += \ - config.ini + config.ini \ + tools/Deploy-Bin.ps1 # Default rules for deployment. qnx: target.path = /tmp/$${TARGET}/bin diff --git a/ssp.pro.user b/ssp.pro.user index 67adf68..6b2f803 100644 --- a/ssp.pro.user +++ b/ssp.pro.user @@ -1,6 +1,6 @@ - + EnvironmentId @@ -8,14 +8,12 @@ ProjectExplorer.Project.ActiveTarget - 0 + 0 ProjectExplorer.Project.EditorSettings - true - false - true + true Cpp @@ -28,41 +26,497 @@ QmlJSGlobal - 2 + 2 UTF-8 - false 4 - false - 80 - true - true 1 - true - false 0 - true true - 0 8 true - 1 true - true - true - false ProjectExplorer.Project.PluginSettings + + true + false + true + true + true + true + + false + + + 0 + true -fno-delayed-template-parsing true + + + + + true + + 0 ProjectExplorer.Project.Target.0 + + Desktop + true + MSVC2022 + MSVC2022 + {faded406-c23f-41ea-ba32-26fbf4464e41} + 1 + 0 + 0 + + 1 + .\build\%{FileSystemFriendly:%{Kit:Name}_%{BuildConfig:Name}} + build/MSVC2022_Debug + + + true + QtProjectManager.QMakeBuildStep + false + + + + true + Qt4ProjectManager.MakeStep + + 2 + Build + Build + ProjectExplorer.BuildSteps.Build + + + + true + Qt4ProjectManager.MakeStep + clean + + 1 + Clean + Clean + ProjectExplorer.BuildSteps.Clean + + 2 + false + + false + + Debug + Qt4ProjectManager.Qt4BuildConfiguration + 0 + 0 + + + 0 + Deploy + Deploy + ProjectExplorer.BuildSteps.Deploy + + 1 + + false + ProjectExplorer.DefaultDeployConfiguration + + 1 + + true + true + 0 + true + + + + 2 + + false + -e cpu-cycles --call-graph "dwarf,4096" -F 250 + + Qt4ProjectManager.Qt4RunConfiguration: + E:/QTCode/ssp/ssp/ssp.pro + false + + true + true + true + %{RunConfig:Executable:Path} + + 1 + 2 + + + E:\QTCode\ssp\build-ssp-MSVC2022-x64-Release + E:/QTCode/ssp/build-ssp-MSVC2022-x64-Release + + + true + QtProjectManager.QMakeBuildStep + CONFIG+=force_debug_info QMAKE_CXXFLAGS+=/utf-8 + false + + + + true + Qt4ProjectManager.MakeStep + + 2 + Build + Build + ProjectExplorer.BuildSteps.Build + + + + true + Qt4ProjectManager.MakeStep + clean + + 1 + Clean + Clean + ProjectExplorer.BuildSteps.Clean + + 2 + false + + false + + Release + Qt4ProjectManager.Qt4BuildConfiguration + 0 + 0 + + + 0 + Deploy + Deploy + ProjectExplorer.BuildSteps.Deploy + + 1 + + false + ProjectExplorer.DefaultDeployConfiguration + + 1 + + true + true + 0 + true + + + + 2 + + false + -e cpu-cycles --call-graph "dwarf,4096" -F 250 + + Qt4ProjectManager.Qt4RunConfiguration: + E:/QTCode/ssp/ssp/ssp.pro + false + + true + true + true + %{RunConfig:Executable:Path} + + 1 + 0 + + 2 + + + 0 + Deploy + Deploy + ProjectExplorer.BuildSteps.Deploy + + 1 + + false + ProjectExplorer.DefaultDeployConfiguration + + 1 + + true + true + 0 + true + + + + 2 + + false + -e cpu-cycles --call-graph "dwarf,4096" -F 250 + + Qt4ProjectManager.Qt4RunConfiguration: + E:/QTCode/ssp/ssp/ssp.pro + false + + true + true + true + %{RunConfig:Executable:Path} + + 1 + + + + ProjectExplorer.Project.Target.1 + + Desktop Qt 5.14.1 MinGW 32-bit + Desktop Qt 5.14.1 MinGW 32-bit + qt.qt5.5141.win32_mingw73_kit + 0 + 0 + 0 + + E:/QTCode/ssp/build-ssp-Desktop_Qt_5_14_1_MinGW_32_bit-Debug + + + true + QtProjectManager.QMakeBuildStep + true + + false + false + false + + + true + Qt4ProjectManager.MakeStep + + false + + + false + + 2 + Build + Build + ProjectExplorer.BuildSteps.Build + + + + true + Qt4ProjectManager.MakeStep + + true + clean + + false + + 1 + Clean + Clean + ProjectExplorer.BuildSteps.Clean + + 2 + false + + Debug + Qt4ProjectManager.Qt4BuildConfiguration + 2 + + + E:/QTCode/ssp/build-ssp-Desktop_Qt_5_14_1_MinGW_32_bit-Release + + + true + QtProjectManager.QMakeBuildStep + false + + false + false + true + + + true + Qt4ProjectManager.MakeStep + + false + + + false + + 2 + Build + Build + ProjectExplorer.BuildSteps.Build + + + + true + Qt4ProjectManager.MakeStep + + true + clean + + false + + 1 + Clean + Clean + ProjectExplorer.BuildSteps.Clean + + 2 + false + + Release + Qt4ProjectManager.Qt4BuildConfiguration + 0 + + + E:/QTCode/ssp/build-ssp-Desktop_Qt_5_14_1_MinGW_32_bit-Profile + + + true + QtProjectManager.QMakeBuildStep + true + + false + true + true + + + true + Qt4ProjectManager.MakeStep + + false + + + false + + 2 + Build + Build + ProjectExplorer.BuildSteps.Build + + + + true + Qt4ProjectManager.MakeStep + + true + clean + + false + + 1 + Clean + Clean + ProjectExplorer.BuildSteps.Clean + + 2 + false + + Profile + Qt4ProjectManager.Qt4BuildConfiguration + 0 + + 3 + + + 0 + Deploy + Deploy + ProjectExplorer.BuildSteps.Deploy + + 1 + ProjectExplorer.DefaultDeployConfiguration + + 1 + + + dwarf + + cpu-cycles + + + 250 + + -e + cpu-cycles + --call-graph + dwarf,4096 + -F + 250 + + -F + true + 4096 + false + false + 1000 + + true + + false + false + false + false + true + 0.01 + 10 + true + kcachegrind + 1 + 25 + + 1 + true + false + true + valgrind + + 0 + 1 + 2 + 3 + 4 + 5 + 6 + 7 + 8 + 9 + 10 + 11 + 12 + 13 + 14 + + 2 + + Qt4ProjectManager.Qt4RunConfiguration:E:/QTCode/ssp/ssp/ssp.pro + E:/QTCode/ssp/ssp/ssp.pro + + false + + false + true + true + false + false + true + + E:/QTCode/ssp/build-ssp-Desktop_Qt_5_14_1_MinGW_32_bit-Debug + + 1 + + + + ProjectExplorer.Project.Target.2 Desktop Qt 5.14.1 MinGW 64-bit Desktop Qt 5.14.1 MinGW 64-bit @@ -304,256 +758,9 @@ 1 - - ProjectExplorer.Project.Target.1 - - Desktop Qt 5.14.1 MinGW 32-bit - Desktop Qt 5.14.1 MinGW 32-bit - qt.qt5.5141.win32_mingw73_kit - 0 - 0 - 0 - - E:/QTCode/ssp/build-ssp-Desktop_Qt_5_14_1_MinGW_32_bit-Debug - - - true - QtProjectManager.QMakeBuildStep - true - - false - false - false - - - true - Qt4ProjectManager.MakeStep - - false - - - false - - 2 - Build - Build - ProjectExplorer.BuildSteps.Build - - - - true - Qt4ProjectManager.MakeStep - - true - clean - - false - - 1 - Clean - Clean - ProjectExplorer.BuildSteps.Clean - - 2 - false - - Debug - Qt4ProjectManager.Qt4BuildConfiguration - 2 - - - E:/QTCode/ssp/build-ssp-Desktop_Qt_5_14_1_MinGW_32_bit-Release - - - true - QtProjectManager.QMakeBuildStep - false - - false - false - true - - - true - Qt4ProjectManager.MakeStep - - false - - - false - - 2 - Build - Build - ProjectExplorer.BuildSteps.Build - - - - true - Qt4ProjectManager.MakeStep - - true - clean - - false - - 1 - Clean - Clean - ProjectExplorer.BuildSteps.Clean - - 2 - false - - Release - Qt4ProjectManager.Qt4BuildConfiguration - 0 - - - E:/QTCode/ssp/build-ssp-Desktop_Qt_5_14_1_MinGW_32_bit-Profile - - - true - QtProjectManager.QMakeBuildStep - true - - false - true - true - - - true - Qt4ProjectManager.MakeStep - - false - - - false - - 2 - Build - Build - ProjectExplorer.BuildSteps.Build - - - - true - Qt4ProjectManager.MakeStep - - true - clean - - false - - 1 - Clean - Clean - ProjectExplorer.BuildSteps.Clean - - 2 - false - - Profile - Qt4ProjectManager.Qt4BuildConfiguration - 0 - - 3 - - - 0 - Deploy - Deploy - ProjectExplorer.BuildSteps.Deploy - - 1 - ProjectExplorer.DefaultDeployConfiguration - - 1 - - - dwarf - - cpu-cycles - - - 250 - - -e - cpu-cycles - --call-graph - dwarf,4096 - -F - 250 - - -F - true - 4096 - false - false - 1000 - - true - - false - false - false - false - true - 0.01 - 10 - true - kcachegrind - 1 - 25 - - 1 - true - false - true - valgrind - - 0 - 1 - 2 - 3 - 4 - 5 - 6 - 7 - 8 - 9 - 10 - 11 - 12 - 13 - 14 - - 2 - - Qt4ProjectManager.Qt4RunConfiguration:E:/QTCode/ssp/ssp/ssp.pro - E:/QTCode/ssp/ssp/ssp.pro - - false - - false - true - true - false - false - true - - - - 1 - - ProjectExplorer.Project.TargetCount - 2 - - - ProjectExplorer.Project.Updater.FileVersion - 22 + 3 Version diff --git a/third_party/hikvision/HikVisionGuidance.h b/third_party/hikvision/HikVisionGuidance.h new file mode 100644 index 0000000..a4ead57 --- /dev/null +++ b/third_party/hikvision/HikVisionGuidance.h @@ -0,0 +1,42 @@ +#ifndef HIK_VISION_GUIDANCE_H +#define HIK_VISION_GUIDANCE_H + +#include + +#if defined(_WIN32) +# define HVG_CALL __cdecl +#else +# define HVG_CALL +#endif + +#define HVG_ABI_VERSION 1 +#define HVG_RESPONSE_CAPACITY (1024u * 1024u) + +typedef void *HVG_Handle; + +enum HVG_Status { + HVG_OK = 0, + HVG_INVALID_ARGUMENT = 1, + HVG_BUFFER_TOO_SMALL = 2, + HVG_INVALID_HANDLE = 3, + HVG_BUSY = 4, + HVG_WRONG_THREAD = 5, + HVG_CONFIG_ERROR = 6, + HVG_DEVICE_ERROR = 7, + HVG_NO_TARGET = 8, + HVG_TIMEOUT = 9, + HVG_CANCELLED = 10, + HVG_NOT_READY = 11, + HVG_IO_ERROR = 12, + HVG_PROTOCOL_ERROR = 13, + HVG_DISTANCE_UNKNOWN = 14, + HVG_WRITE_OUTCOME_UNKNOWN = 15, + HVG_INTERNAL_ERROR = 100 +}; + +typedef int32_t (HVG_CALL *HVG_Function)(HVG_Handle, const char *, char *, uint32_t, + uint32_t *); +typedef int32_t (HVG_CALL *HVG_InitializeFunction)(const char *, HVG_Handle *, char *, + uint32_t, uint32_t *); + +#endif // HIK_VISION_GUIDANCE_H diff --git a/third_party/hikvision/HikVisionGuidanceQt.h b/third_party/hikvision/HikVisionGuidanceQt.h new file mode 100644 index 0000000..857e6a2 --- /dev/null +++ b/third_party/hikvision/HikVisionGuidanceQt.h @@ -0,0 +1,131 @@ +#ifndef HIK_VISION_GUIDANCE_QT_H +#define HIK_VISION_GUIDANCE_QT_H + +#include "HikVisionGuidance.h" + +#include +#include +#include +#include +#include + +class HikVisionGuidanceQt +{ +public: + struct Reply { + int code = HVG_INTERNAL_ERROR; + QJsonObject json; + bool ok() const { return code == HVG_OK; } + QString message() const { return json.value("message").toString(); } + }; + + bool load(const QString &path) + { + if (m_handle) { + m_error = "Close the context before loading another library"; + return false; + } + m_functions.clear(); + m_library.setFileName(path); + m_library.setLoadHints(QLibrary::ResolveAllSymbolsHint); + if (!m_library.load()) { + m_error = m_library.errorString(); + return false; + } + m_initialize = reinterpret_cast(m_library.resolve("HVG_Initialize")); + const QStringList names = { + "InitializeCamera", "InitializeLight", "InitializePlc", "LoadData", + "ReadRobotPose", "WriteRobotPose", "Measure", "PlanAvoidance", + "RecognizeGrooves", "Shutdown", "GetVersion", "GetStatus", "GetLastError", + "CancelOperation", "EnumerateCameras", "ConfigureCamera", "ConfigureLight", + "CaptureImages", "DisconnectCamera", "ExportResult", "StartCamera", "StopCamera", + "TurnOnLight", "TurnOffLight", "DisconnectLight", "DisconnectPlc" + }; + for (const QString &name : names) { + HVG_Function function = reinterpret_cast( + m_library.resolve(("HVG_" + name).toLatin1().constData())); + if (!function) { + m_error = "Missing export HVG_" + name; + m_functions.clear(); + m_library.unload(); + return false; + } + m_functions.insert(name, function); + } + if (!m_initialize) { + m_error = "Missing HVG_Initialize"; + m_library.unload(); + return false; + } + return true; + } + + Reply initialize(const QJsonObject &request) + { + if (m_handle) return localError(HVG_BUSY, "Already initialized"); + if (!m_initialize) return localError(HVG_NOT_READY, "DLL is not loaded"); + QByteArray buffer(int(HVG_RESPONSE_CAPACITY), 0); + uint32_t required = 0; + const QByteArray input = QJsonDocument(request).toJson(QJsonDocument::Compact); + const int code = m_initialize(input.constData(), &m_handle, buffer.data(), + uint32_t(buffer.size()), &required); + return decode(code, buffer, required); + } + + Reply call(const QString &name, const QJsonObject &request = QJsonObject()) + { + HVG_Function function = m_functions.value(name, nullptr); + if (!function) return localError(HVG_NOT_READY, "Unknown or unloaded export"); + QByteArray buffer(int(HVG_RESPONSE_CAPACITY), 0); + uint32_t required = 0; + const QByteArray input = QJsonDocument(request).toJson(QJsonDocument::Compact); + const int code = function(m_handle, input.constData(), buffer.data(), + uint32_t(buffer.size()), &required); + Reply reply = decode(code, buffer, required); + if (name == "Shutdown" && code == HVG_OK) m_handle = nullptr; + return reply; + } + + Reply close() { return m_handle ? call("Shutdown") : Reply{HVG_OK, {{"success", true}}}; } + bool unload() + { + if (m_handle) return false; + m_functions.clear(); + m_initialize = nullptr; + return !m_library.isLoaded() || m_library.unload(); + } + bool isOpen() const { return m_handle != nullptr; } + QString errorString() const { return m_error; } + HVG_Handle handle() const { return m_handle; } + HVG_Function function(const QString &name) const { return m_functions.value(name, nullptr); } + int resolvedCount() const { return m_functions.size() + (m_initialize ? 1 : 0); } + + ~HikVisionGuidanceQt() { close(); unload(); } + HikVisionGuidanceQt() = default; + HikVisionGuidanceQt(const HikVisionGuidanceQt &) = delete; + HikVisionGuidanceQt &operator=(const HikVisionGuidanceQt &) = delete; + +private: + static Reply localError(int code, const QString &message) + { + return {code, {{"success", false}, {"message", message}, {"code", code}}}; + } + + static Reply decode(int code, const QByteArray &buffer, uint32_t required) + { + if (required > uint32_t(buffer.size())) + return localError(code, "Response buffer insufficient; call was not replayed"); + const QJsonDocument document = QJsonDocument::fromJson(buffer.constData()); + if (!document.isObject()) + return localError(code, "DLL returned no valid JSON response"); + return {code, document.object()}; + } + + QLibrary m_library; + QHash m_functions; + HVG_InitializeFunction m_initialize = nullptr; + HVG_Handle m_handle = nullptr; + QString m_error; +}; + +#endif // HIK_VISION_GUIDANCE_QT_H diff --git a/tools/Deploy-Bin.ps1 b/tools/Deploy-Bin.ps1 new file mode 100644 index 0000000..bf17c09 --- /dev/null +++ b/tools/Deploy-Bin.ps1 @@ -0,0 +1,124 @@ +param( + [Parameter(Mandatory = $true)] + [string]$ProjectRoot, + [string]$SdkRoot, + [string]$QtRoot, + [string]$PostgresBin, + [switch]$RuntimeOnly +) + +$ErrorActionPreference = 'Stop' + +function Resolve-ExistingDirectory { + param([string[]]$Candidates, [string]$Label) + foreach ($candidate in $Candidates) { + if ($candidate -and (Test-Path -LiteralPath $candidate -PathType Container)) { + return [IO.Path]::GetFullPath($candidate) + } + } + throw "$Label directory was not found." +} + +function Copy-FileIfChanged { + param([string]$Source, [string]$Destination) + if (-not (Test-Path -LiteralPath $Source -PathType Leaf)) { + throw "Missing deployment file: $Source" + } + $sourceItem = Get-Item -LiteralPath $Source + $destinationItem = Get-Item -LiteralPath $Destination -ErrorAction SilentlyContinue + if ($destinationItem -and $destinationItem.Length -eq $sourceItem.Length -and + $destinationItem.LastWriteTimeUtc -eq $sourceItem.LastWriteTimeUtc) { + return + } + $parent = Split-Path -Parent $Destination + if ($parent) { New-Item -ItemType Directory -Path $parent -Force | Out-Null } + Copy-Item -LiteralPath $Source -Destination $Destination -Force +} + +function Copy-TreeIncremental { + param([string]$Source, [string]$Destination) + if (-not (Test-Path -LiteralPath $Source -PathType Container)) { + throw "Missing deployment directory: $Source" + } + foreach ($file in Get-ChildItem -LiteralPath $Source -Recurse -File) { + $relative = $file.FullName.Substring($Source.Length).TrimStart('\', '/') + Copy-FileIfChanged $file.FullName (Join-Path $Destination $relative) + } +} + +$project = [IO.Path]::GetFullPath($ProjectRoot) +$output = Join-Path $project 'bin' +$sdk = Resolve-ExistingDirectory @( + $SdkRoot, + $env:HVG_SDK_ROOT, + (Join-Path $project '../../HikVisionGuide/HikVisionGuide_DLL') +) 'HikVisionGuidance SDK' +$qt = Resolve-ExistingDirectory @( + $QtRoot, + $env:HVG_QT_ROOT, + 'C:\Qt\Qt5.14.1\5.14.1\msvc2017_64' +) 'Qt 5.14.1 MSVC x64' +$postgres = Resolve-ExistingDirectory @( + $PostgresBin, + $env:HVG_POSTGRES_BIN, + 'C:\Program Files\PostgreSQL\16\bin' +) 'PostgreSQL client runtime' + +New-Item -ItemType Directory -Path $output -Force | Out-Null + +$sdkBin = Join-Path $sdk 'bin' +foreach ($pattern in @('*.dll', '*.cti', '*.ini', '*.manifest')) { + foreach ($file in Get-ChildItem -LiteralPath $sdkBin -File -Filter $pattern) { + Copy-FileIfChanged $file.FullName (Join-Path $output $file.Name) + } +} +Copy-FileIfChanged (Join-Path $sdkBin 'qt.conf') (Join-Path $output 'qt.conf') +foreach ($directory in @('platforms', 'imageformats', 'styles', 'ThirdParty')) { + Copy-TreeIncremental (Join-Path $sdkBin $directory) (Join-Path $output $directory) +} + +foreach ($name in @('Qt5Sql.dll', 'Qt5SerialBus.dll')) { + Copy-FileIfChanged (Join-Path $qt "bin/$name") (Join-Path $output $name) +} +Copy-FileIfChanged (Join-Path $qt 'plugins/sqldrivers/qsqlpsql.dll') ` + (Join-Path $output 'sqldrivers/qsqlpsql.dll') + +foreach ($name in @('libpq.dll', 'libssl-3-x64.dll', 'libcrypto-3-x64.dll', + 'libintl-9.dll', 'libiconv-2.dll', 'libwinpthread-1.dll')) { + Copy-FileIfChanged (Join-Path $postgres $name) (Join-Path $output $name) +} + +if (-not $RuntimeOnly) { + Copy-FileIfChanged (Join-Path $project 'config.ini') (Join-Path $output 'config.ini') + Copy-TreeIncremental (Join-Path $sdk 'config') (Join-Path $output 'config') + Copy-TreeIncremental (Join-Path $sdk 'assets') (Join-Path $output 'assets') +} + +$requiredRuntime = @( + 'ssp.exe', 'HikVisionGuidance.dll', 'opencv_world4120.dll', 'onnxruntime.dll', + 'VisionGuide.dll', 'VisionGuide_cpp.dll', 'MvCameraControl.dll', + 'Qt5Core.dll', 'Qt5Gui.dll', 'Qt5Widgets.dll', 'Qt5Network.dll', + 'Qt5SerialPort.dll', 'Qt5SerialBus.dll', 'Qt5Sql.dll', + 'platforms/qwindows.dll', 'sqldrivers/qsqlpsql.dll', 'libpq.dll' +) +foreach ($relative in $requiredRuntime) { + if (-not (Test-Path -LiteralPath (Join-Path $output $relative) -PathType Leaf)) { + throw "Incomplete runtime deployment: $relative" + } +} + +if (-not $RuntimeOnly) { + $sdkConfigPath = Join-Path $output 'config/sdk.json' + $sdkConfig = Get-Content -LiteralPath $sdkConfigPath -Raw -Encoding UTF8 | ConvertFrom-Json + $assetRoot = [IO.Path]::GetFullPath((Join-Path (Split-Path -Parent $sdkConfigPath) $sdkConfig.asset_root)) + foreach ($entry in $sdkConfig.files.PSObject.Properties) { + $path = Join-Path $assetRoot ([string]$entry.Value) + $expectedType = if ($entry.Name -eq 'trays') { 'Container' } else { 'Leaf' } + if (-not (Test-Path -LiteralPath $path -PathType $expectedType)) { + throw "Incomplete asset deployment: files.$($entry.Name) -> $path" + } + } +} + +Write-Host "Deployment complete: $output" +Write-Host ($(if ($RuntimeOnly) { 'Runtime libraries only.' } else { 'Runtime libraries, configuration and assets.' })) diff --git a/widget.cpp b/widget.cpp index 6c7cf9e..bc717f5 100644 --- a/widget.cpp +++ b/widget.cpp @@ -106,9 +106,7 @@ void Widget::setupTopBar(QVBoxLayout *rootLayout) robotStatusLabel = UiHelpers::makeBadge("机器人:未采集", "#607d8b"); safetyStatusLabel = UiHelpers::makeBadge("安全回路:未采集", "#607d8b"); cameraStatusLabel = UiHelpers::makeBadge( - ConfigManager::instance().visionConfig().enabled - ? "相机:离线" : "相机:未启用", - "#607d8b"); + ConfigManager::instance().visionConfig().enabled ? "相机:离线" : "相机:未启用", "#607d8b"); topLayout->addWidget(plcStatusLabel); topLayout->addWidget(robotStatusLabel); topLayout->addWidget(safetyStatusLabel); @@ -221,9 +219,13 @@ void Widget::setupMainArea(QVBoxLayout *rootLayout) connect(visionService, &VisionService::logMessage, this, [this](const QString &message) { appendLog("生产日志", "视觉引导", "通信/测量", message, "记录"); }); + connect(visionService, &VisionService::avoidanceLog, this, + [this](const QString &state, const QString &message) { + appendLog("生产日志", "视觉避障", "距离检测", message, state); + }); connect(visionService, &VisionService::availabilityChanged, this, [this](bool ready, bool, const QString &session) { - if (!ConfigManager::instance().visionConfig().enabled) { + if (!visionService->isEnabled()) { cameraStatusLabel->setText("相机:未启用"); } else if (session.isEmpty()) { cameraStatusLabel->setText("相机:离线"); @@ -231,7 +233,7 @@ void Widget::setupMainArea(QVBoxLayout *rootLayout) cameraStatusLabel->setText(ready ? "相机:就绪" : "相机:在线"); } }); - if (ConfigManager::instance().visionConfig().enabled) + if (visionService->isEnabled()) QTimer::singleShot(0, visionService, &VisionService::startService); }