一种基于平滑切换的机械臂碰撞响应控制方法
Abstract:
一种基于平滑切换的机械臂碰撞响应控制方法,涉及碰撞响应领域。本发明是为了解决目前的机械臂碰撞响应方法还无法实现控制状态的平滑切换,进而导致机械臂作业安全性低的问题。本发明包括:建立机械臂动力学回归模型;设计机械臂的阈函数β(τext),并根据阈函数β(τext)获取机械臂平滑切换函数ω;根据平滑切换函数获取机械臂关节控制力矩;将机械臂关节控制力矩代入机械臂动力学回归模型中,获取机械臂碰撞的平滑切换方式:若机械臂没有受到外力则阈函数β(τext)<0,平滑切换函数ω=1,机械臂则在位置控制模式下工作,若机械臂受到外力作用则阈函数β(τext)>0,平滑切换函数ω=0,机械臂则在柔顺控制模式下工作。本发明用于实现机械臂碰撞响应。
Public/Granted literature
Patent Agency Ranking
0/0