Compare commits
7 Commits
bugfix/ui_
...
cbda29e270
| Author | SHA1 | Date | |
|---|---|---|---|
| cbda29e270 | |||
| e54c8d6f5e | |||
| b66b31d9ad | |||
| fbf28fe9cc | |||
| f274162ee6 | |||
| 8b96a2d3e9 | |||
| 640faf26b8 |
4
.gitignore
vendored
4
.gitignore
vendored
@ -1,8 +1,8 @@
|
||||
# Python
|
||||
**/__pycache__/
|
||||
*/__pycache__/
|
||||
*.py[cod]
|
||||
*$py.class
|
||||
|
||||
*.egg-info/
|
||||
|
||||
# IDEs and editors
|
||||
.idea/
|
||||
|
||||
@ -1,7 +1,9 @@
|
||||
import logging
|
||||
from enum import Enum
|
||||
from turtle import Turtle
|
||||
# from numpy.array_api import trunc
|
||||
|
||||
from numpy.array_api import trunc
|
||||
|
||||
import Constant
|
||||
from COM.COM_TCP import TCPClient
|
||||
import queue
|
||||
@ -43,11 +45,17 @@ class RobotClient(TCPClient):
|
||||
def send_Command(self):
|
||||
try:
|
||||
if self.command_quene.qsize()!=0:
|
||||
log.log_message(logging.INFO, f'robot-command:从队列获取命令')
|
||||
command = self.command_quene.get()
|
||||
log.log_message(logging.INFO, f'robot-command:{command}')
|
||||
self.client_socket.send(command.encode())
|
||||
if True:
|
||||
response = self.client_socket.recv(1024).decode('utf-8')
|
||||
# response_message = json.loads(response)
|
||||
if response:
|
||||
log.log_message(logging.INFO, f'robot-command:{response},剩余:{self.command_quene.qsize()}条命令')
|
||||
else:
|
||||
log.log_message(logging.INFO, f'robot-command:无返回值,剩余:{self.command_quene.qsize()}条命令')
|
||||
return True
|
||||
else:
|
||||
return True
|
||||
@ -93,10 +101,10 @@ class RobotClient(TCPClient):
|
||||
log.log_message(logging.ERROR,Constant.str_tcp_robot_data_error)
|
||||
return True
|
||||
except json.JSONDecodeError as e:
|
||||
log.log_message(logging.WARNING,Constant.str_sys_json_error+response)
|
||||
log.log_message(logging.WARNING,Constant.str_sys_json_error+request_status_json)
|
||||
return True
|
||||
except Exception as e:
|
||||
log.log_message(logging.ERROR,f'{e}{response}')
|
||||
log.log_message(logging.ERROR,f'{e}{request_status_json}')
|
||||
raise
|
||||
|
||||
def send_emergency_sound(self):
|
||||
|
||||
@ -41,10 +41,11 @@ class TCPClient:
|
||||
if (self.send_Status() and self.send_Command()):
|
||||
self.error_count = 0
|
||||
except Exception as e:
|
||||
log.log_message(logging.ERROR,f'COM_TCP: {str(e)}')
|
||||
self.error_count += 1
|
||||
if self.error_count> 5:
|
||||
print("Error: 机械臂控制程序中TCPClient is not connected")
|
||||
log.log_message(logging.ERROR,Constant.str_tcp_connect_no_reply)
|
||||
# log.log_message(logging.ERROR,f'{Constant.str_tcp_connect_no_reply}:{str(e)}')
|
||||
try:
|
||||
self.CreatConnect()
|
||||
log.log_message(logging.INFO, Constant.str_tcp_reconnect)
|
||||
|
||||
Binary file not shown.
Binary file not shown.
101
CU/Feeding.py
101
CU/Feeding.py
@ -1,6 +1,8 @@
|
||||
import copy
|
||||
from dis import stack_effect
|
||||
import logging
|
||||
import math
|
||||
from pickle import FALSE
|
||||
import random
|
||||
import threading
|
||||
import time
|
||||
@ -29,7 +31,9 @@ from Util.util_log import log
|
||||
from Model.RobotModel import Instruction
|
||||
from EMV.EMV import RelayController
|
||||
from CU.drop import DropPositionManager
|
||||
# from Mv3D.CameraImg import CameraImg
|
||||
from Mv3D.CameraUtil import CameraUtil
|
||||
from Mv3D.calculate_diff2 import calculate_offset_from_image
|
||||
|
||||
class ResetStatus(Enum):
|
||||
RNone = 0
|
||||
RStart = 1
|
||||
@ -204,7 +208,7 @@ class FeedLine:
|
||||
f"✅ FDropBag 位置已更新: ({position.X}, {position.Y}, {position.Z}, {position.U}, {position.V}, {position.W})")
|
||||
break # 假设只有一个丢包点
|
||||
|
||||
def get_drop_path(self) -> list:
|
||||
def get_drop_path(self,offsetX) -> list:
|
||||
"""获取动态扔包路径"""
|
||||
|
||||
if self.drop_manager is None:
|
||||
@ -218,8 +222,11 @@ class FeedLine:
|
||||
self.id,
|
||||
self.current_index
|
||||
)
|
||||
|
||||
if pos_model is None:
|
||||
break
|
||||
if pos_model.status==FeedStatus.FDropBag.value:
|
||||
pos_model=self.get_offset_position(pos_model,self.current_index,offsetX)
|
||||
path.append(pos_model)
|
||||
return path
|
||||
|
||||
@ -245,21 +252,51 @@ class FeedLine:
|
||||
self.start_to_take = self.feed_positions[index_start:index_take+1]
|
||||
self.feeding_to_end = self.feed_positions[index_take:]
|
||||
|
||||
def set_feeding_to_end(self):
|
||||
|
||||
def set_feeding_to_end(self,offsetX)->bool:
|
||||
"""
|
||||
设置动态扔包路径
|
||||
:param image_path: 偏移量图像路径
|
||||
"""
|
||||
for i in range(len(self.feed_positions)):
|
||||
if self.feed_positions[i].status == FeedStatus.FPhoto.value:
|
||||
index_take = i
|
||||
break
|
||||
index_drop=self.current_dropbag_index
|
||||
test_path = self.get_drop_path()
|
||||
test_path = self.get_drop_path(offsetX)
|
||||
self.current_index+=1
|
||||
# 将总list的drop部分，替换为动态路径
|
||||
self.feed_positions = self.feed_positions[:index_drop] + test_path
|
||||
# self.feeding_to_end = self.feed_positions[index_take:index_drop]
|
||||
self.feeding_to_end = self.feed_positions[index_take:index_drop]+test_path
|
||||
|
||||
|
||||
|
||||
# 计算偏移量
|
||||
|
||||
def get_offset_position(self,point,_current_index,offsetX):
|
||||
"""
|
||||
获取偏移后的坐标。
|
||||
"""
|
||||
_current_index=_current_index-1
|
||||
if _current_index<0:
|
||||
_current_index=0
|
||||
loc_floor=(_current_index//5)+1
|
||||
loc_bag=(_current_index%5)+1
|
||||
if loc_floor in [1,3,5]:
|
||||
if loc_bag in [1,2,3]:
|
||||
point.X=round(point.X-offsetX, 3)
|
||||
elif loc_bag==4:
|
||||
point.Y=round(point.Y-offsetX, 3)
|
||||
elif loc_bag==5:
|
||||
point.Y=round(point.Y+offsetX, 3)
|
||||
elif loc_floor in [2,4,6]:
|
||||
if loc_bag in [1,2,3]:
|
||||
point.X=round(point.X+offsetX, 3)
|
||||
elif loc_bag==4:
|
||||
point.Y=round(point.Y-offsetX, 3)
|
||||
elif loc_bag==5:
|
||||
point.Y=round(point.Y+offsetX, 3)
|
||||
return point
|
||||
|
||||
|
||||
class FeedingConfig:
|
||||
def __init__(self, num: int, feedLine: FeedLine, photo_locs,remain_count:int):
|
||||
#需码垛数量，如50，或30
|
||||
@ -286,6 +323,8 @@ class Feeding(QObject):
|
||||
log_signal = Signal(int,str)
|
||||
#码垛完成通知
|
||||
stack_finish_signal=Signal()
|
||||
#误差过大，通知用户
|
||||
feed_error_signal=Signal(int,str)
|
||||
|
||||
def __init__(self, robotClient: RobotClient,relay_controller:RelayController):
|
||||
super().__init__()
|
||||
@ -326,7 +365,7 @@ class Feeding(QObject):
|
||||
#用于同步控制EMV相关
|
||||
self.relay_controller = relay_controller
|
||||
self.relay_controller.take_robot_signal.connect(self.take_feed_notice)
|
||||
# self.camera_img=CameraImg()
|
||||
self.camera_img=CameraUtil()
|
||||
# 启动传感器2线程
|
||||
# self.relay_controller._running = True
|
||||
# self.sensor2_thread = None
|
||||
@ -340,8 +379,8 @@ class Feeding(QObject):
|
||||
# self.detect_thread.join()
|
||||
if self.detect.detection:
|
||||
self.detect.detection.release()
|
||||
# if self.camera_img:
|
||||
# self.camera_img.close_camera()
|
||||
if self.camera_img:
|
||||
self.camera_img.release()
|
||||
|
||||
def run_detect(self):
|
||||
#图片相关线程
|
||||
@ -353,6 +392,8 @@ class Feeding(QObject):
|
||||
"""接收机器人信号通知"""
|
||||
self.take_sensor_signal = True
|
||||
|
||||
|
||||
|
||||
def run(self):
|
||||
self.catch.run()
|
||||
# 获取事件坐标
|
||||
@ -501,13 +542,41 @@ class Feeding(QObject):
|
||||
return
|
||||
time.sleep(1) # 每秒检查一次
|
||||
|
||||
loc_offsetX=0
|
||||
loc_is_next=False
|
||||
#第二次执行FeedStatus.FPhoto时，改变码垛点
|
||||
# self.camera_img.save_frame_path()
|
||||
self.feedConfig.feedLine.set_feeding_to_end()
|
||||
# self.take_photo_sigal.emit()
|
||||
self.next_position()
|
||||
self.log_signal.emit(logging.INFO, Constant.str_sys_runing2)
|
||||
# self.feedStatus = FeedStatus.FTake
|
||||
try:
|
||||
loc_image_path=self.camera_img.save_img()
|
||||
loc_model_result = calculate_offset_from_image(loc_image_path, visualize=False)
|
||||
if loc_model_result['success']:
|
||||
#置信度
|
||||
if loc_model_result['obj_conf']>0.5:
|
||||
loc_offsetX=loc_model_result['dx_mm']
|
||||
if abs(loc_model_result['dx_mm'])<200:
|
||||
loc_is_next=True
|
||||
print(f'{loc_image_path}:料带偏移{loc_offsetX}mm')
|
||||
else:
|
||||
print(f"{loc_image_path}:料带偏移过大，报警")
|
||||
self.feed_error_signal.emit(1,f"{loc_image_path}:料带偏移过大，报警")
|
||||
else:
|
||||
print(f"{loc_image_path}:未检测到料带,置信度低")
|
||||
self.feed_error_signal.emit(2,f"{loc_image_path}:未检测到料带,置信度低")
|
||||
else:
|
||||
print(f"{loc_image_path}:计算偏移失败，视觉返回False")
|
||||
self.feed_error_signal.emit(2,f"{loc_image_path}:计算偏移失败，视觉返回False")
|
||||
# loc_is_next=False
|
||||
loc_offsetX=0
|
||||
except Exception as e:
|
||||
print(f"视频模型异常：{loc_image_path}",e)
|
||||
# loc_is_next=False
|
||||
loc_offsetX=0
|
||||
self.feed_error_signal.emit(2,"视频模型异常")
|
||||
self.log_signal.emit(logging.ERROR, f"视频模型异常：{e}")
|
||||
finally:
|
||||
if loc_is_next:
|
||||
self.feedConfig.feedLine.set_feeding_to_end(loc_offsetX)
|
||||
self.next_position()
|
||||
self.log_signal.emit(logging.INFO, Constant.str_sys_runing2)
|
||||
|
||||
elif self.feedStatus == FeedStatus.FTake:
|
||||
self.log_signal.emit(logging.INFO, Constant.str_feed_take)
|
||||
|
||||
Binary file not shown.
Binary file not shown.
Binary file not shown.
Binary file not shown.
Binary file not shown.
Binary file not shown.
Binary file not shown.
@ -3,7 +3,7 @@ import os
|
||||
# 调试变量
|
||||
Debug = False # 控制不加图像的Fphoto False是不加
|
||||
Debug1 = False # 打印很多日志节点
|
||||
DebugPosition = False # 调试位置，关闭机器人和传感器及判断
|
||||
DebugPosition = True # 调试位置，关闭机器人和传感器及判断
|
||||
# Debug2 = False
|
||||
feedStatus = True #feedStatus的状态打印
|
||||
|
||||
@ -53,6 +53,7 @@ str_feed_drop_mid = '移动到码垛中间点位置'
|
||||
str_feed_drop_reset = '移动到码垛复位位置'
|
||||
str_feed_broken = '移动到破袋位置'
|
||||
str_feed_takePhoto_fail = '识别图像失败'
|
||||
str_image_model_fail = '摄像头识别料带失败'
|
||||
str_feed_takePhoto_success = '识别图像成功'
|
||||
str_feed_takePhoto_new_line = '新的一排袋识别'
|
||||
str_feed_takePhoto_line = '一排袋最高的识别'
|
||||
|
||||
159
EMV/EMV.py
159
EMV/EMV.py
@ -14,6 +14,8 @@ import Constant
|
||||
class RelayController(QObject):
|
||||
log_signal = Signal(int, str)
|
||||
take_robot_signal = Signal()
|
||||
emergency_signal = Signal(bool)
|
||||
|
||||
def __init__(self, host='192.168.0.18', port=50000):
|
||||
super().__init__()
|
||||
# ===================== 全局线程延时参数 =====================
|
||||
@ -32,6 +34,8 @@ class RelayController(QObject):
|
||||
self.delay_clamp = 0.5 # 夹爪动作延时
|
||||
self.delay_after_pusher = 5.0 # 推板推出后到重启传动带时间
|
||||
|
||||
self.emergency_is_pressed=False
|
||||
|
||||
# ===================== 传感器稳定检测参数 =====================
|
||||
self.sensor_stable_duration = 1.0 # 传感器状态稳定检测时间（秒）
|
||||
self.sensor_max_attempts = 3 # 连续检测次数达到此值判定有效
|
||||
@ -49,8 +53,11 @@ class RelayController(QObject):
|
||||
self.PUSHER1 = 'pusher1'
|
||||
self.SENSOR1 = 'sensor1'
|
||||
self.SENSOR2 = 'sensor2'
|
||||
self.BELT = 'belt'
|
||||
self.ALARM = 'alarm'
|
||||
|
||||
self.valve_commands = {
|
||||
#包装机皮带
|
||||
self.CONVEYOR1: {'open': '000000000006010500070000', 'close': '00000000000601050007FF00'},
|
||||
# self.CONVEYOR11: {'open': '00000000000601050000FF00', 'close': '000000000006010500000000'},
|
||||
self.PUSHER: {'open': '00000000000601050001FF00', 'close': '000000000006010500010000'},
|
||||
@ -60,6 +67,10 @@ class RelayController(QObject):
|
||||
self.CLAMP: {'open': '00000000000601050003FF00', 'close': '000000000006010500030000'},
|
||||
#DO5 回 DO2推
|
||||
self.PUSHER1: {'open': '00000000000601050004FF00', 'close': '000000000006010500040000'},
|
||||
#D07 长皮带
|
||||
self.BELT: {'open': '00000000000601050006FF00', 'close': '000000000006010500060000'},
|
||||
#D01 声控报警
|
||||
self.ALARM: {'open': '00000000000601050000FF00', 'close': '000000000006010500000000'},
|
||||
#滚筒反转
|
||||
self.CONVEYOR2_REVERSE: {'open': '000100000006020620000022', 'close': '000100000006020620000001'}
|
||||
}
|
||||
@ -77,7 +88,9 @@ class RelayController(QObject):
|
||||
self.CONVEYOR2: 2,
|
||||
self.CLAMP: 3,
|
||||
self.PUSHER1: 4,
|
||||
self.CONVEYOR2_REVERSE: 5
|
||||
self.CONVEYOR2_REVERSE: 5,
|
||||
self.BELT: 6,
|
||||
self.ALARM: 7,
|
||||
}
|
||||
|
||||
self.sensor_bit_map = {
|
||||
@ -91,7 +104,9 @@ class RelayController(QObject):
|
||||
self.CONVEYOR2: "传送带2",
|
||||
self.CLAMP: "机械臂夹爪",
|
||||
self.PUSHER1: "推板关",
|
||||
self.CONVEYOR2_REVERSE: "传送带2反转"
|
||||
self.CONVEYOR2_REVERSE: "传送带2反转",
|
||||
self.BELT: "皮带",
|
||||
self.ALARM: "声控报警",
|
||||
}
|
||||
|
||||
self.sensor_name_map = {
|
||||
@ -105,8 +120,8 @@ class RelayController(QObject):
|
||||
self._sensor1_thread = None
|
||||
self._sensor2_thread = None
|
||||
|
||||
self.required_codes = {'0101', '0103'} # 有效状态码（传感器1）
|
||||
self.required_codes_1 = {'0102', '0103'} # 有效状态码（传感器2）
|
||||
self.required_codes = {'0101', '0103','0105','0107'} # 有效状态码（传感器1）
|
||||
self.required_codes_1 = {'0102', '0103','0106','0107'} # 有效状态码（传感器2）
|
||||
|
||||
self.sensor1_triggered = False
|
||||
self.sensor1_last_time = 0
|
||||
@ -117,7 +132,7 @@ class RelayController(QObject):
|
||||
# ===================== 基础通信方法 =====================
|
||||
def send_command(self, command_hex, retry_count=2, source='unknown'):
|
||||
if Constant.DebugPosition:
|
||||
# print(f"[发送命令] {command_hex} ({source})")
|
||||
print(f"[发送命令] {command_hex} ({source})")
|
||||
return None
|
||||
byte_data = binascii.unhexlify(command_hex)
|
||||
for attempt in range(retry_count):
|
||||
@ -136,12 +151,14 @@ class RelayController(QObject):
|
||||
#print(f"[通信响应] {hex_response}")
|
||||
return response
|
||||
except Exception as e:
|
||||
self.log_signal.emit(logging.INFO,f"网络继电器通信错误 ({source}): {e}, 尝试重连... ({attempt + 1}/{retry_count})")
|
||||
print(f"网络继电器通信错误 ({source}): {e}, 尝试重连... ({attempt + 1}/{retry_count})")
|
||||
time.sleep(5)
|
||||
self.trigger_alarm()
|
||||
return None
|
||||
|
||||
def trigger_alarm(self):
|
||||
self.log_signal.emit(logging.ERROR,"警告：网络继电器连续多次通信失败，请检查设备连接！")
|
||||
print("警告：网络继电器连续多次通信失败，请检查设备连接！")
|
||||
|
||||
# ===================== 状态读取方法 =====================
|
||||
@ -199,6 +216,25 @@ class RelayController(QObject):
|
||||
print(f"[{command_type}] 无法获取响应数据")
|
||||
return responses
|
||||
|
||||
def get_emergency_is_pressed(self)->bool:
|
||||
"获取急停信号，DI 3 位为1，正常，DI 3为0时为按下急停状态，00000000000401020107 后四位01表示一个字节，最后一位（07）二进制对应开关量"
|
||||
"按下急停为"
|
||||
command = self.read_status_command.get("sensors")
|
||||
response = self.send_command(command)
|
||||
loc_is_pressed=False
|
||||
if response and len(response) >= 10:
|
||||
status_byte = response[9]
|
||||
#简单验证
|
||||
status_crc=response[8]
|
||||
loc_is_pressed =status_crc==1 and (status_byte & 0b100) == 0 # 0b100 表示第三位为1
|
||||
else:
|
||||
self.log_signal.emit(logging.ERROR,f"网络继电器[急停] 读取状态失败或响应无效")
|
||||
print(f"网络继电器[急停] 读取状态失败或响应无效")
|
||||
|
||||
return loc_is_pressed
|
||||
|
||||
|
||||
|
||||
def parse_status_code(self, response):
|
||||
"""
|
||||
从 Modbus 响应字符串中提取状态码（后两位）
|
||||
@ -268,8 +304,67 @@ class RelayController(QObject):
|
||||
time.sleep(self.sensor2_loop_lost)
|
||||
return False
|
||||
|
||||
def is_valid_sensor(self,sensor_name):
|
||||
"""
|
||||
检查传感器状态是否有效
|
||||
参数:
|
||||
sensor_name: 传感器名称
|
||||
返回:
|
||||
True: 传感器状态有效
|
||||
False: 传感器状态无效
|
||||
"""
|
||||
stable_count = 0
|
||||
_try_nums=5 # 尝试次数
|
||||
for _ in range(_try_nums):
|
||||
responses = self.get_all_sensor_responses('sensors')
|
||||
response = responses.get(sensor_name)
|
||||
|
||||
if not response:
|
||||
print(f"[警告] 无法获取 {sensor_name} 的响应，尝试重试...")
|
||||
return False
|
||||
else:
|
||||
temp_status_code = self.parse_status_code(response)
|
||||
if temp_status_code in self.required_codes_1:
|
||||
stable_count += 1
|
||||
if stable_count >= 3:
|
||||
return True
|
||||
else:
|
||||
stable_count = 0
|
||||
time.sleep(self.sensor2_loop_lost)
|
||||
return False
|
||||
|
||||
def is_valid_sensor_signal_stable(self, sensor_name, detection_duration=3.0, stability_duration=2.5, check_interval=0.1):
|
||||
"""
|
||||
检测在指定时间窗口内是否存在持续稳定的有效信号
|
||||
参数:
|
||||
sensor_name: 传感器名称
|
||||
detection_duration: 总检测时间窗口(秒)，默认为3秒
|
||||
stability_duration: 信号需要持续稳定的时间(秒)，默认为2.5秒
|
||||
check_interval: 检测间隔(秒)，默认为0.1秒
|
||||
|
||||
返回:
|
||||
True: 在时间窗口内检测到持续稳定的有效信号
|
||||
False: 未检测到持续稳定的有效信号
|
||||
"""
|
||||
stable_start_time = None # 记录首次检测到有效信号的时间
|
||||
start_time = time.time()
|
||||
if not self.is_valid_sensor(sensor_name):
|
||||
return False # 传感器状态无效,返回
|
||||
else:
|
||||
stable_start_time = time.time() # 首次检测到有效信号
|
||||
time.sleep(check_interval)
|
||||
|
||||
while time.time() - start_time < detection_duration:
|
||||
temp_is_valid = self.is_valid_sensor(sensor_name)
|
||||
if temp_is_valid:
|
||||
if time.time() - stable_start_time >= stability_duration:
|
||||
return True # 信号持续稳定达到要求时间
|
||||
else:
|
||||
stable_start_time = None # 信号不稳定，重置计时
|
||||
time.sleep(check_interval)
|
||||
return False
|
||||
# ===================== 动作控制方法 =====================
|
||||
def open(self, conveyor1=False, pusher=False, conveyor2=False, clamp=False, pusher1=False, conveyor2_reverse=False):
|
||||
def open(self, conveyor1=False, pusher=False, conveyor2=False, clamp=False, pusher1=False, conveyor2_reverse=False,belt=False,alarm=False):
|
||||
if Constant.DebugPosition:
|
||||
return
|
||||
status = self.get_all_device_status()
|
||||
@ -291,8 +386,14 @@ class RelayController(QObject):
|
||||
if conveyor2_reverse:
|
||||
self.send_command(self.valve_commands[self.CONVEYOR2_REVERSE]['open'])
|
||||
time.sleep(self.delay_conveyor)
|
||||
if belt and not status.get(self.BELT, False):
|
||||
self.send_command(self.valve_commands[self.BELT]['open'])
|
||||
# time.sleep(self.delay_belt)
|
||||
if alarm and not status.get(self.ALARM, False):
|
||||
self.send_command(self.valve_commands[self.ALARM]['open'])
|
||||
# time.sleep(self.delay_alarm)
|
||||
|
||||
def close(self, conveyor1=False, pusher=False, conveyor2=False, clamp=False, pusher1=False, conveyor2_reverse=False):
|
||||
def close(self, conveyor1=False, pusher=False, conveyor2=False, clamp=False, pusher1=False, conveyor2_reverse=False,belt=False,alarm=False):
|
||||
if conveyor1:
|
||||
self.send_command(self.valve_commands[self.CONVEYOR1]['close'])
|
||||
time.sleep(self.delay_conveyor)
|
||||
@ -311,6 +412,12 @@ class RelayController(QObject):
|
||||
if conveyor2_reverse:
|
||||
self.send_command(self.valve_commands[self.CONVEYOR2_REVERSE]['close'])
|
||||
time.sleep(self.delay_conveyor)
|
||||
if belt:
|
||||
self.send_command(self.valve_commands[self.BELT]['close'])
|
||||
# time.sleep(self.delay_belt)
|
||||
if alarm:
|
||||
self.send_command(self.valve_commands[self.ALARM]['close'])
|
||||
# time.sleep(self.delay_alarm)
|
||||
|
||||
# ===================== 传感器处理线程 =====================
|
||||
def handle_sensor1(self):
|
||||
@ -346,16 +453,17 @@ class RelayController(QObject):
|
||||
|
||||
time.sleep(1)
|
||||
# 5. 状态检查（可选）
|
||||
status = self.get_all_device_status()
|
||||
if status.get('conveyor1') and not status.get('pusher'):
|
||||
print("流程完成1：皮带运行中，推板已收回")
|
||||
else:
|
||||
print("状态异常，请检查设备")
|
||||
# status = self.get_all_device_status()
|
||||
# if status.get('conveyor1') and not status.get('pusher'):
|
||||
# print("流程完成1：皮带运行中，推板已收回")
|
||||
# else:
|
||||
# print("状态异常，请检查设备")
|
||||
# 流程结束，重置触发标志
|
||||
self.sensor1_triggered = False
|
||||
time.sleep(self.sensor1_loop_delay)
|
||||
except Exception as e:
|
||||
print(f"SENSOR1 处理错误: {e}")
|
||||
self.log_signal.emit(logging.ERROR,f"SENSOR1 处理错误: {e}")
|
||||
self.sensor1_triggered = False
|
||||
time.sleep(self.sensor1_error_delay)
|
||||
|
||||
@ -390,8 +498,10 @@ class RelayController(QObject):
|
||||
self.take_robot_signal.emit()
|
||||
_is_signal=False
|
||||
self.sensor2_ready=False #打开滚洞标识
|
||||
else:
|
||||
_is_signal=True
|
||||
else:
|
||||
if self.sensor2_ready:
|
||||
#只有在FPhoto处才有效
|
||||
_is_signal=True
|
||||
# time.sleep(0.1)
|
||||
continue
|
||||
elif self.sensor2_ready:
|
||||
@ -404,6 +514,7 @@ class RelayController(QObject):
|
||||
time.sleep(2)
|
||||
except Exception as e:
|
||||
print(f"SENSOR2 处理错误: {e}")
|
||||
self.log_signal.emit(logging.ERROR,f"SENSOR2 处理错误: {e}")
|
||||
time.sleep(self.sensor2_error_delay)
|
||||
|
||||
def pause_start_sensor(self,is_pause):
|
||||
@ -413,6 +524,7 @@ class RelayController(QObject):
|
||||
"""
|
||||
self._ispause = is_pause
|
||||
|
||||
|
||||
def stop_sensor(self,sensor1_thread,sensor2_thread):
|
||||
if not self._running:
|
||||
print("线程未在运行")
|
||||
@ -424,3 +536,22 @@ class RelayController(QObject):
|
||||
if sensor2_thread and sensor2_thread.is_alive():
|
||||
sensor2_thread.join()
|
||||
print("传感器线程已终止。")
|
||||
|
||||
def handle_emergency_pressed(self):
|
||||
"处理急停按钮信号状态线程"
|
||||
while self._running:
|
||||
try:
|
||||
loc_is_pressed =self.get_emergency_is_pressed()
|
||||
if loc_is_pressed:
|
||||
# 处理急停按钮信号状态
|
||||
self.log_signal.emit(logging.INFO,f"急停按钮被按下")
|
||||
self.emergency_is_pressed=True
|
||||
self.emergency_signal.emit(True)
|
||||
else:
|
||||
self.emergency_is_pressed=False
|
||||
self.emergency_signal.emit(False)
|
||||
time.sleep(0.5)
|
||||
except Exception as e:
|
||||
print(f"急停 处理错误: {e}")
|
||||
self.log_signal.emit(logging.ERROR,f"急停线程 处理错误: {e}")
|
||||
time.sleep(2)
|
||||
|
||||
Binary file not shown.
@ -102112,31 +102112,31 @@ qt_resource_struct = b"\
|
||||
\x00\x00\x00\x0e\x00\x02\x00\x00\x00\x0d\x00\x00\x00\x03\
|
||||
\x00\x00\x00\x00\x00\x00\x00\x00\
|
||||
\x00\x00\x00\xb2\x00\x00\x00\x00\x00\x01\x00\x03/R\
|
||||
\x00\x00\x01\x99\x8e\x16\x01I\
|
||||
\x00\x00\x01\x9a\x01M\x90X\
|
||||
\x00\x00\x00\x1e\x00\x00\x00\x00\x00\x01\x00\x00\x00\x00\
|
||||
\x00\x00\x01\x99\x8e\x16\x01R\
|
||||
\x00\x00\x01\x9a\x01M\x90h\
|
||||
\x00\x00\x008\x00\x00\x00\x00\x00\x01\x00\x00\x05\x9a\
|
||||
\x00\x00\x01\x99\x8e\x16\x01N\
|
||||
\x00\x00\x01\x9a\x01M\x90X\
|
||||
\x00\x00\x00~\x00\x00\x00\x00\x00\x01\x00\x03\x13\xe9\
|
||||
\x00\x00\x01\x99\x8e\x16\x01O\
|
||||
\x00\x00\x01\x9a\x01M\x90h\
|
||||
\x00\x00\x00\xe4\x00\x00\x00\x00\x00\x01\x00\x0ff\xaf\
|
||||
\x00\x00\x01\x99\x8e\x16\x01I\
|
||||
\x00\x00\x01\x9a\x01M\x90X\
|
||||
\x00\x00\x01\xbc\x00\x00\x00\x00\x00\x01\x00\x18\xcf\xe2\
|
||||
\x00\x00\x01\x99\x8e\x16\x01O\
|
||||
\x00\x00\x01\x9a\x01M\x90h\
|
||||
\x00\x00\x01\x88\x00\x00\x00\x00\x00\x01\x00\x16\xd0\xa3\
|
||||
\x00\x00\x01\x99\x8e\x16\x01N\
|
||||
\x00\x00\x01\x9a\x01M\x90X\
|
||||
\x00\x00\x01\xa6\x00\x00\x00\x00\x00\x01\x00\x16\xd7X\
|
||||
\x00\x00\x01\x99\x8e\x16\x01Q\
|
||||
\x00\x00\x01\x9a\x01M\x90h\
|
||||
\x00\x00\x01\x16\x00\x00\x00\x00\x00\x01\x00\x0f\xd3\xa7\
|
||||
\x00\x00\x01\x99\x8e\x16\x01L\
|
||||
\x00\x00\x01\x9a\x01M\x90X\
|
||||
\x00\x00\x00\x92\x00\x00\x00\x00\x00\x01\x00\x03\x1eU\
|
||||
\x00\x00\x01\x99\x8e\x16\x01P\
|
||||
\x00\x00\x01\x9a\x01M\x90h\
|
||||
\x00\x00\x00\xc2\x00\x00\x00\x00\x00\x01\x00\x0f\x5c\xad\
|
||||
\x00\x00\x01\x99\x8e\x16\x01O\
|
||||
\x00\x00\x01\x9a\x01M\x90X\
|
||||
\x00\x00\x01\xd6\x00\x00\x00\x00\x00\x01\x00\x18\xd4\xc0\
|
||||
\x00\x00\x01\x99\x8e\x16\x01O\
|
||||
\x00\x00\x01\x9a\x01M\x90h\
|
||||
\x00\x00\x01P\x00\x00\x00\x00\x00\x01\x00\x16\xbe\x07\
|
||||
\x00\x00\x01\x99\x8e\x16\x01N\
|
||||
\x00\x00\x01\x9a\x01M\x90X\
|
||||
"
|
||||
|
||||
def qInitResources():
|
||||
|
||||
Binary file not shown.
Binary file not shown.
Binary file not shown.
204
Mv3D/CameraUtil.py
Normal file
204
Mv3D/CameraUtil.py
Normal file
@ -0,0 +1,204 @@
|
||||
# vision/camera.py
|
||||
import cv2
|
||||
import os
|
||||
import time
|
||||
from datetime import datetime
|
||||
from typing import Optional
|
||||
import numpy as np
|
||||
import shutil # 用于检查磁盘空间
|
||||
|
||||
class CameraUtil:
|
||||
"""
|
||||
海康摄像头工具类，用于初始化、设置配置、捕获图像等操作
|
||||
"""
|
||||
def __init__(self):
|
||||
self.camera = None
|
||||
self.camera_type = "ip"
|
||||
self.camera_ip = "192.168.0.234"
|
||||
self.camera_port = 554
|
||||
self.camera_username = "admin"
|
||||
self.camera_password = "ailaimiye123"
|
||||
self.camera_channel = 1
|
||||
|
||||
def set_config(self, camera_type="ip", ip=None, port=None, username=None, password=None, channel=1):
|
||||
"""
|
||||
设置摄像头配置
|
||||
"""
|
||||
self.camera_type = camera_type
|
||||
if ip:
|
||||
self.camera_ip = ip
|
||||
if port:
|
||||
self.camera_port = port
|
||||
if username:
|
||||
self.camera_username = username
|
||||
if password:
|
||||
self.camera_password = password
|
||||
self.camera_channel = channel
|
||||
|
||||
def setup_capture(self, camera_index=0):
|
||||
"""
|
||||
设置摄像头捕获
|
||||
"""
|
||||
try:
|
||||
rtsp_url = f"rtsp://{self.camera_username}:{self.camera_password}@{self.camera_ip}:{self.camera_port}/streaming/channels/{self.camera_channel}01"
|
||||
self.camera = cv2.VideoCapture(rtsp_url, cv2.CAP_FFMPEG)
|
||||
|
||||
if not self.camera.isOpened():
|
||||
print(f"无法打开网络摄像头: {rtsp_url}")
|
||||
return False
|
||||
print(f"网络摄像头初始化成功，地址: {rtsp_url}")
|
||||
# 关键优化：设置极低的缓冲区大小
|
||||
self.camera.set(cv2.CAP_PROP_BUFFERSIZE, 1)
|
||||
# 确保设置合理的帧率
|
||||
self.camera.set(cv2.CAP_PROP_FPS, 25)
|
||||
|
||||
# 设置超时参数
|
||||
self.camera.set(cv2.CAP_PROP_OPEN_TIMEOUT_MSEC, 5000) # 5秒超时
|
||||
self.camera.set(cv2.CAP_PROP_READ_TIMEOUT_MSEC, 1000) # 1秒读取超时
|
||||
return True
|
||||
except Exception as e:
|
||||
print(f"摄像头设置失败: {e}")
|
||||
return False
|
||||
|
||||
def capture_frame(self):
|
||||
"""捕获当前帧并返回numpy数组，设置5秒总超时"""
|
||||
try:
|
||||
if self.camera is None:
|
||||
print("摄像头未初始化")
|
||||
return None
|
||||
|
||||
# 设置总超时时间为5秒
|
||||
total_timeout = 5.0 # 5秒总超时时间
|
||||
start_time = time.time()
|
||||
|
||||
# 跳20帧，获取最新图像
|
||||
frames_skipped = 0
|
||||
while frames_skipped < 20:
|
||||
# 检查总超时
|
||||
if time.time() - start_time > total_timeout:
|
||||
print("捕获图像总超时")
|
||||
return None
|
||||
self.camera.grab()
|
||||
time.sleep(0.05) # 稍微增加延迟，确保有新帧到达
|
||||
frames_skipped += 1
|
||||
|
||||
# 尝试读取帧，使用同一超时计时器
|
||||
read_attempts = 0
|
||||
max_read_attempts = 3
|
||||
if self.camera.grab():
|
||||
while read_attempts < max_read_attempts:
|
||||
# 使用同一个超时计时器检查
|
||||
if time.time() - start_time > total_timeout:
|
||||
print("捕获图像总超时")
|
||||
return None
|
||||
|
||||
ret, frame = self.camera.retrieve()
|
||||
if ret:
|
||||
return frame
|
||||
else:
|
||||
print(f"尝试读取图像帧失败，重试 ({read_attempts+1}/{max_read_attempts})")
|
||||
read_attempts += 1
|
||||
# 短暂延迟后重试
|
||||
time.sleep(0.05)
|
||||
|
||||
print("多次尝试后仍无法捕获有效图像帧")
|
||||
return None
|
||||
except Exception as e:
|
||||
print(f"图像捕获失败: {e}")
|
||||
return None
|
||||
|
||||
def release(self):
|
||||
"""释放摄像头资源"""
|
||||
if self.camera is not None:
|
||||
self.camera.release()
|
||||
self.camera = None
|
||||
print("摄像头资源已释放")
|
||||
|
||||
def save_frame(self, frame, save_dir="captured_frames", filename=None):
|
||||
"""
|
||||
保存图像帧到指定目录，按日期创建子文件夹
|
||||
:param frame: 要保存的图像帧
|
||||
:param save_dir: 保存根目录
|
||||
:param filename: 保存的文件名，如果为None则使用时分秒格式
|
||||
:return: 保存的文件路径
|
||||
"""
|
||||
try:
|
||||
# 确保保存根目录存在
|
||||
if not os.path.exists(save_dir):
|
||||
os.makedirs(save_dir)
|
||||
print(f"创建保存根目录: {save_dir}")
|
||||
|
||||
# 检查磁盘可用空间 - 修复变量名称错误
|
||||
total, used, free = shutil.disk_usage(save_dir)
|
||||
if free < 1024 * 1024 * 20: # 小于 20MB 就停止
|
||||
print(f"❌ 磁盘空间严重不足（仅剩 {free / (1024**3):.2f} GB），停止运行。")
|
||||
return None
|
||||
|
||||
# 获取当前日期，创建日期子文件夹
|
||||
current_date = datetime.now().strftime("%Y%m%d")
|
||||
date_dir = os.path.join(save_dir, current_date)
|
||||
|
||||
# 确保日期子文件夹存在
|
||||
if not os.path.exists(date_dir):
|
||||
os.makedirs(date_dir)
|
||||
print(f"创建日期文件夹: {date_dir}")
|
||||
|
||||
# 生成文件名（时分秒格式）
|
||||
if filename is None:
|
||||
time_str = datetime.now().strftime("%Y%m%d%H%M%S")
|
||||
filename = f"{time_str}.jpg"
|
||||
|
||||
# 保存图像到日期子文件夹
|
||||
save_path = os.path.join(date_dir, filename)
|
||||
loc_status=cv2.imwrite(save_path, frame)
|
||||
if not loc_status:
|
||||
print(f"保存图像失败: {save_path}")
|
||||
return None
|
||||
print(f"图像已保存到: {save_path}")
|
||||
return save_path
|
||||
except Exception as e:
|
||||
print(f"保存图像失败: {e}")
|
||||
return None
|
||||
|
||||
def save_img(self)->Optional[str]:
|
||||
"""
|
||||
保存当前帧
|
||||
:return: 保存的文件路径
|
||||
"""
|
||||
if self.camera is None:
|
||||
self.setup_capture()
|
||||
frame = self.capture_frame()
|
||||
if frame is not None:
|
||||
loc_filepath=self.save_frame(frame)
|
||||
self.release()
|
||||
return loc_filepath
|
||||
else:
|
||||
print("无法捕获图像帧")
|
||||
return None
|
||||
|
||||
|
||||
def __del__(self):
|
||||
"""关闭
|
||||
"""
|
||||
self.release()
|
||||
|
||||
|
||||
if __name__ == "__main__":
|
||||
camera = CameraUtil()
|
||||
for i in range(10):
|
||||
camera.save_img()
|
||||
time.sleep(5)
|
||||
camera.release()
|
||||
# camera.set_config(camera_type="ip", ip="192.168.0.234", port=554, username="admin", password="ailaimiye123", channel=1)
|
||||
# camera.setup_capture()
|
||||
# for i in range(10):
|
||||
# frame = camera.capture_frame()
|
||||
|
||||
# if frame is not None:
|
||||
# 保存当前帧
|
||||
# camera.save_frame(frame)
|
||||
# cv2.imshow("Camera Feed", frame)
|
||||
print('success')
|
||||
|
||||
# camera.release()
|
||||
# cv2.destroyAllWindows()
|
||||
237
Mv3D/calculate_diff2.py
Normal file
237
Mv3D/calculate_diff2.py
Normal file
@ -0,0 +1,237 @@
|
||||
import cv2
|
||||
import numpy as np
|
||||
import os
|
||||
|
||||
# ====================== 配置区 ======================
|
||||
|
||||
MODEL_PATH = "./Mv3D/point.rknn"
|
||||
OUTPUT_DIR = "./output_rknn"
|
||||
os.makedirs(OUTPUT_DIR, exist_ok=True)
|
||||
|
||||
# 固定参考点（像素坐标）
|
||||
FIXED_REF_POINT = (535, 605)
|
||||
|
||||
# mm/px 缩放因子（根据标定数据填写）
|
||||
width_mm = 70.0
|
||||
width_px = 42
|
||||
SCALE_X = width_mm / float(width_px)
|
||||
height_mm = 890.0
|
||||
height_px = 507
|
||||
SCALE_Y = height_mm / float(height_px)
|
||||
print(f"Scale factors: SCALE_X={SCALE_X:.3f} mm/px, SCALE_Y={SCALE_Y:.3f} mm/px")
|
||||
|
||||
# 输入尺寸
|
||||
IMG_SIZE = (640, 640)
|
||||
|
||||
|
||||
def letterbox_resize(image, size, bg_color=114):
|
||||
target_w, target_h = size
|
||||
h, w = image.shape[:2]
|
||||
scale = min(target_w / w, target_h / h)
|
||||
new_w, new_h = int(w * scale), int(h * scale)
|
||||
resized = cv2.resize(image, (new_w, new_h))
|
||||
canvas = np.full((target_h, target_w, 3), bg_color, dtype=np.uint8)
|
||||
dx, dy = (target_w - new_w) // 2, (target_h - new_h) // 2
|
||||
canvas[dy:dy + new_h, dx:dx + new_w] = resized
|
||||
return canvas, scale, dx, dy
|
||||
|
||||
|
||||
def safe_sigmoid(x):
|
||||
x = np.clip(x, -50, 50)
|
||||
return 1.0 / (1.0 + np.exp(-x))
|
||||
|
||||
|
||||
def softmax(x):
|
||||
x = x - np.max(x)
|
||||
e = np.exp(x)
|
||||
return e / e.sum()
|
||||
|
||||
|
||||
def dfl_to_xywh(loc, grid_x, grid_y, stride):
|
||||
"""将 DFL 输出解析为 xywh"""
|
||||
xywh_ = np.zeros(4)
|
||||
xywh = np.zeros(4)
|
||||
|
||||
# 每个维度 16 bins 做 softmax
|
||||
for i in range(4):
|
||||
l = loc[i * 16:(i + 1) * 16]
|
||||
l = softmax(l)
|
||||
xywh_[i] = sum([j * l[j] for j in range(16)])
|
||||
|
||||
# 对应公式
|
||||
xywh_[0] = (grid_x + 0.5) - xywh_[0]
|
||||
xywh_[1] = (grid_y + 0.5) - xywh_[1]
|
||||
xywh_[2] = (grid_x + 0.5) + xywh_[2]
|
||||
xywh_[3] = (grid_y + 0.5) + xywh_[3]
|
||||
|
||||
# 转成中心点 + 宽高
|
||||
xywh[0] = ((xywh_[0] + xywh_[2]) / 2) * stride
|
||||
xywh[1] = ((xywh_[1] + xywh_[3]) / 2) * stride
|
||||
xywh[2] = (xywh_[2] - xywh_[0]) * stride
|
||||
xywh[3] = (xywh_[3] - xywh_[1]) * stride
|
||||
|
||||
# 转为左上角坐标
|
||||
xywh[0] = xywh[0] - xywh[2] / 2
|
||||
xywh[1] = xywh[1] - xywh[3] / 2
|
||||
return xywh
|
||||
|
||||
|
||||
def parse_pose_outputs(outputs, conf_threshold=0.5, dx=0, dy=0, scale=1.0):
|
||||
"""
|
||||
完整解析 RKNN YOLO-Pose 输出
|
||||
返回 keypoints, class_id, obj_conf, bbox（已映射回原图）
|
||||
"""
|
||||
boxes = []
|
||||
obj_confs = []
|
||||
class_ids = []
|
||||
|
||||
# 遍历前三个输出 tensor (det 输出)
|
||||
for idx in range(3):
|
||||
det = np.array(outputs[idx])[0] # (C,H,W)
|
||||
C, H, W = det.shape
|
||||
num_classes = C - 64 # 前64通道为 DFL bbox
|
||||
stride = 640 // H
|
||||
|
||||
for h in range(H):
|
||||
for w in range(W):
|
||||
for c in range(num_classes):
|
||||
conf = safe_sigmoid(det[64 + c, h, w])
|
||||
if conf >= conf_threshold:
|
||||
loc = det[:64, h, w].astype(np.float32)
|
||||
xywh = dfl_to_xywh(loc, w, h, stride)
|
||||
boxes.append(xywh)
|
||||
obj_confs.append(conf)
|
||||
class_ids.append(c)
|
||||
|
||||
if not obj_confs:
|
||||
best_box = np.array([0, 0, 0, 0])
|
||||
class_id = -1
|
||||
obj_conf = 0.0
|
||||
else:
|
||||
max_idx = np.argmax(obj_confs)
|
||||
best_box = boxes[max_idx]
|
||||
class_id = class_ids[max_idx]
|
||||
obj_conf = obj_confs[max_idx]
|
||||
|
||||
# 🔹 bbox 坐标映射回原图
|
||||
x, y, w, h = best_box
|
||||
x = (x - dx) / scale
|
||||
y = (y - dy) / scale
|
||||
w = w / scale
|
||||
h = h / scale
|
||||
best_box = np.array([x, y, w, h])
|
||||
|
||||
# 🔹 关键点解析
|
||||
kpt_output = np.array(outputs[3])[0] # (num_kpts, 3, num_anchor)
|
||||
confs = kpt_output[:, 2, :]
|
||||
best_anchor_idx = np.argmax(np.mean(confs, axis=0))
|
||||
kpt_data = kpt_output[:, :, best_anchor_idx]
|
||||
|
||||
keypoints = []
|
||||
for i in range(kpt_data.shape[0]):
|
||||
x_img, y_img, vis_conf_raw = kpt_data[i]
|
||||
vis_prob = safe_sigmoid(vis_conf_raw)
|
||||
x_orig = (x_img - dx) / scale
|
||||
y_orig = (y_img - dy) / scale
|
||||
keypoints.append([x_orig, y_orig, vis_prob])
|
||||
|
||||
return np.array(keypoints), class_id, obj_conf, best_box
|
||||
|
||||
|
||||
def compute_offset(keypoints, fixed_point, scale_x, scale_y):
|
||||
if len(keypoints) < 2:
|
||||
return None
|
||||
p1, p2 = keypoints[0], keypoints[1]
|
||||
cx = (p1[0] + p2[0]) / 2.0
|
||||
cy = (p1[1] + p2[1]) / 2.0
|
||||
dx_mm = (cx - fixed_point[0]) * scale_x
|
||||
dy_mm = (cy - fixed_point[1]) * scale_y
|
||||
return cx, cy, dx_mm, dy_mm
|
||||
|
||||
|
||||
def visualize_result(image, keypoints, bbox, fixed_point, offset_info, save_path):
|
||||
vis = image.copy()
|
||||
colors = [(0, 0, 255), (0, 255, 255)]
|
||||
cx, cy, dx_mm, dy_mm = offset_info
|
||||
fx, fy = map(int, fixed_point)
|
||||
|
||||
# 绘制关键点
|
||||
for i, (x, y, conf) in enumerate(keypoints[:2]):
|
||||
if conf > 0.5:
|
||||
cv2.circle(vis, (int(x), int(y)), 6, colors[i], -1)
|
||||
if len(keypoints) >= 2:
|
||||
cv2.line(vis,
|
||||
(int(keypoints[0][0]), int(keypoints[0][1])),
|
||||
(int(keypoints[1][0]), int(keypoints[1][1])),
|
||||
(0, 255, 0), 2)
|
||||
|
||||
# 绘制 bbox
|
||||
x, y, w, h = bbox
|
||||
cv2.rectangle(vis, (int(x), int(y)), (int(x + w), int(y + h)), (255, 0, 0), 2)
|
||||
|
||||
# 绘制中心点
|
||||
cv2.circle(vis, (int(cx), int(cy)), 10, (0, 255, 0), 3)
|
||||
cv2.circle(vis, (fx, fy), 12, (255, 255, 0), 3)
|
||||
cv2.arrowedLine(vis, (fx, fy), (int(cx), int(cy)), (255, 255, 0), 2, tipLength=0.05)
|
||||
cv2.putText(vis, f"DeltaX={dx_mm:+.1f}mm", (fx + 30, fy - 30),
|
||||
cv2.FONT_HERSHEY_SIMPLEX, 0.8, (0, 255, 255), 2)
|
||||
cv2.putText(vis, f"DeltaY={dy_mm:+.1f}mm", (fx + 30, fy + 30),
|
||||
cv2.FONT_HERSHEY_SIMPLEX, 0.8, (0, 255, 255), 2)
|
||||
|
||||
cv2.imwrite(save_path, vis)
|
||||
|
||||
|
||||
def calculate_offset_from_image(image_path, visualize=False):
|
||||
from rknnlite.api import RKNNLite
|
||||
|
||||
orig = cv2.imread(image_path)
|
||||
if orig is None:
|
||||
return {'success': False, 'message': f'Failed to load image: {image_path}'}
|
||||
|
||||
img_resized, scale, dx, dy = letterbox_resize(orig, IMG_SIZE)
|
||||
infer_img = np.expand_dims(img_resized[..., ::-1], 0).astype(np.uint8)
|
||||
|
||||
rknn = RKNNLite(verbose=False)
|
||||
ret = rknn.load_rknn(MODEL_PATH)
|
||||
if ret != 0:
|
||||
return {'success': False, 'message': 'Failed to load RKNN model'}
|
||||
|
||||
try:
|
||||
rknn.init_runtime(core_mask=RKNNLite.NPU_CORE_0)
|
||||
outputs = rknn.inference([infer_img])
|
||||
finally:
|
||||
rknn.release()
|
||||
|
||||
try:
|
||||
keypoints, class_id, obj_conf, bbox = parse_pose_outputs(outputs, dx=dx, dy=dy, scale=scale)
|
||||
except Exception as e:
|
||||
return {'success': False, 'message': f'Parse error: {str(e)}'}
|
||||
|
||||
offset_info = compute_offset(keypoints, FIXED_REF_POINT, SCALE_X, SCALE_Y)
|
||||
if offset_info is None:
|
||||
return {'success': False, 'message': 'Not enough keypoints'}
|
||||
|
||||
cx, cy, dx_mm, dy_mm = offset_info
|
||||
|
||||
if visualize:
|
||||
vis_save_path = os.path.join(OUTPUT_DIR, f"result_{os.path.basename(image_path)}")
|
||||
visualize_result(orig, keypoints, bbox, FIXED_REF_POINT, offset_info, vis_save_path)
|
||||
|
||||
return {'success': True, 'dx_mm': dx_mm, 'dy_mm': dy_mm,
|
||||
'cx': cx, 'cy': cy, 'class_id': class_id,
|
||||
'obj_conf': obj_conf, 'bbox': bbox,
|
||||
'message': 'Success'}
|
||||
|
||||
|
||||
# ====================== 使用示例 ======================
|
||||
if __name__ == "__main__":
|
||||
image_path = "11.jpg"
|
||||
result = calculate_offset_from_image(image_path, visualize=True)
|
||||
|
||||
if result['success']:
|
||||
print(f"Center point: ({result['cx']:.1f}, {result['cy']:.1f})")
|
||||
print(f"Offset: DeltaX={result['dx_mm']:+.2f} mm, DeltaY={result['dy_mm']:+.2f} mm")
|
||||
print(f"Class ID: {result['class_id']}, Confidence: {result['obj_conf']:.3f}")
|
||||
print(f"BBox: {result['bbox']}")
|
||||
else:
|
||||
print("Error:", result['message'])
|
||||
BIN
Mv3D/point.rknn
Normal file
BIN
Mv3D/point.rknn
Normal file
Binary file not shown.
@ -47,7 +47,7 @@ photo_v5 = 0.0
|
||||
photo_w5 = 1.0
|
||||
linecount = 2
|
||||
remain_linename = 1
|
||||
remain_count = 10
|
||||
remain_count = 0
|
||||
maduo_count = 30
|
||||
io_take_addr = 8
|
||||
io_zip_addr = 11
|
||||
|
||||
Binary file not shown.
Binary file not shown.
Binary file not shown.
Binary file not shown.
Binary file not shown.
Binary file not shown.
@ -55,6 +55,15 @@ class Logger(QObject):
|
||||
handler.setFormatter(formatter)
|
||||
self.logger_file_info.addHandler(handler)
|
||||
|
||||
# 添加错误专用日志文件
|
||||
error_handler = TimedRotatingFileHandler(
|
||||
file_path.replace('.log', '_error.log'),
|
||||
when='D', interval=1, backupCount=30, encoding='utf-8')
|
||||
error_handler.suffix = "%Y-%m-%d"
|
||||
error_handler.setLevel(logging.ERROR) # 只处理错误级别
|
||||
error_handler.setFormatter(formatter)
|
||||
self.logger_file_info.addHandler(error_handler)
|
||||
|
||||
def _process_logs(self):
|
||||
while True:
|
||||
time.sleep(0.1)
|
||||
|
||||
Binary file not shown.
Binary file not shown.
Binary file not shown.
Binary file not shown.
Binary file not shown.
Binary file not shown.
17229
log/log.log
17229
log/log.log
File diff suppressed because it is too large
Load Diff
@ -1,40 +0,0 @@
|
||||
2024-12-14 16:10:42 - INFO - <20><><EFBFBD><EFBFBD>ϵͳ
|
||||
2024-12-14 16:11:15 - ERROR - <20>ظ<DEBB>
|
||||
2024-12-14 16:14:02 - INFO - <20>ƶ<EFBFBD><C6B6><EFBFBD>λ<EFBFBD><CEBB>:<3A><><EFBFBD><EFBFBD>·<EFBFBD><C2B7><EFBFBD><EFBFBD>m0:1.0-m2:0.0-m3:0.0-m4:0.0-m5:0.0-m6:0.0
|
||||
2024-12-14 16:14:06 - ERROR - <20>ظ<DEBB>
|
||||
2024-12-14 16:14:10 - INFO - <20><><EFBFBD><EFBFBD>Ͷ<EFBFBD>ϴ<EFBFBD><CFB4><EFBFBD>:1
|
||||
2024-12-14 16:14:11 - INFO - <20>л<EFBFBD><D0BB><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
|
||||
2024-12-14 16:14:11 - INFO - <20>л<EFBFBD><D0BB><EFBFBD><EFBFBD>Զ<EFBFBD><D4B6><EFBFBD><EFBFBD><EFBFBD>״̬
|
||||
2024-12-14 16:14:12 - INFO - <20><>һ<EFBFBD><D2BB>ȷ<EFBFBD><C8B7><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
|
||||
2024-12-14 16:14:12 - INFO - <20><>Ӧ<EFBFBD><D3A6>1:Ͷ<>Ͽ<EFBFBD>ʼ
|
||||
2024-12-14 16:14:12 - INFO - <20><><EFBFBD><EFBFBD>IO<49><4F><EFBFBD><EFBFBD>: 3<><33>1
|
||||
2024-12-14 16:14:14 - ERROR - <20>ظ<DEBB>
|
||||
2024-12-14 16:14:17 - INFO - <20><><EFBFBD><EFBFBD>IO<49><4F><EFBFBD><EFBFBD>: 3<><33>0
|
||||
2024-12-14 16:14:17 - INFO - Ͷ<>Ͽ<EFBFBD>ʼ
|
||||
2024-12-14 16:14:21 - ERROR - <20>ظ<DEBB>
|
||||
2024-12-14 16:21:15 - INFO - <20>˳<EFBFBD>ϵͳ
|
||||
2024-12-14 16:21:15 - ERROR - <20>ظ<DEBB>
|
||||
2024-12-14 16:21:15 - ERROR - model
|
||||
2024-12-14 16:21:27 - INFO - <20><><EFBFBD><EFBFBD>ϵͳ
|
||||
2024-12-14 16:21:59 - ERROR - <20>ظ<DEBB>
|
||||
2024-12-14 16:37:33 - INFO - <20>л<EFBFBD><D0BB><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
|
||||
2024-12-14 16:37:33 - INFO - <20>л<EFBFBD><D0BB><EFBFBD><EFBFBD>Զ<EFBFBD><D4B6><EFBFBD><EFBFBD><EFBFBD>״̬
|
||||
2024-12-14 16:37:34 - INFO - <20><>һ<EFBFBD><D2BB>ȷ<EFBFBD><C8B7><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
|
||||
2024-12-14 16:37:34 - INFO - <20><>Ӧ<EFBFBD><D3A6>1:Ͷ<>Ͽ<EFBFBD>ʼ
|
||||
2024-12-14 16:37:34 - INFO - <20><><EFBFBD><EFBFBD>IO<49><4F><EFBFBD><EFBFBD>: 3<><33>1
|
||||
2024-12-14 16:37:38 - ERROR - <20>ظ<DEBB>
|
||||
2024-12-14 16:37:39 - INFO - <20><><EFBFBD><EFBFBD>Ͷ<EFBFBD>ϴ<EFBFBD><CFB4><EFBFBD>:10
|
||||
2024-12-14 16:37:39 - INFO - <20>л<EFBFBD><D0BB><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
|
||||
2024-12-14 16:37:39 - INFO - <20>л<EFBFBD><D0BB><EFBFBD><EFBFBD>Զ<EFBFBD><D4B6><EFBFBD><EFBFBD><EFBFBD>״̬
|
||||
2024-12-14 16:37:39 - INFO - <20><><EFBFBD><EFBFBD>IO<49><4F><EFBFBD><EFBFBD>: 3<><33>0
|
||||
2024-12-14 16:37:39 - INFO - Ͷ<>Ͽ<EFBFBD>ʼ
|
||||
2024-12-14 16:37:46 - ERROR - <20>ظ<DEBB>
|
||||
2024-12-14 16:39:27 - INFO - <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
|
||||
2024-12-14 16:39:27 - INFO - Ͷ<><CDB6>ֹͣ
|
||||
2024-12-14 16:39:28 - INFO - <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
|
||||
2024-12-14 16:39:28 - INFO - Ͷ<><CDB6>ֹͣ
|
||||
2024-12-14 16:39:30 - INFO - Ͷ<><CDB6><EFBFBD><EFBFBD>ͣ
|
||||
2024-12-14 16:39:30 - ERROR - <20>ظ<DEBB>
|
||||
2024-12-14 16:39:30 - INFO - Ͷ<><CDB6><EFBFBD><EFBFBD>ͣ
|
||||
2024-12-14 16:39:38 - ERROR - <20>ظ<DEBB>
|
||||
2024-12-14 16:41:47 - INFO - <20>û<EFBFBD><C3BB><EFBFBD><EFBFBD><EFBFBD><EFBFBD>˳<EFBFBD><CBB3><EFBFBD><EFBFBD><EFBFBD>
|
||||
581330
log/log.log.2025-07-30
581330
log/log.log.2025-07-30
File diff suppressed because it is too large
Load Diff
8075
log/log.log.bak
8075
log/log.log.bak
File diff suppressed because it is too large
Load Diff
804
log/log.logbak
804
log/log.logbak
@ -1,804 +0,0 @@
|
||||
2025-08-12 10:22:17 - INFO - 进入系统
|
||||
2025-08-12 10:22:25 - INFO - 第一层确认生产
|
||||
2025-08-12 10:22:25 - INFO - 反应釜1:投料开始
|
||||
2025-08-12 10:22:25 - INFO - 发送命令{"dsID":"HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"200","type":"0","io_status":"1","point":"2","delay":"0"}]}
|
||||
2025-08-12 10:22:25 - INFO - 发送IO控制: 2，1
|
||||
2025-08-12 10:22:30 - INFO - 第一层确认生产
|
||||
2025-08-12 10:22:30 - INFO - 反应釜1:投料开始
|
||||
2025-08-12 10:22:30 - INFO - 发送命令{"dsID":"HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"200","type":"0","io_status":"0","point":"2","delay":"0"}]}
|
||||
2025-08-12 10:22:30 - INFO - 发送IO控制: 2，0
|
||||
2025-08-12 10:22:30 - INFO - 投料开始
|
||||
2025-08-12 10:22:31 - INFO - 移动到位置:姿势直线：X:-828.689758-Y:-1146.968872-Z:-77.084404-U:-90.137154-V:0.0-W:-0.0
|
||||
2025-08-12 10:22:31 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"-828.689758","m1":"-1146.968872","m2":"-77.084404","m3":"-90.137154","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:22:31 - ERROR - 启动传感器线程失败: log_message() missing 1 required positional argument: 'message'
|
||||
2025-08-12 10:22:32 - INFO - 投料开始
|
||||
2025-08-12 10:22:33 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"-828.689758","m1":"-1146.968872","m2":"-77.084404","m3":"-90.137154","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:22:33 - INFO - 移动到位置:姿势直线：X:-828.689758-Y:-1146.968872-Z:-77.084404-U:-90.137154-V:0.0-W:-0.0
|
||||
2025-08-12 10:22:33 - INFO - 移动到中位位置
|
||||
2025-08-12 10:22:33 - INFO - 移动到位置:姿势直线：X:-828.689758-Y:-1146.968872-Z:-77.084404-U:-90.137154-V:0.0-W:-0.0
|
||||
2025-08-12 10:22:33 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"-828.689758","m1":"-1146.968872","m2":"-77.084404","m3":"-90.137154","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:22:33 - INFO - [调试计数] 已进入 FMid 分支 1 次
|
||||
2025-08-12 10:22:33 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"-828.689758","m1":"-1146.968872","m2":"-77.084404","m3":"-90.137154","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:22:33 - INFO - 检测是否安全投料
|
||||
2025-08-12 10:22:33 - INFO - 移动到位置:姿势直线：X:-828.689758-Y:-1146.968872-Z:-77.084404-U:-90.137154-V:0.0-W:-0.0
|
||||
2025-08-12 10:22:33 - INFO - 检测是否安全投料
|
||||
2025-08-12 10:22:34 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"-828.689758","m1":"-1146.968872","m2":"-77.084404","m3":"-90.137154","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:22:34 - INFO - 移动到位置:姿势直线：X:-828.689758-Y:-1146.968872-Z:-77.084404-U:-90.137154-V:0.0-W:-0.0
|
||||
2025-08-12 10:22:34 - INFO - 拍照
|
||||
2025-08-12 10:22:34 - INFO - 识别图像成功
|
||||
2025-08-12 10:22:34 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:22:34 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:22:35 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:22:36 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:22:37 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:22:38 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:22:39 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:22:40 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:22:41 - INFO - 清除报警
|
||||
2025-08-12 10:22:41 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"1","instructions":[]}
|
||||
2025-08-12 10:22:41 - INFO - 投料停止
|
||||
2025-08-12 10:22:41 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:22:42 - INFO - ✅ 传感器2检测到料包到位，开始执行抓取
|
||||
2025-08-12 10:22:43 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"-828.689758","m1":"-1146.968872","m2":"-77.084404","m3":"-90.137154","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:22:43 - INFO - 移动到位置:姿势直线：X:-828.689758-Y:-1146.968872-Z:-77.084404-U:-90.137154-V:0.0-W:-0.0
|
||||
2025-08-12 10:22:43 - INFO - 执行完成FPhoto
|
||||
2025-08-12 10:22:43 - INFO - 拍照
|
||||
2025-08-12 10:22:43 - INFO - 识别图像成功
|
||||
2025-08-12 10:22:43 - INFO - ✅ 传感器2检测到料包到位，开始执行抓取
|
||||
2025-08-12 10:22:43 - INFO - 移动到位置:姿势直线：X:-569.528625-Y:-1299.985718-Z:-413.431213-U:-151.127274-V:0.0-W:-0.0
|
||||
2025-08-12 10:22:43 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"-569.528625","m1":"-1299.985718","m2":"-413.431213","m3":"-151.127274","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:22:43 - INFO - 执行完成FPhoto
|
||||
2025-08-12 10:22:44 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"-569.531006","m1":"-1299.971069","m2":"-825.315613","m3":"-151.126694","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:22:44 - INFO - 移动到中位位置
|
||||
2025-08-12 10:22:44 - INFO - 移动到位置:姿势直线：X:-569.531006-Y:-1299.971069-Z:-825.315613-U:-151.126694-V:0.0-W:-0.0
|
||||
2025-08-12 10:22:44 - INFO - [调试计数] 已进入 FMid 分支 2 次
|
||||
2025-08-12 10:22:47 - INFO - 移动到中位位置
|
||||
2025-08-12 10:22:47 - INFO - 移动到位置:姿势直线：X:-569.543396-Y:-1299.659543-Z:-1269.931256-U:-151.12764-V:0.258-W:0.258
|
||||
2025-08-12 10:22:47 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"-569.543396","m1":"-1299.659543","m2":"-1269.931256","m3":"-151.12764","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:22:47 - INFO - [调试计数] 已进入 FMid 分支 3 次
|
||||
2025-08-12 10:22:49 - INFO - 移动到中位位置
|
||||
2025-08-12 10:22:49 - INFO - 移动到位置:姿势直线：X:-569.543396-Y:-1299.659543-Z:-1269.931256-U:-151.12764-V:0.258-W:0.258
|
||||
2025-08-12 10:22:49 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"-569.543396","m1":"-1299.659543","m2":"-1269.931256","m3":"-151.12764","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:22:49 - INFO - [调试计数] 已进入 FMid 分支 4 次
|
||||
2025-08-12 10:22:50 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:22:50 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:22:50 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:22:50 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:22:50 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:22:50 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:22:50 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:22:50 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:22:50 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:22:51 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:22:51 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:22:51 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:22:51 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:22:51 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:22:51 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:22:51 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:22:51 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:22:51 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:22:51 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:22:52 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:22:52 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:22:52 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:22:52 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:22:52 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:22:52 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:22:52 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:22:52 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:22:52 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:22:53 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:22:53 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:22:53 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:22:53 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:22:53 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:22:53 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:22:53 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:22:53 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:22:53 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:22:54 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:22:54 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:22:54 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:22:54 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:22:54 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:22:54 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:22:54 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:22:54 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:22:54 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:22:55 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:22:55 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:22:55 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:22:55 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:22:55 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:22:55 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:22:55 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:22:55 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:22:55 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:22:55 - INFO - 🟢 机器人已到达抓料点位
|
||||
2025-08-12 10:22:56 - INFO - 已设置放置点: X=-187.12
|
||||
2025-08-12 10:22:56 - INFO - 移动到位置:姿势直线：X:-569.543396-Y:-1299.659543-Z:-1269.931256-U:-151.12764-V:0.258-W:0.258
|
||||
2025-08-12 10:22:56 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"-569.543396","m1":"-1299.659543","m2":"-1269.931256","m3":"-151.12764","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:22:56 - INFO - 移动到中位位置
|
||||
2025-08-12 10:22:56 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"-569.524475","m1":"-1299.973877","m2":"-825.314453","m3":"-151.126846","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:22:56 - INFO - 移动到位置:姿势直线：X:-569.524475-Y:-1299.973877-Z:-825.314453-U:-151.126846-V:0.0-W:-0.0
|
||||
2025-08-12 10:22:56 - INFO - [调试计数] 已进入 FMid 分支 5 次
|
||||
2025-08-12 10:22:56 - INFO - 移动到中位位置
|
||||
2025-08-12 10:22:56 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"-569.522156","m1":"-1299.988647","m2":"-413.430023","m3":"-151.126541","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:22:57 - INFO - 移动到位置:姿势直线：X:-569.522156-Y:-1299.988647-Z:-413.430023-U:-151.126541-V:0.0-W:-0.0
|
||||
2025-08-12 10:22:57 - INFO - [调试计数] 已进入 FMid 分支 6 次
|
||||
2025-08-12 10:22:57 - INFO - 移动到中位位置
|
||||
2025-08-12 10:22:57 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"1143.22937","m1":"-822.204346","m2":"-84.250801","m3":"-73.561378","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:22:57 - INFO - 移动到位置:姿势直线：X:1143.22937-Y:-822.204346-Z:-84.250801-U:-73.561378-V:0.0-W:-0.0
|
||||
2025-08-12 10:22:57 - INFO - [调试计数] 已进入 FMid 分支 7 次
|
||||
2025-08-12 10:23:05 - INFO - 移动到中位位置
|
||||
2025-08-12 10:23:05 - INFO - 移动到位置:姿势直线：X:890.821655-Y:-313.300446-Z:-691.557617-U:-63.248192-V:0.0-W:-0.0
|
||||
2025-08-12 10:23:05 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"890.821655","m1":"-313.300446","m2":"-691.557617","m3":"-63.248192","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:23:05 - INFO - [调试计数] 已进入 FMid 分支 8 次
|
||||
2025-08-12 10:23:09 - INFO - 移动到破袋位置
|
||||
2025-08-12 10:23:09 - INFO - 移动到位置:姿势直线：X:-828.689758-Y:-1146.968872-Z:-77.084404-U:-90.137154-V:0.0-W:-0.0
|
||||
2025-08-12 10:23:09 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"-828.689758","m1":"-1146.968872","m2":"-77.084404","m3":"-90.137154","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:23:09 - INFO - 拍照
|
||||
2025-08-12 10:23:10 - INFO - 识别图像成功
|
||||
2025-08-12 10:23:10 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:23:10 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:23:11 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:23:12 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:23:13 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:23:14 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:23:16 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:23:17 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:23:18 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:23:19 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:23:20 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:23:21 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:23:22 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:23:23 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:23:24 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:23:25 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:23:26 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:23:27 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:23:28 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:23:29 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:23:30 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:23:31 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:23:32 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:23:33 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:23:34 - INFO - ✅ 传感器2检测到料包到位，开始执行抓取
|
||||
2025-08-12 10:23:34 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"-569.528625","m1":"-1299.985718","m2":"-413.431213","m3":"-151.127274","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:23:35 - INFO - 移动到位置:姿势直线：X:-569.528625-Y:-1299.985718-Z:-413.431213-U:-151.127274-V:0.0-W:-0.0
|
||||
2025-08-12 10:23:35 - INFO - 执行完成FPhoto
|
||||
2025-08-12 10:23:35 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"-569.531006","m1":"-1299.971069","m2":"-825.315613","m3":"-151.126694","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:23:35 - INFO - 移动到中位位置
|
||||
2025-08-12 10:23:35 - INFO - 移动到位置:姿势直线：X:-569.531006-Y:-1299.971069-Z:-825.315613-U:-151.126694-V:0.0-W:-0.0
|
||||
2025-08-12 10:23:35 - INFO - [调试计数] 已进入 FMid 分支 9 次
|
||||
2025-08-12 10:23:38 - INFO - 移动到中位位置
|
||||
2025-08-12 10:23:38 - INFO - 移动到位置:姿势直线：X:-569.543396-Y:-1299.659543-Z:-1269.931256-U:-151.12764-V:0.258-W:0.258
|
||||
2025-08-12 10:23:38 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"-569.543396","m1":"-1299.659543","m2":"-1269.931256","m3":"-151.12764","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:23:38 - INFO - [调试计数] 已进入 FMid 分支 10 次
|
||||
2025-08-12 10:23:40 - INFO - 移动到中位位置
|
||||
2025-08-12 10:23:40 - INFO - 移动到位置:姿势直线：X:-569.543396-Y:-1299.659543-Z:-1269.931256-U:-151.12764-V:0.258-W:0.258
|
||||
2025-08-12 10:23:41 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"-569.543396","m1":"-1299.659543","m2":"-1269.931256","m3":"-151.12764","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:23:41 - INFO - [调试计数] 已进入 FMid 分支 11 次
|
||||
2025-08-12 10:23:41 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:23:41 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:23:41 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:23:41 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:23:41 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:23:41 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:23:41 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:23:42 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:23:42 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:23:42 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:23:42 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:23:42 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:23:42 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:23:42 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:23:42 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:23:42 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:23:42 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:23:43 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:23:43 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:23:43 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:23:43 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:23:43 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:23:43 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:23:43 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:23:43 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:23:43 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:23:44 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:23:44 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:23:44 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:23:44 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:23:44 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:23:44 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:23:44 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:23:44 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:23:44 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:23:45 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:23:45 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:23:45 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:23:45 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:23:45 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:23:45 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:23:45 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:23:45 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:23:45 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:23:45 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:23:46 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:23:46 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:23:46 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:23:46 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:23:46 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:23:46 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:23:46 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:23:46 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:23:46 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:23:47 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:23:47 - INFO - 🟢 机器人已到达抓料点位
|
||||
2025-08-12 10:23:47 - INFO - 已设置放置点: X=1069.08
|
||||
2025-08-12 10:23:47 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"-569.543396","m1":"-1299.659543","m2":"-1269.931256","m3":"-151.12764","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:23:47 - INFO - 移动到位置:姿势直线：X:-569.543396-Y:-1299.659543-Z:-1269.931256-U:-151.12764-V:0.258-W:0.258
|
||||
2025-08-12 10:23:47 - INFO - 移动到中位位置
|
||||
2025-08-12 10:23:47 - INFO - 移动到位置:姿势直线：X:-569.524475-Y:-1299.973877-Z:-825.314453-U:-151.126846-V:0.0-W:-0.0
|
||||
2025-08-12 10:23:47 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"-569.524475","m1":"-1299.973877","m2":"-825.314453","m3":"-151.126846","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:23:47 - INFO - [调试计数] 已进入 FMid 分支 12 次
|
||||
2025-08-12 10:23:48 - INFO - 移动到中位位置
|
||||
2025-08-12 10:23:48 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"-569.522156","m1":"-1299.988647","m2":"-413.430023","m3":"-151.126541","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:23:48 - INFO - 移动到位置:姿势直线：X:-569.522156-Y:-1299.988647-Z:-413.430023-U:-151.126541-V:0.0-W:-0.0
|
||||
2025-08-12 10:23:48 - INFO - [调试计数] 已进入 FMid 分支 13 次
|
||||
2025-08-12 10:23:48 - INFO - 移动到中位位置
|
||||
2025-08-12 10:23:48 - INFO - 移动到位置:姿势直线：X:1143.22937-Y:-822.204346-Z:-84.250801-U:-73.561378-V:0.0-W:-0.0
|
||||
2025-08-12 10:23:48 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"1143.22937","m1":"-822.204346","m2":"-84.250801","m3":"-73.561378","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:23:48 - INFO - [调试计数] 已进入 FMid 分支 14 次
|
||||
2025-08-12 10:23:56 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"890.821655","m1":"-313.300446","m2":"-691.557617","m3":"-63.248192","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:23:56 - INFO - 移动到中位位置
|
||||
2025-08-12 10:23:56 - INFO - 移动到位置:姿势直线：X:890.821655-Y:-313.300446-Z:-691.557617-U:-63.248192-V:0.0-W:-0.0
|
||||
2025-08-12 10:23:56 - INFO - [调试计数] 已进入 FMid 分支 15 次
|
||||
2025-08-12 10:24:00 - INFO - 移动到破袋位置
|
||||
2025-08-12 10:24:00 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"-828.689758","m1":"-1146.968872","m2":"-77.084404","m3":"-90.137154","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:24:00 - INFO - 移动到位置:姿势直线：X:-828.689758-Y:-1146.968872-Z:-77.084404-U:-90.137154-V:0.0-W:-0.0
|
||||
2025-08-12 10:24:00 - INFO - 拍照
|
||||
2025-08-12 10:24:00 - INFO - 识别图像成功
|
||||
2025-08-12 10:24:01 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:24:01 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:24:02 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:24:03 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:24:04 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:24:05 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:24:06 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:24:07 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:24:08 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:24:10 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:24:11 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:24:12 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:24:13 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:24:14 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:24:15 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:24:16 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:24:17 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:24:18 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:24:19 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:24:20 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:24:21 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:24:22 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:24:23 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:24:23 - ERROR - 'str' object has no attribute 'release'
|
||||
2025-08-12 10:24:24 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:24:25 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:24:26 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:24:26 - ERROR - 'str' object has no attribute 'release'
|
||||
2025-08-12 10:24:27 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:24:28 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:24:29 - ERROR - 'str' object has no attribute 'release'
|
||||
2025-08-12 10:24:29 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:24:30 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:24:31 - ERROR - 'str' object has no attribute 'release'
|
||||
2025-08-12 10:24:31 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:24:32 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:24:33 - ERROR - 'str' object has no attribute 'release'
|
||||
2025-08-12 10:30:07 - INFO - 进入系统
|
||||
2025-08-12 10:30:12 - INFO - 发送命令{"dsID":"www.hc-system.com.RemoteMonitor","reqType":"command","cmdData":["switchTool","2"]}
|
||||
2025-08-12 10:30:12 - INFO - 切换到工具坐标
|
||||
2025-08-12 10:30:12 - INFO - 发送命令{"dsID":"www.hc-system.com.RemoteMonitor","reqType":"command","cmdData":["startButton","1"]}
|
||||
2025-08-12 10:30:12 - INFO - 切换到自动运行状态
|
||||
2025-08-12 10:30:13 - ERROR - 发生报警：42
|
||||
2025-08-12 10:30:13 - ERROR - 发生报警：42
|
||||
2025-08-12 10:30:13 - ERROR - 发生报警：42
|
||||
2025-08-12 10:30:13 - ERROR - 发生报警：42
|
||||
2025-08-12 10:30:14 - ERROR - 发生报警：42
|
||||
2025-08-12 10:30:14 - ERROR - 发生报警：42
|
||||
2025-08-12 10:30:14 - INFO - 第一层确认生产
|
||||
2025-08-12 10:30:14 - INFO - 反应釜1:投料开始
|
||||
2025-08-12 10:30:14 - INFO - 发送命令{"dsID":"HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"200","type":"0","io_status":"1","point":"2","delay":"0"}]}
|
||||
2025-08-12 10:30:14 - INFO - 发送IO控制: 2，1
|
||||
2025-08-12 10:30:14 - ERROR - 发生报警：42
|
||||
2025-08-12 10:30:15 - ERROR - 发生报警：42
|
||||
2025-08-12 10:30:15 - ERROR - 发生报警：42
|
||||
2025-08-12 10:30:15 - ERROR - 发生报警：42
|
||||
2025-08-12 10:30:15 - ERROR - 发生报警：42
|
||||
2025-08-12 10:30:15 - ERROR - 发生报警：42
|
||||
2025-08-12 10:30:15 - ERROR - 发生报警：42
|
||||
2025-08-12 10:30:15 - ERROR - 发生报警：42
|
||||
2025-08-12 10:30:16 - ERROR - 发生报警：42
|
||||
2025-08-12 10:30:16 - ERROR - 发生报警：42
|
||||
2025-08-12 10:30:16 - ERROR - 发生报警：42
|
||||
2025-08-12 10:30:16 - ERROR - 发生报警：42
|
||||
2025-08-12 10:30:16 - ERROR - 发生报警：42
|
||||
2025-08-12 10:30:17 - ERROR - 发生报警：42
|
||||
2025-08-12 10:30:17 - ERROR - 发生报警：42
|
||||
2025-08-12 10:30:17 - ERROR - 发生报警：42
|
||||
2025-08-12 10:30:17 - ERROR - 发生报警：42
|
||||
2025-08-12 10:30:17 - ERROR - 发生报警：42
|
||||
2025-08-12 10:30:18 - ERROR - 发生报警：42
|
||||
2025-08-12 10:30:18 - ERROR - 发生报警：42
|
||||
2025-08-12 10:30:18 - ERROR - 发生报警：42
|
||||
2025-08-12 10:30:18 - ERROR - 发生报警：42
|
||||
2025-08-12 10:30:18 - ERROR - 发生报警：42
|
||||
2025-08-12 10:30:19 - ERROR - 发生报警：42
|
||||
2025-08-12 10:30:19 - ERROR - 发生报警：42
|
||||
2025-08-12 10:30:19 - ERROR - 发生报警：42
|
||||
2025-08-12 10:30:19 - INFO - 发送命令{"dsID":"HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"200","type":"0","io_status":"0","point":"2","delay":"0"}]}
|
||||
2025-08-12 10:30:19 - INFO - 发送IO控制: 2，0
|
||||
2025-08-12 10:30:19 - ERROR - 发生报警：42
|
||||
2025-08-12 10:30:19 - INFO - 清除报警
|
||||
2025-08-12 10:30:20 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"1","instructions":[]}
|
||||
2025-08-12 10:30:20 - INFO - 投料停止
|
||||
2025-08-12 10:30:20 - ERROR - 发生报警：42
|
||||
2025-08-12 10:30:20 - ERROR - 发生报警：42
|
||||
2025-08-12 10:30:20 - ERROR - 发生报警：42
|
||||
2025-08-12 10:30:20 - ERROR - 发生报警：42
|
||||
2025-08-12 10:30:20 - ERROR - 发生报警：42
|
||||
2025-08-12 10:30:20 - ERROR - 发生报警：42
|
||||
2025-08-12 10:30:21 - ERROR - 发生报警：42
|
||||
2025-08-12 10:30:21 - ERROR - 发生报警：42
|
||||
2025-08-12 10:30:21 - ERROR - 发生报警：42
|
||||
2025-08-12 10:30:21 - ERROR - 发生报警：42
|
||||
2025-08-12 10:30:22 - ERROR - 发生报警：42
|
||||
2025-08-12 10:30:22 - ERROR - 发生报警：42
|
||||
2025-08-12 10:30:22 - ERROR - 发生报警：42
|
||||
2025-08-12 10:30:22 - ERROR - 发生报警：42
|
||||
2025-08-12 10:30:24 - INFO - 清除报警
|
||||
2025-08-12 10:30:24 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"1","instructions":[]}
|
||||
2025-08-12 10:30:24 - INFO - 投料停止
|
||||
2025-08-12 10:30:27 - INFO - 清除报警
|
||||
2025-08-12 10:30:27 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"1","instructions":[]}
|
||||
2025-08-12 10:30:27 - INFO - 开始复位
|
||||
2025-08-12 10:30:27 - INFO - 发送命令{"dsID":"HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"200","type":"0","io_status":"1","point":"2","delay":"0"}]}
|
||||
2025-08-12 10:30:28 - ERROR - 机械臂未按照实际路线点移动，未能寻找到适配路径点位
|
||||
2025-08-12 10:30:28 - INFO - 发送IO控制: 2，1
|
||||
2025-08-12 10:30:28 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"-569.522156","m1":"-1299.988647","m2":"-413.430023","m3":"-151.126541","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:30:28 - INFO - 移动到位置:姿势直线：X:-569.522156-Y:-1299.988647-Z:-413.430023-U:-151.126541-V:0.0-W:-0.0
|
||||
2025-08-12 10:30:34 - INFO - 移动到位置:姿势直线：X:-569.524475-Y:-1299.973877-Z:-825.314453-U:-151.126846-V:0.0-W:-0.0
|
||||
2025-08-12 10:30:35 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"-569.524475","m1":"-1299.973877","m2":"-825.314453","m3":"-151.126846","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:30:38 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"-569.531006","m1":"-1299.971069","m2":"-825.315613","m3":"-151.126694","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:30:38 - INFO - 移动到位置:姿势直线：X:-569.531006-Y:-1299.971069-Z:-825.315613-U:-151.126694-V:0.0-W:-0.0
|
||||
2025-08-12 10:30:38 - INFO - 移动到位置:姿势直线：X:-569.528625-Y:-1299.985718-Z:-413.431213-U:-151.127274-V:0.0-W:-0.0
|
||||
2025-08-12 10:30:39 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"-569.528625","m1":"-1299.985718","m2":"-413.431213","m3":"-151.127274","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:30:42 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"-828.689758","m1":"-1146.968872","m2":"-77.084404","m3":"-90.137154","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:30:42 - INFO - 移动到位置:姿势直线：X:-828.689758-Y:-1146.968872-Z:-77.084404-U:-90.137154-V:0.0-W:-0.0
|
||||
2025-08-12 10:30:47 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"-828.689758","m1":"-1146.968872","m2":"-77.084404","m3":"-90.137154","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:30:47 - INFO - 移动到位置:姿势直线：X:-828.689758-Y:-1146.968872-Z:-77.084404-U:-90.137154-V:0.0-W:-0.0
|
||||
2025-08-12 10:30:47 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"-828.689758","m1":"-1146.968872","m2":"-77.084404","m3":"-90.137154","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:30:47 - INFO - 移动到位置:姿势直线：X:-828.689758-Y:-1146.968872-Z:-77.084404-U:-90.137154-V:0.0-W:-0.0
|
||||
2025-08-12 10:30:47 - INFO - 移动到位置:姿势直线：X:-828.689758-Y:-1146.968872-Z:-77.084404-U:-90.137154-V:0.0-W:-0.0
|
||||
2025-08-12 10:30:48 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"-828.689758","m1":"-1146.968872","m2":"-77.084404","m3":"-90.137154","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:30:48 - INFO - 发送命令{"dsID":"HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"200","type":"0","io_status":"0","point":"2","delay":"0"}]}
|
||||
2025-08-12 10:30:48 - INFO - 发送IO控制: 2，0
|
||||
2025-08-12 10:30:57 - INFO - 投料暂停
|
||||
2025-08-12 10:30:57 - INFO - 发送命令{"dsID":"www.hc-system.com.RemoteMonitor","reqType":"command","cmdData":["actionPause","1"]}
|
||||
2025-08-12 10:30:58 - INFO - 发送命令{"dsID":"www.hc-system.com.RemoteMonitor","reqType":"command","cmdData":["actionPause","0"]}
|
||||
2025-08-12 10:30:58 - INFO - 投料继续
|
||||
2025-08-12 10:30:58 - INFO - 发送命令{"dsID":"www.hc-system.com.RemoteMonitor","reqType":"command","cmdData":["startButton","1"]}
|
||||
2025-08-12 10:30:58 - INFO - 切换到自动运行状态
|
||||
2025-08-12 10:30:58 - ERROR - 启动传感器线程失败: log_message() missing 1 required positional argument: 'message'
|
||||
2025-08-12 10:30:58 - INFO - 投料开始
|
||||
2025-08-12 10:30:59 - INFO - 移动到位置:姿势直线：X:-828.689758-Y:-1146.968872-Z:-77.084404-U:-90.137154-V:0.0-W:-0.0
|
||||
2025-08-12 10:30:59 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"-828.689758","m1":"-1146.968872","m2":"-77.084404","m3":"-90.137154","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:30:59 - INFO - 投料开始
|
||||
2025-08-12 10:31:00 - INFO - 移动到位置:姿势直线：X:-828.689758-Y:-1146.968872-Z:-77.084404-U:-90.137154-V:0.0-W:-0.0
|
||||
2025-08-12 10:31:01 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"-828.689758","m1":"-1146.968872","m2":"-77.084404","m3":"-90.137154","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:31:01 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"-828.689758","m1":"-1146.968872","m2":"-77.084404","m3":"-90.137154","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:31:01 - INFO - 移动到中位位置
|
||||
2025-08-12 10:31:01 - INFO - 移动到位置:姿势直线：X:-828.689758-Y:-1146.968872-Z:-77.084404-U:-90.137154-V:0.0-W:-0.0
|
||||
2025-08-12 10:31:01 - INFO - [调试计数] 已进入 FMid 分支 1 次
|
||||
2025-08-12 10:31:01 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"-828.689758","m1":"-1146.968872","m2":"-77.084404","m3":"-90.137154","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:31:01 - INFO - 检测是否安全投料
|
||||
2025-08-12 10:31:01 - INFO - 移动到位置:姿势直线：X:-828.689758-Y:-1146.968872-Z:-77.084404-U:-90.137154-V:0.0-W:-0.0
|
||||
2025-08-12 10:31:01 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"-828.689758","m1":"-1146.968872","m2":"-77.084404","m3":"-90.137154","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:31:02 - INFO - 检测是否安全投料
|
||||
2025-08-12 10:31:02 - INFO - 移动到位置:姿势直线：X:-828.689758-Y:-1146.968872-Z:-77.084404-U:-90.137154-V:0.0-W:-0.0
|
||||
2025-08-12 10:31:02 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"-828.689758","m1":"-1146.968872","m2":"-77.084404","m3":"-90.137154","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:31:02 - INFO - 投料结束
|
||||
2025-08-12 10:31:02 - INFO - 移动到位置:姿势直线：X:-828.689758-Y:-1146.968872-Z:-77.084404-U:-90.137154-V:0.0-W:-0.0
|
||||
2025-08-12 10:31:02 - INFO - 移动到拍照位置
|
||||
2025-08-12 10:31:02 - INFO - 复位成功
|
||||
2025-08-12 10:31:02 - ERROR - 关闭传感器线程异常: log_message() missing 1 required positional argument: 'message'
|
||||
2025-08-12 10:31:04 - INFO - 第一层确认生产
|
||||
2025-08-12 10:31:04 - INFO - 反应釜1:投料开始
|
||||
2025-08-12 10:31:04 - INFO - 发送命令{"dsID":"HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"200","type":"0","io_status":"1","point":"2","delay":"0"}]}
|
||||
2025-08-12 10:31:05 - INFO - 发送IO控制: 2，1
|
||||
2025-08-12 10:31:09 - INFO - 发送命令{"dsID":"HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"200","type":"0","io_status":"0","point":"2","delay":"0"}]}
|
||||
2025-08-12 10:31:10 - INFO - 发送IO控制: 2，0
|
||||
2025-08-12 10:31:10 - INFO - 投料开始
|
||||
2025-08-12 10:31:11 - INFO - 移动到位置:姿势直线：X:-828.689758-Y:-1146.968872-Z:-77.084404-U:-90.137154-V:0.0-W:-0.0
|
||||
2025-08-12 10:31:11 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"-828.689758","m1":"-1146.968872","m2":"-77.084404","m3":"-90.137154","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:31:11 - ERROR - 启动传感器线程失败: log_message() missing 1 required positional argument: 'message'
|
||||
2025-08-12 10:31:11 - INFO - 投料开始
|
||||
2025-08-12 10:31:12 - INFO - 移动到位置:姿势直线：X:-828.689758-Y:-1146.968872-Z:-77.084404-U:-90.137154-V:0.0-W:-0.0
|
||||
2025-08-12 10:31:12 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"-828.689758","m1":"-1146.968872","m2":"-77.084404","m3":"-90.137154","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:31:12 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"-828.689758","m1":"-1146.968872","m2":"-77.084404","m3":"-90.137154","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:31:12 - INFO - 移动到中位位置
|
||||
2025-08-12 10:31:12 - INFO - 移动到位置:姿势直线：X:-828.689758-Y:-1146.968872-Z:-77.084404-U:-90.137154-V:0.0-W:-0.0
|
||||
2025-08-12 10:31:12 - INFO - [调试计数] 已进入 FMid 分支 2 次
|
||||
2025-08-12 10:31:13 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"-828.689758","m1":"-1146.968872","m2":"-77.084404","m3":"-90.137154","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:31:13 - INFO - 检测是否安全投料
|
||||
2025-08-12 10:31:13 - INFO - 移动到位置:姿势直线：X:-828.689758-Y:-1146.968872-Z:-77.084404-U:-90.137154-V:0.0-W:-0.0
|
||||
2025-08-12 10:31:13 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"-828.689758","m1":"-1146.968872","m2":"-77.084404","m3":"-90.137154","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:31:13 - INFO - 检测是否安全投料
|
||||
2025-08-12 10:31:13 - INFO - 移动到位置:姿势直线：X:-828.689758-Y:-1146.968872-Z:-77.084404-U:-90.137154-V:0.0-W:-0.0
|
||||
2025-08-12 10:31:13 - INFO - 拍照
|
||||
2025-08-12 10:31:13 - INFO - 识别图像成功
|
||||
2025-08-12 10:31:13 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:31:13 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:31:14 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:31:16 - INFO - ✅ 传感器2检测到料包到位，开始执行抓取
|
||||
2025-08-12 10:31:16 - INFO - 移动到位置:姿势直线：X:-828.689758-Y:-1146.968872-Z:-77.084404-U:-90.137154-V:0.0-W:-0.0
|
||||
2025-08-12 10:31:16 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"-828.689758","m1":"-1146.968872","m2":"-77.084404","m3":"-90.137154","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:31:16 - INFO - 执行完成FPhoto
|
||||
2025-08-12 10:31:16 - INFO - 拍照
|
||||
2025-08-12 10:31:16 - INFO - 识别图像成功
|
||||
2025-08-12 10:31:16 - INFO - ✅ 传感器2检测到料包到位，开始执行抓取
|
||||
2025-08-12 10:31:16 - INFO - 移动到位置:姿势直线：X:-569.528625-Y:-1299.985718-Z:-413.431213-U:-151.127274-V:0.0-W:-0.0
|
||||
2025-08-12 10:31:16 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"-569.528625","m1":"-1299.985718","m2":"-413.431213","m3":"-151.127274","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:31:17 - INFO - 执行完成FPhoto
|
||||
2025-08-12 10:31:17 - INFO - 移动到中位位置
|
||||
2025-08-12 10:31:17 - INFO - 移动到位置:姿势直线：X:-569.531006-Y:-1299.971069-Z:-825.315613-U:-151.126694-V:0.0-W:-0.0
|
||||
2025-08-12 10:31:17 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"-569.531006","m1":"-1299.971069","m2":"-825.315613","m3":"-151.126694","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:31:17 - INFO - [调试计数] 已进入 FMid 分支 3 次
|
||||
2025-08-12 10:31:20 - INFO - 移动到中位位置
|
||||
2025-08-12 10:31:20 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"-569.543396","m1":"-1299.659543","m2":"-1269.931256","m3":"-151.12764","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:31:20 - INFO - 移动到位置:姿势直线：X:-569.543396-Y:-1299.659543-Z:-1269.931256-U:-151.12764-V:0.258-W:0.258
|
||||
2025-08-12 10:31:20 - INFO - [调试计数] 已进入 FMid 分支 4 次
|
||||
2025-08-12 10:31:22 - INFO - 移动到中位位置
|
||||
2025-08-12 10:31:22 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"-569.543396","m1":"-1299.659543","m2":"-1269.931256","m3":"-151.12764","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:31:22 - INFO - 移动到位置:姿势直线：X:-569.543396-Y:-1299.659543-Z:-1269.931256-U:-151.12764-V:0.258-W:0.258
|
||||
2025-08-12 10:31:23 - INFO - [调试计数] 已进入 FMid 分支 5 次
|
||||
2025-08-12 10:31:23 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:31:23 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:31:23 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:31:23 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:31:23 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:31:23 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:31:23 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:31:23 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:31:23 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:31:24 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:31:24 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:31:24 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:31:24 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:31:24 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:31:24 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:31:24 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:31:24 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:31:24 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:31:25 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:31:25 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:31:25 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:31:25 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:31:25 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:31:25 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:31:25 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:31:25 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:31:25 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:31:26 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:31:26 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:31:26 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:31:26 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:31:26 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:31:26 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:31:26 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:31:26 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:31:26 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:31:26 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:31:27 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:31:27 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:31:27 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:31:27 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:31:27 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:31:27 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:31:27 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:31:27 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:31:27 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:31:28 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:31:28 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:31:28 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:31:28 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:31:28 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:31:28 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:31:28 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:31:28 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:31:28 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"-569.543396","m1":"-1299.659543","m2":"-1269.931256","m3":"-151.12764","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:31:29 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:31:29 - INFO - 🟢 机器人已到达抓料点位
|
||||
2025-08-12 10:31:29 - INFO - 已设置放置点: X=-187.12
|
||||
2025-08-12 10:31:29 - INFO - 移动到位置:姿势直线：X:-569.543396-Y:-1299.659543-Z:-1269.931256-U:-151.12764-V:0.258-W:0.258
|
||||
2025-08-12 10:31:29 - INFO - 移动到中位位置
|
||||
2025-08-12 10:31:29 - INFO - 移动到位置:姿势直线：X:-569.524475-Y:-1299.973877-Z:-825.314453-U:-151.126846-V:0.0-W:-0.0
|
||||
2025-08-12 10:31:29 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"-569.524475","m1":"-1299.973877","m2":"-825.314453","m3":"-151.126846","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:31:29 - INFO - [调试计数] 已进入 FMid 分支 6 次
|
||||
2025-08-12 10:31:29 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"-569.522156","m1":"-1299.988647","m2":"-413.430023","m3":"-151.126541","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:31:29 - INFO - 移动到中位位置
|
||||
2025-08-12 10:31:30 - INFO - 移动到位置:姿势直线：X:-569.522156-Y:-1299.988647-Z:-413.430023-U:-151.126541-V:0.0-W:-0.0
|
||||
2025-08-12 10:31:30 - INFO - [调试计数] 已进入 FMid 分支 7 次
|
||||
2025-08-12 10:31:30 - INFO - 移动到中位位置
|
||||
2025-08-12 10:31:30 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"1143.22937","m1":"-822.204346","m2":"-84.250801","m3":"-73.561378","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:31:30 - INFO - 移动到位置:姿势直线：X:1143.22937-Y:-822.204346-Z:-84.250801-U:-73.561378-V:0.0-W:-0.0
|
||||
2025-08-12 10:31:30 - INFO - [调试计数] 已进入 FMid 分支 8 次
|
||||
2025-08-12 10:31:38 - INFO - 移动到中位位置
|
||||
2025-08-12 10:31:38 - INFO - 移动到位置:姿势直线：X:890.821655-Y:-313.300446-Z:-691.557617-U:-63.248192-V:0.0-W:-0.0
|
||||
2025-08-12 10:31:38 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"890.821655","m1":"-313.300446","m2":"-691.557617","m3":"-63.248192","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:31:38 - INFO - [调试计数] 已进入 FMid 分支 9 次
|
||||
2025-08-12 10:31:42 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"-828.689758","m1":"-1146.968872","m2":"-77.084404","m3":"-90.137154","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:31:42 - INFO - 移动到破袋位置
|
||||
2025-08-12 10:31:42 - INFO - 移动到位置:姿势直线：X:-828.689758-Y:-1146.968872-Z:-77.084404-U:-90.137154-V:0.0-W:-0.0
|
||||
2025-08-12 10:31:42 - INFO - 拍照
|
||||
2025-08-12 10:31:42 - INFO - 识别图像成功
|
||||
2025-08-12 10:31:42 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:31:43 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:31:44 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:31:45 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:31:46 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:31:47 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:31:48 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:31:49 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:31:50 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:31:51 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:31:52 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:31:53 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:31:54 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:31:55 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:31:57 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:31:58 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:31:59 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:32:00 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:32:01 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:32:02 - INFO - ✅ 传感器2检测到料包到位，开始执行抓取
|
||||
2025-08-12 10:32:02 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"-569.528625","m1":"-1299.985718","m2":"-413.431213","m3":"-151.127274","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:32:02 - INFO - 移动到位置:姿势直线：X:-569.528625-Y:-1299.985718-Z:-413.431213-U:-151.127274-V:0.0-W:-0.0
|
||||
2025-08-12 10:32:02 - INFO - 执行完成FPhoto
|
||||
2025-08-12 10:32:02 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"-569.531006","m1":"-1299.971069","m2":"-825.315613","m3":"-151.126694","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:32:02 - INFO - 移动到中位位置
|
||||
2025-08-12 10:32:02 - INFO - 移动到位置:姿势直线：X:-569.531006-Y:-1299.971069-Z:-825.315613-U:-151.126694-V:0.0-W:-0.0
|
||||
2025-08-12 10:32:03 - INFO - [调试计数] 已进入 FMid 分支 10 次
|
||||
2025-08-12 10:32:06 - INFO - 移动到中位位置
|
||||
2025-08-12 10:32:06 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"-569.543396","m1":"-1299.659543","m2":"-1269.931256","m3":"-151.12764","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:32:06 - INFO - 移动到位置:姿势直线：X:-569.543396-Y:-1299.659543-Z:-1269.931256-U:-151.12764-V:0.258-W:0.258
|
||||
2025-08-12 10:32:06 - INFO - [调试计数] 已进入 FMid 分支 11 次
|
||||
2025-08-12 10:32:08 - INFO - 移动到中位位置
|
||||
2025-08-12 10:32:08 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"-569.543396","m1":"-1299.659543","m2":"-1269.931256","m3":"-151.12764","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:32:08 - INFO - 移动到位置:姿势直线：X:-569.543396-Y:-1299.659543-Z:-1269.931256-U:-151.12764-V:0.258-W:0.258
|
||||
2025-08-12 10:32:08 - INFO - [调试计数] 已进入 FMid 分支 12 次
|
||||
2025-08-12 10:32:08 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:32:09 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:32:09 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:32:09 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:32:09 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:32:09 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:32:09 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:32:09 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:32:09 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:32:09 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:32:09 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:32:10 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:32:10 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:32:10 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:32:10 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:32:10 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:32:10 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:32:10 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:32:10 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:32:10 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:32:11 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:32:11 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:32:11 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:32:11 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:32:11 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:32:11 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:32:11 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:32:11 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:32:11 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:32:12 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:32:12 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:32:12 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:32:12 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:32:12 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:32:12 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:32:12 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:32:12 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:32:12 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:32:12 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:32:13 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:32:13 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:32:13 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:32:13 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:32:13 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:32:13 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:32:13 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:32:13 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:32:13 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:32:14 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:32:14 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:32:14 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:32:14 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:32:14 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:32:14 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:32:14 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:32:14 - INFO - 🟢 机器人已到达抓料点位
|
||||
2025-08-12 10:32:14 - INFO - 已设置放置点: X=1067.08
|
||||
2025-08-12 10:32:15 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"-569.543396","m1":"-1299.659543","m2":"-1269.931256","m3":"-151.12764","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:32:15 - INFO - 移动到位置:姿势直线：X:-569.543396-Y:-1299.659543-Z:-1269.931256-U:-151.12764-V:0.258-W:0.258
|
||||
2025-08-12 10:32:15 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"-569.524475","m1":"-1299.973877","m2":"-825.314453","m3":"-151.126846","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:32:15 - INFO - 移动到中位位置
|
||||
2025-08-12 10:32:15 - INFO - 移动到位置:姿势直线：X:-569.524475-Y:-1299.973877-Z:-825.314453-U:-151.126846-V:0.0-W:-0.0
|
||||
2025-08-12 10:32:15 - INFO - [调试计数] 已进入 FMid 分支 13 次
|
||||
2025-08-12 10:32:15 - INFO - 移动到中位位置
|
||||
2025-08-12 10:32:15 - INFO - 移动到位置:姿势直线：X:-569.522156-Y:-1299.988647-Z:-413.430023-U:-151.126541-V:0.0-W:-0.0
|
||||
2025-08-12 10:32:15 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"-569.522156","m1":"-1299.988647","m2":"-413.430023","m3":"-151.126541","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:32:15 - INFO - [调试计数] 已进入 FMid 分支 14 次
|
||||
2025-08-12 10:32:16 - INFO - 移动到中位位置
|
||||
2025-08-12 10:32:16 - INFO - 移动到位置:姿势直线：X:1143.22937-Y:-822.204346-Z:-84.250801-U:-73.561378-V:0.0-W:-0.0
|
||||
2025-08-12 10:32:16 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"1143.22937","m1":"-822.204346","m2":"-84.250801","m3":"-73.561378","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:32:16 - INFO - [调试计数] 已进入 FMid 分支 15 次
|
||||
2025-08-12 10:32:23 - INFO - 移动到中位位置
|
||||
2025-08-12 10:32:24 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"890.821655","m1":"-313.300446","m2":"-691.557617","m3":"-63.248192","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:32:24 - INFO - 移动到位置:姿势直线：X:890.821655-Y:-313.300446-Z:-691.557617-U:-63.248192-V:0.0-W:-0.0
|
||||
2025-08-12 10:32:24 - INFO - [调试计数] 已进入 FMid 分支 16 次
|
||||
2025-08-12 10:32:28 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"-828.689758","m1":"-1146.968872","m2":"-77.084404","m3":"-90.137154","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:32:28 - INFO - 移动到破袋位置
|
||||
2025-08-12 10:32:28 - INFO - 移动到位置:姿势直线：X:-828.689758-Y:-1146.968872-Z:-77.084404-U:-90.137154-V:0.0-W:-0.0
|
||||
2025-08-12 10:32:28 - INFO - 拍照
|
||||
2025-08-12 10:32:28 - INFO - 识别图像成功
|
||||
2025-08-12 10:32:28 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:32:29 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:32:30 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:32:31 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:32:32 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:32:33 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:32:34 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:32:35 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:32:36 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:32:37 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:32:38 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:32:39 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:32:40 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:32:41 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:32:42 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:32:43 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:32:44 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:32:45 - INFO - ✅ 传感器2检测到料包到位，开始执行抓取
|
||||
2025-08-12 10:32:46 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"-569.528625","m1":"-1299.985718","m2":"-413.431213","m3":"-151.127274","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:32:46 - INFO - 移动到位置:姿势直线：X:-569.528625-Y:-1299.985718-Z:-413.431213-U:-151.127274-V:0.0-W:-0.0
|
||||
2025-08-12 10:32:46 - INFO - 执行完成FPhoto
|
||||
2025-08-12 10:32:46 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"-569.531006","m1":"-1299.971069","m2":"-825.315613","m3":"-151.126694","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:32:46 - INFO - 移动到中位位置
|
||||
2025-08-12 10:32:46 - INFO - 移动到位置:姿势直线：X:-569.531006-Y:-1299.971069-Z:-825.315613-U:-151.126694-V:0.0-W:-0.0
|
||||
2025-08-12 10:32:46 - INFO - [调试计数] 已进入 FMid 分支 17 次
|
||||
2025-08-12 10:32:49 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"-569.543396","m1":"-1299.659543","m2":"-1269.931256","m3":"-151.12764","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:32:49 - INFO - 移动到中位位置
|
||||
2025-08-12 10:32:49 - INFO - 移动到位置:姿势直线：X:-569.543396-Y:-1299.659543-Z:-1269.931256-U:-151.12764-V:0.258-W:0.258
|
||||
2025-08-12 10:32:50 - INFO - [调试计数] 已进入 FMid 分支 18 次
|
||||
2025-08-12 10:32:52 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"-569.543396","m1":"-1299.659543","m2":"-1269.931256","m3":"-151.12764","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:32:52 - INFO - 移动到中位位置
|
||||
2025-08-12 10:32:52 - INFO - 移动到位置:姿势直线：X:-569.543396-Y:-1299.659543-Z:-1269.931256-U:-151.12764-V:0.258-W:0.258
|
||||
2025-08-12 10:32:52 - INFO - [调试计数] 已进入 FMid 分支 19 次
|
||||
2025-08-12 10:32:52 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:32:52 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:32:52 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:32:52 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:32:53 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:32:53 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:32:53 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:32:53 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:32:53 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:32:53 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:32:53 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:32:53 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:32:53 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:32:54 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:32:54 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:32:54 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:32:54 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:32:54 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:32:54 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:32:54 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:32:54 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:32:54 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:32:55 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:32:55 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:32:55 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:32:55 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:32:55 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:32:55 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:32:55 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:32:55 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:32:55 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:32:55 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:32:56 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:32:56 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:32:56 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:32:56 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:32:56 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:32:56 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:32:56 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:32:56 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:32:56 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:32:57 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:32:57 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:32:57 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:32:57 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:32:57 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:32:57 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:32:57 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:32:57 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:32:57 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:32:57 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:32:58 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:32:58 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:32:58 - INFO - 🟡 机器人尚未到达抓料点位
|
||||
2025-08-12 10:32:58 - INFO - str_feed_take移动到抓料位置
|
||||
2025-08-12 10:32:58 - INFO - 🟢 机器人已到达抓料点位
|
||||
2025-08-12 10:32:58 - INFO - 已设置放置点: X=-187.12
|
||||
2025-08-12 10:32:58 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"-569.543396","m1":"-1299.659543","m2":"-1269.931256","m3":"-151.12764","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:32:58 - INFO - 移动到位置:姿势直线：X:-569.543396-Y:-1299.659543-Z:-1269.931256-U:-151.12764-V:0.258-W:0.258
|
||||
2025-08-12 10:32:58 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"-569.524475","m1":"-1299.973877","m2":"-825.314453","m3":"-151.126846","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:32:59 - INFO - 移动到中位位置
|
||||
2025-08-12 10:32:59 - INFO - 移动到位置:姿势直线：X:-569.524475-Y:-1299.973877-Z:-825.314453-U:-151.126846-V:0.0-W:-0.0
|
||||
2025-08-12 10:32:59 - INFO - [调试计数] 已进入 FMid 分支 20 次
|
||||
2025-08-12 10:32:59 - INFO - 移动到中位位置
|
||||
2025-08-12 10:32:59 - INFO - 移动到位置:姿势直线：X:-569.522156-Y:-1299.988647-Z:-413.430023-U:-151.126541-V:0.0-W:-0.0
|
||||
2025-08-12 10:32:59 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"-569.522156","m1":"-1299.988647","m2":"-413.430023","m3":"-151.126541","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:32:59 - INFO - [调试计数] 已进入 FMid 分支 21 次
|
||||
2025-08-12 10:32:59 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"1143.22937","m1":"-822.204346","m2":"-84.250801","m3":"-73.561378","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:32:59 - INFO - 移动到中位位置
|
||||
2025-08-12 10:33:00 - INFO - 移动到位置:姿势直线：X:1143.22937-Y:-822.204346-Z:-84.250801-U:-73.561378-V:0.0-W:-0.0
|
||||
2025-08-12 10:33:00 - INFO - [调试计数] 已进入 FMid 分支 22 次
|
||||
2025-08-12 10:33:07 - INFO - 移动到中位位置
|
||||
2025-08-12 10:33:07 - INFO - 移动到位置:姿势直线：X:890.821655-Y:-313.300446-Z:-691.557617-U:-63.248192-V:0.0-W:-0.0
|
||||
2025-08-12 10:33:07 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"890.821655","m1":"-313.300446","m2":"-691.557617","m3":"-63.248192","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:33:08 - INFO - [调试计数] 已进入 FMid 分支 23 次
|
||||
2025-08-12 10:33:11 - INFO - 发送命令{"dsID":"www.hc-system.com.HCRemoteCommand","reqType":"AddRCC","emptyList":"0","instructions":[{"oneshot":"1","action":"10","m0":"-828.689758","m1":"-1146.968872","m2":"-77.084404","m3":"-90.137154","ckStatus":"0x3F","speed":"100","delay":"0","smooth":"9","tool":"2"}]}
|
||||
2025-08-12 10:33:12 - INFO - 移动到破袋位置
|
||||
2025-08-12 10:33:12 - INFO - 移动到位置:姿势直线：X:-828.689758-Y:-1146.968872-Z:-77.084404-U:-90.137154-V:0.0-W:-0.0
|
||||
2025-08-12 10:33:12 - INFO - 拍照
|
||||
2025-08-12 10:33:12 - INFO - 识别图像成功
|
||||
2025-08-12 10:33:12 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:33:13 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:33:14 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:33:15 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:33:16 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:33:17 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:33:18 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:33:19 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:33:20 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:33:21 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:33:22 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:33:23 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:33:24 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:33:25 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:33:26 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:33:27 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:33:28 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:33:29 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:33:30 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:33:31 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:33:32 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:33:33 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:33:35 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:33:36 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:33:37 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:33:38 - INFO - ⏳ 等待传感器2料包信号...
|
||||
2025-08-12 10:33:39 - ERROR - 'str' object has no attribute 'release'
|
||||
2025-08-12 10:33:41 - ERROR - Feeding运行异常: Internal C++ object (Feeding) already deleted.
|
||||
2025-08-12 10:33:41 - ERROR - Feeding运行异常: Internal C++ object (Feeding) already deleted.
|
||||
2025-08-12 10:33:41 - ERROR - Feeding运行异常: Internal C++ object (Feeding) already deleted.
|
||||
120
main.py
120
main.py
@ -17,7 +17,7 @@ from PyQt5.uic.properties import QtWidgets
|
||||
from PySide6 import QtCore
|
||||
from PySide6.QtCore import QThread, Signal, Slot, QObject, QEvent, QTimer
|
||||
from PySide6.QtGui import QIntValidator, QStandardItemModel, QStandardItem, Qt, QMovie, QIcon, QCursor, QColor, \
|
||||
QTextCursor
|
||||
QTextCursor,QFont
|
||||
from PySide6.QtWidgets import QApplication, QMainWindow, QPushButton, QLabel, QHeaderView, QTableWidget, \
|
||||
QTableWidgetItem, QWidget, QHBoxLayout, QAbstractItemView, QMessageBox, QSizePolicy, QComboBox, QMenu, QDialog, QGridLayout
|
||||
from datetime import datetime
|
||||
@ -61,8 +61,11 @@ class MainWindow(QMainWindow, Ui_MainWindow):
|
||||
self.drop_position_manager = DropPositionManager()
|
||||
self.sensor_thread = None
|
||||
self.sensor2_thread = None
|
||||
self.emergency_thread = None
|
||||
self.last_status_printed = None
|
||||
self.last_pause_printed = None
|
||||
#判断是否按下急停按钮
|
||||
self.is_emergency_pressed = False
|
||||
self.cur_pushbutton_num = None
|
||||
self.pushbutton_num_style = """
|
||||
QPushButton { background-color: #101F3F;color:#ffffff }
|
||||
@ -751,6 +754,9 @@ class MainWindow(QMainWindow, Ui_MainWindow):
|
||||
# self.camera_img.update_camera_image.connect(self.updateUI_label_detection)
|
||||
self.feeding.log_signal.connect(self.log_message)
|
||||
self.feeding.stack_finish_signal.connect(self.stack_finish)
|
||||
self.relay_controller.log_signal.connect(self.log_message)
|
||||
self.relay_controller.emergency_signal.connect(self.emergency_press_notify)
|
||||
self.feeding.feed_error_signal.connect(self.feed_error_notify)
|
||||
# self.camera_img=CameraImg(self.feeding)
|
||||
# self.camera_img.update_camera_image.connect(self.updateUI_label_detection)
|
||||
|
||||
@ -941,6 +947,13 @@ class MainWindow(QMainWindow, Ui_MainWindow):
|
||||
|
||||
def start_Runing(self):
|
||||
#多线程启动
|
||||
self.emergency_thread = Thread(
|
||||
target=self.relay_controller.handle_emergency_pressed,
|
||||
name="emergency",
|
||||
daemon=True
|
||||
)
|
||||
self.emergency_thread.start()
|
||||
|
||||
self.main_threading = Thread(target=self.run,name="feeding")#主循环
|
||||
self.robot_connect_threading = Thread(target=self.robotClient.run,name="robot_connect")
|
||||
# self.main_UI_threading = Thread(target=self.updateUI,name="updateUI")
|
||||
@ -1005,6 +1018,10 @@ class MainWindow(QMainWindow, Ui_MainWindow):
|
||||
return
|
||||
|
||||
def send_startFeed_button_click(self):
|
||||
if self.is_emergency_pressed:
|
||||
self.show_infomessage_box("急停按钮已按下，不能启动，请先松开急停按钮")
|
||||
return
|
||||
|
||||
if self.feeding.feedStatus != FeedStatus.FNone:
|
||||
self.show_infomessage_box("正在执行")
|
||||
return
|
||||
@ -1019,6 +1036,8 @@ class MainWindow(QMainWindow, Ui_MainWindow):
|
||||
msg_box_person.setIcon(QMessageBox.Icon.Information)
|
||||
msg_box_person.setText("是否确认生产区域安全继续生产？")
|
||||
msg_box_person.setWindowTitle("提示")
|
||||
font=QFont("Microsoft YaHei UI",20)
|
||||
msg_box_person.setFont(font)
|
||||
|
||||
ok_button = msg_box_person.addButton("确定", PySide6.QtWidgets.QMessageBox.ButtonRole.AcceptRole)
|
||||
cancel_button = msg_box_person.addButton("取消", PySide6.QtWidgets.QMessageBox.ButtonRole.RejectRole)
|
||||
@ -1154,7 +1173,7 @@ class MainWindow(QMainWindow, Ui_MainWindow):
|
||||
button.setStyleSheet(
|
||||
"""
|
||||
*{background-color: #101F3F;
|
||||
font: 10pt "楷体";
|
||||
font: 20pt "楷体";
|
||||
color:#ffffff;
|
||||
border-radius: 5px;
|
||||
min-height: 40px;
|
||||
@ -1181,7 +1200,7 @@ class MainWindow(QMainWindow, Ui_MainWindow):
|
||||
cancel_button.setStyleSheet(
|
||||
"""
|
||||
*{background-color: #6c757d;
|
||||
font: 10pt "楷体";
|
||||
font: 20pt "楷体";
|
||||
color:#ffffff;
|
||||
border-radius: 5px;
|
||||
min-height: 40px;
|
||||
@ -1370,7 +1389,7 @@ class MainWindow(QMainWindow, Ui_MainWindow):
|
||||
self.feeding.feedStatus = FeedStatus.FNone
|
||||
self.feeding.reset_status = ResetStatus.RNone
|
||||
self.relay_controller.pause_start_sensor(True)
|
||||
self.feeding.pause = True #暂停，停止滚去等
|
||||
self.feeding.pause = True #暂停
|
||||
stop_command = CMDRequest()
|
||||
stop_command.cmdData.append("actionStop")
|
||||
stop_command.cmdData.append("1")
|
||||
@ -1382,12 +1401,17 @@ class MainWindow(QMainWindow, Ui_MainWindow):
|
||||
log.log_message(logging.INFO, Constant.str_sys_emergencyStop)
|
||||
|
||||
def send_emergency_alarm_command(self):
|
||||
if self.is_emergency_pressed:
|
||||
self.show_infomessage_box("急停按钮已按下，不能停止，请先松开急停按钮")
|
||||
return
|
||||
"""停止当前工作，需要启动"""
|
||||
msg_box_person = QMessageBox()
|
||||
msg_box_person.setIcon(QMessageBox.Icon.Question)
|
||||
msg_box_person.setText("您确定要停止当前工作吗？")
|
||||
msg_box_person.setWindowTitle("提示")
|
||||
|
||||
font = msg_box_person.font()
|
||||
font.setPointSize(20)
|
||||
msg_box_person.setFont(font)
|
||||
msg_box_person.addButton("确定", PySide6.QtWidgets.QMessageBox.ButtonRole.AcceptRole)
|
||||
cancel_button = msg_box_person.addButton("取消", PySide6.QtWidgets.QMessageBox.ButtonRole.RejectRole)
|
||||
msg_box_person.exec()
|
||||
@ -1399,6 +1423,16 @@ class MainWindow(QMainWindow, Ui_MainWindow):
|
||||
|
||||
|
||||
def send_pauseFeed_button_click(self):
|
||||
if self.is_emergency_pressed:
|
||||
self.show_infomessage_box("急停按钮已按下，不能暂停，请先松开急停按钮")
|
||||
return
|
||||
if self.feeding.feedStatus == FeedStatus.FNone:
|
||||
self.show_infomessage_box("当前没有运行中的工作，不能暂停")
|
||||
return
|
||||
self.send_pauseFeed_click()
|
||||
pass
|
||||
|
||||
def send_pauseFeed_click(self):
|
||||
if self.pushButton_pauseFeed.text() == '暂停':
|
||||
self.relay_controller.pause_start_sensor(True)
|
||||
icon9 = QIcon(QIcon.fromTheme(QIcon.ThemeIcon.SystemReboot))
|
||||
@ -1421,9 +1455,7 @@ class MainWindow(QMainWindow, Ui_MainWindow):
|
||||
log.log_message(logging.INFO, Constant.str_sys_start_tool)
|
||||
self.feeding.pause = False
|
||||
|
||||
pass
|
||||
|
||||
|
||||
|
||||
def send_tabWidget_control_change(self):
|
||||
if self.robotClient.status_model.curMode != 7:
|
||||
self.send_switch_tool_command()
|
||||
@ -1633,10 +1665,13 @@ class MainWindow(QMainWindow, Ui_MainWindow):
|
||||
else:
|
||||
self.set_run_status_button(False)
|
||||
|
||||
if self.feeding.feedStatus == FeedStatus.FNone:
|
||||
self.stackedWidget_num.setCurrentIndex(0)
|
||||
else:
|
||||
self.stackedWidget_num.setCurrentIndex(1)
|
||||
if self.is_emergency_pressed:
|
||||
self.stackedWidget_num.setCurrentIndex(1)
|
||||
else:
|
||||
if self.feeding.feedStatus == FeedStatus.FNone:
|
||||
self.stackedWidget_num.setCurrentIndex(0)
|
||||
else:
|
||||
self.stackedWidget_num.setCurrentIndex(1)
|
||||
|
||||
|
||||
self.label_date.setText(datetime.now().strftime("%Y-%m-%d"))
|
||||
@ -1673,16 +1708,55 @@ class MainWindow(QMainWindow, Ui_MainWindow):
|
||||
# self.send_pause_command(True)
|
||||
# self.feeding.pause = True
|
||||
# self.relay_controller.pause_start_sensor(True)
|
||||
self.stop_all_work()
|
||||
msg_box_finish = QMessageBox()
|
||||
msg_box_finish.setIcon(QMessageBox.Icon.Warning)
|
||||
msg_box_finish.setText("码垛完成,请移走拖板")
|
||||
msg_box_finish.setWindowTitle("提示")
|
||||
msg_box_finish.addButton("确定", QMessageBox.AcceptRole)
|
||||
loc_font=QFont("Microsoft YaHei UI",20)
|
||||
msg_box_finish.setFont(loc_font)
|
||||
result=msg_box_finish.exec()
|
||||
self.label_remain_num.setText(str(self.feeding.feedConfig.remain_count))
|
||||
self.stop_all_work()
|
||||
|
||||
def feed_error_notify(self,error_code,error_msg):
|
||||
"""
|
||||
feeding 报警处理,打开声控
|
||||
"""
|
||||
|
||||
self.relay_controller.open(alarm=True)
|
||||
self.send_pauseFeed_click()
|
||||
msg_box_finish = QMessageBox()
|
||||
msg_box_finish.setIcon(QMessageBox.Icon.Warning)
|
||||
msg_box_finish.setText(error_msg)
|
||||
msg_box_finish.setWindowTitle("提示")
|
||||
msg_box_finish.addButton("确定", QMessageBox.AcceptRole)
|
||||
loc_font=QFont("Microsoft YaHei UI",20)
|
||||
msg_box_finish.setFont(loc_font)
|
||||
result=msg_box_finish.exec()
|
||||
if error_code==1:
|
||||
msg_box_finish.setText("是否打开滚筒让料带滚出？")
|
||||
msg_box_finish.addButton("取消", QMessageBox.RejectRole)
|
||||
result=msg_box_finish.exec()
|
||||
if result == QMessageBox.AcceptRole:
|
||||
self.relay_controller.open(conveyor2=True)
|
||||
|
||||
def emergency_press_notify(self,emergency_pressed):
|
||||
"""
|
||||
急停按钮按下
|
||||
"""
|
||||
if emergency_pressed:
|
||||
if not self.is_emergency_pressed:
|
||||
self.send_pauseFeed_click()
|
||||
self.is_emergency_pressed = True
|
||||
self.label_button_status.setText("急停中，禁止操作")
|
||||
else:
|
||||
if self.is_emergency_pressed:
|
||||
self.label_button_status.setText("已暂停，可操作工控机")
|
||||
|
||||
self.is_emergency_pressed = False
|
||||
|
||||
|
||||
def updateUI_IOPanel(self):
|
||||
try:
|
||||
io_bits = self.robotClient.status_model.get_IO_bits()
|
||||
@ -1917,12 +1991,13 @@ class MainWindow(QMainWindow, Ui_MainWindow):
|
||||
self.robotClient.add_sendQuene(request_command)
|
||||
|
||||
def send_clear_alarm_command(self, pause: bool):
|
||||
self.send_clear_auto_command()
|
||||
pause_command = CMDRequest()
|
||||
pause_command.cmdData.append("StopButton")
|
||||
pause_command.cmdData.append("1")
|
||||
request_command = pause_command.toString()
|
||||
self.robotClient.add_sendQuene(request_command)
|
||||
self.relay_controller.close(alarm=True)
|
||||
# self.send_clear_auto_command()
|
||||
# pause_command = CMDRequest()
|
||||
# pause_command.cmdData.append("StopButton")
|
||||
# pause_command.cmdData.append("1")
|
||||
# request_command = pause_command.toString()
|
||||
# self.robotClient.add_sendQuene(request_command)
|
||||
|
||||
def send_switch_tool_command(self):
|
||||
switch_command = CMDRequest()
|
||||
@ -2197,6 +2272,9 @@ class MainWindow(QMainWindow, Ui_MainWindow):
|
||||
msg_box.setText(message)
|
||||
msg_box.setIcon(QMessageBox.Icon.Information)
|
||||
msg_box.setStandardButtons(QMessageBox.StandardButton.Ok)
|
||||
font = msg_box.font()
|
||||
font.setPointSize(20)
|
||||
msg_box.setFont(font)
|
||||
msg_box.show()
|
||||
def send_click_change_stackView(self,index):
|
||||
self.stackedWidget_view.setCurrentIndex(index)
|
||||
@ -2299,7 +2377,9 @@ def handle_exception(exc_type, exc_value, exc_tb):
|
||||
if __name__ == "__main__":
|
||||
app = MyApplication(sys.argv)
|
||||
window = MainWindow()
|
||||
window.show()
|
||||
# window.show()
|
||||
# window.showFullScreen()
|
||||
window.showMaximized()
|
||||
sys.excepthook = handle_exception
|
||||
try :
|
||||
sys.exit(app.exec())
|
||||
|
||||
@ -4260,7 +4260,7 @@ qt_resource_struct = b"\
|
||||
\x00\x00\x00\x0a\x00\x02\x00\x00\x00\x01\x00\x00\x00\x03\
|
||||
\x00\x00\x00\x00\x00\x00\x00\x00\
|
||||
\x00\x00\x00\x1a\x00\x00\x00\x00\x00\x01\x00\x00\x00\x00\
|
||||
\x00\x00\x01\x99\x8e\x16\x01P\
|
||||
\x00\x00\x01\x9a\x01M\x90h\
|
||||
"
|
||||
|
||||
def qInitResources():
|
||||
|
||||
37
test6.py
37
test6.py
@ -0,0 +1,37 @@
|
||||
import os
|
||||
import sys
|
||||
import time
|
||||
from Mv3D.CameraUtil import CameraUtil
|
||||
from Mv3D.calculate_diff2 import calculate_offset_from_image
|
||||
|
||||
if __name__=='__main__':
|
||||
|
||||
camera_img=CameraUtil()
|
||||
loc_image_path=camera_img.save_img()
|
||||
print(f"保存图片路径:{loc_image_path}")
|
||||
try:
|
||||
loc_model_result = calculate_offset_from_image(loc_image_path, visualize=False)
|
||||
if loc_model_result['success']:
|
||||
#置信度
|
||||
if loc_model_result['obj_conf']>0.5:
|
||||
loc_offsetX=loc_model_result['dx_mm']
|
||||
if abs(loc_model_result['dx_mm'])<200:
|
||||
loc_is_next=True
|
||||
print(f'{loc_image_path}:料带偏移{loc_offsetX}mm')
|
||||
else:
|
||||
print(f"{loc_image_path}:料带偏移过大，报警")
|
||||
# self.feed_error_signal.emit(1,f"{loc_image_path}:料带偏移过大，报警")
|
||||
else:
|
||||
print(f"{loc_image_path}:未检测到料带,置信度低")
|
||||
# self.feed_error_signal.emit(2,f"{loc_image_path}:未检测到料带,置信度低")
|
||||
else:
|
||||
print(f"{loc_image_path}:计算偏移失败，视觉返回False")
|
||||
# self.feed_error_signal.emit(2,f"{loc_image_path}:计算偏移失败，视觉返回False")
|
||||
# loc_is_next=False
|
||||
loc_offsetX=0
|
||||
except Exception as e:
|
||||
print(f"{loc_image_path}:计算偏移失败:{e}")
|
||||
|
||||
time.sleep(10)
|
||||
|
||||
|
||||
|
||||
@ -3445,7 +3445,7 @@ class Ui_MainWindow(object):
|
||||
self.lineEdit_num.setSizePolicy(sizePolicy1)
|
||||
self.lineEdit_num.setStyleSheet(u"color: rgb(255, 255, 255);\n"
|
||||
"border: 1px solid #dcdfe6;\n"
|
||||
"font: 9pt \"Microsoft YaHei UI\";")
|
||||
"font: 12pt \"Microsoft YaHei UI\";")
|
||||
|
||||
self.gridLayout.addWidget(self.lineEdit_num, 0, 0, 1, 4)
|
||||
|
||||
@ -3455,7 +3455,7 @@ class Ui_MainWindow(object):
|
||||
self.pushButton_numkeybord.setSizePolicy(sizePolicy1)
|
||||
self.pushButton_numkeybord.setStyleSheet(u"\n"
|
||||
"*{background-color: #101F3F;\n"
|
||||
"font: 11pt \"\u6977\u4f53\";\n"
|
||||
"font: 20pt \"\u6977\u4f53\";\n"
|
||||
"color:#ffffff\n"
|
||||
"}\n"
|
||||
"*:hover {\n"
|
||||
@ -3475,7 +3475,7 @@ class Ui_MainWindow(object):
|
||||
self.pushButton_num_confirm.setSizePolicy(sizePolicy1)
|
||||
self.pushButton_num_confirm.setStyleSheet(u"\n"
|
||||
"*{background-color: #101F3F;\n"
|
||||
"font: 11pt \"\u6977\u4f53\";\n"
|
||||
"font: 20pt \"\u6977\u4f53\";\n"
|
||||
"color:#ffffff\n"
|
||||
"}\n"
|
||||
"*:hover {\n"
|
||||
@ -3516,7 +3516,7 @@ class Ui_MainWindow(object):
|
||||
self.label_button_status.setStyleSheet(u"\n"
|
||||
"QLabel{\n"
|
||||
"background-color: rgba(255, 255, 255, 0);\n"
|
||||
"font: 700 16pt \"Microsoft YaHei UI\";\n"
|
||||
"font: 700 36pt \"Microsoft YaHei UI\";\n"
|
||||
"color:#FF0000;\n"
|
||||
"}")
|
||||
|
||||
@ -3545,7 +3545,7 @@ class Ui_MainWindow(object):
|
||||
self.pushButton_reset.setSizePolicy(sizePolicy5)
|
||||
self.pushButton_reset.setStyleSheet(u"*{\n"
|
||||
"background-color: #FFFFBF;\n"
|
||||
"font: 9pt \"\u6977\u4f53\";\n"
|
||||
"font: 20pt \"\u6977\u4f53\";\n"
|
||||
"border-radius: 10px;\n"
|
||||
"}\n"
|
||||
"*:pressed\n"
|
||||
@ -3584,7 +3584,7 @@ class Ui_MainWindow(object):
|
||||
self.pushButton_stopFeed.setSizePolicy(sizePolicy5)
|
||||
self.pushButton_stopFeed.setStyleSheet(u"*{\n"
|
||||
"background-color: #FF0000;\n"
|
||||
"font: 9pt \"\u6977\u4f53\";\n"
|
||||
"font: 20pt \"\u6977\u4f53\";\n"
|
||||
"border-radius: 10px;\n"
|
||||
"}\n"
|
||||
"*:pressed\n"
|
||||
@ -3603,7 +3603,7 @@ class Ui_MainWindow(object):
|
||||
self.pushButton_pauseFeed.setSizePolicy(sizePolicy5)
|
||||
self.pushButton_pauseFeed.setStyleSheet(u"*{\n"
|
||||
"background-color: #2196F3;\n"
|
||||
"font: 9pt \"\u6977\u4f53\";\n"
|
||||
"font: 20pt \"\u6977\u4f53\";\n"
|
||||
"border-radius: 10px;\n"
|
||||
"}\n"
|
||||
"*:pressed\n"
|
||||
@ -3622,7 +3622,7 @@ class Ui_MainWindow(object):
|
||||
self.pushButton_startFeed.setSizePolicy(sizePolicy5)
|
||||
self.pushButton_startFeed.setStyleSheet(u"*{\n"
|
||||
"background-color: #499C54;\n"
|
||||
"font: 9pt \"\u6977\u4f53\";\n"
|
||||
"font: 20pt \"\u6977\u4f53\";\n"
|
||||
"\n"
|
||||
"border-radius: 10px;\n"
|
||||
"}\n"
|
||||
@ -3642,7 +3642,7 @@ class Ui_MainWindow(object):
|
||||
self.pushButton_clearAlarm.setSizePolicy(sizePolicy5)
|
||||
self.pushButton_clearAlarm.setStyleSheet(u"*{\n"
|
||||
"background-color: #1CB2B1;\n"
|
||||
"font: 9pt \"\u6977\u4f53\";\n"
|
||||
"font: 20pt \"\u6977\u4f53\";\n"
|
||||
"border-radius: 10px;\n"
|
||||
"}\n"
|
||||
"*:pressed\n"
|
||||
|
||||
Binary file not shown.
Binary file not shown.
Reference in New Issue
Block a user