1.一种机械臂路径规划方法,其特征在于,所述方法包括:获取机械臂各设定关键点的原始周围区域信息;所述原始周围区域信息包括:传感器获得的所述机械臂周围的信息;
利用卷积神经网络对所述原始周围区域信息进行特征提取,得到各设定关键点特征提取后的位置特征向量;所述位置特征向量包括:周围人或物体的位置特征;
计算所述各设定关键点的位置特征向量之间的协方差,得到协方差矩阵;
利用所述协方差矩阵为每个所述设定关键点创建三维可视化仿真特征;
利用每个所述设定关键点的三维可视化仿真特征在具有机械臂的虚拟环境中对所述周围人或物体建模;
在所述虚拟环境中利用人工势场法,设定机械臂应激行为参数;所述机械臂应激参数中目标任务对所述机械臂产生吸引力,人或物体对所述机械臂产生排斥力;
判断所述机械臂是否遇到人或物体;若遇到人或物体则根据所述机械臂应激行为参数执行机械臂应激行为,若没有遇到人或物体则不执行机械臂应激行为。
2.根据权利要求1所述的机械臂路径规划方法,其特征在于,所述利用卷积神经网络对所述原始周围区域信息进行特征提取,得到各设定关键点特征提取后的位置特征向量,具体包括:
基于输入的所述原始周围区域信息的数量及卷积神经网络的内属性计算输出特征数量: ;其中,Nin表示特征的大小,p是根据人为输入的填充大小,k表示系统的内核大小,s表示人为输入的卷积运算次数;
计算输出特征中心位置: ;其中,startin表示人为输入的特征区域的中心位置,jin表示人为输入的跳跃;
根据各个输出特征中心位置得到各设定关键点特征提取后的位置特征向量。
3.根据权利要求1所述的机械臂路径规划方法,其特征在于,所述利用每个所述设定关键点的三维可视化仿真特征在具有机械臂的虚拟环境中对所述周围人或物体建模,具体包括:
根据每个所述设定关键点的三维可视化仿真特征在具有机械臂的虚拟环境中对所述周围人或物体进行D‑H建模,利用MATLAB工具箱仿真和验证所述机械臂的位姿和关节角,并基于数字孪生进行三维可视化显示。
4.根据权利要求1所述的机械臂路径规划方法,其特征在于,所述在所述虚拟环境中利用人工势场法,设定机械臂应激行为参数,具体包括:设定机械臂上设定关键点和人或物体的位置特征点产生的引力势函数:;其中,Uatt(q)表示引力势函数, 表示引力增益,d表示机械臂上设定关键点与人或物体的位置特征点的距离,qgoal表示躲避人或物体时要移动的最终目标点,q代表机械臂上的设定关键点;
设定机械臂上设定关键点和人或物体的位置特征点产生的斥力势函数:;其中,D(q)表示与q最近障碍区域的距离,η表示斥力增益,Q*表示障碍区域的作用距离阈值;
设定所述虚拟环境中人或物体的位置特征的势函数: ;其中,U(q)表示势函数,Uatt(q)表示引力势函数,Urep(q)表示斥力势函数。
5.根据权利要求1所述的机械臂路径规划方法,其特征在于,所述判断所述机械臂是否遇到人或物体,具体包括:
在设定的范围内有人或物体出现,即判断所述机械臂遇到人或物体,否则即判断所述机械臂没有遇到人或物体。
6.根据权利要求1所述的机械臂路径规划方法,其特征在于,所述若遇到人或物体则执行所述机械臂应激行为,若没有遇到人或物体则不执行所述机械臂应激行为,具体包括:若所述机械臂遇到人或物体,则判断所述机械臂的各设定关键点是否遇到人或物体的特征区域;若是,则使所述设定关键点沿着所述人工势场法的斥力场等势线运动,继续绕行行为;若否,则使所述设定关键点沿着所述吸引力与所述排斥力的合力方向运动,继续绕行行为;
若所述机械臂没有遇到人或物体,则判断所述机械臂的各设定关键点是否遇到人或物体的特征区域;若是,则使所述设定关键点沿着所述人工势场法的斥力场等势线运动,开始绕行行为;若否,则使所述设定关键点沿着所述吸引力与所述排斥力的合力方向运动。
7.根据权利要求6所述的机械臂路径规划方法,其特征在于,所述判断所述机械臂的各设定关键点是否遇到人或物体的特征区域,具体包括:当 ,或者 时,判定机械臂设定关键点遇到人或物体;其中,所述fatt表示机械臂上设定关键点和人或物体的位置特征点产生的引力,frep,j表示机械臂上设定关键点和人或物体的位置特征点产生的总斥力,n代表总共有多少个斥力,j表示第j个斥力, 表示极小正数,x表示人或物体的位置,xA表示机械臂设定关键点运动中的某一状态,sA表示从xA到x的总路程, 为0到1之间某一正数。
8.一种机械臂路径规划系统,其特征在于,所述系统包括:周围信息获取模块,用于获取机械臂各设定关键点的原始周围区域信息;所述原始周围区域信息包括:传感器获得的所述机械臂周围的信息;
特征提取模块,用于利用卷积神经网络对所述原始周围区域信息进行特征提取,得到各设定关键点特征提取后的位置特征向量;所述位置特征向量包括:周围人或物体的位置特征;
协方差计算模块,用于计算所述各设定关键点的位置特征向量之间的协方差,得到协方差矩阵;
三维特征构建模块,用于利用所述协方差矩阵为每个所述设定关键点创建三维可视化仿真特征;
建模模块,用于利用每个所述设定关键点的三维可视化仿真特征在具有机械臂的虚拟环境中对所述周围人或物体建模;
应激行为参数设定模块,用于在所述虚拟环境中利用人工势场法,设定机械臂应激行为参数;所述机械臂应激参数中目标任务对所述机械臂产生吸引力,人或物体对所述机械臂产生排斥力;
应激行为判断模块,用于判断所述机械臂是否遇到人或物体;若遇到人或物体则根据所述机械臂应激行为参数执行机械臂应激行为,若没有遇到人或物体则不执行机械臂应激行为。
9.根据权利要求8所述的机械臂路径规划系统,其特征在于,所述应激行为参数设定模块,具体用于:
设定机械臂上设定关键点和人或物体的位置特征点产生的引力势函数:;其中,Uatt(q)表示引力势函数, 表示引力增益,d表示机械臂上设定关键点与人或物体的位置特征点的距离,qgoal表示躲避人或物体时要移动的最终目标点,q代表机械臂上的设定关键点;
设定机械臂上设定关键点和人或物体的位置特征点产生的斥力势函数:;其中,D(q)表示与q最近障碍区域的距离,η表示斥力增益,Q*表示障碍区域的作用距离阈值;
设定所述虚拟环境中人或物体的位置特征的势函数: ;其中,U(q)表示势函数,Uatt(q)表示引力势函数,Urep(q)表示斥力势函数。
10.根据权利要求8所述的机械臂路径规划系统,其特征在于,所述应激行为判断模块,具体用于:
若所述机械臂遇到人或物体,则判断所述机械臂的各设定关键点是否遇到人或物体的特征区域;若是,则使所述设定关键点沿着所述人工势场法的斥力场等势线运动,继续绕行行为;若否,则使所述设定关键点沿着所述吸引力与所述排斥力的合力方向运动,继续绕行行为;
若所述机械臂没有遇到人或物体,则判断所述机械臂的各设定关键点是否遇到人或物体的特征区域;若是,则使所述设定关键点沿着所述人工势场法的斥力场等势线运动,开始绕行行为;若否,则使所述设定关键点沿着所述吸引力与所述排斥力的合力方向运动。