一种基于合作预测控制的多机器人环境监测方法
一种基于合作预测控制的多机器人环境监测方法
【技术领域】
[0001] 本发明属于自动化技术领域，设及一种面向环境质量参数监测的多机器人合作控 制方法。
【背景技术】
[0002] 环境质量对人类安全有着非常重要的意义，如海洋环境中的盐分浓度分布、化值 分布、温度分布，陆地上的有毒气体浓度分布等等。该些环境参数能够很好地表征环境的质 量特征，因此，统称为环境质量参数。如何快速有效地追踪环境质量参数中的最优值，是建 立环境质量参数分布模型的一个极其重要的问题。然而，环境质量参数的分布在不同的环 境下，呈现出不同的特点。通常的情况，可W采用梯度的方法控制多机器人系统追踪环境质 量参数的最优值，从而建立合适的环境质量参数分布模型。然而，实际的环境中，由于洋流、 温度、风力等不同因素的影响，使得环境质量参数分布极其复杂，采用梯度的方法由于不确 定因素的存在，使得多机器人系统建立的环境质量参数模型仅具有局部特征。在该一背景 下，本发明弥补了现有技术的不足。
【发明内容】
[0003] 本发明的目标是针对现有技术的不足之处，提供了一种有效地环境质量参数监测 方法，使得建立的环境质量参数模型具有全局特征。首先采用径向基函数网络建立环境质 量参数模型，对于每一个机器人，在每一时刻，都可W使用自己和他的邻居机器人通过网络 传输过来的新的质量参数数据来更新建立的环境质量参数模型；然后，在环境质量参数模 型的基础上，建立环境质量参数优化问题，采用预测控制方法，获得机器人理想的最优运动 轨迹；最后，建立多机器人合作控制优化问题，基于机器人的理想的最优运动轨迹，采用预 测控制方法，产生机器人实际最优的控制序列，并采用实际最优控制序列中第一个控制输 入到机器人，控制机器人的运动。本发明弥补了传统控制的不足，设计的合作预测控制的环 境监测方法，在保证多机器人追踪环境质量参数最优值的同时，可W保持多机器人运动避 碰W及速度之间的协调。本发明采用的控制方法可W有效地保证多机器人更好地监测环境 质量参数，从而更准确地建立环境质量参数模型。
[0004] 本发明方法的步骤包括：
[0005] 第一步：采用径向基函数网络建立环境质量参数模型，具体步骤如下：
[0006]a、对于第i个机器人的环境质量参数模型fi(x)，即径向基函数网络如（1)式所 示，其中；i= 1，2, . . .，n，n是机器人的数量；
[0007]
【主权项】
1. 一种基于合作预测控制的多机器人环境监测方法，其特征在于，该方法具体包括以 下步骤： 第一步：采用径向基函数网络建立环境质量参数模型，具体步骤如下： a、 对于第i个机器人的环境质量参数模型&〇〇,即径向基函数网络如（1)式所示，其 中：i = 1，2, . . .，η，η是机器人的数量；
(1) 其中：a kk是径向基函数的权重；m是径向基函数的个数；X是机器人的位置；f i (X)表 示在机器人在位置X，径向基函数网络输出的环境质量参数预测值；Pkk(X)是第kk个径向基 函数，具体如（2)式所示；
其中：γ是归一化常数；Ukk是径向基函数中心；〇 kk是径向基函数的宽度；exp(·)是 指数函数；11 · 11表示2范数； b、 对于第i个机器人的所有邻居，即可以和第i个机器人通信的机器人集合用Af1表 示，那么第i个机器人的环境质量参数模型中径向基函数的权重akk(kk= l，2，...，m)根 据⑶式更新；
其中：min表示取最小值；I · I表示绝对值；由于第j个机器人在第i个机器人的邻域 内，即J € Λ/)，因此，能和第i个机器人通信，可以将第j个机器人的位置Xj和环境实际质 量参数数值z (?)发送给第i个机器人；z (\)表示第j个机器人在位置&的环境质量参数 实际数值，fi (Xj)表示第i个机器人的环境质量参数模型对第j个机器人的位置Xj上的环 境质量参数预测值； 第二步：基于环境质量参数模型，建立环境质量参数优化问题，采用预测控制方法产生 机器人的理想的最优运动轨迹，具体步骤如下： a、在环境质量参数模型的基础上，建立的环境质量参数优化问题如下：
其中：max表示取最大值；表示第i个机器人在k时刻预测的位置序列 為(1_),…，N是预测的长度；/:(?⑷）是关于位置序列:?⑷的成本函数； s. t.表示位置序列应满足的条件，这个条件就是机器人的动力学方程；i:,(0|/,:)是 第i个机器人在k时刻的位置；?Μ〇μ〇是第i个机器人在k时刻的速度；1幻是第i个 机器人在k时刻预测的在第k+l时刻的位置；Ci i (611 ^是第i个机器人在k时刻预测的在第 k+l时刻的速度；是第i个机器人在k时刻需要求得的在第k+l时刻的控制输入； ft#)表示第i个机器人在k时刻需要求得的控制序列…s b、求解环境质量参数优化问题（4)，获得理想的最优预测控制序列，即：
其中：·&丨(λ·)表示第i个机器人在k时刻获得的理想的最优控制序列 #(11幻....，对应于该理想的最优控制序列，我们可以得到第i个机器 人在k时刻理想的最优位置序列和理想的最优速度序列 ?);:(ιμ·)…..，.^Λ-μ..)，如果用$(/μ·)=丨对(取:).if(取0Γ，上标T表示矩阵 的转置，表示在k时刻获得的在第k+l时刻的最优状态，那么对应于理想的最优控 制序列，我们可以将理想的最优位置序列和理想的最优速度序列表示成理想的最 优运动轨迹MPI幻将第i个机器人在k时刻获得最优运动轨迹 发给他的邻居，同时，获得他的邻居发给他的最优运动轨迹 s*(l\k),,..fs*j(X\k).j e Mr, 第三步：建立多机器人合作控制优化问题，基于理想的最优运动轨迹，获得实际的最优 控制序列，并产生实际的最优运动轨迹，具体步骤如下： a、 律立多机器人合作能量函数，如（6)式所示：
其中：d表示相邻机器人之间的理想距离；Si(i|k) = [XidikhVidiiohVihaik)) 表示第i个机器人在状态Si (I I k)时的能量；能量函数用来约束多机器人系统之间的距离 和速度，即在理想的情况下，相邻机器人之间的距离为d;并且速度相 等 ?+?|λ·) = ?·+^(Ι|λ·); b、 建立多机器人合作控制优化问题，如（7)式所示；
其中：γ是距离约束参数用来约束产生的实际运动轨迹Si(Ilk),...，Si(N|k)和理想 的运动轨迹句（1|幻.·. " 之间的距离；优化的目的是要求产生的实际运动轨迹在 接近理想运动轨迹的情况下，即保持多机器人系统搜索环境质量参数最优数值的情况下， 使得多机器人避免碰撞并速度相差有界；Ui (k)表示第i个机器人在k时刻需要求得的控制 序列 UiCL I k)，…，Ui(Nlk); c、求解多机器人合作控制优化问题（7)，获得实际的最优预测控制序列；
其中：表示第i个机器人在k时刻获得的实际的最优控制序列 第四步：将第i个机器人在k时刻获得的实际的最优控制序列μ:)."., 4(λ+?α'） 中的第一个最优控制施加给第i个机器人； 第五步：如果终止条件满足，则第i个机器人停止运行，并将他的环境模型fi (X)输出； 如果终止条件没有满足，则返回第一步继续执行。
【专利摘要】本发明涉及一种基于合作预测控制的多机器人环境监测方法。本发明采用径向基函数网络建立环境质量参数模型，对于每一个机器人，在每一时刻，都可以使用自己和他的邻居机器人通过网络传输过来的新的质量参数数据来更新建立的环境质量参数模型；再在环境质量参数模型的基础上，建立环境质量参数优化问题，采用预测控制方法，获得机器人理想的最优运动轨迹；最后建立多机器人合作控制优化问题，基于机器人的理想的最优运动轨迹，采用预测控制方法，产生机器人实际最优的控制序列，并采用实际最优控制序列中第一个控制输入到机器人，控制机器人的运动。本发明在保证多机器人追踪环境质量参数最优值的同时，可以保持多机器人运动避碰以及速度相差有界。
【IPC分类】G05B13-04
【公开号】CN104865826
【申请号】CN201510121747
【发明人】吕强, 刘士荣, 张波涛, 谢小高, 王坚
【申请人】杭州电子科技大学
【公开日】2015年8月26日
【申请日】2015年3月19日
【技术领域】
[0001] 本发明属于自动化技术领域，设及一种面向环境质量参数监测的多机器人合作控 制方法。
【背景技术】
[0002] 环境质量对人类安全有着非常重要的意义，如海洋环境中的盐分浓度分布、化值 分布、温度分布，陆地上的有毒气体浓度分布等等。该些环境参数能够很好地表征环境的质 量特征，因此，统称为环境质量参数。如何快速有效地追踪环境质量参数中的最优值，是建 立环境质量参数分布模型的一个极其重要的问题。然而，环境质量参数的分布在不同的环 境下，呈现出不同的特点。通常的情况，可W采用梯度的方法控制多机器人系统追踪环境质 量参数的最优值，从而建立合适的环境质量参数分布模型。然而，实际的环境中，由于洋流、 温度、风力等不同因素的影响，使得环境质量参数分布极其复杂，采用梯度的方法由于不确 定因素的存在，使得多机器人系统建立的环境质量参数模型仅具有局部特征。在该一背景 下，本发明弥补了现有技术的不足。
【发明内容】
[0003] 本发明的目标是针对现有技术的不足之处，提供了一种有效地环境质量参数监测 方法，使得建立的环境质量参数模型具有全局特征。首先采用径向基函数网络建立环境质 量参数模型，对于每一个机器人，在每一时刻，都可W使用自己和他的邻居机器人通过网络 传输过来的新的质量参数数据来更新建立的环境质量参数模型；然后，在环境质量参数模 型的基础上，建立环境质量参数优化问题，采用预测控制方法，获得机器人理想的最优运动 轨迹；最后，建立多机器人合作控制优化问题，基于机器人的理想的最优运动轨迹，采用预 测控制方法，产生机器人实际最优的控制序列，并采用实际最优控制序列中第一个控制输 入到机器人，控制机器人的运动。本发明弥补了传统控制的不足，设计的合作预测控制的环 境监测方法，在保证多机器人追踪环境质量参数最优值的同时，可W保持多机器人运动避 碰W及速度之间的协调。本发明采用的控制方法可W有效地保证多机器人更好地监测环境 质量参数，从而更准确地建立环境质量参数模型。
[0004] 本发明方法的步骤包括：
[0005] 第一步：采用径向基函数网络建立环境质量参数模型，具体步骤如下：
[0006]a、对于第i个机器人的环境质量参数模型fi(x)，即径向基函数网络如（1)式所 示，其中；i= 1，2, . . .，n，n是机器人的数量；
[0007]
【主权项】
1. 一种基于合作预测控制的多机器人环境监测方法，其特征在于，该方法具体包括以 下步骤： 第一步：采用径向基函数网络建立环境质量参数模型，具体步骤如下： a、 对于第i个机器人的环境质量参数模型&〇〇,即径向基函数网络如（1)式所示，其 中：i = 1，2, . . .，η，η是机器人的数量；
(1) 其中：a kk是径向基函数的权重；m是径向基函数的个数；X是机器人的位置；f i (X)表 示在机器人在位置X，径向基函数网络输出的环境质量参数预测值；Pkk(X)是第kk个径向基 函数，具体如（2)式所示；
其中：γ是归一化常数；Ukk是径向基函数中心；〇 kk是径向基函数的宽度；exp(·)是 指数函数；11 · 11表示2范数； b、 对于第i个机器人的所有邻居，即可以和第i个机器人通信的机器人集合用Af1表 示，那么第i个机器人的环境质量参数模型中径向基函数的权重akk(kk= l，2，...，m)根 据⑶式更新；
其中：min表示取最小值；I · I表示绝对值；由于第j个机器人在第i个机器人的邻域 内，即J € Λ/)，因此，能和第i个机器人通信，可以将第j个机器人的位置Xj和环境实际质 量参数数值z (?)发送给第i个机器人；z (\)表示第j个机器人在位置&的环境质量参数 实际数值，fi (Xj)表示第i个机器人的环境质量参数模型对第j个机器人的位置Xj上的环 境质量参数预测值； 第二步：基于环境质量参数模型，建立环境质量参数优化问题，采用预测控制方法产生 机器人的理想的最优运动轨迹，具体步骤如下： a、在环境质量参数模型的基础上，建立的环境质量参数优化问题如下：
其中：max表示取最大值；表示第i个机器人在k时刻预测的位置序列 為(1_),…，N是预测的长度；/:(?⑷）是关于位置序列:?⑷的成本函数； s. t.表示位置序列应满足的条件，这个条件就是机器人的动力学方程；i:,(0|/,:)是 第i个机器人在k时刻的位置；?Μ〇μ〇是第i个机器人在k时刻的速度；1幻是第i个 机器人在k时刻预测的在第k+l时刻的位置；Ci i (611 ^是第i个机器人在k时刻预测的在第 k+l时刻的速度；是第i个机器人在k时刻需要求得的在第k+l时刻的控制输入； ft#)表示第i个机器人在k时刻需要求得的控制序列…s b、求解环境质量参数优化问题（4)，获得理想的最优预测控制序列，即：
其中：·&丨(λ·)表示第i个机器人在k时刻获得的理想的最优控制序列 #(11幻....，对应于该理想的最优控制序列，我们可以得到第i个机器 人在k时刻理想的最优位置序列和理想的最优速度序列 ?);:(ιμ·)…..，.^Λ-μ..)，如果用$(/μ·)=丨对(取:).if(取0Γ，上标T表示矩阵 的转置，表示在k时刻获得的在第k+l时刻的最优状态，那么对应于理想的最优控 制序列，我们可以将理想的最优位置序列和理想的最优速度序列表示成理想的最 优运动轨迹MPI幻将第i个机器人在k时刻获得最优运动轨迹 发给他的邻居，同时，获得他的邻居发给他的最优运动轨迹 s*(l\k),,..fs*j(X\k).j e Mr, 第三步：建立多机器人合作控制优化问题，基于理想的最优运动轨迹，获得实际的最优 控制序列，并产生实际的最优运动轨迹，具体步骤如下： a、 律立多机器人合作能量函数，如（6)式所示：
其中：d表示相邻机器人之间的理想距离；Si(i|k) = [XidikhVidiiohVihaik)) 表示第i个机器人在状态Si (I I k)时的能量；能量函数用来约束多机器人系统之间的距离 和速度，即在理想的情况下，相邻机器人之间的距离为d;并且速度相 等 ?+?|λ·) = ?·+^(Ι|λ·); b、 建立多机器人合作控制优化问题，如（7)式所示；
其中：γ是距离约束参数用来约束产生的实际运动轨迹Si(Ilk),...，Si(N|k)和理想 的运动轨迹句（1|幻.·. " 之间的距离；优化的目的是要求产生的实际运动轨迹在 接近理想运动轨迹的情况下，即保持多机器人系统搜索环境质量参数最优数值的情况下， 使得多机器人避免碰撞并速度相差有界；Ui (k)表示第i个机器人在k时刻需要求得的控制 序列 UiCL I k)，…，Ui(Nlk); c、求解多机器人合作控制优化问题（7)，获得实际的最优预测控制序列；
其中：表示第i个机器人在k时刻获得的实际的最优控制序列 第四步：将第i个机器人在k时刻获得的实际的最优控制序列μ:)."., 4(λ+?α'） 中的第一个最优控制施加给第i个机器人； 第五步：如果终止条件满足，则第i个机器人停止运行，并将他的环境模型fi (X)输出； 如果终止条件没有满足，则返回第一步继续执行。
【专利摘要】本发明涉及一种基于合作预测控制的多机器人环境监测方法。本发明采用径向基函数网络建立环境质量参数模型，对于每一个机器人，在每一时刻，都可以使用自己和他的邻居机器人通过网络传输过来的新的质量参数数据来更新建立的环境质量参数模型；再在环境质量参数模型的基础上，建立环境质量参数优化问题，采用预测控制方法，获得机器人理想的最优运动轨迹；最后建立多机器人合作控制优化问题，基于机器人的理想的最优运动轨迹，采用预测控制方法，产生机器人实际最优的控制序列，并采用实际最优控制序列中第一个控制输入到机器人，控制机器人的运动。本发明在保证多机器人追踪环境质量参数最优值的同时，可以保持多机器人运动避碰以及速度相差有界。
【IPC分类】G05B13-04
【公开号】CN104865826
【申请号】CN201510121747
【发明人】吕强, 刘士荣, 张波涛, 谢小高, 王坚
【申请人】杭州电子科技大学
【公开日】2015年8月26日
【申请日】2015年3月19日
最新回复(0)