添加管控软件和相机的通讯
This commit is contained in:
@@ -4,6 +4,67 @@
|
||||
#include <QDir>
|
||||
#include <QSettings>
|
||||
#include <QStringList>
|
||||
#include <QSet>
|
||||
|
||||
bool VisionConfig::isValid(QString *error) const
|
||||
{
|
||||
QStringList errors;
|
||||
if (!enabled || !contractConfirmed || !photoPoseReadyConfirmed) {
|
||||
errors.append("Vision PLC contract is disabled or not confirmed");
|
||||
}
|
||||
if (ipcName.trimmed().isEmpty() || startupTimeoutMs <= 0
|
||||
|| initializeTimeoutMs <= 0 || requestTimeoutMs <= 5000
|
||||
|| robotAckTimeoutMs <= 0) {
|
||||
errors.append("Vision IPC name or timeouts are invalid");
|
||||
}
|
||||
if (photoPoseR < 0 || photoPoseR > 32756 || photoPoseR % 2
|
||||
|| graspPoseR < 0 || graspPoseR > 32756 || graspPoseR % 2
|
||||
|| qAbs(photoPoseR - graspPoseR) < 12) {
|
||||
errors.append("Vision REAL blocks must be distinct, even, 12-word R ranges");
|
||||
}
|
||||
const int coils[] = {robotReceivedCoil, photoRequestCoil, comparingCoil,
|
||||
comparisonErrorCoil, comparisonPassedCoil};
|
||||
QSet<int> unique;
|
||||
for (int coil : coils) {
|
||||
if (coil < 0 || coil > 65535 || unique.contains(coil)) {
|
||||
errors.append("Vision coil addresses must be configured and distinct");
|
||||
break;
|
||||
}
|
||||
unique.insert(coil);
|
||||
}
|
||||
const QSet<QString> outputs = {"comparing", "comparisonError", "comparisonPassed"};
|
||||
const QSet<QString> configured(writableSignals.begin(), writableSignals.end());
|
||||
if (handshakeProtocol != "request_compare_result_ack_v1" || configured != outputs
|
||||
|| writableSignals.size() != outputs.size()) {
|
||||
errors.append("Vision handshake ownership and protocol are not confirmed");
|
||||
}
|
||||
const QStringList knownActions = {"RackPick", "FrontUnload", "BackUnload"};
|
||||
if (actionNames.isEmpty()) {
|
||||
errors.append("Vision production actions are not configured");
|
||||
}
|
||||
for (const QString &action : actionNames) {
|
||||
if (!knownActions.contains(action)) {
|
||||
errors.append("Vision action must be a confirmed pickup action: " + action);
|
||||
}
|
||||
}
|
||||
if (trayMap.isEmpty()) {
|
||||
errors.append("Vision tray mapping is not configured");
|
||||
}
|
||||
for (auto it = trayMap.constBegin(); it != trayMap.constEnd(); ++it) {
|
||||
if (it.key() < 1 || it.value() < 1 || it.value() > 99) {
|
||||
errors.append("Vision tray mapping is invalid");
|
||||
}
|
||||
}
|
||||
if (error) {
|
||||
*error = errors.join("; ");
|
||||
}
|
||||
return errors.isEmpty();
|
||||
}
|
||||
|
||||
int VisionConfig::visionTrayNo(int sspTrayNo) const
|
||||
{
|
||||
return trayMap.value(sspTrayNo, -1);
|
||||
}
|
||||
|
||||
ConfigManager &ConfigManager::instance()
|
||||
{
|
||||
@@ -149,6 +210,38 @@ bool ConfigManager::load(const QString &filePath)
|
||||
settings.value("production/usePlcErrorCode",
|
||||
m_productionConfig.usePlcErrorCode).toBool();
|
||||
|
||||
// Reload from safe defaults so removing a key cannot retain an old contract.
|
||||
m_visionConfig = VisionConfig();
|
||||
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.initializeTimeoutMs = settings.value("vision/initializeTimeoutMs", m_visionConfig.initializeTimeoutMs).toInt();
|
||||
m_visionConfig.requestTimeoutMs = settings.value("vision/requestTimeoutMs", m_visionConfig.requestTimeoutMs).toInt();
|
||||
m_visionConfig.robotAckTimeoutMs = settings.value("vision/robotAckTimeoutMs", m_visionConfig.robotAckTimeoutMs).toInt();
|
||||
m_visionConfig.photoPoseR = settings.value("vision/photoPoseR", 40).toInt();
|
||||
m_visionConfig.graspPoseR = settings.value("vision/graspPoseR", 60).toInt();
|
||||
m_visionConfig.lowWordFirst = settings.value("vision/lowWordFirst", true).toBool();
|
||||
m_visionConfig.robotReceivedCoil = settings.value("vision/robotReceivedCoil", -1).toInt();
|
||||
m_visionConfig.photoRequestCoil = settings.value("vision/photoRequestCoil", -1).toInt();
|
||||
m_visionConfig.comparingCoil = settings.value("vision/comparingCoil", -1).toInt();
|
||||
m_visionConfig.comparisonErrorCoil = settings.value("vision/comparisonErrorCoil", -1).toInt();
|
||||
m_visionConfig.comparisonPassedCoil = settings.value("vision/comparisonPassedCoil", -1).toInt();
|
||||
m_visionConfig.handshakeProtocol = settings.value("vision/handshakeProtocol").toString();
|
||||
m_visionConfig.writableSignals = settings.value("vision/writableSignals").toStringList();
|
||||
m_visionConfig.actionNames = settings.value("vision/actionNames").toStringList();
|
||||
m_visionConfig.writableSignals.removeAll(QString());
|
||||
m_visionConfig.actionNames.removeAll(QString());
|
||||
settings.beginGroup("visionTrayMap");
|
||||
for (const QString &key : settings.childKeys()) {
|
||||
bool validKey = false;
|
||||
const int tray = key.toInt(&validKey);
|
||||
m_visionConfig.trayMap.insert(validKey ? tray : -1, settings.value(key).toInt());
|
||||
}
|
||||
settings.endGroup();
|
||||
|
||||
m_simulationMode = settings.value("system/simulation", m_simulationMode).toBool();
|
||||
m_productionEnabled = settings.value("system/productionEnabled", m_productionEnabled).toBool();
|
||||
return settings.status() == QSettings::NoError;
|
||||
@@ -174,6 +267,11 @@ ProductionConfig ConfigManager::productionConfig() const
|
||||
return m_productionConfig;
|
||||
}
|
||||
|
||||
VisionConfig ConfigManager::visionConfig() const
|
||||
{
|
||||
return m_visionConfig;
|
||||
}
|
||||
|
||||
bool ConfigManager::simulationMode() const
|
||||
{
|
||||
return m_simulationMode;
|
||||
@@ -187,6 +285,15 @@ bool ConfigManager::productionEnabled() const
|
||||
bool ConfigManager::validate(QString *error) const
|
||||
{
|
||||
QStringList errors;
|
||||
if (m_visionConfig.enabled) {
|
||||
QString visionError;
|
||||
if (!m_visionConfig.isValid(&visionError)) {
|
||||
errors.append(visionError);
|
||||
}
|
||||
if (m_modbusConfig.serverAddress == 0) {
|
||||
errors.append("Vision PLC writes cannot use Modbus broadcast address 0");
|
||||
}
|
||||
}
|
||||
if (m_modbusConfig.host.trimmed().isEmpty()) {
|
||||
errors.append("Modbus host is empty");
|
||||
}
|
||||
|
||||
@@ -5,6 +5,36 @@
|
||||
#include "../modbus/modbusconfig.h"
|
||||
|
||||
#include <QString>
|
||||
#include <QStringList>
|
||||
#include <QMap>
|
||||
|
||||
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;
|
||||
int robotAckTimeoutMs = 10000;
|
||||
int photoPoseR = 40;
|
||||
int graspPoseR = 60;
|
||||
bool lowWordFirst = true;
|
||||
int robotReceivedCoil = -1;
|
||||
int photoRequestCoil = -1;
|
||||
int comparingCoil = -1;
|
||||
int comparisonErrorCoil = -1;
|
||||
int comparisonPassedCoil = -1;
|
||||
QString handshakeProtocol;
|
||||
QStringList writableSignals;
|
||||
QStringList actionNames;
|
||||
QMap<int, int> trayMap;
|
||||
|
||||
bool isValid(QString *error = nullptr) const;
|
||||
int visionTrayNo(int sspTrayNo) const;
|
||||
};
|
||||
|
||||
struct ProductionConfig
|
||||
{
|
||||
@@ -35,6 +65,7 @@ public:
|
||||
DbConfig databaseConfig() const;
|
||||
ModbusConfig modbusConfig() const;
|
||||
ProductionConfig productionConfig() const;
|
||||
VisionConfig visionConfig() const;
|
||||
bool simulationMode() const;
|
||||
bool productionEnabled() const;
|
||||
bool validate(QString *error = nullptr) const;
|
||||
@@ -50,6 +81,7 @@ private:
|
||||
DbConfig m_databaseConfig;
|
||||
ModbusConfig m_modbusConfig;
|
||||
ProductionConfig m_productionConfig;
|
||||
VisionConfig m_visionConfig;
|
||||
bool m_simulationMode;
|
||||
bool m_productionEnabled;
|
||||
};
|
||||
|
||||
Reference in New Issue
Block a user