末端工具有效工作空间的规划方法、装置及存储介质与流程

技术特征：
1.一种末端工具有效工作空间的规划方法，其特征在于，包括：设置基坐标系中的第一坐标轴的极限值为有效工作空间的设计变量，其中所述极限值包括极限最大值和极限最小值；基于约束条件确定所述有效工作空间的非线性等式，以及根据所述非线性等式确定所述设计变量的目标函数，其中所述约束条件包括末端工具的极限朝向的空间向量集合；在基坐标系中的第二坐标轴和第三坐标轴组成的平面上等间隔取点，通过优化所述目标函数计算出所述平面上每个点对应的所述末端工具所能达到的第一坐标轴上的最大值和最小值；根据所述平面上所有的点对应的所述最大值和所述最小值确定最大有效工作空间。2.如权利要求1所述的规划方法，其特征在于，所述约束条件还包括机械臂的结构参数和末端工具参数。3.如权利要求1所述的规划方法，其特征在于，所述非线性等式为：其中，t
tool
为基坐标系到工具坐标系的坐标转换矩阵，f(
·
)是机械臂运动学正解函数，q是机械臂轴角向量，tool是末端工具参数，[z1，z2，z3]为所述末端工具的末端朝向在基坐标系下的投影，[x
q
，y
q
，z
q
]为根据机械臂轴角向量确定的基坐标系下的坐标。4.如权利要求3所述的规划方法，其特征在于，所述目标函数为：征在于，所述目标函数为：其中，min(x)为第一坐标轴的最小值，max(x)为第一坐标轴的最大值，f(
·
)是第一坐标轴的值与机械臂轴角向量的关系函数，q
a
是对应第一坐标轴的最小值的最优机械臂轴角向量，q
b
是对应第一坐标轴的最大值的最优机械臂轴角向量。5.如权利要求4所述的规划方法，其特征在于，通过优化所述目标函数计算出所述平面上每个点对应的所述末端工具所能达到的第一坐标轴上的最大值和最小值的步骤包括：以下列等式约束与不等式约束为所述目标函数的kkt条件，通过顺序二次规划优化所述目标函数得到每个点对应的一组最优机械臂轴角向量；q
min
＜q＜q
max
其中，[z1，z2，z3]为所述末端工具的末端朝向在基坐标系下的投影，[z
n1
，z
n2
，z
n3
]为第n组限制的末端朝向在基坐标系下的投影，y
q
和z
q
为根据所述机械臂轴角向量确定的第二坐标轴上的坐标和第三坐标轴上的坐标，y和z为所述平面上的点在第二坐标轴上的坐标和在第三坐标轴上的坐标，q
min
为机械臂关节的最小可达角度所构成的向量，q
max
为机械臂关节
的最大可达角度所构成的向量，q是机械臂轴角向量；以所述一组最优机械臂轴角向量对应的的一组第一坐标轴的值的其中一个为所述最大值，另一个为所述最小值。6.如权利要求1所述的规划方法，其特征在于，在基坐标系中的第二坐标轴和第三坐标轴组成的平面上等间隔取点的步骤包括：在所述第二坐标轴上从原点开始以第一步长递增确定各个点的第二坐标；在所述第三坐标轴上从原点开始以第二步长递增确定各个点的第三坐标，直到由所述第二坐标和所述第三坐标确定的点对应的第一坐标轴的最大值和最小值的差值小于第一阈值，则在所述第三坐标轴上从原点开始以第二步长递减继续确定各个点的第三坐标。7.如权利要求1所述的规划方法，其特征在于，还包括：根据工况需求确定所述末端工具在所述第二坐标轴所需要的第一工作范围和所述末端工具在所述第三坐标轴所需要的第二工作范围，根据所述第一工作范围和所述第二工作范围在基坐标系中的第二坐标轴和第三坐标轴组成的平面上等间隔取点。8.如权利要求7所述的规划方法，其特征在于，根据所述第一工作范围和所述第二工作范围在基坐标系中的第二坐标轴和第三坐标轴组成的平面上等间隔取点的步骤包括：在所述第二坐标轴上从原点开始到二分之一的所述第一工作范围内以第一步长递增确定各个点的第二坐标，其中所述有效工作空间在第二坐标轴上关于原点对称；在所述第三坐标轴上从原点开始以所述第二工作范围为步长递增确定各个点的第三坐标，直到由所述第二坐标和所述第三坐标确定的点对应的第一坐标轴的最大值和最小值的差值小于第一阈值，则在所述第三坐标轴上从原点开始以所述第二工作范围为步长递减继续确定各个点的第三坐标。9.如权利要求1所述的规划方法，其特征在于，根据所述平面上所有的点对应的所述最大值和所述最小值确定最大有效工作空间的步骤包括：从所述平面上所有的点对应的所述最大值中取最小者作为所述极限最大值，从所述平面上所有的点对应的所述最小值中取最大者作为所述极限最小值；根据所述极限最大值和所述极限最小值确定最大有效工作空间。10.如权利要求1所述的规划方法，其特征在于，根据所述极限最大值和所述极限最小值得到最大有效工作空间的步骤包括：生成所述第二坐标轴和所述第三坐标轴组成的平面对应的极限最大值曲面，生成所述第二坐标轴和所述第三坐标轴组成的平面对应的极限最小值曲面，得到最大有效工作空间。11.如权利要求2所述的规划方法，其特征在于，还包括：判断所述最大有效工作空间是否大于需求工作空间，如果否，则调整所述机械臂结构参数并重新获取所述最大有效工作空间。12.一种末端工具有效工作空间的规划装置，包括：存储器，用于存储可由处理器执行的指令；处理器，用于执行所述指令以实现如权利要求1-11任一项所述的方法。13.一种存储有计算机程序代码的计算机可读介质，所述计算机程序代码在由处理器执行时实现如权利要求1-11任一项所述的方法。

技术总结
本申请涉及一种末端工具有效工作空间的规划方法、装置及存储介质，该方法包括：设置基坐标系中的第一坐标轴的极限值为有效工作空间的设计变量，其中极限值包括极限最大值和极限最小值；基于约束条件确定有效工作空间的非线性等式，以及根据非线性等式确定设计变量的目标函数，其中约束条件包括末端工具的极限朝向的空间向量集合；在基坐标系中的第二坐标轴和第三坐标轴组成的平面上等间隔取点，通过优化目标函数计算出平面上每个点对应的末端工具所能达到的第一坐标轴上的最大值和最小值；根据平面上所有的点对应的最大值和最小值确定最大有效工作空间。本发明实现了末端工具与机械臂末端不共轴时规划最大的有效工作空间。机械臂末端不共轴时规划最大的有效工作空间。机械臂末端不共轴时规划最大的有效工作空间。


技术研发人员：王乾 钱进 李睿钦 王启超
受保护的技术使用者：实时侠智能控制技术有限公司
技术研发日：2022.06.21
技术公布日：2022/8/9