[发明专利]一种基于人机协作的机器人柔顺示教及再现方法

权利要求书

1.一种基于人机协作的机器人柔顺示教及再现方法，其特征在于，包括：

首先，基于人机协作的机器人动力学模型建立方法：计算关节电机期望输入力矩及操作者施加的操作力等效到机器人末端的力矩，由电机期望力矩承担柔顺示教过程中较大的重力项及库伦摩擦力项，由操作者施加的操作力承担示教过程中较小的与速度、加速度有关的惯性力、离心力和哥氏力及粘滞摩擦力；

第二，基于人机协作的机器人柔顺示教方法：基于关节重力与位姿的机器人动力学模型，通过最小二乘法辨识得到重力和库伦摩擦力的数值，控制转矩模式下的驱动电机输出电流指令补偿相应位姿下的重力和库伦摩擦力，使机器人各关节处于动态平衡状态下，由操作者施加操作力作用在机器人末端，完成柔顺示教；

第三，基于速度与位置反馈的示教轨迹再现控制方法：根据电流指令及通过编码器采集的机器人柔顺示教中的反馈数据，计算相应的速度指令，控制电机转换为速度模式，对速度指令进行滤波降噪处理，将滤波后的速度作为输出目标，通过驱动器进行模拟量输出，以速度反馈和位置反馈的双闭环控制完成轨迹再现。

2.根据权利要求1所述的一种基于人机协作的机器人柔顺示教及再现方法，其特征是

机器人正常运动时，动力学模型表示为如下形式：

分别包括惯性力项、离心力和哥氏力、重力项、摩擦力项，其中分别表示关节角度、角速度、角加速度；M(q)表示惯量矩阵；表示哥氏力及离心力矩阵；G(q)表示重力项矩阵；分别表示库伦摩擦力项和与速度有关的粘滞摩擦力；表示各关节总力矩；

由机器人动力学模型公式可知，惯性力项与加速度有关，离心力和哥氏力项与速度有关，由于柔顺示教过程是由人施加在机器人末端的示教力为主导，示教速度较低、加速度较小，因此产生的惯性力项、离心力和哥氏力项较小；因此基于人机协作的柔顺示教及再现方法原理如下：由驱动电机输出力矩实时补偿各关节不同位姿时较大的重力项和库仑摩擦力项，较小的惯性力、离心力、哥氏力项和粘滞摩擦力由操作者施加的操作力克服；

将原本完全由电机控制的机器人的各项力，此时将由操作者的操作力F_h承担一部分，根据公式，基于人机协作的机器人力学模型表示为：

上式中F_h为操作者施加的操作力，包括与速度、加速度相关的惯性力、离心力和哥氏力项及粘滞摩擦力；F_b为电机输出力，包含重力矩、库伦摩擦力矩；在以人为主导的操作力作用下，人机协作，共同实现柔顺示教；为确定准确的F_b和F_h的数值，需要对于常规六自由度机器人的重力、摩擦力进行建模分析并计算；

对于常规六自由度机器人，当底座水平放置时，机器人自重以及腰部产生的弯矩近似为零，故对于第一关节，仅考虑进行库伦摩擦力的影响；对于第四关节、第六关节，其运动时只产生绕自身轴线的回转运动，运行过程中质心位置变化较小，可忽略其运动产生的重力矩；因此，只考虑库伦摩擦力对第四、第六关节的影响；而第二、第三、第五关节由于俯仰运动，质心位置随机器人关节的位姿而变化，同时相邻两关节之间会产生重力耦合作用，因此需对该三个关节进行重力补偿和摩擦力补偿；

据上述分析，机器人任意位姿下的重力模型可由机器人动力学推导得到，动力学推导如下：

其中，q_i为机器人i关节位置，为i关节的速度，F_i为作用在i关节上的力矩，n代表机器人的关节数量，对于六自由度拖动示教机器人来说n为6；由于动能部分由操作者承担，故此时只对其势能进行建模；

将机器人简化为一系列连杆组成的系统，设第i号杆件，其质心为c_i，其质心处坐标系为{ci}，用表示质心在杆件坐标系中的位置矢量：

设机器人连杆i的质量为m_i，则第i号连杆的位能为：

其中表示重力加速度项；

因此仅包含重力项在内的机器人总位能为：

即各关节重力补偿项G_i为：

前述已分析，第一、第四、第六关节由于结构特点，无需对其进行重力项补偿,仅考虑第二、三、五关节重力矩影响；库伦摩擦与法向载荷呈正比，为常数,故包含摩擦力在内的六个关节力矩平衡模型如下：

式中s_i,c_i,i=1,2..6分别表示;m₃₄为第三关节和第四关节质量之和；m₅₆为第五关节和第六关节质量之和；c₂₃表示为；c₂₃₅表示为;u_i表示第i个关节的库伦摩擦系数，各关节质量及库伦摩擦力具体数值由最小二乘法辨识得到。

3.根据权利要求1所述的一种基于人机协作的机器人柔顺示教及再现方法，其特征是：示教轨迹再现时采用速度模式下的基于PID的各关节电机速度追踪算法，在应用PID控制的基础上，为提高系统鲁棒性，辅助以速度前馈的控制策略，速度前馈旨在减小状态误差，提高系统响应增加系统稳定性；机器人轨迹再现过程通过速度和位置的双闭环控制；在速度环中，将柔顺示教过程中保存的速度作为原始示教速度，通过对其进行低通滤波处理后作为轨迹再现时的跟踪目标；将实时再现速度反馈与原始示教速度进行误差计算，并将速度误差进行比例调节，当示教速度与再现速度产生误差时，通过比例调节器控制，不断对误差进行修正；在位置环中，将示教位置与实时再现位置进行的误差跟踪，分别进行微分调节与比例调节，提高跟踪精度；适当的选择微分系数Kd和比例系数Kp的数值，使其既能达到较好的控制精度，同时又能生成较为平滑的输出力矩。