[发明专利]空间冗余机械臂的运动规划方法与装置

权利要求书

1.一种空间冗余机械臂的运动规划方法，其特征在于，包括：

确定所述空间冗余机械臂的无碰初始关节轨迹；

建立所述空间冗余机械臂的轨迹规划最优控制问题模型，并对所述轨迹规划最优控制问题模型的约束条件进行凸化处理，得到凸化处理后的轨迹规划最优控制问题模型，其中，所述约束条件至少包括：运动学约束、动力学约束、避障约束和末端任务约束；

根据所述无碰初始关节轨迹以及所述凸化处理后的轨迹规划最优控制问题模型，确定所述空间冗余机械臂的最优关节轨迹。

2.根据权利要求1所述的方法，其特征在于，确定所述空间冗余机械臂的无碰初始关节轨迹，包括：

利用基于快速扩展随机树优化算法和三次样条曲线规划所述空间冗余机械臂从起始点到目标点的所述无碰初始关节轨迹。

3.根据权利要求2所述的方法，其特征在于，利用基于快速扩展随机树优化算法和三次样条曲线规划所述空间冗余机械臂从起始点到目标点的所述无碰初始关节轨迹，包括：

利用基于快速扩展随机树优化算法规划所述空间冗余机械臂从所述起始点到所述目标点的无碰路径点；

采用所述三次样条曲线对所述无碰路径点进行插值，得到所述空间冗余机械臂的所述无碰初始关节轨迹。

4.根据权利要求3所述的方法，其特征在于，在采用所述三次样条曲线对所述无碰路径点进行插值，得到所述空间冗余机械臂的所述无碰初始关节轨迹之后，所述方法还包括：

基于机械臂逆动力学确定所述无碰初始关节轨迹对应的关节力矩。

5.根据权利要求1所述的方法，其特征在于，对所述轨迹规划最优控制问题模型的约束条件进行凸化处理，包括：

基于速度阻尼法对所述避障约束的时间区间进行离散化处理，将所述空间冗余机械臂的连杆与障碍物的避障约束处理成关节角速度的线性不等式约束，并设置避障策略；

基于单位四元数对所述空间冗余机械臂的末端手眼相机的视线锥约束进行凸化处理，将所述视线锥约束处理成单位姿态四元数的正定二次型不等式约束；

基于二阶积分器和连续线性化对所述运动学约束、所述动力学约束进行凸化处理，得到凸化处理后的运动学约束与动力学约束。

6.根据权利要求1至5中任意一项所述的方法，其特征在于，根据所述无碰初始关节轨迹以及所述凸化处理后的轨迹规划最优控制问题模型，确定所述空间冗余机械臂的最优关节轨迹，包括：

将所述无碰初始关节轨迹输入所述凸化处理后的轨迹规划最优控制问题模型，由所述凸化处理后的轨迹规划最优控制问题模型输出所述空间冗余机械臂的所述最优关节轨迹。

7.一种空间冗余机械臂的运动规划装置，其特征在于，包括：

第一确定模块，用于确定所述空间冗余机械臂的无碰初始关节轨迹；

处理模块，用于建立所述空间冗余机械臂的轨迹规划最优控制问题模型，并对所述轨迹规划最优控制问题模型的约束条件进行凸化处理，得到凸化处理后的轨迹规划最优控制问题模型，其中，所述约束条件至少包括：运动学约束、动力学约束、避障约束和末端任务约束；

第二确定模块，用于根据所述无碰初始关节轨迹以及所述凸化处理后的轨迹规划最优控制问题模型，确定所述空间冗余机械臂的最优关节轨迹。

8.根据权利要求7所述的装置，其特征在于，所述第一确定模块包括：

规划单元，用于利用基于快速扩展随机树优化算法和三次样条曲线规划所述空间冗余机械臂从起始点到目标点的所述无碰初始关节轨迹。

9.一种计算机可读存储介质，其特征在于，所述计算机可读存储介质包括存储的程序，其中，在所述程序运行时控制所述计算机可读存储介质所在设备执行权利要求1至6中任意一项所述的空间冗余机械臂的运动规划方法。

10.一种处理器，其特征在于，所述处理器用于运行程序，其中，所述程序运行时执行权利要求1至6中任意一项所述的空间冗余机械臂的运动规划方法。