diff --git a/Massage/MassageControl/MassageRobot_nova5.py b/Massage/MassageControl/MassageRobot_nova5.py index ed45833..b6db9cd 100644 --- a/Massage/MassageControl/MassageRobot_nova5.py +++ b/Massage/MassageControl/MassageRobot_nova5.py @@ -116,11 +116,11 @@ class MassageRobot: # 初始化坐标系 TOOL=0 BASE=1 self.arm = dobot_nova5(arm_ip = self.arm_config['arm_ip']) self.arm.start() -<<<<<<< HEAD + self.arm.chooseRightFrame() -======= + self.arm.init() ->>>>>>> cc63eb47a5fd86a36d8af9fbf38a4b10a4c2ff7f + self.thermotherapy = None self.shockwave = None @@ -145,7 +145,7 @@ class MassageRobot: self.controller_manager.switch_controller('admittance') -<<<<<<< HEAD + # 读取数据 self.gravity_base = None self.force_zero = None @@ -155,10 +155,6 @@ class MassageRobot: self.s_tf_matrix_t = None arm_orientation_set0 = np.array([-180,-30,0]) self.b_rotation_s_set0 = R.from_euler('xyz',arm_orientation_set0,degrees=True).as_matrix() -======= - - ->>>>>>> cc63eb47a5fd86a36d8af9fbf38a4b10a4c2ff7f # 频率数据赋值 self.control_rate = Rate(self.arm_config['control_rate']) @@ -644,8 +640,6 @@ class MassageRobot: self.controller_manager.switch_controller('position') - else: - self.logger.log_error(f"未找到{name}按摩头") def log_thread(self): while True: