本發(fā)明涉及無人集群仿真,具體地說,涉及一種基于虛實(shí)結(jié)合的異構(gòu)無人集群系統(tǒng)。
背景技術(shù):
1、本發(fā)明考慮到大規(guī)模異構(gòu)無人系統(tǒng)的實(shí)驗(yàn)情況,為了能夠使得前人的開發(fā)經(jīng)驗(yàn)得到整合,并且順利完成高難度的異構(gòu)無人系統(tǒng)集群實(shí)驗(yàn),建立一個(gè)基于虛實(shí)結(jié)合的異構(gòu)無人系統(tǒng)集群試驗(yàn)平臺(tái),融合旋翼/固定翼等異構(gòu)無人機(jī)智能體,完成大規(guī)模復(fù)雜試驗(yàn)驗(yàn)證,并達(dá)到縮短開發(fā)間隔、提高安全性和降低實(shí)驗(yàn)成本的目的。
2、現(xiàn)階段在國(guó)內(nèi)研究機(jī)構(gòu)及試驗(yàn),受到空間和實(shí)驗(yàn)成本的限制,大規(guī)模的集群實(shí)驗(yàn)難以開展。國(guó)內(nèi)外許多研究機(jī)構(gòu)及軍方對(duì)基于虛實(shí)結(jié)合的實(shí)驗(yàn)平臺(tái)進(jìn)行了開發(fā)和應(yīng)用研究。其中,首先要解決的問題是設(shè)計(jì)一套高效運(yùn)行的基于虛實(shí)結(jié)合的虛實(shí)實(shí)驗(yàn)框架。在對(duì)不同階段的數(shù)字孿生模型性能需求進(jìn)行分析,從“建—組—融—驗(yàn)—?!堋?個(gè)方面建立了一套無人機(jī)數(shù)字孿生模型構(gòu)建方法,并基于所提出的數(shù)字孿生模型構(gòu)建準(zhǔn)則和方法,設(shè)計(jì)一套適用于智能無人機(jī)集群虛實(shí)結(jié)合實(shí)驗(yàn)平臺(tái)設(shè)計(jì)框架,和無人機(jī)管理虛實(shí)結(jié)合實(shí)驗(yàn)平臺(tái)框架,從幾何、物理、行為和規(guī)則等方面對(duì)模型進(jìn)行描述,實(shí)現(xiàn)了物理實(shí)體和虛擬實(shí)體之間的交互映射。在有一套完整系統(tǒng)架構(gòu)后,虛實(shí)結(jié)合平臺(tái)建設(shè)得以逐步實(shí)現(xiàn)。仿真缺少可視化實(shí)現(xiàn),仿真粒度較低。數(shù)據(jù)驅(qū)動(dòng)的訓(xùn)練環(huán)境建模,與真實(shí)環(huán)境數(shù)據(jù)的一致性存在一定差異,并且沒有實(shí)物節(jié)點(diǎn)的參與。智能體硬件在環(huán)仿真實(shí)驗(yàn)節(jié)點(diǎn)數(shù)量受限,缺少建立大規(guī)模無人機(jī)節(jié)點(diǎn)的實(shí)驗(yàn)?zāi)芰?。面向虛?shí)結(jié)合的協(xié)同任務(wù)應(yīng)用場(chǎng)景,目前開展的協(xié)同控制研究較少等問題。因此,設(shè)計(jì)一種基于虛實(shí)結(jié)合的異構(gòu)無人集群系統(tǒng)。
技術(shù)實(shí)現(xiàn)思路
1、本發(fā)明的目的在于提供一種基于虛實(shí)結(jié)合的異構(gòu)無人集群系統(tǒng),以解決上述背景技術(shù)中提出的仿真缺少可視化實(shí)現(xiàn),仿真粒度較低。數(shù)據(jù)驅(qū)動(dòng)的訓(xùn)練環(huán)境建模,與真實(shí)環(huán)境數(shù)據(jù)的一致性存在一定差異,并且沒有實(shí)物節(jié)點(diǎn)的參與。智能體硬件在環(huán)仿真實(shí)驗(yàn)節(jié)點(diǎn)數(shù)量受限,缺少建立大規(guī)模無人機(jī)節(jié)點(diǎn)的實(shí)驗(yàn)?zāi)芰?。面向虛?shí)結(jié)合的協(xié)同任務(wù)應(yīng)用場(chǎng)景,目前開展的協(xié)同控制研究較少等問題的問題。
2、為實(shí)現(xiàn)上述目的,本發(fā)明目的在于提供了一種基于虛實(shí)結(jié)合的異構(gòu)無人集群系統(tǒng),包括運(yùn)動(dòng)預(yù)測(cè)單元,所述運(yùn)動(dòng)預(yù)測(cè)單元基于龍格庫(kù)塔法計(jì)算無人機(jī)在未來某一時(shí)刻的位置;
3、通信補(bǔ)償單元,所述通信補(bǔ)償單元基于運(yùn)動(dòng)預(yù)測(cè)單元所得到的無人機(jī)在未來某一時(shí)刻的位置,通過預(yù)測(cè)調(diào)整無人機(jī)數(shù)據(jù),使其與當(dāng)前時(shí)間點(diǎn)對(duì)齊;
4、雙向時(shí)鐘同步單元,所述雙向時(shí)鐘同步單元選擇網(wǎng)絡(luò)中精度高的節(jié)點(diǎn)的時(shí)鐘作為基準(zhǔn)時(shí)鐘,其他節(jié)點(diǎn)作為子時(shí)鐘,并與基準(zhǔn)時(shí)鐘進(jìn)行時(shí)鐘同步;
5、主從式時(shí)間同步單元,所述主從式時(shí)間同步單元基于雙向時(shí)鐘同步單元提供的同步機(jī)制,設(shè)定一個(gè)固定的同步周期,在此周期內(nèi),各子模擬器獨(dú)立運(yùn)行,并在周期結(jié)束時(shí)暫停以交換數(shù)據(jù)。
6、作為本技術(shù)方案的進(jìn)一步改進(jìn),所述運(yùn)動(dòng)預(yù)測(cè)單元中,使用龍格庫(kù)塔法計(jì)算無人機(jī)在未來某一時(shí)刻的位置的具體步驟為:
7、s2.1、每個(gè)無人機(jī)節(jié)點(diǎn)i提供當(dāng)前位置和速度;
8、s2.2、使用龍格庫(kù)塔法來預(yù)測(cè)未來位置;
9、s2.3、計(jì)算無人機(jī)在未來時(shí)間的位置。
10、作為本技術(shù)方案的進(jìn)一步改進(jìn),所述s2.2中,使用龍格庫(kù)塔法來預(yù)測(cè)未來位置的具體表達(dá)式為:
11、;
12、其中,f表示控制輸入和其他因素引起的加速度;表示當(dāng)前速度;表示基于當(dāng)前速度和一半時(shí)間步長(zhǎng)預(yù)測(cè)的位置變化;基于和一半時(shí)間步長(zhǎng)預(yù)測(cè)的位置變化;基于和完整時(shí)間步長(zhǎng)預(yù)測(cè)的位置變化。
13、作為本技術(shù)方案的進(jìn)一步改進(jìn),所述s2.3中,計(jì)算無人機(jī)在未來時(shí)間的位置具體表達(dá)式為:
14、;
15、其中,表示無人機(jī)節(jié)點(diǎn)i在時(shí)間的預(yù)測(cè)位置;表示預(yù)測(cè)的時(shí)間增量。
16、作為本技術(shù)方案的進(jìn)一步改進(jìn),所述通信補(bǔ)償單元中,通過預(yù)測(cè)調(diào)整無人機(jī)數(shù)據(jù),使其與當(dāng)前時(shí)間點(diǎn)對(duì)齊的具體步驟為:
17、s5.1、地面站從各無人機(jī)節(jié)點(diǎn)接收包含位置和速度的狀態(tài)信息;
18、s5.2、找出最接近當(dāng)前時(shí)間t的狀態(tài)信息作為基準(zhǔn);
19、s5.3、使用運(yùn)動(dòng)預(yù)測(cè)來預(yù)測(cè)其在當(dāng)前時(shí)間t的位置,并調(diào)整數(shù)據(jù)使其與當(dāng)前時(shí)間點(diǎn)對(duì)齊。
20、作為本技術(shù)方案的進(jìn)一步改進(jìn),所述s5.3中,使用運(yùn)動(dòng)預(yù)測(cè)來預(yù)測(cè)其在當(dāng)前時(shí)間t的位置,并調(diào)整數(shù)據(jù)使其與當(dāng)前時(shí)間點(diǎn)對(duì)齊的具體表達(dá)式為:
21、;
22、其中,表示無人機(jī)節(jié)點(diǎn)j在時(shí)間t的預(yù)測(cè)位置;表示無人機(jī)節(jié)點(diǎn)j在時(shí)間的位置;無人機(jī)節(jié)點(diǎn)j的數(shù)據(jù)延遲時(shí)間;表示無人機(jī)節(jié)點(diǎn)j在時(shí)間的速度。
23、作為本技術(shù)方案的進(jìn)一步改進(jìn),所述雙向時(shí)鐘同步單元中,進(jìn)行時(shí)鐘同步的具體步驟為:
24、s7.1、在時(shí)間同步周期到來的時(shí)候,子時(shí)鐘給基準(zhǔn)時(shí)鐘發(fā)送時(shí)隙同步詢問報(bào)文,并且記錄下子時(shí)鐘發(fā)送時(shí)的時(shí)間戳;
25、s7.2、當(dāng)基準(zhǔn)時(shí)鐘在接收到時(shí)隙同步詢問報(bào)文時(shí),基準(zhǔn)時(shí)鐘記錄下此時(shí)本地時(shí)鐘的時(shí)間戳;
26、s7.3、在空閑的時(shí)隙的時(shí)候,基準(zhǔn)時(shí)鐘給子時(shí)鐘回復(fù)同步應(yīng)答報(bào)文,該報(bào)文中攜帶時(shí)間戳和;
27、s7.4、當(dāng)子時(shí)鐘在接收到基準(zhǔn)時(shí)鐘發(fā)送同步應(yīng)答報(bào)文時(shí),子時(shí)鐘記錄此時(shí)本地時(shí)鐘時(shí)間戳;
28、s7.5、基于時(shí)間戳計(jì)算時(shí)鐘偏移;
29、s7.6、子時(shí)鐘根據(jù)計(jì)算出的時(shí)鐘偏移調(diào)整自身時(shí)鐘,使其與基準(zhǔn)時(shí)鐘同步。
30、作為本技術(shù)方案的進(jìn)一步改進(jìn),所述s7.5中,計(jì)算時(shí)鐘偏移具體表達(dá)式為:
31、;
32、其中,表示時(shí)鐘偏移。
33、作為本技術(shù)方案的進(jìn)一步改進(jìn),所述主從式時(shí)間同步單元中,通過設(shè)定一個(gè)固定的同步周期,在此周期內(nèi),各子模擬器獨(dú)立運(yùn)行,并在周期結(jié)束時(shí)暫停以交換數(shù)據(jù)的具體步驟為:
34、s9.1、設(shè)定一個(gè)固定的同步周期t;
35、s9.2、基于雙向時(shí)鐘同步單元提供的同步機(jī)制,用于確保所有節(jié)點(diǎn)的時(shí)間基準(zhǔn)一致;
36、s9.3、在每個(gè)同步周期內(nèi),各子模擬器獨(dú)立運(yùn)行;
37、s9.4、在每個(gè)周期t結(jié)束時(shí),子模擬器暫停運(yùn)行,并交換數(shù)據(jù);
38、s9.5、在每次暫停時(shí)檢查是否有關(guān)鍵事件發(fā)生,當(dāng)檢測(cè)到關(guān)鍵事件,則調(diào)整步長(zhǎng)并立即同步。
39、作為本技術(shù)方案的進(jìn)一步改進(jìn),所述s9.5中,當(dāng)檢測(cè)到關(guān)鍵事件,則調(diào)整步長(zhǎng)并立即同步的具體表達(dá)式為:
40、;
41、其中,表示調(diào)整后的同步周期;表示關(guān)鍵事件發(fā)生的時(shí)間點(diǎn);e表示事件的條件。
42、與現(xiàn)有技術(shù)相比,本發(fā)明的有益效果:
43、1、該一種基于虛實(shí)結(jié)合的異構(gòu)無人集群系統(tǒng)中,通過使用龍格庫(kù)塔法進(jìn)行數(shù)值積分,具有較高的精度,能夠較好地預(yù)測(cè)無人機(jī)在未來某一時(shí)刻的位置。通過使用運(yùn)動(dòng)預(yù)測(cè)單元提供的未來位置預(yù)測(cè),通信補(bǔ)償單元能夠減少由于通信延遲造成的數(shù)據(jù)不同步問題,提高系統(tǒng)的實(shí)時(shí)性。
44、2、該一種基于虛實(shí)結(jié)合的異構(gòu)無人集群系統(tǒng)中,選擇網(wǎng)絡(luò)中精度高的節(jié)點(diǎn)作為基準(zhǔn)時(shí)鐘,確保了時(shí)間基準(zhǔn)的一致性,提高了整體系統(tǒng)的同步精度。主從式時(shí)間同步機(jī)制易于擴(kuò)展,適用于多個(gè)子模擬器組成的復(fù)雜系統(tǒng),能夠有效管理大規(guī)模系統(tǒng)的同步需求。