一种柔性关节机器人输出力矩控制方法

基本信息

申请号 CN202110792270.0 申请日 -
公开(公告)号 CN113977571A 公开(公告)日 2022-01-28
申请公布号 CN113977571A 申请公布日 2022-01-28
分类号 B25J9/16(2006.01)I 分类 手动工具;轻便机动工具;手动器械的手柄;车间设备;机械手;
发明人 张赫;赵杰;李长乐;刘刚峰 申请(专利权)人 洛阳尚奇机器人科技有限公司
代理机构 成都弘毅天承知识产权代理有限公司 代理人 张东明
地址 471000河南省洛阳市高新区滨河北路96号洛阳机器人智能装备产业园F2
法律状态 -

摘要

摘要 本发明公开了一种柔性关节机器人输出力矩控制方法,包括以下步骤:步骤1、建立机器人柔性单关节的数学模型,如下:其中,θm、和分别是关节电机轴的角位置、角速度和角加速度;Jm是关节电机轴的转动惯量;Bm是关节电机轴的粘性阻尼系数;dm(t)是作用在关节电机轴上的外部扰动;θl、Jl、Bl和dl(t)分别是关节负载端相对应的物理量变量或参数;Ks是关节扭簧的弹性系数;u是关节电机的驱动力矩;本发明中可以估计速度状态,所以最终设计的控制器只依赖于关节电机轴、负载轴的角位置信号;同时观测器能够估计系统的总扰动,所以使控制器具有较强的鲁棒性;观测器是有限时间收敛的,所以能快速估计速度和扰动信号,增强了系统对扰动的鲁棒性。