[发明专利]任务执行控制方法、装置、控制设备及可读存储介质

说明书

本申请提供一种任务执行控制方法、装置、控制设备及可读存储介质，涉及机器人控制技术领域。本申请基于获取到的机器人当前的运动状态信息以及与目标任务对应的期望运动轨迹信息，确定机器人执行目标任务时的任务执行系数矩阵及动力学约束条件，并根据运动状态信息及机体动作安全约束条件构建参数分布约束条件，接着使用任务执行系数矩阵求解任务执行损失函数，得到满足动力学约束条件以及参数分布约束条件的目标驱动参数，最后基于目标驱动参数将机器人实时状态结合到机器人运动状况的控制过程中，确保机器人实现预期运动效果，并同步地确保机器人的机体动作符合机器人运动规律且处于安全运动范围内，提升机器人运行安全性。

技术领域

本申请涉及机器人控制技术领域，具体而言，涉及一种任务执行控制方法、装置、控制设备及可读存储介质。

背景技术

随着科学技术的不断发展，机器人技术因具有极大的研究价值及应用价值受到了各行各业的广泛重视，而在机器人技术的实际应用过程中，通常需要确保机器人的机体结构在运动过程中不产生奇异，或将机器人的机体动作限定在特定的运动范围内，以避免机器人与外界事物发生碰撞，保证机器人得以安全运行。

发明内容

有鉴于此，本申请的目的在于提供一种任务执行控制方法、装置、控制设备及可读存储介质，能够将机器人实时状态结合到机器人运动状况的控制过程中，确保机器人实现预期运动效果，并确保机器人的机体动作符合机器人运动规律且处于安全运动范围内，提升机器人运行安全性。

为了实现上述目的，本申请实施例采用的技术方案如下：

第一方面，本申请提供一种任务执行控制方法，所述方法包括：

获取机器人当前的运动状态信息以及与目标任务对应的期望运动轨迹信息；

根据所述期望运动轨迹信息以及所述运动状态信息，确定所述机器人执行所述目标任务所对应的任务执行系数矩阵；

根据所述期望运动轨迹信息以及所述运动状态信息，针对所述机器人的任务驱动参数构建匹配的动力学约束条件；

根据所述运动状态信息以及与所述目标任务对应的机体动作安全约束条件，针对所述任务驱动参数构建匹配的参数分布约束条件；

采用所述任务执行系数矩阵求解预存的任务执行损失函数，得到满足所述动力学约束条件以及所述参数分布约束条件的目标驱动参数；

按照所述目标驱动参数对所述机器人各关节端执行器的运行状态进行控制，使所述机器人对应执行所述目标任务。

在可选的实施方式中，所述目标任务包括至少一项待执行任务，所述任务执行系数矩阵包括第一任务系数矩阵及第二任务系数矩阵，所述根据所述期望运动轨迹信息以及所述运动状态信息，确定所述机器人执行所述目标任务所对应的任务执行系数矩阵，包括：

针对每个待执行任务，从所述期望运动轨迹信息中获取与所述待执行任务对应的末端雅可比矩阵，并基于获取到的所述末端雅可比矩阵构建所述待执行任务的第一执行系数子矩阵；

从所述运动状态信息中获取所述机器人的广义速度，从所述期望运动轨迹信息中获取与所述待执行任务对应的期望末端加速度，并根据所述广义速度、所述末端雅可比矩阵以及所述期望末端加速度构建所述待执行任务的第二执行系数子矩阵；

根据所述目标任务中每个待执行任务的执行权重，将同一待执行任务的第一执行系数子矩阵与第二执行系数子矩阵分别与该待执行任务的执行权重进行加权运算，得到该待执行任务的第一加权参数子矩阵及第二加权参数子矩阵；

将所述目标任务下所有待执行任务各自的第一加权参数子矩阵进行矩阵聚合，得到所述目标任务的第一任务系数矩阵，并将所述目标任务下所有待执行任务各自的第二加权参数子矩阵进行矩阵聚合，得到所述目标任务的第二任务系数矩阵。