[发明专利]一种高自由度机器人逆运动学的快速求解方法及系统

说明书

本发明提出一种高自由度机器人逆运动学的快速求解方法及系统，该方法包括步骤1，将关节变量θ带入机器人运动学方程中，获得雅克比矩阵J，将所述雅克比矩阵J进行转置，获得雅克比转置矩阵J^T；步骤2，生成一组投机值，为每个投机值计算相应的关节变量更新值，将每个关节变量更新值带入机器人正运动学方程中，获得相应的位姿P_k，为每个位姿P_k计算其与目标位姿P的位姿偏差Δe_k，及位姿偏差Δe_k的模error_k；步骤3，在模error_k的集合中选取最小值error_min，及其对应的位姿偏差Δe_min与关节变量更新值Δθ_min，并更新位姿偏差为Δe＝Δe_min，更新关节变量θ＝θ+Δθ_min；步骤4，判断error_min是否满足error_min<Threshold，如果是，则输出关节变量θ并结束，否则，返至所述步骤1，继续执行。

技术领域

本发明涉及机器人控制技术领域，特别涉及一种高自由度机器人逆运动学的快速求解方法及系统。

背景技术

机器人技术不仅可以应用于工业生产，而且可以服务于民众生活，是一项很有应用前景的技术。机器人一般是由很多关节组成，通过控制每个关节变量，达到位姿变化的功能，例如移动、行走和抓取等等。在机器人学中，每个关节各提供一个自由度。通常来讲，机器人的自由度越多(关节越多)，机器人功能就越强大，移动就越灵活。机器人运动学是机器人运动控制的基础，包含正运动学和逆运动学。正运动学，即给定每个关节变量θ，求解机器人的位姿P；逆运动学，即给定机器人的位姿P，求解机器人各个关节的关节变量θ，如图1所示。正运动学可以通过运动学方程求解，求解过程相对简单，相反，逆运动学求解复杂、耗时，对于高自由度机器人情况更糟。目前，机器人逆运动学求解主要采用：解析法、数值法和机器学习法。

解析法，通过构建逆运动学方程，可以很容易求解逆运动学问题。但是，对于任意机器人来讲，构建逆运动学方程非常复杂，并且很多情况是不存在逆运动学方程的。因此，解析法只能应用特定的机器人或机械臂中，并且机器人或机械臂的自由度只能很少。

数值法，一般需要通过多次迭代，寻找一个满足一定精度要求的近似解。其中，运用最多的是基于雅克比的方法，相比其他数值方法，该方法更加精确、稳定。基于雅克比的求解方法又包含两类：雅克比伪逆法和雅克比转置法。雅克比伪逆法收敛快，但是需要进行奇异值分解运算，复杂耗时，难并行；相反，雅克比转置法需要很多次迭代，但是，每次迭代运算简单，快速。

机器学习法，利用机器学习的方法对逆运动学方程进行近似，从而在有限时间内得到近似解。但是，该方法最大的问题是近似解与精确解的偏差较大，远大于数值法得到的近似解。同时，该方法需要大量数据进行训练。

目前，最常用的逆运动学求解方法是基于雅克比的求解方法，但是对高自由度机器人来讲，现有的基于雅克比的方法非常耗时，不能满足机器人控制的实时性要求，为此，本发明提出一种适用于并行体系结构中执行的快速求解高自由度机器人逆运动学问题的方法。

原始雅克比转置法在每次迭代过程中，首先生成一个参数值α，然后依据该参数更新关节变量θ，见附图2，发明人发现该参考值α的选取对于求解速度有严重影响，为此提出一种并行投机的选取方法。该方法在每次迭代时，生成多个参数值(投机值)α1,α2,...αm，依据这些不同的参数值可以得到多个关节变量更新值，然后从中选出最接近目标解的参数值及关节变量更新值，由于多个参数值的计算及后续的关节变量更新值计算之间没有依赖，可以通过并行结构同时执行，从而加速求解速度。

发明内容

针对现有技术的不足，本发明提出一种高自由度机器人逆运动学的快速求解方法及系统。

本发明提出一种高自由度机器人逆运动学的快速求解方法，包括：