本發(fā)明涉及多智能體系統(tǒng)和編隊控制領(lǐng)域，具體涉及一種使用狀態(tài)觀測器的領(lǐng)導跟隨編隊軌跡跟蹤控制的方法。

背景技術(shù)：

1、作為多智能體系統(tǒng)這一領(lǐng)域中最為熱門的研究方向，編隊控制問題以其在各種應(yīng)用領(lǐng)域的使用前景及存在于其中的挑戰(zhàn)性理論問題，近年來受到了越來越多的關(guān)注。其控制目標一般為使得各智能體的狀態(tài)滿足某些規(guī)定的約束條件。

2、考慮到多智能體系統(tǒng)的規(guī)模與日俱增，大量信息通過網(wǎng)絡(luò)交換會產(chǎn)生阻塞導致時間延遲和數(shù)據(jù)丟失問題，采用預測控制機制可以主動補償網(wǎng)絡(luò)中的時間延遲和數(shù)據(jù)丟失，達到與本地控制系統(tǒng)相同的控制效果。對虛擬領(lǐng)導者進行軌跡規(guī)劃可以使編隊控制更加靈活，更加貼合實際。

技術(shù)實現(xiàn)思路

1、本發(fā)明提出了一種考慮延遲和丟包的多智能體系統(tǒng)實現(xiàn)編隊軌跡跟蹤的方法，以建立網(wǎng)絡(luò)化多智能體系統(tǒng)的數(shù)學模型，設(shè)計狀態(tài)觀測器，解決具有通信約束的網(wǎng)絡(luò)化多智能體系統(tǒng)的編隊問題。

2、本發(fā)明提出一種具有時間延遲和數(shù)據(jù)丟失的網(wǎng)絡(luò)化多智能體系統(tǒng)實現(xiàn)領(lǐng)導跟隨編隊軌跡跟蹤的方法，該方法包括以下步驟：

3、步驟一：建立網(wǎng)絡(luò)化多智能體系統(tǒng)虛擬領(lǐng)導者和跟隨者的數(shù)學模型，并對數(shù)學模型進行簡化；

4、步驟二：對虛擬領(lǐng)導者進行軌跡規(guī)劃，設(shè)計一種基于改進人工勢場法的路徑規(guī)劃算法，使虛擬領(lǐng)導者的避障軌跡更加平滑；

5、步驟三：在確保虛擬領(lǐng)導者能夠收斂到目標點的前提下，解決傳統(tǒng)人工勢場法中的目標不可達和局部極小值問題；

6、步驟四：為了估計智能體當前時刻的狀態(tài)，根據(jù)智能體過時的狀態(tài)信息，設(shè)計狀態(tài)觀測器；

7、步驟五：利用觀測器得到的估計值，設(shè)計能夠主動補償網(wǎng)絡(luò)中時間延時和數(shù)據(jù)丟失的預測控制協(xié)議；

8、步驟六：根據(jù)預測控制協(xié)議推導出閉環(huán)誤差系統(tǒng)，獲得預測控制協(xié)議的反饋增益矩陣滿足的條件；

9、步驟七：將反饋增益矩陣代入預測控制協(xié)議中，利用預測控制協(xié)議實現(xiàn)領(lǐng)導跟隨編隊軌跡跟蹤控制；

10、進一步的，步驟一中所述網(wǎng)絡(luò)化多智能體數(shù)學模型表示為：

11、跟隨者的動力學模型描述如下：

12、xi(t+1)＝xi(t)+tvi(t)

13、vi(t+1)＝vi(t)+tui(t)

14、其中，和分別為第i個跟隨者在t時刻的位置、速度和控制輸入向量，t為采樣周期，i∈{1,2,...n}。

15、虛擬領(lǐng)導者的動力學模型描述如下：

16、x0(t+1)＝x0(t)+tv0(t)

17、v0(t+1)＝v0(t)+tu0(t)

18、其中，和分別為虛擬領(lǐng)導者在t時刻的位置、速度和控制輸入向量。

19、顯然式跟隨者動力學模型可簡化成如下形式：

20、

21、其中，和為系統(tǒng)矩陣，表示跟隨者的輸出向量，表示跟隨者的狀態(tài)向量。

22、同理式虛擬領(lǐng)導者動力學方程可簡化成如下形式：

23、

24、其中，為系統(tǒng)矩陣，表示虛擬領(lǐng)導者的狀態(tài)向量。

25、進一步的，步驟二中所述的改進人工勢場法的路徑規(guī)劃算法表示為：

26、假設(shè)智能體的運動空間中存在n個障礙物，它們的外包圓圓心和半徑分別為xobsi和robsi，智能體的位置為x，速度目標點的位置為xtar。智能體到第i個障礙物的最短距離為ρi＝||x-xobsi||-robsi，各個障礙物的作用距離為ρ0。

27、將智能體與目標點的距離||x-xtar||引入到引力中，且只讓其作用一半的路程，一是為了使路徑更加平滑，二是確保智能體能收斂到目標點，因此引力修改為如下形式：

28、

29、其中,kp和kv分別表示位置增益和速度增益，xtar表示目標點的位置，xstarox表示起始點的橫坐標，xtarox表示目標點的橫坐標，xx表示智能體當前位置的橫坐標，。

30、進一步的，步驟三中所述目標不可達與局部極小值問題解決方案為：

31、·針對局部極小值問題解決方案：

32、在步驟二引力中的速度項引入偏移矩陣γ，當引力與斥力中的位置項方向相反時，由于引力中速度項偏移矩陣的γ的作用，使得平衡點位置的合力不為零，以此來解決局部極小值問題。因此引力修改為如下形式：

33、

34、其中，偏移矩陣的選取不僅要使引力中速度項的方向產(chǎn)生微小偏移，而且還要確保不要對路徑規(guī)劃以及避障效果產(chǎn)生較大的影響，因此本文選取偏移矩陣

35、·針對目標不可達問題解決方案：

36、將智能體與目標點的相對距離||x-xtar||引入斥力中，使智能體在靠近目標點時，即使目標點附近有障礙物斥力也會變小，不至于遠遠大于引力造成合力仍處于一個較大的值，使得智能體無法到達目標點。

37、對ρi＝||x-xobsi||-robsi求梯度：

38、

39、代入斥力公式中，可以得到修改后障礙物斥力的坐標表達式：

40、

41、總的人工勢場函數(shù)為故智能體在人工勢場中受到的合力為：

42、

43、設(shè)智能體的狀態(tài)方程為：

44、

45、令u＝f，設(shè)置matlab中的ode45微分方程求解器的積分區(qū)間為相同間隔的長向量，且間隔與采樣周期t相同，此時求解得到的狀態(tài)序列相當于虛擬領(lǐng)導者軌跡規(guī)劃后的狀態(tài)序列。

46、進一步的，步驟四中所述狀態(tài)觀測器的表達式為：

47、對于跟隨者智能體i，為了獲得其狀態(tài)，設(shè)計如下形式的狀態(tài)觀測器：

48、

49、表示第i個智能體使用t-j時刻的信息對t-k時刻的狀態(tài)預測，為觀測器增益矩陣可以通過觀測器設(shè)計得到。

50、進一步的，根據(jù)步驟五所述預測控制協(xié)議的表達式為：

51、

52、其中，為待設(shè)計的反饋增益矩陣，為加權(quán)鄰接矩陣的非負元素，表示相對于的編隊偏移向量。

53、進一步的，步驟六中所述閉環(huán)誤差系統(tǒng)的表達式為：

54、令εi(t+1)可以寫成以下形式：

55、

56、閉環(huán)誤差系統(tǒng)為

57、

58、其中，

59、ε(t)＝[ε1(t)t?ε2(t)t?…?εn(t)t]t

60、e(t)＝[e1(t-τ1+1)t?e2(t-τ2+1)t?…?en(t-τn+1)t]t

61、

62、θ＝diag{a-k0c,a-k0c,...,a-k0c}

63、因此，誤差系統(tǒng)可以表示為：

64、

65、其中，

66、

67、ω＝-(υ+ξ)

68、θ＝diag{a-k0c,a-k0c,...,a-k0c}

69、如果以下條件成立，則網(wǎng)絡(luò)化多智能體系統(tǒng)可以實現(xiàn)編隊軌跡跟蹤。

70、(1)

71、(2)

72、其中，||·||表示向量的范數(shù)，是t時刻的估計誤差。

73、由定義可知，如果誤差系統(tǒng)是穩(wěn)定的，則當t→∞，i＝1,2,...,n時，εi(t)→0，ei(t)→0。

74、由t→∞，ei(t)→0，得到：

75、

76、由t→∞，εi(t)→0，得到：

77、

78、因此，當矩陣和a-k0c是schur穩(wěn)定時，在控制協(xié)議的作用下多智能體系統(tǒng)可以實現(xiàn)編隊軌跡跟蹤；并且，利用matlab中的線性矩陣不等式工具箱求解下列問題：

79、

80、a-k0c<0

81、可以得到反饋增益矩陣k1和k2以及觀測器增益矩陣k0。

82、進一步的，步驟七中將步驟六求得的反饋增益矩陣k1和k2，代入步驟五中的網(wǎng)絡(luò)化多智能體系統(tǒng)編隊軌跡跟蹤預測控制協(xié)議，實現(xiàn)具有時間延遲和數(shù)據(jù)丟失的網(wǎng)絡(luò)化多智能體系統(tǒng)的領(lǐng)導跟隨編隊軌跡跟蹤；

83、本發(fā)明的有益技術(shù)效果是：

84、本發(fā)明研究了網(wǎng)絡(luò)化多智能體系統(tǒng)實現(xiàn)領(lǐng)導跟隨編隊軌跡跟蹤的方法，考慮了時間延遲和數(shù)據(jù)丟失對網(wǎng)絡(luò)化多智能體系統(tǒng)的影響，同時考慮了針對虛擬領(lǐng)導者的軌跡規(guī)劃。與現(xiàn)有的不考慮時間延遲和數(shù)據(jù)丟失問題的多智能體系統(tǒng)相比，本發(fā)明的協(xié)議設(shè)計可以克服網(wǎng)絡(luò)中時間延遲和數(shù)據(jù)丟失對控制系統(tǒng)的影響，達到與本地控制系統(tǒng)相同的控制效果，并且改善了已有大多數(shù)編隊軌跡跟蹤控制研究只考慮跟蹤固定參考軌跡這一問題，具有更大的理論與現(xiàn)實意義。借助于圖論和矩陣論等數(shù)學工具，基于線性矩陣不等式求解出反饋增益矩陣，使系統(tǒng)實現(xiàn)所期望的領(lǐng)導跟編隊軌跡跟蹤。