机械臂过腕部奇异点的轨迹规划方法、系统、设备及介质技术方案

本发明专利技术公开一种机械臂过腕部奇异点的轨迹规划方法、系统、设备及介质，涉及机械臂控制技术领域，包括：根据对机械臂所规划的初始路径得到在笛卡尔空间内每个时刻对应的位置，根据初始路径总时间、起点位置的轴角度和终点位置的轴角度，得到在四轴、五轴和六轴匀速状态下每个时刻对应的四轴、五轴和六轴的轴角度；根据每个时刻对应的四轴、五轴和六轴的轴角度和每个时刻对应的位置得到一轴、二轴和三轴的轴角度，从而根据一轴至六轴的轴角度得到使机械臂通过腕部奇异点的运动轨迹。在保证末端位置精度的同时，使机械臂末端经过奇异位置时不会出现四六轴超速和末端精度误差大的问题。会出现四六轴超速和末端精度误差大的问题。会出现四六轴超速和末端精度误差大的问题。

【技术实现步骤摘要】
机械臂过腕部奇异点的轨迹规划方法、系统、设备及介质


[0001]本专利技术涉及机械臂控制
，特别是涉及一种机械臂过腕部奇异点的轨迹规划方法、系统、设备及介质。

技术介绍

[0002]机械臂在笛卡尔空间中走直线时，路径中很容易出现五轴为零度的情况，此时机械臂进入腕部奇异状态，会导致四轴和六轴的速度无限大，造成超速停机。
[0003]目前大多数机械臂在遇到奇异问题时，会报告路径中存在错误重新选择位置或改变姿态进行规划，这种方式由于改变了路径或初末姿态，容易造成路径的丢失。
[0004]或者是，划分奇异区域在奇异区域内进行关节空间的规划；在路径规划时，首先在笛卡尔空间把路径分割，获得离散的笛卡尔空间内的点和运动总时间，然后再根据笛卡尔空间的点反解得到各轴的角度，如果路径中存在五轴过零的点，就会引起四轴和六轴的速度无穷大，导致无法通过，而该中方式就是在四轴和六轴超速开始位置和终止位置的这一段在关节空间内进行重新规划，会牺牲一部分位置精度，导致奇异区域内路径精度误差过大。

技术实现思路

[0005]为了解决上述问题，本专利技术提出了一种机械臂过腕部奇异点的轨迹规划方法、系统、设备及介质，在保证末端位置精度的同时，使机械臂末端经过奇异位置时不会出现四六轴超速和末端精度误差大的问题。
[0006]为了实现上述目的，本专利技术采用如下技术方案：第一方面，本专利技术提供一种机械臂过腕部奇异点的轨迹规划方法，包括：根据对机械臂所规划的初始路径得到在笛卡尔空间内每个时刻对应的位置，根据初始路径总时间、起点位置的轴角度和终点位置的轴角度，得到在四轴、五轴和六轴匀速状态下每个时刻对应的四轴、五轴和六轴的轴角度；根据每个时刻对应的四轴、五轴和六轴的轴角度和每个时刻对应的位置得到一轴、二轴和三轴的轴角度，从而根据一轴至六轴的轴角度得到使机械臂通过腕部奇异点的运动轨迹。
[0007]作为可选择的实施方式，四轴、五轴和六轴匀速的轴速度分别为：其中，为四轴的轴速度，为五轴的轴速度，为六轴的轴速度，、、分别为起点位置的四轴、五轴和六轴的轴角度，、、分别为终点位置的四轴、五轴和六轴的轴角度，T为初始路径总时间。
[0008]作为可选择的实施方式，每个时刻对应的四轴、五轴和六轴的轴角度分别为：
其中，为t时刻四轴的轴角度，为t时刻五轴的轴角度，为t时刻六轴的轴角度，为插值时间。
[0009]作为可选择的实施方式，一轴的轴角度为：；其中，为四轴的轴角度，为五轴的轴角度，为一轴的轴角度，（x,y）为每个时刻对应的位置坐标，d6是第6个关节的关节距离。
[0010]作为可选择的实施方式，三轴的轴角度为：；其中，为三轴的轴角度，c3、s3、K3均为中间系数。
[0011]作为可选择的实施方式，二轴的轴角度为：；其中，为二轴的轴角度，为三轴的轴角度，z为每个时刻对应的位置坐标中的z坐标值，d1为第1个关节的关节距离，为从3轴坐标系变换到6轴坐标系后的位置坐标。
[0012]作为可选择的实施方式，得到一轴、二轴和三轴的轴角度后，选择使所有轴的轴角度变化最小的解为一轴、二轴和三轴的最优轴角度，根据一轴至六轴的最优轴角度得到使机械臂通过腕部奇异点的运动轨迹。
[0013]第二方面，本专利技术提供一种机械臂过腕部奇异点的轨迹规划系统，包括：四轴至六轴轴角度确定模块，被配置为根据对机械臂所规划的初始路径得到在笛卡尔空间内每个时刻对应的位置，根据初始路径总时间、起点位置的轴角度和终点位置的轴角度，得到在四轴、五轴和六轴匀速状态下每个时刻对应的四轴、五轴和六轴的轴角度；一轴至三轴轴角度确定模块，被配置为根据每个时刻对应的四轴、五轴和六轴的轴角度和每个时刻对应的位置得到一轴、二轴和三轴的轴角度，从而根据一轴至六轴的轴角度得到使机械臂通过腕部奇异点的运动轨迹。
[0014]第三方面，本专利技术提供一种电子设备，包括存储器和处理器以及存储在存储器上并在处理器上运行的计算机指令，所述计算机指令被处理器运行时，完成第一方面所述的方法。
[0015]第四方面，本专利技术提供一种计算机可读存储介质，用于存储计算机指令，所述计算机指令被处理器执行时，完成第一方面所述的方法。
[0016]与现有技术相比，本专利技术的有益效果为：
本专利技术提出一种机械臂过腕部奇异点的轨迹规划方法、系统、设备及介质，应用于机械臂笛卡尔空间轨迹规划，根据起点位置和终点位置的轴角度，固定四轴、五轴和六轴的轴速度，从而得到在四轴、五轴和六轴匀速状态下每个时刻对应的四轴、五轴和六轴的轴角度，继而采用四轴、五轴和六轴的轴角度反解一轴、二轴和三轴的轴角度，在保证末端位置精度的同时，使机械臂末端经过奇异位置时不会出现四六轴超速和末端精度误差大的问题。
[0017]本专利技术无需改变路径和初末姿态，无需绕过奇异点规划，实现原路径通过奇异点，其关键过程是固定四轴、五轴和六轴的轴速度，再结合位置反解一轴、二轴和三轴的轴角度；因为五轴为0度时，四轴和六轴旋转轴重合，在求反解时会引起四轴和六轴的轴速度出现超速，那么先固定四轴、五轴和六轴的轴速度就不会出现该问题，从而保证位置精度。
[0018]本专利技术附加方面的优点将在下面的描述中部分给出，部分将从下面的描述中变得明显，或通过本专利技术的实践了解到。
附图说明
[0019]构成本专利技术的一部分的说明书附图用来提供对本专利技术的进一步理解，本专利技术的示意性实施例及其说明用于解释本专利技术，并不构成对本专利技术的不当限定。
[0020]图1为本专利技术实施例1提供的机械臂过腕部奇异点的轨迹规划方法流程图。
具体实施方式
[0021]下面结合附图与实施例对本专利技术做进一步说明。
[0022]应该指出，以下详细说明都是示例性的，旨在对本专利技术提供进一步的说明。除非另有指明，本文使用的所有技术和科学术语具有与本专利技术所属
的普通技术人员通常理解的相同含义。
[0023]需要注意的是，这里所使用的术语仅是为了描述具体实施方式，而非意图限制根据本专利技术的示例性实施方式。如在这里所使用的，除非上下文另外明确指出，否则单数形式也意图包括复数形式，此外，还应当理解的是，术语“包括”和“具有”以及他们的任何变形，意图在于覆盖不排他的包含，例如，包含了一系列步骤或单元的过程、方法、系统、产品或设备不必限于清楚地列出的那些步骤或单元，而是可包括没有清楚地列出的或对于这些过程、方法、产品或设备固有的其它步骤或单元。
[0024]在不冲突的情况下，本专利技术中的实施例及实施例中的特征可以相互组合。
[0025]实施例1在对机械臂规划直线路径时，根据所规划的路径的起点和终点的位置在笛卡尔空间内规划得到每个时刻对应的位置，在求反解时如果出现了五轴经过0点且四六轴出现超速的情况时，便认为该条路径会经过腕部奇异点。本实施例为了保证位置精度，采用原来规划的位置，通过给定四轴、五轴和六轴的轴速度避免超速，改变姿态插补的方式使机械臂末端平稳顺利的经过奇异点，且不会出现四六轴超速和末端精度误差大的问题。
本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.机械臂过腕部奇异点的轨迹规划方法，其特征在于，包括：根据对机械臂所规划的初始路径得到在笛卡尔空间内每个时刻对应的位置，根据初始路径总时间、起点位置的轴角度和终点位置的轴角度，得到在四轴、五轴和六轴匀速状态下每个时刻对应的四轴、五轴和六轴的轴角度；根据每个时刻对应的四轴、五轴和六轴的轴角度和每个时刻对应的位置得到一轴、二轴和三轴的轴角度，从而根据一轴至六轴的轴角度得到使机械臂通过腕部奇异点的运动轨迹。2.如权利要求1所述的机械臂过腕部奇异点的轨迹规划方法，其特征在于，四轴、五轴和六轴匀速的轴速度分别为：其中，为四轴的轴速度，为五轴的轴速度，为六轴的轴速度，、、分别为起点位置的四轴、五轴和六轴的轴角度，、、分别为终点位置的四轴、五轴和六轴的轴角度，T为初始路径总时间。3.如权利要求2所述的机械臂过腕部奇异点的轨迹规划方法，其特征在于，每个时刻对应的四轴、五轴和六轴的轴角度分别为：其中，为t时刻四轴的轴角度，为t时刻五轴的轴角度，为t时刻六轴的轴角度，为插值时间。4.如权利要求1所述的机械臂过腕部奇异点的轨迹规划方法，其特征在于，一轴的轴角度为：；其中，为四轴的轴角度，为五轴的轴角度，为一轴的轴角度，（x,y）为每个时刻对应的位置坐标，d6是第6个关节的关节距离。5.如权利要求1所述的机械臂过腕部奇异点的轨迹规划方法，其特征在于，三轴的轴角度为：；其中，为三轴的轴角度，c3、s3、K3均为中间系数。6.如权利要求1所述的机械臂过腕部奇异点的轨迹规...

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