发明名称 |
移动机器人系统及其在混合交互环境下的协调控制方法 |
摘要 |
本发明提出一种移动机器人系统及其在混合交互环境下的协调控制方法。方法包括:获取每个个体移动机器人的位置,每个个体移动机器人的邻居机器人的位置以及每个个体移动机器人获取邻居机器人位置时的通信时滞;根据移动机器人系统的混合交互环境确定移动机器人系统的加权邻接矩阵;根据每个个体移动机器人的位置、个体移动机器人的邻居机器人的位置、每个个体移动机器人获取邻居机器人位置时的通信时滞以及移动机器人系统的加权邻接矩阵确定每个个体移动机器人的控制量;以及根据每个个体移动机器人的控制量控制每个个体移动机器人。本发明能够保证存在通信时滞的移动机器人在混合交互环境下达到双向一致性,且控制速度快,控制精确。 |
申请公布号 |
CN103970020B |
申请公布日期 |
2016.08.31 |
申请号 |
CN201410214396.X |
申请日期 |
2014.05.21 |
申请人 |
北京航空航天大学 |
发明人 |
孟德元;贾英民;杜明骏 |
分类号 |
G05B13/04(2006.01)I;G05D1/02(2006.01)I |
主分类号 |
G05B13/04(2006.01)I |
代理机构 |
|
代理人 |
|
主权项 |
一种移动机器人系统在混合交互环境下的协调控制方法,其特征在于,所述移动机器人系统包括多个个体移动机器人,所述方法包括以下步骤:获取每个个体移动机器人的位置,每个所述个体移动机器人的邻居机器人的位置以及每个个体移动机器人获取邻居机器人位置时的通信时滞;根据所述移动机器人系统的混合交互环境确定所述移动机器人系统的加权邻接矩阵;根据每个个体移动机器人的位置、所述个体移动机器人的邻居机器人的位置、每个个体移动机器人获取邻居机器人位置时的通信时滞以及所述移动机器人系统的加权邻接矩阵确定每个个体移动机器人的控制量;以及根据每个个体移动机器人的控制量控制每个个体移动机器人,其中,所述根据所述移动机器人系统的混合交互环境确定所述移动机器人系统的加权邻接矩阵包括:如果第j个个体移动机器人和第i个个体移动机器人沿同一方向运行并且第i个个体移动机器人能够获得第j个个体移动机器人的位置信息,那么加权邻接矩阵的元素a<sub>ij</sub>为1;如果第j个个体移动机器人和第i个个体移动机器人沿相反的方向运行并且第i个个体移动机器人能够获得第j个个体移动机器人的位置信息,那么加权邻接矩阵的元素a<sub>ij</sub>为‑1;如果第i个个体移动机器人不能够获得第j个个体移动机器人的位置信息,那么加权邻接矩阵的元素a<sub>ij</sub>为0,其中,根据每个所述个体移动机器人的位置、所述个体移动机器人的邻居机器人的位置、每个个体移动机器人获取邻居机器人位置时的通信时滞以及所述移动机器人系统的加权邻接矩阵,通过以下的公式确定个体移动机器人的控制量:<maths num="0001" id="cmaths0001"><math><![CDATA[<mrow><msub><mi>u</mi><mi>i</mi></msub><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>=</mo><munder><mo>Σ</mo><mrow><mi>j</mi><mo>∈</mo><msub><mi>N</mi><mi>i</mi></msub></mrow></munder><msub><mi>a</mi><mrow><mi>i</mi><mi>j</mi></mrow></msub><mo>[</mo><msub><mi>x</mi><mi>j</mi></msub><mrow><mo>(</mo><mi>t</mi><mo>-</mo><msub><mi>τ</mi><mrow><mi>i</mi><mi>j</mi></mrow></msub><mo>)</mo></mrow><mo>-</mo><msub><mi>a</mi><mrow><mi>i</mi><mi>j</mi></mrow></msub><msub><mi>x</mi><mi>i</mi></msub><mrow><mo>(</mo><mi>t</mi><mo>-</mo><msub><mi>τ</mi><mrow><mi>i</mi><mi>j</mi></mrow></msub><mo>)</mo></mrow><mo>]</mo><mo>,</mo></mrow>]]></math><img file="FDA0001046643120000011.GIF" wi="886" he="127" /></maths>其中,x<sub>i</sub>(t)为个体移动机器人i的位置,x<sub>j</sub>(t)为个体移动机器人i的邻居机器人j的位置,u<sub>i</sub>(t)为个体移动机器人i的控制量,a<sub>ij</sub>表示所述多个个体移动机器人的加权邻接矩阵第i行且第j列的元素,N<sub>i</sub>为所述移动机器人i的邻居机器人集合,以及τ<sub>ij</sub>表示第i个机器人获得第j个机器人位置信息时的通信时滞。 |
地址 |
100191 北京市海淀区学院路37号 |