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

    基于OSG和OSDK的無人機標校系統(tǒng)設計及實現(xiàn)

    2022-12-26 12:54:58虞炳文蔡紅維丁思煒
    計算機測量與控制 2022年12期
    關(guān)鍵詞:應答機航點標校

    虞炳文,蔡紅維,丁思煒,楊 波,王 康

    (西昌衛(wèi)星發(fā)射中心,四川 西昌 615000)

    0 引言

    目前的標校,根據(jù)跟蹤目標的屬性,可以區(qū)分為對靜態(tài)目標的標校以及對動態(tài)目標的標校。

    對靜態(tài)目標的跟蹤標校實現(xiàn)較為簡單,但是需要標校塔或者標校桿配合進行,因此受到場地限制的約束較為明顯。

    通過對動態(tài)目標的跟蹤標校,較為常見的有三種方式,分別是利用標校衛(wèi)星、利用飛機、利用無人機進行標校。

    利用標校衛(wèi)星,即利用天平衛(wèi)星進行標校,優(yōu)點是簡單可行,但是此種方法只能對測控設備的跟蹤性能(基帶指標)進行標校,對設備的動態(tài)性能(伺服指標)則無法進行有效標校。

    利用飛機標校,優(yōu)點是對設備的跟蹤性能和動態(tài)性能都能進行有效的檢驗,但缺點也很明顯,就是成本高昂。

    利用無人機進行標校,優(yōu)點是成本較低,起飛在一定程度上不受場地限制,對測控設備的跟蹤和動態(tài)性能在理論上都能進行有效的驗證,但是缺點是,目前所使用的無人機上可攜帶的應答機較為簡單,以及無人機容易受到天氣等因素影響,驗證精度無法得到有效保證。

    而文中通過對無人機、應答機等的硬件指標設計,對標校相關(guān)軟件設計,提高無人機的標??煽啃裕WC其精度,從而保證無人機標校的可行性。通過對無人機標校系統(tǒng)進行功能需求分析,提出了對于標校軟件功能和無人機、應答機等硬件指標的設計與實現(xiàn),對于進一步提高無人機標校精度與可靠性,推動無人機標校的應用有較強的現(xiàn)實意義。

    1 無人機標校存在的問題

    在前期開展的無人機標校過程中,暴露出一些問題。

    1)無人機在高空中穩(wěn)定性差,容易受到高空風等因素影響,導致不能按照既定飛行軌跡飛行。

    2)目前基地正在使用的標校無人機,攜帶的是信標機,并非應答機,無應答模式。

    3)無人機攜帶的信標機的發(fā)射頻點與信號強度不支持修改。

    4)因機載信標機較為簡易,未配備頻標設備,頻率的穩(wěn)定性較差。

    5)飛行軌跡的設計依靠無人機產(chǎn)家提供的商業(yè)軟件,例如DJI Pilot,并非專業(yè)的標校軟件,因此使用上有很多限制,例如在手動添加飛行軌跡的路徑點時,難以避免地會出現(xiàn)點密度較低,點分布不均勻等情況。另外,在飛行軌跡的導入導出格式上,也會出現(xiàn)不匹配的情況。

    6)專業(yè)的無人機標校軟件的缺失,導致無人機的飛行軌跡的設計無法考慮到很多重要因素,例如被標校設備的指標參數(shù),當時當?shù)氐淖匀灰蛩氐取?/p>

    2 無人機標校軟硬件分析設計

    在此對無人機標校系統(tǒng)進行一個分析及設計,涉及硬件及軟件內(nèi)容。

    2.1 應答機需求分析及設計

    應答機應包含六個模塊,依次為:控制天線、無線通信模塊、控制模塊、應答模塊、射頻天線、供電模塊,應答機示意圖見圖1。

    圖1 應答機平面示意圖

    對機載應答機作如下要求:

    1)應答機的重量主要來源于應答機保護外殼、無線通信模塊、應答模塊、電池。應答機總重量小于15 kg。

    2)供電模塊的輸入端電壓為12 V,電流為2 A,即功率為24 W。

    3)應答機外接3S電池。

    4)可通過地面控制臺無線控制應答機信號開關(guān),調(diào)整信號頻點、調(diào)整信號強度,切換應答及信標模式等。

    2.2 標校無人機需求分析及設計

    標校無人機的重要指標為:無人機載重與飛行穩(wěn)定性。

    1)無人機載重量與無人機的電機、螺旋槳槳葉長度、螺距等密切相關(guān)。電池、電機、螺旋槳選型與搭配很重要,一般情況下,整機重量,應該小于電機最大動力的2/5。

    2)飛行穩(wěn)定性受飛控影響較大。選擇大疆A3 Pro飛控,搭載D-RTK-GNSS,可使得飛行懸停精度達到垂直方向約0.02 m,水平方向約0.01 m。

    3)機架選用六旋翼機架,材質(zhì)輕且堅固。

    4)電池的選擇需要綜合考慮電池的重量及容量。無人機電池容量保證載重10 kg下,可飛行30 min。

    5)無人機遙控天線與應答機射頻天線、應答機通信控制天線區(qū)分開。

    6)無人機可同時接收來自遙控器及地面控制臺的控制信號。遙控器控制無人機進行飛行操作,地面控制臺通過上傳規(guī)劃好的航線驅(qū)動無人機啟動航線飛行。

    無人機示意圖見圖2。

    圖2 無人機俯視圖

    2.3 無人機標校軟件需求分析及設計

    無人機標校軟件是為標校無人機專用設計的桌面端應用軟件,運行在地面控制臺服務器上,其作用是能夠根據(jù)測控設備及機載應答機的性能參數(shù)、指標要求以及當?shù)丨h(huán)境因素,綜合生成一條滿足標校需求的飛行軌跡,并且能夠?qū)w行軌跡上傳至無人機飛控,驅(qū)動標校無人機實施飛行計劃。同時,無人機標校軟件可以實現(xiàn)對機載應答機的遠程控制。

    2.3.1 軟件功能

    無人機標校軟件需要實現(xiàn)以下三個功能:

    1)生成一條可靠的飛行軌跡;

    2)將飛行軌跡導入飛控,并實施;

    3)遠程控制機載應答機。

    2.3.2 開發(fā)環(huán)境

    軟件部分使用較為成熟的C++開發(fā)框架:

    1)操作系統(tǒng):Linux操作系統(tǒng)。

    2)開發(fā)語言:C++。

    3)開發(fā)工具:Qt及QtCreator。

    4)編譯器:GCC 5.4.0/5.5.0以上版本。

    2.3.3 功能設計

    軟件功能設計分為三部分進行闡述。

    2.3.3.1 生成飛行軌跡功能

    生成飛行軌跡的功能是整個軟件部分的基礎內(nèi)容。

    2.3.3.1.1 功能分析

    飛行軌跡的規(guī)劃,需要考慮以下幾個方面的情況:

    1)標校的目的。跟蹤靜態(tài)目標與跟蹤動態(tài)目標所要達成的目標是不同的。跟蹤靜態(tài)目標的通常是為了檢查測控設備的極性、AGC曲線標定。跟蹤動態(tài)目標通常是為了測試設備的伺服性能,即設備方位俯仰上的速度、加速度、加加速度等,能否達到指標要求,因此在設計飛行軌跡時,需考慮其極限值。

    2)飛行軌跡的約束條件。標校無人機允許飛行的最大高度與起飛點位置相關(guān)。測控設備與應答機之間的最小距離與電磁波傳輸特性有關(guān),即電磁波遠場距離公式,見公式(1),其中D為天線口徑,λ為電磁波頻率;最遠距離與測控設備與應答機的發(fā)射信號強度、接收靈敏度有關(guān)。

    3)無人機飛行的干擾因素。主要是環(huán)境因素,包括高空風、大氣折射率、溫濕壓、太陽夾角、月球夾角等。

    4)飛行軌跡的模擬仿真。搭建三維立體場景進行模擬仿真,一方面實現(xiàn)飛行軌跡可視化,一方面驗證各參數(shù)的正確性,可選用OpenSceneGraph及osgEarth函數(shù)庫實現(xiàn)。

    2.3.3.1.2 程序設計

    根據(jù)上述影響分析,對飛行軌跡的功能作如下設計。

    1)設計飛行軌跡生成函數(shù)類,QGenerateTraj。

    2)設計一個結(jié)構(gòu)體trajStruct,包含每個飛行軌跡跡點的數(shù)據(jù)格式值,見代碼 1,其中T為相對時間,X、Y、Z分別為地心固定坐標系下的X軸值、Y軸值、Z軸值,Vx、Vy、Vz分別為在X軸、Y軸、Z軸方向的速度分量。

    代碼1:飛行軌跡點結(jié)構(gòu)體

    struct trajStruct{

    int T;

    int X;

    int Y;

    int Z;

    int Vx;

    int Vy;

    int Vz;

    }

    3)函數(shù)emulateTrajectory(),無返回值,功能為根據(jù)生成的飛行軌跡在三維環(huán)境中進行仿真。

    4)函數(shù)getFlyTrajectory(),返回值為保存為QList的飛行軌跡,即保存為每個跡點的數(shù)據(jù)的容器,功能為根據(jù)輸入的參數(shù)生成飛行軌跡,該函數(shù)在emulateTrajectory()中被調(diào)用。

    5)setOsgSceneParaAndDisplay(QList traj)函數(shù),返回值為QList的飛行軌跡,輸入值為getFlyTrajectory()輸出的結(jié)果數(shù)據(jù),功能為在三維空間中演示輸入的飛行軌跡。該函數(shù)在emulateTrajectory()中被調(diào)用。

    6)函數(shù)setFlyTrajPara(),無返回值,輸入值為各指標參數(shù),功能為設置飛行軌跡設計中需要用到的基本參數(shù),如測站地理坐標、測試指標、飛行限制條件、環(huán)境干擾因素、數(shù)據(jù)輸出格式等。該函數(shù)在getFlyTrajectory()函數(shù)中被調(diào)用。

    7)函數(shù)setFlyTrajPara(),無返回值,輸入值為測試指標參數(shù),功能為設置測試期望達到的指標參數(shù)。該函數(shù)在setFlyTrajPara()被調(diào)用。在該函數(shù)下,根據(jù)指標參數(shù)的不同,分別調(diào)用setElSpeed(int val)設置方位速度,調(diào)用setElAcceleration(int val)設置方位加速度,調(diào)用setElJerk(int val)設置方位加加速度,調(diào)用setAzSpeed(int val)設置方位速度,調(diào)用setAzAcceleration(int val)設置方位加速度,調(diào)用setAzJerk(int val)設置方位加加速度。

    8)函數(shù)setFlyLimitPara(),無返回值,輸入值為飛行軌跡的限制條件,功能為設置因設備性能帶來的限制條件。該函數(shù)在setFlyTrajPara()被調(diào)用。在該函數(shù)下,根據(jù)指標參數(shù)的不同,分別調(diào)用setRadarEmitPower (int val)設置測控設備的發(fā)送功率,調(diào)用setRadarRecvMinVal (int val)設置測控設備的接收靈敏度,調(diào)用setRespEmitPower (int val)設置應答機的發(fā)送功率,調(diào)用setRespRecvMinVal (int val)設置應答機的接收靈敏度,調(diào)用setRemoteDist (int val,int fr)設置并計算遠場距離,其中val為天線口徑,fr為電磁波頻率。

    9)函數(shù)setFlyInterPara(),無返回值,輸入值為環(huán)境因素帶來的干擾參數(shù),功能為設置因環(huán)境因素帶來的干擾。該函數(shù)在setFlyTrajPara()被調(diào)用。在該函數(shù)下,根據(jù)指標參數(shù)的不同,分別調(diào)用ifUpperAirWinds(bool ok)設置是否啟用高空風誤差修正,調(diào)用ifAtmosRef(bool ok)設置是否啟用大氣折射修正,調(diào)用ifTempHumiPressure(bool ok)設置是否啟用溫濕壓修正,調(diào)用ifSunAngle(bool ok)設置是否避開太陽夾角干擾,調(diào)用ifMoonAngle(bool ok)設置是否避開月球夾角干擾。

    函數(shù)調(diào)用關(guān)系見圖3。

    圖3 生成飛行軌跡函數(shù)設計

    2.3.3.1.3 關(guān)鍵技術(shù)實現(xiàn)

    關(guān)鍵技術(shù)主要圍繞與OSG相關(guān)的內(nèi)容。

    2.3.3.1.3.1 三維環(huán)境的搭建

    為搭建一個高還原度、可測量、準確可靠的三維世界,選用開源的osgEarth函數(shù)庫來實現(xiàn)。osgEarth是基于OSG函數(shù)庫二次開發(fā)的,專門用于地理信息系統(tǒng)建模的函數(shù)庫,使用范圍廣,可配置性強。選用osgEarth2.10版本及OSG3.6.4版本進行二次開發(fā)。

    通過osgEarth實現(xiàn)三維建模主要有兩種方法,一種是純代碼形式,所有的配置項通過代碼中調(diào)用函數(shù)庫實現(xiàn);另一種是代碼加配置文件形式,三維地理模型的絕大部分配置內(nèi)容,都可以通過*.earth文件中的配置項實現(xiàn)配置。在無人機標校軟件的設計中使用第二種方式。

    2.3.3.1.3.1.1 編寫*.earth文件

    編寫*.earth文件,可以將其命名為simple.earth配置文件,earth后綴的文件格式,類似于*.xml文件,是用作配置三維地理模型的配置文件。定義地理信息模型,需要最少包含五部分內(nèi)容,一是確定空間參考系,二是確定地形渲染參數(shù),三是加載高程數(shù)據(jù),四是加載紋理信息,五是確定數(shù)據(jù)緩存方式。

    1)確定空間參考系。空間參考系配置選用geocentric,地固系坐標系,即地心為質(zhì)心的空間直角坐標系。

    代碼2:空間參考系配置項

    2)定義地形引擎如何渲染影像數(shù)據(jù)和高程數(shù)據(jù)??蓪Φ乩砟P偷牟逯捣绞?、是否開啟地形表面的光照、加載地形數(shù)據(jù)(瓦片)的策略、多影像數(shù)據(jù)疊加時集成最終影像數(shù)據(jù)的方式、地形瓦片分割的最大層數(shù)、瓦片范圍系數(shù)、瓦片的采樣率、瓦片邊緣率、高程夸張系數(shù)、邊緣緩沖率等參數(shù)進行設置。

    代碼3:地形渲染方式配置項

    3)加載高程數(shù)據(jù)。使用加載DEM圖的方式加載高程數(shù)據(jù),DEM圖是一種每個圖元像素都包含了地理信息,如經(jīng)緯度、高程信息的TIF格式圖。在此使用的DEM圖為包含了中國范圍內(nèi)的1Km精度的高程信息。加載高程數(shù)據(jù)的操作,可以先貼上一張高程精度較低的DEM圖,然后在此基礎上,根據(jù)需求在特定區(qū)域貼上精度更高的DEM圖,如下圖所示。之所以要選擇不同精度的不同范圍的DEM圖,是因為精度如果太高,就會導致DEM圖非常大,加載起來就會非常困難,因此要合理安排DEM圖的精度。

    代碼4:加載高程數(shù)據(jù)配置項

    4)加載紋理信息,即貼圖操作。是為了使得地理模型可以更直觀且美觀的展現(xiàn),如果沒有貼圖操作,則顯示的地理模型就是一個密密麻麻的點云。貼圖操作可以先貼上一張分辨率較低的全球影像圖,然后在此基礎上,根據(jù)需求在特定區(qū)域貼上分辨率更高的影像圖。原因同高程數(shù)據(jù)。

    代碼5:加載紋理信息配置項

    5)確定數(shù)據(jù)緩存的方式和存儲位置。緩存在三維建模中顯得較為重要,因為加載一次高程和紋理圖的數(shù)據(jù)量較大,需要較長時間,如果在每一次運行時都去重新加載,那顯然是不可接受的,因此osgEarth給出的一種方案是,第一次加載完成后,就會生成緩存數(shù)據(jù),以后每次加載,則從緩存數(shù)據(jù)進行加載,這樣會顯著提升效率。

    代碼6:數(shù)據(jù)緩存的配置項

    /media/ybw/SSD/OSG_DATA/MAIN_DATA/FileCache

    2.3.3.1.3.1.2 運行并顯示三維世界

    因為選用Qt作為開發(fā)工具,要將osgEarth顯示的地理模型,顯示在Qt的窗口中。在osgEarth開發(fā)中,至少需要配置兩部分內(nèi)容,一是加載三維模型,二是設置相機操作器。

    1)加載*.earth模型。

    代碼7:讀取模型的代碼

    osg::Node* pNode =

    osgDB::readNodeFile("./Data/simple.earth");

    osgEarth::MapNode* mapNode =

    osgEarth::MapNode::findMapNode(pNode.get());

    2)初始化相機操作器,即相機參數(shù)。osgEarth的界面顯示,實際上是將顯示界面當作一個攝像頭,顯示的是攝像機視角。

    代碼8:設置相機操作器的代碼

    osgEarth::Util::EarthManipulator *em = new osgEarth::Util::EarthManipulator;

    if(mapNode.valid())

    {

    em.get()->setNode(mapNode);

    }

    em.get()->getSettings()->setArcViewpointTransitions(true);

    osgViewer::Viewer * pViewer=this->getOsgViewer();

    pViewer->setCameraManipulator(em.get());

    pViewer->setSceneData(mRoot.get());//添加到場景

    pViewer->realize();

    2.3.3.2 航線導入飛控并實施功能

    在生成了航線之后,就需要考慮如何將該航線轉(zhuǎn)換為無人機可識別的格式并上傳使用。

    2.3.3.2.1 功能分析

    實現(xiàn)飛行軌跡的導入,需要解決幾方面的問題。

    1)將生成的飛行軌跡數(shù)據(jù)整理成飛控程序能識別的格式。

    2)將整理后的飛行軌跡數(shù)據(jù)上傳至飛控。

    3)驅(qū)動飛行器按既定飛行軌跡飛行。

    2.3.3.2.2 程序設計

    大疆無人機設備基于C++的二次開發(fā),大疆官方提供了OSDK開發(fā)工具包,目前最新的版本為V4.0.0。

    2.3.3.2.2.1 DJI OSDK簡介

    在此介紹OSDK開發(fā)包。

    1)DJI OSDK是由大疆自主開發(fā)的一個運行于桌面端的軟件庫,貼合用戶自主進行二次開發(fā)的需要,可個性定制對無人機在飛行中與自動化相關(guān)的的需求,其提供了一些基礎的API,用于實現(xiàn)基本的運動規(guī)劃功能;開發(fā)者在使用調(diào)用規(guī)劃相關(guān)的庫的同時,可以根據(jù)個人需要,對功能進一步擴展,可根據(jù)實際的使用需求,設計并編寫相應的航點任務以及熱點任務,制定一套個性化控制無人機自動化飛行的控制邏輯。

    2)在無人機標校中主要用到的功能是航點規(guī)劃的功能。航點規(guī)劃,簡單來說就是通過設置一系列的軌跡點,連接成線,然后將航跡上傳給無人機,指令控制無人機按照指定的航線啟動飛行,實現(xiàn)無人機根據(jù)既定航線自動化飛行的控制功能。開發(fā)者通過調(diào)用DJI OSDK 的API接口,能夠控制無人機以指定的高度、方向飛往既定的位置,并且執(zhí)行約定好的動作,根據(jù)任務需求,還可以編寫更多的任務動作,控制無人機多次重復執(zhí)行該任務,以此實現(xiàn)多輪次標校的功能。

    3)開發(fā)者在代碼開發(fā)中,調(diào)用航點任務相關(guān)的API,需要指定的參數(shù)為航點數(shù)量和對應的航點類型。航點數(shù)量在最新版本的API中,最多可設置65535個點。航點類型主要包含三種飛行模式,分別為曲率飛行、直線飛行和協(xié)調(diào)轉(zhuǎn)彎。

    4)OSDK庫文件同時還為開發(fā)者提供了更多方便簡潔的功能,以便直接調(diào)用,比如對速度的控制功能,開發(fā)者能夠按照既定任務要求,為不同的航點配置不同的速度,當然,也可以為同一個航點設置多個速度。另外,在無人機執(zhí)行航線飛行任務時,修改或查詢無人機全局巡航速度等的狀態(tài)數(shù)據(jù)的函數(shù),也是事先寫好,可以直接調(diào)用的。

    2.3.3.2.2.2 主要函數(shù)類

    為實現(xiàn)航點任務功能,利用OSDK函數(shù)庫,主要將設計到以下幾個代碼文件:

    1)dji_mission_type.hpp文件。該文件主要用于定義在航線自動飛行中會用到的一些數(shù)據(jù)的結(jié)構(gòu)體文件,主要的內(nèi)容為WaypointV2結(jié)構(gòu)體,其中主要涉及到的內(nèi)容有:longitude為精度值,latitude為緯度值,relativeHeight為高程值,maxFlightSpeed為最大速度值,autoFlightSpeed為自動巡航速度值。

    代碼9:WaypointV2結(jié)構(gòu)體內(nèi)容

    typedef struct WaypointV2

    {

    float64_t longitude;

    float64_t latitude;

    float32_t relativeHeight; /*! relative to takeoff height*/

    DJIWaypointV2FlightPathMode waypointType;

    DJIWaypointV2HeadingMode headingMode;

    WaypointV2Config config;

    uint16_t dampingDistance;

    float32_t heading;

    DJIWaypointV2TurnMode turnMode;

    RelativePosition pointOfInterest;

    float32_t maxFlightSpeed;

    float32_t autoFlightSpeed;

    }WaypointV2;

    2)dji_mission_base.hpp文件。在這部分代碼中,主要實現(xiàn)的是對航線任務的控制函數(shù),start()實現(xiàn)啟動任務,stop()實現(xiàn)停止任務,pause()實現(xiàn)暫停任務,resume()實現(xiàn)重啟任務。

    代碼10:dji_mission_base.hpp主要代碼

    virtual void start(VehicleCallBack callback = 0, UserData userData=0)=0;

    virtual ACK::ErrorCode start(int timer) = 0;

    virtual void stop(VehicleCallBack callback = 0, UserData userData = 0) = 0;

    virtual ACK::ErrorCode stop(int timer) = 0;

    virtual void pause(VehicleCallBack callback = 0, UserData userData = 0) = 0;

    virtual ACK::ErrorCode pause(int timer) = 0;

    virtual void resume(VehicleCallBack callback = 0, UserData userData = 0)=0;

    virtual ACK::ErrorCode resume(int timer) = 0;

    3)dji_waypoint_v2.hpp、dji_waypoint_v2.cpp代碼文件。其中的WaypointV2MissionOperator類為主要功能實現(xiàn)的類,在該類中主要涉及到的函數(shù)有,init(WayPointV2InitSettings *info,int timeout)函數(shù)為實現(xiàn)該類函數(shù)的初始化操作,其中WayPointV2InitSettings為航線任務結(jié)構(gòu)體,在該結(jié)構(gòu)體中主要規(guī)定了任務ID值,missionID,任務重復次數(shù)repeatTimes,航線結(jié)束時的動作finishedAction,最大飛行速度maxFlightSpeed,自動飛行速度autoFlightSpeed,前往第一個任務點的方式gotoFirstWaypointMode,以及裝載了任務航點的容器mission。downloadInitSetting()即從飛控設備下載航跡任務的初始化配置信息。start()函數(shù)用于啟動航線任務,stop()為停止航線任務,pause()函數(shù)用于暫停飛行任務,resume()用于重啟飛行任務,注意到,start()、stop()、pause()、resume()四個函數(shù)都繼承自dji_mission_base.hpp代碼。uploadMission()函數(shù)用于上傳任務航線,downloadMission()用于下載在飛控中的任務航線。uploadAction()用于上傳飛行器動作。RegisterMissionEventCallback()和RegisterMissionStateCallback()分別用于反饋目前的動作和狀態(tài)信息。

    代碼11:dji_waypoint_v2.hpp主要代碼:

    class WaypointV2MissionOperator

    {

    public:

    const uint16_t MAX_WAYPOINT_NUM_SIGNAL_PUSH = 260;

    WaypointV2MissionOperator(Vehicle* vehiclePtr);

    ~WaypointV2MissionOperator();

    ErrorCode::ErrorCodeType init(WayPointV2InitSettings *info, int timeout);

    ErrorCode::ErrorCodeType downloadInitSetting(WayPointV2InitSettingsInternal &info, int timeout);

    ErrorCode::ErrorCodeType start(int timeout);

    ErrorCode::ErrorCodeType stop(int timeout);

    ErrorCode::ErrorCodeType pause(int timeout);

    ErrorCode::ErrorCodeType resume(int timeout);

    ErrorCode::ErrorCodeType uploadMission(int timeout);

    ErrorCode::ErrorCodeType downloadMission(std::vector&mission, int timeout);

    ErrorCode::ErrorCodeType getGlobalCruiseSpeed(GlobalCruiseSpeed &cruiseSpeed, int timeout);

    ErrorCode::ErrorCodeType setGlobalCruiseSpeed(const GlobalCruiseSpeed &cruiseSpeed, int timeout);

    ErrorCode::ErrorCodeType uploadAction(std::vector&actions, int timeout);

    ErrorCode::ErrorCodeType getActionRemainMemory(GetRemainRamAck &remainRamAck, int timeout);

    ErrorCode::ErrorCodeType getWaypointIndexInList(GetWaypontStartEndIndexAck &startEndIndexAck, int timeout);

    inline DJIWaypointV2MissionState getCurrentState() { return currentState; }

    inline DJIWaypointV2MissionState getPrevState() { return prevState; }

    void setPrevState(DJIWaypointV2MissionState state) {prevState = state; }

    void setCurrentState(DJIWaypointV2MissionState state) {currentState = state; }

    float32_t getTakeoffAltitude(){return takeoffAltitude;};

    void setTakeoffAltitude(float32_t altitude){ takeoffAltitude = altitude;};

    void RegisterMissionEventCallback(void *userData, PushCallback cb = NULL);

    void RegisterMissionStateCallback(void *userData, PushCallback cb = NULL) ;

    private:

    std::vector missionV2;

    DJIWaypointV2MissionState currentState;

    DJIWaypointV2MissionState prevState;

    Vehicle *vehiclePtr;

    float32_t takeoffAltitude;

    void RegisterOSDInfoCallback(Vehicle *vehiclePtr);

    };

    2.3.3.2.2.3 流程設計

    航線導入并啟動的功能實施流程如下:

    1)在之前已經(jīng)設計好航線的前提下,需要將該航行的數(shù)據(jù)點存儲模式修改為大疆指定的數(shù)據(jù)點存儲方式;

    2)將生成的航線通過API調(diào)用上傳航線任務的整體信息。

    3)一個航點任務包含航線飛行任務的ID、航點任務的航點數(shù)、任務重復次數(shù)、航點任務結(jié)束后的動作、最大飛行速度和巡航速度。

    4)上傳航點信息基礎參數(shù):航點坐標(設置航點的經(jīng)度、緯度和相對于起飛點的高度)、航點類型、航向類型和飛行速度??蛇x參數(shù):緩沖距離、航向角度、轉(zhuǎn)向模式、興趣點、單點最大飛行速度、單點巡航速度。

    5)將航線任務上傳至標校無人機飛控。

    6)控制無人機執(zhí)行航點任務。上傳完成后,標校無人機可通過開發(fā)者之前預設的動作,如開始、停止或暫停任務、設置或獲取巡航速度等。

    2.3.3.2.2.4 程序?qū)崿F(xiàn)

    本章節(jié)內(nèi)容旨在將上一章節(jié)內(nèi)容以代碼實現(xiàn)。

    1)首先判斷是否支持航線任務規(guī)劃的功能,通過如下代碼。

    代碼12:判斷函數(shù)是否支持功能

    if (!vehiclePtr->isM300()) {

    DSTATUS("This sample only supports M300!"); /*當前waypoint v2 僅支持M300機型*/

    return false;

    }

    int timeout = 1;

    GetRemainRamAck actionMemory = {0};

    ErrorCode::ErrorCodeType ret;

    if(!setUpSubscription(timeout))

    {

    DERROR("Failed to set up subscription!");

    return -1;

    }

    else

    {

    DSTATUS("Set up subscription successfully!");

    }

    /*! wait for subscription data come*/

    sleep(timeout);

    2)而后創(chuàng)建mission任務,初始化mission任務,用到initMissionSetting()函數(shù),該函數(shù)實現(xiàn)了任務初始化配置的功能,部分代碼見代碼7內(nèi)容。

    代碼13:上傳任務的代碼

    /*! init mission */ /* 初始化mission任務 */

    ret = initMissionSetting(timeout);

    if(ret != ErrorCode::SysCommonErr::Success)

    return ret;

    sleep(timeout);

    3)其中代碼8中為添加航跡點的核心代碼。是initMissionSetting代碼中內(nèi)容,通過這段代碼,添加每個航點信息。

    代碼14:上傳任務的代碼

    /*! Init waypoint settings*/

    WayPointV2InitSettings missionInitSettings;

    missionInitSettings.missionID = rand();

    missionInitSettings.repeatTimes = 1;

    missionInitSettings.finishedAction = DJIWaypointV2MissionFinishedGoHome;

    missionInitSettings.maxFlightSpeed = 10;

    missionInitSettings.autoFlightSpeed = 2;

    missionInitSettings.exitMissionOnRCSignalLost = 1;

    missionInitSettings.gotoFirstWaypointMode = DJIWaypointV2MissionGotoFirstWaypointModePointToPoint;

    missionInitSettings.mission = generatePolygonWaypoints(radius, polygonNum);

    missionInitSettings.missTotalLen = missionInitSettings.mission.size();

    ErrorCode::ErrorCodeType ret = vehiclePtr->waypointV2Mission->init(&missionInitSettings,timeout);

    4)代碼9的內(nèi)容是在代碼8中進一步展開,特別將generatePolygonWaypoints()函數(shù)單獨講解,這部分內(nèi)容是generatePolygonWaypoints()函數(shù)的內(nèi)容。該函數(shù)實現(xiàn)了航點數(shù)據(jù)的添加功能。這一步函數(shù)調(diào)用,也是實現(xiàn)在飛行軌跡設計完成之后,將設計的航跡進行轉(zhuǎn)換,使得無人機飛控可以使用的關(guān)鍵。

    代碼15:上傳任務的代碼

    std::vector WaypointV2MissionSample::generatePolygonWaypoints(float32_t radius, uint16_t polygonNum) {

    // Let's create a vector to store our waypoints in.

    std::vector waypointList;

    WaypointV2 startPoint;

    WaypointV2 waypointV2;

    Telemetry::TypeMap::type subscribeGPosition = vehiclePtr->subscribe->getValue();

    startPoint.latitude = subscribeGPosition.latitude;

    startPoint.longitude = subscribeGPosition.longitude;

    startPoint.relativeHeight = 15;

    setWaypointV2Defaults(startPoint);

    waypointList.push_back(startPoint);

    // Iterative algorithm

    for (int i = 0; i < polygonNum; i++) {

    float32_t angle = i * 2 * M_PI / polygonNum;

    setWaypointV2Defaults(waypointV2);

    float32_t X = radius * cos(angle);

    float32_t Y = radius * sin(angle);

    waypointV2.latitude = X/EARTH_RADIUS + startPoint.latitude;

    waypointV2.longitude = Y/(EARTH_RADIUS * cos(startPoint.latitude)) + startPoint.longitude;

    waypointV2.relativeHeight = startPoint.relativeHeight ;

    waypointList.push_back(waypointV2);

    waypointList.push_back(startPoint);

    return waypointList;

    }

    5)而后將自定義的航線任務上傳至無人機飛控。見代碼8內(nèi)容。

    代碼16:上傳任務的代碼

    /*! upload mission */

    /*! upload mission's timeout need to be longer than 2s*/

    int uploadMissionTimeOut = 3;

    ret = uploadWaypointMission(uploadMissionTimeOut); /* 上傳任務,注意注釋部分,這里的超時需要設置為3s, 設置為1時,可能因為上傳任務過多,報index錯誤*/

    if(ret != ErrorCode::SysCommonErr::Success)

    return ret;

    sleep(timeout);

    6)從飛控中下載航線,這一步可以起到檢查航線的作用。

    代碼17:下載并檢查任務的代碼

    /*! download mission */ /* 下載任務,可以查看對比上傳的任務 debug的時候可以用來對比排查問題 */

    std::vector mission;

    ret = downloadWaypointMission(mission, timeout);

    if(ret != ErrorCode::SysCommonErr::Success)

    return ret;

    sleep(timeout);

    7)而后上傳在航線進行過程中,需要涉及的一些飛行器動作。

    代碼18:上傳飛行器動作的代碼

    /*! upload actions */ /* 上傳actions:*/

    /*! check action memory */

    ret = getActionRemainMemory(actionMemory, timeout); //上傳action前先檢查action容量,避免上傳的任務過多導致action被擠掉了,執(zhí)行動作可能不完整。最大貌似為65535 byte

    if (actionMemory.remainMemory <= 0)

    {

    DSTATUS("action memory is not enough.Can not upload more action!");

    return ErrorCode::SysCommonErr::UndefinedError;

    }

    ret = uploadWapointActions(timeout);

    if(ret != ErrorCode::SysCommonErr::Success)

    return ret;

    ret = getActionRemainMemory(actionMemory, timeout);

    sleep(timeout);

    8)開始執(zhí)行飛行任務。

    代碼19:開始執(zhí)行飛行任務的代碼

    /*! start mission */

    ret = startWaypointMission(timeout); //開始執(zhí)行

    if(ret != ErrorCode::SysCommonErr::Success)

    return ret;

    sleep(20);

    9)設置飛行過程中的一些參數(shù),比如最大飛行速度等。

    代碼20:設置飛行參數(shù)的代碼

    /*! set global cruise speed */

    setGlobalCruiseSpeed(1.5, timeout); //設置巡航速度,巡航速度為全程航線的巡航速度,不是通過單點航點任務來設置的??梢栽趩吸c航點中更改,間接實現(xiàn)不同的航點以不同的速度運行。

    sleep(timeout);

    10)獲取巡航速度,以判斷飛行器飛行狀態(tài)。

    代碼21:獲取飛行參數(shù)的代碼

    /*! get global cruise speed */

    getGlobalCruiseSpeed(timeout);

    sleep(timeout);

    11)可以測試暫停飛行。

    代碼22:暫停飛行的代碼

    /*! pause the mission*/

    ret = pauseWaypointMission(timeout);

    if(ret != ErrorCode::SysCommonErr::Success)

    return ret;

    sleep(5);

    12)測試重啟飛行任務的功能。

    代碼23:重啟飛行的代碼

    printf("kyle test: pauseWaypointMission and resumeWaypointMission/n");

    /*! resume the mission*/

    ret = resumeWaypointMission(timeout); //暫停及回復航線指令

    if(ret != ErrorCode::SysCommonErr::Success)

    return ret;

    sleep(50);

    2.3.3.3 遠控機載應答機功能

    當無人機按照既定設計的航線自動飛行后,就需要考慮標校無人機機載應答機的控制問題。

    2.3.3.3.1 功能分析

    這部分功能需要根據(jù)應答機廠家所提供的API接口進行開發(fā),但是無論是哪家廠家,根據(jù)使用者的需求對接,軟件接口至少包含以下內(nèi)容。

    1)開關(guān)機控制;

    2)信號頻率的選擇;

    3)應答機信號發(fā)送強度的衰減值;

    4)在應答和信標模式之間切換;

    5)射頻信號是否允許輸出。

    6)網(wǎng)絡通信功能。可以將這部分功能設計為網(wǎng)絡通信的形式,與近端的應答機控制模塊進行通信,使其控制遠端的應答機。

    2.3.3.3.2 程序設計

    根據(jù)需求分析,可以將功能分為兩部分,一部分是參數(shù)設置模塊,一部分是網(wǎng)絡通信模塊。

    1)參數(shù)設置模塊。設計一個結(jié)構(gòu)體,將所有的參數(shù)包含在內(nèi),以方便使用和查看。

    代碼24:遠控應答機參數(shù)設置模塊

    Typedef struct

    {

    unsigned char OnOff;//開關(guān)機控制

    unsigned char FreqChoose;//頻率選擇

    unsigned char Attenuator;//衰減器控制

    unsigned char WorkMode;//工作方式

    unsigned char SPout;//射頻輸出允許

    }

    2)網(wǎng)絡通信模塊。

    代碼25:遠控應答機網(wǎng)絡通信模塊

    QudpSocket *SendudpSocket;

    SendudpSocket->writeDatagram(buf,len,QhostAddress(FSendIp),FSendPort);

    3 無人機標校應用場景

    在某次車載測控設備轉(zhuǎn)場后,受場地限制,沒有標校桿或者標校塔可供其進行標校,此時,需要起降標校無人機,進行標校。

    1)利用無人機標校系統(tǒng)生成飛行軌跡功能,輸入當?shù)氐沫h(huán)境因素,如溫濕壓,海拔,以及當?shù)刈鴺宋恢玫葏?shù),利用OSG在三維仿真空間中,生成飛行軌跡;

    2)利用無人機標校系統(tǒng)導入航線的功能,通過OSDK上傳飛行軌跡;

    3)利用無人機標校系統(tǒng)控制無人機的功能,控制無人機起飛,并飛行至等待點位置;

    4)通過無人機標校系統(tǒng)遠控機載應答機的功能,設置合適的應答機頻點及強度,并開啟應答機;

    5)標校無人機根據(jù)飛行軌跡實施完畢靜態(tài)及動態(tài)標校,并返航。

    4 結(jié)束語

    通過設計從生成飛行軌跡、到將飛行軌跡導入飛控并實施以及遠控應答機完整功能的軟件,并配套相應的硬件模塊,提升了無人機標校的可靠性、為后續(xù)無人機標校工作的推動提供了一套可行的技術(shù)方案。

    猜你喜歡
    應答機航點標校
    基于目標模擬器的跟蹤雷達無塔標校實現(xiàn)方法
    衛(wèi)星測控應答機的接收機在軌性能評估方法
    航天器工程(2021年2期)2021-04-28 08:41:48
    一種用于導航雷達標校的專用AIS設備
    電子制作(2019年7期)2019-04-25 13:17:42
    飛機應答機的奧秘
    基于移動站的轉(zhuǎn)發(fā)式地面站設備時延標校方法
    二次開發(fā)在航點航跡圖批量繪制中的應用
    航管應答機退敏和恢復的設計研究
    電子制作(2017年23期)2017-02-02 07:16:51
    星載測控應答機抗輻射加固與可靠性平臺研究
    遙測遙控(2015年5期)2015-04-23 08:16:28
    載波相位DGPS標校系統(tǒng)時間同步設計與仿真
    插阴视频在线观看视频| 国产熟女午夜一区二区三区 | 国产乱人偷精品视频| 中文字幕人妻熟人妻熟丝袜美| 中文在线观看免费www的网站| 中文字幕精品免费在线观看视频 | 国产精品女同一区二区软件| 欧美日韩视频高清一区二区三区二| 麻豆成人午夜福利视频| 精品人妻熟女av久视频| 亚洲国产欧美日韩在线播放 | 观看av在线不卡| 日日撸夜夜添| 亚洲婷婷狠狠爱综合网| 亚洲国产精品成人久久小说| 成年av动漫网址| 国产免费又黄又爽又色| 色5月婷婷丁香| 看十八女毛片水多多多| 亚洲精品视频女| 亚洲精品,欧美精品| 亚洲国产日韩一区二区| 日本欧美视频一区| 亚洲国产精品成人久久小说| 国产一区二区三区综合在线观看 | 99热6这里只有精品| 亚洲四区av| a 毛片基地| 在线免费观看不下载黄p国产| 国产 精品1| 一本一本综合久久| 插阴视频在线观看视频| 亚洲情色 制服丝袜| 久久97久久精品| 欧美xxxx性猛交bbbb| 三上悠亚av全集在线观看 | av天堂中文字幕网| 少妇被粗大的猛进出69影院 | 久久精品久久久久久久性| 亚洲自偷自拍三级| 国产av码专区亚洲av| 99久久精品一区二区三区| 如何舔出高潮| 午夜老司机福利剧场| 亚洲色图综合在线观看| 九色成人免费人妻av| 一级毛片黄色毛片免费观看视频| 伦理电影大哥的女人| 久久女婷五月综合色啪小说| h日本视频在线播放| 在线天堂最新版资源| 久久久久久久久久成人| 精品酒店卫生间| 亚洲人成网站在线观看播放| 久久99热6这里只有精品| 2021少妇久久久久久久久久久| 精品卡一卡二卡四卡免费| 国产黄片视频在线免费观看| 97在线人人人人妻| 又黄又爽又刺激的免费视频.| 色94色欧美一区二区| 91在线精品国自产拍蜜月| 最近最新中文字幕免费大全7| 美女大奶头黄色视频| 99久久人妻综合| 国产爽快片一区二区三区| 麻豆精品久久久久久蜜桃| 丝袜脚勾引网站| 日本av手机在线免费观看| 韩国高清视频一区二区三区| 日韩视频在线欧美| 一级毛片黄色毛片免费观看视频| av播播在线观看一区| 99久久中文字幕三级久久日本| 亚洲av电影在线观看一区二区三区| 久久ye,这里只有精品| 99久久综合免费| 国产美女午夜福利| 蜜桃久久精品国产亚洲av| 中文资源天堂在线| 在线观看av片永久免费下载| 少妇人妻 视频| 99热国产这里只有精品6| 免费不卡的大黄色大毛片视频在线观看| 国产高清不卡午夜福利| av天堂久久9| 丰满乱子伦码专区| 人人澡人人妻人| xxx大片免费视频| 亚洲国产精品专区欧美| av福利片在线| 国产午夜精品久久久久久一区二区三区| 久久国产乱子免费精品| 国产极品天堂在线| 国内揄拍国产精品人妻在线| 欧美性感艳星| 男女免费视频国产| 午夜av观看不卡| 国产高清国产精品国产三级| 国语对白做爰xxxⅹ性视频网站| 中文字幕制服av| 国产爽快片一区二区三区| 97超碰精品成人国产| 国产免费福利视频在线观看| 又大又黄又爽视频免费| 有码 亚洲区| 亚洲综合精品二区| 亚洲欧美日韩另类电影网站| 中文字幕亚洲精品专区| 又黄又爽又刺激的免费视频.| 99热这里只有是精品在线观看| 在线观看国产h片| 久久久精品94久久精品| 在线观看免费日韩欧美大片 | 七月丁香在线播放| 美女脱内裤让男人舔精品视频| 欧美最新免费一区二区三区| 五月开心婷婷网| 99精国产麻豆久久婷婷| 亚洲精品视频女| 亚洲精品乱久久久久久| av在线播放精品| 亚洲欧美中文字幕日韩二区| 久久精品国产鲁丝片午夜精品| 免费人成在线观看视频色| 插逼视频在线观看| 桃花免费在线播放| 久久影院123| 精品卡一卡二卡四卡免费| 熟女人妻精品中文字幕| 久久精品国产鲁丝片午夜精品| 国产精品久久久久久精品古装| 大片免费播放器 马上看| 亚洲色图综合在线观看| 久久精品国产亚洲网站| 精品国产国语对白av| 久久97久久精品| 在线免费观看不下载黄p国产| 下体分泌物呈黄色| 精品久久久精品久久久| 在线观看免费日韩欧美大片 | av视频免费观看在线观看| 午夜福利在线观看免费完整高清在| 国产 一区精品| 欧美精品一区二区免费开放| 各种免费的搞黄视频| 男人爽女人下面视频在线观看| 黄色欧美视频在线观看| 十八禁网站网址无遮挡 | 久久久久国产精品人妻一区二区| 午夜视频国产福利| 免费观看av网站的网址| 国产在线免费精品| 汤姆久久久久久久影院中文字幕| 国产男女内射视频| av不卡在线播放| 一级毛片久久久久久久久女| 人妻一区二区av| 亚洲自偷自拍三级| 婷婷色麻豆天堂久久| 亚洲成人av在线免费| 欧美最新免费一区二区三区| 午夜免费男女啪啪视频观看| 欧美丝袜亚洲另类| 一级毛片电影观看| 国产永久视频网站| 色94色欧美一区二区| 天堂俺去俺来也www色官网| 视频中文字幕在线观看| 亚洲美女视频黄频| 黑人猛操日本美女一级片| 亚洲av.av天堂| 国产成人精品无人区| 亚洲国产精品国产精品| 男男h啪啪无遮挡| av播播在线观看一区| 色5月婷婷丁香| 午夜免费男女啪啪视频观看| 国产探花极品一区二区| 免费人成在线观看视频色| 午夜精品国产一区二区电影| 免费少妇av软件| 80岁老熟妇乱子伦牲交| 亚洲av免费高清在线观看| 搡老乐熟女国产| 亚洲,一卡二卡三卡| 久久99热6这里只有精品| 国产欧美日韩精品一区二区| 国产一区二区在线观看日韩| 亚洲,一卡二卡三卡| videos熟女内射| 成人免费观看视频高清| 看非洲黑人一级黄片| 一区二区三区乱码不卡18| 亚洲图色成人| 国产免费又黄又爽又色| 久久国产乱子免费精品| 插阴视频在线观看视频| 国产探花极品一区二区| 婷婷色麻豆天堂久久| xxx大片免费视频| 日韩一区二区三区影片| a级片在线免费高清观看视频| 在线观看av片永久免费下载| 欧美日韩国产mv在线观看视频| 高清在线视频一区二区三区| 国产男女超爽视频在线观看| 欧美区成人在线视频| 女性被躁到高潮视频| 国产伦理片在线播放av一区| 久久久久久人妻| 欧美精品高潮呻吟av久久| 美女中出高潮动态图| 国产乱人偷精品视频| 日韩视频在线欧美| 亚洲精品色激情综合| 亚洲欧美精品专区久久| av在线播放精品| 亚洲精品中文字幕在线视频 | 国产在线男女| 亚洲精品久久久久久婷婷小说| 青春草亚洲视频在线观看| 麻豆精品久久久久久蜜桃| 国产色婷婷99| 伦精品一区二区三区| 黄片无遮挡物在线观看| 91久久精品国产一区二区成人| 亚洲精品国产av蜜桃| 亚洲欧美日韩东京热| 人人妻人人澡人人看| videossex国产| 精品亚洲成国产av| 成人毛片a级毛片在线播放| 女人精品久久久久毛片| 一本大道久久a久久精品| 一个人免费看片子| 午夜福利网站1000一区二区三区| 国产伦精品一区二区三区视频9| 国模一区二区三区四区视频| 国产精品麻豆人妻色哟哟久久| 黄色日韩在线| 国产精品秋霞免费鲁丝片| 9色porny在线观看| 啦啦啦视频在线资源免费观看| 一本一本综合久久| 在线 av 中文字幕| 亚洲av欧美aⅴ国产| 亚洲av中文av极速乱| 又粗又硬又长又爽又黄的视频| 成人18禁高潮啪啪吃奶动态图 | 热re99久久国产66热| 麻豆乱淫一区二区| 成年女人在线观看亚洲视频| 中文资源天堂在线| 亚洲精品亚洲一区二区| 日本猛色少妇xxxxx猛交久久| 搡老乐熟女国产| 中文字幕精品免费在线观看视频 | 最近最新中文字幕免费大全7| 免费观看a级毛片全部| 国产成人免费观看mmmm| 免费播放大片免费观看视频在线观看| 99久久精品热视频| √禁漫天堂资源中文www| 男男h啪啪无遮挡| 欧美日韩av久久| 内地一区二区视频在线| av有码第一页| 女人精品久久久久毛片| 中文乱码字字幕精品一区二区三区| 在线观看免费视频网站a站| 亚洲精品乱码久久久久久按摩| 日本wwww免费看| 精品少妇内射三级| 久久精品夜色国产| 少妇精品久久久久久久| 久久狼人影院| 精品酒店卫生间| 最黄视频免费看| 卡戴珊不雅视频在线播放| 又爽又黄a免费视频| 在线天堂最新版资源| 精品久久久久久电影网| 国产乱来视频区| 欧美人与善性xxx| 3wmmmm亚洲av在线观看| 欧美性感艳星| 成年av动漫网址| 亚洲成人av在线免费| 亚洲精品乱久久久久久| 亚洲欧美日韩另类电影网站| 亚洲欧美日韩东京热| 少妇丰满av| 王馨瑶露胸无遮挡在线观看| 欧美97在线视频| av网站免费在线观看视频| 欧美另类一区| 久久久久久久国产电影| 欧美高清成人免费视频www| 日本-黄色视频高清免费观看| 草草在线视频免费看| 一级a做视频免费观看| 午夜91福利影院| 亚洲国产欧美日韩在线播放 | 久久精品国产a三级三级三级| 伦精品一区二区三区| 91久久精品电影网| 日本午夜av视频| 国国产精品蜜臀av免费| 曰老女人黄片| 丝袜在线中文字幕| 午夜福利,免费看| 我的女老师完整版在线观看| 欧美丝袜亚洲另类| 制服丝袜香蕉在线| 一区二区三区乱码不卡18| 久热这里只有精品99| 国产精品福利在线免费观看| 亚洲国产色片| 国产有黄有色有爽视频| 久久久久久久精品精品| 人妻 亚洲 视频| 欧美日韩视频精品一区| 在线 av 中文字幕| av有码第一页| 久久影院123| 精品一品国产午夜福利视频| av在线app专区| 精品亚洲乱码少妇综合久久| 久久久久久久久久久免费av| 久久久国产一区二区| 中文字幕精品免费在线观看视频 | 国产国拍精品亚洲av在线观看| 国产免费一区二区三区四区乱码| 晚上一个人看的免费电影| 涩涩av久久男人的天堂| 国产精品一区二区在线观看99| 亚洲精品久久午夜乱码| 婷婷色av中文字幕| 大话2 男鬼变身卡| 午夜福利视频精品| 亚洲精品一二三| 91久久精品国产一区二区三区| 在线观看www视频免费| 国产在线男女| 久久精品熟女亚洲av麻豆精品| 18+在线观看网站| 全区人妻精品视频| 亚洲天堂av无毛| 亚洲精品久久午夜乱码| 在线亚洲精品国产二区图片欧美 | 日本wwww免费看| 一区二区三区乱码不卡18| 国产成人一区二区在线| 精品午夜福利在线看| 成年av动漫网址| 天天操日日干夜夜撸| 熟女电影av网| 国产又色又爽无遮挡免| 欧美bdsm另类| 国产精品女同一区二区软件| 免费看日本二区| 女人久久www免费人成看片| 久久久亚洲精品成人影院| 国国产精品蜜臀av免费| 韩国av在线不卡| 久久毛片免费看一区二区三区| 亚洲天堂av无毛| 午夜激情久久久久久久| videossex国产| 熟妇人妻不卡中文字幕| 三级经典国产精品| 极品人妻少妇av视频| 人妻人人澡人人爽人人| 高清欧美精品videossex| 观看免费一级毛片| 国产精品.久久久| 2022亚洲国产成人精品| 欧美国产精品一级二级三级 | 国产精品99久久久久久久久| 国产伦在线观看视频一区| 我的老师免费观看完整版| 精品久久久久久久久av| 国产精品久久久久久精品电影小说| videos熟女内射| 久久久久久久久久成人| 国产午夜精品久久久久久一区二区三区| 男女国产视频网站| 亚洲欧美中文字幕日韩二区| 久久精品熟女亚洲av麻豆精品| 两个人的视频大全免费| 欧美另类一区| 99热这里只有是精品在线观看| 亚洲无线观看免费| 男的添女的下面高潮视频| 中文字幕人妻丝袜制服| 免费观看av网站的网址| 日韩欧美 国产精品| 日韩大片免费观看网站| 热re99久久国产66热| 久久久久网色| 美女内射精品一级片tv| 国产成人免费无遮挡视频| 2021少妇久久久久久久久久久| 成年av动漫网址| 亚洲欧美日韩东京热| 久久久亚洲精品成人影院| 五月玫瑰六月丁香| 日韩亚洲欧美综合| 日本91视频免费播放| 国产熟女欧美一区二区| 免费高清在线观看视频在线观看| 一本大道久久a久久精品| 亚洲图色成人| 国产伦理片在线播放av一区| 久久久久久久久大av| 成年人午夜在线观看视频| av有码第一页| 国产黄频视频在线观看| 国产免费视频播放在线视频| 18+在线观看网站| 国产真实伦视频高清在线观看| 51国产日韩欧美| 少妇高潮的动态图| 午夜av观看不卡| 99热6这里只有精品| 免费看不卡的av| 噜噜噜噜噜久久久久久91| 免费少妇av软件| 成年美女黄网站色视频大全免费 | 91久久精品电影网| 精品少妇内射三级| 日本与韩国留学比较| 中文字幕精品免费在线观看视频 | 亚洲国产毛片av蜜桃av| 国产精品成人在线| 啦啦啦啦在线视频资源| 精华霜和精华液先用哪个| 男的添女的下面高潮视频| 国语对白做爰xxxⅹ性视频网站| 欧美老熟妇乱子伦牲交| 久久青草综合色| 中文字幕人妻熟人妻熟丝袜美| 五月玫瑰六月丁香| 高清毛片免费看| 九九久久精品国产亚洲av麻豆| 日本vs欧美在线观看视频 | 伊人久久精品亚洲午夜| 亚州av有码| 欧美xxxx性猛交bbbb| 欧美人与善性xxx| 亚洲经典国产精华液单| 亚洲激情五月婷婷啪啪| 精品少妇久久久久久888优播| 国产精品一二三区在线看| 久久精品国产亚洲av天美| 高清午夜精品一区二区三区| 一级毛片 在线播放| 亚洲欧美成人综合另类久久久| av女优亚洲男人天堂| 国产伦在线观看视频一区| 国产一区二区在线观看日韩| 一级毛片 在线播放| 久久99蜜桃精品久久| 一本大道久久a久久精品| 性高湖久久久久久久久免费观看| 国产亚洲欧美精品永久| 在线 av 中文字幕| 亚洲中文av在线| 青春草亚洲视频在线观看| 午夜免费观看性视频| 五月伊人婷婷丁香| 成人黄色视频免费在线看| 亚洲欧洲日产国产| 热re99久久精品国产66热6| 欧美最新免费一区二区三区| 十分钟在线观看高清视频www | av网站免费在线观看视频| 青春草亚洲视频在线观看| 成人二区视频| 日韩熟女老妇一区二区性免费视频| av福利片在线| 亚洲精品日本国产第一区| 国产欧美亚洲国产| 99久久精品热视频| 人妻少妇偷人精品九色| 国产精品麻豆人妻色哟哟久久| 国产精品久久久久久久电影| 男女国产视频网站| 自线自在国产av| 国产黄色免费在线视频| 卡戴珊不雅视频在线播放| 国产精品麻豆人妻色哟哟久久| 国产精品福利在线免费观看| 日日爽夜夜爽网站| 中文在线观看免费www的网站| 日韩人妻高清精品专区| 黑人猛操日本美女一级片| 成人av一区二区三区在线看 | 日韩三级视频一区二区三区| 18在线观看网站| 又黄又粗又硬又大视频| 19禁男女啪啪无遮挡网站| 久久影院123| 成人av一区二区三区在线看 | 久久精品国产亚洲av高清一级| 久久九九热精品免费| 欧美中文综合在线视频| 一区二区三区激情视频| 人人妻人人澡人人爽人人夜夜| 正在播放国产对白刺激| 国产xxxxx性猛交| 伊人亚洲综合成人网| 日日夜夜操网爽| 国产淫语在线视频| 国产精品秋霞免费鲁丝片| 精品国产国语对白av| 日韩欧美一区视频在线观看| 亚洲成国产人片在线观看| 老熟妇乱子伦视频在线观看 | 亚洲精品中文字幕一二三四区 | 少妇裸体淫交视频免费看高清 | 午夜福利在线免费观看网站| 首页视频小说图片口味搜索| 国产一级毛片在线| 丝袜美腿诱惑在线| 高清在线国产一区| 欧美日韩黄片免| 国产视频一区二区在线看| 日韩欧美一区视频在线观看| 中文欧美无线码| 一区二区三区乱码不卡18| 久久天堂一区二区三区四区| 日本一区二区免费在线视频| 欧美激情久久久久久爽电影 | 视频区图区小说| 成人av一区二区三区在线看 | 丰满迷人的少妇在线观看| 黑人巨大精品欧美一区二区蜜桃| 久久久国产一区二区| avwww免费| 一级毛片精品| 亚洲一码二码三码区别大吗| 一边摸一边抽搐一进一出视频| 久久香蕉激情| 日韩电影二区| 成人国产av品久久久| 日韩有码中文字幕| 国产精品1区2区在线观看. | 午夜两性在线视频| 日本撒尿小便嘘嘘汇集6| 另类亚洲欧美激情| 精品欧美一区二区三区在线| 精品人妻熟女毛片av久久网站| 午夜91福利影院| 免费观看人在逋| 一边摸一边抽搐一进一出视频| 国产男女超爽视频在线观看| 国产亚洲av高清不卡| 国产区一区二久久| 成人av一区二区三区在线看 | 久久精品国产亚洲av香蕉五月 | 午夜福利影视在线免费观看| 亚洲人成77777在线视频| 欧美成人午夜精品| 日本vs欧美在线观看视频| 一个人免费看片子| 我的亚洲天堂| 欧美激情高清一区二区三区| 曰老女人黄片| 日韩制服骚丝袜av| 蜜桃在线观看..| 啦啦啦中文免费视频观看日本| 精品福利永久在线观看| av线在线观看网站| 最新在线观看一区二区三区| 精品少妇黑人巨大在线播放| 9热在线视频观看99| 午夜福利在线免费观看网站| 一区二区三区激情视频| av又黄又爽大尺度在线免费看| 少妇精品久久久久久久| 久久青草综合色| a级毛片在线看网站| 一二三四在线观看免费中文在| av片东京热男人的天堂| 十八禁网站免费在线| 真人做人爱边吃奶动态| 国产精品久久久久久人妻精品电影 | 老鸭窝网址在线观看| 女性被躁到高潮视频| 热99re8久久精品国产| 久久天堂一区二区三区四区| 国产免费视频播放在线视频| 超色免费av| 国产日韩欧美在线精品| 国产男人的电影天堂91| 久久精品人人爽人人爽视色| 日韩中文字幕欧美一区二区| 久久久国产成人免费| 国产免费av片在线观看野外av| 日韩免费高清中文字幕av| 91成年电影在线观看| 精品国产超薄肉色丝袜足j| 欧美另类亚洲清纯唯美| 十八禁高潮呻吟视频| 亚洲精品久久午夜乱码| 一级,二级,三级黄色视频| 伊人久久大香线蕉亚洲五| 日韩中文字幕视频在线看片| 日韩熟女老妇一区二区性免费视频| 亚洲欧美日韩另类电影网站| 最近最新中文字幕大全免费视频| 亚洲欧美精品综合一区二区三区| 久久亚洲国产成人精品v|