一种基于人机协作的机器人柔顺示教及再现方法与流程

本发明涉及一种机器人控制技术领域，具体涉及一种基于人机协作的机器人柔顺示教及再现方法。

背景技术：

目前传统机器人的示教主要以示教器示教和编程示教为主，示教器示教效率低、繁琐，且不适用于复杂的曲线或曲面轨迹；编程示教对编程者编程能力要求较高，且脱离本体难以保证精度。在此背景下，柔顺示教因操作灵活简单、效率高，因此成为研究热点。柔顺示教是指机器人顺应操作者的操作力的运动轨迹，记录并再现作业轨迹，近几年，国内外多家机器人厂家也相应推出了能够实现柔顺示教的机器人，如abb、kuka、新松等。

机器人的柔顺示教分为主动柔顺性和被动柔顺性，机器人凭借一些辅助的柔顺机构，使其在与环境接触时能够对外部作用力产生自然顺从，被称为被动柔顺控制；机器人利用力的反馈信息采用一定的控制策略去主动控制作用力，被称为主动柔顺控制。被动柔顺机构通常包括一些弹簧、阻尼等柔性装置；主动柔顺控制按对作用力的获取的方式的不同又分为基于力/力矩传感器的和免力矩传感器的。

但由于传感器成本高、系统复杂性高等问题限制了此类基于传感器的机器人柔顺示教的研究及应用。免力矩传感器的柔顺示教是通过控制策略实现对力的非精确测量，目前已有的方法包括阻抗控制、零力控制、自适应控制等。

技术实现要素：

本发明针对现有的机器人柔顺示教技术中的缺陷，提供了一种基于人机协作的机器人柔顺示教及再现方法。

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

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

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

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

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

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

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

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

建立人机协作模型，确定驱动电机期望输入力矩所需承担的重力项，其特征是通过力学公式建立关节重力与位姿的数学关系，对于常规六自由度机器人，当底座水平放置时，机器人自重以及腰部产生的弯矩近似为零，故对于第一关节，仅考虑进行库伦摩擦力的影响；对于第四关节、第六关节，其运动时只产生绕自身轴线的回转运动，运行过程中质心位置变化较小，可忽略其运动产生的重力矩；因此，只考虑库伦摩擦力对第四、第六关节的影响。而第二、第三、第五关节由于俯仰运动，质心位置随机器人关节的位姿而变化，同时相邻两关节之间会产生重力耦合作用，因此需对该三个关节进行重力补偿和摩擦力补偿。

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

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

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

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

其中表示重力加速度项。

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

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

前述已分析，第一、第四、第六关节由于结构特点，无需对其进行重力项补偿,仅考虑第二、三、五关节重力矩影响。

库伦摩擦与法向载荷呈正比，为常数,故包含摩擦力在内的六个关节力矩平衡模型如下：

式中si,ci，i=1,2..6分别表示；m34为第三关节和第四关节质量之和；m56为第五关节和第六关节质量之和；c23表示为；c235表示为；ui表示第i个关节的库伦摩擦系数，各关节质量及库伦摩擦力具体数值由最小二乘法辨识得到。

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

说明书附图

图1是系统组成图；

图2是人机协作方案图；

图3是轨迹再现控制方法流程图；

具体实施方式

下面结合附图和实例对本发明所公开的一种基于人机协作的机器人柔顺示教及再现方法进行详细的阐述和说明。一种基于人机协作的机器人柔顺示教及再现方法，系统组成如图1所示，包括上位机、运动控制卡、端子板、伺服驱动器、电机、六自由度机器人。

首先，建立人机协作模型，如图2所示，计算关节电机期望输入力矩及操作者施加的操作力等效到机器人末端的力矩，由电机期望力矩承担柔顺示教过程中较大的重力及库伦摩擦力，由操作者施加的操作力承担示教过程中较小的与速度、加速度有关的惯性力、离心力和哥氏力、粘滞摩擦力等；将原本完全由电机控制的机器人的各项力，此时将由操作者的操作力fh承担一部分，根据公式(1)，基于人机协作的机器人力学模型表示为：

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

建立人机协作模型，确定驱动电机期望输入力矩所需承担的重力项，其特征是通过力学公式建立关节重力与位姿的数学关系，对于常规六自由度机器人，当底座水平放置时，机器人自重以及腰部产生的弯矩近似为零，故对于第一关节，仅考虑进行库伦摩擦力的影响；对于第四关节、第六关节，其运动时只产生绕自身轴线的回转运动，运行过程中质心位置变化较小，可忽略其运动产生的重力矩；因此，只考虑库伦摩擦力对第四、第六关节的影响。而第二、第三、第五关节由于俯仰运动，质心位置随机器人关节的位姿而变化，同时相邻两关节之间会产生重力耦合作用，因此需对该三个关节进行重力补偿和摩擦力补偿。

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

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

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

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

其中表示重力加速度项。

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

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

前述已分析，第一、第四、第六关节由于结构特点，无需对其进行重力项补偿,仅考虑第二、三、五关节重力矩影响。

库伦摩擦与法向载荷呈正比，为常数,故包含摩擦力在内的六个关节力矩平衡模型如下：

式中si,ci,i=1,2..6分别表示；m34为第三关节和第四关节质量之和；m56为第五关节和第六关节质量之和；c23表示为；c235表示为;ui表示第i个关节的库伦摩擦系数，各关节质量及库伦摩擦力具体数值由最小二乘法辨识得到。

图3为示教再现控制方法流程图。

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

本发明上述实施方案，只是举例说明，不是仅有，所有在本发明范围内或等同本发明的范围内的改变均被本发明包围。