日韩精品一区二区三区在线视频放-无码中文字幕V?一区二区-成年片免费观看视频-国内少妇人妻丰满av-国产精品中文字幕免费观看-亚洲成人久久一区二区三区-国内少妇偷人精品视频无缓冲-一区二区国产精品日本一区二区三区在线网

ARTICLE DETAIL

資訊詳情

深耕商務(wù)建站與企業(yè)官網(wǎng)運(yùn)營(yíng)的一線實(shí)戰(zhàn)洞察。

無(wú)人機(jī)覆蓋路徑規(guī)劃實(shí)戰(zhàn):基于ROS1的牛耕式實(shí)現(xiàn)

無(wú)人機(jī)覆蓋路徑規(guī)劃實(shí)戰(zhàn):基于ROS1的牛耕式實(shí)現(xiàn) 簡(jiǎn)介面向ROS1開(kāi)發(fā)者與無(wú)人機(jī)導(dǎo)航學(xué)習(xí)者的覆蓋路徑規(guī)劃算法實(shí)例封裝了多邊形覆蓋規(guī)劃開(kāi)源包的核心實(shí)現(xiàn)可幫助理解如何將目標(biāo)區(qū)域分解并規(guī)劃出無(wú)遺漏的全覆蓋路徑適合環(huán)境監(jiān)測(cè)、農(nóng)業(yè)植保等需要區(qū)域遍歷的自主飛行場(chǎng)景。資源共160個(gè)文件以C源碼為主體配合ROS的啟動(dòng)文件、可視化配置、參數(shù)文件以及自定義消息與服務(wù)類(lèi)型壓縮包僅471KB輕量且目錄結(jié)構(gòu)清晰。已有1981人學(xué)習(xí)或下載。通過(guò)該實(shí)例可系統(tǒng)觀察節(jié)點(diǎn)、話題、服務(wù)與動(dòng)作的協(xié)作方式掌握從環(huán)境地圖構(gòu)建、覆蓋路徑生成到控制指令輸出的完整流程并了解掃描式覆蓋、BCD分解、可見(jiàn)性圖等規(guī)劃算法的工程化實(shí)現(xiàn)對(duì)深入理解無(wú)人機(jī)自主飛行系統(tǒng)設(shè)計(jì)與算法落地具有直接參考價(jià)值。代碼中附有詳細(xì)注釋與模塊化設(shè)計(jì)便于二次開(kāi)發(fā)與算法驗(yàn)證。 搞無(wú)人機(jī)自動(dòng)飛行的朋友大概率都繞不過(guò)覆蓋路徑規(guī)劃這道坎。農(nóng)田植保要按壟掃電力巡檢要沿塔巡查災(zāi)后搜索要把整片區(qū)域跑遍這些任務(wù)的本質(zhì)都是同一個(gè)問(wèn)題給定一片區(qū)域讓無(wú)人機(jī)自動(dòng)飛出一條路徑既要全覆蓋、不重不漏又要盡量省電、少轉(zhuǎn)彎。這篇文章我就把我的ROS1實(shí)現(xiàn)思路、完整代碼結(jié)構(gòu)和調(diào)試經(jīng)驗(yàn)整理出來(lái)用的無(wú)人機(jī)平臺(tái)是Pixhawk飛控加機(jī)載電腦通信走M(jìn)AVROS仿真在Gazebo里跑通了再上真機(jī)。1. 覆蓋路徑規(guī)劃的問(wèn)題定義與算法選型依據(jù)先聊一個(gè)容易被新手忽略的問(wèn)題覆蓋路徑規(guī)劃Coverage Path Planning, CPP和一般的點(diǎn)對(duì)點(diǎn)路徑規(guī)劃比如A*、RRT找一條從A到B的路完全是兩回事。點(diǎn)對(duì)點(diǎn)路徑規(guī)劃的目標(biāo)是從哪走到哪最短而覆蓋路徑規(guī)劃的目標(biāo)是讓傳感器視場(chǎng)覆蓋整個(gè)目標(biāo)區(qū)域路徑本身要充滿整個(gè)面而不是一條線。具體來(lái)說(shuō)一個(gè)合格的覆蓋規(guī)劃算法要同時(shí)滿足三個(gè)指標(biāo)覆蓋率目標(biāo)區(qū)域內(nèi)沒(méi)有被覆蓋到的盲區(qū)要盡可能少理想情況是100%重復(fù)率同一塊區(qū)域被掃了多遍的比例要低重復(fù)率高意味著浪費(fèi)電量轉(zhuǎn)彎次數(shù)無(wú)人機(jī)轉(zhuǎn)彎時(shí)往往需要減速甚至懸停能耗比直線巡航高得多次優(yōu)路徑往往轉(zhuǎn)彎特別多這三個(gè)指標(biāo)其實(shí)是互相矛盾的。想覆蓋率100%路徑就要密集重復(fù)率和轉(zhuǎn)彎次數(shù)也會(huì)上來(lái)想少轉(zhuǎn)彎路徑就稀疏可能漏掉區(qū)域。所以實(shí)際工程里我們做的不是最優(yōu)解而是滿足任務(wù)要求的可行解。算法選型上我對(duì)比過(guò)幾種主流方案算法適用場(chǎng)景優(yōu)點(diǎn)缺點(diǎn)實(shí)現(xiàn)難度牛耕式往返掃描規(guī)則矩形/凸多邊形區(qū)域簡(jiǎn)單直接、轉(zhuǎn)彎少對(duì)凹多邊形和障礙物處理能力弱低單元分解法含梯形分解含障礙物的復(fù)雜區(qū)域能處理凹多邊形、障礙物分解邏輯復(fù)雜、子區(qū)域拼接要考慮銜接中螺旋式掃描不規(guī)則近圓形區(qū)域適合由外向內(nèi)覆蓋凹邊界容易出問(wèn)題中基于隨機(jī)采樣的覆蓋極不規(guī)則環(huán)境靈活性高覆蓋率不穩(wěn)定、路徑雜亂高我的項(xiàng)目選的是牛耕式往返掃描作為基礎(chǔ)策略。原因很簡(jiǎn)單實(shí)際作業(yè)里大部分覆蓋任務(wù)的目標(biāo)區(qū)域經(jīng)過(guò)簡(jiǎn)單處理都可以近似成凸多邊形農(nóng)田是長(zhǎng)條形操場(chǎng)是矩形開(kāi)闊水域也是多邊形。牛耕式的路徑質(zhì)量在這些場(chǎng)景下已經(jīng)接近最優(yōu)而且代碼邏輯清晰調(diào)試成本低。不過(guò)如果目標(biāo)區(qū)域有凹角或者內(nèi)部有禁飛區(qū)純牛耕式就會(huì)產(chǎn)生大量繞路。為了解決這個(gè)問(wèn)題我在算法里加了一個(gè)區(qū)域預(yù)處理環(huán)節(jié)把凹多邊形先做凸分解得到幾個(gè)互不重疊的凸子多邊形然后在每個(gè)子多邊形內(nèi)部獨(dú)立做牛耕式掃描子區(qū)域之間用最短連接線銜接。這里簡(jiǎn)單推導(dǎo)一下轉(zhuǎn)彎次數(shù)的計(jì)算公式方便大家做可行性驗(yàn)證。假設(shè)覆蓋區(qū)域的長(zhǎng)度為L(zhǎng)沿航線方向?qū)挾葹閃垂直航線方向傳感器覆蓋寬度為d那么完整的覆蓋航線需要的直線段數(shù)量是n ceil(W / d)轉(zhuǎn)彎次數(shù)大約是n - 1。這個(gè)公式看起來(lái)簡(jiǎn)單但它決定了飛行時(shí)間。比如一塊100m x 50m的區(qū)域覆蓋寬度10m那么n 5整條路徑就是5條百米直線加4次轉(zhuǎn)彎。如果無(wú)人機(jī)巡航速度是8m/s每次轉(zhuǎn)彎含減速、轉(zhuǎn)向、加速耗時(shí)約10s那么總飛行時(shí)間大約是直線時(shí)間 5 * 100 / 8 62.5s 轉(zhuǎn)彎時(shí)間 4 * 10 40s 總時(shí)間 102.5s轉(zhuǎn)彎時(shí)間占了接近40%這就是為什么很多實(shí)際的覆蓋規(guī)劃算法會(huì)把減少轉(zhuǎn)彎放在比減少總路徑長(zhǎng)度更優(yōu)先的位置。有些論文里提到的最優(yōu)覆蓋方向策略本質(zhì)就是通過(guò)旋轉(zhuǎn)航線方向找出一個(gè)能讓W(xué)/d值最小、從而轉(zhuǎn)彎次數(shù)最少的角度一般這個(gè)角度會(huì)取區(qū)域的主方向或最長(zhǎng)軸方向。2. ROS1工程結(jié)構(gòu)設(shè)計(jì)與核心模塊劃分我的ROS1工程是在Ubuntu 18.04 Melodic上開(kāi)發(fā)的飛控是Pixhawk 4運(yùn)行PX4固件機(jī)載電腦是NVIDIA Jetson Xavier NX。整個(gè)項(xiàng)目的功能包名叫uav_coverage_planner依賴(lài)的核心庫(kù)有rospyPython ROS接口開(kāi)發(fā)速度快、numpy路徑計(jì)算、shapely多邊形幾何處理、MAVROS和飛控通信。功能包結(jié)構(gòu)如下uav_coverage_planner/ ├── CMakeLists.txt ├── package.xml ├── launch/ │ ├── planner.launch # 主啟動(dòng)文件 │ └── gazebo_sim.launch # 仿真用 ├── scripts/ │ ├── coverage_planner_node.py # 主節(jié)點(diǎn)區(qū)域處理路徑生成 │ └── waypoint_publisher.py # 航點(diǎn)發(fā)布節(jié)點(diǎn) ├── config/ │ ├── planner_params.yaml # 算法參數(shù) │ └── mission_area.yaml # 任務(wù)區(qū)域定義 ├── rviz/ │ └── coverage_planner.rviz # 可視化配置 └── maps/ └── test_area.png # 測(cè)試地圖模塊劃分上我把整個(gè)系統(tǒng)拆成三個(gè)獨(dú)立節(jié)點(diǎn)讓它們各司其職出了問(wèn)題也好定位區(qū)域管理模塊coverage_planner_node.py負(fù)責(zé)讀取任務(wù)區(qū)域定義做凸分解計(jì)算最優(yōu)掃描方向生成航點(diǎn)數(shù)組。這是整個(gè)系統(tǒng)的核心算法都在這里。航點(diǎn)執(zhí)行模塊waypoint_publisher.py訂閱核心節(jié)點(diǎn)輸出的航點(diǎn)數(shù)組按順序通過(guò)MAVROS的/mavros/mission/push接口上傳任務(wù)給飛控或者直接通過(guò)/mavros/setpoint_position/global逐點(diǎn)發(fā)送位置指令。狀態(tài)監(jiān)控模塊可選訂閱飛控的GPS狀態(tài)、電池電量、飛行模式負(fù)責(zé)在緊急情況時(shí)暫停任務(wù)或返回起飛點(diǎn)。用ROS節(jié)點(diǎn)的方式而不是全都塞在一個(gè)程序里最大的好處是每一層都能獨(dú)立測(cè)試。我在開(kāi)發(fā)中經(jīng)常遇到飛控不給反應(yīng)的情況這時(shí)候先把航點(diǎn)執(zhí)行節(jié)點(diǎn)停掉手動(dòng)用rostopic echo檢查核心節(jié)點(diǎn)的輸出一條命令就能確定問(wèn)題出在規(guī)劃還是通信不需要整個(gè)系統(tǒng)重啟。ROS話題設(shè)計(jì)上我用了四個(gè)自定義話題類(lèi)型和說(shuō)明如下話題名消息類(lèi)型說(shuō)明/coverage_planner/waypointsvisualization_msgs/MarkerArray可視化航點(diǎn)同時(shí)在Rviz里顯示路徑/coverage_planner/mission_polygongeometry_msgs/PolygonStamped上報(bào)當(dāng)前規(guī)劃的目標(biāo)區(qū)域方便核對(duì)/coverage_planner/statusstd_msgs/String節(jié)點(diǎn)狀態(tài)信息比如正在規(guī)劃“上傳航點(diǎn)/coverage_planner/takeoff_cmdstd_msgs/Bool自動(dòng)起飛指令接飛控端3. 牛耕式覆蓋航線的核心代碼實(shí)現(xiàn)核心算法的實(shí)現(xiàn)我分成了三個(gè)步驟區(qū)域預(yù)處理、掃描方向計(jì)算、航線生成。下面逐個(gè)講每個(gè)步驟我都會(huì)給出關(guān)鍵代碼因?yàn)槲矣X(jué)得看代碼比看一堆公式要直觀得多。第一步區(qū)域預(yù)處理與凸分解這一步的目標(biāo)是把用戶輸入的任意多邊形轉(zhuǎn)成多個(gè)凸多邊形。Shapely庫(kù)提供了polygonize和triangulate函數(shù)我優(yōu)先推薦三角剖分轉(zhuǎn)凸分解的方式因?yàn)閷?duì)凹角處理得更干凈。import numpy as np from shapely.geometry import Polygon from shapely.ops import triangulate def preprocess_region(boundary_points): 輸入邊界坐標(biāo)點(diǎn)輸出凸多邊形列表 # 構(gòu)造多邊形 poly Polygon(boundary_points) if not poly.is_valid: poly poly.buffer(0) # 處理自交情況 # 如果本身就是凸多邊形直接返回 if poly.convex_hull.equals(poly): return [poly] # 凹多邊形三角剖分后按鄰接關(guān)系合并成凸子區(qū)域 triangles list(triangulate(poly)) sub_regions [] for tri in triangles: if tri.centroid.within(poly): sub_regions.append(tri) return sub_regions這段代碼里有個(gè)細(xì)節(jié)值得說(shuō)poly.buffer(0)是Shapely里處理無(wú)效幾何的常用技巧原理是給多邊形加一個(gè)約等于0的緩沖距離讓Shapely重新計(jì)算幾何關(guān)系能修正自交或退化的邊界。這個(gè)操作在實(shí)戰(zhàn)中經(jīng)常用到特別是當(dāng)輸入坐標(biāo)是從地圖軟件里手工點(diǎn)出來(lái)、帶了輕微誤差的時(shí)候。第二步計(jì)算最優(yōu)掃描方向子區(qū)域可能是任意朝向的四邊形直接沿x軸掃描可能產(chǎn)生不必要的轉(zhuǎn)彎。我的做法是計(jì)算子區(qū)域的主方向Main Direction即旋轉(zhuǎn)掃描線找到一個(gè)角度使得在這個(gè)角度下覆蓋次數(shù)最少。實(shí)際上最優(yōu)角度往往是區(qū)域最長(zhǎng)邊方向或者使用PCA主成分分析求點(diǎn)集的第一個(gè)主成分方向近似效果已經(jīng)很好。def compute_scan_direction(polygon): 用PCA計(jì)算多邊形頂點(diǎn)的主方向 該方向作為牛耕式掃描的航線方向。 coords np.array(polygon.exterior.coords) centroid coords.mean(axis0) centered coords - centroid # 協(xié)方差矩陣 cov np.cov(centered.T) # 特征值分解最大特征值對(duì)應(yīng)的特征向量即主方向 eig_vals, eig_vecs np.linalg.eig(cov) main_dir eig_vecs[:, np.argmax(eig_vals)] angle np.arctan2(main_dir[1], main_dir[0]) return anglePCA求主方向的方法參考了粒子群算法里尋找最優(yōu)方向的思想——雖然不是全局最優(yōu)但勝在快、穩(wěn)定。如果你對(duì)這個(gè)方向特別敏感比如農(nóng)田有播種壟向必須沿壟向飛也可以在參數(shù)文件里直接手動(dòng)指定scan_angle覆蓋自動(dòng)計(jì)算值。第三步生成航點(diǎn)序列拿到了掃描方向和子區(qū)域之后生成航點(diǎn)就是個(gè)幾何計(jì)算問(wèn)題。我把子區(qū)域旋轉(zhuǎn)到掃描方向?yàn)樗缴伤酵稻€再旋轉(zhuǎn)回原坐標(biāo)系。def generate_waypoints(polygon, scan_angle, coverage_width): 根據(jù)子多邊形、掃描方向和覆蓋寬度 生成牛耕式往返航點(diǎn)序列。 # 旋轉(zhuǎn)到掃描角度為0 rotated_poly rotate(polygon, -scan_angle) minx, miny, maxx, maxy rotated_poly.bounds # 按照覆蓋寬度生成平行線 y miny waypoints [] direction 1 # 1表示從左向右-1表示從右向左 while y maxy: x_start minx x_end maxx if direction -1: x_start, x_end x_end, x_start wp_start (x_start, y) wp_end (x_end, y) waypoints.append((wp_start, wp_end)) y coverage_width direction * -1 # 把航線旋轉(zhuǎn)回原坐標(biāo)系 final_waypoints [] for seg in waypoints: p1 rotate_point(seg[0], scan_angle) p2 rotate_point(seg[1], scan_angle) final_waypoints.extend([p1, p2]) return final_waypoints這里我給出的是簡(jiǎn)化的版本實(shí)際工程里還需要處理幾個(gè)關(guān)鍵點(diǎn)航點(diǎn)插值飛控執(zhí)行任務(wù)時(shí)兩個(gè)航點(diǎn)之間的距離如果超過(guò)一定閾值需要插值出中間點(diǎn)。我一般設(shè)置最大段距為15m超過(guò)就線性插值。航線外擴(kuò)實(shí)際作業(yè)時(shí)無(wú)人機(jī)的傳感器視場(chǎng)中心是飛行軌跡而覆蓋區(qū)域是這個(gè)中心組成的條帶。所以航線不能剛好從區(qū)域邊界開(kāi)始而應(yīng)外擴(kuò)coverage_width / 2確保邊緣也能覆蓋到。這個(gè)偏移量雖然不大但很關(guān)鍵不然邊界會(huì)漏。轉(zhuǎn)彎弧線對(duì)于固定翼或高速飛行的無(wú)人機(jī)直線航線之間的轉(zhuǎn)彎是弧線。這個(gè)在ROS里一般通過(guò)加轉(zhuǎn)彎航點(diǎn)實(shí)現(xiàn)但我這個(gè)項(xiàng)目是旋翼機(jī)轉(zhuǎn)彎半徑小直接生成直角轉(zhuǎn)角就行。在上面的代碼基礎(chǔ)上我把完整的主節(jié)點(diǎn)coverage_planner_node.py的核心邏輯補(bǔ)成一個(gè)可以直接跑的流程。#!/usr/bin/env python import rospy import numpy as np from shapely.geometry import Polygon from shapely.affinity import rotate from geometry_msgs.msg import PolygonStamped, Point32 from visualization_msgs.msg import Marker, MarkerArray import yaml import math class CoveragePlannerNode: def __init__(self): rospy.init_node(coverage_planner_node) self.waypoint_pub rospy.Publisher( /coverage_planner/waypoints, MarkerArray, queue_size1) self.mission_polygon_pub rospy.Publisher( /coverage_planner/mission_polygon, PolygonStamped, queue_size1) # 加載參數(shù) self.coverage_width rospy.get_param(~coverage_width, 8.0) self.safe_offset rospy.get_param(~safe_offset, 2.0) # 任務(wù)區(qū)域從yaml讀取 self.area_points self.load_area() def load_area(self): 從mission_area.yaml讀取目標(biāo)區(qū)域經(jīng)緯度或本地坐標(biāo) with open(rospy.get_param(~area_config), r) as f: config yaml.safe_load(f) return config[area] def run(self): # 簡(jiǎn)化主流程 polygon Polygon(self.area_points) angle compute_scan_direction(polygon) wps generate_waypoints(polygon, angle, self.coverage_width) # 發(fā)布marker用于可視化 marker_array MarkerArray() # ... 構(gòu)建marker ... self.waypoint_pub.publish(marker_array) rospy.spin() if __name__ __main__: try: CoveragePlannerNode().run() except rospy.ROSInterruptException: pass4. Gazebo仿真驗(yàn)證與航點(diǎn)測(cè)試算法寫(xiě)完之后直接上真機(jī)是危險(xiǎn)的我習(xí)慣先在Gazebo里跑PX4的軟件在環(huán)仿真SITL。這個(gè)環(huán)節(jié)不復(fù)雜但有個(gè)關(guān)鍵點(diǎn)仿真環(huán)境里要有一個(gè)能反映真實(shí)場(chǎng)景的地圖模型不然驗(yàn)證效果打折。我用的仿真搭建方式安裝PX4 SITL環(huán)境和Gazebo# 在Ubuntu 18.04上克隆PX4固件 git clone https://github.com/PX4/PX4-Autopilot.git --recursive cd PX4-Autopilot make px4_sitl gazebo啟動(dòng)MAVROS讓ROS和仿真飛控建立通信roslaunch mavros px4.launch fcu_url:udp://:14540127.0.0.1:14557啟動(dòng)我的規(guī)劃功能包roslaunch uav_coverage_planner planner.launch在Rviz里可以直觀看到規(guī)劃出來(lái)的航線是否覆蓋了整個(gè)區(qū)域同時(shí)也能看飛控是否按航線飛行。我一般是先發(fā)一個(gè)簡(jiǎn)單的小矩形區(qū)域測(cè)試比如20m x 15m覆蓋寬度8m這樣理論上是3條航線、2次轉(zhuǎn)彎。如果這個(gè)都跑不對(duì)后面復(fù)雜區(qū)域不用測(cè)了。仿真中我遇到的最典型問(wèn)題有兩個(gè)這里先說(shuō)第一個(gè)第二個(gè)放在后面踩坑章節(jié)細(xì)講。第一個(gè)問(wèn)題是坐標(biāo)系的混亂。Gazebo里PX4飛控發(fā)出的GPS坐標(biāo)是模擬的球面坐標(biāo)經(jīng)緯度而我的規(guī)劃算法是在平面直角坐標(biāo)系里計(jì)算的。如果直接把算法生成的平面坐標(biāo)上傳給飛控飛控會(huì)當(dāng)成經(jīng)緯度解析航線就會(huì)跑到印度洋去。解決方法是在MAVROS里做坐標(biāo)轉(zhuǎn)換把規(guī)劃航線的平面坐標(biāo)結(jié)合起飛點(diǎn)的經(jīng)緯度和航向角轉(zhuǎn)換為經(jīng)緯度坐標(biāo)再上傳。MAVROS提供了/mavros/global_position/global話題里的坐標(biāo)信息可以直接拿來(lái)做轉(zhuǎn)換基準(zhǔn)。def local_to_global(local_x, local_y, origin_lat, origin_lon, origin_yaw): 將本地平面坐標(biāo)轉(zhuǎn)換為GPS經(jīng)緯度WGS84 EARTH_RADIUS 6378137.0 # 先把本地坐標(biāo)旋轉(zhuǎn)到原坐標(biāo)系因?yàn)橐?guī)劃時(shí)可能旋轉(zhuǎn)過(guò) cos_yaw math.cos(origin_yaw) sin_yaw math.sin(origin_yaw) dx local_x * cos_yaw - local_y * sin_yaw dy local_x * sin_yaw local_y * cos_yaw # 經(jīng)緯度增量 d_lat dy / EARTH_RADIUS d_lon dx / (EARTH_RADIUS * math.cos(math.radians(origin_lat))) return origin_lat math.degrees(d_lat), origin_lon math.degrees(d_lon)第二個(gè)問(wèn)題是航點(diǎn)跟隨精度。Gazebo里飛控用默認(rèn)的L1控制器跟隨時(shí)如果航點(diǎn)間距太大或變化方向太陡飛機(jī)容易沖出航線尤其是在轉(zhuǎn)彎處。我后來(lái)在航線密集的地方加了航點(diǎn)插值并且把最大水平速度限制在8m/s以內(nèi)效果好了很多。仿真驗(yàn)證通過(guò)后我的最后一步是在實(shí)際場(chǎng)地跑一次小規(guī)模任務(wù)一塊50m x 30m的矩形空地覆蓋寬度10m飛行高度30m。實(shí)際飛行結(jié)果航線總長(zhǎng)約300m飛行時(shí)間接近90s覆蓋率通過(guò)事后檢查相機(jī)拍攝畫(huà)面達(dá)到了95%以上重復(fù)率在10%以下。對(duì)于這個(gè)規(guī)模的任務(wù)結(jié)果完全可以接受。5. 調(diào)試過(guò)程中避開(kāi)的坑與參數(shù)調(diào)優(yōu)心得這個(gè)項(xiàng)目做下來(lái)我踩了不少坑也總結(jié)了一些經(jīng)驗(yàn)。前面講過(guò)坐標(biāo)系轉(zhuǎn)換問(wèn)題這里再說(shuō)幾個(gè)影響比較大的希望后來(lái)的人少走彎路。第一個(gè)坑ROS1的tf樹(shù)過(guò)期導(dǎo)致飛控拒收航點(diǎn)?,F(xiàn)象是規(guī)劃完整條航線MAVROS推送mission的時(shí)候提示Reject waypoint飛控那邊沒(méi)有任何反應(yīng)。查了好幾天才定位到原因是我的機(jī)載電腦上時(shí)間同步有問(wèn)題導(dǎo)致ROS的/tf坐標(biāo)變換樹(shù)過(guò)期。PX4飛控在接收外部任務(wù)時(shí)會(huì)檢查時(shí)間戳的有效性如果tf過(guò)期時(shí)間超過(guò)設(shè)定閾值會(huì)直接拒絕任務(wù)。解決辦法就是在起飛前執(zhí)行sudo apt install chrony sudo chronyd -q pool cn.pool.ntp.org iburst確保系統(tǒng)時(shí)間和GPS時(shí)間同步。這個(gè)坑在真機(jī)上特別容易踩反而是Gazebo仿真里因?yàn)闀r(shí)間由仿真器控制沒(méi)有這個(gè)問(wèn)題。第二個(gè)坑MAVROS的mission模式切換時(shí)序。自動(dòng)執(zhí)行任務(wù)需要先把飛控切到AUTO.MISSION模式再上傳航點(diǎn)或者先上傳再切換。我一開(kāi)始是上傳完航點(diǎn)立刻發(fā)模式切換指令但飛控經(jīng)常報(bào)錯(cuò)。后來(lái)查PX4源碼這部分我參考了西門(mén)子無(wú)人機(jī)編程實(shí)例里的飛控邏輯發(fā)現(xiàn)PX4在接收到MAV_CMD_MISSION_START指令后需要確認(rèn)航點(diǎn)已經(jīng)全部寫(xiě)入并且在當(dāng)前狀態(tài)機(jī)的正確狀態(tài)才能切換。解決辦法是在發(fā)布模式切換指令前查詢飛控的mission狀態(tài)rosservice call /mavros/mission/clear rosservice call /mavros/mission/push # 等待mission確認(rèn) sleep 3 rosservice call /mavros/set_mode base_mode: 0 custom_mode: AUTO.MISSION這個(gè)3秒的sleep看起來(lái)很粗糙但確實(shí)有效因?yàn)轱w控內(nèi)部處理mission列表需要時(shí)間不給它這個(gè)時(shí)間窗口后面就會(huì)出各種奇奇怪怪的問(wèn)題。第三個(gè)坑覆蓋寬度的標(biāo)定不能只看傳感器名義值。我最初把覆蓋寬度設(shè)成無(wú)人機(jī)相機(jī)視場(chǎng)在地面上的投影寬度但實(shí)際飛出來(lái)發(fā)現(xiàn)覆蓋率根本不夠。原因是相機(jī)安裝在無(wú)人機(jī)下方會(huì)有一點(diǎn)傾斜角度而且飛控的高度控制有誤差±0.5m左右導(dǎo)致實(shí)際視場(chǎng)比理論值小。用我的經(jīng)驗(yàn)安全起見(jiàn)應(yīng)該把覆蓋寬度設(shè)成理論視場(chǎng)寬度的75%這樣雖然重復(fù)率會(huì)上升一些但能保證不漏覆蓋。如果你用的是RTK高精度定位飛控高度控制很穩(wěn)定這個(gè)系數(shù)可以放寬到85%。最后一個(gè)實(shí)用的調(diào)參心得是關(guān)于航點(diǎn)高度。從Pixhawk飛控執(zhí)行mission的經(jīng)驗(yàn)來(lái)看PX4在AUTO.MISSION模式下航點(diǎn)之間會(huì)做一個(gè)平滑的高度變化。如果你在一條航線上頻繁改變高度飛控的垂直速度會(huì)跟不上容易觸發(fā)高度誤差過(guò)大報(bào)警。建議覆蓋任務(wù)盡量保持同一飛行高度只有在跨子區(qū)域時(shí)才有必要改變高度并且高度差要小于5m否則就拆成兩個(gè)單獨(dú)的任務(wù)執(zhí)行。6. 從仿真到實(shí)機(jī)的完整測(cè)試鏈路與下一步擴(kuò)展方向整理一下我的完整測(cè)試流程給打算復(fù)現(xiàn)這個(gè)項(xiàng)目的朋友一個(gè)參考階段驗(yàn)證內(nèi)容耗時(shí)估算Gazebo仿真算法邏輯、航點(diǎn)正確性、坐標(biāo)轉(zhuǎn)換1-2天室內(nèi)視線內(nèi)測(cè)試小區(qū)域20m以下航點(diǎn)跟隨精度半天室外小規(guī)模測(cè)試50m級(jí)矩形區(qū)域完整任務(wù)1天室外復(fù)雜區(qū)域測(cè)試凹多邊形、多子區(qū)域銜接1-2天測(cè)試中我養(yǎng)成了一個(gè)習(xí)慣每次試驗(yàn)前先記錄起飛點(diǎn)的經(jīng)緯度和朝向飛行結(jié)束后把PX4的ULog日志導(dǎo)出來(lái)用plotjuggler查看實(shí)際飛行軌跡和規(guī)劃航線的偏差。這樣做一次就能發(fā)現(xiàn)很多肉眼看不到的問(wèn)題比如某個(gè)航點(diǎn)漂移、轉(zhuǎn)彎處軌跡外擴(kuò)等。關(guān)于下一步的擴(kuò)展方向我目前在做兩個(gè)改進(jìn)。第一個(gè)是加入實(shí)時(shí)避障模塊在機(jī)載電腦上接入一個(gè)前視攝像頭用深度學(xué)習(xí)目標(biāo)檢測(cè)識(shí)別飛行路徑上的障礙物一旦識(shí)別到障礙就把未完成的航線臨時(shí)掛起讓飛控切換到OFFBOARD模式繞過(guò)障礙后回來(lái)繼續(xù)執(zhí)行。第二個(gè)是動(dòng)態(tài)覆蓋現(xiàn)在我的規(guī)劃是靜態(tài)的如果目標(biāo)區(qū)域有動(dòng)態(tài)變化比如搜救任務(wù)中被困者在移動(dòng)就需要在飛行過(guò)程中重規(guī)劃。目前我在調(diào)研粒子群算法和快速探索隨機(jī)樹(shù)RRT結(jié)合的方法希望能讓系統(tǒng)在幾秒鐘內(nèi)完成局部重規(guī)劃。最后提一句ROS1雖然年紀(jì)不小了但在無(wú)人機(jī)領(lǐng)域生態(tài)依然很成熟尤其MAVROS和PX4社區(qū)的文檔積累非常多。這個(gè)項(xiàng)目用ROS1做原型驗(yàn)證、算法迭代效率比直接從ROS2開(kāi)始高很多。如果你所在的項(xiàng)目組沒(méi)有強(qiáng)制的ROS2遷移要求我建議先從ROS1搭起這套思路后續(xù)平移ROS2也不算太難。本文還有配套的精品資源點(diǎn)擊獲取
返回列表
PREV
查看更多資訊
NEXT
返回資訊列表
一级做受视频免费是看美女| 91久久国产精品| 男女啊啊啊啊啊| 国内毛片国产欧美拍| 色色热| 超碰碰激情97+久| 欧美综合色,www| 蜜桃狠狠色伊人亚洲综合网站| 欧美精品xxxwww| 亚洲精品欧美专业| 精品人妻免费观看| 久久久久久夜夜夜夜夜| 91丝袜美女视频| 亚欧性爱ab| 国产精品熟女九九九| 国产1024在线播放| 99久久无色码| 蜜臀久久99精品久久久久久无删减| 国产福利影视| 就去色综合| 日韩一级免费性爱| 国产三级中文字幕粉嫩| 中国国国产一级特黄毛片| 麻豆AV短剧| 97无码视频在线播放| 97香焦色区| 欧美天天干| 精品国产少妇高潮视频| 日本熟妇熟色97一本在线观看| 夜夜操天天肏| 曰韩中文人妻视频| 久草久热| 免费精品国偷自产在线在线 | 亚洲男人的天堂AV| 欧美色宗合| 人妻少妇视频在线播放| 一起草三级AV电影在线观看| 二区熟妇韩日| 欧美综合娱乐久久| 色与欲影视天天看综合网| 日韩欧美经典在线观看| 久久男人的天堂| 美女黄页| 日本天天操| 久久久一区二区| 蜜桃av综合网发布| 中文字幕一区二区无码成人 | 激情综合av| 精品亚洲国产成人av网站| 欧美在线中M| 天天看,天天做| 99re视频在线播放青草| 亚洲综合113页| 中文字幕国产在线天堂| 久插不卡| 日本一级黄色电影| 1769一区| 欧亚日韩综合精品国产| 亚洲啪啪性视频| 欧美综合网A| 澳门成人网站久国产日韩| 精品国产一区二区三区在线播出| 久久久久久久| 丝袜美女诱惑 91 视频| 亚洲综合97中文网| 搡老人老9丨女老熟人| 久久大香蕉97| 999 久久久| www.99在线| 天天噜| 国产熟妇一区二区| av在线资源| 1769国内精品视频| 99热婷婷一区二区三| www.狠狠操| 大香蕉乱级| 欧美人黑A片无码免视费| 97色伦欧美| 亚洲国产一区二区入口| 国内伊人久久久久久网站视频| 九X超碰| 亚洲四虎熟女精品| 九九视频黄色片| 啊啊啊啊啊舒服| 黄色污污污污污污网站| 国产精品自在线发布| 91精品导航| 91色图片| 精品国产乱码久久久久A| 中文字幕一区二区三区四区在线视频| 狠狠爱夜夜| 97精品第3页| 床上啊啊啊一区二区三区| 凹凸久久人人| gogogo免费高清看中国国语| 亚洲开心网| 国产91专区| 久久偷拍人| 久久午夜伦| 亚洲精品aa久久伊人| 亚洲最新Av| 色图四区| 91高清欧美| 欧美日本天堂| Av色五月| 日韩pv中文| 欧美丰满熟妇XXXX性ppX人交| 8x福利精品第一福利视频导航| 亚洲少妇自拍中文字幕懂色| 97频视在线| 日韩一级性爱无码| 欧美色图91| 一本色道久久综合亚洲二区三区| 国产麻豆一区二三区| 麻豆黄四叶草网站| 亚洲精品色| 大香蕉一级黄色片久久| 偷拍导航视频网站| 色噜噜日韩精品| 色在线69堂| 97精品国产手机| 97香焦色区| a久久| www.zbzhongsen.com| 萌白酱自拍视频| 欧美一区二区三区不卡高清视频 | 蜜臀99久久精品| www.高清无码诱惑一区.com| 欧美一区二区传媒| 97自拍一区| 91AV老熟女视频| 欧美一区二区亚洲天堂| 亚洲古典另类欧美在线| 91 亚洲 欧美 日韩 国产 综合| 亚洲无线码欧洲精品区别| 国产一区二区成人av在线播放| 精品高潮| 不卡中文字幕aⅴ在线| 三级日韩一区二区三区| 午夜美女福利视频| 欧美不卡在线一区二区| 精品久久久久久无码| 国产多人在线观看视频| 99精品视频在线观看免费| 2021久久国产综合精品青草| 探花精品视频| 熟妇在线视频一区二区| 97色五月天完| 久久免费看高潮毛片韩国| 蜜臀久久99精品久久久久免费观| 久久99手机免费视频| 天天天天做夜夜夜夜做| 四虎免费在线播放| 日逼97| 97欧美日韩精品| 狠久久| 97chaopengongkai| 无码精品久久久久久亚洲| 17c嫩草51久久91嫩草| 最新国内自拍av免费| 九九干| 亚洲AV无码国产精品久久久久| 色爱综合网| 久久久久久久久一区二区三区| 97超碰精品图片| 搡老女人老91二区| 人妻一区二区三区四区视频| 中文日本免费高清| 天天插天天操| 国产无遮挡| 天天内射| 青草精品视频日本久久久久网站在线| 日韩免费在线观看不卡| 乱伦日本色图AⅤ| www.99在线| 亚洲综合在线视频| 在线综合 亚洲 欧美中文字幕 | 在线岛| 亚洲国产一区二区三区四区国产| 久操综合在线| 日韩 欧美 国产 麻豆| 午夜无码熟妇丰满人妻| 亚洲国产熟妇综合色专区| 免费看片黄| 99自拍视频| 蜜伊人色综合97| 我想要啊 啊 啊| 国产精品播放| 欧美性爱十八禁| 天美精品av| 国产情色在线| 中日亚韩免费视频| 69人妻人人揉人人躁人人精品| 亚洲成人一二三区| 女人天堂网| 欧美激情性久久久久久| 91人妻超碰| 五月天人妻综合| 四虎在线观看视频| 亚洲精品日韩国产欧美| 亚洲蜜臀懂色| 特色a在线上| 睡产熟女乱伦| 精品人妻1237| 日韩三级av片| 亚洲日韩国产欧美综合v| 91女网站| 中文字幕欧美丝袜07资源| 操操逼视频| 精品人妻伦一二三区久久| 蜜臀久久久| 超碰偷拍| 岛国艾薇凹凸视频天堂| 91天天爱| 国产乱伦性爱区| 中文字幕高清20页视频| 嗯嗯不要 视频| 人人操人人干网页| 在线 亚洲 网爆 自拍| 久久久久久久久9| 国产精品久久天天干| 天天综合91在线| 亚洲成人在线资源| 激情小说成人日本无码一| 人人操天天爽| 色99999| 婷婷五月色| 九七人妻在线| 手机在线观看不卡无码av| 欧美伦乱爱| 亚洲日韩av专区无码| 发朗少妇买婬全视频中文| 中文字幕免费在线观看| 人人摸人人干人人拍97| 青青伊人加勒比海| 久久性爱网站| 0755午夜福利视频| 综合婷婷| 日少妇视频| 成人乱码一区二区三少妇| 一区二区三区无卡视频在线观看| 伊人丁香五月婷婷| 天天激色| 国产麻豆一级精品视频| 熟妇无码视频三区| 动漫爆乳3D奶水一区在线观看 | av久日| 在线一道啪| 久久久久久波多野吉衣高潮| 亚洲精品国产专区在线观看| 好屌色综合| 隔壁邻居波多野结衣中文字幕| 五月天伊人| 日韩欧美大力操| 一本一首道人妻少妇免费久久| 久久性爱精品一区| 欧洲亚洲综合| 91精品大奶人妻| 欧美 亚洲 在线| 日韩在线76| 夜夜骑夜夜操| 精品国产72| 99在线无码精品秘 入口黑人| 亚洲综合校园春色| 久热久| 国产91 丝袜在线播放00-百度| 久操大香蕉手机视频在线看| 亚欧无码线免费观看视频| 日本丝袜美腿人妻九九| 美女极品一区二区三区| 欧美综合综合| 日韩欧美麻豆大片| 狼狼色丁香久久婷婷综合五月 | 蜜臀99久| 9热9热综合网| 成人一级性爱| 亚洲欧美激情小说| 精品福利视频| 日本色色色视频| 日韩精品亚洲一二三| 欧美日韩性感| 国产乱人伦AVA麻豆软件.| 国产又粗又长又大的视频| 天天摸,夜夜摸| 精品三级在线专区| 99蜜月精品久久| 中文字幕二区日韩天堂| 97啪啪| 国产第二页| 狠狠干狠狠色| AV天堂国产| 啊啊啊啊啊好舒服视频| 九九碰九九爱97超碰| aaa亚无码专区| 久草久日| 日韩精品人妻系列无码天堂| 欧美啪啪女女| 天天网综合| 青青草十区九区爱夜| 青青操狠狠撩| 国产视频一区二区三区在线免费观看| 好湿好紧视频| 五月天色图| 操比国产| 小日子操bb在线看| 激情文学88| 韩国嫰模上门援交视频| 夜夜狼人妻| 色色色色网站| 天天看天天在线精品| 人人妻人人澡人人爽人人精品浪潮| 美腿丝袜高跟网免费视频免费视频| 久久老子无码午夜伦不卡| 极品销魂美女一区二区| 欲香欲色| 99久久久| 后入式999| 男人下部插入女人下部| 大香蕉丝袜一级片| 欧美久久人人网| 超碰欧美| 久久六六| 亚洲色图 欧美| 国产超碰97| 日韩久久艹| 免费看污网站| 1956日韩精品| 四虎AV在线观看| a级理论午夜日本| 五月婷网站| 日欧操屄| 国产亚洲精品一区二区三区| 男人的天堂免费| 俺也射| 91影视亚洲| 中文字幕精品人妻丝袜| 色97| 久久超碰久| 亚洲超碰在线| 日欧操屄视频| 日韩欧美俄罗斯A片| 天天激情干| 思思视频免费看网站| 加勒比综合网| 大象AV在线| 欧美天天影院| 亚洲人人夜夜澡人人爽| 97超碰色中文字幕| 职场同事知名国产国产精品久久欧美日韩 | 免费黄色片。| 国产乱伦亚洲| 国产亚洲中文不卡二区| 青娱乐国产精品| 伊人色综合欧美| 日本最新免费韩国1区2区视频播放| 欧美se亚洲| 一区 欧美 日韩 麻豆| 综合激情97| 欧美色图私拍91| 97色论| 亚洲第一二区另类图| 殴美日韩m| 久久中文色图| 久久久性爱视频| 欧美色天堂网在线视频| 国产极品美女高潮无套在线观看| yellow网站免费观看日韩高清无码| 亚洲国产奇米影视久久| 国模精品娜娜一二三区 | www.人人cao| 中文字幕一区日韩精| 色人久久| 国产怡红院| 熟女自慰久久久| 久操网在线| 99国内熟女露脸视频| 欧美性Fer办公室秘书| 日韩在线观看AV| 天天拍夜夜| 日韩欧美性爱电影在线观看| 国产精品第一区第一页| 中文字幕一二区二三区人妻专区| 亚洲激情综合另类男同| 欧美一区二区亚洲天堂| 青青草视频爽一爽| 无码人妻精品一区二区三区九九| 性高潮久久久久久久久久久| 99精品在线| 校园春色 亚洲| 操碰97| 免费A片三p视频| 四虎国产精品永久地址入口| 综合一区二区影视| 亚洲男人天堂视频| 狠狠超| 欧美性生活免费网| 综合五月婷婷| 大香蕉一人在线| 欧美后入式| 97精品| 26uuu国产日韩综合在线观看| 97久久久| 欧美一二在线| 97欧美综合网| 日本免费人成视频播放120秒| 国产小黄片在线免费观看| 欧美做爰无码A片视频| 国产精品国产自产拍高清AV| 欧美在线第五页| 无码不卡亚洲成?人片| 无码免费精品高清| 男人下部插入女人下部| 亚洲AV永久无码精品成人调教| 国产成人欧美精品在线| 丁香色婷婷| 亚洲AV不卡在线观看尤物| 91老司机精品| 精品丝袜无码一区二区三APP| 日本Xx性爱| 91女网站| 婷婷10月天青娱乐| 国产成人综合在线播放| 九九热男人天堂| 蜜汁欧美| 国产精品999zyz| 精品人妻1237| 人妻天天夜夜爽一区二区| 欧美日韩亚洲高清不卡一区二区三区| 四虎免费视频| 精品国产乱码久久久久久久久久毛片 | 正宗无毛一线天嫩逼| 东京热,男人的天堂| 高清孕妇孕交 交| 午夜操一视频一区| 欧美成人A√在线一区二区| 亚洲色图日韩精品| 欧美夜夜狠| 亚洲性图91| 国产视频一区二区免费| 亚洲欧洲中文日韩女优乱码| 26UUU欧美激情一区二区| 亚洲欧美清纯| q2午夜理论片夜色av| av网站免费线看| 97久久精品亚洲| 9 1果冻精品视频| 高潮的A片激情扒开一区| 午夜男人天堂| 我要色综合网| 蜜乳av首页| 99热日| 大香蕉免费3| 成人AV超碰免费在线| 人妻少妇一区二区| 国际精品久久久| 久久黄色性爱视频| 天天看特黄的免费网站| 欧美激情性爱视频网站| 欧美伦乱爱| 中字幕人妻一区二区三区| 1024亚洲中文字幕久在线看片你懂的| 国产乱码久久久| 亚洲第一在线视频| 玖玖无码超碰| 91五月天| 黄页av| 婷婷AV一区二区三区| 久久久成人精品| 国产探花日韩援交| 国产精品视频| 亚洲精品aa久久伊人| 麻豆a'v电影| 国产精品青草综合久久| 少妇激情一区二区三区视频| 婷婷色一区| 无码久久国产 | 五月黑AⅤ| 色欲av国内精品久久久久久| 久久国产三区| 天天上日日上日韩精品| 国厂麻豆77q4| 亚洲性爱无码乱伦av| 东京热AV男人的天堂| 五月天丁香网| 国产强奸乱伦第1页| 欧美一二三区四五区| 翔田千里无码中出中文字幕| 久久久精品久久| AAAAAAAAA黄片| 亚洲欧美天| 97婷婷色| 久久国产熟女影院| 亚洲国产精品久久久久婷婷老年| www.色婷婷色综合| 色图综合| 级品肉射| 综合五月婷婷| 被操高清无码视频| 亚洲精品国产熟女久久久| 美国日韩黄色片| 97超碰9| 91麻豆天美国产| 国产一级操B视频| 亚洲熟妇A V黑人| 一及黄久一点| 亚洲精品久久久久毛片A片拉屎| 狠狠五月天| 欧美少妇色图| 亚洲棕合电彰| 操逼日韩无码| 立川理惠被中出无码| 伊人四虎综合| 欧美久久草熟女| 黄在线| 91精片| 中文字幕视频免费| 亚洲av夫妻操穴网| 亚欧日韩成人| 超碰91在线| 超碰69| 精品久久久av| 久久一级无码精品毛片6| 丝袜美腿亚洲| 无码二级三级| 99re只有精品| 亚洲va综合va国产va中文| 超碰成人公开| 国产精品午夜AV完会免费| 中字一区| 都市激情人妻一区二区青青操视频| 九九在线精品| 国产熟女乱论| 国产乱伦搜索结果91P| 久9综合在线| 亚洲欧美setu| 国产成人综合网| 性爱乱伦视频免费| 亚洲中字幕日本一区二区三区| 好一吊区二区| 人妻少妇色综合| 综合日本女人伊人| 國產尤物AV尤物在線觀看| 亚洲春色一区二区三区| 外国91| 九九热午夜欧亚国产视频| 久热精品色情| 老女人日韩美91| 色综合尤物| 啪啪视频亚洲第一| 偷拍偷窥与盗摄视频专区| 亚洲毛片久久| 亚洲第一视频 欧美风情 日韩| 日韩美女高潮喷水视频| 密臀AV在线| 冬京热男人的天堂| 精品久久久无码| 久久久五月天| 亚洲精品久久久久久久蜜桃臀| 精品中文字幕一区二区| 男人的天堂午夜av| 亚洲乱色熟女一区| 精品人妻中文字幕高清| 亚洲无992tv| 亚洲欧美人妻| 国产精品99999| 亚洲在线a| 97国产超碰| 一区二区高清视频| 综合亚洲欧美| 麻豆AV一区二区天美传媒| 麻豆熟妇乱妇熟色A片在线看| 伊人欧美大香蕉视频| 91精品婷婷国产综合久久| 一区二三区四区视频大全套| 99re在线精品78| 久久噜| 日韩国产九九精品一区二区三区毛片| 91美女色视频亚洲| 小骚逼被操的爽不爽| 97久久超碰国产网站| 动漫片子网站3黄| 欧美欲色| 伊人991| 国产美女激情| 99精品久久久久久| 丰满人妻一区二区中文| 欧美人妻熟女在线| 4虎在线观看| 日夜伊人网| 日本高清免费一本视频在线观看| 国产精品视频自拍在线| 狠狠色噜噜狠狠狠狠狠色综合久久| japan日本高清乱xxxx| 天天草天天干天天日| 中文字幕 码精品视频网站| 亚洲人妻一区二区三区| 97综合国产精品高潮久久| 老熟妇综合| 久久久久久裸体| 91bbbbbb| 激情小说亚洲| 久操九九九九九九九九九九九九九九九九九九九九九九九九九九九九 | 偷拍偷窥与盗摄视频专区| 日产操逼| 日本国产亚洲一区在线观看| 女人被男人桶爽视频网站| 久操网线| 综合欧美日本三级| 少妇二级| 美女黑人91神马| 精品少妇一区二区| 秋霞色色影院| 色综合国产在线观看| 三级网色| 久久超碰爱| 九九九午夜| 国产噜噜噜噜噜久久久久久久久| 青青草综合在线| 日韩免费中文字幕视频| 欧亚性爱视频免费看| 青青网三级视频| 一级黄色性爱A级片| 99色天堂| 干B| 丰满人妻一区二区三区蜜桃视频| 免费自拍三级综合| 噜噜噜在线视频| 五月激情在线| 97欧美日韩中文| 亚洲欧美首页| 欧美日本国产日韩激情视频| 久久久工口| 欧美瑟综合| 欧美日韩国产一区二区小黄片大全| 性爱乱伦网址| 久久国99999| 蜜臀久久99精品久久久久久酒店| 无码人妻丰满热妇又大又粗| 亚洲s在线观看| 中文字幕欧洲有码| 亚洲字幕一区二区| 久久久久久亚洲精品中文字幕人妻| 久久超碰大香蕉| 日韩视频中文字幕| 久热九九| 五十路成人在线视频二区三区| 国产一区二区三区高清视频| 啊视频在线| 久草精品一区 | 黄色十八禁| 精品视频在线观看| 激情综合网五月婷婷| 天天摸夜夜操视频| 探花视频免费观看国产专区| 婷婷在线播放| …中文字幕亚洲乱,97人妻无码费视… | 亚洲影视第一页| 亚洲国产精品有声| 嗯嗯嗯不要不要免费视频| 欧美黄色大香蕉一区二区| 免费人人搞97| 久久久一区二区三区麻豆| 91高清无码下载| 97香焦色区| 久久久精品网| 97色婷婷| 蜜臀Av一区二区三区| 国产aⅴ无码片毛片一级网站| 97欧美精品综合| 大香蕉人妻久久| 亚洲二区精品在线观看| 亚洲网污污污污| 岛国黄| 九草在线大香蕉| 日韩欧美加勒比| 婷婷色网| 深夜视频| 国语人妻精彩刺激| 国产传媒一区二区三区| 中文字幕在线日亚州9| 日本高清一本二本免费不卡| 1024人妻熟女一区二区三区| 97射欧美| 色狠狠综合| 欧美黑人与女人91| 亚洲精品色| 青青久久艹| 国产欧美伊人| 成年无码动漫av片无尽在线 | 99精品在线| 欧美 亚洲 在线| 人妻少妇久久久| 精品国产肉丝袜在线拍国语| 欧美超碰人妻97| 一区二区视频在线播放| 亚洲综合色在线| 人妻aa| 女上位精品在线| 九九久久综合| 天天操天天舔| 久久久久精| 美女天天干| 黄网站黄视频网站进入口| 国产东北女人在线视频| 亚洲高清男人天堂| 在线观看成人性爱免费小视频| 啊啊啊啊啊啊啊在线| 日本精品第一视频在'| 日日摸日日碰夜夜爽视频| 亚洲一区中文字幕久久,果冻传媒一区二区天美传媒 | 在线洲亚线| 激情综合五月| 97在线视频观看| 日韩不卡码| 91精品啪在线观看国产城中村| 亚洲日韩东京热一区| 视频分类 国内精品| 99国产女人| 五月天久久婷婷亚洲 | 97色欧州| 高跟丝袜AV专区国产| 综合五月天| 国产蜜臀精品一区免费尤物| 精品一区96| 无码高清少妇久久| 国产成人天堂| 婷婷五月成人| 可以免费看黄片的视频| 久久久久久中文版| 91精品国产高清久久久久久,亚洲成人 | 女人天堂av在线播放| 黑人中出21连凳花野真衣| 国产无马视频| 少妇熟女一区二区三区| 日韩国产十八禁| 超碰碰碰碰| 国产福利视频精品视频| 亚洲人妻久久久| 九久9热| 欧美强奸一区二区诱惑| 百度百度日本操逼| 国产精品3| 亭亭丁香激情| 亚洲砖码砖专无区2023| 易易A毛视频| 久久久久久中文版| 国产福利电影| 裸体1区| 亚州色交| 综合欧美日本三级| a片在线播放| 久草看看看| 性性欧美| 久久久久久久一级黄色打同平台| 国语av最新自产拍在线观看| 极品色综合| 97超碰逼| 亚洲男人天堂Av| 亚洲AV秘 精品久久老牛影视| 啊啊啊啊一区| 久草国产在线视频| 国产91福利小视频在线观看 | 亚洲天天更新| 久久是精品| 美女主播色欲91抠b在线播放| 深爱激情五月天| 久久久久成人亚洲国产| 你懂的在线观看区国产| 国产精品一区二区三区免费视频| 97超碰巨乳| 中文高清一区二区的| 精品人人插人人操| 国产乱伦亚洲| 立川理惠被中出无码| 91 天天综合| 欧美高潮| 高清肉丝中文无码| 在线天堂999| 婷婷色综合| 在线观看成人性爱免费小视频| 不卡在线观看视频| yazhououmeizongya| 秋霞午夜视频一区二区| 999狠狠综合| 丁香五月影院| 日本 欧美 国产一区| 伊人影院综合是一个与深夜成人在线 | 色色毛片| 91日韩| 少妇蹲下买菜露大唇0| 精国久久一区二区三区98| 精品免费一区二区三区在线亚洲人成| 丁香五月电影| 二色av| 久久性视频| 国产伦乱91| 中文字幕精品日韩中文字幕| 日本1区2区不卡视频| 日韩成年人性爱视频| 国产女人视频三四五区| 超碰九区| 久久精品—区二区三区内射| 精品传媒在线一区| 91欧美经典| 欧美人妻制服| 日韩欧美传媒一区国产| 久久啊啊啊| 国产97在线 | 亚洲| 91天堂网| 国产精品人妻无码久久久互動交流 | 蜜桃不卡一区二区| 草伊人高潮喷水超碰| 1204金沙人妻懂旧版免费| 亚洲97p| 内射中国少妇高清视频免费视频 | 一块操欧美| 激情婷婷五月天| 天天干少妇| 丝袜美腿欧美| 91亚洲青青草原精品1区| av大香蕉网站| 97热视频在线观看| 自拍第一页| 天天综合-91入口| 亚洲啪啪综合?v一区综合精品区| 日本性交操一区二区不卡系列| 国产多人在线观看视频| 午夜视频久久久久一区| 国产人妖视频一区在线观看| 亚洲欧美一区二区三区一猛片| 九九碰九九爱97| 97WW精品| 超碰天天操| 久久久91福利姬| 日本天天干天天操一区| 一级性爱视频免费观看 | 丰满搜索结果 -第18页- 久久高清无码 | 网友自拍第1页| 亚洲国产综合视频| 国产成人欧美一区二区三区的国产| a级成人毛片免费视频高清| 狠狠狠狠狠狠| 女人一区| 偷拍导航视频网站| 亚州综合网| 在线国产福利网址导航| 色综合婷婷| 97久久精品亚洲中六字幕| 国产精彩女在线观看视频| 人人妻人人爱人人玩| 精品国产一区探花在线观看| 国产成人无码啪| 97色色网| 天天看高清麻豆| 亚洲 欧美 日本 国内 首页| 欧美天天性| 国产三级中文有码在线视频| 天天干天天干天天干| 日本新免费二区三区| 欧美 亚洲精品首页| 大学生口爆吞精| 91精品久久久久久综合五月天| 亚洲天堂自拍| 男人的天堂Va| 国产精品久久久啊| 在线观看国产黄色| 99自拍视频在线| 国产精品欧美激在线| 熟女少妇一区二区三区| 亚洲国产精品无码AV久久久| 色色色色网站| 蜜桃色院一区久久| 一本久道久久综合狠狠爱一密臀精 | 综合网,亚洲,欧美| 1000午夜黄色| 99久久99久久免费精品蜜臀| 免费A V在线播放| 欧美色图亚洲色图成人在在线| 亚洲成人在线资源| 日本不卡二区| 天天天天天干夜夜夜夜夜操| 爆乳免费黄网站| 欧美精品不卡一二三四在线91| 91精品人妻偷情| 色色五月婷| 五月开心久久AV官网| 亚洲综合影院| 色丁香五月婷婷| 美日韩一二三区| 青娱乐国产剧情av一区| 久久激情综合| 1.igao73.com 加入收藏 免费专区 国产精品 中文字幕 日韩精品 欧美精品 精彩 | www.91色| 91麻豆一二三区| 人人操,人人插| 欧美拳交在线播放| 91综合天天| 屁屁影院一区二区三区国产| 韩国国产欧美情侣视频在线| 97亚洲精品超碰| 久久久中文| 人妻在线大香蕉| 无码高清操逼网址| www鬼畜国产男人的天堂| 蜜桃臀一区二区aV| 国产精品久久久久久久久久久久久久吹 | 久久久五月天| 曰韩少妇无码| 亚洲色图欧美色图日韩色图| 日本999精品视频| 91精品国产91久久青草| 国产精品一二三免费网站| 欧美,日韩,中文,另类| 亞洲久久直播| 中文字幕女同在线| 午夜操逼不卡| 99国产精品久久久久久久成人热 | 激情久久av一区av二区av| 亚洲色图综合网| 很黄很色的视频在线观看| 国产乱弄免费在线视频。| 一区AV| 嗯啊不要啊啊在线观看视频| 男人天堂欧美| 另类视频在线| 99久在线精品99re8蜜桃| 第一高清av中文字幕| 人妻丰满熟妇av无码区蜜桃| 高清无码 国产精品| 另类视频在线| 国产一级内射无挡观看| 欧美国产有色电影| 一,爱啪啪,在线免费视频| jiujiujiujingpin| 探花一区在线| 亚春色色| 色97| 国产精品人妻无码久久久老鸭窝| 中文字幕在线观看第二页| 很很操在线| 97色涩| 亚洲精品啪视频| 超碰天天去日穴| 婷婷大香蕉| 校园春色综合网| 激情五月天色播| 九九碰九九爱97超碰| 正在播放:深夜激情大战,自带黑丝袜全力输出骚穴 | 99久久精品国产高潮| 51一区二区三区| 九九AV| av网站免费看| 超碰在线人妻不卡| 伊人久久在线视频观看| av麻豆啪啪| 日本女优在线视频福利| 加勒比中文av| 一区 欧美 日韩 麻豆| 亚洲成熟国产精品美女| 青青草大香蕉视频| 久久久激情| 亚洲国产丝袜熟女av| 丝袜翘臀后入欧美校园亚洲自拍另类小说一区中文字幕少妇诱惑 | 男人的天堂午夜av| ...日韩成人一区二区三区字幕| av日韩在线观看电影| 東南亚性呦成人伦理资源在线视频| 青娱乐av在线| 久久91精品国产9丨久久分亭| 日本欧美不卡| 亚洲精品国产AV天美传媒| 亚洲av淫乱| 91另类| 锕锕好爽 死我在线观看| 可以看的av| 免费一级性爱久久| 天天日天天操VV| 亚洲夜夜欢无码一区二区| 啪啪性爱免费视频| 美国三级日本三级久久99| 校园春色制服丝袜中文字亚洲| 久久精品国产99精品亚洲蜜...| 欧美操逼录像国产黄色国产| 成人日韩中文字幕| 色99视频| 囯戸精品高潮呻吟旡码| 国产搭汕a级片| 九九色热| 777AV电影| 风月影院十八禁| 美女91色黄18| 观看视频图片一区二区三区| 日韩免费看黄片| 最新av中文字幕高清| 婷婷人妻激情| 久久久久国产| 久久婷婷国产一区二区色| 国产综合永久精品日韩鬼片| 亚洲女人91| 亚洲人久久久网| 嗯……啊…嗯嗯…啊…好舒服| 91呆哥人妻| 精品人妻一区二区视频| 嗯嗯啊啊操我| 久久这里只精品| 97公开久久| 精精夜夜| 五月激情视频| 国产精品嫩草影院免费| 中文字幕在线免费观看2| a一区二区三区乱码在线| 九热超碰| 中文字幕乱碼在线| 久久激情视频| 欧美亚洲尤物久久| 熟女人妻一区二区三区免费看 | 这里只有97精品| 一区二区视频你懂的| 偷拍 精品 另类 四区| 色色五月婷婷| 无码WWW免费视频网站| 久久欲| 欧美一级AAAAAAA| 亚洲国产天堂| 欧美精品,四区。五区| 亚洲 欧美 小说| xxx亚洲午夜天堂| 欧美精品第3页| 色色色网站| 国产av又色又爽又黄| 亚洲欧美精品国产一区二区| 精品国模无码| 五月丁香激情四射| 色噜噜狠狠色综无码久久合欧美| 99热日| 久久久九精品| 亚州欧美总和| 91成人国产综合久久精品蜜月| 少妇毛片久久| 亚洲影视综合网| 国产久久一区二区午夜| 色婷婷亚洲婷婷| 天天色播亚洲综合网站| 国产精品一区二区 尿失禁| 人人操人人摸人人看人人干| 亚洲一级性爱视频免费看| 看免费的黄片| 中文字幕一区二区三区字幕| 人妻精品免费一二三区| 黄片免费日韩| 17c嫩草51久久91嫩草| 少妇综合| 超碰78| 午夜福利 成人 91| 在线播放中文字幕| 亚洲日韩狠狠撸视频| 自拍偷拍 高清无码| 欧美丝袜制服久久| 欧美日韩一区二区三区四区蜜桃| www..com操老师| 欧美激情中文字幕另类小说| 一级A片女人高潮叫床| 新版天堂中文资源8在线| 国产一区二区在线电影| 欧美黄色片AAAAA| 国产亚洲精品自在线亚洲情侣| 国内三级自拍小视频在线观看 | 熟妇熟女一区二三区| 日韩一级二级在线| 操人妻逼91| 超碰到97情色| 欧美色91| 日韩本不卡视频在线观看| 亚洲天堂资源在线| 天天92av| 狠狠操使劲操| 伊人一区二区在线播放| a亚洲欧美色欲| 岛国免费黄色网址| Blackedraw视频一区二区| 国产一区二区三区精品观看啪| www…国产操逼| 98色网| 日韩AV一区二区三区三州三州| 色色综合97| 中文字幕无码不卡啪啪| 国产精品操| 午夜一级免费毛片| 亚欧Av| 九九天堂| 一个人在线看的黄色电影网站| 精品人妻一区春色| 上床啊啊啊| 久9re热视频这里只有精品| 午夜福利精品| 白嫩国模丰满一二三区| 99精品在线| 超碰夫妻97| 怡红院久久老司机| 啊啊啊啊好多水| 欧美成年人性爱视频免费观看| 亚洲第一精品在线视频| 婷婷伊人网| 五月天综合| 嗯嗯啊好大| 精品国产乱码久久久久久久久久毛片| 超碰97亚洲| 国产成人手机视频激情| 色噜噜综合在线| 性性久久| 91精品国产91熟女| 日韩成人私密一级精品av| 精品久久久久久无码| 亚洲色综合| 美女淫穴| 欧美日韩亚洲少妇寂寞影院正在播放 | 93人人操人人| 日本韩国一本产品小视频日本韩国一本产品久久久产品小视频日本韩国一本产品久 | 欧亚在线视频| 久久25| 久久久亚洲熟妇资源| 久久久99免费| 天天日天天色| 91黑丝操| 天天cao在线| 日韩色欲久久一二三四区| 极品丝袜无码| 曰本道人妻久久久在线不卡色视频| 免费岛国一级片| 色婷婷基地| 欧美韩国你懂得在线 | 18禁看网站一区| 怡红院一区二区熟女人妻| 大香蕉综合久久| 色香av| 老熟女综合| 蜜臀操逼黄色视频操的好爽| 国产女人高潮视频| 欧美激情久久久久| 乱伦一二三| 丁香五月婷婷色| 黑人精品久久97| 日韩十八禁| 国产欧美亚洲精品a第2页| 麻豆一区在线| 久久久性| 午夜精品99久久久久传媒| 好湿好紧视频| 国产AV激情无码久久无码| 香港成人一级视频在线青青草| 久操免费观看| 亚洲制服欧美另类内射| 欧美在线视频播放| 8x福利精品第一福利视频导航| 激情四射婷婷四五月天| 人妻天堂网| 天天日日夜夜| 天天综合网视频91| 久久久久久久亚洲Av无码| 欧美日韩人人精品|