一种给定时间和初末速度的机械臂轨迹规划方法及系统技术方案

本发明专利技术公开一种给定时间和初末速度的机械臂轨迹规划方法及系统，涉及机械臂轨迹规划技术领域，包括：根据给定的路径运行总时间、路径距离、最大加速度、起点速度和终点速度得到匀速段速度以及加速段、匀速段和减速段的时间；根据匀速段速度和起点速度更新最大加速度；根据更新后的最大加速度、匀速段速度、起点速度和终点速度，在加速段、匀速段和减速段的时间内，确定每段路径每时刻的加加速度、加速度、速度和位置，以此得到运动轨迹。给定起点速度、终点速度和路径运行总时间，规定运动过程中的最大速度和最大加速度，采用三次多项式方式进行规划，保证速度和加速度的连续性。保证速度和加速度的连续性。保证速度和加速度的连续性。

【技术实现步骤摘要】
一种给定时间和初末速度的机械臂轨迹规划方法及系统


[0001]本专利技术涉及机械臂轨迹规划
，特别是涉及一种给定时间和初末速度的机械臂轨迹规划方法及系统。

技术介绍

[0002]机械臂在关节空间运动时，为保持速度的连续性和不同轴关节的等时性，给定轴关节经过一段路径的总时间、初始速度以及末速度，并且保证运动过程中速度和加速度不超限。但是传统的S曲线算法在给定时间时需要固定的缩放始末速度，而T曲线不能保证运动过程中加速度的连续性。

技术实现思路

[0003]为了解决上述问题，本专利技术提出了一种给定时间和初末速度的机械臂轨迹规划方法及系统，给定起点速度、终点速度和路径运行总时间，规定运动过程中的最大速度和最大加速度，采用三次多项式方式进行规划，保证速度和加速度的连续性。
[0004]为了实现上述目的，本专利技术采用如下技术方案：第一方面，本专利技术提供一种给定时间和初末速度的机械臂轨迹规划方法，包括：根据给定的路径运行总时间、路径距离、最大加速度、起点速度和终点速度得到匀速段速度以及加速段、匀速段和减速段的时间；根据匀速段速度和起点速度更新最大加速度；根据更新后的最大加速度、匀速段速度、起点速度和终点速度，在加速段、匀速段和减速段的时间内，确定每段路径每时刻的加加速度、加速度、速度和位置，以此得到运动轨迹。
[0005]作为可选择的实施方式，确定匀速段速度的过程包括：根据匀速段速度与起点速度和终点速度的大小比较关系，设定假设条件分别计算匀速段速度，同时设置匀速段速度不大于最大速度的约束条件，当计算出的匀速段速度满足设定的假设条件和约束条件时则停止计算。
[0006]作为可选择的实施方式，设，则匀速段速度为：
设，则匀速段速度为：设，则匀速段速度为：设，则匀速段速度为：其中，为匀速段速度，T为轨迹运行总时间，为起点速度，为终点速度，为最大加速度，h为路径距离。
[0007]作为可选择的实施方式，加速段时间、减速段时间和匀速段时间为：其中，T为轨迹运行总时间，为起点速度，为终点速度，为最大加速度，为匀速段速度。
[0008]作为可选择的实施方式，在加速段的时间内，每时刻的加加速度、加速度、速度和位置分别为：
其中，T为轨迹运行总时间，为起点速度，为最大加速度，为匀速段速度，为起点位置，为加速段时间。
[0009]作为可选择的实施方式，在匀速段的时间内，每时刻的加加速度、加速度、速度和位置分别为：其中，为匀速段速度，为起点位置，为减速段时间，为最大加速度，为起点速度，为加速段时间。
[0010]作为可选择的实施方式，在减速段的时间内，每时刻的加加速度、加速度、速度和位置分别为：其中，为匀速段速度，为起点位置，为减速段时间，为最大加速度，为起点速度，为加速段时间，T为轨迹运行总时间。
[0011]第二方面，本专利技术提供一种给定时间和初末速度的机械臂轨迹规划系统，包括：
匀速段速度确定模块，被配置为根据给定的路径运行总时间、路径距离、最大加速度、起点速度和终点速度得到匀速段速度以及加速段、匀速段和减速段的时间；最大加速度确定模块，被配置为根据匀速段速度和起点速度更新最大加速度；轨迹规划模块，被配置为根据更新后的最大加速度、匀速段速度、起点速度和终点速度，在加速段、匀速段和减速段的时间内，确定每段路径每时刻的加加速度、加速度、速度和位置，以此得到运动轨迹。
[0012]第三方面，本专利技术提供一种电子设备，包括存储器和处理器以及存储在存储器上并在处理器上运行的计算机指令，所述计算机指令被处理器运行时，完成第一方面所述的方法。
[0013]第四方面，本专利技术提供一种计算机可读存储介质，用于存储计算机指令，所述计算机指令被处理器执行时，完成第一方面所述的方法。
[0014]与现有技术相比，本专利技术的有益效果为：本专利技术提出一种给定时间和初末速度的机械臂轨迹规划方法及系统，对机械臂轨迹进行规划时，给定起点速度、终点速度和路径运行总时间，规定运动过程中的最大速度和最大加速度，采用三次多项式的方式进行规划，给定路径运行总时间以保证速度的连续性，采用三次多项式以保证运行过程中加速度的连续性。
[0015]本专利技术提出一种给定时间和初末速度的机械臂三次分段式轨迹规划方法，为保证各关节运动的等时性和速度连续性，对轴进行轨迹规划，在给定时间和速度、加速度的条件下，结合三次曲线加速度连续的优势和保证始末速度连续给出轨迹规划的方案。
[0016]本专利技术附加方面的优点将在下面的描述中部分给出，部分将从下面的描述中变得明显，或通过本专利技术的实践了解到。
附图说明
[0017]构成本专利技术的一部分的说明书附图用来提供对本专利技术的进一步理解，本专利技术的示意性实施例及其说明用于解释本专利技术，并不构成对本专利技术的不当限定。
[0018]图1为本专利技术实施例1提供的给定时间和初末速度的机械臂轨迹规划方法流程图。
具体实施方式
[0019]下面结合附图与实施例对本专利技术做进一步说明。
[0020]应该指出，以下详细说明都是示例性的，旨在对本专利技术提供进一步的说明。除非另有指明，本文使用的所有技术和科学术语具有与本专利技术所属
的普通技术人员通常理解的相同含义。
[0021]需要注意的是，这里所使用的术语仅是为了描述具体实施方式，而非意图限制根据本专利技术的示例性实施方式。如在这里所使用的，除非上下文另外明确指出，否则单数形式也意图包括复数形式，此外，还应当理解的是，术语“包括”和“具有”以及他们的任何变形，意图在于覆盖不排他的包含，例如，包含了一系列步骤或单元的过程、方法、系统、产品或设备不必限于清楚地列出的那些步骤或单元，而是可包括没有清楚地列出的或对于这些过程、方法、产品或设备固有的其它步骤或单元。
[0022]在不冲突的情况下，本专利技术中的实施例及实施例中的特征可以相互组合。
[0023]实施例1本实施例提供一种给定时间和初末速度的机械臂轨迹规划方法，如图1所示，包括：根据给定的路径运行总时间、路径距离、最大加速度、起点速度和终点速度得到匀速段速度以及加速段、匀速段和减速段的时间；根据匀速段速度和起点速度更新最大加速度；根据更新后的最大加速度、匀速段速度、起点速度和终点速度，在加速段、匀速段和减速段的时间内，确定每段路径每时刻的加加速度、加速度、速度和位置，以此得到运动轨迹。
[0024]在本实施例中，给定以下参数：路径运行总时间T、起点位置、终点位置、起点速度、终点速度、最大速度、最大加速度；本实施例首先计算出匀速段速度，以保证运行过程中加速度连续，且计算在速度变化段的加加速度；本实施例将整个运动过程分为加速段、匀速段和减速段，且分别确定每段路径每时刻的时间、加加速度、加速度、速度和位置，以此得到运动轨迹。
[0025]在本实施例中，根据起点位置和终点位置的关节的角度大小，修正给定的各项参数的符号；具体地：若终点位置小于起点位置，则交换各项参数的符号，更新给定的各项参数：（1）在本实施例中，根据给定的路径距离、本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种给定时间和初末速度的机械臂轨迹规划方法，其特征在于，包括：根据给定的路径运行总时间、路径距离、最大加速度、起点速度和终点速度得到匀速段速度以及加速段、匀速段和减速段的时间；根据匀速段速度和起点速度更新最大加速度；根据更新后的最大加速度、匀速段速度、起点速度和终点速度，在加速段、匀速段和减速段的时间内，确定每段路径每时刻的加加速度、加速度、速度和位置，以此得到运动轨迹。2.如权利要求1所述的一种给定时间和初末速度的机械臂轨迹规划方法，其特征在于，确定匀速段速度的过程包括：根据匀速段速度与起点速度和终点速度的大小比较关系，设定假设条件分别计算匀速段速度，同时设置匀速段速度不大于最大速度的约束条件，当计算出的匀速段速度满足设定的假设条件和约束条件时则停止计算。3.如权利要求2所述的一种给定时间和初末速度的机械臂轨迹规划方法，其特征在于，设，则匀速段速度为：设，则匀速段速度为：设，则匀速段速度为：设，则匀速段速度为：
其中，为匀速段速度，T为轨迹运行总时间，为起点速度，为终点速度，为最大加速度，h为路径距离。4.如权利要求1所述的一种给定时间和初末速度的机械臂轨迹规划方法，其特征在于，加速段时间、减速段时间和匀速段时间为：其中，T为轨迹运行总时间，为起点速度，为终点速度，为最大加速度，为匀速段速度。5.如权利要求1所述的一种给定时间和初末速度的机械臂轨迹规划方法，其特征在于，在加速段的时间内，每时刻的加加速度、加速度、速度和位置分别为：其中，T为轨迹运行总时间，为起点速度，为最大加速度，为匀速段速...

【专利技术属性】
技术研发人员：王迎智，张书猛，戈朝波，
申请(专利权)人：极限人工智能北京有限公司，
类型：发明
国别省市：