[发明专利]采用快速双幂次终态神经网络的冗余机器人重复运动规划方法有效
申请号: | 201811078759.6 | 申请日: | 2018-09-17 |
公开(公告)号: | CN109159124B | 公开(公告)日: | 2021-02-26 |
发明(设计)人: | 孙明轩;张钰;李杏 | 申请(专利权)人: | 浙江工业大学 |
主分类号: | B25J9/16 | 分类号: | B25J9/16 |
代理公司: | 杭州斯可睿专利事务所有限公司 33241 | 代理人: | 王利强 |
地址: | 310014 浙江省杭*** | 国省代码: | 浙江;33 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 采用 快速 双幂次终态 神经网络 冗余 机器人 重复 运动 规划 方法 | ||
1.一种采用快速双幂次终态神经网络的冗余机器人重复运动规划方法,其特征在于,所述方法包括以下步骤:
1)在笛卡尔空间中给定冗余机器人末端执行器的期望轨迹rd,并给出各个关节的期望关节角度θd(0);
2)对于重复运动的冗余机器人,其初始关节角度为θ(0)=θ0,初始关节角度θ0不同于期望关节角度,即θ0≠θd(0);
3)将冗余机器人重复运动规划描述为二次规划问题,给出渐近收敛性能指标,形成重复运动规划方案:
其中,
g(θ)=-ρ0(θ(t)-θd(0))
ρ00,θ(t)-θd(0)表示关节角度θ(t)与期望关节角度的偏差,由于冗余机器人初始位置不在期望轨迹上,因此冗余机器人末端执行器速度与关节速度的关系式的右边需要加上一个反馈偏差量,即rd-f(θ),该偏差量表示期望轨迹与实际轨迹之间存在的误差;由于人为构造的收敛关系,这个误差会不断地缩小,直至为零;参数β用来调节冗余机器人末端执行器运动到期望轨迹的速率,β0;J(θ)是根据冗余机器人DH参数求出来的雅克比矩阵,f(θ)是冗余机器人末端执行器实际轨迹;
4)构建如下基于快速双幂次终态神经网络的动态特性方程
其中,E(t)为误差矩阵变量,Eij(t)为矩阵E(t)的元素,ρ>0,κ1>0,κ2>0,α=q1/p1,β=p2/q2,q1>p1,q2>p2,且q1,p1,q2,p2都是正奇数;
式(5)是有限时间稳定的,其有限收敛时间不能直接求解,只能近似求得:
当|Eij(0)|≥1,
当|Eij(0)|<1,
综合式(6)、式(7),得
当ρ=0,式(5)变为不带加速项的双幂次终态网络特性方程
式(9)也是有限时间稳定的,其有限收敛时间不能直接求解,只能近似求得:
当|Eij(0)|≥1,
当|Eij(0)|<1,
综合式(10)、式(11),得
5)定义拉格朗日函数
其中,λ为拉格朗日乘子向量,关于和λ分别求偏导,并令其为零,经整理得
W(t)Y(t)=v (14)
其中,
I为单位矩阵;
6)为求解步骤3)中的二次规划问题,由式(14)定义误差
E(t)=W(t)Y(t)-v (15)
根据快速双幂次终态神经网络动态特性方程式(5),给出快速双幂次终态神经网络方程
通过神经网络计算过程,得到冗余机器人各个关节角度。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于浙江工业大学,未经浙江工业大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201811078759.6/1.html,转载请声明来源钻瓜专利网。