Files
ssp/pages/visionpage.cpp
T
lidg a7af930a0a feat(vision): 新增拍照到位前置流程并支持视觉失败降级取料
- 在普通 RackPick 前写托盘号、格位并置 M850,收到 M851 后清除两位
- 使用 vision/enabled 控制识别,关闭时仍执行拍照到位流程
- 识别成功且 R60 写入确认后写 M852=1,视觉关闭或失败时写 M852=0
- 确认 M852 写入后启动 RackPick,动作结束保留 M852
- 移除旧 850–854 五信号握手,更新配置和协议文档
- 允许未就绪的视觉服务接收测量,扩展超时以覆盖初始化重试
- 保留 PLC 写入失败阻断、暂停发送门控及迟到结果拒绝
- 持久化未完成事务,支持 PLC 暂停后的视觉维护与人工恢复

验证:MinGW 32/64 位编译通过;生产流程47、IPC14、PLC11项测试通过
2026-10-28 15:19:18 +08:00

178 lines
9.2 KiB
C++
Raw Blame History

This file contains ambiguous Unicode characters
This file contains Unicode characters that might be confused with other characters. If you think that this is intentional, you can safely ignore this warning. Use the Escape button to reveal them.
#include "visionpage.h"
#include "../services/visionservice.h"
#include <QDateTime>
#include <QDoubleSpinBox>
#include <QGridLayout>
#include <QGroupBox>
#include <QHeaderView>
#include <QJsonArray>
#include <QJsonDocument>
#include <QLabel>
#include <QPushButton>
#include <QSpinBox>
#include <QTableWidget>
#include <QUuid>
#include <QVBoxLayout>
VisionPage::VisionPage(VisionService *service, QWidget *parent)
: QWidget(parent), m_service(service), m_productionActive(false)
{
QVBoxLayout *layout = new QVBoxLayout(this);
layout->setContentsMargins(18, 18, 18, 18);
QHBoxLayout *buttons = new QHBoxLayout;
QPushButton *start = new QPushButton("启动视觉程序", this);
QPushButton *connectButton = new QPushButton("连接已有视觉程序", this);
m_initialize = new QPushButton("初始化左右相机", this);
QPushButton *show = new QPushButton("打开视觉调试窗口", this);
QPushButton *disconnectButton = new QPushButton("断开并释放调试控制", this);
buttons->addWidget(start);
buttons->addWidget(connectButton);
buttons->addWidget(m_initialize);
buttons->addWidget(show);
buttons->addWidget(disconnectButton);
buttons->addStretch();
layout->addLayout(buttons);
m_status = new QLabel("视觉进程:未连接", this);
m_initialization = new QLabel("相机初始化:未执行", this);
m_initialization->setWordWrap(true);
m_cycle = new QLabel("自动流程:未开始", this);
m_cycle->setWordWrap(true);
m_result = new QLabel("本次结果:无", this);
m_result->setWordWrap(true);
layout->addWidget(m_status);
layout->addWidget(m_initialization);
layout->addWidget(new QLabel("左相机 · 高精细化 · 测量截止 5 秒 · MinScore 0.70 · Greediness 0.80 · 中心选择 · 模型原点 · 抓取偏移 4.40 mm", this));
layout->addWidget(m_cycle);
layout->addWidget(m_result);
m_poses = new QTableWidget(3, 6, this);
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);
for (int row = 0; row < 3; ++row)
for (int col = 0; col < 6; ++col)
m_poses->setItem(row, col, new QTableWidgetItem("—"));
layout->addWidget(m_poses);
layout->addWidget(new QLabel("机器人坐标单位:mm / °。相机姿态沿用 VisionGuide 原始类型;显示抓取目标不代表 PLC 已写入或机器人已接收。", this));
QGroupBox *diagnostic = new QGroupBox("手动诊断(只测量,不写 R60)", this);
QGridLayout *form = new QGridLayout(diagnostic);
form->addWidget(new QLabel("视觉料盘", diagnostic), 0, 0);
m_tray = new QSpinBox(diagnostic);
m_tray->setRange(1, 99);
form->addWidget(m_tray, 0, 1);
const QStringList axes = QStringList() << "X" << "Y" << "Z" << "A" << "B" << "C";
for (int i = 0; i < 6; ++i) {
form->addWidget(new QLabel(axes.at(i), diagnostic), 1, i);
m_diagnosticPose[i] = new QDoubleSpinBox(diagnostic);
m_diagnosticPose[i]->setRange(-1000000, 1000000);
m_diagnosticPose[i]->setDecimals(6);
form->addWidget(m_diagnosticPose[i], 2, i);
}
m_diagnose = new QPushButton("使用上述拍照位姿测量", diagnostic);
form->addWidget(m_diagnose, 3, 0, 1, 3);
layout->addWidget(diagnostic);
layout->addStretch();
connect(start, &QPushButton::clicked, service, &VisionService::startService);
connect(connectButton, &QPushButton::clicked, service, &VisionService::connectService);
connect(m_initialize, &QPushButton::clicked, service, &VisionService::initialize);
connect(show, &QPushButton::clicked, service, &VisionService::showWindow);
connect(disconnectButton, &QPushButton::clicked, service, &VisionService::disconnectService);
connect(m_diagnose, &QPushButton::clicked, this, [this]() {
QJsonArray pose;
for (QDoubleSpinBox *axis : m_diagnosticPose) pose.append(axis->value());
const QString id = QUuid::createUuid().toString(QUuid::WithoutBraces);
QJsonObject request{{"request_id", id}, {"robot_pose", pose},
{"context", QJsonObject{{"workpiece_id", "diagnostic"}, {"task_id", "diagnostic"},
{"tray_no", m_tray->value()}, {"generation", id}}},
{"pose_source", "diagnostic"}, {"pose_read_at", QDateTime::currentDateTimeUtc().toString(Qt::ISODateWithMs)},
{"parameters", VisionService::standardParameters()}, {"convention", VisionService::standardConvention()},
{"require_robot_pose", true}};
m_service->diagnose(request);
});
connect(service, &VisionService::availabilityChanged, this, [this](bool ready, bool busy, const QString &session) {
m_status->setText(session.isEmpty() ? "视觉进程:未连接"
: QString("视觉进程:在线;初始化%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;
for (const QString &camera : QStringList() << "left" << "right") {
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(";"));
}
});
connect(service, &VisionService::requestStarted, this, [this](const QJsonObject &request) {
invalidateResult();
m_poses->verticalHeaderItem(0)->setText(request.value("pose_source").toString() == "diagnostic"
? "诊断拍照位姿" : "R40 拍照位姿");
showPose(0, request.value("robot_pose"));
const QJsonObject context = request.value("context").toObject();
m_cycle->setText(QString("请求 %1;工件 %2;视觉料盘 %3;等待测量结果%4")
.arg(request.value("request_id").toString(), context.value("workpiece_id").toString())
.arg(context.value("tray_no").toInt())
.arg(request.value("pose_source").toString() == "diagnostic" ? "(诊断)" : ""));
});
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;抓取计算 %3 ms;等待生产流程确认提交状态")
.arg(result.value("score").toDouble(), 0, 'f', 3)
.arg(result.value("measure_elapsed_ms").toInt()).arg(result.value("grasp_elapsed_ms").toInt()));
if (result.value("context").toObject().value("task_id").toString() == "diagnostic")
m_result->setText(m_result->text().replace("等待生产流程确认提交状态", "诊断结果,未写入 PLC"));
});
refreshControls();
}
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::setProductionActive(bool active)
{
m_productionActive = active;
refreshControls();
}
void VisionPage::refreshControls()
{
m_initialize->setEnabled(m_service->canInitialize());
m_diagnose->setEnabled(!m_productionActive && m_service->isReady() && !m_service->isBusy());
m_tray->setEnabled(!m_productionActive);
for (QDoubleSpinBox *axis : m_diagnosticPose) axis->setEnabled(!m_productionActive);
}