[发明专利]移动机器人及多移动机器人的协调控制方法有效
申请号: | 201210152185.9 | 申请日: | 2012-05-16 |
公开(公告)号: | CN102707719A | 公开(公告)日: | 2012-10-03 |
发明(设计)人: | 孟德元;贾英民 | 申请(专利权)人: | 北京航空航天大学 |
主分类号: | G05D1/02 | 分类号: | G05D1/02;G05B19/418 |
代理公司: | 暂无信息 | 代理人: | 暂无信息 |
地址: | 100191*** | 国省代码: | 北京;11 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 移动 机器人 协调 控制 方法 | ||
1.一种多移动机器人的协调控制方法,其特征在于,包括以下步骤:
A:获取个体移动机器人的当前时刻的位置以及所述个体移动机器人的邻居机器人的当前时刻的位置;
B:判断所述个体移动机器人是否具有预定的期望位置信息,并根据所述判断的结果确定第一参数;
C:根据所述第一参数以及所述多移动机器人的加权邻接矩阵确定所述个体移动机器人的学习参数,其中所述学习参数包括第一学习参数和第二学习参数,且所述第一学习参数和第二学习参数非负且满足预定的权规则条件;以及
D:根据所述个体移动机器人的当前时刻的位置、所述个体移动机器人的邻居机器人的当前时刻的位置、所述第一参数和所述学习参数控制所述个体移动机器人。
2.根据权利要求1所述的多移动机器人的协调控制方法,其特征在于,所述步骤B进一步包括:
如果所述个体移动机器人具有所述预定的期望位置信息,则确定所述第一参数为大于0的数值;
如果所述个体移动机器人不具有所述预定的期望位置信息,则确定所述第一参数为0。
3.根据权利要求1所述的多移动机器人的协调控制方法,其特征在于,所述预定的权规则条件为:
其中,φij为所述第一学习参数,为所述第二学习参数,ωi为所述第一参数,aij为所述多移动机器人的加权邻接矩阵的元素,Ni为所述个体移动机器人i的邻居机器人集合,εi为采样步长。
4.根据权利要求1所述的多移动机器人的协调控制方法,其特征在于,所述步骤D进一步包括:
D1:根据所述个体移动机器人的当前时刻的位置、所述个体移动机器人的邻居机器人的当前时刻的位置、所述第一参数和所述学习参数,通过以下的公式确定个体移动机器人i的控制量:
其中,xi(t)为个体移动机器人i的当前时刻的位置,xj(t)为个体移动机器人i的邻居机器人j的当前时刻的位置,xr为所述预定的期望位置信息,ui(t)为所述个体移动机器人i的控制量;以及
D2:根据所述控制量和所述个体移动机器人当前时刻的位置,通过以下的公式确定所述个体移动机器人的下一时刻的位置:
xi(t+1)=xi(t)+εiui(t),
其中,xi(t+1)为所述个体移动机器人的下一时刻的位置。
5.一种移动机器人,其特征在于,包括:
获取模块,用于获取所述移动机器人的当前时刻的位置以及所述移动机器人的邻居机器人的当前时刻的位置;
第一确定模块,用于判断所述移动机器人是否具有预定的期望位置信息,并根据所述判断的结果确定第一参数;
第二确定模块,用于根据所述第一参数以及所述移动机器人所在的多移动机器人网络的加权邻接矩阵确定所述移动机器人的学习参数,其中所述学习参数包括第一学习参数和第二学习参数,且所述第一学习参数和第二学习参数非负且满足预定的权规则条件;以及
控制模块,用于根据所述移动机器人的当前时刻的位置、所述移动机器人的邻居机器人的当前时刻的位置、所述第一参数和所述学习参数控制所述移动机器人。
6.根据权利要求5所述的移动机器人,其特征在于,
如果所述移动机器人具有所述预定的期望位置信息,则所述第一确定模块确定所述第一参数为大于0的数值;
如果所述移动机器人不具有预定的期望位置信息,则所述第一确定模块确定所述第一参数为0。
7.根据权利要求5所述的移动机器人,其特征在于,所述预定的权规则条件为:
其中,φij为所述第一学习参数,为所述第二学习参数,ωi为所述第一参数,aij为所述多移动机器人网络的加权邻接矩阵的元素,Ni为所述移动机器人i的邻居机器人集合,εi为采样步长。
8.根据权利要求5所述的移动机器人协调控制方法,其特征在于,所述控制模块进一步包括:
控制量确定单元,用于根据所述移动机器人的当前时刻的位置、所述移动机器人的邻居机器人的当前时刻的位置、所述第一参数和所述学习参数,通过以下的公式确定所述移动机器人的控制量:
其中,xi(t)为移动机器人i的当前时刻的位置,xj(t)为移动机器人i的邻居机器人j的当前时刻的位置,xr为所述预定的期望位置信息,ui(t)为所述移动机器人i的控制量;以及
位置确定单元,用于根据所述移动机器人的控制量和所述移动机器人当前时刻的位置,通过以下的公式确定所述移动机器人的下一时刻的位置:
xi(t+1)=xi(t)+εiui(t),
其中,xi(t+1)为所述移动机器人的下一时刻的位置。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于北京航空航天大学,未经北京航空航天大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201210152185.9/1.html,转载请声明来源钻瓜专利网。