欠约束下的最优位姿确定方法、装置、存储介质及机械臂

摘要

一种欠约束下的最优位姿确定方法、装置、存储介质及机械臂，主要包括根据机械臂的当前位姿和基于目标轴所随机生成的目标位姿，获得机械臂的基础位姿；根据基础位姿和目标位姿，确定交点；根据交点和目标轴，构建目标坐标系，并基于目标坐标系确定机械臂的最优位姿。据此，本申请可在欠约束的条件下快速且准确地确定机械臂的最优位置，并可充分利用机械臂的臂展，以获得最大的工作半径，从而有利于机械臂更好地完成各种复杂操作。

权利要求

1.一种欠约束下的最优位姿确定方法，其特征在于，包括：根据机械臂的当前位姿和基于目标轴所随机生成的目标位姿，获得所述机械臂的基础位姿；

根据所述基础位姿和所述目标位姿，确定交点；以及根据所述交点、所述机械臂的基座，确定所述交点至所述基座的连线在预设平面内的投影线；并根据所述目标轴和所述投影线，构建目标坐标系，以基于所述目标坐标系确定所述机械臂的最优位姿。

2.根据权利要求1所述的欠约束下的最优位姿确定方法，其特征在于，所述根据机械臂的当前位姿和基于目标轴所随机生成的目标位姿，获得所述机械臂的基础位姿包括：根据预设目标特征确定所述目标轴，并根据所述目标轴随机生成中间坐标系；

基于随机生成的所述中间坐标系，确定所述目标位姿；以及根据所述当前位姿和所述目标位姿，确定所述基础位姿。

3.根据权利要求2所述的欠约束下的最优位姿确定方法，其特征在于，所述方法还包括：

根据所述基础位姿和所述目标位姿，获得所述基础位姿的基础轴和所述目标位姿的目标轴为共面相交或异面相交的分析结果。

4.根据权利要求3所述的欠约束下的最优位姿确定方法，其特征在于，所述根据所述基础位姿和所述目标位姿，确定交点包括：响应所述基础轴和所述目标轴之间为共面相交的所述分析结果，基于所述中间坐标系，获得所述基础轴的第一轴线方程和所述目标轴的第二轴线方程；以及根据所述第一轴线方程和所述第二轴线方程，获得所述交点的位置信息；其中，所述第一轴线方程和所述第二轴线方程分别表示为：；

；

其中，所述 表示所述基础轴，所述 表示所述基础轴的方向向量，所述表示所述基础轴上的任意一点的位置，所述 表示所述目标轴，所述 表示所述目标轴的方向向量，所述 表示所述目标轴上的任意一点的位置；所述 表示所述基础轴或所述目标轴所在直线上的任意一点的位置。

5.根据权利要求4所述的欠约束下的最优位姿确定方法，其特征在于，所述基础轴的方向与处于所述基础位姿下的所述机械臂的第六轴的轴线相互平行。

6.根据权利要求3所述的欠约束下的最优位姿确定方法，其特征在于，所述根据所述基础位姿和所述目标位姿，确定交点包括：响应所述基础轴和所述目标轴之间为异面相交的所述分析结果，根据所述基础轴、所述目标轴、所述基础轴和所述目标轴的公垂线，获得所述交点的位置信息。

7.根据权利要求6所述的欠约束下的最优位姿确定方法，其特征在于，所述根据所述基础轴、所述目标轴、所述基础轴和所述目标轴的公垂线，获得所述交点包括：根据所述中间坐标系，确定所述基础轴上任意两个基础点对应的两个基础点坐标和所述目标轴上任意两个目标点对应的两个目标点坐标；

根据所述两个基础点坐标、所述两个目标点坐标，定义所述基础轴的基础垂足坐标、所述目标轴的目标垂足坐标、所述公垂线；

根据所述两个基础点坐标、所述基础垂足坐标、所述两个目标点坐标、所述目标垂足坐标、以及所述公垂线同时垂直于所述基础轴和所述目标轴的原理，确定第一换算公式和第二换算公式；以及

根据所述第一换算公式和所述第二换算公式，获得所述交点的位置信息；

所述基础轴和所述目标轴各自的轴线方程分别表示为：；

；

其中，所述 表示所述基础轴，所述 表示所述基础轴的方向向量，所述表示所述基础轴上的任意一点的位置，所述 表示所述目标轴，所述 表示所述目标轴的方向向量，所述 表示所述目标轴上的任意一点的位置；所述 表示所述基础轴或所述目标轴所在直线上的任意一点的位置；

所述两个基础点坐标分别表示为： 和 ；

所述两个目标点坐标分别表示为： 和 ;所述基础垂足坐标表示为：

；

所述目标垂足坐标表示为：

；

所述第一换算公式和所述第二换算公式分别表示为：；

；

其中，所述 和 分别为待求解的中间参数，其可基于所述第一换算公式和所述第二换算公式推导求得。

8.根据权利要求1所述的欠约束下的最优位姿确定方法，其特征在于，所述预设平面与所述机械臂的基座的水平面相互平行。

9.根据权利要求1所述的欠约束下的最优位姿确定方法，其特征在于，当所述机械臂处于所述最优位姿时，所述机械臂的第六轴的轴线处于由所述目标轴和所述投影线构成的平面内。

10.一种存储介质，其特征在于，所述存储介质上存储有计算机指令，所述计算机指令在被处理器执行时，使所述处理器执行权利要求1至9中任一项所述的方法。

11.一种欠约束下的最优位姿确定装置，其特征在于，包括：基础位姿计算模块，其根据机械臂的当前位姿和基于目标轴所随机生成的目标位姿，获得所述机械臂的基础位姿；

交点计算模块，其根据所述基础位姿和所述目标位姿，确定交点；以及最优位姿确定模块，其根据所述交点、所述机械臂的基座，确定所述交点至所述基座的连线在预设平面内的投影线，并根据所述目标轴和所述投影线，构建目标坐标系，以基于所述目标坐标系确定所述机械臂的最优位姿。

12.一种机械臂，其特征在于，所述机械臂可根据权利要求11所述的欠约束下的最优位姿确定装置所确定的所述最优位姿进行调整。

说明书

欠约束下的最优位姿确定方法、装置、存储介质及机械臂

技术领域

[0001] 本发明实施例涉及机械臂位姿控制技术，尤其涉及一种欠约束下的最优位姿确定方法、装置、存储介质及机械臂。

背景技术

[0002] 在目前的机器人领域，为了使机器人能够正常运作并完成相应的工作，常常需要根据目标位姿和当前位姿求得运动学逆解，据以提供机器人的机械臂以特定的姿态到达目
标附近的特定位置，从而完成后续的工作。

[0003] 然而，由于机械臂的目标姿态往往是无法完全确定的、是欠约束的，所以机械臂从当前位姿到达目标位姿之间的解将由于自转角度等多种因素，而存在多解关系。不同的求
解结果对于机械臂臂展的利用程度各不相同，甚至可能存在机械臂无法到达目标位姿的情
况，因此，如何在欠约束的情况下优化求解姿态，对于机械臂能否到达目标位置、能否获得
良好的机械臂空间姿态以及能否获得最大化的机械臂工作空间等问题起到至关重要的作
用，也足以影响机械臂整体性能。

[0004] 对于在复杂工况下进行高精度操作的机器人而言，由于工作环境和工作任务的特殊性，其需要尽可能利用机械臂的臂展，借以获得较好的空间姿态。

[0005] 在现有的机械臂姿态优化方法中，通过手动调整机械臂的自转角度，从而获得最优姿态的方式是较为常见的，然而，此方式主要是利用人眼及人脑中的先验知识对所获得
的结果进行判断，并通过手工调整的方式针对机械臂的位姿进行优化调整。

[0006] 然而，由于人脑对基础姿态与最优姿态之间的差距判断存在局限性，无法准确地描述两个姿态间的差距，导致方需要进行多次尝试求解，故此方法极大地降低了机械臂的
定位效率，且最终所确定的姿态无法确保能够最大化利用机械臂的臂展。

[0007] 再者，目前采用的另外一种方法是通过在基础姿态的基础上遍历解空间的方法以获得较优位姿，然而，此方法虽然减少了人工对于整个求解过程的参与，但是极大的增加了
机械臂求解次数，因此，此方法同样存在效率较低，以及根据其遍历解空间的精度不同而存
在误差的问题，对于后续的作业及定位工作造成很大的影响。

[0008] 有鉴于此，如何在欠约束的条件下提供一种快速准确的机械臂最优位姿确定技术，即为本申请待解决的技术课题。

发明内容

[0009] 有鉴于此，本发明实施例所解决的技术问题之一在于提供一种欠约束下的最优位姿确定方法、装置、存储介质及机械臂，可快速且准确地确定机械臂的最优位姿。

[0010] 根据本发明的第一方面，提供一种欠约束下的最优位姿确定方法，其包括根据机械臂的当前位姿和基于目标轴所随机生成的目标位姿，获得所述机械臂的基础位姿；根据
所述基础位姿和所述目标位姿，确定交点；以及根据所述交点和所述目标位姿，构建目标坐
标系，以基于所述目标坐标系确定所述机械臂的最优位姿。

[0011] 可选地，所述根据机械臂的当前位姿和基于目标轴所随机生成的目标位姿，获得所述机械臂的基础位姿包括：根据预设目标特征确定所述目标轴，并根据所述目标轴随机
生成中间坐标系；基于随机生成的所述中间坐标系，确定所述目标位姿；以及根据所述当前
位姿和所述目标位姿，确定所述基础位姿。

[0012] 可选地，所述方法还包括：根据所述基础位姿和所述目标位姿，获得所述基础位姿的基础轴和所述目标位姿的目标轴为共面相交或异面相交的分析结果。

[0013] 可选地，所述根据所述基础位姿和所述目标位姿，确定交点包括：响应所述基础轴和所述目标轴之间为共面相交的所述分析结果，基于所述中间坐标系，获得所述基础轴的
第一轴线方程和所述目标轴的第二轴线方程；以及根据所述第一轴线方程和所述第二轴线
方程，获得所述交点的位置信息；其中，所述第一轴线方程和所述第二轴线方程分别表示
为：

[0014] ；

[0015] ；

[0016] 其中，所述 表示所述基础轴，所述 表示所述基础轴的方向向量，所述表示所述基础轴上的任意一点的位置，所述 表示所述目标轴，所述 表示
所述目标轴的方向向量，所述 表示所述目标轴上的任意一点的位置；所述
表示所述基础轴或所述目标轴所在直线上的任意一点的位置。

[0017] 可选地，所述基础轴的方向与处于所述基础位姿下的所述机械臂的第六轴的轴线相互平行。

[0018] 可选地，所述根据所述基础位姿和所述目标位姿，确定交点包括：响应所述基础轴和所述目标轴之间为异面相交的所述分析结果，根据所述基础轴、所述目标轴、所述基础轴
和所述目标轴的公垂线，获得所述交点的位置信息。

[0019] 可选地，所述根据所述基础轴、所述目标轴、所述基础轴和所述目标轴的公垂线，获得所述交点包括：根据所述中间坐标系，确定所述基础轴上任意两个基础点对应的两个
基础点坐标和所述目标轴上任意两个目标点对应的两个目标点坐标；根据所述两个基础点
坐标、所述两个目标点坐标，定义所述基础轴的基础垂足坐标、所述目标轴的目标垂足坐
标、所述公垂线；根据所述两个基础点坐标、所述基础垂足坐标、所述两个目标点坐标、所述
目标垂足坐标、以及所述公垂线同时垂直于所述基础轴和所述目标轴的原理，确定第一换
算公式和第二换算公式；以及根据所述第一换算公式和所述第二换算公式，获得所述交点
的位置信息；所述基础轴和所述目标轴各自的轴线方程分别表示为：

[0020] ；

[0021] ；

[0022] 其中，所述 表示所述基础轴，所述 表示所述基础轴的方向向量，所述表示所述基础轴上的任意一点的位置，所述 表示所述目标轴，所述 表示
所述目标轴的方向向量，所述 表示所述目标轴上的任意一点的位置；所述
表示所述基础轴或所述目标轴所在直线上的任意一点的位置；

[0023] 所述两个基础点坐标分别表示为： 和 ；所述两个目标点坐标分别表示为： 和 ；所述基础垂足坐标表示为：

[0024] ；

[0025] 所述目标垂足坐标表示为：

[0026] ；

[0027] 所述第一换算公式和所述第二换算公式分别表示为：

[0028] ；

[0029] ；

[0030] 其中，所述 和 分别为待求解的中间参数，其可基于所述第一换算公式和所述第二换算公式推导求得。

[0031] 可选地，所述根据所述交点和所述目标轴，构建目标坐标系包括：根据所述交点、所述机械臂的基座，确定所述交点至所述基座的连线在预设平面内的投影线；以及根据所
述目标轴和所述投影线，构建所述目标坐标系。

[0032] 可选地，所述预设平面与所述机械臂的基座的水平面相互平行。

[0033] 可选地，当所述机械臂处于所述最优位姿时，所述机械臂的第六轴的轴线处于由所述目标轴和所述投影线构成的平面内。

[0034] 根据本发明的第二方面，提供一种存储介质，所述存储介质上存储有计算机指令，所述计算机指令在被处理器执行时，使所述处理器执行上述第一方面所述的方法。

[0035] 根据本发明的第三方面，提供一种欠约束下的最优位姿确定装置，其包括基础位姿计算模块，其根据机械臂的当前位姿和基于目标轴所随机生成的目标位姿，获得所述机
械臂的基础位姿；交点计算模块，其根据所述基础位姿和所述目标轴，确定交点；以及最优
位姿确定模块，其根据所述交点和所述目标位姿，构建目标坐标系，以基于所述目标坐标系
确定所述机械臂的最优位姿。

[0036] 根据本发明的第四方面，提供一种机械臂，所述机械臂可根据上述第三方面的欠约束下的最优位姿确定装置所确定的所述最优位姿进行调整。

[0037] 由以上技术方案可见，本发明实施例提供的欠约束下的最优位姿确定方法、装置、存储介质及机械臂，可根据由当前位姿和基于目标轴所随机生成的目标位置获得基础位
姿，并根据基于基础位姿和目标位姿所确定的交点和目标轴，构建目标坐标系，据以确定机
械臂的最优姿态。据此，本申请不仅可在欠约束的条件下提供机械臂快速、准确地调整至最
优姿态，且可充分利用机械臂的臂展，以获得最大化的工作半径，从而有利于机械臂更好地
完成复杂操作。

附图说明

[0038] 后文将参照附图以示例性而非限制性的方式详细描述本申请实施例的一些具体实施例。附图中相同的附图标记标示了相同或类似的部件或部分。本领域技术人员应该理
解，这些附图未必是按比值绘制的。附图中：

[0039] 图1示出了本发明第一实施例的欠约束下的最优位姿确定方法的流程示意图。

[0040] 图2示出了本发明第二实施例的欠约束下的最优位姿确定方法的流程示意图。

[0041] 图3示出了本发明第三实施例的欠约束下的最优位姿确定方法的流程示意图。

[0042] 图4示出了本发明第四实施例的欠约束下的最优位姿确定方法的流程示意图。

[0043] 图5示出了本发明第五实施例的欠约束下的最优位姿确定方法的流程示意图。

[0044] 图6示出了机械臂的状态示意图。

[0045] 图7示出了本申请第七实施例的欠约束下的最优位姿确定装置的架构示意图。

[0046] 图8示出了本申请第八实施例的机械臂的结构示意图。

具体实施方式

[0047] 为了使本领域的人员更好地理解本发明实施例中的技术方案，下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实
施例仅是本发明实施例一部分实施例，而不是全部的实施例。基于本发明实施例中的实施
例，本领域普通技术人员所获得的所有其他实施例，都应当属于本发明实施例保护的范围。

[0048] 诚如前述背景技术部分所述，由于目前机械臂的最优位姿主要是通过手动调整方式来实现，存在着机械臂调整操作效率低下，且在最优位姿下无法确保机械臂臂展得到充
分利用等问题。

[0049] 有鉴于此，本申请提出一种欠约束下的最优位姿确定方法、装置、存储介质和机械臂，可在欠约束条件下快速且准确的确定机械臂的最优位姿。下面将结合本发明各实施例
附图进一步说明本发明各实施例的具体实现。

[0050] 第一实施例

[0051] 图1示出了本发明第一实施例的欠约束下的最优位姿确定方法的流程示意图。如图所示，本实施例的欠约束下的最优位姿确定方法主要包括以下步骤：

[0052] 步骤S102, 根据机械臂的当前位姿和基于目标轴所随机生成的目标位姿，获得机械臂的基础位姿。

[0053] 于本实施例中，机械臂包括六轴机械臂（参考图6）。

[0054] 可选地，可通过机械臂的控制箱，获得机械臂的当前位姿。

[0055] 可选地，可根据预设目标特征确定目标轴，并基于目标轴构建随机的目标位姿。

[0056] 步骤S104，根据基础位姿和目标位姿，确定交点。

[0057] 于本实施例中，可根据基础位姿的基础轴和目标位姿的目标轴，确定交点。

[0058] 可选地，可根据机械臂的基础位姿，获得机械臂末端的位置信息以及方向信息（亦可称之为法兰方向信息）。

[0059] 如图6所示，于本实施例中，基础轴的方向与处于基础位姿下的机械臂的第六轴的轴线相互平行（或重合）。

[0060] 步骤S106，根据交点和目标轴，构建目标坐标系，以基于目标坐标系确定机械臂的最优位姿。

[0061] 于本实施例中，可根据交点和机械臂的基座，确定交点至基座的连线在预设平面内的投影线。

[0062] 于本实施例中，预设平面与机械臂的基座的水平面相互平行（即如图6所示的XOY平面）。

[0063] 于本实施例中，当处于最优位姿时，机械臂的第六轴的轴线可位于由目标轴和投影线所构成的平面内。

[0064] 具体地，由于根据预设目标特征所生成的目标位姿是随机的，欠约束的，使得基础位姿不一定与最优位姿重合，因此需要对基础位姿进一步优化调整。对于六轴机械臂而言，
若在最优位姿下，机械臂的第六轴的轴线位于由目标轴和投影线所构成的平面内时，可使
得在定位过程中能够尽可能地利用第六轴的长度，从而可最大化地利用机械臂的臂展以实
现最大化的工作半径。

[0065] 综上所述，本申请实施例的欠约束下的最优位姿确定方法，通过求解机械臂的基础位姿和目标位姿的交点，并根据交点和目标轴构建目标坐标系，据以确定机械臂的最优
位姿，借此，本申请可在欠约束的条件下，快速准确地确定机械臂的最优位姿，不仅可避免
人工调整机械臂导致的人为操作误差、亦可降低对操作人员的操作门槛，且可实现在保证
精度的同时有效提高处理效率。

[0066] 第二实施例

[0067] 图2示出了本申请第二实施例的欠约束下的最优位姿确定方法的流程示意图。本实施例为上述步骤S102的具体实施方案，如图所示，本实施例主要包括以下步骤：

[0068] 步骤S202，根据预设目标特征确定目标轴，并根据目标轴随机生成中间坐标系。

[0069] 具体地，可根据预设目标特征确定目标轴，再将所确定的目标轴上的一点作为中间坐标系的原点，并将目标轴作为中间坐标系的X轴，而后，根据坐标系之间的垂直关系随
机生成一个与X轴相垂直的向量以作为中间坐标系的Y轴，再根据直角坐标系坐标轴间的叉
乘关系，获得中间坐标系的Z轴，从而完成中间坐标系的建立。

[0070] 步骤S204，基于随机生成的中间坐标系，确定目标位姿。

[0071] 于本实施例中，可根据当前随机生成的中间坐标系，确定目标位姿。

[0072] 可选地，目标位姿的目标位姿信息可通过矩阵形式呈现。

[0073] 需说明的是，于本实施例中，由于中间坐标系中仅X轴为确定轴，而Y轴、Z轴均为随机生成，因此，根据随机生成的中间坐标系的不同，目标位姿的目标位姿信息亦可能不同。

[0074] 可选地，可通过机械臂函数接口获取机械臂的当前位姿的当前位姿信息。于本实施例中，当前位姿的当前位姿信息亦可通过矩阵形式呈现。

[0075] 步骤S206,根据当前位姿和目标位姿，确定基础位姿。

[0076] 于本实施例中，由于中间坐标系为随机生成，基于随机生成的中间坐标系所获得的目标位姿可有所不同，而基于不同目标位姿所确定的基础位姿亦可能不同。

[0077] 综上所述，本实施例根据预设目标特征建立随机的中间坐标系，以实现在欠约束的条件下，快速准确地确定机械臂的最优位姿。

[0078] 第三实施例

[0079] 图3示出了本申请第三实施例的欠约束下的最优位姿确定方法的流程示意图。本实施例主要示出了上述步骤S104的具体实施方案。

[0080] 于本实施例中，由于机械臂在空间中可以绕已知直线（例如目标位姿的目标轴）进行自转，其中，根据自转角度的不同，所获得各求解结果对应的各目标姿态亦不相同，然而，
由于这些不同目标姿态均位于沿机械臂的第六轴的轴线（即机械臂末端端面法兰坐标系的
Z轴）绕已知直线旋转所形成的空间锥面上（其中，空间锥面的锥度可根据机械臂末端工具
的不同而不同），因此，空间锥面的顶点（即交点）可作为所有目标姿态下都经过的空间点，
具有稳定不变的特点，可以很好的表示所有目标姿态，因此，可将空间锥面的顶点（即交点）
作为用于获取最优姿态的目标参考点。

[0081] 如图所示，本实施例主要包括以下步骤：

[0082] 接续上述步骤S204，继续执行步骤S302，判断基础位姿的基础轴和目标位姿的目标轴两者是否为共面相交，若是，则进行步骤S310，若否，则进行步骤S320。

[0083] 步骤S310，基于中间坐标系，获得基础轴的第一轴线方程和目标轴的第二轴线方程。

[0084] 于本实施例中，第一轴线方程和第二轴线方程分别表示为：

[0085] ；

[0086] ；

[0087] 其中，表示基础轴（即机械臂第六轴的轴线）， 表示基础轴的方向向量，表示基础轴上的任意一点的坐标位置，表示目标轴， 表示目标轴的方向
向量， 表示目标轴上的任意一点的坐标位置；所述 表示所述基础轴或所述
目标轴所在直线上的任意一点的位置。

[0088] 其中，上述第一轴线方程中的 和第二轴线方程中的 均为待求解的中间参数，用于求解方程式（参考步骤S312的详细描述）。

[0089] 步骤S312，根据第一轴线方程和第二轴线方程，获得交点的位置信息。

[0090] 具体地，根据上述第一轴线方程，使用 表示 、、 ，可推导获得下列方程式1：

[0091]

[0092] 将上述方程式1代入第二轴线方程，可推导获得下列方程式2：

[0093]

[0094] 根据上述方程式2可推导获得方程式3：

[0095]

[0096] 将方程式3代入第一轴线方程，亦即，将 代入 ，可获得交点的位置信息。

[0097] 步骤S320，根据基础轴、目标轴、基础轴和目标轴的公垂线，获得交点的位置信息。

[0098] 具体地，当判断基础位姿的基础轴和目标位姿的目标轴为异面相交时，可根据基础轴和目标轴的公垂线，来确定基础位姿和目标位姿之间的交点（具体参考下面的第四实
施例）。

[0099] 第四实施例

[0100] 图4示出了本申请第四实施例的欠约束下的最优位姿确定方法的流程示意图。本实施例主要示出了上述步骤S320的具体实施方案。

[0101] 于本实施例中，由于机械臂末端工具存在误差，以及末端工具与机械臂末端配合紧密性等问题，导致机械臂的第六轴的轴线（基础轴）与目标轴二者往往是异面相交的关
系，在此情况下，可根据两条轴线的公垂线在基础轴上的垂足作为交点，以使所获得的最优
位姿可更好的描述机械臂的姿态。

[0102] 如图所示，本实施例的方法主要包括以下步骤：

[0103] 步骤S402, 根据中间坐标系，确定基础轴上任意两个基础点对应的两个基础点坐标和目标轴上任意两个目标点对应的两个目标点坐标。

[0104] 于本实施例中，基础轴 上的两个基础点对应的两个基础点坐标可分别表示为：和 ，目标轴 上的两个目标点对应的两个目标点坐标可分别表示为: 
和 。

[0105] 步骤S404, 根据两个基础点坐标定义、两个目标点坐标，获得基础轴的基础垂足坐标、目标轴的目标垂足坐标、公垂线。

[0106] 于本实施例中，针对基础轴 ，定义 ，

[0107] 则基础轴 的基础垂足坐标 可定义为：

[0108] ；

[0109] 同理，针对目标轴 ，定义 ，

[0110] 目标轴 的目标垂足坐标 可定义为：

[0111] 。

[0112] 其中，上述的基础垂足坐标中的 和目标垂足坐标中的 均为待求解的中间参数，用于求解方程式（参考步骤S404至步骤S406的具体描述）。

[0113] 具体地，可根据上述定义的基础垂足坐标 和目标垂足坐标 ，将基础轴和目标轴的公垂线定义为：

[0114] 。

[0115] 步骤S406，根据两个基础点坐标、基础垂足坐标、两个目标点坐标、目标垂足坐标、以及公垂线同时垂直于基础轴和目标轴的原理，确定第一换算公式和第二换算公式。

[0116] 具体地，由于公垂线 同时垂直于 （即基础轴 ）和 （即目标轴 ），根据空间矢量点积特性，可以获得第一换算公式和第二换算公式，其分别表示为：

[0117] ；

[0118] 。

[0119] 步骤S408, 根据第一换算公式和第二换算公式，获得交点的位置信息。

[0120] 具体地，根据上述第一换算公式和第二换算公式，可推导获得下列方程式4：

[0121]

[0122]

[0123] 求解上述方程式4，可获得下列方程式5：

[0124] ；

[0125] 将方程式5中的 、 分别代入 和，即可获得基础垂足坐标与目标垂足坐标，并将基
础轴（即机械臂的第六轴的轴线）的基础垂足坐标确定为交点的位置信息。

[0126] 综上所述，借由本申请的第三实施例和第四实施例，可分别获得基础轴和目标轴二者为共面相交以及异面相交下的交点，所求得的交点能够表示所有目标位姿，具有稳定
不变的特点，可确保在欠约束条件下所确定的最优位姿具有较高的准确性。

[0127] 第五实施例

[0128] 图5示出了本申请第五实施例的欠约束下的最优位姿确定方法的流程示意图。本实施例示出了上述步骤S106的具体实施方案。如图所示，本实施例主要包括以下步骤：

[0129] 步骤S502，根据交点、机械臂的基座，确定交点至基座的连线在预设平面内的投影线。

[0130] 于本实施例中，预设平面（即图6所示的XOY平面）与机械臂的基座的水平面相互平行。

[0131] 步骤S504，根据目标轴和投影线，构建目标坐标系。

[0132] 于本实施例中，可根据目标轴和投影线的向量积，获得目标轴和投影线的平面法向量，并利用所获得的平面法向量与目标轴的叉乘关系构建目标坐标系，据以确定机械臂
的最优位姿。

[0133] 于本实施例中，在处于最优位姿时，机械臂的第六轴的轴线位于由目标轴和投影线所构成的平面内。

[0134] 综上所述，本实施例的欠约束下的最优位姿确定方法，基于所求得的交点以及目标轴构建目标坐标系，据以确定机械臂的最优位姿，由于处于最优位姿下的机械臂的第六
轴的轴线位于由目标轴和投影线构成的平面内，因此，本申请可充分利用机械臂臂展，以获
得最大化的工作半径，从而有利于机械臂更好地完成高精度的复杂操作。

[0135] 第六实施例

[0136] 本申请第六实施例提供一种存储介质，所述存储介质上存储有计算机指令，所述计算机指令在被处理器执行时，使所述处理器执行上述第一实施例至第五实施例所述的方
法。

[0137] 于本实施例中，所述存储介质是指计算机可读存储介质。

[0138] 第七实施例

[0139] 图7示出了本申请第七实施例的欠约束下的最优位姿确定装置的架构示意图。如图所示，本实施例的最优位姿确定装置700主要包括基础位姿计算模块702、交点计算模块
704、最优位姿确定模块706。

[0140] 基础位姿计算模块702根据机械臂的当前位姿和基于目标轴所随机生成的目标位姿，获得所述机械臂的基础位姿。

[0141] 可选地，基础位姿计算模块702还包括根据预设目标特征确定目标轴，并根据所述目标轴随机生成中间坐标系；基于随机生成的所述中间坐标系，确定所述目标位姿；以及根
据所述当前位姿和所述目标位姿，确定所述基础位姿。

[0142] 交点计算模块704根据所述基础位姿和所述目标轴，确定交点；以及。

[0143] 可选地，交点计算模块704还用于根据所述基础位姿和所述目标位姿，获得所述基础位姿的基础轴和所述目标位姿的目标轴为共面相交或异面相交的分析结果。

[0144] 可选地，交点计算模块704还用于响应所述基础轴和所述目标轴之间为共面相交的所述分析结果，基于所述中间坐标系，获得所述基础轴的第一轴线方程和所述目标轴的
第二轴线方程；以及根据所述第一轴线方程和所述第二轴线方程，获得所述交点的位置信
息。

[0145] 可选地，所述基础轴的方向与处于所述基础位姿下的所述机械臂的所述第六轴的垂线方向相互平行。

[0146] 可选地，交点计算模块704还用于响应所述基础轴和所述目标轴之间为异面相交的所述分析结果，根据所述基础轴、所述目标轴、所述基础轴和所述目标轴的公垂线，获得
所述交点的位置信息。

[0147] 可选地，交点计算模块704还用于根据所述中间坐标系，确定所述基础轴上任意两个基础点对应的两个基础点坐标和所述目标轴上任意两个目标点对应的两个目标点坐标；
根据所述两个基础点坐标定义、所述两个目标点坐标，获得所述基础轴的基础垂足坐标、所
述目标轴的目标垂足坐标、所述公垂线；根据所述两个基础点坐标、所述基础垂足坐标、所
述两个目标点坐标、所述目标垂足坐标、以及所述公垂线同时垂直于所述基础轴和所述目
标轴的原理，确定第一换算公式和第二换算公式；以及根据所述第一换算公式和所述第二
换算公式，获得所述交点的位置信息。

[0148] 可选地，根据所述基础位姿和所述目标位姿确定的所述交点与基于所述预设目标特征所随机生成的多个所述目标位姿对应的各所述目标轴的交点相吻合。

[0149] 最优位姿确定模块706根据所述交点和所述目标位姿，构建目标坐标系，以基于所述目标坐标系确定所述机械臂的最优位姿。

[0150] 可选地，最优位姿确定模块706还用于根据所述交点、所述机械臂的基座，确定所述交点至所述基座的连线在预设平面内的投影线；以及根据所述目标轴和所述投影线，构
建所述目标坐标系。

[0151] 可选地，所述预设平面与所述机械臂的基座的水平面相互平行。

[0152] 可选地，当所述机械臂处于所述最优位姿时，所述机械臂的第六轴的轴线处于由所述目标轴和所述投影线构成的平面内。

[0153] 此外，本发明实施例的最优位姿确定装置700还可用于实现前述各欠约束下的最优位姿确定方法实施例中的其他步骤，并具有相应的方法步骤实施例的有益效果，在此不
再赘述。

[0154] 第八实施例

[0155] 本发明第八实施例提供了一种机械臂800（请参阅图8），其中，机械臂800可根据上述第七实施例所述的欠约束下的最优位姿确定装置700所确定的所述最优位姿进行调整。

[0156] 综上所述，本发明实施例提供的欠约束下的最优位姿确定方法、装置、存储介质和机械臂，可根据预设目标特征随机生成目标位姿，并根据机械臂的当前位姿和基础位姿，获
得交点，再根据交点和目标位姿构建目标坐标系，进而确定机械臂的最优位姿，因此，本申
请可在欠约束条件下，快速准确地实现机械臂最优位姿的自动确定，以有效避免人为操作
引起的误差，并可降低对操作人员的操作门槛，可在保证精度的同时大大提高处理效率。

[0157] 再者，由于在最优位姿下，机械臂的第六轴的轴线处于由目标轴和交点至基座的连线在预设平面内的投影线所构成的平面内，因此，本申请可充分利用机械臂臂展，以获得
最大的工作半径，从而有利于支持机械臂更好的完成复杂工作。

[0158] 需要指出，根据实施的需要，可将本发明实施例中描述的各个部件/步骤拆分为更多部件/步骤，也可将两个或多个部件/步骤或者部件/步骤的部分操作组合成新的部件/步
骤，以实现本发明实施例的目的。

[0159] 上述根据本发明实施例的方法可在硬件、固件中实现，或者被实现为可存储在记录介质（诸如CD ROM、RAM、软盘、硬盘或磁光盘）中的软件或计算机代码，或者被实现通过网
络下载的原始存储在远程记录介质或非暂时机器可读介质中并将被存储在本地记录介质
中的计算机代码，从而在此描述的方法可被存储在使用通用计算机、专用处理器或者可编
程或专用硬件（诸如ASIC或FPGA）的记录介质上的这样的软件处理。可以理解，计算机、处理
器、微处理器控制器或可编程硬件包括可存储或接收软件或计算机代码的存储组件（例如，
RAM、ROM、闪存等），当所述软件或计算机代码被计算机、处理器或硬件访问且执行时，实现
在此描述的判题方法。此外，当通用计算机访问用于实现在此示出的欠约束下的最优位姿
确定方法的代码时，代码的执行将通用计算机转换为用于执行在此示出的欠约束下的最优
位姿确定方法的专用计算机。

[0160] 本领域普通技术人员可以意识到，结合本文中所公开的实施例描述的各示例的单元及方法步骤，能够以电子硬件、或者计算机软件和电子硬件的结合来实现。这些功能究竟
以硬件还是软件方式来执行，取决于技术方案的特定应用和设计约束条件。专业技术人员
可以对每个特定的应用来使用不同方法来实现所描述的功能，但是这种实现不应认为超出
本发明实施例的范围。

[0161] 以上实施方式仅用于说明本发明实施例，而并非对本发明实施例的限制，有关技术领域的普通技术人员，在不脱离本发明实施例的精神和范围的情况下，还可以做出各种
变化和变型，因此所有等同的技术方案也属于本发明实施例的范畴，本发明实施例的专利
保护范围应由权利要求限定。