This commit is contained in:
ywb
2026-06-08 11:42:41 +08:00
parent 696bf2ef6e
commit a4f4be4c8e
8 changed files with 141 additions and 52 deletions
+34 -11
View File
@@ -101,11 +101,10 @@ class MissionExecutorV3:
self._nav = Nav2Navigator()
# 速度控制(默认值,可在 execute_mission 时覆写)
self.arm_speed = 500
self.agv_speed = 0.5
self.arm_speed = 1000
self.agv_speed = 1.0
# 照片上传序号计数器(连续递增,从1开始)
self.next_upload_index = 1
# ==================== 连接 ====================
@@ -239,8 +238,7 @@ class MissionExecutorV3:
self._log(f"📍 点位蛇形路径: {len(path)} 个点位, {total_machines} 台机器")
# 重置照片上传序号(每次任务开始时重置,从1开始)
self.next_upload_index = 1
# 任务步骤控制开关
if options is None:
options = {}
@@ -258,8 +256,8 @@ class MissionExecutorV3:
has_arm_pose = self.arm_client and any(abs(a) > 0.01 for a in arm_initial_pose)
# 速度控制(从前端传入)
self.arm_speed = int(options.get("arm_speed", 500))
self.agv_speed = float(options.get("agv_speed", 0.5))
self.arm_speed = int(options.get("arm_speed", 1000))
self.agv_speed = float(options.get("agv_speed", 1.0))
self._log(f"🚀 AGV速度={self.agv_speed:.1f}m/s, 机械臂速度={self.arm_speed}")
# 设置 Nav2 导航速度(仅在任务开始时设一次)
@@ -831,9 +829,8 @@ class MissionExecutorV3:
self.arm_client.set_angles(angles, speed=self.arm_speed)
self._wait_arm_ready(angles)
# 拍照(upload_index 连续递增
path = self._capture_arm_photo(row, col, side, pi + 1, qr_value, upload_index=self.next_upload_index)
self.next_upload_index += 1
# 拍照(每台机器独立从0开始编号
path = self._capture_arm_photo(row, col, side, pi + 1, qr_value, upload_index=pi + 1)
if path:
self._log(f" 💾 {os.path.basename(path)}")
@@ -842,7 +839,7 @@ class MissionExecutorV3:
upload_index: int = 0) -> Optional[str]:
"""从机械臂摄像头拍照,直接上传到服务器(不保存本地)
upload_index: 从1开始,先正面后背面,由调用方维护
upload_index: 每台机器独立,从0开始
"""
try:
resp = requests.get(ARM_CAMERA_SNAPSHOT, timeout=10)
@@ -892,6 +889,32 @@ class MissionExecutorV3:
self._log(f" ❌ 上传异常 [{index}]: {e}")
return False
def _upload_photo_bytes(self, filename: str, image_data: bytes, serial_number: str, index: int) -> bool:
"""上传照片 bytes 到远程服务器(不保存本地文件)
Args:
filename: 文件名(用于服务器存储)
image_data: 图片二进制数据
serial_number: 二维码/序列号
index: 上传序号(从1开始递增)
"""
try:
headers = {
"Authorization": "Bearer eyJhbGciOiJIUzUxMiJ9.eyJ1c2VyX2lkIjoxLCJ1c2VyX2tleSI6ImZhNTNkZTZiLWE3NjYtNDZmNC05MDUyLTQ2MjUzZTAyNjdmNSIsInVzZXJuYW1lIjoiYWRtaW4ifQ.lC4vKThZo4aAOLsekm2kPgaEJRqRx-YDQWKfHFqxdPNESCKy57l3eIqaKTj2ZjAMaoYAwYlMrv5M1zAOJsO_PA"
}
files = {"file": (filename, image_data, "image/jpeg")}
data = {"serialNumber": serial_number, "index": str(index)}
resp = requests.post(UPLOAD_URL, files=files, data=data, headers=headers, timeout=30)
if resp.status_code == 200:
self._log(f" ☁️ 上传成功 [{index}]: {filename}")
return True
else:
self._log(f" ⚠️ 上传失败 [{index}] HTTP {resp.status_code}: {resp.text[:200]}")
return False
except Exception as e:
self._log(f" ❌ 上传异常 [{index}]: {e}")
return False
# ==================== 控制 ====================
def _wait_pause(self):