[发明专利]一种多关节串联型工业机器人的谐振抑制方法

权利要求书

1.一种多关节串联型工业机器人的谐振抑制方法，其特征在于，包括以下步骤：

步骤一，从机器人的基坐标关节开始，依次测量机器人各关节的机械谐振频率，具体的为：

1-1，设定机器人的关节序号，机器人基坐标关节序号为1，沿着从基坐标到末端坐标的方向关节序号依次增加，末端关节的序号为序号最大值；

1-2，对于机器人的第n个关节，n≥1，首先通过机器人的示教器手动调整机器人的姿态，使得关节序号大于n的所有关节调整后的姿态作为第n关节的负载时惯量达到最大；

步骤二，从机器人的基坐标关节开始，依次设计机器人各关节的陷波滤波器，具体的为：

选择双T型滤波器作为陷波滤波器，其传递函数的表达式如式(1)所示：

其中，f为陷波中心频率，ζ为陷波深度，K为陷波宽度。

2.如权利要求1所述的一种多关节串联型工业机器人的谐振抑制方法，其特征在于，所述步骤一还包括：

利用机器人伺服系统中的抱闸装置锁死除了第n关节以外的所有关节，通过第n关节的伺服驱动器对第n关节施加正反转的位置阶跃信号1次，使得机器人的第n关节产生周期不小于10秒的阶跃摆动，利用装在机器人末端的六维加速度传感器测量第n关节运动方向上的振动频率f_n0和振动衰减到初始幅值的2％的时间t_nr，按照该方法依次测量其余关节的谐振频率和振动衰减时间。

3.如权利要求2所述的一种多关节串联型工业机器人的谐振抑制方法，其特征在于，对于第n关节，步骤一中测量的第n关节的振动频率f_n0为第n关节陷波滤波器的陷波中心频率，采用人工蜂群算法搜索第n关节的最优的ζ和K参数值，具体过程如下：

设第n关节的人工蜂群算法的目标函数为：

f_n＝0.1t_ni (2)

I、蜂群初始化，初始化100个雇佣蜂和观察蜂，对应100个蜜源，每个蜜源对应解的维数是二，两个解分别代表ζ和K；

II、蜂群寻找新蜜源，与第i个蜜源对应的雇佣蜂按照式(3)寻找新蜜源，即新的解：

x′_id＝x_id+φ_id(x_id-x_kd) (3)

其中，i＝1,2,...100，d＝1,2，φ_id是随机数，φ_id在区间[-1,1]内，i≠k，寻找到的新蜜源为X′_i＝{x′_i1,x′_i2}；

III、新蜜源中的x′_i1,x′_i2分别对应当前搜索出来的ζ和K值，将ζ和K值带入式(1)中，得到当前关节的陷波滤波器，并用陷波滤波器滤除该关节的伺服驱动器中的速度环的输出信号，滤波后的输出信号是电流环的指令信号，对该关节施加周期不小于10秒的正反转的位置阶跃信号10次，通过安装在机器人末端的六维加速度传感器分别测量该关节运动方向上的振动幅值衰减到初始值2％时的时间，并求取平均值t_ni；

IV、更新蜜源，将新蜜源X_i求出的t_ni值与原蜜源X_i-1求出的t_ni-1比较，并根据式(4)更新蜜源，

其中，fit_i是解X_i的适应值，表达式如式(5)所示：

V、侦查蜂出发，在第IV步中，与被丢弃的蜜源对应的雇佣蜂变成侦查蜂，并根据式(6)寻找新蜜源，

其中，r₁∈[0,1]，与分别是解的上下界；

VI、记忆最佳蜜源，记忆最佳蜜源位置，即最优解，并重复II-VI100次；

VII、结束蜜源寻找，当100次循环完成，或者找到达到预期适应度的蜜源，则寻优停止，输出该关节的陷波滤波器的ζ和K值的最优解。