• <tr id="yyy80"></tr>
  • <sup id="yyy80"></sup>
  • <tfoot id="yyy80"><noscript id="yyy80"></noscript></tfoot>
  • 99热精品在线国产_美女午夜性视频免费_国产精品国产高清国产av_av欧美777_自拍偷自拍亚洲精品老妇_亚洲熟女精品中文字幕_www日本黄色视频网_国产精品野战在线观看 ?

    動態(tài)優(yōu)先級解耦的無人機集群軌跡分布式序列凸規(guī)劃

    2022-03-29 07:49:52徐廣通王祝曹嚴(yán)孫景亮龍騰
    航空學(xué)報 2022年2期
    關(guān)鍵詞:編隊步長集群

    徐廣通,王祝,曹嚴(yán),孫景亮,*,龍騰

    1.北京理工大學(xué) 宇航學(xué)院,北京 100081

    2.飛行器動力學(xué)與控制教育部重點實驗室,北京 100081

    3.華北電力大學(xué) 河北省發(fā)電過程仿真與優(yōu)化控制技術(shù)創(chuàng)新中心,保定 071003

    近年來,無人機集群智能技術(shù)在軍事與民用領(lǐng)域得到了愈來愈廣泛的研究。無人機集群快速軌跡規(guī)劃是實現(xiàn)集群智能化的一項瓶頸技術(shù)。集群軌跡規(guī)劃是指在有限空間維度下為大量無人機規(guī)劃出連續(xù)平滑的協(xié)同軌跡,滿足機間避碰、威脅規(guī)避及無人機動力學(xué)等約束,實現(xiàn)無人機之間高效的任務(wù)協(xié)作。然而,嚴(yán)格的威脅規(guī)避約束、耦合的機間避碰約束以及非線性無人機動力學(xué)導(dǎo)致了集群軌跡規(guī)劃難以快速求解,無法滿足集群在線軌跡規(guī)劃要求。因此,如何通過處理機間耦合關(guān)系來提升求解效率是快速軌跡規(guī)劃的關(guān)鍵。

    優(yōu)先級規(guī)劃作為解耦規(guī)劃的主要分支,可使無人機按照優(yōu)先級次序依次進行規(guī)劃。該方法因其降低了集群軌跡規(guī)劃的耦合度,提升了集群軌跡規(guī)劃效率,得到了國內(nèi)外學(xué)者的廣泛研究。Van Den Berg和Dvermars提出一種基于運動距離的啟發(fā)式優(yōu)先級確定規(guī)則,能夠在15 s內(nèi)完成包含24個智能體的幾何航路規(guī)劃,但未考慮智能體非線性動力學(xué)約束。Robinson 等使用串行優(yōu)先級解耦機制與偽譜法求解異構(gòu)旋翼機協(xié)同軌跡規(guī)劃問題,32 架機軌跡規(guī)劃耗時累計為112 s。然而,該方法使用預(yù)設(shè)式優(yōu)先級生成方法,導(dǎo)致解耦規(guī)劃易于陷入不可行狀態(tài)。Prasanna等提出了同步并行優(yōu)先級解耦機制,并在理想通信條件下完成了算法的收斂性證明,仿真結(jié)果表明240個智能體的并行迭代一般可在20次以內(nèi)收斂,相比串行方式可以大幅減少規(guī)劃耗時。2015年,Cap等提出了改進的并行優(yōu)先級規(guī)劃方法,進一步節(jié)省了同步規(guī)劃方法中個體相互等待時間,更加充分地利用集群計算資源,相比于同步規(guī)劃方法,25個智能體軌跡規(guī)劃效率提升了1倍。但是,上述并行優(yōu)先級規(guī)劃方法均未考慮多智能體的時間協(xié)同約束,難以實現(xiàn)編隊形成與變換等任務(wù)。

    除了高效的解耦機制外,數(shù)值優(yōu)化方法也是制約集群軌跡規(guī)劃效率的關(guān)鍵之一。近年序列凸規(guī)劃(SCP)開始應(yīng)用于多智能體協(xié)同軌跡規(guī)劃問題。蘇黎世聯(lián)邦理工學(xué)院D’Andrea團隊于2012年首次利用SCP 方法以耦合規(guī)劃方式實現(xiàn)了12架無人機的避撞軌跡規(guī)劃,每個迭代求解子問題是關(guān)于集群軌跡的二次規(guī)劃問題。文獻[11]結(jié)合罰函數(shù)與耦合的SCP方法,能夠在40 s內(nèi)為7架固定翼無人機規(guī)劃出編隊集結(jié)軌跡。為緩解耦合規(guī)劃時效性不足問題,麻省理工學(xué)院Chen等使用串行優(yōu)先級解耦規(guī)劃機制與SCP 方法,依據(jù)優(yōu)先級次序利用SCP逐個求解每架無人機軌跡,能夠?qū)?0架四旋翼編隊軌跡規(guī)劃耗時由40 s降到4 s。Chung等針對固定時間航天器集群軌跡規(guī)劃問題,提出并行解耦SCP 方法,降低了計算復(fù)雜度,將航天器集群無障礙環(huán)境下軌跡規(guī)劃時間縮短到幾十秒。在此基礎(chǔ)上,Wang等使用并行解耦SCP 求解多無人機時間最優(yōu)軌跡規(guī)劃問題,能夠在13.5 s內(nèi)生成7架機編隊集結(jié)軌跡,滿足動力學(xué)、障礙規(guī)避與機間避碰約束。然而,文獻[14]所提并行解耦SCP處理機間避碰約束可能陷入迭代振蕩,難以獲得可行解。另外,該研究未給出并行SCP求解集群軌跡規(guī)劃問題的時間一致理論分析。Lu針對非線性等式約束提出凹凸分解的SCP方法,將一個等式約束轉(zhuǎn)化為3個不等式約束,但是該方法難以處理非線性動力學(xué)約束。Foust等提出一種飛行器非線性動力學(xué)修正的SCP方法,以犧牲計算效率為代價提升了SCP的求解精度,且僅涉及小規(guī)模無人機的協(xié)同軌跡規(guī)劃。

    針對高維強耦合的集群軌跡規(guī)劃問題,本文結(jié)合優(yōu)先級解耦機制與SCP方法,發(fā)展動態(tài)優(yōu)先級解耦的集群軌跡分布式規(guī)劃方法,實現(xiàn)集群軌跡并行規(guī)劃,改善軌跡迭代收斂速度。本文主要貢獻為:①提出了動態(tài)優(yōu)先級解耦的序列凸規(guī)劃方法(DPD-SCP),將連續(xù)時間集群軌跡規(guī)劃問題轉(zhuǎn)化為一組單機凸規(guī)劃子問題,降低問題求解復(fù)雜度。②發(fā)展了飛行時間驅(qū)動的動態(tài)優(yōu)先級解耦機制,解決迭代振蕩問題,改善集群軌跡解耦規(guī)劃的收斂性;定制時間一致約束更新準(zhǔn)則,調(diào)整飛行時間下邊界約束,驅(qū)使集群同時抵達終端位置,形成既定編隊構(gòu)型。③理論證明了所提方法能夠獲得滿足協(xié)同約束的集群軌跡;數(shù)值仿真結(jié)果表明,DPD-SCP相比耦合SCP、串行優(yōu)先級解耦SCP以及并行解耦SCP具有明顯的效率優(yōu)勢。

    1 無人機集群軌跡解耦規(guī)劃問題建模

    集群軌跡解耦規(guī)劃是指每架無人機根據(jù)自身任務(wù)、他機軌跡、威脅等信息,并行規(guī)劃出最小飛行時間協(xié)同軌跡。圖1 為集群軌跡解耦規(guī)劃示意,每架無人機基于共享的軌跡信息規(guī)劃本機軌跡,通過不斷的軌跡迭代確保集群時空一致性。

    圖1 無人機集群軌跡規(guī)劃示意圖Fig.1 Illustration of trajectory planning for UAV swarms

    1.1 無人機動力學(xué)建模

    考慮存在架具有相同飛行性能的固定翼無人機,基于歐拉角建立三自由度無側(cè)滑動力學(xué)模型,如式(1)所示:

    式中:

    無人機動力學(xué)狀態(tài)變量s ∈R包括無人機三維空間位置p =[p ,p ,p ]、飛行速度V 、航向角χ以及航跡傾角γ,即s =[p ,p ,,p ,V ,χ,γ]??刂谱兞?span id="j5i0abt0b" class="emphasis_italic">u ∈R包括切向過載n 、法向過載n 與垂直過載n ,即u =[n ,n ,n ]。表示重力加速度,下標(biāo)為無人機索引,代表第架無人機。

    1.2 解耦的非凸軌跡規(guī)劃問題建模

    利用配點法離散化狀態(tài)與控制變量,將軌跡時間[,]拆分成等步長的個區(qū)間,離散步長為Δ=(-)/。使用離散處的+1個點近似表示軌跡,其中t =+·Δ,=0,1,…,。解耦的軌跡規(guī)劃問題設(shè)計變量X 包含單機狀態(tài)與控制變量及時間步長Δt,即X =[ t],其中z =[s [],u []],=0,1,…,。無人機考慮的初始與終端狀態(tài)[s ,s ]、狀態(tài)與控制邊界[,,,]、動力學(xué)以及威脅規(guī)避約束,均不涉及他機軌跡信息,分別如式(3)~式(6)所示。

    針對無人機碰撞規(guī)避問題,建立如式(7)所示的機間避碰約束,其中表示機間安全距離限制,確保無人機安全性。

    為實現(xiàn)無人機集群同時抵達終端位置,無人機之間需要分享彼此飛行時間信息,并設(shè)定離散時間步長下邊界約束,如式(8)所示。通過延長飛行時間短無人機的時間步長,或調(diào)整無人機的飛行速度,使得所有無人機飛行時間趨于一致,保證無人機集群形成預(yù)設(shè)的編隊隊形。

    式中:Δ表示集群軌跡規(guī)劃的時間步長下邊界值,具體取值方法詳見2.4節(jié)。

    考慮機間避碰與時間協(xié)同約束,建立無人機-的非凸軌跡規(guī)劃問題模型P1,如式(9)所示:

    2 動態(tài)優(yōu)先級解耦的序列凸規(guī)劃方法

    本節(jié)首先建立集群軌跡凸規(guī)劃子問題,然后設(shè)計分布式軌跡規(guī)劃架構(gòu),詳細(xì)描述動態(tài)優(yōu)先級解耦機制與時間一致約束更新準(zhǔn)則,最后給出動態(tài)優(yōu)先級解耦的序列凸規(guī)劃算法具體流程。

    2.1 解耦的凸規(guī)劃子問題建模

    使用一階泰勒展開將非線性動力學(xué)與非凸威脅規(guī)避約束凸化為式(10)與式(11)的仿射約束。

    另外,針對耦合的非凸機間避碰約束,基于軌跡凍結(jié)思想,在單機軌跡規(guī)劃每一步迭代中將其他無人機軌跡視為固定不變,每架無人機僅需規(guī)避他機的凍結(jié)軌跡點位置,即上一步迭代結(jié)果。由于凍結(jié)軌跡在每次規(guī)劃時已知,因此避碰約束僅包含無人機-的狀態(tài)變量,實現(xiàn)避碰約束解耦。在此基礎(chǔ)上,使用一階泰勒展開凸化解耦機間避碰約束,得到式(12)所示的仿射形式。

    引入信賴域約束,通過非凸約束凸化,建立集群軌跡的解耦凸規(guī)劃子問題,如式(13)所示,其中=[ρ,ρ,ρ,ρ,ρ,ρ]為信賴域半徑。

    2.2 分布式軌跡規(guī)劃架構(gòu)

    分布式體系架構(gòu)中無人機處于同等地位,相互之間不存在主從關(guān)系。分布式架構(gòu)依賴無人機之間的通信,通過迭代求解實現(xiàn)機間協(xié)同。因此,本節(jié)給出理想通信假設(shè)(假設(shè)1):集群個體間保持兩兩通信,能夠有效獲取彼此的軌跡信息,不考慮通信數(shù)量、通信距離、通信帶寬、通信延遲等約束。

    無人機集群分布式軌跡規(guī)劃本質(zhì)上是一個計算平臺并行迭代求解方法,架構(gòu)如圖2所示。在每一輪迭代中,各無人機考慮本機動力學(xué)、威脅規(guī)避與解耦的機間避碰等約束,構(gòu)建各自的單機軌跡規(guī)劃凸規(guī)劃子問題P2。針對耦合的機間避碰約束,每架無人機僅考慮規(guī)避其他無人機上一步迭代的軌跡,不考慮當(dāng)前迭代步他機軌跡的更新,通過軌跡暫時凍結(jié)實現(xiàn)機間避碰與時間一致約束解耦。每次迭代中,無人機獨立求解本機軌跡規(guī)劃問題,無人機之間沒有信息交互,計算較快無人機需等待他機完成本輪軌跡解算。在每一輪迭代結(jié)束后,無人機之間通過通信傳輸彼此最新的軌跡信息,為下一輪迭代提供凍結(jié)軌跡信息。無人機根據(jù)獲取的他機軌跡信息,更新時間步長下邊界約束,建立解耦的機間避碰約束,進行新一輪計算,直到獲得滿足飛行約束的軌跡。

    圖2 無人機集群軌跡分布式規(guī)劃框架Fig.2 Framework of distributed trajectory planning for UAV swarms

    無人機集群協(xié)同飛行的密集特征與動態(tài)特性給算法快速求解可行軌跡帶來了更加嚴(yán)苛的條件。由于無人機規(guī)避他機凍結(jié)軌跡,在密集高動態(tài)集群環(huán)境下,基于相互避碰機制的軌跡迭代可能出現(xiàn)振蕩而難以收斂的問題。為此,本文設(shè)計了飛行時間驅(qū)動的動態(tài)優(yōu)先級解耦機制(具體見2.3節(jié)),改善軌跡迭代的收斂性?;谲壽E凍結(jié)思想,無人機規(guī)避的他機凍結(jié)軌跡與實際軌跡的偏差在信賴域的約束范圍內(nèi),且隨著迭代進行信賴域半徑逐漸縮小,凍結(jié)軌跡與實際軌跡的偏差降低。當(dāng)序列迭代收斂時,凍結(jié)軌跡與實際軌跡趨于一致。因此,基于軌跡凍結(jié)思想的分布式規(guī)劃能夠獲得滿足約束的集群軌跡。

    2.3 飛行時間驅(qū)動的動態(tài)優(yōu)先級解耦機制

    在基于軌跡凍結(jié)思想的解耦規(guī)劃框架下,不合理的機間避碰約束處理機制可能導(dǎo)致集群軌跡規(guī)劃難以收斂。在軌跡迭代過程中,各無人機通信僅得到他機上一步迭代的軌跡信息,而未獲取他機當(dāng)前的軌跡信息。在無人機相互規(guī)避機制下,軌跡迭代可能出現(xiàn)振蕩情況。圖3為機間避碰反復(fù)振蕩示例,在第次迭代時,由于無人機-考慮規(guī)避無人機-第-1次迭代的位置,無人機-在虛線所示的安全區(qū)域外飛行,逐漸靠近無人機-當(dāng)前位置。在下一輪+1次迭代時,相互避碰機制將會保守的驅(qū)使兩架無人遠離彼此。后續(xù)迭代中兩架無人機可能反復(fù)靠近與遠離,難以獲取滿足避碰約束的軌跡。

    圖3 碰撞規(guī)避振蕩現(xiàn)象示意圖Fig.3 Illustration of collision-avoidance oscillation

    為了處理上述問題,使用優(yōu)先級驅(qū)動的單向避碰規(guī)則,給無人機分配高低優(yōu)先級,低優(yōu)先級無人機進行軌跡規(guī)劃時,需規(guī)避高優(yōu)先級無人機,而高優(yōu)先級無人機無需考慮對低優(yōu)先級個體的規(guī)避,從而避免無人機相互避碰而引起的軌跡迭代振蕩問題。圖4給出了6架無人機優(yōu)先級次序示例,其中P 表示無人機優(yōu)先級,下標(biāo)=1,2,…,為無人機編號,上標(biāo)=1,2,…,為優(yōu)先級等級。例如,P表示無人機-1優(yōu)先級等級為3,需要規(guī)避無人機-2、無人機-5與無人機-6;P表示無人機-3優(yōu)先級最低;P表示無人機-5具有最高的優(yōu)先級,無需考慮機間避碰約束。

    圖4 避碰優(yōu)先級示意圖Fig.4 Illustration of collision-avoidance priority

    不同的優(yōu)先級生成方法對于集群軌跡規(guī)劃收斂速度具有重要影響,合適的優(yōu)先級可以提高集群解耦軌跡規(guī)劃效率。本文提出飛行時間驅(qū)動的動態(tài)優(yōu)先級生成方法,在每次迭代結(jié)束后,根據(jù)無人機凍結(jié)軌跡對應(yīng)飛行時間,自適應(yīng)調(diào)整無人機優(yōu)先級次序,改善軌跡規(guī)劃的收斂性。無人機-的優(yōu)先級評價指標(biāo)κ取為無人機-從起始點到目標(biāo)點的飛行時間·Δt,如式(14)所示:

    由于飛行時間短無人機具有更多的剩余飛行空間,其成功規(guī)避他機的概率更高,因此對飛行時間短的無人機分配低的優(yōu)先級,充分利用該類無人機的剩余飛行空間進行軌跡調(diào)整。若2架無人機飛行時間相同,則隨機分配其優(yōu)先級次序。

    根據(jù)飛行時間·Δt確定集群優(yōu)先級關(guān)系,將無人機-所需規(guī)避的無人機集合Π表示為

    根據(jù)優(yōu)先級確定的無人機規(guī)避集合,集群內(nèi)無人機的避碰約束可表示為

    在每一輪迭代求解結(jié)束后,動態(tài)優(yōu)先級生成機制根據(jù)新生成的軌跡信息,對無人機優(yōu)先級次序進行調(diào)整,如式(17)所示:

    針對任意2架無人機,如果原高優(yōu)先級無人機飛行時間小于低優(yōu)先級無人機,且時間差大于閾值,則進行優(yōu)先級次序互換,否則優(yōu)先級次序不變。若低優(yōu)先級無人機飛行時間仍然小于高優(yōu)先級無人機,則優(yōu)先級次序保持不變?;谒O(shè)計的動態(tài)優(yōu)先級生成方法,只有無人機飛行時間變化超過一定范圍后才進行優(yōu)先級調(diào)整,避免微小變動引發(fā)的優(yōu)先級次序反復(fù)變化問題。

    2.4 時間一致約束更新準(zhǔn)則

    針對集群解耦軌跡規(guī)劃時間一致問題,增加了時間步長下邊界約束Δ??紤]到凸規(guī)劃子問題中的動力學(xué)約束是線性近似的結(jié)果,無人機軌跡迭代過程中存在前后兩次迭代結(jié)果相差較大的情況,因此直接取所有無人機軌跡離散步長最大值作為時間步長下邊界,可能導(dǎo)致整體飛行時間的顯著增大。為了避免該現(xiàn)象引起集群飛行時間下限非正常增長的情況,在計算時間步長下限時,僅考慮連續(xù)兩次迭代中時間步長變化較小無人機的飛行時間,如式(18)所示:

    式中:表示時間步長變化判斷閾值;上標(biāo)表示軌跡迭代索引。

    2.5 動態(tài)優(yōu)先級解耦的序列凸規(guī)劃算法流程

    DPD-SCP方法求解流程主要包括3個階段,初始直線軌跡生成的第1階段,不考慮避碰約束的第2階段和考慮所有約束的第3階段。第2和第3階段需要滿足式(19)所示的時間一致收斂條件,其中表示集群時間一致收斂閾值。

    動態(tài)優(yōu)先級解耦的序列凸規(guī)劃偽代碼如算法1所示,具體流程如下所述。

    算法1 動態(tài)優(yōu)先級解耦的序列凸規(guī)劃算法

    初始化算法。初始化算法參數(shù),包括軌跡離散時刻數(shù)量、狀態(tài)收斂閾值∈R、初始信賴域半徑、時間一致收斂閾值、時間步長調(diào)整閾值、優(yōu)先級動態(tài)調(diào)整閾值。輸入無人機的初始與終端狀態(tài)[s ,s ]、狀態(tài)與控制邊界約束[,]和[,]、威脅集合等信息。

    (第1~3行) 生成初始軌跡與初始優(yōu)先級。使用線性插值為每架無人機規(guī)劃出連接起始點與目標(biāo)點的直線軌跡,為后續(xù)軌跡迭代提供初值。基于式(15)所示的優(yōu)先級生成方法,根據(jù)初始軌跡時間步長,確定無人機所需規(guī)避的他機集合Π。

    (第4~13行) 規(guī)劃滿足動力學(xué)與時間一致約束的軌跡。迭代過程中,使用式(18)計算時間下邊界值Δ,逐次建立并求解考慮無人機動力學(xué)、初始與終端狀態(tài)、狀態(tài)與控制邊界、時間一致約束的凸規(guī)劃子問題。根據(jù)上一步迭代的軌跡信息,使用式(17)更新無人機規(guī)避集合Π。該階段不斷迭代求解,直到生成滿足收斂條件(20)的軌跡,其中表示狀態(tài)收斂閾值。

    (第14~25行) 規(guī)劃滿足全部約束的協(xié)同軌跡。本階段重新給信賴域賦初始值。在步驟3生成軌跡的基礎(chǔ)上,考慮碰撞規(guī)避約束,使用所提動態(tài)優(yōu)先級解耦機制,迭代規(guī)劃出滿足動力學(xué)、碰撞規(guī)避、時間一致等約束及收斂條件(20)的集群軌跡。

    3 集群軌跡分布式序列凸規(guī)劃收斂性分析

    本節(jié)首先給出理論分析所依賴的基本假設(shè),然后分析DPD-SCP求解集群軌跡規(guī)劃問題的收斂性,并給出定理1及其證明。

    假設(shè)2(集群非凸軌跡規(guī)劃問題解存在性):無人機集群非凸軌跡規(guī)劃問題(P1)至少存在一個可行解,滿足初始與終端狀態(tài)、狀態(tài)與控制邊界、動力學(xué)、威脅規(guī)避、機間避碰與時間一致約束。

    在假設(shè)2解存在性的基礎(chǔ)上,針對轉(zhuǎn)化的集群軌跡規(guī)劃的凸規(guī)劃子問題P2,如果序列凸規(guī)劃方法生成有限或無限序列{X },則{X }能夠收斂到至少一個極值點,即序列凸規(guī)劃至少能夠求解得到問題P2的一個局部最優(yōu)解。

    問題P2中動力學(xué)約束為仿射等式形式,初始與終端狀態(tài)約束為線性等式形式,狀態(tài)與控制邊界、威脅規(guī)避、機間避碰以及信賴域約束均為仿射不等式形式,因此問題P2 所考慮的約束構(gòu)建了一個凸緊集。由于問題P2的目標(biāo)函數(shù)在凸緊集上是連續(xù)可微的,依據(jù)Bolzano-Weierstrass定理,在凸緊集中問題P2 至少存在一個極值點,即局部最優(yōu)解。

    若解耦的非凸軌跡規(guī)劃問題P1包含可微目標(biāo)函數(shù)、如式(6)與式(7)所示的威脅規(guī)避與機間避碰凹不等式約束、如式(1)所示的無人機非線性動力學(xué)等式約束,序列凸規(guī)劃能夠通過迭代求解獲得原非凸軌跡規(guī)劃問題P1的局部最優(yōu)解。

    引理1說明了序列凸規(guī)劃能夠獲得問題P2的局部最優(yōu)解。下面重點分析問題P2 的局部最優(yōu)解同樣是問題P1局部最優(yōu)解。

    針對考慮凹不等式約束(機間避碰與威脅規(guī)避)的軌跡規(guī)劃問題,文獻[19]利用凹約束Hessian矩陣負(fù)定特性,證明了序列凸規(guī)劃能夠得到凹不等式約束下軌跡規(guī)劃問題的局部最優(yōu)解。

    針對考慮無人機非線性動力學(xué)等式約束的軌跡規(guī)劃問題,文獻[20]基于罰函數(shù)方法,證明了序列凸規(guī)劃能夠得到非線性動力學(xué)約束下軌跡規(guī)劃問題的局部最優(yōu)解。

    綜上分析可得序列凸規(guī)劃方法能夠得到非凸軌跡規(guī)劃問題P1的局部最優(yōu)解。

    針對非凸軌跡規(guī)劃問題P1,在分布式軌跡規(guī)劃架構(gòu)下,通過設(shè)計飛行時間驅(qū)動的動態(tài)優(yōu)先級解耦機制,定制時間協(xié)同約束更新準(zhǔn)則,使得DPD-SCP能夠收斂到滿足機間避碰與時間一致約束的集群軌跡。

    基于引理1與引理2,序列凸規(guī)劃能夠為每架無人機規(guī)劃出滿足初始與終端狀態(tài)、狀態(tài)與控制邊界、無人機動力學(xué)、威脅規(guī)避約束的局部最優(yōu)解。

    針對機間避碰約束,DPD-SCP基于軌跡凍結(jié)思想實現(xiàn)問題解耦。隨著軌跡序列迭代過程進行,信賴域半徑逐漸縮減,由式(21)可知迭代的軌跡逐漸變得與凍結(jié)軌跡一致。

    當(dāng)軌跡規(guī)劃收斂時,無人機規(guī)避的他機軌跡即為最新軌跡。因此,最終的集群軌跡結(jié)果能夠滿足機間避碰約束。

    后續(xù)基于反證法重點分析DPD-SCP 能夠收斂到時間一致的集群軌跡。

    不失一般性,第次迭代,無人機-以最小化飛行時間為目標(biāo)函數(shù),考慮時間下邊界約束(18),通過序列規(guī)劃得到滿足約束的飛行時間結(jié)果,如式(22)所示:

    DPD-SCP求解得到每架無人機飛行時間為

    考慮動力學(xué)約束與時間下邊界約束包含時間步長信息,為便于推導(dǎo),建立僅考慮動力學(xué)約束與時間下邊界約束的凸規(guī)劃子問題P3。

    式中:(s ,u t)=0表示線性化后的動力學(xué)等式約束。推導(dǎo)P3 的Karush-Kuhn-Tucker(KKT)條件,如式(26)所示:

    式中:h 為動力學(xué)約束求偏導(dǎo)后的常值;h 與凍結(jié)軌跡相關(guān),與當(dāng)前設(shè)計變量X 無關(guān);λ與分別表示等式與不等式約束的拉格朗日乘子。

    若第次迭代-Δt+Δ=0,則時間下邊界約束成為主動約束。若Δt>Δ,根據(jù)KKT條件第1項與第4項,迭代結(jié)果需滿足式(27),才能獲得滿足KKT 條件的解。

    由集群具有統(tǒng)一的飛行時間下邊界可得

    考慮無人機數(shù)量有界,可得

    由此可證DPD-SCP能夠求解得到滿足機間避碰與時間一致約束的集群軌跡。

    4 仿真試驗結(jié)果與分析

    本節(jié)針對DPD-SCP 開展數(shù)值仿真試驗,在典型集群編隊集結(jié)想定下驗證DPD-SCP的合理性與時效性。通過對比耦合SCP(cSCP)、串行優(yōu)先級解耦SCP(spSCP)互換想定,進一步驗證DPD-SCP的有效性。針對單機軌跡凸規(guī)劃子問題P2,使用SeDu Mi與CVX進行求解?;贛ATLAB R2017a軟件平臺進行數(shù)值仿真運算,PC機硬件為Intel Core i7-6700 3.40 GHz處理器與8 GB運行內(nèi)存。

    4.1 集群編隊想定與參數(shù)設(shè)置

    編隊集結(jié)想定包含15架無人機,要求集群從分散位置形成雁形編隊。無人機初始與終端飛行速度均設(shè)置為35 m/s;初始與終端航跡傾角均為0°;初始與終端航向角分別為0°與90°;無人機之間的避碰距離設(shè)置為100 m;狀態(tài)與控制邊界約束取值如式(30)所示:

    集群編隊互換想定包含100架無人機,初始與終端位置等間距分布在半徑為3 km 的圓上,初末速度為35 m/s,航跡傾角為0°。想定要求處于對角位置的無人機進行位置互換,初末航向角設(shè)置為初始位置朝圓心的方向角。機間安全距離設(shè)置為10 m,狀態(tài)與控制邊界如式(30)所示。

    使用所提DPD-SCP方法求解編隊集結(jié)與編隊重構(gòu)軌跡規(guī)劃問題,軌跡離散數(shù)量設(shè)置為40。初始信賴域半徑、狀態(tài)收斂閾值、時間一致收斂閾值、優(yōu)先級調(diào)整閾值、飛行時間下邊界更新閾值等參數(shù)設(shè)置如式(31)所示。

    cSCP與pdSCP的參數(shù)設(shè)置分別見文獻[11,14],其狀態(tài)收斂閾值與時間一致收斂閾值同DPD-SCP。

    4.2 集群編隊集結(jié)軌跡規(guī)劃

    4.2.1 編隊集結(jié)軌跡規(guī)劃結(jié)果

    DPD-SCP規(guī)劃的編隊集結(jié)軌跡如圖5所示。從圖中結(jié)果可以看出,所生成軌跡能夠引導(dǎo)無人機集群從松散編隊形成較為緊密的雁形編隊,且集群無人機飛行時間均為174.4 s,滿足時間一致約束。三維視圖與水平投影視圖均表明集群飛行軌跡成功規(guī)避了環(huán)境中的威脅。

    圖5 編隊集結(jié)想定下DPD-SCP的軌跡規(guī)劃結(jié)果Fig.5 Trajectory planning results by DPD-SCP on the formation rendezvous scenario

    如圖6所示,在編隊集結(jié)想定下,所生成的集群軌跡滿足機間避碰約束,機間最小距離始終大于安全距離限制(100 m),驗證了動態(tài)優(yōu)先級解耦機制的有效性。綜上分析可得,DPD-SCP方法能夠生成滿足威脅規(guī)避、機間避碰與時間一致約束的飛行軌跡。

    圖6 編隊集結(jié)想定下集群軌跡的機間最小距離Fig.6 Minimum distance among UAVs of the swarm trajectories on the formation rendezvous scenario

    DPD-SCP分布式求解耗時結(jié)果如圖7所示,其中圖上方標(biāo)注表示軌跡迭代序列。針對編隊集結(jié)想定,DPD-SCP通過19次迭代求解得到滿足飛行約束與收斂條件的集群軌跡。DPD-SCP 每步軌跡迭代耗時大約為0.5 s。注意的是,每步軌跡迭代耗時取所有無人機當(dāng)前步迭代耗時的最大值。從結(jié)果中可以得出,優(yōu)先級解耦機制下分布式規(guī)劃通過并行求解將計算壓力分散至每架無人機,增強了方法的可擴展性。

    圖7 編隊集結(jié)想定下DPD-SCP分布式求解耗時Fig.7 Runtime of distributed trajectory planning by DPDSCP on the formation rendezvous scenario

    4.2.2 編隊集結(jié)軌跡規(guī)劃結(jié)果對比分析

    為充分驗證DPD-SCP 方法的有效性,給出不同集群規(guī)模編隊集結(jié)想定下cSCP、spSCP、pdSCP與DPD-SCP目標(biāo)函數(shù)值(飛行時間)對比結(jié)果,如圖8所示。spSCP包含兩層迭代,即外層的協(xié)同迭代層和內(nèi)層的SCP 迭代層。spSCP 在內(nèi)層迭代收斂后,在外層迭代更新時間下邊界約束值,因此spSCP時間下邊界值更新存在一定滯后,易于出現(xiàn)時間下邊界值迅速增長的情況。pdSCP與DPD-SCP將內(nèi)外雙層迭代合并為一層,在每次軌跡迭代后立即進行時間下邊界值調(diào)整。因此,相比于spSCP,pdSCP與DPD-SCP能夠根據(jù)最新的迭代結(jié)果更加及時的進行飛行時間調(diào)整,避免飛行時間下邊界值迅速增長的問題,獲得更短的飛行時間。DPD-SCP 的目標(biāo)函數(shù)與cSCP、pdSCP 相當(dāng),最大偏差不超過3%,表明DPD-SCP規(guī)劃結(jié)果具有良好的時間最優(yōu)性。

    圖8 cSCP、spSCP、pdSCP與DPD-SCP目標(biāo)函數(shù)值Fig.8 Objective function value of cSCP,spSCP,pd-SCP,and DPD-SCP

    為進一步驗證DPD-SCP 方法的時效性,對比cSCP、spSCP、pdSCP 與DPD-SCP 的規(guī)劃耗時,如圖9所示,其中括號中數(shù)據(jù)表示迭代次數(shù)。由結(jié)果可得,DPD-SCP計算效率明顯高于cSCP、spSCP與pdSCP,且隨著無人機規(guī)模增大,DPDSCP效率優(yōu)勢相比于cSCP更加明顯。受益于動態(tài)優(yōu)先級解耦機制,DPD-SCP平均迭代次數(shù)相比于pdSCP降低了大約15%。15架無人機編隊集結(jié)想定下,DPD-SCP求解耗時相比cSCP、spSCP與pdSCP 分別減低了93.7%、88.3%與40.2%。綜上分析可得,DPD-SCP方法能夠降低序列迭代次數(shù),提升軌跡規(guī)劃方法的收斂速度,相比于其他3種方法具有更高的求解效率與更優(yōu)的可擴展性。

    圖9 cSCP、spSCP、pdSCP與DPD-SCP求解耗時對比Fig.9 Runtime comparisons among cSCP,spSCP,pdSCP,and DPD-SCP

    4.3 集群編隊互換軌跡規(guī)劃

    100架無人機編隊互換軌跡規(guī)劃結(jié)果如圖10所示,機間最小距離如圖11所示。針對強耦合的大規(guī)模集群軌跡規(guī)劃問題,DPD-SCP 通過26次迭代規(guī)劃出滿足約束的集群編隊互換軌跡,集群飛行時間(目標(biāo)函數(shù)值)為209.8 s。DPD-SCP求解耗時9.9 s,然而對比方法cSCP、spSCP 與pdSCP難以在有限時間內(nèi)獲得可行的大規(guī)模集群編隊互換軌跡。相比于15架無人機編隊集結(jié)軌跡規(guī)劃,100 架無人機軌跡規(guī)劃耗時僅增加1.1 s,表明DPD-SCP具有良好的可擴展性。

    圖10 編隊互換想定下DPD-SCP的軌跡規(guī)劃結(jié)果Fig.10 Trajectory planning results by DPD-SCP on the formation exchange scenario

    圖11 編隊互換想定下集群軌跡的機間最小距離Fig.11 Minimum distance among UAVs of the swarm trajectories on the formation exchange scenario

    5 結(jié) 論

    1)提出了動態(tài)優(yōu)先級解耦的序列凸規(guī)劃方法,將集群軌跡規(guī)劃問題分解為一組單機分布式規(guī)劃問題,降低了問題維度與求解復(fù)雜度。

    2)發(fā)展了飛行時間驅(qū)動的動態(tài)優(yōu)先級解耦機制,根據(jù)飛行時間動態(tài)調(diào)整無人機優(yōu)先級并更新時間一致約束,提高集群軌跡規(guī)劃收斂速度。

    3)理論分析證明了DPD-SCP能夠生成滿足碰撞規(guī)避與時間一致約束的集群軌跡。數(shù)值仿真試驗驗證了DPD-SCP 的合理性與時效性,結(jié)果表明相比于cSCP、spSCP與pdSCP,DPD-SCP具備良好的時間最優(yōu)性與顯著的效率優(yōu)勢。

    猜你喜歡
    編隊步長集群
    2023年1月25日,美軍一次演習(xí)期間,空軍正在進行編隊飛行
    軍事文摘(2023年5期)2023-03-27 08:56:26
    集群式AUV可控分群控制算法
    基于Armijo搜索步長的BFGS與DFP擬牛頓法的比較研究
    一種無人機集群發(fā)射回收裝置的控制系統(tǒng)設(shè)計
    電子制作(2018年11期)2018-08-04 03:25:40
    基于事件驅(qū)動的多飛行器編隊協(xié)同控制
    Python與Spark集群在收費數(shù)據(jù)分析中的應(yīng)用
    基于RQPSO-DMPC的多無人機編隊自主重構(gòu)控制方法
    勤快又呆萌的集群機器人
    基于逐維改進的自適應(yīng)步長布谷鳥搜索算法
    基于預(yù)測控制的無人機編隊內(nèi)部避碰
    欧美激情极品国产一区二区三区| 亚洲精品av麻豆狂野| 免费高清在线观看日韩| 国产毛片在线视频| 中文字幕制服av| 97精品久久久久久久久久精品| 我要看黄色一级片免费的| 国产亚洲午夜精品一区二区久久| 七月丁香在线播放| 亚洲精品,欧美精品| 欧美最新免费一区二区三区| 国产成人一区二区在线| 赤兔流量卡办理| 欧美亚洲日本最大视频资源| 99久久综合免费| 又黄又粗又硬又大视频| 久久午夜综合久久蜜桃| 超色免费av| 成人毛片60女人毛片免费| 看十八女毛片水多多多| 如何舔出高潮| 亚洲精品中文字幕在线视频| 国产精品久久久久久精品电影小说| 亚洲,一卡二卡三卡| xxxhd国产人妻xxx| 大香蕉久久成人网| 欧美精品一区二区免费开放| 大码成人一级视频| 成年人免费黄色播放视频| 青春草视频在线免费观看| 青春草视频在线免费观看| 青春草视频在线免费观看| 精品一品国产午夜福利视频| 新久久久久国产一级毛片| 青春草国产在线视频| 久久久久精品性色| 久久99热这里只频精品6学生| 国产1区2区3区精品| 欧美精品人与动牲交sv欧美| 久久免费观看电影| 操出白浆在线播放| 人成视频在线观看免费观看| 国产成人精品久久二区二区91 | 一边摸一边抽搐一进一出视频| 99香蕉大伊视频| 在线看a的网站| 看免费成人av毛片| 国产无遮挡羞羞视频在线观看| 一二三四在线观看免费中文在| 亚洲精品第二区| 人妻人人澡人人爽人人| 精品卡一卡二卡四卡免费| 色视频在线一区二区三区| 欧美精品av麻豆av| 亚洲av电影在线观看一区二区三区| 少妇人妻久久综合中文| 伊人亚洲综合成人网| 亚洲在久久综合| 久久久亚洲精品成人影院| 亚洲男人天堂网一区| 午夜影院在线不卡| 精品亚洲成a人片在线观看| 18禁观看日本| 欧美成人精品欧美一级黄| 建设人人有责人人尽责人人享有的| 韩国av在线不卡| 啦啦啦啦在线视频资源| 亚洲三区欧美一区| 欧美成人午夜精品| 国产99久久九九免费精品| 久久久精品94久久精品| 爱豆传媒免费全集在线观看| 各种免费的搞黄视频| 国产成人免费观看mmmm| 一级片'在线观看视频| 欧美另类一区| 免费在线观看黄色视频的| 亚洲熟女精品中文字幕| 69精品国产乱码久久久| 99热国产这里只有精品6| 亚洲一级一片aⅴ在线观看| 黑人猛操日本美女一级片| 国产97色在线日韩免费| 别揉我奶头~嗯~啊~动态视频 | 黑人欧美特级aaaaaa片| 大码成人一级视频| av片东京热男人的天堂| 国产欧美日韩综合在线一区二区| 亚洲人成电影观看| 亚洲av日韩在线播放| 免费高清在线观看日韩| 国产精品.久久久| 99re6热这里在线精品视频| 亚洲成人国产一区在线观看 | 久久精品国产a三级三级三级| 性色av一级| 日韩一区二区三区影片| 国产精品熟女久久久久浪| 丰满少妇做爰视频| 观看美女的网站| 久久韩国三级中文字幕| 亚洲自偷自拍图片 自拍| 综合色丁香网| 多毛熟女@视频| 成人三级做爰电影| 免费高清在线观看视频在线观看| 成人黄色视频免费在线看| 街头女战士在线观看网站| 国产黄频视频在线观看| 18禁裸乳无遮挡动漫免费视频| 日本猛色少妇xxxxx猛交久久| 亚洲精品av麻豆狂野| 咕卡用的链子| 99九九在线精品视频| 天天躁日日躁夜夜躁夜夜| 久久精品久久久久久久性| 国产欧美日韩一区二区三区在线| 999精品在线视频| 日韩电影二区| 国产精品国产av在线观看| 久久久欧美国产精品| 人人妻人人爽人人添夜夜欢视频| 宅男免费午夜| 久久久精品免费免费高清| 天天影视国产精品| 国产一卡二卡三卡精品 | 人体艺术视频欧美日本| 波野结衣二区三区在线| 欧美最新免费一区二区三区| 国产成人精品久久久久久| 国产成人精品无人区| 日韩av不卡免费在线播放| 国产成人精品在线电影| 国产免费现黄频在线看| 中文字幕人妻丝袜制服| 大陆偷拍与自拍| 国产成人精品在线电影| a级片在线免费高清观看视频| www.av在线官网国产| 国产成人精品久久二区二区91 | 久久影院123| www.熟女人妻精品国产| 国产片内射在线| 国产成人免费观看mmmm| 自拍欧美九色日韩亚洲蝌蚪91| 欧美日韩一级在线毛片| 久久久久精品国产欧美久久久 | 在线亚洲精品国产二区图片欧美| 男人舔女人的私密视频| 韩国精品一区二区三区| 免费黄频网站在线观看国产| 精品人妻熟女毛片av久久网站| 亚洲精品美女久久av网站| 欧美日韩亚洲综合一区二区三区_| 免费观看人在逋| 欧美精品人与动牲交sv欧美| 久久精品亚洲av国产电影网| 欧美日韩一级在线毛片| 国产精品人妻久久久影院| 中文精品一卡2卡3卡4更新| www.熟女人妻精品国产| 日日摸夜夜添夜夜爱| 老司机亚洲免费影院| 国产精品久久久久成人av| 亚洲国产欧美网| 黄色视频在线播放观看不卡| 国产无遮挡羞羞视频在线观看| 女人高潮潮喷娇喘18禁视频| 天天影视国产精品| 男女床上黄色一级片免费看| 夫妻性生交免费视频一级片| 中文字幕另类日韩欧美亚洲嫩草| 午夜福利网站1000一区二区三区| 亚洲av国产av综合av卡| 成人黄色视频免费在线看| 国产一区亚洲一区在线观看| 日韩av免费高清视频| 亚洲情色 制服丝袜| 国产成人a∨麻豆精品| 老司机影院成人| 啦啦啦啦在线视频资源| 亚洲精品一区蜜桃| 日本欧美视频一区| 国产毛片在线视频| 天天添夜夜摸| 欧美最新免费一区二区三区| 最近最新中文字幕大全免费视频 | 99国产综合亚洲精品| 久久天躁狠狠躁夜夜2o2o | 欧美在线一区亚洲| 又大又爽又粗| 69精品国产乱码久久久| 色综合欧美亚洲国产小说| 国产片内射在线| 卡戴珊不雅视频在线播放| 国产精品国产三级国产专区5o| 欧美av亚洲av综合av国产av | 亚洲精品国产一区二区精华液| 午夜久久久在线观看| 亚洲一区二区三区欧美精品| 色精品久久人妻99蜜桃| 亚洲美女视频黄频| 男女国产视频网站| 国产成人免费无遮挡视频| 美女国产高潮福利片在线看| 欧美av亚洲av综合av国产av | 一边亲一边摸免费视频| 热re99久久国产66热| 老司机在亚洲福利影院| 国产精品久久久久久久久免| 青春草视频在线免费观看| 啦啦啦 在线观看视频| 久久久久久久久久久久大奶| 日韩欧美精品免费久久| 王馨瑶露胸无遮挡在线观看| 在现免费观看毛片| 新久久久久国产一级毛片| 成人免费观看视频高清| 亚洲一区二区三区欧美精品| 视频区图区小说| 男女国产视频网站| 水蜜桃什么品种好| 午夜精品国产一区二区电影| 日韩精品免费视频一区二区三区| 国产成人精品福利久久| 国产黄色免费在线视频| 日韩中文字幕视频在线看片| 久久久久人妻精品一区果冻| 卡戴珊不雅视频在线播放| 欧美亚洲日本最大视频资源| 在线观看免费视频网站a站| 国产高清不卡午夜福利| 制服诱惑二区| 熟女少妇亚洲综合色aaa.| 亚洲国产最新在线播放| 99热全是精品| 久久久国产欧美日韩av| 性高湖久久久久久久久免费观看| 免费高清在线观看视频在线观看| 亚洲一级一片aⅴ在线观看| 国产免费视频播放在线视频| 五月天丁香电影| 亚洲国产精品国产精品| 蜜桃在线观看..| 久久99一区二区三区| 欧美人与性动交α欧美精品济南到| 国产激情久久老熟女| 日韩欧美精品免费久久| a 毛片基地| 日韩制服丝袜自拍偷拍| 欧美激情 高清一区二区三区| 欧美激情高清一区二区三区 | 王馨瑶露胸无遮挡在线观看| 亚洲熟女毛片儿| 亚洲国产精品999| 中文天堂在线官网| 精品一区二区三区四区五区乱码 | 99久久99久久久精品蜜桃| 日韩一区二区三区影片| 久久精品国产亚洲av涩爱| 久久久久精品久久久久真实原创| 午夜福利视频精品| 搡老岳熟女国产| 亚洲精品久久久久久婷婷小说| 丰满乱子伦码专区| 啦啦啦啦在线视频资源| 国产高清不卡午夜福利| 亚洲成国产人片在线观看| 亚洲成人手机| 欧美成人精品欧美一级黄| 19禁男女啪啪无遮挡网站| 欧美日韩视频精品一区| 美女福利国产在线| 高清在线视频一区二区三区| 丝袜美腿诱惑在线| 色婷婷av一区二区三区视频| 久久 成人 亚洲| 黄网站色视频无遮挡免费观看| 欧美老熟妇乱子伦牲交| 99热国产这里只有精品6| 五月天丁香电影| 中文字幕人妻丝袜一区二区 | 性色av一级| 少妇被粗大的猛进出69影院| 美女脱内裤让男人舔精品视频| 欧美日韩成人在线一区二区| 日本爱情动作片www.在线观看| 免费黄网站久久成人精品| 国产伦人伦偷精品视频| 欧美精品av麻豆av| 女人高潮潮喷娇喘18禁视频| 一级片免费观看大全| 两个人看的免费小视频| 精品人妻一区二区三区麻豆| 国产精品久久久久久人妻精品电影 | 青春草视频在线免费观看| 午夜福利网站1000一区二区三区| 国产人伦9x9x在线观看| 人人妻,人人澡人人爽秒播 | 亚洲视频免费观看视频| 91国产中文字幕| 午夜免费鲁丝| 久久久久久久国产电影| 最近最新中文字幕大全免费视频 | 午夜福利影视在线免费观看| 久久久欧美国产精品| 久久性视频一级片| 日本爱情动作片www.在线观看| 91成人精品电影| 欧美激情高清一区二区三区 | 日本91视频免费播放| 亚洲精品日韩在线中文字幕| 久久久久精品国产欧美久久久 | 国产一区二区激情短视频 | 大话2 男鬼变身卡| 自拍欧美九色日韩亚洲蝌蚪91| 国产一级毛片在线| 免费观看av网站的网址| 国产视频首页在线观看| 无遮挡黄片免费观看| 成人亚洲欧美一区二区av| 街头女战士在线观看网站| 亚洲美女视频黄频| 久久久久精品性色| 亚洲国产日韩一区二区| 日韩av免费高清视频| 十八禁高潮呻吟视频| av网站免费在线观看视频| 久久午夜综合久久蜜桃| 一级爰片在线观看| 人人妻人人澡人人看| 亚洲熟女毛片儿| 亚洲精品aⅴ在线观看| 午夜日韩欧美国产| 欧美黑人欧美精品刺激| 国产成人啪精品午夜网站| 成年av动漫网址| 亚洲人成电影观看| 中文字幕高清在线视频| 亚洲人成网站在线观看播放| 中国三级夫妇交换| 在线观看www视频免费| 最近最新中文字幕大全免费视频 | 日韩成人av中文字幕在线观看| 日韩视频在线欧美| av福利片在线| 久久久久国产精品人妻一区二区| 成人亚洲欧美一区二区av| 男女高潮啪啪啪动态图| 亚洲图色成人| 国产精品 国内视频| netflix在线观看网站| 人妻一区二区av| 一边亲一边摸免费视频| 无遮挡黄片免费观看| 亚洲美女视频黄频| 国产一级毛片在线| 一级,二级,三级黄色视频| 国产精品久久久久成人av| 久久久久精品人妻al黑| 国产视频首页在线观看| 欧美97在线视频| 一本色道久久久久久精品综合| 亚洲美女搞黄在线观看| 在线观看免费日韩欧美大片| av电影中文网址| 久久久久久久久久久免费av| 久久精品久久精品一区二区三区| 亚洲精华国产精华液的使用体验| 大片电影免费在线观看免费| 97在线人人人人妻| 国产国语露脸激情在线看| 亚洲欧美一区二区三区国产| 久久女婷五月综合色啪小说| 天美传媒精品一区二区| 国产精品国产av在线观看| 一级片'在线观看视频| 一个人免费看片子| 视频区图区小说| 老汉色∧v一级毛片| 亚洲av国产av综合av卡| 亚洲精品日本国产第一区| 成人亚洲欧美一区二区av| av国产精品久久久久影院| 久久av网站| 久久ye,这里只有精品| avwww免费| 国产精品人妻久久久影院| 97在线人人人人妻| bbb黄色大片| 超碰97精品在线观看| 最新的欧美精品一区二区| 老司机影院成人| 免费观看av网站的网址| 大码成人一级视频| 人人妻,人人澡人人爽秒播 | www.av在线官网国产| 欧美久久黑人一区二区| 精品一品国产午夜福利视频| 久久久久视频综合| 亚洲国产精品国产精品| 少妇人妻 视频| 18禁动态无遮挡网站| av在线观看视频网站免费| 老司机影院成人| 中文字幕另类日韩欧美亚洲嫩草| av卡一久久| 国产在线视频一区二区| 熟女少妇亚洲综合色aaa.| 国产精品麻豆人妻色哟哟久久| 极品人妻少妇av视频| 伊人久久大香线蕉亚洲五| 日本一区二区免费在线视频| 纯流量卡能插随身wifi吗| 男人操女人黄网站| 久久久精品区二区三区| 久久久亚洲精品成人影院| 中文乱码字字幕精品一区二区三区| 国产av码专区亚洲av| av国产久精品久网站免费入址| 看十八女毛片水多多多| 啦啦啦视频在线资源免费观看| 欧美黑人欧美精品刺激| 成人漫画全彩无遮挡| 欧美老熟妇乱子伦牲交| 久久午夜综合久久蜜桃| a级片在线免费高清观看视频| 国产亚洲欧美精品永久| 日韩制服丝袜自拍偷拍| 在线观看免费午夜福利视频| 国产精品99久久99久久久不卡 | 国产1区2区3区精品| 亚洲,欧美,日韩| 国产高清国产精品国产三级| av视频免费观看在线观看| 亚洲天堂av无毛| 中国国产av一级| 爱豆传媒免费全集在线观看| 国产精品久久久久久久久免| 国产免费福利视频在线观看| 夜夜骑夜夜射夜夜干| 人人妻人人爽人人添夜夜欢视频| 久久久久国产一级毛片高清牌| 欧美 日韩 精品 国产| 美女大奶头黄色视频| 久久久久精品国产欧美久久久 | 天天影视国产精品| 只有这里有精品99| 老司机亚洲免费影院| 熟女av电影| 亚洲精品乱久久久久久| 亚洲国产欧美日韩在线播放| 制服丝袜香蕉在线| 人人澡人人妻人| 日韩制服丝袜自拍偷拍| a级毛片在线看网站| 欧美人与性动交α欧美软件| 色94色欧美一区二区| 国产成人啪精品午夜网站| 人人妻,人人澡人人爽秒播 | 欧美在线黄色| 又大又黄又爽视频免费| 性色av一级| 丝袜人妻中文字幕| 久久久久网色| 亚洲av日韩精品久久久久久密 | 黄频高清免费视频| 黄色怎么调成土黄色| 国产免费又黄又爽又色| 99香蕉大伊视频| 亚洲五月色婷婷综合| 国产免费福利视频在线观看| 亚洲国产最新在线播放| 九草在线视频观看| 黄片播放在线免费| 久久久欧美国产精品| 国产成人啪精品午夜网站| 无遮挡黄片免费观看| 99热网站在线观看| 午夜精品国产一区二区电影| 又大又爽又粗| 我要看黄色一级片免费的| 老司机影院毛片| 啦啦啦在线免费观看视频4| 亚洲成人国产一区在线观看 | 国产亚洲最大av| 波多野结衣av一区二区av| 日韩不卡一区二区三区视频在线| 亚洲精品国产区一区二| 伊人亚洲综合成人网| 一区二区三区四区激情视频| 国产精品香港三级国产av潘金莲 | 亚洲av中文av极速乱| 亚洲精品日本国产第一区| 免费观看av网站的网址| 欧美日韩国产mv在线观看视频| 国产一区二区三区综合在线观看| 欧美另类一区| 国产亚洲精品第一综合不卡| 亚洲一卡2卡3卡4卡5卡精品中文| 国产 精品1| 免费观看av网站的网址| 99久久99久久久精品蜜桃| 十八禁网站网址无遮挡| 欧美中文综合在线视频| 巨乳人妻的诱惑在线观看| 日本一区二区免费在线视频| 热re99久久精品国产66热6| 久久天躁狠狠躁夜夜2o2o | 亚洲,一卡二卡三卡| 欧美在线黄色| 精品久久久久久电影网| 婷婷色av中文字幕| 美女大奶头黄色视频| 丰满少妇做爰视频| 精品人妻熟女毛片av久久网站| 欧美少妇被猛烈插入视频| 无遮挡黄片免费观看| 人人妻人人澡人人看| 建设人人有责人人尽责人人享有的| 狠狠婷婷综合久久久久久88av| 亚洲精品av麻豆狂野| 久久久欧美国产精品| 久久久久视频综合| 精品亚洲乱码少妇综合久久| 一区在线观看完整版| 亚洲精品第二区| a级毛片在线看网站| 亚洲自偷自拍图片 自拍| 夫妻性生交免费视频一级片| 久久精品国产综合久久久| 国产在线免费精品| 精品第一国产精品| 亚洲,欧美精品.| 一级毛片电影观看| 91成人精品电影| 99热网站在线观看| 97在线人人人人妻| 精品一区二区三区四区五区乱码 | 日韩成人av中文字幕在线观看| 纯流量卡能插随身wifi吗| 精品福利永久在线观看| 精品一区在线观看国产| 日韩欧美一区视频在线观看| 操出白浆在线播放| 日韩制服丝袜自拍偷拍| 在线观看免费午夜福利视频| 国产欧美日韩一区二区三区在线| 国产一区二区三区av在线| 亚洲精品国产区一区二| 成人黄色视频免费在线看| 国产精品国产三级国产专区5o| 国产精品偷伦视频观看了| 激情视频va一区二区三区| 在线观看免费日韩欧美大片| 妹子高潮喷水视频| 成人黄色视频免费在线看| 热re99久久精品国产66热6| 欧美亚洲 丝袜 人妻 在线| 欧美亚洲日本最大视频资源| 国产一区二区三区av在线| 国产欧美日韩一区二区三区在线| 别揉我奶头~嗯~啊~动态视频 | 久久天躁狠狠躁夜夜2o2o | 亚洲精品日本国产第一区| 久久精品国产亚洲av高清一级| 天天躁日日躁夜夜躁夜夜| 黄色视频不卡| 精品少妇久久久久久888优播| 国产不卡av网站在线观看| 亚洲国产欧美在线一区| 国产亚洲av片在线观看秒播厂| av有码第一页| 久久午夜综合久久蜜桃| 亚洲成人国产一区在线观看 | 黑人猛操日本美女一级片| 久久久欧美国产精品| 国产精品欧美亚洲77777| av视频免费观看在线观看| 黑人猛操日本美女一级片| 成人午夜精彩视频在线观看| 欧美国产精品一级二级三级| 秋霞伦理黄片| 久久ye,这里只有精品| 免费在线观看完整版高清| 久久久久久久久免费视频了| 尾随美女入室| 色视频在线一区二区三区| 中文字幕人妻丝袜一区二区 | 美女中出高潮动态图| 日本猛色少妇xxxxx猛交久久| 亚洲精品久久成人aⅴ小说| 午夜久久久在线观看| 欧美黑人精品巨大| 丰满乱子伦码专区| 国产一卡二卡三卡精品 | 欧美日韩精品网址| 日韩人妻精品一区2区三区| 一级a爱视频在线免费观看| 在线观看免费日韩欧美大片| 亚洲国产成人一精品久久久| 日韩不卡一区二区三区视频在线| 国产免费一区二区三区四区乱码| 一个人免费看片子| 在线观看三级黄色| 国产av一区二区精品久久| 国产视频首页在线观看| 亚洲男人天堂网一区| 亚洲 欧美一区二区三区| 成人亚洲欧美一区二区av| 99久国产av精品国产电影| 1024视频免费在线观看| 中文字幕高清在线视频| 成年美女黄网站色视频大全免费| 国产精品99久久99久久久不卡 |