CN111660306A - 一种基于操作者舒适度的机器人可变导纳控制方法及系统 - Google Patents

Abstract

本发明属于人机交互相关技术领域，并具体公开了一种基于操作者舒适度的机器人可变导纳控制方法及系统。所述方法包括对人手操作力进行前处理，得到与环境交互力；根据该操作者舒适力和机器人末端实际位姿生成虚阻尼调整策略；根据虚阻尼调整策略构建机器人六自由度导纳控制模型以获取与环境交互力和期望力之间的偏差力，并根据该偏差力生成机器人末端的位置、速度以及加速度的修正量，以此对机器人末端实际位姿进行修正。所述系统包括人机交互模块、人手操作力前处理模块、变导纳控制模块以及机器人末端位置控制模块。本发明根据操作者舒适力与机器人末端速度实时调整导纳控制中的阻尼系数，计算简单，实时性高，提高人机交互的操作感和沉浸感。

Description

一种基于操作者舒适度的机器人可变导纳控制方法及系统

技术领域

本发明属于人机交互相关技术领域，更具体地，涉及一种基于操作者舒适度的机器人可变导纳控制方法及系统。

背景技术

机器人具有柔性好、智能化、操作空间大等优势，广泛应用于零件加工、遥操作、医疗机器人领域。机器人在示教、运动控制过程中是否具备良好的顺应性是实现人机共融、柔顺加工、路径引导等一系列智能化功能化的基础。机器人主动顺应控制分为直接力控、间接力控、智能控制，间接力控又细分为阻抗控制与导纳控制。导纳控制相比阻抗控制不依赖机器人的动力学模型而能够提高人机交互过程中的顺应性。机器人在导纳控制下虽然能够顺应人手操作，但是针对一些特殊情况如机器人的启停、突然改变方向等仍会因惯性导致动作不柔顺。由于现有控制方案中导纳控制参数固定，因此操作者施加的力过大或系统受外部干扰时机器人容易因加速度过大导致系统不稳定。过大的阻尼项会增加操作者的负担，阻力项较小时因惯性导致机器人动作难以控制系统不稳定。

因此，在人机协作过程中保证操作者舒适度如何调整机器人导纳控制参数以提高机器人顺应性及抗干扰能力是一个重要的研究问题。

发明内容

针对现有技术的以上缺陷或改进需求，本发明提供了一种基于操作者舒适度的机器人可变导纳控制方法及系统，其中结合导纳控制自身的特征以及人机交互的工艺特点，相应的设计了基于操作者舒适度的机器人可变导纳控制方法及系统，通过获取机器人与操作者之间的与环境交互力，以根据操作者舒适力与机器人末端速度实时调整导纳控制中的阻尼系数，进而通过调整机器人末端的速度来纠正力偏差，使机器人末端能够在基于操作者舒适力的可变异导纳控制下顺应性动作，提高交互过程的沉浸感，具有计算简单，实时性高，提高人机交互的操作感和沉浸感的特点。

为实现上述目的，按照本发明的一个方面，提出了一种基于操作者舒适度的机器人可变导纳控制方法，包括以下步骤：

S1对牵引机器人过程中的人手操作力进行前处理，得到与环境交互力，并将该与环境交互力转换为机器人末端的期望位姿；

S2设定操作者舒适力，根据该操作者舒适力以及机器人末端实际位姿生成虚阻尼调整策略；

S3根据虚阻尼调整策略构建机器人六自由度导纳控制模型，该机器人六自由度导纳控制模型用于获取与环境交互力和期望力之间的偏差力，并根据该偏差力生成机器人末端的位置、速度以及加速度的修正量；

S4根据机器人末端的位置、速度以及加速度的修正量对机器人末端实际位姿进行修正，以此方式，使机器人末端能够在基于操作者舒适力的可变异导纳控制下顺应性动作。

作为进一步优选的，步骤S1中，所述前处理包括滤波处理以及重力补偿处理。

作为进一步优选的，步骤S2中，所述虚阻尼调整策略的计算模型为：

其中，

为虚阻尼调整策略，F_std为操作者舒适力，

为机器人末端实际位姿速度，D_max为预设的最大阻尼，D_min为预设的最小阻尼。

作为进一步优选的，步骤S3中根据虚阻尼调整策略构建机器人六自由度导纳控制模型具体包括以下步骤：

S31构建机器末端位置导纳控制模型：

其中，M_p为位置惯性矩阵，D_p为位置阻尼矩阵，K_p为位置刚度矩阵，Δx_p为位置误差，

为速度误差，

为加速度误差；

S32构建机器人末端姿态导纳控制模型：

其中，M_o为姿态惯性矩阵，D_o为姿态阻尼矩阵，K_o为姿态刚度矩阵，

为由旋转矩阵提取的欧拉角，

为

的一阶导数，

为

的二阶导数，^eΔf_o为在机器人末端实际姿态下的力矩值，T表示欧拉角与机器人末端在笛卡尔空间下的角速度旋转矩阵；

S33根据机器末端位置导纳控制模型和机器人末端姿态导纳控制模型构建机器人末端空间导纳控制模型：

其中，

为质量矩阵，

为阻尼矩阵，

为刚度矩阵，

Δx_o为方向误差。

作为进一步优选的，本发明中，通过与环境交互力和操作者舒适力进行对比，改变机器人末端的加速度以调整机器人末端的速度大小：

当与环境交互力和操作者舒适力的差值为0时，设置机器人末端的加速度为零；

当与环境交互力和操作者舒适力的差值大于0时，设置机器人末端的加速度为正；

当与环境交互力和操作者舒适力的差值小于0时，设置机器人末端的加速度为负；

其中，F_std为操作者舒适力，F_e为与环境交互力，

为机器人末端的最大速度。

作为进一步优选的，步骤S3中还需定义机器人末端的最大速度和最大加速度，所述机器人末端的最大速度

的计算模型为：

所述机器人末端的最大加速度

的计算模型为：

其中，F_std为操作者舒适力，F_e为与环境交互力，M为质量矩阵，D为阻尼矩阵，

为机器人末端的实际速度。

作为进一步优选的，步骤S4具体包括以下步骤：

S41根据机器人末端的位置、速度以及加速度的修正量对机器人末端实际位姿进行修正，获取机器人末端的期望位姿；

S42根据机器人末端的期望位姿获取机器人末端的理想运动关节角，并以此控制机器人末端在基于操作者舒适力的可变异导纳控制下沿虚拟夹具引导路径顺应性动作。

按照本发明的另一个方面，还提供了一种基于操作者舒适度的机器人可变导纳控制系统，包括人机交互模块、人手操作力前处理模块、变导纳控制模块以及机器人末端位置控制模块，其中，

所述人机交互模块包括操作者单元以及机器人末端，操作者单元用于牵引机器人末端；

所述人手操作力前处理模块用于将牵引机器人过程中的人手操作力进行前处理，得到与环境交互力；

所述变导纳控制模块根据该操作者舒适力以及机器人末端实际位姿生成虚阻尼调整策略，并根据虚阻尼调整策略构建机器人六自由度导纳控制模型，该机器人六自由度导纳控制模型用于获取与环境交互力和期望力之间的偏差力，并根据该偏差力生成机器人末端的位置、速度以及加速度的修正量；

所述机器人末端位置控制模块根据机器人末端的位置、速度以及加速度的修正量对机器人末端实际位姿进行修正，以此方式，使机器人末端能够在基于操作者舒适力的可变异导纳控制下顺应性动作。

作为进一步优选的，所述虚阻尼调整策略的计算模型为：

其中，

为虚阻尼调整策略，F_std为操作者舒适力，

为机器人末端实际位姿速度，D_max为预设的最大阻尼，该预设的最大阻尼是人为设定的，D_min为预设的最小阻尼，该预设的最小阻尼是人为设定的；

所述机器人六自由度导纳控制模型为：

其中，

为质量矩阵，

为阻尼矩阵，

为刚度矩阵，

Δx_o为方向误差。

作为进一步优选的，所述人手操作力前处理模块包括依次连接的力传感器以及重力补偿与滤波器；

所述变导纳控制模块包括通信连接的阻尼更新律单元以及导纳控制器。

总体而言，通过本发明所构思的以上技术方案与现有技术相比，主要具备以下的技术优点：

1.本发明通过获取机器人与操作者之间的与环境交互力，以根据操作者舒适力与机器人末端速度实时调整机器人末端导纳控制模型的阻尼系数，进而通过调整机器人末端的速度来纠正力偏差，使机器人末端能够在基于操作者舒适力的可变异导纳控制下顺应性动作，提高交互过程的沉浸感，具有计算简单，实时性高，提高人机交互的操作感和沉浸感的特点。

2.本发明基于操作者舒适度的可变阻尼策略，能够使操作者控制机器人末端速度与施加的人手操作力大小相似，机器人动作更加柔顺。限定导纳控制下机器人末端的最大速度和最大加速度，避免系统在突发情况下的震荡问题。

3.本发明在操作者需要快速运动时，使阻尼系数减小；在操作者需要慢速精细运动时，使阻尼系数增加。机器人末端反馈合适的操作交互力来增加操作者舒适度。

4.本发明在基于操作者舒适度的可变异导纳控制下，人机交互过程中当对机器人末端施加力时，机器人顺应性动作，反之机器人停止；当施加的力增加时，其运动速度增加，反之则速度减小或改变方向。

附图说明

图1是本发明优选实施例涉及的一种基于操作者舒适度的机器人可变导纳控制方法的流程图；

图2是本发明优选实施例涉及的一种基于操作者舒适度的机器人可变导纳控制方法的系统控制图；

图3是按照本发明的优选实施例构建的基于操作者舒适力的可变导纳控制策略示意图。

具体实施方式

为了使本发明的目的、技术方案及优点更加清楚明白，以下结合附图及实施例，对本发明进行进一步详细说明。应当理解，此处所描述的具体实施例仅仅用以解释本发明，并不用于限定本发明。此外，下面所描述的本发明各个实施方式中所涉及到的技术特征只要彼此之间未构成冲突就可以相互组合。

如图1以及图2所示，本发明实施例提供的一种基于操作者舒适度的机器人可变导纳控制方法，在人机协作交互过程中，需要机器人末端流畅柔顺地跟随操作者运动，本发明通过传感器获取机器人与环境间接触力，以根据操作者舒适力与机器人末端速度实时调整导纳控制中的阻尼系数，进而通过调整机器人的速度来纠正力偏差，提高交互过程的沉浸感，其具体步骤如下：

步骤一，对牵引机器人过程中的人手操作力进行前处理，得到与环境交互力，并将该与环境交互力转换为机器人末端执行动作的期望位姿。

具体而言，示教过程中，操作者牵引机器人末端运动，在机器人末端依次设置有力传感器以及重力补偿与滤波器，力传感器用于检测操作者牵引机器人末端运动的人手操作力，并将该力传感器信号发送给重力补偿与滤波器。该重力补偿与滤波器则对力信号进行滤波处理和力补偿处理，得到与环境交互力，机器人末端位置控制模块则将经导纳控制处理后的与环境交互力转换为机器人末端执行动作的期望位姿。在本发明中，力传感器为6维力传感器。

更具体的，在本发明中，由于机器人动觉示教过程中，需要在力传感器上安装末端执行器，此时，当机器人姿态发生变化时，力传感器的姿态也会发生相应的变化，但是，机器人末端执行器相对于世界坐标系的重力并不会因为机器人末端姿态的变换而发生改变，为了保证机器人动觉示教的正常进行，需要对机器人末端执行器在各姿态下进行重力补偿。

首先构建世界坐标系与机器人末端坐标系之间的旋转矩阵T，通过zyx形式的欧拉角进行表示，其中，

θ,ψ分别表示绕Z轴，Y轴，X轴的旋转角度。该旋转矩阵T的计算模型为：

机器人末端执行器的重力为G，在世界坐标系下的重力向量可表示为：

机器人末端执行器的重力矢量

与机器人末端坐标系X_t轴之间夹角余弦通过旋转矩阵T计算得到：

同时，机器人末端执行器在X_t轴上的重力分量G_x通过夹角余弦计算得到：

G_x＝G*cosα＝r₃₁*G

同理可获取机器人末端执行器在机器人末端坐标系{T}各轴上的重力分量为：

{G_x，G_y，G_z}＝{r₃₁*G，r₃₂*G，r₃₃*G}

根据力传感器测得的数据构建机器人末端执行器重力和重心坐标计算模型：

根据器人末端执行器重力和重心坐标对机器人末端执行器在各姿态下进行重力补偿。

步骤二，设定操作者舒适力，根据该操作者舒适力以及机器人末端实际位姿生成虚阻尼调整策略。

所述虚阻尼调整策略的计算模型为：

其中，

为虚阻尼调整策略，F_std为操作者舒适力，

为机器人末端实际位姿速度，D_max为预设的最大阻尼，D_min为预设的最小阻尼。

步骤三，根据虚阻尼调整策略构建机器人六自由度导纳控制模型，该机器人六自由度导纳控制模型用于获取与环境交互力和期望力之间的偏差力，并根据该偏差力生成机器人末端的位置、速度以及加速度的修正量。

在本发明中，根据虚阻尼调整策略构建机器人六自由度导纳控制模型具体包括以下步骤：

(1)构建机器末端位置导纳控制模型：

其中，M_p为位置惯性矩阵，D_p为位置阻尼矩阵，K_p为位置刚度矩阵，Δx_p为位置误差，

为速度误差，

为加速度误差；

(2)构建机器人末端姿态导纳控制模型：

其中，M_o为姿态惯性矩阵，D_o为姿态阻尼矩阵，K_o为姿态刚度矩阵，

为由旋转矩阵提取的欧拉角，

为

的一阶导数，

为

的二阶导数，^eΔf_o为在机器人末端实际姿态下的力矩值，T表示欧拉角与机器人末端在笛卡尔空间下的角速度旋转矩阵；

(3)根据机器末端位置导纳控制模型和机器人末端姿态导纳控制模型构建机器人末端空间导纳控制模型：

其中，

为质量矩阵，

为阻尼矩阵，

为刚度矩阵，

Δx_o为方向误差。

作为本发明的优选方案，步骤三中，还需根据与环境交互力和操作者舒适力的差值来改变机器人六自由度导纳控制模型中机器人末端的加速度，该调整模型为：

当与环境交互力和操作者舒适力的差值为0时，设置机器人末端的加速度为零；

当与环境交互力和操作者舒适力的差值大于0时，设置机器人末端的加速度为正；

当与环境交互力和操作者舒适力的差值小于0时，设置机器人末端的加速度为负；

其中，F_std为操作者舒适力，F_e为与环境交互力，

为机器人末端的最大速度。

作为本发明的优选方案，步骤三中还需定义机器人末端的最大速度和最大加速度，所述机器人末端的最大速度

的计算模型为：

所述机器人末端的最大加速度

的计算模型为：

其中，F_std为操作者舒适力，F_e为与环境交互力，M为质量矩阵，D为阻尼矩阵，

为机器人末端的实际速度

步骤四：根据机器人末端的位置、速度以及加速度的修正量对机器人末端实际位姿进行修正，获取机器人末端的期望位姿，然后根据机器人末端的期望位姿获取机器人末端的理想运动关节角，并以此控制机器人末端在基于操作者舒适力的可变异导纳控制下顺应性动作。

具体而言，本发明方法首先建立机器人六自由度导纳控制模型。如图2所示，通过力传感器反馈回来的与环境交互力与期望力之间的偏差，转换为机器人末端的位置、速度以及加速度的修正量以纠正力偏差。将导纳控制模型简化为一个质量-阻尼-弹簧的振荡二阶系统，具体如下：

(1)构建位置导纳控制模型。机器人末端运动过程中仅考虑线性力的影响，机器人末端仅位置发生变化，该控制模型为：

其中，M_p、D_p、K_p为(3×3)位置惯性矩阵，位置阻尼矩阵，位置刚度矩阵；Δx_p＝x_d-x_e为(3×1)位置误差。

当K_p与D_p为正定矩阵时系统成指数稳定，M_p、K_p与D_p满足

关系。

(2)构建姿态导纳控制模型。机器人末端姿态发生改变时，力传感器相对于世界坐标系所测得的力值需要实时改变，采用欧拉角的方式进行姿态导纳控制：

其中，M_o、D_o、D_o分别为(3×3)姿态惯性矩阵，姿态阻尼矩阵，姿态刚度矩阵；

为由旋转矩阵提取的欧拉角，^eΔf_o为在末端实际姿态下的力矩值，T表示欧拉角与机器人末端在笛卡尔空间下的(3×3)角速度旋转矩阵。

当K_o与D_o为正定矩阵时系统成指数稳定，M_o、D_o、K_o满足

关系。

(3)综上，机器人空间导纳控制模型，即机器人六自由度导纳控制模型为：

其中，M，D，K分别为(6×6)质量矩阵，阻尼矩阵，刚度矩阵，力偏差Δf＝f_e-f_d，f_d为期望力，f_e为与环境交互力；位姿误差Δx＝x_d-x_e，x_d与x_e分别为机器人末端期望与实际位姿。

其次，简化机器人空间导纳控制模型。在本发明所述人机交互过程中，聚焦变导纳控制方法，不考虑机器人末端加持物体或其他驱动交互力即机器人末端期望力f_d为零，此时空间导纳控制模型表示为：

接着，本发明所提出的基于操作者舒适度的可变导纳控制策略如图3所示。可变异导纳控制方法的策略为：即在操作者需要快速运动时，使阻尼系数减小；在操作者需要慢速精细运动时，使阻尼系数增加。机器人末端反馈合适的操作交互力来增加操作者舒适度。具体构造方式如下：

(1)设定操作者舒适力。定义在示教过程中的特定交互力使操作者感到舒适，并控制机器人运动速度范围，其操作者舒适力设置为标准力F_std，大小取决于操作者与机器人硬件平台。

(2)环境交互力固定时，机器人运动最大速度与虚阻尼成反比。维持速度的最小力等于速度与虚阻尼的乘积即

为了使与环境交互力能够保持在机器人运动范围内的最小值，在机器人速度增加的同时减小虚阻尼。

(3)虚阻尼调整策略。设计基于操作者舒适度的可变导纳控制策略为：

当机器人速度的改变时，即可动态调整导纳控制中虚阻力项的大小，具体调整方式如下所述：

速度项调整：通过与环境交互力与标准力比对改变机器人的加速度进而影响其速度大小，表示为：

上述策略表示为：当操作者所施加的与环境交互力与标准力相等时，机器人末端的加速度为0，速度将收敛于它的最大值；当与环境交互力超过标准力时，系统的加速度为正，机器人速度增加；当与环境交互力小于标准力时，系统的加速度为负，机器人速度减小。

同时，在本发明中还需设定机器人末端的安全速度与加速度。在所选择的阻尼范围内，机器人末端的最大速度取决于操作者与机器人之间的与环境交互力F_e与标准力F_std之间的关系。为保证运动过程安全性，定义机器人末端的最大速度与加速度，运动过程中机器人不能超过限定值。

最后，在基于操作者舒适度的可变异导纳控制下，人机交互过程中当对机器人末端施加力时，机器人顺应性动作，反之机器人停止；当施加的力增加时，其运动速度增加，反之则速度减小或改变方向。

本发明还提供了一种基于操作者舒适度的机器人可变导纳控制系统，包括人机交互模块、人手操作力前处理模块、变导纳控制模块以及机器人末端位置控制模块，其中，

所述人机交互模块包括操作者单元以及机器人末端，操作者单元用于牵引机器人末端；

所述人手操作力前处理模块用于将牵引机器人过程中的人手操作力进行前处理，得到与环境交互力；

所述变导纳控制模块根据该操作者舒适力以及机器人末端实际位姿生成虚阻尼调整策略，并根据虚阻尼调整策略构建机器人六自由度导纳控制模型，该机器人六自由度导纳控制模型用于获取与环境交互力和期望力之间的偏差力，并根据该偏差力生成机器人末端的位置、速度以及加速度的修正量；

所述机器人末端位置控制模块根据机器人末端的位置、速度以及加速度的修正量对机器人末端实际位姿进行修正，以此方式，使机器人末端能够在基于操作者舒适力的可变异导纳控制下顺应性动作。

具体而言，所述虚阻尼调整策略的计算模型为：

其中，

为虚阻尼调整策略，F_std为操作者舒适力，

为机器人末端实际位姿速度，D_max为预设的最大阻尼，D_min为预设的最小阻尼；

所述机器人六自由度导纳控制模型为：

其中，

为质量矩阵，

为阻尼矩阵，

为刚度矩阵，

Δx_o为方向误差。

所述人手操作力前处理模块包括依次连接的力传感器以及重力补偿与滤波器；所述变导纳控制模块包括通信连接的阻尼更新律单元以及导纳控制器，所述变导纳控制模块为质量-阻尼-弹簧的振荡二阶系统。

本领域的技术人员容易理解，以上所述仅为本发明的较佳实施例而已，并不用以限制本发明，凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等，均应包含在本发明的保护范围之内。

Claims (9)

1.一种基于操作者舒适度的机器人可变导纳控制方法，其特征在于，包括以下步骤：

S1对牵引机器人过程中的人手操作力进行前处理，得到与环境交互力，并将该与环境交互力转换为机器人末端的期望位姿；

S2设定操作者舒适力，根据该操作者舒适力以及机器人末端实际位姿生成虚阻尼调整策略；

S3根据虚阻尼调整策略构建机器人六自由度导纳控制模型，该机器人六自由度导纳控制模型用于获取与环境交互力和期望力之间的偏差力，并根据该偏差力生成机器人末端的位置、速度以及加速度的修正量；

S4根据机器人末端的位置、速度以及加速度的修正量对机器人末端实际位姿进行修正，以此方式，使机器人末端能够在基于操作者舒适力的可变异导纳控制下顺应性动作。

2.根据权利要求1所述的一种基于操作者舒适度的机器人可变导纳控制方法，其特征在于，步骤S1中，所述前处理包括滤波处理以及重力补偿处理。

3.根据权利要求1所述的一种基于操作者舒适度的机器人可变导纳控制方法，其特征在于，步骤S2中，所述虚阻尼调整策略的计算模型为：

其中，

为虚阻尼调整策略，F_std为操作者舒适力，

为机器人末端实际位姿速度，D_max为预设的最大阻尼，D_min为预设的最小阻尼。

4.根据权利要求1所述的一种基于操作者舒适度的机器人可变导纳控制方法，其特征在于，步骤S3中根据虚阻尼调整策略构建机器人六自由度导纳控制模型具体包括以下步骤：

S31构建机器末端位置导纳控制模型：

其中，M_p为位置惯性矩阵，D_p为位置阻尼矩阵，K_p为位置刚度矩阵，Δx_p为位置误差，

为速度误差，

为加速度误差；

S32构建机器人末端姿态导纳控制模型：

其中，M_o为姿态惯性矩阵，D_o为姿态阻尼矩阵，K_o为姿态刚度矩阵，

为由旋转矩阵提取的欧拉角，

为

的一阶导数，

为

的二阶导数，^eΔf_o为在机器人末端实际姿态下的力矩值，T表示欧拉角与机器人末端在笛卡尔空间下的角速度旋转矩阵；

S33根据机器末端位置导纳控制模型和机器人末端姿态导纳控制模型构建机器人末端空间导纳控制模型：

其中，

为质量矩阵，

为阻尼矩阵，

为刚度矩阵，

Δx_o为方向误差。

5.根据权利要求4所述的一种基于操作者舒适度的机器人可变导纳控制方法，其特征在于，步骤S3中还需定义机器人末端的最大速度和最大加速度，所述机器人末端的最大速度

的计算模型为：

所述机器人末端的最大加速度

的计算模型为：

其中，F_std为操作者舒适力，F_e为与环境交互力，M为质量矩阵，D为阻尼矩阵，

为机器人末端的实际速度。

6.根据权利要求1所述的一种基于操作者舒适度的机器人可变导纳控制方法，其特征在于，步骤S4具体包括以下步骤：

S41根据机器人末端的位置、速度以及加速度的修正量对机器人末端实际位姿进行修正，获取机器人末端的期望位姿；

S42根据机器人末端的期望位姿获取机器人末端的理想运动关节角，并以此控制机器人末端在基于操作者舒适力的可变异导纳控制下顺应性动作。

7.一种基于操作者舒适度的机器人可变导纳控制系统，其特征在于，包括人机交互模块、人手操作力前处理模块、变导纳控制模块以及机器人末端位置控制模块，其中，

所述人机交互模块包括操作者单元以及机器人末端，操作者单元用于牵引机器人末端；

所述人手操作力前处理模块用于将牵引机器人过程中的人手操作力进行前处理，得到与环境交互力；

所述变导纳控制模块根据该操作者舒适力以及机器人末端实际位姿生成虚阻尼调整策略，并根据虚阻尼调整策略构建机器人六自由度导纳控制模型，该机器人六自由度导纳控制模型用于获取与环境交互力和期望力之间的偏差力，并根据该偏差力生成机器人末端的位置、速度以及加速度的修正量；

所述机器人末端位置控制模块根据机器人末端的位置、速度以及加速度的修正量对机器人末端实际位姿进行修正，以此方式，使机器人末端能够在基于操作者舒适力的可变异导纳控制下顺应性动作。

8.根据权利要求7所述的一种基于操作者舒适度的机器人可变导纳控制系统，其特征在于，所述虚阻尼调整策略的计算模型为：

其中，

为虚阻尼调整策略，F_std为操作者舒适力，

为机器人末端实际位姿速度，D_max为预设的最大阻尼，D_min为预设的最小阻尼；

所述机器人六自由度导纳控制模型为：

其中，

为质量矩阵，

为阻尼矩阵，

为刚度矩阵，

Δx_o为方向误差。

9.根据权利要求7所述的一种基于操作者舒适度的机器人可变导纳控制系统，其特征在于，所述人手操作力前处理模块包括依次连接的力传感器以及重力补偿与滤波器；

所述变导纳控制模块包括通信连接的阻尼更新律单元以及导纳控制器。

Images