位姿关系标定方法及装置、计算机设备和可读存储介质

1.本技术涉及机器人控制技术领域，具体而言，涉及一种位姿关系标定方法及装置、计算机设备和可读存储介质。


背景技术：

2.随着科学技术的不断发展，机器人技术因具有极大的研究价值及应用价值受到了各行各业的广泛重视，其中工业机器人控制便是机器人控制技术领域中的一项重要研究方向。而在对工业机器人进行作业控制时，往往需要利用附加轴系统作为机器人外设来扩展工业机器人工作空间，通过使附加轴系统与工业机器人同步协同运动，确保工业机器人能够对安装在附加轴系统上的工件进行相关作业（例如，焊接作业、切割作业、涂胶作业等）。在此过程中，值得注意的是，有效标定附加轴系统与工业机器人之间的位姿关系，是实现附加轴系统与工业机器人同步协同运动的前提条件。
3.目前，现有针对附加轴系统与工业机器人的位姿关系标定方案需要针对附加轴系统中每个附加轴单独根据对应附加轴类型进行位姿关系标定示教，而后对附加轴系统中所有附加轴各自对应的已标定位姿关系进行整合，才能得到附加轴系统与工业机器人之间的位姿关系。因此，这种位姿关系标定方案实质存在示教繁琐问题，同时极易在示教过程中引入示教误差，导致最终确定出的附加轴系统与工业机器人之间的位姿关系精准度不高。


技术实现要素：

4.有鉴于此，本技术的目的在于提供一种位姿关系标定方法及装置、计算机设备和可读存储介质，能够有效避免现有位姿关系标定过程中的繁琐示教操作，并提升位姿关系的标定精准度及标定效率。
5.为了实现上述目的，本技术实施例采用的技术方案如下：第一方面，本技术提供一种位姿关系标定方法，所述标定方法包括：控制附加轴系统通过连接装置牵引目标机器人进行多次位姿变化运动，其中所述连接装置用于连接所述目标机器人的机器人末端和所述附加轴系统的输出末端；获取所述附加轴系统与所述目标机器人各自在每次位姿变化运动前后的实际关节位置数据；基于获取到的所述附加轴系统与所述目标机器人各自的实际关节位置数据，调用与所述连接装置对应的位姿关系标定模型进行参数优化求解，得到所述目标机器人与所述附加轴系统之间的位姿关系变换矩阵。
6.在可选的实施方式中，针对每次位姿变化运动，控制所述附加轴系统通过所述连接装置牵引所述目标机器人实现该位姿变化运动的步骤，包括：控制所述附加轴系统执行与该位姿变化运动对应的附加轴运动操作；获取所述连接装置检测到的与所述附加轴运动操作对应的牵引力数据；根据所述牵引力数据计算所述目标机器人的机器人末端在机器人基座坐标系下
的期望速度数据；根据所述机器人末端在机器人基座坐标系下的当前位姿数据及期望速度数据，计算所述机器人末端在机器人基座坐标系下的与所述附加轴运动操作匹配的期望位姿数据；按照所述机器人末端在机器人基座坐标系下的期望位姿数据，基于机器人逆运动学原理控制所述目标机器人的各机器人关节进行运动，以完成该位姿变化运动。
7.在可选的实施方式中，所述根据所述牵引力数据计算所述目标机器人的机器人末端在机器人基座坐标系下的期望速度数据的步骤，包括：调用所述机器人末端在机器人末端坐标系下的末端作用力参数与末端速度参数之间的关联关系，计算所述机器人末端在机器人末端坐标系下的与所述牵引力数据对应的目标速度数据；根据所述目标机器人的机器人末端坐标系与机器人基座坐标系之间的当前齐次变换矩阵，对所述机器人末端在机器人末端坐标系下的目标速度数据进行数据变换处理，得到所述机器人末端在机器人基座坐标系下的期望速度数据。
8.在可选的实施方式中，所述按照所述机器人末端在机器人基座坐标系下的期望位姿数据，基于机器人逆运动学原理控制所述目标机器人的各机器人关节进行运动的步骤，包括：基于机器人逆运动学原理对所述机器人末端在机器人基座坐标系下的期望位姿数据进行逆运动学求解，得到所述目标机器人的各机器人关节的期望关节位置；针对所述目标机器人的每个机器人关节，按照该机器人关节的期望关节位置调整该机器人关节的当前关节位置。
9.在可选的实施方式中，所述基于获取到的所述附加轴系统与所述目标机器人各自的实际关节位置数据，调用与所述连接装置对应的位姿关系标定模型进行参数优化求解，得到所述目标机器人与所述附加轴系统之间的位姿关系变换矩阵的步骤，包括：针对每次位姿变化运动，根据所述目标机器人在该位姿变化运动前后的实际关节位置数据，基于机器人正向运动学原理计算得到所述目标机器人的机器人末端坐标系与机器人基座坐标系之间的第一运动前齐次变换矩阵及第一运动后齐次变换矩阵；针对每次位姿变化运动，根据所述附加轴系统在该位姿变化运动前后的实际关节位置数据，基于改进型d-h参数法计算得到所述附加轴系统的输出末端坐标系与附加轴基座坐标系之间的第二运动前齐次变换矩阵及第二运动后齐次变换矩阵；针对每次位姿变化运动，将与该位姿变化运动对应的所述第一运动前齐次变换矩阵、所述第二运动前齐次变换矩阵、所述第一运动后齐次变换矩阵及所述第二运动后齐次变换矩阵代入到所述位姿关系标定模型中，构建形成关于所述附加轴基座坐标系与所述机器人基座坐标系之间的目标齐次变换矩阵的待求解方程；将所有位姿变化运动各自对应的待求解方程集成为目标方程组进行非线性优化求解，并将求解得到的目标齐次变换矩阵作为所述位姿关系变换矩阵。
10.在可选的实施方式中，所述位姿关系标定模型采用如下式子进行表达：；
其中，用于表示与第i次位姿变化运动对应的机器人末端坐标系t和机器人基座坐标系b之间的第一运动前齐次变换矩阵，用于表示与第i次位姿变化运动对应的机器人末端坐标系t和机器人基座坐标系b之间的第一运动后齐次变换矩阵，用于表示与第i次位姿变化运动对应的输出末端坐标系c与附加轴基座坐标系d之间的第二运动前齐次变换矩阵，用于表示与第i次位姿变化运动对应的输出末端坐标系c与附加轴基座坐标系d之间的第二运动后齐次变换矩阵，用于表示附加轴基座坐标系d与机器人基座坐标系b之间的目标齐次变换矩阵，其中所述目标齐次变换矩阵为所述目标机器人与所述附加轴系统之间的位姿关系变换矩阵。
11.第二方面，本技术提供一种位姿关系标定装置，所述标定装置包括：运动控制模块，用于控制附加轴系统通过连接装置牵引目标机器人进行多次位姿变化运动，其中所述连接装置用于连接所述目标机器人的机器人末端和所述附加轴系统的输出末端；数据获取模块，用于获取所述附加轴系统与所述目标机器人各自在每次位姿变化运动前后的实际关节位置数据；关系标定模块，用于基于获取到的所述附加轴系统与所述目标机器人各自的实际关节位置数据，调用与所述连接装置对应的位姿关系标定模型进行参数优化求解，得到所述目标机器人与所述附加轴系统之间的位姿关系变换矩阵。
12.在可选的实施方式中，所述位姿关系标定模型采用如下式子进行表达：；其中，用于表示与第i次位姿变化运动对应的机器人末端坐标系t和机器人基座坐标系b之间的第一运动前齐次变换矩阵，用于表示与第i次位姿变化运动对应的机器人末端坐标系t和机器人基座坐标系b之间的第一运动后齐次变换矩阵，用于表示与第i次位姿变化运动对应的输出末端坐标系c与附加轴基座坐标系d之间的第二运动前齐次变换矩阵，用于表示与第i次位姿变化运动对应的输出末端坐标系c与附加轴基座坐标系d之间的第二运动后齐次变换矩阵，用于表示附加轴基座坐标系d与机器人基座坐标系b之间的目标齐次变换矩阵，其中所述目标齐次变换矩阵为所述目标机器人与所述附加轴系统之间的位姿关系变换矩阵。
13.第三方面，本技术提供一种计算机设备，包括处理器和存储器，所述存储器存储有能够被所述处理器执行的计算机程序，所述处理器可执行所述计算机程序，以实现前述实施方式中任意一项所述的位姿关系标定方法。
14.第四方面，本技术提供一种可读存储介质，其上存储有计算机程序，所述计算机程
序被处理器执行时，实现前述实施方式中任意一项所述的位姿关系标定方法。
15.在此情况下，本技术实施例的有益效果可以包括以下内容：本技术通过连接装置连接目标机器人的机器人末端和附加轴系统的输出末端，并控制附加轴系统通过连接装置牵引目标机器人进行多次位姿变化运动，以获取附加轴系统与目标机器人各自在每次位姿变化运动前后的实际关节位置数据，而后直接基于获取到的附加轴系统与目标机器人各自的实际关节位置数据，调用与连接装置对应的位姿关系标定模型进行参数优化求解，得到目标机器人与附加轴系统之间的位姿关系变换矩阵，从而有效避免现有位姿关系标定过程中的繁琐示教操作，并提升位姿关系的标定精准度及标定效率。
16.为使本技术的上述目的、特征和优点能更明显易懂，下文特举较佳实施例，并配合所附附图，作详细说明如下。
附图说明
17.为了更清楚地说明本技术实施例的技术方案，下面将对实施例中所需要使用的附图作简单地介绍，应当理解，以下附图仅示出了本技术的某些实施例，因此不应被看作是对范围的限定，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他相关的附图。
18.图1为本技术实施例提供的计算机设备的组成示意图；图2为本技术实施例提供的目标机器人与附加轴系统的部署示意图；图3为本技术实施例提供的位姿关系标定方法的流程示意图；图4为图3中的步骤s210包括的子步骤的流程示意图；图5为图3中的步骤s230包括的子步骤的流程示意图；图6为改进型d-h参数法的连杆坐标系变换示意图；图7为本技术实施例提供的位姿关系标定装置的组成示意图。
19.图标：10-计算机设备；11-存储器；12-处理器；13-通信单元；100-位姿关系标定装置；20-目标机器人；30-附加轴系统；40-连接装置；110-运动控制模块；120-数据获取模块；130-关系标定模块。
具体实施方式
20.为使本技术实施例的目的、技术方案和优点更加清楚，下面将结合本技术实施例中的附图，对本技术实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例是本技术一部分实施例，而不是全部的实施例。通常在此处附图中描述和示出的本技术实施例的组件可以以各种不同的配置来布置和设计。
21.因此，以下对在附图中提供的本技术的实施例的详细描述并非旨在限制要求保护的本技术的范围，而是仅仅表示本技术的选定实施例。基于本技术中的实施例，本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例，都属于本技术保护的范围。
22.应注意到：相似的标号和字母在下面的附图中表示类似项，因此，一旦某一项在一个附图中被定义，则在随后的附图中不需要对其进行进一步定义和解释。
memory，eeprom）等。其中，所述存储器11用于存储计算机程序，所述处理器12在接收到执行指令后，可相应地执行所述计算机程序。
29.其中，所述存储器11还用于存储基于所述连接装置40针对所述目标机器人20与所述附加轴系统30构建出的位姿关系标定模型，所述位姿关系标定模型用于描述所述目标机器人20的机器人末端坐标系t（即x
t-y
t-z
t
）和机器人基座坐标系b（即x
b-y
b-zb）、所述附加轴系统30的输出末端坐标系c（即x
c-y
c-zc）和附加轴基座坐标系d（即x
d-y
d-zd）在位姿变换过程中的坐标系变换关系。所述计算机设备10在标定所述目标机器人20与所述附加轴系统30之间的位姿关系时，可通过调用上述位姿关系标定模型计算得到所述目标机器人20与所述附加轴系统30之间的位姿关系变换矩阵。
30.在本实施例中，所述处理器12可以是一种具有信号的处理能力的集成电路芯片。所述处理器12可以是通用处理器，包括中央处理器（central processing unit，cpu）、图形处理器（graphics processing unit，gpu）及网络处理器（network processor，np）、数字信号处理器（dsp）、专用集成电路（asic）、现成可编程门阵列（fpga）或者其他可编程逻辑器件、分立门或者晶体管逻辑器件、分立硬件组件中的至少一种。通用处理器可以是微处理器或者该处理器也可以是任何常规的处理器等，可以实现或者执行本技术实施例中的公开的各方法、步骤及逻辑框图。
31.在本实施例中，所述通信单元13用于通过网络建立所述计算机设备10与其他电子设备之间的通信连接，并通过所述网络收发数据，其中所述网络包括有线通信网络及无线通信网络。例如，所述计算机设备10可以通过所述通信单元13分别控制所述目标机器人20和所述附加轴系统30各自的运动状况，并通过所述通信单元13获取所述连接装置40采集到的牵引力数据。
32.在本实施例中，所述位姿关系标定装置100包括至少一个能够以软件或固件的形式存储于所述存储器11中或者存储在所述计算机设备10的操作系统中的软件功能模块。所述处理器12可用于执行所述存储器11存储的可执行模块，例如所述位姿关系标定装置100所包括的软件功能模块及计算机程序等。所述计算机设备10可通过所述位姿关系标定装置100针对目标机器人20与所述附加轴系统30实现位姿关系标定操作，并有效避免现有位姿关系标定过程中的繁琐示教操作，提升位姿关系的标定精准度及标定效率。
33.可以理解的是，图1所示的框图仅为所述计算机设备10的一种组成示意图，所述计算机设备10还可包括比图1中所示更多或者更少的组件，或者具有与图1所示不同的配置。图1中所示的各组件可以采用硬件、软件或其组合实现。
34.在本技术中，为确保所述计算机设备10能够针对目标机器人20与所述附加轴系统30实现位姿关系标定操作，并有效避免现有位姿关系标定过程中的繁琐示教操作，提升位姿关系的标定精准度及标定效率，本技术实施例提供一种位姿关系标定方法实现前述目的。下面对本技术提供的位姿关系标定方法进行详细描述。
35.请参照图3，图3是本技术实施例提供的位姿关系标定方法的流程示意图。在本技术实施例中，所述位姿关系标定方法可以包括步骤s210~步骤s230。
36.步骤s210，控制附加轴系统通过连接装置牵引目标机器人进行多次位姿变化运动。
37.在本实施例中，所述计算机设备10可通过多次控制所述附加轴系统30执行附加轴
运动操作，使所述连接装置40对应检测所述附加轴系统30在对应附加轴运动操作下向所述目标机器人20的机器人末端施加的牵引力数据，由所述计算机设备10根据所述连接装置40检测到的牵引力数据控制所述目标机器人20进行应激式运动，从而确保所述目标机器人20能够跟随所述附加轴系统30执行的附加轴运动操作进行位姿变化运动。
38.可选地，请参照图4，图4是图3中的步骤s210包括的子步骤的流程示意图。在本实施例中，所述步骤s210可以包括子步骤s211~子步骤s215，以确保所述目标机器人20能够有效跟随所述附加轴系统30的运动而运动。
39.子步骤s211，控制所述附加轴系统执行与该位姿变化运动对应的附加轴运动操作。
40.在本实施例中，当所述计算机设备10需要控制所述附加轴系统30带动所述目标机器人20进行位姿变化运动时，会控制所述附加轴系统30执行与该位姿变化运动对应的附加轴运动操作。
41.子步骤s212，获取连接装置检测到的与附加轴运动操作对应的牵引力数据。
42.在本实施例中，因所述连接装置40包括的六维力传感器与所述目标机器人20的机器人末端固定连接，所述连接装置40检测到的牵引力数据可以直接以所述目标机器人20的机器人末端坐标系t为基准进行表示。
43.子步骤s213，根据牵引力数据计算目标机器人的机器人末端在机器人基座坐标系下的期望速度数据。
44.在本实施例中，所述根据牵引力数据计算目标机器人20的机器人末端在机器人基座坐标系下的期望速度数据的步骤，可以包括：调用所述机器人末端在机器人末端坐标系下的末端作用力参数与末端速度参数之间的关联关系，计算所述机器人末端在机器人末端坐标系下的与所述牵引力数据对应的目标速度数据；根据所述目标机器人20的机器人末端坐标系与机器人基座坐标系之间的当前齐次变换矩阵，对所述机器人末端在机器人末端坐标系下的目标速度数据进行数据变换处理，得到所述机器人末端在机器人基座坐标系下的期望速度数据。
45.其中，所述末端作用力参数与末端速度参数之间的关联关系可表示为：末端作用力参数=k*末端速度参数，其中k用于表示力速转换系数；所述目标速度数据包括机器人末端在机器人末端坐标系下的目标移动速度及目标姿态角速度，其中所述牵引力数据可由所述目标速度数据与所述力速转换系数k进行矩阵乘法运算得到；所述期望速度数据包括机器人末端在机器人基座坐标系下的期望移动速度及期望姿态角速度。其中，所述计算机设备10可基于所述目标机器人20的机器人末端坐标系与机器人基座坐标系之间的当前齐次变换矩阵，构建形成一个以对角矩阵形式进行表达的分块矩阵，使该分块矩阵的对角线上的矩阵块即为所述当前齐次变换矩阵，此时所述计算机设备10即可通过将该分块矩阵与所述目标速度数据进行矩阵乘法运算，得到所述机器人末端在机器人基座坐标系下的期望速度数据。
46.子步骤s214，根据机器人末端在机器人基座坐标系下的当前位姿数据及期望速度数据，计算机器人末端在机器人基座坐标系下的与附加轴运动操作匹配的期望位姿数据。
47.在本实施例中，所述期望位姿数据包括机器人末端在机器人基座坐标系下的期望
位置数据及期望姿态角数据，所述当前位姿数据包括机器人末端在机器人基座坐标系下的当前位置数据及当前姿态角数据，此时所述计算机设备10可通过将所述期望速度数据包括的期望移动速度与采样周期进行相乘后和所述当前位置数据进行向量求和运算，得到所述期望位置数据；所述计算机设备10可通过将所述期望速度数据包括的期望姿态角速度与采样周期进行相乘后和所述当前姿态角数据进行矩阵乘法运算，得到所述期望姿态角数据。
48.子步骤s215，按照机器人末端在机器人基座坐标系下的期望位姿数据，基于机器人逆运动学原理控制目标机器人的各机器人关节进行运动，以完成该位姿变化运动。
49.在本实施例中，所述按照所述机器人末端在机器人基座坐标系下的期望位姿数据，基于机器人逆运动学原理控制所述目标机器人20的各机器人关节进行运动的步骤，包括：基于机器人逆运动学原理对所述机器人末端在机器人基座坐标系下的期望位姿数据进行逆运动学求解，得到所述目标机器人20的各机器人关节的期望关节位置；针对所述目标机器人20的每个机器人关节，按照该机器人关节的期望关节位置调整该机器人关节的当前关节位置。
50.其中，每个机器人关节的期望关节位置为该机器人关节在对应关节坐标系下期望到达的关节位置，每个机器人关节的当前关节位置为该机器人关节当前在对应关节坐标系下实际表现出的关节位置。
51.由此，本技术可通过执行上述子步骤s211~子步骤s215，确保所述目标机器人20能够有效跟随所述附加轴系统30的运动而运动。
52.步骤s220，获取附加轴系统与目标机器人各自在每次位姿变化运动前后的实际关节位置数据。
53.在本实施例中，所述附加轴系统30在每次位姿变化运动前后的实际关节位置数据包括该附加轴系统30的各附加轴关节分别在对应关节坐标系下下于对应位姿变化运动前后的实际关节位置，所述目标机器人20在每次位姿变化运动前后的实际关节位置数据包括该目标机器人20的各机器人关节分别在对应关节坐标系下于对应位姿变化运动前后的实际关节位置。
54.步骤s230，基于获取到的附加轴系统与目标机器人各自的实际关节位置数据，调用与连接装置对应的位姿关系标定模型进行参数优化求解，得到目标机器人与附加轴系统之间的位姿关系变换矩阵。
55.在本实施例中，对于由附加轴系统30、目标机器人20及连接装置40构建形成的运动关联系统来说，所述目标机器人20的机器人末端坐标系t和机器人基座坐标系b、所述附加轴系统30的输出末端坐标系c和附加轴基座坐标系d之间的变换关联关系采用如下式子进行表达：；其中，用于表示机器人末端坐标系t和机器人基座坐标系b之间的齐次变换矩阵，用于表示附加轴基座坐标系d与机器人基座坐标系b之间的齐次变换矩阵，用
于表示输出末端坐标系c与附加轴基座坐标系d之间的齐次变换矩阵，用于表示机器人末端坐标系t与输出末端坐标系c之间的齐次变换矩阵；其中与上述连接装置40实质匹配，其实质为一个常数量，上述变换关联关系中的在不同运动时刻下的具体内容保持一致。
56.由此，所述计算机设备10可通过对上述变换关联关系表达式进行变形，以消去机器人末端坐标系t与输出末端坐标系c之间的齐次变换矩阵，使变形后的关系表达式能够与附加轴系统30和目标机器人20各自的位姿变化状况相互匹配，此时变形后的关系表达式即为与所述连接装置40对应的位姿关系标定模型。在此情况下，所述位姿关系标定模型可采用如下式子进行表达：；其中，用于表示与第i次位姿变化运动对应的机器人末端坐标系t和机器人基座坐标系b之间的第一运动前齐次变换矩阵，用于表示与第i次位姿变化运动对应的机器人末端坐标系t和机器人基座坐标系b之间的第一运动后齐次变换矩阵，用于表示与第i次位姿变化运动对应的输出末端坐标系c与附加轴基座坐标系d之间的第二运动前齐次变换矩阵，用于表示与第i次位姿变化运动对应的输出末端坐标系c与附加轴基座坐标系d之间的第二运动后齐次变换矩阵，用于表示附加轴基座坐标系d与机器人基座坐标系b之间的目标齐次变换矩阵，其中所述目标齐次变换矩阵为所述目标机器人与所述附加轴系统之间的位姿关系变换矩阵。
57.由此，所述计算机设备10可基于获取到的附加轴系统30与目标机器人20各自的实际关节位置数据，调用上述位姿关系标定模型针对附加轴基座坐标系d与机器人基座坐标系b之间的目标齐次变换矩阵进行参数优化求解，以有效标定目标机器人20与附加轴系统30之间的位姿关系变换矩阵，避免现有位姿关系标定过程中的繁琐示教操作，并提升位姿关系的标定精准度及标定效率。
58.可选地，请参照图5，图5是图3中的步骤s230包括的子步骤的流程示意图。在本实施例中，所述步骤s230可以包括子步骤s231~子步骤s234，以有效调用位姿关系标定模型求解得到目标机器人20与附加轴系统30之间的位姿关系变换矩阵。
59.子步骤s231，针对每次位姿变化运动，根据目标机器人在该位姿变化运动前后的实际关节位置数据，基于机器人正向运动学原理计算得到目标机器人的机器人末端坐标系与机器人基座坐标系之间的第一运动前齐次变换矩阵及第一运动后齐次变换矩阵。
60.在本实施例中，针对每次位姿变化运动，所述计算机设备10可基于所述目标机器人20的各机器人关节在该位姿变化运动前的实际关节位置数据，利用机器人正向运动学原理计算得到所述目标机器人20的机器人末端在机器人末端坐标系下于该位姿变化运动前的实际末端位姿，以及所述机器人末端在机器人基座坐标系下于该位姿变化运动前的实际
末端位姿，而后计算该位姿变化运动前的所述机器人末端坐标系所对应的实际末端位姿与所述机器人基座坐标系所对应的实际末端位姿之间的位姿变换关系矩阵，得到与该位姿变化运动相关的机器人末端坐标系和机器人基座坐标系之间的第一运动前齐次变换矩阵。
61.针对每次位姿变化运动，所述计算机设备10可基于所述目标机器人20的各机器人关节在该位姿变化运动后的实际关节位置数据，利用机器人正向运动学原理计算得到所述目标机器人20的机器人末端在机器人末端坐标系下于该位姿变化运动后的实际末端位姿，以及所述机器人末端在机器人基座坐标系下于该位姿变化运动后的实际末端位姿，而后计算该位姿变化运动后的所述机器人末端坐标系所对应的实际末端位姿与所述机器人基座坐标系所对应的实际末端位姿之间的位姿变换关系矩阵，得到与该位姿变化运动相关的机器人末端坐标系和机器人基座坐标系之间的第一运动后齐次变换矩阵。
62.子步骤s232，针对每次位姿变化运动，根据附加轴系统在该位姿变化运动前后的实际关节位置数据，基于改进型d-h参数法计算得到附加轴系统的输出末端坐标系与附加轴基座坐标系之间的第二运动前齐次变换矩阵及第二运动后齐次变换矩阵。
63.在本实施例中，请参照图6所示的改进型d-h参数法的连杆坐标系变换示意图，所述改进型d-h参数法在应用到所述附加轴系统30时，可通过查找该附加轴系统30下各个关节轴，并标出各个关节轴的轴延长线，确定出相邻两个关节轴的表征连杆的公垂线（例如，关节轴i-1和关节轴i之间的公垂线a
i-1
），以及相邻两个关节轴的交点，此时可采用这两个关节轴的公垂线与前一个关节轴之间的交点作为前一个关节轴的连杆坐标系的原点（例如，关节轴i-1和关节轴i之间的公垂线a
i-1
与关节轴i-1之间的交点，即为关节轴i-1的连杆坐标系的原点），此时前一个关节轴的连杆坐标系的z轴方向（即z
i-1
）与前一个关节轴（即轴i-1）的轴线延伸方向保持一致，前一个关节轴的连杆坐标系的x轴方向（即x
i-1
）与前述公垂线指向保持一致，基于右手原则确定出前一个关节轴的连杆坐标系的y轴方向（即y
i-1
）。
64.此时，公垂线a
i-1
的具体数值即为沿x
i-1
方向将z
i-1
移动到zi的距离，旋转角α
i-1
的具体角度值为绕x
i-1
将z
i-1
旋转到zi的角度，距离di的具体数值即为沿zi方向将x
i-1
移动到xi的距离，旋转角θi的具体角度值为绕zi将x
i-1
旋转到xi的角度。
65.由此，所述改进型d-h参数法可基于上述两组距离及两组角度表征相邻两个关节轴的连杆坐标系之间的坐标系变换关系，进而所述计算机设备10可利用所述改进型d-h参数法有效求解出所述附加轴系统30的输出末端坐标系与附加轴基座坐标系之间的齐次变换矩阵。
66.进一步地，针对每次位姿变化运动，所述计算机设备10可基于所述附加轴系统30的各附加轴关节在该位姿变化运动前的实际关节位置数据，利用改进型d-h参数法计算得到所述附加轴系统30的相邻两个附加轴关节之间的连杆坐标系变换矩阵，而后利用运动传递特性对求解得到的所有连杆坐标系变换矩阵进行矩阵乘法运算，得到所述附加轴系统30的输出末端坐标系与附加轴基座坐标系之间的第二运动前齐次变换矩阵。
67.针对每次位姿变化运动，所述计算机设备10可基于所述附加轴系统30的各附加轴关节在该位姿变化运动后的实际关节位置数据，利用改进型d-h参数法计算得到所述附加轴系统30的相邻两个附加轴关节之间的连杆坐标系变换矩阵，而后利用运动传递特性对求解得到的所有连杆坐标系变换矩阵进行矩阵乘法运算，得到所述附加轴系统30的输出末端坐标系与附加轴基座坐标系之间的第二运动后齐次变换矩阵。
68.子步骤s233，针对每次位姿变化运动，将与该位姿变化运动对应的第一运动前齐次变换矩阵、第二运动前齐次变换矩阵、第一运动后齐次变换矩阵及第二运动后齐次变换矩阵代入到位姿关系标定模型中，构建形成关于附加轴基座坐标系与机器人基座坐标系之间的目标齐次变换矩阵的待求解方程。
69.子步骤s234，将所有位姿变化运动各自对应的待求解方程集成为目标方程组进行非线性优化求解，并将求解得到的目标齐次变换矩阵作为所述位姿关系变换矩阵。
70.在本实施例中，所述附加轴基座坐标系与机器人基座坐标系之间的目标齐次变换矩阵可采用如下表达式进行表达：；其中，α、β、γ、x、y、z分别为用于描述目标齐次变换矩阵的矩阵参数分量。
71.所述计算机设备10在针对每次位姿变化运动构建出关于目标齐次变换矩阵的待求解方程后，可从每次位姿变化运动所对应的待求解方程中抽取出与上述六个矩阵参数分量α、β、γ、x、y、z相关的部分矩阵元素的方程分量，再将抽取出的所有方程分量集合形成一个非线性方程组，而后通过非线性优化方法求解出该非线性方程组所对应的六个矩阵参数分量α、β、γ、x、y、z，进而直接得到具体的位姿关系变换矩阵。
72.以位姿变化运动的运动总次数为3为例，所述计算机设备10可从第一次位姿变化运动所对应的待求解方程中抽取与上述目标齐次变换矩阵表达式的矩阵元素（1，1）、（1，2）、（1，3）、（1，4）、（2，4）及（3，4）分别对应的方程分量，从第二次位姿变化运动所对应的待求解方程中抽取与上述目标齐次变换矩阵表达式的矩阵元素（2，1）、（2，2）、（2，3）、（1，4）、（2，4）及（3，4）分别对应的方程分量，然后从第三次位姿变化运动所对应的待求解方程中抽取与上述目标齐次变换矩阵表达式的矩阵元素（1，1）、（2，2）、（3，3）、（1，4）、（2，4）及（3，4）分别对应的方程分量，而后将抽取出的所有方程分量组合形成一个非线性方程组进行参数优化求解，得到最终的六个矩阵参数分量α、β、γ、x、y、z，进而直接得到具体的位姿关系变换矩阵。
73.由此，本技术可通过执行上述子步骤s231~子步骤s234，有效调用位姿关系标定模型求解得到目标机器人20与附加轴系统30之间的位姿关系变换矩阵。
74.本技术可通过执行上述步骤s210~步骤s230，针对目标机器人20与所述附加轴系统30实现位姿关系标定操作，并有效避免现有位姿关系标定过程中的繁琐示教操作，提升位姿关系的标定精准度及标定效率。
75.在本技术中，为确保所述计算机设备10能够通过所述位姿关系标定装置100执行上述位姿关系标定方法，本技术通过对所述位姿关系标定装置100进行功能模块划分的方式实现前述功能。下面对本技术提供的位姿关系标定装置100的具体组成进行相应描述。
76.请参照图7，图7是本技术实施例提供的位姿关系标定装置100的组成示意图。在本技术实施例中，所述位姿关系标定装置100可以包括运动控制模块110、数据获取模块120及关系标定模块130。
77.运动控制模块110，用于控制附加轴系统通过连接装置牵引目标机器人进行多次位姿变化运动，其中连接装置用于连接目标机器人的机器人末端和附加轴系统的输出末端。
78.数据获取模块120，用于获取附加轴系统与目标机器人各自在每次位姿变化运动前后的实际关节位置数据。
79.关系标定模块130，用于基于获取到的附加轴系统与目标机器人各自的实际关节位置数据，调用与连接装置对应的位姿关系标定模型进行参数优化求解，得到目标机器人与附加轴系统之间的位姿关系变换矩阵。
80.其中，所述位姿关系标定模型采用如下式子进行表达：；其中，用于表示与第i次位姿变化运动对应的机器人末端坐标系t和机器人基座坐标系b之间的第一运动前齐次变换矩阵，用于表示与第i次位姿变化运动对应的机器人末端坐标系t和机器人基座坐标系b之间的第一运动后齐次变换矩阵，用于表示与第i次位姿变化运动对应的输出末端坐标系c与附加轴基座坐标系d之间的第二运动前齐次变换矩阵，用于表示与第i次位姿变化运动对应的输出末端坐标系c与附加轴基座坐标系d之间的第二运动后齐次变换矩阵，用于表示附加轴基座坐标系d与机器人基座坐标系b之间的目标齐次变换矩阵，其中所述目标齐次变换矩阵为所述目标机器人20与所述附加轴系统30之间的位姿关系变换矩阵。
81.需要说明的是，本技术实施例所提供的位姿关系标定装置100，其基本原理及产生的技术效果与前述的位姿关系标定方法相同。为简要描述，本实施例部分未提及之处，可参考上述的针对位姿关系标定方法的描述内容。
82.在本技术所提供的实施例中，应该理解到，所揭露的装置和方法，也可以通过其它的方式实现。以上所描述的装置实施例仅仅是示意性的，例如，附图中的流程图和框图显示了根据本技术的实施例的装置、方法和计算机程序产品的可能实现的体系架构、功能和操作。在这点上，流程图或框图中的每个方框可以代表一个模块、程序段或代码的一部分，所述模块、程序段或代码的一部分包含一个或多个用于实现规定的逻辑功能的可执行指令。也应当注意，在有些作为替换的实现方式中，方框中所标注的功能也可以以不同于附图中所标注的顺序发生。例如，两个连续的方框实际上可以基本并行地执行，它们有时也可以按相反的顺序执行，这依所涉及的功能而定。也要注意的是，框图和/或流程图中的每个方框、以及框图和/或流程图中的方框的组合，可以用执行规定的功能或动作的专用的基于硬件的系统来实现，或者可以用专用硬件与计算机指令的组合来实现。
83.另外，在本技术各个实施例中的各功能模块可以集成在一起形成一个独立的部分，也可以是各个模块单独存在，也可以两个或两个以上模块集成形成一个独立的部分。所述功能如果以软件功能模块的形式实现并作为独立的产品销售或使用时，可以存储在一个可读存储介质中。基于这样的理解，本技术的技术方案本质上或者说对现有技术做出贡献
的部分或者该技术方案的部分可以以软件产品的形式体现出来，该计算机软件产品存储在一个可读存储介质中，包括若干指令用以使得一台计算机设备（可以是个人计算机，服务器，或者网络设备等）执行本技术各个实施例所述方法的全部或部分步骤。而前述的可读存储介质包括：u盘、移动硬盘、只读存储器（rom，read-only memory）、随机存取存储器（ram，random access memory）、磁碟或者光盘等各种可以存储程序代码的介质。
84.综上所述，在本技术提供的位姿关系标定方法及装置、计算机设备和可读存储介质中，本技术通过连接装置连接目标机器人的机器人末端和附加轴系统的输出末端，并控制附加轴系统通过连接装置牵引目标机器人进行多次位姿变化运动，以获取附加轴系统与目标机器人各自在每次位姿变化运动前后的实际关节位置数据，而后直接基于获取到的附加轴系统与目标机器人各自的实际关节位置数据，调用与连接装置对应的位姿关系标定模型进行参数优化求解，得到目标机器人与附加轴系统之间的位姿关系变换矩阵，从而有效避免现有位姿关系标定过程中的繁琐示教操作，并提升位姿关系的标定精准度及标定效率。
85.以上所述，仅为本技术的各种实施方式，但本技术的保护范围并不局限于此，任何熟悉本技术领域的技术人员在本技术揭露的技术范围内，可轻易想到变化或替换，都应涵盖在本技术的保护范围之内。因此，本技术的保护范围应当以权利要求的保护范围为准。