207 lines
9.3 KiB
C++
207 lines
9.3 KiB
C++
#include "visionpage.h"
|
||
#include "../services/visionservice.h"
|
||
|
||
#include <QGridLayout>
|
||
#include <QGroupBox>
|
||
#include <QHeaderView>
|
||
#include <QJsonArray>
|
||
#include <QLabel>
|
||
#include <QPushButton>
|
||
#include <QTableWidget>
|
||
#include <QVBoxLayout>
|
||
|
||
VisionPage::VisionPage(VisionService *service, QWidget *parent)
|
||
: QWidget(parent), m_service(service), m_operationPending(false)
|
||
{
|
||
QVBoxLayout *layout = new QVBoxLayout(this);
|
||
layout->setContentsMargins(18, 18, 18, 18);
|
||
layout->setSpacing(12);
|
||
setStyleSheet(
|
||
"QGroupBox#visionControlBox QPushButton { min-width: 160px; }"
|
||
"QGroupBox#visionControlBox QPushButton:pressed {"
|
||
" background: #cfd8dc; border-color: #607d8b; padding-top: 7px; padding-bottom: 3px; }"
|
||
"QGroupBox#visionControlBox QPushButton:disabled {"
|
||
" color: #90a4ae; background: #eceff1; border-color: #cfd8dc; }");
|
||
|
||
QGroupBox *control = new QGroupBox("视觉 DLL 控制", this);
|
||
control->setObjectName("visionControlBox");
|
||
QGridLayout *controlLayout = new QGridLayout(control);
|
||
controlLayout->setHorizontalSpacing(10);
|
||
controlLayout->setVerticalSpacing(8);
|
||
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_initialize, 0, 1);
|
||
controlLayout->addWidget(m_disconnect, 0, 2);
|
||
controlLayout->setColumnStretch(0, 1);
|
||
controlLayout->setColumnStretch(1, 1);
|
||
controlLayout->setColumnStretch(2, 1);
|
||
m_operation = new QLabel("最近操作:等待操作", control);
|
||
m_operation->setObjectName("visionOperationFeedback");
|
||
m_operation->setMinimumHeight(38);
|
||
m_operation->setWordWrap(true);
|
||
controlLayout->addWidget(m_operation, 2, 0, 1, 3);
|
||
showOperation("info", "等待操作");
|
||
layout->addWidget(control);
|
||
|
||
QGroupBox *status = new QGroupBox("运行状态", this);
|
||
QVBoxLayout *statusLayout = new QVBoxLayout(status);
|
||
statusLayout->setSpacing(7);
|
||
m_status = new QLabel("视觉 DLL:未加载", status);
|
||
m_initialization = new QLabel("相机初始化:未执行", status);
|
||
m_initialization->setWordWrap(true);
|
||
QLabel *parameters = new QLabel(
|
||
"左相机 · 高精细化 · 测量截止 30 秒 · MinScore 0.70 · Greediness 0.80 · 中心选择 · 模型原点 · 抓取偏移 4.40 mm",
|
||
status);
|
||
parameters->setWordWrap(true);
|
||
m_cycle = new QLabel("自动流程:未开始", status);
|
||
m_cycle->setWordWrap(true);
|
||
m_result = new QLabel("本次结果:无", status);
|
||
m_result->setWordWrap(true);
|
||
statusLayout->addWidget(m_status);
|
||
statusLayout->addWidget(m_initialization);
|
||
statusLayout->addWidget(parameters);
|
||
statusLayout->addWidget(m_cycle);
|
||
statusLayout->addWidget(m_result);
|
||
layout->addWidget(status);
|
||
|
||
QGroupBox *poses = new QGroupBox("位姿结果", this);
|
||
QVBoxLayout *poseLayout = new QVBoxLayout(poses);
|
||
m_poses = new QTableWidget(3, 6, poses);
|
||
m_poses->setHorizontalHeaderLabels(QStringList() << "X" << "Y" << "Z" << "A" << "B" << "C");
|
||
m_poses->setVerticalHeaderLabels(QStringList() << "R40 拍照位姿" << "相机模型原点" << "R60 抓取目标");
|
||
m_poses->setEditTriggers(QAbstractItemView::NoEditTriggers);
|
||
m_poses->horizontalHeader()->setSectionResizeMode(QHeaderView::Stretch);
|
||
m_poses->verticalHeader()->setSectionResizeMode(QHeaderView::Stretch);
|
||
m_poses->setMinimumHeight(190);
|
||
for (int row = 0; row < 3; ++row)
|
||
for (int col = 0; col < 6; ++col)
|
||
m_poses->setItem(row, col, new QTableWidgetItem("—"));
|
||
poseLayout->addWidget(m_poses);
|
||
QLabel *units = new QLabel(
|
||
"机器人坐标单位:mm / °。相机姿态来自视觉 DLL;显示抓取目标不代表 PLC 已写入或机器人已接收。",
|
||
poses);
|
||
units->setWordWrap(true);
|
||
poseLayout->addWidget(units);
|
||
layout->addWidget(poses, 1);
|
||
|
||
connect(m_start, &QPushButton::clicked, this, [this]() {
|
||
beginOperation("start", "正在加载视觉 DLL…");
|
||
m_service->startService();
|
||
});
|
||
connect(m_initialize, &QPushButton::clicked, this, [this]() {
|
||
beginOperation("initialize", "正在初始化相机、光源和视觉数据…");
|
||
m_service->initialize();
|
||
});
|
||
connect(m_disconnect, &QPushButton::clicked, this, [this]() {
|
||
beginOperation("disconnect", "正在释放视觉设备和 DLL…");
|
||
m_service->disconnectService();
|
||
});
|
||
connect(service, &VisionService::operationFeedback, this,
|
||
[this](const QString &operation, const QString &state, const QString &message) {
|
||
if (!m_operationPending || operation != m_pendingOperation)
|
||
return;
|
||
m_operationPending = false;
|
||
showOperation(state, message);
|
||
refreshControls();
|
||
});
|
||
connect(service, &VisionService::availabilityChanged, this, [this](bool ready, bool busy, const QString &session) {
|
||
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("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();
|
||
showPose(0, request.value("robot_pose"));
|
||
const QJsonObject context = request.value("context").toObject();
|
||
m_cycle->setText(QString("请求 %1;工件 %2;视觉料盘 %3;等待测量结果")
|
||
.arg(request.value("request_id").toString(), context.value("workpiece_id").toString())
|
||
.arg(context.value("tray_no").toInt()));
|
||
});
|
||
connect(service, &VisionService::measurementFinished, this, [this](const QJsonObject &result) {
|
||
if (result.value("status").toString() != "ok") {
|
||
invalidateResult();
|
||
m_result->setText("本次结果不可用:" + result.value("message").toString());
|
||
return;
|
||
}
|
||
showPose(1, result.value("camera_pose"));
|
||
showPose(2, result.value("robot_pose"));
|
||
m_result->setText(QString("视觉计算成功;匹配分数 %1;总耗时 %2 ms;等待生产流程确认提交状态")
|
||
.arg(result.value("score").toDouble(), 0, 'f', 3)
|
||
.arg(result.value("elapsed_ms").toInt()));
|
||
});
|
||
refreshControls();
|
||
}
|
||
|
||
void VisionPage::beginOperation(const QString &operation, const QString &message)
|
||
{
|
||
m_pendingOperation = operation;
|
||
m_operationPending = true;
|
||
showOperation("pending", message);
|
||
refreshControls();
|
||
}
|
||
|
||
void VisionPage::showOperation(const QString &state, const QString &message)
|
||
{
|
||
QString color = "#546e7a";
|
||
QString background = "#eceff1";
|
||
if (state == "pending") {
|
||
color = "#1565c0";
|
||
background = "#e3f2fd";
|
||
} else if (state == "success") {
|
||
color = "#2e7d32";
|
||
background = "#e8f5e9";
|
||
} else if (state == "error") {
|
||
color = "#c62828";
|
||
background = "#ffebee";
|
||
}
|
||
m_operation->setText("最近操作:" + message);
|
||
m_operation->setStyleSheet(QString(
|
||
"QLabel { color: %1; background: %2; border: 1px solid %1; border-radius: 4px; padding: 7px 10px; }")
|
||
.arg(color, background));
|
||
}
|
||
|
||
void VisionPage::showPose(int row, const QJsonValue &pose)
|
||
{
|
||
const QJsonArray values = pose.toArray();
|
||
for (int i = 0; i < 6; ++i)
|
||
m_poses->item(row, i)->setText(values.size() == 6 ? QString::number(values.at(i).toDouble(), 'g', 12) : "—");
|
||
}
|
||
|
||
void VisionPage::invalidateResult()
|
||
{
|
||
showPose(1, QJsonArray());
|
||
showPose(2, QJsonArray());
|
||
m_result->setText("本次结果:不可用");
|
||
}
|
||
|
||
void VisionPage::updateCycle(const QJsonObject &cycle)
|
||
{
|
||
m_cycle->setText("自动流程:" + cycle.value("phase").toString() + ";" + cycle.value("message").toString());
|
||
if (cycle.contains("photo_pose")) showPose(0, cycle.value("photo_pose"));
|
||
if (cycle.contains("robot_pose")) showPose(2, cycle.value("robot_pose"));
|
||
if (cycle.value("invalidated").toBool()) invalidateResult();
|
||
}
|
||
|
||
void VisionPage::refreshControls()
|
||
{
|
||
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_disconnect->setEnabled(m_service->isEnabled()
|
||
&& (!m_operationPending || m_pendingOperation != "disconnect"));
|
||
}
|