一种基于旋转搜索策略的机械臂力控螺栓对准方法

本发明公开了一种基于旋转搜索策略的机械臂力控螺栓对准方法，包括：S1、机械臂预对准，控制机械臂运动到预对准位置；S2、机械臂直线运动接触螺栓，控制机械臂沿笛卡尔空间工具坐标系z轴正方向运动，当z轴负方向的力大于设定阈值F1时，停止机械臂运动；S3、机械臂旋转搜索，控制机械臂绕z轴顺时针旋转，当z轴负方向的力小于设定阈值F2或绕z轴逆时针方向的力矩大于设定阈值T1时，停止机械臂旋转运动；S4、机械臂直线对准进入螺栓，控制机械臂z轴正方向运动，当z轴负方向的力大于设定阈值F3时，停止机械臂运动。本发明显著提高了对准过程的成功率和操作安全性。