一种应用于冗余度机械臂的障碍物躲避解决方法

摘要

本发明公开了一种应用于冗余度机械臂的障碍物躲避解决方法，包括以下步骤：S1、通过建立机械臂的D‑H矩阵获得机械臂的正运动学模型，并对其求导后建立速度层的目标轨迹等式约束指标；S2、建立基于矢量的障碍物躲避不等式约束指标；S3、将步骤S1建立的速度层的目标轨迹等式约束指标和步骤S2建立的基于矢量的障碍物躲避不等式约束指标写为统一形式的二次规划问题；S4、将步骤S3中统一形式的二次规划问题转化为线性变分不等式；S5、使用原对偶神经网络求解器求解步骤S4中的线性变分不等式；S6、将步骤S5中原对偶神经网络求解器求解出来的机械臂关节角控制变量输出到机械臂以实现控制冗余度机械臂障碍物躲避。