一种机器人自适应变阻抗电驱动系统及控制方法、装置

技术领域

本发明属于机器人电驱动控制技术领域，具体涉及一种机器人自适应变阻抗电驱动系统及控制方法、装置。

背景技术

机器人广泛应用于工业、服务等应用领域。对于协作与足式机器人，协作机器人在作业任务时需要与人和环境大量交互，足式机器人在运动过程中需要具备更高的环境适应性。传统的位置控制方式已不能满足机器人与人或环境交互能力，机器人需要具备一定的柔顺性能。基于阻抗控制的电驱动系统使机器人能够具备一定的柔顺性能，但驱动系统刚度与阻尼控制参数往往是恒定的。为使机器人在变化的环境中具备更智能的柔顺性能，需要对机器人进行自适应变阻抗控制。

机器人柔顺性能通常可以通过被动柔顺和主动柔顺控制实现。被动柔顺方式通过设计额外的机械结构使机器人具备一定的柔顺性能，但会使机器人驱动系统体积增大并且不能实现较大范围的刚度阻尼调节。主动柔顺控制可以通过控制机器人位置、速度及力三者运动关系来实现机器人的柔顺性能，其通过设定机器人的等效刚度与阻尼控制参数来实现。但单一的刚度与阻尼控制参数并不能满足机器人与变化的不同环境智能柔顺交互的性能。机器人根据交互环境进行自适应变阻抗控制能达到更好的柔顺性能。

发明内容

针对现有技术的不足，本发明提出了一种机器人自适应变阻抗电驱动系统及控制方法、装置。

为实现上述发明目的，本发明的技术方案为：本发明实施例的第一方面提供了一种机器人自适应变阻抗电驱动系统的控制方法，所述方法具体包括：

获取包括电机电流或驱动关节力矩、转速及位置信号在内的电驱动系统传感器信号；

根据机器人运动作业场景，自适应设置刚度参数；

根据驱动关节转速和力矩计算电驱动系统关节阻尼参数，根据刚度参数和关节阻尼参数确定电驱动系统关节需求力矩，以此基于力内环的阻抗控制方式对机器人驱动关节进行闭环自适应控制。

进一步地，自适应设置刚度参数包括：

刚度参数包括三个参数区间，公式如下：

式中，K为设定的刚度参数，K

进一步地，根据驱动关节转速和力矩计算电驱动系统关节阻尼参数包括：初始设定一阻尼常量，计算自适应阻尼增量，将初始设定的阻尼常量与自适应阻尼增量叠加得到实时计算的电驱动系统关节阻尼参数。

进一步地，自适应阻尼增量为驱动关节力矩的微分量与权重系数的乘积。

进一步地，根据计算的刚度参数和关节阻尼参数确定电驱动系统关节需求力矩的公式如下：

其中，τ为驱动关节控制力矩，K为刚度参数，q

本发明实施例的第二方面提供了一种机器人自适应变阻抗电驱动系统，用于实现上述的机器人自适应变阻抗电驱动系统的控制方法，包括：

永磁同步电机，经行星减速器减速、放大力矩后输出转速和力矩；

编码器，安装在永磁同步电机侧，用于采集永磁同步电机的转速及位置信号；

自适应变阻抗控制器，接收永磁同步电机对应的电流、力矩、转速及位置信号；根据机器人运动作业场景，自适应设置刚度参数；根据驱动关节转速和力矩计算电驱动系统关节阻尼参数，根据刚度参数和关节阻尼参数确定电驱动系统关节需求力矩，以此基于力内环的阻抗控制方式对机器人驱动关节进行闭环自适应控制。

进一步地，所述系统还包括力矩传感器，设置于行星减速器的输出端，用于测量驱动系统的输出力矩。

本发明实施例的第三方面提供了一种机器人自适应变阻抗电驱动系统的控制装置，包括一个或多个处理器，用于上述的机器人自适应变阻抗电驱动系统的控制方法。

本发明实施例的第四方面提供了一种计算机可读存储介质，其上存储有程序，该程序被处理器执行时，用于实现上述的机器人自适应变阻抗电驱动系统的控制方法。

本发明与传统机器人电驱动系统相比具有以下有益效果：机器人的驱动系统采用电机与低速比减速器具有更好的力控性能，并且直接通过主动控制的方法使机器人能够根据机器人电机电流或驱动关节力矩、转速以及机器人运动作业需求，在线实时调整机器人电驱动关节系统刚度与阻尼，无需增加额外的柔性机械元件，达到使机器人更智能柔顺的目的，有利于提高协作机器人交互能力和足式机器人运动行走能力。

附图说明

为了更清楚地说明本发明实施例中的技术方案，下面将对实施例描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本发明的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动性的前提下，还可以根据这些附图获得其他的附图。

图1是机器人自适应变阻抗电驱动系统控制方法流程图；

图2是机器人自适应变阻抗电驱动系统组成图；

图3是采用位置控制(无缓冲)电驱动系统机器人跳跃跌落地面冲击加速度；

图4是采用自适应变阻抗电驱动系统机器人跳跃跌落地面冲击加速度；

图5是本发明实施例提供的一种机器人自适应变阻抗电驱动系统的控制装置的示意图。

具体实施方式

这里将详细地对示例性实施例进行说明，其示例表示在附图中。下面的描述涉及附图时，除非另有表示，不同附图中的相同数字表示相同或相似的要素。以下示例性实施例中所描述的实施方式并不代表与本发明相一致的所有实施方式。相反，它们仅是与如所附权利要求书中所详述的、本发明的一些方面相一致的装置和方法的例子。

在本发明使用的术语是仅仅出于描述特定实施例的目的，而非旨在限制本发明。在本发明和所附权利要求书中所使用的单数形式的“一种”、“所述”和“该”也旨在包括多数形式，除非上下文清楚地表示其他含义。还应当理解，本文中使用的术语“和/或”是指并包含一个或多个相关联的列出项目的任何或所有可能组合。

应当理解，尽管在本发明可能采用术语第一、第二、第三等来描述各种信息，但这些信息不应限于这些术语。这些术语仅用来将同一类型的信息彼此区分开。例如，在不脱离本发明范围的情况下，第一信息也可以被称为第二信息，类似地，第二信息也可以被称为第一信息。取决于语境，如在此所使用的词语“如果”可以被解释成为“在……时”或“当……时”或“响应于确定”。

下面结合附图，对本发明进行详细说明。在不冲突的情况下，下述的实施例及实施方式中的特征可以相互组合。

如图1所示，本发明提出了一种机器人自适应变阻抗电驱动系统控制方法，所述方法包括：

获取包括电机电流或驱动关节力矩、转速及位置信号在内的电驱动系统传感器信号；其中，驱动关节力矩可以通过力矩传感器测量，或通过关节电流估计。

根据机器人运动作业场景，自适应设置刚度参数。

根据驱动关节转速和力矩计算电驱动系统关节阻尼参数，根据预设的刚度参数和关节阻尼参数确定电驱动系统关节需求力矩，以此基于力内环的阻抗控制方式对机器人驱动关节进行闭环自适应控制。

本发明提供的电驱动系统包括：

永磁同步电机，经行星减速器减速后输出转速和力矩。

编码器，安装在永磁同步电机侧，用于采集永磁同步电机的转速及位置信号。

自适应变阻抗控制器，接收永磁同步电机对应的电流、力矩、转速及位置信号；根据机器人运动作业场景，自适应设置刚度参数；根据驱动关节转速和力矩计算电驱动系统关节阻尼参数，根据刚度参数和关节阻尼参数确定电驱动系统关节需求力矩，以此基于力内环的阻抗控制方式对机器人驱动关节进行闭环自适应控制。

进一步地，本发明提供的电驱动系统还可包括：力矩传感器，用于测量减速器端输出力矩。

其中，自适应设置刚度参数可以表示为：

式中，K为设定的刚度参数，K

根据获取的驱动关节转速和力矩计算电驱动系统关节阻尼参数，具体为：初始设定一阻尼常量，计算自适应阻尼增量，将初始设定的阻尼常量与自适应阻尼增量叠加得到实时计算的电驱动系统关节阻尼参数。其中，自适应阻尼增量为驱动关节力矩的微分量与权重系数的乘积。

电驱动系统关节阻尼参数可以表示为：

D＝D

式中，D为实时计算的阻尼参数，D

根据刚度参数和关节阻尼参数确定电驱动系统关节需求力矩，以此基于力内环的阻抗控制方式对机器人驱动关节进行闭环自适应控制。

其中，驱动关节控制力矩可以通过采集力矩传感器信号或者电机电流计算而得。

电驱动系统关节需求力矩可以表示为：

其中τ为驱动关节控制力矩，q

图3是采用位置控制(无缓冲)电驱动系统机器人跳跃跌落地面冲击加速度；图4是采用自适应变阻抗电驱动系统机器人跳跃跌落地面冲击加速度。由图3和图4对比可知，通过本发明方法处理，可以使机器人跳跃跌落地面的运动缓冲减震能力明显增强，且机器人系统可以较大范围根据应用需求自适应调节自身控制刚度与阻尼特性。

综上所述，本发明机器人驱动系统无需增加的额外弹性和阻尼等机械元件，直接通过主动控制的方法根据不同的作业场景、作业任务在线实时改变机器人驱动系统的刚度与阻尼使机器人达到更智能柔顺的目的，有利于提高机器人与环境的交互能力特别是足式机器人运动缓冲减震能力。

与前述机器人自适应变阻抗电驱动系统的控制方法的实施例相对应，本发明还提供了机器人自适应变阻抗电驱动系统的控制装置的实施例。

参见图5，本发明实施例提供的一种机器人自适应变阻抗电驱动系统的控制装置，包括一个或多个处理器，用于实现上述实施例中的机器人自适应变阻抗电驱动系统的控制方法。

本发明机器人自适应变阻抗电驱动系统的控制装置的实施例可以应用在任意具备数据处理能力的设备上，该任意具备数据处理能力的设备可以为诸如计算机等设备或装置。装置实施例可以通过软件实现，也可以通过硬件或者软硬件结合的方式实现。以软件实现为例，作为一个逻辑意义上的装置，是通过其所在任意具备数据处理能力的设备的处理器将非易失性存储器中对应的计算机程序指令读取到内存中运行形成的。从硬件层面而言，如图5所示，为本发明机器人自适应变阻抗电驱动系统的控制装置所在任意具备数据处理能力的设备的一种硬件结构图，除了图5所示的处理器、内存、网络接口、以及非易失性存储器之外，实施例中装置所在的任意具备数据处理能力的设备通常根据该任意具备数据处理能力的设备的实际功能，还可以包括其他硬件，对此不再赘述。

上述装置中各个单元的功能和作用的实现过程具体详见上述方法中对应步骤的实现过程，在此不再赘述。

对于装置实施例而言，由于其基本对应于方法实施例，所以相关之处参见方法实施例的部分说明即可。以上所描述的装置实施例仅仅是示意性的，其中所述作为分离部件说明的单元可以是或者也可以不是物理上分开的，作为单元显示的部件可以是或者也可以不是物理单元，即可以位于一个地方，或者也可以分布到多个网络单元上。可以根据实际的需要选择其中的部分或者全部模块来实现本发明方案的目的。本领域普通技术人员在不付出创造性劳动的情况下，即可以理解并实施。

本发明实施例还提供一种计算机可读存储介质，其上存储有程序，该程序被处理器执行时，实现上述实施例中的机器人自适应变阻抗电驱动系统的控制方法。

所述计算机可读存储介质可以是前述任一实施例所述的任意具备数据处理能力的设备的内部存储单元，例如硬盘或内存。所述计算机可读存储介质也可以是任意具备数据处理能力的设备，例如所述设备上配备的插接式硬盘、智能存储卡(Smart Media Card，SMC)、SD卡、闪存卡(Flash Card)等。进一步的，所述计算机可读存储介质还可以既包括任意具备数据处理能力的设备的内部存储单元也包括外部存储设备。所述计算机可读存储介质用于存储所述计算机程序以及所述任意具备数据处理能力的设备所需的其他程序和数据，还可以用于暂时地存储已经输出或者将要输出的数据。

以上应用了具体个例对本发明的原理及实施方式进行了阐述，以上实施例的说明只是用于帮助理解本发明的方法及其核心思想；同时，对于本领域的一般技术人员，依据本发明的思想，在具体实施方式及应用范围上均会有改变之处，综上所述，本说明书内容不应理解为对本发明的限制。