From 5a8bbd2426aeacdbbb2fdb1a7f7a1adce0cac7f9 Mon Sep 17 00:00:00 2001
From: mrDarker <mr.darker@163.com>
Date: 星期五, 01 八月 2025 16:23:29 +0800
Subject: [PATCH] 1. 新增以下功能函数并集成： - InitStorage()：初始化存储区域 - StartStorage()：开始数据存储 - StopStorage()：停止存储并自动提取、分析数据 - AnalyzeStoredData()：分析指定端口数据，返回偏移量
---
SourceCode/Bond/Servo/CRobotTask.cpp | 14 ++++++++++++++
1 files changed, 14 insertions(+), 0 deletions(-)
diff --git a/SourceCode/Bond/Servo/CRobotTask.cpp b/SourceCode/Bond/Servo/CRobotTask.cpp
index b549782..1c9f61d 100644
--- a/SourceCode/Bond/Servo/CRobotTask.cpp
+++ b/SourceCode/Bond/Servo/CRobotTask.cpp
@@ -286,6 +286,17 @@
});
}
+ void CRobotTask::resend()
+ {
+ // 重新下发命令，无非是下发取料或下发放料的命令，根据当前状态来
+ if (ROBOT_TASK_STATE::Picking == m_state || ROBOT_TASK_STATE::Picked == m_state) {
+ pick();
+ }
+ else if (ROBOT_TASK_STATE::Placing == m_state) {
+ place();
+ }
+ }
+
void CRobotTask::completed()
{
m_state = ROBOT_TASK_STATE::Completed;
@@ -359,6 +370,9 @@
case EQ_ID_LOADPORT2:
case EQ_ID_LOADPORT3:
case EQ_ID_LOADPORT4:
+ tarPos = srcPos;
+ tarSlot = srcSlot;
+ break;
case EQ_ID_ARM_TRAY1:
case EQ_ID_ARM_TRAY2:
case EQ_ID_ALIGNER:
--
Gitblit v1.9.3