[发明专利]一种基于闭环结构的扭矩计算、碰撞检测与拖动示教方法

说明书

本发明公开一种基于闭环结构的扭矩计算、碰撞检测与拖动示教方法，扭矩计算包括：S1、闭环切割；S2、计算等价的开环结构扭矩，再转换为闭环结构中的驱动电机的实际扭矩。碰撞检测与拖动示教方法包括：S3、利用电机电流估算扭矩；S4、结合电机电流的估算扭矩值、扭矩传感器的测量扭矩值和计算出的实际扭矩判断是否产生碰撞信号；S5、根据碰撞信号的大小及符号进行刹车或电子助力。本发明可以将传统的递归牛顿欧拉求解开环机械臂关节扭矩的方法推广到任意闭环结构的机械臂，并且适用于基于普通无刷有刷电机，使这类机械臂实现碰撞检测与拖动示教的功能。本发明同时使碰撞信号的检测达到了更高的鲁棒性与抗躁能力。

技术领域

本发明属于扭矩补偿领域，具体涉及一种基于闭环结构的扭矩计算、碰撞检测与拖动示教方法。此方法可以用于任何带有闭环结构，如平行四连杆与扭矩传感器的机械臂，为其每个关节计算主动补偿的扭矩，从而实现精准的轨迹跟随，以及碰撞检测及拖动示教。

背景技术

目前的市面上的协作机器人全部采用“扭矩电机”，或者叫“盘式电机”。此种电机无需额外的传动系统即可提供足够的扭矩。对这类电机组成的机械臂进行碰撞检测或拖动示教的电子助力时，由于没有传动系统，电机的电流对外力的响应较快，因此可以直接使用电流作为电机输出端所受扭矩的估计值。然而此类电机最大的缺点是成本高，且成本与扭力大小不成线性关系。因此基于扭矩电机的协作机械臂，可延展性较差。这就使得目前市面上的协作机器人均限制在一定的形态以及臂展、负重等参数范围内，很难有突破。为了使协作机械臂能有更大的臂展和负重，需要更加灵活的本体结构与传动系统的配合，例如基于主动驱动的平行四连杆的机械臂结构。然而这类机械臂结构，由于较高的传动比，使得电机输出端感受到的扭力变化相对实际的扭力施加处较小，也就导致实际发生碰撞时，电机的电流变化较小，在电机内信噪比较高的环境下很难单凭电流判断是否真的发生碰撞，且难以判断外力的大小。此外，基于闭环的机械臂结构无法直接使用递归牛顿欧拉方法对其各个关节的补偿扭矩进行计算，因此需要特定的方式求解闭环结构的各个关节的补偿扭矩。

发明内容

为了解决现有技术存在的上述问题，本发明目的在于提供一种基于闭环结构的扭矩计算、碰撞检测与拖动示教方法。

本发明所采用的技术方案为：

一种基于闭环结构的扭矩计算方法，包括如下步骤：

S1、闭环切割：将任何一个闭环结构的每一个环断开成两条关节路径，断开后，将原闭环结构等价成多个开环结构，等价的开环结构中，将原被动驱动关节当做带有虚拟驱动器的主动关节；

S2、计算等价的开环结构扭矩，再转换为闭环结构中的驱动电机的实际扭矩。

本发明可以将传统的递归牛顿欧拉求解开环机械臂关节扭矩的方法推广到任意闭环结构的机械臂，并且适用于基于普通无刷有刷电机，而不是扭矩电机的带有高传动比的机械臂上，使这类机械臂实现碰撞检测与拖动示教的功能。

具体地，所述步骤S2的实现方法为：计算等价的开环结构扭矩，求出开环结构与闭环结构的关节角度之间的对应关系，然后计算闭环结构中的驱动电机的实际扭矩。

本发明提出一种不需要解析，而是通过实验或仿真数据，列出线性方程组的方法来解出闭环与开环的关节映射。求出开环结构与闭环结构的关节角度之间的对应关系的步骤包括：

S21、使用仿真软件或者实验，测定若干组闭环结构在不同姿态下的关节角度，获得多组关节角度数据；

S22、设步骤S21取得了N组关节角度数据，每一组都由Q_close[1]到Q_close[n]组成，其中n为闭环结构中实际关节的数量，令Q_open[1]到Q_open[m]为此闭环结构等价的开环结构的所有关节的关节角度，其中m为开环结构中关节的数量，将所有数据汇总并形成矩阵形式，如式(1)：

Qc＝A*Qo (1)