一种基于机器人动力学的关节运动轨迹优化方法与流程

本发明涉及关节运动轨迹优化技术领域，特别涉及一种基于机器人动力学的关节运动轨迹优化方法。

背景技术：

现有技术中，在机器人轨迹规划的时候一般采用固定的速度和加速度值或者加速度时间来进行速度规划，进而得到位置规划曲线，但规划的速度以及加速度是否超过了机器人本体能承受的极限，是否是时间最优的方式等这些都没有进行计算校核，因此，一方面存在规划的速度或者加速度过大导致损坏机器人的风险，另一方面也存在规划的速度或者加速度过小，没有达到时间最优的效果，导致效率降低。

技术实现要素：

本发明的目的是克服上述背景技术中不足，提供一种基于机器人动力学的关节运动轨迹优化方法，在实际运行当前段程序时候，基于动力学模型实时计算后面2段程序各个关节的关节力矩，在保证关节力矩略小于最大关节力矩以及所有关节都同时加速、同时匀速、同时减速的前提下，尽可能提高关节加速度并减小加速时间，从而保证在相同的运动轨迹上能运行的最快，提高生产效率。

为了达到上述的技术效果，本发明采取以下技术方案：

一种基于机器人动力学的关节运动轨迹优化方法，包括：

s1.分别设置各关节允许的最大力矩及最大运行速度；

s2.根据运行速度倍率计算各关节的匀速段运行速度：

；其中，k为运行速度倍率；

s3.预设各关节最大加速度并设置各关节初始运行的加速度的值为其最大加速度，即：；

s4.计算各关节运行至匀速段运行速度所需的加速时间或者减速时间：；

s5.计算当前程序段各关节各自的起始角度和终止角度，并计算各关节各自的运行角度：；

s6.计算当前程序段各关节的程序运行时间：；

s7.计算当前程序段各关节的匀速运行时间：；

s8.根据各关节的加速时间或者减速时间、匀速运行时间、匀速段运行速度确定各个关节各自的速度曲线；

s9.对速度曲线积分得到各关节的当前程序段的运行轨迹，根据运行轨迹得到动力学方程的惯性参数集，离心力和科氏力参数集以及重力力矩；

s10.计算各关节运行时的最大力矩t：，其中，为惯性参数集，为离心力和科氏力参数集，为重力力矩，为关节加速度即=；为关节速度且=；

s11.依次比较各关节运行时的最大力矩t是否满足以下条件：t＞，若是，则将该关节的加速度降低为原来的n倍得到的新的加速度；否则，将该关节的加速度增大为原来的b倍得到的新的加速度，其中，0＜a＜1，b＞1，0＜n＜1；

s12.代入各关节得到的新的加速度返回步骤s4-s10重新计算，直至计算得到各关节运行时的最大力矩t满足：＜t＜，其中，0.9≤c＜d≤1；记录各关节的最终加速度；

s13.将步骤s12得到的各关节的最终加速度及步骤s2得到的各关节的匀速段运行速度重新代入步骤s4至步骤s9，即可得到该段程序的运行轨迹。

进一步地，a等于0.9；b等于1.1；n等于0.9，具体的数值可以在其满足的取值范围内依据实际情况进行定值。

本发明与现有技术相比，具有以下的有益效果

本发明的基于机器人动力学的关节运动轨迹优化方法，针对现有技术存在的在机器人轨迹规划时，规划速度以及加速度的方法存在的可能过大或过小的问题，通过在实际运行当前段程序时候，基于动力学模型实时计算后面2段程序各个关节的关节力矩，在保证关节力矩略小于最大关节力矩以及所有关节都同时加速、同时匀速、同时减速的前提下，实现关节加速度的最大化，从而减小加速时间，实现保证在相同的运动轨迹上机器人能运行的最快，达到提高生产效率的目的。

附图说明

图1是本发明的基于机器人动力学的关节运动轨迹优化方法的流程示意图。

图2是本发明的一个实施例的梯形加减速速度曲线示意图。

具体实施方式

下面结合本发明的实施例对本发明作进一步的阐述和说明。

实施例：

实施例一：

如图1所示，一种基于机器人动力学的关节运动轨迹优化方法，本实施例中具体是将该方法应用于工业机器人常见的6关节机器人上，其余类型机器人以此类推，具体包括以下步骤：

步骤1.分别设置各关节允许的最大力矩及最大运行速度。

本实施例中具体包括分别设置6个关节允许的最大力矩分别为：；以及分别设置6个关节允许的最大速度分别为：。

步骤2.根据运行速度倍率计算各关节的匀速段运行速度：

；其中，k为运行速度倍率；

本实施例中，得出6个关节的匀速段运行速度分别为：。

步骤3.预设各关节最大加速度并设置各关节初始运行的加速度的值为其最大加速度，即：。

对应的，本实施例中，预设的6个关节的最大加速度分别为：，则6个关节初始运行加速度对应分别为：。

步骤4.计算各关节运行至匀速段运行速度所需的加速时间或者减速时间：。

即根据6个关节的运行速度，运行加速度可分别计算得到对应的加速时间或者减速时间；

具体的，因为机器人进行轨迹规划时加速时间与减速时间相等，则步骤4统一表述为加速时间。

步骤5.计算当前程序段各关节各自的起始角度和终止角度，并计算各关节各自的运行角度：。

即计算当前程序段的6个关节各自的起始角度和终止角度后可进一步计算得到6个关节各自的运行角度。其中，计算当前程序段的6个关节各自的起始角度和终止角度为现有技术，此处不再赘述。

步骤6.计算当前程序段各关节的程序运行时间：。

本实施例中，具体根据6个关节的运行速度，以及当前程序段的6个关节各自的运行角度可计算得到到该段程序各关节的总体运行时间分别为：。

步骤7.计算当前程序段各关节的匀速运行时间：。

本实施例中，根据6个关节的加速时间，程序运行时间进行相应的计算即可得到当前程序段各关节的匀速运行时间，本实施例中分别为。

步骤8.根据各关节的加速时间或者减速时间、匀速运行时间、匀速段运行速度确定各个关节各自的速度曲线。

如图2所示，已知加速时间，匀速时间，匀速段运行速度，就可以得到6个关节各自的速度曲线，本实施例采用如图2的梯形加减速速度曲线，其他的加减速方式曲线不同，但计算方式相同，此处不赘述。

步骤9.对速度曲线积分得到各关节的当前程序段的运行轨迹，根据运行轨迹得到动力学方程的惯性参数集，离心力和科氏力参数集以及重力力矩；具体实现为现有技术，此处不再赘述。

步骤10.计算各关节运行时的最大力矩t：，其中，为惯性参数集，为离心力和科氏力参数集，为重力力矩，为关节加速度即=；为关节速度且=。

本实施例中，即将各关节速度，关节加速度，以及步骤9得到的运行轨迹所对应的参数集（惯性参数集、离心力和科氏力参数集），通过对应的计算方式的计算即可得到6个关节的运行时的最大力矩，分别为：。

步骤11.依次比较各关节运行时的最大力矩t是否满足以下条件：t＞，若是，则将该关节的加速度降低为原来的n倍得到的新的加速度；否则，将该关节的加速度增大为原来的b倍得到的新的加速度，其中，0＜a＜1，b＞1，0＜n＜1。

步骤12.代入各关节得到的新的加速度返回步骤s4-s10重新计算，直至计算得到各关节运行时的最大力矩t满足：＜t＜，其中，0.9≤c＜d≤1；记录各关节的最终加速度；其中，c与d的值越接近1越好。

上述步骤11及步骤12对应在本实施例中具体为：

比较第1关节运行时的最大力矩是否大于0.9倍的该关节允许的最大力矩，如果小于，则增大第1关节的加速度为原来的1.1倍，如果大于，则降低第1关节的加速度为原来0.9倍。

然后，将新的第1关节的加速度返回步骤s4-s10重新计算，直到计算得到第1关节的运行时的最大力矩的值落在之间，则记录此时的第1关节的关节加速度为。

依照上述方法依次确定6个关节的最终加速度分别记为。

步骤13.将步骤s12得到的各关节的最终加速度及步骤s2得到的各关节的匀速段运行速度重新代入步骤s4至步骤s9，即可得到该段程序的运行轨迹。

即根据步骤12得到的各关节的关节加速度，以及步骤2得到的各关节的匀速段运行速度，将其带入步骤4到步骤9即可得到该段程序的运行轨迹。

通过本发明的方法得出的运行轨迹可实现在保证关节力矩略小于最大关节力矩以及所有关节都同时加速、同时匀速、同时减速的前提下，尽可能的提高关节加速度从而减小加速时间，提升效率。

实施例二

本实施例中公开了一种计算机设备，该计算机设备可以是服务器，该计算机设备包括通过系统总线连接的处理器、存储器、网络接口和数据库。其中，该计算机设备的处理器用于提供计算和控制能力。该计算机设备的存储器包括非易失性存储介质、内存储器。该非易失性存储介质存储有操作系统、计算机程序和数据库。该内存储器为非易失性存储介质中的操作系统和计算机程序的运行提供环境。该计算机设备的数据库用于存储基于机器人动力学的关节运动轨迹优化方法中涉及到的数据。该计算机设备的网络接口用于与外部的终端通过网络连接通信。该计算机程序被处理器执行时以实现基于机器人动力学的关节运动轨迹优化方法。

在另一个实施例中，提供了一种计算机设备，包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序，处理器执行计算机程序时实现上述实施例一中基于机器人动力学的关节运动轨迹优化方法的步骤。为避免重复，这里不再赘述。

在另一个实施例中，提供了一种计算机可读存储介质，其上存储有计算机程序，计算机程序被处理器执行时实现上述实施例一中基于机器人动力学的关节运动轨迹优化方法的步骤。为避免重复，这里不再赘述

可以理解的是，以上实施方式仅仅是为了说明本发明的原理而采用的示例性实施方式，然而本发明并不局限于此。对于本领域内的普通技术人员而言，在不脱离本发明的精神和实质的情况下，可以做出各种变型和改进，这些变型和改进也视为本发明的保护范围。

起点商标作为专业知识产权交易平台，可以帮助大家解决很多问题，如果大家想要了解更多知产交易信息请点击 【在线咨询】或添加微信 【19522093243】与客服一对一沟通，为大家解决相关问题。

此文章来源于网络,如有侵权,请联系删除