三关节机械臂运动控制方法、装置、电子设备及存储介质制造方法及图纸

本申请提供一种三关节机械臂运动控制方法、装置、电子设备及存储介质，涉及机械控制技术领域。该方法通过机械臂当前所在的起始点、待运行至的指令点以及中间点和各关节的运动参数，进行数学建模，构建得到RTT构型的三关节机械臂的数学模型，并构建得到RTT构型的三关节机械臂对应的基准函数关系，基于基准函数关系，得到机械臂各关节轴线在不同位置关系下的逆解函数关系，从而根据逆解函数关系解析得到各关节的运动参数。由于基准函数关系是在RTT构型下根据关节关联参数唯一确定的，从而也唯一的确定了各关节轴线在不同位置关系下的逆解函数关系，根据逆解函数关系进行逆解解析，从而可实现RTT构型的三关节机械臂在多种情况下的全面和完整性逆解求解。下的全面和完整性逆解求解。下的全面和完整性逆解求解。

【技术实现步骤摘要】
三关节机械臂运动控制方法、装置、电子设备及存储介质


[0001]本申请涉及机械控制
，具体而言，涉及一种三关节机械臂运动控制方法、装置、电子设备及存储介质。

技术介绍

[0002]RTT三关节机械臂指由旋转关节、移动关节及移动关节依次相互链接构成的机械臂，对于RTT三关节机械臂的运动控制，通常可通过机械臂的运动学逆解实现，运动学逆解也即指已知机械臂末端位姿，求解机械臂中各运动关节的运动矢量。
[0003]目前，如何实现RTT三关节机械臂的逆解解析成为亟待解决的技术问题。

技术实现思路

[0004]本申请的目的在于，针对上述现有技术中的不足，提供一种三关节机械臂运动控制方法、装置、电子设备及存储介质，以便于实现RTT构型的三关节机械臂的运动学逆解解析。
[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]根据所述第一中间点的值、所述第一移动距离以及所述第二代数等式关系，确定所述第二中间点的值；
[0040]根据所述第二中间点的值、所述指令点以及预设的空间点与关节轴线之间的运动函数关系，确定所述关节转动角度的值。
[0041]第二方面，本申请实施例还提供了一种三关节机械臂运动控制装置，应用于机械臂控制系统中的处理设备，所述系本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种三关节机械臂运动控制方法，其特征在于，应用于机械臂控制系统中的处理设备，所述系统包括处理设备及具有目标结构的三关节机械臂，所述三关节机械臂包括依次相互链接的旋转关节、第一移动关节及第二移动关节；所述方法包括：获取所述机械臂的末端待运行至的指令点；根据所述机械臂中各关节的关节轴线之间的位置关系，确定所述位置关系对应的逆解函数关系；根据所述逆解函数关系，分别确定所述旋转关节的关节转动角度、所述第一移动关节的第一移动距离以及所述第二移动关节的第二移动距离；所述逆解函数关系根据基准函数关系变形得到，所述基准函数关系根据中间点的代数等式关系以及中间点与所述指令点之间的约束函数关系构建得到；所述中间点的代数等式关系根据所述机械臂的末端当前所在的起始点以及关节关联参数构建，所述关节关联参数包括：所述第一移动关节的第一移动距离、所述第一移动关节的第一关节轴线的第一方向矢量、所述第二移动关节的第二移动距离以及所述第二移动关节的第二关节轴线的第二方向矢量；所述中间点包括所述机械臂的末端由所述起始点运行至所述指令点的过程中所经过的指定点；分别控制所述机械臂的旋转关节转动所述关节转动角度、控制所述第一移动关节移动所述第一移动距离以及控制所述第二移动关节移动所述第二移动距离，以使得所述机械臂的末端由所述起始点运行至所述指令点。2.根据权利要求1所述的方法，其特征在于，所述根据所述机械臂中各关节的关节轴线之间的位置关系，确定所述位置关系对应的逆解函数关系，包括：根据各关节的关节轴线之间的位置关系，确定所述位置关系下各关节轴线的方向矢量之间所满足的矢量等式关系；根据所述矢量等式关系、以及所述基准函数关系，确定所述位置关系对应的逆解函数关系。3.根据权利要求1所述的方法，其特征在于，所述中间点的代数等式关系包括：第一中间点对应的第一代数等式关系以及第二中间点对应的第二代数等式关系；所述第一代数等式关系用于表征所述第一中间点与所述起始点、所述第二移动距离以及所述第二方向矢量之间的关系；所述第二代数等式关系用于表征所述第二中间点与所述第一中间点、所述第一移动距离以及所述第一方向矢量之间的关系。4.根据权利要求3所述的方法，其特征在于，所述中间点与所述指令点之间的约束函数关系包括：几何约束函数和代数约束函数；所述几何约束函数用于表征所述第二中间点与所述指令点以及所述旋转关节的旋转关节轴线的方向矢量之间的几何关系；所述代数约束函数用于表征所述第二中间点与所述指令点以及所述旋转关节轴线上的参考点之间的代数关系。5.根据权利要求3所述的方法，其特征在于，若所述旋转关节的旋转关节轴线不垂直于所述第二移动关节的第二关节轴线，且所述旋转关节轴线垂直于所述第一移动关节的第一关节轴线；则所述逆解函数关系为所述基准函数关系中所述第二移动距离相关的函数；所述根据所述逆解函数关系，分别确定所述旋转关节的关节转动角度、所述第一移动
关节的第一移动距离以及所述第二移动关节的第二移动距离，包括：根据所述逆解函数关系，确定所述第二移动距离；根据所述第二移动距离、以及所述基准函数关系中所述第一移动距离与所述第二移动距离之间的函数关系，确定所述第一移动距离；根据所述第二移动距离以及所述第一代数等式关系，确定所述第一中间点的值；根据所述第一中间点的值、所述第一移动距离以及所述第二代数等式关系，确定所述第二中间点的值；根据所述第二中间点的值、所述指令点以及预设的空间点与关节轴线之间的运动函数关系，确定所述关节转动角度的值。6.根据权利要求3所述的方法，其特征在于，若所述旋转关节的旋转关节轴线不垂直于所述第一移动关节的第一关节轴线，且所述旋转关节轴线垂直于所述第二移动关节的第二关节轴线；则所述...

【专利技术属性】
技术研发人员：请求不公布姓名，
申请(专利权)人：杭州唯精医疗机器人有限公司，
类型：发明
国别省市：