[发明专利]一种冗余度机械臂运动规划的初始化方法

说明书

技术领域

本发明属于一种冗余度机械臂运动规划的初始化方法。

背景技术

冗余度机械臂是一种自由度大于任务空间所需最少自由度的末端能动机械装置，其运动任务包括焊接、油漆、组装、挖掘和绘图等，广泛应用于装备制造、产品加工、机器作业等国民经济生产活动中。冗余度机械臂在空间不同位置执行任务时，当结束一个任务后，往往需要从当前位置移动到下一个任务的执行位置。一般而言，冗余度机械臂从当前位置移动到下一个任务的执行位置，都是通过慢慢移动机械臂并不断调整来实现。然而，这种做法是相当繁琐且存在着不足的：每次改变任务操作位置时都有可能需要多次度量各个关节角以使机械臂准确到达任务执行的位置；并且任务执行位置测量(或调整)的不准确也会影响到机械臂正常完成任务。

发明内容

本发明的目的在于克服一般技术的不足，提供一种计算量小、操作方便、工作量少、作业规范的冗余度机械臂运动规划初始化方法。

为了实现上述发明目的，采用的技术方案如下：

一种冗余度机械臂运动规划的初始化方法，包括如下步骤：

1)启动冗余度机械臂控制器，将冗余度机械臂调节到极限位置；

2)将步骤1)的极限位置作为起始值，并设定机械臂任务执行位置作为终止值，从而把机械臂的控制转化为二次型规划问题；

3)将步骤2)的二次型规划问题利用二次型规划求解器进行求解；

4)将步骤3)的求解结果用于驱动各关节电机使机械臂由极限位置转动到任务执行位置。

上述技术方案中，所述步骤1)将冗余度机械臂调节到极限位置，具体操作是依次驱动各个关节的电机使其最终达到各自的极限位置。

所述步骤2)把机械臂的控制转化为二次型规划问题，其性能指标为约束条件为θ^-≤θ≤θ⁺，其中，为机械臂关节角速度，W为合适维数的单位阵，z＝λ(θ-θ_f)表示关节位移幅值偏差，λ＞0是用来控制关节位移幅值的设计参数，θ_f为任务执行初始位置，θ^±、分别表示机械臂的关节角度极限、关节角速度极限。

所述步骤3)利用二次型规划求解器来求解二次型规划问题，具体是将该二次型规划问题变换为分段线性投影方程，从而构造二次型规划求解器进行求解。

所述二次型规划求解器采用基于线性变分不等式的原对偶神经网络求解器或二次规划数值方法。

所述步骤4)将二次型规划求解器的结果转化为电机驱动所需要的脉冲频率，从而驱动各关节电机使机械臂由极限位置转动到任务执行位置。

本发明能有效克服现有技术的不足，提供一种计算量小、操作方便、工作量少、作业规范的冗余度机械臂运动规划初始化方法。

附图说明

图1为本发明的流程图；

图2为实现本发明的机械臂关节极限状态俯视图；

图3为实现本发明的机械臂关节极限状态主视图；

图4为实现本发明的机械臂任务初始关节位置俯视图；

图5为实现本发明的机械臂任务初始关节位置主视图；

具体实施方式

下面结合附图对本发明做进一步的说明。

图1所示的一种冗余度机械臂运动规划的初始化方法主要由机械臂调节到极限位置1、转为二次型规划问题2、二次规划型求解器3、驱动机械臂转到任务执行位置4组成。

图2、图3、图4和图5所示的冗余度机械臂为一个平面六连杆冗余度机械臂，主要由关节5、关节6、关节7、关节8、关节9和关节10组成。

首先启动冗余度机械臂控制器，将冗余度机械臂调节到极限位置；再将该极限位置作为初始化方法的起始值，并设定机械臂任务执行位置作为初始化方法的终止值，从而把机械臂的控制问题转化为相应的二次型规划问题；然后构造相应的二次型规划求解器将该问题求解；最后把求解结果用于驱动机械臂的各关节电机使其由极限位置转动到任务执行位置。

基于最小化机械臂关节当前位置与任务执行位置之间位移量的思想，机械臂运动规划的初始化方法可设计为：