From ce34b3a2736e1a9e676c2a5cc49542c27070b68d Mon Sep 17 00:00:00 2001 From: "ziwei.he" Date: Mon, 26 May 2025 13:49:35 +0800 Subject: [PATCH] =?UTF-8?q?=E5=A2=9E=E5=8A=A0=E4=BA=86=E5=85=B3=E8=8A=82?= =?UTF-8?q?=E8=A7=92=E5=BA=A6=E5=92=8C=E7=B1=B3=E4=B8=BA=E5=8D=95=E4=BD=8D?= =?UTF-8?q?=E7=9A=84=E4=B8=80=E4=BA=9B=E6=8E=A5=E5=8F=A3?= MIME-Version: 1.0 Content-Type: text/plain; charset=UTF-8 Content-Transfer-Encoding: 8bit --- .../MassageControl/hardware/dobot_nova5.py | 236 +- logs/MassageRobot_nova5_test.log | 8723 ----------------- logs/test.py | 45 +- 3 files changed, 273 insertions(+), 8731 deletions(-) diff --git a/Massage/MassageControl/hardware/dobot_nova5.py b/Massage/MassageControl/hardware/dobot_nova5.py index c08bf87..05b04b4 100644 --- a/Massage/MassageControl/hardware/dobot_nova5.py +++ b/Massage/MassageControl/hardware/dobot_nova5.py @@ -144,7 +144,44 @@ class dobot_nova5: break sleep(0.1) return 0 - + + def RunPoint_P_inPose_M_RAD(self,poses_list): + ''' + RUNPOINT_P 以关节运动方式运动到目标点 + MovJ flag = 0 通过位姿走点,输入为[X Y Z RX RY RZ] unit: M/RAD + ''' + # 单位 m/rad -> mm/deg + poses_list_mm_deg = self.__transform_m_rad_2_mm_deg(poses_list) + # 走点 + recvmovemess = self.dashboard.MovJ(*poses_list_mm_deg,0) + print("MovJ:",recvmovemess) + print(self.parseResultId(recvmovemess)) + currentCommandID = self.parseResultId(recvmovemess)[1] + print("指令 ID:", currentCommandID) + sleep(0.02) + while True: # 完成判断循环 + ########## 调试注释 ############# + # print("robot mode",self.feedbackData.robotMode) + # print("feedback current ID", self.feedbackData.robotCurrentCommandID) + # print("指令 ID:", currentCommandID) + ########## 调试注释 ############# + currentCommandID = self.parseResultId(self.dashboard.GetCurrentCommandID())[1] + if self.feedbackData.robotMode == 9 or self.feedbackData.robotMode == 11: + self.dashboard.Stop() + self.dashboard.EmergencyStop(mode=1) + print("当前工作停止,机械臂处于急停状态") + if self.feedbackData.robotMode == 10: # 10 当前工程暂停 + print("机械臂为暂停状态") + res = self.dashboard.Continue() + code = self.parseResultId(res)[0] + if code == 0: + print("机械臂继续已暂停的运动指令") + if self.feedbackData.robotMode == 5 and self.feedbackData.robotCurrentCommandID == currentCommandID: + print("该次运动完成") + break + sleep(0.1) + return 0 + def RunPoint_P_inJoint(self,joints_list): ''' RUNPOINT_P 以关节运动方式运动到目标点 @@ -180,7 +217,45 @@ class dobot_nova5: break sleep(0.1) # 避免 CPU 占用过高 return 0 - + + def RunPoint_P_inJoint_RAD(self,joints_list): + ''' + RUNPOINT_P 以关节运动方式运动到目标点 + MovJ flag = 1 通过关节角度走点,输入为[J1 J2 J3 J4 J5 J6] unit: rad + ''' + # 单位 rad -> deg + joints_list_deg = self.__transform_rad_2_deg(joints_list) + # 走点 + recvmovemess = self.dashboard.MovJ(*joints_list_deg,1) + print("MovJ:",recvmovemess) + print(self.parseResultId(recvmovemess)) + currentCommandID = self.parseResultId(recvmovemess)[1] + print("指令 ID:", currentCommandID) + sleep(0.02) + while True: # 完成判断循环 + ########## 调试注释 ############# + # print("robot mode",self.feedbackData.robotMode) + # print("feedback current ID", self.feedbackData.robotCurrentCommandID) + # print("指令 ID:", currentCommandID) + # print("30004",self.dashboard.GetCurrentCommandID()) + ########## 调试注释 ############# + currentCommandID = self.parseResultId(self.dashboard.GetCurrentCommandID())[1] + if self.feedbackData.robotMode == 9 or self.feedbackData.robotMode == 11: + self.dashboard.Stop() + self.dashboard.EmergencyStop(mode=1) + print("当前工作停止,机械臂处于急停状态") + if self.feedbackData.robotMode == 10: # 10 当前工程暂停 + print("机械臂为暂停状态") + res = self.dashboard.Continue() + code = self.parseResultId(res)[0] + if code == 0: + print("机械臂继续已暂停的运动指令") + if self.feedbackData.robotMode == 5 and self.feedbackData.robotCurrentCommandID == currentCommandID: + print("该次运动完成") + break + sleep(0.1) # 避免 CPU 占用过高 + return 0 + def RunPoint_L_inPose(self,poses_list): ''' RUNPOINT_L 以直线运动方式运动到目标点 @@ -210,6 +285,37 @@ class dobot_nova5: sleep(0.1) return 0 + def RunPoint_L_inPose_M_RAD(self,poses_list): + ''' + RUNPOINT_L 以直线运动方式运动到目标点 + MovJ flag = 0 通过位姿走点,输入为[X Y Z RX RY RZ] unit: m/rad + ''' + # 单位 m/rad -> mm/deg + poses_list_mm_deg = self.__transform_m_rad_2_mm_deg(poses_list) + # 走点 + recvmovemess = self.dashboard.MovL(*poses_list_mm_deg,0) + print("MovL:",recvmovemess) + print(self.parseResultId(recvmovemess)) + currentCommandID = self.parseResultId(recvmovemess)[1] + print("指令 ID:", currentCommandID) + while True: + currentCommandID = self.parseResultId(self.dashboard.GetCurrentCommandID())[1] + if self.feedbackData.robotMode == 9 or self.feedbackData.robotMode == 11: + self.dashboard.Stop() + self.dashboard.EmergencyStop(mode=1) + print("当前工作停止,机械臂处于急停状态") + if self.feedbackData.robotMode == 10: # 10 当前工程暂停 + print("机械臂为暂停状态") + res = self.dashboard.Continue() + code = self.parseResultId(res)[0] + if code == 0: + print("机械臂继续已暂停的运动指令") + if self.feedbackData.robotMode == 5 and self.feedbackData.robotCurrentCommandID == currentCommandID: + print("该次运动完成") + break + sleep(0.1) + return 0 + def RunPoint_L_inJoint(self,joints_list): ''' RUNPOINT_L 以直线运动方式运动到目标点 @@ -238,9 +344,68 @@ class dobot_nova5: break sleep(0.1) return 0 + + def RunPoint_L_inJoint_RAD(self,joints_list): + ''' + RUNPOINT_L 以直线运动方式运动到目标点 + MovJ flag = 0 通过位姿走点,输入为[X Y Z RX RY RZ] unit: rad + ''' + # 单位 rad -> deg + joints_list_deg = self.__transform_rad_2_deg(joints_list) + # 走点 + recvmovemess = self.dashboard.MovL(*joints_list_deg,0) + print("MovL:",recvmovemess) + print(self.parseResultId(recvmovemess)) + currentCommandID = self.parseResultId(recvmovemess)[1] + print("指令 ID:", currentCommandID) + while True: + currentCommandID = self.parseResultId(self.dashboard.GetCurrentCommandID())[1] + if self.feedbackData.robotMode == 9 or self.feedbackData.robotMode == 11: + self.dashboard.Stop() + self.dashboard.EmergencyStop(mode=1) + print("当前工作停止,机械臂处于急停状态") + if self.feedbackData.robotMode == 10: # 10 当前工程暂停 + print("机械臂为暂停状态") + res = self.dashboard.Continue() + code = self.parseResultId(res)[0] + if code == 0: + print("机械臂继续已暂停的运动指令") + if self.feedbackData.robotMode == 5 and self.feedbackData.robotCurrentCommandID == currentCommandID: + print("该次运动完成") + break + sleep(0.1) + return 0 - def ServoJoint(self,joints_list,t=-1,aheadtime=-1,gain=-1): - tcp_command = f"servoj({joints_list[0]},{joints_list[1]},{joints_list[2]},{joints_list[3]},{joints_list[4]},{joints_list[5]},t={t},aheadtime={aheadtime},gain={gain})" + def ServoJoint(self,joints_list): + ''' + 关节角度伺服 + 输入为[J1 J2 J3 J4 J5 J6] unit: deg + ''' + tcp_command = f"servoj({joints_list[0]},{joints_list[1]},{joints_list[2]},{joints_list[3]},{joints_list[4]},{joints_list[5]}, t=0.01, aheadtime=20, gain=200)" + self.dashboard.send_data(tcp_command) # 通过反馈状态来进行异常处理,故这里只需要发,不需要收 + print("ServoJ:",tcp_command) + if self.feedbackData.robotMode == 9 or self.feedbackData.robotMode == 11: + self.dashboard.Stop() + self.dashboard.EmergencyStop(mode=1) + print("当前工作停止,机械臂处于急停状态") + return -1 + if self.feedbackData.robotMode == 10: # 10 当前工程暂停 + print("机械臂为暂停状态") + res = self.dashboard.Continue() + code = self.parseResultId(res)[0] + if code == 0: + print("机械臂继续已暂停的运动指令") + return 0 + + def ServoJoint_RAD(self,joints_list): + ''' + 关节角度伺服 + 输入为[J1 J2 J3 J4 J5 J6] unit: rad + ''' + # 单位转换 rad -> deg + joints_list_deg = self.__transform_rad_2_deg(joints_list) + # 构造字符串 + tcp_command = f"servoj({joints_list_deg[0]},{joints_list_deg[1]},{joints_list_deg[2]},{joints_list_deg[3]},{joints_list_deg[4]},{joints_list_deg[5]}, t=0.01, aheadtime=20, gain=200)" self.dashboard.send_data(tcp_command) # 通过反馈状态来进行异常处理,故这里只需要发,不需要收 print("ServoJ:",tcp_command) if self.feedbackData.robotMode == 9 or self.feedbackData.robotMode == 11: @@ -257,6 +422,10 @@ class dobot_nova5: return 0 def ServoPose(self,poses_list): + ''' + 位姿伺服 + 输入为[X Y Z RX RY RZ] unit: mm/deg + ''' poses_list = list(map(float, poses_list)) tcp_command = f"ServoP({poses_list[0]},{poses_list[1]},{poses_list[2]},{poses_list[3]},{poses_list[4]},{poses_list[5]}, t=0.01, aheadtime=20, gain=200)" res = self.dashboard.sendRecvMsg(tcp_command) # 通过反馈状态来进行异常处理,故这里只需要发,不需要收 @@ -271,6 +440,30 @@ class dobot_nova5: code = self.parseResultId(res)[0] if code == 0: print("机械臂继续已暂停的运动指令") + + def ServoPose_M_RAD(self,poses_list): + ''' + 位姿伺服 + 输入为[X Y Z RX RY RZ] unit: M/RAD + ''' + # 单位 m/rad -> mm/deg + poses_list_mm_deg = self.__transform_m_rad_2_mm_deg(poses_list) + # 确保数据类型正确 + poses_list_mm_deg = list(map(float, poses_list_mm_deg)) + # 构造字符串 + tcp_command = f"ServoP({poses_list[0]},{poses_list[1]},{poses_list[2]},{poses_list[3]},{poses_list[4]},{poses_list[5]}, t=0.01, aheadtime=20, gain=200)" + res = self.dashboard.sendRecvMsg(tcp_command) # 通过反馈状态来进行异常处理,故这里只需要发,不需要收 + print("ServoP msg:",res) + if self.feedbackData.robotMode == 9 or self.feedbackData.robotMode == 11: + self.dashboard.Stop() + self.dashboard.EmergencyStop(mode=1) + print("当前工作停止,机械臂处于急停状态") + if self.feedbackData.robotMode == 10: # 10 当前工程暂停 + print("机械臂为暂停状态") + res = self.dashboard.Continue() + code = self.parseResultId(res)[0] + if code == 0: + print("机械臂继续已暂停的运动指令") def setEndEffector(self,i,tool_i): ''' @@ -469,7 +662,42 @@ class dobot_nova5: def __del__(self): del self.dashboard del self.feedFour + ## 内部工具函数 + + def __transform_m_rad_2_mm_deg(self,input_list): + ''' + 接受列表 [X Y Z RX RY RZ] + 将单位 m/rad 转为 mm/deg + ''' + if len(input_list) != 6: + raise ValueError("Input list must contain exactly 6 elements [X, Y, Z, RX, RY, RZ]") + + # 转换位置单位:m -> mm (乘以 1000) + x_mm = input_list[0] * 1000.0 + y_mm = input_list[1] * 1000.0 + z_mm = input_list[2] * 1000.0 + + # 转换角度单位:rad -> deg (乘以 180/pi) + rx_deg = math.degrees(input_list[3]) + ry_deg = math.degrees(input_list[4]) + rz_deg = math.degrees(input_list[5]) + + return [x_mm, y_mm, z_mm, rx_deg, ry_deg, rz_deg] + def __transform_rad_2_deg(self,input_list): + ''' + 接受列表 [J1 J2 J3 J4 J5 J6] + 将单位rad转为deg + ''' + if len(input_list) != 6: + raise ValueError("Input list must contain exactly 6 elements [J1, J2, J3, J4, J5, J6]") + # 转换角度单位: rad -> deg + J_deg = [] + for i in range(6): + J_deg.append(math.degrees(input_list[i])) + return J_deg + + ## 为反馈线程封装 def Get_feedInfo_angle(self): diff --git a/logs/MassageRobot_nova5_test.log b/logs/MassageRobot_nova5_test.log index 7b655aa..e69de29 100644 --- a/logs/MassageRobot_nova5_test.log +++ b/logs/MassageRobot_nova5_test.log @@ -1,8723 +0,0 @@ -2025-05-16 19:14:19,914 - 测试日志 - INFO - log.py:106 - 切换到finger_head按摩头 -2025-05-16 19:14:23,434 - 测试日志 - INFO - log.py:106 - 机械臂测量线程启动 -2025-05-16 19:15:18,135 - 测试日志 - INFO - log.py:106 - 切换到finger_head按摩头 -2025-05-16 19:15:21,649 - 测试日志 - INFO - log.py:106 - 机械臂测量线程启动 -2025-05-16 19:15:21,650 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999994 -0.13499988 0.34431362] -2025-05-16 19:15:21,651 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999893e+02 -2.74658196e-05 -8.99999466e+01] -2025-05-16 19:15:21,652 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000061 -0.13499976 0.34434018] -2025-05-16 19:15:21,653 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14158972e+00 1.37889700e-12 -1.57079579e+00] -2025-05-16 19:15:21,655 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000059 -0.13499976 0.34429637] -2025-05-16 19:15:21,657 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999893e+02 -2.74658196e-05 -8.99999466e+01] -2025-05-16 19:15:21,658 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000061 -0.13499976 0.34434018] -2025-05-16 19:15:21,662 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14158972e+00 1.37889700e-12 -1.57079579e+00] -2025-05-16 19:15:21,676 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999788 -0.13499978 0.34428121] -2025-05-16 19:15:21,677 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999893e+02 -2.74658196e-05 -8.99999466e+01] -2025-05-16 19:15:21,679 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999944 -0.13500012 0.34433871] -2025-05-16 19:15:21,686 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 -2.30038211e-13 -1.57079726e+00] -2025-05-16 19:15:21,696 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999632 -0.13500012 0.34427031] -2025-05-16 19:15:21,698 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999893e+02 -2.74658196e-05 -8.99999466e+01] -2025-05-16 19:15:21,701 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000002 -0.135 0.34433914] -2025-05-16 19:15:21,707 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 -4.79368983e-07 -1.57079579e+00] -2025-05-16 19:15:21,716 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999511 -0.13499999 0.34426282] -2025-05-16 19:15:21,718 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999893e+02 -2.74658196e-05 -8.99999466e+01] -2025-05-16 19:15:21,720 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000012 -0.13499988 0.34433902] -2025-05-16 19:15:21,731 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212 0. -1.57079579] -2025-05-16 19:15:21,748 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999279 -0.13500148 0.34425695] -2025-05-16 19:15:21,752 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999893e+02 -2.74658196e-05 -8.99999466e+01] -2025-05-16 19:15:21,756 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000018 -0.135 0.34433957] -2025-05-16 19:15:21,759 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159 0. -1.57079633] -2025-05-16 19:15:21,767 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999249 -0.13500324 0.34425258] -2025-05-16 19:15:21,781 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999893e+02 -2.74658196e-05 -8.99999466e+01] -2025-05-16 19:15:21,784 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000006 -0.135 0.34433917] -2025-05-16 19:15:21,797 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 -4.79369237e-07 -1.57079633e+00] -2025-05-16 19:15:21,807 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999176 -0.13500399 0.34424912] -2025-05-16 19:15:21,809 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999893e+02 -2.74658196e-05 -8.99999466e+01] -2025-05-16 19:15:21,817 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000011 -0.13500012 0.34433923] -2025-05-16 19:15:21,820 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 -4.79368983e-07 -1.57079686e+00] -2025-05-16 19:15:21,826 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999136 -0.13500394 0.34424579] -2025-05-16 19:15:21,835 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999893e+02 -2.74658196e-05 -8.99999466e+01] -2025-05-16 19:15:21,838 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999977 -0.13500012 0.34433893] -2025-05-16 19:15:21,840 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 -2.29372077e-13 -1.57079726e+00] -2025-05-16 19:15:21,847 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999226 -0.13500352 0.34424414] -2025-05-16 19:15:21,856 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999893e+02 -2.74658196e-05 -8.99999466e+01] -2025-05-16 19:15:21,858 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999989 -0.13500012 0.34433942] -2025-05-16 19:15:21,862 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159132 0. -1.57079686] -2025-05-16 19:15:21,875 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999359 -0.13500311 0.34424418] -2025-05-16 19:15:21,885 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999893e+02 -2.74658196e-05 -8.99999466e+01] -2025-05-16 19:15:21,889 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999994 -0.13499988 0.34433881] -2025-05-16 19:15:21,905 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159159e+00 4.59410288e-13 -1.57079539e+00] -2025-05-16 19:15:21,907 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999445 -0.13500392 0.34424192] -2025-05-16 19:15:21,929 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999893e+02 -2.74658196e-05 -8.99999466e+01] -2025-05-16 19:15:21,939 - 测试日志 - INFO - log.py:106 - position current:[ 0.25 -0.13499989 0.34433917] -2025-05-16 19:15:21,940 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 9.58738221e-07 -1.57079726e+00] -2025-05-16 19:15:21,943 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999415 -0.13500421 0.3442416 ] -2025-05-16 19:15:21,948 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999893e+02 -2.74658196e-05 -8.99999466e+01] -2025-05-16 19:15:21,952 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999994 -0.13499977 0.34433896] -2025-05-16 19:15:21,955 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159159e+00 4.79369904e-07 -1.57079486e+00] -2025-05-16 19:15:21,964 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999465 -0.13500402 0.3442415 ] -2025-05-16 19:15:21,966 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999893e+02 -2.74658196e-05 -8.99999466e+01] -2025-05-16 19:15:21,968 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999992 -0.13500012 0.34433902] -2025-05-16 19:15:21,977 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 2.29816166e-13 -1.57079633e+00] -2025-05-16 19:15:21,986 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999473 -0.13500511 0.34424027] -2025-05-16 19:15:21,995 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999893e+02 -2.74658196e-05 -8.99999466e+01] -2025-05-16 19:15:21,999 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000006 -0.135 0.34433917] -2025-05-16 19:15:22,001 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 -2.29372077e-13 -1.57079579e+00] -2025-05-16 19:15:22,045 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999523 -0.13500678 0.34424005] -2025-05-16 19:15:22,047 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999893e+02 -2.74658196e-05 -8.99999466e+01] -2025-05-16 19:15:22,048 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000023 -0.13500023 0.34433963] -2025-05-16 19:15:22,049 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159132e+00 -4.79369682e-07 -1.57079633e+00] -2025-05-16 19:15:22,053 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999467 -0.13500662 0.34423981] -2025-05-16 19:15:22,054 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999893e+02 -2.74658196e-05 -8.99999466e+01] -2025-05-16 19:15:22,056 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000024 -0.135 0.34433942] -2025-05-16 19:15:22,072 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 -4.79369460e-07 -1.57079539e+00] -2025-05-16 19:15:22,075 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999435 -0.13500639 0.34423951] -2025-05-16 19:15:22,076 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999893e+02 -2.74658196e-05 -8.99999466e+01] -2025-05-16 19:15:22,077 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999989 -0.13499977 0.34433893] -2025-05-16 19:15:22,096 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 4.79369460e-07 -1.57079486e+00] -2025-05-16 19:15:22,100 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999484 -0.13500672 0.34423905] -2025-05-16 19:15:22,107 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999893e+02 -2.74658196e-05 -8.99999466e+01] -2025-05-16 19:15:22,109 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999931 -0.13500035 0.34433899] -2025-05-16 19:15:22,114 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159265e+00 -4.79368983e-07 -1.57079686e+00] -2025-05-16 19:15:22,131 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999563 -0.13500669 0.34423993] -2025-05-16 19:15:22,133 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999893e+02 -2.74658196e-05 -8.99999466e+01] -2025-05-16 19:15:22,134 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000012 -0.13499976 0.34433902] -2025-05-16 19:15:22,136 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212 0. -1.57079539] -2025-05-16 19:15:22,152 - 测试日志 - INFO - log.py:106 - MassageRobot启动 -2025-05-16 19:15:22,153 - 测试日志 - INFO - log.py:106 - 机械臂控制线程启动 -2025-05-16 19:15:22,175 - 测试日志 - ERROR - log.py:106 - 机械臂控制失败:The truth value of an array with more than one element is ambiguous. Use a.any() or a.all() -2025-05-16 19:16:49,657 - 测试日志 - INFO - log.py:106 - 切换到finger_head按摩头 -2025-05-16 19:16:53,182 - 测试日志 - INFO - log.py:106 - 机械臂测量线程启动 -2025-05-16 19:16:53,183 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000008 -0.135 0.34431414] -2025-05-16 19:16:53,205 - 测试日志 - INFO - log.py:106 - orientation command: [-1.80000000e+02 -5.49316392e-05 -8.99999695e+01] -2025-05-16 19:16:53,212 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000011 -0.135 0.3443389 ] -2025-05-16 19:16:53,213 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159159e+00 -4.79369460e-07 -1.57079633e+00] -2025-05-16 19:16:53,214 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000011 -0.135 0.34429516] -2025-05-16 19:16:53,215 - 测试日志 - INFO - log.py:106 - orientation command: [-1.80000000e+02 -5.49316392e-05 -8.99999695e+01] -2025-05-16 19:16:53,216 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999992 -0.13500012 0.34433868] -2025-05-16 19:16:53,217 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159132e+00 -4.79368983e-07 -1.57079633e+00] -2025-05-16 19:16:53,244 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999972 -0.13500022 0.34428107] -2025-05-16 19:16:53,245 - 测试日志 - INFO - log.py:106 - orientation command: [-1.80000000e+02 -5.49316392e-05 -8.99999695e+01] -2025-05-16 19:16:53,247 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999968 -0.13500012 0.34433926] -2025-05-16 19:16:53,248 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 -4.79368984e-07 -1.57079633e+00] -2025-05-16 19:16:53,260 - 测试日志 - INFO - log.py:106 - position command: [ 0.2499997 -0.13500011 0.34427091] -2025-05-16 19:16:53,261 - 测试日志 - INFO - log.py:106 - orientation command: [-1.80000000e+02 -5.49316392e-05 -8.99999695e+01] -2025-05-16 19:16:53,262 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000015 -0.13499988 0.34433862] -2025-05-16 19:16:53,264 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159132e+00 -6.89226454e-13 -1.57079633e+00] -2025-05-16 19:16:53,279 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000017 -0.13499987 0.34426238] -2025-05-16 19:16:53,281 - 测试日志 - INFO - log.py:106 - orientation command: [-1.80000000e+02 -5.49316392e-05 -8.99999695e+01] -2025-05-16 19:16:53,282 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000017 -0.13499988 0.34433905] -2025-05-16 19:16:53,282 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159159e+00 -4.79369904e-07 -1.57079633e+00] -2025-05-16 19:16:53,299 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000017 -0.13499988 0.34425687] -2025-05-16 19:16:53,300 - 测试日志 - INFO - log.py:106 - orientation command: [-1.80000000e+02 -5.49316392e-05 -8.99999695e+01] -2025-05-16 19:16:53,305 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000005 -0.13500023 0.34433908] -2025-05-16 19:16:53,306 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 -4.79368983e-07 -1.57079779e+00] -2025-05-16 19:16:53,325 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999992 -0.135 0.34425271] -2025-05-16 19:16:53,327 - 测试日志 - INFO - log.py:106 - orientation command: [-1.80000000e+02 -5.49316392e-05 -8.99999695e+01] -2025-05-16 19:16:53,329 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000002 -0.135 0.34433948] -2025-05-16 19:16:53,331 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 9.18820575e-13 -1.57079726e+00] -2025-05-16 19:16:53,343 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000003 -0.13500139 0.34424948] -2025-05-16 19:16:53,345 - 测试日志 - INFO - log.py:106 - orientation command: [-1.80000000e+02 -5.49316392e-05 -8.99999695e+01] -2025-05-16 19:16:53,346 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999956 -0.13499977 0.34433887] -2025-05-16 19:16:53,347 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 4.79368984e-07 -1.57079579e+00] -2025-05-16 19:16:53,362 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999958 -0.13500183 0.34424638] -2025-05-16 19:16:53,363 - 测试日志 - INFO - log.py:106 - orientation command: [-1.80000000e+02 -5.49316392e-05 -8.99999695e+01] -2025-05-16 19:16:53,364 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999979 -0.13499988 0.34433899] -2025-05-16 19:16:53,365 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 -4.79369238e-07 -1.57079579e+00] -2025-05-16 19:16:53,384 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999982 -0.13500216 0.34424463] -2025-05-16 19:16:53,387 - 测试日志 - INFO - log.py:106 - orientation command: [-1.80000000e+02 -5.49316392e-05 -8.99999695e+01] -2025-05-16 19:16:53,390 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000002 -0.135 0.34433929] -2025-05-16 19:16:53,391 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 -4.79368983e-07 -1.57079686e+00] -2025-05-16 19:16:53,413 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000004 -0.13500247 0.3442437 ] -2025-05-16 19:16:53,415 - 测试日志 - INFO - log.py:106 - orientation command: [-1.80000000e+02 -5.49316392e-05 -8.99999695e+01] -2025-05-16 19:16:53,416 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000011 -0.135 0.34433908] -2025-05-16 19:16:53,429 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265 0. -1.57079686] -2025-05-16 19:16:53,431 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000024 -0.13500207 0.34424242] -2025-05-16 19:16:53,432 - 测试日志 - INFO - log.py:106 - orientation command: [-1.80000000e+02 -5.49316392e-05 -8.99999695e+01] -2025-05-16 19:16:53,433 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000023 -0.135 0.34433911] -2025-05-16 19:16:53,435 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 -4.79369237e-07 -1.57079633e+00] -2025-05-16 19:16:53,451 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000023 -0.13500183 0.34424148] -2025-05-16 19:16:53,460 - 测试日志 - INFO - log.py:106 - orientation command: [-1.80000000e+02 -5.49316392e-05 -8.99999695e+01] -2025-05-16 19:16:53,462 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999971 -0.135 0.34433868] -2025-05-16 19:16:53,463 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159079e+00 -4.79370825e-07 -1.57079686e+00] -2025-05-16 19:16:53,472 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000012 -0.13500158 0.34424113] -2025-05-16 19:16:53,474 - 测试日志 - INFO - log.py:106 - orientation command: [-1.80000000e+02 -5.49316392e-05 -8.99999695e+01] -2025-05-16 19:16:53,494 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999962 -0.13500012 0.34433908] -2025-05-16 19:16:53,495 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 -4.79368983e-07 -1.57079779e+00] -2025-05-16 19:16:53,496 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000006 -0.13500168 0.344241 ] -2025-05-16 19:16:53,498 - 测试日志 - INFO - log.py:106 - orientation command: [-1.80000000e+02 -5.49316392e-05 -8.99999695e+01] -2025-05-16 19:16:53,499 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999962 -0.13500012 0.34433908] -2025-05-16 19:16:53,501 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 -4.79368983e-07 -1.57079779e+00] -2025-05-16 19:16:53,517 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999992 -0.13500111 0.34424018] -2025-05-16 19:16:53,519 - 测试日志 - INFO - log.py:106 - orientation command: [-1.80000000e+02 -5.49316392e-05 -8.99999695e+01] -2025-05-16 19:16:53,522 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000037 -0.13500035 0.34433997] -2025-05-16 19:16:53,524 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159026e+00 -1.43810359e-06 -1.57079779e+00] -2025-05-16 19:16:53,538 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000016 -0.13500091 0.34423952] -2025-05-16 19:16:53,539 - 测试日志 - INFO - log.py:106 - orientation command: [-1.80000000e+02 -5.49316392e-05 -8.99999695e+01] -2025-05-16 19:16:53,541 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999997 -0.13499976 0.34433936] -2025-05-16 19:16:53,542 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 1.37800882e-12 -1.57079686e+00] -2025-05-16 19:16:53,558 - 测试日志 - INFO - log.py:106 - position command: [ 0.2500003 -0.13500074 0.34424059] -2025-05-16 19:16:53,560 - 测试日志 - INFO - log.py:106 - orientation command: [-1.80000000e+02 -5.49316392e-05 -8.99999695e+01] -2025-05-16 19:16:53,562 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999988 -0.13500012 0.34433896] -2025-05-16 19:16:53,563 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159159e+00 -4.79369904e-07 -1.57079726e+00] -2025-05-16 19:16:53,579 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999988 -0.13500072 0.34423936] -2025-05-16 19:16:53,581 - 测试日志 - INFO - log.py:106 - orientation command: [-1.80000000e+02 -5.49316392e-05 -8.99999695e+01] -2025-05-16 19:16:53,582 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000003 -0.13499988 0.3443396 ] -2025-05-16 19:16:53,586 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159132e+00 6.89226454e-13 -1.57079633e+00] -2025-05-16 19:16:53,597 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000003 -0.13500058 0.34423971] -2025-05-16 19:16:53,599 - 测试日志 - INFO - log.py:106 - orientation command: [-1.80000000e+02 -5.49316392e-05 -8.99999695e+01] -2025-05-16 19:16:53,601 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999974 -0.13500035 0.34433862] -2025-05-16 19:16:53,605 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159079e+00 -9.58738919e-07 -1.57079726e+00] -2025-05-16 19:16:53,618 - 测试日志 - INFO - log.py:106 - MassageRobot启动 -2025-05-16 19:16:53,620 - 测试日志 - INFO - log.py:106 - 机械臂控制线程启动 -2025-05-16 19:16:53,643 - 测试日志 - ERROR - log.py:106 - 机械臂控制失败:The truth value of an array with more than one element is ambiguous. Use a.any() or a.all() -2025-05-16 19:17:27,178 - 测试日志 - INFO - log.py:106 - 切换到finger_head按摩头 -2025-05-16 19:17:30,694 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000006 -0.13500012 0.34431451] -2025-05-16 19:17:30,695 - 测试日志 - INFO - log.py:106 - orientation command: [-179.99992371 0. -90.00003052] -2025-05-16 19:17:30,697 - 测试日志 - INFO - log.py:106 - 机械臂测量线程启动 -2025-05-16 19:17:30,698 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000002 -0.135 0.34433948] -2025-05-16 19:17:30,699 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 -9.19264664e-13 -1.57079539e+00] -2025-05-16 19:17:30,705 - 测试日志 - INFO - log.py:106 - position command: [ 0.25 -0.135 0.34429511] -2025-05-16 19:17:30,709 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999924e+02 -2.73696515e-05 -8.99999469e+01] -2025-05-16 19:17:30,712 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999969 -0.13500012 0.34433875] -2025-05-16 19:17:30,714 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159132e+00 2.06812345e-12 -1.57079539e+00] -2025-05-16 19:17:30,723 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999971 -0.13500013 0.34428098] -2025-05-16 19:17:30,725 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999925e+02 9.92135866e-08 -8.99999472e+01] -2025-05-16 19:17:30,727 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999974 -0.13499988 0.34433942] -2025-05-16 19:17:30,730 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 -9.19264664e-13 -1.57079486e+00] -2025-05-16 19:17:30,742 - 测试日志 - INFO - log.py:106 - position command: [ 0.25 -0.13500012 0.34427045] -2025-05-16 19:17:30,743 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999941e+02 1.00127538e-07 -8.99999703e+01] -2025-05-16 19:17:30,745 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000017 -0.135 0.34433911] -2025-05-16 19:17:30,746 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 4.58966198e-13 -1.57079539e+00] -2025-05-16 19:17:30,765 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999992 -0.13500023 0.34426331] -2025-05-16 19:17:30,767 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999892e+02 -5.46198249e-05 -8.99999190e+01] -2025-05-16 19:17:30,769 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000024 -0.13499965 0.34433908] -2025-05-16 19:17:30,771 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 4.79368984e-07 -1.57079446e+00] -2025-05-16 19:17:30,797 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999976 -0.13500489 0.34425725] -2025-05-16 19:17:30,801 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999938e+02 4.41686016e-04 -8.99998668e+01] -2025-05-16 19:17:30,803 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999976 -0.13499988 0.34433859] -2025-05-16 19:17:30,809 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159132e+00 4.79369682e-07 -1.57079579e+00] -2025-05-16 19:17:30,812 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000026 -0.13500601 0.34425247] -2025-05-16 19:17:30,815 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999998e+02 6.49917982e-04 -8.99998861e+01] -2025-05-16 19:17:30,818 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000017 -0.135 0.34433926] -2025-05-16 19:17:30,826 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 6.89226454e-13 -1.57079486e+00] -2025-05-16 19:17:30,838 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000017 -0.13500649 0.34424932] -2025-05-16 19:17:30,849 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999971e+02 7.92084632e-04 -8.99998839e+01] -2025-05-16 19:17:30,859 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999994 -0.13500012 0.34433948] -2025-05-16 19:17:30,866 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 -9.18820575e-13 -1.57079579e+00] -2025-05-16 19:17:30,878 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999989 -0.13500582 0.34424637] -2025-05-16 19:17:30,887 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999941e+02 8.55973477e-04 -8.99999365e+01] -2025-05-16 19:17:30,892 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000017 -0.135 0.34433908] -2025-05-16 19:17:30,901 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159265e+00 -4.79368984e-07 -1.57079446e+00] -2025-05-16 19:17:30,904 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999997 -0.13500506 0.34424494] -2025-05-16 19:17:30,906 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999967e+02 8.68196194e-04 -8.99998830e+01] -2025-05-16 19:17:30,907 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999974 -0.13499988 0.34433926] -2025-05-16 19:17:30,911 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 -1.37889700e-12 -1.57079446e+00] -2025-05-16 19:17:30,927 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999992 -0.1350043 0.34424347] -2025-05-16 19:17:30,930 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999936e+02 8.90382550e-04 -8.99998223e+01] -2025-05-16 19:17:30,935 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000024 -0.13499976 0.34433908] -2025-05-16 19:17:30,941 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265 0. -1.57079446] -2025-05-16 19:17:30,951 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000025 -0.13500336 0.3442423 ] -2025-05-16 19:17:30,955 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999997e+02 9.27353458e-04 -8.99998480e+01] -2025-05-16 19:17:30,962 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000005 -0.13500012 0.3443389 ] -2025-05-16 19:17:30,965 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159159e+00 -4.79368063e-07 -1.57079539e+00] -2025-05-16 19:17:30,971 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000005 -0.1350031 0.34424133] -2025-05-16 19:17:30,985 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999942e+02 9.00481952e-04 -8.99998905e+01] -2025-05-16 19:17:30,989 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000015 -0.135 0.34433878] -2025-05-16 19:17:30,995 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159132e+00 -4.79368317e-07 -1.57079539e+00] -2025-05-16 19:17:31,006 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999995 -0.13500238 0.34424113] -2025-05-16 19:17:31,008 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999997e+02 9.17363811e-04 -8.99998552e+01] -2025-05-16 19:17:31,009 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999974 -0.13499988 0.34433908] -2025-05-16 19:17:31,010 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159265e+00 -4.79368983e-07 -1.57079393e+00] -2025-05-16 19:17:31,024 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000002 -0.13500189 0.34424053] -2025-05-16 19:17:31,027 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999997e+02 8.76269770e-04 -8.99998295e+01] -2025-05-16 19:17:31,030 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999994 -0.13500012 0.34433896] -2025-05-16 19:17:31,035 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159265e+00 -4.79368983e-07 -1.57079539e+00] -2025-05-16 19:17:31,049 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000024 -0.13500116 0.34424043] -2025-05-16 19:17:31,057 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999996e+02 9.15230802e-04 -8.99998280e+01] -2025-05-16 19:17:31,060 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000011 -0.135 0.34433908] -2025-05-16 19:17:31,064 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265 0. -1.57079539] -2025-05-16 19:17:31,067 - 测试日志 - INFO - log.py:106 - position command: [ 0.2500001 -0.13500119 0.34423988] -2025-05-16 19:17:31,069 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999996e+02 8.70474707e-04 -8.99998808e+01] -2025-05-16 19:17:31,070 - 测试日志 - INFO - log.py:106 - position current:[ 0.25 -0.13500023 0.34433884] -2025-05-16 19:17:31,072 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 -9.58737332e-07 -1.57079486e+00] -2025-05-16 19:17:31,109 - 测试日志 - INFO - log.py:106 - position command: [ 0.25 -0.13500118 0.34423946] -2025-05-16 19:17:31,110 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999974e+02 7.98877382e-04 -8.99998498e+01] -2025-05-16 19:17:31,112 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000035 -0.13499976 0.3443396 ] -2025-05-16 19:17:31,112 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212 0. -1.57079539] -2025-05-16 19:17:31,125 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999996 -0.13500052 0.34423956] -2025-05-16 19:17:31,126 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999965e+02 8.62447199e-04 -8.99998504e+01] -2025-05-16 19:17:31,127 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000002 -0.135 0.34433948] -2025-05-16 19:17:31,128 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 -9.19264664e-13 -1.57079539e+00] -2025-05-16 19:17:31,146 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000002 -0.1350006 0.34423984] -2025-05-16 19:17:31,154 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999935e+02 8.16720626e-04 -8.99998815e+01] -2025-05-16 19:17:31,155 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000011 -0.13500012 0.34433923] -2025-05-16 19:17:31,156 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 -4.79368983e-07 -1.57079633e+00] -2025-05-16 19:17:31,160 - 测试日志 - INFO - log.py:106 - MassageRobot启动 -2025-05-16 19:17:31,166 - 测试日志 - INFO - log.py:106 - 机械臂控制线程启动 -2025-05-16 19:17:31,191 - 测试日志 - ERROR - log.py:106 - 机械臂控制失败:The truth value of an array with more than one element is ambiguous. Use a.any() or a.all() -2025-05-16 19:18:06,012 - 测试日志 - INFO - log.py:106 - 切换到finger_head按摩头 -2025-05-16 19:18:09,527 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000023 -0.135 0.34431445] -2025-05-16 19:18:09,528 - 测试日志 - INFO - log.py:106 - 机械臂测量线程启动 -2025-05-16 19:18:09,529 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999969e+02 1.31547742e-11 -9.00000305e+01] -2025-05-16 19:18:09,531 - 测试日志 - INFO - log.py:106 - position current:[ 0.25 -0.13499988 0.34433868] -2025-05-16 19:18:09,533 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159132e+00 -6.89448498e-13 -1.57079633e+00] -2025-05-16 19:18:09,535 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000001 -0.13499988 0.34429496] -2025-05-16 19:18:09,536 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999924e+02 -5.33060965e-11 -9.00000001e+01] -2025-05-16 19:18:09,537 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000006 -0.13500012 0.34433951] -2025-05-16 19:18:09,538 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 -4.79368761e-07 -1.57079686e+00] -2025-05-16 19:18:09,554 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999988 -0.135 0.34428074] -2025-05-16 19:18:09,555 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999925e+02 2.73653824e-05 -9.00000427e+01] -2025-05-16 19:18:09,556 - 测试日志 - INFO - log.py:106 - position current:[ 0.25 -0.135 0.34433902] -2025-05-16 19:18:09,558 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 -2.29372077e-13 -1.57079686e+00] -2025-05-16 19:18:09,579 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999954 -0.135 0.34427027] -2025-05-16 19:18:09,580 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999970e+02 -1.02161350e-07 -8.99999789e+01] -2025-05-16 19:18:09,581 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999968 -0.13499977 0.34433926] -2025-05-16 19:18:09,582 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 4.79368983e-07 -1.57079579e+00] -2025-05-16 19:18:09,598 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999998 -0.13499988 0.34426261] -2025-05-16 19:18:09,599 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999940e+02 -1.01646953e-07 -8.99999659e+01] -2025-05-16 19:18:09,600 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999994 -0.13499988 0.34433881] -2025-05-16 19:18:09,602 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159159e+00 -4.59410288e-13 -1.57079633e+00] -2025-05-16 19:18:09,620 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999989 -0.13499989 0.34425721] -2025-05-16 19:18:09,624 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999968e+02 2.72660199e-05 -8.99999489e+01] -2025-05-16 19:18:09,625 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999983 -0.135 0.34433893] -2025-05-16 19:18:09,628 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212 0. -1.57079633] -2025-05-16 19:18:09,640 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999977 -0.13500001 0.34425255] -2025-05-16 19:18:09,641 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999968e+02 -1.98010826e-07 -8.99999070e+01] -2025-05-16 19:18:09,642 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999986 -0.13500024 0.34433902] -2025-05-16 19:18:09,643 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212 0. -1.57079726] -2025-05-16 19:18:09,661 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000016 -0.13499989 0.34424941] -2025-05-16 19:18:09,663 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999968e+02 -1.95282737e-07 -8.99998993e+01] -2025-05-16 19:18:09,673 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000031 -0.13499976 0.34433942] -2025-05-16 19:18:09,682 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159 0. -1.57079539] -2025-05-16 19:18:09,688 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999999 -0.13499989 0.34424696] -2025-05-16 19:18:09,692 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999968e+02 -1.91949121e-07 -8.99998867e+01] -2025-05-16 19:18:09,697 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000024 -0.13499976 0.34433923] -2025-05-16 19:18:09,703 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159265 0. -1.57079579] -2025-05-16 19:18:09,711 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999986 -0.13500001 0.34424478] -2025-05-16 19:18:09,714 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999940e+02 2.71811172e-05 -8.99999580e+01] -2025-05-16 19:18:09,719 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999983 -0.135 0.34433926] -2025-05-16 19:18:09,723 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 4.79368984e-07 -1.57079686e+00] -2025-05-16 19:18:09,730 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999969 -0.13500012 0.34424287] -2025-05-16 19:18:09,731 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999926e+02 2.70880220e-05 -8.99999190e+01] -2025-05-16 19:18:09,733 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999986 -0.13499988 0.34433948] -2025-05-16 19:18:09,735 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159132e+00 -6.89448498e-13 -1.57079539e+00] -2025-05-16 19:18:09,747 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000005 -0.135 0.34424207] -2025-05-16 19:18:09,750 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999972e+02 -3.74535656e-07 -8.99998702e+01] -2025-05-16 19:18:09,756 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000064 -0.13499965 0.34433926] -2025-05-16 19:18:09,762 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 4.79369460e-07 -1.57079579e+00] -2025-05-16 19:18:09,770 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999991 -0.13499988 0.34424158] -2025-05-16 19:18:09,773 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999967e+02 -2.77394374e-05 -8.99997971e+01] -2025-05-16 19:18:09,779 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999989 -0.13500012 0.34433926] -2025-05-16 19:18:09,782 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 -4.79368984e-07 -1.57079633e+00] -2025-05-16 19:18:09,790 - 测试日志 - INFO - log.py:106 - position command: [ 0.2500001 -0.13499978 0.34424086] -2025-05-16 19:18:09,790 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999972e+02 2.71001160e-05 -8.99997982e+01] -2025-05-16 19:18:09,791 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000003 -0.135 0.3443396 ] -2025-05-16 19:18:09,791 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159132e+00 -4.79368317e-07 -1.57079633e+00] -2025-05-16 19:18:09,810 - 测试日志 - INFO - log.py:106 - position command: [ 0.2499998 -0.13500036 0.34424053] -2025-05-16 19:18:09,810 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999998e+02 -3.59614631e-07 -8.99998910e+01] -2025-05-16 19:18:09,811 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000006 -0.13499977 0.34433902] -2025-05-16 19:18:09,812 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 4.79368762e-07 -1.57079633e+00] -2025-05-16 19:18:09,830 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000025 -0.13500011 0.34424023] -2025-05-16 19:18:09,832 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999998e+02 -3.53008237e-07 -8.99998159e+01] -2025-05-16 19:18:09,833 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999991 -0.13499988 0.34433936] -2025-05-16 19:18:09,834 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 4.59632332e-13 -1.57079633e+00] -2025-05-16 19:18:09,849 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000004 -0.13499999 0.34423997] -2025-05-16 19:18:09,851 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999972e+02 -3.45881467e-07 -8.99997715e+01] -2025-05-16 19:18:09,853 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999994 -0.13499977 0.34433896] -2025-05-16 19:18:09,854 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159159e+00 4.79368539e-07 -1.57079633e+00] -2025-05-16 19:18:09,872 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999996 -0.13499988 0.34423946] -2025-05-16 19:18:09,873 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999926e+02 2.70313608e-05 -8.99997327e+01] -2025-05-16 19:18:09,874 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999954 -0.135 0.34433893] -2025-05-16 19:18:09,876 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 4.79368983e-07 -1.57079686e+00] -2025-05-16 19:18:09,891 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999986 -0.13500012 0.34423944] -2025-05-16 19:18:09,892 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999942e+02 -4.27517514e-07 -8.99998044e+01] -2025-05-16 19:18:09,893 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000003 -0.135 0.34433878] -2025-05-16 19:18:09,894 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159132e+00 4.79369682e-07 -1.57079633e+00] -2025-05-16 19:18:09,910 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999998 -0.135 0.34423951] -2025-05-16 19:18:09,911 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999997e+02 -4.19118102e-07 -8.99997096e+01] -2025-05-16 19:18:09,912 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999994 -0.135 0.34433914] -2025-05-16 19:18:09,913 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159265 0. -1.57079579] -2025-05-16 19:18:09,931 - 测试日志 - INFO - log.py:106 - 机械臂控制线程启动 -2025-05-16 19:18:09,935 - 测试日志 - INFO - log.py:106 - MassageRobot启动 -2025-05-16 19:19:07,078 - 测试日志 - INFO - log.py:106 - 切换到finger_head按摩头 -2025-05-16 19:19:10,599 - 测试日志 - INFO - log.py:106 - 机械臂测量线程启动 -2025-05-16 19:19:10,616 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000037 -0.13499882 0.34431442] -2025-05-16 19:19:10,620 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999939e+02 1.92260821e-04 -9.00000000e+01] -2025-05-16 19:19:10,622 - 测试日志 - INFO - log.py:106 - position current:[ 0.2500002 -0.13499895 0.34433969] -2025-05-16 19:19:10,625 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159132e+00 3.83495466e-06 -1.57079779e+00] -2025-05-16 19:19:10,627 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999995 -0.13500145 0.34429508] -2025-05-16 19:19:10,630 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999939e+02 1.92260821e-04 -9.00000000e+01] -2025-05-16 19:19:10,633 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999995 -0.13499883 0.34433908] -2025-05-16 19:19:10,635 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 3.83495161e-06 -1.57079633e+00] -2025-05-16 19:19:10,648 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999998 -0.13500415 0.3442813 ] -2025-05-16 19:19:10,654 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999939e+02 1.92260821e-04 -9.00000000e+01] -2025-05-16 19:19:10,657 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000047 -0.13499883 0.34433966] -2025-05-16 19:19:10,658 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 3.83495238e-06 -1.57079579e+00] -2025-05-16 19:19:10,668 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000027 -0.13500515 0.3442709 ] -2025-05-16 19:19:10,669 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999939e+02 1.92260821e-04 -9.00000000e+01] -2025-05-16 19:19:10,670 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999985 -0.13499907 0.3443392 ] -2025-05-16 19:19:10,671 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 3.35558308e-06 -1.57079579e+00] -2025-05-16 19:19:10,692 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000031 -0.13500671 0.3442632 ] -2025-05-16 19:19:10,695 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999939e+02 1.92260821e-04 -9.00000000e+01] -2025-05-16 19:19:10,705 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999995 -0.13499895 0.34433908] -2025-05-16 19:19:10,714 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 3.35558257e-06 -1.57079633e+00] -2025-05-16 19:19:10,723 - 测试日志 - INFO - log.py:106 - position command: [ 0.2500002 -0.13500773 0.34425717] -2025-05-16 19:19:10,726 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999939e+02 1.92260821e-04 -9.00000000e+01] -2025-05-16 19:19:10,738 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999997 -0.13499872 0.34433954] -2025-05-16 19:19:10,740 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 4.31432219e-06 -1.57079686e+00] -2025-05-16 19:19:10,742 - 测试日志 - INFO - log.py:106 - position command: [ 0.25 -0.13500758 0.3442529 ] -2025-05-16 19:19:10,744 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999939e+02 1.92260821e-04 -9.00000000e+01] -2025-05-16 19:19:10,746 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999985 -0.13499884 0.34433902] -2025-05-16 19:19:10,749 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159265e+00 4.31432117e-06 -1.57079633e+00] -2025-05-16 19:19:10,770 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000015 -0.13500718 0.34424937] -2025-05-16 19:19:10,773 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999939e+02 1.92260821e-04 -9.00000000e+01] -2025-05-16 19:19:10,775 - 测试日志 - INFO - log.py:106 - position current:[ 0.2499998 -0.13499872 0.34433893] -2025-05-16 19:19:10,779 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159265e+00 3.83495187e-06 -1.57079539e+00] -2025-05-16 19:19:10,791 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999989 -0.13500615 0.34424622] -2025-05-16 19:19:10,798 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999939e+02 1.92260821e-04 -9.00000000e+01] -2025-05-16 19:19:10,805 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000009 -0.13499847 0.34433908] -2025-05-16 19:19:10,809 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 4.31432066e-06 -1.57079539e+00] -2025-05-16 19:19:10,818 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000012 -0.13500641 0.34424448] -2025-05-16 19:19:10,826 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999939e+02 1.92260821e-04 -9.00000000e+01] -2025-05-16 19:19:10,829 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000002 -0.13499895 0.34433914] -2025-05-16 19:19:10,838 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159265e+00 3.83495187e-06 -1.57079633e+00] -2025-05-16 19:19:10,840 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000056 -0.13500834 0.34424423] -2025-05-16 19:19:10,841 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999939e+02 1.92260821e-04 -9.00000000e+01] -2025-05-16 19:19:10,842 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000031 -0.13499895 0.34433957] -2025-05-16 19:19:10,843 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 3.35558333e-06 -1.57079579e+00] -2025-05-16 19:19:10,860 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000009 -0.13500992 0.34424254] -2025-05-16 19:19:10,861 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999939e+02 1.92260821e-04 -9.00000000e+01] -2025-05-16 19:19:10,862 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000047 -0.13499884 0.34433984] -2025-05-16 19:19:10,866 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159079e+00 4.31432168e-06 -1.57079633e+00] -2025-05-16 19:19:10,882 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000037 -0.13501152 0.34424215] -2025-05-16 19:19:10,886 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999939e+02 1.92260821e-04 -9.00000000e+01] -2025-05-16 19:19:10,891 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999995 -0.13499907 0.34433893] -2025-05-16 19:19:10,904 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 2.87621403e-06 -1.57079539e+00] -2025-05-16 19:19:10,908 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999999 -0.13501273 0.34424072] -2025-05-16 19:19:10,912 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999939e+02 1.92260821e-04 -9.00000000e+01] -2025-05-16 19:19:10,919 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000003 -0.13499965 0.34433926] -2025-05-16 19:19:10,921 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 4.79369682e-07 -1.57079686e+00] -2025-05-16 19:19:10,927 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000007 -0.13501444 0.34424062] -2025-05-16 19:19:10,929 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999939e+02 1.92260821e-04 -9.00000000e+01] -2025-05-16 19:19:10,932 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000002 -0.13500011 0.34433914] -2025-05-16 19:19:10,934 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 -9.58737967e-07 -1.57079686e+00] -2025-05-16 19:19:10,954 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000005 -0.13501585 0.34424017] -2025-05-16 19:19:10,957 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999939e+02 1.92260821e-04 -9.00000000e+01] -2025-05-16 19:19:10,958 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000003 -0.13500011 0.34433926] -2025-05-16 19:19:10,960 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 -1.43810651e-06 -1.57079633e+00] -2025-05-16 19:19:10,972 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000007 -0.13501529 0.34424004] -2025-05-16 19:19:10,973 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999939e+02 1.92260821e-04 -9.00000000e+01] -2025-05-16 19:19:10,974 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999986 -0.135 0.34433948] -2025-05-16 19:19:10,976 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 -9.58737967e-07 -1.57079539e+00] -2025-05-16 19:19:10,993 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000007 -0.13501407 0.34424 ] -2025-05-16 19:19:10,996 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999939e+02 1.92260821e-04 -9.00000000e+01] -2025-05-16 19:19:11,001 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999991 -0.13500011 0.3443392 ] -2025-05-16 19:19:11,003 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 -1.43810701e-06 -1.57079579e+00] -2025-05-16 19:19:11,012 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999996 -0.13501361 0.34423965] -2025-05-16 19:19:11,014 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999939e+02 1.92260821e-04 -9.00000000e+01] -2025-05-16 19:19:11,015 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999979 -0.13500023 0.34433932] -2025-05-16 19:19:11,017 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 -1.43810651e-06 -1.57079686e+00] -2025-05-16 19:19:11,032 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000024 -0.1350142 0.34424001] -2025-05-16 19:19:11,035 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999939e+02 1.92260821e-04 -9.00000000e+01] -2025-05-16 19:19:11,037 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000008 -0.13500011 0.34433914] -2025-05-16 19:19:11,039 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 -1.43810701e-06 -1.57079539e+00] -2025-05-16 19:19:11,051 - 测试日志 - INFO - log.py:106 - 机械臂控制线程启动 -2025-05-16 19:19:11,052 - 测试日志 - INFO - log.py:106 - MassageRobot启动 -2025-05-16 19:20:30,100 - 测试日志 - ERROR - log.py:106 - 传感器数据读取失败 -2025-05-16 19:20:30,104 - 测试日志 - ERROR - log.py:106 - 传感器线程数据读取失败-1 -2025-05-16 19:21:01,065 - 测试日志 - INFO - log.py:106 - 切换到finger_head按摩头 -2025-05-16 19:21:04,582 - 测试日志 - INFO - log.py:106 - 机械臂测量线程启动 -2025-05-16 19:21:04,591 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000008 -0.13499988 0.34431448] -2025-05-16 19:21:04,596 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999939e+02 1.31662242e-10 -9.00001068e+01] -2025-05-16 19:21:04,606 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999985 -0.13499988 0.3443392 ] -2025-05-16 19:21:04,609 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265 0. -1.57079779] -2025-05-16 19:21:04,612 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999984 -0.13500011 0.3442952 ] -2025-05-16 19:21:04,614 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999939e+02 1.31662242e-10 -9.00001068e+01] -2025-05-16 19:21:04,616 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999983 -0.13500012 0.34433893] -2025-05-16 19:21:04,617 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 -4.79370381e-07 -1.57079926e+00] -2025-05-16 19:21:04,632 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999814 -0.13500175 0.34428118] -2025-05-16 19:21:04,637 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999939e+02 1.31662242e-10 -9.00001068e+01] -2025-05-16 19:21:04,641 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000002 -0.13499965 0.34433881] -2025-05-16 19:21:04,644 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159159e+00 4.79367142e-07 -1.57079726e+00] -2025-05-16 19:21:04,652 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999718 -0.13500245 0.3442707 ] -2025-05-16 19:21:04,654 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999939e+02 1.31662242e-10 -9.00001068e+01] -2025-05-16 19:21:04,655 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999983 -0.13500012 0.34433926] -2025-05-16 19:21:04,657 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 9.19042620e-13 -1.57079872e+00] -2025-05-16 19:21:04,683 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999703 -0.13500314 0.34426294] -2025-05-16 19:21:04,685 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999939e+02 1.31662242e-10 -9.00001068e+01] -2025-05-16 19:21:04,688 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000031 -0.13499965 0.34433957] -2025-05-16 19:21:04,690 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 4.79371745e-07 -1.57079819e+00] -2025-05-16 19:21:04,704 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999749 -0.13500247 0.34425739] -2025-05-16 19:21:04,705 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999939e+02 1.31662242e-10 -9.00001068e+01] -2025-05-16 19:21:04,713 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999948 -0.13500012 0.34433878] -2025-05-16 19:21:04,715 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159159e+00 -2.29771757e-12 -1.57079926e+00] -2025-05-16 19:21:04,724 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999693 -0.13500269 0.34425217] -2025-05-16 19:21:04,728 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999939e+02 1.31662242e-10 -9.00001068e+01] -2025-05-16 19:21:04,732 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000014 -0.13499976 0.34433929] -2025-05-16 19:21:04,735 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 2.29771757e-12 -1.57079779e+00] -2025-05-16 19:21:04,744 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999788 -0.13500202 0.34424935] -2025-05-16 19:21:04,751 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999939e+02 1.31662242e-10 -9.00001068e+01] -2025-05-16 19:21:04,754 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000023 -0.135 0.34433945] -2025-05-16 19:21:04,762 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 1.14841470e-12 -1.57079872e+00] -2025-05-16 19:21:04,766 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999829 -0.13500194 0.34424699] -2025-05-16 19:21:04,770 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999939e+02 1.31662242e-10 -9.00001068e+01] -2025-05-16 19:21:04,773 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999983 -0.13500035 0.3443396 ] -2025-05-16 19:21:04,778 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159132e+00 -4.79366253e-07 -1.57079926e+00] -2025-05-16 19:21:04,789 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999395 -0.13500123 0.34424531] -2025-05-16 19:21:04,791 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999939e+02 1.31662242e-10 -9.00001068e+01] -2025-05-16 19:21:04,801 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000018 -0.13499976 0.34433917] -2025-05-16 19:21:04,816 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 6.89226454e-13 -1.57079686e+00] -2025-05-16 19:21:04,820 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999421 -0.13500098 0.34424342] -2025-05-16 19:21:04,823 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999939e+02 1.31662242e-10 -9.00001068e+01] -2025-05-16 19:21:04,824 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000018 -0.135 0.34433942] -2025-05-16 19:21:04,828 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 2.75734990e-12 -1.57079926e+00] -2025-05-16 19:21:04,840 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999459 -0.13500113 0.34424234] -2025-05-16 19:21:04,845 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999939e+02 1.31662242e-10 -9.00001068e+01] -2025-05-16 19:21:04,847 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999992 -0.13500012 0.34433932] -2025-05-16 19:21:04,850 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 -9.19264664e-13 -1.57079872e+00] -2025-05-16 19:21:04,858 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999504 -0.13500082 0.34424111] -2025-05-16 19:21:04,861 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999939e+02 1.31662242e-10 -9.00001068e+01] -2025-05-16 19:21:04,865 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999989 -0.13500012 0.3443396 ] -2025-05-16 19:21:04,867 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159132e+00 2.75734990e-12 -1.57079872e+00] -2025-05-16 19:21:04,880 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999606 -0.13500078 0.34424141] -2025-05-16 19:21:04,882 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999939e+02 1.31662242e-10 -9.00001068e+01] -2025-05-16 19:21:04,885 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000006 -0.135 0.34433917] -2025-05-16 19:21:04,888 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 6.89226454e-13 -1.57079779e+00] -2025-05-16 19:21:04,899 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999681 -0.13500188 0.3442404 ] -2025-05-16 19:21:04,901 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999939e+02 1.31662242e-10 -9.00001068e+01] -2025-05-16 19:21:04,906 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000011 -0.13500012 0.34433923] -2025-05-16 19:21:04,907 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 -4.79368983e-07 -1.57079872e+00] -2025-05-16 19:21:04,919 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999748 -0.13500388 0.34424027] -2025-05-16 19:21:04,922 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999939e+02 1.31662242e-10 -9.00001068e+01] -2025-05-16 19:21:04,925 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999994 -0.13499988 0.34433914] -2025-05-16 19:21:04,929 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159265e+00 4.79368984e-07 -1.57079926e+00] -2025-05-16 19:21:04,938 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999797 -0.13500476 0.34424002] -2025-05-16 19:21:04,938 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999939e+02 1.31662242e-10 -9.00001068e+01] -2025-05-16 19:21:04,939 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999973 -0.13499977 0.34433929] -2025-05-16 19:21:04,940 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 4.79367396e-07 -1.57079926e+00] -2025-05-16 19:21:04,958 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999801 -0.13500444 0.34423989] -2025-05-16 19:21:04,960 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999939e+02 1.31662242e-10 -9.00001068e+01] -2025-05-16 19:21:04,966 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000015 -0.13500012 0.34433899] -2025-05-16 19:21:04,967 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159159e+00 -3.21698224e-12 -1.57080019e+00] -2025-05-16 19:21:04,982 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999854 -0.13500441 0.34423949] -2025-05-16 19:21:04,985 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999939e+02 1.31662242e-10 -9.00001068e+01] -2025-05-16 19:21:04,989 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999989 -0.13499988 0.34433942] -2025-05-16 19:21:04,990 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 4.79370381e-07 -1.57079926e+00] -2025-05-16 19:21:04,999 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999883 -0.13500397 0.34423939] -2025-05-16 19:21:05,000 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999939e+02 1.31662242e-10 -9.00001068e+01] -2025-05-16 19:21:05,001 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999966 -0.13500012 0.34433914] -2025-05-16 19:21:05,002 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 -4.79370158e-07 -1.57079872e+00] -2025-05-16 19:21:05,020 - 测试日志 - INFO - log.py:106 - MassageRobot启动 -2025-05-16 19:21:05,021 - 测试日志 - INFO - log.py:106 - 机械臂控制线程启动 -2025-05-16 19:21:05,047 - 测试日志 - ERROR - log.py:106 - 机械臂控制失败:The truth value of an array with more than one element is ambiguous. Use a.any() or a.all() -2025-05-16 19:21:19,050 - 测试日志 - INFO - log.py:106 - 切换到finger_head按摩头 -2025-05-16 19:21:22,574 - 测试日志 - INFO - log.py:106 - 机械臂测量线程启动 -2025-05-16 19:21:22,575 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999989 -0.13499977 0.34431408] -2025-05-16 19:21:22,584 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 2.74658341e-05 -8.99999466e+01] -2025-05-16 19:21:22,588 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000035 -0.13499977 0.34433945] -2025-05-16 19:21:22,591 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159132e+00 4.79368317e-07 -1.57079539e+00] -2025-05-16 19:21:22,593 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000011 -0.13499987 0.34429574] -2025-05-16 19:21:22,595 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 2.74658341e-05 -8.99999466e+01] -2025-05-16 19:21:22,597 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999992 -0.13500012 0.34433902] -2025-05-16 19:21:22,598 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 2.29816166e-13 -1.57079633e+00] -2025-05-16 19:21:22,615 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000017 -0.13499975 0.34428102] -2025-05-16 19:21:22,617 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 2.74658341e-05 -8.99999466e+01] -2025-05-16 19:21:22,618 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999954 -0.135 0.34433878] -2025-05-16 19:21:22,619 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159159e+00 1.37845291e-12 -1.57079486e+00] -2025-05-16 19:21:22,635 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000007 -0.13500011 0.3442706 ] -2025-05-16 19:21:22,636 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 2.74658341e-05 -8.99999466e+01] -2025-05-16 19:21:22,638 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000035 -0.135 0.34433984] -2025-05-16 19:21:22,640 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159079e+00 4.79368984e-07 -1.57079686e+00] -2025-05-16 19:21:22,656 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999976 -0.13499998 0.34426275] -2025-05-16 19:21:22,658 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 2.74658341e-05 -8.99999466e+01] -2025-05-16 19:21:22,660 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999988 -0.13500023 0.34433914] -2025-05-16 19:21:22,662 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159265e+00 -4.79368983e-07 -1.57079633e+00] -2025-05-16 19:21:22,676 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999972 -0.13499998 0.34425679] -2025-05-16 19:21:22,679 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 2.74658341e-05 -8.99999466e+01] -2025-05-16 19:21:22,686 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999977 -0.13500012 0.34433893] -2025-05-16 19:21:22,691 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 2.29816166e-13 -1.57079633e+00] -2025-05-16 19:21:22,700 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999977 -0.13500009 0.34425229] -2025-05-16 19:21:22,703 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 2.74658341e-05 -8.99999466e+01] -2025-05-16 19:21:22,708 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000012 -0.13499977 0.34433917] -2025-05-16 19:21:22,717 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 4.79368984e-07 -1.57079579e+00] -2025-05-16 19:21:22,720 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999962 -0.13499985 0.34424869] -2025-05-16 19:21:22,724 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 2.74658341e-05 -8.99999466e+01] -2025-05-16 19:21:22,729 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000006 -0.13499988 0.34433951] -2025-05-16 19:21:22,734 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 4.79368761e-07 -1.57079579e+00] -2025-05-16 19:21:22,739 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000006 -0.13499986 0.34424702] -2025-05-16 19:21:22,741 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 2.74658341e-05 -8.99999466e+01] -2025-05-16 19:21:22,746 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999974 -0.135 0.34433813] -2025-05-16 19:21:22,750 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14158972e+00 1.37867495e-12 -1.57079579e+00] -2025-05-16 19:21:22,759 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000001 -0.13499986 0.3442451 ] -2025-05-16 19:21:22,764 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 2.74658341e-05 -8.99999466e+01] -2025-05-16 19:21:22,768 - 测试日志 - INFO - log.py:106 - position current:[ 0.25 -0.13500012 0.34433917] -2025-05-16 19:21:22,770 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212 0. -1.57079686] -2025-05-16 19:21:22,782 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999994 -0.13499998 0.34424335] -2025-05-16 19:21:22,783 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 2.74658341e-05 -8.99999466e+01] -2025-05-16 19:21:22,784 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000005 -0.13500012 0.34433939] -2025-05-16 19:21:22,785 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159265 0. -1.57079633] -2025-05-16 19:21:22,804 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999994 -0.13500133 0.3442423 ] -2025-05-16 19:21:22,806 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 2.74658341e-05 -8.99999466e+01] -2025-05-16 19:21:22,807 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999977 -0.13499988 0.34433887] -2025-05-16 19:21:22,810 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159159e+00 4.59410288e-13 -1.57079539e+00] -2025-05-16 19:21:22,824 - 测试日志 - INFO - log.py:106 - position command: [ 0.2500002 -0.13500221 0.34424201] -2025-05-16 19:21:22,827 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 2.74658341e-05 -8.99999466e+01] -2025-05-16 19:21:22,832 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000031 -0.13499988 0.34433957] -2025-05-16 19:21:22,838 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159079e+00 -1.83852933e-12 -1.57079486e+00] -2025-05-16 19:21:22,845 - 测试日志 - INFO - log.py:106 - position command: [ 0.25 -0.13500207 0.3442409 ] -2025-05-16 19:21:22,848 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 2.74658341e-05 -8.99999466e+01] -2025-05-16 19:21:22,854 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999994 -0.13499988 0.34433914] -2025-05-16 19:21:22,857 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 4.79368983e-07 -1.57079539e+00] -2025-05-16 19:21:22,864 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999997 -0.13500194 0.34423975] -2025-05-16 19:21:22,866 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 2.74658341e-05 -8.99999466e+01] -2025-05-16 19:21:22,870 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000017 -0.135 0.34433896] -2025-05-16 19:21:22,872 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 4.58966198e-13 -1.57079539e+00] -2025-05-16 19:21:22,884 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000015 -0.135002 0.34423997] -2025-05-16 19:21:22,886 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 2.74658341e-05 -8.99999466e+01] -2025-05-16 19:21:22,890 - 测试日志 - INFO - log.py:106 - position current:[ 0.2500002 -0.13499965 0.34433951] -2025-05-16 19:21:22,892 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159132e+00 9.58735935e-07 -1.57079446e+00] -2025-05-16 19:21:22,905 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000017 -0.13500144 0.34424025] -2025-05-16 19:21:22,906 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 2.74658341e-05 -8.99999466e+01] -2025-05-16 19:21:22,909 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000014 -0.13499976 0.34433929] -2025-05-16 19:21:22,911 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 -9.19264664e-13 -1.57079446e+00] -2025-05-16 19:21:22,925 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000011 -0.1350013 0.34423984] -2025-05-16 19:21:22,933 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 2.74658341e-05 -8.99999466e+01] -2025-05-16 19:21:22,936 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000021 -0.13500012 0.34433932] -2025-05-16 19:21:22,940 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159265 0. -1.57079633] -2025-05-16 19:21:22,948 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000003 -0.13500118 0.34423958] -2025-05-16 19:21:22,951 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 2.74658341e-05 -8.99999466e+01] -2025-05-16 19:21:22,957 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999983 -0.135 0.34433926] -2025-05-16 19:21:22,961 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 4.79368539e-07 -1.57079579e+00] -2025-05-16 19:21:22,967 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000004 -0.13500096 0.34423948] -2025-05-16 19:21:22,973 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 2.74658341e-05 -8.99999466e+01] -2025-05-16 19:21:22,974 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999966 -0.135 0.34433932] -2025-05-16 19:21:22,976 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 4.79368984e-07 -1.57079686e+00] -2025-05-16 19:21:22,989 - 测试日志 - INFO - log.py:106 - MassageRobot启动 -2025-05-16 19:21:22,989 - 测试日志 - INFO - log.py:106 - 机械臂控制线程启动 -2025-05-16 19:21:23,014 - 测试日志 - ERROR - log.py:106 - 机械臂控制失败:The truth value of an array with more than one element is ambiguous. Use a.any() or a.all() -2025-05-16 19:21:38,969 - 测试日志 - INFO - log.py:106 - 切换到finger_head按摩头 -2025-05-16 19:21:42,488 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999983 -0.13500023 0.34431408] -2025-05-16 19:21:42,504 - 测试日志 - INFO - log.py:106 - 机械臂测量线程启动 -2025-05-16 19:21:42,505 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999969e+02 -2.74658196e-05 -9.00000305e+01] -2025-05-16 19:21:42,509 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000023 -0.13500012 0.34433945] -2025-05-16 19:21:42,511 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 -4.79369460e-07 -1.57079539e+00] -2025-05-16 19:21:42,515 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000016 -0.13499989 0.34429548] -2025-05-16 19:21:42,517 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999969e+02 -2.74658196e-05 -9.00000305e+01] -2025-05-16 19:21:42,518 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999973 -0.13499953 0.34433847] -2025-05-16 19:21:42,520 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159026e+00 4.79368984e-07 -1.57079486e+00] -2025-05-16 19:21:42,534 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999972 -0.13499478 0.34428068] -2025-05-16 19:21:42,534 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999969e+02 -2.74658196e-05 -9.00000305e+01] -2025-05-16 19:21:42,535 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000005 -0.13500012 0.34433939] -2025-05-16 19:21:42,536 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159265 0. -1.57079633] -2025-05-16 19:21:42,553 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999974 -0.13499147 0.34427106] -2025-05-16 19:21:42,554 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999969e+02 -2.74658196e-05 -9.00000305e+01] -2025-05-16 19:21:42,554 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000008 -0.135 0.34433948] -2025-05-16 19:21:42,555 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 -4.79369460e-07 -1.57079539e+00] -2025-05-16 19:21:42,574 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999973 -0.1349888 0.3442624 ] -2025-05-16 19:21:42,576 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999969e+02 -2.74658196e-05 -9.00000305e+01] -2025-05-16 19:21:42,581 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999965 -0.13500012 0.34433868] -2025-05-16 19:21:42,584 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159159e+00 4.59188243e-13 -1.57079633e+00] -2025-05-16 19:21:42,598 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999994 -0.13498816 0.34425695] -2025-05-16 19:21:42,599 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999969e+02 -2.74658196e-05 -9.00000305e+01] -2025-05-16 19:21:42,600 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999994 -0.13500012 0.34433896] -2025-05-16 19:21:42,602 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159265e+00 -4.79368983e-07 -1.57079579e+00] -2025-05-16 19:21:42,619 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000018 -0.13498878 0.34425317] -2025-05-16 19:21:42,621 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999969e+02 -2.74658196e-05 -9.00000305e+01] -2025-05-16 19:21:42,622 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000023 -0.13500023 0.34433911] -2025-05-16 19:21:42,623 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 -9.58738475e-07 -1.57079539e+00] -2025-05-16 19:21:42,639 - 测试日志 - INFO - log.py:106 - position command: [ 0.2500002 -0.13498855 0.34424911] -2025-05-16 19:21:42,639 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999969e+02 -2.74658196e-05 -9.00000305e+01] -2025-05-16 19:21:42,640 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999969 -0.13500012 0.34433875] -2025-05-16 19:21:42,642 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159132e+00 6.89226454e-13 -1.57079633e+00] -2025-05-16 19:21:42,659 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999968 -0.13498769 0.34424625] -2025-05-16 19:21:42,663 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999969e+02 -2.74658196e-05 -9.00000305e+01] -2025-05-16 19:21:42,665 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000014 -0.13499988 0.34433948] -2025-05-16 19:21:42,667 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 -4.79369460e-07 -1.57079486e+00] -2025-05-16 19:21:42,680 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000012 -0.13498654 0.3442451 ] -2025-05-16 19:21:42,682 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999969e+02 -2.74658196e-05 -9.00000305e+01] -2025-05-16 19:21:42,682 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999944 -0.13500012 0.34433887] -2025-05-16 19:21:42,683 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 2.29816166e-13 -1.57079633e+00] -2025-05-16 19:21:42,699 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999943 -0.13498582 0.34424309] -2025-05-16 19:21:42,700 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999969e+02 -2.74658196e-05 -9.00000305e+01] -2025-05-16 19:21:42,701 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999954 -0.13500011 0.34433844] -2025-05-16 19:21:42,702 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159079e+00 -9.58737078e-07 -1.57079539e+00] -2025-05-16 19:21:42,719 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000011 -0.13498468 0.34424284] -2025-05-16 19:21:42,720 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999969e+02 -2.74658196e-05 -9.00000305e+01] -2025-05-16 19:21:42,721 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999986 -0.13500024 0.34433902] -2025-05-16 19:21:42,723 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212 0. -1.57079726] -2025-05-16 19:21:42,739 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999985 -0.13498422 0.34424138] -2025-05-16 19:21:42,740 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999969e+02 -2.74658196e-05 -9.00000305e+01] -2025-05-16 19:21:42,741 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999983 -0.135 0.34433908] -2025-05-16 19:21:42,749 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 4.59854377e-13 -1.57079539e+00] -2025-05-16 19:21:42,760 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999983 -0.13498326 0.34424085] -2025-05-16 19:21:42,762 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999969e+02 -2.74658196e-05 -9.00000305e+01] -2025-05-16 19:21:42,764 - 测试日志 - INFO - log.py:106 - position current:[ 0.25 -0.135 0.34433902] -2025-05-16 19:21:42,765 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 2.29594121e-13 -1.57079579e+00] -2025-05-16 19:21:42,779 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000022 -0.13498265 0.3442412 ] -2025-05-16 19:21:42,780 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999969e+02 -2.74658196e-05 -9.00000305e+01] -2025-05-16 19:21:42,781 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000006 -0.13499988 0.34433917] -2025-05-16 19:21:42,782 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 6.89226454e-13 -1.57079446e+00] -2025-05-16 19:21:42,799 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999968 -0.13498226 0.34423941] -2025-05-16 19:21:42,801 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999969e+02 -2.74658196e-05 -9.00000305e+01] -2025-05-16 19:21:42,802 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999992 -0.13500035 0.34433917] -2025-05-16 19:21:42,803 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 -9.58737332e-07 -1.57079539e+00] -2025-05-16 19:21:42,820 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999977 -0.13498172 0.34423968] -2025-05-16 19:21:42,821 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999969e+02 -2.74658196e-05 -9.00000305e+01] -2025-05-16 19:21:42,822 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999962 -0.13500012 0.34433908] -2025-05-16 19:21:42,823 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159265e+00 -4.79368983e-07 -1.57079579e+00] -2025-05-16 19:21:42,839 - 测试日志 - INFO - log.py:106 - position command: [ 0.2499997 -0.13498183 0.3442395 ] -2025-05-16 19:21:42,840 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999969e+02 -2.74658196e-05 -9.00000305e+01] -2025-05-16 19:21:42,842 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000008 -0.135 0.34433948] -2025-05-16 19:21:42,844 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 -4.79369460e-07 -1.57079539e+00] -2025-05-16 19:21:42,867 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999995 -0.1349812 0.34424001] -2025-05-16 19:21:42,869 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999969e+02 -2.74658196e-05 -9.00000305e+01] -2025-05-16 19:21:42,872 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000002 -0.13500012 0.34433929] -2025-05-16 19:21:42,874 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 -4.79369904e-07 -1.57079539e+00] -2025-05-16 19:21:42,888 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000001 -0.13498094 0.34423959] -2025-05-16 19:21:42,890 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999969e+02 -2.74658196e-05 -9.00000305e+01] -2025-05-16 19:21:42,893 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000011 -0.13499988 0.3443389 ] -2025-05-16 19:21:42,895 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159159e+00 4.59410288e-13 -1.57079539e+00] -2025-05-16 19:21:42,907 - 测试日志 - INFO - log.py:106 - 机械臂控制线程启动 -2025-05-16 19:21:42,909 - 测试日志 - INFO - log.py:106 - MassageRobot启动 -2025-05-16 19:21:51,941 - 测试日志 - ERROR - log.py:106 - 传感器数据读取失败 -2025-05-16 19:21:51,953 - 测试日志 - ERROR - log.py:106 - 传感器线程数据读取失败-1 -2025-05-16 19:22:04,905 - 测试日志 - INFO - log.py:106 - 切换到finger_head按摩头 -2025-05-16 19:22:08,431 - 测试日志 - INFO - log.py:106 - 机械臂测量线程启动 -2025-05-16 19:22:08,432 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999944 -0.13499988 0.34431371] -2025-05-16 19:22:08,439 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999924e+02 2.74657814e-05 -9.00000305e+01] -2025-05-16 19:22:08,450 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999977 -0.135 0.34433902] -2025-05-16 19:22:08,453 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265 0. -1.57079633] -2025-05-16 19:22:08,457 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999976 -0.13500455 0.34429526] -2025-05-16 19:22:08,459 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999924e+02 2.74657814e-05 -9.00000305e+01] -2025-05-16 19:22:08,460 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000037 -0.13499965 0.34433957] -2025-05-16 19:22:08,461 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159079e+00 4.79369904e-07 -1.57079579e+00] -2025-05-16 19:22:08,474 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999985 -0.13500681 0.34428131] -2025-05-16 19:22:08,476 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999924e+02 2.74657814e-05 -9.00000305e+01] -2025-05-16 19:22:08,477 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999988 -0.13500012 0.34433914] -2025-05-16 19:22:08,478 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265 0. -1.57079726] -2025-05-16 19:22:08,495 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000007 -0.13500898 0.34427116] -2025-05-16 19:22:08,499 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999924e+02 2.74657814e-05 -9.00000305e+01] -2025-05-16 19:22:08,501 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999994 -0.135 0.34433896] -2025-05-16 19:22:08,504 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265 0. -1.57079686] -2025-05-16 19:22:08,515 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000011 -0.13501082 0.34426297] -2025-05-16 19:22:08,518 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999924e+02 2.74657814e-05 -9.00000305e+01] -2025-05-16 19:22:08,521 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000027 -0.13499988 0.34433899] -2025-05-16 19:22:08,523 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159159 0. -1.57079579] -2025-05-16 19:22:08,535 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999972 -0.13501099 0.34425629] -2025-05-16 19:22:08,540 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999924e+02 2.74657814e-05 -9.00000305e+01] -2025-05-16 19:22:08,542 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000032 -0.135 0.34433936] -2025-05-16 19:22:08,543 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 -4.59632332e-13 -1.57079726e+00] -2025-05-16 19:22:08,558 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999976 -0.13501188 0.34425212] -2025-05-16 19:22:08,560 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999924e+02 2.74657814e-05 -9.00000305e+01] -2025-05-16 19:22:08,561 - 测试日志 - INFO - log.py:106 - position current:[ 0.2499996 -0.135 0.34433847] -2025-05-16 19:22:08,562 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159132 0. -1.57079633] -2025-05-16 19:22:08,581 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999981 -0.13501172 0.34424867] -2025-05-16 19:22:08,582 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999924e+02 2.74657814e-05 -9.00000305e+01] -2025-05-16 19:22:08,584 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999989 -0.13499988 0.34433893] -2025-05-16 19:22:08,585 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212 0. -1.57079579] -2025-05-16 19:22:08,603 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999936 -0.13501196 0.34424582] -2025-05-16 19:22:08,606 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999924e+02 2.74657814e-05 -9.00000305e+01] -2025-05-16 19:22:08,607 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999995 -0.13499965 0.34433957] -2025-05-16 19:22:08,609 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 9.58737777e-07 -1.57079539e+00] -2025-05-16 19:22:08,625 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999985 -0.13501225 0.34424437] -2025-05-16 19:22:08,627 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999924e+02 2.74657814e-05 -9.00000305e+01] -2025-05-16 19:22:08,628 - 测试日志 - INFO - log.py:106 - position current:[ 0.25 -0.135 0.34433917] -2025-05-16 19:22:08,630 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212 0. -1.57079633] -2025-05-16 19:22:08,644 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999994 -0.13501351 0.34424338] -2025-05-16 19:22:08,646 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999924e+02 2.74657814e-05 -9.00000305e+01] -2025-05-16 19:22:08,647 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999953 -0.135 0.34433847] -2025-05-16 19:22:08,649 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159132e+00 4.79369682e-07 -1.57079633e+00] -2025-05-16 19:22:08,664 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000003 -0.1350149 0.34424275] -2025-05-16 19:22:08,666 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999924e+02 2.74657814e-05 -9.00000305e+01] -2025-05-16 19:22:08,668 - 测试日志 - INFO - log.py:106 - position current:[ 0.25 -0.13500024 0.34433969] -2025-05-16 19:22:08,670 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159132e+00 -6.89004409e-13 -1.57079686e+00] -2025-05-16 19:22:08,684 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999993 -0.13501537 0.344242 ] -2025-05-16 19:22:08,686 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999924e+02 2.74657814e-05 -9.00000305e+01] -2025-05-16 19:22:08,688 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999954 -0.135 0.34433878] -2025-05-16 19:22:08,689 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159159e+00 4.59188243e-13 -1.57079579e+00] -2025-05-16 19:22:08,704 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999987 -0.13501429 0.34424053] -2025-05-16 19:22:08,705 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999924e+02 2.74657814e-05 -9.00000305e+01] -2025-05-16 19:22:08,706 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999971 -0.135 0.34433887] -2025-05-16 19:22:08,708 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159159 0. -1.57079633] -2025-05-16 19:22:08,726 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999977 -0.13501494 0.34424036] -2025-05-16 19:22:08,729 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999924e+02 2.74657814e-05 -9.00000305e+01] -2025-05-16 19:22:08,730 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999995 -0.13499965 0.34433893] -2025-05-16 19:22:08,733 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 4.79368762e-07 -1.57079579e+00] -2025-05-16 19:22:08,745 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999973 -0.13501365 0.34424027] -2025-05-16 19:22:08,747 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999924e+02 2.74657814e-05 -9.00000305e+01] -2025-05-16 19:22:08,749 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000012 -0.13500012 0.34434003] -2025-05-16 19:22:08,750 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159026e+00 -1.14908083e-12 -1.57079633e+00] -2025-05-16 19:22:08,766 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999965 -0.13501355 0.34423924] -2025-05-16 19:22:08,768 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999924e+02 2.74657814e-05 -9.00000305e+01] -2025-05-16 19:22:08,770 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000012 -0.13499988 0.34433936] -2025-05-16 19:22:08,772 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 2.29816166e-13 -1.57079633e+00] -2025-05-16 19:22:08,787 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000001 -0.13501246 0.34423966] -2025-05-16 19:22:08,790 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999924e+02 2.74657814e-05 -9.00000305e+01] -2025-05-16 19:22:08,793 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000002 -0.13499988 0.34433929] -2025-05-16 19:22:08,800 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265 0. -1.57079486] -2025-05-16 19:22:08,810 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000017 -0.13501244 0.34423978] -2025-05-16 19:22:08,813 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999924e+02 2.74657814e-05 -9.00000305e+01] -2025-05-16 19:22:08,818 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999977 -0.135 0.34433926] -2025-05-16 19:22:08,827 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 9.58738221e-07 -1.57079779e+00] -2025-05-16 19:22:08,834 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999994 -0.13501302 0.34423972] -2025-05-16 19:22:08,837 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999924e+02 2.74657814e-05 -9.00000305e+01] -2025-05-16 19:22:08,841 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999988 -0.13500012 0.34433929] -2025-05-16 19:22:08,846 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265 0. -1.57079686] -2025-05-16 19:22:08,851 - 测试日志 - INFO - log.py:106 - 机械臂控制线程启动 -2025-05-16 19:22:08,852 - 测试日志 - INFO - log.py:106 - MassageRobot启动 -2025-05-16 19:22:32,287 - 测试日志 - INFO - log.py:106 - 切换到finger_head按摩头 -2025-05-16 19:22:35,805 - 测试日志 - INFO - log.py:106 - 机械臂测量线程启动 -2025-05-16 19:22:35,809 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000002 -0.135 0.34431414] -2025-05-16 19:22:35,838 - 测试日志 - INFO - log.py:106 - orientation command: [-1.80000000e+02 -2.74658196e-05 -8.99999695e+01] -2025-05-16 19:22:35,849 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999994 -0.13499988 0.34433896] -2025-05-16 19:22:35,851 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 4.79368983e-07 -1.57079633e+00] -2025-05-16 19:22:35,855 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999966 -0.13500012 0.34429495] -2025-05-16 19:22:35,857 - 测试日志 - INFO - log.py:106 - orientation command: [-1.80000000e+02 -2.74658196e-05 -8.99999695e+01] -2025-05-16 19:22:35,867 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999995 -0.135 0.34433942] -2025-05-16 19:22:35,869 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159132e+00 -6.89226454e-13 -1.57079579e+00] -2025-05-16 19:22:35,880 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999997 -0.13500188 0.34428161] -2025-05-16 19:22:35,886 - 测试日志 - INFO - log.py:106 - orientation command: [-1.80000000e+02 -2.74658196e-05 -8.99999695e+01] -2025-05-16 19:22:35,892 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999971 -0.13500012 0.34433902] -2025-05-16 19:22:35,893 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265 0. -1.57079686] -2025-05-16 19:22:35,897 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999986 -0.13500441 0.34427084] -2025-05-16 19:22:35,898 - 测试日志 - INFO - log.py:106 - orientation command: [-1.80000000e+02 -2.74658196e-05 -8.99999695e+01] -2025-05-16 19:22:35,901 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000006 -0.13499988 0.34433951] -2025-05-16 19:22:35,902 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 4.79369238e-07 -1.57079686e+00] -2025-05-16 19:22:35,916 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000007 -0.13500661 0.34426323] -2025-05-16 19:22:35,918 - 测试日志 - INFO - log.py:106 - orientation command: [-1.80000000e+02 -2.74658196e-05 -8.99999695e+01] -2025-05-16 19:22:35,944 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999966 -0.135 0.34433914] -2025-05-16 19:22:35,946 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212 0. -1.57079633] -2025-05-16 19:22:35,950 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999968 -0.13500899 0.34425693] -2025-05-16 19:22:35,952 - 测试日志 - INFO - log.py:106 - orientation command: [-1.80000000e+02 -2.74658196e-05 -8.99999695e+01] -2025-05-16 19:22:35,963 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999989 -0.135 0.34433942] -2025-05-16 19:22:35,968 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212 0. -1.57079633] -2025-05-16 19:22:35,987 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999991 -0.13501097 0.34425275] -2025-05-16 19:22:36,006 - 测试日志 - INFO - log.py:106 - orientation command: [-1.80000000e+02 -2.74658196e-05 -8.99999695e+01] -2025-05-16 19:22:36,008 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999983 -0.135 0.34433923] -2025-05-16 19:22:36,009 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212 0. -1.57079633] -2025-05-16 19:22:36,013 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999956 -0.13501142 0.34424849] -2025-05-16 19:22:36,030 - 测试日志 - INFO - log.py:106 - orientation command: [-1.80000000e+02 -2.74658196e-05 -8.99999695e+01] -2025-05-16 19:22:36,035 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999998 -0.13500012 0.34433905] -2025-05-16 19:22:36,040 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159159 0. -1.57079686] -2025-05-16 19:22:36,044 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999985 -0.13501022 0.34424681] -2025-05-16 19:22:36,046 - 测试日志 - INFO - log.py:106 - orientation command: [-1.80000000e+02 -2.74658196e-05 -8.99999695e+01] -2025-05-16 19:22:36,050 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999994 -0.135 0.34433896] -2025-05-16 19:22:36,052 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265 0. -1.57079633] -2025-05-16 19:22:36,064 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999996 -0.13500876 0.3442446 ] -2025-05-16 19:22:36,068 - 测试日志 - INFO - log.py:106 - orientation command: [-1.80000000e+02 -2.74658196e-05 -8.99999695e+01] -2025-05-16 19:22:36,072 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999989 -0.13499988 0.34433893] -2025-05-16 19:22:36,074 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212 0. -1.57079579] -2025-05-16 19:22:36,083 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999934 -0.13500767 0.34424278] -2025-05-16 19:22:36,085 - 测试日志 - INFO - log.py:106 - orientation command: [-1.80000000e+02 -2.74658196e-05 -8.99999695e+01] -2025-05-16 19:22:36,087 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000034 -0.13500023 0.34433923] -2025-05-16 19:22:36,089 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 -4.79369237e-07 -1.57079633e+00] -2025-05-16 19:22:36,104 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999994 -0.13500597 0.34424189] -2025-05-16 19:22:36,116 - 测试日志 - INFO - log.py:106 - orientation command: [-1.80000000e+02 -2.74658196e-05 -8.99999695e+01] -2025-05-16 19:22:36,118 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999989 -0.135 0.34433875] -2025-05-16 19:22:36,119 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 -4.79368984e-07 -1.57079579e+00] -2025-05-16 19:22:36,130 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999992 -0.13500512 0.34424116] -2025-05-16 19:22:36,133 - 测试日志 - INFO - log.py:106 - orientation command: [-1.80000000e+02 -2.74658196e-05 -8.99999695e+01] -2025-05-16 19:22:36,136 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999977 -0.13499988 0.34433887] -2025-05-16 19:22:36,142 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 4.79368983e-07 -1.57079579e+00] -2025-05-16 19:22:36,152 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999991 -0.13500418 0.34424097] -2025-05-16 19:22:36,161 - 测试日志 - INFO - log.py:106 - orientation command: [-1.80000000e+02 -2.74658196e-05 -8.99999695e+01] -2025-05-16 19:22:36,186 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999988 -0.13500023 0.34433896] -2025-05-16 19:22:36,199 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 -4.79368983e-07 -1.57079726e+00] -2025-05-16 19:22:36,200 - 测试日志 - INFO - log.py:106 - position command: [ 0.2499999 -0.1350042 0.34424034] -2025-05-16 19:22:36,201 - 测试日志 - INFO - log.py:106 - orientation command: [-1.80000000e+02 -2.74658196e-05 -8.99999695e+01] -2025-05-16 19:22:36,204 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999994 -0.13500012 0.34433914] -2025-05-16 19:22:36,207 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 -4.79368983e-07 -1.57079633e+00] -2025-05-16 19:22:36,222 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999996 -0.13500372 0.34424017] -2025-05-16 19:22:36,224 - 测试日志 - INFO - log.py:106 - orientation command: [-1.80000000e+02 -2.74658196e-05 -8.99999695e+01] -2025-05-16 19:22:36,226 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999994 -0.13500012 0.34433914] -2025-05-16 19:22:36,227 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 -4.79368983e-07 -1.57079633e+00] -2025-05-16 19:22:36,242 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000013 -0.13500438 0.3442398 ] -2025-05-16 19:22:36,245 - 测试日志 - INFO - log.py:106 - orientation command: [-1.80000000e+02 -2.74658196e-05 -8.99999695e+01] -2025-05-16 19:22:36,247 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000012 -0.13499988 0.34433902] -2025-05-16 19:22:36,249 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 2.29816166e-13 -1.57079633e+00] -2025-05-16 19:22:36,266 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999995 -0.13500605 0.34423973] -2025-05-16 19:22:36,268 - 测试日志 - INFO - log.py:106 - orientation command: [-1.80000000e+02 -2.74658196e-05 -8.99999695e+01] -2025-05-16 19:22:36,271 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999994 -0.135 0.34433914] -2025-05-16 19:22:36,273 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265 0. -1.57079686] -2025-05-16 19:22:36,286 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999995 -0.13500783 0.34423958] -2025-05-16 19:22:36,288 - 测试日志 - INFO - log.py:106 - orientation command: [-1.80000000e+02 -2.74658196e-05 -8.99999695e+01] -2025-05-16 19:22:36,292 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000006 -0.135 0.34433868] -2025-05-16 19:22:36,294 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 -4.79368984e-07 -1.57079579e+00] -2025-05-16 19:22:36,306 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000001 -0.13500828 0.34423903] -2025-05-16 19:22:36,310 - 测试日志 - INFO - log.py:106 - orientation command: [-1.80000000e+02 -2.74658196e-05 -8.99999695e+01] -2025-05-16 19:22:36,312 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999973 -0.13500012 0.34433932] -2025-05-16 19:22:36,314 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 -4.79368761e-07 -1.57079686e+00] -2025-05-16 19:22:36,327 - 测试日志 - INFO - log.py:106 - MassageRobot启动 -2025-05-16 19:22:36,328 - 测试日志 - INFO - log.py:106 - 机械臂控制线程启动 -2025-05-16 19:22:38,210 - 测试日志 - ERROR - log.py:106 - 传感器数据读取失败 -2025-05-16 19:22:38,212 - 测试日志 - ERROR - log.py:106 - 传感器线程数据读取失败-1 -2025-05-16 19:23:51,474 - 测试日志 - INFO - log.py:106 - 切换到finger_head按摩头 -2025-05-16 19:23:54,997 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999959 -0.13499976 0.34431298] -2025-05-16 19:23:55,001 - 测试日志 - INFO - log.py:106 - 机械臂测量线程启动 -2025-05-16 19:23:55,006 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999802e+02 -9.21597525e-11 -8.99999695e+01] -2025-05-16 19:23:55,013 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999973 -0.13499988 0.34433881] -2025-05-16 19:23:55,015 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 4.44089210e-16 -1.57079579e+00] -2025-05-16 19:23:55,018 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999993 -0.13500021 0.3442955 ] -2025-05-16 19:23:55,022 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999802e+02 -9.21597525e-11 -8.99999695e+01] -2025-05-16 19:23:55,024 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999994 -0.13500012 0.34433929] -2025-05-16 19:23:55,025 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159 0. -1.57079686] -2025-05-16 19:23:55,039 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000004 -0.1349981 0.34428146] -2025-05-16 19:23:55,041 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999802e+02 -9.21597525e-11 -8.99999695e+01] -2025-05-16 19:23:55,043 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000006 -0.135 0.34433936] -2025-05-16 19:23:55,046 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212 0. -1.57079633] -2025-05-16 19:23:55,063 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999975 -0.13499741 0.3442703 ] -2025-05-16 19:23:55,064 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999802e+02 -9.21597525e-11 -8.99999695e+01] -2025-05-16 19:23:55,066 - 测试日志 - INFO - log.py:106 - position current:[ 0.25 -0.13500012 0.34433951] -2025-05-16 19:23:55,068 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212 0. -1.57079686] -2025-05-16 19:23:55,084 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999947 -0.13499558 0.34426256] -2025-05-16 19:23:55,092 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999802e+02 -9.21597525e-11 -8.99999695e+01] -2025-05-16 19:23:55,093 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000024 -0.13499988 0.34433957] -2025-05-16 19:23:55,099 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159 0. -1.57079579] -2025-05-16 19:23:55,114 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000021 -0.13499485 0.34425724] -2025-05-16 19:23:55,116 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999802e+02 -9.21597525e-11 -8.99999695e+01] -2025-05-16 19:23:55,116 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000005 -0.135 0.34433905] -2025-05-16 19:23:55,117 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159159e+00 -4.59632332e-13 -1.57079686e+00] -2025-05-16 19:23:55,131 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999972 -0.13499464 0.34425197] -2025-05-16 19:23:55,132 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999802e+02 -9.21597525e-11 -8.99999695e+01] -2025-05-16 19:23:55,134 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000018 -0.135 0.34433942] -2025-05-16 19:23:55,138 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 -4.59632332e-13 -1.57079579e+00] -2025-05-16 19:23:55,148 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000008 -0.13499441 0.3442489 ] -2025-05-16 19:23:55,149 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999802e+02 -9.21597525e-11 -8.99999695e+01] -2025-05-16 19:23:55,151 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000006 -0.135 0.34433917] -2025-05-16 19:23:55,153 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 2.29594121e-13 -1.57079686e+00] -2025-05-16 19:23:55,166 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999989 -0.13499372 0.34424666] -2025-05-16 19:23:55,168 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999802e+02 -9.21597525e-11 -8.99999695e+01] -2025-05-16 19:23:55,175 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000008 -0.13500012 0.34433981] -2025-05-16 19:23:55,176 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159079e+00 -4.79367142e-07 -1.57079726e+00] -2025-05-16 19:23:55,186 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999945 -0.13499227 0.34424377] -2025-05-16 19:23:55,188 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999802e+02 -9.21597525e-11 -8.99999695e+01] -2025-05-16 19:23:55,193 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000024 -0.135 0.34433975] -2025-05-16 19:23:55,194 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159079e+00 9.19264664e-13 -1.57079686e+00] -2025-05-16 19:23:55,210 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000026 -0.13499053 0.34424383] -2025-05-16 19:23:55,212 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999802e+02 -9.21597525e-11 -8.99999695e+01] -2025-05-16 19:23:55,215 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000005 -0.135 0.34433923] -2025-05-16 19:23:55,216 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159265e+00 4.79368983e-07 -1.57079779e+00] -2025-05-16 19:23:55,226 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000013 -0.13499051 0.34424257] -2025-05-16 19:23:55,227 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999802e+02 -9.21597525e-11 -8.99999695e+01] -2025-05-16 19:23:55,230 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000018 -0.13500012 0.34433957] -2025-05-16 19:23:55,234 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 -4.79368984e-07 -1.57079633e+00] -2025-05-16 19:23:55,247 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999987 -0.13499078 0.34424073] -2025-05-16 19:23:55,249 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999802e+02 -9.21597525e-11 -8.99999695e+01] -2025-05-16 19:23:55,256 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999983 -0.13499988 0.34433859] -2025-05-16 19:23:55,257 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159132e+00 6.89226454e-13 -1.57079539e+00] -2025-05-16 19:23:55,267 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000012 -0.13499167 0.34424119] -2025-05-16 19:23:55,272 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999802e+02 -9.21597525e-11 -8.99999695e+01] -2025-05-16 19:23:55,276 - 测试日志 - INFO - log.py:106 - position current:[ 0.2499996 -0.13499988 0.34433847] -2025-05-16 19:23:55,280 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159132e+00 4.79368984e-07 -1.57079633e+00] -2025-05-16 19:23:55,291 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999988 -0.13499249 0.34423999] -2025-05-16 19:23:55,294 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999802e+02 -9.21597525e-11 -8.99999695e+01] -2025-05-16 19:23:55,298 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999969 -0.13500012 0.34433859] -2025-05-16 19:23:55,301 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159132e+00 -6.89004409e-13 -1.57079726e+00] -2025-05-16 19:23:55,312 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999985 -0.13499232 0.34424005] -2025-05-16 19:23:55,314 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999802e+02 -9.21597525e-11 -8.99999695e+01] -2025-05-16 19:23:55,315 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999991 -0.13499977 0.3443392 ] -2025-05-16 19:23:55,317 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 4.79369904e-07 -1.57079686e+00] -2025-05-16 19:23:55,336 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999986 -0.13499172 0.34423979] -2025-05-16 19:23:55,339 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999802e+02 -9.21597525e-11 -8.99999695e+01] -2025-05-16 19:23:55,362 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999982 -0.13500024 0.34433929] -2025-05-16 19:23:55,364 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265 0. -1.57079686] -2025-05-16 19:23:55,366 - 测试日志 - INFO - log.py:106 - position command: [ 0.2500002 -0.13499069 0.3442404 ] -2025-05-16 19:23:55,368 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999802e+02 -9.21597525e-11 -8.99999695e+01] -2025-05-16 19:23:55,370 - 测试日志 - INFO - log.py:106 - position current:[ 0.2499998 -0.13500024 0.34433884] -2025-05-16 19:23:55,374 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159132 0. -1.57079726] -2025-05-16 19:23:55,389 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999961 -0.13498945 0.34423923] -2025-05-16 19:23:55,391 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999802e+02 -9.21597525e-11 -8.99999695e+01] -2025-05-16 19:23:55,394 - 测试日志 - INFO - log.py:106 - position current:[ 0.25 -0.135 0.34433902] -2025-05-16 19:23:55,396 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 -2.29372077e-13 -1.57079686e+00] -2025-05-16 19:23:55,408 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999989 -0.13498818 0.34423928] -2025-05-16 19:23:55,411 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999802e+02 -9.21597525e-11 -8.99999695e+01] -2025-05-16 19:23:55,415 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000018 -0.135 0.34433908] -2025-05-16 19:23:55,418 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159 0. -1.57079633] -2025-05-16 19:23:55,428 - 测试日志 - INFO - log.py:106 - MassageRobot启动 -2025-05-16 19:23:55,429 - 测试日志 - INFO - log.py:106 - 机械臂控制线程启动 -2025-05-16 19:24:08,417 - 测试日志 - INFO - log.py:106 - 切换到finger_head按摩头 -2025-05-16 19:24:11,927 - 测试日志 - INFO - log.py:106 - position command: [ 0.2499996 -0.13500023 0.34431399] -2025-05-16 19:24:11,927 - 测试日志 - INFO - log.py:106 - 机械臂测量线程启动 -2025-05-16 19:24:11,928 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 -2.74658596e-05 -9.00001068e+01] -2025-05-16 19:24:11,932 - 测试日志 - INFO - log.py:106 - position current:[ 0.2499998 -0.13500012 0.34433835] -2025-05-16 19:24:11,934 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159026e+00 -2.29793962e-12 -1.57079779e+00] -2025-05-16 19:24:11,936 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999979 -0.13500264 0.34429462] -2025-05-16 19:24:11,938 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 -2.74658596e-05 -9.00001068e+01] -2025-05-16 19:24:11,939 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999969 -0.13500035 0.34433908] -2025-05-16 19:24:11,940 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 -4.79369682e-07 -1.57079872e+00] -2025-05-16 19:24:11,956 - 测试日志 - INFO - log.py:106 - position command: [ 0.2500003 -0.13500346 0.34428169] -2025-05-16 19:24:11,958 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 -2.74658596e-05 -9.00001068e+01] -2025-05-16 19:24:11,961 - 测试日志 - INFO - log.py:106 - position current:[ 0.2499996 -0.135 0.34433865] -2025-05-16 19:24:11,963 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159132e+00 -2.06790141e-12 -1.57079779e+00] -2025-05-16 19:24:11,978 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999973 -0.13500401 0.34427045] -2025-05-16 19:24:11,979 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 -2.74658596e-05 -9.00001068e+01] -2025-05-16 19:24:11,981 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999983 -0.135 0.34433908] -2025-05-16 19:24:11,982 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 -4.59632332e-13 -1.57079726e+00] -2025-05-16 19:24:11,996 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999967 -0.13500383 0.34426296] -2025-05-16 19:24:11,998 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 -2.74658596e-05 -9.00001068e+01] -2025-05-16 19:24:11,999 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999971 -0.135 0.34433902] -2025-05-16 19:24:12,000 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159159e+00 -4.59632332e-13 -1.57079686e+00] -2025-05-16 19:24:12,017 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000013 -0.13500282 0.34425702] -2025-05-16 19:24:12,020 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 -2.74658596e-05 -9.00001068e+01] -2025-05-16 19:24:12,026 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000011 -0.13500012 0.34433972] -2025-05-16 19:24:12,029 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 1.37823086e-12 -1.57079819e+00] -2025-05-16 19:24:12,038 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999974 -0.13500265 0.34425221] -2025-05-16 19:24:12,040 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 -2.74658596e-05 -9.00001068e+01] -2025-05-16 19:24:12,043 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000018 -0.13499988 0.34433957] -2025-05-16 19:24:12,046 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 4.79370381e-07 -1.57079779e+00] -2025-05-16 19:24:12,064 - 测试日志 - INFO - log.py:106 - position command: [ 0.2499999 -0.13500237 0.34424914] -2025-05-16 19:24:12,067 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 -2.74658596e-05 -9.00001068e+01] -2025-05-16 19:24:12,095 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999983 -0.135 0.34433893] -2025-05-16 19:24:12,096 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 -4.59632332e-13 -1.57079726e+00] -2025-05-16 19:24:12,101 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000006 -0.13500177 0.3442464 ] -2025-05-16 19:24:12,103 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 -2.74658596e-05 -9.00001068e+01] -2025-05-16 19:24:12,108 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999994 -0.13500012 0.34433945] -2025-05-16 19:24:12,113 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 -4.79368983e-07 -1.57079726e+00] -2025-05-16 19:24:12,127 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999989 -0.13500177 0.34424506] -2025-05-16 19:24:12,134 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 -2.74658596e-05 -9.00001068e+01] -2025-05-16 19:24:12,136 - 测试日志 - INFO - log.py:106 - position current:[ 0.25 -0.135 0.34433917] -2025-05-16 19:24:12,140 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 -4.59632332e-13 -1.57079726e+00] -2025-05-16 19:24:12,156 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999996 -0.13500271 0.34424338] -2025-05-16 19:24:12,159 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 -2.74658596e-05 -9.00001068e+01] -2025-05-16 19:24:12,160 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999976 -0.135 0.34433875] -2025-05-16 19:24:12,162 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159132e+00 -1.37867495e-12 -1.57079726e+00] -2025-05-16 19:24:12,164 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999995 -0.13500311 0.34424232] -2025-05-16 19:24:12,166 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 -2.74658596e-05 -9.00001068e+01] -2025-05-16 19:24:12,167 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999995 -0.13499988 0.34433942] -2025-05-16 19:24:12,169 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 2.29816166e-13 -1.57079633e+00] -2025-05-16 19:24:12,185 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999991 -0.13500435 0.34424176] -2025-05-16 19:24:12,187 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 -2.74658596e-05 -9.00001068e+01] -2025-05-16 19:24:12,189 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999995 -0.13499988 0.34433942] -2025-05-16 19:24:12,195 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 2.29816166e-13 -1.57079633e+00] -2025-05-16 19:24:12,215 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999979 -0.13500514 0.34424116] -2025-05-16 19:24:12,225 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 -2.74658596e-05 -9.00001068e+01] -2025-05-16 19:24:12,232 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999976 -0.13500012 0.34433875] -2025-05-16 19:24:12,245 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159132e+00 -4.79370381e-07 -1.57079726e+00] -2025-05-16 19:24:12,251 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999979 -0.13500463 0.34424056] -2025-05-16 19:24:12,253 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 -2.74658596e-05 -9.00001068e+01] -2025-05-16 19:24:12,274 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000011 -0.13500012 0.34433908] -2025-05-16 19:24:12,276 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 -4.79368983e-07 -1.57079686e+00] -2025-05-16 19:24:12,278 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000006 -0.13500547 0.34424005] -2025-05-16 19:24:12,280 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 -2.74658596e-05 -9.00001068e+01] -2025-05-16 19:24:12,283 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999977 -0.135 0.34433902] -2025-05-16 19:24:12,285 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265 0. -1.57079726] -2025-05-16 19:24:12,300 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000001 -0.13500679 0.34424007] -2025-05-16 19:24:12,304 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 -2.74658596e-05 -9.00001068e+01] -2025-05-16 19:24:12,314 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000029 -0.135 0.34433963] -2025-05-16 19:24:12,315 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159132 0. -1.57079633] -2025-05-16 19:24:12,326 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000023 -0.13500713 0.34424014] -2025-05-16 19:24:12,327 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 -2.74658596e-05 -9.00001068e+01] -2025-05-16 19:24:12,327 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999969 -0.13500012 0.34433859] -2025-05-16 19:24:12,328 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159132e+00 -6.89004409e-13 -1.57079726e+00] -2025-05-16 19:24:12,343 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000004 -0.13500632 0.34423976] -2025-05-16 19:24:12,345 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 -2.74658596e-05 -9.00001068e+01] -2025-05-16 19:24:12,349 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999989 -0.135 0.34433942] -2025-05-16 19:24:12,350 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 4.59854377e-13 -1.57079726e+00] -2025-05-16 19:24:12,363 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999989 -0.13500558 0.34423921] -2025-05-16 19:24:12,365 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 -2.74658596e-05 -9.00001068e+01] -2025-05-16 19:24:12,366 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999971 -0.135 0.34433887] -2025-05-16 19:24:12,370 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159159e+00 -9.19264664e-13 -1.57079726e+00] -2025-05-16 19:24:12,384 - 测试日志 - INFO - log.py:106 - MassageRobot启动 -2025-05-16 19:24:12,387 - 测试日志 - INFO - log.py:106 - 机械臂控制线程启动 -2025-05-16 19:24:27,225 - 测试日志 - INFO - log.py:106 - 切换到finger_head按摩头 -2025-05-16 19:24:30,740 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999977 -0.13500023 0.34431393] -2025-05-16 19:24:30,742 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 -2.74658469e-05 -9.00000839e+01] -2025-05-16 19:24:30,743 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999965 -0.13500012 0.34433853] -2025-05-16 19:24:30,744 - 测试日志 - INFO - log.py:106 - 机械臂测量线程启动 -2025-05-16 19:24:30,745 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159079e+00 -4.79370825e-07 -1.57079726e+00] -2025-05-16 19:24:30,749 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000007 -0.13500001 0.34429553] -2025-05-16 19:24:30,752 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 -2.74658469e-05 -9.00000839e+01] -2025-05-16 19:24:30,754 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999971 -0.13500023 0.34433902] -2025-05-16 19:24:30,756 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 -4.79368983e-07 -1.57079726e+00] -2025-05-16 19:24:30,767 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000006 -0.13500001 0.34428146] -2025-05-16 19:24:30,771 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 -2.74658469e-05 -9.00000839e+01] -2025-05-16 19:24:30,774 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000012 -0.135 0.34433902] -2025-05-16 19:24:30,778 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 -4.79368983e-07 -1.57079579e+00] -2025-05-16 19:24:30,790 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999974 -0.13500002 0.34427052] -2025-05-16 19:24:30,795 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 -2.74658469e-05 -9.00000839e+01] -2025-05-16 19:24:30,797 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000043 -0.13499965 0.34433978] -2025-05-16 19:24:30,800 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159132e+00 4.79368317e-07 -1.57079486e+00] -2025-05-16 19:24:30,812 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000017 -0.13500002 0.34426321] -2025-05-16 19:24:30,813 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 -2.74658469e-05 -9.00000839e+01] -2025-05-16 19:24:30,815 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999988 -0.13500012 0.34433862] -2025-05-16 19:24:30,818 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159159e+00 -4.79369460e-07 -1.57079686e+00] -2025-05-16 19:24:30,831 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999986 -0.13500163 0.34425641] -2025-05-16 19:24:30,833 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 -2.74658469e-05 -9.00000839e+01] -2025-05-16 19:24:30,834 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999977 -0.135 0.34433908] -2025-05-16 19:24:30,848 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 4.79368984e-07 -1.57079686e+00] -2025-05-16 19:24:30,851 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999975 -0.1350022 0.34425241] -2025-05-16 19:24:30,853 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 -2.74658469e-05 -9.00000839e+01] -2025-05-16 19:24:30,856 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999994 -0.135 0.34433896] -2025-05-16 19:24:30,857 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265 0. -1.57079686] -2025-05-16 19:24:30,872 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000019 -0.13500276 0.34424949] -2025-05-16 19:24:30,873 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 -2.74658469e-05 -9.00000839e+01] -2025-05-16 19:24:30,876 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999983 -0.13500024 0.3443396 ] -2025-05-16 19:24:30,880 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159132e+00 -6.89004409e-13 -1.57079686e+00] -2025-05-16 19:24:30,891 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999997 -0.13500249 0.3442465 ] -2025-05-16 19:24:30,893 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 -2.74658469e-05 -9.00000839e+01] -2025-05-16 19:24:30,896 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000017 -0.135 0.34433939] -2025-05-16 19:24:30,902 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159265e+00 -4.79368983e-07 -1.57079539e+00] -2025-05-16 19:24:30,912 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999957 -0.13500219 0.34424366] -2025-05-16 19:24:30,919 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 -2.74658469e-05 -9.00000839e+01] -2025-05-16 19:24:30,925 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999989 -0.13499988 0.34433908] -2025-05-16 19:24:30,929 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 4.59632332e-13 -1.57079486e+00] -2025-05-16 19:24:30,937 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999968 -0.13500195 0.34424309] -2025-05-16 19:24:30,944 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 -2.74658469e-05 -9.00000839e+01] -2025-05-16 19:24:30,947 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999988 -0.13500012 0.34433914] -2025-05-16 19:24:30,950 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265 0. -1.57079633] -2025-05-16 19:24:30,960 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999969 -0.13500169 0.34424204] -2025-05-16 19:24:30,961 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 -2.74658469e-05 -9.00000839e+01] -2025-05-16 19:24:30,963 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999994 -0.13499988 0.34433881] -2025-05-16 19:24:30,964 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159159 0. -1.57079579] -2025-05-16 19:24:30,974 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999976 -0.13500131 0.34424107] -2025-05-16 19:24:30,976 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 -2.74658469e-05 -9.00000839e+01] -2025-05-16 19:24:30,977 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000002 -0.13499988 0.34433896] -2025-05-16 19:24:30,979 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159159e+00 -4.79368983e-07 -1.57079539e+00] -2025-05-16 19:24:30,996 - 测试日志 - INFO - log.py:106 - position command: [ 0.25 -0.13500108 0.34424075] -2025-05-16 19:24:30,998 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 -2.74658469e-05 -9.00000839e+01] -2025-05-16 19:24:31,001 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999969 -0.135 0.34433859] -2025-05-16 19:24:31,007 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159132e+00 4.79369682e-07 -1.57079633e+00] -2025-05-16 19:24:31,015 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999964 -0.13500122 0.34424021] -2025-05-16 19:24:31,017 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 -2.74658469e-05 -9.00000839e+01] -2025-05-16 19:24:31,019 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999991 -0.13499976 0.34433902] -2025-05-16 19:24:31,021 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265 0. -1.57079539] -2025-05-16 19:24:31,034 - 测试日志 - INFO - log.py:106 - position command: [ 0.2499999 -0.13500057 0.34424002] -2025-05-16 19:24:31,037 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 -2.74658469e-05 -9.00000839e+01] -2025-05-16 19:24:31,043 - 测试日志 - INFO - log.py:106 - position current:[ 0.25 -0.13500012 0.34433951] -2025-05-16 19:24:31,046 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 -2.29816166e-13 -1.57079633e+00] -2025-05-16 19:24:31,054 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999998 -0.13500078 0.34424024] -2025-05-16 19:24:31,056 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 -2.74658469e-05 -9.00000839e+01] -2025-05-16 19:24:31,062 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999994 -0.13500012 0.34433929] -2025-05-16 19:24:31,065 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 -4.79368983e-07 -1.57079686e+00] -2025-05-16 19:24:31,075 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999992 -0.13500065 0.34423983] -2025-05-16 19:24:31,076 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 -2.74658469e-05 -9.00000839e+01] -2025-05-16 19:24:31,078 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999977 -0.13500035 0.34433908] -2025-05-16 19:24:31,080 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 -9.58738221e-07 -1.57079726e+00] -2025-05-16 19:24:31,095 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999976 -0.13500077 0.34423948] -2025-05-16 19:24:31,098 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 -2.74658469e-05 -9.00000839e+01] -2025-05-16 19:24:31,103 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000024 -0.135 0.34433942] -2025-05-16 19:24:31,105 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 -4.79369904e-07 -1.57079486e+00] -2025-05-16 19:24:31,117 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000022 -0.13500034 0.3442397 ] -2025-05-16 19:24:31,120 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 -2.74658469e-05 -9.00000839e+01] -2025-05-16 19:24:31,123 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000029 -0.13499988 0.34433929] -2025-05-16 19:24:31,124 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 2.29816166e-13 -1.57079633e+00] -2025-05-16 19:24:31,135 - 测试日志 - INFO - log.py:106 - MassageRobot启动 -2025-05-16 19:24:31,143 - 测试日志 - INFO - log.py:106 - 机械臂控制线程启动 -2025-05-16 19:25:02,339 - 测试日志 - INFO - log.py:106 - 切换到finger_head按摩头 -2025-05-16 19:25:05,868 - 测试日志 - INFO - log.py:106 - 机械臂测量线程启动 -2025-05-16 19:25:05,882 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999969 -0.135 0.34431359] -2025-05-16 19:25:05,904 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999924e+02 2.74657814e-05 -9.00000534e+01] -2025-05-16 19:25:05,947 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000021 -0.13500012 0.34433932] -2025-05-16 19:25:05,948 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159265 0. -1.57079686] -2025-05-16 19:25:05,956 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000017 -0.135 0.34429564] -2025-05-16 19:25:05,958 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999924e+02 2.74657814e-05 -9.00000534e+01] -2025-05-16 19:25:05,962 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999995 -0.13499988 0.34433926] -2025-05-16 19:25:05,964 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 2.29150032e-13 -1.57079633e+00] -2025-05-16 19:25:05,978 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999979 -0.13499978 0.34428194] -2025-05-16 19:25:05,995 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999924e+02 2.74657814e-05 -9.00000534e+01] -2025-05-16 19:25:06,005 - 测试日志 - INFO - log.py:106 - position current:[ 0.25 -0.135 0.34433884] -2025-05-16 19:25:06,008 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212 0. -1.57079633] -2025-05-16 19:25:06,011 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999998 -0.13500001 0.34427042] -2025-05-16 19:25:06,012 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999924e+02 2.74657814e-05 -9.00000534e+01] -2025-05-16 19:25:06,014 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999983 -0.135 0.34433893] -2025-05-16 19:25:06,015 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 2.29594121e-13 -1.57079579e+00] -2025-05-16 19:25:06,030 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999981 -0.135 0.3442626 ] -2025-05-16 19:25:06,032 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999924e+02 2.74657814e-05 -9.00000534e+01] -2025-05-16 19:25:06,034 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999989 -0.13500012 0.34433926] -2025-05-16 19:25:06,035 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 -4.79369237e-07 -1.57079579e+00] -2025-05-16 19:25:06,050 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999947 -0.13500012 0.34425653] -2025-05-16 19:25:06,051 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999924e+02 2.74657814e-05 -9.00000534e+01] -2025-05-16 19:25:06,057 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999985 -0.135 0.34433954] -2025-05-16 19:25:06,062 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 -4.59632332e-13 -1.57079579e+00] -2025-05-16 19:25:06,099 - 测试日志 - INFO - log.py:106 - position command: [ 0.2500005 -0.13499965 0.34425268] -2025-05-16 19:25:06,105 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999924e+02 2.74657814e-05 -9.00000534e+01] -2025-05-16 19:25:06,108 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999988 -0.13500012 0.34433881] -2025-05-16 19:25:06,113 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159159e+00 -4.79369904e-07 -1.57079726e+00] -2025-05-16 19:25:06,116 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999986 -0.13500012 0.34424877] -2025-05-16 19:25:06,129 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999924e+02 2.74657814e-05 -9.00000534e+01] -2025-05-16 19:25:06,131 - 测试日志 - INFO - log.py:106 - position current:[ 0.2499996 -0.13500012 0.34433881] -2025-05-16 19:25:06,137 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159132e+00 -4.79369682e-07 -1.57079686e+00] -2025-05-16 19:25:06,145 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999987 -0.13499966 0.34424701] -2025-05-16 19:25:06,148 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999924e+02 2.74657814e-05 -9.00000534e+01] -2025-05-16 19:25:06,151 - 测试日志 - INFO - log.py:106 - position current:[ 0.25 -0.13499989 0.34433951] -2025-05-16 19:25:06,159 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 9.58737777e-07 -1.57079633e+00] -2025-05-16 19:25:06,163 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999997 -0.1349999 0.34424505] -2025-05-16 19:25:06,166 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999924e+02 2.74657814e-05 -9.00000534e+01] -2025-05-16 19:25:06,170 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000027 -0.13500012 0.34433951] -2025-05-16 19:25:06,172 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 -4.59188243e-13 -1.57079633e+00] -2025-05-16 19:25:06,199 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999982 -0.13500001 0.34424334] -2025-05-16 19:25:06,211 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999924e+02 2.74657814e-05 -9.00000534e+01] -2025-05-16 19:25:06,221 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000002 -0.13499988 0.34433914] -2025-05-16 19:25:06,224 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265 0. -1.57079539] -2025-05-16 19:25:06,232 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999998 -0.13499989 0.34424321] -2025-05-16 19:25:06,243 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999924e+02 2.74657814e-05 -9.00000534e+01] -2025-05-16 19:25:06,246 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999995 -0.13499988 0.34433975] -2025-05-16 19:25:06,247 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159132e+00 4.79368984e-07 -1.57079633e+00] -2025-05-16 19:25:06,251 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999979 -0.13500013 0.34424225] -2025-05-16 19:25:06,253 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999924e+02 2.74657814e-05 -9.00000534e+01] -2025-05-16 19:25:06,254 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999977 -0.13499977 0.34433902] -2025-05-16 19:25:06,255 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159159e+00 4.79368984e-07 -1.57079579e+00] -2025-05-16 19:25:06,270 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999975 -0.13499978 0.34424236] -2025-05-16 19:25:06,273 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999924e+02 2.74657814e-05 -9.00000534e+01] -2025-05-16 19:25:06,282 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000008 -0.13499977 0.34433929] -2025-05-16 19:25:06,287 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 4.79368984e-07 -1.57079579e+00] -2025-05-16 19:25:06,290 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999991 -0.13500001 0.34424184] -2025-05-16 19:25:06,291 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999924e+02 2.74657814e-05 -9.00000534e+01] -2025-05-16 19:25:06,294 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000017 -0.13500023 0.34433945] -2025-05-16 19:25:06,296 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 -4.79368761e-07 -1.57079726e+00] -2025-05-16 19:25:06,311 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000013 -0.13500023 0.34424186] -2025-05-16 19:25:06,315 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999924e+02 2.74657814e-05 -9.00000534e+01] -2025-05-16 19:25:06,324 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000008 -0.13499988 0.34433948] -2025-05-16 19:25:06,326 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 -4.59188243e-13 -1.57079539e+00] -2025-05-16 19:25:06,331 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000004 -0.13499988 0.34424146] -2025-05-16 19:25:06,333 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999924e+02 2.74657814e-05 -9.00000534e+01] -2025-05-16 19:25:06,336 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999985 -0.13499976 0.34433887] -2025-05-16 19:25:06,339 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159159 0. -1.57079539] -2025-05-16 19:25:06,351 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000034 -0.13500012 0.34424132] -2025-05-16 19:25:06,356 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999924e+02 2.74657814e-05 -9.00000534e+01] -2025-05-16 19:25:06,367 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999966 -0.135 0.34433914] -2025-05-16 19:25:06,369 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 -2.29816166e-13 -1.57079686e+00] -2025-05-16 19:25:06,374 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999962 -0.135 0.34424043] -2025-05-16 19:25:06,379 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999924e+02 2.74657814e-05 -9.00000534e+01] -2025-05-16 19:25:06,382 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999982 -0.13500012 0.34433896] -2025-05-16 19:25:06,387 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159159e+00 -4.59410288e-13 -1.57079726e+00] -2025-05-16 19:25:06,391 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000036 -0.13499988 0.34424052] -2025-05-16 19:25:06,392 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999924e+02 2.74657814e-05 -9.00000534e+01] -2025-05-16 19:25:06,393 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000024 -0.13499988 0.34433942] -2025-05-16 19:25:06,396 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 -4.59188243e-13 -1.57079539e+00] -2025-05-16 19:25:06,414 - 测试日志 - INFO - log.py:106 - MassageRobot启动 -2025-05-16 19:25:06,415 - 测试日志 - INFO - log.py:106 - 机械臂控制线程启动 -2025-05-16 19:32:26,560 - 测试日志 - INFO - log.py:106 - 切换到finger_head按摩头 -2025-05-16 19:32:30,093 - 测试日志 - INFO - log.py:106 - 机械臂测量线程启动 -2025-05-16 19:32:30,096 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999995 -0.13499976 0.34431408] -2025-05-16 19:32:30,102 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 1.31420519e-11 -8.99999161e+01] -2025-05-16 19:32:30,104 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999991 -0.13499988 0.3443392 ] -2025-05-16 19:32:30,108 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 -4.79368983e-07 -1.57079579e+00] -2025-05-16 19:32:30,111 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000034 -0.13499999 0.34429586] -2025-05-16 19:32:30,114 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 1.31420519e-11 -8.99999161e+01] -2025-05-16 19:32:30,116 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000018 -0.13499953 0.34433884] -2025-05-16 19:32:30,117 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 4.79369238e-07 -1.57079446e+00] -2025-05-16 19:32:30,135 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000018 -0.13499963 0.34428164] -2025-05-16 19:32:30,136 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 1.31420519e-11 -8.99999161e+01] -2025-05-16 19:32:30,138 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000006 -0.135 0.34433902] -2025-05-16 19:32:30,139 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 4.79368984e-07 -1.57079686e+00] -2025-05-16 19:32:30,155 - 测试日志 - INFO - log.py:106 - position command: [ 0.2500001 -0.13499987 0.34427079] -2025-05-16 19:32:30,156 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 1.31420519e-11 -8.99999161e+01] -2025-05-16 19:32:30,158 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000015 -0.13499977 0.34433878] -2025-05-16 19:32:30,159 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159132e+00 4.79368984e-07 -1.57079579e+00] -2025-05-16 19:32:30,175 - 测试日志 - INFO - log.py:106 - position command: [ 0.2500001 -0.13499975 0.34426273] -2025-05-16 19:32:30,178 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 1.31420519e-11 -8.99999161e+01] -2025-05-16 19:32:30,186 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999994 -0.13499988 0.34433896] -2025-05-16 19:32:30,190 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159159e+00 4.59410288e-13 -1.57079539e+00] -2025-05-16 19:32:30,199 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999988 -0.13499999 0.34425672] -2025-05-16 19:32:30,205 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 1.31420519e-11 -8.99999161e+01] -2025-05-16 19:32:30,207 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000012 -0.13499977 0.34433917] -2025-05-16 19:32:30,210 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 4.79368761e-07 -1.57079539e+00] -2025-05-16 19:32:30,218 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000011 -0.13499976 0.34425251] -2025-05-16 19:32:30,219 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 1.31420519e-11 -8.99999161e+01] -2025-05-16 19:32:30,221 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999985 -0.13499976 0.34433868] -2025-05-16 19:32:30,223 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159159e+00 4.59632332e-13 -1.57079486e+00] -2025-05-16 19:32:30,239 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000016 -0.13499987 0.34424941] -2025-05-16 19:32:30,241 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 1.31420519e-11 -8.99999161e+01] -2025-05-16 19:32:30,250 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999994 -0.135 0.34433914] -2025-05-16 19:32:30,258 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265 0. -1.57079633] -2025-05-16 19:32:30,262 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000004 -0.13499976 0.34424666] -2025-05-16 19:32:30,268 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 1.31420519e-11 -8.99999161e+01] -2025-05-16 19:32:30,274 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000041 -0.13499988 0.34433969] -2025-05-16 19:32:30,277 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159079e+00 4.79369904e-07 -1.57079686e+00] -2025-05-16 19:32:30,285 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000032 -0.13499976 0.34424523] -2025-05-16 19:32:30,290 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 1.31420519e-11 -8.99999161e+01] -2025-05-16 19:32:30,296 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000024 -0.13499988 0.34433923] -2025-05-16 19:32:30,303 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159 0. -1.57079579] -2025-05-16 19:32:30,306 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000021 -0.13499987 0.34424343] -2025-05-16 19:32:30,309 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 1.31420519e-11 -8.99999161e+01] -2025-05-16 19:32:30,312 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999977 -0.135 0.34433868] -2025-05-16 19:32:30,322 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159159e+00 -4.79369460e-07 -1.57079633e+00] -2025-05-16 19:32:30,327 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999993 -0.13499987 0.34424208] -2025-05-16 19:32:30,336 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 1.31420519e-11 -8.99999161e+01] -2025-05-16 19:32:30,339 - 测试日志 - INFO - log.py:106 - position current:[ 0.25 -0.135 0.34433884] -2025-05-16 19:32:30,340 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 -6.89004409e-13 -1.57079779e+00] -2025-05-16 19:32:30,354 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999998 -0.13499998 0.34424121] -2025-05-16 19:32:30,356 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 1.31420519e-11 -8.99999161e+01] -2025-05-16 19:32:30,358 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999977 -0.13499977 0.34433868] -2025-05-16 19:32:30,360 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159159e+00 4.79368539e-07 -1.57079633e+00] -2025-05-16 19:32:30,374 - 测试日志 - INFO - log.py:106 - position command: [ 0.2499996 -0.13499986 0.34424027] -2025-05-16 19:32:30,376 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 1.31420519e-11 -8.99999161e+01] -2025-05-16 19:32:30,377 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000006 -0.13499988 0.34433902] -2025-05-16 19:32:30,380 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 4.79368761e-07 -1.57079579e+00] -2025-05-16 19:32:30,389 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000007 -0.13499986 0.34424081] -2025-05-16 19:32:30,392 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 1.31420519e-11 -8.99999161e+01] -2025-05-16 19:32:30,394 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999977 -0.13499965 0.34433835] -2025-05-16 19:32:30,396 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159079e+00 4.79368984e-07 -1.57079539e+00] -2025-05-16 19:32:30,411 - 测试日志 - INFO - log.py:106 - position command: [ 0.2500001 -0.1350001 0.34424041] -2025-05-16 19:32:30,413 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 1.31420519e-11 -8.99999161e+01] -2025-05-16 19:32:30,416 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000003 -0.13499965 0.34433893] -2025-05-16 19:32:30,418 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 4.79368761e-07 -1.57079486e+00] -2025-05-16 19:32:30,428 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000009 -0.13500009 0.34424015] -2025-05-16 19:32:30,437 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 1.31420519e-11 -8.99999161e+01] -2025-05-16 19:32:30,441 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999983 -0.13499977 0.34433875] -2025-05-16 19:32:30,445 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159132e+00 4.79368984e-07 -1.57079579e+00] -2025-05-16 19:32:30,451 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999995 -0.13499985 0.34423963] -2025-05-16 19:32:30,454 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 1.31420519e-11 -8.99999161e+01] -2025-05-16 19:32:30,455 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999988 -0.13499977 0.34433896] -2025-05-16 19:32:30,457 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159265e+00 1.43810701e-06 -1.57079726e+00] -2025-05-16 19:32:30,472 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000006 -0.13499975 0.34423955] -2025-05-16 19:32:30,474 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 1.31420519e-11 -8.99999161e+01] -2025-05-16 19:32:30,475 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999988 -0.13499988 0.34433881] -2025-05-16 19:32:30,476 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159159e+00 4.79368984e-07 -1.57079633e+00] -2025-05-16 19:32:30,490 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000006 -0.13499976 0.34423945] -2025-05-16 19:32:30,491 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 1.31420519e-11 -8.99999161e+01] -2025-05-16 19:32:30,494 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999988 -0.13499989 0.34433896] -2025-05-16 19:32:30,498 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 9.58737967e-07 -1.57079686e+00] -2025-05-16 19:32:30,510 - 测试日志 - INFO - log.py:106 - 机械臂控制线程启动 -2025-05-16 19:32:30,512 - 测试日志 - INFO - log.py:106 - MassageRobot启动 -2025-05-16 19:33:05,485 - 测试日志 - INFO - log.py:106 - 切换到finger_head按摩头 -2025-05-16 19:33:09,003 - 测试日志 - INFO - log.py:106 - 机械臂测量线程启动 -2025-05-16 19:33:09,018 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999992 -0.13500024 0.34431451] -2025-05-16 19:33:09,026 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999969e+02 1.31547742e-11 -9.00000839e+01] -2025-05-16 19:33:09,027 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999994 -0.13500023 0.34433948] -2025-05-16 19:33:09,029 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 -4.79368063e-07 -1.57079779e+00] -2025-05-16 19:33:09,031 - 测试日志 - INFO - log.py:106 - position command: [ 0.2500001 -0.13500013 0.34429535] -2025-05-16 19:33:09,033 - 测试日志 - INFO - log.py:106 - orientation command: [-1.80000000e+02 -2.73593802e-05 -9.00000133e+01] -2025-05-16 19:33:09,034 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000018 -0.13500012 0.34433942] -2025-05-16 19:33:09,035 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 -4.79368984e-07 -1.57079633e+00] -2025-05-16 19:33:09,052 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999987 -0.13499989 0.34428085] -2025-05-16 19:33:09,054 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999894e+02 1.10255404e-07 -9.00000017e+01] -2025-05-16 19:33:09,055 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999989 -0.135 0.34433942] -2025-05-16 19:33:09,056 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 2.29594121e-13 -1.57079686e+00] -2025-05-16 19:33:09,070 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999983 -0.13500024 0.34427094] -2025-05-16 19:33:09,072 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999969e+02 -2.72544275e-05 -9.00001373e+01] -2025-05-16 19:33:09,073 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999971 -0.13500012 0.34433902] -2025-05-16 19:33:09,074 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265 0. -1.57079779] -2025-05-16 19:33:09,091 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999976 -0.13500025 0.34426241] -2025-05-16 19:33:09,093 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999940e+02 2.11089203e-07 -9.00001515e+01] -2025-05-16 19:33:09,095 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000023 -0.135 0.34433945] -2025-05-16 19:33:09,096 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 4.58966198e-13 -1.57079726e+00] -2025-05-16 19:33:09,110 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999984 -0.13500024 0.34425726] -2025-05-16 19:33:09,111 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999969e+02 -2.71572021e-05 -9.00001609e+01] -2025-05-16 19:33:09,112 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999989 -0.135 0.34433942] -2025-05-16 19:33:09,113 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 2.29594121e-13 -1.57079686e+00] -2025-05-16 19:33:09,132 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999937 -0.13500047 0.34425186] -2025-05-16 19:33:09,134 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999895e+02 -5.44283949e-05 -9.00001898e+01] -2025-05-16 19:33:09,136 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999965 -0.13500023 0.34433868] -2025-05-16 19:33:09,142 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159159e+00 -4.79369904e-07 -1.57079779e+00] -2025-05-16 19:33:09,153 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000008 -0.13500013 0.3442491 ] -2025-05-16 19:33:09,159 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999968e+02 -2.68683235e-05 -9.00001481e+01] -2025-05-16 19:33:09,162 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000011 -0.13500012 0.34433939] -2025-05-16 19:33:09,164 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 -4.79368983e-07 -1.57079779e+00] -2025-05-16 19:33:09,172 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000011 -0.13500013 0.34424695] -2025-05-16 19:33:09,173 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999999e+02 -2.67769373e-05 -9.00001861e+01] -2025-05-16 19:33:09,175 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999995 -0.135 0.34433926] -2025-05-16 19:33:09,177 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 -4.79368539e-07 -1.57079686e+00] -2025-05-16 19:33:09,194 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000021 -0.13499978 0.34424515] -2025-05-16 19:33:09,195 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999892e+02 6.79494720e-07 -9.00000846e+01] -2025-05-16 19:33:09,196 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999989 -0.135 0.34433926] -2025-05-16 19:33:09,197 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 6.89004409e-13 -1.57079779e+00] -2025-05-16 19:33:09,212 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000001 -0.13500014 0.34424374] -2025-05-16 19:33:09,213 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999938e+02 -2.66989116e-05 -9.00001616e+01] -2025-05-16 19:33:09,214 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999976 -0.13500012 0.34433859] -2025-05-16 19:33:09,214 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159132e+00 -4.79371079e-07 -1.57079779e+00] -2025-05-16 19:33:09,233 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999965 -0.13500014 0.34424176] -2025-05-16 19:33:09,236 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999895e+02 -2.66137380e-05 -9.00002254e+01] -2025-05-16 19:33:09,237 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999966 -0.135 0.34433881] -2025-05-16 19:33:09,239 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 -2.29816166e-13 -1.57079686e+00] -2025-05-16 19:33:09,253 - 测试日志 - INFO - log.py:106 - position command: [ 0.2500001 -0.13500024 0.34424184] -2025-05-16 19:33:09,254 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999938e+02 -2.65290706e-05 -9.00001863e+01] -2025-05-16 19:33:09,255 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999982 -0.13500012 0.34433881] -2025-05-16 19:33:09,255 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159159 0. -1.57079686] -2025-05-16 19:33:09,274 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000001 -0.13500002 0.34424144] -2025-05-16 19:33:09,277 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999938e+02 9.20052322e-07 -9.00001956e+01] -2025-05-16 19:33:09,279 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999969 -0.13499988 0.34433826] -2025-05-16 19:33:09,281 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159026e+00 4.79367841e-07 -1.57079686e+00] -2025-05-16 19:33:09,294 - 测试日志 - INFO - log.py:106 - position command: [ 0.2499997 -0.13499991 0.34423966] -2025-05-16 19:33:09,296 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999864e+02 2.82679231e-05 -9.00002088e+01] -2025-05-16 19:33:09,298 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000041 -0.13499988 0.34433951] -2025-05-16 19:33:09,301 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 4.59188243e-13 -1.57079633e+00] -2025-05-16 19:33:09,314 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000024 -0.13499979 0.34424015] -2025-05-16 19:33:09,317 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999998e+02 7.83897445e-07 -9.00001944e+01] -2025-05-16 19:33:09,320 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000029 -0.135 0.34433945] -2025-05-16 19:33:09,322 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159132e+00 6.89226454e-13 -1.57079686e+00] -2025-05-16 19:33:09,335 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000027 -0.13500004 0.34424025] -2025-05-16 19:33:09,337 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999922e+02 7.65542553e-07 -9.00002428e+01] -2025-05-16 19:33:09,340 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999994 -0.13499988 0.34433929] -2025-05-16 19:33:09,342 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159265e+00 4.79368983e-07 -1.57079686e+00] -2025-05-16 19:33:09,353 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999994 -0.13500004 0.3442402 ] -2025-05-16 19:33:09,355 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999922e+02 7.47012425e-07 -9.00002846e+01] -2025-05-16 19:33:09,357 - 测试日志 - INFO - log.py:106 - position current:[ 0.25 -0.135 0.34433902] -2025-05-16 19:33:09,358 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212 0. -1.57079633] -2025-05-16 19:33:09,375 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000004 -0.13500004 0.34423981] -2025-05-16 19:33:09,377 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999968e+02 7.28419717e-07 -9.00002815e+01] -2025-05-16 19:33:09,379 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999988 -0.13500012 0.34433914] -2025-05-16 19:33:09,381 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265 0. -1.57079686] -2025-05-16 19:33:09,395 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999982 -0.13500026 0.34423961] -2025-05-16 19:33:09,397 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999968e+02 -2.66564113e-05 -9.00003017e+01] -2025-05-16 19:33:09,400 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000002 -0.135 0.34433914] -2025-05-16 19:33:09,403 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 -4.79368983e-07 -1.57079686e+00] -2025-05-16 19:33:09,414 - 测试日志 - INFO - log.py:106 - 机械臂控制线程启动 -2025-05-16 19:33:09,417 - 测试日志 - INFO - log.py:106 - MassageRobot启动 -2025-05-16 19:35:03,735 - 测试日志 - INFO - log.py:106 - 切换到finger_head按摩头 -2025-05-16 19:35:07,254 - 测试日志 - INFO - log.py:106 - 机械臂测量线程启动 -2025-05-16 19:35:07,267 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999969 -0.13500012 0.34431408] -2025-05-16 19:35:07,273 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 2.74658069e-05 -9.00000839e+01] -2025-05-16 19:35:07,281 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000027 -0.135 0.34433966] -2025-05-16 19:35:07,286 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 4.79370825e-07 -1.57079872e+00] -2025-05-16 19:35:07,289 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999989 -0.135 0.34429565] -2025-05-16 19:35:07,291 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999924e+02 2.74611250e-05 -9.00001650e+01] -2025-05-16 19:35:07,295 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999985 -0.135 0.34433902] -2025-05-16 19:35:07,297 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 -4.79368984e-07 -1.57079819e+00] -2025-05-16 19:35:07,309 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999998 -0.13500024 0.34428167] -2025-05-16 19:35:07,310 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999924e+02 8.78162852e-08 -9.00001922e+01] -2025-05-16 19:35:07,312 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999989 -0.13499988 0.34433926] -2025-05-16 19:35:07,313 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 4.79369682e-07 -1.57079779e+00] -2025-05-16 19:35:07,329 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999998 -0.135 0.34427097] -2025-05-16 19:35:07,331 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999970e+02 2.75451958e-05 -9.00001885e+01] -2025-05-16 19:35:07,333 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999977 -0.13500012 0.34433893] -2025-05-16 19:35:07,334 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 -1.14885879e-12 -1.57079926e+00] -2025-05-16 19:35:07,350 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999991 -0.13499979 0.34426253] -2025-05-16 19:35:07,353 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999938e+02 2.75352101e-05 -9.00001920e+01] -2025-05-16 19:35:07,364 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999977 -0.13500024 0.34433926] -2025-05-16 19:35:07,367 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 9.19264664e-13 -1.57079926e+00] -2025-05-16 19:35:07,373 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000013 -0.13499979 0.34425702] -2025-05-16 19:35:07,375 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999993e+02 2.75248518e-05 -9.00002405e+01] -2025-05-16 19:35:07,377 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000002 -0.13499977 0.34433896] -2025-05-16 19:35:07,379 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159265e+00 4.79368984e-07 -1.57079819e+00] -2025-05-16 19:35:07,392 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000007 -0.13500002 0.34425289] -2025-05-16 19:35:07,394 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999919e+02 2.75139719e-05 -9.00002577e+01] -2025-05-16 19:35:07,397 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999942 -0.13500012 0.34433859] -2025-05-16 19:35:07,403 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159079e+00 -4.59543514e-12 -1.57079926e+00] -2025-05-16 19:35:07,416 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999958 -0.13500002 0.34424881] -2025-05-16 19:35:07,418 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999953e+02 1.35167874e-07 -9.00002689e+01] -2025-05-16 19:35:07,420 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999971 -0.13500012 0.3443392 ] -2025-05-16 19:35:07,422 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265 0. -1.57079819] -2025-05-16 19:35:07,435 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999959 -0.1349999 0.34424617] -2025-05-16 19:35:07,437 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999963e+02 2.75902455e-05 -9.00003102e+01] -2025-05-16 19:35:07,441 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000002 -0.135 0.34433929] -2025-05-16 19:35:07,443 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 9.18820575e-13 -1.57079726e+00] -2025-05-16 19:35:07,455 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000021 -0.1349998 0.34424537] -2025-05-16 19:35:07,464 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999848e+02 5.49491865e-05 -9.00002940e+01] -2025-05-16 19:35:07,466 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000006 -0.13500012 0.34433936] -2025-05-16 19:35:07,468 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159132e+00 2.75734990e-12 -1.57079872e+00] -2025-05-16 19:35:07,480 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000002 -0.13500014 0.34424356] -2025-05-16 19:35:07,481 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999877e+02 1.03714326e-07 -9.00003374e+01] -2025-05-16 19:35:07,483 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000002 -0.13499977 0.34433929] -2025-05-16 19:35:07,485 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159265e+00 4.79368983e-07 -1.57079726e+00] -2025-05-16 19:35:07,499 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999996 -0.1349999 0.34424217] -2025-05-16 19:35:07,505 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999982e+02 2.75563760e-05 -9.00002997e+01] -2025-05-16 19:35:07,513 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999971 -0.135 0.3443392 ] -2025-05-16 19:35:07,519 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159265e+00 4.79368984e-07 -1.57079819e+00] -2025-05-16 19:35:07,526 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999968 -0.13500002 0.34424156] -2025-05-16 19:35:07,529 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999951e+02 2.75437692e-05 -9.00003399e+01] -2025-05-16 19:35:07,533 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000031 -0.13500012 0.34434009] -2025-05-16 19:35:07,535 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14158972e+00 -4.79360729e-07 -1.57079926e+00] -2025-05-16 19:35:07,545 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000026 -0.13500014 0.34424182] -2025-05-16 19:35:07,546 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999783e+02 -2.72015194e-05 -9.00004192e+01] -2025-05-16 19:35:07,547 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000005 -0.13500024 0.34433957] -2025-05-16 19:35:07,548 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 1.37867495e-12 -1.57079872e+00] -2025-05-16 19:35:07,566 - 测试日志 - INFO - log.py:106 - position command: [ 0.25 -0.13500025 0.34424085] -2025-05-16 19:35:07,568 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999890e+02 3.48883999e-07 -9.00004078e+01] -2025-05-16 19:35:07,571 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999966 -0.13499977 0.34433899] -2025-05-16 19:35:07,575 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 9.58737523e-07 -1.57079726e+00] -2025-05-16 19:35:07,586 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999963 -0.13499979 0.34423996] -2025-05-16 19:35:07,587 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999982e+02 5.51661475e-05 -9.00003436e+01] -2025-05-16 19:35:07,589 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999992 -0.13500024 0.34433902] -2025-05-16 19:35:07,594 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 6.88782364e-13 -1.57079872e+00] -2025-05-16 19:35:07,606 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999989 -0.13500025 0.34423975] -2025-05-16 19:35:07,609 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999922e+02 3.18233490e-07 -9.00004393e+01] -2025-05-16 19:35:07,615 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000006 -0.13499988 0.34433936] -2025-05-16 19:35:07,618 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 4.79369460e-07 -1.57079726e+00] -2025-05-16 19:35:07,626 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000002 -0.13499989 0.34423989] -2025-05-16 19:35:07,628 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999923e+02 2.77679875e-05 -9.00003620e+01] -2025-05-16 19:35:07,634 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999924 -0.13500024 0.34433853] -2025-05-16 19:35:07,637 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159132e+00 4.79366920e-07 -1.57079926e+00] -2025-05-16 19:35:07,647 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999923 -0.13500025 0.34423895] -2025-05-16 19:35:07,649 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 2.77504293e-05 -9.00004864e+01] -2025-05-16 19:35:07,656 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999983 -0.13500012 0.34433942] -2025-05-16 19:35:07,658 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159132e+00 4.79371079e-07 -1.57079872e+00] -2025-05-16 19:35:07,667 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999982 -0.13500013 0.34423972] -2025-05-16 19:35:07,673 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999879e+02 2.77343618e-05 -9.00004686e+01] -2025-05-16 19:35:07,674 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999994 -0.135 0.34433948] -2025-05-16 19:35:07,677 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 4.79370380e-07 -1.57079819e+00] -2025-05-16 19:35:07,686 - 测试日志 - INFO - log.py:106 - 机械臂控制线程启动 -2025-05-16 19:35:07,695 - 测试日志 - INFO - log.py:106 - MassageRobot启动 -2025-05-16 19:35:07,715 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25000019 -0.13500025 0.34423973] -2025-05-16 19:35:07,716 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07103799e-01 7.07109764e-01 -6.43064464e-07 6.45007920e-07] -2025-05-16 19:35:07,743 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24999948 -0.13500002 0.34423879] -2025-05-16 19:35:07,744 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07103929e-01 7.07109633e-01 3.59608547e-07 -3.58963820e-07] -2025-05-16 19:35:07,771 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2499997 -0.13500026 0.3442391 ] -2025-05-16 19:35:07,774 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07103528e-01 7.07110035e-01 -1.32185598e-07 1.31585090e-07] -2025-05-16 19:35:07,802 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24999988 -0.13500014 0.34423928] -2025-05-16 19:35:07,816 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07103869e-01 7.07109694e-01 -3.28185874e-07 3.26410431e-07] -2025-05-16 19:35:07,843 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24999967 -0.13500003 0.34423911] -2025-05-16 19:35:07,844 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07103999e-01 7.07109564e-01 -1.44323700e-07 1.41398485e-07] -2025-05-16 19:35:07,872 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25000006 -0.13499992 0.34423945] -2025-05-16 19:35:07,873 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07104207e-01 7.07109356e-01 -3.50384088e-07 6.84084052e-07] -2025-05-16 19:35:07,904 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24999972 -0.13500004 0.34423896] -2025-05-16 19:35:07,906 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07104235e-01 7.07109327e-01 4.62200299e-08 -5.26140378e-08] -2025-05-16 19:35:07,936 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25000003 -0.13499981 0.34423949] -2025-05-16 19:35:07,938 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07104333e-01 7.07109229e-01 -5.13806312e-07 5.06350442e-07] -2025-05-16 19:35:07,968 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24999983 -0.13500005 0.34423947] -2025-05-16 19:35:07,969 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07103800e-01 7.07109762e-01 -3.39561095e-07 6.68814960e-07] -2025-05-16 19:35:07,996 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25000019 -0.13499983 0.34423973] -2025-05-16 19:35:07,997 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07104123e-01 7.07109439e-01 -6.50441817e-07 9.77467195e-07] -2025-05-16 19:35:08,039 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24999983 -0.13499994 0.34423912] -2025-05-16 19:35:08,041 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07104086e-01 7.07109476e-01 -1.17828856e-08 3.36616665e-07] -2025-05-16 19:35:08,064 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24999959 -0.13500006 0.34423892] -2025-05-16 19:35:08,066 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07103530e-01 7.07110033e-01 2.89163951e-07 3.71262818e-07] -2025-05-16 19:35:08,090 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2499996 -0.13500005 0.34423893] -2025-05-16 19:35:08,098 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07103471e-01 7.07110092e-01 2.02560703e-07 4.54547750e-07] -2025-05-16 19:35:08,121 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24999979 -0.13500029 0.34423932] -2025-05-16 19:35:08,126 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07103233e-01 7.07110329e-01 -7.39177856e-07 7.17553753e-07] -2025-05-16 19:35:08,150 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2500002 -0.13500005 0.34423955] -2025-05-16 19:35:08,153 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07104012e-01 7.07109550e-01 -1.21302026e-06 8.52908413e-07] -2025-05-16 19:35:08,190 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24999969 -0.13500005 0.34423912] -2025-05-16 19:35:08,194 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07103923e-01 7.07109639e-01 -7.48378132e-07 3.88788103e-07] -2025-05-16 19:35:08,223 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24999972 -0.13500027 0.34423907] -2025-05-16 19:35:08,226 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07103689e-01 7.07109873e-01 -7.96992833e-07 4.37914343e-07] -2025-05-16 19:35:08,258 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24999995 -0.13500004 0.34423919] -2025-05-16 19:35:08,266 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07103589e-01 7.07109973e-01 -6.46566323e-07 6.25827364e-07] -2025-05-16 19:35:08,292 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25000003 -0.13499993 0.34423978] -2025-05-16 19:35:08,293 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07103628e-01 7.07109934e-01 -1.11888895e-06 1.09751571e-06] -2025-05-16 19:35:08,317 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24999977 -0.13500005 0.34423911] -2025-05-16 19:35:08,319 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07103386e-01 7.07110176e-01 -2.90039627e-07 6.05769802e-07] -2025-05-16 19:35:08,343 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25000034 -0.13500004 0.34423955] -2025-05-16 19:35:08,344 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07103290e-01 7.07110273e-01 -1.01943236e-06 9.94357160e-07] -2025-05-16 19:35:08,368 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24999958 -0.13500016 0.34423905] -2025-05-16 19:35:08,370 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07102863e-01 7.07110700e-01 -8.79843360e-08 4.01266248e-07] -2025-05-16 19:35:08,403 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25000009 -0.13500004 0.34423941] -2025-05-16 19:35:08,404 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07103096e-01 7.07110466e-01 -6.23800852e-07 5.97524979e-07] -2025-05-16 19:35:08,429 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24999983 -0.13500003 0.34423897] -2025-05-16 19:35:08,430 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07102816e-01 7.07110747e-01 -4.25828764e-07 3.98978369e-07] -2025-05-16 19:35:08,456 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24999966 -0.13500027 0.34423924] -2025-05-16 19:35:08,458 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07102584e-01 7.07110978e-01 -6.02696666e-07 5.75299028e-07] -2025-05-16 19:35:08,484 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24999956 -0.13499992 0.34423851] -2025-05-16 19:35:08,485 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07102636e-01 7.07110926e-01 6.61094990e-08 -9.40400937e-08] -2025-05-16 19:35:08,509 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24999979 -0.13500004 0.34423929] -2025-05-16 19:35:08,513 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07102549e-01 7.07111013e-01 -2.24398218e-07 5.33708571e-07] -2025-05-16 19:35:08,539 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24999996 -0.13499982 0.34423946] -2025-05-16 19:35:08,542 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07102652e-01 7.07110911e-01 -5.88948749e-07 8.96553886e-07] -2025-05-16 19:35:08,574 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24999989 -0.13500005 0.34423934] -2025-05-16 19:35:08,578 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07102240e-01 7.07111323e-01 -4.24101758e-07 7.30005802e-07] -2025-05-16 19:35:08,603 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25000013 -0.13499993 0.34423966] -2025-05-16 19:35:08,606 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07102629e-01 7.07110934e-01 -1.31085077e-06 1.27732212e-06] -2025-05-16 19:35:08,636 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24999991 -0.13499983 0.34423956] -2025-05-16 19:35:08,641 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07102736e-01 7.07110826e-01 -8.82819486e-07 1.18661933e-06] -2025-05-16 19:35:08,669 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25000001 -0.13499994 0.34423887] -2025-05-16 19:35:08,673 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07102330e-01 7.07111232e-01 -2.19760910e-07 1.84201879e-07] -2025-05-16 19:35:08,708 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24999966 -0.13500017 0.34423906] -2025-05-16 19:35:08,710 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07101738e-01 7.07111824e-01 -5.21554913e-07 8.23400862e-07] -2025-05-16 19:35:08,741 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25000011 -0.13500029 0.34423992] -2025-05-16 19:35:08,745 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07101667e-01 7.07111896e-01 -1.34049421e-06 1.30310090e-06] -2025-05-16 19:35:08,769 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25 -0.13500016 0.34423937] -2025-05-16 19:35:08,771 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07101596e-01 7.07111966e-01 -9.72353727e-07 1.27242757e-06] -2025-05-16 19:35:08,794 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25000011 -0.1349997 0.34423937] -2025-05-16 19:35:08,796 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07101857e-01 7.07111706e-01 -5.10338743e-07 1.14667112e-06] -2025-05-16 19:35:08,832 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24999977 -0.13500005 0.3442389 ] -2025-05-16 19:35:08,835 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07101789e-01 7.07111774e-01 -6.48674752e-07 6.06833324e-07] -2025-05-16 19:35:08,861 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24999965 -0.13500017 0.34423891] -2025-05-16 19:35:08,869 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07101394e-01 7.07112168e-01 -2.60780855e-07 2.18719768e-07] -2025-05-16 19:35:08,896 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24999948 -0.1350005 0.34423919] -2025-05-16 19:35:08,899 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07101519e-01 7.07112044e-01 -6.05619544e-07 2.25640632e-07] -2025-05-16 19:35:08,931 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24999967 -0.13500004 0.34423925] -2025-05-16 19:35:08,935 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07101456e-01 7.07112106e-01 -2.73680067e-07 9.08057633e-07] -2025-05-16 19:35:08,961 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25000003 -0.13500004 0.34423951] -2025-05-16 19:35:08,965 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07101536e-01 7.07112026e-01 -9.74918206e-07 9.31212222e-07] -2025-05-16 19:35:08,995 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25000239 -0.13500151 0.34423959] -2025-05-16 19:35:09,000 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07101336e-01 7.07112227e-01 1.21676884e-06 5.48715213e-07] -2025-05-16 19:35:09,037 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2500031 -0.13500264 0.34423941] -2025-05-16 19:35:09,040 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07101419e-01 7.07112144e-01 3.16203184e-06 4.23213261e-07] -2025-05-16 19:35:09,072 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25000297 -0.13500356 0.34423932] -2025-05-16 19:35:09,084 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07101034e-01 7.07112529e-01 4.08850893e-06 4.31330242e-07] -2025-05-16 19:35:09,114 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25000221 -0.13500299 0.34423007] -2025-05-16 19:35:09,115 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07101495e-01 7.07112067e-01 5.04927101e-06 -1.16503624e-07] -2025-05-16 19:35:09,153 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25000698 -0.13500283 0.34417321] -2025-05-16 19:35:09,159 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07101111e-01 7.07112451e-01 -1.38855639e-06 6.24388990e-06] -2025-05-16 19:35:09,195 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25000907 -0.13500314 0.34416365] -2025-05-16 19:35:09,208 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07101200e-01 7.07112363e-01 -3.41705859e-06 1.00971077e-05] -2025-05-16 19:35:09,237 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25001332 -0.13500311 0.34416662] -2025-05-16 19:35:09,239 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07100868e-01 7.07112694e-01 -8.34390278e-06 1.52066191e-05] -2025-05-16 19:35:09,268 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.250015 -0.13500429 0.34416386] -2025-05-16 19:35:09,269 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07100665e-01 7.07112897e-01 -5.88811736e-06 1.47890932e-05] -2025-05-16 19:35:09,300 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2500181 -0.13500482 0.34413119] -2025-05-16 19:35:09,305 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07099790e-01 7.07113772e-01 -8.08465980e-06 1.78367358e-05] -2025-05-16 19:35:09,335 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2500216 -0.13500614 0.34410568] -2025-05-16 19:35:09,336 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07098769e-01 7.07114793e-01 -5.91344493e-06 1.78057159e-05] -2025-05-16 19:35:09,370 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25002329 -0.13500773 0.34410739] -2025-05-16 19:35:09,371 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07098876e-01 7.07114686e-01 -5.34661203e-06 1.95777248e-05] -2025-05-16 19:35:09,406 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25003066 -0.13500963 0.34409781] -2025-05-16 19:35:09,414 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07097667e-01 7.07115895e-01 -9.26105921e-06 2.75160544e-05] -2025-05-16 19:35:09,447 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2500342 -0.13501055 0.34407882] -2025-05-16 19:35:09,450 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07096649e-01 7.07116913e-01 -1.18311319e-05 3.19663301e-05] -2025-05-16 19:35:09,481 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25003737 -0.13501135 0.34406787] -2025-05-16 19:35:09,484 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07096243e-01 7.07117318e-01 -1.25635575e-05 3.49277256e-05] -2025-05-16 19:35:09,514 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25003988 -0.13501168 0.34404848] -2025-05-16 19:35:09,516 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07095886e-01 7.07117675e-01 -7.49881543e-06 3.32602813e-05] -2025-05-16 19:35:09,556 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004784 -0.13501408 0.34404238] -2025-05-16 19:35:09,563 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07092669e-01 7.07120892e-01 -9.87941153e-06 4.01000186e-05] -2025-05-16 19:35:09,599 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005122 -0.13501482 0.34403003] -2025-05-16 19:35:09,601 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07091621e-01 7.07121939e-01 -1.11603800e-05 4.37713478e-05] -2025-05-16 19:35:09,635 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005411 -0.13501714 0.34399633] -2025-05-16 19:35:09,637 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07090624e-01 7.07122937e-01 -1.83049771e-06 3.75188323e-05] -2025-05-16 19:35:09,666 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005555 -0.13501749 0.34399616] -2025-05-16 19:35:09,667 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07089772e-01 7.07123789e-01 1.52169982e-06 3.70001851e-05] -2025-05-16 19:35:09,697 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006359 -0.13501997 0.34399189] -2025-05-16 19:35:09,698 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07087737e-01 7.07125823e-01 1.69695341e-07 4.29773046e-05] -2025-05-16 19:35:09,729 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006496 -0.13501996 0.34398018] -2025-05-16 19:35:09,731 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07087764e-01 7.07125797e-01 2.79284677e-06 4.27692287e-05] -2025-05-16 19:35:09,763 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006765 -0.13501955 0.34397027] -2025-05-16 19:35:09,765 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07085761e-01 7.07127800e-01 5.98642223e-06 4.19818947e-05] -2025-05-16 19:35:09,798 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006692 -0.13502059 0.34394903] -2025-05-16 19:35:09,802 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07084086e-01 7.07129475e-01 1.33826294e-05 3.62630219e-05] -2025-05-16 19:35:09,837 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007174 -0.13503261 0.34394556] -2025-05-16 19:35:09,841 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07067730e-01 7.07145829e-01 1.43269505e-05 3.89115130e-05] -2025-05-16 19:35:09,878 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2500704 -0.13503883 0.34392482] -2025-05-16 19:35:09,879 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07058699e-01 7.07154859e-01 2.13197571e-05 3.58018625e-05] -2025-05-16 19:35:09,911 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007165 -0.1350374 0.34392479] -2025-05-16 19:35:09,913 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07060112e-01 7.07153446e-01 2.51381830e-05 3.41882266e-05] -2025-05-16 19:35:09,943 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007209 -0.13503749 0.34391721] -2025-05-16 19:35:09,947 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07059546e-01 7.07154012e-01 2.94560972e-05 3.31778370e-05] -2025-05-16 19:35:09,981 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007644 -0.13504111 0.34389817] -2025-05-16 19:35:09,983 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07051755e-01 7.07161801e-01 3.91520312e-05 3.08124940e-05] -2025-05-16 19:35:10,021 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007478 -0.1350484 0.34388525] -2025-05-16 19:35:10,031 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07041937e-01 7.07171618e-01 4.44282722e-05 2.95433562e-05] -2025-05-16 19:35:10,061 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007282 -0.13504955 0.34388406] -2025-05-16 19:35:10,063 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07040424e-01 7.07173130e-01 4.81607949e-05 2.88120994e-05] -2025-05-16 19:35:10,092 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007334 -0.13505108 0.34388047] -2025-05-16 19:35:10,095 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07039607e-01 7.07173946e-01 5.30239687e-05 2.73269055e-05] -2025-05-16 19:35:10,139 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2500756 -0.13505293 0.3438668 ] -2025-05-16 19:35:10,151 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07036433e-01 7.07177119e-01 6.35066634e-05 1.97520509e-05] -2025-05-16 19:35:10,190 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007769 -0.13506135 0.34384541] -2025-05-16 19:35:10,194 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07025112e-01 7.07188437e-01 7.49352088e-05 1.21679594e-05] -2025-05-16 19:35:10,226 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007864 -0.1350618 0.34384675] -2025-05-16 19:35:10,229 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07024278e-01 7.07189271e-01 7.59568617e-05 1.40566936e-05] -2025-05-16 19:35:10,257 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007806 -0.13506297 0.34384773] -2025-05-16 19:35:10,260 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07023346e-01 7.07190202e-01 7.80196890e-05 1.53965584e-05] -2025-05-16 19:35:10,296 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007654 -0.13506714 0.34384027] -2025-05-16 19:35:10,298 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07019277e-01 7.07194269e-01 8.74370420e-05 1.05075985e-05] -2025-05-16 19:35:10,327 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007853 -0.13507824 0.34381431] -2025-05-16 19:35:10,329 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07003970e-01 7.07209569e-01 1.05094011e-04 -3.22957184e-06] -2025-05-16 19:35:10,360 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007885 -0.13508001 0.34381441] -2025-05-16 19:35:10,361 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07002233e-01 7.07211306e-01 1.08294331e-04 -2.99656990e-06] -2025-05-16 19:35:10,388 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007852 -0.1350789 0.34381493] -2025-05-16 19:35:10,390 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07002689e-01 7.07210850e-01 1.09231178e-04 -2.37416646e-06] -2025-05-16 19:35:10,419 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007853 -0.13507826 0.34381579] -2025-05-16 19:35:10,422 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07002935e-01 7.07210604e-01 1.10415477e-04 -1.37479753e-06] -2025-05-16 19:35:10,451 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007751 -0.13507801 0.34381438] -2025-05-16 19:35:10,452 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07001621e-01 7.07211917e-01 1.12035809e-04 -1.80962128e-06] -2025-05-16 19:35:10,482 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007509 -0.13509662 0.34378742] -2025-05-16 19:35:10,484 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06976088e-01 7.07237436e-01 1.36571528e-04 -2.40912402e-05] -2025-05-16 19:35:10,512 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007606 -0.13509561 0.34378848] -2025-05-16 19:35:10,513 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06976431e-01 7.07237093e-01 1.37251148e-04 -2.44877712e-05] -2025-05-16 19:35:10,540 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007704 -0.13509386 0.34378893] -2025-05-16 19:35:10,547 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06980462e-01 7.07233064e-01 1.38004837e-04 -2.28529075e-05] -2025-05-16 19:35:10,576 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007829 -0.13509296 0.34378943] -2025-05-16 19:35:10,579 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06983333e-01 7.07230194e-01 1.40753987e-04 -2.41760448e-05] -2025-05-16 19:35:10,608 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2500779 -0.13509348 0.34378701] -2025-05-16 19:35:10,609 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06981829e-01 7.07231696e-01 1.45300861e-04 -2.63670153e-05] -2025-05-16 19:35:10,636 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007788 -0.1351045 0.34376753] -2025-05-16 19:35:10,641 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06966774e-01 7.07246739e-01 1.68550592e-04 -4.68015942e-05] -2025-05-16 19:35:10,669 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007695 -0.13510649 0.34376475] -2025-05-16 19:35:10,671 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06968337e-01 7.07245175e-01 1.73957053e-04 -5.00123969e-05] -2025-05-16 19:35:10,703 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007613 -0.13510505 0.34376527] -2025-05-16 19:35:10,706 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06972878e-01 7.07240635e-01 1.74285139e-04 -4.88616301e-05] -2025-05-16 19:35:10,739 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007644 -0.13510574 0.34376444] -2025-05-16 19:35:10,746 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06978743e-01 7.07234772e-01 1.77704802e-04 -4.87885114e-05] -2025-05-16 19:35:10,781 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007799 -0.13510713 0.34376096] -2025-05-16 19:35:10,782 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06979436e-01 7.07234077e-01 1.87530132e-04 -5.44412185e-05] -2025-05-16 19:35:10,813 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007965 -0.13511299 0.34374636] -2025-05-16 19:35:10,815 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06978517e-01 7.07234986e-01 2.12385213e-04 -7.21601759e-05] -2025-05-16 19:35:10,846 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25008043 -0.13511224 0.34374808] -2025-05-16 19:35:10,853 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06983725e-01 7.07229781e-01 2.13727663e-04 -7.03771757e-05] -2025-05-16 19:35:10,882 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007973 -0.13511076 0.34374777] -2025-05-16 19:35:10,884 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06999814e-01 7.07213696e-01 2.16663831e-04 -6.76303625e-05] -2025-05-16 19:35:10,913 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007794 -0.1351091 0.34374833] -2025-05-16 19:35:10,918 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07004051e-01 7.07209458e-01 2.23069162e-04 -6.13570973e-05] -2025-05-16 19:35:10,951 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007677 -0.13505412 0.34374341] -2025-05-16 19:35:10,953 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07003294e-01 7.07210181e-01 3.19040445e-04 1.81632912e-05] -2025-05-16 19:35:10,980 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007653 -0.13505414 0.34372545] -2025-05-16 19:35:10,982 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06996337e-01 7.07217114e-01 3.64316901e-04 1.15321558e-05] -2025-05-16 19:35:11,013 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2500773 -0.13506043 0.34372718] -2025-05-16 19:35:11,015 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06996450e-01 7.07217004e-01 3.59554114e-04 9.00314070e-06] -2025-05-16 19:35:11,050 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007785 -0.13506444 0.34372716] -2025-05-16 19:35:11,053 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06996807e-01 7.07216647e-01 3.57827007e-04 5.96626812e-06] -2025-05-16 19:35:11,081 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007782 -0.13506478 0.34372667] -2025-05-16 19:35:11,082 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06997203e-01 7.07216251e-01 3.61089080e-04 6.90270166e-06] -2025-05-16 19:35:11,118 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007484 -0.13502639 0.34371563] -2025-05-16 19:35:11,120 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06996038e-01 7.07217356e-01 4.57302105e-04 6.50933611e-05] -2025-05-16 19:35:11,150 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007223 -0.13503578 0.34370874] -2025-05-16 19:35:11,151 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06988328e-01 7.07225056e-01 4.70786209e-04 5.56529224e-05] -2025-05-16 19:35:11,180 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007353 -0.13504422 0.34370906] -2025-05-16 19:35:11,181 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06990808e-01 7.07222580e-01 4.66735335e-04 4.82846651e-05] -2025-05-16 19:35:11,209 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007456 -0.1350456 0.34370992] -2025-05-16 19:35:11,212 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06992394e-01 7.07220994e-01 4.65764744e-04 4.85702545e-05] -2025-05-16 19:35:11,241 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007318 -0.13504689 0.34370802] -2025-05-16 19:35:11,251 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06993984e-01 7.07219404e-01 4.68313261e-04 4.66392512e-05] -2025-05-16 19:35:11,283 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006454 -0.13503878 0.34368941] -2025-05-16 19:35:11,284 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06972503e-01 7.07240814e-01 5.53009213e-04 7.07802159e-05] -2025-05-16 19:35:11,312 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006522 -0.13503713 0.34369027] -2025-05-16 19:35:11,314 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06973592e-01 7.07239722e-01 5.55973747e-04 7.42531639e-05] -2025-05-16 19:35:11,347 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006827 -0.13504058 0.34369242] -2025-05-16 19:35:11,349 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06986982e-01 7.07226339e-01 5.54353195e-04 7.01362351e-05] -2025-05-16 19:35:11,380 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006851 -0.13504119 0.34369139] -2025-05-16 19:35:11,382 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06988628e-01 7.07224694e-01 5.53792145e-04 6.78945632e-05] -2025-05-16 19:35:11,413 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006495 -0.13504201 0.34368621] -2025-05-16 19:35:11,415 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06980961e-01 7.07232336e-01 5.81420022e-04 7.19030205e-05] -2025-05-16 19:35:11,447 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005877 -0.13504816 0.34367488] -2025-05-16 19:35:11,449 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06958626e-01 7.07254631e-01 6.19015790e-04 7.29145769e-05] -2025-05-16 19:35:11,479 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005767 -0.13504385 0.34367406] -2025-05-16 19:35:11,481 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06963717e-01 7.07249534e-01 6.27728820e-04 7.81864688e-05] -2025-05-16 19:35:11,512 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005895 -0.13504316 0.34367569] -2025-05-16 19:35:11,515 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06965970e-01 7.07247281e-01 6.28231476e-04 7.94811768e-05] -2025-05-16 19:35:11,544 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006042 -0.13504224 0.3436757 ] -2025-05-16 19:35:11,547 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06969267e-01 7.07243985e-01 6.28936120e-04 8.03276002e-05] -2025-05-16 19:35:11,578 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006107 -0.13504079 0.34367594] -2025-05-16 19:35:11,581 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06970557e-01 7.07242694e-01 6.30589992e-04 7.95283278e-05] -2025-05-16 19:35:11,613 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005527 -0.13505264 0.34365959] -2025-05-16 19:35:11,619 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06943994e-01 7.07269188e-01 6.91980422e-04 8.02133928e-05] -2025-05-16 19:35:11,650 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2500555 -0.13505116 0.34366169] -2025-05-16 19:35:11,651 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06948612e-01 7.07264574e-01 6.90295344e-04 7.96321264e-05] -2025-05-16 19:35:11,682 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005538 -0.13505081 0.34366253] -2025-05-16 19:35:11,686 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06952921e-01 7.07260268e-01 6.88574208e-04 7.90956281e-05] -2025-05-16 19:35:11,716 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005531 -0.13505088 0.34366401] -2025-05-16 19:35:11,719 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06954328e-01 7.07258862e-01 6.87754246e-04 7.91881713e-05] -2025-05-16 19:35:11,749 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005429 -0.1350597 0.3436467 ] -2025-05-16 19:35:11,751 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06942038e-01 7.07271094e-01 7.41542925e-04 6.62132824e-05] -2025-05-16 19:35:11,790 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005075 -0.13506253 0.34364916] -2025-05-16 19:35:11,792 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06938952e-01 7.07274173e-01 7.46317884e-04 7.60105661e-05] -2025-05-16 19:35:11,819 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005161 -0.13506104 0.3436494 ] -2025-05-16 19:35:11,821 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06944175e-01 7.07268951e-01 7.47614850e-04 7.88952425e-05] -2025-05-16 19:35:11,849 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2500535 -0.13506105 0.34364977] -2025-05-16 19:35:11,852 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06947617e-01 7.07265509e-01 7.48372692e-04 8.01947197e-05] -2025-05-16 19:35:11,884 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005488 -0.13506911 0.34363946] -2025-05-16 19:35:11,884 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06947778e-01 7.07265313e-01 7.82434659e-04 5.82895888e-05] -2025-05-16 19:35:11,915 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005305 -0.13507118 0.34364183] -2025-05-16 19:35:11,917 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06946284e-01 7.07266808e-01 7.81636525e-04 6.12917418e-05] -2025-05-16 19:35:11,952 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005365 -0.13507097 0.3436406 ] -2025-05-16 19:35:11,955 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06950880e-01 7.07262209e-01 7.85480807e-04 5.96995563e-05] -2025-05-16 19:35:11,993 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005516 -0.13507113 0.34364144] -2025-05-16 19:35:11,998 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06954314e-01 7.07258775e-01 7.87382029e-04 5.98986692e-05] -2025-05-16 19:35:12,029 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005431 -0.1350714 0.34363545] -2025-05-16 19:35:12,030 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06957395e-01 7.07255626e-01 8.47010532e-04 6.03969000e-05] -2025-05-16 19:35:12,064 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005304 -0.135067 0.34363656] -2025-05-16 19:35:12,066 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06958175e-01 7.07254843e-01 8.49519187e-04 6.48646111e-05] -2025-05-16 19:35:12,110 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005382 -0.13506604 0.3436366 ] -2025-05-16 19:35:12,113 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06960088e-01 7.07252930e-01 8.50420435e-04 6.60099011e-05] -2025-05-16 19:35:12,148 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005543 -0.13506737 0.34363639] -2025-05-16 19:35:12,157 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06961458e-01 7.07251560e-01 8.49801243e-04 6.70659455e-05] -2025-05-16 19:35:12,189 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005658 -0.13506734 0.3436377 ] -2025-05-16 19:35:12,195 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06962155e-01 7.07250867e-01 8.47511886e-04 6.77130651e-05] -2025-05-16 19:35:12,232 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005514 -0.13506665 0.34363843] -2025-05-16 19:35:12,234 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06962510e-01 7.07250515e-01 8.44840015e-04 7.00968914e-05] -2025-05-16 19:35:12,266 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005422 -0.13506583 0.34363865] -2025-05-16 19:35:12,267 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06962553e-01 7.07250477e-01 8.40389024e-04 7.22020512e-05] -2025-05-16 19:35:12,300 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005364 -0.13506575 0.34363736] -2025-05-16 19:35:12,301 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06962846e-01 7.07250186e-01 8.39059724e-04 7.17114459e-05] -2025-05-16 19:35:12,332 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005328 -0.13506547 0.34363759] -2025-05-16 19:35:12,332 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06962630e-01 7.07250405e-01 8.35978284e-04 7.35077012e-05] -2025-05-16 19:35:12,367 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2500519 -0.13506566 0.34363734] -2025-05-16 19:35:12,368 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06963481e-01 7.07249558e-01 8.32984528e-04 7.51571458e-05] -2025-05-16 19:35:12,397 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005106 -0.13506667 0.34363733] -2025-05-16 19:35:12,398 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06963293e-01 7.07249749e-01 8.30308066e-04 7.74881068e-05] -2025-05-16 19:35:12,425 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004972 -0.13506733 0.3436367 ] -2025-05-16 19:35:12,428 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06963550e-01 7.07249492e-01 8.29246488e-04 7.90414811e-05] -2025-05-16 19:35:12,460 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005153 -0.13506883 0.34363693] -2025-05-16 19:35:12,466 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06963310e-01 7.07249736e-01 8.27100187e-04 7.99392420e-05] -2025-05-16 19:35:12,499 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005165 -0.1350699 0.3436368 ] -2025-05-16 19:35:12,501 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06963711e-01 7.07249337e-01 8.25330810e-04 8.10208058e-05] -2025-05-16 19:35:12,534 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005112 -0.13506935 0.34363673] -2025-05-16 19:35:12,537 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06963636e-01 7.07249414e-01 8.23137235e-04 8.21258587e-05] -2025-05-16 19:35:12,564 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005237 -0.13506854 0.34363681] -2025-05-16 19:35:12,566 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06963696e-01 7.07249356e-01 8.20596876e-04 8.17242296e-05] -2025-05-16 19:35:12,593 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005235 -0.13506635 0.3436369 ] -2025-05-16 19:35:12,597 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06964411e-01 7.07248645e-01 8.17950540e-04 8.19369050e-05] -2025-05-16 19:35:12,626 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005154 -0.13506599 0.34363701] -2025-05-16 19:35:12,628 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06963806e-01 7.07249254e-01 8.14462971e-04 8.14156953e-05] -2025-05-16 19:35:12,660 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005068 -0.13506478 0.34363722] -2025-05-16 19:35:12,662 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06963483e-01 7.07249581e-01 8.11040803e-04 8.15830576e-05] -2025-05-16 19:35:12,697 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004985 -0.13506311 0.34363722] -2025-05-16 19:35:12,700 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06964051e-01 7.07249018e-01 8.07192389e-04 8.05697314e-05] -2025-05-16 19:35:12,735 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004893 -0.13506141 0.34363681] -2025-05-16 19:35:12,738 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06963771e-01 7.07249301e-01 8.04394964e-04 7.94297136e-05] -2025-05-16 19:35:12,769 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004836 -0.13505997 0.34363778] -2025-05-16 19:35:12,770 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06963819e-01 7.07249258e-01 7.99271749e-04 7.97559509e-05] -2025-05-16 19:35:12,802 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004764 -0.13506026 0.34363635] -2025-05-16 19:35:12,804 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06963866e-01 7.07249213e-01 7.98087288e-04 7.80834559e-05] -2025-05-16 19:35:12,832 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004892 -0.13506172 0.34363708] -2025-05-16 19:35:12,833 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06963817e-01 7.07249265e-01 7.94846085e-04 7.84954458e-05] -2025-05-16 19:35:12,863 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004715 -0.13505888 0.34363544] -2025-05-16 19:35:12,865 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06972152e-01 7.07240920e-01 8.06004780e-04 8.90275036e-05] -2025-05-16 19:35:12,893 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004967 -0.13506128 0.34363624] -2025-05-16 19:35:12,894 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06971526e-01 7.07241545e-01 8.06876446e-04 8.83337916e-05] -2025-05-16 19:35:12,928 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005215 -0.13506356 0.34363736] -2025-05-16 19:35:12,931 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06971446e-01 7.07241625e-01 8.07195131e-04 8.82094215e-05] -2025-05-16 19:35:12,960 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005178 -0.1350657 0.34363755] -2025-05-16 19:35:12,961 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06971623e-01 7.07241448e-01 8.07099707e-04 8.94529336e-05] -2025-05-16 19:35:12,989 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005047 -0.13506717 0.34363714] -2025-05-16 19:35:12,999 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06971135e-01 7.07241935e-01 8.07048837e-04 9.08137047e-05] -2025-05-16 19:35:13,030 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004971 -0.13506833 0.34363706] -2025-05-16 19:35:13,032 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06971390e-01 7.07241680e-01 8.06752473e-04 9.25325493e-05] -2025-05-16 19:35:13,060 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004836 -0.13506787 0.34363697] -2025-05-16 19:35:13,061 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06971629e-01 7.07241443e-01 8.05399047e-04 9.41477054e-05] -2025-05-16 19:35:13,096 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2500466 -0.13506734 0.3436366 ] -2025-05-16 19:35:13,097 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06970814e-01 7.07242259e-01 8.04203955e-04 9.44954079e-05] -2025-05-16 19:35:13,126 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004577 -0.13506522 0.34363608] -2025-05-16 19:35:13,127 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06971164e-01 7.07241911e-01 8.02230237e-04 9.39868550e-05] -2025-05-16 19:35:13,163 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004471 -0.13506446 0.34363696] -2025-05-16 19:35:13,165 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06971509e-01 7.07241570e-01 7.98925627e-04 9.62674749e-05] -2025-05-16 19:35:13,197 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004423 -0.13506359 0.34363633] -2025-05-16 19:35:13,199 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06971707e-01 7.07241373e-01 7.97683971e-04 9.66619025e-05] -2025-05-16 19:35:13,238 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2500438 -0.13506249 0.34363578] -2025-05-16 19:35:13,239 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06971857e-01 7.07241224e-01 7.96300216e-04 9.64980430e-05] -2025-05-16 19:35:13,271 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004325 -0.13506042 0.3436364 ] -2025-05-16 19:35:13,281 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06972428e-01 7.07240657e-01 7.93120916e-04 9.75154481e-05] -2025-05-16 19:35:13,312 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004255 -0.13505899 0.34363637] -2025-05-16 19:35:13,316 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06972654e-01 7.07240434e-01 7.90461352e-04 9.75809617e-05] -2025-05-16 19:35:13,348 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004226 -0.13505747 0.34363667] -2025-05-16 19:35:13,351 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06973144e-01 7.07239949e-01 7.87034456e-04 9.74331662e-05] -2025-05-16 19:35:13,386 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004232 -0.13505865 0.34363589] -2025-05-16 19:35:13,388 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06973668e-01 7.07239426e-01 7.86155314e-04 9.71724034e-05] -2025-05-16 19:35:13,430 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2500423 -0.13505792 0.3436362 ] -2025-05-16 19:35:13,433 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06973857e-01 7.07239239e-01 7.83992520e-04 9.80306563e-05] -2025-05-16 19:35:13,463 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004192 -0.13505883 0.34363609] -2025-05-16 19:35:13,466 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06974373e-01 7.07238725e-01 7.82493890e-04 9.87473388e-05] -2025-05-16 19:35:13,500 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004141 -0.13505945 0.34363601] -2025-05-16 19:35:13,503 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06974697e-01 7.07238403e-01 7.80983226e-04 9.94024667e-05] -2025-05-16 19:35:13,538 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004188 -0.13505932 0.34363633] -2025-05-16 19:35:13,549 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06976555e-01 7.07236547e-01 7.79016904e-04 1.00487214e-04] -2025-05-16 19:35:13,579 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004176 -0.13506102 0.34363619] -2025-05-16 19:35:13,581 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06976747e-01 7.07236356e-01 7.78505310e-04 1.01660903e-04] -2025-05-16 19:35:13,614 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004144 -0.13506239 0.34363592] -2025-05-16 19:35:13,615 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06977073e-01 7.07236030e-01 7.78677814e-04 1.03282730e-04] -2025-05-16 19:35:13,648 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2500416 -0.13506289 0.34363648] -2025-05-16 19:35:13,649 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06977907e-01 7.07235196e-01 7.77700324e-04 1.05205792e-04] -2025-05-16 19:35:13,680 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004159 -0.13506249 0.34363596] -2025-05-16 19:35:13,682 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06978268e-01 7.07234836e-01 7.77338693e-04 1.05441619e-04] -2025-05-16 19:35:13,708 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004128 -0.13506203 0.34363603] -2025-05-16 19:35:13,709 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06977864e-01 7.07235242e-01 7.75399495e-04 1.06121622e-04] -2025-05-16 19:35:13,742 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004137 -0.13506024 0.34363615] -2025-05-16 19:35:13,743 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06978581e-01 7.07234528e-01 7.73275272e-04 1.06002843e-04] -2025-05-16 19:35:13,778 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004134 -0.13506001 0.34363589] -2025-05-16 19:35:13,780 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06978802e-01 7.07234307e-01 7.72664091e-04 1.06601284e-04] -2025-05-16 19:35:13,809 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004087 -0.13505914 0.34363625] -2025-05-16 19:35:13,811 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06978467e-01 7.07234645e-01 7.69692756e-04 1.07049140e-04] -2025-05-16 19:35:13,842 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004111 -0.13505767 0.34363566] -2025-05-16 19:35:13,844 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06979182e-01 7.07233932e-01 7.68709319e-04 1.05306309e-04] -2025-05-16 19:35:13,876 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2500409 -0.13505762 0.34363569] -2025-05-16 19:35:13,878 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06979367e-01 7.07233748e-01 7.67368051e-04 1.05989361e-04] -2025-05-16 19:35:13,919 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004081 -0.1350567 0.34363549] -2025-05-16 19:35:13,921 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06979752e-01 7.07233365e-01 7.66004135e-04 1.05854885e-04] -2025-05-16 19:35:13,954 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004102 -0.13505549 0.34363645] -2025-05-16 19:35:13,956 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06979554e-01 7.07233566e-01 7.62827290e-04 1.06683801e-04] -2025-05-16 19:35:13,989 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2500408 -0.135056 0.34363569] -2025-05-16 19:35:13,991 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06979351e-01 7.07233769e-01 7.62977244e-04 1.06288848e-04] -2025-05-16 19:35:14,031 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004068 -0.13505523 0.34363585] -2025-05-16 19:35:14,033 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06979518e-01 7.07233604e-01 7.60956765e-04 1.06506504e-04] -2025-05-16 19:35:14,060 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004038 -0.1350546 0.34363538] -2025-05-16 19:35:14,061 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06979681e-01 7.07233442e-01 7.59734808e-04 1.05231183e-04] -2025-05-16 19:35:14,120 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25002527 -0.13505278 0.3436208 ] -2025-05-16 19:35:14,122 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06981866e-01 7.07231278e-01 7.39212379e-04 1.20769713e-04] -2025-05-16 19:35:14,156 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25002681 -0.13505306 0.34362095] -2025-05-16 19:35:14,157 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06981831e-01 7.07231314e-01 7.38433791e-04 1.19973311e-04] -2025-05-16 19:35:14,193 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25003085 -0.1350527 0.343636 ] -2025-05-16 19:35:14,195 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06983810e-01 7.07229348e-01 7.23293931e-04 1.35489900e-04] -2025-05-16 19:35:14,232 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2500344 -0.1350523 0.34363569] -2025-05-16 19:35:14,234 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06985459e-01 7.07227699e-01 7.24097223e-04 1.33458533e-04] -2025-05-16 19:35:14,260 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25003274 -0.13505468 0.34363528] -2025-05-16 19:35:14,261 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06985083e-01 7.07228077e-01 7.21377495e-04 1.35621697e-04] -2025-05-16 19:35:14,288 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25002003 -0.13505279 0.34362279] -2025-05-16 19:35:14,289 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06988463e-01 7.07224704e-01 7.14662830e-04 1.41319906e-04] -2025-05-16 19:35:14,317 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25002695 -0.13505476 0.34363582] -2025-05-16 19:35:14,318 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06989249e-01 7.07223929e-01 7.01914497e-04 1.53568381e-04] -2025-05-16 19:35:14,344 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25002855 -0.13505564 0.34363413] -2025-05-16 19:35:14,346 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06990178e-01 7.07223000e-01 7.02921914e-04 1.53237878e-04] -2025-05-16 19:35:14,374 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2500286 -0.13505709 0.34363383] -2025-05-16 19:35:14,376 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06990118e-01 7.07223057e-01 7.04207062e-04 1.53874134e-04] -2025-05-16 19:35:14,409 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25002718 -0.13505896 0.34363204] -2025-05-16 19:35:14,411 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06991276e-01 7.07221912e-01 6.88269626e-04 1.71036675e-04] -2025-05-16 19:35:14,442 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25003032 -0.13505873 0.34364106] -2025-05-16 19:35:14,443 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06991917e-01 7.07221281e-01 6.74594085e-04 1.83349307e-04] -2025-05-16 19:35:14,480 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25003248 -0.13505785 0.34364186] -2025-05-16 19:35:14,481 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06992338e-01 7.07220860e-01 6.74972205e-04 1.82768175e-04] -2025-05-16 19:35:14,511 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25003228 -0.13505829 0.34364157] -2025-05-16 19:35:14,520 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06992065e-01 7.07221133e-01 6.75673305e-04 1.81406445e-04] -2025-05-16 19:35:14,550 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2500319 -0.13505755 0.34364207] -2025-05-16 19:35:14,553 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06992838e-01 7.07220361e-01 6.74370171e-04 1.82128203e-04] -2025-05-16 19:35:14,584 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25003158 -0.1350582 0.34364183] -2025-05-16 19:35:14,586 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06992960e-01 7.07220239e-01 6.74328089e-04 1.81888431e-04] -2025-05-16 19:35:14,617 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25003207 -0.13505925 0.34364164] -2025-05-16 19:35:14,618 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06993038e-01 7.07220160e-01 6.75684377e-04 1.81638822e-04] -2025-05-16 19:35:14,659 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25003273 -0.13505767 0.34364128] -2025-05-16 19:35:14,661 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06993825e-01 7.07219375e-01 6.74554083e-04 1.80681927e-04] -2025-05-16 19:35:14,703 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25003161 -0.13505563 0.3436404 ] -2025-05-16 19:35:14,703 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06994987e-01 7.07218214e-01 6.73425983e-04 1.78703991e-04] -2025-05-16 19:35:14,735 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25003022 -0.13505601 0.34363971] -2025-05-16 19:35:14,735 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06995067e-01 7.07218135e-01 6.72978371e-04 1.78687857e-04] -2025-05-16 19:35:14,764 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25003034 -0.13505506 0.34363882] -2025-05-16 19:35:14,765 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06995852e-01 7.07217350e-01 6.73117522e-04 1.77242385e-04] -2025-05-16 19:35:14,794 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2500313 -0.13505572 0.34363864] -2025-05-16 19:35:14,795 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06995793e-01 7.07217410e-01 6.73050017e-04 1.76202206e-04] -2025-05-16 19:35:14,827 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25003058 -0.13505492 0.34363842] -2025-05-16 19:35:14,830 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06995735e-01 7.07217469e-01 6.72100437e-04 1.74583319e-04] -2025-05-16 19:35:14,864 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25002997 -0.13505442 0.34363801] -2025-05-16 19:35:14,866 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06996709e-01 7.07216495e-01 6.71948750e-04 1.74478082e-04] -2025-05-16 19:35:14,895 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25002864 -0.13505464 0.34363725] -2025-05-16 19:35:14,897 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06996979e-01 7.07216227e-01 6.71292830e-04 1.73327273e-04] -2025-05-16 19:35:14,924 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25002814 -0.13505482 0.34363732] -2025-05-16 19:35:14,925 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06997623e-01 7.07215584e-01 6.70324818e-04 1.73909011e-04] -2025-05-16 19:35:14,954 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25002697 -0.1350565 0.3436368 ] -2025-05-16 19:35:14,956 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06997703e-01 7.07215504e-01 6.69672101e-04 1.73789710e-04] -2025-05-16 19:35:14,984 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2500261 -0.13505501 0.34363638] -2025-05-16 19:35:14,987 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06998348e-01 7.07214860e-01 6.68955221e-04 1.73654783e-04] -2025-05-16 19:35:15,016 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25002523 -0.13505368 0.34363642] -2025-05-16 19:35:15,017 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06998101e-01 7.07215108e-01 6.67323079e-04 1.73021483e-04] -2025-05-16 19:35:15,045 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25002458 -0.13505357 0.34363613] -2025-05-16 19:35:15,046 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06998044e-01 7.07215167e-01 6.66481578e-04 1.73213753e-04] -2025-05-16 19:35:15,072 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25002361 -0.1350544 0.34363562] -2025-05-16 19:35:15,081 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06998503e-01 7.07214708e-01 6.66172416e-04 1.73017417e-04] -2025-05-16 19:35:15,113 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25002451 -0.13505479 0.34363545] -2025-05-16 19:35:15,115 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06997931e-01 7.07215281e-01 6.65918580e-04 1.72398728e-04] -2025-05-16 19:35:15,145 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25002464 -0.13505473 0.34363588] -2025-05-16 19:35:15,148 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06998205e-01 7.07215007e-01 6.64543020e-04 1.72782925e-04] -2025-05-16 19:35:15,177 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25002467 -0.13505493 0.34363599] -2025-05-16 19:35:15,179 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06998480e-01 7.07214732e-01 6.64468143e-04 1.73703511e-04] -2025-05-16 19:35:15,211 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25002436 -0.13505412 0.34363557] -2025-05-16 19:35:15,219 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06999131e-01 7.07214083e-01 6.63093481e-04 1.72607416e-04] -2025-05-16 19:35:15,249 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25002436 -0.13505367 0.34363629] -2025-05-16 19:35:15,253 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06999593e-01 7.07213623e-01 6.61215030e-04 1.73367894e-04] -2025-05-16 19:35:15,287 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2500237 -0.13505316 0.3436353 ] -2025-05-16 19:35:15,294 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06999352e-01 7.07213865e-01 6.60431863e-04 1.71856350e-04] -2025-05-16 19:35:15,323 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25002325 -0.13505188 0.34363517] -2025-05-16 19:35:15,331 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06999816e-01 7.07213403e-01 6.58999842e-04 1.71040009e-04] -2025-05-16 19:35:15,365 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25002275 -0.13505172 0.34363451] -2025-05-16 19:35:15,367 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06999763e-01 7.07213456e-01 6.58705185e-04 1.70426627e-04] -2025-05-16 19:35:15,401 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25002256 -0.13505094 0.34363448] -2025-05-16 19:35:15,402 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07000041e-01 7.07213180e-01 6.57387588e-04 1.69721833e-04] -2025-05-16 19:35:15,437 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2500225 -0.13505002 0.34363457] -2025-05-16 19:35:15,442 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06999661e-01 7.07213560e-01 6.56108556e-04 1.69788104e-04] -2025-05-16 19:35:15,473 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25002205 -0.1350492 0.34363435] -2025-05-16 19:35:15,474 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06999613e-01 7.07213610e-01 6.54407123e-04 1.68660692e-04] -2025-05-16 19:35:15,515 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25002215 -0.1350498 0.3436343 ] -2025-05-16 19:35:15,518 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06999565e-01 7.07213659e-01 6.53378095e-04 1.68559768e-04] -2025-05-16 19:35:15,550 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25002211 -0.1350519 0.34363461] -2025-05-16 19:35:15,551 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06999517e-01 7.07213707e-01 6.52737216e-04 1.69765883e-04] -2025-05-16 19:35:15,588 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25002208 -0.13505229 0.34363426] -2025-05-16 19:35:15,592 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06999800e-01 7.07213424e-01 6.52944343e-04 1.69542359e-04] -2025-05-16 19:35:15,621 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25002206 -0.13505145 0.34363439] -2025-05-16 19:35:15,631 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07000049e-01 7.07213177e-01 6.51915140e-04 1.69754255e-04] -2025-05-16 19:35:15,660 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25002175 -0.13505176 0.34363414] -2025-05-16 19:35:15,661 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07000173e-01 7.07213053e-01 6.51202394e-04 1.69134073e-04] -2025-05-16 19:35:15,694 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25002221 -0.13505243 0.34363477] -2025-05-16 19:35:15,695 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07000213e-01 7.07213015e-01 6.49675318e-04 1.69557883e-04] -2025-05-16 19:35:15,726 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25002181 -0.13505233 0.34363411] -2025-05-16 19:35:15,727 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07000516e-01 7.07212711e-01 6.50246034e-04 1.70178752e-04] -2025-05-16 19:35:15,757 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25002191 -0.13505393 0.3436345 ] -2025-05-16 19:35:15,759 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06999935e-01 7.07213292e-01 6.49061565e-04 1.70716550e-04] -2025-05-16 19:35:15,788 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25002168 -0.13505516 0.34363438] -2025-05-16 19:35:15,792 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06999880e-01 7.07213346e-01 6.49794724e-04 1.71647753e-04] -2025-05-16 19:35:15,820 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25002168 -0.13505452 0.34363377] -2025-05-16 19:35:15,823 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07000164e-01 7.07213063e-01 6.49402295e-04 1.71247981e-04] -2025-05-16 19:35:15,853 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25002191 -0.13505328 0.34363435] -2025-05-16 19:35:15,854 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06999795e-01 7.07213434e-01 6.47807017e-04 1.71131249e-04] -2025-05-16 19:35:15,883 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25002168 -0.135052 0.34363423] -2025-05-16 19:35:15,885 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06999758e-01 7.07213472e-01 6.47017299e-04 1.70297776e-04] -2025-05-16 19:35:15,919 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25002171 -0.1350528 0.343634 ] -2025-05-16 19:35:15,922 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07000708e-01 7.07212522e-01 6.46803261e-04 1.70774711e-04] -2025-05-16 19:35:15,952 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2500217 -0.13505297 0.34363406] -2025-05-16 19:35:15,954 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07000014e-01 7.07213217e-01 6.46340276e-04 1.71362592e-04] -2025-05-16 19:35:15,988 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25002182 -0.1350522 0.3436346 ] -2025-05-16 19:35:16,001 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06999793e-01 7.07213438e-01 6.44898906e-04 1.71515977e-04] -2025-05-16 19:35:16,037 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25002176 -0.13505103 0.34363421] -2025-05-16 19:35:16,040 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07000607e-01 7.07212626e-01 6.43833592e-04 1.70147848e-04] -2025-05-16 19:35:16,070 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2500239 -0.13505245 0.34363388] -2025-05-16 19:35:16,081 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06999588e-01 7.07213643e-01 6.45486083e-04 1.69059904e-04] -2025-05-16 19:35:16,114 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25002426 -0.13505434 0.34363386] -2025-05-16 19:35:16,116 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06999558e-01 7.07213672e-01 6.46894273e-04 1.69752037e-04] -2025-05-16 19:35:16,145 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25002471 -0.13505606 0.34363381] -2025-05-16 19:35:16,148 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07000186e-01 7.07213043e-01 6.47932122e-04 1.70467321e-04] -2025-05-16 19:35:16,199 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25002591 -0.13505799 0.34363408] -2025-05-16 19:35:16,203 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06999826e-01 7.07213401e-01 6.49432004e-04 1.71408087e-04] -2025-05-16 19:35:16,239 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25002626 -0.13505964 0.34363398] -2025-05-16 19:35:16,251 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07000313e-01 7.07212913e-01 6.50887072e-04 1.72029092e-04] -2025-05-16 19:35:16,280 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25002727 -0.13505962 0.34363434] -2025-05-16 19:35:16,282 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07000096e-01 7.07213129e-01 6.52306274e-04 1.72271533e-04] -2025-05-16 19:35:16,308 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25002895 -0.13506011 0.34363439] -2025-05-16 19:35:16,310 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07000255e-01 7.07212968e-01 6.53775477e-04 1.71752276e-04] -2025-05-16 19:35:16,336 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25003063 -0.13505899 0.34363426] -2025-05-16 19:35:16,338 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06999711e-01 7.07213510e-01 6.56329435e-04 1.71006614e-04] -2025-05-16 19:35:16,364 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25003099 -0.13505962 0.34363393] -2025-05-16 19:35:16,366 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07000014e-01 7.07213205e-01 6.58281213e-04 1.69601502e-04] -2025-05-16 19:35:16,393 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25003081 -0.135059 0.34363435] -2025-05-16 19:35:16,394 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06999472e-01 7.07213747e-01 6.58931395e-04 1.69684082e-04] -2025-05-16 19:35:16,430 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25003062 -0.13505922 0.34363364] -2025-05-16 19:35:16,432 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06999824e-01 7.07213393e-01 6.60961967e-04 1.69091750e-04] -2025-05-16 19:35:16,465 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25003193 -0.13505989 0.34363421] -2025-05-16 19:35:16,466 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07000268e-01 7.07212947e-01 6.62518814e-04 1.69204677e-04] -2025-05-16 19:35:16,498 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25003242 -0.13506078 0.34363406] -2025-05-16 19:35:16,501 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06999914e-01 7.07213299e-01 6.64679701e-04 1.69177018e-04] -2025-05-16 19:35:16,533 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25003386 -0.13506154 0.3436345 ] -2025-05-16 19:35:16,536 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07000078e-01 7.07213134e-01 6.66831193e-04 1.69035311e-04] -2025-05-16 19:35:16,569 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2500353 -0.13506244 0.34363405] -2025-05-16 19:35:16,570 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07000054e-01 7.07213155e-01 6.70135935e-04 1.67759279e-04] -2025-05-16 19:35:16,600 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25003655 -0.13506329 0.3436347 ] -2025-05-16 19:35:16,601 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06999843e-01 7.07213364e-01 6.72512921e-04 1.67751287e-04] -2025-05-16 19:35:16,635 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25003771 -0.13506365 0.34363438] -2025-05-16 19:35:16,637 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07000149e-01 7.07213055e-01 6.75852707e-04 1.66431704e-04] -2025-05-16 19:35:16,670 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2500389 -0.13506392 0.34363438] -2025-05-16 19:35:16,672 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07000126e-01 7.07213075e-01 6.78746122e-04 1.66500427e-04] -2025-05-16 19:35:16,704 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004783 -0.13506549 0.34363134] -2025-05-16 19:35:16,715 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07003524e-01 7.07209691e-01 6.60037475e-04 1.84007000e-04] -2025-05-16 19:35:16,747 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2500487 -0.13506535 0.34363154] -2025-05-16 19:35:16,749 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07004336e-01 7.07208878e-01 6.62628947e-04 1.83321823e-04] -2025-05-16 19:35:16,779 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2500491 -0.13506622 0.34363148] -2025-05-16 19:35:16,782 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07003644e-01 7.07209567e-01 6.64599858e-04 1.83223827e-04] -2025-05-16 19:35:16,810 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004934 -0.13506655 0.34363185] -2025-05-16 19:35:16,812 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07003753e-01 7.07209457e-01 6.66956212e-04 1.82642424e-04] -2025-05-16 19:35:16,847 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006163 -0.13506781 0.34363391] -2025-05-16 19:35:16,849 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07006437e-01 7.07206784e-01 6.50160501e-04 2.01145780e-04] -2025-05-16 19:35:16,880 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2500617 -0.13506784 0.34363393] -2025-05-16 19:35:16,882 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07007757e-01 7.07205462e-01 6.52137064e-04 2.01170518e-04] -2025-05-16 19:35:16,915 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006158 -0.1350681 0.34363361] -2025-05-16 19:35:16,918 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07010576e-01 7.07202642e-01 6.54162685e-04 2.00741109e-04] -2025-05-16 19:35:16,953 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006117 -0.13506833 0.34363365] -2025-05-16 19:35:16,954 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07012728e-01 7.07200489e-01 6.55596281e-04 2.01253292e-04] -2025-05-16 19:35:16,985 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006949 -0.13506921 0.34363662] -2025-05-16 19:35:16,987 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07025194e-01 7.07188034e-01 6.43524205e-04 2.13410692e-04] -2025-05-16 19:35:17,018 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006818 -0.13506865 0.3436381 ] -2025-05-16 19:35:17,019 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07028284e-01 7.07184944e-01 6.43795926e-04 2.14551084e-04] -2025-05-16 19:35:17,050 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006779 -0.13506864 0.34363838] -2025-05-16 19:35:17,052 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07032258e-01 7.07180970e-01 6.44935987e-04 2.14697419e-04] -2025-05-16 19:35:17,082 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006803 -0.13506849 0.34363813] -2025-05-16 19:35:17,085 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07033453e-01 7.07179775e-01 6.46252069e-04 2.13454412e-04] -2025-05-16 19:35:17,117 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006678 -0.13506843 0.34363784] -2025-05-16 19:35:17,119 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07036897e-01 7.07176330e-01 6.47186593e-04 2.13789355e-04] -2025-05-16 19:35:17,150 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006434 -0.13506729 0.34363627] -2025-05-16 19:35:17,152 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07035595e-01 7.07177632e-01 6.47754174e-04 2.11694988e-04] -2025-05-16 19:35:17,184 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006322 -0.13506486 0.34363704] -2025-05-16 19:35:17,186 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07035801e-01 7.07177428e-01 6.45225874e-04 2.12748188e-04] -2025-05-16 19:35:17,219 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006133 -0.13506401 0.34363667] -2025-05-16 19:35:17,234 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07035165e-01 7.07178064e-01 6.44610169e-04 2.12593622e-04] -2025-05-16 19:35:17,262 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005964 -0.13506496 0.34363583] -2025-05-16 19:35:17,264 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07034720e-01 7.07178509e-01 6.44533396e-04 2.13012586e-04] -2025-05-16 19:35:17,298 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005935 -0.1350648 0.34363607] -2025-05-16 19:35:17,301 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07033952e-01 7.07179278e-01 6.43730082e-04 2.12776420e-04] -2025-05-16 19:35:17,329 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005903 -0.13506312 0.34363556] -2025-05-16 19:35:17,331 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07033846e-01 7.07179385e-01 6.42672599e-04 2.11752296e-04] -2025-05-16 19:35:17,361 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005813 -0.13506293 0.34363532] -2025-05-16 19:35:17,362 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07033038e-01 7.07180194e-01 6.41691701e-04 2.11766784e-04] -2025-05-16 19:35:17,397 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005704 -0.1350634 0.34363463] -2025-05-16 19:35:17,399 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07033455e-01 7.07179777e-01 6.41279801e-04 2.11131401e-04] -2025-05-16 19:35:17,430 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005648 -0.13506268 0.34363429] -2025-05-16 19:35:17,431 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07031997e-01 7.07181236e-01 6.40460342e-04 2.10785962e-04] -2025-05-16 19:35:17,463 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005697 -0.13506169 0.34363419] -2025-05-16 19:35:17,466 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07031391e-01 7.07181844e-01 6.39282997e-04 2.09749992e-04] -2025-05-16 19:35:17,494 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005807 -0.13506157 0.34363407] -2025-05-16 19:35:17,497 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07030976e-01 7.07182259e-01 6.38864375e-04 2.08561109e-04] -2025-05-16 19:35:17,529 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005941 -0.13506281 0.34363366] -2025-05-16 19:35:17,531 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07030751e-01 7.07182483e-01 6.40176569e-04 2.07351356e-04] -2025-05-16 19:35:17,565 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005954 -0.13506495 0.3436342 ] -2025-05-16 19:35:17,568 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07030294e-01 7.07182940e-01 6.39594777e-04 2.08580961e-04] -2025-05-16 19:35:17,601 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005879 -0.13506676 0.34363316] -2025-05-16 19:35:17,603 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07029887e-01 7.07183346e-01 6.41301444e-04 2.08170624e-04] -2025-05-16 19:35:17,633 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005769 -0.13506828 0.34363318] -2025-05-16 19:35:17,635 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07029483e-01 7.07183749e-01 6.41742050e-04 2.09336042e-04] -2025-05-16 19:35:17,666 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005676 -0.13506896 0.34363308] -2025-05-16 19:35:17,668 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07029222e-01 7.07184009e-01 6.41298510e-04 2.10092425e-04] -2025-05-16 19:35:17,697 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005594 -0.13506818 0.34363372] -2025-05-16 19:35:17,699 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07028496e-01 7.07184737e-01 6.40012945e-04 2.11946497e-04] -2025-05-16 19:35:17,729 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005546 -0.13506774 0.34363348] -2025-05-16 19:35:17,730 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07028430e-01 7.07184803e-01 6.39076220e-04 2.11788940e-04] -2025-05-16 19:35:17,762 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005466 -0.13506668 0.3436331 ] -2025-05-16 19:35:17,764 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07027850e-01 7.07185383e-01 6.38350044e-04 2.11656959e-04] -2025-05-16 19:35:17,796 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005413 -0.13506569 0.34363297] -2025-05-16 19:35:17,798 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07027603e-01 7.07185632e-01 6.36941063e-04 2.10646347e-04] -2025-05-16 19:35:17,826 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005371 -0.13506548 0.3436336 ] -2025-05-16 19:35:17,828 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07027216e-01 7.07186021e-01 6.35010814e-04 2.11860475e-04] -2025-05-16 19:35:17,860 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2500534 -0.13506411 0.34363321] -2025-05-16 19:35:17,862 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07027349e-01 7.07185890e-01 6.33381947e-04 2.10756754e-04] -2025-05-16 19:35:17,897 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005401 -0.13506245 0.3436339 ] -2025-05-16 19:35:17,899 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07026966e-01 7.07186275e-01 6.30989762e-04 2.11500049e-04] -2025-05-16 19:35:17,933 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005296 -0.13506388 0.34363315] -2025-05-16 19:35:17,935 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07025881e-01 7.07187359e-01 6.31183222e-04 2.11430123e-04] -2025-05-16 19:35:17,966 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005316 -0.13506539 0.34363321] -2025-05-16 19:35:17,969 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07026161e-01 7.07187079e-01 6.30563389e-04 2.12590271e-04] -2025-05-16 19:35:17,998 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005308 -0.13506568 0.34363269] -2025-05-16 19:35:18,000 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07025973e-01 7.07187267e-01 6.30780666e-04 2.12490892e-04] -2025-05-16 19:35:18,036 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005322 -0.13506549 0.34363318] -2025-05-16 19:35:18,039 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07025223e-01 7.07188018e-01 6.28965642e-04 2.12960693e-04] -2025-05-16 19:35:18,080 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005239 -0.13506441 0.34363333] -2025-05-16 19:35:18,081 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07024372e-01 7.07188871e-01 6.26776411e-04 2.12460550e-04] -2025-05-16 19:35:18,110 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005231 -0.13506259 0.34363268] -2025-05-16 19:35:18,114 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07024218e-01 7.07189026e-01 6.25883639e-04 2.11533928e-04] -2025-05-16 19:35:18,146 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005231 -0.13506133 0.34363299] -2025-05-16 19:35:18,147 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07024194e-01 7.07189053e-01 6.23236236e-04 2.11077449e-04] -2025-05-16 19:35:18,183 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005213 -0.1350604 0.34363243] -2025-05-16 19:35:18,185 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07023132e-01 7.07190115e-01 6.22052935e-04 2.09800570e-04] -2025-05-16 19:35:18,223 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005511 -0.13506033 0.3436348 ] -2025-05-16 19:35:18,226 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07023760e-01 7.07189489e-01 6.21405002e-04 2.09304003e-04] -2025-05-16 19:35:18,258 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004311 -0.13505894 0.34362602] -2025-05-16 19:35:18,261 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07026776e-01 7.07186479e-01 6.12862154e-04 2.14418599e-04] -2025-05-16 19:35:18,291 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004469 -0.13506064 0.34362617] -2025-05-16 19:35:18,298 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07027109e-01 7.07186146e-01 6.14129484e-04 2.13013975e-04] -2025-05-16 19:35:18,331 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004771 -0.13506165 0.34362736] -2025-05-16 19:35:18,337 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07027534e-01 7.07185721e-01 6.13807990e-04 2.13395896e-04] -2025-05-16 19:35:18,371 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2500502 -0.13506247 0.34362673] -2025-05-16 19:35:18,375 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07027536e-01 7.07185718e-01 6.15327007e-04 2.12155934e-04] -2025-05-16 19:35:18,404 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25003976 -0.13506181 0.34361931] -2025-05-16 19:35:18,406 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07030023e-01 7.07183235e-01 6.09323761e-04 2.17370688e-04] -2025-05-16 19:35:18,437 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004113 -0.13506493 0.34362134] -2025-05-16 19:35:18,442 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07029782e-01 7.07183476e-01 6.08454679e-04 2.20635438e-04] -2025-05-16 19:35:18,470 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004067 -0.13506544 0.34362152] -2025-05-16 19:35:18,471 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07030764e-01 7.07182493e-01 6.09008256e-04 2.20341680e-04] -2025-05-16 19:35:18,502 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004202 -0.13506474 0.34362352] -2025-05-16 19:35:18,503 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07031556e-01 7.07181701e-01 6.09254388e-04 2.20826538e-04] -2025-05-16 19:35:18,532 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004347 -0.13506133 0.34362415] -2025-05-16 19:35:18,533 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07033004e-01 7.07180254e-01 6.08849018e-04 2.18620867e-04] -2025-05-16 19:35:18,570 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004374 -0.13505978 0.34362427] -2025-05-16 19:35:18,571 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07033276e-01 7.07179983e-01 6.08724343e-04 2.17640124e-04] -2025-05-16 19:35:18,610 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004234 -0.13506087 0.34362544] -2025-05-16 19:35:18,612 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07032749e-01 7.07180510e-01 6.08171564e-04 2.18173042e-04] -2025-05-16 19:35:18,648 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004165 -0.13506036 0.3436272 ] -2025-05-16 19:35:18,651 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07032835e-01 7.07180425e-01 6.06937507e-04 2.18670186e-04] -2025-05-16 19:35:18,682 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004015 -0.13505914 0.34362718] -2025-05-16 19:35:18,695 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07033298e-01 7.07179962e-01 6.06780033e-04 2.18214240e-04] -2025-05-16 19:35:18,727 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2500411 -0.13505909 0.34362711] -2025-05-16 19:35:18,730 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07033057e-01 7.07180205e-01 6.05901843e-04 2.18803217e-04] -2025-05-16 19:35:18,763 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004088 -0.13506012 0.34362705] -2025-05-16 19:35:18,766 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07033380e-01 7.07179881e-01 6.05791388e-04 2.18939341e-04] -2025-05-16 19:35:18,793 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25003957 -0.13506199 0.34362778] -2025-05-16 19:35:18,795 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07032624e-01 7.07180638e-01 6.05342728e-04 2.19793310e-04] -2025-05-16 19:35:18,826 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25003898 -0.13506316 0.34362795] -2025-05-16 19:35:18,829 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07032903e-01 7.07180357e-01 6.05757724e-04 2.20991810e-04] -2025-05-16 19:35:18,860 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25003983 -0.13506151 0.34362746] -2025-05-16 19:35:18,863 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07033372e-01 7.07179890e-01 6.05476643e-04 2.20412287e-04] -2025-05-16 19:35:18,896 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2500395 -0.13506096 0.3436272 ] -2025-05-16 19:35:18,898 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07033323e-01 7.07179939e-01 6.04338785e-04 2.20357466e-04] -2025-05-16 19:35:18,934 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25003882 -0.13506109 0.34362676] -2025-05-16 19:35:18,937 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07032431e-01 7.07180832e-01 6.03699470e-04 2.21129105e-04] -2025-05-16 19:35:18,968 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25003786 -0.13506244 0.34362618] -2025-05-16 19:35:18,970 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07032246e-01 7.07181016e-01 6.03129384e-04 2.21956643e-04] -2025-05-16 19:35:19,002 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25003781 -0.13506195 0.34362591] -2025-05-16 19:35:19,003 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07032532e-01 7.07180730e-01 6.03141064e-04 2.22952844e-04] -2025-05-16 19:35:19,032 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25003676 -0.13506261 0.34362567] -2025-05-16 19:35:19,035 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07032680e-01 7.07180583e-01 6.02451454e-04 2.24360720e-04] -2025-05-16 19:35:19,064 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25003736 -0.1350622 0.34362518] -2025-05-16 19:35:19,067 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07032639e-01 7.07180623e-01 6.03136806e-04 2.23505308e-04] -2025-05-16 19:35:19,098 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004017 -0.13506024 0.34362607] -2025-05-16 19:35:19,099 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07033443e-01 7.07179820e-01 6.02133678e-04 2.24011614e-04] -2025-05-16 19:35:19,135 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004206 -0.13505836 0.34362468] -2025-05-16 19:35:19,137 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07033027e-01 7.07180236e-01 6.03861070e-04 2.20406371e-04] -2025-05-16 19:35:19,165 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004201 -0.13505773 0.34362481] -2025-05-16 19:35:19,167 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07033175e-01 7.07180089e-01 6.02948904e-04 2.19730702e-04] -2025-05-16 19:35:19,198 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004164 -0.13505808 0.34362523] -2025-05-16 19:35:19,202 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07033135e-01 7.07180129e-01 6.01907544e-04 2.19946296e-04] -2025-05-16 19:35:19,234 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004104 -0.13505824 0.34362522] -2025-05-16 19:35:19,235 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07032287e-01 7.07180977e-01 6.01674443e-04 2.19421289e-04] -2025-05-16 19:35:19,266 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004185 -0.13505706 0.34362509] -2025-05-16 19:35:19,267 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07032465e-01 7.07180800e-01 6.01511588e-04 2.18603203e-04] -2025-05-16 19:35:19,297 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004371 -0.13505534 0.34362556] -2025-05-16 19:35:19,299 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07032772e-01 7.07180494e-01 6.01326634e-04 2.17040789e-04] -2025-05-16 19:35:19,330 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004288 -0.13505701 0.34362488] -2025-05-16 19:35:19,331 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07032039e-01 7.07181227e-01 6.01132368e-04 2.16287757e-04] -2025-05-16 19:35:19,364 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2500426 -0.13505799 0.34362503] -2025-05-16 19:35:19,369 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07032198e-01 7.07181067e-01 6.01673901e-04 2.16751025e-04] -2025-05-16 19:35:19,399 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004265 -0.13505964 0.34362764] -2025-05-16 19:35:19,403 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07031980e-01 7.07181285e-01 6.01979170e-04 2.16782938e-04] -2025-05-16 19:35:19,432 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004447 -0.13505927 0.34363078] -2025-05-16 19:35:19,436 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07031810e-01 7.07181456e-01 6.02245447e-04 2.14631191e-04] -2025-05-16 19:35:19,466 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004627 -0.13505767 0.34363216] -2025-05-16 19:35:19,469 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07032297e-01 7.07180969e-01 6.02626428e-04 2.12631831e-04] -2025-05-16 19:35:19,499 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004547 -0.1350601 0.34363322] -2025-05-16 19:35:19,502 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07031469e-01 7.07181796e-01 6.03425082e-04 2.12501724e-04] -2025-05-16 19:35:19,535 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004447 -0.135063 0.34363745] -2025-05-16 19:35:19,538 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07030959e-01 7.07182306e-01 6.03752238e-04 2.12152095e-04] -2025-05-16 19:35:19,569 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004213 -0.1350658 0.34364296] -2025-05-16 19:35:19,574 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07030656e-01 7.07182608e-01 6.05200950e-04 2.13191235e-04] -2025-05-16 19:35:19,602 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25003822 -0.13506695 0.34364686] -2025-05-16 19:35:19,604 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07031126e-01 7.07182136e-01 6.07221756e-04 2.11552687e-04] -2025-05-16 19:35:19,635 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25003143 -0.13506955 0.34365093] -2025-05-16 19:35:19,638 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07029756e-01 7.07183505e-01 6.07348955e-04 2.10793908e-04] -2025-05-16 19:35:19,670 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25001741 -0.13508054 0.34366917] -2025-05-16 19:35:19,672 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07029860e-01 7.07183407e-01 6.00468866e-04 2.11299379e-04] -2025-05-16 19:35:19,702 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24999871 -0.13509005 0.34368033] -2025-05-16 19:35:19,705 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07030437e-01 7.07182832e-01 5.99558138e-04 2.09863976e-04] -2025-05-16 19:35:19,749 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24998024 -0.13509937 0.3436951 ] -2025-05-16 19:35:19,770 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07030661e-01 7.07182609e-01 5.98537836e-04 2.08196600e-04] -2025-05-16 19:35:19,807 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24997813 -0.13510371 0.34370833] -2025-05-16 19:35:19,808 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07030032e-01 7.07183239e-01 5.98099816e-04 2.07395337e-04] -2025-05-16 19:35:19,839 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24995137 -0.13510991 0.34375089] -2025-05-16 19:35:19,839 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07022348e-01 7.07190924e-01 5.94747675e-04 2.08265974e-04] -2025-05-16 19:35:19,875 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24995691 -0.13511049 0.34377506] -2025-05-16 19:35:19,877 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07021150e-01 7.07192120e-01 5.97373746e-04 2.04455420e-04] -2025-05-16 19:35:19,910 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24995968 -0.13511355 0.34380432] -2025-05-16 19:35:19,912 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07018335e-01 7.07194934e-01 6.00213257e-04 1.99886335e-04] -2025-05-16 19:35:19,942 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24996922 -0.13511603 0.34384081] -2025-05-16 19:35:19,944 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07017801e-01 7.07195468e-01 5.99989713e-04 1.98653827e-04] -2025-05-16 19:35:19,980 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2499513 -0.13512924 0.34393061] -2025-05-16 19:35:19,981 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07007484e-01 7.07205783e-01 6.01217355e-04 1.92691529e-04] -2025-05-16 19:35:20,010 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24995467 -0.13513645 0.34397485] -2025-05-16 19:35:20,012 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07003373e-01 7.07209891e-01 6.05009842e-04 1.85060768e-04] -2025-05-16 19:35:20,054 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24996044 -0.13514778 0.34406973] -2025-05-16 19:35:20,057 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06998142e-01 7.07215125e-01 6.00341124e-04 1.84837292e-04] -2025-05-16 19:35:20,096 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24997407 -0.13515549 0.34416816] -2025-05-16 19:35:20,097 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07000350e-01 7.07212916e-01 6.04543946e-04 1.76557746e-04] -2025-05-16 19:35:20,127 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25000272 -0.13514891 0.34427797] -2025-05-16 19:35:20,129 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06997572e-01 7.07215695e-01 6.03822465e-04 1.71633039e-04] -2025-05-16 19:35:20,161 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25001907 -0.13514195 0.34431579] -2025-05-16 19:35:20,162 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06994530e-01 7.07218743e-01 5.95181307e-04 1.72521054e-04] -2025-05-16 19:35:20,195 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25002769 -0.13513862 0.34434482] -2025-05-16 19:35:20,196 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06993210e-01 7.07220064e-01 5.96309181e-04 1.65234547e-04] -2025-05-16 19:35:20,226 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2500448 -0.13515388 0.34452106] -2025-05-16 19:35:20,228 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06982674e-01 7.07230609e-01 5.81242077e-04 1.60485393e-04] -2025-05-16 19:35:20,257 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006112 -0.13516176 0.34463359] -2025-05-16 19:35:20,260 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06980917e-01 7.07232370e-01 5.83092213e-04 1.34129707e-04] -2025-05-16 19:35:20,289 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25009956 -0.13519381 0.34483446] -2025-05-16 19:35:20,292 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06984870e-01 7.07228486e-01 5.05900946e-04 8.04249392e-05] -2025-05-16 19:35:20,321 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011995 -0.13518477 0.34493775] -2025-05-16 19:35:20,322 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06985926e-01 7.07227437e-01 4.95178677e-04 8.10967369e-05] -2025-05-16 19:35:20,350 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25013674 -0.13517341 0.3450781 ] -2025-05-16 19:35:20,352 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06990746e-01 7.07222613e-01 5.05690764e-04 6.15682368e-05] -2025-05-16 19:35:20,382 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25014881 -0.13517566 0.34528501] -2025-05-16 19:35:20,384 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06990670e-01 7.07222702e-01 4.88094079e-04 6.80028654e-05] -2025-05-16 19:35:20,415 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25017595 -0.13519234 0.34560851] -2025-05-16 19:35:20,418 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06990739e-01 7.07222648e-01 4.67924283e-04 4.84196104e-05] -2025-05-16 19:35:20,445 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25018678 -0.13522182 0.34580579] -2025-05-16 19:35:20,447 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07009509e-01 7.07203923e-01 4.06578977e-04 7.18455063e-06] -2025-05-16 19:35:20,473 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25018428 -0.13522847 0.34593077] -2025-05-16 19:35:20,482 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07010872e-01 7.07202565e-01 3.98904908e-04 6.78096242e-06] -2025-05-16 19:35:20,519 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25022229 -0.13520908 0.34640008] -2025-05-16 19:35:20,521 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07029428e-01 7.07184015e-01 3.95628001e-04 2.12237371e-06] -2025-05-16 19:35:20,549 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25023884 -0.13520502 0.34665085] -2025-05-16 19:35:20,551 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07030232e-01 7.07183215e-01 3.89039248e-04 -3.88574920e-07] -2025-05-16 19:35:20,581 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25027343 -0.13521648 0.34727516] -2025-05-16 19:35:20,583 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07033452e-01 7.07180018e-01 3.46140093e-04 -1.65890870e-05] -2025-05-16 19:35:20,614 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25029139 -0.13523034 0.3476508 ] -2025-05-16 19:35:20,615 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07038464e-01 7.07175027e-01 2.99479998e-04 -3.20350718e-05] -2025-05-16 19:35:20,645 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25032398 -0.13523244 0.34818645] -2025-05-16 19:35:20,654 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07052748e-01 7.07160757e-01 2.68145574e-04 -5.54362319e-05] -2025-05-16 19:35:20,682 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25034113 -0.13521943 0.348474 ] -2025-05-16 19:35:20,683 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07061978e-01 7.07151530e-01 2.61025104e-04 -6.45013193e-05] -2025-05-16 19:35:20,715 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25038052 -0.13520063 0.3491383 ] -2025-05-16 19:35:20,716 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07079505e-01 7.07134007e-01 2.50014199e-04 -8.52007202e-05] -2025-05-16 19:35:20,750 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25041706 -0.13520212 0.34990797] -2025-05-16 19:35:20,756 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07098007e-01 7.07115516e-01 2.07092733e-04 -1.13559410e-04] -2025-05-16 19:35:20,786 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25043848 -0.13520188 0.35037377] -2025-05-16 19:35:20,796 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07108550e-01 -7.07104977e-01 -1.80660100e-04 1.31446684e-04] -2025-05-16 19:35:20,828 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25048675 -0.13517392 0.35111925] -2025-05-16 19:35:20,831 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07138833e-01 -7.07074694e-01 -1.66142077e-04 1.44973213e-04] -2025-05-16 19:35:20,866 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25052286 -0.13514939 0.35174875] -2025-05-16 19:35:20,870 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07097124e-01 7.07116403e-01 1.59707619e-04 -1.54341118e-04] -2025-05-16 19:35:20,902 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25057301 -0.13512047 0.3526452 ] -2025-05-16 19:35:20,903 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07130015e-01 -7.07083520e-01 -1.29053823e-04 1.43712280e-04] -2025-05-16 19:35:20,933 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25058048 -0.13512477 0.35296127] -2025-05-16 19:35:20,934 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07137379e-01 -7.07076160e-01 -1.09115505e-04 1.41500785e-04] -2025-05-16 19:35:20,966 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25061684 -0.13515373 0.35388871] -2025-05-16 19:35:20,968 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07178712e-01 -7.07034792e-01 -2.74701124e-05 2.66092197e-04] -2025-05-16 19:35:20,998 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25063452 -0.13514265 0.35421714] -2025-05-16 19:35:20,999 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07183904e-01 -7.07029595e-01 -2.39464376e-05 2.79042210e-04] -2025-05-16 19:35:21,030 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25068439 -0.13511775 0.35514165] -2025-05-16 19:35:21,032 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07176125e-01 -7.07037348e-01 3.03348345e-06 3.41705453e-04] -2025-05-16 19:35:21,065 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25071394 -0.13509032 0.35559434] -2025-05-16 19:35:21,067 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07187182e-01 -7.07026285e-01 4.81717068e-06 3.48572853e-04] -2025-05-16 19:35:21,102 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25077546 -0.13506489 0.3566825 ] -2025-05-16 19:35:21,105 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07203634e-01 -7.07009834e-01 7.20466517e-05 3.30277880e-04] -2025-05-16 19:35:21,135 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25081824 -0.13505648 0.35744351] -2025-05-16 19:35:21,136 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07251981e-01 -7.06961428e-01 1.26656494e-04 3.99081449e-04] -2025-05-16 19:35:21,168 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25082406 -0.1350501 0.35768638] -2025-05-16 19:35:21,170 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07253479e-01 -7.06959914e-01 1.39258438e-04 4.21565162e-04] -2025-05-16 19:35:21,200 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25085501 -0.13503386 0.35852775] -2025-05-16 19:35:21,202 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07238600e-01 -7.06974712e-01 1.38383533e-04 5.46941050e-04] -2025-05-16 19:35:21,229 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25086978 -0.13501504 0.35896595] -2025-05-16 19:35:21,231 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07254165e-01 -7.06959120e-01 1.46137861e-04 5.72160897e-04] -2025-05-16 19:35:21,264 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25093865 -0.13498218 0.36008508] -2025-05-16 19:35:21,266 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07306325e-01 -7.06906907e-01 2.11904787e-04 5.84272765e-04] -2025-05-16 19:35:21,301 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25098399 -0.13497771 0.36080977] -2025-05-16 19:35:21,304 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07337506e-01 -7.06875676e-01 3.01808384e-04 5.83090147e-04] -2025-05-16 19:35:21,337 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25099343 -0.13496589 0.36159594] -2025-05-16 19:35:21,338 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07349404e-01 -7.06863649e-01 2.98048751e-04 7.16718787e-04] -2025-05-16 19:35:21,365 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25099229 -0.13496622 0.36184982] -2025-05-16 19:35:21,366 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07349966e-01 -7.06863050e-01 3.04981100e-04 7.48867097e-04] -2025-05-16 19:35:21,397 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25099964 -0.13495015 0.36230459] -2025-05-16 19:35:21,399 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07353313e-01 -7.06859658e-01 3.11669399e-04 7.86203707e-04] -2025-05-16 19:35:21,432 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25104234 -0.1349188 0.36329362] -2025-05-16 19:35:21,435 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07389631e-01 -7.06823236e-01 3.43528011e-04 8.39817500e-04] -2025-05-16 19:35:21,469 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25109835 -0.13489284 0.36415689] -2025-05-16 19:35:21,472 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07434277e-01 -7.06778493e-01 4.33448804e-04 8.47163699e-04] -2025-05-16 19:35:21,515 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25111248 -0.13488647 0.36486324] -2025-05-16 19:35:21,521 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07445378e-01 -7.06767227e-01 4.71720587e-04 9.49626713e-04] -2025-05-16 19:35:21,553 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25112307 -0.13486579 0.36516988] -2025-05-16 19:35:21,554 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07444939e-01 -7.06767606e-01 4.76418505e-04 9.91252333e-04] -2025-05-16 19:35:21,585 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25114829 -0.13481494 0.36585423] -2025-05-16 19:35:21,587 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07468432e-01 -7.06743999e-01 4.70769500e-04 1.05639689e-03] -2025-05-16 19:35:21,621 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2511938 -0.13477486 0.36668107] -2025-05-16 19:35:21,624 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07509574e-01 -7.06702718e-01 5.31636016e-04 1.08996823e-03] -2025-05-16 19:35:21,654 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25120077 -0.13476502 0.36702076] -2025-05-16 19:35:21,655 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07528694e-01 -7.06683498e-01 5.59989350e-04 1.12552762e-03] -2025-05-16 19:35:21,685 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25119911 -0.13477384 0.36748809] -2025-05-16 19:35:21,687 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07537164e-01 -7.06674841e-01 5.91014268e-04 1.21718944e-03] -2025-05-16 19:35:21,717 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25120989 -0.13475143 0.36774055] -2025-05-16 19:35:21,718 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07539460e-01 -7.06672487e-01 6.05734785e-04 1.24169658e-03] -2025-05-16 19:35:21,746 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25124678 -0.13469554 0.36826481] -2025-05-16 19:35:21,748 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07556354e-01 -7.06655453e-01 5.93857980e-04 1.31333575e-03] -2025-05-16 19:35:21,782 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2512711 -0.13466471 0.36856955] -2025-05-16 19:35:21,786 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07577718e-01 -7.06633956e-01 6.01222550e-04 1.36495353e-03] -2025-05-16 19:35:21,815 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25129687 -0.13465124 0.3689808 ] -2025-05-16 19:35:21,817 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07596667e-01 -7.06614816e-01 6.56207662e-04 1.42398927e-03] -2025-05-16 19:35:21,848 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25128373 -0.13466956 0.36908338] -2025-05-16 19:35:21,851 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07607244e-01 -7.06603998e-01 6.62020843e-04 1.52970033e-03] -2025-05-16 19:35:21,882 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25127746 -0.13468799 0.36892594] -2025-05-16 19:35:21,884 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07606298e-01 -7.06604885e-01 6.72421119e-04 1.55319479e-03] -2025-05-16 19:35:21,914 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25130522 -0.1346371 0.36934992] -2025-05-16 19:35:21,916 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07629017e-01 -7.06581781e-01 6.67275885e-04 1.70754470e-03] -2025-05-16 19:35:21,962 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25130171 -0.13463644 0.36924686] -2025-05-16 19:35:21,965 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07645921e-01 -7.06564751e-01 6.56689159e-04 1.75275165e-03] -2025-05-16 19:35:21,996 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25130804 -0.13464421 0.36919347] -2025-05-16 19:35:21,999 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07657082e-01 -7.06553343e-01 6.91406174e-04 1.83039612e-03] -2025-05-16 19:35:22,033 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25127672 -0.1346859 0.36880343] -2025-05-16 19:35:22,035 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07654403e-01 -7.06555831e-01 6.85689534e-04 1.90611083e-03] -2025-05-16 19:35:22,065 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25127884 -0.13469615 0.36854526] -2025-05-16 19:35:22,067 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07678610e-01 -7.06531345e-01 6.94502089e-04 1.99020905e-03] -2025-05-16 19:35:22,103 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25126109 -0.13470361 0.36824776] -2025-05-16 19:35:22,106 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07687405e-01 -7.06522378e-01 6.76491481e-04 2.05153824e-03] -2025-05-16 19:35:22,140 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25123596 -0.13472704 0.36784988] -2025-05-16 19:35:22,143 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07688251e-01 -7.06521340e-01 6.59738501e-04 2.12127016e-03] -2025-05-16 19:35:22,172 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25121831 -0.13476844 0.36703804] -2025-05-16 19:35:22,174 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07695186e-01 -7.06514227e-01 6.65036546e-04 2.17464071e-03] -2025-05-16 19:35:22,204 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25120094 -0.13478985 0.36657775] -2025-05-16 19:35:22,206 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07691810e-01 -7.06517364e-01 6.62931545e-04 2.25327590e-03] -2025-05-16 19:35:22,235 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25119284 -0.13480618 0.36620865] -2025-05-16 19:35:22,238 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07689439e-01 -7.06519667e-01 6.63193474e-04 2.27565196e-03] -2025-05-16 19:35:22,279 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25114912 -0.1348483 0.36510364] -2025-05-16 19:35:22,281 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07679780e-01 -7.06529051e-01 6.50617213e-04 2.36756444e-03] -2025-05-16 19:35:22,314 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25113274 -0.13485849 0.36456118] -2025-05-16 19:35:22,316 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07670997e-01 -7.06537792e-01 6.39884091e-04 2.38747756e-03] -2025-05-16 19:35:22,347 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25108074 -0.13489727 0.36350636] -2025-05-16 19:35:22,351 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07685757e-01 -7.06522694e-01 5.94949477e-04 2.48988727e-03] -2025-05-16 19:35:22,382 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25107146 -0.13490118 0.36308618] -2025-05-16 19:35:22,383 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07683390e-01 -7.06525002e-01 5.86233796e-04 2.50947407e-03] -2025-05-16 19:35:22,418 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25105574 -0.13492297 0.36214472] -2025-05-16 19:35:22,419 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07665637e-01 -7.06542692e-01 5.85918197e-04 2.53529372e-03] -2025-05-16 19:35:22,468 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25104286 -0.13495073 0.36094326] -2025-05-16 19:35:22,469 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07648366e-01 -7.06559879e-01 5.93770936e-04 2.56424647e-03] -2025-05-16 19:35:22,503 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25105223 -0.13493671 0.36096049] -2025-05-16 19:35:22,505 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07646537e-01 -7.06561731e-01 5.90565559e-04 2.55924546e-03] -2025-05-16 19:35:22,534 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25094782 -0.13498775 0.35886314] -2025-05-16 19:35:22,537 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07664918e-01 -7.06542810e-01 4.96772571e-04 2.71555544e-03] -2025-05-16 19:35:22,569 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25094257 -0.13499029 0.35858043] -2025-05-16 19:35:22,570 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07657135e-01 -7.06550631e-01 4.97836842e-04 2.70867601e-03] -2025-05-16 19:35:22,597 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25094723 -0.13500213 0.35799362] -2025-05-16 19:35:22,600 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07645848e-01 -7.06561970e-01 4.98385104e-04 2.69972550e-03] -2025-05-16 19:35:22,643 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25095745 -0.13501205 0.35732352] -2025-05-16 19:35:22,645 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07634943e-01 -7.06572994e-01 5.20351324e-04 2.66864305e-03] -2025-05-16 19:35:22,672 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25096272 -0.13501895 0.35677471] -2025-05-16 19:35:22,673 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07630071e-01 -7.06577945e-01 5.32537378e-04 2.64701747e-03] -2025-05-16 19:35:22,700 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25090322 -0.1350262 0.35577654] -2025-05-16 19:35:22,702 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07625426e-01 -7.06582387e-01 4.63840683e-04 2.71523518e-03] -2025-05-16 19:35:22,734 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25084433 -0.13505139 0.35491878] -2025-05-16 19:35:22,734 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07612244e-01 -7.06595283e-01 3.74144159e-04 2.80687662e-03] -2025-05-16 19:35:22,761 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25085175 -0.13505323 0.3545618 ] -2025-05-16 19:35:22,763 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07614359e-01 -7.06593319e-01 4.07611749e-04 2.76302885e-03] -2025-05-16 19:35:22,791 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25086828 -0.13506554 0.35396862] -2025-05-16 19:35:22,793 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07603346e-01 -7.06604420e-01 4.07985377e-04 2.74428862e-03] -2025-05-16 19:35:22,822 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25089092 -0.13505819 0.35371986] -2025-05-16 19:35:22,828 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07605090e-01 -7.06602787e-01 4.26765288e-04 2.71227666e-03] -2025-05-16 19:35:22,859 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25086043 -0.1350749 0.35244533] -2025-05-16 19:35:22,861 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07583297e-01 -7.06624571e-01 4.00403949e-04 2.72626609e-03] -2025-05-16 19:35:22,890 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25083146 -0.13507967 0.35207973] -2025-05-16 19:35:22,898 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07577870e-01 -7.06629845e-01 3.43050408e-04 2.77535937e-03] -2025-05-16 19:35:22,931 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25079701 -0.13509635 0.35139213] -2025-05-16 19:35:22,934 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07567384e-01 -7.06640303e-01 3.13781660e-04 2.78920520e-03] -2025-05-16 19:35:22,965 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25080867 -0.1351133 0.35086519] -2025-05-16 19:35:22,968 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07564638e-01 -7.06643133e-01 3.15864133e-04 2.76872825e-03] -2025-05-16 19:35:23,000 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25082544 -0.13512981 0.35005827] -2025-05-16 19:35:23,005 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07551120e-01 -7.06656879e-01 3.54624349e-04 2.70984037e-03] -2025-05-16 19:35:23,036 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25081528 -0.13513504 0.34982369] -2025-05-16 19:35:23,047 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07547959e-01 -7.06660021e-01 3.33491424e-04 2.71831602e-03] -2025-05-16 19:35:23,076 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25079763 -0.13514697 0.34931779] -2025-05-16 19:35:23,078 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07535764e-01 -7.06672228e-01 3.15133384e-04 2.72118438e-03] -2025-05-16 19:35:23,107 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25075547 -0.13517541 0.34867865] -2025-05-16 19:35:23,111 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07515137e-01 -7.06692784e-01 2.64135974e-04 2.75136303e-03] -2025-05-16 19:35:23,150 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25074947 -0.13518953 0.34819925] -2025-05-16 19:35:23,151 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07506473e-01 -7.06701560e-01 2.72064807e-04 2.72431674e-03] -2025-05-16 19:35:23,204 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25073863 -0.13516547 0.3473951 ] -2025-05-16 19:35:23,205 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07496022e-01 -7.06712447e-01 1.99479835e-04 2.61828465e-03] -2025-05-16 19:35:23,237 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25073655 -0.1351598 0.34746439] -2025-05-16 19:35:23,238 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07495222e-01 -7.06713266e-01 1.97840136e-04 2.61375433e-03] -2025-05-16 19:35:23,265 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25068558 -0.13519187 0.34681361] -2025-05-16 19:35:23,267 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07464202e-01 -7.06744234e-01 1.38736549e-04 2.64030749e-03] -2025-05-16 19:35:23,305 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2506739 -0.13520324 0.34662372] -2025-05-16 19:35:23,308 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07449110e-01 -7.06759444e-01 1.49017959e-04 2.61213792e-03] -2025-05-16 19:35:23,337 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2506671 -0.13520835 0.34618833] -2025-05-16 19:35:23,338 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07440678e-01 -7.06768111e-01 1.45726972e-04 2.55034694e-03] -2025-05-16 19:35:23,365 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25067047 -0.13518452 0.34600172] -2025-05-16 19:35:23,367 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07436531e-01 -7.06772543e-01 1.11909864e-04 2.47269583e-03] -2025-05-16 19:35:23,400 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.250668 -0.13516962 0.3457901 ] -2025-05-16 19:35:23,406 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07426396e-01 -7.06782847e-01 7.65370733e-05 2.42812916e-03] -2025-05-16 19:35:23,439 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25063326 -0.13517874 0.34546075] -2025-05-16 19:35:23,446 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07401382e-01 -7.06807859e-01 1.37461403e-05 2.43631342e-03] -2025-05-16 19:35:23,476 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25062457 -0.13518178 0.34531933] -2025-05-16 19:35:23,478 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07382299e-01 -7.06827053e-01 1.10672815e-05 2.40832972e-03] -2025-05-16 19:35:23,505 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25060964 -0.13517443 0.34504886] -2025-05-16 19:35:23,507 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07364516e-01 -7.06845116e-01 -2.11797937e-05 2.32868212e-03] -2025-05-16 19:35:23,540 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25060512 -0.13516585 0.34502206] -2025-05-16 19:35:23,542 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07364306e-01 -7.06845412e-01 -3.66886300e-05 2.30225176e-03] -2025-05-16 19:35:23,570 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25059441 -0.13514107 0.34484339] -2025-05-16 19:35:23,572 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07351765e-01 -7.06858198e-01 -8.91881124e-05 2.22733228e-03] -2025-05-16 19:35:23,609 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25057364 -0.13513646 0.34476867] -2025-05-16 19:35:23,613 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07340953e-01 -7.06869020e-01 -1.22838728e-04 2.22483192e-03] -2025-05-16 19:35:23,645 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2505497 -0.13513216 0.34459875] -2025-05-16 19:35:23,654 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07314642e-01 -7.06895459e-01 -1.56490129e-04 2.18701485e-03] -2025-05-16 19:35:23,692 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25051372 -0.13511264 0.34438454] -2025-05-16 19:35:23,697 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07282392e-01 -7.06928024e-01 -2.21647034e-04 2.08269171e-03] -2025-05-16 19:35:23,726 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25050132 -0.13507823 0.34435699] -2025-05-16 19:35:23,727 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07277559e-01 -7.06933100e-01 -2.55130004e-04 1.99561744e-03] -2025-05-16 19:35:23,760 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25049593 -0.13507156 0.34438167] -2025-05-16 19:35:23,763 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07274153e-01 -7.06936531e-01 -2.73681290e-04 1.98461911e-03] -2025-05-16 19:35:23,789 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25049882 -0.13507126 0.34439537] -2025-05-16 19:35:23,791 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07273119e-01 -7.06937569e-01 -2.77287193e-04 1.98284321e-03] -2025-05-16 19:35:23,829 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25044849 -0.13506614 0.34422232] -2025-05-16 19:35:23,830 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07237841e-01 -7.06972942e-01 -3.47214364e-04 1.94289559e-03] -2025-05-16 19:35:23,859 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25042854 -0.13506216 0.34413581] -2025-05-16 19:35:23,861 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07213422e-01 -7.06997543e-01 -3.74561311e-04 1.87332350e-03] -2025-05-16 19:35:23,889 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25041214 -0.13503552 0.34410551] -2025-05-16 19:35:23,892 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07199102e-01 -7.07012121e-01 -4.18639956e-04 1.76509993e-03] -2025-05-16 19:35:23,922 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2504095 -0.13503149 0.34410815] -2025-05-16 19:35:23,924 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07199322e-01 -7.07011966e-01 -4.28575022e-04 1.73639265e-03] -2025-05-16 19:35:23,952 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25039802 -0.13502061 0.34411751] -2025-05-16 19:35:23,953 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07193435e-01 -7.07017927e-01 -4.61411097e-04 1.69811203e-03] -2025-05-16 19:35:23,981 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25036297 -0.13502319 0.34404887] -2025-05-16 19:35:23,982 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07169993e-01 -7.07041373e-01 -5.13312736e-04 1.68342981e-03] -2025-05-16 19:35:24,010 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25034565 -0.13502563 0.34400183] -2025-05-16 19:35:24,012 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07152708e-01 -7.07058706e-01 -5.37941315e-04 1.65701725e-03] -2025-05-16 19:35:24,040 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25032318 -0.13501111 0.3439368 ] -2025-05-16 19:35:24,043 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07125476e-01 -7.07086141e-01 -5.85555834e-04 1.55144085e-03] -2025-05-16 19:35:24,069 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25031545 -0.13500287 0.34392674] -2025-05-16 19:35:24,070 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07112536e-01 -7.07099207e-01 -6.03083159e-04 1.48617443e-03] -2025-05-16 19:35:24,097 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25029282 -0.13498546 0.34392476] -2025-05-16 19:35:24,098 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07108427e-01 -7.07103381e-01 -6.17380746e-04 1.44910717e-03] -2025-05-16 19:35:24,126 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25029247 -0.13498829 0.34392331] -2025-05-16 19:35:24,127 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07100229e-01 7.07111652e-01 6.62491152e-04 -1.39288041e-03] -2025-05-16 19:35:24,176 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25026322 -0.13498609 0.34387631] -2025-05-16 19:35:24,178 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70707916 0.70713275 0.0007223 -0.00135101] -2025-05-16 19:35:24,205 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25022536 -0.1349668 0.34380158] -2025-05-16 19:35:24,207 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7070333 0.70717883 0.00079352 -0.00117379] -2025-05-16 19:35:24,237 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25021872 -0.13495962 0.34380234] -2025-05-16 19:35:24,241 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70703109 0.70718109 0.00079778 -0.00114204] -2025-05-16 19:35:24,270 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25021365 -0.13495322 0.34380895] -2025-05-16 19:35:24,282 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70703229 0.70717994 0.00079829 -0.00111315] -2025-05-16 19:35:24,309 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25020974 -0.13495282 0.34381085] -2025-05-16 19:35:24,310 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70703041 0.70718184 0.00081225 -0.00109136] -2025-05-16 19:35:24,337 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25018891 -0.13495831 0.34377087] -2025-05-16 19:35:24,339 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70697938 0.70723295 0.00090049 -0.00094824] -2025-05-16 19:35:24,367 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2501929 -0.13495411 0.34377198] -2025-05-16 19:35:24,369 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70699236 0.70721998 0.00090147 -0.00094529] -2025-05-16 19:35:24,403 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25019205 -0.13495086 0.3437746 ] -2025-05-16 19:35:24,405 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70699754 0.70721482 0.00090095 -0.00093639] -2025-05-16 19:35:24,439 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25018308 -0.13494778 0.34378012] -2025-05-16 19:35:24,446 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70700145 0.70721096 0.00089251 -0.00089905] -2025-05-16 19:35:24,479 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25017899 -0.13495784 0.34377209] -2025-05-16 19:35:24,482 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7069832 0.70722924 0.00090643 -0.00085871] -2025-05-16 19:35:24,509 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25016031 -0.13496322 0.34374978] -2025-05-16 19:35:24,512 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70694429 0.70726817 0.00098141 -0.0007377 ] -2025-05-16 19:35:24,543 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25016361 -0.13495969 0.34375202] -2025-05-16 19:35:24,545 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70695041 0.70726206 0.00097985 -0.00073778] -2025-05-16 19:35:24,574 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25014705 -0.13498979 0.34374918] -2025-05-16 19:35:24,576 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06938152e-01 7.07274382e-01 9.63192221e-04 -6.86459235e-04] -2025-05-16 19:35:24,606 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25010578 -0.13504163 0.34375288] -2025-05-16 19:35:24,615 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06944903e-01 7.07267637e-01 9.62995164e-04 -6.83082092e-04] -2025-05-16 19:35:24,646 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25003526 -0.13511799 0.34378184] -2025-05-16 19:35:24,648 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06952859e-01 7.07259703e-01 9.64562398e-04 -6.61358005e-04] -2025-05-16 19:35:24,676 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2499693 -0.13518418 0.34378734] -2025-05-16 19:35:24,681 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06897498e-01 7.07315045e-01 1.03041181e-03 -5.41555733e-04] -2025-05-16 19:35:24,712 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24997102 -0.13519306 0.34378177] -2025-05-16 19:35:24,713 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06917147e-01 7.07295433e-01 1.03363253e-03 -4.99063169e-04] -2025-05-16 19:35:24,749 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24996593 -0.13522664 0.34377437] -2025-05-16 19:35:24,750 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06915191e-01 7.07297418e-01 1.02294654e-03 -4.77502171e-04] -2025-05-16 19:35:24,790 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.249887 -0.13533316 0.34380399] -2025-05-16 19:35:24,798 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06937951e-01 7.07274731e-01 1.00865687e-03 -4.13939318e-04] -2025-05-16 19:35:24,834 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24981607 -0.13540304 0.34381789] -2025-05-16 19:35:24,836 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06891211e-01 7.07321413e-01 1.07518711e-03 -2.79273433e-04] -2025-05-16 19:35:24,867 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24984159 -0.13534959 0.34382687] -2025-05-16 19:35:24,869 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06918688e-01 7.07293933e-01 1.09222978e-03 -2.60650056e-04] -2025-05-16 19:35:24,900 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24986546 -0.1353465 0.34386597] -2025-05-16 19:35:24,902 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06916117e-01 7.07296535e-01 1.07379594e-03 -2.49276926e-04] -2025-05-16 19:35:24,929 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24984856 -0.13536928 0.34389567] -2025-05-16 19:35:24,930 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06938834e-01 7.07273832e-01 1.07226568e-03 -2.46856003e-04] -2025-05-16 19:35:24,962 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24977359 -0.13547776 0.34396108] -2025-05-16 19:35:24,964 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06926082e-01 7.07286643e-01 1.04572064e-03 -1.62808089e-04] -2025-05-16 19:35:25,002 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24972229 -0.13548413 0.34400251] -2025-05-16 19:35:25,004 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06918295e-01 7.07294353e-01 1.10528898e-03 -3.31294367e-05] -2025-05-16 19:35:25,034 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24972682 -0.13542427 0.34404981] -2025-05-16 19:35:25,036 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06926458e-01 7.07286195e-01 1.10518714e-03 -4.01354440e-06] -2025-05-16 19:35:25,071 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24974843 -0.13536767 0.34413474] -2025-05-16 19:35:25,073 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06946598e-01 7.07266101e-01 1.08124468e-03 3.52891208e-05] -2025-05-16 19:35:25,107 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24971493 -0.13537445 0.34422505] -2025-05-16 19:35:25,110 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06937764e-01 7.07274974e-01 1.05131919e-03 6.11217778e-05] -2025-05-16 19:35:25,146 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24964725 -0.13535327 0.34434122] -2025-05-16 19:35:25,149 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06925516e-01 7.07287196e-01 1.05182824e-03 1.74353115e-04] -2025-05-16 19:35:25,199 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24960014 -0.13524314 0.34444542] -2025-05-16 19:35:25,200 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06945781e-01 7.07266940e-01 1.03480085e-03 2.59364437e-04] -2025-05-16 19:35:25,234 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24958671 -0.13515377 0.3445341 ] -2025-05-16 19:35:25,236 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06998960e-01 7.07213832e-01 9.93532893e-04 2.81113158e-04] -2025-05-16 19:35:25,271 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2495527 -0.13511843 0.34458387] -2025-05-16 19:35:25,274 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07016859e-01 7.07195980e-01 9.61389103e-04 2.88411168e-04] -2025-05-16 19:35:25,301 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2495031 -0.13511201 0.34465117] -2025-05-16 19:35:25,303 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06998771e-01 7.07214118e-01 9.05573847e-04 3.28736772e-04] -2025-05-16 19:35:25,336 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24939297 -0.13506237 0.34476643] -2025-05-16 19:35:25,337 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06998091e-01 7.07214783e-01 8.71318847e-04 4.36491627e-04] -2025-05-16 19:35:25,365 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24932198 -0.13498754 0.34485543] -2025-05-16 19:35:25,367 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07015498e-01 7.07197384e-01 8.24378226e-04 5.15702328e-04] -2025-05-16 19:35:25,395 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24925896 -0.1348967 0.34495411] -2025-05-16 19:35:25,397 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07045006e-01 7.07167919e-01 7.60006361e-04 5.63378001e-04] -2025-05-16 19:35:25,427 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24924144 -0.13489517 0.34495657] -2025-05-16 19:35:25,429 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07042142e-01 7.07170804e-01 7.36980987e-04 5.65523143e-04] -2025-05-16 19:35:25,462 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24915896 -0.13476836 0.34507317] -2025-05-16 19:35:25,463 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07049730e-01 7.07163256e-01 6.35993568e-04 6.35846825e-04] -2025-05-16 19:35:25,502 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2490504 -0.13469778 0.34519216] -2025-05-16 19:35:25,503 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07033649e-01 7.07179342e-01 5.21624877e-04 7.24880621e-04] -2025-05-16 19:35:25,533 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24899359 -0.13461075 0.34529202] -2025-05-16 19:35:25,534 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07050098e-01 7.07162886e-01 4.26525641e-04 7.92833722e-04] -2025-05-16 19:35:25,561 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24894762 -0.13451693 0.34541054] -2025-05-16 19:35:25,563 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07051292e-01 7.07161671e-01 3.27527883e-04 8.56912853e-04] -2025-05-16 19:35:25,593 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24893765 -0.13447874 0.34547527] -2025-05-16 19:35:25,595 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07054425e-01 7.07158541e-01 2.74242652e-04 8.72925207e-04] -2025-05-16 19:35:25,627 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24887484 -0.13434927 0.34561818] -2025-05-16 19:35:25,628 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07059552e-01 7.07153346e-01 1.52196555e-04 9.55396563e-04] -2025-05-16 19:35:25,657 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24885657 -0.13430707 0.34570119] -2025-05-16 19:35:25,659 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07047438e-01 7.07165423e-01 8.34309226e-05 9.88765260e-04] -2025-05-16 19:35:25,692 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24876387 -0.13414814 0.34589995] -2025-05-16 19:35:25,694 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07066394e-01 7.07146278e-01 -9.92708762e-05 1.11596609e-03] -2025-05-16 19:35:25,722 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24876966 -0.13410939 0.34594605] -2025-05-16 19:35:25,726 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07059683e-01 7.07152966e-01 -1.46593741e-04 1.12513436e-03] -2025-05-16 19:35:25,754 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24876925 -0.1340282 0.34607272] -2025-05-16 19:35:25,757 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07038494e-01 7.07174095e-01 -3.23372897e-04 1.12390780e-03] -2025-05-16 19:35:25,788 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24879197 -0.13395808 0.34614412] -2025-05-16 19:35:25,789 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07038392e-01 7.07174123e-01 -4.00407553e-04 1.14524882e-03] -2025-05-16 19:35:25,819 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24878083 -0.13385266 0.34630513] -2025-05-16 19:35:25,821 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07021434e-01 7.07190899e-01 -5.55608544e-04 1.19005374e-03] -2025-05-16 19:35:25,851 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24874727 -0.13375873 0.34644332] -2025-05-16 19:35:25,855 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07020274e-01 7.07191838e-01 -7.05642633e-04 1.24020019e-03] -2025-05-16 19:35:25,893 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24874378 -0.13369793 0.34660454] -2025-05-16 19:35:25,895 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70699552 0.70721629 -0.00090177 0.00127967] -2025-05-16 19:35:25,925 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24877562 -0.13366408 0.3467154 ] -2025-05-16 19:35:25,927 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70698367 0.70722794 -0.00106734 0.00126354] -2025-05-16 19:35:25,958 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24880717 -0.13358466 0.3468465 ] -2025-05-16 19:35:25,959 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70698529 0.70722606 -0.00120903 0.00128114] -2025-05-16 19:35:25,986 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24881895 -0.13356235 0.34689772] -2025-05-16 19:35:25,987 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70698264 0.70722859 -0.00127592 0.00128015] -2025-05-16 19:35:26,013 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24883989 -0.1335106 0.34697338] -2025-05-16 19:35:26,015 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70698048 0.70723053 -0.0013771 0.00129697] -2025-05-16 19:35:26,044 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24888085 -0.13343612 0.34712041] -2025-05-16 19:35:26,048 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70694977 0.7072607 -0.00161722 0.00130795] -2025-05-16 19:35:26,089 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24896076 -0.13338651 0.34722031] -2025-05-16 19:35:26,090 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70694465 0.70726533 -0.00184268 0.00127297] -2025-05-16 19:35:26,119 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24899958 -0.13339194 0.34720256] -2025-05-16 19:35:26,136 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70694477 0.7072651 -0.00189646 0.00125194] -2025-05-16 19:35:26,174 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24907962 -0.13337112 0.34729647] -2025-05-16 19:35:26,182 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70692651 0.70728267 -0.0021662 0.00120308] -2025-05-16 19:35:26,213 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24918943 -0.13329723 0.34732954] -2025-05-16 19:35:26,214 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70688441 0.70732383 -0.00244619 0.00120323] -2025-05-16 19:35:26,241 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24925102 -0.13327397 0.34722175] -2025-05-16 19:35:26,242 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70687501 0.70733295 -0.00253539 0.00117827] -2025-05-16 19:35:26,275 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24927381 -0.13326728 0.34709141] -2025-05-16 19:35:26,276 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70687617 0.70733178 -0.00254173 0.00117145] -2025-05-16 19:35:26,308 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24936404 -0.1332809 0.34694646] -2025-05-16 19:35:26,309 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70684129 0.70736617 -0.00269549 0.00111059] -2025-05-16 19:35:26,344 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24954236 -0.13327903 0.34681823] -2025-05-16 19:35:26,353 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70681159 0.70739438 -0.00309049 0.00100666] -2025-05-16 19:35:26,381 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24968077 -0.13324742 0.34652664] -2025-05-16 19:35:26,382 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70677915 0.7074256 -0.00336446 0.00096413] -2025-05-16 19:35:26,410 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24971442 -0.13324591 0.34627508] -2025-05-16 19:35:26,411 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70677181 0.70743273 -0.00341077 0.0009527 ] -2025-05-16 19:35:26,441 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24977464 -0.13321623 0.34594561] -2025-05-16 19:35:26,442 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70675942 0.70744487 -0.00347044 0.00092009] -2025-05-16 19:35:26,473 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24982793 -0.13318809 0.34567877] -2025-05-16 19:35:26,474 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70674814 0.70745586 -0.003537 0.00086956] -2025-05-16 19:35:26,501 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005473 -0.13316028 0.3451816 ] -2025-05-16 19:35:26,502 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70671837 0.70748355 -0.00395701 0.00072151] -2025-05-16 19:35:26,538 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2502311 -0.13306111 0.34456822] -2025-05-16 19:35:26,541 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06684563e-01 7.07515799e-01 -4.23949523e-03 5.90897942e-04] -2025-05-16 19:35:26,573 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2504013 -0.13300315 0.34369439] -2025-05-16 19:35:26,578 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06644371e-01 7.07554419e-01 -4.50095834e-03 4.67481008e-04] -2025-05-16 19:35:26,606 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25041217 -0.13297002 0.34356 ] -2025-05-16 19:35:26,608 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06644684e-01 7.07554009e-01 -4.52033267e-03 4.25006371e-04] -2025-05-16 19:35:26,686 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25064325 -0.13285562 0.34267969] -2025-05-16 19:35:26,688 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06653250e-01 7.07543454e-01 -4.83376701e-03 2.83804771e-04] -2025-05-16 19:35:26,718 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2509896 -0.13266944 0.34117422] -2025-05-16 19:35:26,719 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06555250e-01 7.07637378e-01 -5.38704797e-03 -1.63608562e-05] -2025-05-16 19:35:26,746 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25110876 -0.13254243 0.34027072] -2025-05-16 19:35:26,748 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06551565e-01 7.07639808e-01 -5.54377687e-03 -2.34705825e-04] -2025-05-16 19:35:26,778 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25112434 -0.13250826 0.34005038] -2025-05-16 19:35:26,780 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06545852e-01 7.07645353e-01 -5.56074259e-03 -3.03521629e-04] -2025-05-16 19:35:26,809 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2511464 -0.13246963 0.33973044] -2025-05-16 19:35:26,811 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06534861e-01 7.07656048e-01 -5.59152189e-03 -3.76597476e-04] -2025-05-16 19:35:26,843 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25127501 -0.13237942 0.3390927 ] -2025-05-16 19:35:26,846 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06540622e-01 7.07648620e-01 -5.79035821e-03 -5.02137990e-04] -2025-05-16 19:35:26,880 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2516242 -0.13213588 0.33744508] -2025-05-16 19:35:26,883 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70650588 0.70767858 -0.00631022 -0.00080212] -2025-05-16 19:35:26,911 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25180908 -0.13191276 0.33610472] -2025-05-16 19:35:26,919 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70645986 0.70772203 -0.00653074 -0.00116091] -2025-05-16 19:35:26,952 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25186584 -0.13183268 0.33542214] -2025-05-16 19:35:26,955 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70640747 0.70777298 -0.006623 -0.00142355] -2025-05-16 19:35:26,986 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25191628 -0.13178148 0.33507355] -2025-05-16 19:35:26,989 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70640218 0.70777738 -0.00668736 -0.00155676] -2025-05-16 19:35:27,018 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25216353 -0.13161237 0.33388819] -2025-05-16 19:35:27,020 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70639701 0.70777777 -0.0071149 -0.00180909] -2025-05-16 19:35:27,050 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25229314 -0.13149916 0.33314063] -2025-05-16 19:35:27,053 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70637008 0.70780186 -0.00733148 -0.00202147] -2025-05-16 19:35:27,082 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25245415 -0.13130604 0.33178625] -2025-05-16 19:35:27,084 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7063341 0.70783357 -0.00758795 -0.00248915] -2025-05-16 19:35:27,115 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25257539 -0.13117049 0.33076362] -2025-05-16 19:35:27,118 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7062688 0.70789511 -0.00775774 -0.00295337] -2025-05-16 19:35:27,150 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25267845 -0.13111475 0.33030566] -2025-05-16 19:35:27,152 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70623635 0.70792496 -0.00790793 -0.0031504 ] -2025-05-16 19:35:27,186 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25289143 -0.13097948 0.32932451] -2025-05-16 19:35:27,188 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70624636 0.70790902 -0.00828657 -0.00349653] -2025-05-16 19:35:27,223 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25300519 -0.13086934 0.32836837] -2025-05-16 19:35:27,233 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70624202 0.70790817 -0.00854392 -0.00390222] -2025-05-16 19:35:27,270 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25317131 -0.13069188 0.32677289] -2025-05-16 19:35:27,272 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70616814 0.70797292 -0.00886559 -0.00472331] -2025-05-16 19:35:27,301 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25330184 -0.13061166 0.32605892] -2025-05-16 19:35:27,303 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70611129 0.70802457 -0.00906197 -0.00509332] -2025-05-16 19:35:27,335 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25338784 -0.1305907 0.32579673] -2025-05-16 19:35:27,336 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70611661 0.70801637 -0.00919971 -0.00524664] -2025-05-16 19:35:27,371 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25350442 -0.13051355 0.32514713] -2025-05-16 19:35:27,372 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70613849 0.70798929 -0.00939789 -0.00559328] -2025-05-16 19:35:27,408 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25363281 -0.1303677 0.32370202] -2025-05-16 19:35:27,409 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7060989 0.70801765 -0.00969883 -0.00642546] -2025-05-16 19:35:27,441 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25365438 -0.13035609 0.32339615] -2025-05-16 19:35:27,443 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70609323 0.70802059 -0.00972904 -0.00667417] -2025-05-16 19:35:27,470 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25379984 -0.13028456 0.3225444 ] -2025-05-16 19:35:27,479 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70605637 0.70804879 -0.00994841 -0.00723503] -2025-05-16 19:35:27,510 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25393335 -0.13027292 0.32214996] -2025-05-16 19:35:27,512 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70608287 0.708016 -0.01014699 -0.00757339] -2025-05-16 19:35:27,548 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25399193 -0.13025788 0.32190721] -2025-05-16 19:35:27,550 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70610568 0.70798977 -0.01021198 -0.00780805] -2025-05-16 19:35:27,581 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25407484 -0.1301954 0.32084185] -2025-05-16 19:35:27,583 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70609343 0.70798947 -0.01040768 -0.00864045] -2025-05-16 19:35:27,615 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25409468 -0.13022146 0.32054935] -2025-05-16 19:35:27,618 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70606713 0.70801097 -0.01043998 -0.00898248] -2025-05-16 19:35:27,650 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25421258 -0.13022594 0.31994981] -2025-05-16 19:35:27,652 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70606704 0.70800032 -0.0106128 -0.00960476] -2025-05-16 19:35:27,686 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25430566 -0.13024649 0.31969021] -2025-05-16 19:35:27,688 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70607747 0.70798355 -0.01068008 -0.00999122] -2025-05-16 19:35:27,719 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25437106 -0.13025504 0.31938357] -2025-05-16 19:35:27,721 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70610747 0.70794659 -0.01077163 -0.0103844 ] -2025-05-16 19:35:27,751 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25440881 -0.13028062 0.31887482] -2025-05-16 19:35:27,754 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70611483 0.70792895 -0.01080847 -0.01102854] -2025-05-16 19:35:27,788 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25447452 -0.13034111 0.31843296] -2025-05-16 19:35:27,790 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70610627 0.70792635 -0.01089065 -0.01164497] -2025-05-16 19:35:27,819 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25450685 -0.13036474 0.31836109] -2025-05-16 19:35:27,820 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70611618 0.7079132 -0.01086933 -0.01186148] -2025-05-16 19:35:27,851 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25460251 -0.13038369 0.31815186] -2025-05-16 19:35:27,853 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70612179 0.70789962 -0.01085314 -0.01234274] -2025-05-16 19:35:27,883 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25465664 -0.13040085 0.31807058] -2025-05-16 19:35:27,885 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70614204 0.70787402 -0.01086115 -0.01264216] -2025-05-16 19:35:27,918 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25470885 -0.1304297 0.31775665] -2025-05-16 19:35:27,920 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70616765 0.70783685 -0.01080057 -0.0133264 ] -2025-05-16 19:35:27,951 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25475554 -0.1305021 0.31762116] -2025-05-16 19:35:27,953 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70615809 0.7078357 -0.0107706 -0.01390594] -2025-05-16 19:35:27,983 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25477099 -0.13052637 0.31773943] -2025-05-16 19:35:27,985 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70617277 0.70781876 -0.0107182 -0.01406205] -2025-05-16 19:35:28,018 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25479901 -0.13056631 0.3178755 ] -2025-05-16 19:35:28,020 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70620171 0.7077833 -0.01059497 -0.01448049] -2025-05-16 19:35:28,052 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25481805 -0.13063794 0.3180494 ] -2025-05-16 19:35:28,054 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7062398 0.70773629 -0.01052776 -0.0149617 ] -2025-05-16 19:35:28,083 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25480562 -0.13069634 0.31823645] -2025-05-16 19:35:28,090 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70626994 0.70769906 -0.01042279 -0.01536816] -2025-05-16 19:35:28,120 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25480046 -0.13080152 0.31854853] -2025-05-16 19:35:28,121 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70628397 0.7076743 -0.01028334 -0.01594649] -2025-05-16 19:35:28,152 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25476646 -0.13084333 0.31885104] -2025-05-16 19:35:28,153 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70628868 0.70766984 -0.01023443 -0.01596727] -2025-05-16 19:35:28,188 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2547396 -0.13095351 0.31950913] -2025-05-16 19:35:28,190 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70631955 0.70763095 -0.0100127 -0.01645822] -2025-05-16 19:35:28,229 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25468592 -0.13105782 0.32019323] -2025-05-16 19:35:28,231 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7063522 0.70759009 -0.00982422 -0.01692128] -2025-05-16 19:35:28,269 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2546314 -0.13118363 0.32091198] -2025-05-16 19:35:28,282 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70637201 0.70756038 -0.00961468 -0.01744844] -2025-05-16 19:35:28,323 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25453311 -0.13132061 0.32213616] -2025-05-16 19:35:28,326 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70638098 0.70754456 -0.00929918 -0.01789217] -2025-05-16 19:35:28,361 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25450736 -0.13136723 0.3226783 ] -2025-05-16 19:35:28,363 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70639374 0.70753082 -0.00917941 -0.01799365] -2025-05-16 19:35:28,397 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25442403 -0.1314815 0.32369125] -2025-05-16 19:35:28,399 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70642495 0.70749459 -0.00892713 -0.01831663] -2025-05-16 19:35:28,435 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25432489 -0.13160336 0.3245847 ] -2025-05-16 19:35:28,446 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70645746 0.70745493 -0.00865776 -0.01871942] -2025-05-16 19:35:28,479 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25420961 -0.13175308 0.32583484] -2025-05-16 19:35:28,480 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70648161 0.70742484 -0.00834248 -0.01908477] -2025-05-16 19:35:28,509 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25416008 -0.13183661 0.32657753] -2025-05-16 19:35:28,510 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70649568 0.70741045 -0.00819318 -0.01916181] -2025-05-16 19:35:28,544 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.254066 -0.13196234 0.32759103] -2025-05-16 19:35:28,546 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70651859 0.70738554 -0.00794572 -0.0193404 ] -2025-05-16 19:35:28,579 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25398925 -0.1320332 0.32815697] -2025-05-16 19:35:28,582 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70654358 0.70735967 -0.00776959 -0.01944453] -2025-05-16 19:35:28,612 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25385753 -0.13217934 0.32929164] -2025-05-16 19:35:28,614 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70657957 0.7073187 -0.00738842 -0.01977312] -2025-05-16 19:35:28,649 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25374953 -0.13236173 0.33074895] -2025-05-16 19:35:28,652 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70663185 0.70726342 -0.00708895 -0.01999083] -2025-05-16 19:35:28,688 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25362901 -0.13247711 0.33180648] -2025-05-16 19:35:28,702 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70671066 0.70718424 -0.0067428 -0.02012541] -2025-05-16 19:35:28,734 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25351595 -0.13257111 0.33281417] -2025-05-16 19:35:28,735 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70678095 0.7071152 -0.0064196 -0.02018811] -2025-05-16 19:35:28,771 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25344856 -0.1326615 0.333546 ] -2025-05-16 19:35:28,776 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7068091 0.70708637 -0.00615013 -0.02029648] -2025-05-16 19:35:28,810 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25334225 -0.13277886 0.33449967] -2025-05-16 19:35:28,813 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70685985 0.7070351 -0.00582829 -0.0204096 ] -2025-05-16 19:35:28,847 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25321229 -0.13292328 0.33565462] -2025-05-16 19:35:28,849 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70694391 0.70695186 -0.00542631 -0.02049212] -2025-05-16 19:35:28,880 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25309753 -0.13304747 0.33667882] -2025-05-16 19:35:28,881 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70701696 -0.70688288 0.00505864 0.02044537] -2025-05-16 19:35:28,910 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25306865 -0.13307419 0.33685597] -2025-05-16 19:35:28,912 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70704356 -0.70685907 0.00495272 0.02037489] -2025-05-16 19:35:28,943 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25296549 -0.13318129 0.33753492] -2025-05-16 19:35:28,946 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70710557 -0.7067988 0.00456408 0.02040434] -2025-05-16 19:35:28,981 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2528386 -0.13331451 0.33858387] -2025-05-16 19:35:28,983 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.7072042 -0.70670312 0.00411057 0.02039668] -2025-05-16 19:35:29,018 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25271771 -0.1334715 0.33973875] -2025-05-16 19:35:29,020 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70728678 -0.70662535 0.0036191 0.02032055] -2025-05-16 19:35:29,048 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25267717 -0.13353432 0.34008459] -2025-05-16 19:35:29,052 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70729944 -0.70661668 0.00345724 0.02020925] -2025-05-16 19:35:29,083 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2525846 -0.13362718 0.3405771 ] -2025-05-16 19:35:29,087 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70735661 -0.70656448 0.0030955 0.02009174] -2025-05-16 19:35:29,118 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25254272 -0.13367921 0.34075552] -2025-05-16 19:35:29,121 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70737424 -0.70654853 0.00291989 0.02005839] -2025-05-16 19:35:29,152 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25238473 -0.13387812 0.34205352] -2025-05-16 19:35:29,153 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70754662 -0.70638276 0.00221736 0.01990628] -2025-05-16 19:35:29,184 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25232158 -0.1339808 0.34270648] -2025-05-16 19:35:29,185 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70759161 -0.70634382 0.00188009 0.01972272] -2025-05-16 19:35:29,218 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2522884 -0.13402714 0.34294603] -2025-05-16 19:35:29,221 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70760096 -0.70633868 0.00169165 0.01958806] -2025-05-16 19:35:29,256 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25221398 -0.13411707 0.34327489] -2025-05-16 19:35:29,261 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70764718 -0.70629925 0.00135031 0.0193651 ] -2025-05-16 19:35:29,305 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25209488 -0.13426924 0.34403603] -2025-05-16 19:35:29,307 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07769641e-01 -7.06182938e-01 6.89473251e-04 1.91655264e-02] -2025-05-16 19:35:29,340 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2519926 -0.13442134 0.3448876 ] -2025-05-16 19:35:29,348 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07867056e-01 -7.06094147e-01 1.44840484e-04 1.88484852e-02] -2025-05-16 19:35:29,381 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25196238 -0.13447424 0.34513423] -2025-05-16 19:35:29,383 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07874570e-01 -7.06092840e-01 -1.29203527e-04 1.86139135e-02] -2025-05-16 19:35:29,416 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25193078 -0.13452685 0.34526887] -2025-05-16 19:35:29,417 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07890650e-01 -7.06083772e-01 -3.64000669e-04 1.83412858e-02] -2025-05-16 19:35:29,449 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25188962 -0.13457222 0.34544985] -2025-05-16 19:35:29,450 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07925015e-01 -7.06053645e-01 -6.71499642e-04 1.81651475e-02] -2025-05-16 19:35:29,485 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25181236 -0.13466049 0.34598098] -2025-05-16 19:35:29,491 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.708019 -0.7059672 -0.00126344 0.01782714] -2025-05-16 19:35:29,522 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25175396 -0.13474165 0.34651474] -2025-05-16 19:35:29,530 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70810576 -0.70588959 -0.00176345 0.01740705] -2025-05-16 19:35:29,565 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25170453 -0.13480209 0.34676709] -2025-05-16 19:35:29,566 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70812958 -0.70587531 -0.00219074 0.016963 ] -2025-05-16 19:35:29,596 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25168375 -0.13482561 0.34678848] -2025-05-16 19:35:29,598 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70812985 -0.70587953 -0.00235897 0.01675258] -2025-05-16 19:35:29,632 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2516434 -0.13488054 0.34695185] -2025-05-16 19:35:29,633 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70817871 -0.70583597 -0.00276438 0.01645787] -2025-05-16 19:35:29,668 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25159282 -0.13497461 0.34733758] -2025-05-16 19:35:29,669 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70829681 -0.70572404 -0.00319766 0.01609288] -2025-05-16 19:35:29,704 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.251521 -0.13506876 0.34774254] -2025-05-16 19:35:29,705 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70834248 -0.70568868 -0.00377565 0.01549723] -2025-05-16 19:35:29,735 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25150194 -0.13509031 0.34778975] -2025-05-16 19:35:29,736 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70834099 -0.70569379 -0.00391196 0.01529753] -2025-05-16 19:35:29,771 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25145601 -0.13512923 0.34784848] -2025-05-16 19:35:29,772 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70834681 -0.70569454 -0.00426748 0.01489325] -2025-05-16 19:35:29,802 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2514484 -0.13515726 0.34790509] -2025-05-16 19:35:29,804 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70838295 -0.70566147 -0.0044369 0.01468998] -2025-05-16 19:35:29,836 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25142357 -0.13520931 0.34804772] -2025-05-16 19:35:29,838 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70845644 -0.70559152 -0.00468694 0.01442605] -2025-05-16 19:35:29,873 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25133658 -0.13533464 0.34851658] -2025-05-16 19:35:29,875 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.7085506 -0.70550867 -0.0054064 0.01357688] -2025-05-16 19:35:29,915 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25128461 -0.13533503 0.34856909] -2025-05-16 19:35:29,917 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70853867 -0.70552639 -0.00578006 0.0131173 ] -2025-05-16 19:35:29,948 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25126493 -0.13532717 0.34856653] -2025-05-16 19:35:29,953 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.7085477 -0.70552208 -0.00604033 0.01273826] -2025-05-16 19:35:29,990 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25126701 -0.13536326 0.34869416] -2025-05-16 19:35:29,993 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70863777 -0.70543702 -0.0063319 0.01228891] -2025-05-16 19:35:30,030 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25122597 -0.13545978 0.34903223] -2025-05-16 19:35:30,036 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70869967 -0.70538316 -0.00684763 0.01151027] -2025-05-16 19:35:30,070 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25120883 -0.13548003 0.34908724] -2025-05-16 19:35:30,072 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70869743 -0.70538755 -0.00699287 0.0112896 ] -2025-05-16 19:35:30,120 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25113526 -0.13551454 0.34911545] -2025-05-16 19:35:30,124 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70866234 -0.70542761 -0.00742685 0.01069677] -2025-05-16 19:35:30,155 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25114589 -0.13552709 0.3491948 ] -2025-05-16 19:35:30,164 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70875153 -0.7053429 -0.00773788 0.0101387 ] -2025-05-16 19:35:30,194 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2511365 -0.13561702 0.34944451] -2025-05-16 19:35:30,195 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70879676 -0.70530318 -0.00807103 0.00945671] -2025-05-16 19:35:30,222 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25114154 -0.13561893 0.34950198] -2025-05-16 19:35:30,224 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.7088029 -0.70529839 -0.00811569 0.00931539] -2025-05-16 19:35:30,254 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25113631 -0.13562087 0.34953396] -2025-05-16 19:35:30,255 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70879096 -0.70531131 -0.00818858 0.00918022] -2025-05-16 19:35:30,283 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25109355 -0.1356454 0.3495507 ] -2025-05-16 19:35:30,285 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70874738 -0.70535773 -0.00848148 0.00869982] -2025-05-16 19:35:30,317 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25109609 -0.13566103 0.3495895 ] -2025-05-16 19:35:30,318 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70875936 -0.70534799 -0.0086699 0.00831963] -2025-05-16 19:35:30,346 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25110633 -0.13567103 0.34977251] -2025-05-16 19:35:30,347 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70882985 -0.70528147 -0.00910584 0.00744079] -2025-05-16 19:35:30,380 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25111461 -0.13566261 0.3498322 ] -2025-05-16 19:35:30,383 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.7088539 -0.70525881 -0.00917819 0.00720535] -2025-05-16 19:35:30,412 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25110729 -0.13566001 0.34988421] -2025-05-16 19:35:30,415 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70883115 -0.70528337 -0.00931495 0.00685603] -2025-05-16 19:35:30,442 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25109148 -0.13567474 0.34987932] -2025-05-16 19:35:30,444 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70879632 -0.70531918 -0.00937105 0.0066947 ] -2025-05-16 19:35:30,474 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25108098 -0.13569802 0.34990331] -2025-05-16 19:35:30,484 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70878202 -0.7053353 -0.00965771 0.00607406] -2025-05-16 19:35:30,513 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25106506 -0.13577085 0.34997868] -2025-05-16 19:35:30,515 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70876874 -0.70535039 -0.00991051 0.00543058] -2025-05-16 19:35:30,549 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25106612 -0.13577441 0.35002182] -2025-05-16 19:35:30,550 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70880888 -0.70531154 -0.00999421 0.00507039] -2025-05-16 19:35:30,582 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25104552 -0.13578413 0.35002794] -2025-05-16 19:35:30,583 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70881982 -0.70530172 -0.01007538 0.00473566] -2025-05-16 19:35:30,618 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25103141 -0.13579333 0.3499961 ] -2025-05-16 19:35:30,620 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70878739 -0.7053356 -0.01016514 0.00433483] -2025-05-16 19:35:30,651 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25100597 -0.13582712 0.34995637] -2025-05-16 19:35:30,653 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70875917 -0.70536438 -0.0102637 0.00402248] -2025-05-16 19:35:30,684 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25097033 -0.13590363 0.34992547] -2025-05-16 19:35:30,687 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70873812 -0.70538615 -0.01045034 0.00338471] -2025-05-16 19:35:30,719 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25094493 -0.13592514 0.34986778] -2025-05-16 19:35:30,720 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70875402 -0.70537082 -0.01055492 0.00288636] -2025-05-16 19:35:30,754 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25091758 -0.13591816 0.34976555] -2025-05-16 19:35:30,763 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70873791 -0.70538752 -0.01057952 0.00266251] -2025-05-16 19:35:30,792 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25088229 -0.13592041 0.34962286] -2025-05-16 19:35:30,798 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70869912 -0.70542732 -0.01061501 0.00227565] -2025-05-16 19:35:30,836 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25082867 -0.13598016 0.3494697 ] -2025-05-16 19:35:30,839 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70865077 -0.70547585 -0.0107201 0.00172647] -2025-05-16 19:35:30,868 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2507866 -0.13595241 0.34928129] -2025-05-16 19:35:30,870 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70866462 -0.70546035 -0.01091141 0.00104779] -2025-05-16 19:35:30,902 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25078425 -0.13591836 0.34914131] -2025-05-16 19:35:30,903 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70865953 -0.70546534 -0.01093796 0.00083128] -2025-05-16 19:35:30,934 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25077185 -0.1358887 0.34890923] -2025-05-16 19:35:30,936 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.08621408e-01 -7.05504134e-01 -1.09240766e-02 5.30215209e-04] -2025-05-16 19:35:30,968 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25073887 -0.13588666 0.3486489 ] -2025-05-16 19:35:30,973 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.08547265e-01 -7.05578208e-01 -1.09616942e-02 8.38157125e-05] -2025-05-16 19:35:31,011 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25070425 -0.13586948 0.34836316] -2025-05-16 19:35:31,015 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.08496048e-01 -7.05627392e-01 -1.10886616e-02 -6.12964494e-04] -2025-05-16 19:35:31,048 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25070858 -0.13584401 0.34822586] -2025-05-16 19:35:31,050 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70848495 -0.70563806 -0.01110211 -0.00086687] -2025-05-16 19:35:31,087 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25069971 -0.13580143 0.34797405] -2025-05-16 19:35:31,096 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70846745 -0.70565565 -0.01107133 -0.00118303] -2025-05-16 19:35:31,128 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25067932 -0.13576734 0.3476335 ] -2025-05-16 19:35:31,135 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.7083872 -0.70573642 -0.01101314 -0.00154563] -2025-05-16 19:35:31,170 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2506357 -0.13576976 0.34726781] -2025-05-16 19:35:31,171 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70827874 -0.70584379 -0.011013 -0.00211701] -2025-05-16 19:35:31,211 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25062194 -0.1357487 0.34708268] -2025-05-16 19:35:31,212 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70825485 -0.70586676 -0.01101158 -0.00243533] -2025-05-16 19:35:31,263 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25060406 -0.13568361 0.34674375] -2025-05-16 19:35:31,265 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70822703 -0.7058946 -0.0109236 -0.00282264] -2025-05-16 19:35:31,294 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25058531 -0.13564209 0.34635469] -2025-05-16 19:35:31,296 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70811827 -0.7060035 -0.01080668 -0.00328467] -2025-05-16 19:35:31,331 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25057011 -0.13563989 0.34623383] -2025-05-16 19:35:31,332 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70805333 -0.70606852 -0.01075715 -0.003464 ] -2025-05-16 19:35:31,361 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25057273 -0.13563359 0.3462116 ] -2025-05-16 19:35:31,362 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70803456 -0.70608774 -0.01071132 -0.00352684] -2025-05-16 19:35:31,389 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25057704 -0.13560059 0.34599007] -2025-05-16 19:35:31,390 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70797945 -0.7061428 -0.01060192 -0.0038796 ] -2025-05-16 19:35:31,418 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25059737 -0.13558999 0.34602793] -2025-05-16 19:35:31,421 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70797816 -0.70614466 -0.01057512 -0.00384777] -2025-05-16 19:35:31,450 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2505944 -0.13548785 0.34548196] -2025-05-16 19:35:31,452 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70787723 -0.7062455 -0.01033447 -0.00450742] -2025-05-16 19:35:31,492 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25058497 -0.13545536 0.34534209] -2025-05-16 19:35:31,495 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.707829 -0.70629457 -0.01018437 -0.00472961] -2025-05-16 19:35:31,534 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25057075 -0.1354313 0.34531832] -2025-05-16 19:35:31,538 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70781186 -0.70631251 -0.01008145 -0.00483451] -2025-05-16 19:35:31,579 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25056084 -0.13540995 0.34523323] -2025-05-16 19:35:31,580 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70779089 -0.70633487 -0.00987638 -0.00505652] -2025-05-16 19:35:31,611 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2505547 -0.13534448 0.345068 ] -2025-05-16 19:35:31,617 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70774891 -0.70637713 -0.00971299 -0.00533781] -2025-05-16 19:35:31,645 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25053902 -0.13528607 0.34488902] -2025-05-16 19:35:31,646 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70767546 -0.7064512 -0.00951359 -0.00562445] -2025-05-16 19:35:31,686 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25052851 -0.13524061 0.34490524] -2025-05-16 19:35:31,687 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70761991 -0.70650797 -0.00934203 -0.00576896] -2025-05-16 19:35:31,714 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25053002 -0.13522557 0.34496466] -2025-05-16 19:35:31,716 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70760443 -0.70652418 -0.00929104 -0.00576416] -2025-05-16 19:35:31,747 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25054059 -0.13516388 0.34500326] -2025-05-16 19:35:31,754 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70757522 -0.70655516 -0.00904457 -0.00594219] -2025-05-16 19:35:31,784 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25058885 -0.1350878 0.34492769] -2025-05-16 19:35:31,786 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70750976 -0.70662266 -0.00870238 -0.00621433] -2025-05-16 19:35:31,822 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25066032 -0.13498617 0.34493028] -2025-05-16 19:35:31,831 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70742488 -0.70670898 -0.00843056 -0.00643351] -2025-05-16 19:35:31,869 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25079499 -0.13487754 0.34507536] -2025-05-16 19:35:31,870 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70735987 -0.70677516 -0.0082893 -0.00649408] -2025-05-16 19:35:31,902 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25092882 -0.1347439 0.34522373] -2025-05-16 19:35:31,905 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70731097 -0.70682583 -0.00803747 -0.00662128] -2025-05-16 19:35:31,936 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25106956 -0.13469611 0.34530183] -2025-05-16 19:35:31,947 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70728762 -0.70685085 -0.00787813 -0.00663589] -2025-05-16 19:35:31,976 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25131843 -0.13455828 0.34540053] -2025-05-16 19:35:31,977 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70721019 -0.70693082 -0.00752067 -0.00678226] -2025-05-16 19:35:32,012 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25153939 -0.13444954 0.34550628] -2025-05-16 19:35:32,014 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70716163 -0.70698069 -0.00739763 -0.00678243] -2025-05-16 19:35:32,045 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25205332 -0.13413108 0.34586535] -2025-05-16 19:35:32,046 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70707706 -0.70706848 -0.00704517 -0.00682345] -2025-05-16 19:35:32,083 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25238131 -0.1340088 0.34606146] -2025-05-16 19:35:32,085 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70704715 0.70710069 0.00688942 0.00674421] -2025-05-16 19:35:32,114 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25269431 -0.13388986 0.34620468] -2025-05-16 19:35:32,118 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70701175 0.70713796 0.00679543 0.00664171] -2025-05-16 19:35:32,146 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25324206 -0.133663 0.34646002] -2025-05-16 19:35:32,148 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70691956 0.70723332 0.00651395 0.00658333] -2025-05-16 19:35:32,183 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25404309 -0.13328679 0.34690262] -2025-05-16 19:35:32,185 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70678015 0.70737684 0.00616204 0.00646903] -2025-05-16 19:35:32,216 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25443923 -0.13312558 0.34710713] -2025-05-16 19:35:32,219 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70673638 0.70742254 0.00608699 0.00632357] -2025-05-16 19:35:32,255 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25518663 -0.13284463 0.34750004] -2025-05-16 19:35:32,258 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70667087 0.70749197 0.00591357 0.00603494] -2025-05-16 19:35:32,299 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25612407 -0.13248887 0.34793363] -2025-05-16 19:35:32,301 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70656036 0.7076071 0.00569611 0.00567454] -2025-05-16 19:35:32,336 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25709565 -0.13208547 0.34842362] -2025-05-16 19:35:32,339 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70641622 0.7077556 0.00543087 0.0053519 ] -2025-05-16 19:35:32,367 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25758364 -0.13188979 0.34867781] -2025-05-16 19:35:32,368 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70636124 0.70781278 0.00536359 0.00510924] -2025-05-16 19:35:32,403 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25824398 -0.13165912 0.34901373] -2025-05-16 19:35:32,404 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70629717 0.7078798 0.00530059 0.00473307] -2025-05-16 19:35:32,436 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25914319 -0.13132266 0.34944458] -2025-05-16 19:35:32,437 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70619184 0.7079887 0.00520625 0.00423907] -2025-05-16 19:35:32,468 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2599501 -0.13103259 0.34985735] -2025-05-16 19:35:32,470 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70605831 0.70812555 0.0050515 0.00378831] -2025-05-16 19:35:32,500 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.26101265 -0.1306177 0.35037904] -2025-05-16 19:35:32,503 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70593154 0.7082564 0.00487336 0.00312826] -2025-05-16 19:35:32,538 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.26191233 -0.1303108 0.35085386] -2025-05-16 19:35:32,549 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70581814 0.70837261 0.00477594 0.00248682] -2025-05-16 19:35:32,598 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.26277157 -0.13002347 0.35129719] -2025-05-16 19:35:32,599 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70575892 0.70843409 0.00472281 0.00178658] -2025-05-16 19:35:32,663 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.26432651 -0.12949095 0.35208994] -2025-05-16 19:35:32,665 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.05518763e-01 7.08676608e-01 4.51361888e-03 6.05472063e-04] -2025-05-16 19:35:32,703 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.26534095 -0.1291689 0.35258845] -2025-05-16 19:35:32,704 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.05377153e-01 7.08818371e-01 4.41720075e-03 -2.75897632e-04] -2025-05-16 19:35:32,734 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.26617077 -0.1289128 0.35303891] -2025-05-16 19:35:32,737 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70528616 0.70890822 0.00438024 -0.00117845] -2025-05-16 19:35:32,767 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.26623846 -0.1288846 0.35307902] -2025-05-16 19:35:32,769 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70529072 0.70890317 0.00442081 -0.00132756] -2025-05-16 19:35:32,798 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.26654662 -0.12880741 0.35326456] -2025-05-16 19:35:32,799 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70521836 0.70897399 0.00446238 -0.00174092] -2025-05-16 19:35:32,837 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.26805828 -0.12826646 0.35402666] -2025-05-16 19:35:32,840 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70499796 0.70918865 0.00440131 -0.00315647] -2025-05-16 19:35:32,910 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.26912389 -0.1279122 0.35458726] -2025-05-16 19:35:32,911 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70480275 0.70937581 0.00442813 -0.00440804] -2025-05-16 19:35:32,947 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.26975675 -0.12777739 0.3549508 ] -2025-05-16 19:35:32,948 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70465655 0.70951278 0.00450702 -0.00551799] -2025-05-16 19:35:32,978 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.27055958 -0.12749718 0.35536925] -2025-05-16 19:35:32,980 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70458966 0.70957073 0.0045389 -0.00649502] -2025-05-16 19:35:33,015 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.27088255 -0.12741138 0.35554082] -2025-05-16 19:35:33,016 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70451802 0.70963748 0.00455202 -0.00694827] -2025-05-16 19:35:33,048 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2714902 -0.1272512 0.35586591] -2025-05-16 19:35:33,050 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70433183 0.70981176 0.00460844 -0.00791797] -2025-05-16 19:35:33,079 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.27175258 -0.12719211 0.35599639] -2025-05-16 19:35:33,083 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70429048 0.70984634 0.00466427 -0.00844615] -2025-05-16 19:35:33,109 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.27264886 -0.12694636 0.35644914] -2025-05-16 19:35:33,111 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70414697 0.70996612 0.00482498 -0.01009345] -2025-05-16 19:35:33,146 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.27304266 -0.12687137 0.35665944] -2025-05-16 19:35:33,151 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70406129 0.71003951 0.00488025 -0.01085307] -2025-05-16 19:35:33,182 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.27350045 -0.12672864 0.35692425] -2025-05-16 19:35:33,184 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70394919 0.71013601 0.00501258 -0.01171594] -2025-05-16 19:35:33,216 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.27388252 -0.12664393 0.35711469] -2025-05-16 19:35:33,218 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70384026 0.71022688 0.00517177 -0.01264595] -2025-05-16 19:35:33,250 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.27443928 -0.12648329 0.35738046] -2025-05-16 19:35:33,260 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70370522 0.71033501 0.00540519 -0.01392576] -2025-05-16 19:35:33,292 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.27498133 -0.12633253 0.35764939] -2025-05-16 19:35:33,299 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70356696 0.7104419 0.00564179 -0.01529748] -2025-05-16 19:35:33,333 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.27538805 -0.12627995 0.35787012] -2025-05-16 19:35:33,335 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70343872 0.71054031 0.00584235 -0.0165014 ] -2025-05-16 19:35:33,367 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.27555037 -0.12622401 0.35795362] -2025-05-16 19:35:33,370 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70342419 0.7105411 0.00596564 -0.01703424] -2025-05-16 19:35:33,404 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.27583924 -0.12618122 0.35808728] -2025-05-16 19:35:33,407 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70326435 0.71067273 0.00620931 -0.01802691] -2025-05-16 19:35:33,441 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.27628774 -0.1260746 0.35827781] -2025-05-16 19:35:33,444 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70313273 0.71075996 0.00651465 -0.01955011] -2025-05-16 19:35:33,489 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.27668274 -0.12601086 0.35846012] -2025-05-16 19:35:33,492 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70300462 0.7108424 0.00680189 -0.02100754] -2025-05-16 19:35:33,531 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.27689022 -0.12600733 0.35853872] -2025-05-16 19:35:33,533 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70291278 0.71089351 0.00706947 -0.02222756] -2025-05-16 19:35:33,565 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.27699457 -0.12602667 0.35856705] -2025-05-16 19:35:33,568 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70274045 0.71103018 0.00737283 -0.02318589] -2025-05-16 19:35:33,599 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.27706029 -0.12601345 0.35856043] -2025-05-16 19:35:33,609 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70266238 0.71108189 0.00760087 -0.02388212] -2025-05-16 19:35:33,641 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.27736043 -0.12595232 0.35866461] -2025-05-16 19:35:33,644 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70249682 0.71117494 0.00811105 -0.02574156] -2025-05-16 19:35:33,698 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.27748724 -0.12595157 0.3586786 ] -2025-05-16 19:35:33,699 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70241658 0.71119543 0.00852113 -0.0271917 ] -2025-05-16 19:35:33,735 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.27739279 -0.1260777 0.35858366] -2025-05-16 19:35:33,747 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70221511 0.71134454 0.00890999 -0.02834595] -2025-05-16 19:35:33,775 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.27724963 -0.12615409 0.35848748] -2025-05-16 19:35:33,777 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70211602 0.71140488 0.00922536 -0.0291733 ] -2025-05-16 19:35:33,816 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.27719382 -0.12622834 0.35844984] -2025-05-16 19:35:33,819 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7020082 0.71144677 0.00965268 -0.03057469] -2025-05-16 19:35:33,853 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.27707034 -0.12632372 0.35836458] -2025-05-16 19:35:33,858 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70194643 0.71144397 0.01006413 -0.03189682] -2025-05-16 19:35:33,887 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2767786 -0.12652968 0.3581923 ] -2025-05-16 19:35:33,889 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70182197 0.71150417 0.01048429 -0.03313335] -2025-05-16 19:35:33,930 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.27653948 -0.12666185 0.35806082] -2025-05-16 19:35:33,931 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70177025 0.71153759 0.01063079 -0.03346274] -2025-05-16 19:35:33,968 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2761481 -0.12687038 0.35786836] -2025-05-16 19:35:33,969 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70163294 0.71161666 0.01103479 -0.03451357] -2025-05-16 19:35:34,001 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.27578912 -0.12705064 0.35770267] -2025-05-16 19:35:34,003 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70155791 0.71162604 0.01142749 -0.03569719] -2025-05-16 19:35:34,035 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2752399 -0.12734877 0.35742278] -2025-05-16 19:35:34,037 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70146127 0.71163483 0.01195366 -0.03721649] -2025-05-16 19:35:34,079 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.27494015 -0.12747304 0.35727709] -2025-05-16 19:35:34,088 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70145925 0.71161928 0.01209836 -0.0375041 ] -2025-05-16 19:35:34,119 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.27424067 -0.12778217 0.35693119] -2025-05-16 19:35:34,120 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70133668 0.71168691 0.01252313 -0.0383636 ] -2025-05-16 19:35:34,166 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.27386758 -0.12793381 0.35676765] -2025-05-16 19:35:34,170 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70131638 0.71168002 0.01272143 -0.03879496] -2025-05-16 19:35:34,204 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.27298695 -0.12832708 0.35640208] -2025-05-16 19:35:34,206 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70122542 0.71167415 0.01331218 -0.04031867] -2025-05-16 19:35:34,234 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.27248544 -0.12851941 0.35617047] -2025-05-16 19:35:34,235 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70118209 0.71168054 0.01356782 -0.04087054] -2025-05-16 19:35:34,265 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.27188228 -0.12873671 0.35587976] -2025-05-16 19:35:34,267 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70106164 0.71177572 0.01381269 -0.04119598] -2025-05-16 19:35:34,295 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2712107 -0.12899209 0.35557036] -2025-05-16 19:35:34,297 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70101935 0.71179989 0.01401244 -0.04143004] -2025-05-16 19:35:34,326 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.27092961 -0.12907544 0.35545752] -2025-05-16 19:35:34,329 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70103553 0.71178155 0.01407211 -0.041451 ] -2025-05-16 19:35:34,358 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.26998189 -0.12943839 0.35508634] -2025-05-16 19:35:34,361 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7010046 0.71174852 0.01451432 -0.04237832] -2025-05-16 19:35:34,389 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.26930001 -0.12969958 0.35479106] -2025-05-16 19:35:34,391 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70098489 0.71172874 0.01478112 -0.04294064] -2025-05-16 19:35:34,421 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.26847286 -0.12998183 0.35440775] -2025-05-16 19:35:34,423 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70091342 0.7117731 0.01504817 -0.04327797] -2025-05-16 19:35:34,450 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.26810309 -0.13010759 0.35422686] -2025-05-16 19:35:34,452 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70089187 0.71179545 0.015103 -0.04324018] -2025-05-16 19:35:34,486 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.26729075 -0.13038692 0.35386985] -2025-05-16 19:35:34,487 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70088601 0.71180023 0.01521259 -0.04321828] -2025-05-16 19:35:34,519 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.26622787 -0.13074101 0.35346088] -2025-05-16 19:35:34,521 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7009328 0.71171883 0.01555166 -0.04367677] -2025-05-16 19:35:34,554 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.26578461 -0.13089992 0.35327103] -2025-05-16 19:35:34,566 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70094038 0.71170079 0.01565758 -0.0438111 ] -2025-05-16 19:35:34,596 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2647125 -0.13126333 0.35278722] -2025-05-16 19:35:34,597 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70092454 0.71169311 0.01591115 -0.04409698] -2025-05-16 19:35:34,626 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.26398105 -0.13152563 0.35245114] -2025-05-16 19:35:34,627 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.700911 0.71171581 0.015912 -0.04394509] -2025-05-16 19:35:34,654 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.26301431 -0.13185441 0.35203841] -2025-05-16 19:35:34,657 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70096125 0.7116727 0.01596924 -0.0438211 ] -2025-05-16 19:35:34,690 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.26248613 -0.13202079 0.35182702] -2025-05-16 19:35:34,693 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70100991 0.71162966 0.01601132 -0.04372607] -2025-05-16 19:35:34,722 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.26189155 -0.13219786 0.35157857] -2025-05-16 19:35:34,724 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70107424 0.71156821 0.0160883 -0.04366647] -2025-05-16 19:35:34,755 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.26137443 -0.13235784 0.35134977] -2025-05-16 19:35:34,758 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70111602 0.71153105 0.01613377 -0.04358436] -2025-05-16 19:35:34,787 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.26022827 -0.13272809 0.3508247 ] -2025-05-16 19:35:34,789 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70117108 0.7114912 0.0161988 -0.0433242 ] -2025-05-16 19:35:34,818 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25926881 -0.13304692 0.35040551] -2025-05-16 19:35:34,820 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70122569 0.71146567 0.01613479 -0.04288114] -2025-05-16 19:35:34,850 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25876903 -0.13320403 0.3501892 ] -2025-05-16 19:35:34,851 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70130026 0.71141409 0.01606089 -0.04254405] -2025-05-16 19:35:34,882 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25821724 -0.13334793 0.349942 ] -2025-05-16 19:35:34,886 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70140104 0.71133684 0.01602486 -0.04218621] -2025-05-16 19:35:34,918 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25779095 -0.13347594 0.34975519] -2025-05-16 19:35:34,919 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70146403 0.71129394 0.01597561 -0.0418799 ] -2025-05-16 19:35:34,948 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25658271 -0.13384897 0.34919196] -2025-05-16 19:35:34,957 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70161259 0.71118602 0.01591867 -0.0412408 ] -2025-05-16 19:35:34,992 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25568722 -0.13416106 0.34877904] -2025-05-16 19:35:34,995 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70170244 0.71114484 0.01570955 -0.04049598] -2025-05-16 19:35:35,029 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25528264 -0.13427232 0.34858586] -2025-05-16 19:35:35,032 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70178994 0.71109418 0.01555519 -0.03992471] -2025-05-16 19:35:35,068 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25487987 -0.13437973 0.34840855] -2025-05-16 19:35:35,070 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70190795 0.71101623 0.01539244 -0.03929669] -2025-05-16 19:35:35,105 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2540719 -0.13458256 0.34799727] -2025-05-16 19:35:35,106 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70214718 0.71082842 0.01525232 -0.03846642] -2025-05-16 19:35:35,135 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25320964 -0.13489182 0.3475766 ] -2025-05-16 19:35:35,136 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70228027 0.71075615 0.01496251 -0.0374733 ] -2025-05-16 19:35:35,165 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25297808 -0.13496511 0.34743602] -2025-05-16 19:35:35,166 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70233975 0.7107277 0.01480403 -0.0369575 ] -2025-05-16 19:35:35,196 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2526532 -0.1350777 0.34727357] -2025-05-16 19:35:35,197 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70243395 0.71068285 0.014525 -0.03613099] -2025-05-16 19:35:35,230 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25245183 -0.13511571 0.34718068] -2025-05-16 19:35:35,232 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70257512 0.7105783 0.01432801 -0.035516 ] -2025-05-16 19:35:35,265 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25201431 -0.13520794 0.34694634] -2025-05-16 19:35:35,267 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70277333 0.71042553 0.01413736 -0.03471811] -2025-05-16 19:35:35,298 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25120849 -0.13547302 0.34650692] -2025-05-16 19:35:35,300 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70293567 0.71033294 0.01380628 -0.03343554] -2025-05-16 19:35:35,327 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25092232 -0.13556516 0.34633266] -2025-05-16 19:35:35,329 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70304535 0.71026924 0.01353001 -0.03258514] -2025-05-16 19:35:35,358 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25071481 -0.13563833 0.34620463] -2025-05-16 19:35:35,360 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70317632 0.71019237 0.01317487 -0.03156417] -2025-05-16 19:35:35,386 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25066146 -0.13564965 0.34618639] -2025-05-16 19:35:35,400 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70326064 0.71014174 0.01292887 -0.03091981] -2025-05-16 19:35:35,436 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24989267 -0.13577691 0.34572946] -2025-05-16 19:35:35,439 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70362309 0.70988248 0.01243347 -0.0287545 ] -2025-05-16 19:35:35,466 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24970678 -0.13583681 0.34561256] -2025-05-16 19:35:35,467 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70371484 0.70982051 0.01224649 -0.02811227] -2025-05-16 19:35:35,498 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24946933 -0.13590455 0.34544604] -2025-05-16 19:35:35,500 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7038509 0.7097322 0.01193418 -0.02704967] -2025-05-16 19:35:35,532 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24937045 -0.13596188 0.34538234] -2025-05-16 19:35:35,535 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70390531 0.70972009 0.01157331 -0.02609134] -2025-05-16 19:35:35,567 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24924964 -0.13597178 0.34530435] -2025-05-16 19:35:35,568 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70408511 0.70959017 0.01114644 -0.02493407] -2025-05-16 19:35:35,599 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24883868 -0.13609475 0.34503484] -2025-05-16 19:35:35,602 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70434039 0.70940488 0.01062151 -0.02316286] -2025-05-16 19:35:35,630 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24867377 -0.13614483 0.34492087] -2025-05-16 19:35:35,632 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70449825 0.70928403 0.01033 -0.02217388] -2025-05-16 19:35:35,664 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24854253 -0.13615877 0.344796 ] -2025-05-16 19:35:35,667 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70462512 0.70919676 0.00999858 -0.02105767] -2025-05-16 19:35:35,703 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24849659 -0.13621387 0.34476534] -2025-05-16 19:35:35,706 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70464475 0.70920382 0.00968513 -0.02029558] -2025-05-16 19:35:35,738 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24837028 -0.13621852 0.34464832] -2025-05-16 19:35:35,747 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70489529 0.70900801 0.00909133 -0.01864465] -2025-05-16 19:35:35,779 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24809899 -0.13634003 0.34444849] -2025-05-16 19:35:35,780 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70520131 0.70876528 0.00837503 -0.01651473] -2025-05-16 19:35:35,812 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24799872 -0.13630039 0.34433364] -2025-05-16 19:35:35,815 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70536168 0.70863847 0.00806688 -0.01520979] -2025-05-16 19:35:35,853 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24798498 -0.13630004 0.34431089] -2025-05-16 19:35:35,855 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70536696 0.70864321 0.00795095 -0.01479985] -2025-05-16 19:35:35,887 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24796846 -0.13629231 0.34427758] -2025-05-16 19:35:35,888 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70548665 0.7085513 0.00754295 -0.01366563] -2025-05-16 19:35:35,924 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24783615 -0.13636181 0.34413029] -2025-05-16 19:35:35,933 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7057528 0.70833009 0.00680567 -0.0116255 ] -2025-05-16 19:35:35,979 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24771127 -0.13642861 0.34399265] -2025-05-16 19:35:35,988 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7060035 0.70811696 0.00607812 -0.00961663] -2025-05-16 19:35:36,020 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24766444 -0.13640295 0.34392808] -2025-05-16 19:35:36,021 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70614756 0.70799505 0.00565169 -0.00816659] -2025-05-16 19:35:36,053 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24770568 -0.13636644 0.3439295 ] -2025-05-16 19:35:36,054 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70617786 0.70797119 0.00549507 -0.00770852] -2025-05-16 19:35:36,085 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24769363 -0.13639766 0.34387256] -2025-05-16 19:35:36,087 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70621839 0.70793723 0.00529693 -0.00723917] -2025-05-16 19:35:36,115 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24769937 -0.13643257 0.34382798] -2025-05-16 19:35:36,116 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70638996 0.70778641 0.0046107 -0.00551069] -2025-05-16 19:35:36,147 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24768782 -0.1364556 0.34376042] -2025-05-16 19:35:36,150 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70653481 0.70765371 0.0041154 -0.00422631] -2025-05-16 19:35:36,178 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24764433 -0.13642896 0.34367152] -2025-05-16 19:35:36,181 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70676788 0.70743326 0.00350405 -0.00225138] -2025-05-16 19:35:36,216 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24770221 -0.13634573 0.343628 ] -2025-05-16 19:35:36,218 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70686098 0.70734386 0.0032507 -0.00128872] -2025-05-16 19:35:36,245 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24775458 -0.13634156 0.34360463] -2025-05-16 19:35:36,247 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06912442e-01 7.07294875e-01 2.92681505e-03 -4.39506997e-04] -2025-05-16 19:35:36,278 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2477883 -0.1363481 0.34358765] -2025-05-16 19:35:36,279 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06942315e-01 7.07266078e-01 2.68952777e-03 1.55551111e-04] -2025-05-16 19:35:36,311 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24783946 -0.13632909 0.34351485] -2025-05-16 19:35:36,313 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70721271 -0.70699406 -0.00182633 -0.00249865] -2025-05-16 19:35:36,345 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24785816 -0.13632942 0.34348939] -2025-05-16 19:35:36,347 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70726847 -0.70693609 -0.00156884 -0.00319733] -2025-05-16 19:35:36,378 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24790566 -0.13630829 0.3434611 ] -2025-05-16 19:35:36,380 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.7073551 -0.70684482 -0.00119779 -0.00421108] -2025-05-16 19:35:36,412 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24802161 -0.13624742 0.34343946] -2025-05-16 19:35:36,413 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70743283 -0.70675941 -0.00078051 -0.0054143 ] -2025-05-16 19:35:36,444 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24809828 -0.13623461 0.34341775] -2025-05-16 19:35:36,446 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07530270e-01 -7.06653432e-01 -3.61366158e-04 -6.45855114e-03] -2025-05-16 19:35:36,487 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24815253 -0.13623464 0.34336873] -2025-05-16 19:35:36,489 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07711873e-01 -7.06456934e-01 1.93587140e-04 -7.90369287e-03] -2025-05-16 19:35:36,517 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24819348 -0.1362203 0.34333569] -2025-05-16 19:35:36,518 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07802517e-01 -7.06355718e-01 5.20836044e-04 -8.77070661e-03] -2025-05-16 19:35:36,547 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24829191 -0.13617988 0.34331921] -2025-05-16 19:35:36,548 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70788511 -0.70625754 0.00096073 -0.00990165] -2025-05-16 19:35:36,583 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24844332 -0.13609272 0.34330914] -2025-05-16 19:35:36,584 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70797165 -0.70615198 0.00137044 -0.01112004] -2025-05-16 19:35:36,619 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24847584 -0.13606818 0.34329625] -2025-05-16 19:35:36,620 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70801551 -0.70610128 0.00149817 -0.01152267] -2025-05-16 19:35:36,652 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24853014 -0.13604129 0.34324889] -2025-05-16 19:35:36,654 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70816125 -0.70593383 0.00191109 -0.01270496] -2025-05-16 19:35:36,687 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24858997 -0.13600961 0.34322748] -2025-05-16 19:35:36,689 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70825903 -0.70581942 0.00221621 -0.01353424] -2025-05-16 19:35:36,722 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2487002 -0.13598005 0.3432056 ] -2025-05-16 19:35:36,723 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70831187 -0.70574109 0.00268957 -0.01471671] -2025-05-16 19:35:36,751 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24885007 -0.13592842 0.34320736] -2025-05-16 19:35:36,752 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70838325 -0.70564883 0.00306544 -0.01560424] -2025-05-16 19:35:36,785 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24888256 -0.13591793 0.34318672] -2025-05-16 19:35:36,786 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70841122 -0.70561454 0.00316297 -0.01586386] -2025-05-16 19:35:36,814 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24894732 -0.13588586 0.34315082] -2025-05-16 19:35:36,816 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.7085178 -0.70548592 0.00348574 -0.0167333 ] -2025-05-16 19:35:36,846 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24899756 -0.1358635 0.34310948] -2025-05-16 19:35:36,847 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70860242 -0.7053831 0.00373467 -0.01741691] -2025-05-16 19:35:36,876 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24910048 -0.13584255 0.34307665] -2025-05-16 19:35:36,887 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70867793 -0.70527802 0.00417007 -0.0184693 ] -2025-05-16 19:35:36,916 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24919664 -0.13582198 0.34305401] -2025-05-16 19:35:36,919 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70871937 -0.7052195 0.00443427 -0.01904339] -2025-05-16 19:35:36,947 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2492522 -0.13580844 0.34302818] -2025-05-16 19:35:36,948 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70875193 -0.7051767 0.0045825 -0.01937855] -2025-05-16 19:35:36,980 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24932241 -0.13578493 0.34298399] -2025-05-16 19:35:36,985 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70882063 -0.70508687 0.0048473 -0.02005823] -2025-05-16 19:35:37,018 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24941531 -0.13575854 0.34293471] -2025-05-16 19:35:37,019 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70891424 -0.70496547 0.00519729 -0.02091125] -2025-05-16 19:35:37,046 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24945286 -0.13575635 0.34292268] -2025-05-16 19:35:37,048 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70892559 -0.70494532 0.00532525 -0.0211717 ] -2025-05-16 19:35:37,074 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24950013 -0.13576421 0.34291081] -2025-05-16 19:35:37,078 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70893775 -0.70492421 0.00548151 -0.02142634] -2025-05-16 19:35:37,105 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24958221 -0.13573356 0.34286141] -2025-05-16 19:35:37,106 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70898086 -0.70486601 0.00565989 -0.02186337] -2025-05-16 19:35:37,134 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24960352 -0.13572415 0.34284074] -2025-05-16 19:35:37,134 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70899163 -0.70485067 0.0057087 -0.0219959 ] -2025-05-16 19:35:37,162 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24969491 -0.13566905 0.34278929] -2025-05-16 19:35:37,163 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70908645 -0.70472881 0.00597077 -0.02276093] -2025-05-16 19:35:37,190 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24973317 -0.13564685 0.34276891] -2025-05-16 19:35:37,193 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70912059 -0.70468672 0.00604565 -0.02297978] -2025-05-16 19:35:37,223 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24979657 -0.13564042 0.34274511] -2025-05-16 19:35:37,225 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70913584 -0.70466181 0.00619758 -0.0232312 ] -2025-05-16 19:35:37,254 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24981863 -0.13563343 0.34273111] -2025-05-16 19:35:37,257 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70914048 -0.70465605 0.00622424 -0.02325694] -2025-05-16 19:35:37,290 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24989963 -0.13559148 0.34268074] -2025-05-16 19:35:37,293 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70917558 -0.70460773 0.00636136 -0.02361091] -2025-05-16 19:35:37,322 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24992086 -0.1355702 0.34266506] -2025-05-16 19:35:37,331 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70919654 -0.70458206 0.00639305 -0.02373852] -2025-05-16 19:35:37,361 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25001538 -0.13551125 0.34263162] -2025-05-16 19:35:37,362 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70925596 -0.70450707 0.0065345 -0.02414704] -2025-05-16 19:35:37,393 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25000827 -0.13551244 0.34263406] -2025-05-16 19:35:37,399 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70925024 -0.70451614 0.00650059 -0.02405911] -2025-05-16 19:35:37,429 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004775 -0.13550687 0.34261237] -2025-05-16 19:35:37,431 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70925285 -0.70451279 0.00654603 -0.02406796] -2025-05-16 19:35:37,467 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25009478 -0.1354892 0.34257497] -2025-05-16 19:35:37,470 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70925754 -0.70450697 0.00658409 -0.02408978] -2025-05-16 19:35:37,504 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25016377 -0.1354323 0.34254914] -2025-05-16 19:35:37,507 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70928629 -0.70447239 0.00662178 -0.02424384] -2025-05-16 19:35:37,540 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25019012 -0.13541288 0.34254864] -2025-05-16 19:35:37,543 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70929621 -0.70446234 0.00661451 -0.02424785] -2025-05-16 19:35:37,570 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25019396 -0.13540632 0.34254659] -2025-05-16 19:35:37,572 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.7093054 -0.70445709 0.0065684 -0.02414362] -2025-05-16 19:35:37,600 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25019639 -0.13540069 0.34253929] -2025-05-16 19:35:37,602 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70932351 -0.70444386 0.00651308 -0.02401243] -2025-05-16 19:35:37,638 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25022518 -0.13537964 0.34250452] -2025-05-16 19:35:37,647 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70935719 -0.70441723 0.00644595 -0.02381586] -2025-05-16 19:35:37,675 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25028069 -0.13534372 0.34248898] -2025-05-16 19:35:37,678 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70936258 -0.70441574 0.00641074 -0.02370852] -2025-05-16 19:35:37,708 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25029856 -0.13533168 0.34248723] -2025-05-16 19:35:37,711 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70935515 -0.70442671 0.00637312 -0.02361495] -2025-05-16 19:35:37,743 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25030759 -0.13533186 0.34249496] -2025-05-16 19:35:37,747 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70935355 -0.70443689 0.00629248 -0.02337999] -2025-05-16 19:35:37,781 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25032604 -0.1353264 0.34246632] -2025-05-16 19:35:37,783 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70937968 -0.70443441 0.00602991 -0.02272138] -2025-05-16 19:35:37,811 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25030632 -0.13534164 0.34249199] -2025-05-16 19:35:37,816 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70935723 -0.70445868 0.00603918 -0.02266772] -2025-05-16 19:35:37,847 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25031355 -0.13534054 0.34252263] -2025-05-16 19:35:37,849 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70934267 -0.70447519 0.00602772 -0.02261303] -2025-05-16 19:35:37,880 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.250356 -0.135304 0.34255118] -2025-05-16 19:35:37,881 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70936296 -0.7044681 0.00587716 -0.02223387] -2025-05-16 19:35:37,915 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25034289 -0.13531648 0.34256978] -2025-05-16 19:35:37,932 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70933754 -0.70449532 0.00587378 -0.02218326] -2025-05-16 19:35:37,967 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25031586 -0.13533808 0.34253688] -2025-05-16 19:35:37,968 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70932772 -0.70453045 0.00558816 -0.02144295] -2025-05-16 19:35:37,996 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25030519 -0.13535097 0.34257764] -2025-05-16 19:35:37,998 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70929315 -0.70458075 0.00544486 -0.02096529] -2025-05-16 19:35:38,027 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25035072 -0.13531329 0.34263421] -2025-05-16 19:35:38,028 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70933507 -0.70455014 0.00533364 -0.02060138] -2025-05-16 19:35:38,066 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25034482 -0.13532974 0.34268228] -2025-05-16 19:35:38,067 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.7092711 -0.70462577 0.00523645 -0.02023887] -2025-05-16 19:35:38,093 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25034093 -0.13533102 0.34267945] -2025-05-16 19:35:38,095 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70925739 -0.70465298 0.00507593 -0.01980852] -2025-05-16 19:35:38,125 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2503235 -0.1353483 0.34267769] -2025-05-16 19:35:38,126 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70921929 -0.70470917 0.00486385 -0.01921791] -2025-05-16 19:35:38,153 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25031815 -0.13535309 0.34268382] -2025-05-16 19:35:38,155 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70920463 -0.70472909 0.00480937 -0.01904146] -2025-05-16 19:35:38,186 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25031887 -0.13536412 0.34271615] -2025-05-16 19:35:38,188 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70918076 -0.70476344 0.00471968 -0.01867822] -2025-05-16 19:35:38,215 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25034776 -0.13534726 0.34280273] -2025-05-16 19:35:38,216 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70912867 -0.7048389 0.00448645 -0.01784739] -2025-05-16 19:35:38,251 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25033507 -0.13535343 0.34281033] -2025-05-16 19:35:38,253 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70910324 -0.70486995 0.00442516 -0.01764568] -2025-05-16 19:35:38,287 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25032272 -0.13534742 0.34281969] -2025-05-16 19:35:38,288 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70905815 -0.70493935 0.00408087 -0.01674513] -2025-05-16 19:35:38,320 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25029893 -0.13535589 0.34284449] -2025-05-16 19:35:38,321 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70901385 -0.70499748 0.00390366 -0.01620737] -2025-05-16 19:35:38,350 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25029975 -0.13534572 0.34287695] -2025-05-16 19:35:38,352 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70899125 -0.70502853 0.00379268 -0.01586793] -2025-05-16 19:35:38,382 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2503112 -0.1353149 0.34293934] -2025-05-16 19:35:38,383 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70892801 -0.70511123 0.00352306 -0.01506038] -2025-05-16 19:35:38,410 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25029929 -0.13531258 0.34297235] -2025-05-16 19:35:38,414 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70889799 -0.70515004 0.00340742 -0.01467823] -2025-05-16 19:35:38,443 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25030016 -0.13528585 0.34298492] -2025-05-16 19:35:38,445 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70884561 -0.70522004 0.00309137 -0.01389373] -2025-05-16 19:35:38,488 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25027828 -0.13527443 0.34301771] -2025-05-16 19:35:38,502 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70876638 -0.70531354 0.00284287 -0.01322698] -2025-05-16 19:35:38,532 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25028894 -0.13521906 0.34310241] -2025-05-16 19:35:38,533 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70869967 -0.70540288 0.00243975 -0.01206652] -2025-05-16 19:35:38,562 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25028283 -0.13522395 0.34312313] -2025-05-16 19:35:38,564 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70866365 -0.70544453 0.0023538 -0.01176063] -2025-05-16 19:35:38,598 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25027203 -0.1352166 0.34314459] -2025-05-16 19:35:38,600 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70860128 -0.70552066 0.00208504 -0.01097634] -2025-05-16 19:35:38,633 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25026277 -0.13521019 0.34313296] -2025-05-16 19:35:38,634 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70857717 -0.70554933 0.00196933 -0.01070792] -2025-05-16 19:35:38,664 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25028622 -0.13518311 0.34319836] -2025-05-16 19:35:38,665 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70852841 -0.70561007 0.00175152 -0.00994258] -2025-05-16 19:35:38,702 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25026425 -0.13519687 0.34317905] -2025-05-16 19:35:38,702 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70850148 -0.70563716 0.0017616 -0.00993682] -2025-05-16 19:35:38,732 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25023578 -0.13522406 0.34320834] -2025-05-16 19:35:38,732 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70846982 -0.70567255 0.00168934 -0.00969093] -2025-05-16 19:35:38,763 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25023598 -0.13518829 0.34320251] -2025-05-16 19:35:38,765 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70842848 -0.70572482 0.00139626 -0.00892264] -2025-05-16 19:35:38,794 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25021693 -0.13520547 0.34320387] -2025-05-16 19:35:38,795 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70837293 -0.7057854 0.00128687 -0.00854986] -2025-05-16 19:35:38,821 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25025064 -0.1351848 0.34324122] -2025-05-16 19:35:38,822 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70833956 -0.70582387 0.00124984 -0.00813434] -2025-05-16 19:35:38,849 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25024837 -0.13519518 0.34324896] -2025-05-16 19:35:38,850 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.7083031 -0.7058608 0.00123996 -0.00810609] -2025-05-16 19:35:38,877 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25022459 -0.13522134 0.34324769] -2025-05-16 19:35:38,879 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70827303 -0.70589225 0.0011991 -0.008001 ] -2025-05-16 19:35:38,907 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25021543 -0.13519601 0.34327236] -2025-05-16 19:35:38,911 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70822743 -0.70594713 0.00090447 -0.00719285] -2025-05-16 19:35:38,937 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25019649 -0.13521129 0.34328247] -2025-05-16 19:35:38,939 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70816172 -0.70601764 0.00079159 -0.00674094] -2025-05-16 19:35:38,966 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25022414 -0.13519629 0.34330711] -2025-05-16 19:35:38,967 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70813305 -0.70604971 0.00071246 -0.00639482] -2025-05-16 19:35:38,997 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25022341 -0.1352039 0.34331334] -2025-05-16 19:35:38,998 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.08043441e-01 -7.06145660e-01 5.68543125e-04 -5.69818229e-03] -2025-05-16 19:35:39,027 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25021407 -0.13522343 0.34331458] -2025-05-16 19:35:39,028 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07999984e-01 -7.06190365e-01 5.27731980e-04 -5.55992629e-03] -2025-05-16 19:35:39,054 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25020229 -0.13521036 0.34335028] -2025-05-16 19:35:39,054 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07970069e-01 -7.06225481e-01 2.93894454e-04 -4.88519221e-03] -2025-05-16 19:35:39,082 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25019133 -0.13521896 0.34336257] -2025-05-16 19:35:39,082 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07929203e-01 -7.06268493e-01 2.04990902e-04 -4.58453309e-03] -2025-05-16 19:35:39,114 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25019311 -0.13521472 0.34338769] -2025-05-16 19:35:39,117 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07826706e-01 -7.06375504e-01 -3.64606541e-06 -3.87310594e-03] -2025-05-16 19:35:39,148 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25021277 -0.13520319 0.34341684] -2025-05-16 19:35:39,149 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07761139e-01 -7.06444035e-01 -1.81039993e-04 -3.31097068e-03] -2025-05-16 19:35:39,181 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25023383 -0.13520054 0.34340332] -2025-05-16 19:35:39,183 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07751925e-01 -7.06453393e-01 -1.97308217e-04 -3.28295710e-03] -2025-05-16 19:35:39,211 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25024572 -0.13520407 0.34342613] -2025-05-16 19:35:39,212 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07743380e-01 -7.06461947e-01 -1.91434533e-04 -3.28471861e-03] -2025-05-16 19:35:39,244 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25023521 -0.13519116 0.34346794] -2025-05-16 19:35:39,244 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07682855e-01 -7.06524567e-01 -3.56716224e-04 -2.80818034e-03] -2025-05-16 19:35:39,271 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25024018 -0.1351779 0.34350392] -2025-05-16 19:35:39,272 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07617244e-01 -7.06592051e-01 -5.18503286e-04 -2.28917706e-03] -2025-05-16 19:35:39,298 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25025567 -0.13516177 0.34353294] -2025-05-16 19:35:39,301 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07579577e-01 -7.06630712e-01 -6.24938193e-04 -1.94641718e-03] -2025-05-16 19:35:39,331 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25030159 -0.13513737 0.34354402] -2025-05-16 19:35:39,332 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70751313 -0.70669844 -0.00085051 -0.00132813] -2025-05-16 19:35:39,362 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25031569 -0.13514187 0.34356901] -2025-05-16 19:35:39,363 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70748447 -0.70672728 -0.00088298 -0.00122436] -2025-05-16 19:35:39,395 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25033049 -0.13512305 0.34364173] -2025-05-16 19:35:39,396 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.7074384 -0.70677383 -0.00104306 -0.00075797] -2025-05-16 19:35:39,428 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2503262 -0.1351053 0.3436747] -2025-05-16 19:35:39,430 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07385342e-01 -7.06827020e-01 -1.17266758e-03 -4.07419504e-04] -2025-05-16 19:35:39,458 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25034626 -0.13509716 0.3437234 ] -2025-05-16 19:35:39,462 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07277172e-01 -7.06934904e-01 -1.39046698e-03 3.30478902e-04] -2025-05-16 19:35:39,494 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25036816 -0.13509018 0.3437362 ] -2025-05-16 19:35:39,495 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70722275 -0.70698879 -0.00152616 0.00071212] -2025-05-16 19:35:39,528 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25038113 -0.1350955 0.34378146] -2025-05-16 19:35:39,530 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.7071564 -0.70705435 -0.00165286 0.00111226] -2025-05-16 19:35:39,563 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25038327 -0.13509832 0.34383736] -2025-05-16 19:35:39,564 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70710664 -0.70710339 -0.00174181 0.00139902] -2025-05-16 19:35:39,596 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25038334 -0.13509079 0.34392348] -2025-05-16 19:35:39,597 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70697355 0.7072335 0.00201198 -0.00226175] -2025-05-16 19:35:39,639 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25038911 -0.13509533 0.34393938] -2025-05-16 19:35:39,641 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70693175 0.70727393 0.0021019 -0.00258322] -2025-05-16 19:35:39,670 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25041694 -0.13510915 0.34397184] -2025-05-16 19:35:39,672 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70684774 0.70735498 0.00227623 -0.00316584] -2025-05-16 19:35:39,707 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25042812 -0.13512572 0.34405495] -2025-05-16 19:35:39,710 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70679717 0.7074033 0.00238237 -0.00355821] -2025-05-16 19:35:39,745 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25043174 -0.13514545 0.34414876] -2025-05-16 19:35:39,750 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70668025 0.70751608 0.00254129 -0.00419199] -2025-05-16 19:35:39,782 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25044864 -0.13514707 0.34419334] -2025-05-16 19:35:39,786 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70665042 0.70754458 0.00258899 -0.00437689] -2025-05-16 19:35:39,817 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25047651 -0.13517959 0.34426899] -2025-05-16 19:35:39,819 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70655574 0.70763493 0.00272954 -0.00493373] -2025-05-16 19:35:39,853 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2504986 -0.13520911 0.34437641] -2025-05-16 19:35:39,855 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70647665 0.70770848 0.00289842 -0.00557251] -2025-05-16 19:35:39,886 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25047071 -0.13525753 0.34448053] -2025-05-16 19:35:39,888 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70641065 0.70777311 0.00289036 -0.0057328 ] -2025-05-16 19:35:39,919 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25051017 -0.1352437 0.3445449 ] -2025-05-16 19:35:39,920 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70646894 0.70771845 0.00271244 -0.00537407] -2025-05-16 19:35:39,951 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25048536 -0.1352556 0.34462105] -2025-05-16 19:35:39,954 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70645239 0.70773431 0.00276428 -0.00543378] -2025-05-16 19:35:39,986 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25051536 -0.13528734 0.34478535] -2025-05-16 19:35:39,987 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70639336 0.70778771 0.00293746 -0.00602852] -2025-05-16 19:35:40,017 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25053121 -0.13531672 0.34490827] -2025-05-16 19:35:40,019 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70634978 0.70782763 0.00303215 -0.00639081] -2025-05-16 19:35:40,046 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25055603 -0.13536181 0.34512616] -2025-05-16 19:35:40,048 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7062753 0.70789825 0.00307434 -0.00676806] -2025-05-16 19:35:40,090 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25058823 -0.13536573 0.34521886] -2025-05-16 19:35:40,100 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70627442 0.70790009 0.00302091 -0.00669121] -2025-05-16 19:35:40,134 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25060478 -0.13537707 0.34546108] -2025-05-16 19:35:40,140 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70625876 0.70791598 0.00300553 -0.0066707 ] -2025-05-16 19:35:40,170 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25062908 -0.13540827 0.34560679] -2025-05-16 19:35:40,172 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70624418 0.70792667 0.003152 -0.00700384] -2025-05-16 19:35:40,199 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25064364 -0.13543945 0.34574968] -2025-05-16 19:35:40,201 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7062234 0.70794617 0.00317424 -0.00711702] -2025-05-16 19:35:40,247 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25067503 -0.13545277 0.34586318] -2025-05-16 19:35:40,248 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70618207 0.70798587 0.00317056 -0.00726895] -2025-05-16 19:35:40,279 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25071558 -0.13546817 0.34601314] -2025-05-16 19:35:40,280 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70615853 0.70800972 0.00314749 -0.00724229] -2025-05-16 19:35:40,315 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25074772 -0.13548962 0.34625619] -2025-05-16 19:35:40,316 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70614001 0.70802802 0.0031538 -0.00725662] -2025-05-16 19:35:40,352 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25077622 -0.13555732 0.34654036] -2025-05-16 19:35:40,359 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7061087 0.7080567 0.00324836 -0.00746088] -2025-05-16 19:35:40,386 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25079681 -0.13560538 0.3467423 ] -2025-05-16 19:35:40,386 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70607797 0.70808542 0.00331563 -0.00761285] -2025-05-16 19:35:40,414 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25084106 -0.13563541 0.34694587] -2025-05-16 19:35:40,415 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70604568 0.70811708 0.00330833 -0.00766459] -2025-05-16 19:35:40,446 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25085869 -0.13566217 0.34706391] -2025-05-16 19:35:40,447 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70604171 0.70812147 0.00330081 -0.00762853] -2025-05-16 19:35:40,480 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25088922 -0.13571375 0.3473638 ] -2025-05-16 19:35:40,481 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70601319 0.70814994 0.00332101 -0.00761621] -2025-05-16 19:35:40,515 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25088467 -0.13574968 0.34746229] -2025-05-16 19:35:40,517 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70600054 0.70816248 0.00335144 -0.00761014] -2025-05-16 19:35:40,549 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25091018 -0.13582599 0.34778849] -2025-05-16 19:35:40,550 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70595122 0.70820966 0.0034541 -0.00774715] -2025-05-16 19:35:40,588 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25096226 -0.13588413 0.34808801] -2025-05-16 19:35:40,589 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70588637 0.70827413 0.00347171 -0.00775517] -2025-05-16 19:35:40,619 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25099415 -0.13594268 0.34833047] -2025-05-16 19:35:40,621 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7058012 0.70835969 0.00345637 -0.00769835] -2025-05-16 19:35:40,650 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25101435 -0.13596548 0.34843548] -2025-05-16 19:35:40,651 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70577644 0.70838508 0.00343944 -0.00763956] -2025-05-16 19:35:40,679 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25101806 -0.13603811 0.34866565] -2025-05-16 19:35:40,680 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70575319 0.70840813 0.00348322 -0.00763094] -2025-05-16 19:35:40,715 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2510159 -0.13606996 0.34880517] -2025-05-16 19:35:40,716 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70573622 0.70842487 0.00352292 -0.0076277 ] -2025-05-16 19:35:40,744 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25105541 -0.1361435 0.34918247] -2025-05-16 19:35:40,745 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70567083 0.70849014 0.0035545 -0.00760068] -2025-05-16 19:35:40,779 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25106322 -0.13616855 0.34930296] -2025-05-16 19:35:40,782 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70563429 0.70852712 0.00354724 -0.00754899] -2025-05-16 19:35:40,814 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25108849 -0.13621817 0.3495848 ] -2025-05-16 19:35:40,815 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70555756 0.70860519 0.00354237 -0.00739368] -2025-05-16 19:35:40,844 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25108696 -0.13626935 0.34977501] -2025-05-16 19:35:40,845 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70553372 0.70862989 0.00354509 -0.00729967] -2025-05-16 19:35:40,875 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25107984 -0.13629959 0.34991847] -2025-05-16 19:35:40,879 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70551316 0.70865087 0.0035611 -0.00724187] -2025-05-16 19:35:40,910 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25109293 -0.13635158 0.350233 ] -2025-05-16 19:35:40,912 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70547006 0.7086947 0.00359043 -0.0071367 ] -2025-05-16 19:35:40,939 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25109658 -0.13636578 0.35037846] -2025-05-16 19:35:40,943 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70544495 0.70872075 0.0035851 -0.00703361] -2025-05-16 19:35:40,972 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2511071 -0.13640662 0.35060871] -2025-05-16 19:35:40,974 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70537814 0.70878911 0.00357139 -0.00685014] -2025-05-16 19:35:41,002 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25110679 -0.13643027 0.35073607] -2025-05-16 19:35:41,014 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70534995 0.70881845 0.00356372 -0.00671882] -2025-05-16 19:35:41,052 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25109787 -0.13646808 0.35093379] -2025-05-16 19:35:41,055 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70531722 0.70885247 0.00356705 -0.00656225] -2025-05-16 19:35:41,084 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25108795 -0.13651592 0.35123297] -2025-05-16 19:35:41,087 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70527549 0.70889587 0.00357287 -0.00635268] -2025-05-16 19:35:41,118 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25108723 -0.13653586 0.35146095] -2025-05-16 19:35:41,119 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70522757 0.70894556 0.00358266 -0.00611818] -2025-05-16 19:35:41,146 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2510832 -0.13654596 0.35151576] -2025-05-16 19:35:41,148 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70520992 0.70896411 0.00357813 -0.00600434] -2025-05-16 19:35:41,180 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25108308 -0.13654848 0.35154664] -2025-05-16 19:35:41,182 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70520167 0.70897313 0.00356954 -0.00591307] -2025-05-16 19:35:41,217 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25107455 -0.13657691 0.35177943] -2025-05-16 19:35:41,219 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70515987 0.70901727 0.00356939 -0.00559762] -2025-05-16 19:35:41,248 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25107532 -0.13659839 0.35193481] -2025-05-16 19:35:41,250 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70513587 0.70904259 0.00356704 -0.00541163] -2025-05-16 19:35:41,289 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25107236 -0.13661589 0.35216315] -2025-05-16 19:35:41,297 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7051008 0.7090797 0.00357134 -0.00510762] -2025-05-16 19:35:41,327 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25106592 -0.1366078 0.35221937] -2025-05-16 19:35:41,329 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70508956 0.70909217 0.00358431 -0.00491593] -2025-05-16 19:35:41,364 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25106001 -0.13660893 0.35230481] -2025-05-16 19:35:41,365 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70506504 0.70911836 0.00359013 -0.00464287] -2025-05-16 19:35:41,394 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25106859 -0.13661465 0.35236971] -2025-05-16 19:35:41,395 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70505138 0.70913312 0.00357592 -0.00446986] -2025-05-16 19:35:41,423 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25108097 -0.13660524 0.35249162] -2025-05-16 19:35:41,428 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70503008 0.70915604 0.00357596 -0.00418487] -2025-05-16 19:35:41,461 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25107423 -0.13658519 0.35260168] -2025-05-16 19:35:41,463 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70500941 0.70917828 0.00361175 -0.00385486] -2025-05-16 19:35:41,492 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25106804 -0.13656769 0.35259376] -2025-05-16 19:35:41,500 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70500677 0.70918146 0.0036299 -0.00373279] -2025-05-16 19:35:41,538 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25106839 -0.13653499 0.35262392] -2025-05-16 19:35:41,539 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70497972 0.70921027 0.00366233 -0.00331256] -2025-05-16 19:35:41,568 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25107794 -0.13651283 0.35262031] -2025-05-16 19:35:41,571 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70497686 0.70921426 0.00365755 -0.00306144] -2025-05-16 19:35:41,600 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2510799 -0.13648561 0.35261669] -2025-05-16 19:35:41,602 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70497782 0.70921415 0.00367799 -0.00283468] -2025-05-16 19:35:41,636 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2510742 -0.13645557 0.35262478] -2025-05-16 19:35:41,637 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70495697 0.70923589 0.00370511 -0.00252893] -2025-05-16 19:35:41,668 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25107975 -0.13642035 0.35257654] -2025-05-16 19:35:41,670 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70497018 0.70922326 0.00371401 -0.00236994] -2025-05-16 19:35:41,698 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25107523 -0.13637492 0.35249747] -2025-05-16 19:35:41,699 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70494641 0.709248 0.00374059 -0.00195872] -2025-05-16 19:35:41,730 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25107492 -0.13635268 0.35242627] -2025-05-16 19:35:41,731 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70495391 0.709241 0.00374118 -0.00178692] -2025-05-16 19:35:41,762 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25107688 -0.13631267 0.35232935] -2025-05-16 19:35:41,763 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70496625 0.7092293 0.00375329 -0.00151386] -2025-05-16 19:35:41,790 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25107151 -0.13629234 0.35226048] -2025-05-16 19:35:41,798 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70496418 0.70923169 0.00375759 -0.00133524] -2025-05-16 19:35:41,830 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25106256 -0.1362414 0.35212215] -2025-05-16 19:35:41,835 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70496732 0.70922907 0.00376685 -0.00100362] -2025-05-16 19:35:41,869 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25104424 -0.13620036 0.3519369 ] -2025-05-16 19:35:41,870 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.04954856e-01 7.09241819e-01 3.77528102e-03 -6.63697471e-04] -2025-05-16 19:35:41,904 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2510388 -0.13616709 0.35174997] -2025-05-16 19:35:41,905 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.04970172e-01 7.09226923e-01 3.75187255e-03 -3.89093149e-04] -2025-05-16 19:35:41,934 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25103688 -0.13615784 0.351665 ] -2025-05-16 19:35:41,935 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.04977428e-01 7.09219840e-01 3.73473355e-03 -3.09493030e-04] -2025-05-16 19:35:41,970 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25102861 -0.13612172 0.35143933] -2025-05-16 19:35:41,971 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.04989140e-01 7.09208437e-01 3.70208547e-03 -1.64121688e-05] -2025-05-16 19:35:42,006 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.251013 -0.1360889 0.35124381] -2025-05-16 19:35:42,008 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.04984834e-01 7.09212725e-01 3.69386356e-03 2.25742347e-04] -2025-05-16 19:35:42,048 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25101332 -0.13604533 0.35098467] -2025-05-16 19:35:42,051 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.04990355e-01 7.09207246e-01 3.65373014e-03 5.76271733e-04] -2025-05-16 19:35:42,083 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25100639 -0.13601077 0.35071023] -2025-05-16 19:35:42,084 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70501267 0.70918502 0.00361067 0.00083436] -2025-05-16 19:35:42,109 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25100753 -0.13599565 0.35058756] -2025-05-16 19:35:42,110 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70502166 0.70917608 0.00358866 0.0009297 ] -2025-05-16 19:35:42,140 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25100389 -0.13598319 0.35044469] -2025-05-16 19:35:42,151 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70503078 0.709167 0.00356106 0.00104082] -2025-05-16 19:35:42,187 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25099507 -0.13595789 0.35021652] -2025-05-16 19:35:42,207 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70502858 0.709169 0.00353589 0.00123524] -2025-05-16 19:35:42,239 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25098675 -0.13590538 0.34977494] -2025-05-16 19:35:42,245 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70505355 0.70914364 0.0034717 0.00165205] -2025-05-16 19:35:42,274 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25098691 -0.13587103 0.34944434] -2025-05-16 19:35:42,277 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70509229 0.70910485 0.00341701 0.00186981] -2025-05-16 19:35:42,306 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25098387 -0.1358668 0.34938541] -2025-05-16 19:35:42,308 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70509999 0.70909723 0.00341012 0.00187053] -2025-05-16 19:35:42,339 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25098196 -0.13586689 0.34936137] -2025-05-16 19:35:42,343 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70510453 0.70909277 0.00340725 0.00185371] -2025-05-16 19:35:42,377 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25097702 -0.13584405 0.34909897] -2025-05-16 19:35:42,378 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70510726 0.7090899 0.0033484 0.00201395] -2025-05-16 19:35:42,408 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25095656 -0.13580055 0.34863332] -2025-05-16 19:35:42,411 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70512626 0.70907026 0.0032815 0.00235533] -2025-05-16 19:35:42,439 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25095225 -0.13577589 0.34838683] -2025-05-16 19:35:42,443 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70515628 0.70904009 0.0032343 0.00251096] -2025-05-16 19:35:42,470 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25095116 -0.13576511 0.34827172] -2025-05-16 19:35:42,476 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70517511 0.70902134 0.00320761 0.00255277] -2025-05-16 19:35:42,511 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25093723 -0.13576209 0.34815706] -2025-05-16 19:35:42,513 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70518803 0.70900857 0.00318996 0.0025533 ] -2025-05-16 19:35:42,544 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25093074 -0.13574312 0.34794304] -2025-05-16 19:35:42,546 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70520267 0.70899392 0.00313064 0.00264838] -2025-05-16 19:35:42,577 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25091854 -0.1356954 0.34751335] -2025-05-16 19:35:42,578 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70522036 0.70897562 0.00304911 0.00291836] -2025-05-16 19:35:42,605 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25091041 -0.13567508 0.34730725] -2025-05-16 19:35:42,608 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70524581 0.70894999 0.00300626 0.00303591] -2025-05-16 19:35:42,636 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25090097 -0.1356583 0.34715651] -2025-05-16 19:35:42,638 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7052712 0.70892462 0.00299061 0.00307778] -2025-05-16 19:35:42,670 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25089167 -0.13565508 0.34708331] -2025-05-16 19:35:42,671 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70528166 0.7089143 0.00298461 0.00306389] -2025-05-16 19:35:42,703 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25087703 -0.13563622 0.34680365] -2025-05-16 19:35:42,704 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70530286 0.70889321 0.00290478 0.00314002] -2025-05-16 19:35:42,735 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25087384 -0.13562268 0.34665163] -2025-05-16 19:35:42,737 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70531071 0.70888531 0.00285897 0.00320099] -2025-05-16 19:35:42,771 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2508533 -0.13558362 0.34628101] -2025-05-16 19:35:42,773 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70534383 0.70885183 0.00278285 0.00337747] -2025-05-16 19:35:42,803 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25084305 -0.13557352 0.34619195] -2025-05-16 19:35:42,808 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70536193 0.70883377 0.00276806 0.00340187] -2025-05-16 19:35:42,847 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25081958 -0.13556149 0.34602662] -2025-05-16 19:35:42,849 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70539244 0.70880344 0.00275291 0.0034062 ] -2025-05-16 19:35:42,881 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25080068 -0.13554473 0.34585443] -2025-05-16 19:35:42,883 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70542456 0.70877151 0.00269442 0.00344757] -2025-05-16 19:35:42,912 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25080029 -0.13554472 0.34586402] -2025-05-16 19:35:42,916 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70543424 0.70876194 0.00268304 0.0034413 ] -2025-05-16 19:35:42,947 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25079157 -0.13554541 0.34584277] -2025-05-16 19:35:42,948 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70544125 0.70875503 0.0026743 0.00343476] -2025-05-16 19:35:42,981 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25076298 -0.13553703 0.34567594] -2025-05-16 19:35:42,983 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70546185 0.70873458 0.00265552 0.00343867] -2025-05-16 19:35:43,012 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25074432 -0.13552973 0.34558168] -2025-05-16 19:35:43,014 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70548183 0.70871474 0.0026426 0.00343715] -2025-05-16 19:35:43,053 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25073228 -0.13551171 0.34546302] -2025-05-16 19:35:43,054 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70551578 0.70868099 0.00260523 0.00345828] -2025-05-16 19:35:43,084 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25072912 -0.13551211 0.34546397] -2025-05-16 19:35:43,085 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70552378 0.7086731 0.00259712 0.00344797] -2025-05-16 19:35:43,118 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25071623 -0.13550549 0.34541084] -2025-05-16 19:35:43,124 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70554134 0.7086557 0.00260066 0.00342802] -2025-05-16 19:35:43,155 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25068895 -0.13548597 0.34523024] -2025-05-16 19:35:43,156 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70557916 0.70861813 0.00257809 0.00342801] -2025-05-16 19:35:43,186 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25067836 -0.13547284 0.34508756] -2025-05-16 19:35:43,189 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70561032 0.70858717 0.0025427 0.00344004] -2025-05-16 19:35:43,227 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25067001 -0.13545807 0.34499118] -2025-05-16 19:35:43,232 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70564213 0.70855558 0.00251954 0.00343951] -2025-05-16 19:35:43,265 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25065294 -0.1354497 0.3449131 ] -2025-05-16 19:35:43,268 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70567455 0.70852351 0.00250571 0.00340505] -2025-05-16 19:35:43,299 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25065162 -0.13544729 0.34490389] -2025-05-16 19:35:43,300 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70568851 0.70850973 0.00251071 0.00337458] -2025-05-16 19:35:43,337 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25064446 -0.13544909 0.34481667] -2025-05-16 19:35:43,344 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70570966 0.70848888 0.0024794 0.00335316] -2025-05-16 19:35:43,377 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25063177 -0.13543073 0.34467267] -2025-05-16 19:35:43,379 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70575626 0.70844264 0.00244173 0.00334154] -2025-05-16 19:35:43,412 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25062473 -0.13541953 0.34463923] -2025-05-16 19:35:43,415 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70580174 0.70839764 0.00241475 0.00329472] -2025-05-16 19:35:43,448 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25062464 -0.13542137 0.34464664] -2025-05-16 19:35:43,451 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70580241 0.70839704 0.00241466 0.0032805 ] -2025-05-16 19:35:43,480 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25061012 -0.1354274 0.34459501] -2025-05-16 19:35:43,482 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70581385 0.70838585 0.00241284 0.00323568] -2025-05-16 19:35:43,511 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25060843 -0.135423 0.34454623] -2025-05-16 19:35:43,512 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70583752 0.70836245 0.00239668 0.00320951] -2025-05-16 19:35:43,555 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25059633 -0.13540533 0.34439192] -2025-05-16 19:35:43,562 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70591804 0.70828271 0.00233433 0.00314215] -2025-05-16 19:35:43,595 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25059544 -0.13540225 0.34439795] -2025-05-16 19:35:43,599 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70591946 0.70828134 0.00233441 0.00313235] -2025-05-16 19:35:43,630 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25058544 -0.13540465 0.34437622] -2025-05-16 19:35:43,633 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70594888 0.70825235 0.00232019 0.00306703] -2025-05-16 19:35:43,671 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25057171 -0.13540077 0.34431832] -2025-05-16 19:35:43,672 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70599971 0.70820212 0.00229886 0.00298057] -2025-05-16 19:35:43,708 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25056995 -0.13538112 0.34419854] -2025-05-16 19:35:43,711 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70607655 0.70812592 0.00223821 0.00292733] -2025-05-16 19:35:43,744 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25056884 -0.13538016 0.34420907] -2025-05-16 19:35:43,748 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70607698 0.70812553 0.00223622 0.00292146] -2025-05-16 19:35:43,781 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25056492 -0.13537797 0.34421618] -2025-05-16 19:35:43,784 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70609008 0.70811257 0.00222819 0.00290311] -2025-05-16 19:35:43,814 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25055381 -0.13537636 0.34419129] -2025-05-16 19:35:43,815 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70614512 0.70805812 0.00220084 0.00281375] -2025-05-16 19:35:43,847 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25052972 -0.13536707 0.34413682] -2025-05-16 19:35:43,848 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70620276 0.70800101 0.00219082 0.00272518] -2025-05-16 19:35:43,882 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25052195 -0.13534871 0.34405991] -2025-05-16 19:35:43,883 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70626115 0.70794305 0.00215354 0.00268077] -2025-05-16 19:35:43,911 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25052065 -0.13534701 0.34407218] -2025-05-16 19:35:43,912 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70625922 0.70794499 0.00215032 0.00268034] -2025-05-16 19:35:43,943 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25051858 -0.13534504 0.34407988] -2025-05-16 19:35:43,945 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70625898 0.70794525 0.00214932 0.00267588] -2025-05-16 19:35:43,976 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2505032 -0.13533263 0.34405066] -2025-05-16 19:35:43,978 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70636371 0.7078414 0.00209641 0.00254232] -2025-05-16 19:35:44,010 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25048786 -0.13532356 0.3440188 ] -2025-05-16 19:35:44,013 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70641298 0.70779251 0.00208403 0.00247456] -2025-05-16 19:35:44,048 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25047233 -0.13530791 0.34396829] -2025-05-16 19:35:44,049 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70645605 0.70774972 0.00206913 0.00243034] -2025-05-16 19:35:44,078 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25047249 -0.13530926 0.34397613] -2025-05-16 19:35:44,080 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7064546 0.70775119 0.00206496 0.00242737] -2025-05-16 19:35:44,111 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25046983 -0.1353039 0.34397671] -2025-05-16 19:35:44,114 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70648336 0.70772266 0.00204279 0.00239262] -2025-05-16 19:35:44,147 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25045352 -0.13527861 0.34395656] -2025-05-16 19:35:44,148 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70658276 0.7076239 0.00200445 0.00227975] -2025-05-16 19:35:44,205 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25042486 -0.13526508 0.34388901] -2025-05-16 19:35:44,217 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70665624 0.70755094 0.00197994 0.00216903] -2025-05-16 19:35:44,248 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25042356 -0.13526776 0.34389467] -2025-05-16 19:35:44,250 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70664774 0.70755946 0.00197377 0.00216323] -2025-05-16 19:35:44,279 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25041876 -0.13526805 0.34389971] -2025-05-16 19:35:44,280 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70664964 0.70755763 0.0019692 0.002147 ] -2025-05-16 19:35:44,307 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2504139 -0.13524818 0.34390351] -2025-05-16 19:35:44,316 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7066732 0.70753431 0.00194506 0.00209859] -2025-05-16 19:35:44,351 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25040042 -0.13522973 0.34388881] -2025-05-16 19:35:44,353 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70674457 0.70746346 0.00190322 0.00198801] -2025-05-16 19:35:44,385 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25037584 -0.13520894 0.34383624] -2025-05-16 19:35:44,386 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7068329 0.70737563 0.00187182 0.00186204] -2025-05-16 19:35:44,418 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25036995 -0.13520598 0.34383007] -2025-05-16 19:35:44,420 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70684502 0.70736359 0.00186913 0.00183674] -2025-05-16 19:35:44,452 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25035838 -0.13520911 0.34382757] -2025-05-16 19:35:44,454 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70685738 0.70735143 0.00184755 0.00178326] -2025-05-16 19:35:44,491 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25034878 -0.13517695 0.34382863] -2025-05-16 19:35:44,492 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7069132 0.70729602 0.00180401 0.00167677] -2025-05-16 19:35:44,528 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25033407 -0.13514959 0.34379967] -2025-05-16 19:35:44,529 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70699766 0.70721199 0.00176211 0.00154902] -2025-05-16 19:35:44,557 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25032897 -0.13513806 0.34378887] -2025-05-16 19:35:44,558 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70702435 0.70718541 0.00175584 0.00151012] -2025-05-16 19:35:44,586 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25031935 -0.13513663 0.34377705] -2025-05-16 19:35:44,587 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70704396 0.70716595 0.00174071 0.00145879] -2025-05-16 19:35:44,614 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25030366 -0.13513926 0.34376874] -2025-05-16 19:35:44,617 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70707184 0.70713835 0.00170536 0.00136466] -2025-05-16 19:35:44,654 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25030488 -0.13514016 0.34377025] -2025-05-16 19:35:44,655 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70706935 0.70714084 0.00170531 0.00136496] -2025-05-16 19:35:44,691 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25029356 -0.13509212 0.34375621] -2025-05-16 19:35:44,692 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70715703 -0.70705358 -0.00165055 -0.00120447] -2025-05-16 19:35:44,719 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25029251 -0.13509667 0.34375716] -2025-05-16 19:35:44,720 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70714797 -0.70706265 -0.00164686 -0.00120165] -2025-05-16 19:35:44,747 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25027859 -0.13510443 0.34375061] -2025-05-16 19:35:44,748 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70716283 -0.707048 -0.00161386 -0.00112028] -2025-05-16 19:35:44,779 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25028098 -0.13510247 0.34374949] -2025-05-16 19:35:44,780 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70716142 -0.70704943 -0.00160965 -0.00111359] -2025-05-16 19:35:44,806 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.250273 -0.13510039 0.34374589] -2025-05-16 19:35:44,807 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70717365 -0.70703729 -0.00159724 -0.00106834] -2025-05-16 19:35:44,834 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25027065 -0.13505511 0.34373811] -2025-05-16 19:35:44,835 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.7072391 -0.706972 -0.00157619 -0.00097916] -2025-05-16 19:35:44,866 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25026112 -0.13505566 0.34373459] -2025-05-16 19:35:44,867 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70724813 -0.70696311 -0.00155107 -0.00091044] -2025-05-16 19:35:44,900 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25025542 -0.13505241 0.34373202] -2025-05-16 19:35:44,901 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70725782 -0.7069535 -0.00153947 -0.0008708 ] -2025-05-16 19:35:44,935 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2502448 -0.13505932 0.34372687] -2025-05-16 19:35:44,937 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70726148 -0.70695002 -0.00149965 -0.00078542] -2025-05-16 19:35:44,975 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2502377 -0.13502307 0.34371845] -2025-05-16 19:35:44,982 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07311905e-01 -7.06899717e-01 -1.48065116e-03 -6.83122994e-04] -2025-05-16 19:35:45,015 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25023837 -0.1350294 0.34371823] -2025-05-16 19:35:45,017 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07302656e-01 -7.06909002e-01 -1.47021757e-03 -6.73865281e-04] -2025-05-16 19:35:45,048 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25023564 -0.13503681 0.34371872] -2025-05-16 19:35:45,052 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07293949e-01 -7.06917741e-01 -1.46226802e-03 -6.62271974e-04] -2025-05-16 19:35:45,082 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25023008 -0.135043 0.34371954] -2025-05-16 19:35:45,085 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07303231e-01 -7.06908543e-01 -1.44054196e-03 -6.13527909e-04] -2025-05-16 19:35:45,120 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25021041 -0.13503716 0.34371516] -2025-05-16 19:35:45,124 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07340183e-01 -7.06871814e-01 -1.37698209e-03 -4.55653923e-04] -2025-05-16 19:35:45,153 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25021236 -0.13502334 0.34371837] -2025-05-16 19:35:45,156 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07350580e-01 -7.06861459e-01 -1.36117098e-03 -4.26635667e-04] -2025-05-16 19:35:45,187 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25021262 -0.13503984 0.34372488] -2025-05-16 19:35:45,189 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07333261e-01 -7.06878836e-01 -1.34216160e-03 -4.09509357e-04] -2025-05-16 19:35:45,219 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25021688 -0.13504036 0.34373077] -2025-05-16 19:35:45,221 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07329050e-01 -7.06883052e-01 -1.34101624e-03 -4.08154570e-04] -2025-05-16 19:35:45,252 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25020832 -0.13504347 0.34373493] -2025-05-16 19:35:45,253 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07334846e-01 -7.06877288e-01 -1.33308723e-03 -3.71839089e-04] -2025-05-16 19:35:45,300 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25019354 -0.13503027 0.34373728] -2025-05-16 19:35:45,312 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07378397e-01 -7.06833854e-01 -1.28554924e-03 -2.29336093e-04] -2025-05-16 19:35:45,344 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25017872 -0.13504511 0.3437394 ] -2025-05-16 19:35:45,345 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07382374e-01 -7.06830053e-01 -1.20371484e-03 -5.91651263e-05] -2025-05-16 19:35:45,379 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25018156 -0.13504835 0.3437449 ] -2025-05-16 19:35:45,382 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07377625e-01 -7.06834824e-01 -1.19411433e-03 -4.29385295e-05] -2025-05-16 19:35:45,415 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25019548 -0.13505486 0.34375987] -2025-05-16 19:35:45,416 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07343967e-01 -7.06868491e-01 -1.20089178e-03 -8.09984586e-05] -2025-05-16 19:35:45,454 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25020076 -0.13504976 0.34376925] -2025-05-16 19:35:45,456 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07346197e-01 -7.06866259e-01 -1.20158871e-03 -7.43073331e-05] -2025-05-16 19:35:45,487 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25020297 -0.13503227 0.34377927] -2025-05-16 19:35:45,488 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07397487e-01 -7.06814976e-01 -1.17516679e-03 6.41846229e-05] -2025-05-16 19:35:45,518 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25023776 -0.13503153 0.34379626] -2025-05-16 19:35:45,519 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07402929e-01 -7.06809610e-01 -1.11116895e-03 1.90127630e-04] -2025-05-16 19:35:45,548 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25028558 -0.13502562 0.34381819] -2025-05-16 19:35:45,549 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07393774e-01 -7.06818779e-01 -1.10694244e-03 1.89855114e-04] -2025-05-16 19:35:45,578 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25036832 -0.13500884 0.34384948] -2025-05-16 19:35:45,579 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07376092e-01 -7.06836488e-01 -1.09855719e-03 1.92272895e-04] -2025-05-16 19:35:45,611 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25043699 -0.13498979 0.34386111] -2025-05-16 19:35:45,614 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07368469e-01 -7.06844100e-01 -1.10481676e-03 2.14689294e-04] -2025-05-16 19:35:45,645 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2505433 -0.13493821 0.34389957] -2025-05-16 19:35:45,651 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07398482e-01 -7.06814015e-01 -1.08445399e-03 3.99096561e-04] -2025-05-16 19:35:45,678 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25066976 -0.13489629 0.34392858] -2025-05-16 19:35:45,679 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07409201e-01 -7.06803253e-01 -1.05510893e-03 5.20412775e-04] -2025-05-16 19:35:45,706 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25080859 -0.13486139 0.34395847] -2025-05-16 19:35:45,714 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07400066e-01 -7.06812337e-01 -1.03952180e-03 6.21903209e-04] -2025-05-16 19:35:45,749 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25104212 -0.13479599 0.34401234] -2025-05-16 19:35:45,751 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.7073732 -0.70683912 -0.00103209 0.00073739] -2025-05-16 19:35:45,779 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25128667 -0.1346971 0.34405705] -2025-05-16 19:35:45,780 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70737587 -0.70683626 -0.00104669 0.00088726] -2025-05-16 19:35:45,812 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25146492 -0.13461915 0.34407779] -2025-05-16 19:35:45,813 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70737978 -0.70683213 -0.00105863 0.00103063] -2025-05-16 19:35:45,838 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25176315 -0.13451531 0.34412529] -2025-05-16 19:35:45,839 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70737794 -0.70683351 -0.00104554 0.00132046] -2025-05-16 19:35:45,866 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25196168 -0.13445223 0.34414435] -2025-05-16 19:35:45,867 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.7073558 -0.70685532 -0.00105426 0.00148981] -2025-05-16 19:35:45,895 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25214535 -0.13439045 0.34416329] -2025-05-16 19:35:45,897 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70734274 -0.70686804 -0.00106783 0.00164008] -2025-05-16 19:35:45,940 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25266296 -0.13421126 0.34425017] -2025-05-16 19:35:45,952 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70733538 -0.70687449 -0.00108714 0.00198443] -2025-05-16 19:35:45,983 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25318146 -0.13400755 0.34429778] -2025-05-16 19:35:45,985 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70732279 -0.70688559 -0.00113243 0.00243877] -2025-05-16 19:35:46,036 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25377918 -0.13380321 0.34434446] -2025-05-16 19:35:46,039 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70726487 -0.70694132 -0.00117081 0.00300147] -2025-05-16 19:35:46,071 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25383577 -0.13378268 0.34433195] -2025-05-16 19:35:46,073 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70725635 -0.70694941 -0.0011959 0.00309277] -2025-05-16 19:35:46,103 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25449794 -0.13355739 0.34439533] -2025-05-16 19:35:46,106 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70723332 -0.70696963 -0.00126314 0.00365703] -2025-05-16 19:35:46,152 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25483415 -0.13342168 0.34441614] -2025-05-16 19:35:46,154 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70725263 -0.70694836 -0.0013058 0.00400224] -2025-05-16 19:35:46,195 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25568467 -0.13313078 0.34446634] -2025-05-16 19:35:46,196 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70721784 -0.7069775 -0.00138073 0.00488285] -2025-05-16 19:35:46,231 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25615793 -0.13296782 0.34445989] -2025-05-16 19:35:46,233 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70712327 -0.70706766 -0.0014872 0.00545842] -2025-05-16 19:35:46,264 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25648725 -0.13286114 0.34447602] -2025-05-16 19:35:46,268 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70709267 0.7070951 0.0015347 -0.00584114] -2025-05-16 19:35:46,300 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25688729 -0.13268815 0.34447396] -2025-05-16 19:35:46,302 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.7070962 -0.70708704 -0.00165569 0.00633611] -2025-05-16 19:35:46,334 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25744359 -0.13250049 0.34450516] -2025-05-16 19:35:46,335 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70706626 0.70711007 0.00174678 -0.00704279] -2025-05-16 19:35:46,363 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25774014 -0.13237058 0.34450728] -2025-05-16 19:35:46,365 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70708615 -0.70708553 -0.00183835 0.00747342] -2025-05-16 19:35:46,402 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25851946 -0.13208581 0.34449197] -2025-05-16 19:35:46,404 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70693626 0.70722301 0.0020534 -0.00851614] -2025-05-16 19:35:46,436 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25901462 -0.13188909 0.34448645] -2025-05-16 19:35:46,439 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70688119 0.7072684 0.00223029 -0.00924258] -2025-05-16 19:35:46,485 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25957135 -0.13166986 0.34448412] -2025-05-16 19:35:46,497 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70685176 0.7072854 0.00242851 -0.01010235] -2025-05-16 19:35:46,528 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.26001415 -0.1314716 0.34449835] -2025-05-16 19:35:46,528 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.706853 0.70727243 0.00261473 -0.01084936] -2025-05-16 19:35:46,555 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.26043406 -0.13133161 0.34448754] -2025-05-16 19:35:46,558 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70674311 0.70736929 0.00277624 -0.01162548] -2025-05-16 19:35:46,587 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2610044 -0.13112184 0.34446717] -2025-05-16 19:35:46,589 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70661783 0.70747613 0.00300737 -0.01263834] -2025-05-16 19:35:46,619 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.26119612 -0.1310829 0.34446407] -2025-05-16 19:35:46,620 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7065379 0.70754729 0.00311187 -0.01308954] -2025-05-16 19:35:46,673 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.26177065 -0.13083815 0.34446167] -2025-05-16 19:35:46,678 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70656485 0.70749821 0.00338405 -0.0141755 ] -2025-05-16 19:35:46,707 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.26220672 -0.13069679 0.34445586] -2025-05-16 19:35:46,710 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70644965 0.70759032 0.00361949 -0.01522252] -2025-05-16 19:35:46,739 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.26276196 -0.13052963 0.34444929] -2025-05-16 19:35:46,741 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70630687 0.70770163 0.00389372 -0.01654826] -2025-05-16 19:35:46,770 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.26303911 -0.13046586 0.3444288 ] -2025-05-16 19:35:46,771 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70619259 0.70779393 0.00412082 -0.0174009 ] -2025-05-16 19:35:46,799 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.26309861 -0.13047501 0.34442712] -2025-05-16 19:35:46,801 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70615643 0.70782338 0.00418636 -0.01765348] -2025-05-16 19:35:46,835 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.26357823 -0.13029435 0.34445168] -2025-05-16 19:35:46,837 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70615482 0.70779402 0.00443685 -0.01879649] -2025-05-16 19:35:46,866 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.26375142 -0.13025025 0.34444413] -2025-05-16 19:35:46,867 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70607969 0.70785131 0.00459664 -0.01941277] -2025-05-16 19:35:46,900 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.26430144 -0.13010414 0.34446443] -2025-05-16 19:35:46,901 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70590636 0.70797414 0.00497719 -0.02107267] -2025-05-16 19:35:46,936 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.26458972 -0.13002138 0.34443836] -2025-05-16 19:35:46,937 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7057853 0.70805766 0.00533336 -0.02220398] -2025-05-16 19:35:46,967 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.26469805 -0.13003864 0.34444101] -2025-05-16 19:35:46,968 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7056966 0.70812619 0.00550076 -0.02278923] -2025-05-16 19:35:47,005 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.26497958 -0.12992069 0.3444596 ] -2025-05-16 19:35:47,006 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70571606 0.7080762 0.00575267 -0.02366099] -2025-05-16 19:35:47,036 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.26512511 -0.12988733 0.3444614 ] -2025-05-16 19:35:47,038 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70562951 0.70813664 0.00597415 -0.02436806] -2025-05-16 19:35:47,069 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.26556628 -0.1297983 0.34448694] -2025-05-16 19:35:47,070 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70549203 0.70820218 0.00643154 -0.02625479] -2025-05-16 19:35:47,103 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.26575731 -0.12979563 0.34447376] -2025-05-16 19:35:47,104 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70529539 0.70834409 0.00683019 -0.02757541] -2025-05-16 19:35:47,135 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.26580278 -0.12982978 0.34448083] -2025-05-16 19:35:47,136 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70523713 0.70838396 0.00695476 -0.02800708] -2025-05-16 19:35:47,169 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.26597857 -0.12975936 0.34450651] -2025-05-16 19:35:47,170 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70523717 0.70835223 0.00718406 -0.02874091] -2025-05-16 19:35:47,201 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.26607246 -0.12975758 0.34451396] -2025-05-16 19:35:47,204 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7051622 0.70839735 0.00739336 -0.02940738] -2025-05-16 19:35:47,243 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.26637972 -0.12974655 0.34456778] -2025-05-16 19:35:47,267 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70500018 0.70846648 0.00787687 -0.03143161] -2025-05-16 19:35:47,295 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.26649112 -0.12985237 0.34453251] -2025-05-16 19:35:47,297 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70471353 0.70864526 0.00853196 -0.03358488] -2025-05-16 19:35:47,328 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2664383 -0.12985534 0.34454808] -2025-05-16 19:35:47,329 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70472249 0.70862563 0.00863104 -0.03378496] -2025-05-16 19:35:47,358 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.26633943 -0.12989331 0.34456686] -2025-05-16 19:35:47,359 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70467322 0.70865735 0.00879286 -0.03410424] -2025-05-16 19:35:47,387 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.26622386 -0.12994123 0.34458246] -2025-05-16 19:35:47,390 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70465866 0.70866716 0.00881989 -0.03419401] -2025-05-16 19:35:47,419 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.26620294 -0.12999921 0.34464379] -2025-05-16 19:35:47,422 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.704552 0.70870445 0.00917578 -0.03550051] -2025-05-16 19:35:47,454 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.26610151 -0.13007224 0.34466471] -2025-05-16 19:35:47,457 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70445394 0.70875685 0.00942454 -0.03632566] -2025-05-16 19:35:47,492 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.26591712 -0.13019049 0.34463945] -2025-05-16 19:35:47,501 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70425433 0.70884525 0.01011359 -0.03823565] -2025-05-16 19:35:47,530 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.26557314 -0.13031228 0.34465791] -2025-05-16 19:35:47,540 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70420524 0.7088765 0.01025566 -0.03852145] -2025-05-16 19:35:47,570 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.26523036 -0.13045104 0.34470918] -2025-05-16 19:35:47,573 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7041455 0.70891384 0.01038447 -0.03889011] -2025-05-16 19:35:47,604 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.26486744 -0.13062236 0.34477704] -2025-05-16 19:35:47,618 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70403508 0.70897425 0.01059904 -0.03972114] -2025-05-16 19:35:47,653 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.26450624 -0.13080369 0.34477449] -2025-05-16 19:35:47,655 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7038876 0.70903421 0.01107928 -0.04110937] -2025-05-16 19:35:47,683 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.26396952 -0.13097506 0.34475608] -2025-05-16 19:35:47,687 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70380864 0.70906135 0.01142532 -0.04189101] -2025-05-16 19:35:47,724 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.26366979 -0.13106867 0.34476133] -2025-05-16 19:35:47,728 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70377313 0.70909535 0.01145752 -0.04190336] -2025-05-16 19:35:47,762 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2630105 -0.13131654 0.34481459] -2025-05-16 19:35:47,764 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70366295 0.70917824 0.01159658 -0.04231076] -2025-05-16 19:35:47,796 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.26245064 -0.13159631 0.3448523 ] -2025-05-16 19:35:47,799 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70361307 0.70916638 0.01186992 -0.04325271] -2025-05-16 19:35:47,833 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2619645 -0.13176321 0.34481313] -2025-05-16 19:35:47,835 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70355711 0.70917512 0.01216316 -0.04393294] -2025-05-16 19:35:47,863 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.26164338 -0.13183818 0.34479329] -2025-05-16 19:35:47,865 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70354149 0.70918025 0.01226121 -0.04407278] -2025-05-16 19:35:47,902 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.26105761 -0.1320085 0.34482021] -2025-05-16 19:35:47,904 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70338944 0.70933077 0.01230498 -0.04406515] -2025-05-16 19:35:47,933 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.26053158 -0.13221375 0.34484767] -2025-05-16 19:35:47,938 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70331812 0.70938941 0.01235847 -0.04424432] -2025-05-16 19:35:47,973 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25982015 -0.13252257 0.34484916] -2025-05-16 19:35:47,974 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70327905 0.70938606 0.01253971 -0.04486375] -2025-05-16 19:35:48,015 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25922407 -0.1327091 0.34479826] -2025-05-16 19:35:48,016 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70326934 0.70936871 0.01274154 -0.04523184] -2025-05-16 19:35:48,052 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2587439 -0.13282911 0.34478375] -2025-05-16 19:35:48,054 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70321351 0.70943326 0.01273125 -0.04509022] -2025-05-16 19:35:48,086 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25794943 -0.13308055 0.34481288] -2025-05-16 19:35:48,087 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70310191 0.70955525 0.01271852 -0.04491425] -2025-05-16 19:35:48,121 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25727243 -0.13330739 0.34479349] -2025-05-16 19:35:48,129 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70308666 0.70955836 0.01283533 -0.04507037] -2025-05-16 19:35:48,165 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25708295 -0.1333737 0.34477435] -2025-05-16 19:35:48,169 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70310965 0.70953711 0.01284487 -0.04504351] -2025-05-16 19:35:48,201 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25643339 -0.13356269 0.3447197 ] -2025-05-16 19:35:48,202 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70311577 0.70953939 0.01283201 -0.04491561] -2025-05-16 19:35:48,231 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25580732 -0.13376131 0.34470506] -2025-05-16 19:35:48,233 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70304789 0.70963106 0.01272076 -0.04456002] -2025-05-16 19:35:48,263 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25533465 -0.13389958 0.34469413] -2025-05-16 19:35:48,265 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70303191 0.70966412 0.01267636 -0.04429763] -2025-05-16 19:35:48,292 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2552028 -0.133932 0.34467675] -2025-05-16 19:35:48,295 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70306189 0.70964554 0.01264315 -0.04412863] -2025-05-16 19:35:48,322 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25494466 -0.13401487 0.34465385] -2025-05-16 19:35:48,324 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70311019 0.70961391 0.01259418 -0.04388103] -2025-05-16 19:35:48,351 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25438501 -0.13416235 0.34458161] -2025-05-16 19:35:48,354 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70315247 0.70959908 0.01252561 -0.043461 ] -2025-05-16 19:35:48,387 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25393552 -0.13431568 0.34452599] -2025-05-16 19:35:48,389 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70312776 0.709653 0.0124125 -0.0430105 ] -2025-05-16 19:35:48,432 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25350379 -0.1344053 0.34449636] -2025-05-16 19:35:48,434 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70313774 0.7096831 0.01224731 -0.0423936 ] -2025-05-16 19:35:48,466 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25323521 -0.1344678 0.34446187] -2025-05-16 19:35:48,467 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70322482 0.70963743 0.01208118 -0.04175671] -2025-05-16 19:35:48,499 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25279855 -0.13460159 0.34438749] -2025-05-16 19:35:48,500 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70327865 0.70963005 0.01189473 -0.0410225 ] -2025-05-16 19:35:48,528 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25268803 -0.13463173 0.34436197] -2025-05-16 19:35:48,529 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7033088 0.70962094 0.01182689 -0.04068143] -2025-05-16 19:35:48,563 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25247668 -0.13467524 0.34432205] -2025-05-16 19:35:48,567 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70334155 0.70962181 0.01170682 -0.04013113] -2025-05-16 19:35:48,603 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25214748 -0.13470491 0.34428011] -2025-05-16 19:35:48,605 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70343274 0.70959019 0.01148686 -0.03914337] -2025-05-16 19:35:48,638 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2519567 -0.13473476 0.34424346] -2025-05-16 19:35:48,639 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70350225 0.70956309 0.0113077 -0.038431 ] -2025-05-16 19:35:48,670 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25168041 -0.13480527 0.34417724] -2025-05-16 19:35:48,671 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70359555 0.70952884 0.01106875 -0.03741136] -2025-05-16 19:35:48,703 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25163043 -0.13481818 0.34415265] -2025-05-16 19:35:48,705 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70364312 0.70950824 0.01095596 -0.03693763] -2025-05-16 19:35:48,735 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25150832 -0.13481554 0.34410919] -2025-05-16 19:35:48,737 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70371202 0.70948671 0.01077134 -0.03608281] -2025-05-16 19:35:48,766 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25144172 -0.13481249 0.34409167] -2025-05-16 19:35:48,768 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70374987 0.70947431 0.01066079 -0.03561834] -2025-05-16 19:35:48,799 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25114048 -0.13485015 0.34401815] -2025-05-16 19:35:48,803 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70394412 0.70936752 0.01023198 -0.03399564] -2025-05-16 19:35:48,832 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25108074 -0.1348785 0.34399144] -2025-05-16 19:35:48,836 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70400359 0.70933411 0.01008348 -0.03350215] -2025-05-16 19:35:48,871 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25098776 -0.13490697 0.3439534 ] -2025-05-16 19:35:48,872 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70409402 0.70929874 0.00980822 -0.03241477] -2025-05-16 19:35:48,902 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25094297 -0.1348948 0.34391765] -2025-05-16 19:35:48,904 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70415102 0.70928375 0.00961884 -0.03154977] -2025-05-16 19:35:48,935 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25080967 -0.13490163 0.3438728 ] -2025-05-16 19:35:48,937 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70427358 0.70922859 0.00923672 -0.03013657] -2025-05-16 19:35:48,967 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2507464 -0.13491479 0.34385422] -2025-05-16 19:35:48,969 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70436066 0.70917854 0.00899336 -0.02934257] -2025-05-16 19:35:49,004 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2506916 -0.13494401 0.34381922] -2025-05-16 19:35:49,005 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7045074 0.709075 0.00870404 -0.02839397] -2025-05-16 19:35:49,036 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25063518 -0.13496334 0.34377139] -2025-05-16 19:35:49,037 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70456992 0.70904408 0.0085198 -0.02766114] -2025-05-16 19:35:49,068 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25058455 -0.13496616 0.34372565] -2025-05-16 19:35:49,070 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70465041 0.70902346 0.00815988 -0.02620966] -2025-05-16 19:35:49,103 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2505016 -0.13493216 0.34367849] -2025-05-16 19:35:49,107 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70475502 0.70897698 0.00783351 -0.0247111 ] -2025-05-16 19:35:49,144 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25046988 -0.13491621 0.3436558 ] -2025-05-16 19:35:49,146 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70493077 0.70885278 0.00746194 -0.02333816] -2025-05-16 19:35:49,178 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25047038 -0.13492077 0.34363856] -2025-05-16 19:35:49,180 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70497675 0.70881894 0.00736173 -0.02300623] -2025-05-16 19:35:49,208 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25042376 -0.13494896 0.34357954] -2025-05-16 19:35:49,214 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70509736 0.70875547 0.00690728 -0.02134662] -2025-05-16 19:35:49,249 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25038217 -0.13494631 0.34353026] -2025-05-16 19:35:49,256 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70516979 0.70871886 0.00663062 -0.02022831] -2025-05-16 19:35:49,289 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25031237 -0.13495627 0.34348848] -2025-05-16 19:35:49,299 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70531934 0.70862729 0.0061039 -0.01829578] -2025-05-16 19:35:49,336 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25030893 -0.13495027 0.34346686] -2025-05-16 19:35:49,337 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70547098 0.70850371 0.00582032 -0.01730068] -2025-05-16 19:35:49,369 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25029915 -0.13498185 0.34342445] -2025-05-16 19:35:49,372 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70556263 0.70844546 0.00544591 -0.01602324] -2025-05-16 19:35:49,405 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25029128 -0.13499444 0.34340484] -2025-05-16 19:35:49,415 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70561428 0.70840865 0.0052728 -0.01542296] -2025-05-16 19:35:49,445 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25025102 -0.13498978 0.34334107] -2025-05-16 19:35:49,447 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70571704 0.70834064 0.00488359 -0.01389821] -2025-05-16 19:35:49,479 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25019403 -0.13501029 0.34332187] -2025-05-16 19:35:49,481 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70586406 0.7082249 0.00446911 -0.01238737] -2025-05-16 19:35:49,521 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25019206 -0.13497346 0.34328777] -2025-05-16 19:35:49,523 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70601248 0.70810138 0.00415533 -0.01102438] -2025-05-16 19:35:49,562 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25022056 -0.13497386 0.34328117] -2025-05-16 19:35:49,565 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70608818 0.70804369 0.00384346 -0.00994218] -2025-05-16 19:35:49,605 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25021332 -0.13496862 0.34323032] -2025-05-16 19:35:49,609 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70615445 0.70799461 0.00354109 -0.00877427] -2025-05-16 19:35:49,648 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25015487 -0.13501147 0.34320839] -2025-05-16 19:35:49,651 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70635316 0.70781845 0.0030057 -0.0070157 ] -2025-05-16 19:35:49,681 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25013118 -0.13501846 0.34318409] -2025-05-16 19:35:49,684 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70645572 0.7077262 0.0027446 -0.00603401] -2025-05-16 19:35:49,713 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25013922 -0.13502353 0.3431846 ] -2025-05-16 19:35:49,714 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70651003 0.7076791 0.00253253 -0.00523921] -2025-05-16 19:35:49,744 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25018033 -0.13501419 0.34318143] -2025-05-16 19:35:49,745 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70656421 0.70763123 0.00231023 -0.00444171] -2025-05-16 19:35:49,773 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25018011 -0.13502534 0.3431482 ] -2025-05-16 19:35:49,776 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7066159 0.70758517 0.002069 -0.00359276] -2025-05-16 19:35:49,812 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012501 -0.13507797 0.34312475] -2025-05-16 19:35:49,813 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70681829 0.70739168 0.00148306 -0.00165039] -2025-05-16 19:35:49,845 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25009822 -0.13509234 0.3431154 ] -2025-05-16 19:35:49,846 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06886241e-01 7.07326184e-01 1.16410508e-03 -3.96944844e-04] -2025-05-16 19:35:49,883 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011537 -0.13506711 0.34312443] -2025-05-16 19:35:49,886 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06917983e-01 7.07294732e-01 1.04210872e-03 2.03104525e-04] -2025-05-16 19:35:49,946 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25015395 -0.13503055 0.34311268] -2025-05-16 19:35:49,948 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70697777 0.70723416 0.00080975 0.0012729 ] -2025-05-16 19:35:49,977 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25014422 -0.13505005 0.34309443] -2025-05-16 19:35:49,979 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07101818e-01 7.07106727e-01 4.37617651e-04 2.62781714e-03] -2025-05-16 19:35:50,015 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25010571 -0.13509359 0.3431199 ] -2025-05-16 19:35:50,025 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07271759e-01 -7.06926510e-01 1.58406060e-04 -4.64151148e-03] -2025-05-16 19:35:50,064 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25010552 -0.13510271 0.34313548] -2025-05-16 19:35:50,066 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07289794e-01 -7.06905213e-01 2.87738052e-04 -5.10734244e-03] -2025-05-16 19:35:50,098 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012784 -0.13507254 0.34311349] -2025-05-16 19:35:50,100 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07311329e-01 -7.06879319e-01 3.74775334e-04 -5.67206297e-03] -2025-05-16 19:35:50,149 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25013715 -0.13508681 0.34310416] -2025-05-16 19:35:50,150 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07414096e-01 -7.06764930e-01 7.06994641e-04 -6.93764849e-03] -2025-05-16 19:35:50,200 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2501213 -0.1351367 0.34313433] -2025-05-16 19:35:50,202 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70752055 -0.70664119 0.00119482 -0.00845438] -2025-05-16 19:35:50,233 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011761 -0.13514756 0.343179 ] -2025-05-16 19:35:50,234 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70757422 -0.706575 0.00147934 -0.00939638] -2025-05-16 19:35:50,266 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012248 -0.13513476 0.3431514 ] -2025-05-16 19:35:50,267 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70758606 -0.70655703 0.00153787 -0.0098367 ] -2025-05-16 19:35:50,295 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25013252 -0.1351427 0.34314049] -2025-05-16 19:35:50,297 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70760238 -0.70653643 0.00161063 -0.01012684] -2025-05-16 19:35:50,322 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25014655 -0.13513139 0.34314082] -2025-05-16 19:35:50,323 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70763407 -0.70650008 0.00167089 -0.01043359] -2025-05-16 19:35:50,351 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012133 -0.13513932 0.3431495 ] -2025-05-16 19:35:50,352 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70772598 -0.7063886 0.00196528 -0.01162826] -2025-05-16 19:35:50,380 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011 -0.13514409 0.34319507] -2025-05-16 19:35:50,381 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70778951 -0.70630892 0.00220974 -0.01252339] -2025-05-16 19:35:50,418 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011618 -0.13513014 0.34321269] -2025-05-16 19:35:50,418 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70783272 -0.70625042 0.00238392 -0.01332308] -2025-05-16 19:35:50,451 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011839 -0.13513292 0.34320657] -2025-05-16 19:35:50,452 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70783765 -0.70624434 0.00238479 -0.01338272] -2025-05-16 19:35:50,483 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25015077 -0.1351208 0.34319731] -2025-05-16 19:35:50,484 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70789399 -0.70617401 0.00253758 -0.01406868] -2025-05-16 19:35:50,515 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25014972 -0.13512823 0.34322945] -2025-05-16 19:35:50,517 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70794814 -0.70610275 0.0027576 -0.01485706] -2025-05-16 19:35:50,555 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25014058 -0.13515535 0.34327796] -2025-05-16 19:35:50,556 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70802042 -0.70601149 0.00301963 -0.0156762 ] -2025-05-16 19:35:50,588 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25013056 -0.13515599 0.34329645] -2025-05-16 19:35:50,589 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70806258 -0.70595792 0.00313176 -0.01615507] -2025-05-16 19:35:50,619 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25013676 -0.1351457 0.34329012] -2025-05-16 19:35:50,619 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70807735 -0.70594126 0.00313137 -0.0162357 ] -2025-05-16 19:35:50,660 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25015753 -0.13514419 0.34328299] -2025-05-16 19:35:50,666 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70811679 -0.70588628 0.00325614 -0.01686958] -2025-05-16 19:35:50,702 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25015199 -0.13515646 0.3433127 ] -2025-05-16 19:35:50,704 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70815274 -0.70583424 0.00343915 -0.01748969] -2025-05-16 19:35:50,737 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012293 -0.13519903 0.3433617 ] -2025-05-16 19:35:50,738 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70817871 -0.70579054 0.00366316 -0.01814401] -2025-05-16 19:35:50,771 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011944 -0.13519774 0.34336918] -2025-05-16 19:35:50,772 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70819159 -0.70577628 0.00368013 -0.01819269] -2025-05-16 19:35:50,805 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25013285 -0.13518756 0.34335024] -2025-05-16 19:35:50,807 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70821679 -0.70574905 0.00367229 -0.01826962] -2025-05-16 19:35:50,848 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25015468 -0.13517743 0.34334659] -2025-05-16 19:35:50,850 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.7082458 -0.70570907 0.00374679 -0.01866967] -2025-05-16 19:35:50,887 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25013232 -0.13521451 0.343385 ] -2025-05-16 19:35:50,888 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70825133 -0.70568407 0.0039559 -0.01934933] -2025-05-16 19:35:50,924 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011509 -0.13523869 0.34341608] -2025-05-16 19:35:50,927 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70827389 -0.70565539 0.00404529 -0.01954981] -2025-05-16 19:35:50,965 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011142 -0.13523306 0.34340605] -2025-05-16 19:35:50,967 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70828841 -0.7056424 0.00401506 -0.01949883] -2025-05-16 19:35:51,061 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012109 -0.13523014 0.34338032] -2025-05-16 19:35:51,067 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70828118 -0.70564713 0.00401395 -0.01959053] -2025-05-16 19:35:51,096 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25009966 -0.13526971 0.34341361] -2025-05-16 19:35:51,098 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70828274 -0.7056427 0.00409861 -0.01967595] -2025-05-16 19:35:51,131 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25010154 -0.13526671 0.3434111 ] -2025-05-16 19:35:51,133 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70828309 -0.7056444 0.00407652 -0.01960697] -2025-05-16 19:35:51,179 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011083 -0.13525543 0.34338913] -2025-05-16 19:35:51,180 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70829711 -0.70563364 0.0040102 -0.01950094] -2025-05-16 19:35:51,207 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2501211 -0.13524503 0.34337936] -2025-05-16 19:35:51,208 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70829336 -0.70563868 0.00399071 -0.01945885] -2025-05-16 19:35:51,235 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012624 -0.13524318 0.34337237] -2025-05-16 19:35:51,236 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70828777 -0.70564464 0.00398996 -0.01944631] -2025-05-16 19:35:51,267 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011032 -0.13527153 0.34339121] -2025-05-16 19:35:51,269 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70826765 -0.70566412 0.00402897 -0.01946419] -2025-05-16 19:35:51,299 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25010977 -0.13527045 0.34338991] -2025-05-16 19:35:51,301 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70826394 -0.70566966 0.00401144 -0.01940163] -2025-05-16 19:35:51,337 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25010981 -0.13524319 0.34336159] -2025-05-16 19:35:51,338 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70830394 -0.70563489 0.00388409 -0.01923121] -2025-05-16 19:35:51,378 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011787 -0.13522089 0.34335314] -2025-05-16 19:35:51,379 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70832848 -0.70561361 0.00382494 -0.01911978] -2025-05-16 19:35:51,409 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011678 -0.13521992 0.34335808] -2025-05-16 19:35:51,412 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.7083227 -0.70562105 0.0038144 -0.01906142] -2025-05-16 19:35:51,443 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011173 -0.13522437 0.3433701 ] -2025-05-16 19:35:51,446 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70830999 -0.70563525 0.00381401 -0.01900795] -2025-05-16 19:35:51,477 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25009585 -0.13521756 0.3433605 ] -2025-05-16 19:35:51,478 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.7083271 -0.70562424 0.00369484 -0.01880127] -2025-05-16 19:35:51,510 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25010082 -0.13520587 0.34335103] -2025-05-16 19:35:51,512 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70834701 -0.70560858 0.0036285 -0.01865177] -2025-05-16 19:35:51,547 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011481 -0.13518046 0.34334183] -2025-05-16 19:35:51,549 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.7083562 -0.70560396 0.00356474 -0.01848891] -2025-05-16 19:35:51,587 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25010895 -0.13518361 0.3433577 ] -2025-05-16 19:35:51,588 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70833547 -0.70562765 0.00354517 -0.0183826 ] -2025-05-16 19:35:51,620 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25009428 -0.13518205 0.34336191] -2025-05-16 19:35:51,620 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70832133 -0.70564985 0.00344319 -0.01809213] -2025-05-16 19:35:51,652 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25009193 -0.13517192 0.34335845] -2025-05-16 19:35:51,652 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70833401 -0.70564383 0.0033454 -0.01784713] -2025-05-16 19:35:51,687 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25010597 -0.13514273 0.34334476] -2025-05-16 19:35:51,688 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70835428 -0.70563186 0.00322254 -0.01753583] -2025-05-16 19:35:51,715 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011335 -0.13512924 0.34334701] -2025-05-16 19:35:51,716 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70835088 -0.70563876 0.00318305 -0.01740214] -2025-05-16 19:35:51,750 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011052 -0.1351155 0.34336027] -2025-05-16 19:35:51,751 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70833821 -0.70566029 0.00308419 -0.01705966] -2025-05-16 19:35:51,779 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2501079 -0.13511689 0.34336903] -2025-05-16 19:35:51,782 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70832391 -0.70567978 0.00303796 -0.01685375] -2025-05-16 19:35:51,813 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011237 -0.13511233 0.34337185] -2025-05-16 19:35:51,816 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70831677 -0.70569128 0.00299183 -0.01668007] -2025-05-16 19:35:51,847 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012226 -0.13510144 0.3433688 ] -2025-05-16 19:35:51,848 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70832157 -0.70569064 0.00293365 -0.0165126 ] -2025-05-16 19:35:51,881 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25014521 -0.13506448 0.34337375] -2025-05-16 19:35:51,882 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70831956 -0.70570262 0.00279655 -0.01610555] -2025-05-16 19:35:51,921 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25015336 -0.13504062 0.34339545] -2025-05-16 19:35:51,922 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70829433 -0.70573799 0.00267188 -0.01568113] -2025-05-16 19:35:51,952 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25015244 -0.13503727 0.34341315] -2025-05-16 19:35:51,952 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70825248 -0.70578819 0.00257778 -0.01532357] -2025-05-16 19:35:51,980 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25015437 -0.13503256 0.34342307] -2025-05-16 19:35:51,981 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70823861 -0.70580675 0.00252319 -0.01511735] -2025-05-16 19:35:52,012 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25017399 -0.13499616 0.34342715] -2025-05-16 19:35:52,013 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70823877 -0.70581709 0.00236187 -0.01464606] -2025-05-16 19:35:52,040 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25017851 -0.13498218 0.34342993] -2025-05-16 19:35:52,041 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70823265 -0.7058278 0.00229138 -0.01443542] -2025-05-16 19:35:52,071 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25019926 -0.13493638 0.34346421] -2025-05-16 19:35:52,079 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70822256 -0.70584627 0.00216882 -0.0140404 ] -2025-05-16 19:35:52,121 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25019336 -0.13493762 0.34348308] -2025-05-16 19:35:52,127 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70815311 -0.70592875 0.00198671 -0.01341015] -2025-05-16 19:35:52,170 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25019339 -0.13492825 0.34345049] -2025-05-16 19:35:52,172 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70815173 -0.70593182 0.00196631 -0.01332419] -2025-05-16 19:35:52,201 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25019377 -0.13491237 0.34344905] -2025-05-16 19:35:52,203 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70814771 -0.7059406 0.00187893 -0.01308268] -2025-05-16 19:35:52,231 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25020599 -0.13486773 0.343461 ] -2025-05-16 19:35:52,233 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70814351 -0.7059538 0.00171679 -0.01261167] -2025-05-16 19:35:52,265 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25020983 -0.13485234 0.34347685] -2025-05-16 19:35:52,267 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70810665 -0.70600064 0.00155078 -0.01206925] -2025-05-16 19:35:52,296 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25020379 -0.1348507 0.34346506] -2025-05-16 19:35:52,299 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70808725 -0.70602693 0.0014283 -0.01167828] -2025-05-16 19:35:52,335 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25018938 -0.13485852 0.34344481] -2025-05-16 19:35:52,339 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70805023 -0.70606803 0.00135663 -0.01144418] -2025-05-16 19:35:52,382 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2501949 -0.13485393 0.34343399] -2025-05-16 19:35:52,384 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70801497 -0.70611225 0.00121678 -0.01090003] -2025-05-16 19:35:52,415 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25020249 -0.13482798 0.34344588] -2025-05-16 19:35:52,417 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.7079679 -0.70617092 0.00098859 -0.01015393] -2025-05-16 19:35:52,455 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25021035 -0.13482288 0.34345247] -2025-05-16 19:35:52,467 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70792747 -0.7062197 0.000826 -0.00957856] -2025-05-16 19:35:52,499 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25018989 -0.13485897 0.34344031] -2025-05-16 19:35:52,500 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70785426 -0.70629962 0.00071182 -0.00909324] -2025-05-16 19:35:52,532 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25020268 -0.13487699 0.34342831] -2025-05-16 19:35:52,533 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07797843e-01 -7.06361919e-01 6.39181722e-04 -8.63971560e-03] -2025-05-16 19:35:52,571 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25022223 -0.13486042 0.34345231] -2025-05-16 19:35:52,573 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07815369e-01 -7.06344369e-01 6.61533965e-04 -8.63703448e-03] -2025-05-16 19:35:52,605 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2502182 -0.13488132 0.34347558] -2025-05-16 19:35:52,608 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07747803e-01 -7.06419226e-01 5.23501416e-04 -8.04060833e-03] -2025-05-16 19:35:52,645 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25020406 -0.13489692 0.34347537] -2025-05-16 19:35:52,648 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07717411e-01 -7.06454968e-01 4.18160468e-04 -7.56767231e-03] -2025-05-16 19:35:52,679 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25019939 -0.13491052 0.34346836] -2025-05-16 19:35:52,680 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07693845e-01 -7.06480661e-01 3.74777515e-04 -7.37273076e-03] -2025-05-16 19:35:52,712 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25020989 -0.13491422 0.34344467] -2025-05-16 19:35:52,713 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07668854e-01 -7.06510891e-01 2.79922799e-04 -6.86114757e-03] -2025-05-16 19:35:52,750 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25021036 -0.13493885 0.34348189] -2025-05-16 19:35:52,751 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07634804e-01 -7.06547075e-01 2.85836654e-04 -6.64335862e-03] -2025-05-16 19:35:52,787 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25021411 -0.13494081 0.34349224] -2025-05-16 19:35:52,789 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07565841e-01 -7.06623595e-01 7.19730188e-05 -5.80264202e-03] -2025-05-16 19:35:52,820 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25020009 -0.13496854 0.34350507] -2025-05-16 19:35:52,821 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07530731e-01 -7.06660629e-01 4.90046748e-05 -5.56928522e-03] -2025-05-16 19:35:52,851 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25020237 -0.13497484 0.34351362] -2025-05-16 19:35:52,854 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07507627e-01 -7.06686931e-01 -2.73227909e-05 -5.15154201e-03] -2025-05-16 19:35:52,889 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25019194 -0.13499791 0.34348844] -2025-05-16 19:35:52,901 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07461759e-01 -7.06736878e-01 -1.38271784e-04 -4.56351482e-03] -2025-05-16 19:35:52,936 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2501973 -0.13500589 0.34352011] -2025-05-16 19:35:52,937 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07419959e-01 -7.06781513e-01 -2.18606091e-04 -4.10454227e-03] -2025-05-16 19:35:52,969 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2501923 -0.13501009 0.3435418 ] -2025-05-16 19:35:52,970 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07343944e-01 -7.06861442e-01 -4.06045349e-04 -3.35888930e-03] -2025-05-16 19:35:53,000 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25019226 -0.13500859 0.34355659] -2025-05-16 19:35:53,002 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07332055e-01 -7.06874123e-01 -4.38376017e-04 -3.18532357e-03] -2025-05-16 19:35:53,037 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25019967 -0.13499059 0.3435443 ] -2025-05-16 19:35:53,038 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07329542e-01 -7.06878270e-01 -5.24878461e-04 -2.78465174e-03] -2025-05-16 19:35:53,072 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25019775 -0.13499626 0.3435484 ] -2025-05-16 19:35:53,073 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07319852e-01 -7.06887917e-01 -5.13092746e-04 -2.79947022e-03] -2025-05-16 19:35:53,108 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25019289 -0.13499087 0.3435649 ] -2025-05-16 19:35:53,115 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07274725e-01 -7.06935008e-01 -6.79153445e-04 -2.21281255e-03] -2025-05-16 19:35:53,147 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25018984 -0.13499154 0.34357153] -2025-05-16 19:35:53,149 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70726705 -0.70694328 -0.00073651 -0.00199104] -2025-05-16 19:35:53,183 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25019158 -0.13497737 0.34358766] -2025-05-16 19:35:53,184 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.7072195 -0.70699213 -0.00087515 -0.00139467] -2025-05-16 19:35:53,215 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25019874 -0.13495393 0.34357459] -2025-05-16 19:35:53,221 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70719422 -0.70701789 -0.00099022 -0.00102724] -2025-05-16 19:35:53,256 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25019428 -0.13496525 0.3435784 ] -2025-05-16 19:35:53,266 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70717829 -0.70703382 -0.00097262 -0.00104351] -2025-05-16 19:35:53,317 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25017876 -0.13497885 0.34359115] -2025-05-16 19:35:53,319 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70715133 -0.70706089 -0.00099147 -0.00095166] -2025-05-16 19:35:53,350 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.250179 -0.13495007 0.34359707] -2025-05-16 19:35:53,353 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07093929e-01 7.07118582e-01 1.20203812e-03 2.05476166e-04] -2025-05-16 19:35:53,386 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25019378 -0.13494749 0.34357371] -2025-05-16 19:35:53,388 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07054768e-01 7.07157671e-01 1.25556176e-03 -8.15303197e-05] -2025-05-16 19:35:53,420 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2501933 -0.13495618 0.3435741 ] -2025-05-16 19:35:53,423 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07049391e-01 7.07163075e-01 1.24126380e-03 -5.94727321e-05] -2025-05-16 19:35:53,463 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25018948 -0.13496013 0.34358328] -2025-05-16 19:35:53,464 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07047464e-01 7.07165003e-01 1.23995150e-03 -6.26122316e-05] -2025-05-16 19:35:53,497 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25015017 -0.13498556 0.34361018] -2025-05-16 19:35:53,499 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06980534e-01 7.07231436e-01 1.37016823e-03 -5.86296172e-04] -2025-05-16 19:35:53,528 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25015657 -0.13495642 0.34357907] -2025-05-16 19:35:53,529 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7069215 0.7072891 0.00156326 -0.00129074] -2025-05-16 19:35:53,566 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25015495 -0.13496001 0.3435719 ] -2025-05-16 19:35:53,572 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70690589 0.70730448 0.0015788 -0.0013938 ] -2025-05-16 19:35:53,600 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25017124 -0.1349631 0.34357063] -2025-05-16 19:35:53,601 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70688116 0.70732879 0.00158569 -0.00157554] -2025-05-16 19:35:53,632 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25013653 -0.13499567 0.34359198] -2025-05-16 19:35:53,634 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70683578 0.70737353 0.0016276 -0.00179564] -2025-05-16 19:35:53,668 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012524 -0.13499824 0.34360163] -2025-05-16 19:35:53,671 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7068107 0.70739759 0.00169798 -0.00209771] -2025-05-16 19:35:53,706 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011631 -0.13499379 0.34357429] -2025-05-16 19:35:53,712 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70677182 0.70743378 0.00186392 -0.00275199] -2025-05-16 19:35:53,744 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25013174 -0.13499248 0.34356981] -2025-05-16 19:35:53,746 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7067447 0.70745977 0.00189768 -0.00299957] -2025-05-16 19:35:53,783 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012824 -0.13501466 0.34357291] -2025-05-16 19:35:53,784 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70669675 0.70750655 0.00191593 -0.00324417] -2025-05-16 19:35:53,820 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25010836 -0.13503943 0.3436053 ] -2025-05-16 19:35:53,821 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70665264 0.70754956 0.00192399 -0.00345823] -2025-05-16 19:35:53,853 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25009449 -0.13504711 0.34358486] -2025-05-16 19:35:53,854 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70660291 0.70759575 0.00206145 -0.00404142] -2025-05-16 19:35:53,884 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25009948 -0.13504352 0.34357324] -2025-05-16 19:35:53,886 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70659601 0.70760147 0.00209769 -0.0042237 ] -2025-05-16 19:35:53,920 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011591 -0.1350432 0.34356862] -2025-05-16 19:35:53,921 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70657255 0.70762275 0.00214365 -0.00454699] -2025-05-16 19:35:53,955 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011899 -0.13505891 0.34357356] -2025-05-16 19:35:53,957 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70654633 0.70764791 0.00213946 -0.00470598] -2025-05-16 19:35:53,990 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011199 -0.13508568 0.34359058] -2025-05-16 19:35:53,996 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70651774 0.70767604 0.00208963 -0.00478904] -2025-05-16 19:35:54,029 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25010811 -0.13508291 0.34358761] -2025-05-16 19:35:54,031 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70651945 0.70767328 0.00212153 -0.0049289 ] -2025-05-16 19:35:54,063 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25010892 -0.1350688 0.34357716] -2025-05-16 19:35:54,064 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70652604 0.70766533 0.00218007 -0.00509708] -2025-05-16 19:35:54,097 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011327 -0.13507559 0.34357405] -2025-05-16 19:35:54,098 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70651601 0.70767463 0.00219359 -0.00519001] -2025-05-16 19:35:54,135 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011671 -0.13509568 0.34358448] -2025-05-16 19:35:54,138 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70647313 0.70771533 0.0021845 -0.00547404] -2025-05-16 19:35:54,167 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011163 -0.13510271 0.34358846] -2025-05-16 19:35:54,172 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70645531 0.70773394 0.00213305 -0.00538713] -2025-05-16 19:35:54,205 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011153 -0.13509414 0.34359871] -2025-05-16 19:35:54,215 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7064616 0.7077276 0.00214899 -0.00538773] -2025-05-16 19:35:54,245 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011413 -0.13507172 0.3435861 ] -2025-05-16 19:35:54,255 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70649314 0.70769443 0.00221978 -0.00557861] -2025-05-16 19:35:54,289 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012386 -0.1350917 0.34358968] -2025-05-16 19:35:54,297 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70646346 0.7077213 0.0022211 -0.00591709] -2025-05-16 19:35:54,333 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012559 -0.13508984 0.34359341] -2025-05-16 19:35:54,337 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70645263 0.70773247 0.00220806 -0.00587885] -2025-05-16 19:35:54,369 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012057 -0.13509043 0.34360828] -2025-05-16 19:35:54,371 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70644242 0.70774334 0.0021777 -0.00580811] -2025-05-16 19:35:54,405 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011349 -0.13508696 0.34360239] -2025-05-16 19:35:54,414 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70644513 0.70774053 0.00219994 -0.00581264] -2025-05-16 19:35:54,455 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011586 -0.13506478 0.34359324] -2025-05-16 19:35:54,471 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70646981 0.70771274 0.00227849 -0.0061562 ] -2025-05-16 19:35:54,500 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25013446 -0.13506183 0.34359475] -2025-05-16 19:35:54,502 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70646702 0.70771532 0.00225261 -0.00618873] -2025-05-16 19:35:54,536 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25013709 -0.13507294 0.34361935] -2025-05-16 19:35:54,538 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70644367 0.7077398 0.00217724 -0.0060813 ] -2025-05-16 19:35:54,583 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2501284 -0.13507549 0.34361836] -2025-05-16 19:35:54,585 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70644525 0.70773832 0.0021835 -0.00606762] -2025-05-16 19:35:54,620 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011123 -0.1350509 0.3436066 ] -2025-05-16 19:35:54,624 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70647823 0.70770312 0.00227568 -0.00629451] -2025-05-16 19:35:54,661 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012595 -0.13503393 0.34359946] -2025-05-16 19:35:54,662 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70648051 0.70769976 0.00228627 -0.00641214] -2025-05-16 19:35:54,694 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25013084 -0.13504085 0.34360493] -2025-05-16 19:35:54,696 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7064728 0.70770768 0.00225945 -0.00639693] -2025-05-16 19:35:54,724 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25013617 -0.13505004 0.34361401] -2025-05-16 19:35:54,727 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70645761 0.70772325 0.00222443 -0.00636377] -2025-05-16 19:35:54,756 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25013454 -0.13505268 0.34362531] -2025-05-16 19:35:54,758 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70644675 0.70773447 0.00220113 -0.00632889] -2025-05-16 19:35:54,789 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011579 -0.13504009 0.34362529] -2025-05-16 19:35:54,794 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70645892 0.70772176 0.00223349 -0.00638093] -2025-05-16 19:35:54,824 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012322 -0.13502879 0.34361508] -2025-05-16 19:35:54,827 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70646585 0.70771452 0.00224079 -0.00641414] -2025-05-16 19:35:54,856 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012439 -0.13503493 0.34361606] -2025-05-16 19:35:54,858 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70646075 0.70771985 0.00222696 -0.00639253] -2025-05-16 19:35:54,888 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25013378 -0.13503843 0.34362413] -2025-05-16 19:35:54,889 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70645491 0.70772615 0.00219527 -0.00635109] -2025-05-16 19:35:54,920 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25013252 -0.13504015 0.34362992] -2025-05-16 19:35:54,922 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70645351 0.70772789 0.00217858 -0.00631861] -2025-05-16 19:35:54,953 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012186 -0.13504127 0.34363269] -2025-05-16 19:35:54,954 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70644263 0.70773888 0.0021722 -0.00630645] -2025-05-16 19:35:54,986 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011746 -0.13503482 0.34362767] -2025-05-16 19:35:54,988 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70644874 0.70773279 0.00217602 -0.00630418] -2025-05-16 19:35:55,019 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011913 -0.13502913 0.34362221] -2025-05-16 19:35:55,021 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70645601 0.70772548 0.00217318 -0.00630998] -2025-05-16 19:35:55,051 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012605 -0.13503005 0.34362685] -2025-05-16 19:35:55,053 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7064555 0.70772636 0.00215216 -0.00627661] -2025-05-16 19:35:55,080 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012876 -0.13503211 0.34363317] -2025-05-16 19:35:55,082 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70645483 0.70772746 0.00212714 -0.0062371 ] -2025-05-16 19:35:55,112 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012967 -0.13503701 0.34364111] -2025-05-16 19:35:55,114 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7064484 0.70773442 0.00209139 -0.00618669] -2025-05-16 19:35:55,148 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012863 -0.13503717 0.34364039] -2025-05-16 19:35:55,150 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70644968 0.70773334 0.00208563 -0.0061666 ] -2025-05-16 19:35:55,187 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012497 -0.13503486 0.34362929] -2025-05-16 19:35:55,188 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70645364 0.70772954 0.00208234 -0.00614949] -2025-05-16 19:35:55,220 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.250139 -0.13503579 0.34364744] -2025-05-16 19:35:55,221 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7064523 0.70773182 0.00201145 -0.00606376] -2025-05-16 19:35:55,253 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25013817 -0.13503378 0.34364111] -2025-05-16 19:35:55,255 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70645429 0.70772992 0.00201271 -0.00605321] -2025-05-16 19:35:55,285 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25013594 -0.13503477 0.34364263] -2025-05-16 19:35:55,286 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70645462 0.70772978 0.00200856 -0.00603309] -2025-05-16 19:35:55,320 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25013755 -0.1350354 0.3436431 ] -2025-05-16 19:35:55,323 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70645434 0.7077303 0.00200137 -0.00600725] -2025-05-16 19:35:55,351 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25014245 -0.13503743 0.34364449] -2025-05-16 19:35:55,353 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70645253 0.70773257 0.00197314 -0.00596124] -2025-05-16 19:35:55,396 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25014194 -0.13503963 0.34364534] -2025-05-16 19:35:55,400 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70645137 0.70773391 0.00196803 -0.00594194] -2025-05-16 19:35:55,440 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25013914 -0.13504064 0.34364619] -2025-05-16 19:35:55,446 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70645128 0.70773417 0.0019641 -0.00592195] -2025-05-16 19:35:55,481 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25016186 -0.13503991 0.3436564 ] -2025-05-16 19:35:55,490 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70644603 0.70774155 0.00181912 -0.0057091 ] -2025-05-16 19:35:55,520 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25014014 -0.13504302 0.34364084] -2025-05-16 19:35:55,522 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70642046 0.70776731 0.00184419 -0.00567146] -2025-05-16 19:35:55,552 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25014325 -0.13503714 0.34364165] -2025-05-16 19:35:55,553 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70642246 0.70776541 0.00184578 -0.00565874] -2025-05-16 19:35:55,599 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25013883 -0.13504274 0.34364014] -2025-05-16 19:35:55,603 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70641913 0.70776883 0.00184618 -0.00564685] -2025-05-16 19:35:55,636 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2501667 -0.13505698 0.34365402] -2025-05-16 19:35:55,637 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70640281 0.70778707 0.00169487 -0.00544633] -2025-05-16 19:35:55,670 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25016226 -0.13506342 0.34365063] -2025-05-16 19:35:55,671 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7063975 0.70779303 0.00166452 -0.00536899] -2025-05-16 19:35:55,702 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25015312 -0.13504686 0.34364616] -2025-05-16 19:35:55,703 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70640373 0.70778705 0.00170247 -0.00532664] -2025-05-16 19:35:55,735 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25015052 -0.13504437 0.34364708] -2025-05-16 19:35:55,735 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70640928 0.70778166 0.00170239 -0.00530541] -2025-05-16 19:35:55,764 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25015894 -0.13504796 0.3436463 ] -2025-05-16 19:35:55,766 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70640798 0.70778358 0.0016607 -0.00523553] -2025-05-16 19:35:55,796 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2501698 -0.13506697 0.34365237] -2025-05-16 19:35:55,797 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70639663 0.7077962 0.00156492 -0.00508742] -2025-05-16 19:35:55,830 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25017206 -0.13506168 0.34365405] -2025-05-16 19:35:55,831 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70641233 0.7077808 0.00156131 -0.00505285] -2025-05-16 19:35:55,861 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25015283 -0.13505088 0.34364409] -2025-05-16 19:35:55,862 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70640363 0.70779023 0.0015849 -0.00493945] -2025-05-16 19:35:55,887 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25015005 -0.1350525 0.34364677] -2025-05-16 19:35:55,888 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70640741 0.70778656 0.00158299 -0.00492518] -2025-05-16 19:35:55,915 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25015094 -0.13505056 0.34364727] -2025-05-16 19:35:55,917 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70641403 0.70778006 0.00158057 -0.00490928] -2025-05-16 19:35:55,945 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25015899 -0.13508662 0.34364254] -2025-05-16 19:35:55,946 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70638949 0.70780636 0.00144623 -0.00468569] -2025-05-16 19:35:55,975 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25015894 -0.13508047 0.34364305] -2025-05-16 19:35:55,976 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70640344 0.70779256 0.00145094 -0.00466616] -2025-05-16 19:35:56,004 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25015004 -0.13505641 0.34363425] -2025-05-16 19:35:56,005 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70641598 0.70778092 0.00147869 -0.00452163] -2025-05-16 19:35:56,032 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25014411 -0.13505851 0.34364058] -2025-05-16 19:35:56,033 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70641994 0.7077771 0.0014709 -0.00450286] -2025-05-16 19:35:56,060 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25014515 -0.13505638 0.34364437] -2025-05-16 19:35:56,061 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70642508 0.7077721 0.00146184 -0.00448689] -2025-05-16 19:35:56,099 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25015832 -0.13510627 0.34363729] -2025-05-16 19:35:56,101 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70641155 0.70778695 0.00135935 -0.00430289] -2025-05-16 19:35:56,127 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25015807 -0.13511495 0.34363809] -2025-05-16 19:35:56,130 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70642959 0.70776964 0.0013162 -0.00420133] -2025-05-16 19:35:56,161 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2501524 -0.13509494 0.34363285] -2025-05-16 19:35:56,163 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70646365 0.707737 0.0012978 -0.00397051] -2025-05-16 19:35:56,203 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2501459 -0.13509112 0.34363502] -2025-05-16 19:35:56,206 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70646566 0.70773523 0.0012965 -0.00393005] -2025-05-16 19:35:56,237 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25014599 -0.13510789 0.34363771] -2025-05-16 19:35:56,238 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70647298 0.70772921 0.00122859 -0.00371277] -2025-05-16 19:35:56,268 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011841 -0.13512016 0.34360266] -2025-05-16 19:35:56,270 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70649261 0.70771064 0.00121735 -0.00351588] -2025-05-16 19:35:56,308 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25013434 -0.13510516 0.34362095] -2025-05-16 19:35:56,311 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70650908 0.70769434 0.00120538 -0.003491 ] -2025-05-16 19:35:56,339 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25013322 -0.13509912 0.34362482] -2025-05-16 19:35:56,347 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7065106 0.70769287 0.00120454 -0.00348065] -2025-05-16 19:35:56,375 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25014406 -0.13509228 0.34363668] -2025-05-16 19:35:56,377 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70652194 0.70768198 0.00116794 -0.00340489] -2025-05-16 19:35:56,413 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011338 -0.13511284 0.34360819] -2025-05-16 19:35:56,414 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70653046 0.70767525 0.00112346 -0.00302994] -2025-05-16 19:35:56,448 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011816 -0.13510773 0.34361697] -2025-05-16 19:35:56,451 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70654152 0.70766427 0.00111534 -0.00302031] -2025-05-16 19:35:56,481 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012337 -0.13509586 0.34362026] -2025-05-16 19:35:56,485 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70654968 0.70765613 0.00111945 -0.00301589] -2025-05-16 19:35:56,512 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012334 -0.1350998 0.34363191] -2025-05-16 19:35:56,513 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70654878 0.7076572 0.00109665 -0.00298482] -2025-05-16 19:35:56,558 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25013726 -0.13508245 0.34363491] -2025-05-16 19:35:56,562 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70656646 0.70763997 0.00106526 -0.00289247] -2025-05-16 19:35:56,591 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25010278 -0.1351216 0.34362172] -2025-05-16 19:35:56,596 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70653811 0.70766961 0.00102453 -0.00256441] -2025-05-16 19:35:56,623 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2501112 -0.13509781 0.34362414] -2025-05-16 19:35:56,625 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70656741 0.70764041 0.0010286 -0.00254868] -2025-05-16 19:35:56,656 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25010873 -0.13510408 0.34363676] -2025-05-16 19:35:56,658 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7065678 0.70764012 0.00100694 -0.00252784] -2025-05-16 19:35:56,692 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011811 -0.13509954 0.34363658] -2025-05-16 19:35:56,697 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7065768 0.70763121 0.00099457 -0.0025121 ] -2025-05-16 19:35:56,732 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012549 -0.1351042 0.34363255] -2025-05-16 19:35:56,734 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70658568 0.70762323 0.00092602 -0.00227824] -2025-05-16 19:35:56,766 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25010333 -0.13510562 0.34361513] -2025-05-16 19:35:56,769 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7065803 0.7076291 0.00094394 -0.00210925] -2025-05-16 19:35:56,798 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25009963 -0.13509756 0.34362177] -2025-05-16 19:35:56,801 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70659025 0.70761923 0.00094572 -0.002087 ] -2025-05-16 19:35:56,833 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25010604 -0.13509361 0.34363247] -2025-05-16 19:35:56,837 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70660065 0.70760896 0.00092465 -0.00205561] -2025-05-16 19:35:56,880 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25010868 -0.13509251 0.34362913] -2025-05-16 19:35:56,880 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70660454 0.70760506 0.00092904 -0.00205659] -2025-05-16 19:35:56,913 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25008135 -0.13508945 0.34362901] -2025-05-16 19:35:56,915 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70660076 0.70761008 0.00087025 -0.00160727] -2025-05-16 19:35:56,951 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25009222 -0.13508137 0.34363481] -2025-05-16 19:35:56,953 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70660906 0.70760175 0.00089 -0.00161587] -2025-05-16 19:35:57,000 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25010368 -0.13506889 0.34365741] -2025-05-16 19:35:57,002 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70662552 0.70758539 0.0008792 -0.0015867 ] -2025-05-16 19:35:57,039 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011441 -0.13506443 0.34367372] -2025-05-16 19:35:57,040 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70663899 0.70757203 0.00086752 -0.00155206] -2025-05-16 19:35:57,071 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011377 -0.13505828 0.34368116] -2025-05-16 19:35:57,071 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70664123 0.7075704 0.00083239 -0.00127004] -2025-05-16 19:35:57,099 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011424 -0.13505261 0.34370247] -2025-05-16 19:35:57,100 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70663543 0.70757635 0.00084079 -0.00116598] -2025-05-16 19:35:57,131 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011735 -0.13503488 0.34372095] -2025-05-16 19:35:57,131 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70664465 0.70756716 0.00084622 -0.00115826] -2025-05-16 19:35:57,168 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011672 -0.13502804 0.34374561] -2025-05-16 19:35:57,171 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70665036 0.70756147 0.0008387 -0.00115099] -2025-05-16 19:35:57,200 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2501238 -0.13500814 0.3437776 ] -2025-05-16 19:35:57,201 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70666704 0.70754484 0.00083509 -0.00113463] -2025-05-16 19:35:57,233 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25013921 -0.13498706 0.34382541] -2025-05-16 19:35:57,245 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70667145 0.70754077 0.00080314 -0.00092844] -2025-05-16 19:35:57,280 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25015485 -0.13494244 0.34389457] -2025-05-16 19:35:57,281 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06675019e-01 7.07537541e-01 7.88724025e-04 -6.50346346e-04] -2025-05-16 19:35:57,319 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2501575 -0.13490663 0.34396522] -2025-05-16 19:35:57,320 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06682429e-01 7.07530221e-01 7.89263197e-04 -5.54400371e-04] -2025-05-16 19:35:57,358 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25015531 -0.13490067 0.34403861] -2025-05-16 19:35:57,359 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06711567e-01 7.07501001e-01 8.03962130e-04 -6.69650930e-04] -2025-05-16 19:35:57,395 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25018658 -0.13486442 0.34411119] -2025-05-16 19:35:57,404 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06713245e-01 7.07499503e-01 7.60835162e-04 -5.14339072e-04] -2025-05-16 19:35:57,432 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25021837 -0.13479541 0.34425915] -2025-05-16 19:35:57,433 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06700869e-01 7.07512058e-01 7.33962226e-04 -1.75476565e-04] -2025-05-16 19:35:57,462 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25022321 -0.1347764 0.34434827] -2025-05-16 19:35:57,463 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06695706e-01 7.07517228e-01 7.33308356e-04 -1.18063137e-04] -2025-05-16 19:35:57,499 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25023329 -0.13474525 0.34446764] -2025-05-16 19:35:57,500 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06706222e-01 7.07506741e-01 7.24688983e-04 -4.04105257e-05] -2025-05-16 19:35:57,534 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25025172 -0.13472183 0.34467341] -2025-05-16 19:35:57,535 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06726973e-01 7.07486039e-01 7.00602338e-04 -1.16028857e-05] -2025-05-16 19:35:57,571 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25026825 -0.13470964 0.34479147] -2025-05-16 19:35:57,572 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06728913e-01 7.07484118e-01 6.80852939e-04 5.43250143e-05] -2025-05-16 19:35:57,606 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25030506 -0.13461839 0.34507158] -2025-05-16 19:35:57,607 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06734311e-01 7.07478664e-01 6.48305961e-04 3.66453103e-04] -2025-05-16 19:35:57,639 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.250308 -0.13458439 0.34522801] -2025-05-16 19:35:57,640 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06733820e-01 7.07479113e-01 6.38580925e-04 4.52738523e-04] -2025-05-16 19:35:57,668 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25031639 -0.13456009 0.34555607] -2025-05-16 19:35:57,670 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06737068e-01 7.07475859e-01 5.90640752e-04 5.25653717e-04] -2025-05-16 19:35:57,700 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25032194 -0.13454341 0.34572106] -2025-05-16 19:35:57,706 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06744108e-01 7.07468842e-01 5.70806371e-04 5.26246070e-04] -2025-05-16 19:35:57,739 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25034084 -0.13449899 0.34596249] -2025-05-16 19:35:57,740 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06751906e-01 7.07461003e-01 5.41745826e-04 6.15428656e-04] -2025-05-16 19:35:57,769 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25034238 -0.13448707 0.34603773] -2025-05-16 19:35:57,775 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06748883e-01 7.07464040e-01 5.34048067e-04 6.03087469e-04] -2025-05-16 19:35:57,812 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25034314 -0.13442957 0.34653396] -2025-05-16 19:35:57,815 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06754483e-01 7.07458393e-01 5.00376065e-04 6.86999983e-04] -2025-05-16 19:35:57,850 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25035513 -0.13439466 0.34687168] -2025-05-16 19:35:57,852 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06788201e-01 7.07424656e-01 4.07919778e-04 7.92413913e-04] -2025-05-16 19:35:57,886 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25037125 -0.13433068 0.34728113] -2025-05-16 19:35:57,887 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06833360e-01 7.07379492e-01 3.64146488e-04 8.50051256e-04] -2025-05-16 19:35:57,918 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25038688 -0.13426755 0.34759491] -2025-05-16 19:35:57,919 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06872955e-01 7.07339893e-01 3.19763240e-04 8.93320531e-04] -2025-05-16 19:35:57,948 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.250393 -0.13420923 0.3479135 ] -2025-05-16 19:35:57,954 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06857461e-01 7.07355374e-01 2.89685722e-04 9.05593653e-04] -2025-05-16 19:35:57,984 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25040384 -0.13413859 0.34839065] -2025-05-16 19:35:57,985 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06873775e-01 7.07338992e-01 1.94465641e-04 9.89112284e-04] -2025-05-16 19:35:58,015 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25041237 -0.13410169 0.34863486] -2025-05-16 19:35:58,016 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06879942e-01 7.07332798e-01 1.46662121e-04 1.01946328e-03] -2025-05-16 19:35:58,047 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25041955 -0.13401065 0.34923399] -2025-05-16 19:35:58,050 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06932732e-01 7.07279956e-01 7.48629439e-05 1.08196859e-03] -2025-05-16 19:35:58,079 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25042952 -0.13395321 0.34954668] -2025-05-16 19:35:58,081 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06950106e-01 7.07262545e-01 2.53967480e-05 1.11310897e-03] -2025-05-16 19:35:58,109 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25043725 -0.13383822 0.35007545] -2025-05-16 19:35:58,112 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06955672e-01 7.07256939e-01 -2.36562611e-05 1.13999267e-03] -2025-05-16 19:35:58,142 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25044623 -0.13378484 0.35032009] -2025-05-16 19:35:58,144 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06955775e-01 7.07256800e-01 -6.73758247e-05 1.16068226e-03] -2025-05-16 19:35:58,183 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25045933 -0.13366856 0.3509974 ] -2025-05-16 19:35:58,185 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06955821e-01 7.07256604e-01 -1.72511381e-04 1.23840509e-03] -2025-05-16 19:35:58,213 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25047287 -0.13356305 0.35160297] -2025-05-16 19:35:58,214 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06986772e-01 7.07225516e-01 -2.67100715e-04 1.30465381e-03] -2025-05-16 19:35:58,248 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25048675 -0.13349602 0.35199167] -2025-05-16 19:35:58,249 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06994876e-01 7.07217319e-01 -3.25386018e-04 1.34308766e-03] -2025-05-16 19:35:58,277 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25049893 -0.13338779 0.35249242] -2025-05-16 19:35:58,278 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06999718e-01 7.07212424e-01 -3.69810074e-04 1.35971273e-03] -2025-05-16 19:35:58,312 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25050811 -0.13335646 0.35269112] -2025-05-16 19:35:58,318 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06988832e-01 7.07223265e-01 -3.99973407e-04 1.37309870e-03] -2025-05-16 19:35:58,353 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25053239 -0.13320726 0.35359111] -2025-05-16 19:35:58,355 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07001123e-01 7.07210767e-01 -5.57450203e-04 1.42566688e-03] -2025-05-16 19:35:58,387 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25054119 -0.13311223 0.3542586 ] -2025-05-16 19:35:58,389 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07007753e-01 7.07203963e-01 -6.65581521e-04 1.46620209e-03] -2025-05-16 19:35:58,420 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25054155 -0.1330916 0.35443812] -2025-05-16 19:35:58,424 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07008299e-01 7.07203427e-01 -6.70055280e-04 1.45948939e-03] -2025-05-16 19:35:58,454 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25056594 -0.13300063 0.35494163] -2025-05-16 19:35:58,455 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70699823 0.70721339 -0.00072326 0.00148384] -2025-05-16 19:35:58,484 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25057238 -0.13298155 0.35518044] -2025-05-16 19:35:58,487 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7069784 0.70723324 -0.00074371 0.00146083] -2025-05-16 19:35:58,519 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25061462 -0.13284615 0.35604631] -2025-05-16 19:35:58,520 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70702737 0.70718403 -0.00090652 0.00149286] -2025-05-16 19:35:58,551 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25064125 -0.1327695 0.35676526] -2025-05-16 19:35:58,552 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70699959 0.70721149 -0.00105368 0.00154181] -2025-05-16 19:35:58,587 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25065033 -0.13272907 0.35707357] -2025-05-16 19:35:58,589 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70698134 0.70722978 -0.00106501 0.00151379] -2025-05-16 19:35:58,620 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25067709 -0.13268043 0.35751736] -2025-05-16 19:35:58,622 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70693966 0.70727137 -0.00111175 0.00151376] -2025-05-16 19:35:58,684 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25070613 -0.13259948 0.35815094] -2025-05-16 19:35:58,689 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70694427 0.70726679 -0.0011818 0.00144867] -2025-05-16 19:35:58,720 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25075667 -0.13248782 0.35928662] -2025-05-16 19:35:58,722 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70690423 0.70730633 -0.00140906 0.0014762 ] -2025-05-16 19:35:58,753 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2507692 -0.13248276 0.35950587] -2025-05-16 19:35:58,755 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70687605 0.70733457 -0.00141891 0.00142898] -2025-05-16 19:35:58,788 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25080496 -0.13245748 0.35983451] -2025-05-16 19:35:58,789 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70684453 0.707366 -0.0014615 0.0014239 ] -2025-05-16 19:35:58,816 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25081355 -0.13246784 0.3599074 ] -2025-05-16 19:35:58,818 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70682472 0.70738582 -0.00145966 0.00141003] -2025-05-16 19:35:58,854 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25088514 -0.13237441 0.36084607] -2025-05-16 19:35:58,855 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7068136 0.70739686 -0.00157313 0.00132104] -2025-05-16 19:35:58,885 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25092654 -0.13233676 0.36121781] -2025-05-16 19:35:58,887 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70680057 0.70740968 -0.00165417 0.00132758] -2025-05-16 19:35:58,917 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25095561 -0.13232888 0.36181965] -2025-05-16 19:35:58,920 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7067241 0.70748596 -0.00175349 0.00126082] -2025-05-16 19:35:58,955 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25097779 -0.13232687 0.36200582] -2025-05-16 19:35:58,957 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70670182 0.70750824 -0.001768 0.00122881] -2025-05-16 19:35:58,990 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25101649 -0.13231131 0.36242757] -2025-05-16 19:35:58,992 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70666467 0.70754548 -0.00176831 0.00114736] -2025-05-16 19:35:59,023 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25106069 -0.13228664 0.36278275] -2025-05-16 19:35:59,031 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70666084 0.70754937 -0.00178943 0.00106948] -2025-05-16 19:35:59,067 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25112722 -0.13225296 0.36346103] -2025-05-16 19:35:59,068 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.706628 0.70758191 -0.0019119 0.00102897] -2025-05-16 19:35:59,102 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25116174 -0.13226109 0.363848 ] -2025-05-16 19:35:59,104 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70656782 0.70764203 -0.00195421 0.00092247] -2025-05-16 19:35:59,135 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25121434 -0.13224944 0.36419726] -2025-05-16 19:35:59,137 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7065119 0.70769787 -0.00197315 0.00087147] -2025-05-16 19:35:59,165 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25122849 -0.13223429 0.3642788 ] -2025-05-16 19:35:59,166 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70650051 0.70770941 -0.00193951 0.00081109] -2025-05-16 19:35:59,196 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25129877 -0.13221982 0.36468238] -2025-05-16 19:35:59,197 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06478566e-01 7.07731401e-01 -1.95546122e-03 6.90106241e-04] -2025-05-16 19:35:59,231 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25134792 -0.13220666 0.36500527] -2025-05-16 19:35:59,233 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06461491e-01 7.07748341e-01 -2.00781507e-03 6.45254419e-04] -2025-05-16 19:35:59,265 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25139996 -0.13222471 0.36546813] -2025-05-16 19:35:59,268 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06382413e-01 7.07827232e-01 -2.05767356e-03 5.11767124e-04] -2025-05-16 19:35:59,302 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25143955 -0.13223811 0.36576359] -2025-05-16 19:35:59,305 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06319096e-01 7.07890478e-01 -2.06072241e-03 4.00034425e-04] -2025-05-16 19:35:59,335 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25146246 -0.13223078 0.36587284] -2025-05-16 19:35:59,336 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06300778e-01 7.07908932e-01 -2.01274498e-03 3.21655983e-04] -2025-05-16 19:35:59,364 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2514974 -0.13223085 0.36599595] -2025-05-16 19:35:59,367 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06288217e-01 7.07921639e-01 -1.96525143e-03 2.12802089e-04] -2025-05-16 19:35:59,398 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25157807 -0.13221715 0.36642391] -2025-05-16 19:35:59,401 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06247028e-01 7.07962695e-01 -1.98737733e-03 9.16985441e-05] -2025-05-16 19:35:59,430 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25159721 -0.13222772 0.36656183] -2025-05-16 19:35:59,431 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06218843e-01 7.07990848e-01 -1.97609137e-03 1.36651615e-05] -2025-05-16 19:35:59,463 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25165473 -0.13224766 0.36695905] -2025-05-16 19:35:59,470 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06132870e-01 7.08076558e-01 -1.98198661e-03 -1.73059730e-04] -2025-05-16 19:35:59,502 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25167266 -0.13227449 0.36705347] -2025-05-16 19:35:59,504 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06086760e-01 7.08122678e-01 -1.90326109e-03 -3.70968585e-04] -2025-05-16 19:35:59,532 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25168339 -0.1322802 0.36706087] -2025-05-16 19:35:59,534 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06081082e-01 7.08128413e-01 -1.85923942e-03 -4.46535541e-04] -2025-05-16 19:35:59,573 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25175341 -0.13225639 0.36728191] -2025-05-16 19:35:59,576 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06053148e-01 7.08156265e-01 -1.82735087e-03 -5.63030588e-04] -2025-05-16 19:35:59,604 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25177221 -0.13227593 0.36734342] -2025-05-16 19:35:59,606 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70600707 0.70820217 -0.00178538 -0.00071862] -2025-05-16 19:35:59,636 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25180366 -0.13229206 0.36741574] -2025-05-16 19:35:59,639 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70595797 0.708251 -0.00177119 -0.00085175] -2025-05-16 19:35:59,670 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25181084 -0.13232792 0.36735964] -2025-05-16 19:35:59,671 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70591083 0.70829788 -0.00169574 -0.00106823] -2025-05-16 19:35:59,701 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25180047 -0.13234207 0.36719305] -2025-05-16 19:35:59,707 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70590184 0.70830683 -0.0016491 -0.00114559] -2025-05-16 19:35:59,737 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25186401 -0.13231681 0.36712252] -2025-05-16 19:35:59,738 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70586222 0.70834617 -0.00152633 -0.00137589] -2025-05-16 19:35:59,773 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25186425 -0.13230501 0.36683954] -2025-05-16 19:35:59,776 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70584792 0.70836031 -0.00149997 -0.00146148] -2025-05-16 19:35:59,807 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25187152 -0.13231847 0.36667124] -2025-05-16 19:35:59,809 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70581987 0.70838802 -0.00147497 -0.00159835] -2025-05-16 19:35:59,839 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25186374 -0.13236324 0.36631749] -2025-05-16 19:35:59,839 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70576449 0.70844271 -0.00139026 -0.00186771] -2025-05-16 19:35:59,867 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2518601 -0.132375 0.36607966] -2025-05-16 19:35:59,868 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70575403 0.70845299 -0.00135008 -0.00194892] -2025-05-16 19:35:59,899 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25188167 -0.13238706 0.36570503] -2025-05-16 19:35:59,900 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70574064 0.70846597 -0.00126383 -0.00212746] -2025-05-16 19:35:59,928 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25188077 -0.13238407 0.36532877] -2025-05-16 19:35:59,928 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70573652 0.70846988 -0.00120649 -0.00222178] -2025-05-16 19:35:59,958 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25187029 -0.13239506 0.36486566] -2025-05-16 19:35:59,959 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70571453 0.70849144 -0.00114031 -0.00236306] -2025-05-16 19:35:59,989 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2518578 -0.13242033 0.36446559] -2025-05-16 19:35:59,990 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70569579 0.70850965 -0.00109311 -0.00251587] -2025-05-16 19:36:00,022 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25183499 -0.13246437 0.36385096] -2025-05-16 19:36:00,024 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70568074 0.70852396 -0.00100645 -0.00273398] -2025-05-16 19:36:00,053 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25182782 -0.13249142 0.36355631] -2025-05-16 19:36:00,057 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70567876 0.70852568 -0.00097231 -0.00281203] -2025-05-16 19:36:00,094 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2518243 -0.13252966 0.36269577] -2025-05-16 19:36:00,096 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70567309 0.70853062 -0.00086978 -0.00301429] -2025-05-16 19:36:00,123 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25181402 -0.13254909 0.36227446] -2025-05-16 19:36:00,124 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70566463 0.70853878 -0.00082343 -0.00309011] -2025-05-16 19:36:00,151 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2518092 -0.1325743 0.36185528] -2025-05-16 19:36:00,152 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70565792 0.70854512 -0.00079321 -0.00317735] -2025-05-16 19:36:00,180 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25179878 -0.13260387 0.36142343] -2025-05-16 19:36:00,185 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70564784 0.70855471 -0.00075405 -0.00328145] -2025-05-16 19:36:00,213 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.251785 -0.13265689 0.3604939 ] -2025-05-16 19:36:00,215 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.05641426e-01 7.08560127e-01 -6.69414860e-04 -3.50375015e-03] -2025-05-16 19:36:00,244 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2517481 -0.13268627 0.36032504] -2025-05-16 19:36:00,247 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.05605628e-01 7.08595829e-01 -6.47028314e-04 -3.49732624e-03] -2025-05-16 19:36:00,277 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25177855 -0.13268978 0.36025025] -2025-05-16 19:36:00,279 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.05608035e-01 7.08593560e-01 -6.81118520e-04 -3.46475863e-03] -2025-05-16 19:36:00,313 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2517821 -0.13268718 0.36000352] -2025-05-16 19:36:00,316 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.05608847e-01 7.08592692e-01 -6.73994547e-04 -3.47817046e-03] -2025-05-16 19:36:00,348 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25174274 -0.13274138 0.35915107] -2025-05-16 19:36:00,351 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.05583431e-01 7.08617070e-01 -5.38785543e-04 -3.68505785e-03] -2025-05-16 19:36:00,385 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25171601 -0.13281261 0.3581107 ] -2025-05-16 19:36:00,388 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.05554642e-01 7.08644621e-01 -4.38254289e-04 -3.90585491e-03] -2025-05-16 19:36:00,422 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25171285 -0.13285606 0.35770615] -2025-05-16 19:36:00,426 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.05515959e-01 7.08682910e-01 -4.15339394e-04 -3.94881425e-03] -2025-05-16 19:36:00,456 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25173842 -0.13286395 0.35754853] -2025-05-16 19:36:00,458 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.05511788e-01 7.08687239e-01 -4.48067394e-04 -3.91311256e-03] -2025-05-16 19:36:00,485 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.251743 -0.13288141 0.35731566] -2025-05-16 19:36:00,488 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.05502936e-01 7.08696045e-01 -4.46641324e-04 -3.91464819e-03] -2025-05-16 19:36:00,520 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25171433 -0.13293651 0.35647334] -2025-05-16 19:36:00,521 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.05478530e-01 7.08719597e-01 -3.49667710e-04 -4.05636477e-03] -2025-05-16 19:36:00,557 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25166436 -0.13303998 0.35530619] -2025-05-16 19:36:00,559 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.05457412e-01 7.08739012e-01 -1.88410320e-04 -4.33786497e-03] -2025-05-16 19:36:00,587 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25166345 -0.13306855 0.35508841] -2025-05-16 19:36:00,587 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.05449194e-01 7.08747047e-01 -1.70966799e-04 -4.36231194e-03] -2025-05-16 19:36:00,615 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25168005 -0.13309869 0.35474113] -2025-05-16 19:36:00,616 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.05432402e-01 7.08763824e-01 -1.81648802e-04 -4.35150313e-03] -2025-05-16 19:36:00,644 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25168869 -0.13310426 0.35463278] -2025-05-16 19:36:00,646 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.05428634e-01 7.08767611e-01 -1.82671521e-04 -4.34541120e-03] -2025-05-16 19:36:00,671 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2516661 -0.13314988 0.35396034] -2025-05-16 19:36:00,672 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.05423534e-01 7.08772231e-01 -1.21380345e-04 -4.42124253e-03] -2025-05-16 19:36:00,699 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25163588 -0.13321515 0.35322657] -2025-05-16 19:36:00,701 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.05423999e-01 7.08770754e-01 -1.32083872e-05 -4.58251542e-03] -2025-05-16 19:36:00,734 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25162548 -0.13323902 0.35298151] -2025-05-16 19:36:00,737 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.05433368e-01 7.08761077e-01 2.45637041e-05 -4.63668377e-03] -2025-05-16 19:36:00,764 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25163825 -0.13330115 0.3523453 ] -2025-05-16 19:36:00,765 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.05437200e-01 7.08756897e-01 4.89895067e-05 -4.69200229e-03] -2025-05-16 19:36:00,792 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2516429 -0.13331407 0.35215304] -2025-05-16 19:36:00,799 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.05438787e-01 7.08755323e-01 5.06616498e-05 -4.69118909e-03] -2025-05-16 19:36:00,828 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25161548 -0.13335487 0.35155956] -2025-05-16 19:36:00,829 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.05438840e-01 7.08754878e-01 1.03364556e-04 -4.74933364e-03] -2025-05-16 19:36:00,856 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25157425 -0.1333986 0.35094408] -2025-05-16 19:36:00,863 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.05448941e-01 7.08743876e-01 2.16817751e-04 -4.88499197e-03] -2025-05-16 19:36:00,893 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25156488 -0.13340951 0.35075041] -2025-05-16 19:36:00,895 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.05458938e-01 7.08733634e-01 2.47784559e-04 -4.92559219e-03] -2025-05-16 19:36:00,925 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25156666 -0.13346784 0.35020945] -2025-05-16 19:36:00,930 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.05480970e-01 7.08711181e-01 2.96427881e-04 -4.99748422e-03] -2025-05-16 19:36:00,960 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25156756 -0.13350419 0.34978737] -2025-05-16 19:36:00,962 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.05498804e-01 7.08693321e-01 3.03879878e-04 -5.01209817e-03] -2025-05-16 19:36:00,992 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25155544 -0.13352318 0.34955044] -2025-05-16 19:36:00,999 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.05503512e-01 7.08688550e-01 3.17076007e-04 -5.02320575e-03] -2025-05-16 19:36:01,030 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25152107 -0.13355279 0.34909286] -2025-05-16 19:36:01,032 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.05512946e-01 7.08678494e-01 4.00491525e-04 -5.11024081e-03] -2025-05-16 19:36:01,060 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25152283 -0.13358784 0.34860413] -2025-05-16 19:36:01,061 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.05543964e-01 7.08647164e-01 4.48020667e-04 -5.16824750e-03] -2025-05-16 19:36:01,089 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25152494 -0.13360702 0.34843991] -2025-05-16 19:36:01,090 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.05556692e-01 7.08634314e-01 4.69638286e-04 -5.19065453e-03] -2025-05-16 19:36:01,123 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25152464 -0.13363341 0.3481993 ] -2025-05-16 19:36:01,131 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.05578438e-01 7.08612471e-01 4.91988523e-04 -5.21455938e-03] -2025-05-16 19:36:01,162 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25150722 -0.13366806 0.34781952] -2025-05-16 19:36:01,168 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.05599561e-01 7.08591361e-01 5.02533644e-04 -5.22389549e-03] -2025-05-16 19:36:01,200 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25148683 -0.1336948 0.34734212] -2025-05-16 19:36:01,203 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.05628602e-01 7.08561815e-01 5.80331483e-04 -5.30030043e-03] -2025-05-16 19:36:01,237 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25148616 -0.1337094 0.34713418] -2025-05-16 19:36:01,239 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.05652862e-01 7.08537403e-01 6.13413564e-04 -5.33023283e-03] -2025-05-16 19:36:01,290 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25149098 -0.13372548 0.34697424] -2025-05-16 19:36:01,295 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.05678621e-01 7.08511604e-01 6.33861116e-04 -5.34682286e-03] -2025-05-16 19:36:01,325 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25147015 -0.13376703 0.34657881] -2025-05-16 19:36:01,329 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.05710194e-01 7.08480012e-01 6.54933033e-04 -5.36336534e-03] -2025-05-16 19:36:01,357 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25144769 -0.13379119 0.34621605] -2025-05-16 19:36:01,362 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70574483 0.70844502 0.00071496 -0.00542029] -2025-05-16 19:36:01,394 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25144724 -0.13379548 0.34612368] -2025-05-16 19:36:01,396 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70576084 0.70842899 0.00072773 -0.00542886] -2025-05-16 19:36:01,424 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25144874 -0.13380147 0.34605608] -2025-05-16 19:36:01,428 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70578786 0.70840204 0.000736 -0.00543151] -2025-05-16 19:36:01,456 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25144718 -0.13381373 0.34598743] -2025-05-16 19:36:01,459 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7058012 0.70838878 0.000739 -0.00542774] -2025-05-16 19:36:01,492 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25142292 -0.13385212 0.34566775] -2025-05-16 19:36:01,495 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70583655 0.70835342 0.00075824 -0.00544163] -2025-05-16 19:36:01,525 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25140521 -0.13387905 0.34538796] -2025-05-16 19:36:01,527 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70587469 0.7083152 0.00078729 -0.00546574] -2025-05-16 19:36:01,556 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25139929 -0.13388263 0.34535335] -2025-05-16 19:36:01,558 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70588804 0.7083019 0.00079013 -0.0054641 ] -2025-05-16 19:36:01,587 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25139239 -0.13389436 0.34528922] -2025-05-16 19:36:01,588 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70592674 0.70826334 0.00079717 -0.00546344] -2025-05-16 19:36:01,616 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25138155 -0.13392143 0.34518524] -2025-05-16 19:36:01,617 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70595388 0.70823645 0.00078569 -0.00544388] -2025-05-16 19:36:01,645 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25136194 -0.13394986 0.34503549] -2025-05-16 19:36:01,648 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7059705 0.70821995 0.00078402 -0.00543515] -2025-05-16 19:36:01,678 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.251343 -0.13397366 0.34491167] -2025-05-16 19:36:01,680 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70599271 0.70819787 0.00078615 -0.005428 ] -2025-05-16 19:36:01,715 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25132203 -0.13400347 0.34476061] -2025-05-16 19:36:01,717 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7060415 0.70814927 0.00078989 -0.00542156] -2025-05-16 19:36:01,745 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25130852 -0.13402345 0.34473462] -2025-05-16 19:36:01,747 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70605798 0.70813291 0.00079223 -0.00541072] -2025-05-16 19:36:01,778 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25127969 -0.13406989 0.34462786] -2025-05-16 19:36:01,781 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70610133 0.70808983 0.0007896 -0.00539158] -2025-05-16 19:36:01,812 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25125115 -0.13410757 0.34452519] -2025-05-16 19:36:01,814 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70613232 0.70805919 0.00077968 -0.00535996] -2025-05-16 19:36:01,840 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25122744 -0.13413265 0.34445292] -2025-05-16 19:36:01,842 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70614844 0.70804325 0.00077878 -0.00534041] -2025-05-16 19:36:01,875 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25119308 -0.13417569 0.34434131] -2025-05-16 19:36:01,880 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7061966 0.70799539 0.00077572 -0.0053183 ] -2025-05-16 19:36:01,910 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25118129 -0.13419527 0.3443216 ] -2025-05-16 19:36:01,912 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70621484 0.70797732 0.00077244 -0.00530194] -2025-05-16 19:36:01,940 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25113696 -0.1342595 0.34423344] -2025-05-16 19:36:01,942 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70629552 0.70789711 0.00075981 -0.00526798] -2025-05-16 19:36:01,979 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25109504 -0.13430905 0.34416189] -2025-05-16 19:36:01,982 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70632789 0.70786512 0.00074204 -0.00522899] -2025-05-16 19:36:02,016 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25106806 -0.13433765 0.34411912] -2025-05-16 19:36:02,029 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70634635 0.70784692 0.00073234 -0.00519919] -2025-05-16 19:36:02,063 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25101925 -0.13440207 0.34403085] -2025-05-16 19:36:02,075 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.706408 0.70778573 0.00072389 -0.00515497] -2025-05-16 19:36:02,120 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25094805 -0.13445661 0.34394796] -2025-05-16 19:36:02,122 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70650619 0.70768862 0.00076989 -0.00502245] -2025-05-16 19:36:02,161 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25090974 -0.13450164 0.34392111] -2025-05-16 19:36:02,172 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70653947 0.70765578 0.00075195 -0.00497005] -2025-05-16 19:36:02,210 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25088752 -0.13452526 0.34391747] -2025-05-16 19:36:02,217 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70654783 0.7076477 0.00073936 -0.00493391] -2025-05-16 19:36:02,245 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25084849 -0.13457442 0.34387234] -2025-05-16 19:36:02,246 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70658069 0.70761526 0.00072583 -0.00488288] -2025-05-16 19:36:02,277 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25076977 -0.13463284 0.34379844] -2025-05-16 19:36:02,286 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70667865 0.70751842 0.00076975 -0.00473049] -2025-05-16 19:36:02,318 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2507295 -0.1346686 0.3437783] -2025-05-16 19:36:02,322 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70672901 0.70746866 0.00076982 -0.00464794] -2025-05-16 19:36:02,357 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25071115 -0.13468676 0.34377583] -2025-05-16 19:36:02,363 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70674005 0.70745793 0.00076315 -0.00460326] -2025-05-16 19:36:02,392 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25067807 -0.13472711 0.34376207] -2025-05-16 19:36:02,405 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70675177 0.7074467 0.00074652 -0.00453391] -2025-05-16 19:36:02,435 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25060776 -0.13479046 0.34370745] -2025-05-16 19:36:02,436 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70681563 0.70738374 0.00076038 -0.00439661] -2025-05-16 19:36:02,463 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25057109 -0.13481399 0.34368266] -2025-05-16 19:36:02,465 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70686461 0.70733537 0.00077554 -0.0042997 ] -2025-05-16 19:36:02,497 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25053595 -0.13484245 0.34367058] -2025-05-16 19:36:02,501 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7069033 0.70729732 0.00077665 -0.00419762] -2025-05-16 19:36:02,536 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25051579 -0.13486217 0.34367776] -2025-05-16 19:36:02,537 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70690091 0.70730031 0.00076527 -0.00409834] -2025-05-16 19:36:02,568 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25051475 -0.1348649 0.34368027] -2025-05-16 19:36:02,569 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70688668 0.70731461 0.00076912 -0.00408284] -2025-05-16 19:36:02,604 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25050902 -0.1348565 0.34367027] -2025-05-16 19:36:02,606 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70690313 0.70729844 0.00077996 -0.00403327] -2025-05-16 19:36:02,636 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2504912 -0.13487272 0.34366077] -2025-05-16 19:36:02,637 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70693022 0.70727176 0.00078278 -0.00396393] -2025-05-16 19:36:02,668 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25043958 -0.13491231 0.34364482] -2025-05-16 19:36:02,669 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70701901 0.70718399 0.00078413 -0.00378436] -2025-05-16 19:36:02,696 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25042834 -0.13492315 0.34364586] -2025-05-16 19:36:02,697 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70702955 0.70717376 0.00077791 -0.00372636] -2025-05-16 19:36:02,724 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25041069 -0.13493422 0.34364913] -2025-05-16 19:36:02,727 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70703234 0.70717149 0.0007747 -0.0036269 ] -2025-05-16 19:36:02,755 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25040551 -0.13493381 0.34364784] -2025-05-16 19:36:02,757 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70702921 0.70717487 0.00077503 -0.00357803] -2025-05-16 19:36:02,786 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2503848 -0.1349461 0.34363859] -2025-05-16 19:36:02,787 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70704683 0.70715786 0.00078368 -0.00345411] -2025-05-16 19:36:02,820 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25036413 -0.13496469 0.34363506] -2025-05-16 19:36:02,823 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7070993 0.70710582 0.00077984 -0.00336675] -2025-05-16 19:36:02,851 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25036649 -0.13495735 0.34363834] -2025-05-16 19:36:02,854 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70710667 -0.70709858 -0.00077955 0.00333831] -2025-05-16 19:36:02,887 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25034934 -0.13496836 0.3436408 ] -2025-05-16 19:36:02,889 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70709449 0.70711116 0.00078089 -0.00325139] -2025-05-16 19:36:02,918 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25034872 -0.13496694 0.34364152] -2025-05-16 19:36:02,919 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70709761 0.70710828 0.00077873 -0.00320261] -2025-05-16 19:36:02,952 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25032706 -0.13497905 0.34363047] -2025-05-16 19:36:02,954 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70711089 -0.70709568 -0.00078786 0.00304614] -2025-05-16 19:36:02,983 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25030762 -0.13500259 0.34362764] -2025-05-16 19:36:02,986 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70712393 -0.70708284 -0.0007846 0.00299816] -2025-05-16 19:36:03,016 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25030078 -0.13499128 0.3436413 ] -2025-05-16 19:36:03,018 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70713043 -0.70707689 -0.0007788 0.00286745] -2025-05-16 19:36:03,052 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25029881 -0.13498914 0.34363353] -2025-05-16 19:36:03,055 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70712579 -0.70708154 -0.00079295 0.00285946] -2025-05-16 19:36:03,097 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25030114 -0.13498664 0.34362999] -2025-05-16 19:36:03,099 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70713048 -0.70707703 -0.00079253 0.00281432] -2025-05-16 19:36:03,133 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25026948 -0.13502226 0.34362334] -2025-05-16 19:36:03,135 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70712834 -0.70708002 -0.000785 0.00259761] -2025-05-16 19:36:03,172 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25025706 -0.13501792 0.3436282 ] -2025-05-16 19:36:03,175 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70715587 -0.70705305 -0.00078712 0.00243576] -2025-05-16 19:36:03,210 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2502439 -0.1350203 0.34363674] -2025-05-16 19:36:03,212 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70715845 -0.70705083 -0.00078028 0.00233163] -2025-05-16 19:36:03,244 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25024271 -0.13501713 0.34362677] -2025-05-16 19:36:03,247 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70716437 -0.70704513 -0.00078632 0.00226475] -2025-05-16 19:36:03,281 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2502373 -0.1350369 0.34362259] -2025-05-16 19:36:03,288 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70715239 -0.70705728 -0.00077346 0.00221296] -2025-05-16 19:36:03,322 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25022146 -0.13504237 0.34362746] -2025-05-16 19:36:03,331 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70717042 -0.70703974 -0.00078371 0.00204619] -2025-05-16 19:36:03,365 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25020652 -0.13502704 0.34362753] -2025-05-16 19:36:03,370 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70717771 -0.70703293 -0.00080166 0.00186433] -2025-05-16 19:36:03,403 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25020978 -0.1350232 0.34363822] -2025-05-16 19:36:03,405 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70718252 -0.70702814 -0.00080213 0.00185852] -2025-05-16 19:36:03,436 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25021288 -0.13503024 0.34364388] -2025-05-16 19:36:03,438 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70717977 -0.70703096 -0.00079455 0.00183315] -2025-05-16 19:36:03,469 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25020679 -0.13504868 0.34365427] -2025-05-16 19:36:03,472 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.7071621 -0.70704889 -0.00078632 0.00173704] -2025-05-16 19:36:03,514 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25018807 -0.13504191 0.3436659 ] -2025-05-16 19:36:03,517 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70716128 -0.70705024 -0.00081299 0.00148858] -2025-05-16 19:36:03,567 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25018171 -0.13501501 0.34368544] -2025-05-16 19:36:03,571 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70718532 -0.70702651 -0.00084226 0.00131332] -2025-05-16 19:36:03,605 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25018086 -0.13501435 0.34369374] -2025-05-16 19:36:03,615 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70718705 -0.70702485 -0.00084763 0.00126992] -2025-05-16 19:36:03,647 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25016916 -0.13503393 0.34370847] -2025-05-16 19:36:03,650 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70713562 -0.70707658 -0.00086483 0.00108576] -2025-05-16 19:36:03,684 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25017459 -0.13501524 0.34370735] -2025-05-16 19:36:03,686 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70715876 -0.70705346 -0.0008696 0.00106564] -2025-05-16 19:36:03,713 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25017148 -0.13499185 0.34371849] -2025-05-16 19:36:03,717 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70718061 -0.70703177 -0.00089145 0.0009256 ] -2025-05-16 19:36:03,752 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25017009 -0.13499333 0.34371466] -2025-05-16 19:36:03,753 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70718228 -0.7070301 -0.0008908 0.00092572] -2025-05-16 19:36:03,791 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25017584 -0.13499066 0.34371309] -2025-05-16 19:36:03,799 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.7071887 -0.7070237 -0.00088791 0.00091837] -2025-05-16 19:36:03,833 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25016859 -0.13500037 0.34373907] -2025-05-16 19:36:03,835 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07141964e-01 -7.07070719e-01 -9.09153567e-04 6.43442560e-04] -2025-05-16 19:36:03,867 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25016842 -0.13496842 0.34374172] -2025-05-16 19:36:03,870 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07195335e-01 -7.07017386e-01 -9.42343879e-04 5.35040248e-04] -2025-05-16 19:36:03,899 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25016506 -0.13497045 0.34374044] -2025-05-16 19:36:03,922 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07197766e-01 -7.07014955e-01 -9.42163272e-04 5.34966822e-04] -2025-05-16 19:36:03,961 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25016672 -0.1349724 0.34373644] -2025-05-16 19:36:03,966 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07203868e-01 -7.07008852e-01 -9.39902697e-04 5.37849267e-04] -2025-05-16 19:36:04,012 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25016734 -0.13497468 0.34375699] -2025-05-16 19:36:04,013 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07178186e-01 -7.07034689e-01 -9.54194713e-04 2.29063781e-04] -2025-05-16 19:36:04,052 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25016264 -0.13496565 0.34375741] -2025-05-16 19:36:04,054 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07199610e-01 -7.07013249e-01 -9.69471938e-04 1.91245388e-04] -2025-05-16 19:36:04,083 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25016161 -0.13496477 0.34375352] -2025-05-16 19:36:04,084 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07200217e-01 -7.07012640e-01 -9.70368706e-04 1.97170114e-04] -2025-05-16 19:36:04,115 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25016273 -0.1349667 0.34375163] -2025-05-16 19:36:04,116 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07198858e-01 -7.07013998e-01 -9.69372256e-04 2.03673042e-04] -2025-05-16 19:36:04,147 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25016428 -0.1349672 0.34375049] -2025-05-16 19:36:04,150 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07197687e-01 -7.07015169e-01 -9.68493749e-04 2.10458039e-04] -2025-05-16 19:36:04,184 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25014508 -0.1349965 0.3437598 ] -2025-05-16 19:36:04,185 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07165921e-01 -7.07046943e-01 -9.84594460e-04 -1.09139683e-04] -2025-05-16 19:36:04,215 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25015383 -0.13497901 0.34375884] -2025-05-16 19:36:04,217 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07203268e-01 -7.07009600e-01 -9.75882052e-04 -1.02428170e-04] -2025-05-16 19:36:04,245 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2501554 -0.13497733 0.34375697] -2025-05-16 19:36:04,246 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07205284e-01 -7.07007587e-01 -9.74159248e-04 -9.31102514e-05] -2025-05-16 19:36:04,283 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2501546 -0.13497969 0.34375646] -2025-05-16 19:36:04,285 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07204729e-01 -7.07008149e-01 -9.70390604e-04 -8.81568417e-05] -2025-05-16 19:36:04,312 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25015757 -0.13497761 0.34375391] -2025-05-16 19:36:04,314 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07202843e-01 -7.07010034e-01 -9.70444723e-04 -9.09954129e-05] -2025-05-16 19:36:04,340 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2501554 -0.13497703 0.3437454 ] -2025-05-16 19:36:04,348 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07230776e-01 -7.06981997e-01 -9.75490583e-04 -3.65430426e-04] -2025-05-16 19:36:04,378 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25015589 -0.13497138 0.34374453] -2025-05-16 19:36:04,379 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07232224e-01 -7.06980555e-01 -9.74996605e-04 -3.54960421e-04] -2025-05-16 19:36:04,410 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25014851 -0.13498136 0.3437435 ] -2025-05-16 19:36:04,413 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07222667e-01 -7.06990122e-01 -9.72829039e-04 -3.46763654e-04] -2025-05-16 19:36:04,440 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25014797 -0.13497905 0.34374001] -2025-05-16 19:36:04,442 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07224313e-01 -7.06988478e-01 -9.74790298e-04 -3.36316902e-04] -2025-05-16 19:36:04,471 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25015752 -0.134976 0.34374135] -2025-05-16 19:36:04,472 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07229392e-01 -7.06983395e-01 -9.62590819e-04 -3.71998604e-04] -2025-05-16 19:36:04,503 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25014047 -0.13499647 0.34372193] -2025-05-16 19:36:04,510 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07218918e-01 -7.06993740e-01 -9.67524691e-04 -5.63976189e-04] -2025-05-16 19:36:04,549 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25014581 -0.13498558 0.34372862] -2025-05-16 19:36:04,552 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07228872e-01 -7.06983788e-01 -9.62365911e-04 -5.65595984e-04] -2025-05-16 19:36:04,585 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25014232 -0.13498888 0.3437304 ] -2025-05-16 19:36:04,590 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07227222e-01 -7.06985446e-01 -9.59911201e-04 -5.61517587e-04] -2025-05-16 19:36:04,617 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25014139 -0.13498929 0.34372728] -2025-05-16 19:36:04,618 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07226823e-01 -7.06985849e-01 -9.61323706e-04 -5.53218814e-04] -2025-05-16 19:36:04,652 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012931 -0.13500315 0.34370979] -2025-05-16 19:36:04,654 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70719751 -0.70701502 -0.00094489 -0.00073842] -2025-05-16 19:36:04,684 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25013777 -0.13499294 0.34371413] -2025-05-16 19:36:04,686 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70721379 -0.70699875 -0.00093779 -0.00073304] -2025-05-16 19:36:04,716 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25013597 -0.13499063 0.34371451] -2025-05-16 19:36:04,717 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70721588 -0.70699667 -0.00093673 -0.00072935] -2025-05-16 19:36:04,747 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25013298 -0.13499458 0.34371508] -2025-05-16 19:36:04,750 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70721379 -0.70699876 -0.00093673 -0.00072364] -2025-05-16 19:36:04,783 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25013304 -0.13499526 0.34371167] -2025-05-16 19:36:04,784 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70721387 -0.70699868 -0.00093469 -0.00072753] -2025-05-16 19:36:04,821 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012906 -0.13500241 0.34369558] -2025-05-16 19:36:04,822 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.7071915 -0.70702092 -0.00091496 -0.00087589] -2025-05-16 19:36:04,850 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25013081 -0.13500156 0.34369623] -2025-05-16 19:36:04,851 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.7071957 -0.70701673 -0.00091172 -0.00087205] -2025-05-16 19:36:04,883 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012903 -0.13500196 0.34369755] -2025-05-16 19:36:04,885 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70719615 -0.70701628 -0.00091072 -0.00086782] -2025-05-16 19:36:04,924 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012898 -0.13500211 0.34369661] -2025-05-16 19:36:04,934 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70719717 -0.70701527 -0.00091187 -0.00086137] -2025-05-16 19:36:04,963 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012869 -0.13500895 0.34369399] -2025-05-16 19:36:04,964 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70716078 -0.70705152 -0.00088249 -0.0010028 ] -2025-05-16 19:36:04,995 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25013021 -0.13500403 0.34368986] -2025-05-16 19:36:04,998 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70716698 -0.7070453 -0.00089329 -0.00100066] -2025-05-16 19:36:05,041 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2501272 -0.13499974 0.34368813] -2025-05-16 19:36:05,043 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70717036 -0.70704192 -0.00089755 -0.00099963] -2025-05-16 19:36:05,087 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012638 -0.13500197 0.34368846] -2025-05-16 19:36:05,102 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70717258 -0.70703971 -0.00089605 -0.0009916 ] -2025-05-16 19:36:05,141 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2501275 -0.13500403 0.34368807] -2025-05-16 19:36:05,143 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70717326 -0.70703905 -0.00089509 -0.00098223] -2025-05-16 19:36:05,183 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012648 -0.13500294 0.34368848] -2025-05-16 19:36:05,185 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.7071738 -0.70703852 -0.00089398 -0.00097609] -2025-05-16 19:36:05,221 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012522 -0.13500398 0.34368938] -2025-05-16 19:36:05,221 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70717365 -0.70703868 -0.00089216 -0.00097158] -2025-05-16 19:36:05,249 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012521 -0.13500491 0.34368928] -2025-05-16 19:36:05,251 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70717402 -0.70703831 -0.00089275 -0.00096611] -2025-05-16 19:36:05,287 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012592 -0.13500646 0.34368903] -2025-05-16 19:36:05,288 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70717356 -0.70703878 -0.00089345 -0.00096079] -2025-05-16 19:36:05,317 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012538 -0.13500535 0.34368905] -2025-05-16 19:36:05,319 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70717363 -0.70703872 -0.00089313 -0.00095579] -2025-05-16 19:36:05,356 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012461 -0.13500422 0.34368898] -2025-05-16 19:36:05,358 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70717384 -0.70703851 -0.00089172 -0.00094971] -2025-05-16 19:36:05,388 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012487 -0.13500414 0.34368979] -2025-05-16 19:36:05,393 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70717322 -0.70703914 -0.00088978 -0.00094517] -2025-05-16 19:36:05,425 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012527 -0.13500479 0.34368859] -2025-05-16 19:36:05,428 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70717351 -0.70703886 -0.00089165 -0.00093895] -2025-05-16 19:36:05,456 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012629 -0.13500485 0.34368875] -2025-05-16 19:36:05,458 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70717258 -0.7070398 -0.00089187 -0.00093387] -2025-05-16 19:36:05,486 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012545 -0.13500415 0.34368814] -2025-05-16 19:36:05,488 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70717284 -0.70703955 -0.00089112 -0.00092795] -2025-05-16 19:36:05,520 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012391 -0.13500257 0.34368861] -2025-05-16 19:36:05,521 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70717264 -0.70703976 -0.00088901 -0.00092354] -2025-05-16 19:36:05,553 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012387 -0.13500371 0.34368808] -2025-05-16 19:36:05,554 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70717155 -0.70704085 -0.00088923 -0.00091898] -2025-05-16 19:36:05,580 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012472 -0.1350048 0.34368746] -2025-05-16 19:36:05,581 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70717188 -0.70704052 -0.00088947 -0.00091465] -2025-05-16 19:36:05,608 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012471 -0.1350051 0.34368816] -2025-05-16 19:36:05,610 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70717119 -0.70704122 -0.00088918 -0.00091033] -2025-05-16 19:36:05,640 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012389 -0.13500469 0.34368791] -2025-05-16 19:36:05,642 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70717083 -0.70704158 -0.00088808 -0.00090602] -2025-05-16 19:36:05,673 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012166 -0.13500371 0.34368741] -2025-05-16 19:36:05,684 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70717011 -0.70704231 -0.0008866 -0.0009014 ] -2025-05-16 19:36:05,723 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012259 -0.13500432 0.34368771] -2025-05-16 19:36:05,725 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70717029 -0.70704214 -0.00088618 -0.00089796] -2025-05-16 19:36:05,754 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012349 -0.1350063 0.34368698] -2025-05-16 19:36:05,755 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70716964 -0.7070428 -0.00088745 -0.00089354] -2025-05-16 19:36:05,784 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012531 -0.13500614 0.34368781] -2025-05-16 19:36:05,786 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70716937 -0.70704307 -0.00088711 -0.00089025] -2025-05-16 19:36:05,820 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011197 -0.13500664 0.34367749] -2025-05-16 19:36:05,823 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.7071676 -0.70704485 -0.00086544 -0.00090581] -2025-05-16 19:36:05,854 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011333 -0.13500777 0.34367897] -2025-05-16 19:36:05,855 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.7071668 -0.70704565 -0.00086558 -0.00090058] -2025-05-16 19:36:05,887 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011506 -0.13500809 0.34368108] -2025-05-16 19:36:05,889 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70716601 -0.70704645 -0.00086492 -0.00089696] -2025-05-16 19:36:05,933 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011653 -0.13501035 0.34368259] -2025-05-16 19:36:05,941 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70716567 -0.70704679 -0.00086453 -0.00089378] -2025-05-16 19:36:05,968 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.250117 -0.13501076 0.34368143] -2025-05-16 19:36:05,969 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70716544 -0.70704703 -0.00086209 -0.00089143] -2025-05-16 19:36:05,996 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011818 -0.13501016 0.34368111] -2025-05-16 19:36:05,998 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70716469 -0.70704779 -0.0008613 -0.00088735] -2025-05-16 19:36:06,032 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011857 -0.1350084 0.34368099] -2025-05-16 19:36:06,034 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70716477 -0.70704771 -0.00085885 -0.00088403] -2025-05-16 19:36:06,069 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2501191 -0.1350083 0.34368086] -2025-05-16 19:36:06,070 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70716419 -0.70704829 -0.00085672 -0.0008816 ] -2025-05-16 19:36:06,100 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011742 -0.13500811 0.3436799 ] -2025-05-16 19:36:06,100 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70716395 -0.70704854 -0.00085611 -0.00087903] -2025-05-16 19:36:06,133 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2501153 -0.1350089 0.3436792] -2025-05-16 19:36:06,134 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70716338 -0.70704912 -0.00085467 -0.00087783] -2025-05-16 19:36:06,164 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011612 -0.13500747 0.34367925] -2025-05-16 19:36:06,166 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70716347 -0.70704903 -0.0008539 -0.00087499] -2025-05-16 19:36:06,203 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011703 -0.13500594 0.34367889] -2025-05-16 19:36:06,204 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70716291 -0.70704959 -0.00085319 -0.00087122] -2025-05-16 19:36:06,233 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2501178 -0.13500481 0.34367841] -2025-05-16 19:36:06,234 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70716217 -0.70705034 -0.00085266 -0.00086646] -2025-05-16 19:36:06,266 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011646 -0.13500438 0.34367819] -2025-05-16 19:36:06,267 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70716163 -0.70705089 -0.00085178 -0.00086387] -2025-05-16 19:36:06,299 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011518 -0.13500379 0.34367829] -2025-05-16 19:36:06,300 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70716141 -0.70705111 -0.00084957 -0.00086143] -2025-05-16 19:36:06,333 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2501144 -0.13500292 0.34367778] -2025-05-16 19:36:06,334 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70716088 -0.70705165 -0.00084778 -0.00085883] -2025-05-16 19:36:06,370 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011439 -0.13500351 0.34367783] -2025-05-16 19:36:06,371 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70716035 -0.70705218 -0.00084711 -0.0008561 ] -2025-05-16 19:36:06,400 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011491 -0.13500469 0.34367822] -2025-05-16 19:36:06,400 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70716015 -0.70705238 -0.00084646 -0.00085398] -2025-05-16 19:36:06,436 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2501138 -0.13500416 0.34367774] -2025-05-16 19:36:06,437 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70715959 -0.70705295 -0.00084605 -0.00085177] -2025-05-16 19:36:06,466 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2501122 -0.13500365 0.34367782] -2025-05-16 19:36:06,467 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70715908 -0.70705347 -0.00084316 -0.00084987] -2025-05-16 19:36:06,497 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011196 -0.13500303 0.34367767] -2025-05-16 19:36:06,498 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70715791 -0.70705464 -0.00084225 -0.00084696] -2025-05-16 19:36:06,528 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011184 -0.13500267 0.34367732] -2025-05-16 19:36:06,530 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70715774 -0.70705481 -0.00084168 -0.00084489] -2025-05-16 19:36:06,558 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011115 -0.13500299 0.34367764] -2025-05-16 19:36:06,559 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70715654 -0.70705601 -0.00083965 -0.00084294] -2025-05-16 19:36:06,589 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25010134 -0.13500725 0.34367329] -2025-05-16 19:36:06,594 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70713169 -0.70708094 -0.00080774 -0.00081399] -2025-05-16 19:36:06,628 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2501071 -0.13501016 0.34367485] -2025-05-16 19:36:06,632 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70712844 -0.7070842 -0.0008072 -0.00080679] -2025-05-16 19:36:06,662 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011318 -0.13501331 0.34367871] -2025-05-16 19:36:06,664 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.7071253 -0.70708735 -0.00080447 -0.00079957] -2025-05-16 19:36:06,701 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011482 -0.13501267 0.3436837 ] -2025-05-16 19:36:06,703 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70712433 -0.70708833 -0.00080473 -0.00079273] -2025-05-16 19:36:06,737 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25010645 -0.13501536 0.34369091] -2025-05-16 19:36:06,739 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70709788 0.70711484 0.00077509 0.00076779] -2025-05-16 19:36:06,768 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25010529 -0.13501545 0.34370823] -2025-05-16 19:36:06,769 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70709512 0.70711761 0.00077374 0.00076156] -2025-05-16 19:36:06,797 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25010946 -0.135019 0.34373054] -2025-05-16 19:36:06,800 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70708963 0.70712311 0.00076836 0.00074822] -2025-05-16 19:36:06,833 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25010544 -0.13502322 0.34374879] -2025-05-16 19:36:06,834 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70708824 0.70712451 0.00076652 0.00074453] -2025-05-16 19:36:06,862 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25010479 -0.13501903 0.3437635 ] -2025-05-16 19:36:06,864 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70708818 0.70712458 0.00076992 0.00073565] -2025-05-16 19:36:06,895 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25010133 -0.13501262 0.34377653] -2025-05-16 19:36:06,896 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70708169 0.70713109 0.00076855 0.00071976] -2025-05-16 19:36:06,925 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25009689 -0.13499225 0.34378371] -2025-05-16 19:36:06,933 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07065864e-01 7.07146939e-01 7.76642941e-04 6.84065422e-04] -2025-05-16 19:36:06,965 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25010335 -0.13497878 0.34380006] -2025-05-16 19:36:06,966 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07049751e-01 7.07163082e-01 7.67910677e-04 6.59655129e-04] -2025-05-16 19:36:06,995 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25010971 -0.13497471 0.34382289] -2025-05-16 19:36:06,996 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07045662e-01 7.07167191e-01 7.62416643e-04 6.43724930e-04] -2025-05-16 19:36:07,026 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011193 -0.13496941 0.34382419] -2025-05-16 19:36:07,029 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07043380e-01 7.07169481e-01 7.61172543e-04 6.35914551e-04] -2025-05-16 19:36:07,057 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011532 -0.13494799 0.34384267] -2025-05-16 19:36:07,059 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07037711e-01 7.07175165e-01 7.68253888e-04 6.09359951e-04] -2025-05-16 19:36:07,089 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012497 -0.13492969 0.34385555] -2025-05-16 19:36:07,097 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07032535e-01 7.07180352e-01 7.73535851e-04 5.88439880e-04] -2025-05-16 19:36:07,132 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.250136 -0.13489901 0.34387103] -2025-05-16 19:36:07,134 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07008921e-01 7.07204003e-01 7.75151431e-04 5.31976874e-04] -2025-05-16 19:36:07,163 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25016078 -0.13486469 0.34384438] -2025-05-16 19:36:07,164 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06997399e-01 7.07215562e-01 7.69486522e-04 4.83476001e-04] -2025-05-16 19:36:07,197 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25018376 -0.13483108 0.34378622] -2025-05-16 19:36:07,201 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07001548e-01 7.07211429e-01 7.70423802e-04 4.60555157e-04] -2025-05-16 19:36:07,234 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25020525 -0.13477568 0.34370323] -2025-05-16 19:36:07,235 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07000288e-01 7.07212707e-01 7.72065592e-04 4.29653108e-04] -2025-05-16 19:36:07,271 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25023155 -0.13470237 0.34362386] -2025-05-16 19:36:07,273 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06981499e-01 7.07231522e-01 7.75012710e-04 3.67235445e-04] -2025-05-16 19:36:07,300 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25025026 -0.13466528 0.34353345] -2025-05-16 19:36:07,302 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06970604e-01 7.07242445e-01 7.68813669e-04 3.13650964e-04] -2025-05-16 19:36:07,333 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25029022 -0.13462501 0.34340108] -2025-05-16 19:36:07,336 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06944686e-01 7.07268408e-01 7.49373833e-04 2.21887603e-04] -2025-05-16 19:36:07,378 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25034106 -0.13455378 0.34319694] -2025-05-16 19:36:07,386 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06945529e-01 7.07267575e-01 7.59749569e-04 1.37568851e-04] -2025-05-16 19:36:07,417 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25039909 -0.13446488 0.34292308] -2025-05-16 19:36:07,418 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06945291e-01 7.07267835e-01 7.49679003e-04 5.94189479e-05] -2025-05-16 19:36:07,449 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25046252 -0.13434727 0.34261136] -2025-05-16 19:36:07,450 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06936449e-01 7.07276680e-01 7.44091769e-04 -3.58143372e-05] -2025-05-16 19:36:07,480 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2505067 -0.13427102 0.34234185] -2025-05-16 19:36:07,481 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06906513e-01 7.07306607e-01 7.28533447e-04 -1.25529806e-04] -2025-05-16 19:36:07,513 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25058226 -0.1341814 0.34198394] -2025-05-16 19:36:07,516 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06874908e-01 7.07338206e-01 6.79292164e-04 -2.57799165e-04] -2025-05-16 19:36:07,546 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25062774 -0.13411762 0.34174085] -2025-05-16 19:36:07,547 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06864066e-01 7.07349035e-01 6.51194555e-04 -3.33080092e-04] -2025-05-16 19:36:07,579 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25067333 -0.13405718 0.34147618] -2025-05-16 19:36:07,580 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06855862e-01 7.07357213e-01 6.27384946e-04 -4.12891245e-04] -2025-05-16 19:36:07,609 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25080238 -0.13385973 0.34083467] -2025-05-16 19:36:07,611 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06834439e-01 7.07378516e-01 5.90805447e-04 -6.00650798e-04] -2025-05-16 19:36:07,641 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25089749 -0.13369556 0.34025572] -2025-05-16 19:36:07,646 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06796887e-01 7.07415867e-01 5.59506032e-04 -7.98995308e-04] -2025-05-16 19:36:07,672 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25096639 -0.13358941 0.339835 ] -2025-05-16 19:36:07,683 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06767403e-01 7.07445155e-01 5.15960867e-04 -9.61579277e-04] -2025-05-16 19:36:07,715 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2510356 -0.1334894 0.33936904] -2025-05-16 19:36:07,716 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06749365e-01 7.07462940e-01 4.55171954e-04 -1.14726243e-03] -2025-05-16 19:36:07,746 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25115023 -0.13333719 0.33868958] -2025-05-16 19:36:07,748 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06730904e-01 7.07481011e-01 3.61523389e-04 -1.38442732e-03] -2025-05-16 19:36:07,777 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25123872 -0.13320322 0.33818648] -2025-05-16 19:36:07,781 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06713188e-01 7.07498336e-01 3.17161877e-04 -1.57325111e-03] -2025-05-16 19:36:07,810 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25134236 -0.13305647 0.33757985] -2025-05-16 19:36:07,812 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06676097e-01 7.07534846e-01 2.68415294e-04 -1.80655772e-03] -2025-05-16 19:36:07,844 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25149353 -0.13289231 0.33681068] -2025-05-16 19:36:07,846 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06591060e-01 7.07618982e-01 1.28849624e-04 -2.10533675e-03] -2025-05-16 19:36:07,875 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25154297 -0.13285243 0.33652255] -2025-05-16 19:36:07,880 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06562205e-01 7.07647367e-01 7.41492238e-05 -2.24702585e-03] -2025-05-16 19:36:07,913 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25167699 -0.13269609 0.33566468] -2025-05-16 19:36:07,915 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06533848e-01 7.07674366e-01 -7.16066378e-05 -2.62832626e-03] -2025-05-16 19:36:07,946 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25178662 -0.13254512 0.33485979] -2025-05-16 19:36:07,954 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06466994e-01 7.07739604e-01 -1.51311728e-04 -3.00266952e-03] -2025-05-16 19:36:07,984 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25187916 -0.13245093 0.33427186] -2025-05-16 19:36:07,987 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06427503e-01 7.07777599e-01 -2.46859193e-04 -3.31551448e-03] -2025-05-16 19:36:08,023 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25197982 -0.13235817 0.33371475] -2025-05-16 19:36:08,032 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06344223e-01 7.07859280e-01 -3.31257356e-04 -3.60124169e-03] -2025-05-16 19:36:08,067 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25210027 -0.13229789 0.33300664] -2025-05-16 19:36:08,068 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06258753e-01 7.07942498e-01 -5.25695624e-04 -3.96446138e-03] -2025-05-16 19:36:08,097 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25222828 -0.13219367 0.33220643] -2025-05-16 19:36:08,109 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06211203e-01 7.07987458e-01 -6.49282466e-04 -4.36750903e-03] -2025-05-16 19:36:08,137 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25227906 -0.13215205 0.3317706 ] -2025-05-16 19:36:08,138 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06176631e-01 7.08020346e-01 -6.96382488e-04 -4.61192551e-03] -2025-05-16 19:36:08,173 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25235129 -0.13210893 0.33119731] -2025-05-16 19:36:08,175 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70611854 0.7080759 -0.00074024 -0.00495752] -2025-05-16 19:36:08,239 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25243254 -0.13207663 0.3305961 ] -2025-05-16 19:36:08,240 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70599944 0.70819191 -0.00083924 -0.00532055] -2025-05-16 19:36:08,278 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25258162 -0.13199376 0.32953759] -2025-05-16 19:36:08,279 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70584716 0.70833875 -0.00101564 -0.00591344] -2025-05-16 19:36:08,315 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25264182 -0.13198135 0.32895434] -2025-05-16 19:36:08,316 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70579066 0.70839178 -0.00104304 -0.00628841] -2025-05-16 19:36:08,349 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25266539 -0.13198211 0.32866045] -2025-05-16 19:36:08,358 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70575608 0.7084244 -0.00101571 -0.00649527] -2025-05-16 19:36:08,391 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25270841 -0.13201184 0.32821725] -2025-05-16 19:36:08,408 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70563961 0.70853719 -0.00110774 -0.00682404] -2025-05-16 19:36:08,437 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25282 -0.13199051 0.32736576] -2025-05-16 19:36:08,439 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7054967 0.70867369 -0.00125429 -0.00737829] -2025-05-16 19:36:08,468 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25284063 -0.13198786 0.32707457] -2025-05-16 19:36:08,470 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7054432 0.70872458 -0.0012789 -0.00759733] -2025-05-16 19:36:08,503 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25288903 -0.13200115 0.32651079] -2025-05-16 19:36:08,505 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70534007 0.70882252 -0.00127818 -0.00802382] -2025-05-16 19:36:08,535 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2528842 -0.13203459 0.32626601] -2025-05-16 19:36:08,537 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70527957 0.70888 -0.0012481 -0.00826513] -2025-05-16 19:36:08,570 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25290355 -0.13204963 0.32604711] -2025-05-16 19:36:08,573 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7052163 0.7089405 -0.00128986 -0.00846557] -2025-05-16 19:36:08,601 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25295867 -0.13206862 0.32539014] -2025-05-16 19:36:08,602 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70504876 0.70910023 -0.00139145 -0.00900976] -2025-05-16 19:36:08,634 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2529691 -0.13206949 0.32518601] -2025-05-16 19:36:08,636 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70499871 0.70914748 -0.00140749 -0.00920314] -2025-05-16 19:36:08,669 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25300512 -0.13209005 0.32456951] -2025-05-16 19:36:08,670 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70489178 0.70924624 -0.00140438 -0.00976616] -2025-05-16 19:36:08,704 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25301137 -0.1320812 0.3244503 ] -2025-05-16 19:36:08,705 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70486382 0.7092722 -0.001361 -0.00990445] -2025-05-16 19:36:08,734 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25303012 -0.13209546 0.32406363] -2025-05-16 19:36:08,736 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70474752 0.70938181 -0.00139507 -0.0103164 ] -2025-05-16 19:36:08,769 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25304761 -0.13208947 0.32364756] -2025-05-16 19:36:08,771 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70461688 0.70950471 -0.00143316 -0.01077338] -2025-05-16 19:36:08,804 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25306871 -0.13208353 0.32334575] -2025-05-16 19:36:08,807 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70452067 0.709595 -0.00147858 -0.01110759] -2025-05-16 19:36:08,838 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25308989 -0.13208065 0.32294235] -2025-05-16 19:36:08,839 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70441523 0.70969241 -0.00144096 -0.01156711] -2025-05-16 19:36:08,870 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25309865 -0.13204398 0.3227126 ] -2025-05-16 19:36:08,872 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70435545 0.70974734 -0.00138059 -0.01184083] -2025-05-16 19:36:08,904 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25312131 -0.13201674 0.32250517] -2025-05-16 19:36:08,905 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70427997 0.70981771 -0.00138917 -0.01210845] -2025-05-16 19:36:08,934 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2531292 -0.13197088 0.32215657] -2025-05-16 19:36:08,935 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70417475 0.70991481 -0.00136709 -0.01253057] -2025-05-16 19:36:08,965 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25313815 -0.13195203 0.32201467] -2025-05-16 19:36:08,966 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70412622 0.70995978 -0.00136719 -0.01270833] -2025-05-16 19:36:08,999 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25316761 -0.13192725 0.32152069] -2025-05-16 19:36:09,001 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70398816 0.71008538 -0.00131556 -0.01332966] -2025-05-16 19:36:09,031 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25318082 -0.13187572 0.32130334] -2025-05-16 19:36:09,034 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70392407 0.71014381 -0.0012341 -0.01360728] -2025-05-16 19:36:09,064 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25319974 -0.13181838 0.32116041] -2025-05-16 19:36:09,066 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70386488 0.71019865 -0.00119722 -0.0138088 ] -2025-05-16 19:36:09,096 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25321512 -0.13172576 0.32087872] -2025-05-16 19:36:09,098 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70377111 0.71028393 -0.00112206 -0.01420243] -2025-05-16 19:36:09,125 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25322687 -0.13169491 0.32079535] -2025-05-16 19:36:09,132 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70373849 0.71031347 -0.00109829 -0.01434265] -2025-05-16 19:36:09,161 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25326612 -0.13162376 0.32034949] -2025-05-16 19:36:09,163 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70361233 0.71042539 -0.00099509 -0.01498193] -2025-05-16 19:36:09,193 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25327215 -0.13159698 0.32024539] -2025-05-16 19:36:09,197 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70358051 0.71045346 -0.00093102 -0.01514873] -2025-05-16 19:36:09,225 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25329199 -0.1315072 0.32007286] -2025-05-16 19:36:09,227 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70350254 0.71052394 -0.00083994 -0.01546628] -2025-05-16 19:36:09,257 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25330684 -0.13143179 0.32000239] -2025-05-16 19:36:09,264 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70347577 0.71054641 -0.00077163 -0.0156541 ] -2025-05-16 19:36:09,300 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25333744 -0.13131295 0.31975761] -2025-05-16 19:36:09,302 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.03354204e-01 7.10654193e-01 -6.68846929e-04 -1.62183473e-02] -2025-05-16 19:36:09,337 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25335001 -0.13125941 0.31971842] -2025-05-16 19:36:09,338 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.03294901e-01 7.10706512e-01 -5.97404054e-04 -1.64978542e-02] -2025-05-16 19:36:09,370 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25336031 -0.13120334 0.31970411] -2025-05-16 19:36:09,372 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.03209791e-01 7.10783074e-01 -5.15045480e-04 -1.68269567e-02] -2025-05-16 19:36:09,403 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25335662 -0.13114748 0.31977944] -2025-05-16 19:36:09,404 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.03164732e-01 7.10821864e-01 -4.25298361e-04 -1.70721049e-02] -2025-05-16 19:36:09,438 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25334268 -0.13112848 0.31991904] -2025-05-16 19:36:09,440 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.03145256e-01 7.10838413e-01 -3.78180423e-04 -1.71859139e-02] -2025-05-16 19:36:09,470 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25333434 -0.13105438 0.31999908] -2025-05-16 19:36:09,472 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.03051263e-01 7.10919187e-01 -2.67288900e-04 -1.76850331e-02] -2025-05-16 19:36:09,503 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25331332 -0.13105108 0.32016055] -2025-05-16 19:36:09,504 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.03007736e-01 7.10956464e-01 -2.04171441e-04 -1.79161469e-02] -2025-05-16 19:36:09,534 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25330007 -0.13101267 0.32043268] -2025-05-16 19:36:09,536 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.02945997e-01 7.11008178e-01 -8.22224777e-05 -1.82835801e-02] -2025-05-16 19:36:09,571 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25326818 -0.13102003 0.32083461] -2025-05-16 19:36:09,572 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.02905904e-01 7.11042575e-01 2.14697735e-06 -1.84864019e-02] -2025-05-16 19:36:09,603 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25323541 -0.13103227 0.32112059] -2025-05-16 19:36:09,604 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.02891153e-01 7.11054602e-01 4.24245523e-05 -1.85843660e-02] -2025-05-16 19:36:09,641 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25319209 -0.13103846 0.32158198] -2025-05-16 19:36:09,649 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.02821494e-01 7.11114764e-01 1.12538855e-04 -1.89136768e-02] -2025-05-16 19:36:09,683 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25313664 -0.13107332 0.32209338] -2025-05-16 19:36:09,688 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.02775181e-01 7.11152104e-01 2.01340923e-04 -1.92273089e-02] -2025-05-16 19:36:09,719 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25310085 -0.13111149 0.32259664] -2025-05-16 19:36:09,721 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.02760202e-01 7.11162317e-01 2.64036877e-04 -1.93955466e-02] -2025-05-16 19:36:09,752 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25303792 -0.13116304 0.32326232] -2025-05-16 19:36:09,754 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.02742829e-01 7.11176093e-01 3.52936519e-04 -1.95180841e-02] -2025-05-16 19:36:09,788 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25295418 -0.13122466 0.32390801] -2025-05-16 19:36:09,800 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.02737593e-01 7.11176912e-01 4.46194529e-04 -1.96742513e-02] -2025-05-16 19:36:09,837 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25287634 -0.1313103 0.3245366 ] -2025-05-16 19:36:09,840 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.02706229e-01 7.11202646e-01 4.98461079e-04 -1.98621149e-02] -2025-05-16 19:36:09,869 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25281485 -0.13140614 0.32540984] -2025-05-16 19:36:09,872 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.02691688e-01 7.11211383e-01 5.47157895e-04 -2.00614083e-02] -2025-05-16 19:36:09,905 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25275507 -0.13148915 0.32621072] -2025-05-16 19:36:09,906 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.02638708e-01 7.11261867e-01 6.16351068e-04 -2.01251760e-02] -2025-05-16 19:36:09,950 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25268488 -0.13156442 0.32675213] -2025-05-16 19:36:09,952 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.02587754e-01 7.11311809e-01 6.70960150e-04 -2.01372295e-02] -2025-05-16 19:36:09,981 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25258632 -0.13165492 0.32743536] -2025-05-16 19:36:09,983 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70255611 0.71134163 0.00075083 -0.02018479] -2025-05-16 19:36:10,018 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25246928 -0.13178635 0.32848746] -2025-05-16 19:36:10,020 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70256966 0.71132413 0.00083767 -0.02032609] -2025-05-16 19:36:10,051 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25240772 -0.13190688 0.32943992] -2025-05-16 19:36:10,053 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70256632 0.71132667 0.00085476 -0.02035172] -2025-05-16 19:36:10,089 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25236265 -0.13197995 0.32985954] -2025-05-16 19:36:10,091 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70255566 0.71133843 0.00085931 -0.02030863] -2025-05-16 19:36:10,124 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25225487 -0.13212383 0.33059106] -2025-05-16 19:36:10,128 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70252016 0.71137443 0.00088328 -0.0202748 ] -2025-05-16 19:36:10,158 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25211258 -0.13228033 0.33156067] -2025-05-16 19:36:10,169 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70252092 0.71137319 0.00095354 -0.02028856] -2025-05-16 19:36:10,200 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25199576 -0.13244802 0.33271745] -2025-05-16 19:36:10,204 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70256125 0.71133408 0.00099255 -0.02026157] -2025-05-16 19:36:10,239 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25194042 -0.13255542 0.33326859] -2025-05-16 19:36:10,242 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70260371 0.71129504 0.00096249 -0.02016081] -2025-05-16 19:36:10,269 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25181377 -0.13273839 0.33405865] -2025-05-16 19:36:10,270 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70263254 0.71127019 0.00095037 -0.02003312] -2025-05-16 19:36:10,312 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25172063 -0.1328106 0.3345063 ] -2025-05-16 19:36:10,313 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70266003 0.71124607 0.00100195 -0.01992266] -2025-05-16 19:36:10,340 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25165951 -0.13287617 0.33487128] -2025-05-16 19:36:10,342 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70268137 0.71122697 0.00102898 -0.01985002] -2025-05-16 19:36:10,369 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25154314 -0.13302033 0.33580342] -2025-05-16 19:36:10,370 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70275351 0.71115941 0.00105939 -0.01971473] -2025-05-16 19:36:10,396 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2514709 -0.13312799 0.33642557] -2025-05-16 19:36:10,398 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70282378 0.71109526 0.00103428 -0.01952435] -2025-05-16 19:36:10,424 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25141917 -0.13319896 0.33675502] -2025-05-16 19:36:10,426 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70286769 0.71105586 0.00102062 -0.01937867] -2025-05-16 19:36:10,460 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25129804 -0.13333105 0.33737425] -2025-05-16 19:36:10,462 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70293081 0.71100126 0.00102202 -0.01909038] -2025-05-16 19:36:10,489 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25123435 -0.13338206 0.33763111] -2025-05-16 19:36:10,490 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70297617 0.71096034 0.00106202 -0.01894106] -2025-05-16 19:36:10,520 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2510872 -0.1335448 0.33865659] -2025-05-16 19:36:10,522 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7031329 0.71081545 0.00110271 -0.01855535] -2025-05-16 19:36:10,552 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25107004 -0.13356994 0.33880796] -2025-05-16 19:36:10,553 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70317081 0.71078136 0.0010949 -0.01842466] -2025-05-16 19:36:10,586 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25097658 -0.13367594 0.33937372] -2025-05-16 19:36:10,587 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70326986 0.71069276 0.00108291 -0.01805917] -2025-05-16 19:36:10,617 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25094043 -0.13370607 0.3395294 ] -2025-05-16 19:36:10,618 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70330448 0.71066318 0.00107513 -0.01787436] -2025-05-16 19:36:10,647 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25079276 -0.13384164 0.34032221] -2025-05-16 19:36:10,649 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70345911 0.71052409 0.00111313 -0.01730782] -2025-05-16 19:36:10,676 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25074293 -0.13390361 0.34065515] -2025-05-16 19:36:10,679 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70352842 0.7104622 0.00111594 -0.01702901] -2025-05-16 19:36:10,705 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25072872 -0.13391697 0.34080116] -2025-05-16 19:36:10,707 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70358236 0.7104132 0.0011006 -0.01684463] -2025-05-16 19:36:10,736 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25065652 -0.13398663 0.34117658] -2025-05-16 19:36:10,737 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.703731 0.71027517 0.00110728 -0.01645121] -2025-05-16 19:36:10,765 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25062329 -0.13401785 0.34136343] -2025-05-16 19:36:10,766 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70380989 0.71020354 0.00107475 -0.01616858] -2025-05-16 19:36:10,792 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25050542 -0.13414787 0.34196341] -2025-05-16 19:36:10,795 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70392966 0.71009916 0.00106376 -0.01552708] -2025-05-16 19:36:10,820 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25048279 -0.13417965 0.34210114] -2025-05-16 19:36:10,821 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70398496 0.7100489 0.00103869 -0.01531853] -2025-05-16 19:36:10,850 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25047049 -0.13420048 0.34223919] -2025-05-16 19:36:10,851 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70405629 0.70998319 0.00100335 -0.01508672] -2025-05-16 19:36:10,887 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25040873 -0.1342449 0.34252682] -2025-05-16 19:36:10,889 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70421561 0.70983593 0.00099072 -0.0145723 ] -2025-05-16 19:36:10,926 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25033842 -0.13430775 0.3428838 ] -2025-05-16 19:36:10,930 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7043856 0.7096801 0.00094891 -0.01393486] -2025-05-16 19:36:10,967 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25027804 -0.13439004 0.34320772] -2025-05-16 19:36:10,968 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70452706 0.70955084 0.00089674 -0.01335761] -2025-05-16 19:36:11,000 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25025279 -0.13441184 0.34333327] -2025-05-16 19:36:11,001 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70462762 0.70945823 0.0008616 -0.01296905] -2025-05-16 19:36:11,030 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25023263 -0.13443251 0.34340658] -2025-05-16 19:36:11,033 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70470034 0.70939158 0.00083229 -0.01266165] -2025-05-16 19:36:11,071 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25019907 -0.13445894 0.34357646] -2025-05-16 19:36:11,074 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70483655 0.70926549 0.00079611 -0.01213501] -2025-05-16 19:36:11,114 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25014985 -0.13453122 0.34382955] -2025-05-16 19:36:11,117 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70499059 0.70912338 0.00074618 -0.0114783 ] -2025-05-16 19:36:11,146 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012155 -0.13457816 0.34405069] -2025-05-16 19:36:11,154 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.05198251e-01 7.08928284e-01 6.66576789e-04 -1.07549999e-02] -2025-05-16 19:36:11,188 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012264 -0.13459134 0.34410692] -2025-05-16 19:36:11,191 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.05292137e-01 7.08841140e-01 6.07225329e-04 -1.03378124e-02] -2025-05-16 19:36:11,232 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011052 -0.13461683 0.34418276] -2025-05-16 19:36:11,235 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.05419637e-01 7.08721819e-01 5.61106195e-04 -9.80838402e-03] -2025-05-16 19:36:11,266 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007901 -0.13465965 0.34431089] -2025-05-16 19:36:11,270 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.05549406e-01 7.08600877e-01 5.56295789e-04 -9.19365123e-03] -2025-05-16 19:36:11,301 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.250072 -0.13468173 0.34438241] -2025-05-16 19:36:11,302 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.05637705e-01 7.08517946e-01 5.46966649e-04 -8.80056989e-03] -2025-05-16 19:36:11,328 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006892 -0.13468689 0.34448513] -2025-05-16 19:36:11,329 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.05817883e-01 7.08346363e-01 5.23041490e-04 -8.14075125e-03] -2025-05-16 19:36:11,358 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007236 -0.13468924 0.34449908] -2025-05-16 19:36:11,360 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.05917878e-01 7.08251148e-01 4.97737603e-04 -7.74682293e-03] -2025-05-16 19:36:11,389 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007403 -0.13469475 0.34449631] -2025-05-16 19:36:11,391 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.05970513e-01 7.08201115e-01 4.90507404e-04 -7.52160855e-03] -2025-05-16 19:36:11,421 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006578 -0.13473496 0.34454164] -2025-05-16 19:36:11,422 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06093390e-01 7.08085185e-01 4.74162098e-04 -6.87535790e-03] -2025-05-16 19:36:11,453 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006707 -0.13475184 0.34457691] -2025-05-16 19:36:11,455 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06181073e-01 7.08001693e-01 4.72980268e-04 -6.45531549e-03] -2025-05-16 19:36:11,487 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2500682 -0.13477535 0.34463849] -2025-05-16 19:36:11,492 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06353391e-01 7.07836059e-01 4.45180265e-04 -5.72738729e-03] -2025-05-16 19:36:11,526 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25008204 -0.13479995 0.34463174] -2025-05-16 19:36:11,538 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06528581e-01 7.07665294e-01 3.82135718e-04 -5.20103445e-03] -2025-05-16 19:36:11,566 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25009083 -0.13483332 0.3446061 ] -2025-05-16 19:36:11,569 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06651068e-01 7.07546561e-01 3.57954099e-04 -4.69089645e-03] -2025-05-16 19:36:11,597 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25010516 -0.13484718 0.3445949 ] -2025-05-16 19:36:11,598 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06728433e-01 7.07471793e-01 3.49106691e-04 -4.29674640e-03] -2025-05-16 19:36:11,624 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011702 -0.13485913 0.34459898] -2025-05-16 19:36:11,627 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06815660e-01 7.07387460e-01 3.45896563e-04 -3.80585644e-03] -2025-05-16 19:36:11,659 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011821 -0.1348993 0.34460608] -2025-05-16 19:36:11,662 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06940282e-01 7.07265773e-01 2.97282628e-04 -3.23648220e-03] -2025-05-16 19:36:11,688 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012161 -0.1349122 0.3445927 ] -2025-05-16 19:36:11,690 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07009008e-01 7.07198142e-01 2.70854114e-04 -2.99622460e-03] -2025-05-16 19:36:11,719 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012786 -0.13494844 0.34454211] -2025-05-16 19:36:11,721 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07171185e-01 -7.07038119e-01 -2.41492701e-04 2.44023883e-03] -2025-05-16 19:36:11,753 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25013682 -0.13496868 0.34451005] -2025-05-16 19:36:11,756 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07248163e-01 -7.06962180e-01 -2.30067034e-04 2.11161524e-03] -2025-05-16 19:36:11,791 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2501603 -0.13498167 0.34447388] -2025-05-16 19:36:11,793 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07359611e-01 -7.06852309e-01 -2.26176324e-04 1.46379293e-03] -2025-05-16 19:36:11,821 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2501595 -0.13501798 0.34444986] -2025-05-16 19:36:11,824 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07454781e-01 -7.06758059e-01 -1.88330680e-04 8.62896911e-04] -2025-05-16 19:36:11,856 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25015747 -0.13503044 0.34442276] -2025-05-16 19:36:11,858 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07512320e-01 -7.06700695e-01 -1.73030474e-04 6.44323853e-04] -2025-05-16 19:36:11,892 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25015361 -0.13505167 0.34437037] -2025-05-16 19:36:11,901 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07585563e-01 -7.06627597e-01 -1.81319610e-04 2.77233822e-04] -2025-05-16 19:36:11,930 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25018095 -0.13503502 0.34430954] -2025-05-16 19:36:11,933 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07719086e-01 -7.06493856e-01 -2.11409342e-04 -2.84191092e-04] -2025-05-16 19:36:11,965 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25019019 -0.13504062 0.34424158] -2025-05-16 19:36:11,969 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07882054e-01 -7.06329510e-01 -2.42963279e-04 -1.24998315e-03] -2025-05-16 19:36:12,001 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25019164 -0.13503798 0.34422963] -2025-05-16 19:36:12,003 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07905073e-01 -7.06306104e-01 -2.40538223e-04 -1.42741728e-03] -2025-05-16 19:36:12,035 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25019157 -0.13505443 0.34418253] -2025-05-16 19:36:12,037 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07954893e-01 -7.06255424e-01 -2.32860275e-04 -1.75836903e-03] -2025-05-16 19:36:12,066 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25019695 -0.13504924 0.34416311] -2025-05-16 19:36:12,081 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07985292e-01 -7.06224524e-01 -2.46747534e-04 -1.92014600e-03] -2025-05-16 19:36:12,110 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2502239 -0.13503346 0.34410207] -2025-05-16 19:36:12,114 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.08105630e-01 -7.06102121e-01 -2.77985155e-04 -2.47656469e-03] -2025-05-16 19:36:12,140 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2502329 -0.13504252 0.34403099] -2025-05-16 19:36:12,142 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.08260052e-01 -7.05943595e-01 -2.95266899e-04 -3.35447869e-03] -2025-05-16 19:36:12,176 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25022674 -0.13505496 0.34401528] -2025-05-16 19:36:12,178 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.08293561e-01 -7.05909214e-01 -2.80621336e-04 -3.51198280e-03] -2025-05-16 19:36:12,205 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2502197 -0.13506672 0.34400204] -2025-05-16 19:36:12,206 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.08306545e-01 -7.05895632e-01 -2.67000130e-04 -3.62278434e-03] -2025-05-16 19:36:12,236 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25022499 -0.13505979 0.34397261] -2025-05-16 19:36:12,237 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.08339465e-01 -7.05861639e-01 -2.81745192e-04 -3.80387884e-03] -2025-05-16 19:36:12,266 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25021974 -0.13506319 0.34394067] -2025-05-16 19:36:12,267 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.08378733e-01 -7.05820335e-01 -3.36626816e-04 -4.13652178e-03] -2025-05-16 19:36:12,302 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25022975 -0.13504186 0.34395122] -2025-05-16 19:36:12,303 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.08415099e-01 -7.05783867e-01 -3.24429638e-04 -4.13228901e-03] -2025-05-16 19:36:12,337 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25021933 -0.13506159 0.34393889] -2025-05-16 19:36:12,339 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.08417582e-01 -7.05780620e-01 -2.91837322e-04 -4.26160623e-03] -2025-05-16 19:36:12,372 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25019817 -0.13508777 0.34392648] -2025-05-16 19:36:12,374 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.08395750e-01 -7.05802163e-01 -2.84697405e-04 -4.32292738e-03] -2025-05-16 19:36:12,404 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25020165 -0.13508081 0.34387654] -2025-05-16 19:36:12,405 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.08458595e-01 -7.05736595e-01 -3.23483539e-04 -4.70881031e-03] -2025-05-16 19:36:12,439 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25019152 -0.13509924 0.34386039] -2025-05-16 19:36:12,441 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.08480916e-01 -7.05712654e-01 -3.47803405e-04 -4.93157906e-03] -2025-05-16 19:36:12,473 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25020231 -0.13507338 0.3438623 ] -2025-05-16 19:36:12,477 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.08515557e-01 -7.05677483e-01 -3.52616814e-04 -4.98707630e-03] -2025-05-16 19:36:12,507 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25017977 -0.13510416 0.3438535 ] -2025-05-16 19:36:12,511 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.08498036e-01 -7.05694218e-01 -3.17692064e-04 -5.10911789e-03] -2025-05-16 19:36:12,553 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25017599 -0.13509974 0.34383224] -2025-05-16 19:36:12,556 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.08502042e-01 -7.05689477e-01 -3.41867921e-04 -5.20591015e-03] -2025-05-16 19:36:12,590 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25017215 -0.13511672 0.34381943] -2025-05-16 19:36:12,596 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.08499130e-01 -7.05691715e-01 -3.54855067e-04 -5.29721559e-03] -2025-05-16 19:36:12,639 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25017807 -0.13509971 0.34381519] -2025-05-16 19:36:12,642 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.08544511e-01 -7.05644750e-01 -3.73427521e-04 -5.47929774e-03] -2025-05-16 19:36:12,674 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25015818 -0.13511826 0.34379954] -2025-05-16 19:36:12,680 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.08533867e-01 -7.05654332e-01 -3.60586858e-04 -5.62088049e-03] -2025-05-16 19:36:12,713 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25016003 -0.13511215 0.34379595] -2025-05-16 19:36:12,717 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.08538622e-01 -7.05649687e-01 -3.66887077e-04 -5.60397515e-03] -2025-05-16 19:36:12,748 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25016159 -0.13511603 0.34379219] -2025-05-16 19:36:12,751 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.08528416e-01 -7.05660019e-01 -3.70248763e-04 -5.59322309e-03] -2025-05-16 19:36:12,780 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25016136 -0.13512535 0.34378314] -2025-05-16 19:36:12,782 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.08514314e-01 -7.05673334e-01 -3.89165287e-04 -5.69746134e-03] -2025-05-16 19:36:12,817 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25016081 -0.13511777 0.34377561] -2025-05-16 19:36:12,820 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.08537629e-01 -7.05648855e-01 -4.04298810e-04 -5.82736421e-03] -2025-05-16 19:36:12,853 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25014334 -0.13512465 0.34377322] -2025-05-16 19:36:12,855 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.08559350e-01 -7.05626454e-01 -3.90876211e-04 -5.89931887e-03] -2025-05-16 19:36:12,886 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2501449 -0.13511996 0.34377215] -2025-05-16 19:36:12,889 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.08558695e-01 -7.05627285e-01 -3.96874843e-04 -5.87822648e-03] -2025-05-16 19:36:12,919 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25014619 -0.13512392 0.34376956] -2025-05-16 19:36:12,921 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.08543712e-01 -7.05642356e-01 -3.99471584e-04 -5.87479924e-03] -2025-05-16 19:36:12,952 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25014513 -0.13511307 0.34374501] -2025-05-16 19:36:12,955 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.08546884e-01 -7.05637697e-01 -4.56954252e-04 -6.04526320e-03] -2025-05-16 19:36:12,991 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25013505 -0.13511148 0.3437542 ] -2025-05-16 19:36:13,001 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.08569588e-01 -7.05614509e-01 -4.32469285e-04 -6.09227415e-03] -2025-05-16 19:36:13,033 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2501342 -0.13510933 0.34374835] -2025-05-16 19:36:13,040 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.08570509e-01 -7.05613851e-01 -4.41076426e-04 -6.06074984e-03] -2025-05-16 19:36:13,070 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25013123 -0.13511291 0.34374712] -2025-05-16 19:36:13,072 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.08563756e-01 -7.05620816e-01 -4.42304389e-04 -6.03926923e-03] -2025-05-16 19:36:13,104 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25013455 -0.13511038 0.3437328 ] -2025-05-16 19:36:13,105 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.08529492e-01 -7.05654590e-01 -4.71776632e-04 -6.11025783e-03] -2025-05-16 19:36:13,138 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25013199 -0.13510484 0.34371961] -2025-05-16 19:36:13,141 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.08522589e-01 -7.05661124e-01 -4.99061464e-04 -6.15392020e-03] -2025-05-16 19:36:13,175 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25013253 -0.13509931 0.34372127] -2025-05-16 19:36:13,185 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.08522172e-01 -7.05661695e-01 -5.00674746e-04 -6.13620717e-03] -2025-05-16 19:36:13,213 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012283 -0.13509549 0.34372477] -2025-05-16 19:36:13,214 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.08526822e-01 -7.05657269e-01 -5.02994147e-04 -6.10802706e-03] -2025-05-16 19:36:13,250 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012443 -0.13509857 0.34371699] -2025-05-16 19:36:13,252 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.08515180e-01 -7.05669040e-01 -5.05754292e-04 -6.09829502e-03] -2025-05-16 19:36:13,289 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011944 -0.13510168 0.34369849] -2025-05-16 19:36:13,291 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.08480214e-01 -7.05703840e-01 -5.34295995e-04 -6.13114092e-03] -2025-05-16 19:36:13,322 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012025 -0.13509994 0.34370029] -2025-05-16 19:36:13,324 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.08476806e-01 -7.05707428e-01 -5.36090982e-04 -6.11179062e-03] -2025-05-16 19:36:13,353 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011604 -0.13508912 0.34370412] -2025-05-16 19:36:13,355 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.08488013e-01 -7.05696471e-01 -5.48733764e-04 -6.07655411e-03] -2025-05-16 19:36:13,385 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011626 -0.13509088 0.3437046 ] -2025-05-16 19:36:13,386 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.08483935e-01 -7.05700741e-01 -5.48860652e-04 -6.05618712e-03] -2025-05-16 19:36:13,419 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011514 -0.13509415 0.34369684] -2025-05-16 19:36:13,421 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.08480241e-01 -7.05704617e-01 -5.50741822e-04 -6.03632611e-03] -2025-05-16 19:36:13,455 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011322 -0.13509759 0.343686 ] -2025-05-16 19:36:13,458 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.08463860e-01 -7.05721239e-01 -5.67769618e-04 -6.01407506e-03] -2025-05-16 19:36:13,489 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25010753 -0.13508864 0.34369027] -2025-05-16 19:36:13,490 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.08470858e-01 -7.05714574e-01 -5.93011909e-04 -5.96925780e-03] -2025-05-16 19:36:13,535 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25010859 -0.13508765 0.34369048] -2025-05-16 19:36:13,571 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.08468668e-01 -7.05716935e-01 -5.93663356e-04 -5.94999816e-03] -2025-05-16 19:36:13,612 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25009598 -0.13507365 0.34367452] -2025-05-16 19:36:13,655 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.08471238e-01 -7.05715162e-01 -6.71003139e-04 -5.84500330e-03] -2025-05-16 19:36:13,685 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25009663 -0.1350711 0.34367333] -2025-05-16 19:36:13,686 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.08460801e-01 -7.05725811e-01 -6.71412826e-04 -5.82434956e-03] -2025-05-16 19:36:13,722 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25009653 -0.13507019 0.34367297] -2025-05-16 19:36:13,723 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.08454160e-01 -7.05732630e-01 -6.71297885e-04 -5.80581994e-03] -2025-05-16 19:36:13,752 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25009647 -0.13507158 0.34367433] -2025-05-16 19:36:13,755 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.08445588e-01 -7.05741366e-01 -6.69836794e-04 -5.79004064e-03] -2025-05-16 19:36:13,786 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25008858 -0.13506405 0.34366832] -2025-05-16 19:36:13,788 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.08439968e-01 -7.05747417e-01 -7.03147563e-04 -5.73590036e-03] -2025-05-16 19:36:13,821 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25008027 -0.1350479 0.34365775] -2025-05-16 19:36:13,823 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70842785 -0.70576024 -0.00076658 -0.00564524] -2025-05-16 19:36:13,852 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25008352 -0.13504806 0.34365937] -2025-05-16 19:36:13,853 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70841982 -0.70576844 -0.00076487 -0.00562855] -2025-05-16 19:36:13,884 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25008643 -0.13505013 0.34366155] -2025-05-16 19:36:13,885 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70840994 -0.70577849 -0.00076073 -0.00561327] -2025-05-16 19:36:13,914 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25008576 -0.13505431 0.34366089] -2025-05-16 19:36:13,918 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70840216 -0.70578658 -0.00075688 -0.0055781 ] -2025-05-16 19:36:13,957 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007477 -0.13506644 0.34365622] -2025-05-16 19:36:13,967 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70836338 -0.70582665 -0.00076917 -0.00542828] -2025-05-16 19:36:13,996 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007384 -0.13505091 0.34364808] -2025-05-16 19:36:13,998 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70833721 -0.70585356 -0.00081907 -0.00533564] -2025-05-16 19:36:14,033 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007648 -0.1350511 0.34365169] -2025-05-16 19:36:14,035 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70832742 -0.70586347 -0.00081883 -0.00532534] -2025-05-16 19:36:14,075 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007687 -0.13505288 0.34365418] -2025-05-16 19:36:14,083 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70832172 -0.70586928 -0.00081878 -0.0053129 ] -2025-05-16 19:36:14,115 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2500735 -0.13505413 0.3436609 ] -2025-05-16 19:36:14,117 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70830631 -0.70588513 -0.00082389 -0.00526103] -2025-05-16 19:36:14,171 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007498 -0.1350489 0.34364466] -2025-05-16 19:36:14,172 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.7082449 -0.70594875 -0.000875 -0.00497518] -2025-05-16 19:36:14,202 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007452 -0.13505089 0.34364632] -2025-05-16 19:36:14,204 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70823798 -0.70595575 -0.00087101 -0.00496733] -2025-05-16 19:36:14,235 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007725 -0.13504768 0.34364806] -2025-05-16 19:36:14,238 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70823324 -0.70596058 -0.00086898 -0.00495732] -2025-05-16 19:36:14,273 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007005 -0.13505947 0.34366428] -2025-05-16 19:36:14,276 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70819131 -0.70600317 -0.00086335 -0.0048836 ] -2025-05-16 19:36:14,309 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007362 -0.13505758 0.34365994] -2025-05-16 19:36:14,312 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70818717 -0.70600793 -0.00086775 -0.00479385] -2025-05-16 19:36:14,342 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007725 -0.13504647 0.34363786] -2025-05-16 19:36:14,349 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70813593 -0.70606085 -0.00090996 -0.00455595] -2025-05-16 19:36:14,379 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007677 -0.13504918 0.34364145] -2025-05-16 19:36:14,380 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70812526 -0.70607159 -0.00090507 -0.00455135] -2025-05-16 19:36:14,409 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25008099 -0.13504188 0.34364737] -2025-05-16 19:36:14,412 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70812216 -0.70607478 -0.00090301 -0.00453819] -2025-05-16 19:36:14,446 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006761 -0.13506326 0.3436615 ] -2025-05-16 19:36:14,447 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70806323 -0.70613437 -0.00088332 -0.00446416] -2025-05-16 19:36:14,478 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006475 -0.13506621 0.34365377] -2025-05-16 19:36:14,480 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70805356 -0.70614456 -0.00089035 -0.00438362] -2025-05-16 19:36:14,510 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007676 -0.13504344 0.34362979] -2025-05-16 19:36:14,513 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70800222 -0.70619761 -0.00093547 -0.00411255] -2025-05-16 19:36:14,540 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007578 -0.13504541 0.34363604] -2025-05-16 19:36:14,543 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70797718 -0.70622285 -0.00093005 -0.00409118] -2025-05-16 19:36:14,573 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007412 -0.1350524 0.34364459] -2025-05-16 19:36:14,583 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70796504 -0.70623518 -0.00091433 -0.00406688] -2025-05-16 19:36:14,615 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006409 -0.13506254 0.343658 ] -2025-05-16 19:36:14,617 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70791616 -0.70628455 -0.00090481 -0.00400415] -2025-05-16 19:36:14,653 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006701 -0.13504512 0.34364326] -2025-05-16 19:36:14,654 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70786408 -0.70633839 -0.00095126 -0.0036917 ] -2025-05-16 19:36:14,684 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25008053 -0.1350351 0.34363572] -2025-05-16 19:36:14,686 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70785593 -0.70634674 -0.00095476 -0.00365572] -2025-05-16 19:36:14,717 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25008002 -0.13504453 0.34364319] -2025-05-16 19:36:14,720 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70783682 -0.70636599 -0.00094401 -0.00363677] -2025-05-16 19:36:14,752 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007441 -0.13505059 0.34365325] -2025-05-16 19:36:14,753 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70780468 -0.70639841 -0.00094105 -0.00359656] -2025-05-16 19:36:14,789 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006014 -0.13505188 0.34367273] -2025-05-16 19:36:14,791 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70773003 -0.70647403 -0.00094311 -0.00342915] -2025-05-16 19:36:14,821 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006843 -0.13503287 0.34366666] -2025-05-16 19:36:14,823 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.7076837 -0.70652145 -0.00097257 -0.00320633] -2025-05-16 19:36:14,854 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25008873 -0.13503217 0.34365103] -2025-05-16 19:36:14,857 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.7076699 -0.70653546 -0.0009648 -0.0031679 ] -2025-05-16 19:36:14,886 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25008946 -0.13503396 0.34365385] -2025-05-16 19:36:14,890 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.7076688 -0.70653657 -0.00096177 -0.00316509] -2025-05-16 19:36:14,919 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25008257 -0.13503302 0.34366443] -2025-05-16 19:36:14,922 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70764613 -0.7065595 -0.00096962 -0.00311105] -2025-05-16 19:36:14,962 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006521 -0.13502518 0.34368147] -2025-05-16 19:36:14,963 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70758796 -0.70661859 -0.00098399 -0.00291239] -2025-05-16 19:36:14,996 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25008008 -0.13500127 0.34366379] -2025-05-16 19:36:14,998 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70752941 -0.70667815 -0.00101982 -0.00266363] -2025-05-16 19:36:15,032 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25009219 -0.13501326 0.34366084] -2025-05-16 19:36:15,040 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70750287 -0.70670482 -0.00099917 -0.00264375] -2025-05-16 19:36:15,073 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25009107 -0.13501344 0.34366585] -2025-05-16 19:36:15,074 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70750376 -0.70670397 -0.00099926 -0.00263212] -2025-05-16 19:36:15,102 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007999 -0.13501668 0.34367059] -2025-05-16 19:36:15,104 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70749499 -0.70671289 -0.00100516 -0.00259245] -2025-05-16 19:36:15,137 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007637 -0.13498625 0.34367889] -2025-05-16 19:36:15,138 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70743472 -0.70677431 -0.00103953 -0.00226072] -2025-05-16 19:36:15,166 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007969 -0.13498395 0.3436696 ] -2025-05-16 19:36:15,167 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70741387 -0.70679542 -0.0010522 -0.00218039] -2025-05-16 19:36:15,195 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25009365 -0.13498137 0.3436583 ] -2025-05-16 19:36:15,196 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70738077 -0.70682897 -0.00105781 -0.0020352 ] -2025-05-16 19:36:15,224 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25009968 -0.13498537 0.34366053] -2025-05-16 19:36:15,225 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70735961 -0.70685025 -0.00104939 -0.00200004] -2025-05-16 19:36:15,252 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25009973 -0.13498659 0.34366382] -2025-05-16 19:36:15,253 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70734628 -0.70686367 -0.001049 -0.00197177] -2025-05-16 19:36:15,283 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25009441 -0.13495567 0.34367454] -2025-05-16 19:36:15,284 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.7073286 -0.70688189 -0.00107736 -0.00175449] -2025-05-16 19:36:15,318 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25009262 -0.1349702 0.34366661] -2025-05-16 19:36:15,320 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70729802 -0.7069126 -0.00108231 -0.00170821] -2025-05-16 19:36:15,351 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25010477 -0.13497293 0.34366035] -2025-05-16 19:36:15,352 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70726658 -0.7069443 -0.00108078 -0.00160299] -2025-05-16 19:36:15,387 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011088 -0.13497212 0.34365983] -2025-05-16 19:36:15,388 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70726098 -0.70694992 -0.00107973 -0.00159494] -2025-05-16 19:36:15,417 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25009884 -0.13498004 0.34366773] -2025-05-16 19:36:15,418 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70712714 -0.70708444 -0.00109912 -0.0012644 ] -2025-05-16 19:36:15,446 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25010611 -0.13496949 0.34366566] -2025-05-16 19:36:15,447 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70713532 -0.70707626 -0.00109531 -0.001264 ] -2025-05-16 19:36:15,484 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011042 -0.13497451 0.3436815 ] -2025-05-16 19:36:15,485 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70711018 -0.70710152 -0.00107832 -0.00121094] -2025-05-16 19:36:15,519 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012481 -0.13496164 0.34366838] -2025-05-16 19:36:15,520 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70712071 -0.70709103 -0.00108146 -0.00118521] -2025-05-16 19:36:15,553 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011074 -0.13498065 0.34367623] -2025-05-16 19:36:15,555 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70694905 0.70726311 0.00110843 0.00084395] -2025-05-16 19:36:15,586 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012049 -0.13496495 0.34367317] -2025-05-16 19:36:15,587 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70697051 0.70724167 0.0011026 0.00083918] -2025-05-16 19:36:15,615 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011727 -0.13497322 0.34367556] -2025-05-16 19:36:15,616 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70697021 0.70724199 0.00109038 0.00083678] -2025-05-16 19:36:15,650 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25013221 -0.13495657 0.34367831] -2025-05-16 19:36:15,651 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70699465 0.70721761 0.00108769 0.00079794] -2025-05-16 19:36:15,679 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25013105 -0.13495679 0.3436788 ] -2025-05-16 19:36:15,680 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70698029 0.70723203 0.00108923 0.00073841] -2025-05-16 19:36:15,710 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25013293 -0.1349701 0.34367382] -2025-05-16 19:36:15,713 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06832880e-01 7.07379597e-01 1.09712822e-03 4.26163413e-04] -2025-05-16 19:36:15,743 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2501367 -0.13496483 0.34368024] -2025-05-16 19:36:15,745 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06838980e-01 7.07373511e-01 1.08648207e-03 4.36806042e-04] -2025-05-16 19:36:15,773 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25014655 -0.1349506 0.34368219] -2025-05-16 19:36:15,775 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06868609e-01 7.07343926e-01 1.07981896e-03 4.16372441e-04] -2025-05-16 19:36:15,808 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25014684 -0.13495087 0.34368389] -2025-05-16 19:36:15,812 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06869543e-01 7.07342998e-01 1.07501174e-03 4.20054427e-04] -2025-05-16 19:36:15,843 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25014235 -0.13495637 0.34368392] -2025-05-16 19:36:15,846 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06859159e-01 7.07353412e-01 1.07640178e-03 3.47086038e-04] -2025-05-16 19:36:15,872 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25014347 -0.13495449 0.34368252] -2025-05-16 19:36:15,873 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06860985e-01 7.07351590e-01 1.07621980e-03 3.43320363e-04] -2025-05-16 19:36:15,902 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2501409 -0.13495745 0.34368526] -2025-05-16 19:36:15,905 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06858094e-01 7.07354490e-01 1.07327579e-03 3.28182864e-04] -2025-05-16 19:36:15,936 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2501607 -0.13494172 0.34369318] -2025-05-16 19:36:15,938 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06780598e-01 7.07432019e-01 1.06020632e-03 3.49800401e-05] -2025-05-16 19:36:15,972 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25015572 -0.13495426 0.3436949 ] -2025-05-16 19:36:15,974 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06769621e-01 7.07443000e-01 1.05028585e-03 3.60043124e-05] -2025-05-16 19:36:16,006 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25015393 -0.13495718 0.34369074] -2025-05-16 19:36:16,007 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06771794e-01 7.07440829e-01 1.05065367e-03 3.66549492e-05] -2025-05-16 19:36:16,038 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25015545 -0.13495698 0.34369252] -2025-05-16 19:36:16,041 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06775945e-01 7.07436685e-01 1.04879899e-03 3.90256258e-05] -2025-05-16 19:36:16,072 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25014799 -0.13495593 0.34369596] -2025-05-16 19:36:16,089 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06748857e-01 7.07463730e-01 1.05599945e-03 -8.77018543e-05] -2025-05-16 19:36:16,117 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25016181 -0.13494513 0.34369963] -2025-05-16 19:36:16,122 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06704627e-01 7.07507883e-01 1.03642888e-03 -3.02370267e-04] -2025-05-16 19:36:16,151 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25016123 -0.13495744 0.34370077] -2025-05-16 19:36:16,154 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06697379e-01 7.07515140e-01 1.02386983e-03 -3.05252505e-04] -2025-05-16 19:36:16,186 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25016052 -0.13495994 0.34369753] -2025-05-16 19:36:16,188 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06697741e-01 7.07514779e-01 1.02451212e-03 -3.00192619e-04] -2025-05-16 19:36:16,226 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25015917 -0.13496168 0.34369704] -2025-05-16 19:36:16,232 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06698861e-01 7.07513666e-01 1.02365315e-03 -2.92371535e-04] -2025-05-16 19:36:16,269 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25015312 -0.13497398 0.34369346] -2025-05-16 19:36:16,270 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06597631e-01 7.07614544e-01 1.00978677e-03 -6.51278691e-04] -2025-05-16 19:36:16,297 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25015876 -0.13497224 0.34369471] -2025-05-16 19:36:16,299 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06603913e-01 7.07608288e-01 1.00280189e-03 -6.44055190e-04] -2025-05-16 19:36:16,326 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25016036 -0.13497475 0.34369448] -2025-05-16 19:36:16,331 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06606704e-01 7.07605515e-01 9.99914776e-04 -6.33487430e-04] -2025-05-16 19:36:16,357 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25016186 -0.13497301 0.34369108] -2025-05-16 19:36:16,359 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06610271e-01 7.07601959e-01 9.99939339e-04 -6.26444941e-04] -2025-05-16 19:36:16,389 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25016038 -0.13497008 0.34369492] -2025-05-16 19:36:16,391 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06624642e-01 7.07587554e-01 9.93120279e-04 -6.94749721e-04] -2025-05-16 19:36:16,421 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25017016 -0.13495603 0.34368329] -2025-05-16 19:36:16,426 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7065981 0.7076138 0.00098409 -0.00093144] -2025-05-16 19:36:16,467 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25016052 -0.13498062 0.34368224] -2025-05-16 19:36:16,469 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.706572 0.70763987 0.00097645 -0.00093249] -2025-05-16 19:36:16,504 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25016447 -0.13498102 0.34368294] -2025-05-16 19:36:16,510 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70657642 0.70763547 0.00097163 -0.00092776] -2025-05-16 19:36:16,547 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25015934 -0.13498552 0.34368674] -2025-05-16 19:36:16,548 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70657008 0.70764181 0.00096859 -0.00092986] -2025-05-16 19:36:16,581 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25015556 -0.13497981 0.34367768] -2025-05-16 19:36:16,584 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70657709 0.70763467 0.00097476 -0.00102074] -2025-05-16 19:36:16,614 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25015989 -0.13497945 0.34366125] -2025-05-16 19:36:16,615 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70657605 0.70763544 0.0009596 -0.00120437] -2025-05-16 19:36:16,650 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25016004 -0.13499879 0.3436586 ] -2025-05-16 19:36:16,652 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70654403 0.70766744 0.00094323 -0.00119727] -2025-05-16 19:36:16,694 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25015771 -0.13500099 0.34366081] -2025-05-16 19:36:16,702 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70654228 0.70766921 0.00093998 -0.00118676] -2025-05-16 19:36:16,729 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25015172 -0.13499756 0.34366321] -2025-05-16 19:36:16,731 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7065491 0.70766236 0.000943 -0.00120989] -2025-05-16 19:36:16,766 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25014453 -0.1349968 0.34365632] -2025-05-16 19:36:16,768 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7065518 0.70765952 0.00094197 -0.00129135] -2025-05-16 19:36:16,804 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25015222 -0.1350022 0.34364226] -2025-05-16 19:36:16,806 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70654164 0.70766951 0.00092747 -0.00138421] -2025-05-16 19:36:16,833 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25015302 -0.13500556 0.34364386] -2025-05-16 19:36:16,834 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70653847 0.70767269 0.00092489 -0.00137807] -2025-05-16 19:36:16,861 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2501543 -0.13500577 0.343646 ] -2025-05-16 19:36:16,862 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70653721 0.70767397 0.0009241 -0.00137064] -2025-05-16 19:36:16,896 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25014847 -0.13500763 0.34364654] -2025-05-16 19:36:16,900 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70653415 0.707677 0.00092462 -0.00137607] -2025-05-16 19:36:16,932 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25014707 -0.13500754 0.34363154] -2025-05-16 19:36:16,933 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70653113 0.70767974 0.00090769 -0.00152501] -2025-05-16 19:36:16,986 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25014597 -0.13501513 0.34363078] -2025-05-16 19:36:16,995 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70651926 0.70769158 0.00090282 -0.00153236] -2025-05-16 19:36:17,027 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25014661 -0.13501548 0.34363333] -2025-05-16 19:36:17,034 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7065165 0.70769435 0.00090098 -0.00152937] -2025-05-16 19:36:17,062 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25013719 -0.13502802 0.34362734] -2025-05-16 19:36:17,065 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70650222 0.70770831 0.00087155 -0.00167075] -2025-05-16 19:36:17,094 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25013861 -0.13502808 0.34362621] -2025-05-16 19:36:17,096 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70650272 0.70770782 0.00087363 -0.0016698 ] -2025-05-16 19:36:17,125 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2501392 -0.13502841 0.34362744] -2025-05-16 19:36:17,127 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70650479 0.70770577 0.0008739 -0.00166194] -2025-05-16 19:36:17,167 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25014011 -0.13502828 0.34362734] -2025-05-16 19:36:17,168 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70650484 0.70770573 0.00087339 -0.00165607] -2025-05-16 19:36:17,204 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25013916 -0.1350272 0.34362733] -2025-05-16 19:36:17,205 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70650637 0.70770422 0.000873 -0.00164859] -2025-05-16 19:36:17,233 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012782 -0.13504117 0.3436272 ] -2025-05-16 19:36:17,234 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70648142 0.70772888 0.00084465 -0.00176415] -2025-05-16 19:36:17,264 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012805 -0.13504272 0.34362865] -2025-05-16 19:36:17,266 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7064811 0.70772921 0.00084228 -0.00176177] -2025-05-16 19:36:17,295 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012825 -0.13504401 0.34362766] -2025-05-16 19:36:17,296 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70648093 0.70772939 0.00084284 -0.00175582] -2025-05-16 19:36:17,326 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25013017 -0.1350417 0.34362773] -2025-05-16 19:36:17,328 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70648293 0.70772741 0.00084353 -0.00175148] -2025-05-16 19:36:17,356 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012957 -0.13504056 0.3436285 ] -2025-05-16 19:36:17,356 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70648287 0.70772748 0.00084395 -0.00174838] -2025-05-16 19:36:17,386 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2501247 -0.13504313 0.34362917] -2025-05-16 19:36:17,386 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70647131 0.70773886 0.00082175 -0.00182154] -2025-05-16 19:36:17,414 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012319 -0.13504608 0.34362782] -2025-05-16 19:36:17,415 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70647007 0.7077401 0.00082075 -0.00181854] -2025-05-16 19:36:17,448 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2501247 -0.13504785 0.34362722] -2025-05-16 19:36:17,449 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70646983 0.70774036 0.00082015 -0.00181534] -2025-05-16 19:36:17,477 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2501252 -0.13504835 0.34362684] -2025-05-16 19:36:17,481 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70647025 0.70773995 0.00082078 -0.00180938] -2025-05-16 19:36:17,511 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012511 -0.13504841 0.34362771] -2025-05-16 19:36:17,516 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70647024 0.70773998 0.00081924 -0.00180244] -2025-05-16 19:36:17,551 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012499 -0.13504737 0.34362807] -2025-05-16 19:36:17,553 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70647191 0.70773832 0.00082005 -0.00179719] -2025-05-16 19:36:17,585 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012514 -0.13504848 0.34362839] -2025-05-16 19:36:17,588 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70647274 0.70773751 0.00082022 -0.00179146] -2025-05-16 19:36:17,619 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012522 -0.13504794 0.34362859] -2025-05-16 19:36:17,620 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70647442 0.70773585 0.00081977 -0.00178541] -2025-05-16 19:36:17,651 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2501251 -0.13504747 0.34362808] -2025-05-16 19:36:17,652 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.706476 0.70773428 0.00082009 -0.0017806 ] -2025-05-16 19:36:17,682 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012454 -0.13504691 0.34362785] -2025-05-16 19:36:17,684 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70647668 0.70773362 0.00081935 -0.00177453] -2025-05-16 19:36:17,713 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012481 -0.13504629 0.3436278 ] -2025-05-16 19:36:17,714 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70647822 0.7077321 0.00081914 -0.00176961] -2025-05-16 19:36:17,743 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012455 -0.13504594 0.34362726] -2025-05-16 19:36:17,744 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70647892 0.70773141 0.00081925 -0.00176469] -2025-05-16 19:36:17,774 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2501245 -0.13504677 0.34362764] -2025-05-16 19:36:17,776 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70648046 0.70772989 0.00081905 -0.00175925] -2025-05-16 19:36:17,805 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012446 -0.13504768 0.34362642] -2025-05-16 19:36:17,806 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70648167 0.70772869 0.00082048 -0.00175474] -2025-05-16 19:36:17,836 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012437 -0.13504809 0.34362689] -2025-05-16 19:36:17,838 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7064824 0.70772798 0.00082012 -0.00174867] -2025-05-16 19:36:17,869 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012427 -0.13504783 0.34362696] -2025-05-16 19:36:17,870 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70648367 0.70772672 0.00082016 -0.00174404] -2025-05-16 19:36:17,903 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012369 -0.13504737 0.34362623] -2025-05-16 19:36:17,906 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70648474 0.70772566 0.00082056 -0.00174016] -2025-05-16 19:36:17,952 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.250124 -0.13504753 0.34362674] -2025-05-16 19:36:17,954 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70648593 0.70772449 0.00081998 -0.00173439] -2025-05-16 19:36:17,985 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012265 -0.13504725 0.3436267 ] -2025-05-16 19:36:17,987 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70648732 0.70772312 0.00081919 -0.00172936] -2025-05-16 19:36:18,022 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012229 -0.1350465 0.34362704] -2025-05-16 19:36:18,025 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70648807 0.70772238 0.00081828 -0.00172458] -2025-05-16 19:36:18,054 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012205 -0.13504614 0.34362641] -2025-05-16 19:36:18,056 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70648878 0.70772168 0.00081846 -0.00172081] -2025-05-16 19:36:18,091 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012221 -0.13504547 0.34362642] -2025-05-16 19:36:18,110 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70648988 0.70772059 0.00081811 -0.00171683] -2025-05-16 19:36:18,142 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012283 -0.13504527 0.34362647] -2025-05-16 19:36:18,143 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70649075 0.70771973 0.00081728 -0.00171318] -2025-05-16 19:36:18,177 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2501227 -0.1350448 0.34362685] -2025-05-16 19:36:18,180 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70649139 0.7077191 0.00081691 -0.00170936] -2025-05-16 19:36:18,214 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012317 -0.13504463 0.34362683] -2025-05-16 19:36:18,215 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70649242 0.70771808 0.00081633 -0.00170578] -2025-05-16 19:36:18,240 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012336 -0.13504407 0.34362649] -2025-05-16 19:36:18,241 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70649303 0.70771748 0.00081665 -0.00170255] -2025-05-16 19:36:18,268 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012326 -0.1350439 0.34362634] -2025-05-16 19:36:18,269 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70649401 0.70771651 0.0008164 -0.00169948] -2025-05-16 19:36:18,298 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012383 -0.13504343 0.3436264 ] -2025-05-16 19:36:18,300 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.706495 0.70771553 0.00081636 -0.00169596] -2025-05-16 19:36:18,331 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012363 -0.13504345 0.34362684] -2025-05-16 19:36:18,348 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70649564 0.70771491 0.00081509 -0.00169199] -2025-05-16 19:36:18,379 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012369 -0.1350435 0.34362642] -2025-05-16 19:36:18,380 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70649637 0.70771418 0.00081544 -0.0016898 ] -2025-05-16 19:36:18,414 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012454 -0.13504274 0.34362707] -2025-05-16 19:36:18,417 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70649712 0.70771344 0.00081516 -0.00168572] -2025-05-16 19:36:18,451 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012288 -0.13504307 0.34362694] -2025-05-16 19:36:18,453 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70649781 0.70771276 0.00081374 -0.00168228] -2025-05-16 19:36:18,484 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012191 -0.13504268 0.34362681] -2025-05-16 19:36:18,485 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70649884 0.70771174 0.00081311 -0.00167894] -2025-05-16 19:36:18,517 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012213 -0.1350429 0.34362725] -2025-05-16 19:36:18,518 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70649975 0.70771084 0.00081232 -0.00167615] -2025-05-16 19:36:18,552 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012254 -0.13504267 0.3436268 ] -2025-05-16 19:36:18,555 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70650014 0.70771046 0.00081248 -0.0016734 ] -2025-05-16 19:36:18,587 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012266 -0.13504231 0.34362635] -2025-05-16 19:36:18,589 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70650111 0.7077095 0.00081246 -0.00167091] -2025-05-16 19:36:18,620 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012348 -0.13504199 0.34362737] -2025-05-16 19:36:18,621 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70650173 0.70770889 0.00081165 -0.00166703] -2025-05-16 19:36:18,651 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2501231 -0.135042 0.34362664] -2025-05-16 19:36:18,653 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70650231 0.70770831 0.00081274 -0.00166546] -2025-05-16 19:36:18,685 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2501234 -0.13504191 0.34362715] -2025-05-16 19:36:18,686 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70650256 0.70770807 0.00081215 -0.00166226] -2025-05-16 19:36:18,713 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012385 -0.13504134 0.34362731] -2025-05-16 19:36:18,725 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70650385 0.70770679 0.00081184 -0.00165941] -2025-05-16 19:36:18,753 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012415 -0.13504148 0.34362742] -2025-05-16 19:36:18,755 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70650412 0.70770652 0.00081182 -0.00165756] -2025-05-16 19:36:18,782 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2501242 -0.1350415 0.34362666] -2025-05-16 19:36:18,784 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70650487 0.70770578 0.00081242 -0.00165605] -2025-05-16 19:36:18,814 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012441 -0.13504093 0.3436275 ] -2025-05-16 19:36:18,816 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70650567 0.70770499 0.00081168 -0.00165291] -2025-05-16 19:36:18,852 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012419 -0.13504119 0.34362694] -2025-05-16 19:36:18,856 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70650655 0.70770411 0.00081165 -0.00165154] -2025-05-16 19:36:18,890 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012456 -0.1350411 0.34362733] -2025-05-16 19:36:18,898 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70650641 0.70770426 0.00081174 -0.00164897] -2025-05-16 19:36:18,926 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012484 -0.13504087 0.34362753] -2025-05-16 19:36:18,932 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70650768 0.70770299 0.00081121 -0.0016465 ] -2025-05-16 19:36:18,964 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012429 -0.135041 0.34362685] -2025-05-16 19:36:18,967 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70650805 0.70770263 0.0008118 -0.0016452 ] -2025-05-16 19:36:19,000 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012485 -0.13504043 0.34362733] -2025-05-16 19:36:19,002 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70650963 0.70770105 0.00081144 -0.00164265] -2025-05-16 19:36:19,033 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012479 -0.13504081 0.34362721] -2025-05-16 19:36:19,035 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70651083 0.70769987 0.00081115 -0.00164122] -2025-05-16 19:36:19,070 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012451 -0.13504081 0.3436268 ] -2025-05-16 19:36:19,072 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70651205 0.70769865 0.00081148 -0.00163977] -2025-05-16 19:36:19,103 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012396 -0.13504048 0.34362705] -2025-05-16 19:36:19,105 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7065127 0.707698 0.00081114 -0.00163735] -2025-05-16 19:36:19,133 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012464 -0.13504027 0.34362752] -2025-05-16 19:36:19,136 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70651404 0.70769667 0.00081091 -0.00163542] -2025-05-16 19:36:19,170 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012451 -0.13504005 0.34362754] -2025-05-16 19:36:19,178 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70651523 0.70769549 0.00081069 -0.00163354] -2025-05-16 19:36:19,214 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012481 -0.13504007 0.34362759] -2025-05-16 19:36:19,217 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70651602 0.7076947 0.00081085 -0.00163206] -2025-05-16 19:36:19,253 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012419 -0.13503986 0.34362655] -2025-05-16 19:36:19,256 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70651661 0.70769411 0.00081201 -0.00163095] -2025-05-16 19:36:19,285 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012435 -0.13503999 0.34362657] -2025-05-16 19:36:19,287 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70651672 0.70769401 0.0008118 -0.00162917] -2025-05-16 19:36:19,319 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012421 -0.13503966 0.34362641] -2025-05-16 19:36:19,320 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70651819 0.70769255 0.00081212 -0.00162822] -2025-05-16 19:36:19,351 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012473 -0.13503979 0.3436276 ] -2025-05-16 19:36:19,353 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70651842 0.70769232 0.00081065 -0.00162553] -2025-05-16 19:36:19,389 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012478 -0.13503911 0.34362676] -2025-05-16 19:36:19,395 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70651985 0.70769089 0.00081185 -0.0016249 ] -2025-05-16 19:36:19,425 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012463 -0.13503937 0.34362762] -2025-05-16 19:36:19,430 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70652025 0.7076905 0.00081047 -0.00162239] -2025-05-16 19:36:19,461 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012467 -0.13503974 0.3436269 ] -2025-05-16 19:36:19,472 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70652012 0.70769064 0.00081151 -0.00162201] -2025-05-16 19:36:19,506 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012503 -0.13503915 0.34362668] -2025-05-16 19:36:19,511 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70652148 0.70768928 0.00081188 -0.001621 ] -2025-05-16 19:36:19,542 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012469 -0.13503917 0.34362681] -2025-05-16 19:36:19,546 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70652203 0.70768873 0.00081151 -0.00161927] -2025-05-16 19:36:19,575 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012482 -0.13503896 0.34362762] -2025-05-16 19:36:19,579 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70652238 0.70768838 0.00081103 -0.00161713] -2025-05-16 19:36:19,612 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012481 -0.13503886 0.34362713] -2025-05-16 19:36:19,614 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70652291 0.70768786 0.00081124 -0.00161638] -2025-05-16 19:36:19,644 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012448 -0.13503887 0.3436271 ] -2025-05-16 19:36:19,647 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70652358 0.7076872 0.00081109 -0.00161529] -2025-05-16 19:36:19,679 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012461 -0.13503866 0.34362716] -2025-05-16 19:36:19,680 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7065239 0.70768687 0.00081109 -0.0016137 ] -2025-05-16 19:36:19,719 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2501241 -0.13503866 0.34362709] -2025-05-16 19:36:19,723 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70652403 0.70768675 0.00081143 -0.00161349] -2025-05-16 19:36:19,755 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012484 -0.13503856 0.34362759] -2025-05-16 19:36:19,756 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70652486 0.70768593 0.00081059 -0.0016111 ] -2025-05-16 19:36:19,786 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012452 -0.13503869 0.3436264 ] -2025-05-16 19:36:19,787 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70652549 0.7076853 0.0008115 -0.00161151] -2025-05-16 19:36:19,820 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012466 -0.1350387 0.34362739] -2025-05-16 19:36:19,822 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70652559 0.7076852 0.0008105 -0.00160935] -2025-05-16 19:36:19,855 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2501246 -0.13503871 0.34362734] -2025-05-16 19:36:19,856 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70652598 0.70768481 0.00081017 -0.00160822] -2025-05-16 19:36:19,889 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012453 -0.13503883 0.34362704] -2025-05-16 19:36:19,893 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70652624 0.70768455 0.00081061 -0.00160788] -2025-05-16 19:36:19,932 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012458 -0.13503883 0.34362692] -2025-05-16 19:36:19,934 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70652636 0.70768444 0.00081057 -0.00160708] -2025-05-16 19:36:19,962 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2501247 -0.13503883 0.34362714] -2025-05-16 19:36:19,964 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70652695 0.70768385 0.00081035 -0.00160612] -2025-05-16 19:36:19,997 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012453 -0.13503871 0.3436269 ] -2025-05-16 19:36:19,999 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70652753 0.70768327 0.0008104 -0.0016051 ] -2025-05-16 19:36:20,031 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012434 -0.13503837 0.34362714] -2025-05-16 19:36:20,037 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70652835 0.70768246 0.00081009 -0.00160409] -2025-05-16 19:36:20,066 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012426 -0.13503872 0.3436269 ] -2025-05-16 19:36:20,068 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70652828 0.70768253 0.00081026 -0.00160357] -2025-05-16 19:36:20,101 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2501244 -0.13503872 0.34362741] -2025-05-16 19:36:20,110 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70652863 0.70768219 0.00080949 -0.00160213] -2025-05-16 19:36:20,140 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012439 -0.1350385 0.34362678] -2025-05-16 19:36:20,147 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70652911 0.7076817 0.00081039 -0.00160204] -2025-05-16 19:36:20,178 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012431 -0.13503827 0.34362732] -2025-05-16 19:36:20,181 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70652949 0.70768133 0.00080977 -0.00160011] -2025-05-16 19:36:20,210 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012462 -0.1350384 0.34362705] -2025-05-16 19:36:20,211 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7065295 0.70768132 0.00081006 -0.00160012] -2025-05-16 19:36:20,239 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012473 -0.13503816 0.3436269 ] -2025-05-16 19:36:20,251 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70653008 0.70768074 0.00080995 -0.00159942] -2025-05-16 19:36:20,283 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012434 -0.13503795 0.3436267 ] -2025-05-16 19:36:20,284 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70653042 0.7076804 0.00081047 -0.00159867] -2025-05-16 19:36:20,314 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012451 -0.13503808 0.34362683] -2025-05-16 19:36:20,317 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70653048 0.70768034 0.00081009 -0.00159772] -2025-05-16 19:36:20,346 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012409 -0.13503821 0.34362693] -2025-05-16 19:36:20,348 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70653049 0.70768034 0.00080999 -0.00159707] -2025-05-16 19:36:20,382 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012455 -0.1350381 0.34362702] -2025-05-16 19:36:20,384 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7065305 0.70768033 0.00080988 -0.00159607] -2025-05-16 19:36:20,410 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012436 -0.13503856 0.34362685] -2025-05-16 19:36:20,412 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70653069 0.70768014 0.00080973 -0.00159607] -2025-05-16 19:36:20,441 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2501245 -0.13503809 0.34362729] -2025-05-16 19:36:20,449 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70653139 0.70767944 0.00080951 -0.00159466] -2025-05-16 19:36:20,484 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012449 -0.13503833 0.34362717] -2025-05-16 19:36:20,485 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70653143 0.70767941 0.00080944 -0.00159442] -2025-05-16 19:36:20,513 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012445 -0.13503821 0.34362728] -2025-05-16 19:36:20,514 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70653142 0.70767942 0.00080934 -0.00159349] -2025-05-16 19:36:20,542 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012457 -0.13503821 0.34362734] -2025-05-16 19:36:20,544 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70653159 0.70767925 0.00080911 -0.0015927 ] -2025-05-16 19:36:20,573 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012596 -0.13503652 0.34362685] -2025-05-16 19:36:20,576 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70653219 0.70767865 0.00081072 -0.00159278] -2025-05-16 19:36:20,607 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012789 -0.13503442 0.34362638] -2025-05-16 19:36:20,609 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70653257 0.70767826 0.0008121 -0.0015928 ] -2025-05-16 19:36:20,638 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012841 -0.13503328 0.34362558] -2025-05-16 19:36:20,640 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70653241 0.70767843 0.00081212 -0.00159137] -2025-05-16 19:36:20,670 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012858 -0.1350326 0.34362475] -2025-05-16 19:36:20,673 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70653242 0.70767842 0.00081368 -0.00159056] -2025-05-16 19:36:20,704 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012772 -0.13503474 0.34362474] -2025-05-16 19:36:20,705 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70653217 0.70767867 0.00081472 -0.00158868] -2025-05-16 19:36:20,734 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012726 -0.1350357 0.34362551] -2025-05-16 19:36:20,736 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70653279 0.70767806 0.00081451 -0.00158632] -2025-05-16 19:36:20,771 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012721 -0.13503645 0.34362645] -2025-05-16 19:36:20,773 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70653273 0.70767813 0.00081419 -0.0015848 ] -2025-05-16 19:36:20,802 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012625 -0.13503679 0.3436256 ] -2025-05-16 19:36:20,805 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70653286 0.70767799 0.00081587 -0.00158519] -2025-05-16 19:36:20,836 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012432 -0.13503612 0.34362743] -2025-05-16 19:36:20,838 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70653296 0.7076779 0.00081427 -0.00158445] -2025-05-16 19:36:20,870 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012179 -0.13503313 0.34363167] -2025-05-16 19:36:20,872 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70653291 0.70767795 0.00081358 -0.00158414] -2025-05-16 19:36:20,903 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011983 -0.13503032 0.34364037] -2025-05-16 19:36:20,904 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7065332 0.70767766 0.0008116 -0.00158394] -2025-05-16 19:36:20,933 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011805 -0.13502487 0.34365082] -2025-05-16 19:36:20,935 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70653303 0.70767783 0.00081096 -0.00158376] -2025-05-16 19:36:20,972 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011113 -0.1350126 0.34368312] -2025-05-16 19:36:20,975 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70653316 0.7076777 0.00081054 -0.00158303] -2025-05-16 19:36:21,017 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25010032 -0.13498924 0.34371667] -2025-05-16 19:36:21,019 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70660225 0.70760909 0.00079288 -0.00141929] -2025-05-16 19:36:21,054 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007464 -0.13494621 0.34372586] -2025-05-16 19:36:21,056 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70660668 0.70760468 0.00080746 -0.001402 ] -2025-05-16 19:36:21,089 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25003553 -0.13489336 0.34373696] -2025-05-16 19:36:21,090 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70660939 0.707602 0.00080816 -0.00138798] -2025-05-16 19:36:21,118 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24997528 -0.13479969 0.34374601] -2025-05-16 19:36:21,119 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70662331 0.70758812 0.00080596 -0.00138004] -2025-05-16 19:36:21,148 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24991572 -0.13473939 0.34377721] -2025-05-16 19:36:21,150 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70662612 0.70758538 0.00077059 -0.00135993] -2025-05-16 19:36:21,186 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2498377 -0.13468733 0.34385107] -2025-05-16 19:36:21,203 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06640518e-01 7.07571287e-01 6.98821743e-04 -1.25059187e-03] -2025-05-16 19:36:21,231 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2497274 -0.13461479 0.34392146] -2025-05-16 19:36:21,233 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06663605e-01 7.07548495e-01 6.54741044e-04 -1.11705734e-03] -2025-05-16 19:36:21,262 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24956371 -0.13448957 0.34401762] -2025-05-16 19:36:21,264 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06775872e-01 7.07436548e-01 5.92285001e-04 -1.02307343e-03] -2025-05-16 19:36:21,296 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24938469 -0.13434365 0.34412065] -2025-05-16 19:36:21,298 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06817655e-01 7.07394972e-01 5.15100063e-04 -9.43360291e-04] -2025-05-16 19:36:21,328 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24923586 -0.13428974 0.34422758] -2025-05-16 19:36:21,329 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06811707e-01 7.07401068e-01 4.23857890e-04 -8.71484959e-04] -2025-05-16 19:36:21,358 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24900827 -0.13421284 0.34440824] -2025-05-16 19:36:21,360 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06811180e-01 7.07401863e-01 2.54459644e-04 -7.04177982e-04] -2025-05-16 19:36:21,389 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2488474 -0.13417727 0.34454472] -2025-05-16 19:36:21,401 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06817920e-01 7.07395276e-01 1.28726817e-04 -5.79143080e-04] -2025-05-16 19:36:21,433 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24847887 -0.13395694 0.34481938] -2025-05-16 19:36:21,435 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06924657e-01 7.07288795e-01 -6.42656020e-05 -2.93431413e-04] -2025-05-16 19:36:21,471 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2480785 -0.13378107 0.34512246] -2025-05-16 19:36:21,476 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06957028e-01 7.07256432e-01 -3.12098115e-04 -4.91559041e-05] -2025-05-16 19:36:21,507 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24770432 -0.13366253 0.34542659] -2025-05-16 19:36:21,514 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06949890e-01 7.07263360e-01 -5.89687635e-04 2.11807177e-04] -2025-05-16 19:36:21,542 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24755389 -0.13364012 0.34556515] -2025-05-16 19:36:21,543 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06929153e-01 7.07283895e-01 -7.38367730e-04 3.45924661e-04] -2025-05-16 19:36:21,584 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24680872 -0.13337534 0.34615391] -2025-05-16 19:36:21,586 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70701308 0.70719876 -0.0012816 0.0008822 ] -2025-05-16 19:36:21,615 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24659309 -0.13329152 0.34633384] -2025-05-16 19:36:21,617 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70701787 0.70719327 -0.00149602 0.00108318] -2025-05-16 19:36:21,646 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24613948 -0.13311274 0.34668586] -2025-05-16 19:36:21,648 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70703798 0.70717159 -0.00188164 0.00144971] -2025-05-16 19:36:21,684 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24597534 -0.13305709 0.34681449] -2025-05-16 19:36:21,685 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70701401 0.70719452 -0.00209803 0.00164094] -2025-05-16 19:36:21,717 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24552116 -0.13291028 0.34714965] -2025-05-16 19:36:21,719 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7069906 0.70721552 -0.00252337 0.00203462] -2025-05-16 19:36:21,754 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24487829 -0.1326781 0.34763211] -2025-05-16 19:36:21,756 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70697504 0.70722563 -0.00327594 0.00273381] -2025-05-16 19:36:21,786 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24490874 -0.13268262 0.34757175] -2025-05-16 19:36:21,788 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7069433 0.70725729 -0.00330342 0.00271658] -2025-05-16 19:36:21,818 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24484373 -0.13265145 0.34752709] -2025-05-16 19:36:21,819 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70690497 0.70729469 -0.00343197 0.00279281] -2025-05-16 19:36:21,853 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24451337 -0.13250879 0.34779345] -2025-05-16 19:36:21,855 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70686309 0.7073318 -0.00395641 0.0032631 ] -2025-05-16 19:36:21,884 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24406845 -0.13232263 0.34806993] -2025-05-16 19:36:21,886 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7068415 0.7073478 -0.0045022 0.00373035] -2025-05-16 19:36:21,914 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24347396 -0.13209475 0.34848551] -2025-05-16 19:36:21,915 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70677221 0.70740662 -0.00537785 0.00447137] -2025-05-16 19:36:21,946 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24329106 -0.13201481 0.34856744] -2025-05-16 19:36:21,952 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70670152 0.7074724 -0.00577663 0.00473208] -2025-05-16 19:36:21,986 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2430477 -0.13193785 0.34859195] -2025-05-16 19:36:21,988 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70663854 0.70753015 -0.0061822 0.00498377] -2025-05-16 19:36:22,025 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24284269 -0.13185657 0.34869469] -2025-05-16 19:36:22,027 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7066222 0.70754031 -0.00661006 0.00530014] -2025-05-16 19:36:22,055 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24221414 -0.13156878 0.34906111] -2025-05-16 19:36:22,057 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70656478 0.70758042 -0.00764947 0.00613519] -2025-05-16 19:36:22,095 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24165714 -0.13127029 0.34935911] -2025-05-16 19:36:22,097 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70645535 0.70767051 -0.00868161 0.00692209] -2025-05-16 19:36:22,140 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24124106 -0.1312186 0.3494403 ] -2025-05-16 19:36:22,144 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70633741 0.70777425 -0.00943123 0.00735669] -2025-05-16 19:36:22,202 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24091691 -0.13112804 0.34944288] -2025-05-16 19:36:22,204 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70628104 0.7078152 -0.01020781 0.00778055] -2025-05-16 19:36:22,237 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24005815 -0.13066864 0.34983439] -2025-05-16 19:36:22,248 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70616106 0.7078888 -0.01209004 0.00915621] -2025-05-16 19:36:22,282 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.23965829 -0.13051609 0.34994329] -2025-05-16 19:36:22,283 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70599163 0.70803165 -0.01306916 0.00980792] -2025-05-16 19:36:22,314 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.23952731 -0.13051227 0.34990954] -2025-05-16 19:36:22,316 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70592452 0.70808804 -0.01348455 0.0100031 ] -2025-05-16 19:36:22,345 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.23934161 -0.13055116 0.3497908 ] -2025-05-16 19:36:22,346 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70586911 0.70812774 -0.01411409 0.01023214] -2025-05-16 19:36:22,373 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.23882403 -0.13031196 0.34988578] -2025-05-16 19:36:22,374 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70581833 0.70813581 -0.0154816 0.01115726] -2025-05-16 19:36:22,403 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.23850149 -0.13013196 0.34997224] -2025-05-16 19:36:22,414 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70570884 0.70820909 -0.0165236 0.01191212] -2025-05-16 19:36:22,447 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.23838505 -0.13005017 0.34998869] -2025-05-16 19:36:22,449 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70561243 0.70828267 -0.01716123 0.01233949] -2025-05-16 19:36:22,482 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.23803964 -0.12997697 0.34991559] -2025-05-16 19:36:22,489 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70540516 0.70844144 -0.01850853 0.01310418] -2025-05-16 19:36:22,518 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.23772202 -0.12991194 0.34980596] -2025-05-16 19:36:22,519 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70534992 0.7084419 -0.0199532 0.01390811] -2025-05-16 19:36:22,545 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.23771363 -0.12990441 0.3497683 ] -2025-05-16 19:36:22,546 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70531612 0.70845565 -0.02043773 0.01421452] -2025-05-16 19:36:22,575 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.23760381 -0.12976366 0.3497477 ] -2025-05-16 19:36:22,579 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70520386 0.70851492 -0.02162293 0.01505246] -2025-05-16 19:36:22,606 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.23761939 -0.12977804 0.34964174] -2025-05-16 19:36:22,608 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70503905 0.7086309 -0.02272934 0.01567013] -2025-05-16 19:36:22,638 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.23770294 -0.12981576 0.34954698] -2025-05-16 19:36:22,669 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70497077 0.7086719 -0.02334612 0.01597815] -2025-05-16 19:36:22,700 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.23775348 -0.12991432 0.34939312] -2025-05-16 19:36:22,701 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70487357 0.70870811 -0.02466939 0.01665801] -2025-05-16 19:36:22,730 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.23798947 -0.12994164 0.34914375] -2025-05-16 19:36:22,732 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7047758 0.70875273 -0.02574228 0.01726216] -2025-05-16 19:36:22,760 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.23823156 -0.13003195 0.34909657] -2025-05-16 19:36:22,761 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70462974 0.70882829 -0.02707623 0.01806275] -2025-05-16 19:36:22,790 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.23851646 -0.1301149 0.34899855] -2025-05-16 19:36:22,791 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70459206 0.7088538 -0.02731376 0.01817381] -2025-05-16 19:36:22,817 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.23874437 -0.13020341 0.34890821] -2025-05-16 19:36:22,818 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70456154 0.70887996 -0.0274129 0.01818724] -2025-05-16 19:36:22,845 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.23902535 -0.13035369 0.34876074] -2025-05-16 19:36:22,850 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70449657 0.70891065 -0.02808672 0.01847702] -2025-05-16 19:36:22,880 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.23944089 -0.13051939 0.34848549] -2025-05-16 19:36:22,883 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7044161 0.70893104 -0.02922556 0.01898968] -2025-05-16 19:36:22,914 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2400115 -0.13071509 0.34826816] -2025-05-16 19:36:22,916 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70428328 0.70898524 -0.0305991 0.01971512] -2025-05-16 19:36:22,948 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2405729 -0.13086132 0.3481274 ] -2025-05-16 19:36:22,955 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70418173 0.70906092 -0.03102561 0.0199529 ] -2025-05-16 19:36:22,986 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24103708 -0.13106793 0.34794255] -2025-05-16 19:36:22,987 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70399471 0.70923787 -0.03121133 0.0199737 ] -2025-05-16 19:36:23,018 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24122744 -0.13115017 0.3478571 ] -2025-05-16 19:36:23,021 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7039832 0.70924244 -0.03135397 0.01999383] -2025-05-16 19:36:23,052 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24202089 -0.13141314 0.34749471] -2025-05-16 19:36:23,055 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70392241 0.70922448 -0.03269001 0.02062135] -2025-05-16 19:36:23,082 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24227837 -0.13148924 0.34740346] -2025-05-16 19:36:23,085 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70388846 0.70923822 -0.033016 0.02078767] -2025-05-16 19:36:23,114 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24303303 -0.1317221 0.34716723] -2025-05-16 19:36:23,116 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70373244 0.70936044 -0.03354875 0.02104489] -2025-05-16 19:36:23,145 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24332617 -0.13184184 0.34704023] -2025-05-16 19:36:23,148 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70364766 0.70945005 -0.0334917 0.02094995] -2025-05-16 19:36:23,178 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24372403 -0.13198493 0.34687628] -2025-05-16 19:36:23,184 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70360415 0.70948781 -0.03361511 0.02093474] -2025-05-16 19:36:23,217 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2443893 -0.13217474 0.3465924 ] -2025-05-16 19:36:23,218 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70359085 0.70946024 -0.03429474 0.0212122 ] -2025-05-16 19:36:23,253 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24472758 -0.13226931 0.34646813] -2025-05-16 19:36:23,255 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70356705 0.70946672 -0.03457058 0.0213368 ] -2025-05-16 19:36:23,287 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24539301 -0.13248394 0.3462303 ] -2025-05-16 19:36:23,288 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70344032 0.70957923 -0.03480639 0.02139055] -2025-05-16 19:36:23,326 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24568933 -0.13260175 0.3460707 ] -2025-05-16 19:36:23,338 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70337962 0.70965453 -0.03462171 0.02118723] -2025-05-16 19:36:23,370 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24614652 -0.13273775 0.34590219] -2025-05-16 19:36:23,387 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70336924 0.70966479 -0.0346683 0.02111186] -2025-05-16 19:36:23,415 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24706538 -0.13300383 0.34555315] -2025-05-16 19:36:23,418 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70334218 0.70966597 -0.03512802 0.02121362] -2025-05-16 19:36:23,450 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24719646 -0.13305084 0.34550444] -2025-05-16 19:36:23,452 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70332221 0.70969147 -0.03506207 0.02113149] -2025-05-16 19:36:23,482 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2474123 -0.13315628 0.34535007] -2025-05-16 19:36:23,483 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70327434 0.70976101 -0.03478476 0.02084544] -2025-05-16 19:36:23,515 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24759983 -0.13324529 0.34524901] -2025-05-16 19:36:23,516 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70326125 0.70979944 -0.03445557 0.02052283] -2025-05-16 19:36:23,546 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24791971 -0.13332342 0.34512155] -2025-05-16 19:36:23,547 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70327139 0.70979941 -0.03432227 0.0203991 ] -2025-05-16 19:36:23,577 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24849881 -0.1334859 0.34493051] -2025-05-16 19:36:23,589 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70328756 0.70978427 -0.03435891 0.0203066 ] -2025-05-16 19:36:23,624 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24879359 -0.13359316 0.3447741 ] -2025-05-16 19:36:23,627 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70333022 0.7097617 -0.03411931 0.02001992] -2025-05-16 19:36:23,659 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24897499 -0.1337146 0.3446677 ] -2025-05-16 19:36:23,661 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70332196 0.70980706 -0.0336324 0.01951969] -2025-05-16 19:36:23,697 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24920906 -0.13384193 0.34453252] -2025-05-16 19:36:23,707 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70334727 0.70982117 -0.03310757 0.01898447] -2025-05-16 19:36:23,737 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24935771 -0.13388608 0.34448168] -2025-05-16 19:36:23,738 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70337161 0.70981027 -0.03291809 0.01881909] -2025-05-16 19:36:23,765 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24974488 -0.13399908 0.3443381 ] -2025-05-16 19:36:23,767 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70342934 0.70977709 -0.03258754 0.0184851 ] -2025-05-16 19:36:23,795 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24991041 -0.1340828 0.34427526] -2025-05-16 19:36:23,796 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70344851 0.7097847 -0.03221244 0.01811708] -2025-05-16 19:36:23,827 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.24995832 -0.1341138 0.34425588] -2025-05-16 19:36:23,832 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70346782 0.70978406 -0.03194013 0.01787261] -2025-05-16 19:36:23,863 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012836 -0.13423341 0.34413675] -2025-05-16 19:36:23,864 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70351855 0.70979165 -0.03106524 0.01710012] -2025-05-16 19:36:23,892 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25025515 -0.13428043 0.34408088] -2025-05-16 19:36:23,893 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7035704 0.70976622 -0.03065961 0.01675118] -2025-05-16 19:36:23,927 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25039033 -0.13432776 0.34403611] -2025-05-16 19:36:23,931 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70360394 0.70975441 -0.03031291 0.01647112] -2025-05-16 19:36:23,958 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25057876 -0.13438937 0.34397216] -2025-05-16 19:36:23,959 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70365322 0.70973877 -0.02976294 0.0160371 ] -2025-05-16 19:36:23,989 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25065088 -0.13442855 0.34394875] -2025-05-16 19:36:23,990 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70369953 0.70972465 -0.02922724 0.0156094 ] -2025-05-16 19:36:24,038 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25075674 -0.13452578 0.34387798] -2025-05-16 19:36:24,040 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70377403 0.70970973 -0.0282219 0.01475602] -2025-05-16 19:36:24,070 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25080874 -0.13456282 0.3438484 ] -2025-05-16 19:36:24,071 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70384983 0.70966443 -0.02768985 0.01432067] -2025-05-16 19:36:24,103 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25097413 -0.13462131 0.34380931] -2025-05-16 19:36:24,104 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70393119 0.70963011 -0.0268173 0.01366782] -2025-05-16 19:36:24,140 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25105094 -0.1346572 0.34378815] -2025-05-16 19:36:24,141 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70399066 0.70960056 -0.02625174 0.01322999] -2025-05-16 19:36:24,169 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25107536 -0.13467454 0.34378355] -2025-05-16 19:36:24,170 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70404098 0.70957917 -0.02568155 0.01281262] -2025-05-16 19:36:24,198 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25109633 -0.13471626 0.34376702] -2025-05-16 19:36:24,206 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70408922 0.70956288 -0.02504593 0.01231214] -2025-05-16 19:36:24,235 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2511243 -0.13474041 0.3437141 ] -2025-05-16 19:36:24,237 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70418369 0.70950864 -0.02421717 0.01167696] -2025-05-16 19:36:24,267 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25125624 -0.13480806 0.34369386] -2025-05-16 19:36:24,271 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70430471 0.70944645 -0.02292665 0.01072323] -2025-05-16 19:36:24,298 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25128262 -0.13480888 0.34368539] -2025-05-16 19:36:24,301 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70434797 0.70942063 -0.02252085 0.01044602] -2025-05-16 19:36:24,330 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25131233 -0.13484022 0.34370165] -2025-05-16 19:36:24,331 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70440048 0.70940068 -0.02174175 0.00989607] -2025-05-16 19:36:24,362 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25132395 -0.1348408 0.34369902] -2025-05-16 19:36:24,365 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70445068 0.70937191 -0.02121457 0.00952212] -2025-05-16 19:36:24,400 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25134905 -0.13487665 0.34367032] -2025-05-16 19:36:24,402 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70454291 0.70932533 -0.02004593 0.0086623 ] -2025-05-16 19:36:24,431 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25143138 -0.13491804 0.34364209] -2025-05-16 19:36:24,433 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7047073 0.70921165 -0.01865458 0.00764608] -2025-05-16 19:36:24,466 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25144603 -0.13491565 0.34364454] -2025-05-16 19:36:24,468 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7047753 0.70916424 -0.01804096 0.0072366 ] -2025-05-16 19:36:24,506 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25146489 -0.13492362 0.34367958] -2025-05-16 19:36:24,508 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70484493 0.70912164 -0.01719332 0.00667203] -2025-05-16 19:36:24,538 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25145842 -0.1349348 0.34367311] -2025-05-16 19:36:24,539 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70490661 0.70909199 -0.01612539 0.00593173] -2025-05-16 19:36:24,572 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25147603 -0.13494592 0.34367406] -2025-05-16 19:36:24,574 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70497521 0.70904466 -0.01537528 0.00540601] -2025-05-16 19:36:24,602 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2515135 -0.13496308 0.34363896] -2025-05-16 19:36:24,615 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70511713 0.70893598 -0.01411459 0.00451534] -2025-05-16 19:36:24,646 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25153283 -0.13496785 0.34368039] -2025-05-16 19:36:24,648 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70523096 0.70885041 -0.01290866 0.00370805] -2025-05-16 19:36:24,679 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25152174 -0.13496861 0.34369222] -2025-05-16 19:36:24,681 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70527058 0.70882519 -0.01222793 0.00327772] -2025-05-16 19:36:24,709 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25149651 -0.13495304 0.3437098 ] -2025-05-16 19:36:24,711 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7053499 0.70876693 -0.01114329 0.0026046 ] -2025-05-16 19:36:24,743 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25149532 -0.13494363 0.34371972] -2025-05-16 19:36:24,746 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70542819 0.70869986 -0.01051964 0.00221595] -2025-05-16 19:36:24,774 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25151666 -0.13493728 0.34370586] -2025-05-16 19:36:24,780 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70557293 0.70857634 -0.00919738 0.00134699] -2025-05-16 19:36:24,812 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25151208 -0.13493179 0.34369193] -2025-05-16 19:36:24,819 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7056362 0.70852274 -0.00849921 0.00091695] -2025-05-16 19:36:24,851 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25149023 -0.13491971 0.34373374] -2025-05-16 19:36:24,853 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.05727241e-01 7.08446950e-01 -7.20812096e-03 1.53697146e-04] -2025-05-16 19:36:24,891 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25144967 -0.13489719 0.34376132] -2025-05-16 19:36:24,902 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.05804346e-01 7.08380730e-01 -6.05822294e-03 -5.14845473e-04] -2025-05-16 19:36:24,935 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25143454 -0.13489176 0.34375744] -2025-05-16 19:36:24,937 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70591683 0.70827706 -0.00483676 -0.0012789 ] -2025-05-16 19:36:24,974 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25143782 -0.13487594 0.34373615] -2025-05-16 19:36:24,984 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70603046 0.70816846 -0.00385333 -0.00188967] -2025-05-16 19:36:25,017 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25143415 -0.1348973 0.34376683] -2025-05-16 19:36:25,019 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70607696 0.70812431 -0.00315961 -0.00230293] -2025-05-16 19:36:25,050 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25138328 -0.13490227 0.34381538] -2025-05-16 19:36:25,052 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70622581 0.7079774 -0.00163669 -0.00322989] -2025-05-16 19:36:25,084 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25136239 -0.13490004 0.3438168 ] -2025-05-16 19:36:25,086 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70627148 0.70793149 -0.00119585 -0.00348789] -2025-05-16 19:36:25,118 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25132895 -0.13488049 0.3437879 ] -2025-05-16 19:36:25,119 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06380498e-01 7.07820214e-01 -1.26827518e-04 -4.13760695e-03] -2025-05-16 19:36:25,147 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25131533 -0.13488497 0.34377128] -2025-05-16 19:36:25,149 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06423699e-01 7.07775027e-01 4.15352958e-04 -4.46064809e-03] -2025-05-16 19:36:25,184 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25129236 -0.1348951 0.34379007] -2025-05-16 19:36:25,186 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70651291 0.70768022 0.00149177 -0.00509915] -2025-05-16 19:36:25,214 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25126317 -0.13492081 0.34381658] -2025-05-16 19:36:25,216 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70656969 0.70761844 0.00220511 -0.00552844] -2025-05-16 19:36:25,247 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25120916 -0.13492172 0.34382936] -2025-05-16 19:36:25,248 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70667585 0.70750383 0.00319554 -0.00611159] -2025-05-16 19:36:25,279 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25118665 -0.13493061 0.34382306] -2025-05-16 19:36:25,281 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70671355 0.70746158 0.00365811 -0.00637842] -2025-05-16 19:36:25,312 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25115196 -0.13491713 0.34378365] -2025-05-16 19:36:25,314 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70683547 0.7073281 0.00467872 -0.00697809] -2025-05-16 19:36:25,342 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25114209 -0.13493077 0.34378874] -2025-05-16 19:36:25,349 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70685916 0.7073014 0.00492678 -0.00711279] -2025-05-16 19:36:25,385 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25108961 -0.13494744 0.34381079] -2025-05-16 19:36:25,388 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70694992 0.70719607 0.00599229 -0.00772215] -2025-05-16 19:36:25,419 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25100725 -0.13497146 0.34381474] -2025-05-16 19:36:25,421 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70703637 0.70709125 0.00715171 -0.00838917] -2025-05-16 19:36:25,450 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25097552 -0.13497576 0.34377702] -2025-05-16 19:36:25,451 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70711052 -0.70700298 -0.00794718 0.00885108] -2025-05-16 19:36:25,487 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25097097 -0.13497346 0.34376555] -2025-05-16 19:36:25,489 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70712933 -0.70698244 -0.00805293 0.00889267] -2025-05-16 19:36:25,518 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25094815 -0.13496806 0.34377792] -2025-05-16 19:36:25,520 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70718123 -0.7069215 -0.00857048 0.00912343] -2025-05-16 19:36:25,550 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25091172 -0.13497087 0.34379105] -2025-05-16 19:36:25,551 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70721205 -0.70687942 -0.00916375 0.00941425] -2025-05-16 19:36:25,586 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25083222 -0.13497824 0.34377522] -2025-05-16 19:36:25,588 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70728713 -0.70677938 -0.01035634 0.01002892] -2025-05-16 19:36:25,621 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25078058 -0.13496263 0.34374174] -2025-05-16 19:36:25,622 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70738497 -0.70666382 -0.01115212 0.01041056] -2025-05-16 19:36:25,650 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25078404 -0.13495923 0.34373887] -2025-05-16 19:36:25,651 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.7074044 -0.70664285 -0.01123584 0.01042382] -2025-05-16 19:36:25,678 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2507528 -0.13495408 0.34376777] -2025-05-16 19:36:25,686 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70744591 -0.70659057 -0.01174445 0.0105886 ] -2025-05-16 19:36:25,714 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25074983 -0.13495386 0.34376291] -2025-05-16 19:36:25,716 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.7074189 -0.70662102 -0.0116601 0.01045368] -2025-05-16 19:36:25,751 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25072509 -0.13494069 0.34379663] -2025-05-16 19:36:25,753 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70744149 -0.70659599 -0.0117731 0.01048971] -2025-05-16 19:36:25,785 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25069902 -0.1349576 0.3437634 ] -2025-05-16 19:36:25,787 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70745151 -0.70657747 -0.01211593 0.01066942] -2025-05-16 19:36:25,822 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25065226 -0.13494531 0.34375422] -2025-05-16 19:36:25,825 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70752658 -0.70648516 -0.01284535 0.01094752] -2025-05-16 19:36:25,866 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25065318 -0.13493924 0.34377197] -2025-05-16 19:36:25,873 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70756098 -0.70644657 -0.01304198 0.01098232] -2025-05-16 19:36:25,903 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2506258 -0.1349372 0.3437893] -2025-05-16 19:36:25,904 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70757994 -0.70642435 -0.01322578 0.01096987] -2025-05-16 19:36:25,951 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25059785 -0.13494477 0.34380552] -2025-05-16 19:36:25,956 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70757801 -0.70642362 -0.01337973 0.0109551 ] -2025-05-16 19:36:25,992 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25056795 -0.13495524 0.34377422] -2025-05-16 19:36:25,996 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70759649 -0.70639693 -0.01370217 0.01108345] -2025-05-16 19:36:26,029 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25054324 -0.13494545 0.34377825] -2025-05-16 19:36:26,038 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70767776 -0.70630104 -0.01429103 0.01126042] -2025-05-16 19:36:26,067 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25052541 -0.13494987 0.34378409] -2025-05-16 19:36:26,069 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70769962 -0.70627596 -0.01445325 0.01125293] -2025-05-16 19:36:26,106 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25049684 -0.13496868 0.3438045 ] -2025-05-16 19:36:26,109 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70769283 -0.70628339 -0.01448856 0.01116748] -2025-05-16 19:36:26,138 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25046577 -0.13498322 0.34378561] -2025-05-16 19:36:26,141 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70771154 -0.70625961 -0.01469657 0.01121331] -2025-05-16 19:36:26,171 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25046447 -0.13499249 0.34375383] -2025-05-16 19:36:26,174 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.7077472 -0.7062192 -0.01489779 0.01124316] -2025-05-16 19:36:26,202 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25047031 -0.13497362 0.34375727] -2025-05-16 19:36:26,206 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.7077662 -0.70620227 -0.01483512 0.01119311] -2025-05-16 19:36:26,235 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25046724 -0.13497849 0.34376939] -2025-05-16 19:36:26,236 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70775943 -0.70621142 -0.01476485 0.01113603] -2025-05-16 19:36:26,269 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25043372 -0.13499638 0.34377454] -2025-05-16 19:36:26,270 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70776697 -0.7062041 -0.01480868 0.01106276] -2025-05-16 19:36:26,302 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25040455 -0.13502856 0.34377977] -2025-05-16 19:36:26,304 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70777212 -0.70619809 -0.01488299 0.01101757] -2025-05-16 19:36:26,335 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25039179 -0.1350266 0.34374368] -2025-05-16 19:36:26,339 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70781426 -0.70615257 -0.01504814 0.01100357] -2025-05-16 19:36:26,366 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2503906 -0.13502424 0.34373298] -2025-05-16 19:36:26,367 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70782536 -0.70614238 -0.01503272 0.01096433] -2025-05-16 19:36:26,393 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25039003 -0.13501455 0.34374881] -2025-05-16 19:36:26,395 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70784221 -0.70612857 -0.01497154 0.01084891] -2025-05-16 19:36:26,422 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25038009 -0.13502116 0.34375313] -2025-05-16 19:36:26,423 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70783522 -0.70613797 -0.01491775 0.01076668] -2025-05-16 19:36:26,451 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25036902 -0.13502981 0.34375401] -2025-05-16 19:36:26,451 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70783537 -0.70613965 -0.01488075 0.01069783] -2025-05-16 19:36:26,483 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25032266 -0.13505767 0.34375521] -2025-05-16 19:36:26,485 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70785665 -0.70611933 -0.01493853 0.01054969] -2025-05-16 19:36:26,514 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25032081 -0.13505471 0.34373359] -2025-05-16 19:36:26,517 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70788787 -0.70609008 -0.01492925 0.01042507] -2025-05-16 19:36:26,549 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25032599 -0.13504964 0.34373425] -2025-05-16 19:36:26,550 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70789575 -0.70608483 -0.01485933 0.01034496] -2025-05-16 19:36:26,583 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25032553 -0.13504333 0.34373684] -2025-05-16 19:36:26,584 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70789646 -0.7060893 -0.01472358 0.01018464] -2025-05-16 19:36:26,616 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25029867 -0.13506167 0.34374937] -2025-05-16 19:36:26,618 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70788163 -0.70610923 -0.0146157 0.00998642] -2025-05-16 19:36:26,646 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25028114 -0.13507491 0.34374642] -2025-05-16 19:36:26,647 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70787709 -0.70611622 -0.01456608 0.0098866 ] -2025-05-16 19:36:26,673 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25026254 -0.13508965 0.34373623] -2025-05-16 19:36:26,674 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70787606 -0.70611995 -0.01452001 0.00976083] -2025-05-16 19:36:26,701 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25026186 -0.13507997 0.34372269] -2025-05-16 19:36:26,702 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.707896 -0.70610384 -0.01443552 0.00960389] -2025-05-16 19:36:26,730 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25026417 -0.1350757 0.34372005] -2025-05-16 19:36:26,732 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70789712 -0.70610626 -0.01433084 0.00949946] -2025-05-16 19:36:26,768 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25025359 -0.13507813 0.34372943] -2025-05-16 19:36:26,769 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70788457 -0.70612767 -0.01407748 0.00921827] -2025-05-16 19:36:26,798 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25023917 -0.1350897 0.34373903] -2025-05-16 19:36:26,800 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70786449 -0.7061529 -0.01393 0.00904972] -2025-05-16 19:36:26,832 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25021282 -0.1351075 0.34372971] -2025-05-16 19:36:26,834 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70785442 -0.70616989 -0.01374611 0.00878934] -2025-05-16 19:36:26,866 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25021018 -0.13509961 0.34371716] -2025-05-16 19:36:26,867 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70786716 -0.70616118 -0.01363566 0.00863363] -2025-05-16 19:36:26,895 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25021028 -0.13509414 0.34371252] -2025-05-16 19:36:26,896 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70787188 -0.70616148 -0.01347499 0.00847262] -2025-05-16 19:36:26,925 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25020549 -0.13508878 0.34371938] -2025-05-16 19:36:26,929 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70787229 -0.70617056 -0.01316403 0.00816484] -2025-05-16 19:36:26,959 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25020089 -0.13509313 0.34372497] -2025-05-16 19:36:26,963 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70786224 -0.70618507 -0.01301129 0.00802494] -2025-05-16 19:36:26,991 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25017141 -0.13511536 0.34371608] -2025-05-16 19:36:26,994 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70781976 -0.70623772 -0.01267238 0.00767372] -2025-05-16 19:36:27,024 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25016237 -0.13512129 0.34371111] -2025-05-16 19:36:27,066 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70780672 -0.70625448 -0.0125455 0.00754092] -2025-05-16 19:36:27,104 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25016423 -0.13510622 0.34370104] -2025-05-16 19:36:27,106 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70781856 -0.70625449 -0.0121244 0.00710488] -2025-05-16 19:36:27,134 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2501507 -0.1351 0.34369992] -2025-05-16 19:36:27,136 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70782761 -0.70625967 -0.01157703 0.00658138] -2025-05-16 19:36:27,171 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25015249 -0.13510088 0.34368828] -2025-05-16 19:36:27,174 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70782336 -0.70626616 -0.01148369 0.00650571] -2025-05-16 19:36:27,202 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012988 -0.13509783 0.343688 ] -2025-05-16 19:36:27,204 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70782154 -0.70626188 -0.01171677 0.00674799] -2025-05-16 19:36:27,239 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2501394 -0.13509412 0.34369165] -2025-05-16 19:36:27,242 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70782494 -0.70626447 -0.01147643 0.00652961] -2025-05-16 19:36:27,280 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25014476 -0.13507882 0.34368317] -2025-05-16 19:36:27,282 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70784742 -0.70625453 -0.01096026 0.00603679] -2025-05-16 19:36:27,313 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011728 -0.1350801 0.34368521] -2025-05-16 19:36:27,315 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70783972 -0.70627049 -0.01060199 0.00570236] -2025-05-16 19:36:27,346 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011643 -0.13507875 0.34367973] -2025-05-16 19:36:27,351 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70783558 -0.70627445 -0.01060392 0.00572225] -2025-05-16 19:36:27,380 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25010222 -0.13507301 0.34367833] -2025-05-16 19:36:27,381 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70784372 -0.70626647 -0.01059151 0.00572461] -2025-05-16 19:36:27,419 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012893 -0.13505063 0.34368206] -2025-05-16 19:36:27,421 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70787156 -0.70624539 -0.01028421 0.00543533] -2025-05-16 19:36:27,452 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012817 -0.13504917 0.34366506] -2025-05-16 19:36:27,455 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70786438 -0.70625716 -0.01006985 0.00523768] -2025-05-16 19:36:27,494 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25010368 -0.135048 0.34369281] -2025-05-16 19:36:27,498 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70783176 -0.70629813 -0.00966833 0.00486552] -2025-05-16 19:36:27,526 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25008419 -0.13505532 0.34367893] -2025-05-16 19:36:27,529 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70781722 -0.70631293 -0.00964066 0.00488772] -2025-05-16 19:36:27,558 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25009745 -0.13503044 0.34368189] -2025-05-16 19:36:27,561 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70784251 -0.70629192 -0.00941432 0.00469849] -2025-05-16 19:36:27,590 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25010749 -0.13500988 0.3436625 ] -2025-05-16 19:36:27,591 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70785759 -0.70627882 -0.00930754 0.00460702] -2025-05-16 19:36:27,626 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25010382 -0.13501123 0.34364913] -2025-05-16 19:36:27,634 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70782868 -0.70631617 -0.00885383 0.00419936] -2025-05-16 19:36:27,678 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007635 -0.13502124 0.34368797] -2025-05-16 19:36:27,682 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70779287 -0.70635923 -0.0084064 0.00390182] -2025-05-16 19:36:27,711 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007273 -0.13502553 0.34368567] -2025-05-16 19:36:27,720 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.7077893 -0.70636302 -0.00838865 0.00390087] -2025-05-16 19:36:27,751 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25008056 -0.13501232 0.34366232] -2025-05-16 19:36:27,753 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70780231 -0.706351 -0.00832683 0.00384909] -2025-05-16 19:36:27,782 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25009076 -0.1350004 0.34360177] -2025-05-16 19:36:27,785 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70778971 -0.70637085 -0.00786995 0.00346593] -2025-05-16 19:36:27,814 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25010282 -0.1350081 0.34364911] -2025-05-16 19:36:27,816 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70777595 -0.70638649 -0.00774119 0.00337623] -2025-05-16 19:36:27,850 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006837 -0.13499856 0.34369221] -2025-05-16 19:36:27,852 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70775118 -0.7064163 -0.00738686 0.00311547] -2025-05-16 19:36:27,883 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006464 -0.13502558 0.34370214] -2025-05-16 19:36:27,884 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70772712 -0.70644093 -0.00734058 0.00310787] -2025-05-16 19:36:27,917 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25008217 -0.13500004 0.34363961] -2025-05-16 19:36:27,919 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70773737 -0.70643411 -0.00709008 0.00289783] -2025-05-16 19:36:27,957 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011194 -0.13497904 0.34362407] -2025-05-16 19:36:27,961 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70773376 -0.7064434 -0.00664987 0.00253619] -2025-05-16 19:36:27,993 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25012293 -0.134978 0.34364251] -2025-05-16 19:36:28,002 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70771934 -0.70646004 -0.00646183 0.00240555] -2025-05-16 19:36:28,036 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25008795 -0.13499657 0.34371637] -2025-05-16 19:36:28,039 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70764288 -0.70654366 -0.00581443 0.00195037] -2025-05-16 19:36:28,076 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25009311 -0.1349787 0.34367016] -2025-05-16 19:36:28,080 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70764932 -0.7065397 -0.00556528 0.00176727] -2025-05-16 19:36:28,114 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011673 -0.1349667 0.34363986] -2025-05-16 19:36:28,117 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.7076465 -0.70654497 -0.00530874 0.00156482] -2025-05-16 19:36:28,154 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25014534 -0.1349529 0.3436433 ] -2025-05-16 19:36:28,159 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70763694 -0.7065574 -0.00498688 0.00131759] -2025-05-16 19:36:28,198 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25013077 -0.13495873 0.34369781] -2025-05-16 19:36:28,199 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70758769 -0.70661036 -0.00452611 0.00099166] -2025-05-16 19:36:28,226 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25010905 -0.13497089 0.3437243 ] -2025-05-16 19:36:28,229 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07536035e-01 -7.06665344e-01 -4.04999794e-03 6.69693555e-04] -2025-05-16 19:36:28,259 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011032 -0.13497077 0.34370393] -2025-05-16 19:36:28,266 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07527256e-01 -7.06675142e-01 -3.88787722e-03 5.56726089e-04] -2025-05-16 19:36:28,295 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25013875 -0.134951 0.34366132] -2025-05-16 19:36:28,306 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07532677e-01 -7.06671423e-01 -3.59151897e-03 3.33040378e-04] -2025-05-16 19:36:28,337 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25015863 -0.13493626 0.34368794] -2025-05-16 19:36:28,340 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07523117e-01 -7.06683373e-01 -3.10632644e-03 -1.80046346e-05] -2025-05-16 19:36:28,374 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25014193 -0.13494156 0.34374581] -2025-05-16 19:36:28,384 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07450470e-01 -7.06758120e-01 -2.57819403e-03 -3.79616077e-04] -2025-05-16 19:36:28,417 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25013426 -0.13495799 0.34376086] -2025-05-16 19:36:28,418 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07397171e-01 -7.06812418e-01 -2.25995783e-03 -5.83097433e-04] -2025-05-16 19:36:28,450 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25014623 -0.1349503 0.34374714] -2025-05-16 19:36:28,451 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07395713e-01 -7.06814238e-01 -2.11455764e-03 -6.83183286e-04] -2025-05-16 19:36:28,480 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25017682 -0.13492613 0.34374606] -2025-05-16 19:36:28,481 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70739834 -0.70681229 -0.00174439 -0.00096193] -2025-05-16 19:36:28,511 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2501871 -0.13491178 0.34376852] -2025-05-16 19:36:28,513 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70738809 -0.70682282 -0.00154098 -0.00110316] -2025-05-16 19:36:28,541 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25019377 -0.13490343 0.34383316] -2025-05-16 19:36:28,542 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70732336 -0.70688789 -0.00106241 -0.00142966] -2025-05-16 19:36:28,573 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25018978 -0.13491585 0.34389246] -2025-05-16 19:36:28,582 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70725987 -0.70695138 -0.00079138 -0.00161235] -2025-05-16 19:36:28,617 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25019511 -0.13490112 0.34390015] -2025-05-16 19:36:28,618 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07209745e-01 -7.07001265e-01 -4.37333944e-04 -1.84293761e-03] -2025-05-16 19:36:28,653 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25023572 -0.13485218 0.34394644] -2025-05-16 19:36:28,655 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07207205e-01 -7.07003048e-01 -1.53795920e-06 -2.15863102e-03] -2025-05-16 19:36:28,681 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25024625 -0.1348331 0.34399524] -2025-05-16 19:36:28,682 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07180081e-01 -7.07029691e-01 2.40772520e-04 -2.30015148e-03] -2025-05-16 19:36:28,717 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25025024 -0.13482949 0.34407798] -2025-05-16 19:36:28,718 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.07114643e-01 -7.07094329e-01 5.65988933e-04 -2.48422077e-03] -2025-05-16 19:36:28,750 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25025653 -0.13480945 0.34413306] -2025-05-16 19:36:28,752 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70707551 0.70713299 -0.00071682 0.00257782] -2025-05-16 19:36:28,779 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25026448 -0.13477469 0.34419173] -2025-05-16 19:36:28,781 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70702341 0.70718407 -0.00100306 0.0027551 ] -2025-05-16 19:36:28,811 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25029276 -0.13472083 0.34425299] -2025-05-16 19:36:28,813 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70699818 0.70720782 -0.00134992 0.00297344] -2025-05-16 19:36:28,842 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25031454 -0.13467082 0.34434257] -2025-05-16 19:36:28,844 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70696335 0.70724089 -0.00173904 0.00318217] -2025-05-16 19:36:28,876 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25031522 -0.13465074 0.34438753] -2025-05-16 19:36:28,880 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70693341 0.7072702 -0.00188168 0.00323633] -2025-05-16 19:36:28,920 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25031383 -0.13461786 0.34449111] -2025-05-16 19:36:28,922 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70686308 0.70733917 -0.00215053 0.00335573] -2025-05-16 19:36:28,953 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25029904 -0.13458227 0.3445913 ] -2025-05-16 19:36:28,955 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70680469 0.70739559 -0.00248154 0.00352752] -2025-05-16 19:36:28,985 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25032042 -0.13450231 0.34468478] -2025-05-16 19:36:28,991 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70680695 0.70739085 -0.00286815 0.00372754] -2025-05-16 19:36:29,027 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25032478 -0.13447532 0.34471734] -2025-05-16 19:36:29,032 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70679475 0.70740226 -0.00300122 0.00377158] -2025-05-16 19:36:29,058 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25032592 -0.1344144 0.34479505] -2025-05-16 19:36:29,060 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70673106 0.7074645 -0.00323733 0.00383499] -2025-05-16 19:36:29,091 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25031033 -0.13437322 0.34491192] -2025-05-16 19:36:29,094 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70665719 0.70753627 -0.0035433 0.00393465] -2025-05-16 19:36:29,123 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25030651 -0.1343472 0.34492277] -2025-05-16 19:36:29,124 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70664855 0.70754455 -0.00360686 0.00394102] -2025-05-16 19:36:29,151 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25030845 -0.13426347 0.34498096] -2025-05-16 19:36:29,154 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70662834 0.70756268 -0.00388741 0.004041 ] -2025-05-16 19:36:29,188 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25030657 -0.13420121 0.34504041] -2025-05-16 19:36:29,189 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70659535 0.70759366 -0.00417088 0.0041024 ] -2025-05-16 19:36:29,230 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25030018 -0.13413403 0.34510707] -2025-05-16 19:36:29,232 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7065551 0.7076322 -0.00443264 0.00411294] -2025-05-16 19:36:29,263 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25028439 -0.13412425 0.34517081] -2025-05-16 19:36:29,265 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70649451 0.70769109 -0.00468007 0.00411557] -2025-05-16 19:36:29,301 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25027009 -0.13411155 0.34517207] -2025-05-16 19:36:29,303 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70648534 0.70769964 -0.0047791 0.00410402] -2025-05-16 19:36:29,331 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25025749 -0.13404979 0.34519571] -2025-05-16 19:36:29,334 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70647927 0.70770398 -0.00500002 0.0041365 ] -2025-05-16 19:36:29,369 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25025383 -0.13399336 0.34521553] -2025-05-16 19:36:29,370 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7064561 0.70772538 -0.00525021 0.00412419] -2025-05-16 19:36:29,404 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25025682 -0.13399368 0.34521369] -2025-05-16 19:36:29,406 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70644793 0.7077332 -0.00531411 0.00409884] -2025-05-16 19:36:29,435 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2502402 -0.13399882 0.34525602] -2025-05-16 19:36:29,436 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70639982 0.7077793 -0.00561595 0.00402781] -2025-05-16 19:36:29,473 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2502161 -0.13400586 0.34523742] -2025-05-16 19:36:29,475 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70637903 0.70779911 -0.00577457 0.00396781] -2025-05-16 19:36:29,502 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2502169 -0.13401124 0.34522976] -2025-05-16 19:36:29,504 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70637262 0.70780471 -0.00589065 0.00393971] -2025-05-16 19:36:29,535 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25022214 -0.13401089 0.34522289] -2025-05-16 19:36:29,537 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70636416 0.70781265 -0.00596655 0.00391443] -2025-05-16 19:36:29,567 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25021898 -0.13403529 0.34522578] -2025-05-16 19:36:29,569 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70633989 0.70783625 -0.00607018 0.00386669] -2025-05-16 19:36:29,597 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25020558 -0.13409448 0.34521807] -2025-05-16 19:36:29,599 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70630726 0.70786742 -0.00632278 0.00371455] -2025-05-16 19:36:29,626 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25020437 -0.13411919 0.34520391] -2025-05-16 19:36:29,628 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70630116 0.70787347 -0.00634725 0.00367738] -2025-05-16 19:36:29,667 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25019681 -0.13414891 0.34516581] -2025-05-16 19:36:29,674 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70629399 0.70788059 -0.00638816 0.00361349] -2025-05-16 19:36:29,701 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25019994 -0.13419224 0.34512831] -2025-05-16 19:36:29,705 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7062751 0.70789878 -0.00651068 0.00352454] -2025-05-16 19:36:29,734 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25019458 -0.13422316 0.34511934] -2025-05-16 19:36:29,736 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70626636 0.70790731 -0.00655886 0.00347052] -2025-05-16 19:36:29,768 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25018847 -0.1342914 0.34509077] -2025-05-16 19:36:29,770 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70624917 0.7079239 -0.00669137 0.00332887] -2025-05-16 19:36:29,798 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25019353 -0.13428238 0.34507646] -2025-05-16 19:36:29,800 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70625255 0.70792083 -0.00667141 0.00330587] -2025-05-16 19:36:29,825 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25020077 -0.13429233 0.34502319] -2025-05-16 19:36:29,826 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70624928 0.70792449 -0.00666833 0.00322456] -2025-05-16 19:36:29,853 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25021465 -0.13427489 0.34499137] -2025-05-16 19:36:29,854 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70624969 0.7079243 -0.00666849 0.00317593] -2025-05-16 19:36:29,882 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25022735 -0.13426415 0.3449514 ] -2025-05-16 19:36:29,883 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70624834 0.70792588 -0.00667613 0.00310697] -2025-05-16 19:36:29,912 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25023923 -0.13426956 0.3448951 ] -2025-05-16 19:36:29,914 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70623928 0.70793504 -0.00672743 0.00296683] -2025-05-16 19:36:29,951 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2502548 -0.13425974 0.34485651] -2025-05-16 19:36:29,952 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70622641 0.70794831 -0.00673 0.0028569 ] -2025-05-16 19:36:29,987 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25025537 -0.13425485 0.34485636] -2025-05-16 19:36:30,003 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70622274 0.70795224 -0.00671455 0.00282594] -2025-05-16 19:36:30,040 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25027449 -0.13424152 0.34476489] -2025-05-16 19:36:30,041 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70622402 0.70795226 -0.00663935 0.0026736 ] -2025-05-16 19:36:30,083 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25030912 -0.13418987 0.3446863 ] -2025-05-16 19:36:30,093 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70622268 0.7079545 -0.00659976 0.0025295 ] -2025-05-16 19:36:30,123 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25033391 -0.13417687 0.34464992] -2025-05-16 19:36:30,134 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70619315 0.70798446 -0.00658733 0.00241882] -2025-05-16 19:36:30,179 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25032798 -0.13418609 0.34464343] -2025-05-16 19:36:30,180 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70618677 0.70799119 -0.00655158 0.00240839] -2025-05-16 19:36:30,216 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25032844 -0.1341955 0.34458582] -2025-05-16 19:36:30,219 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70618329 0.70799618 -0.00643112 0.00228213] -2025-05-16 19:36:30,258 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25033574 -0.13420499 0.34455933] -2025-05-16 19:36:30,259 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70617882 0.70800138 -0.0063682 0.00222755] -2025-05-16 19:36:30,287 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25037062 -0.13417816 0.34449718] -2025-05-16 19:36:30,296 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70616071 0.70802071 -0.00627366 0.00209005] -2025-05-16 19:36:30,337 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25036832 -0.13420834 0.34449928] -2025-05-16 19:36:30,338 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70614028 0.70804145 -0.0062329 0.00209013] -2025-05-16 19:36:30,377 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25038205 -0.13421768 0.34444805] -2025-05-16 19:36:30,378 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70611194 0.70807128 -0.00608802 0.00198104] -2025-05-16 19:36:30,419 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25039051 -0.13424402 0.34441689] -2025-05-16 19:36:30,421 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70606907 0.7081153 -0.0059656 0.00190062] -2025-05-16 19:36:30,451 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25042593 -0.13423125 0.34437001] -2025-05-16 19:36:30,452 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70605858 0.70812699 -0.00584428 0.00181245] -2025-05-16 19:36:30,481 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25044097 -0.13421658 0.34436048] -2025-05-16 19:36:30,482 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70603744 0.70814833 -0.00581316 0.00181391] -2025-05-16 19:36:30,510 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25046778 -0.13420963 0.3443208 ] -2025-05-16 19:36:30,511 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7059632 0.70822376 -0.00565468 0.00175779] -2025-05-16 19:36:30,539 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25048454 -0.13417033 0.3442932 ] -2025-05-16 19:36:30,543 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70592729 0.70826023 -0.00557365 0.00174374] -2025-05-16 19:36:30,586 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25050642 -0.13409629 0.34425718] -2025-05-16 19:36:30,589 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70590489 0.70828288 -0.00554011 0.00171751] -2025-05-16 19:36:30,620 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25056194 -0.13398516 0.34418198] -2025-05-16 19:36:30,622 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70587995 0.70830902 -0.00540454 0.00161549] -2025-05-16 19:36:30,655 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25063352 -0.13379877 0.3440875 ] -2025-05-16 19:36:30,656 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7058472 0.70834307 -0.00524386 0.00152406] -2025-05-16 19:36:30,688 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2506692 -0.13363832 0.34404076] -2025-05-16 19:36:30,689 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70583433 0.708356 -0.00524295 0.00147454] -2025-05-16 19:36:30,722 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25070806 -0.13342264 0.34397852] -2025-05-16 19:36:30,724 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70580963 0.70838097 -0.0052118 0.00141962] -2025-05-16 19:36:30,756 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25076118 -0.13314925 0.34392348] -2025-05-16 19:36:30,758 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70577696 0.70841352 -0.00522914 0.00134708] -2025-05-16 19:36:30,802 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25086346 -0.13275268 0.3438039 ] -2025-05-16 19:36:30,804 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70575218 0.70843901 -0.00516246 0.00117276] -2025-05-16 19:36:30,830 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25092308 -0.13244708 0.34372724] -2025-05-16 19:36:30,831 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70571186 0.70847935 -0.00516722 0.00103684] -2025-05-16 19:36:30,859 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25100894 -0.13199668 0.34361265] -2025-05-16 19:36:30,864 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70564089 0.70855025 -0.00516712 0.00087843] -2025-05-16 19:36:30,896 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25106344 -0.13162509 0.34354816] -2025-05-16 19:36:30,897 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7056007 0.70858989 -0.00523601 0.00077211] -2025-05-16 19:36:30,930 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25112092 -0.13127601 0.34349224] -2025-05-16 19:36:30,932 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.05564718e-01 7.08625332e-01 -5.30511912e-03 6.50803848e-04] -2025-05-16 19:36:30,966 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2512615 -0.13060292 0.34335489] -2025-05-16 19:36:30,967 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.05541739e-01 7.08647776e-01 -5.39016252e-03 3.61511881e-04] -2025-05-16 19:36:31,000 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25137158 -0.12999721 0.34321413] -2025-05-16 19:36:31,003 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.05407014e-01 7.08781141e-01 -5.49863028e-03 5.92939994e-05] -2025-05-16 19:36:31,035 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25142589 -0.12973475 0.34316387] -2025-05-16 19:36:31,035 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.05377619e-01 7.08809409e-01 -5.62350407e-03 -1.13016245e-04] -2025-05-16 19:36:31,062 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25150921 -0.12918833 0.34305301] -2025-05-16 19:36:31,067 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.05272061e-01 7.08912966e-01 -5.79545297e-03 -3.74055451e-04] -2025-05-16 19:36:31,100 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25157255 -0.12880098 0.34298374] -2025-05-16 19:36:31,102 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.05195701e-01 7.08987198e-01 -5.98360402e-03 -6.09908559e-04] -2025-05-16 19:36:31,132 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25173337 -0.12800914 0.34284758] -2025-05-16 19:36:31,135 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70516471 0.70901527 -0.00624533 -0.00103409] -2025-05-16 19:36:31,166 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25181726 -0.12755569 0.34274982] -2025-05-16 19:36:31,169 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70509613 0.70908142 -0.00641908 -0.00133719] -2025-05-16 19:36:31,198 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25190129 -0.12700688 0.34261262] -2025-05-16 19:36:31,201 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70496362 0.70920944 -0.00671529 -0.00178074] -2025-05-16 19:36:31,233 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2519778 -0.12651064 0.34250789] -2025-05-16 19:36:31,235 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70485154 0.70931597 -0.00708689 -0.00222241] -2025-05-16 19:36:31,267 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25205643 -0.12609136 0.34243497] -2025-05-16 19:36:31,271 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70479732 0.7093651 -0.00742363 -0.00260289] -2025-05-16 19:36:31,307 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25219082 -0.12542155 0.34231566] -2025-05-16 19:36:31,323 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70471099 0.70944394 -0.00785691 -0.00315838] -2025-05-16 19:36:31,355 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25229317 -0.12476053 0.34214212] -2025-05-16 19:36:31,357 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70449294 0.70964944 -0.00846612 -0.00396214] -2025-05-16 19:36:31,392 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25237962 -0.12429608 0.34203874] -2025-05-16 19:36:31,401 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70436364 0.7097674 -0.00900413 -0.0045852 ] -2025-05-16 19:36:31,438 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25241817 -0.1239809 0.34196644] -2025-05-16 19:36:31,439 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70422743 0.7098926 -0.00949307 -0.00510861] -2025-05-16 19:36:31,472 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25250236 -0.1235627 0.3419112 ] -2025-05-16 19:36:31,473 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7041698 0.70993879 -0.00999384 -0.00565044] -2025-05-16 19:36:31,502 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25251824 -0.12337472 0.3418697 ] -2025-05-16 19:36:31,504 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70410108 0.71000024 -0.01027166 -0.00598537] -2025-05-16 19:36:31,539 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25261401 -0.12268024 0.34170671] -2025-05-16 19:36:31,541 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70387744 0.7102015 -0.01104726 -0.00695334] -2025-05-16 19:36:31,573 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25265799 -0.12236841 0.341633 ] -2025-05-16 19:36:31,576 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70375479 0.7103064 -0.01165921 -0.00762112] -2025-05-16 19:36:31,612 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25269787 -0.12210214 0.3415829 ] -2025-05-16 19:36:31,614 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70362751 0.7104124 -0.01236529 -0.00834548] -2025-05-16 19:36:31,643 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25270322 -0.1220309 0.3415741 ] -2025-05-16 19:36:31,648 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70356768 0.71046184 -0.0126955 -0.00867852] -2025-05-16 19:36:31,683 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25273789 -0.12171469 0.3415061 ] -2025-05-16 19:36:31,684 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70337705 0.71062615 -0.01344447 -0.00950989] -2025-05-16 19:36:31,744 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25277702 -0.12132183 0.34141901] -2025-05-16 19:36:31,746 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70319303 0.71078134 -0.01420798 -0.01037273] -2025-05-16 19:36:31,774 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25280175 -0.12090874 0.34133553] -2025-05-16 19:36:31,786 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70294182 0.71098771 -0.01534394 -0.01156884] -2025-05-16 19:36:31,818 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25279783 -0.12089235 0.34134006] -2025-05-16 19:36:31,820 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70291363 0.71100628 -0.01559027 -0.01180901] -2025-05-16 19:36:31,850 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25280334 -0.12078198 0.34132285] -2025-05-16 19:36:31,851 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70282595 0.71106587 -0.01626384 -0.01250975] -2025-05-16 19:36:31,878 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25280821 -0.12063933 0.34129067] -2025-05-16 19:36:31,880 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70266505 0.71119436 -0.01697856 -0.01327139] -2025-05-16 19:36:31,912 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25280877 -0.12053309 0.3412661 ] -2025-05-16 19:36:31,914 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7025781 0.71125309 -0.01759192 -0.01391314] -2025-05-16 19:36:31,943 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25281674 -0.12045393 0.34126085] -2025-05-16 19:36:31,946 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70250364 0.71130729 -0.01801958 -0.0143479 ] -2025-05-16 19:36:31,983 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25278609 -0.12035487 0.34122969] -2025-05-16 19:36:31,986 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7023029 0.71146543 -0.01884917 -0.01524108] -2025-05-16 19:36:32,017 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25276699 -0.12027542 0.34123157] -2025-05-16 19:36:32,017 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70214305 0.71157567 -0.01979386 -0.01622967] -2025-05-16 19:36:32,048 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.252753 -0.12032832 0.34124634] -2025-05-16 19:36:32,050 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7020958 0.71160668 -0.02009461 -0.01654165] -2025-05-16 19:36:32,088 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25272586 -0.12039833 0.34125754] -2025-05-16 19:36:32,089 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70206443 0.71161476 -0.02052524 -0.01699058] -2025-05-16 19:36:32,135 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25268311 -0.12054197 0.34127741] -2025-05-16 19:36:32,138 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70174463 0.71186079 -0.02178553 -0.01827792] -2025-05-16 19:36:32,169 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25265101 -0.12068377 0.34130995] -2025-05-16 19:36:32,185 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70163405 0.71192355 -0.02257796 -0.0190985 ] -2025-05-16 19:36:32,215 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25260871 -0.12089769 0.34136006] -2025-05-16 19:36:32,217 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70152136 0.71200247 -0.02310958 -0.01965226] -2025-05-16 19:36:32,248 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25255034 -0.12122143 0.3414136 ] -2025-05-16 19:36:32,250 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70150739 0.71199462 -0.02344725 -0.02003176] -2025-05-16 19:36:32,285 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2525086 -0.12153527 0.34148544] -2025-05-16 19:36:32,289 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70136222 0.712091 -0.02419233 -0.0207888 ] -2025-05-16 19:36:32,321 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25248914 -0.12178197 0.34152869] -2025-05-16 19:36:32,323 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7012811 0.71215023 -0.02450969 -0.02112206] -2025-05-16 19:36:32,362 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25242509 -0.12230238 0.34161108] -2025-05-16 19:36:32,366 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70112991 0.71223377 -0.02547302 -0.02215933] -2025-05-16 19:36:32,402 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25239496 -0.12262876 0.34166184] -2025-05-16 19:36:32,403 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70110176 0.71224488 -0.02569377 -0.02243632] -2025-05-16 19:36:32,435 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.252339 -0.12315476 0.34176326] -2025-05-16 19:36:32,437 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70103128 0.7122785 -0.02619452 -0.02298549] -2025-05-16 19:36:32,467 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25230769 -0.1235244 0.34185367] -2025-05-16 19:36:32,469 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70093342 0.71235743 -0.02644153 -0.02323954] -2025-05-16 19:36:32,497 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25228904 -0.12373777 0.34189309] -2025-05-16 19:36:32,498 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70091127 0.71237017 -0.02654699 -0.02339625] -2025-05-16 19:36:32,529 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25223127 -0.1243092 0.34200001] -2025-05-16 19:36:32,531 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70082293 0.71241415 -0.02710121 -0.02405894] -2025-05-16 19:36:32,559 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25219327 -0.12463164 0.34205623] -2025-05-16 19:36:32,568 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70077779 0.71244734 -0.02722384 -0.02425144] -2025-05-16 19:36:32,598 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25214137 -0.12524408 0.34217046] -2025-05-16 19:36:32,600 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70073053 0.71246922 -0.02751752 -0.02463977] -2025-05-16 19:36:32,627 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25213734 -0.12535397 0.34219056] -2025-05-16 19:36:32,630 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70074308 0.71245904 -0.02746976 -0.02463074] -2025-05-16 19:36:32,659 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25208336 -0.1259839 0.34231859] -2025-05-16 19:36:32,663 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7006872 0.71249796 -0.02763753 -0.02490526] -2025-05-16 19:36:32,694 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25202108 -0.12665382 0.34244871] -2025-05-16 19:36:32,697 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70067174 0.71248856 -0.02789062 -0.02532348] -2025-05-16 19:36:32,727 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25200568 -0.1268054 0.34247411] -2025-05-16 19:36:32,729 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70068463 0.71247714 -0.02784563 -0.02533744] -2025-05-16 19:36:32,759 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25195331 -0.12739344 0.34256909] -2025-05-16 19:36:32,775 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70066547 0.71248719 -0.02788392 -0.02554194] -2025-05-16 19:36:32,803 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25192293 -0.12779641 0.34264345] -2025-05-16 19:36:32,805 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70068819 0.71247023 -0.02774221 -0.02554614] -2025-05-16 19:36:32,838 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25185359 -0.12866025 0.34281288] -2025-05-16 19:36:32,840 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70072996 0.71241931 -0.02776858 -0.02579072] -2025-05-16 19:36:32,879 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25183238 -0.12894048 0.34286164] -2025-05-16 19:36:32,881 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70077867 0.7123759 -0.02765447 -0.02578881] -2025-05-16 19:36:32,912 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25179697 -0.12927369 0.34289925] -2025-05-16 19:36:32,923 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70080691 0.7123546 -0.02748577 -0.02578998] -2025-05-16 19:36:32,956 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25175976 -0.12978589 0.34296476] -2025-05-16 19:36:32,957 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70085356 0.71231603 -0.02730025 -0.02578483] -2025-05-16 19:36:32,988 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25174205 -0.13005264 0.34300378] -2025-05-16 19:36:32,995 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70090856 0.71226937 -0.02714516 -0.02574259] -2025-05-16 19:36:33,033 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2516833 -0.13079215 0.34313462] -2025-05-16 19:36:33,035 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70098888 0.71220155 -0.02686607 -0.02572452] -2025-05-16 19:36:33,071 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2516529 -0.13104455 0.34315428] -2025-05-16 19:36:33,074 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70111896 0.71208862 -0.02657075 -0.02561237] -2025-05-16 19:36:33,103 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25159448 -0.13146025 0.34317755] -2025-05-16 19:36:33,105 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70121023 0.71202332 -0.02609873 -0.02541379] -2025-05-16 19:36:33,137 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25157885 -0.13169008 0.34319786] -2025-05-16 19:36:33,140 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70131468 0.71194099 -0.02575205 -0.0251907 ] -2025-05-16 19:36:33,168 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25156389 -0.13183345 0.34321048] -2025-05-16 19:36:33,170 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70138672 0.71188295 -0.0255271 -0.02505399] -2025-05-16 19:36:33,203 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25151789 -0.13229588 0.34325746] -2025-05-16 19:36:33,204 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7014596 0.71183271 -0.02509693 -0.02487486] -2025-05-16 19:36:33,234 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25148392 -0.1325785 0.34327375] -2025-05-16 19:36:33,239 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7015892 0.71172731 -0.02467232 -0.02465973] -2025-05-16 19:36:33,278 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25140613 -0.13313693 0.34328701] -2025-05-16 19:36:33,281 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70180967 0.71155589 -0.02380047 -0.02418563] -2025-05-16 19:36:33,313 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25139981 -0.13321101 0.34328184] -2025-05-16 19:36:33,316 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70191351 0.71146996 -0.02351772 -0.02397554] -2025-05-16 19:36:33,352 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25136169 -0.13347796 0.34329278] -2025-05-16 19:36:33,354 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70202805 0.71138892 -0.02293397 -0.0235892 ] -2025-05-16 19:36:33,384 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25131845 -0.13380074 0.34329246] -2025-05-16 19:36:33,386 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70214484 0.71130614 -0.02229917 -0.02321516] -2025-05-16 19:36:33,420 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25126357 -0.13419212 0.34328025] -2025-05-16 19:36:33,423 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70238896 0.71110739 -0.02144567 -0.02271795] -2025-05-16 19:36:33,456 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25123864 -0.13428114 0.34326545] -2025-05-16 19:36:33,458 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70245677 0.71105699 -0.0211267 -0.02249692] -2025-05-16 19:36:33,489 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25121493 -0.13443313 0.34325436] -2025-05-16 19:36:33,491 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70266737 0.71088474 -0.02043887 -0.02199317] -2025-05-16 19:36:33,526 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25119345 -0.13453185 0.34324526] -2025-05-16 19:36:33,535 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70275285 0.71082869 -0.0198823 -0.02157998] -2025-05-16 19:36:33,567 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2511217 -0.13488538 0.34320302] -2025-05-16 19:36:33,569 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70301248 0.71063259 -0.01858208 -0.02072407] -2025-05-16 19:36:33,605 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25109803 -0.13506786 0.3431664 ] -2025-05-16 19:36:33,607 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70321706 0.71046101 -0.01789314 -0.02026717] -2025-05-16 19:36:33,643 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25107801 -0.13518704 0.34314563] -2025-05-16 19:36:33,652 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70341968 0.7102946 -0.01716398 -0.0196911 ] -2025-05-16 19:36:33,688 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25107832 -0.13520362 0.34312466] -2025-05-16 19:36:33,689 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70353468 0.71020696 -0.016594 -0.01922681] -2025-05-16 19:36:33,721 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25105354 -0.13533329 0.3430908 ] -2025-05-16 19:36:33,723 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70363958 0.71013617 -0.01579968 -0.01866386] -2025-05-16 19:36:33,755 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25100342 -0.13551005 0.34303289] -2025-05-16 19:36:33,757 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70387034 0.70994778 -0.01478089 -0.01795046] -2025-05-16 19:36:33,789 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25100498 -0.1355451 0.34299629] -2025-05-16 19:36:33,792 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7041219 0.70973514 -0.01385711 -0.01721533] -2025-05-16 19:36:33,822 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25099703 -0.1355567 0.34296811] -2025-05-16 19:36:33,825 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70424023 0.70963661 -0.01337545 -0.01681312] -2025-05-16 19:36:33,855 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25099988 -0.13560685 0.34294017] -2025-05-16 19:36:33,857 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70437075 0.70953641 -0.01260703 -0.01615552] -2025-05-16 19:36:33,889 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25097534 -0.13573284 0.34288892] -2025-05-16 19:36:33,891 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70455621 0.70938319 -0.01168367 -0.01547648] -2025-05-16 19:36:33,919 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25096429 -0.13577137 0.34285792] -2025-05-16 19:36:33,921 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70466918 0.70928594 -0.01121819 -0.01513137] -2025-05-16 19:36:33,954 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25094585 -0.13583028 0.34279755] -2025-05-16 19:36:33,956 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70498002 0.70901333 -0.01006288 -0.0142128 ] -2025-05-16 19:36:33,989 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25095264 -0.13578504 0.34276834] -2025-05-16 19:36:33,991 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70511119 0.70890064 -0.00948827 -0.01371389] -2025-05-16 19:36:34,028 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25094679 -0.13576882 0.34271597] -2025-05-16 19:36:34,030 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70528176 0.70876425 -0.0083182 -0.01271572] -2025-05-16 19:36:34,067 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25092709 -0.13586937 0.34266802] -2025-05-16 19:36:34,068 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70544741 0.70861837 -0.00755287 -0.01212044] -2025-05-16 19:36:34,120 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25091308 -0.13594804 0.34260856] -2025-05-16 19:36:34,125 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70570736 0.70838505 -0.00643432 -0.01124014] -2025-05-16 19:36:34,155 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.250913 -0.1358956 0.34255425] -2025-05-16 19:36:34,157 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70597827 0.70813873 -0.00533135 -0.01028601] -2025-05-16 19:36:34,203 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25091067 -0.13582371 0.34251043] -2025-05-16 19:36:34,204 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70608922 0.70804584 -0.00439961 -0.00947345] -2025-05-16 19:36:34,230 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25089802 -0.13581299 0.34247047] -2025-05-16 19:36:34,235 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70623634 0.70791212 -0.00361758 -0.00880745] -2025-05-16 19:36:34,272 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25089617 -0.13583896 0.34245636] -2025-05-16 19:36:34,281 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70632109 0.70783375 -0.00320387 -0.00846347] -2025-05-16 19:36:34,313 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25089757 -0.13590614 0.34240007] -2025-05-16 19:36:34,319 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7065359 0.70762974 -0.0023898 -0.00784041] -2025-05-16 19:36:34,348 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25090057 -0.13586557 0.34235697] -2025-05-16 19:36:34,349 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7067609 0.70741815 -0.00127068 -0.0068537 ] -2025-05-16 19:36:34,387 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25090303 -0.13579047 0.34230992] -2025-05-16 19:36:34,390 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06918332e-01 7.07269910e-01 -2.61151690e-04 -5.97309194e-03] -2025-05-16 19:36:34,422 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25090741 -0.13570111 0.34228904] -2025-05-16 19:36:34,426 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07078209e-01 7.07115586e-01 5.26541925e-04 -5.26085744e-03] -2025-05-16 19:36:34,468 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2509131 -0.13571287 0.34227959] -2025-05-16 19:36:34,473 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70713213 -0.7070628 -0.00074976 0.00507772] -2025-05-16 19:36:34,502 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25090647 -0.13577785 0.34222832] -2025-05-16 19:36:34,504 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70735054 -0.70684807 -0.00175874 0.00423467] -2025-05-16 19:36:34,535 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25091676 -0.13576674 0.34217627] -2025-05-16 19:36:34,536 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70755247 -0.70664742 -0.00289179 0.00325004] -2025-05-16 19:36:34,567 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25091497 -0.1357265 0.34215606] -2025-05-16 19:36:34,568 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70761621 -0.70658321 -0.00346234 0.00273494] -2025-05-16 19:36:34,599 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25092438 -0.1356562 0.34214352] -2025-05-16 19:36:34,601 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.707773 -0.70642501 -0.00402849 0.0022042 ] -2025-05-16 19:36:34,633 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25092467 -0.13563911 0.34212893] -2025-05-16 19:36:34,635 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.707871 -0.70632466 -0.00461828 0.00167414] -2025-05-16 19:36:34,673 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25093455 -0.13561049 0.34208418] -2025-05-16 19:36:34,676 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70804266 -0.70614682 -0.00562264 0.00080399] -2025-05-16 19:36:34,706 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25093382 -0.13564251 0.34204879] -2025-05-16 19:36:34,707 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.08184226e-01 -7.05997190e-01 -6.56263110e-03 -4.74780145e-05] -2025-05-16 19:36:34,743 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25094024 -0.13561935 0.3420368 ] -2025-05-16 19:36:34,752 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 7.08260703e-01 -7.05917058e-01 -6.90988198e-03 -3.70587986e-04] -2025-05-16 19:36:34,779 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25094784 -0.13557708 0.34202739] -2025-05-16 19:36:34,781 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70841052 -0.7057585 -0.00763786 -0.00106649] -2025-05-16 19:36:34,810 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25095083 -0.13556887 0.34202677] -2025-05-16 19:36:34,812 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70845245 -0.70571467 -0.00777659 -0.0012105 ] -2025-05-16 19:36:34,840 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25095611 -0.13556643 0.34198424] -2025-05-16 19:36:34,842 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70862637 -0.70552492 -0.00886223 -0.00217249] -2025-05-16 19:36:34,871 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25095104 -0.13553835 0.34196098] -2025-05-16 19:36:34,873 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70869504 -0.70544747 -0.00939055 -0.00265185] -2025-05-16 19:36:34,903 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25097725 -0.13546371 0.3419554 ] -2025-05-16 19:36:34,907 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70885372 -0.70527638 -0.01003796 -0.00329841] -2025-05-16 19:36:34,935 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25097883 -0.13546251 0.3419505 ] -2025-05-16 19:36:34,937 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70890475 -0.70521854 -0.01037591 -0.00363426] -2025-05-16 19:36:34,967 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25098902 -0.13547046 0.34194381] -2025-05-16 19:36:34,970 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70897356 -0.70514238 -0.01072047 -0.00397291] -2025-05-16 19:36:35,004 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25098753 -0.13548116 0.34190829] -2025-05-16 19:36:35,012 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70908991 -0.70500724 -0.01157098 -0.00473375] -2025-05-16 19:36:35,051 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25098957 -0.13545747 0.34188669] -2025-05-16 19:36:35,054 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70917405 -0.7049161 -0.01185601 -0.00498965] -2025-05-16 19:36:35,089 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25101936 -0.13538994 0.34188099] -2025-05-16 19:36:35,093 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70932729 -0.7047439 -0.01257224 -0.0057247 ] -2025-05-16 19:36:35,123 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25102831 -0.13538992 0.34187249] -2025-05-16 19:36:35,132 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70934953 -0.70471545 -0.01280258 -0.00595539] -2025-05-16 19:36:35,164 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25102383 -0.13534889 0.34184645] -2025-05-16 19:36:35,165 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70945328 -0.70458799 -0.01364399 -0.00675659] -2025-05-16 19:36:35,195 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25102681 -0.13533308 0.34183835] -2025-05-16 19:36:35,197 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70947742 -0.70456132 -0.01372791 -0.0068319 ] -2025-05-16 19:36:35,233 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25104452 -0.13527933 0.34182211] -2025-05-16 19:36:35,236 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70955946 -0.70446662 -0.01413576 -0.00723376] -2025-05-16 19:36:35,267 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25106862 -0.13524176 0.34181247] -2025-05-16 19:36:35,269 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70965368 -0.70435952 -0.01452438 -0.00763981] -2025-05-16 19:36:35,302 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25107692 -0.13523568 0.34180995] -2025-05-16 19:36:35,304 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70967569 -0.70433001 -0.01474846 -0.00788286] -2025-05-16 19:36:35,334 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25106926 -0.13521588 0.34178947] -2025-05-16 19:36:35,337 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.7097375 -0.70425192 -0.01523747 -0.00835084] -2025-05-16 19:36:35,383 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25108166 -0.13515809 0.34176951] -2025-05-16 19:36:35,385 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70982288 -0.70415445 -0.01557794 -0.00867825] -2025-05-16 19:36:35,415 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25109326 -0.1351312 0.34175253] -2025-05-16 19:36:35,417 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70986276 -0.70410465 -0.01585247 -0.00895524] -2025-05-16 19:36:35,458 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25110356 -0.13511854 0.34175503] -2025-05-16 19:36:35,462 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.7098879 -0.70407562 -0.01594318 -0.00908276] -2025-05-16 19:36:35,500 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25110227 -0.13510481 0.34175343] -2025-05-16 19:36:35,503 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70991276 -0.70404503 -0.01608984 -0.00925127] -2025-05-16 19:36:35,530 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25109502 -0.13507317 0.34172505] -2025-05-16 19:36:35,532 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70995787 -0.70399434 -0.01623695 -0.00938926] -2025-05-16 19:36:35,570 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25109125 -0.13506239 0.34173769] -2025-05-16 19:36:35,572 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70996461 -0.70398962 -0.01617006 -0.00934846] -2025-05-16 19:36:35,602 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25108714 -0.13505688 0.34173724] -2025-05-16 19:36:35,604 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70995403 -0.70400118 -0.01614551 -0.00932395] -2025-05-16 19:36:35,639 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25108484 -0.1350521 0.3417429 ] -2025-05-16 19:36:35,641 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70994367 -0.70400938 -0.01619493 -0.00940758] -2025-05-16 19:36:35,671 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25107368 -0.13503307 0.34173531] -2025-05-16 19:36:35,674 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70995395 -0.70399521 -0.01629506 -0.00951886] -2025-05-16 19:36:35,709 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25106556 -0.13499315 0.34174817] -2025-05-16 19:36:35,711 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.7099975 -0.70394784 -0.0163748 -0.00963631] -2025-05-16 19:36:35,747 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25105092 -0.13499406 0.34178473] -2025-05-16 19:36:35,751 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.71000199 -0.7039448 -0.01632373 -0.00961351] -2025-05-16 19:36:35,779 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25103394 -0.13499697 0.34182131] -2025-05-16 19:36:35,784 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70999522 -0.70395332 -0.01626241 -0.00959353] -2025-05-16 19:36:35,826 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25101886 -0.13499824 0.34185226] -2025-05-16 19:36:35,828 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70998444 -0.70396545 -0.01622033 -0.00957303] -2025-05-16 19:36:35,858 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25099896 -0.13495487 0.34188607] -2025-05-16 19:36:35,871 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70996374 -0.70398393 -0.01627004 -0.00966439] -2025-05-16 19:36:35,910 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2509728 -0.13493531 0.34193547] -2025-05-16 19:36:35,918 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70996457 -0.70398273 -0.01625207 -0.00972131] -2025-05-16 19:36:35,954 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25091695 -0.13491897 0.34202562] -2025-05-16 19:36:35,956 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70999433 -0.70395506 -0.01614901 -0.00972296] -2025-05-16 19:36:35,986 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25090335 -0.13492126 0.34205025] -2025-05-16 19:36:35,988 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70999434 -0.7039568 -0.01609338 -0.00968868] -2025-05-16 19:36:36,020 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25086067 -0.13490611 0.34212017] -2025-05-16 19:36:36,022 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.71002427 -0.70392925 -0.01600494 -0.00964296] -2025-05-16 19:36:36,055 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25085139 -0.13491009 0.3421404 ] -2025-05-16 19:36:36,058 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.71001262 -0.70394259 -0.01594661 -0.00962314] -2025-05-16 19:36:36,092 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.250825 -0.13490696 0.34217627] -2025-05-16 19:36:36,094 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.71001887 -0.70393842 -0.01586881 -0.00959564] -2025-05-16 19:36:36,123 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25078082 -0.13490488 0.34225268] -2025-05-16 19:36:36,124 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.71003203 -0.70392932 -0.01571677 -0.00954001] -2025-05-16 19:36:36,151 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25075104 -0.13490507 0.34230219] -2025-05-16 19:36:36,153 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.710035 -0.70392979 -0.01559795 -0.00947903] -2025-05-16 19:36:36,188 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25073038 -0.13490749 0.34235083] -2025-05-16 19:36:36,194 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.71000944 -0.7039605 -0.01543596 -0.0093781 ] -2025-05-16 19:36:36,224 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25072362 -0.13491504 0.34235651] -2025-05-16 19:36:36,225 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70998104 -0.7039909 -0.01537763 -0.00934146] -2025-05-16 19:36:36,254 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25067232 -0.13491142 0.34243403] -2025-05-16 19:36:36,257 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70997964 -0.70399822 -0.01516075 -0.00925052] -2025-05-16 19:36:36,285 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25063606 -0.13491512 0.34249609] -2025-05-16 19:36:36,287 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70996692 -0.70401644 -0.01496867 -0.00915216] -2025-05-16 19:36:36,323 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25062629 -0.13492017 0.34253988] -2025-05-16 19:36:36,325 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70991676 -0.70407392 -0.01474116 -0.00898919] -2025-05-16 19:36:36,355 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2506211 -0.13493946 0.34254175] -2025-05-16 19:36:36,356 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70988016 -0.70411266 -0.0146773 -0.00894995] -2025-05-16 19:36:36,388 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25061824 -0.13494556 0.34255125] -2025-05-16 19:36:36,390 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70985568 -0.70413955 -0.01459363 -0.00891215] -2025-05-16 19:36:36,420 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25056371 -0.13494484 0.34265977] -2025-05-16 19:36:36,422 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70982132 -0.70418414 -0.01421574 -0.00873471] -2025-05-16 19:36:36,457 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25053452 -0.13494387 0.34271844] -2025-05-16 19:36:36,467 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70978668 -0.7042258 -0.01396732 -0.00859109] -2025-05-16 19:36:36,495 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25051599 -0.13494706 0.34277748] -2025-05-16 19:36:36,497 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.709729 -0.70429213 -0.01366428 -0.00840475] -2025-05-16 19:36:36,535 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25050291 -0.13496753 0.34281091] -2025-05-16 19:36:36,538 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70964736 -0.70438121 -0.01340267 -0.00825211] -2025-05-16 19:36:36,569 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25047679 -0.13495209 0.34287517] -2025-05-16 19:36:36,571 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70960773 -0.70442892 -0.01308395 -0.00809758] -2025-05-16 19:36:36,601 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25045226 -0.13495144 0.34292252] -2025-05-16 19:36:36,602 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70956512 -0.70447732 -0.01285729 -0.00798382] -2025-05-16 19:36:36,634 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25042316 -0.13493337 0.34299773] -2025-05-16 19:36:36,634 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.7095231 -0.7045292 -0.01246393 -0.0077604 ] -2025-05-16 19:36:36,665 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25040793 -0.134937 0.34303221] -2025-05-16 19:36:36,666 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70945466 -0.70460361 -0.0122321 -0.00762948] -2025-05-16 19:36:36,700 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25038202 -0.134942 0.34308871] -2025-05-16 19:36:36,701 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70932509 -0.70474418 -0.01179369 -0.00738063] -2025-05-16 19:36:36,732 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25037507 -0.13493179 0.34310979] -2025-05-16 19:36:36,733 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70929011 -0.70478308 -0.01162449 -0.00729482] -2025-05-16 19:36:36,776 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25034923 -0.13492776 0.34317898] -2025-05-16 19:36:36,787 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70922765 -0.70485559 -0.01117939 -0.00705326] -2025-05-16 19:36:36,826 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25030776 -0.13493471 0.34326502] -2025-05-16 19:36:36,827 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70911314 -0.7049841 -0.01054954 -0.00668436] -2025-05-16 19:36:36,855 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25029155 -0.13494284 0.34329512] -2025-05-16 19:36:36,856 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.7090425 -0.70506203 -0.01020942 -0.00648338] -2025-05-16 19:36:36,888 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25028995 -0.13493656 0.34330723] -2025-05-16 19:36:36,889 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70899204 -0.70511709 -0.00999274 -0.00635047] -2025-05-16 19:36:36,922 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25027742 -0.13495443 0.34331509] -2025-05-16 19:36:36,923 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.708911 -0.70520292 -0.0097693 -0.00621251] -2025-05-16 19:36:36,955 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25025799 -0.13495808 0.3433649 ] -2025-05-16 19:36:36,957 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70882076 -0.70530263 -0.00928232 -0.00592922] -2025-05-16 19:36:36,989 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25023388 -0.13496891 0.34342217] -2025-05-16 19:36:36,989 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.7087348 -0.70539844 -0.0087476 -0.00561369] -2025-05-16 19:36:37,031 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25021192 -0.13499309 0.34346239] -2025-05-16 19:36:37,032 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70865612 -0.70548571 -0.00825938 -0.00531058] -2025-05-16 19:36:37,060 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25019777 -0.1350141 0.34346682] -2025-05-16 19:36:37,061 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70855148 -0.70559737 -0.00785426 -0.0050468 ] -2025-05-16 19:36:37,095 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25019543 -0.13501282 0.34347363] -2025-05-16 19:36:37,099 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70850565 -0.70564688 -0.00762325 -0.00491111] -2025-05-16 19:36:37,131 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25018382 -0.13498839 0.34351619] -2025-05-16 19:36:37,132 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70839533 -0.70576522 -0.00709043 -0.00460864] -2025-05-16 19:36:37,160 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2501778 -0.13498545 0.34353443] -2025-05-16 19:36:37,161 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70835459 -0.70580909 -0.00686968 -0.0044837 ] -2025-05-16 19:36:37,190 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25014698 -0.13498794 0.34357503] -2025-05-16 19:36:37,192 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70823253 -0.70594063 -0.00616677 -0.00405943] -2025-05-16 19:36:37,223 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25014561 -0.13498581 0.34357496] -2025-05-16 19:36:37,225 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70819829 -0.70597716 -0.00598913 -0.00394492] -2025-05-16 19:36:37,256 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25013637 -0.13499981 0.34357097] -2025-05-16 19:36:37,265 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.708156 -0.70602105 -0.00586766 -0.0038644 ] -2025-05-16 19:36:37,300 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25013363 -0.13498975 0.34358457] -2025-05-16 19:36:37,303 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70807514 -0.70610809 -0.00533399 -0.00353751] -2025-05-16 19:36:37,339 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25011397 -0.13500157 0.34362851] -2025-05-16 19:36:37,341 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70787354 -0.70631846 -0.00448674 -0.00302712] -2025-05-16 19:36:37,381 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25009847 -0.1350168 0.34364207] -2025-05-16 19:36:37,383 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70777646 -0.70641889 -0.00412403 -0.00279764] -2025-05-16 19:36:37,412 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25008968 -0.13501973 0.34362537] -2025-05-16 19:36:37,415 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70775752 -0.70643887 -0.00401048 -0.00270626] -2025-05-16 19:36:37,444 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25008943 -0.13502029 0.34361886] -2025-05-16 19:36:37,447 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.7077458 -0.70645152 -0.00390021 -0.00262851] -2025-05-16 19:36:37,474 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2500919 -0.13502808 0.34362056] -2025-05-16 19:36:37,476 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70766199 -0.70653907 -0.00341461 -0.00231906] -2025-05-16 19:36:37,503 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25009279 -0.1350485 0.34363479] -2025-05-16 19:36:37,507 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70757531 -0.70662898 -0.00293003 -0.00201879] -2025-05-16 19:36:37,535 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007824 -0.13506902 0.34366647] -2025-05-16 19:36:37,536 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70739144 -0.70681649 -0.00227376 -0.00162098] -2025-05-16 19:36:37,568 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006615 -0.13507702 0.34366602] -2025-05-16 19:36:37,570 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70734504 -0.70686347 -0.00215659 -0.00154372] -2025-05-16 19:36:37,601 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005709 -0.13507201 0.34364563] -2025-05-16 19:36:37,602 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70730006 -0.70690946 -0.0019375 -0.00137762] -2025-05-16 19:36:37,640 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007246 -0.13504692 0.343644 ] -2025-05-16 19:36:37,651 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70724234 -0.70696893 -0.00144001 -0.00106471] -2025-05-16 19:36:37,682 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25009306 -0.13500513 0.34367314] -2025-05-16 19:36:37,686 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70716833 -0.7070435 -0.00122197 -0.00097627] -2025-05-16 19:36:37,715 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007199 -0.13505565 0.34366833] -2025-05-16 19:36:37,717 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.7071245 -0.70708738 -0.00121689 -0.00095369] -2025-05-16 19:36:37,748 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005614 -0.13505447 0.34364727] -2025-05-16 19:36:37,750 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70711936 -0.70709291 -0.00106164 -0.00083021] -2025-05-16 19:36:37,780 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005632 -0.1350546 0.34364723] -2025-05-16 19:36:37,782 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70712277 -0.70708947 -0.00107854 -0.00083988] -2025-05-16 19:36:37,813 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2500893 -0.1349694 0.34364685] -2025-05-16 19:36:37,814 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06975911e-01 7.07237409e-01 3.68595048e-04 4.15832268e-04] -2025-05-16 19:36:37,853 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25009418 -0.13496658 0.34365909] -2025-05-16 19:36:37,855 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06924217e-01 7.07289176e-01 2.30126842e-04 3.46206870e-04] -2025-05-16 19:36:37,884 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006985 -0.1350208 0.34366253] -2025-05-16 19:36:37,886 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06819282e-01 7.07394141e-01 -2.22915531e-05 1.75331770e-04] -2025-05-16 19:36:37,915 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005436 -0.13503445 0.34365447] -2025-05-16 19:36:37,915 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06801812e-01 7.07411598e-01 -1.51896377e-04 7.68309669e-05] -2025-05-16 19:36:37,962 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005949 -0.13503858 0.34364462] -2025-05-16 19:36:37,970 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06787823e-01 7.07425557e-01 -2.30845871e-04 1.96402218e-05] -2025-05-16 19:36:38,000 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25009891 -0.13496412 0.34364838] -2025-05-16 19:36:38,003 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06670188e-01 7.07542396e-01 -9.15260741e-04 -4.06249681e-04] -2025-05-16 19:36:38,034 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25008426 -0.13500363 0.34365904] -2025-05-16 19:36:38,035 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06549480e-01 7.07662264e-01 -1.25152501e-03 -6.21670158e-04] -2025-05-16 19:36:38,063 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007205 -0.1350277 0.343663 ] -2025-05-16 19:36:38,065 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06510969e-01 7.07700467e-01 -1.34937679e-03 -6.92309379e-04] -2025-05-16 19:36:38,098 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005531 -0.13505909 0.34365864] -2025-05-16 19:36:38,101 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70648335 0.7077279 -0.00139737 -0.00074398] -2025-05-16 19:36:38,131 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007007 -0.13504746 0.3436471 ] -2025-05-16 19:36:38,133 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70645255 0.7077578 -0.00167596 -0.00094062] -2025-05-16 19:36:38,182 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25009551 -0.13504634 0.34365987] -2025-05-16 19:36:38,183 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70632861 0.70787879 -0.00236518 -0.00138166] -2025-05-16 19:36:38,215 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25009187 -0.13505408 0.34366455] -2025-05-16 19:36:38,222 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70630004 0.7079067 -0.00249218 -0.00146637] -2025-05-16 19:36:38,252 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007082 -0.13509026 0.34367088] -2025-05-16 19:36:38,253 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70622739 0.70797835 -0.00265091 -0.00158169] -2025-05-16 19:36:38,285 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006926 -0.13509155 0.34365949] -2025-05-16 19:36:38,289 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70622683 0.70797823 -0.00276684 -0.00168235] -2025-05-16 19:36:38,322 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25008934 -0.13507525 0.34365932] -2025-05-16 19:36:38,324 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70617981 0.70802294 -0.00314146 -0.00192817] -2025-05-16 19:36:38,355 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25010306 -0.13505064 0.34366128] -2025-05-16 19:36:38,355 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70611874 0.70808259 -0.00334057 -0.00205178] -2025-05-16 19:36:38,386 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2500994 -0.13505805 0.34366402] -2025-05-16 19:36:38,386 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70607047 0.70813 -0.00344808 -0.00212192] -2025-05-16 19:36:38,417 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25008739 -0.13506936 0.34366722] -2025-05-16 19:36:38,418 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70602974 0.70816969 -0.00357672 -0.00221344] -2025-05-16 19:36:38,459 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007723 -0.13507818 0.34366228] -2025-05-16 19:36:38,461 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70600442 0.70819362 -0.00374553 -0.00235003] -2025-05-16 19:36:38,490 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25009604 -0.1350388 0.34365814] -2025-05-16 19:36:38,491 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70597763 0.70821823 -0.00401559 -0.00252954] -2025-05-16 19:36:38,520 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25010463 -0.13501832 0.34366213] -2025-05-16 19:36:38,521 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70594139 0.70825344 -0.00413312 -0.00259671] -2025-05-16 19:36:38,550 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25010178 -0.13501764 0.34366239] -2025-05-16 19:36:38,551 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70592026 0.70827434 -0.00415307 -0.00260882] -2025-05-16 19:36:38,587 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25009117 -0.13501799 0.34366599] -2025-05-16 19:36:38,588 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70586721 0.70832614 -0.00427675 -0.0026953 ] -2025-05-16 19:36:38,620 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25008322 -0.13503451 0.34365959] -2025-05-16 19:36:38,622 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70584246 0.70834903 -0.00446427 -0.00285228] -2025-05-16 19:36:38,654 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25009519 -0.1350137 0.34365622] -2025-05-16 19:36:38,656 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70585416 0.70833618 -0.00459216 -0.00294486] -2025-05-16 19:36:38,686 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25010984 -0.13500761 0.34366308] -2025-05-16 19:36:38,687 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70587919 0.70831288 -0.00440987 -0.0028259 ] -2025-05-16 19:36:38,721 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25009339 -0.13500682 0.34365859] -2025-05-16 19:36:38,722 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70586548 0.70832646 -0.0044232 -0.00282667] -2025-05-16 19:36:38,751 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25008338 -0.13503002 0.34366334] -2025-05-16 19:36:38,753 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70581886 0.70837211 -0.00451107 -0.00288667] -2025-05-16 19:36:38,784 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25008522 -0.13502201 0.34365287] -2025-05-16 19:36:38,785 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70579825 0.7083902 -0.00475406 -0.00309129] -2025-05-16 19:36:38,818 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25008262 -0.1350347 0.34365248] -2025-05-16 19:36:38,821 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70577646 0.70841165 -0.00477586 -0.00311622] -2025-05-16 19:36:38,854 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25009231 -0.13501798 0.34365002] -2025-05-16 19:36:38,854 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70580793 0.70838208 -0.0045848 -0.00299459] -2025-05-16 19:36:38,885 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25009445 -0.13500353 0.34365006] -2025-05-16 19:36:38,889 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70583068 0.70835955 -0.00457192 -0.00298136] -2025-05-16 19:36:38,922 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005218 -0.13507438 0.34364653] -2025-05-16 19:36:38,924 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70569184 0.70849487 -0.00487046 -0.00321275] -2025-05-16 19:36:38,955 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006622 -0.13505991 0.3436387 ] -2025-05-16 19:36:38,956 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70571705 0.70846996 -0.0048406 -0.00321414] -2025-05-16 19:36:38,987 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007071 -0.13505544 0.34364703] -2025-05-16 19:36:38,988 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70571869 0.70846859 -0.00481802 -0.00318878] -2025-05-16 19:36:39,019 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25008321 -0.13503786 0.3436303 ] -2025-05-16 19:36:39,021 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70570645 0.70848201 -0.00466921 -0.00313629] -2025-05-16 19:36:39,055 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007094 -0.13504483 0.34363461] -2025-05-16 19:36:39,057 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70571024 0.70847824 -0.00467646 -0.00312769] -2025-05-16 19:36:39,087 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2500688 -0.13505313 0.34363209] -2025-05-16 19:36:39,088 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70572508 0.708462 -0.00481626 -0.00324083] -2025-05-16 19:36:39,121 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007111 -0.13505739 0.34363966] -2025-05-16 19:36:39,122 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70571231 0.70847505 -0.00478655 -0.00321369] -2025-05-16 19:36:39,151 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007032 -0.13505606 0.34364239] -2025-05-16 19:36:39,152 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70571332 0.70847428 -0.00476442 -0.00319495] -2025-05-16 19:36:39,182 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007083 -0.1350554 0.34362857] -2025-05-16 19:36:39,184 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7056834 0.7085051 -0.00463843 -0.00315195] -2025-05-16 19:36:39,218 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006819 -0.13505318 0.34362508] -2025-05-16 19:36:39,221 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70568889 0.7084998 -0.00461961 -0.00314322] -2025-05-16 19:36:39,253 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006663 -0.13505419 0.34362539] -2025-05-16 19:36:39,255 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70569454 0.70849428 -0.00460777 -0.00313565] -2025-05-16 19:36:39,288 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25008203 -0.13503366 0.3436433 ] -2025-05-16 19:36:39,290 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70572329 0.70846597 -0.00457475 -0.00311223] -2025-05-16 19:36:39,323 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006846 -0.13505141 0.34362652] -2025-05-16 19:36:39,325 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70570062 0.7084888 -0.00453201 -0.00311784] -2025-05-16 19:36:39,355 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006589 -0.13505521 0.34362283] -2025-05-16 19:36:39,358 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70569722 0.70849235 -0.0045101 -0.0031114 ] -2025-05-16 19:36:39,395 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006873 -0.13505514 0.34362385] -2025-05-16 19:36:39,399 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.705702 0.70848774 -0.00449319 -0.00310317] -2025-05-16 19:36:39,427 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006465 -0.13505206 0.34361288] -2025-05-16 19:36:39,432 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70570435 0.70848629 -0.0043685 -0.0030751 ] -2025-05-16 19:36:39,463 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006312 -0.13505431 0.3436255 ] -2025-05-16 19:36:39,464 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70570812 0.70848261 -0.00437137 -0.00305488] -2025-05-16 19:36:39,490 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006253 -0.13505641 0.3436263 ] -2025-05-16 19:36:39,490 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70571196 0.70847892 -0.00435626 -0.00304558] -2025-05-16 19:36:39,519 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006213 -0.13505737 0.34362693] -2025-05-16 19:36:39,520 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70571874 0.7084723 -0.00434163 -0.00303491] -2025-05-16 19:36:39,547 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006407 -0.13505867 0.34362701] -2025-05-16 19:36:39,548 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70572585 0.70846548 -0.00431082 -0.00301774] -2025-05-16 19:36:39,575 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005601 -0.13505781 0.34362116] -2025-05-16 19:36:39,580 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70572702 0.70846569 -0.00413132 -0.00294425] -2025-05-16 19:36:39,607 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2500574 -0.13505348 0.34362374] -2025-05-16 19:36:39,608 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70574216 0.70845064 -0.00413015 -0.00293809] -2025-05-16 19:36:39,635 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005789 -0.13505361 0.34362482] -2025-05-16 19:36:39,637 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70574539 0.70844752 -0.00411936 -0.00293151] -2025-05-16 19:36:39,669 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005844 -0.13505466 0.34362423] -2025-05-16 19:36:39,671 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70575277 0.70844027 -0.00410604 -0.00292429] -2025-05-16 19:36:39,705 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006095 -0.13505405 0.34362689] -2025-05-16 19:36:39,705 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7057595 0.70843366 -0.00409569 -0.00291522] -2025-05-16 19:36:39,735 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006115 -0.13505455 0.34362626] -2025-05-16 19:36:39,736 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70576332 0.70842995 -0.00408372 -0.00290853] -2025-05-16 19:36:39,769 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006094 -0.13505476 0.34362712] -2025-05-16 19:36:39,771 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70576859 0.7084248 -0.00407385 -0.00289907] -2025-05-16 19:36:39,801 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006033 -0.13505614 0.34362848] -2025-05-16 19:36:39,802 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70577081 0.70842267 -0.00406471 -0.00289127] -2025-05-16 19:36:39,834 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005918 -0.13505639 0.34362714] -2025-05-16 19:36:39,837 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70577562 0.70841798 -0.00405264 -0.00288349] -2025-05-16 19:36:39,872 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005941 -0.13505538 0.34362594] -2025-05-16 19:36:39,874 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70577926 0.70841445 -0.00404198 -0.00287578] -2025-05-16 19:36:39,904 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006125 -0.13505571 0.34362585] -2025-05-16 19:36:39,905 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70578233 0.70841148 -0.00403254 -0.00286856] -2025-05-16 19:36:39,937 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006084 -0.13505366 0.34362507] -2025-05-16 19:36:39,938 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70578586 0.70840804 -0.00402296 -0.00286132] -2025-05-16 19:36:39,969 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006048 -0.13505325 0.34362477] -2025-05-16 19:36:39,971 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70578836 0.70840563 -0.00401472 -0.00285413] -2025-05-16 19:36:40,003 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2500598 -0.13505227 0.34362612] -2025-05-16 19:36:40,007 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7057916 0.70840248 -0.00400603 -0.00284645] -2025-05-16 19:36:40,037 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005931 -0.13505239 0.34362604] -2025-05-16 19:36:40,039 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70579464 0.70839952 -0.00399703 -0.0028392 ] -2025-05-16 19:36:40,067 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005871 -0.13505138 0.34362665] -2025-05-16 19:36:40,068 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70579664 0.70839759 -0.003991 -0.00283264] -2025-05-16 19:36:40,095 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005808 -0.13504972 0.34362584] -2025-05-16 19:36:40,102 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70579872 0.70839558 -0.0039836 -0.00282754] -2025-05-16 19:36:40,141 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005804 -0.13504879 0.3436255 ] -2025-05-16 19:36:40,143 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70580127 0.7083931 -0.00397709 -0.00282184] -2025-05-16 19:36:40,175 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005762 -0.13505017 0.34362567] -2025-05-16 19:36:40,178 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70580321 0.70839123 -0.00397075 -0.00281444] -2025-05-16 19:36:40,211 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005746 -0.13504953 0.34362528] -2025-05-16 19:36:40,215 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70580566 0.70838885 -0.00396484 -0.00280926] -2025-05-16 19:36:40,252 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005762 -0.13504838 0.34362561] -2025-05-16 19:36:40,255 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70580905 0.70838552 -0.00395984 -0.00280409] -2025-05-16 19:36:40,292 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005723 -0.13504796 0.34362502] -2025-05-16 19:36:40,293 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70581122 0.70838342 -0.0039531 -0.00279856] -2025-05-16 19:36:40,326 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2500575 -0.13504901 0.34362494] -2025-05-16 19:36:40,329 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7058133 0.70838139 -0.0039474 -0.00279378] -2025-05-16 19:36:40,368 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25009408 -0.1349177 0.34361971] -2025-05-16 19:36:40,373 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70611128 0.70808796 -0.00347763 -0.00249215] -2025-05-16 19:36:40,409 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005496 -0.13501486 0.3436235 ] -2025-05-16 19:36:40,414 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70598694 0.70821177 -0.00350442 -0.00249899] -2025-05-16 19:36:40,452 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005246 -0.13502634 0.34362305] -2025-05-16 19:36:40,460 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70597199 0.70822669 -0.00349941 -0.00250091] -2025-05-16 19:36:40,491 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006509 -0.13501409 0.34362797] -2025-05-16 19:36:40,502 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70599517 0.70820411 -0.0034264 -0.00245412] -2025-05-16 19:36:40,539 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007723 -0.1349604 0.34361617] -2025-05-16 19:36:40,540 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70613264 0.70806885 -0.00314857 -0.00229981] -2025-05-16 19:36:40,570 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006649 -0.13497967 0.34360675] -2025-05-16 19:36:40,571 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70622822 0.70797459 -0.00296715 -0.00220944] -2025-05-16 19:36:40,603 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005165 -0.13501767 0.34361294] -2025-05-16 19:36:40,604 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70620374 0.70799956 -0.00287931 -0.00214609] -2025-05-16 19:36:40,635 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005232 -0.1350272 0.34361177] -2025-05-16 19:36:40,636 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7061896 0.70801379 -0.00285507 -0.00213596] -2025-05-16 19:36:40,668 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005898 -0.13502328 0.34362475] -2025-05-16 19:36:40,669 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70620655 0.70799749 -0.00276054 -0.00206143] -2025-05-16 19:36:40,705 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006567 -0.13500442 0.34360918] -2025-05-16 19:36:40,707 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70633802 0.7078679 -0.00244727 -0.00190731] -2025-05-16 19:36:40,745 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005386 -0.13502785 0.34361075] -2025-05-16 19:36:40,747 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70637279 0.7078337 -0.00234934 -0.00184943] -2025-05-16 19:36:40,807 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005128 -0.13504378 0.34361463] -2025-05-16 19:36:40,810 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7064093 0.7077982 -0.00215342 -0.00172619] -2025-05-16 19:36:40,843 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005235 -0.13505613 0.34362817] -2025-05-16 19:36:40,850 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70641724 0.70779096 -0.00200142 -0.00162189] -2025-05-16 19:36:40,882 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005216 -0.13505823 0.34362059] -2025-05-16 19:36:40,883 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70647232 0.70773633 -0.00190952 -0.00158421] -2025-05-16 19:36:40,923 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005925 -0.13505432 0.34362669] -2025-05-16 19:36:40,925 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70648121 0.70772753 -0.00189398 -0.00156895] -2025-05-16 19:36:40,969 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2500565 -0.13506661 0.34362337] -2025-05-16 19:36:40,971 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70649498 0.70771431 -0.00175269 -0.00149308] -2025-05-16 19:36:41,003 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004793 -0.13509285 0.34363465] -2025-05-16 19:36:41,005 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70649519 0.70771484 -0.00155563 -0.00135568] -2025-05-16 19:36:41,036 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005085 -0.13507791 0.3436356 ] -2025-05-16 19:36:41,037 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.7065067 0.70770337 -0.0015541 -0.00134819] -2025-05-16 19:36:41,069 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005368 -0.13507616 0.3436376 ] -2025-05-16 19:36:41,072 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70650781 0.70770226 -0.00155323 -0.00134894] -2025-05-16 19:36:41,106 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2500816 -0.13505954 0.34362896] -2025-05-16 19:36:41,107 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70662602 0.70758499 -0.00128773 -0.00122182] -2025-05-16 19:36:41,152 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006586 -0.13506551 0.34364289] -2025-05-16 19:36:41,154 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70666483 0.70754674 -0.00112026 -0.00108269] -2025-05-16 19:36:41,189 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006166 -0.13507634 0.34364512] -2025-05-16 19:36:41,190 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70664904 0.70756252 -0.0011168 -0.00108016] -2025-05-16 19:36:41,224 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006506 -0.13508649 0.3436473 ] -2025-05-16 19:36:41,225 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70664574 0.70756586 -0.00109423 -0.00107201] -2025-05-16 19:36:41,257 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25008201 -0.13507492 0.34363269] -2025-05-16 19:36:41,266 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70671081 0.70750123 -0.00091182 -0.00100288] -2025-05-16 19:36:41,306 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007779 -0.1350745 0.34363413] -2025-05-16 19:36:41,308 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06766894e-01 7.07445623e-01 -7.01282327e-04 -8.69519823e-04] -2025-05-16 19:36:41,387 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006947 -0.13508327 0.34364453] -2025-05-16 19:36:41,389 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06790120e-01 7.07422751e-01 -5.02350511e-04 -7.24637855e-04] -2025-05-16 19:36:41,421 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25008138 -0.13509159 0.34364073] -2025-05-16 19:36:41,422 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06820653e-01 7.07392346e-01 -3.96750884e-04 -6.90514236e-04] -2025-05-16 19:36:41,558 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007615 -0.13506799 0.34364176] -2025-05-16 19:36:41,562 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06887145e-01 7.07326194e-01 -6.00060839e-05 -4.63736850e-04] -2025-05-16 19:36:41,597 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007457 -0.13506366 0.3436452 ] -2025-05-16 19:36:41,601 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06887340e-01 7.07326005e-01 -6.53427743e-05 -4.54811037e-04] -2025-05-16 19:36:41,633 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007567 -0.1350635 0.34364699] -2025-05-16 19:36:41,635 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06888260e-01 7.07325086e-01 -6.22436587e-05 -4.54795823e-04] -2025-05-16 19:36:41,671 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007662 -0.13508273 0.34365089] -2025-05-16 19:36:41,675 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06871838e-01 7.07341499e-01 -5.28278650e-05 -4.52567789e-04] -2025-05-16 19:36:41,716 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006089 -0.13506732 0.34364385] -2025-05-16 19:36:41,722 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06894697e-01 7.07318678e-01 3.75469436e-04 -1.84883178e-04] -2025-05-16 19:36:41,758 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006735 -0.13504193 0.34364514] -2025-05-16 19:36:41,764 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06923248e-01 7.07290147e-01 3.75358469e-04 -1.70192361e-04] -2025-05-16 19:36:41,792 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006941 -0.13504399 0.34364608] -2025-05-16 19:36:41,793 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06925038e-01 7.07288360e-01 3.68878739e-04 -1.74322926e-04] -2025-05-16 19:36:41,823 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007465 -0.1350463 0.34365329] -2025-05-16 19:36:41,825 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06932974e-01 7.07280432e-01 3.61403058e-04 -1.71287918e-04] -2025-05-16 19:36:41,855 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007383 -0.13505523 0.3436599 ] -2025-05-16 19:36:41,857 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06921263e-01 7.07292127e-01 3.91885307e-04 -1.44612683e-04] -2025-05-16 19:36:41,889 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005708 -0.13504915 0.34364946] -2025-05-16 19:36:41,891 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06909112e-01 7.07303975e-01 7.66292064e-04 8.51122186e-05] -2025-05-16 19:36:41,926 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005513 -0.13501338 0.34364619] -2025-05-16 19:36:41,934 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06981737e-01 7.07231323e-01 8.13407843e-04 1.30679619e-04] -2025-05-16 19:36:41,966 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007131 -0.13501426 0.34366804] -2025-05-16 19:36:41,974 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06999995e-01 7.07213093e-01 7.92591888e-04 1.43831716e-04] -2025-05-16 19:36:42,006 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006996 -0.13502247 0.34366534] -2025-05-16 19:36:42,007 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06993715e-01 7.07219373e-01 7.91671553e-04 1.34911784e-04] -2025-05-16 19:36:42,040 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005523 -0.13502739 0.34365167] -2025-05-16 19:36:42,042 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06959153e-01 7.07253552e-01 1.04575676e-03 2.74768271e-04] -2025-05-16 19:36:42,076 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004565 -0.13501393 0.34364225] -2025-05-16 19:36:42,086 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.06987425e-01 7.07224968e-01 1.21640978e-03 3.82719975e-04] -2025-05-16 19:36:42,121 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005068 -0.13498825 0.34364451] -2025-05-16 19:36:42,122 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07040477e-01 7.07171757e-01 1.29252786e-03 4.47051496e-04] -2025-05-16 19:36:42,152 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005966 -0.13498525 0.34366011] -2025-05-16 19:36:42,154 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07090025e-01 7.07122158e-01 1.31050116e-03 4.82657576e-04] -2025-05-16 19:36:42,189 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005769 -0.13499329 0.34365998] -2025-05-16 19:36:42,195 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07065506e-01 7.07146424e-01 1.41816328e-03 5.42516649e-04] -2025-05-16 19:36:42,231 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2500449 -0.13499722 0.34364174] -2025-05-16 19:36:42,235 - 测试日志 - INFO - log.py:106 - 输入姿态:[-7.07051979e-01 7.07159401e-01 1.62960731e-03 6.50952133e-04] -2025-05-16 19:36:42,273 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2500437 -0.13497892 0.34363814] -2025-05-16 19:36:42,274 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70709635 0.70711461 0.00176754 0.00074342] -2025-05-16 19:36:42,318 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004898 -0.13496542 0.34364696] -2025-05-16 19:36:42,320 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70716178 -0.70704898 -0.00182179 -0.00079973] -2025-05-16 19:36:42,347 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005275 -0.13496089 0.34365509] -2025-05-16 19:36:42,349 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70718362 -0.70702713 -0.0018166 -0.00081109] -2025-05-16 19:36:42,391 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004699 -0.13498312 0.34364472] -2025-05-16 19:36:42,399 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70715295 -0.70705728 -0.00198086 -0.00088556] -2025-05-16 19:36:42,435 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004289 -0.13498685 0.3436371 ] -2025-05-16 19:36:42,436 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70714206 -0.70706809 -0.00200971 -0.00089259] -2025-05-16 19:36:42,473 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005635 -0.13496932 0.34365789] -2025-05-16 19:36:42,474 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70722331 -0.70698672 -0.0020239 -0.00093894] -2025-05-16 19:36:42,517 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005538 -0.13497031 0.34365737] -2025-05-16 19:36:42,519 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70723068 -0.7069793 -0.00203648 -0.00094554] -2025-05-16 19:36:42,553 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004449 -0.13501593 0.34364397] -2025-05-16 19:36:42,555 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70716573 -0.70704377 -0.00217962 -0.00099458] -2025-05-16 19:36:42,590 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004826 -0.13500165 0.34364568] -2025-05-16 19:36:42,591 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70719287 -0.70701663 -0.00217529 -0.00100124] -2025-05-16 19:36:42,626 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006244 -0.13498781 0.34366462] -2025-05-16 19:36:42,629 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.707268 -0.70694139 -0.00218539 -0.00103602] -2025-05-16 19:36:42,661 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006295 -0.13498199 0.34366181] -2025-05-16 19:36:42,663 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70727229 -0.70693711 -0.00218036 -0.00103386] -2025-05-16 19:36:42,691 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005769 -0.13499909 0.34365567] -2025-05-16 19:36:42,694 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70724436 -0.70696497 -0.00221033 -0.0010348 ] -2025-05-16 19:36:42,724 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004515 -0.13503531 0.34364048] -2025-05-16 19:36:42,726 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70720709 -0.70700188 -0.00231227 -0.00106748] -2025-05-16 19:36:42,772 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006337 -0.13501809 0.34366394] -2025-05-16 19:36:42,773 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70727652 -0.70693242 -0.00230046 -0.0010944 ] -2025-05-16 19:36:42,803 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006183 -0.13501689 0.34366096] -2025-05-16 19:36:42,804 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70728848 -0.70692047 -0.00229373 -0.00109071] -2025-05-16 19:36:42,836 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006141 -0.13501386 0.34365653] -2025-05-16 19:36:42,838 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70728737 -0.70692154 -0.00230794 -0.00109175] -2025-05-16 19:36:42,868 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005596 -0.13502148 0.34364812] -2025-05-16 19:36:42,870 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70726763 -0.70694119 -0.00233594 -0.0010935 ] -2025-05-16 19:36:42,903 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005264 -0.13503888 0.34364287] -2025-05-16 19:36:42,905 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70724868 -0.70695997 -0.00238312 -0.00110785] -2025-05-16 19:36:42,936 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006159 -0.1350439 0.3436534 ] -2025-05-16 19:36:42,938 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70728245 -0.70692607 -0.00240597 -0.00113253] -2025-05-16 19:36:42,974 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2500666 -0.13503728 0.34365615] -2025-05-16 19:36:42,975 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70730149 -0.70690698 -0.00241349 -0.00114346] -2025-05-16 19:36:43,005 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006462 -0.13503482 0.34365516] -2025-05-16 19:36:43,007 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70730816 -0.70690023 -0.00242797 -0.00115527] -2025-05-16 19:36:43,035 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006446 -0.13503529 0.34365175] -2025-05-16 19:36:43,037 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70730306 -0.70690532 -0.00243276 -0.00114904] -2025-05-16 19:36:43,072 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005949 -0.13505729 0.3436405 ] -2025-05-16 19:36:43,075 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.7072761 -0.70693212 -0.00248464 -0.00115324] -2025-05-16 19:36:43,110 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006447 -0.13505864 0.34364299] -2025-05-16 19:36:43,119 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.7072983 -0.7069098 -0.00250724 -0.00116876] -2025-05-16 19:36:43,149 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006584 -0.1350542 0.34364709] -2025-05-16 19:36:43,151 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70730381 -0.70690427 -0.00250558 -0.00117898] -2025-05-16 19:36:43,186 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006444 -0.13505194 0.34364701] -2025-05-16 19:36:43,189 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70730533 -0.70690279 -0.00249783 -0.00117706] -2025-05-16 19:36:43,223 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006101 -0.1350567 0.34363951] -2025-05-16 19:36:43,225 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70728802 -0.70692004 -0.00251535 -0.0011744 ] -2025-05-16 19:36:43,257 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006195 -0.13505566 0.34363961] -2025-05-16 19:36:43,266 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70728811 -0.70691997 -0.00251161 -0.0011727 ] -2025-05-16 19:36:43,296 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006218 -0.13505669 0.34363928] -2025-05-16 19:36:43,305 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70728627 -0.70692184 -0.00250574 -0.00116932] -2025-05-16 19:36:43,338 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006395 -0.13505656 0.34363874] -2025-05-16 19:36:43,340 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.7072854 -0.70692273 -0.00250129 -0.00116546] -2025-05-16 19:36:43,373 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006283 -0.13505672 0.34363851] -2025-05-16 19:36:43,382 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70728428 -0.70692387 -0.00249545 -0.00116386] -2025-05-16 19:36:43,426 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006086 -0.13505667 0.34363897] -2025-05-16 19:36:43,427 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70728355 -0.70692463 -0.00248846 -0.00116317] -2025-05-16 19:36:43,462 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005902 -0.1350569 0.34363858] -2025-05-16 19:36:43,464 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70728214 -0.70692607 -0.00248171 -0.00116151] -2025-05-16 19:36:43,498 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005765 -0.13505619 0.34363883] -2025-05-16 19:36:43,500 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70728112 -0.70692712 -0.00247381 -0.00115963] -2025-05-16 19:36:43,528 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005563 -0.13505616 0.34363827] -2025-05-16 19:36:43,530 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70727957 -0.70692869 -0.00246724 -0.00115698] -2025-05-16 19:36:43,565 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005462 -0.1350563 0.34363868] -2025-05-16 19:36:43,566 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70727858 -0.70692972 -0.00246012 -0.00115564] -2025-05-16 19:36:43,599 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2500536 -0.13505682 0.3436381 ] -2025-05-16 19:36:43,600 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70727678 -0.70693155 -0.00245323 -0.00115391] -2025-05-16 19:36:43,630 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005263 -0.13505573 0.34363793] -2025-05-16 19:36:43,631 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70727549 -0.70693286 -0.00244661 -0.0011514 ] -2025-05-16 19:36:43,659 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005215 -0.1350553 0.34363787] -2025-05-16 19:36:43,661 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70727465 -0.70693373 -0.00243959 -0.00114932] -2025-05-16 19:36:43,695 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005168 -0.13505552 0.34363877] -2025-05-16 19:36:43,696 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70727364 -0.70693477 -0.0024321 -0.00114891] -2025-05-16 19:36:43,734 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005113 -0.13505562 0.3436387 ] -2025-05-16 19:36:43,736 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70727231 -0.70693612 -0.00242591 -0.00114724] -2025-05-16 19:36:43,768 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005048 -0.13505637 0.34363848] -2025-05-16 19:36:43,769 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70727115 -0.70693731 -0.00241962 -0.00114555] -2025-05-16 19:36:43,805 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005016 -0.13505473 0.34363819] -2025-05-16 19:36:43,807 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70726949 -0.70693899 -0.00241355 -0.00114247] -2025-05-16 19:36:43,839 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005025 -0.13505253 0.34363827] -2025-05-16 19:36:43,852 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70726894 -0.70693958 -0.00240637 -0.00113968] -2025-05-16 19:36:43,880 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005005 -0.13505233 0.3436385 ] -2025-05-16 19:36:43,890 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70726765 -0.70694089 -0.00239998 -0.00113831] -2025-05-16 19:36:43,928 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004936 -0.13505352 0.3436385 ] -2025-05-16 19:36:43,930 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70726643 -0.70694213 -0.00239401 -0.00113651] -2025-05-16 19:36:43,959 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2500272 -0.13505635 0.34362338] -2025-05-16 19:36:43,960 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70725976 -0.70694892 -0.00236407 -0.00112675] -2025-05-16 19:36:43,988 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25003893 -0.13504721 0.34364193] -2025-05-16 19:36:43,992 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70727451 -0.7069342 -0.00234068 -0.00114926] -2025-05-16 19:36:44,023 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004149 -0.13504875 0.34364199] -2025-05-16 19:36:44,024 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70727314 -0.7069356 -0.00233613 -0.00114639] -2025-05-16 19:36:44,059 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004211 -0.13504917 0.34364149] -2025-05-16 19:36:44,061 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70727274 -0.70693602 -0.00233196 -0.00114334] -2025-05-16 19:36:44,092 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004016 -0.13504967 0.34363908] -2025-05-16 19:36:44,093 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70727327 -0.70693551 -0.0023248 -0.00113993] -2025-05-16 19:36:44,124 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25003087 -0.13504204 0.34364397] -2025-05-16 19:36:44,127 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70729103 -0.70691786 -0.00228227 -0.00115583] -2025-05-16 19:36:44,173 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2500404 -0.13503892 0.34365285] -2025-05-16 19:36:44,178 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70729748 -0.70691144 -0.00226634 -0.00116211] -2025-05-16 19:36:44,217 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004186 -0.13504077 0.34365034] -2025-05-16 19:36:44,219 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70729598 -0.70691296 -0.00226495 -0.00115566] -2025-05-16 19:36:44,247 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004325 -0.13504216 0.34364966] -2025-05-16 19:36:44,249 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70729347 -0.70691549 -0.00225992 -0.00115007] -2025-05-16 19:36:44,276 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004457 -0.13504325 0.34364833] -2025-05-16 19:36:44,278 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.7072917 -0.70691729 -0.00225573 -0.0011444 ] -2025-05-16 19:36:44,309 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004774 -0.135035 0.34366272] -2025-05-16 19:36:44,311 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70733104 -0.7068782 -0.00216377 -0.00115254] -2025-05-16 19:36:44,348 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005394 -0.1350419 0.34366309] -2025-05-16 19:36:44,356 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70732622 -0.70688311 -0.00214233 -0.00113981] -2025-05-16 19:36:44,388 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005263 -0.13504436 0.34366117] -2025-05-16 19:36:44,389 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70731272 -0.70689663 -0.00213891 -0.00113311] -2025-05-16 19:36:44,420 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005232 -0.13504774 0.34366244] -2025-05-16 19:36:44,421 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70730158 -0.7069078 -0.0021353 -0.00112955] -2025-05-16 19:36:44,456 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2500612 -0.13503365 0.34366763] -2025-05-16 19:36:44,461 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70732509 -0.70688458 -0.00204141 -0.00111315] -2025-05-16 19:36:44,488 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005857 -0.13503507 0.34367128] -2025-05-16 19:36:44,489 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70731706 -0.70689264 -0.00203344 -0.00111073] -2025-05-16 19:36:44,520 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005748 -0.1350432 0.34366705] -2025-05-16 19:36:44,531 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70729555 -0.70691424 -0.00201813 -0.00109186] -2025-05-16 19:36:44,566 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005725 -0.13504181 0.34366735] -2025-05-16 19:36:44,569 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.7072885 -0.70692132 -0.00201025 -0.00108824] -2025-05-16 19:36:44,600 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006763 -0.13502152 0.34366975] -2025-05-16 19:36:44,602 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70731913 -0.70689093 -0.00192771 -0.00106556] -2025-05-16 19:36:44,632 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006591 -0.13504041 0.34367139] -2025-05-16 19:36:44,633 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70726734 -0.70694287 -0.00189917 -0.00104227] -2025-05-16 19:36:44,666 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006511 -0.13504107 0.34366961] -2025-05-16 19:36:44,667 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70726377 -0.70694644 -0.00189931 -0.00103855] -2025-05-16 19:36:44,698 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2500637 -0.13504291 0.3436699 ] -2025-05-16 19:36:44,700 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70725297 -0.70695728 -0.00189226 -0.00103093] -2025-05-16 19:36:44,735 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007015 -0.13503011 0.34369126] -2025-05-16 19:36:44,737 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70723058 -0.70698006 -0.00175538 -0.0010075 ] -2025-05-16 19:36:44,763 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007295 -0.13503422 0.34367208] -2025-05-16 19:36:44,765 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70722573 -0.70698492 -0.00177218 -0.00097952] -2025-05-16 19:36:44,796 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007165 -0.13503592 0.34367118] -2025-05-16 19:36:44,798 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70722434 -0.70698632 -0.00176956 -0.00097722] -2025-05-16 19:36:44,833 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007151 -0.1350361 0.34367084] -2025-05-16 19:36:44,835 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70722323 -0.70698744 -0.00176638 -0.00097459] -2025-05-16 19:36:44,870 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007543 -0.13503018 0.34366793] -2025-05-16 19:36:44,871 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70716796 -0.70704309 -0.00164895 -0.00091079] -2025-05-16 19:36:44,907 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007529 -0.13502979 0.34366973] -2025-05-16 19:36:44,910 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70716664 -0.70704442 -0.00164514 -0.00090872] -2025-05-16 19:36:44,943 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007416 -0.13503214 0.34367021] -2025-05-16 19:36:44,945 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70716586 -0.70704521 -0.00164023 -0.00090498] -2025-05-16 19:36:44,979 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007455 -0.13503296 0.34367143] -2025-05-16 19:36:45,002 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70716499 -0.70704608 -0.0016403 -0.00090374] -2025-05-16 19:36:45,038 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2500749 -0.13503465 0.34367097] -2025-05-16 19:36:45,039 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70716606 -0.70704503 -0.00163736 -0.00089924] -2025-05-16 19:36:45,073 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007549 -0.13503655 0.34367016] -2025-05-16 19:36:45,074 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70716551 -0.70704558 -0.00163776 -0.00089745] -2025-05-16 19:36:45,123 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007531 -0.13503606 0.34367065] -2025-05-16 19:36:45,125 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70716538 -0.70704572 -0.00163646 -0.0008942 ] -2025-05-16 19:36:45,157 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007438 -0.13503628 0.34367072] -2025-05-16 19:36:45,159 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70716541 -0.70704569 -0.00163434 -0.00089129] -2025-05-16 19:36:45,196 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007527 -0.1350348 0.34367011] -2025-05-16 19:36:45,197 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70716631 -0.7070448 -0.0016332 -0.00088889] -2025-05-16 19:36:45,235 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2500737 -0.13503481 0.34366963] -2025-05-16 19:36:45,239 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70716601 -0.7070451 -0.0016315 -0.00088694] -2025-05-16 19:36:45,272 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.2500723 -0.13503481 0.34366888] -2025-05-16 19:36:45,274 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70716602 -0.7070451 -0.00163014 -0.00088561] -2025-05-16 19:36:45,306 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007179 -0.1350361 0.34366813] -2025-05-16 19:36:45,308 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70716604 -0.70704509 -0.00162945 -0.00088444] -2025-05-16 19:36:45,340 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007204 -0.13503579 0.34366753] -2025-05-16 19:36:45,342 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70716677 -0.70704436 -0.00162958 -0.00088247] -2025-05-16 19:36:45,382 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25007136 -0.13503673 0.34366767] -2025-05-16 19:36:45,383 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70716686 -0.70704427 -0.00162764 -0.00088289] -2025-05-16 19:36:45,416 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006949 -0.13503681 0.34366687] -2025-05-16 19:36:45,417 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70716673 -0.70704441 -0.00162711 -0.0008829 ] -2025-05-16 19:36:45,447 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006805 -0.1350366 0.34366688] -2025-05-16 19:36:45,448 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70716761 -0.70704353 -0.00162459 -0.00088258] -2025-05-16 19:36:45,481 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006666 -0.13503687 0.34366672] -2025-05-16 19:36:45,482 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.7071677 -0.70704344 -0.0016232 -0.00088317] -2025-05-16 19:36:45,513 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006523 -0.13503694 0.34366651] -2025-05-16 19:36:45,514 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70716762 -0.70704353 -0.0016209 -0.00088301] -2025-05-16 19:36:45,552 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006511 -0.13503678 0.34366589] -2025-05-16 19:36:45,554 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.7071682 -0.70704295 -0.0016199 -0.00088197] -2025-05-16 19:36:45,586 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006513 -0.13503706 0.34366637] -2025-05-16 19:36:45,589 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70716864 -0.70704251 -0.00161814 -0.00088268] -2025-05-16 19:36:45,631 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25006418 -0.13503843 0.34366622] -2025-05-16 19:36:45,632 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70716857 -0.70704258 -0.00161742 -0.0008836 ] -2025-05-16 19:36:45,671 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25002814 -0.13506973 0.34364926] -2025-05-16 19:36:45,672 - 测试日志 - INFO - log.py:106 - 输入姿态:[-0.70710479 0.70710669 0.00151203 0.00081255] -2025-05-16 19:36:45,710 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005545 -0.13503617 0.34365451] -2025-05-16 19:36:45,713 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70713466 -0.70707692 -0.00147154 -0.00079002] -2025-05-16 19:36:45,739 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005896 -0.13503622 0.34365406] -2025-05-16 19:36:45,740 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70713525 -0.70707635 -0.00147266 -0.00078579] -2025-05-16 19:36:45,776 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005944 -0.13503837 0.34365806] -2025-05-16 19:36:45,779 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70713299 -0.70707861 -0.00147029 -0.00078568] -2025-05-16 19:36:45,818 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25005046 -0.13503947 0.34365327] -2025-05-16 19:36:45,824 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70712567 -0.70708596 -0.00145595 -0.00077534] -2025-05-16 19:36:45,857 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004013 -0.13505017 0.34365041] -2025-05-16 19:36:45,858 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70710765 -0.70710406 -0.001429 -0.00075677] -2025-05-16 19:36:45,890 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004151 -0.13504889 0.34365074] -2025-05-16 19:36:45,893 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70710769 -0.70710402 -0.00142955 -0.00075551] -2025-05-16 19:36:45,925 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004255 -0.13504793 0.34365099] -2025-05-16 19:36:45,927 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70710773 -0.70710398 -0.00143009 -0.00075428] -2025-05-16 19:36:45,960 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004333 -0.13504722 0.34365118] -2025-05-16 19:36:45,962 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70710777 -0.70710394 -0.00143062 -0.00075308] -2025-05-16 19:36:45,996 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004392 -0.13504668 0.34365131] -2025-05-16 19:36:45,998 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70710781 -0.70710391 -0.00143113 -0.00075192] -2025-05-16 19:36:46,034 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004436 -0.13504627 0.34365142] -2025-05-16 19:36:46,040 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70710785 -0.70710387 -0.00143163 -0.00075078] -2025-05-16 19:36:46,076 - 测试日志 - INFO - log.py:106 - 输入位置:[ 0.25004469 -0.13504597 0.3436515 ] -2025-05-16 19:36:46,080 - 测试日志 - INFO - log.py:106 - 输入姿态:[ 0.70710788 -0.70710383 -0.00143211 -0.00074967] -2025-05-16 19:42:59,029 - 测试日志 - INFO - log.py:106 - 切换到finger_head按摩头 -2025-05-16 19:43:02,548 - 测试日志 - INFO - log.py:106 - 机械臂测量线程启动 -2025-05-16 19:43:02,564 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999983 -0.13500011 0.34431359] -2025-05-16 19:43:02,569 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999924e+02 -5.49316028e-05 -8.99999466e+01] -2025-05-16 19:43:02,572 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000031 -0.13499976 0.34433923] -2025-05-16 19:43:02,575 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159265e+00 -4.79368984e-07 -1.57079446e+00] -2025-05-16 19:43:02,580 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999995 -0.13499978 0.34429298] -2025-05-16 19:43:02,581 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999924e+02 -5.49316028e-05 -8.99999466e+01] -2025-05-16 19:43:02,583 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999983 -0.13500012 0.34433908] -2025-05-16 19:43:02,584 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 -4.79368317e-07 -1.57079486e+00] -2025-05-16 19:43:02,597 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999983 -0.13500013 0.34427778] -2025-05-16 19:43:02,600 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999924e+02 -5.49316028e-05 -8.99999466e+01] -2025-05-16 19:43:02,609 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000024 -0.135 0.34433942] -2025-05-16 19:43:02,612 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 -4.79369460e-07 -1.57079539e+00] -2025-05-16 19:43:02,617 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000023 -0.13500001 0.34426735] -2025-05-16 19:43:02,620 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999924e+02 -5.49316028e-05 -8.99999466e+01] -2025-05-16 19:43:02,622 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999985 -0.13500011 0.34433936] -2025-05-16 19:43:02,624 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159265e+00 -9.58737967e-07 -1.57079486e+00] -2025-05-16 19:43:02,641 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999983 -0.13500011 0.34425953] -2025-05-16 19:43:02,643 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999924e+02 -5.49316028e-05 -8.99999466e+01] -2025-05-16 19:43:02,645 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999977 -0.13500023 0.34433893] -2025-05-16 19:43:02,647 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 -4.79368761e-07 -1.57079633e+00] -2025-05-16 19:43:02,661 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999994 -0.13499989 0.34425224] -2025-05-16 19:43:02,666 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999924e+02 -5.49316028e-05 -8.99999466e+01] -2025-05-16 19:43:02,668 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999995 -0.135 0.34433926] -2025-05-16 19:43:02,672 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 -4.79369237e-07 -1.57079539e+00] -2025-05-16 19:43:02,680 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999982 -0.1349999 0.3442472 ] -2025-05-16 19:43:02,683 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999924e+02 -5.49316028e-05 -8.99999466e+01] -2025-05-16 19:43:02,689 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999962 -0.13500011 0.34433878] -2025-05-16 19:43:02,694 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159159e+00 -9.58737078e-07 -1.57079486e+00] -2025-05-16 19:43:02,701 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000028 -0.1349999 0.34424348] -2025-05-16 19:43:02,704 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999924e+02 -5.49316028e-05 -8.99999466e+01] -2025-05-16 19:43:02,708 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999991 -0.13499988 0.3443392 ] -2025-05-16 19:43:02,709 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159265e+00 -4.79368983e-07 -1.57079486e+00] -2025-05-16 19:43:02,718 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999989 -0.1349999 0.34424037] -2025-05-16 19:43:02,720 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999924e+02 -5.49316028e-05 -8.99999466e+01] -2025-05-16 19:43:02,722 - 测试日志 - INFO - log.py:106 - position current:[ 0.25 -0.13500012 0.34433902] -2025-05-16 19:43:02,727 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 -4.79368539e-07 -1.57079539e+00] -2025-05-16 19:43:02,738 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999998 -0.13500014 0.34423861] -2025-05-16 19:43:02,739 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999924e+02 -5.49316028e-05 -8.99999466e+01] -2025-05-16 19:43:02,741 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999995 -0.135 0.34433926] -2025-05-16 19:43:02,743 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 -4.79369460e-07 -1.57079486e+00] -2025-05-16 19:43:02,760 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999982 -0.13500024 0.34423648] -2025-05-16 19:43:02,762 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999924e+02 -5.49316028e-05 -8.99999466e+01] -2025-05-16 19:43:02,769 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999989 -0.135 0.34433942] -2025-05-16 19:43:02,773 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 -2.29372077e-13 -1.57079579e+00] -2025-05-16 19:43:02,780 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999988 -0.13500001 0.34423577] -2025-05-16 19:43:02,781 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999924e+02 -5.49316028e-05 -8.99999466e+01] -2025-05-16 19:43:02,783 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000006 -0.13499988 0.34433917] -2025-05-16 19:43:02,794 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 2.29594121e-13 -1.57079539e+00] -2025-05-16 19:43:02,799 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000004 -0.13499989 0.3442352 ] -2025-05-16 19:43:02,801 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999924e+02 -5.49316028e-05 -8.99999466e+01] -2025-05-16 19:43:02,803 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000035 -0.135 0.34433994] -2025-05-16 19:43:02,805 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159132e+00 -4.79368983e-07 -1.57079579e+00] -2025-05-16 19:43:02,820 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000032 -0.13500002 0.34423603] -2025-05-16 19:43:02,822 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999924e+02 -5.49316028e-05 -8.99999466e+01] -2025-05-16 19:43:02,825 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999971 -0.13500012 0.34433887] -2025-05-16 19:43:02,826 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159159e+00 -4.79368539e-07 -1.57079579e+00] -2025-05-16 19:43:02,840 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999969 -0.13500013 0.34423528] -2025-05-16 19:43:02,841 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999924e+02 -5.49316028e-05 -8.99999466e+01] -2025-05-16 19:43:02,843 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999985 -0.135 0.34433902] -2025-05-16 19:43:02,849 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159265e+00 -4.79368983e-07 -1.57079539e+00] -2025-05-16 19:43:02,863 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999983 -0.13500001 0.34423449] -2025-05-16 19:43:02,866 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999924e+02 -5.49316028e-05 -8.99999466e+01] -2025-05-16 19:43:02,867 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999966 -0.13499988 0.34433865] -2025-05-16 19:43:02,875 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159132e+00 6.89226454e-13 -1.57079539e+00] -2025-05-16 19:43:02,889 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999966 -0.1349999 0.34423392] -2025-05-16 19:43:02,896 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999924e+02 -5.49316028e-05 -8.99999466e+01] -2025-05-16 19:43:02,899 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999977 -0.135 0.34433868] -2025-05-16 19:43:02,906 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159159e+00 -4.79368063e-07 -1.57079486e+00] -2025-05-16 19:43:02,907 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999989 -0.1349999 0.34423422] -2025-05-16 19:43:02,909 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999924e+02 -5.49316028e-05 -8.99999466e+01] -2025-05-16 19:43:02,913 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999966 -0.135 0.34433865] -2025-05-16 19:43:02,914 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159132e+00 -4.79368317e-07 -1.57079539e+00] -2025-05-16 19:43:02,934 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999962 -0.13500002 0.34423483] -2025-05-16 19:43:02,940 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999924e+02 -5.49316028e-05 -8.99999466e+01] -2025-05-16 19:43:02,943 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999965 -0.13500023 0.34433887] -2025-05-16 19:43:02,950 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159159e+00 -4.79368063e-07 -1.57079579e+00] -2025-05-16 19:43:02,993 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000006 -0.13500003 0.3442358 ] -2025-05-16 19:43:02,994 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999924e+02 -5.49316028e-05 -8.99999466e+01] -2025-05-16 19:43:02,996 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999994 -0.13500023 0.34433914] -2025-05-16 19:43:02,998 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159265e+00 -9.58737967e-07 -1.57079579e+00] -2025-05-16 19:43:03,000 - 测试日志 - INFO - log.py:106 - 机械臂控制线程启动 -2025-05-16 19:43:03,002 - 测试日志 - INFO - log.py:106 - MassageRobot启动 -2025-05-16 19:48:10,121 - 测试日志 - INFO - log.py:106 - 切换到finger_head按摩头 -2025-05-16 19:48:13,644 - 测试日志 - INFO - log.py:106 - 机械臂测量线程启动 -2025-05-16 19:48:13,646 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000031 -0.13499976 0.34431423] -2025-05-16 19:48:13,652 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999939e+02 2.63349928e-11 -8.99999695e+01] -2025-05-16 19:48:13,654 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000008 -0.13499988 0.34433948] -2025-05-16 19:48:13,656 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159 0. -1.57079579] -2025-05-16 19:48:13,658 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000008 -0.13499987 0.34429572] -2025-05-16 19:48:13,660 - 测试日志 - INFO - log.py:106 - orientation command: [-179.99993896 0. -89.99996948] -2025-05-16 19:48:13,661 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000008 -0.13499988 0.34433948] -2025-05-16 19:48:13,662 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159 0. -1.57079579] -2025-05-16 19:48:13,678 - 测试日志 - INFO - log.py:106 - position command: [ 0.2499998 -0.13499987 0.34428121] -2025-05-16 19:48:13,680 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999939e+02 -2.63222705e-11 -9.00000000e+01] -2025-05-16 19:48:13,682 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999977 -0.135 0.34433902] -2025-05-16 19:48:13,684 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265 0. -1.57079633] -2025-05-16 19:48:13,699 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999985 -0.13499999 0.34427046] -2025-05-16 19:48:13,700 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999939e+02 2.74658196e-05 -9.00000305e+01] -2025-05-16 19:48:13,701 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999971 -0.135 0.34433868] -2025-05-16 19:48:13,702 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159079e+00 -4.79368983e-07 -1.57079579e+00] -2025-05-16 19:48:13,722 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999954 -0.13499998 0.34426268] -2025-05-16 19:48:13,724 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999939e+02 2.74658196e-05 -9.00000305e+01] -2025-05-16 19:48:13,725 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000011 -0.13500012 0.34433957] -2025-05-16 19:48:13,727 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159 0. -1.57079686] -2025-05-16 19:48:13,749 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000033 -0.1350002 0.34425743] -2025-05-16 19:48:13,753 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999924e+02 -5.49316392e-05 -9.00000000e+01] -2025-05-16 19:48:13,757 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000023 -0.13499988 0.34433929] -2025-05-16 19:48:13,760 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 4.79368984e-07 -1.57079633e+00] -2025-05-16 19:48:13,764 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000026 -0.13499985 0.34425264] -2025-05-16 19:48:13,765 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999969e+02 2.74658196e-05 -9.00000000e+01] -2025-05-16 19:48:13,766 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999994 -0.135 0.34433896] -2025-05-16 19:48:13,767 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265 0. -1.57079686] -2025-05-16 19:48:13,786 - 测试日志 - INFO - log.py:106 - position command: [ 0.2500002 -0.13499985 0.34424939] -2025-05-16 19:48:13,788 - 测试日志 - INFO - log.py:106 - orientation command: [180. 0. -89.99994659] -2025-05-16 19:48:13,789 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000017 -0.13499988 0.34433939] -2025-05-16 19:48:13,790 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265 0. -1.57079539] -2025-05-16 19:48:13,805 - 测试日志 - INFO - log.py:106 - position command: [ 0.2500002 -0.13500122 0.34424689] -2025-05-16 19:48:13,805 - 测试日志 - INFO - log.py:106 - orientation command: [180. 0. -89.99994659] -2025-05-16 19:48:13,806 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999966 -0.13499977 0.34433881] -2025-05-16 19:48:13,807 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159132e+00 4.79369682e-07 -1.57079539e+00] -2025-05-16 19:48:13,825 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999975 -0.13500221 0.34424483] -2025-05-16 19:48:13,826 - 测试日志 - INFO - log.py:106 - orientation command: [-1.80000000e+02 -2.74658196e-05 -9.00000534e+01] -2025-05-16 19:48:13,826 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999965 -0.135 0.34433868] -2025-05-16 19:48:13,827 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159159e+00 4.79368984e-07 -1.57079686e+00] -2025-05-16 19:48:13,846 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999998 -0.13500232 0.34424336] -2025-05-16 19:48:13,847 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999939e+02 2.63222705e-11 -9.00000534e+01] -2025-05-16 19:48:13,848 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000037 -0.13499965 0.34433975] -2025-05-16 19:48:13,849 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159079e+00 4.79368984e-07 -1.57079539e+00] -2025-05-16 19:48:13,866 - 测试日志 - INFO - log.py:106 - position command: [ 0.2500004 -0.13500183 0.3442429 ] -2025-05-16 19:48:13,879 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999893e+02 2.74658196e-05 -8.99999466e+01] -2025-05-16 19:48:13,882 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999971 -0.13499988 0.34433853] -2025-05-16 19:48:13,890 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159079 0. -1.57079579] -2025-05-16 19:48:13,894 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999975 -0.13500324 0.34424092] -2025-05-16 19:48:13,898 - 测试日志 - INFO - log.py:106 - orientation command: [179.99989319 0. -89.99996948] -2025-05-16 19:48:13,908 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000002 -0.13499988 0.34433914] -2025-05-16 19:48:13,911 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265 0. -1.57079686] -2025-05-16 19:48:13,915 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000006 -0.13500502 0.34424093] -2025-05-16 19:48:13,917 - 测试日志 - INFO - log.py:106 - orientation command: [-180. 0. -90.00003052] -2025-05-16 19:48:13,923 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000002 -0.13499988 0.34433914] -2025-05-16 19:48:13,926 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265 0. -1.57079686] -2025-05-16 19:48:13,934 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999993 -0.13500554 0.34423999] -2025-05-16 19:48:13,935 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999939e+02 5.49315882e-05 -9.00000534e+01] -2025-05-16 19:48:13,936 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000029 -0.13499988 0.34433945] -2025-05-16 19:48:13,937 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 2.29816166e-13 -1.57079633e+00] -2025-05-16 19:48:13,961 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999988 -0.13500571 0.34424011] -2025-05-16 19:48:13,963 - 测试日志 - INFO - log.py:106 - orientation command: [179.99996948 0. -90. ] -2025-05-16 19:48:13,966 - 测试日志 - INFO - log.py:106 - position current:[ 0.25 -0.135 0.34433902] -2025-05-16 19:48:13,971 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 2.29594121e-13 -1.57079579e+00] -2025-05-16 19:48:13,981 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000005 -0.13500529 0.3442398 ] -2025-05-16 19:48:13,983 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999969e+02 1.31547742e-11 -8.99999695e+01] -2025-05-16 19:48:13,985 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000031 -0.13499988 0.34433957] -2025-05-16 19:48:13,989 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159079 0. -1.57079579] -2025-05-16 19:48:14,006 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000034 -0.13500458 0.34424014] -2025-05-16 19:48:14,008 - 测试日志 - INFO - log.py:106 - orientation command: [-179.99989319 0. -89.99996948] -2025-05-16 19:48:14,019 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000012 -0.13499977 0.34433902] -2025-05-16 19:48:14,022 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 4.79369237e-07 -1.57079633e+00] -2025-05-16 19:48:14,025 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000016 -0.13500519 0.34423946] -2025-05-16 19:48:14,026 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999969e+02 2.74658341e-05 -9.00000000e+01] -2025-05-16 19:48:14,028 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999977 -0.13500012 0.3443392 ] -2025-05-16 19:48:14,029 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 -4.79368983e-07 -1.57079686e+00] -2025-05-16 19:48:14,045 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999982 -0.13500556 0.34423953] -2025-05-16 19:48:14,047 - 测试日志 - INFO - log.py:106 - orientation command: [-1.80000000e+02 -2.74658196e-05 -9.00000305e+01] -2025-05-16 19:48:14,050 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999988 -0.135 0.34433881] -2025-05-16 19:48:14,059 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159159e+00 -4.59632332e-13 -1.57079686e+00] -2025-05-16 19:48:14,064 - 测试日志 - INFO - log.py:106 - MassageRobot启动 -2025-05-16 19:48:14,065 - 测试日志 - INFO - log.py:106 - 机械臂控制线程启动 -2025-05-16 19:48:19,876 - 测试日志 - ERROR - log.py:106 - 传感器数据读取失败 -2025-05-16 19:48:19,877 - 测试日志 - ERROR - log.py:106 - 传感器线程数据读取失败-1 -2025-05-16 19:51:26,145 - 测试日志 - INFO - log.py:106 - 切换到finger_head按摩头 -2025-05-16 19:51:29,681 - 测试日志 - INFO - log.py:106 - 机械臂测量线程启动 -2025-05-16 19:51:29,682 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000032 -0.13499953 0.34431436] -2025-05-16 19:51:29,687 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79974625e+02 -3.69333716e-02 -9.00109993e+01] -2025-05-16 19:51:29,691 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000014 -0.13499988 0.34433929] -2025-05-16 19:51:29,696 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 -4.79368983e-07 -1.57079539e+00] -2025-05-16 19:51:29,699 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000014 -0.13499987 0.34429555] -2025-05-16 19:51:29,700 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79963921e+02 -3.93813252e-02 -9.00224707e+01] -2025-05-16 19:51:29,702 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000012 -0.13499976 0.34433902] -2025-05-16 19:51:29,702 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212 0. -1.57079539] -2025-05-16 19:51:29,719 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000021 -0.13499962 0.34428166] -2025-05-16 19:51:29,721 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79990491e+02 -3.93531817e-02 -9.00260998e+01] -2025-05-16 19:51:29,724 - 测试日志 - INFO - log.py:106 - position current:[ 0.2500002 -0.13499963 0.34433948] -2025-05-16 19:51:29,727 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 -4.59632332e-13 -1.57079446e+00] -2025-05-16 19:51:29,742 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000036 -0.13499964 0.34427108] -2025-05-16 19:51:29,744 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79962795e+02 -9.91561828e-03 -9.00554519e+01] -2025-05-16 19:51:29,750 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000002 -0.13499963 0.34433908] -2025-05-16 19:51:29,779 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 -2.29372077e-13 -1.57079539e+00] -2025-05-16 19:51:29,782 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999996 -0.13500008 0.34426255] -2025-05-16 19:51:29,799 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79968903e+02 -6.77967995e-03 -9.00150330e+01] -2025-05-16 19:51:29,800 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000002 -0.13500012 0.34433914] -2025-05-16 19:51:29,809 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 -4.79368063e-07 -1.57079726e+00] -2025-05-16 19:51:29,812 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000034 -0.13499972 0.34425764] -2025-05-16 19:51:29,814 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79998036e+02 -1.03720674e-02 -9.00153465e+01] -2025-05-16 19:51:29,815 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999997 -0.13499976 0.3443392 ] -2025-05-16 19:51:29,817 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 -4.79368983e-07 -1.57079579e+00] -2025-05-16 19:51:29,832 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000027 -0.13499972 0.34425252] -2025-05-16 19:51:29,834 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79977796e+02 -3.90337257e-02 -9.00470445e+01] -2025-05-16 19:51:29,839 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000003 -0.13499976 0.34433908] -2025-05-16 19:51:29,843 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 4.59188243e-13 -1.57079633e+00] -2025-05-16 19:51:29,851 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000005 -0.13499972 0.3442491 ] -2025-05-16 19:51:29,852 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79943489e+02 -2.12627503e-02 -9.00493722e+01] -2025-05-16 19:51:29,853 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000049 -0.13499963 0.34433978] -2025-05-16 19:51:29,854 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159132e+00 6.89226454e-13 -1.57079539e+00] -2025-05-16 19:51:29,871 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999992 -0.13499974 0.34424646] -2025-05-16 19:51:29,873 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79953558e+02 -2.37389744e-02 -9.00337554e+01] -2025-05-16 19:51:29,875 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000008 -0.13499988 0.34433948] -2025-05-16 19:51:29,881 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159 0. -1.57079579] -2025-05-16 19:51:29,891 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000011 -0.13499984 0.34424512] -2025-05-16 19:51:29,893 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79974109e+02 -3.16875835e-02 -9.00006617e+01] -2025-05-16 19:51:29,894 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000038 -0.13499953 0.34433984] -2025-05-16 19:51:29,895 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159132e+00 -6.89226454e-13 -1.57079393e+00] -2025-05-16 19:51:29,912 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000029 -0.13499972 0.34424374] -2025-05-16 19:51:29,913 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79975469e+02 -5.33816266e-02 -9.00135128e+01] -2025-05-16 19:51:29,914 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000018 -0.13500023 0.34433957] -2025-05-16 19:51:29,915 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 -9.58737967e-07 -1.57079633e+00] -2025-05-16 19:51:29,946 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999971 -0.13500107 0.34424135] -2025-05-16 19:51:29,955 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79995090e+02 -1.55195496e-02 -9.00174656e+01] -2025-05-16 19:51:29,957 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000018 -0.13499965 0.34433936] -2025-05-16 19:51:29,964 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 4.79369238e-07 -1.57079579e+00] -2025-05-16 19:51:29,968 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000017 -0.1350032 0.34424144] -2025-05-16 19:51:29,977 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79980800e+02 -1.35464496e-02 -9.00414714e+01] -2025-05-16 19:51:29,979 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000018 -0.13499988 0.34433917] -2025-05-16 19:51:29,980 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 -4.79368539e-07 -1.57079633e+00] -2025-05-16 19:51:29,996 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000016 -0.13500406 0.34424085] -2025-05-16 19:51:29,997 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79960086e+02 -2.10019338e-02 -9.00085114e+01] -2025-05-16 19:51:29,999 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000009 -0.13499953 0.34433926] -2025-05-16 19:51:29,999 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 4.79369237e-07 -1.57079539e+00] -2025-05-16 19:51:30,014 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000013 -0.13500391 0.34424064] -2025-05-16 19:51:30,015 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79982348e+02 -5.44383568e-02 -9.00038725e+01] -2025-05-16 19:51:30,016 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000002 -0.13499953 0.34433908] -2025-05-16 19:51:30,018 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 4.79368984e-07 -1.57079486e+00] -2025-05-16 19:51:30,036 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999995 -0.13500406 0.34424006] -2025-05-16 19:51:30,039 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79998797e+02 -4.78113238e-02 -9.00025381e+01] -2025-05-16 19:51:30,042 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000012 -0.13499988 0.34433884] -2025-05-16 19:51:30,044 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 -4.79369238e-07 -1.57079579e+00] -2025-05-16 19:51:30,062 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000021 -0.13500367 0.34424002] -2025-05-16 19:51:30,063 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79992220e+02 -5.69374468e-02 -9.00484014e+01] -2025-05-16 19:51:30,072 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000014 -0.13499988 0.34433948] -2025-05-16 19:51:30,076 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 -4.79368539e-07 -1.57079579e+00] -2025-05-16 19:51:30,084 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000017 -0.13500319 0.34424006] -2025-05-16 19:51:30,086 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79957801e+02 -3.88925789e-02 -9.00560068e+01] -2025-05-16 19:51:30,092 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999985 -0.13499976 0.34433868] -2025-05-16 19:51:30,097 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159159 0. -1.57079539] -2025-05-16 19:51:30,104 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999989 -0.13500259 0.34423915] -2025-05-16 19:51:30,107 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79976630e+02 -8.48794894e-03 -9.00278034e+01] -2025-05-16 19:51:30,111 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999965 -0.135 0.34433835] -2025-05-16 19:51:30,112 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159079e+00 -9.19264664e-13 -1.57079686e+00] -2025-05-16 19:51:30,126 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000029 -0.13500225 0.3442397 ] -2025-05-16 19:51:30,128 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79968339e+02 -3.69531123e-02 -9.00022808e+01] -2025-05-16 19:51:30,129 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000014 -0.13499965 0.34433929] -2025-05-16 19:51:30,130 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 4.79369460e-07 -1.57079579e+00] -2025-05-16 19:51:30,144 - 测试日志 - INFO - log.py:106 - 机械臂控制线程启动 -2025-05-16 19:51:30,146 - 测试日志 - INFO - log.py:106 - MassageRobot启动 -2025-05-16 19:51:47,730 - 测试日志 - INFO - log.py:106 - 切换到finger_head按摩头 -2025-05-16 19:51:51,246 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000002 -0.13500011 0.34431414] -2025-05-16 19:51:51,247 - 测试日志 - INFO - log.py:106 - 机械臂测量线程启动 -2025-05-16 19:51:51,249 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999890e+02 -1.27609598e-03 -9.00044883e+01] -2025-05-16 19:51:51,255 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999989 -0.13500023 0.34433875] -2025-05-16 19:51:51,257 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159132e+00 -1.91747873e-06 -1.57079726e+00] -2025-05-16 19:51:51,259 - 测试日志 - INFO - log.py:106 - position command: [ 0.2499999 -0.13500023 0.3442977 ] -2025-05-16 19:51:51,261 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999859e+02 -2.43580194e-04 -9.00006981e+01] -2025-05-16 19:51:51,262 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000002 -0.13500035 0.34433914] -2025-05-16 19:51:51,264 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 -1.91747593e-06 -1.57079779e+00] -2025-05-16 19:51:51,279 - 测试日志 - INFO - log.py:106 - position command: [ 0.2500003 -0.13499999 0.34428661] -2025-05-16 19:51:51,281 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79995504e+02 -4.13044179e-03 -9.00025748e+01] -2025-05-16 19:51:51,283 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000035 -0.13500023 0.34433945] -2025-05-16 19:51:51,285 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 -1.91747479e-06 -1.57079779e+00] -2025-05-16 19:51:51,300 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999979 -0.13499989 0.34427648] -2025-05-16 19:51:51,302 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79997203e+02 -5.27388781e-04 -9.00026503e+01] -2025-05-16 19:51:51,304 - 测试日志 - INFO - log.py:106 - position current:[ 0.25 -0.13500023 0.34433902] -2025-05-16 19:51:51,306 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 -9.58739110e-07 -1.57079872e+00] -2025-05-16 19:51:51,321 - 测试日志 - INFO - log.py:106 - position command: [ 0.25 -0.13500035 0.34426917] -2025-05-16 19:51:51,324 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79996476e+02 -6.88294360e-04 -9.00056795e+01] -2025-05-16 19:51:51,329 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000024 -0.13500023 0.34433957] -2025-05-16 19:51:51,336 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 -1.43810511e-06 -1.57079779e+00] -2025-05-16 19:51:51,344 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999999 -0.13499999 0.34426435] -2025-05-16 19:51:51,347 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79998461e+02 -3.19443099e-03 -9.00054114e+01] -2025-05-16 19:51:51,349 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000003 -0.13500035 0.34433926] -2025-05-16 19:51:51,356 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159132e+00 -1.91747327e-06 -1.57079779e+00] -2025-05-16 19:51:51,365 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000024 -0.13500011 0.34426158] -2025-05-16 19:51:51,368 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79996086e+02 -2.61426956e-03 -9.00032818e+01] -2025-05-16 19:51:51,378 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000024 -0.13500011 0.34433942] -2025-05-16 19:51:51,380 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 -9.58736126e-07 -1.57079779e+00] -2025-05-16 19:51:51,382 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000023 -0.13500011 0.3442584 ] -2025-05-16 19:51:51,384 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79997930e+02 -5.73176462e-03 -9.00011967e+01] -2025-05-16 19:51:51,385 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000026 -0.13500011 0.34433936] -2025-05-16 19:51:51,386 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 -1.91747505e-06 -1.57079686e+00] -2025-05-16 19:51:51,407 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999995 -0.13500033 0.34425608] -2025-05-16 19:51:51,409 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999243e+02 -1.42938411e-03 -9.00055883e+01] -2025-05-16 19:51:51,412 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999985 -0.13500023 0.34433887] -2025-05-16 19:51:51,414 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 -1.43810701e-06 -1.57079779e+00] -2025-05-16 19:51:51,423 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999985 -0.13500022 0.34425548] -2025-05-16 19:51:51,424 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79997348e+02 -4.24684621e-03 -9.00032174e+01] -2025-05-16 19:51:51,427 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000006 -0.13500011 0.34433902] -2025-05-16 19:51:51,432 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 -9.58738919e-07 -1.57079779e+00] -2025-05-16 19:51:51,443 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000027 -0.13499998 0.34425488] -2025-05-16 19:51:51,446 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79996705e+02 -4.21634461e-03 -9.00025070e+01] -2025-05-16 19:51:51,448 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000017 -0.13500011 0.34433871] -2025-05-16 19:51:51,451 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159079e+00 -1.91747962e-06 -1.57079686e+00] -2025-05-16 19:51:51,464 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000016 -0.13500011 0.3442533 ] -2025-05-16 19:51:51,466 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79995314e+02 -1.86946393e-03 -9.00037043e+01] -2025-05-16 19:51:51,467 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000031 -0.135 0.34433975] -2025-05-16 19:51:51,469 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159079e+00 -4.79365333e-07 -1.57079779e+00] -2025-05-16 19:51:51,483 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000018 -0.13500034 0.34425417] -2025-05-16 19:51:51,486 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79998858e+02 -5.00509773e-03 -9.00016116e+01] -2025-05-16 19:51:51,488 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000014 -0.13500011 0.34433929] -2025-05-16 19:51:51,490 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 -1.43810511e-06 -1.57079726e+00] -2025-05-16 19:51:51,505 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999999 -0.13500022 0.34425243] -2025-05-16 19:51:51,508 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79996639e+02 -2.07358994e-03 -9.00051841e+01] -2025-05-16 19:51:51,513 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999985 -0.13500011 0.34433936] -2025-05-16 19:51:51,519 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 -9.58737967e-07 -1.57079726e+00] -2025-05-16 19:51:51,528 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000043 -0.13499998 0.34425229] -2025-05-16 19:51:51,531 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79994815e+02 -3.65624482e-03 -9.00036438e+01] -2025-05-16 19:51:51,539 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000024 -0.13500011 0.34433923] -2025-05-16 19:51:51,545 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 -1.43810701e-06 -1.57079779e+00] -2025-05-16 19:51:51,554 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000022 -0.13500011 0.34424988] -2025-05-16 19:51:51,561 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79996847e+02 -1.71190011e-03 -9.00051387e+01] -2025-05-16 19:51:51,568 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000026 -0.13500023 0.34433984] -2025-05-16 19:51:51,572 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159026e+00 -1.43810244e-06 -1.57079779e+00] -2025-05-16 19:51:51,582 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000026 -0.13500011 0.34424848] -2025-05-16 19:51:51,585 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79994330e+02 -3.88380868e-04 -9.00053865e+01] -2025-05-16 19:51:51,588 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000008 -0.13500035 0.34433963] -2025-05-16 19:51:51,591 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159079e+00 -1.43810422e-06 -1.57079779e+00] -2025-05-16 19:51:51,602 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000041 -0.13499999 0.34424825] -2025-05-16 19:51:51,605 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79995739e+02 -4.71392372e-03 -9.00021841e+01] -2025-05-16 19:51:51,609 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000044 -0.13499998 0.34433957] -2025-05-16 19:51:51,611 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159079e+00 -1.43810244e-06 -1.57079726e+00] -2025-05-16 19:51:51,622 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000017 -0.13500023 0.34424824] -2025-05-16 19:51:51,624 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79997612e+02 -3.89269816e-03 -9.00001206e+01] -2025-05-16 19:51:51,626 - 测试日志 - INFO - log.py:106 - position current:[ 0.2500002 -0.13500023 0.34433984] -2025-05-16 19:51:51,628 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159132e+00 -1.43810422e-06 -1.57079779e+00] -2025-05-16 19:51:51,648 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000001 -0.13500056 0.34424709] -2025-05-16 19:51:51,656 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79997003e+02 -4.00069413e-03 -9.00027467e+01] -2025-05-16 19:51:51,666 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000014 -0.13500023 0.34433948] -2025-05-16 19:51:51,675 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 -1.91747416e-06 -1.57079726e+00] -2025-05-16 19:51:51,678 - 测试日志 - INFO - log.py:106 - 机械臂控制线程启动 -2025-05-16 19:51:51,693 - 测试日志 - INFO - log.py:106 - MassageRobot启动 -2025-05-16 19:52:09,248 - 测试日志 - INFO - log.py:106 - 切换到finger_head按摩头 -2025-05-16 19:52:12,766 - 测试日志 - INFO - log.py:106 - 机械臂测量线程启动 -2025-05-16 19:52:12,783 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999965 -0.13500047 0.34431454] -2025-05-16 19:52:12,786 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999661e+02 -1.53391681e-04 -9.00003950e+01] -2025-05-16 19:52:12,788 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000014 -0.1350006 0.34433905] -2025-05-16 19:52:12,791 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 -9.58737777e-07 -1.57079726e+00] -2025-05-16 19:52:12,794 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999961 -0.13500036 0.34429558] -2025-05-16 19:52:12,797 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999509e+02 -5.86742938e-04 -9.00004641e+01] -2025-05-16 19:52:12,807 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999998 -0.13500047 0.34433942] -2025-05-16 19:52:12,809 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 -4.79369460e-07 -1.57079726e+00] -2025-05-16 19:52:12,814 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999997 -0.13500048 0.34428161] -2025-05-16 19:52:12,816 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999900e+02 -3.65397076e-04 -9.00003483e+01] -2025-05-16 19:52:12,818 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999945 -0.13500024 0.3443382 ] -2025-05-16 19:52:12,820 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14158972 0. -1.57079726] -2025-05-16 19:52:12,841 - 测试日志 - INFO - log.py:106 - position command: [ 0.2499994 -0.13500061 0.34427035] -2025-05-16 19:52:12,843 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999567e+02 -3.85698591e-04 -9.00002771e+01] -2025-05-16 19:52:12,845 - 测试日志 - INFO - log.py:106 - position current:[ 0.2499994 -0.1350006 0.34433865] -2025-05-16 19:52:12,848 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159132e+00 -9.58737332e-07 -1.57079726e+00] -2025-05-16 19:52:12,861 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999969 -0.1350006 0.34426261] -2025-05-16 19:52:12,877 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999875e+02 -3.12458298e-04 -9.00001956e+01] -2025-05-16 19:52:12,881 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999985 -0.13500047 0.34433905] -2025-05-16 19:52:12,883 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159159e+00 -4.79368063e-07 -1.57079686e+00] -2025-05-16 19:52:12,886 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999963 -0.13500071 0.34425683] -2025-05-16 19:52:12,890 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999938e+02 -5.48150702e-04 -9.00003175e+01] -2025-05-16 19:52:12,893 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999982 -0.13500047 0.34433929] -2025-05-16 19:52:12,896 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 -4.79368984e-07 -1.57079779e+00] -2025-05-16 19:52:12,913 - 测试日志 - INFO - log.py:106 - position command: [ 0.2500002 -0.13500035 0.34425291] -2025-05-16 19:52:12,915 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999731e+02 -2.11165207e-04 -9.00000787e+01] -2025-05-16 19:52:12,916 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999953 -0.1350006 0.34433914] -2025-05-16 19:52:12,917 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 -9.58738221e-07 -1.57079726e+00] -2025-05-16 19:52:12,929 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999952 -0.13500059 0.34424921] -2025-05-16 19:52:12,930 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999480e+02 -2.08201987e-04 -9.00005132e+01] -2025-05-16 19:52:12,931 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000009 -0.13500023 0.34433893] -2025-05-16 19:52:12,932 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159132e+00 -9.58736634e-07 -1.57079539e+00] -2025-05-16 19:52:12,949 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999998 -0.13500047 0.34424756] -2025-05-16 19:52:12,951 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999557e+02 -1.74136628e-04 -9.00000983e+01] -2025-05-16 19:52:12,953 - 测试日志 - INFO - log.py:106 - position current:[ 0.2499998 -0.13500037 0.34433902] -2025-05-16 19:52:12,955 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 2.22044605e-16 -1.57079779e+00] -2025-05-16 19:52:12,986 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999992 -0.13500069 0.34424534] -2025-05-16 19:52:12,987 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999734e+02 -3.19848052e-04 -9.00001844e+01] -2025-05-16 19:52:12,994 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999969 -0.13500035 0.34433908] -2025-05-16 19:52:12,995 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 -4.79368761e-07 -1.57079686e+00] -2025-05-16 19:52:13,004 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999968 -0.13500035 0.34424333] -2025-05-16 19:52:13,006 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999725e+02 -3.09996442e-04 -9.00003409e+01] -2025-05-16 19:52:13,011 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999986 -0.13500035 0.34433868] -2025-05-16 19:52:13,014 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159132e+00 -9.58737967e-07 -1.57079686e+00] -2025-05-16 19:52:13,024 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999999 -0.13500047 0.34424172] -2025-05-16 19:52:13,025 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999848e+02 -4.97348041e-04 -9.00001682e+01] -2025-05-16 19:52:13,026 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999947 -0.1350006 0.34433914] -2025-05-16 19:52:13,028 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 -9.58737967e-07 -1.57079779e+00] -2025-05-16 19:52:13,044 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999947 -0.13500047 0.34424151] -2025-05-16 19:52:13,046 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999489e+02 -3.56677792e-04 -9.00000633e+01] -2025-05-16 19:52:13,047 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999995 -0.1350007 0.34433865] -2025-05-16 19:52:13,047 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159079e+00 -1.43810701e-06 -1.57079779e+00] -2025-05-16 19:52:13,063 - 测试日志 - INFO - log.py:106 - position command: [ 0.2499999 -0.13500035 0.34424101] -2025-05-16 19:52:13,064 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999736e+02 -3.88382212e-04 -9.00000039e+01] -2025-05-16 19:52:13,064 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999954 -0.13500047 0.34433942] -2025-05-16 19:52:13,065 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 -9.58738919e-07 -1.57079633e+00] -2025-05-16 19:52:13,083 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999993 -0.13500059 0.34424118] -2025-05-16 19:52:13,084 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999443e+02 -3.21686054e-04 -9.00004201e+01] -2025-05-16 19:52:13,086 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999982 -0.13500047 0.34433948] -2025-05-16 19:52:13,088 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 -4.79369460e-07 -1.57079726e+00] -2025-05-16 19:52:13,108 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999941 -0.13500081 0.34424015] -2025-05-16 19:52:13,110 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999529e+02 -3.61937148e-04 -9.00001365e+01] -2025-05-16 19:52:13,111 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999976 -0.13500035 0.34433881] -2025-05-16 19:52:13,113 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159159e+00 -4.79369460e-07 -1.57079779e+00] -2025-05-16 19:52:13,127 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999985 -0.13500046 0.34424029] -2025-05-16 19:52:13,130 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999503e+02 -5.10946397e-04 -9.00002270e+01] -2025-05-16 19:52:13,131 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999954 -0.13500072 0.34433966] -2025-05-16 19:52:13,133 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159132e+00 -9.58738665e-07 -1.57079779e+00] -2025-05-16 19:52:13,147 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000026 -0.13500035 0.34424068] -2025-05-16 19:52:13,148 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999536e+02 -5.70193652e-04 -9.00001532e+01] -2025-05-16 19:52:13,149 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999959 -0.1350006 0.34433902] -2025-05-16 19:52:13,151 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159265e+00 -9.58737967e-07 -1.57079686e+00] -2025-05-16 19:52:13,166 - 测试日志 - INFO - log.py:106 - position command: [ 0.2499998 -0.13500047 0.3442397 ] -2025-05-16 19:52:13,167 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999565e+02 -1.50232052e-04 -9.00005762e+01] -2025-05-16 19:52:13,169 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999977 -0.13500047 0.34433942] -2025-05-16 19:52:13,174 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 -9.58737967e-07 -1.57079726e+00] -2025-05-16 19:52:13,191 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000005 -0.13500059 0.34423963] -2025-05-16 19:52:13,192 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999958e+02 -6.07005264e-04 -9.00001526e+01] -2025-05-16 19:52:13,194 - 测试日志 - INFO - log.py:106 - position current:[ 0.2499998 -0.13500037 0.34433917] -2025-05-16 19:52:13,196 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 2.29594121e-13 -1.57079726e+00] -2025-05-16 19:52:13,211 - 测试日志 - INFO - log.py:106 - MassageRobot启动 -2025-05-16 19:52:13,212 - 测试日志 - INFO - log.py:106 - 机械臂控制线程启动 -2025-05-19 10:02:26,665 - 测试日志 - INFO - log.py:106 - 切换到finger_head按摩头 -2025-05-19 10:02:30,190 - 测试日志 - INFO - log.py:106 - 机械臂测量线程启动 -2025-05-19 10:02:30,192 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999973 -0.135 0.34431432] -2025-05-19 10:02:30,196 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999826e+02 -3.96894838e-04 -9.00005277e+01] -2025-05-19 10:02:30,201 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999982 -0.13500024 0.34433914] -2025-05-19 10:02:30,204 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265 0. -1.57079633] -2025-05-19 10:02:30,215 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999974 -0.13499978 0.34429566] -2025-05-19 10:02:30,217 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999746e+02 -4.46690489e-04 -9.00003049e+01] -2025-05-19 10:02:30,218 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999986 -0.13499976 0.34433963] -2025-05-19 10:02:30,220 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 -2.29372077e-13 -1.57079486e+00] -2025-05-19 10:02:30,227 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999974 -0.13499979 0.3442816 ] -2025-05-19 10:02:30,228 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999524e+02 -2.88008893e-05 -9.00003195e+01] -2025-05-19 10:02:30,229 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000011 -0.13500012 0.34433923] -2025-05-19 10:02:30,230 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159265e+00 -4.79368983e-07 -1.57079579e+00] -2025-05-19 10:02:30,248 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999974 -0.13499979 0.34427105] -2025-05-19 10:02:30,250 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999709e+02 -2.79843752e-04 -9.00000473e+01] -2025-05-19 10:02:30,252 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999989 -0.13500012 0.3443396 ] -2025-05-19 10:02:30,258 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159132e+00 -6.89226454e-13 -1.57079633e+00] -2025-05-19 10:02:30,268 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999974 -0.13499979 0.34426314] -2025-05-19 10:02:30,271 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999611e+02 1.49409562e-05 -9.00000523e+01] -2025-05-19 10:02:30,275 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000006 -0.135 0.34433936] -2025-05-19 10:02:30,279 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212 0. -1.57079633] -2025-05-19 10:02:30,289 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999974 -0.1349998 0.3442572 ] -2025-05-19 10:02:30,294 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999667e+02 -9.54590040e-05 -9.00001427e+01] -2025-05-19 10:02:30,300 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000017 -0.13499988 0.34433908] -2025-05-19 10:02:30,304 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265 0. -1.57079486] -2025-05-19 10:02:30,310 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999974 -0.1349998 0.34425275] -2025-05-19 10:02:30,317 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999457e+02 -5.02497991e-04 -9.00004498e+01] -2025-05-19 10:02:30,323 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999977 -0.135 0.34433902] -2025-05-19 10:02:30,330 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159265 0. -1.57079579] -2025-05-19 10:02:30,337 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999974 -0.1349998 0.34424942] -2025-05-19 10:02:30,340 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999592e+02 -4.73850730e-04 -9.00001035e+01] -2025-05-19 10:02:30,346 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000008 -0.13499988 0.34433914] -2025-05-19 10:02:30,356 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159 0. -1.57079579] -2025-05-19 10:02:30,359 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999974 -0.1349998 0.34424691] -2025-05-19 10:02:30,361 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999835e+02 -1.37206623e-04 -9.00003023e+01] -2025-05-19 10:02:30,364 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999968 -0.135 0.34433911] -2025-05-19 10:02:30,365 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159 0. -1.57079633] -2025-05-19 10:02:30,380 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999974 -0.1349998 0.34424504] -2025-05-19 10:02:30,382 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999379e+02 -1.66344215e-04 -9.00002719e+01] -2025-05-19 10:02:30,383 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999983 -0.13500012 0.34433942] -2025-05-19 10:02:30,386 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 2.29594121e-13 -1.57079726e+00] -2025-05-19 10:02:30,399 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999974 -0.1349998 0.34424363] -2025-05-19 10:02:30,402 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999513e+02 -9.34506466e-05 -9.00003949e+01] -2025-05-19 10:02:30,404 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999962 -0.13500012 0.34433893] -2025-05-19 10:02:30,406 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 -4.79368983e-07 -1.57079633e+00] -2025-05-19 10:02:30,430 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999974 -0.1349998 0.34424257] -2025-05-19 10:02:30,431 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999764e+02 -3.23980268e-04 -9.00003722e+01] -2025-05-19 10:02:30,433 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999979 -0.13500012 0.34433936] -2025-05-19 10:02:30,436 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 4.59410288e-13 -1.57079726e+00] -2025-05-19 10:02:30,441 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999974 -0.1349998 0.34424178] -2025-05-19 10:02:30,443 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999612e+02 -3.14298780e-05 -9.00000663e+01] -2025-05-19 10:02:30,445 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000009 -0.13500012 0.34433896] -2025-05-19 10:02:30,447 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 2.29816166e-13 -1.57079633e+00] -2025-05-19 10:02:30,462 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999974 -0.1349998 0.34424119] -2025-05-19 10:02:30,465 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999905e+02 -1.67172084e-04 -9.00005162e+01] -2025-05-19 10:02:30,469 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999994 -0.135 0.34433929] -2025-05-19 10:02:30,471 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265 0. -1.57079539] -2025-05-19 10:02:30,482 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999974 -0.1349998 0.34424074] -2025-05-19 10:02:30,485 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999527e+02 -3.12925654e-04 -9.00000526e+01] -2025-05-19 10:02:30,491 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000023 -0.13499988 0.34433926] -2025-05-19 10:02:30,496 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212 0. -1.57079579] -2025-05-19 10:02:30,503 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999974 -0.1349998 0.34424041] -2025-05-19 10:02:30,505 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999611e+02 -2.61837169e-04 -9.00002537e+01] -2025-05-19 10:02:30,508 - 测试日志 - INFO - log.py:106 - position current:[ 0.24996494 -0.1350007 0.34429324] -2025-05-19 10:02:30,511 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14145071e+00 -2.87668998e-06 -1.57079966e+00] -2025-05-19 10:02:30,524 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999974 -0.1349998 0.34424016] -2025-05-19 10:02:30,527 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999897e+02 -4.59459577e-04 -9.00004853e+01] -2025-05-19 10:02:30,529 - 测试日志 - INFO - log.py:106 - position current:[ 0.24996278 -0.13500093 0.34429184] -2025-05-19 10:02:30,533 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14144165e+00 -4.31490024e-06 -1.57079966e+00] -2025-05-19 10:02:30,543 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999974 -0.1349998 0.34423997] -2025-05-19 10:02:30,544 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999384e+02 -3.60405976e-04 -9.00004130e+01] -2025-05-19 10:02:30,552 - 测试日志 - INFO - log.py:106 - position current:[ 0.24996272 -0.13500093 0.34429214] -2025-05-19 10:02:30,554 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14144165e+00 -3.83567571e-06 -1.57080112e+00] -2025-05-19 10:02:30,563 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999974 -0.1349998 0.34423983] -2025-05-19 10:02:30,565 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999386e+02 -2.08796960e-04 -8.99999543e+01] -2025-05-19 10:02:30,566 - 测试日志 - INFO - log.py:106 - position current:[ 0.2499621 -0.13500069 0.34429166] -2025-05-19 10:02:30,568 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14143872e+00 -3.35624672e-06 -1.57080019e+00] -2025-05-19 10:02:30,583 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999974 -0.1349998 0.34423972] -2025-05-19 10:02:30,584 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999888e+02 -1.68512875e-04 -9.00004685e+01] -2025-05-19 10:02:30,586 - 测试日志 - INFO - log.py:106 - position current:[ 0.24996198 -0.13500081 0.3442916 ] -2025-05-19 10:02:30,587 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14143819e+00 -3.83554389e-06 -1.57079966e+00] -2025-05-19 10:02:30,603 - 测试日志 - INFO - log.py:106 - MassageRobot启动 -2025-05-19 10:02:30,604 - 测试日志 - INFO - log.py:106 - 机械臂控制线程启动 -2025-05-19 10:05:01,935 - 测试日志 - INFO - log.py:106 - 切换到finger_head按摩头 -2025-05-19 10:05:05,452 - 测试日志 - INFO - log.py:106 - 机械臂测量线程启动 -2025-05-19 10:05:05,453 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999971 -0.13500012 0.34431353] -2025-05-19 10:05:05,454 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79995552e+02 -1.86617047e-03 -9.00040171e+01] -2025-05-19 10:05:05,456 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999995 -0.13499988 0.34433942] -2025-05-19 10:05:05,457 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 1.37823086e-12 -1.57079872e+00] -2025-05-19 10:05:05,460 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999995 -0.13499989 0.34429564] -2025-05-19 10:05:05,462 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79998049e+02 -2.53251216e-03 -9.00041934e+01] -2025-05-19 10:05:05,463 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999982 -0.135 0.34433881] -2025-05-19 10:05:05,465 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159159e+00 4.79366253e-07 -1.57079966e+00] -2025-05-19 10:05:05,479 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999994 -0.13499989 0.34428155] -2025-05-19 10:05:05,482 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79997486e+02 -2.70600055e-03 -9.00027864e+01] -2025-05-19 10:05:05,484 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000008 -0.13499977 0.34433948] -2025-05-19 10:05:05,487 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 4.79371745e-07 -1.57079872e+00] -2025-05-19 10:05:05,499 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999993 -0.1349999 0.34427099] -2025-05-19 10:05:05,500 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79996463e+02 -2.92768249e-03 -9.00020486e+01] -2025-05-19 10:05:05,501 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000012 -0.13499965 0.34433936] -2025-05-19 10:05:05,502 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 9.58739364e-07 -1.57079872e+00] -2025-05-19 10:05:05,520 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999993 -0.1349999 0.34426306] -2025-05-19 10:05:05,521 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79997057e+02 -3.52439726e-03 -9.00015710e+01] -2025-05-19 10:05:05,522 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000002 -0.13499977 0.34433929] -2025-05-19 10:05:05,523 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 9.58740761e-07 -1.57079926e+00] -2025-05-19 10:05:05,541 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999993 -0.1349999 0.34425712] -2025-05-19 10:05:05,542 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79997496e+02 -2.04402400e-04 -9.00036741e+01] -2025-05-19 10:05:05,544 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999954 -0.135 0.34433893] -2025-05-19 10:05:05,546 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159159e+00 -2.75712786e-12 -1.57079926e+00] -2025-05-19 10:05:05,560 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999993 -0.13499991 0.34425266] -2025-05-19 10:05:05,561 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79997787e+02 -4.26138689e-03 -9.00045300e+01] -2025-05-19 10:05:05,563 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999991 -0.13499988 0.34433936] -2025-05-19 10:05:05,564 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 2.75757195e-12 -1.57079872e+00] -2025-05-19 10:05:05,582 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999992 -0.13499991 0.34424932] -2025-05-19 10:05:05,584 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79994455e+02 -1.71898486e-04 -9.00022269e+01] -2025-05-19 10:05:05,585 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000003 -0.135 0.3443396 ] -2025-05-19 10:05:05,586 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159132e+00 -4.79365555e-07 -1.57079819e+00] -2025-05-19 10:05:05,602 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999992 -0.13499991 0.34424681] -2025-05-19 10:05:05,605 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79995389e+02 -1.52944569e-03 -9.00057594e+01] -2025-05-19 10:05:05,610 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999977 -0.13500024 0.34433942] -2025-05-19 10:05:05,614 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 1.37889700e-12 -1.57080019e+00] -2025-05-19 10:05:05,621 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999992 -0.13499991 0.34424493] -2025-05-19 10:05:05,622 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79998949e+02 -1.04873170e-03 -9.00023751e+01] -2025-05-19 10:05:05,622 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000002 -0.13499988 0.34433914] -2025-05-19 10:05:05,623 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265 0. -1.57079926] -2025-05-19 10:05:05,643 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999992 -0.13499991 0.34424352] -2025-05-19 10:05:05,645 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79997839e+02 -4.69136893e-03 -9.00028392e+01] -2025-05-19 10:05:05,647 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000017 -0.13499977 0.34433911] -2025-05-19 10:05:05,648 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 9.58736634e-07 -1.57079926e+00] -2025-05-19 10:05:05,663 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999992 -0.13499991 0.34424247] -2025-05-19 10:05:05,665 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79996167e+02 -5.03447407e-03 -9.00036427e+01] -2025-05-19 10:05:05,666 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999969 -0.13500012 0.34433875] -2025-05-19 10:05:05,668 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159132e+00 -4.82547335e-12 -1.57080019e+00] -2025-05-19 10:05:05,683 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999992 -0.13499991 0.34424167] -2025-05-19 10:05:05,684 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79995145e+02 -7.38464128e-04 -9.00045882e+01] -2025-05-19 10:05:05,685 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999995 -0.135 0.3443396 ] -2025-05-19 10:05:05,686 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159132e+00 4.82547335e-12 -1.57079966e+00] -2025-05-19 10:05:05,703 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999992 -0.13499991 0.34424108] -2025-05-19 10:05:05,704 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79994974e+02 -1.92724409e-03 -9.00055219e+01] -2025-05-19 10:05:05,705 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999985 -0.135 0.34433936] -2025-05-19 10:05:05,707 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 2.75734990e-12 -1.57079926e+00] -2025-05-19 10:05:05,723 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999992 -0.13499991 0.34424063] -2025-05-19 10:05:05,724 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79998747e+02 -2.43098237e-03 -9.00023489e+01] -2025-05-19 10:05:05,725 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999979 -0.13499988 0.34433932] -2025-05-19 10:05:05,730 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 1.60849112e-12 -1.57079926e+00] -2025-05-19 10:05:05,744 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999992 -0.13499991 0.3442403 ] -2025-05-19 10:05:05,752 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79998356e+02 -1.64466089e-03 -9.00013216e+01] -2025-05-19 10:05:05,753 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000005 -0.13499988 0.3443389 ] -2025-05-19 10:05:05,755 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159159e+00 4.79366698e-07 -1.57079872e+00] -2025-05-19 10:05:05,767 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999992 -0.13499991 0.34424005] -2025-05-19 10:05:05,769 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79996625e+02 -3.80025628e-03 -9.00027721e+01] -2025-05-19 10:05:05,771 - 测试日志 - INFO - log.py:106 - position current:[ 0.24997073 -0.13500058 0.34430258] -2025-05-19 10:05:05,773 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14147388e+00 -2.87678396e-06 -1.57080059e+00] -2025-05-19 10:05:05,789 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999992 -0.13499991 0.34423986] -2025-05-19 10:05:05,792 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79997371e+02 -1.23039550e-03 -9.00048932e+01] -2025-05-19 10:05:05,797 - 测试日志 - INFO - log.py:106 - position current:[ 0.24996602 -0.13500093 0.34429745] -2025-05-19 10:05:05,799 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14145550e+00 -3.35630590e-06 -1.57080205e+00] -2025-05-19 10:05:05,808 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999992 -0.13499991 0.34423972] -2025-05-19 10:05:05,811 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79995501e+02 -5.23433975e-03 -9.00057151e+01] -2025-05-19 10:05:05,817 - 测试日志 - INFO - log.py:106 - position current:[ 0.24996593 -0.13500081 0.34429752] -2025-05-19 10:05:05,821 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14145470e+00 -3.83548141e-06 -1.57079966e+00] -2025-05-19 10:05:05,833 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999992 -0.13499991 0.34423961] -2025-05-19 10:05:05,835 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79997612e+02 -2.53266549e-04 -9.00005543e+01] -2025-05-19 10:05:05,836 - 测试日志 - INFO - log.py:106 - position current:[ 0.24996535 -0.13500093 0.34429709] -2025-05-19 10:05:05,838 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14145310e+00 -3.83555380e-06 -1.57080059e+00] -2025-05-19 10:05:05,854 - 测试日志 - INFO - log.py:106 - 机械臂控制线程启动 -2025-05-19 10:05:05,855 - 测试日志 - INFO - log.py:106 - MassageRobot启动 -2025-05-19 10:07:37,761 - 测试日志 - INFO - log.py:106 - 切换到finger_head按摩头 -2025-05-19 10:07:41,275 - 测试日志 - INFO - log.py:106 - 机械臂测量线程启动 -2025-05-19 10:07:41,277 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999991 -0.13500046 0.34431338] -2025-05-19 10:07:41,278 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999832e+02 -1.09863598e-04 -9.00001068e+01] -2025-05-19 10:07:41,295 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000041 -0.13500058 0.34433969] -2025-05-19 10:07:41,297 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159079e+00 -2.39684041e-06 -1.57079872e+00] -2025-05-19 10:07:41,302 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000039 -0.13500058 0.3442959 ] -2025-05-19 10:07:41,304 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999894e+02 -1.37232712e-04 -9.00001372e+01] -2025-05-19 10:07:41,306 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999998 -0.1350007 0.34433923] -2025-05-19 10:07:41,307 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 -1.91747593e-06 -1.57079926e+00] -2025-05-19 10:07:41,319 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000038 -0.13500057 0.3442818 ] -2025-05-19 10:07:41,322 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999895e+02 -1.37138987e-04 -9.00001371e+01] -2025-05-19 10:07:41,328 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000018 -0.13500081 0.3443399 ] -2025-05-19 10:07:41,331 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159079e+00 -2.87621022e-06 -1.57079872e+00] -2025-05-19 10:07:41,343 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000037 -0.13500057 0.34427123] -2025-05-19 10:07:41,349 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999896e+02 -1.37047605e-04 -9.00001370e+01] -2025-05-19 10:07:41,356 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999986 -0.13500023 0.34433914] -2025-05-19 10:07:41,363 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 -1.91747505e-06 -1.57079726e+00] -2025-05-19 10:07:41,373 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000036 -0.13500057 0.3442633 ] -2025-05-19 10:07:41,376 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999897e+02 -1.36958508e-04 -9.00001369e+01] -2025-05-19 10:07:41,382 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999992 -0.1350007 0.34433902] -2025-05-19 10:07:41,385 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 -2.39684600e-06 -1.57079872e+00] -2025-05-19 10:07:41,390 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000036 -0.13500057 0.34425735] -2025-05-19 10:07:41,394 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999898e+02 -1.36871638e-04 -9.00001368e+01] -2025-05-19 10:07:41,398 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999997 -0.13500058 0.34433972] -2025-05-19 10:07:41,403 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14158972e+00 -2.39683939e-06 -1.57079819e+00] -2025-05-19 10:07:41,410 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000035 -0.13500057 0.34425289] -2025-05-19 10:07:41,413 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999899e+02 -1.36786940e-04 -9.00001367e+01] -2025-05-19 10:07:41,418 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999994 -0.13500058 0.34433963] -2025-05-19 10:07:41,421 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 -1.91747416e-06 -1.57079872e+00] -2025-05-19 10:07:41,430 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000035 -0.13500057 0.34424954] -2025-05-19 10:07:41,433 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999899e+02 -1.36704359e-04 -9.00001366e+01] -2025-05-19 10:07:41,438 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999997 -0.13500023 0.34433969] -2025-05-19 10:07:41,442 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159079e+00 -1.43810244e-06 -1.57079819e+00] -2025-05-19 10:07:41,454 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000035 -0.13500056 0.34424703] -2025-05-19 10:07:41,458 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999900e+02 -1.36623843e-04 -9.00001365e+01] -2025-05-19 10:07:41,466 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999973 -0.135 0.34433899] -2025-05-19 10:07:41,469 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 -4.79370158e-07 -1.57079819e+00] -2025-05-19 10:07:41,475 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000035 -0.13500056 0.34424515] -2025-05-19 10:07:41,483 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999901e+02 -1.36545340e-04 -9.00001365e+01] -2025-05-19 10:07:41,485 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999998 -0.13499976 0.34433948] -2025-05-19 10:07:41,489 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159132e+00 -4.79366253e-07 -1.57079686e+00] -2025-05-19 10:07:41,510 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000035 -0.13500056 0.34424374] -2025-05-19 10:07:41,515 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999902e+02 -1.36468799e-04 -9.00001364e+01] -2025-05-19 10:07:41,530 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999992 -0.135 0.34433981] -2025-05-19 10:07:41,531 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159026e+00 -4.79364412e-07 -1.57079779e+00] -2025-05-19 10:07:41,532 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000034 -0.13500056 0.34424268] -2025-05-19 10:07:41,535 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999903e+02 -1.36394172e-04 -9.00001363e+01] -2025-05-19 10:07:41,536 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999957 -0.135 0.34433951] -2025-05-19 10:07:41,538 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 -4.79367142e-07 -1.57079779e+00] -2025-05-19 10:07:41,552 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000034 -0.13500056 0.34424189] -2025-05-19 10:07:41,553 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999903e+02 -1.36321411e-04 -9.00001362e+01] -2025-05-19 10:07:41,554 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999973 -0.13500023 0.34433932] -2025-05-19 10:07:41,556 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159132e+00 -4.79366253e-07 -1.57079872e+00] -2025-05-19 10:07:41,573 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000034 -0.13500056 0.34424129] -2025-05-19 10:07:41,574 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999904e+02 -1.36250468e-04 -9.00001361e+01] -2025-05-19 10:07:41,575 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999989 -0.135 0.3443396 ] -2025-05-19 10:07:41,576 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159132e+00 4.79371079e-07 -1.57079819e+00] -2025-05-19 10:07:41,592 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000034 -0.13500056 0.34424085] -2025-05-19 10:07:41,593 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999905e+02 -1.36181300e-04 -9.00001361e+01] -2025-05-19 10:07:41,594 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999988 -0.13500023 0.34433914] -2025-05-19 10:07:41,594 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 -4.79368983e-07 -1.57079872e+00] -2025-05-19 10:07:41,612 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000034 -0.13500056 0.34424051] -2025-05-19 10:07:41,613 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999905e+02 -1.36113860e-04 -9.00001360e+01] -2025-05-19 10:07:41,615 - 测试日志 - INFO - log.py:106 - position current:[ 0.24996584 -0.13500058 0.34429688] -2025-05-19 10:07:41,616 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14145231e+00 -2.87675246e-06 -1.57079966e+00] -2025-05-19 10:07:41,633 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000034 -0.13500056 0.34424026] -2025-05-19 10:07:41,633 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999906e+02 -1.36048106e-04 -9.00001359e+01] -2025-05-19 10:07:41,634 - 测试日志 - INFO - log.py:106 - position current:[ 0.24996573 -0.13500069 0.34429681] -2025-05-19 10:07:41,635 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14145177e+00 -3.35619110e-06 -1.57080019e+00] -2025-05-19 10:07:41,653 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000034 -0.13500056 0.34424007] -2025-05-19 10:07:41,657 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999907e+02 -1.35983997e-04 -9.00001358e+01] -2025-05-19 10:07:41,661 - 测试日志 - INFO - log.py:106 - position current:[ 0.24996567 -0.13500069 0.34429709] -2025-05-19 10:07:41,663 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14145231e+00 -3.35618881e-06 -1.57080019e+00] -2025-05-19 10:07:41,679 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000034 -0.13500056 0.34423993] -2025-05-19 10:07:41,680 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999907e+02 -1.35921490e-04 -9.00001358e+01] -2025-05-19 10:07:41,681 - 测试日志 - INFO - log.py:106 - position current:[ 0.24996567 -0.13500058 0.34429724] -2025-05-19 10:07:41,683 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14145231e+00 -2.87682002e-06 -1.57080019e+00] -2025-05-19 10:07:41,699 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000034 -0.13500056 0.34423983] -2025-05-19 10:07:41,700 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999908e+02 -1.35860545e-04 -9.00001357e+01] -2025-05-19 10:07:41,701 - 测试日志 - INFO - log.py:106 - position current:[ 0.24996567 -0.13500069 0.34429709] -2025-05-19 10:07:41,702 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14145231e+00 -3.35618881e-06 -1.57080019e+00] -2025-05-19 10:07:41,719 - 测试日志 - INFO - log.py:106 - MassageRobot启动 -2025-05-19 10:07:41,719 - 测试日志 - INFO - log.py:106 - 机械臂控制线程启动 -2025-05-19 10:12:10,090 - 测试日志 - INFO - log.py:106 - 切换到finger_head按摩头 -2025-05-19 10:12:13,603 - 测试日志 - INFO - log.py:106 - 机械臂测量线程启动 -2025-05-19 10:12:13,605 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000014 -0.13500046 0.34431448] -2025-05-19 10:12:13,606 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79994756e+02 -2.56405012e-03 -9.00008278e+01] -2025-05-19 10:12:13,607 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999988 -0.13500035 0.34433862] -2025-05-19 10:12:13,609 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159079e+00 -1.91748063e-06 -1.57079819e+00] -2025-05-19 10:12:13,610 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999989 -0.13500035 0.3442949 ] -2025-05-19 10:12:13,618 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79996752e+02 -3.60509732e-03 -9.00053443e+01] -2025-05-19 10:12:13,620 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999992 -0.13500046 0.34433948] -2025-05-19 10:12:13,621 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159132e+00 -2.87621123e-06 -1.57079726e+00] -2025-05-19 10:12:13,635 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999994 -0.13500046 0.34428169] -2025-05-19 10:12:13,637 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79997715e+02 -4.64413262e-03 -9.00048261e+01] -2025-05-19 10:12:13,639 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999992 -0.13500058 0.34433868] -2025-05-19 10:12:13,641 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159132e+00 -2.39684981e-06 -1.57079966e+00] -2025-05-19 10:12:13,654 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999994 -0.13500058 0.34427037] -2025-05-19 10:12:13,658 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999935e+02 -1.84279279e-03 -9.00047457e+01] -2025-05-19 10:12:13,666 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000015 -0.13500011 0.3443396 ] -2025-05-19 10:12:13,673 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159132e+00 -1.91747327e-06 -1.57079686e+00] -2025-05-19 10:12:13,686 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000027 -0.13500024 0.34426327] -2025-05-19 10:12:13,688 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79998358e+02 -3.62732327e-03 -9.00033528e+01] -2025-05-19 10:12:13,690 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000026 -0.13500023 0.34433951] -2025-05-19 10:12:13,692 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159132e+00 -1.91747327e-06 -1.57079726e+00] -2025-05-19 10:12:13,700 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000026 -0.13500024 0.34425436] -2025-05-19 10:12:13,704 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999227e+02 -1.80729616e-04 -9.00048947e+01] -2025-05-19 10:12:13,708 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000002 -0.13500035 0.34433914] -2025-05-19 10:12:13,712 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 -1.91747593e-06 -1.57079872e+00] -2025-05-19 10:12:13,719 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000001 -0.13500037 0.34424673] -2025-05-19 10:12:13,724 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999488e+02 -5.36432320e-03 -9.00045578e+01] -2025-05-19 10:12:13,726 - 测试日志 - INFO - log.py:106 - position current:[ 0.2499998 -0.1350007 0.34433948] -2025-05-19 10:12:13,728 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159132e+00 -2.87620996e-06 -1.57079926e+00] -2025-05-19 10:12:13,749 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000002 -0.13500037 0.3442409 ] -2025-05-19 10:12:13,752 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79996854e+02 -1.00508466e-03 -9.00047445e+01] -2025-05-19 10:12:13,755 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999977 -0.1350007 0.34433902] -2025-05-19 10:12:13,757 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 -2.87621403e-06 -1.57079819e+00] -2025-05-19 10:12:13,769 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999996 -0.13500195 0.34423787] -2025-05-19 10:12:13,771 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79995982e+02 -7.55974415e-04 -9.00020508e+01] -2025-05-19 10:12:13,773 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999995 -0.13500058 0.34433942] -2025-05-19 10:12:13,774 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159132e+00 -2.39684092e-06 -1.57079926e+00] -2025-05-19 10:12:13,781 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999997 -0.1350026 0.34423617] -2025-05-19 10:12:13,786 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79995908e+02 -3.77872383e-03 -9.00044993e+01] -2025-05-19 10:12:13,788 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999995 -0.13500058 0.34433942] -2025-05-19 10:12:13,791 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159132e+00 -2.39684092e-06 -1.57079926e+00] -2025-05-19 10:12:13,803 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999997 -0.13500282 0.34423546] -2025-05-19 10:12:13,807 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79995351e+02 -4.37792568e-03 -9.00048820e+01] -2025-05-19 10:12:13,809 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999956 -0.1350007 0.3443392 ] -2025-05-19 10:12:13,811 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 -2.87621276e-06 -1.57079872e+00] -2025-05-19 10:12:13,821 - 测试日志 - INFO - log.py:106 - position command: [ 0.2499996 -0.13500289 0.34423511] -2025-05-19 10:12:13,823 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999013e+02 -2.99473191e-03 -9.00045923e+01] -2025-05-19 10:12:13,827 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000015 -0.13500046 0.34433975] -2025-05-19 10:12:13,829 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159026e+00 -2.87620717e-06 -1.57079819e+00] -2025-05-19 10:12:13,840 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000018 -0.1350025 0.34423589] -2025-05-19 10:12:13,844 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79995719e+02 -3.32997381e-03 -9.00056924e+01] -2025-05-19 10:12:13,847 - 测试日志 - INFO - log.py:106 - position current:[ 0.2500002 -0.13500058 0.34433951] -2025-05-19 10:12:13,849 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159132e+00 -2.87621047e-06 -1.57079819e+00] -2025-05-19 10:12:13,863 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999993 -0.13500227 0.34423605] -2025-05-19 10:12:13,866 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79997552e+02 -5.04571586e-03 -9.00001173e+01] -2025-05-19 10:12:13,867 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999997 -0.13500046 0.34433954] -2025-05-19 10:12:13,869 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 -2.87621174e-06 -1.57079779e+00] -2025-05-19 10:12:13,880 - 测试日志 - INFO - log.py:106 - position command: [ 0.25 -0.13500202 0.34423649] -2025-05-19 10:12:13,882 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79997393e+02 -1.54291090e-03 -9.00057294e+01] -2025-05-19 10:12:13,885 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999992 -0.13500058 0.34433948] -2025-05-19 10:12:13,887 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159132e+00 -3.35557876e-06 -1.57079819e+00] -2025-05-19 10:12:13,902 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999995 -0.1350019 0.34423687] -2025-05-19 10:12:13,905 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79994704e+02 -2.14259842e-03 -9.00028670e+01] -2025-05-19 10:12:13,907 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999971 -0.13500105 0.34433969] -2025-05-19 10:12:13,909 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159079e+00 -2.87620844e-06 -1.57080059e+00] -2025-05-19 10:12:13,921 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999975 -0.13500213 0.3442375 ] -2025-05-19 10:12:13,924 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79998098e+02 -5.29066585e-03 -9.00030163e+01] -2025-05-19 10:12:13,926 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999945 -0.13500046 0.3443385 ] -2025-05-19 10:12:13,930 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159159e+00 -2.39684854e-06 -1.57079966e+00] -2025-05-19 10:12:13,941 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000085 -0.13500135 0.34423808] -2025-05-19 10:12:13,943 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79995030e+02 -1.00032927e-03 -9.00009644e+01] -2025-05-19 10:12:13,947 - 测试日志 - INFO - log.py:106 - position current:[ 0.24996632 -0.13500046 0.34429785] -2025-05-19 10:12:13,950 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14145470e+00 -2.87680961e-06 -1.57079966e+00] -2025-05-19 10:12:13,966 - 测试日志 - INFO - log.py:106 - position command: [ 0.24996825 -0.1350013 0.34419674] -2025-05-19 10:12:13,968 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79992721e+02 -4.34144939e-03 -9.00009217e+01] -2025-05-19 10:12:13,971 - 测试日志 - INFO - log.py:106 - position current:[ 0.24996642 -0.13500058 0.34429745] -2025-05-19 10:12:13,973 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14145364e+00 -3.35618272e-06 -1.57079966e+00] -2025-05-19 10:12:13,981 - 测试日志 - INFO - log.py:106 - position command: [ 0.24997003 -0.13500116 0.3441984 ] -2025-05-19 10:12:13,988 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79994564e+02 -5.48814731e-03 -9.00017413e+01] -2025-05-19 10:12:13,993 - 测试日志 - INFO - log.py:106 - position current:[ 0.24996631 -0.13500035 0.34429758] -2025-05-19 10:12:13,996 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14145417e+00 -1.91807367e-06 -1.57080019e+00] -2025-05-19 10:12:14,001 - 测试日志 - INFO - log.py:106 - 机械臂控制线程启动 -2025-05-19 10:12:14,004 - 测试日志 - INFO - log.py:106 - MassageRobot启动 -2025-05-19 10:12:16,688 - 测试日志 - ERROR - log.py:106 - 传感器数据读取失败 -2025-05-19 10:12:16,691 - 测试日志 - ERROR - log.py:106 - 传感器线程数据读取失败-1 -2025-05-19 10:12:29,532 - 测试日志 - INFO - log.py:106 - 切换到finger_head按摩头 -2025-05-19 10:12:33,038 - 测试日志 - INFO - log.py:106 - 机械臂测量线程启动 -2025-05-19 10:12:33,061 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000006 -0.13500046 0.34430962] -2025-05-19 10:12:33,063 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79994852e+02 -5.60862375e-03 -9.00046699e+01] -2025-05-19 10:12:33,070 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000006 -0.13500046 0.34433917] -2025-05-19 10:12:33,072 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 -1.91747530e-06 -1.57079779e+00] -2025-05-19 10:12:33,078 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999994 -0.13500034 0.34428992] -2025-05-19 10:12:33,080 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79996063e+02 -4.46868285e-03 -9.00012097e+01] -2025-05-19 10:12:33,081 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000012 -0.1350007 0.34433969] -2025-05-19 10:12:33,086 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159132e+00 -2.87621250e-06 -1.57079726e+00] -2025-05-19 10:12:33,099 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999956 -0.13500046 0.3442761 ] -2025-05-19 10:12:33,102 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79996789e+02 -3.81510304e-03 -9.00001857e+01] -2025-05-19 10:12:33,105 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000008 -0.13500034 0.34433914] -2025-05-19 10:12:33,107 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 -2.39684498e-06 -1.57079633e+00] -2025-05-19 10:12:33,125 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000003 -0.13500046 0.34426639] -2025-05-19 10:12:33,127 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79996864e+02 -5.57814949e-03 -9.00048620e+01] -2025-05-19 10:12:33,137 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999994 -0.13500058 0.34433896] -2025-05-19 10:12:33,148 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159159e+00 -2.87621530e-06 -1.57079726e+00] -2025-05-19 10:12:33,150 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999996 -0.13500058 0.34425917] -2025-05-19 10:12:33,153 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79997377e+02 -4.76815069e-04 -9.00008801e+01] -2025-05-19 10:12:33,156 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000052 -0.13500046 0.34433972] -2025-05-19 10:12:33,170 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159132e+00 -2.39684295e-06 -1.57079726e+00] -2025-05-19 10:12:33,186 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000052 -0.13500046 0.34425451] -2025-05-19 10:12:33,188 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79996946e+02 -8.95846005e-04 -9.00034034e+01] -2025-05-19 10:12:33,189 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999992 -0.1350007 0.34433902] -2025-05-19 10:12:33,190 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 -2.39684523e-06 -1.57079726e+00] -2025-05-19 10:12:33,192 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000024 -0.13500046 0.34425025] -2025-05-19 10:12:33,193 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999273e+02 -5.26430217e-03 -9.00031904e+01] -2025-05-19 10:12:33,193 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999992 -0.1350007 0.34433902] -2025-05-19 10:12:33,194 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 -2.39684523e-06 -1.57079726e+00] -2025-05-19 10:12:33,213 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999992 -0.1350007 0.34424697] -2025-05-19 10:12:33,214 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79996994e+02 -4.43715146e-03 -9.00048191e+01] -2025-05-19 10:12:33,214 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000012 -0.13500034 0.34433902] -2025-05-19 10:12:33,215 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 -2.39684574e-06 -1.57079686e+00] -2025-05-19 10:12:33,235 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000012 -0.13500034 0.34424485] -2025-05-19 10:12:33,236 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79998830e+02 -5.27165229e-03 -9.00004149e+01] -2025-05-19 10:12:33,237 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000011 -0.13500034 0.34433856] -2025-05-19 10:12:33,238 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159079e+00 -2.39684676e-06 -1.57079633e+00] -2025-05-19 10:12:33,265 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999996 -0.13500034 0.3442435 ] -2025-05-19 10:12:33,267 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79998117e+02 -9.30328975e-04 -9.00031020e+01] -2025-05-19 10:12:33,268 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999959 -0.13500046 0.34433847] -2025-05-19 10:12:33,270 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159026e+00 -2.39684727e-06 -1.57079686e+00] -2025-05-19 10:12:33,276 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999997 -0.13500034 0.34424235] -2025-05-19 10:12:33,292 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79996925e+02 -3.63633983e-04 -9.00043017e+01] -2025-05-19 10:12:33,293 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000024 -0.13500058 0.34433942] -2025-05-19 10:12:33,298 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 -2.87621250e-06 -1.57079726e+00] -2025-05-19 10:12:33,306 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000005 -0.13500024 0.34424072] -2025-05-19 10:12:33,307 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79994973e+02 -2.82283225e-03 -9.00054693e+01] -2025-05-19 10:12:33,308 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999982 -0.1350007 0.34433881] -2025-05-19 10:12:33,309 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159159e+00 -2.39684600e-06 -1.57079779e+00] -2025-05-19 10:12:33,326 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999987 -0.13500059 0.34423992] -2025-05-19 10:12:33,328 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79996695e+02 -3.60863296e-03 -9.00005403e+01] -2025-05-19 10:12:33,333 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000002 -0.13500058 0.34433896] -2025-05-19 10:12:33,334 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 -2.87621403e-06 -1.57079726e+00] -2025-05-19 10:12:33,365 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000014 -0.13500046 0.34424013] -2025-05-19 10:12:33,381 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79995349e+02 -3.85570222e-03 -9.00001866e+01] -2025-05-19 10:12:33,384 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000023 -0.13500058 0.34433929] -2025-05-19 10:12:33,390 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 -2.39684447e-06 -1.57079726e+00] -2025-05-19 10:12:33,395 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000024 -0.13500058 0.34424025] -2025-05-19 10:12:33,397 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999342e+02 -1.26709962e-03 -9.00022666e+01] -2025-05-19 10:12:33,398 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000018 -0.13500023 0.34433936] -2025-05-19 10:12:33,399 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 -1.91747530e-06 -1.57079686e+00] -2025-05-19 10:12:33,415 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999996 -0.13500046 0.34423979] -2025-05-19 10:12:33,418 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79998241e+02 -5.67343674e-04 -9.00046729e+01] -2025-05-19 10:12:33,419 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999989 -0.13500046 0.34433893] -2025-05-19 10:12:33,422 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 -2.39684574e-06 -1.57079726e+00] -2025-05-19 10:12:33,437 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999991 -0.13500046 0.34423947] -2025-05-19 10:12:33,439 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79998951e+02 -4.73310312e-03 -9.00019297e+01] -2025-05-19 10:12:33,440 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999959 -0.13500035 0.34433832] -2025-05-19 10:12:33,442 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159026e+00 -1.91747822e-06 -1.57079686e+00] -2025-05-19 10:12:33,452 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999966 -0.13500081 0.34423916] -2025-05-19 10:12:33,453 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79995476e+02 -4.23580612e-03 -9.00018020e+01] -2025-05-19 10:12:33,454 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999985 -0.13500069 0.34433902] -2025-05-19 10:12:33,455 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 -3.35558308e-06 -1.57079686e+00] -2025-05-19 10:12:33,475 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999973 -0.13500079 0.34423907] -2025-05-19 10:12:33,477 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79997611e+02 -4.04321489e-03 -9.00052083e+01] -2025-05-19 10:12:33,479 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999995 -0.13500046 0.34433926] -2025-05-19 10:12:33,480 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 -2.39684473e-06 -1.57079633e+00] -2025-05-19 10:12:33,501 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999991 -0.13500044 0.34423856] -2025-05-19 10:12:33,504 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79996399e+02 -2.03033247e-03 -9.00056305e+01] -2025-05-19 10:12:33,506 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999971 -0.1350007 0.3443392 ] -2025-05-19 10:12:33,510 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 -2.39684498e-06 -1.57079779e+00] -2025-05-19 10:12:33,522 - 测试日志 - INFO - log.py:106 - MassageRobot启动 -2025-05-19 10:12:33,522 - 测试日志 - INFO - log.py:106 - 机械臂控制线程启动 -2025-05-19 10:14:35,869 - 测试日志 - INFO - log.py:106 - 切换到finger_head按摩头 -2025-05-19 10:14:39,386 - 测试日志 - INFO - log.py:106 - 机械臂测量线程启动 -2025-05-19 10:14:39,387 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999979 -0.13500047 0.34431454] -2025-05-19 10:14:39,388 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999007e+02 -2.14279178e-03 -9.00042940e+01] -2025-05-19 10:14:39,390 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000024 -0.13500046 0.34433975] -2025-05-19 10:14:39,393 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159079e+00 -1.91746768e-06 -1.57080059e+00] -2025-05-19 10:14:39,395 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000023 -0.13499795 0.34429599] -2025-05-19 10:14:39,396 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79994461e+02 -4.03888050e-03 -9.00048524e+01] -2025-05-19 10:14:39,398 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999989 -0.13499998 0.34433939] -2025-05-19 10:14:39,399 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159132e+00 -1.91746844e-06 -1.57079966e+00] -2025-05-19 10:14:39,416 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000015 -0.13499503 0.34428175] -2025-05-19 10:14:39,417 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999698e+02 -2.49357384e-03 -9.00052430e+01] -2025-05-19 10:14:39,419 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999971 -0.1350007 0.34433902] -2025-05-19 10:14:39,420 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 -2.39684498e-06 -1.57080165e+00] -2025-05-19 10:14:39,439 - 测试日志 - INFO - log.py:106 - position command: [ 0.2500001 -0.1349928 0.34427094] -2025-05-19 10:14:39,441 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79994471e+02 -2.28458599e-03 -9.00013561e+01] -2025-05-19 10:14:39,443 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000002 -0.13500035 0.34433929] -2025-05-19 10:14:39,447 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 -1.43810193e-06 -1.57080165e+00] -2025-05-19 10:14:39,468 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999958 -0.13499245 0.34426257] -2025-05-19 10:14:39,474 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79997072e+02 -3.43082450e-03 -9.00050563e+01] -2025-05-19 10:14:39,481 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999947 -0.13500023 0.34433911] -2025-05-19 10:14:39,489 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 -1.43810473e-06 -1.57080059e+00] -2025-05-19 10:14:39,492 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999947 -0.13499314 0.34425695] -2025-05-19 10:14:39,499 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79995892e+02 -2.29426601e-03 -9.00043915e+01] -2025-05-19 10:14:39,501 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000026 -0.13500023 0.34433984] -2025-05-19 10:14:39,505 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159026e+00 -1.43809660e-06 -1.57080019e+00] -2025-05-19 10:14:39,519 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999952 -0.13499315 0.3442522 ] -2025-05-19 10:14:39,524 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79994431e+02 -1.65952335e-03 -9.00015813e+01] -2025-05-19 10:14:39,526 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999994 -0.13500046 0.34433896] -2025-05-19 10:14:39,529 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 -1.91747593e-06 -1.57080165e+00] -2025-05-19 10:14:39,534 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999953 -0.1349934 0.34424888] -2025-05-19 10:14:39,539 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79995060e+02 -3.13497107e-03 -9.00025843e+01] -2025-05-19 10:14:39,542 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999977 -0.13500046 0.3443392 ] -2025-05-19 10:14:39,548 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 -1.91747593e-06 -1.57080165e+00] -2025-05-19 10:14:39,555 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999981 -0.13499358 0.34424703] -2025-05-19 10:14:39,559 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79996551e+02 -2.92748529e-03 -9.00019831e+01] -2025-05-19 10:14:39,568 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000005 -0.13500046 0.3443389 ] -2025-05-19 10:14:39,574 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159159e+00 -1.91748063e-06 -1.57080112e+00] -2025-05-19 10:14:39,579 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999961 -0.13499461 0.34424418] -2025-05-19 10:14:39,583 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79998657e+02 -2.32599176e-03 -9.00035418e+01] -2025-05-19 10:14:39,592 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000072 -0.13499998 0.34433972] -2025-05-19 10:14:39,599 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159132e+00 -1.91746844e-06 -1.57079966e+00] -2025-05-19 10:14:39,613 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000006 -0.13499551 0.34424379] -2025-05-19 10:14:39,616 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999391e+02 -4.38952111e-03 -9.00019574e+01] -2025-05-19 10:14:39,619 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999973 -0.13500011 0.34433881] -2025-05-19 10:14:39,622 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159132e+00 -1.43811387e-06 -1.57080019e+00] -2025-05-19 10:14:39,624 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999973 -0.13499604 0.34424205] -2025-05-19 10:14:39,625 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79997597e+02 -3.80378058e-03 -9.00052124e+01] -2025-05-19 10:14:39,627 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999994 -0.13500058 0.34433948] -2025-05-19 10:14:39,631 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 -1.91747187e-06 -1.57080112e+00] -2025-05-19 10:14:39,646 - 测试日志 - INFO - log.py:106 - position command: [ 0.2499998 -0.13499694 0.34424185] -2025-05-19 10:14:39,650 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79995144e+02 -4.57444526e-03 -9.00036830e+01] -2025-05-19 10:14:39,655 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999994 -0.13500058 0.34433948] -2025-05-19 10:14:39,662 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 -1.91747098e-06 -1.57080205e+00] -2025-05-19 10:14:39,669 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999993 -0.13499787 0.34424131] -2025-05-19 10:14:39,672 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79997985e+02 -2.57216941e-03 -9.00023713e+01] -2025-05-19 10:14:39,678 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999962 -0.13500035 0.34433926] -2025-05-19 10:14:39,685 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159265e+00 -1.43810701e-06 -1.57080165e+00] -2025-05-19 10:14:39,693 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000027 -0.13499808 0.34424097] -2025-05-19 10:14:39,696 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999377e+02 -1.62609162e-03 -9.00031904e+01] -2025-05-19 10:14:39,703 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000024 -0.13500023 0.34433957] -2025-05-19 10:14:39,708 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 -1.43810193e-06 -1.57080112e+00] -2025-05-19 10:14:39,714 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000021 -0.13499718 0.3442406 ] -2025-05-19 10:14:39,719 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79994587e+02 -5.71938269e-03 -9.00007670e+01] -2025-05-19 10:14:39,728 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999989 -0.13500035 0.34433926] -2025-05-19 10:14:39,733 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 -1.43810498e-06 -1.57080059e+00] -2025-05-19 10:14:39,737 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999986 -0.13499701 0.34424004] -2025-05-19 10:14:39,744 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79997321e+02 -1.95545423e-03 -9.00027613e+01] -2025-05-19 10:14:39,748 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999989 -0.13500047 0.34433926] -2025-05-19 10:14:39,751 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159132e+00 -1.43810016e-06 -1.57080165e+00] -2025-05-19 10:14:39,756 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000004 -0.13499719 0.34424007] -2025-05-19 10:14:39,757 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79996715e+02 -5.32486088e-03 -9.00008656e+01] -2025-05-19 10:14:39,758 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000012 -0.13500023 0.34433917] -2025-05-19 10:14:39,760 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 -1.43810473e-06 -1.57080059e+00] -2025-05-19 10:14:39,777 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999986 -0.13499734 0.34423939] -2025-05-19 10:14:39,780 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79997765e+02 -4.66604976e-03 -9.00012530e+01] -2025-05-19 10:14:39,785 - 测试日志 - INFO - log.py:106 - position current:[ 0.25 -0.1350006 0.34433969] -2025-05-19 10:14:39,792 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159132e+00 -1.43810016e-06 -1.57080205e+00] -2025-05-19 10:14:39,797 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999997 -0.13499792 0.34424003] -2025-05-19 10:14:39,799 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79998153e+02 -3.08700958e-03 -9.00048215e+01] -2025-05-19 10:14:39,802 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000003 -0.13500023 0.3443396 ] -2025-05-19 10:14:39,804 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159132e+00 -1.43809939e-06 -1.57080112e+00] -2025-05-19 10:14:39,819 - 测试日志 - INFO - log.py:106 - 机械臂控制线程启动 -2025-05-19 10:14:39,823 - 测试日志 - INFO - log.py:106 - MassageRobot启动 -2025-05-19 10:15:39,975 - 测试日志 - INFO - log.py:106 - 切换到finger_head按摩头 -2025-05-19 10:15:43,487 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999989 -0.13500046 0.34431442] -2025-05-19 10:15:43,488 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79994478e+02 -2.28932694e-04 -9.00047469e+01] -2025-05-19 10:15:43,489 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999994 -0.13500035 0.34433963] -2025-05-19 10:15:43,491 - 测试日志 - INFO - log.py:106 - 机械臂测量线程启动 -2025-05-19 10:15:43,491 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 -9.58733840e-07 -1.57080112e+00] -2025-05-19 10:15:43,496 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999988 -0.13500046 0.34429523] -2025-05-19 10:15:43,497 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79998150e+02 -5.66593885e-03 -9.00021885e+01] -2025-05-19 10:15:43,498 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999988 -0.13500046 0.34433896] -2025-05-19 10:15:43,499 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159159e+00 -1.91748063e-06 -1.57080112e+00] -2025-05-19 10:15:43,516 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000027 -0.13500046 0.34428197] -2025-05-19 10:15:43,517 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79996463e+02 -2.65178379e-03 -9.00003538e+01] -2025-05-19 10:15:43,518 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999966 -0.13500035 0.34433899] -2025-05-19 10:15:43,519 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 -1.43810905e-06 -1.57080059e+00] -2025-05-19 10:15:43,542 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000001 -0.13500069 0.3442717 ] -2025-05-19 10:15:43,543 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79996455e+02 -4.22117999e-04 -9.00048370e+01] -2025-05-19 10:15:43,544 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999994 -0.13500046 0.34433896] -2025-05-19 10:15:43,545 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 -1.91747593e-06 -1.57080165e+00] -2025-05-19 10:15:43,562 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000131 -0.13500047 0.3442628 ] -2025-05-19 10:15:43,564 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79995369e+02 -5.45910840e-03 -9.00027331e+01] -2025-05-19 10:15:43,569 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000023 -0.13500035 0.34433911] -2025-05-19 10:15:43,571 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 -1.43810498e-06 -1.57080059e+00] -2025-05-19 10:15:43,581 - 测试日志 - INFO - log.py:106 - position command: [ 0.2500037 -0.13499881 0.34425698] -2025-05-19 10:15:43,582 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79996111e+02 -7.64966780e-04 -9.00028473e+01] -2025-05-19 10:15:43,583 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000006 -0.13500035 0.34433884] -2025-05-19 10:15:43,585 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 -1.91747809e-06 -1.57080019e+00] -2025-05-19 10:15:43,602 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000453 -0.13499849 0.34425114] -2025-05-19 10:15:43,605 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79998752e+02 -2.17988166e-03 -9.00029691e+01] -2025-05-19 10:15:43,609 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999992 -0.13500058 0.3443385 ] -2025-05-19 10:15:43,610 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159132e+00 -2.39685108e-06 -1.57080059e+00] -2025-05-19 10:15:43,624 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000469 -0.13499655 0.34424867] -2025-05-19 10:15:43,626 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79997526e+02 -5.53454752e-03 -9.00058841e+01] -2025-05-19 10:15:43,627 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000008 -0.13500023 0.34433948] -2025-05-19 10:15:43,629 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 -1.43810282e-06 -1.57080019e+00] -2025-05-19 10:15:43,643 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000459 -0.13499616 0.34424668] -2025-05-19 10:15:43,644 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79997797e+02 -3.66705215e-03 -9.00052022e+01] -2025-05-19 10:15:43,645 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000012 -0.13500046 0.34433951] -2025-05-19 10:15:43,646 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 -2.39684295e-06 -1.57080019e+00] -2025-05-19 10:15:43,663 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000368 -0.13499612 0.34424471] -2025-05-19 10:15:43,664 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79994548e+02 -3.06001257e-04 -9.00003376e+01] -2025-05-19 10:15:43,665 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000008 -0.13500035 0.34433981] -2025-05-19 10:15:43,665 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159079e+00 -1.43809876e-06 -1.57080059e+00] -2025-05-19 10:15:43,684 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000318 -0.1349965 0.34424318] -2025-05-19 10:15:43,687 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999128e+02 -3.39510162e-03 -9.00038338e+01] -2025-05-19 10:15:43,691 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000012 -0.13500035 0.34433951] -2025-05-19 10:15:43,694 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 -1.91747390e-06 -1.57080019e+00] -2025-05-19 10:15:43,705 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000283 -0.13499692 0.34424221] -2025-05-19 10:15:43,708 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79995474e+02 -3.13813778e-03 -9.00016019e+01] -2025-05-19 10:15:43,709 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999965 -0.13500046 0.34433835] -2025-05-19 10:15:43,710 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159079e+00 -1.91748432e-06 -1.57080059e+00] -2025-05-19 10:15:43,724 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000414 -0.13499717 0.34424145] -2025-05-19 10:15:43,726 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79995992e+02 -1.89195249e-03 -9.00051092e+01] -2025-05-19 10:15:43,727 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999989 -0.13500047 0.34433975] -2025-05-19 10:15:43,728 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159132e+00 -1.43810079e-06 -1.57080112e+00] -2025-05-19 10:15:43,744 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000535 -0.13499619 0.3442415 ] -2025-05-19 10:15:43,745 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79995855e+02 -1.21012982e-04 -9.00057013e+01] -2025-05-19 10:15:43,746 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000026 -0.13500035 0.34433969] -2025-05-19 10:15:43,747 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159026e+00 -1.91746679e-06 -1.57079966e+00] -2025-05-19 10:15:43,763 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000737 -0.13499599 0.34424012] -2025-05-19 10:15:43,764 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999038e+02 -3.33372144e-03 -9.00051071e+01] -2025-05-19 10:15:43,765 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000027 -0.13500035 0.34433932] -2025-05-19 10:15:43,766 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 -1.43810701e-06 -1.57080059e+00] -2025-05-19 10:15:43,784 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000788 -0.13499629 0.34423998] -2025-05-19 10:15:43,785 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79996540e+02 -3.47883045e-03 -9.00052323e+01] -2025-05-19 10:15:43,787 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000012 -0.13500035 0.34433951] -2025-05-19 10:15:43,788 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 -1.91747416e-06 -1.57079966e+00] -2025-05-19 10:15:43,804 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000765 -0.13499666 0.34424017] -2025-05-19 10:15:43,806 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999886e+02 -1.11932903e-03 -9.00029534e+01] -2025-05-19 10:15:43,808 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000006 -0.13500035 0.34433917] -2025-05-19 10:15:43,810 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 -1.43810498e-06 -1.57080059e+00] -2025-05-19 10:15:43,825 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000694 -0.13499712 0.34423965] -2025-05-19 10:15:43,827 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999755e+02 -5.05320130e-03 -9.00026995e+01] -2025-05-19 10:15:43,828 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000002 -0.13500023 0.34433914] -2025-05-19 10:15:43,828 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 -1.43810701e-06 -1.57080019e+00] -2025-05-19 10:15:43,845 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000562 -0.13499758 0.34423927] -2025-05-19 10:15:43,846 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79996451e+02 -3.35264175e-03 -9.00024105e+01] -2025-05-19 10:15:43,846 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000023 -0.13500035 0.34433911] -2025-05-19 10:15:43,847 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 -1.91747822e-06 -1.57080059e+00] -2025-05-19 10:15:43,865 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000512 -0.13499791 0.34423965] -2025-05-19 10:15:43,872 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79994613e+02 -4.80889548e-04 -9.00056180e+01] -2025-05-19 10:15:43,874 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000046 -0.13500046 0.34433923] -2025-05-19 10:15:43,875 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 -2.39684295e-06 -1.57080019e+00] -2025-05-19 10:15:43,885 - 测试日志 - INFO - log.py:106 - MassageRobot启动 -2025-05-19 10:15:43,885 - 测试日志 - INFO - log.py:106 - 机械臂控制线程启动 -2025-05-19 10:16:59,761 - 测试日志 - INFO - log.py:106 - 切换到finger_head按摩头 -2025-05-19 10:17:03,280 - 测试日志 - INFO - log.py:106 - 机械臂测量线程启动 -2025-05-19 10:17:03,281 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999992 -0.13500105 0.34431436] -2025-05-19 10:17:03,286 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999652e+02 -1.87089232e-03 -9.00051579e+01] -2025-05-19 10:17:03,288 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000015 -0.13500117 0.34433936] -2025-05-19 10:17:03,289 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 -3.35558155e-06 -1.57079926e+00] -2025-05-19 10:17:03,291 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000241 -0.13500117 0.34430186] -2025-05-19 10:17:03,292 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79997127e+02 -7.56143264e-04 -9.00058446e+01] -2025-05-19 10:17:03,293 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999963 -0.13500105 0.34433908] -2025-05-19 10:17:03,295 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 -2.87621403e-06 -1.57079779e+00] -2025-05-19 10:17:03,312 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000226 -0.13500094 0.34429561] -2025-05-19 10:17:03,313 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79997781e+02 -2.81994889e-04 -9.00032340e+01] -2025-05-19 10:17:03,315 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000014 -0.13500117 0.3443389 ] -2025-05-19 10:17:03,317 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 -3.35558333e-06 -1.57079819e+00] -2025-05-19 10:17:03,332 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000239 -0.13500117 0.34429289] -2025-05-19 10:17:03,334 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79995862e+02 -3.75994976e-03 -9.00028353e+01] -2025-05-19 10:17:03,338 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999992 -0.13500117 0.34433908] -2025-05-19 10:17:03,343 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 -3.35558307e-06 -1.57079872e+00] -2025-05-19 10:17:03,354 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000187 -0.13500105 0.344291 ] -2025-05-19 10:17:03,361 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79998619e+02 -3.60479049e-03 -9.00027346e+01] -2025-05-19 10:17:03,365 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000012 -0.13500081 0.34433969] -2025-05-19 10:17:03,375 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159132e+00 -3.35558155e-06 -1.57079726e+00] -2025-05-19 10:17:03,383 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000124 -0.13500094 0.34428963] -2025-05-19 10:17:03,386 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79998997e+02 -6.77973722e-04 -9.00010804e+01] -2025-05-19 10:17:03,392 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000024 -0.13500081 0.34433905] -2025-05-19 10:17:03,397 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159079e+00 -2.87621581e-06 -1.57079779e+00] -2025-05-19 10:17:03,403 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000105 -0.13500094 0.34428908] -2025-05-19 10:17:03,411 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79996440e+02 -3.56794604e-03 -9.00012469e+01] -2025-05-19 10:17:03,414 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000009 -0.1350007 0.34434027] -2025-05-19 10:17:03,420 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14158919e+00 -2.87621073e-06 -1.57079726e+00] -2025-05-19 10:17:03,430 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000051 -0.13500107 0.34428932] -2025-05-19 10:17:03,433 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79996416e+02 -1.13250565e-03 -9.00004398e+01] -2025-05-19 10:17:03,441 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999988 -0.13500105 0.34433948] -2025-05-19 10:17:03,445 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 -3.35558206e-06 -1.57079819e+00] -2025-05-19 10:17:03,452 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000037 -0.13500073 0.34428903] -2025-05-19 10:17:03,458 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79995809e+02 -5.60133937e-03 -9.00033070e+01] -2025-05-19 10:17:03,464 - 测试日志 - INFO - log.py:106 - position current:[ 0.2500002 -0.13500081 0.34433969] -2025-05-19 10:17:03,470 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159026e+00 -3.35558079e-06 -1.57079726e+00] -2025-05-19 10:17:03,474 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000029 -0.13500095 0.34428955] -2025-05-19 10:17:03,477 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999172e+02 -3.63177690e-03 -9.00014115e+01] -2025-05-19 10:17:03,482 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000003 -0.13500093 0.34433862] -2025-05-19 10:17:03,485 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159132e+00 -3.35558511e-06 -1.57079819e+00] -2025-05-19 10:17:03,495 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000054 -0.13500073 0.34428935] -2025-05-19 10:17:03,501 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79994521e+02 -8.00740148e-04 -9.00046777e+01] -2025-05-19 10:17:03,504 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000026 -0.13500081 0.34433902] -2025-05-19 10:17:03,508 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159132e+00 -3.35558511e-06 -1.57079779e+00] -2025-05-19 10:17:03,521 - 测试日志 - INFO - log.py:106 - position command: [ 0.25 -0.13500107 0.34428986] -2025-05-19 10:17:03,523 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79996804e+02 -3.15261222e-03 -9.00028877e+01] -2025-05-19 10:17:03,524 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999985 -0.13500081 0.34433969] -2025-05-19 10:17:03,530 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159079e+00 -2.87621225e-06 -1.57079779e+00] -2025-05-19 10:17:03,542 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000002 -0.13500106 0.34428947] -2025-05-19 10:17:03,546 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999527e+02 -1.51819666e-03 -9.00057618e+01] -2025-05-19 10:17:03,552 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999988 -0.13500093 0.34433914] -2025-05-19 10:17:03,554 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 -3.35558307e-06 -1.57079726e+00] -2025-05-19 10:17:03,562 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000026 -0.13500106 0.34428929] -2025-05-19 10:17:03,566 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79996181e+02 -3.36967218e-03 -9.00029742e+01] -2025-05-19 10:17:03,568 - 测试日志 - INFO - log.py:106 - position current:[ 0.25 -0.13500093 0.34433917] -2025-05-19 10:17:03,569 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 -3.35558231e-06 -1.57079819e+00] -2025-05-19 10:17:03,591 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999995 -0.13500082 0.34428915] -2025-05-19 10:17:03,594 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79994876e+02 -5.69783265e-03 -9.00031980e+01] -2025-05-19 10:17:03,596 - 测试日志 - INFO - log.py:106 - position current:[ 0.25 -0.13500093 0.34433951] -2025-05-19 10:17:03,604 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159132e+00 -2.87621250e-06 -1.57079819e+00] -2025-05-19 10:17:03,611 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000004 -0.13500106 0.3442891 ] -2025-05-19 10:17:03,618 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79997576e+02 -5.66300840e-03 -9.00004740e+01] -2025-05-19 10:17:03,621 - 测试日志 - INFO - log.py:106 - position current:[ 0.2499998 -0.13500105 0.34433868] -2025-05-19 10:17:03,625 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159132e+00 -3.35558435e-06 -1.57079819e+00] -2025-05-19 10:17:03,629 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999985 -0.13500106 0.34428872] -2025-05-19 10:17:03,631 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79996453e+02 -2.45568063e-03 -9.00054090e+01] -2025-05-19 10:17:03,637 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000034 -0.13500058 0.34433951] -2025-05-19 10:17:03,641 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 -2.39684320e-06 -1.57079819e+00] -2025-05-19 10:17:03,654 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000001 -0.13500094 0.34428926] -2025-05-19 10:17:03,658 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79994889e+02 -6.32962181e-04 -9.00037136e+01] -2025-05-19 10:17:03,662 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999986 -0.13500093 0.34433868] -2025-05-19 10:17:03,670 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159132e+00 -3.35558511e-06 -1.57079819e+00] -2025-05-19 10:17:03,677 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999989 -0.13500094 0.34428873] -2025-05-19 10:17:03,680 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79995292e+02 -2.02686618e-03 -9.00027091e+01] -2025-05-19 10:17:03,687 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999991 -0.13500093 0.3443392 ] -2025-05-19 10:17:03,693 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159159e+00 -2.87621454e-06 -1.57079779e+00] -2025-05-19 10:17:03,695 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000027 -0.13500072 0.34428981] -2025-05-19 10:17:03,697 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79998331e+02 -6.57327590e-04 -9.00056745e+01] -2025-05-19 10:17:03,718 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999988 -0.13500081 0.34433929] -2025-05-19 10:17:03,725 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 -2.87621403e-06 -1.57079819e+00] -2025-05-19 10:17:03,731 - 测试日志 - INFO - log.py:106 - MassageRobot启动 -2025-05-19 10:17:03,733 - 测试日志 - INFO - log.py:106 - 机械臂控制线程启动 -2025-05-19 10:18:12,246 - 测试日志 - INFO - log.py:106 - 切换到finger_head按摩头 -2025-05-19 10:18:15,760 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000006 -0.1350007 0.34431436] -2025-05-19 10:18:15,762 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79998500e+02 -2.84515260e-03 -9.00033458e+01] -2025-05-19 10:18:15,763 - 测试日志 - INFO - log.py:106 - 机械臂测量线程启动 -2025-05-19 10:18:15,766 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000006 -0.1350007 0.34433936] -2025-05-19 10:18:15,769 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 -2.87620996e-06 -1.57080498e+00] -2025-05-19 10:18:15,771 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999966 -0.13500081 0.34430415] -2025-05-19 10:18:15,773 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999342e+02 -1.01180353e-03 -9.00060320e+01] -2025-05-19 10:18:15,774 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000009 -0.13500093 0.34433945] -2025-05-19 10:18:15,776 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 -2.87620996e-06 -1.57080591e+00] -2025-05-19 10:18:15,792 - 测试日志 - INFO - log.py:106 - position command: [ 0.2500002 -0.13500058 0.34429877] -2025-05-19 10:18:15,793 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79994843e+02 -5.29214391e-03 -9.00034858e+01] -2025-05-19 10:18:15,795 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999983 -0.13500058 0.34433859] -2025-05-19 10:18:15,797 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159132e+00 -2.87622571e-06 -1.57080405e+00] -2025-05-19 10:18:15,819 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999977 -0.13500058 0.34429428] -2025-05-19 10:18:15,821 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79994985e+02 -3.86707197e-03 -9.00020636e+01] -2025-05-19 10:18:15,823 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000023 -0.1350007 0.34433911] -2025-05-19 10:18:15,824 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 -2.87620996e-06 -1.57080498e+00] -2025-05-19 10:18:15,833 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000038 -0.13500081 0.34429281] -2025-05-19 10:18:15,836 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79994561e+02 -3.00466567e-03 -9.00049440e+01] -2025-05-19 10:18:15,839 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000017 -0.13500081 0.34433945] -2025-05-19 10:18:15,840 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 -2.87620996e-06 -1.57080538e+00] -2025-05-19 10:18:15,852 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000011 -0.13500093 0.34429188] -2025-05-19 10:18:15,853 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79998377e+02 -3.69849464e-03 -9.00026625e+01] -2025-05-19 10:18:15,854 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999983 -0.13500081 0.34433893] -2025-05-19 10:18:15,855 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 -3.35558714e-06 -1.57080498e+00] -2025-05-19 10:18:15,872 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999998 -0.13500093 0.34429059] -2025-05-19 10:18:15,873 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79994413e+02 -4.70527821e-03 -9.00010360e+01] -2025-05-19 10:18:15,874 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999998 -0.13500093 0.34433905] -2025-05-19 10:18:15,874 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159159e+00 -3.35559069e-06 -1.57080498e+00] -2025-05-19 10:18:15,893 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999982 -0.13500058 0.34428967] -2025-05-19 10:18:15,897 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79995233e+02 -4.96517955e-03 -9.00010524e+01] -2025-05-19 10:18:15,900 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999986 -0.13500046 0.34433966] -2025-05-19 10:18:15,902 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159132e+00 -2.39683330e-06 -1.57080405e+00] -2025-05-19 10:18:15,919 - 测试日志 - INFO - log.py:106 - position command: [ 0.25 -0.1350007 0.3442899] -2025-05-19 10:18:15,921 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79995201e+02 -5.77231694e-03 -9.00019831e+01] -2025-05-19 10:18:15,922 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999985 -0.13500081 0.3443392 ] -2025-05-19 10:18:15,924 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 -3.83495187e-06 -1.57080445e+00] -2025-05-19 10:18:15,937 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999989 -0.13500081 0.34428978] -2025-05-19 10:18:15,938 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79995078e+02 -1.17136995e-03 -9.00049325e+01] -2025-05-19 10:18:15,939 - 测试日志 - INFO - log.py:106 - position current:[ 0.2499996 -0.13500081 0.34433914] -2025-05-19 10:18:15,940 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 -2.87621809e-06 -1.57080538e+00] -2025-05-19 10:18:15,957 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999971 -0.13500081 0.34428923] -2025-05-19 10:18:15,958 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79995873e+02 -9.06894588e-04 -9.00036825e+01] -2025-05-19 10:18:15,959 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000008 -0.13500058 0.34433948] -2025-05-19 10:18:15,959 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 -2.87620615e-06 -1.57080405e+00] -2025-05-19 10:18:15,978 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999974 -0.1350007 0.34428904] -2025-05-19 10:18:15,983 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79997064e+02 -3.73445151e-03 -9.00060974e+01] -2025-05-19 10:18:15,984 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000002 -0.1350007 0.34433948] -2025-05-19 10:18:15,985 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 -2.87620615e-06 -1.57080445e+00] -2025-05-19 10:18:16,000 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999995 -0.1350007 0.34428979] -2025-05-19 10:18:16,001 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79995619e+02 -3.53779784e-03 -9.00032769e+01] -2025-05-19 10:18:16,002 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000005 -0.13500105 0.34433957] -2025-05-19 10:18:16,002 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 -3.35557571e-06 -1.57080498e+00] -2025-05-19 10:18:16,019 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999963 -0.13500058 0.34428952] -2025-05-19 10:18:16,020 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999833e+02 -4.82600341e-03 -9.00034663e+01] -2025-05-19 10:18:16,021 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000021 -0.1350007 0.34433914] -2025-05-19 10:18:16,022 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159159e+00 -2.87622139e-06 -1.57080405e+00] -2025-05-19 10:18:16,039 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999995 -0.13500058 0.34428936] -2025-05-19 10:18:16,041 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79994327e+02 -2.15538511e-03 -9.00027225e+01] -2025-05-19 10:18:16,042 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000005 -0.13500081 0.34433939] -2025-05-19 10:18:16,043 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 -2.87621403e-06 -1.57080445e+00] -2025-05-19 10:18:16,059 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999977 -0.1350007 0.34428909] -2025-05-19 10:18:16,067 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79998601e+02 -3.18590099e-03 -9.00015878e+01] -2025-05-19 10:18:16,068 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999989 -0.1350007 0.34433942] -2025-05-19 10:18:16,070 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 -2.87621022e-06 -1.57080405e+00] -2025-05-19 10:18:16,087 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999989 -0.13500081 0.34428947] -2025-05-19 10:18:16,089 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79997676e+02 -6.43517929e-04 -9.00047649e+01] -2025-05-19 10:18:16,090 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000041 -0.13500058 0.34433936] -2025-05-19 10:18:16,092 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 -2.87620742e-06 -1.57080259e+00] -2025-05-19 10:18:16,104 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000041 -0.13500058 0.34428939] -2025-05-19 10:18:16,105 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79997200e+02 -3.62134950e-04 -9.00005474e+01] -2025-05-19 10:18:16,106 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999988 -0.13500081 0.34433914] -2025-05-19 10:18:16,106 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 -2.87621403e-06 -1.57080405e+00] -2025-05-19 10:18:16,125 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999994 -0.1350007 0.34428899] -2025-05-19 10:18:16,126 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79997960e+02 -4.58471334e-03 -9.00029802e+01] -2025-05-19 10:18:16,130 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999998 -0.13500081 0.34433905] -2025-05-19 10:18:16,132 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159159e+00 -2.87622038e-06 -1.57080352e+00] -2025-05-19 10:18:16,145 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999971 -0.13500081 0.34428922] -2025-05-19 10:18:16,147 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999097e+02 -3.08332616e-03 -9.00043224e+01] -2025-05-19 10:18:16,147 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000002 -0.1350007 0.34433948] -2025-05-19 10:18:16,148 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 -2.87620742e-06 -1.57080298e+00] -2025-05-19 10:18:16,164 - 测试日志 - INFO - log.py:106 - MassageRobot启动 -2025-05-19 10:18:16,165 - 测试日志 - INFO - log.py:106 - 机械臂控制线程启动 -2025-05-19 10:21:40,587 - 测试日志 - INFO - log.py:106 - 切换到finger_head按摩头 -2025-05-19 10:21:44,102 - 测试日志 - INFO - log.py:106 - position command: [ 0.2499996 -0.13499988 0.34433359] -2025-05-19 10:21:44,103 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999044e+02 -4.41616059e-03 -9.00045435e+01] -2025-05-19 10:21:44,103 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999989 -0.13499988 0.34433841] -2025-05-19 10:21:44,104 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159132e+00 -4.79366253e-07 -1.57079340e+00] -2025-05-19 10:21:44,105 - 测试日志 - INFO - log.py:106 - 机械臂测量线程启动 -2025-05-19 10:21:44,107 - 测试日志 - INFO - log.py:106 - position command: [ 0.2499996 -0.13499988 0.34432959] -2025-05-19 10:21:44,108 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79998555e+02 -2.56817960e-03 -9.00042493e+01] -2025-05-19 10:21:44,109 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999992 -0.13500012 0.34433902] -2025-05-19 10:21:44,110 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 6.89448498e-13 -1.57079539e+00] -2025-05-19 10:21:44,116 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999992 -0.13500012 0.34432682] -2025-05-19 10:21:44,116 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79997347e+02 -1.10350209e-03 -9.00046762e+01] -2025-05-19 10:21:44,118 - 测试日志 - INFO - log.py:106 - position current:[ 0.2499996 -0.13500024 0.34433932] -2025-05-19 10:21:44,119 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 -4.59410288e-13 -1.57079633e+00] -2025-05-19 10:21:44,125 - 测试日志 - INFO - log.py:106 - position command: [ 0.2499996 -0.13499987 0.34432456] -2025-05-19 10:21:44,126 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79997411e+02 -2.38227541e-03 -9.00005274e+01] -2025-05-19 10:21:44,127 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999986 -0.13500047 0.34433951] -2025-05-19 10:21:44,129 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159132e+00 -2.06790141e-12 -1.57079686e+00] -2025-05-19 10:21:44,136 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999986 -0.13499992 0.3443227 ] -2025-05-19 10:21:44,138 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79996089e+02 -1.35804733e-03 -9.00014995e+01] -2025-05-19 10:21:44,139 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000018 -0.13499988 0.34433936] -2025-05-19 10:21:44,141 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 -4.79369904e-07 -1.57079340e+00] -2025-05-19 10:21:44,149 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000024 -0.13499903 0.34432079] -2025-05-19 10:21:44,151 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79995069e+02 -6.70950063e-04 -9.00049454e+01] -2025-05-19 10:21:44,153 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000024 -0.13499965 0.34433923] -2025-05-19 10:21:44,154 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159265e+00 4.79368984e-07 -1.57079340e+00] -2025-05-19 10:21:44,161 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999977 -0.1349995 0.34431945] -2025-05-19 10:21:44,162 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79995319e+02 -1.70934287e-03 -9.00030393e+01] -2025-05-19 10:21:44,164 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999977 -0.13499977 0.34433887] -2025-05-19 10:21:44,166 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159159e+00 4.79370825e-07 -1.57079393e+00] -2025-05-19 10:21:44,170 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999977 -0.13499918 0.34431806] -2025-05-19 10:21:44,171 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79998298e+02 -3.85689501e-03 -9.00052813e+01] -2025-05-19 10:21:44,174 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000026 -0.13499988 0.34433969] -2025-05-19 10:21:44,176 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159132e+00 -4.79371079e-07 -1.57079393e+00] -2025-05-19 10:21:44,181 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000026 -0.13499934 0.34431805] -2025-05-19 10:21:44,182 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79998486e+02 -5.14335902e-03 -9.00000455e+01] -2025-05-19 10:21:44,183 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000002 -0.13499963 0.34433893] -2025-05-19 10:21:44,184 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 9.19486709e-13 -1.57079300e+00] -2025-05-19 10:21:44,193 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000017 -0.13499952 0.34431692] -2025-05-19 10:21:44,194 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79998793e+02 -2.59184092e-03 -9.00034357e+01] -2025-05-19 10:21:44,195 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000017 -0.135 0.34433923] -2025-05-19 10:21:44,196 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159265e+00 -4.79368983e-07 -1.57079486e+00] -2025-05-19 10:21:44,211 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999969 -0.1349997 0.34431623] -2025-05-19 10:21:44,213 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79996673e+02 -1.21101684e-03 -9.00003974e+01] -2025-05-19 10:21:44,213 - 测试日志 - INFO - log.py:106 - position current:[ 0.2500002 -0.135 0.34433951] -2025-05-19 10:21:44,214 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159132e+00 -4.79371079e-07 -1.57079446e+00] -2025-05-19 10:21:44,215 - 测试日志 - INFO - log.py:106 - position command: [ 0.2500002 -0.13499964 0.34431623] -2025-05-19 10:21:44,223 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79996362e+02 -2.70660225e-03 -9.00000797e+01] -2025-05-19 10:21:44,229 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999985 -0.13499988 0.34433871] -2025-05-19 10:21:44,230 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159265 0. -1.57079446] -2025-05-19 10:21:44,231 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999985 -0.13499957 0.34431509] -2025-05-19 10:21:44,232 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999876e+02 -3.64733473e-03 -9.00019822e+01] -2025-05-19 10:21:44,233 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999954 -0.13500012 0.34433893] -2025-05-19 10:21:44,235 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159159e+00 -4.79368063e-07 -1.57079539e+00] -2025-05-19 10:21:44,246 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999954 -0.13499987 0.34431503] -2025-05-19 10:21:44,247 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999894e+02 -4.51652918e-03 -9.00022251e+01] -2025-05-19 10:21:44,248 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000011 -0.13500035 0.34433923] -2025-05-19 10:21:44,248 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 -9.58738919e-07 -1.57079579e+00] -2025-05-19 10:21:44,256 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000011 -0.13500014 0.34431511] -2025-05-19 10:21:44,256 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79996969e+02 -4.08489023e-03 -9.00002479e+01] -2025-05-19 10:21:44,258 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999945 -0.13500037 0.34433853] -2025-05-19 10:21:44,258 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159079e+00 3.67617048e-12 -1.57079579e+00] -2025-05-19 10:21:44,265 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000008 -0.1349997 0.344315 ] -2025-05-19 10:21:44,266 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79995986e+02 -5.06250792e-03 -9.00017274e+01] -2025-05-19 10:21:44,271 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000008 -0.13499988 0.34433929] -2025-05-19 10:21:44,273 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 -4.59410288e-13 -1.57079539e+00] -2025-05-19 10:21:44,277 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000006 -0.1350001 0.34431559] -2025-05-19 10:21:44,279 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79997492e+02 -2.31833794e-03 -9.00029288e+01] -2025-05-19 10:21:44,280 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999966 -0.135 0.34433899] -2025-05-19 10:21:44,282 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 4.59854377e-13 -1.57079539e+00] -2025-05-19 10:21:44,291 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999966 -0.13499988 0.34431444] -2025-05-19 10:21:44,293 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79997091e+02 -4.82337323e-03 -9.00040318e+01] -2025-05-19 10:21:44,295 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999989 -0.135 0.34433926] -2025-05-19 10:21:44,296 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 -2.29816166e-13 -1.57079579e+00] -2025-05-19 10:21:44,298 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999989 -0.1349999 0.34431462] -2025-05-19 10:21:44,299 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79996776e+02 -2.88598356e-03 -9.00056959e+01] -2025-05-19 10:21:44,300 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999989 -0.135 0.34433926] -2025-05-19 10:21:44,301 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 -2.29816166e-13 -1.57079579e+00] -2025-05-19 10:21:44,310 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000031 -0.13499992 0.3443147 ] -2025-05-19 10:21:44,312 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79997171e+02 -4.89043208e-03 -9.00015305e+01] -2025-05-19 10:21:44,312 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999988 -0.13500024 0.34433948] -2025-05-19 10:21:44,313 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 -4.59632332e-13 -1.57079686e+00] -2025-05-19 10:21:44,323 - 测试日志 - INFO - log.py:106 - MassageRobot启动 -2025-05-19 10:21:44,324 - 测试日志 - INFO - log.py:106 - 机械臂控制线程启动 -2025-05-19 10:22:55,285 - 测试日志 - INFO - log.py:106 - 切换到finger_head按摩头 -2025-05-19 10:22:58,799 - 测试日志 - INFO - log.py:106 - 机械臂测量线程启动 -2025-05-19 10:22:58,800 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000044 -0.13500034 0.34433384] -2025-05-19 10:22:58,804 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79995991e+02 -2.03260873e-04 -9.00041979e+01] -2025-05-19 10:22:58,807 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000032 -0.13500058 0.3443392 ] -2025-05-19 10:22:58,809 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 -2.39684650e-06 -1.57079966e+00] -2025-05-19 10:22:58,811 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000032 -0.13500058 0.34432748] -2025-05-19 10:22:58,813 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79997867e+02 -3.44143877e-03 -9.00020740e+01] -2025-05-19 10:22:58,814 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000024 -0.13500034 0.34433923] -2025-05-19 10:22:58,816 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 -2.39684498e-06 -1.57080019e+00] -2025-05-19 10:22:58,828 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000024 -0.13500034 0.34432273] -2025-05-19 10:22:58,831 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999285e+02 -1.46096651e-03 -9.00021967e+01] -2025-05-19 10:22:58,833 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000017 -0.13500058 0.34433923] -2025-05-19 10:22:58,834 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 -2.87621403e-06 -1.57080019e+00] -2025-05-19 10:22:58,837 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000017 -0.13500058 0.34431854] -2025-05-19 10:22:58,841 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79996481e+02 -3.33279407e-04 -9.00038248e+01] -2025-05-19 10:22:58,844 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999959 -0.1350007 0.34433868] -2025-05-19 10:22:58,846 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159079e+00 -2.39685133e-06 -1.57080019e+00] -2025-05-19 10:22:58,857 - 测试日志 - INFO - log.py:106 - position command: [ 0.2500002 -0.13500058 0.34431515] -2025-05-19 10:22:58,860 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999271e+02 -3.74060823e-03 -9.00054309e+01] -2025-05-19 10:22:58,862 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999976 -0.13500069 0.34433856] -2025-05-19 10:22:58,864 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159026e+00 -3.35559222e-06 -1.57079966e+00] -2025-05-19 10:22:58,869 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999977 -0.13500058 0.34431131] -2025-05-19 10:22:58,871 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999997e+02 -1.48342147e-03 -9.00057251e+01] -2025-05-19 10:22:58,872 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000009 -0.13500093 0.34433926] -2025-05-19 10:22:58,876 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 -3.35558536e-06 -1.57080165e+00] -2025-05-19 10:22:58,879 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000009 -0.13500093 0.3443089 ] -2025-05-19 10:22:58,883 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79994528e+02 -1.18289952e-03 -9.00045109e+01] -2025-05-19 10:22:58,885 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000069 -0.13500021 0.34433896] -2025-05-19 10:22:58,888 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159132e+00 -2.87621962e-06 -1.57079819e+00] -2025-05-19 10:22:58,893 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000069 -0.13500021 0.34430614] -2025-05-19 10:22:58,895 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79998314e+02 -3.93473231e-04 -9.00023962e+01] -2025-05-19 10:22:58,898 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000008 -0.13500081 0.34433966] -2025-05-19 10:22:58,900 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14158972e+00 -2.87620158e-06 -1.57080112e+00] -2025-05-19 10:22:58,902 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000069 -0.13500021 0.34430399] -2025-05-19 10:22:58,904 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999003e+02 -2.20692273e-03 -9.00020070e+01] -2025-05-19 10:22:58,906 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000026 -0.13500082 0.34433923] -2025-05-19 10:22:58,908 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 -2.39684320e-06 -1.57080112e+00] -2025-05-19 10:22:58,914 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000026 -0.13500083 0.34430239] -2025-05-19 10:22:58,918 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79995046e+02 -3.32890770e-03 -9.00043026e+01] -2025-05-19 10:22:58,922 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999983 -0.13500081 0.34433908] -2025-05-19 10:22:58,925 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 -2.87621225e-06 -1.57080059e+00] -2025-05-19 10:22:58,930 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999988 -0.1350007 0.34430099] -2025-05-19 10:22:58,938 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79997440e+02 -2.25046555e-03 -9.00038712e+01] -2025-05-19 10:22:58,942 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000018 -0.13500058 0.34433957] -2025-05-19 10:22:58,945 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 -2.39684143e-06 -1.57080019e+00] -2025-05-19 10:22:58,952 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000018 -0.13500058 0.34430012] -2025-05-19 10:22:58,956 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79998600e+02 -2.60702581e-03 -9.00042553e+01] -2025-05-19 10:22:58,962 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000014 -0.13500058 0.34433963] -2025-05-19 10:22:58,966 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159079e+00 -2.87620666e-06 -1.57079966e+00] -2025-05-19 10:22:58,974 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000014 -0.13500058 0.34429895] -2025-05-19 10:22:58,977 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79996723e+02 -1.36636199e-03 -9.00004356e+01] -2025-05-19 10:22:58,986 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999985 -0.1350007 0.3443392 ] -2025-05-19 10:22:58,994 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 -2.87621123e-06 -1.57079926e+00] -2025-05-19 10:22:58,997 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000012 -0.13500093 0.34429798] -2025-05-19 10:22:59,000 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79996683e+02 -1.63840690e-03 -9.00032322e+01] -2025-05-19 10:22:59,002 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999995 -0.13500058 0.34433942] -2025-05-19 10:22:59,007 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 -2.87621225e-06 -1.57079926e+00] -2025-05-19 10:22:59,010 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999995 -0.13500058 0.34429701] -2025-05-19 10:22:59,012 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79995970e+02 -6.91898498e-04 -9.00043380e+01] -2025-05-19 10:22:59,015 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999989 -0.13500058 0.34433893] -2025-05-19 10:22:59,017 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 -2.87621581e-06 -1.57079966e+00] -2025-05-19 10:22:59,021 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000044 -0.13500034 0.34429603] -2025-05-19 10:22:59,023 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79995871e+02 -1.71829282e-03 -9.00038603e+01] -2025-05-19 10:22:59,026 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999994 -0.13500058 0.34433914] -2025-05-19 10:22:59,029 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 -2.39684498e-06 -1.57080059e+00] -2025-05-19 10:22:59,036 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999994 -0.13500058 0.3442952 ] -2025-05-19 10:22:59,042 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79997612e+02 -4.97385774e-03 -9.00013481e+01] -2025-05-19 10:22:59,047 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000011 -0.13500058 0.3443389 ] -2025-05-19 10:22:59,059 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159159e+00 -2.87621708e-06 -1.57079926e+00] -2025-05-19 10:22:59,061 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999974 -0.13500034 0.34429412] -2025-05-19 10:22:59,064 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79996643e+02 -6.72520691e-04 -9.00010152e+01] -2025-05-19 10:22:59,070 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000018 -0.13500023 0.34433902] -2025-05-19 10:22:59,073 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 -1.91747416e-06 -1.57079926e+00] -2025-05-19 10:22:59,077 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999974 -0.13500034 0.34429349] -2025-05-19 10:22:59,079 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79997214e+02 -2.69194194e-03 -9.00037132e+01] -2025-05-19 10:22:59,081 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000031 -0.13500058 0.34433942] -2025-05-19 10:22:59,091 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 -3.35557927e-06 -1.57079926e+00] -2025-05-19 10:22:59,094 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999992 -0.13500058 0.34429301] -2025-05-19 10:22:59,095 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79995531e+02 -4.26061268e-03 -9.00050211e+01] -2025-05-19 10:22:59,099 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000014 -0.13500046 0.34433948] -2025-05-19 10:22:59,101 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 -2.87621022e-06 -1.57079926e+00] -2025-05-19 10:22:59,103 - 测试日志 - INFO - log.py:106 - MassageRobot启动 -2025-05-19 10:22:59,104 - 测试日志 - INFO - log.py:106 - 机械臂控制线程启动 -2025-05-19 10:24:16,891 - 测试日志 - INFO - log.py:106 - 切换到finger_head按摩头 -2025-05-19 10:24:20,406 - 测试日志 - INFO - log.py:106 - 机械臂测量线程启动 -2025-05-19 10:24:20,406 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999991 -0.13499977 0.34433175] -2025-05-19 10:24:20,407 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79997942e+02 -3.04576406e-03 -9.00016986e+01] -2025-05-19 10:24:20,408 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000006 -0.13499954 0.34433969] -2025-05-19 10:24:20,409 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159132e+00 2.39684422e-06 -1.57079633e+00] -2025-05-19 10:24:20,412 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999991 -0.13499919 0.34432609] -2025-05-19 10:24:20,413 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999345e+02 -3.30212414e-03 -9.00045014e+01] -2025-05-19 10:24:20,414 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999991 -0.13499919 0.34433936] -2025-05-19 10:24:20,415 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 2.87621301e-06 -1.57079486e+00] -2025-05-19 10:24:20,422 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999988 -0.13499942 0.34432101] -2025-05-19 10:24:20,423 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999142e+02 -4.97487802e-03 -9.00003446e+01] -2025-05-19 10:24:20,424 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999988 -0.13499942 0.34433881] -2025-05-19 10:24:20,424 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159159e+00 2.39684625e-06 -1.57079486e+00] -2025-05-19 10:24:20,435 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999988 -0.13499942 0.34431784] -2025-05-19 10:24:20,436 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79996916e+02 -4.40617280e-03 -9.00001462e+01] -2025-05-19 10:24:20,437 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000018 -0.13499942 0.34433957] -2025-05-19 10:24:20,438 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 2.39684498e-06 -1.57079633e+00] -2025-05-19 10:24:20,445 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000018 -0.13499942 0.34431512] -2025-05-19 10:24:20,453 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79997323e+02 -7.36781719e-04 -9.00012443e+01] -2025-05-19 10:24:20,454 - 测试日志 - INFO - log.py:106 - position current:[ 0.2499998 -0.13499942 0.34433948] -2025-05-19 10:24:20,455 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159132e+00 2.39684422e-06 -1.57079579e+00] -2025-05-19 10:24:20,457 - 测试日志 - INFO - log.py:106 - position command: [ 0.2499998 -0.13499942 0.34431227] -2025-05-19 10:24:20,458 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79995984e+02 -1.22757722e-03 -9.00032059e+01] -2025-05-19 10:24:20,461 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000009 -0.13499966 0.34433929] -2025-05-19 10:24:20,466 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 2.39684473e-06 -1.57079686e+00] -2025-05-19 10:24:20,469 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000009 -0.13499966 0.34430988] -2025-05-19 10:24:20,470 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79996011e+02 -2.40895634e-03 -9.00028612e+01] -2025-05-19 10:24:20,471 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999971 -0.13499942 0.34433902] -2025-05-19 10:24:20,472 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159159e+00 2.39684498e-06 -1.57079633e+00] -2025-05-19 10:24:20,481 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000002 -0.1349993 0.34430809] -2025-05-19 10:24:20,483 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79998629e+02 -2.90102875e-03 -9.00007009e+01] -2025-05-19 10:24:20,484 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999971 -0.13499942 0.34433902] -2025-05-19 10:24:20,490 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159159e+00 2.39684549e-06 -1.57079579e+00] -2025-05-19 10:24:20,491 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999971 -0.13499942 0.34430602] -2025-05-19 10:24:20,492 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79994531e+02 -3.74513693e-03 -9.00055052e+01] -2025-05-19 10:24:20,493 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999979 -0.1349993 0.34433914] -2025-05-19 10:24:20,494 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 2.39684447e-06 -1.57079486e+00] -2025-05-19 10:24:20,503 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999979 -0.1349993 0.34430437] -2025-05-19 10:24:20,504 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79994644e+02 -1.08300375e-03 -9.00026300e+01] -2025-05-19 10:24:20,505 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999985 -0.13499919 0.34433902] -2025-05-19 10:24:20,506 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 2.87621403e-06 -1.57079539e+00] -2025-05-19 10:24:20,517 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999985 -0.13499919 0.34430255] -2025-05-19 10:24:20,520 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79996606e+02 -2.60408742e-03 -9.00038000e+01] -2025-05-19 10:24:20,521 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999977 -0.1349993 0.34433887] -2025-05-19 10:24:20,522 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 2.87621403e-06 -1.57079579e+00] -2025-05-19 10:24:20,523 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999977 -0.1349993 0.34430119] -2025-05-19 10:24:20,524 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79998666e+02 -1.99797764e-03 -9.00013653e+01] -2025-05-19 10:24:20,525 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000008 -0.13499919 0.34433948] -2025-05-19 10:24:20,526 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 2.87621301e-06 -1.57079486e+00] -2025-05-19 10:24:20,534 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000008 -0.13499919 0.34430096] -2025-05-19 10:24:20,535 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79998871e+02 -7.94973727e-04 -9.00034384e+01] -2025-05-19 10:24:20,536 - 测试日志 - INFO - log.py:106 - position current:[ 0.2500002 -0.1349993 0.34433969] -2025-05-19 10:24:20,537 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159132e+00 2.39684422e-06 -1.57079539e+00] -2025-05-19 10:24:20,549 - 测试日志 - INFO - log.py:106 - position command: [ 0.2500002 -0.1349993 0.34430021] -2025-05-19 10:24:20,551 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79994518e+02 -2.20873248e-03 -9.00045977e+01] -2025-05-19 10:24:20,553 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999994 -0.13499942 0.34433948] -2025-05-19 10:24:20,554 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 2.87621403e-06 -1.57079686e+00] -2025-05-19 10:24:20,555 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999956 -0.13499942 0.34429871] -2025-05-19 10:24:20,556 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999309e+02 -2.08139739e-03 -9.00001378e+01] -2025-05-19 10:24:20,557 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999973 -0.1349993 0.34433881] -2025-05-19 10:24:20,558 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 2.39684574e-06 -1.57079446e+00] -2025-05-19 10:24:20,566 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999973 -0.1349993 0.3442977 ] -2025-05-19 10:24:20,569 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79998601e+02 -3.38856862e-03 -9.00033290e+01] -2025-05-19 10:24:20,570 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999948 -0.13499966 0.34433908] -2025-05-19 10:24:20,572 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 2.39684498e-06 -1.57079686e+00] -2025-05-19 10:24:20,576 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999948 -0.13499966 0.34429763] -2025-05-19 10:24:20,578 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79994556e+02 -4.64080896e-03 -9.00027941e+01] -2025-05-19 10:24:20,581 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999985 -0.13499942 0.34433936] -2025-05-19 10:24:20,584 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 2.39684447e-06 -1.57079579e+00] -2025-05-19 10:24:20,591 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999992 -0.13499942 0.34429709] -2025-05-19 10:24:20,593 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79998885e+02 -1.46035715e-03 -9.00052421e+01] -2025-05-19 10:24:20,597 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999966 -0.13499942 0.34433932] -2025-05-19 10:24:20,599 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 2.87621377e-06 -1.57079633e+00] -2025-05-19 10:24:20,603 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999966 -0.13499942 0.34429757] -2025-05-19 10:24:20,604 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79996588e+02 -2.82916041e-03 -9.00044297e+01] -2025-05-19 10:24:20,607 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999989 -0.13499942 0.34433908] -2025-05-19 10:24:20,609 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 1.91747619e-06 -1.57079539e+00] -2025-05-19 10:24:20,615 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999989 -0.13499942 0.34429699] -2025-05-19 10:24:20,617 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999494e+02 -1.79565600e-03 -9.00050070e+01] -2025-05-19 10:24:20,620 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999991 -0.13499954 0.3443389 ] -2025-05-19 10:24:20,622 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159159e+00 2.87621530e-06 -1.57079579e+00] -2025-05-19 10:24:20,624 - 测试日志 - INFO - log.py:106 - MassageRobot启动 -2025-05-19 10:24:20,625 - 测试日志 - INFO - log.py:106 - 机械臂控制线程启动 -2025-05-19 10:35:23,042 - 测试日志 - INFO - log.py:106 - 切换到finger_head按摩头 -2025-05-19 10:35:26,557 - 测试日志 - INFO - log.py:106 - 机械臂测量线程启动 -2025-05-19 10:35:26,558 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999994 -0.135 0.34433215] -2025-05-19 10:35:26,560 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79994310e+02 -1.84564466e-03 -9.00015040e+01] -2025-05-19 10:35:26,563 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000035 -0.13499942 0.34433945] -2025-05-19 10:35:26,565 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159132e+00 1.91747327e-06 -1.57079393e+00] -2025-05-19 10:35:26,567 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000035 -0.13499942 0.34432618] -2025-05-19 10:35:26,569 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79996216e+02 -2.90776851e-04 -9.00023861e+01] -2025-05-19 10:35:26,570 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999959 -0.13500012 0.34433868] -2025-05-19 10:35:26,573 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159159e+00 4.79370825e-07 -1.57079539e+00] -2025-05-19 10:35:26,577 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000014 -0.1349994 0.34432063] -2025-05-19 10:35:26,579 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79996985e+02 -5.36202942e-03 -9.00042842e+01] -2025-05-19 10:35:26,581 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000006 -0.13499965 0.34433902] -2025-05-19 10:35:26,583 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 1.43810587e-06 -1.57079393e+00] -2025-05-19 10:35:26,589 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000006 -0.13499965 0.34431601] -2025-05-19 10:35:26,592 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79994805e+02 -2.74988417e-03 -9.00017402e+01] -2025-05-19 10:35:26,602 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000009 -0.1349994 0.3443396 ] -2025-05-19 10:35:26,606 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159132e+00 1.43810282e-06 -1.57079247e+00] -2025-05-19 10:35:26,617 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000006 -0.13499977 0.34431264] -2025-05-19 10:35:26,621 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79998703e+02 -4.73166300e-03 -9.00033558e+01] -2025-05-19 10:35:26,626 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999953 -0.135 0.34433881] -2025-05-19 10:35:26,632 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159132e+00 4.79372444e-07 -1.57079446e+00] -2025-05-19 10:35:26,641 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999953 -0.13499931 0.34430863] -2025-05-19 10:35:26,645 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79997158e+02 -5.18009783e-03 -9.00037729e+01] -2025-05-19 10:35:26,650 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999977 -0.13499989 0.34433893] -2025-05-19 10:35:26,652 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 9.58739110e-07 -1.57079446e+00] -2025-05-19 10:35:26,654 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999977 -0.13499826 0.34430592] -2025-05-19 10:35:26,656 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999927e+02 -4.07622514e-03 -9.00008657e+01] -2025-05-19 10:35:26,658 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000035 -0.13499965 0.34433945] -2025-05-19 10:35:26,664 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159132e+00 9.58734538e-07 -1.57079340e+00] -2025-05-19 10:35:26,672 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000035 -0.13499711 0.34430401] -2025-05-19 10:35:26,674 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79998227e+02 -2.20542249e-03 -9.00032915e+01] -2025-05-19 10:35:26,678 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999983 -0.135 0.34433942] -2025-05-19 10:35:26,682 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 4.79368063e-07 -1.57079486e+00] -2025-05-19 10:35:26,686 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999983 -0.13499693 0.3443019 ] -2025-05-19 10:35:26,693 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79994584e+02 -3.01212078e-03 -9.00004964e+01] -2025-05-19 10:35:26,696 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000024 -0.13499977 0.34433957] -2025-05-19 10:35:26,699 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159079e+00 9.58734284e-07 -1.57079446e+00] -2025-05-19 10:35:26,704 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000024 -0.13499667 0.34430027] -2025-05-19 10:35:26,706 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79997592e+02 -2.18908466e-03 -9.00031874e+01] -2025-05-19 10:35:26,708 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000003 -0.13499953 0.34433926] -2025-05-19 10:35:26,709 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 9.58737078e-07 -1.57079340e+00] -2025-05-19 10:35:26,713 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000003 -0.13499639 0.34429844] -2025-05-19 10:35:26,715 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999020e+02 -1.92405937e-03 -9.00031805e+01] -2025-05-19 10:35:26,717 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999979 -0.13499953 0.34433899] -2025-05-19 10:35:26,720 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 9.58739110e-07 -1.57079300e+00] -2025-05-19 10:35:26,727 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999994 -0.13499661 0.34429667] -2025-05-19 10:35:26,730 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79994491e+02 -2.84328821e-03 -9.00036979e+01] -2025-05-19 10:35:26,735 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000006 -0.13499977 0.34433917] -2025-05-19 10:35:26,742 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 9.58737078e-07 -1.57079446e+00] -2025-05-19 10:35:26,746 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000018 -0.13499691 0.34429591] -2025-05-19 10:35:26,749 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999875e+02 -4.68231601e-03 -9.00044050e+01] -2025-05-19 10:35:26,755 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999977 -0.13499989 0.34433923] -2025-05-19 10:35:26,758 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 9.58739110e-07 -1.57079446e+00] -2025-05-19 10:35:26,762 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000023 -0.13499733 0.34429507] -2025-05-19 10:35:26,769 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79995654e+02 -4.93520615e-03 -9.00008916e+01] -2025-05-19 10:35:26,780 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000006 -0.13499988 0.34433936] -2025-05-19 10:35:26,782 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 4.79367841e-07 -1.57079393e+00] -2025-05-19 10:35:26,786 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000006 -0.13499735 0.34429431] -2025-05-19 10:35:26,789 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79995039e+02 -3.49179700e-03 -9.00048011e+01] -2025-05-19 10:35:26,791 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000049 -0.13499977 0.34434012] -2025-05-19 10:35:26,794 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14158919e+00 4.79360951e-07 -1.57079340e+00] -2025-05-19 10:35:26,798 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999983 -0.13499751 0.34429333] -2025-05-19 10:35:26,799 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999096e+02 -4.62048389e-03 -9.00017748e+01] -2025-05-19 10:35:26,801 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999994 -0.13499988 0.34433896] -2025-05-19 10:35:26,806 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 4.79368984e-07 -1.57079446e+00] -2025-05-19 10:35:26,812 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999994 -0.13499757 0.3442926 ] -2025-05-19 10:35:26,815 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79996143e+02 -4.41219993e-03 -9.00055296e+01] -2025-05-19 10:35:26,819 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000008 -0.13499965 0.34433929] -2025-05-19 10:35:26,823 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 9.58736126e-07 -1.57079393e+00] -2025-05-19 10:35:26,829 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000008 -0.13499716 0.34429241] -2025-05-19 10:35:26,831 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999219e+02 -1.18120307e-04 -9.00037273e+01] -2025-05-19 10:35:26,838 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999977 -0.13499988 0.3443392 ] -2025-05-19 10:35:26,841 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 4.79368984e-07 -1.57079446e+00] -2025-05-19 10:35:26,845 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999977 -0.13499747 0.34429188] -2025-05-19 10:35:26,849 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79997555e+02 -3.95756071e-03 -9.00032651e+01] -2025-05-19 10:35:26,853 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999989 -0.13499977 0.34433942] -2025-05-19 10:35:26,854 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 9.58736824e-07 -1.57079393e+00] -2025-05-19 10:35:26,857 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999989 -0.13499751 0.34429171] -2025-05-19 10:35:26,863 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79996438e+02 -2.29260739e-03 -9.00053350e+01] -2025-05-19 10:35:26,867 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999971 -0.13499988 0.34433868] -2025-05-19 10:35:26,873 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159159e+00 4.79371301e-07 -1.57079393e+00] -2025-05-19 10:35:26,883 - 测试日志 - INFO - log.py:106 - MassageRobot启动 -2025-05-19 10:35:26,886 - 测试日志 - INFO - log.py:106 - 机械臂控制线程启动 -2025-05-19 10:38:09,663 - 测试日志 - INFO - log.py:106 - 切换到finger_head按摩头 -2025-05-19 10:38:13,176 - 测试日志 - INFO - log.py:106 - 机械臂测量线程启动 -2025-05-19 10:38:13,180 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999983 -0.13499988 0.34433383] -2025-05-19 10:38:13,182 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79994975e+02 -3.47246733e-03 -9.00043957e+01] -2025-05-19 10:38:13,184 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999953 -0.13500012 0.34433914] -2025-05-19 10:38:13,185 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 4.79369682e-07 -1.57079579e+00] -2025-05-19 10:38:13,191 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999976 -0.13500083 0.34432825] -2025-05-19 10:38:13,194 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79999972e+02 -2.43019027e-03 -9.00042026e+01] -2025-05-19 10:38:13,196 - 测试日志 - INFO - log.py:106 - position current:[ 0.2499996 -0.13499988 0.34433881] -2025-05-19 10:38:13,197 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159132e+00 4.79371079e-07 -1.57079486e+00] -2025-05-19 10:38:13,199 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999953 -0.13500215 0.34432426] -2025-05-19 10:38:13,201 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79998040e+02 -3.97238367e-03 -9.00056181e+01] -2025-05-19 10:38:13,202 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999986 -0.135 0.34433899] -2025-05-19 10:38:13,204 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159132e+00 4.79371079e-07 -1.57079539e+00] -2025-05-19 10:38:13,211 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999986 -0.13500289 0.3443202 ] -2025-05-19 10:38:13,213 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79996346e+02 -3.93569846e-03 -9.00036273e+01] -2025-05-19 10:38:13,217 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999976 -0.13500012 0.34433911] -2025-05-19 10:38:13,218 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159159e+00 4.79371301e-07 -1.57079486e+00] -2025-05-19 10:38:13,220 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999976 -0.13500379 0.34431686] -2025-05-19 10:38:13,222 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79996920e+02 -3.86547435e-03 -9.00027133e+01] -2025-05-19 10:38:13,225 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000011 -0.135 0.34433957] -2025-05-19 10:38:13,227 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 4.79367142e-07 -1.57079486e+00] -2025-05-19 10:38:13,231 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999976 -0.13500448 0.34431377] -2025-05-19 10:38:13,232 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79996659e+02 -2.32042250e-03 -9.00001457e+01] -2025-05-19 10:38:13,238 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999976 -0.13500024 0.34433914] -2025-05-19 10:38:13,244 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 4.79368983e-07 -1.57079539e+00] -2025-05-19 10:38:13,250 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999942 -0.13500509 0.3443107 ] -2025-05-19 10:38:13,253 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79994640e+02 -2.41702854e-03 -9.00005414e+01] -2025-05-19 10:38:13,255 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999982 -0.13499989 0.34433929] -2025-05-19 10:38:13,259 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 1.43810701e-06 -1.57079539e+00] -2025-05-19 10:38:13,262 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999982 -0.13500542 0.34430798] -2025-05-19 10:38:13,267 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79997694e+02 -6.61723543e-04 -9.00033143e+01] -2025-05-19 10:38:13,279 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999994 -0.13499988 0.34433929] -2025-05-19 10:38:13,283 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 4.79368983e-07 -1.57079486e+00] -2025-05-19 10:38:13,288 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999994 -0.1350059 0.3443051 ] -2025-05-19 10:38:13,299 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79995454e+02 -2.37098142e-03 -9.00048003e+01] -2025-05-19 10:38:13,307 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999988 -0.135 0.34433948] -2025-05-19 10:38:13,309 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 9.58736634e-07 -1.57079579e+00] -2025-05-19 10:38:13,316 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999973 -0.13500646 0.34430306] -2025-05-19 10:38:13,320 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79996347e+02 -9.42046672e-04 -9.00052733e+01] -2025-05-19 10:38:13,322 - 测试日志 - INFO - log.py:106 - position current:[ 0.2499998 -0.135 0.34433948] -2025-05-19 10:38:13,327 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159132e+00 -1.37867495e-12 -1.57079539e+00] -2025-05-19 10:38:13,335 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999994 -0.13500668 0.34430087] -2025-05-19 10:38:13,338 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79995347e+02 -6.88586423e-04 -9.00035975e+01] -2025-05-19 10:38:13,346 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999983 -0.13500012 0.34433926] -2025-05-19 10:38:13,349 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 -6.89448498e-13 -1.57079539e+00] -2025-05-19 10:38:13,353 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000002 -0.13500654 0.34429958] -2025-05-19 10:38:13,355 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79996357e+02 -1.28450097e-03 -9.00055298e+01] -2025-05-19 10:38:13,357 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999995 -0.135 0.34433942] -2025-05-19 10:38:13,363 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159132e+00 -1.37823086e-12 -1.57079539e+00] -2025-05-19 10:38:13,366 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999995 -0.13500653 0.34429846] -2025-05-19 10:38:13,370 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79998513e+02 -4.01918115e-03 -9.00001599e+01] -2025-05-19 10:38:13,373 - 测试日志 - INFO - log.py:106 - position current:[ 0.2499995 -0.13499988 0.34433887] -2025-05-19 10:38:13,384 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159132e+00 1.37845291e-12 -1.57079486e+00] -2025-05-19 10:38:13,392 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999983 -0.13500678 0.34429705] -2025-05-19 10:38:13,394 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79998834e+02 -2.39480187e-03 -9.00015654e+01] -2025-05-19 10:38:13,396 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000006 -0.13499988 0.34433902] -2025-05-19 10:38:13,399 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 4.59632332e-13 -1.57079486e+00] -2025-05-19 10:38:13,401 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000002 -0.13500661 0.34429601] -2025-05-19 10:38:13,403 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79994957e+02 -4.16125722e-04 -9.00025615e+01] -2025-05-19 10:38:13,405 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999962 -0.13500023 0.34433893] -2025-05-19 10:38:13,408 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159265e+00 -9.58737967e-07 -1.57079486e+00] -2025-05-19 10:38:13,412 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999962 -0.13500718 0.34429517] -2025-05-19 10:38:13,414 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79996663e+02 -2.99955572e-03 -9.00005934e+01] -2025-05-19 10:38:13,416 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999989 -0.13500012 0.34433926] -2025-05-19 10:38:13,417 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 -4.79369460e-07 -1.57079539e+00] -2025-05-19 10:38:13,423 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999989 -0.13500731 0.34429479] -2025-05-19 10:38:13,424 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79995350e+02 -4.80228289e-03 -9.00040518e+01] -2025-05-19 10:38:13,428 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000024 -0.13500012 0.3443399 ] -2025-05-19 10:38:13,430 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14158972e+00 -1.37889700e-12 -1.57079633e+00] -2025-05-19 10:38:13,433 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000024 -0.13500755 0.3442948 ] -2025-05-19 10:38:13,434 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79996457e+02 -4.38128878e-03 -9.00052894e+01] -2025-05-19 10:38:13,436 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999994 -0.13500012 0.34433929] -2025-05-19 10:38:13,439 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 -4.59410288e-13 -1.57079633e+00] -2025-05-19 10:38:13,445 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999994 -0.13500801 0.34429382] -2025-05-19 10:38:13,446 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79994523e+02 -2.74701770e-03 -9.00050564e+01] -2025-05-19 10:38:13,447 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000003 -0.135 0.34433942] -2025-05-19 10:38:13,449 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159132e+00 -4.79369682e-07 -1.57079539e+00] -2025-05-19 10:38:13,458 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000003 -0.13500788 0.34429327] -2025-05-19 10:38:13,461 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999854e+02 -2.55984310e-03 -9.00006675e+01] -2025-05-19 10:38:13,465 - 测试日志 - INFO - log.py:106 - position current:[ 0.2499998 -0.13500012 0.34433948] -2025-05-19 10:38:13,478 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159132e+00 -4.79371745e-07 -1.57079446e+00] -2025-05-19 10:38:13,481 - 测试日志 - INFO - log.py:106 - MassageRobot启动 -2025-05-19 10:38:13,482 - 测试日志 - INFO - log.py:106 - 机械臂控制线程启动 -2025-05-19 10:40:46,795 - 测试日志 - INFO - log.py:106 - 切换到finger_head按摩头 -2025-05-19 10:40:50,313 - 测试日志 - INFO - log.py:106 - 机械臂测量线程启动 -2025-05-19 10:40:50,314 - 测试日志 - INFO - log.py:106 - position command: [ 0.24999977 -0.135 0.34433353] -2025-05-19 10:40:50,330 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79998798e+02 -2.77628317e-03 -9.00045346e+01] -2025-05-19 10:40:50,334 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999994 -0.13499977 0.34433914] -2025-05-19 10:40:50,342 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159265e+00 9.58737967e-07 -1.57079446e+00] -2025-05-19 10:40:50,345 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000102 -0.13499946 0.34432865] -2025-05-19 10:40:50,347 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79998510e+02 -2.15253715e-03 -9.00022707e+01] -2025-05-19 10:40:50,349 - 测试日志 - INFO - log.py:106 - position current:[ 0.25 -0.135 0.34433936] -2025-05-19 10:40:50,351 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 4.79368063e-07 -1.57079486e+00] -2025-05-19 10:40:50,355 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000205 -0.13499915 0.34432447] -2025-05-19 10:40:50,358 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999279e+02 -3.63257640e-03 -9.00011012e+01] -2025-05-19 10:40:50,360 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999977 -0.13499989 0.34433893] -2025-05-19 10:40:50,362 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 9.58738666e-07 -1.57079539e+00] -2025-05-19 10:40:50,366 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000297 -0.13499832 0.34432023] -2025-05-19 10:40:50,368 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79998705e+02 -3.68787899e-03 -9.00035575e+01] -2025-05-19 10:40:50,370 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000006 -0.13499965 0.34433902] -2025-05-19 10:40:50,375 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14159212e+00 9.58738666e-07 -1.57079446e+00] -2025-05-19 10:40:50,379 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000357 -0.13499853 0.34431671] -2025-05-19 10:40:50,381 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79997198e+02 -6.27055026e-04 -9.00010146e+01] -2025-05-19 10:40:50,384 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000006 -0.13499977 0.34433936] -2025-05-19 10:40:50,389 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 9.58737523e-07 -1.57079539e+00] -2025-05-19 10:40:50,391 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000444 -0.13499826 0.34431371] -2025-05-19 10:40:50,395 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79998121e+02 -5.25080726e-03 -9.00018689e+01] -2025-05-19 10:40:50,399 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000006 -0.13500012 0.34433984] -2025-05-19 10:40:50,409 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159132e+00 -1.37889700e-12 -1.57079579e+00] -2025-05-19 10:40:50,418 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000485 -0.13499842 0.3443108 ] -2025-05-19 10:40:50,434 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79998693e+02 -2.36676322e-03 -9.00038245e+01] -2025-05-19 10:40:50,438 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999983 -0.13500023 0.34433926] -2025-05-19 10:40:50,443 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 -4.79369682e-07 -1.57079539e+00] -2025-05-19 10:40:50,447 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000539 -0.13499889 0.34430764] -2025-05-19 10:40:50,451 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79996724e+02 -1.41332329e-03 -9.00040367e+01] -2025-05-19 10:40:50,456 - 测试日志 - INFO - log.py:106 - position current:[ 0.2499996 -0.13500024 0.34433914] -2025-05-19 10:40:50,460 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 -4.58966198e-13 -1.57079633e+00] -2025-05-19 10:40:50,464 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000565 -0.13499874 0.34430519] -2025-05-19 10:40:50,466 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79996303e+02 -5.70267526e-03 -9.00035247e+01] -2025-05-19 10:40:50,467 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999989 -0.13500023 0.3443396 ] -2025-05-19 10:40:50,490 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159132e+00 -4.79371079e-07 -1.57079539e+00] -2025-05-19 10:40:50,495 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000597 -0.13499873 0.3443032 ] -2025-05-19 10:40:50,496 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79998658e+02 -3.34765769e-03 -9.00009831e+01] -2025-05-19 10:40:50,505 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999989 -0.13500012 0.34433942] -2025-05-19 10:40:50,508 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159132e+00 -2.06812345e-12 -1.57079539e+00] -2025-05-19 10:40:50,512 - 测试日志 - INFO - log.py:106 - position command: [ 0.2500066 -0.13499856 0.34430195] -2025-05-19 10:40:50,515 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999573e+02 -3.67825916e-03 -9.00020754e+01] -2025-05-19 10:40:50,516 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999979 -0.13499988 0.34433914] -2025-05-19 10:40:50,526 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 -4.59410288e-13 -1.57079486e+00] -2025-05-19 10:40:50,529 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000726 -0.13499853 0.34430044] -2025-05-19 10:40:50,534 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79994506e+02 -1.16686113e-04 -9.00013013e+01] -2025-05-19 10:40:50,539 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000002 -0.13500012 0.34433997] -2025-05-19 10:40:50,543 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159079e+00 -1.83852933e-12 -1.57079579e+00] -2025-05-19 10:40:50,547 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000755 -0.13499889 0.34430003] -2025-05-19 10:40:50,549 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79997575e+02 -5.03752582e-03 -9.00016504e+01] -2025-05-19 10:40:50,551 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999995 -0.13499977 0.34433926] -2025-05-19 10:40:50,553 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159212e+00 4.79368539e-07 -1.57079486e+00] -2025-05-19 10:40:50,563 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000747 -0.134999 0.34429847] -2025-05-19 10:40:50,566 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79994275e+02 -2.70184955e-03 -9.00013795e+01] -2025-05-19 10:40:50,569 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999985 -0.13500023 0.34433969] -2025-05-19 10:40:50,571 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159079e+00 -4.79371746e-07 -1.57079539e+00] -2025-05-19 10:40:50,575 - 测试日志 - INFO - log.py:106 - position command: [ 0.2500079 -0.13499921 0.34429796] -2025-05-19 10:40:50,577 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79995263e+02 -4.42325900e-03 -9.00049365e+01] -2025-05-19 10:40:50,580 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999995 -0.135 0.34433975] -2025-05-19 10:40:50,586 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159132e+00 -6.89226454e-13 -1.57079579e+00] -2025-05-19 10:40:50,591 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000822 -0.13499909 0.34429718] -2025-05-19 10:40:50,595 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79998815e+02 -4.40775238e-03 -9.00055724e+01] -2025-05-19 10:40:50,598 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999979 -0.13500012 0.34433936] -2025-05-19 10:40:50,605 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 -9.19264664e-13 -1.57079579e+00] -2025-05-19 10:40:50,609 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000854 -0.13499918 0.34429628] -2025-05-19 10:40:50,615 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79996464e+02 -3.52686437e-03 -9.00009237e+01] -2025-05-19 10:40:50,618 - 测试日志 - INFO - log.py:106 - position current:[ 0.24999991 -0.13499988 0.34433954] -2025-05-19 10:40:50,625 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14159159e+00 -9.19264664e-13 -1.57079486e+00] -2025-05-19 10:40:50,627 - 测试日志 - INFO - log.py:106 - position command: [ 0.25000854 -0.13499915 0.34429547] -2025-05-19 10:40:50,628 - 测试日志 - INFO - log.py:106 - orientation command: [-1.79999693e+02 -3.29197642e-04 -9.00026430e+01] -2025-05-19 10:40:50,629 - 测试日志 - INFO - log.py:106 - position current:[ 0.25000018 -0.13500035 0.34434009] -2025-05-19 10:40:50,631 - 测试日志 - INFO - log.py:106 - orientation current: [-3.14158972e+00 -4.79371745e-07 -1.57079633e+00] -2025-05-19 10:40:50,639 - 测试日志 - INFO - log.py:106 - position command: [ 0.24997814 -0.13499804 0.34425667] -2025-05-19 10:40:50,643 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79997497e+02 -4.92112707e-03 -9.00051884e+01] -2025-05-19 10:40:50,648 - 测试日志 - INFO - log.py:106 - position current:[ 0.24996471 -0.1349987 0.3442933 ] -2025-05-19 10:40:50,652 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14144458e+00 1.91797297e-06 -1.57078967e+00] -2025-05-19 10:40:50,657 - 测试日志 - INFO - log.py:106 - position command: [ 0.24997184 -0.13499818 0.34424753] -2025-05-19 10:40:50,659 - 测试日志 - INFO - log.py:106 - orientation command: [ 1.79996131e+02 -5.70830269e-04 -9.00035809e+01] -2025-05-19 10:40:50,660 - 测试日志 - INFO - log.py:106 - position current:[ 0.24996402 -0.13499869 0.3442934 ] -2025-05-19 10:40:50,661 - 测试日志 - INFO - log.py:106 - orientation current: [ 3.14144218e+00 1.43853992e-06 -1.57078967e+00] -2025-05-19 10:40:50,672 - 测试日志 - INFO - log.py:106 - 机械臂控制线程启动 -2025-05-19 10:40:50,675 - 测试日志 - INFO - log.py:106 - MassageRobot启动 diff --git a/logs/test.py b/logs/test.py index 05d1648..acef9d7 100644 --- a/logs/test.py +++ b/logs/test.py @@ -1,5 +1,42 @@ -import random -import numpy as np +# import random +# import numpy as np -random_array = np.random.rand(3) # 生成长度为 3 的数组 -print(random_array/1000) \ No newline at end of file +# random_array = np.random.rand(3) # 生成长度为 3 的数组 +# print(random_array/1000) + +import math + +def __transform_mm_deg_2_m_rad(input_list): + ''' + 接受列表 [X Y Z RX RY RZ] + 将单位 m/rad 转为 mm/deg + ''' + if len(input_list) != 6: + raise ValueError("Input list must contain exactly 6 elements [X, Y, Z, RX, RY, RZ]") + + # 转换位置单位:m -> mm (乘以 1000) + x_mm = input_list[0] * 1000.0 + y_mm = input_list[1] * 1000.0 + z_mm = input_list[2] * 1000.0 + + # 转换角度单位:rad -> deg (乘以 180/pi) + rx_deg = math.degrees(input_list[3]) + ry_deg = math.degrees(input_list[4]) + rz_deg = math.degrees(input_list[5]) + + return [x_mm, y_mm, z_mm, rx_deg, ry_deg, rz_deg] + +def __transform_rad_2_deg(input_list): + ''' + 接受列表 [J1 J2 J3 J4 J5 J6] + 将单位rad转为deg + ''' + if len(input_list) != 6: + raise ValueError("Input list must contain exactly 6 elements [J1, J2, J3, J4, J5, J6]") + # 转换角度单位: rad -> deg + J_deg = [] + for i in range(6): + J_deg.append(math.degrees(input_list[i])) + return J_deg + +print(__transform_rad_2_deg([6.283185307179586, 3.141592653589793, 6.283185307179586,6.283185307179586, 3.141592653589793, 6.283185307179586])) \ No newline at end of file