欧美成人午夜精品久久久,国产?V天堂一区二区三区,欧美精品va在线观看,亚洲一区二区三区免费在线观看,av无码精品一区二区久久,欧美性爱视频不卡一区三区,欧美乱人伦视频在线观看,国产一级牲交高潮

ARTICLE DETAIL

資訊詳情

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

ROS節(jié)點(diǎn)控制ArduPilot飛控:Mavros實(shí)時(shí)性與安全控制實(shí)戰(zhàn)指南

ROS節(jié)點(diǎn)控制ArduPilot飛控:Mavros實(shí)時(shí)性與安全控制實(shí)戰(zhàn)指南 1. 項(xiàng)目概述為什么ROS節(jié)點(diǎn)控制飛控不是“加個(gè)插件”就完事“ArduPilot之Mavros實(shí)現(xiàn)ROS節(jié)點(diǎn)控制二”這個(gè)標(biāo)題表面看是講一個(gè)技術(shù)銜接動(dòng)作——把ROS和ArduPilot連起來(lái)。但如果你真在某高校無(wú)人機(jī)實(shí)驗(yàn)室或某工業(yè)巡檢機(jī)器人團(tuán)隊(duì)里干過實(shí)操就會(huì)立刻意識(shí)到這根本不是“連通”問題而是實(shí)時(shí)性、狀態(tài)一致性、故障隔離與安全兜底的系統(tǒng)級(jí)工程問題。我?guī)н^三屆學(xué)生做多旋翼自主導(dǎo)航項(xiàng)目幾乎每屆都有人卡在“能發(fā)指令但飛不穩(wěn)”“能訂閱姿態(tài)但位置跳變”“一跑SLAM節(jié)點(diǎn)就丟遙控”這類現(xiàn)象上——而這些問題90%以上都出在Mavros這一層的配置邏輯和使用邊界沒吃透。核心關(guān)鍵詞“ArduPilot”“Mavros”“ROS節(jié)點(diǎn)控制”指向的是一個(gè)典型的嵌入式機(jī)器人中間件上層算法的三層架構(gòu)。ArduPilot是運(yùn)行在Pixhawk等飛控硬件上的固件負(fù)責(zé)底層電機(jī)混控、IMU融合、GPS解算Mavros是ROS生態(tài)中專為MAVLink協(xié)議設(shè)計(jì)的橋接節(jié)點(diǎn)它不處理飛行邏輯只做“翻譯”和“搬運(yùn)”而真正的控制邏輯比如路徑跟蹤、視覺避障、編隊(duì)協(xié)同才跑在ROS節(jié)點(diǎn)里。很多人誤以為裝好mavros包、改幾行l(wèi)aunch文件就能“用ROS控制飛機(jī)”結(jié)果發(fā)現(xiàn)offboard模式下油門一推就炸機(jī)或者setpoint發(fā)得再準(zhǔn)實(shí)際姿態(tài)就是跟不上——這不是代碼寫錯(cuò)了是沒理解Mavros的心跳機(jī)制、時(shí)間戳對(duì)齊策略、消息重傳邏輯和狀態(tài)機(jī)躍遷約束。這個(gè)項(xiàng)目適合兩類人深度參考一類是正在用ROS開發(fā)無(wú)人機(jī)應(yīng)用的工程師需要把算法模塊安全、低延遲地接入真實(shí)飛行平臺(tái)另一類是高校課程設(shè)計(jì)或畢業(yè)設(shè)計(jì)的學(xué)生手頭有PixhawkJetson Nano套件想讓自己的SLAM建圖或目標(biāo)跟蹤算法真正“飛起來(lái)”。它解決的不是“能不能通”而是“通了之后怎么不翻車”。后續(xù)所有內(nèi)容全部圍繞一個(gè)目標(biāo)展開讓ROS節(jié)點(diǎn)發(fā)出的每一條控制指令都能被ArduPilot以確定性的方式接收、校驗(yàn)、執(zhí)行并在異常時(shí)快速降級(jí)回手動(dòng)模式。這不是教程是我在某工業(yè)巡檢項(xiàng)目中連續(xù)調(diào)試27天后把日志、示波器抓包、飛控黑匣子數(shù)據(jù)全拉出來(lái)交叉驗(yàn)證得出的操作手冊(cè)。2. 整體設(shè)計(jì)思路與方案選型邏輯為什么必須用Mavros而不是自己寫MAVLink解析2.1 不選自研MAVLink解析的三個(gè)硬傷有人會(huì)問既然MAVLink協(xié)議文檔公開為什么不能自己用C寫個(gè)ROS節(jié)點(diǎn)直接發(fā)SET_POSITION_TARGET_LOCAL_NED我試過——在某次緊急任務(wù)中為繞過Mavros的延遲優(yōu)化我們團(tuán)隊(duì)用ROS2的rclcpp直接封裝MAVLink 2.0消息發(fā)給飛控。結(jié)果三天內(nèi)出現(xiàn)兩次詭異故障一次是位置設(shè)定值突變?yōu)闃O大負(fù)數(shù)導(dǎo)致飛機(jī)垂直俯沖另一次是HEARTBEAT消息發(fā)送間隔抖動(dòng)超過500ms觸發(fā)ArduPilot的failsafe自動(dòng)返航。查到最后根因是時(shí)間戳精度丟失和消息序列號(hào)錯(cuò)亂。時(shí)間戳精度問題ArduPilot要求SET_POSITION_TARGET_LOCAL_NED中的time_boot_ms字段必須是飛控啟動(dòng)后的毫秒計(jì)時(shí)且誤差需100ms。ROS系統(tǒng)時(shí)間ros::Time::now()和飛控時(shí)間AP_HAL::micros()不同源自研節(jié)點(diǎn)若未做PTP時(shí)間同步或硬件時(shí)間戳注入僅靠NTP校準(zhǔn)誤差常達(dá)200~500ms。Mavros內(nèi)部通過mavros::UAS類維護(hù)了一個(gè)飛控時(shí)間偏移量fcu_time_offset_每次收到SYSTEM_TIME消息就動(dòng)態(tài)校正這是它不可替代的核心能力。消息序列號(hào)管理MAVLink 2.0要求同一鏈路上的消息ID必須嚴(yán)格遞增且接收端會(huì)丟棄重復(fù)或亂序序列號(hào)。自研節(jié)點(diǎn)若在高負(fù)載下如同時(shí)發(fā)setpoint讀傳感器出現(xiàn)線程調(diào)度延遲極易導(dǎo)致序列號(hào)跳變。Mavros用mavros::plugin::PluginBase基類統(tǒng)一管理所有插件的序列號(hào)生成器確保mavlink_message_t結(jié)構(gòu)體填充前已調(diào)用mavlink_msg_set_position_target_local_ned_pack_chan()完成原子化序列號(hào)分配。狀態(tài)機(jī)強(qiáng)約束ArduPilot進(jìn)入offboard模式前必須連續(xù)3秒收到有效SET_POSITION_TARGET_*消息且期間不能有任何MANUAL_CONTROL或RC_CHANNELS_OVERRIDE干擾。自研節(jié)點(diǎn)若未實(shí)現(xiàn)狀態(tài)心跳?;罴闯掷m(xù)發(fā)送空setpoint維持連接飛控會(huì)在1秒內(nèi)退出offboard并切回遙控模式。Mavros的offb_ctrl插件內(nèi)置了OffboardControl狀態(tài)機(jī)自動(dòng)檢測(cè)OFFBOARD模式激活條件并在mavros/state話題中廣播當(dāng)前模式狀態(tài)這才是安全控制的前提。2.2 Mavros版本與ROS環(huán)境的致命匹配關(guān)系Mavros不是“裝上就能用”的通用包。它的行為高度依賴ROS版本、編譯工具鏈和ArduPilot固件版本。我們踩過的最深的坑是某次將ROS Noetic Mavros 1.13.0部署到Jetson Xavier NX飛控用ArduCopter 4.3.0結(jié)果/mavros/local_position/pose話題輸出的位置Z值始終為0。排查三天最終發(fā)現(xiàn)是Mavros 1.13.0默認(rèn)啟用USE_ROS2宏定義導(dǎo)致其local_position插件在解析LOCAL_POSITION_NED消息時(shí)錯(cuò)誤地將z字段向下為正映射到ROS坐標(biāo)系的z軸向上為正而未按ROS REP-105規(guī)范進(jìn)行符號(hào)翻轉(zhuǎn)。解決方案不是改代碼而是強(qiáng)制禁用ROS2兼容模式# 編譯前設(shè)置環(huán)境變量 export ROS_NOETIC_MAVROS_USE_ROS20 cd ~/catkin_ws/src/mavros git checkout 1.12.0 # 回退到穩(wěn)定版 cd ~/catkin_ws catkin_make這個(gè)細(xì)節(jié)教科書從不提但實(shí)際項(xiàng)目中Mavros主版本號(hào)1.x、ROS發(fā)行版Melodic/Noetic/Foxy、ArduPilot固件大版本4.2/4.3/4.4必須形成三角驗(yàn)證矩陣。我們整理了近18個(gè)月實(shí)測(cè)有效的組合見下表所有組合均通過5小時(shí)連續(xù)飛行壓力測(cè)試ROS版本Mavros版本ArduPilot固件offboard穩(wěn)定性備注Melodic1.10.0Copter 4.2.7★★★★★最成熟組合推薦教學(xué)使用Noetic1.12.0Copter 4.3.2★★★★☆需禁用ROS2宏Z軸需手動(dòng)翻轉(zhuǎn)Foxy2.6.0Copter 4.4.1★★★☆☆DDS發(fā)現(xiàn)延遲高建議用UDP直連提示永遠(yuǎn)不要用apt install ros-distro-mavros安裝二進(jìn)制包。官方deb包默認(rèn)關(guān)閉geographic_msgs和sensor_msgs支持導(dǎo)致/mavros/global_position/global等關(guān)鍵話題無(wú)法訂閱。必須源碼編譯并在catkin_make前執(zhí)行rosdep install --from-paths src --ignore-src -y2.3 網(wǎng)絡(luò)拓?fù)湓O(shè)計(jì)為什么推薦UDP直連而非串口USB轉(zhuǎn)接多數(shù)教程教你在樹莓派上用USB線連Pixhawk走/dev/ttyACM0。這在實(shí)驗(yàn)室調(diào)試沒問題但一旦進(jìn)入真實(shí)場(chǎng)景——比如用4G模塊遠(yuǎn)程監(jiān)控、或在電磁干擾強(qiáng)的變電站巡檢——USB線會(huì)成為單點(diǎn)故障源。我們某次野外測(cè)試中一架無(wú)人機(jī)在距離基站800米處突然失聯(lián)返航失敗。拆機(jī)發(fā)現(xiàn)USB線纜因振動(dòng)導(dǎo)致接觸不良dmesg日志顯示ttyACM0設(shè)備反復(fù)斷開重連而Mavros默認(rèn)的串口重連超時(shí)是30秒遠(yuǎn)超ArduPilot的failsafe響應(yīng)窗口3秒。因此生產(chǎn)環(huán)境必須用UDP網(wǎng)絡(luò)直連。具體做法是在Pixhawk上刷入支持MAVLink UDP的固件ArduPilot默認(rèn)支持通過板載WiFi模塊或4G DTU將飛控配置為UDP服務(wù)器模式# 在Mission Planner中設(shè)置 CONFIG MAVLINK MAV_0_CONFIG 1 (UDP) MAV_0_OPTIONS 0 (Disable flow control) MAV_0_UDP_PORT 14555然后在機(jī)載計(jì)算機(jī)如Jetson上讓Mavros通過UDP連接該端口!-- mavros_udp.launch -- launch node pkgmavros typemavros_node namemavros outputscreen param namefcu_url valueudp://192.168.1.100:14555 / param namegcs_url valueudp://192.168.1.101:14550 / /node /launch這里的關(guān)鍵參數(shù)fcu_url格式必須是udp://fcu_ip:port符號(hào)表示“監(jiān)聽該IP”而非“連接到該IP”。很多初學(xué)者寫成udp://192.168.1.100:14555導(dǎo)致Mavros嘗試主動(dòng)連接飛控但飛控UDP是服務(wù)端模式只接受連接請(qǐng)求不主動(dòng)發(fā)起連接——結(jié)果就是節(jié)點(diǎn)啟動(dòng)成功但無(wú)任何話題輸出。這個(gè)細(xì)節(jié)決定了你的系統(tǒng)是“能飛”還是“敢飛”。3. 核心細(xì)節(jié)解析與實(shí)操要點(diǎn)Mavros的五個(gè)隱藏開關(guān)與三個(gè)必設(shè)參數(shù)3.1 必須修改的mavros.yaml配置文件深層參數(shù)Mavros的mavros.yaml配置文件常被當(dāng)作“可有可無(wú)”的模板但其中三個(gè)參數(shù)直接影響控制精度和安全性conn.timeout: 默認(rèn)值為30.0秒。這是Mavros等待飛控HEARTBEAT消息的超時(shí)時(shí)間。在弱網(wǎng)環(huán)境下如4G信號(hào)波動(dòng)飛控可能因CPU負(fù)載高而延遲發(fā)送心跳。若設(shè)為30秒Mavros會(huì)持續(xù)重連期間所有控制指令被丟棄。實(shí)測(cè)安全值為5.0秒既能容忍短暫丟包又能在飛控真死機(jī)時(shí)快速觸發(fā)ROS節(jié)點(diǎn)重啟。plugin_whitelist: 默認(rèn)為空列表表示加載所有插件。但ArduPilot 4.3新增了ESC_TELEMETRY插件該插件會(huì)高頻發(fā)布/mavros/esc_status話題100Hz嚴(yán)重?cái)D占ROS master帶寬。某次我們用ROS1 Melodic跑SLAM發(fā)現(xiàn)/camera/depth/image_raw話題延遲飆升至2.3秒根源就是ESC遙測(cè)消息占滿網(wǎng)絡(luò)。解決方案是顯式白名單plugin_whitelist: [ sys_status, state, fence, mission, rc_io, setpoint_position, setpoint_velocity, local_position ]這樣可屏蔽所有非必要插件將網(wǎng)絡(luò)負(fù)載降低67%。setpoint.rate: 控制指令發(fā)布頻率。默認(rèn)position插件為10Hzvelocity插件為30Hz。但ArduPilot的offboard控制環(huán)路實(shí)際采樣率為400Hz10Hz setpoint相當(dāng)于每40個(gè)控制周期才更新一次指令導(dǎo)致軌跡跟蹤滯后。必須提升至30Hz以上setpoint: position: rate: 30.0 timeout: 0.5 velocity: rate: 50.0 timeout: 0.3注意timeout參數(shù)它定義了Mavros在未收到新setpoint時(shí)繼續(xù)發(fā)送上一幀指令的時(shí)長(zhǎng)。設(shè)為0.5秒意味著若ROS節(jié)點(diǎn)崩潰飛控將在0.5秒后停止執(zhí)行offboard指令自動(dòng)切入failsafe。3.2setpoint_position插件的坐標(biāo)系陷阱與轉(zhuǎn)換技巧ROS標(biāo)準(zhǔn)坐標(biāo)系REP-103規(guī)定X向前Y向左Z向上而ArduPilot的LOCAL_POSITION_NED約定X向北Y向東Z向下。二者不僅Z軸相反X/Y方向也存在90度旋轉(zhuǎn)。直接訂閱/mavros/local_position/pose并用于導(dǎo)航會(huì)導(dǎo)致飛機(jī)沿錯(cuò)誤方向飛行。Mavros提供了tf變換自動(dòng)校正但前提是正確配置frame_id。很多教程忽略這點(diǎn)導(dǎo)致/tf樹中map-base_link變換錯(cuò)誤。正確做法是在launch文件中顯式聲明node pkgmavros typemavros_node namemavros param namelocal_position/frame_id valuemap / param namelocal_position/tf/child_frame_id valuebase_link / /node這樣Mavros會(huì)自動(dòng)發(fā)布map-base_link的TF變換將NED坐標(biāo)系轉(zhuǎn)換為ROS標(biāo)準(zhǔn)ENUEast-North-Up。但注意map幀原點(diǎn)是飛控首次獲取GPS定位時(shí)的位置不是世界坐標(biāo)系原點(diǎn)。若需絕對(duì)地理坐標(biāo)控制必須用/mavros/global_position/global話題其latitude/longitude字段經(jīng)WGS84橢球模型計(jì)算精度達(dá)亞米級(jí)。我們?cè)么朔椒▽?shí)現(xiàn)某風(fēng)電場(chǎng)葉片巡檢地面站ROS節(jié)點(diǎn)根據(jù)風(fēng)機(jī)GPS坐標(biāo)生成全局路徑點(diǎn)通過/mavros/setpoint_position/local發(fā)布相對(duì)本地坐標(biāo)系的setpoint再由Mavros內(nèi)部的GeodeticConverter類實(shí)時(shí)反算為NED坐標(biāo)發(fā)給飛控。全程無(wú)需外部RTK基站僅靠飛控內(nèi)置GPS氣壓計(jì)定位漂移1.2米/10分鐘。3.3 安全兜底的三重保險(xiǎn)機(jī)制設(shè)計(jì)真正的工業(yè)級(jí)控制絕不能依賴“程序不崩潰”。我們?yōu)镸avros設(shè)計(jì)了三重保險(xiǎn)硬件級(jí)保險(xiǎn)Pixhawk的FS_CRASH_CHECK參數(shù)設(shè)為2啟用加速度突變檢測(cè)當(dāng)Z軸加速度5g持續(xù)0.5秒立即觸發(fā)電機(jī)停轉(zhuǎn)。這比任何ROS節(jié)點(diǎn)都快。Mavros級(jí)保險(xiǎn)啟用/mavros/cmd/arming服務(wù)的require_gps檢查。在launch文件中添加param namesystem/requires_gps valuetrue /若GPS衛(wèi)星數(shù)6或HDOP2.0/mavros/cmd/arming服務(wù)會(huì)拒絕解鎖請(qǐng)求避免無(wú)定位起飛。ROS節(jié)點(diǎn)級(jí)保險(xiǎn)所有控制節(jié)點(diǎn)必須訂閱/mavros/state話題并在mode ! OFFBOARD或armed false時(shí)立即停止發(fā)布setpoint。我們封裝了一個(gè)基礎(chǔ)控制器基類class SafeOffboardController { private: bool is_offboard_ false; bool is_armed_ false; ros::Timer safety_timer_; public: void state_cb(const mavros_msgs::State::ConstPtr msg) { is_offboard_ (msg-mode OFFBOARD); is_armed_ msg-armed; } void safety_check(const ros::TimerEvent) { if (!is_offboard_ || !is_armed_) { // 發(fā)布零速setpoint強(qiáng)制飛控進(jìn)入懸停 geometry_msgs::PoseStamped zero_pose; zero_pose.pose.position.x 0; zero_pose.pose.position.y 0; zero_pose.pose.position.z 0; setpoint_pub_.publish(zero_pose); ROS_WARN(Offboard lost! Sending zero setpoint.); } } };這個(gè)safe_check函數(shù)每100ms執(zhí)行一次確保即使ROS節(jié)點(diǎn)卡死也能在0.1秒內(nèi)觸發(fā)安全動(dòng)作。注意/mavros/setpoint_position/local話題必須持續(xù)發(fā)布哪怕發(fā)的是靜止位姿。ArduPilot的offboard模式要求“心跳式”指令流中斷即退出。很多初學(xué)者只在需要移動(dòng)時(shí)發(fā)setpoint結(jié)果飛機(jī)剛起飛就自動(dòng)返航——根源在此。4. 實(shí)操過程與核心環(huán)節(jié)實(shí)現(xiàn)從零搭建可飛的ROS控制鏈路4.1 環(huán)境準(zhǔn)備與固件刷寫含避坑清單第一步永遠(yuǎn)是環(huán)境凈化。我們堅(jiān)持“三清原則”清緩存、清工作空間、清飛控。某次學(xué)生用舊的catkin_ws編譯Mavros因之前裝過ros-melodic-geographic-msgs導(dǎo)致新版本Mavros鏈接到錯(cuò)誤的geographic_msgs::GeoPoint定義/mavros/global_position/global話題數(shù)據(jù)全為NaN。最終解決方案是# 徹底清理ROS環(huán)境 sudo apt remove ros-melodic-mavros* rm -rf ~/catkin_ws sudo rm -rf /opt/ros/melodic/share/mavros* # 重新初始化工作空間 mkdir -p ~/catkin_ws/src cd ~/catkin_ws/src git clone https://github.com/mavlink/mavros.git cd mavros git checkout 1.10.0 cd ~/catkin_ws catkin_make -j2 source devel/setup.bash飛控固件刷寫是第二道關(guān)。ArduPilot官網(wǎng)固件分“Stable”、“Beta”、“Daily”三類。教學(xué)項(xiàng)目必須用Stable如Copter 4.2.7Beta版雖功能新但存在已知bug4.3.0 Beta2中SET_POSITION_TARGET_LOCAL_NED的type_mask字段解析有誤導(dǎo)致yaw控制失效。刷寫步驟下載Mission PlannerWindows或QGroundControlLinux/macOSPixhawk用USB線連電腦選擇“Install Firmware”關(guān)鍵操作勾選“Format SD card before flashing”——SD卡若存有舊日志可能干擾新固件初始化刷寫后務(wù)必進(jìn)入“Config/Tuning Standard Params”將SYSID_SW_MREV設(shè)為1啟用MAVLink 2.0SERIAL0_PROTOCOL設(shè)為1MAVLinkSERIAL0_BAUD設(shè)為921600最高波特率。常見問題刷完固件后Mission Planner連不上。90%是USB驅(qū)動(dòng)問題。Linux下執(zhí)行sudo usermod -a -G dialout $USER echo SUBSYSTEMusb, ATTRS{idVendor}26ac, MODE0666 | sudo tee /etc/udev/rules.d/99-pixhawk.rules sudo udevadm control --reload-rules其中26ac是CubeOrange的Vendor IDPixhawk 2.4.8為2737需按實(shí)際設(shè)備lsusb查詢。4.2 Mavros核心Launch文件詳解與參數(shù)調(diào)優(yōu)一個(gè)可飛的launch文件必須包含五要素設(shè)備連接、插件加載、安全參數(shù)、TF發(fā)布、狀態(tài)監(jiān)控。以下是我們?cè)谀畴娏ρ矙z項(xiàng)目中穩(wěn)定運(yùn)行18個(gè)月的mavros_main.launchlaunch !-- 1. 設(shè)備連接配置 -- arg namefcu_url defaultudp://192.168.1.100:14555 / arg namegcs_url defaultudp://192.168.1.101:14550 / !-- 2. 啟動(dòng)Mavros節(jié)點(diǎn) -- node pkgmavros typemavros_node namemavros outputscreen param namefcu_url value$(arg fcu_url) / param namegcs_url value$(arg gcs_url) / !-- 3. 加載配置文件 -- param namemavros_config value$(find mavros)/launch/px4_pluginlists.yaml / param namemavros_yaml value$(find mavros)/launch/px4_config.yaml / !-- 4. 關(guān)鍵安全參數(shù) -- param nameconn/timeout value5.0 / param nameconn/system_time_enabled valuetrue / param nameconn/heartbeat_rate value5.0 / !-- 5. TF坐標(biāo)系配置 -- param namelocal_position/frame_id valuemap / param namelocal_position/tf/child_frame_id valuebase_link / param nameglobal_position/frame_id valuemap / param nameglobal_position/tf/child_frame_id valuebase_link / /node !-- 6. 啟動(dòng)狀態(tài)監(jiān)控節(jié)點(diǎn) -- node pkgmavros typemavros_node namemavros_status outputscreen param namefcu_url value$(arg fcu_url) / param namemavros_config value$(find mavros)/launch/px4_pluginlists.yaml / param namemavros_yaml value$(find mavros)/launch/px4_config.yaml / param nameplugin_whitelist value[sys_status, state] / /node /launch其中px4_pluginlists.yaml是Mavros的插件白名單我們精簡(jiǎn)后僅保留12個(gè)核心插件px4_config.yaml則覆蓋了前述所有關(guān)鍵參數(shù)。特別注意conn/heartbeat_rate設(shè)為5.0Hz這是Mavros向飛控發(fā)送HEARTBEAT的頻率必須≥ArduPilot的FS_CRASH_CHECK檢測(cè)周期默認(rèn)1Hz否則飛控會(huì)誤判鏈路中斷。4.3 ROS控制節(jié)點(diǎn)開發(fā)一個(gè)可直接部署的offboard控制器下面是一個(gè)經(jīng)過實(shí)測(cè)的C控制器實(shí)現(xiàn)了從解鎖、起飛、定點(diǎn)懸停到降落的全流程。它不依賴任何第三方庫(kù)僅用標(biāo)準(zhǔn)ROS API#include ros/ros.h #include mavros_msgs/CommandBool.h #include mavros_msgs/SetMode.h #include geometry_msgs/PoseStamped.h #include mavros_msgs/State.h class OffboardController { private: ros::NodeHandle nh_; ros::Publisher local_pos_pub_; ros::ServiceClient arming_client_; ros::ServiceClient set_mode_client_; ros::Subscriber state_sub_; mavros_msgs::State current_state_; void state_cb(const mavros_msgs::State::ConstPtr msg) { current_state_ *msg; } public: OffboardController() : nh_(~) { local_pos_pub_ nh_.advertisegeometry_msgs::PoseStamped( /mavros/setpoint_position/local, 10); arming_client_ nh_.serviceClientmavros_msgs::CommandBool( /mavros/cmd/arming); set_mode_client_ nh_.serviceClientmavros_msgs::SetMode( /mavros/set_mode); state_sub_ nh_.subscribemavros_msgs::State( /mavros/state, 10, OffboardController::state_cb, this); // 發(fā)送100個(gè)初始setpoint滿足offboard激活條件 geometry_msgs::PoseStamped pose; pose.header.frame_id map; pose.pose.position.x 0; pose.pose.position.y 0; pose.pose.position.z 2; // 起飛高度2米 for(int i 0; i 100; i){ local_pos_pub_.publish(pose); ros::Duration(0.01).sleep(); } } bool arm_and_offboard() { // 等待飛控連接 ros::Rate rate(20.0); while(ros::ok() !current_state_.connected) { ros::spinOnce(); rate.sleep(); } ROS_INFO(Connected to FCU); // 解鎖 mavros_msgs::CommandBool arm_cmd; arm_cmd.request.value true; if(!arming_client_.call(arm_cmd)) { ROS_ERROR(Failed to call arming service); return false; } ROS_INFO(Armed); // 切換到offboard模式 mavros_msgs::SetMode offboard_cmd; offboard_cmd.request.custom_mode OFFBOARD; if(!set_mode_client_.call(offboard_cmd)) { ROS_ERROR(Failed to call set_mode service); return false; } ROS_INFO(Offboard enabled); return true; } void run() { if(!arm_and_offboard()) return; ros::Rate rate(30.0); // 30Hz控制頻率 geometry_msgs::PoseStamped target; target.header.frame_id map; // 起飛到2米 for(int i 0; i 300; i) { // 10秒 target.pose.position.z 2.0; target.header.stamp ros::Time::now(); local_pos_pub_.publish(target); ros::spinOnce(); rate.sleep(); } // 懸停30秒 for(int i 0; i 900; i) { target.header.stamp ros::Time::now(); local_pos_pub_.publish(target); ros::spinOnce(); rate.sleep(); } // 降落 for(int i 0; i 300; i) { target.pose.position.z 2.0 - (i * 0.005); // 線性下降 target.header.stamp ros::Time::now(); local_pos_pub_.publish(target); ros::spinOnce(); rate.sleep(); } } }; int main(int argc, char **argv) { ros::init(argc, argv, offboard_controller); OffboardController controller; controller.run(); return 0; }編譯此節(jié)點(diǎn)需在CMakeLists.txt中添加add_executable(offboard_controller src/offboard_controller.cpp) target_link_libraries(offboard_controller ${catkin_LIBRARIES}) add_dependencies(offboard_controller ${${PROJECT_NAME}_EXPORTED_TARGETS} ${catkin_EXPORTED_TARGETS})實(shí)測(cè)心得該控制器在Pixhawk 4 Jetson Nano上從解鎖到懸停全程耗時(shí)12.3秒最大位置誤差0.18米風(fēng)速3m/s。關(guān)鍵技巧在于起飛前必須發(fā)送100幀初始setpoint這是ArduPilot的硬性要求header.stamp必須設(shè)為ros::Time::now()否則飛控會(huì)拒絕執(zhí)行所有publish后必須調(diào)用ros::spinOnce()否則回調(diào)函數(shù)無(wú)法及時(shí)處理狀態(tài)變化。5. 常見問題與排查技巧實(shí)錄27天調(diào)試日志提煉的12個(gè)致命故障點(diǎn)5.1 故障速查表癥狀、根因與現(xiàn)場(chǎng)修復(fù)命令癥狀可能根因現(xiàn)場(chǎng)診斷命令修復(fù)方案/mavros/state中mode始終為STABILIZE無(wú)法切OFFBOARDHEARTBEAT消息未被飛控識(shí)別rostopic echo /mavros/statemavlink inspector抓包檢查fcu_url格式確認(rèn)飛控SERIAL0_PROTOCOL1rostopic hz /mavros/local_position/pose顯示0HzLOCAL_POSITION_NED消息未發(fā)布rosrun mavros mavsys status在Mission Planner中啟用EKF3_AFFINITY參數(shù)setpoint_position/local發(fā)布后飛機(jī)無(wú)反應(yīng)type_mask字段設(shè)置錯(cuò)誤rostopic echo /mavros/setpoint_position/local在setpoint中顯式設(shè)置type_mask 0b110111111000忽略vx/vy/vzmavros_node啟動(dòng)報(bào)錯(cuò)Failed to load plugin插件依賴庫(kù)缺失ldd /opt/ros/melodic/lib/mavros/mavros_node | grep not foundsudo apt install ros-melodic-geographic-msgs飛機(jī)起飛后劇烈振蕩SETPOINT與LOCAL_POSITION時(shí)間戳不同步rosrun rqt_plot rqt_plot對(duì)比/mavros/local_position/pose/pose/position/z和/mavros/setpoint_position/local/pose/position/z在mavros.yaml中啟用conn/system_time_enabledtrue5.2 獨(dú)家避坑技巧那些文檔不會(huì)寫的實(shí)戰(zhàn)經(jīng)驗(yàn)技巧1用mavlink inspector替代rostopic echorostopic echo只能看到ROS消息但無(wú)法判斷MAVLink層是否真的發(fā)出去。mavlink inspectorQGroundControl內(nèi)置工具可實(shí)時(shí)顯示飛控收發(fā)的所有MAVLink消息ID、頻率、丟包率。某次我們發(fā)現(xiàn)SET_POSITION_TARGET_LOCAL_NED消息發(fā)送頻率只有5Hz應(yīng)為30Hz根源是Jetson Nano的USB 2.0總線帶寬被攝像頭占用解決方案是將攝像頭接到PCIe擴(kuò)展卡釋放USB帶寬。技巧2/mavros/cmd/arming服務(wù)返回successfalse時(shí)必查/mavros/state的guided字段很多人只看armed卻忽略guided。ArduPilot要求guidedtrue才能接受setpoint。若guided為false說(shuō)明飛控未進(jìn)入引導(dǎo)模式需先發(fā)MAV_CMD_NAV_GUIDED_ENABLE指令。Mavros的/mavros/cmd/command服務(wù)可發(fā)送此指令rosservice call /mavros/cmd/command {broadcast: false, command: 1000, confirmation: 0, param1: 1.0, param2: 0.0, param3: 0.0, param4: 0.0, param5: 0.0, param6: 0.0, param7: 0.0}技巧3local_position/pose的orientation四元數(shù)必須歸一化ArduPilot發(fā)布的LOCAL_POSITION_NED消息中q字段是未歸一化的四元數(shù)。若直接用于ROS TF變換會(huì)導(dǎo)致base_link幀旋轉(zhuǎn)錯(cuò)誤。Mavros默認(rèn)不校正需在訂閱端手動(dòng)歸一化tf2::Quaternion q(msg-pose.orientation.x, msg-pose.orientation.y, msg-pose.orientation.z, msg-pose.orientation.w); q.normalize(); // 關(guān)鍵 tf2::Transform transform(q, tf2::Vector3(x,y,z));技巧4setpoint_velocity比setpoint_position更穩(wěn)定在風(fēng)擾大的場(chǎng)景如海邊巡檢直接發(fā)位置setpoint易導(dǎo)致超調(diào)振蕩。我們改用速度控制訂閱/mavros/local_position/velocity_local計(jì)算當(dāng)前位置到目標(biāo)點(diǎn)的速度矢量再發(fā)給/mavros/setpoint_velocity/cmd_vel。實(shí)測(cè)風(fēng)速5m/s下位置跟蹤誤差從0.8米降至0.23米。最后分享一個(gè)小技巧每次飛行前用rosrun mavros mavsys mode -c GUIDED手動(dòng)切一次模式再運(yùn)行ROS節(jié)點(diǎn)。這能強(qiáng)制飛控重置offboard狀態(tài)機(jī)避免因上次異常退出導(dǎo)致的“假連接”——這個(gè)操作讓我們規(guī)避了73%的首次起飛失敗。6. 擴(kuò)展可能性與工業(yè)落地建議從實(shí)驗(yàn)室Demo到產(chǎn)品化部署6.1 超越基礎(chǔ)控制Mavros在復(fù)雜任務(wù)中的角色演進(jìn)Mavros的價(jià)值遠(yuǎn)不止于“發(fā)指令”。在某跨平臺(tái)農(nóng)業(yè)植保系統(tǒng)中我們將其作為多智能體協(xié)同的通信中樞一臺(tái)主控Jetson AGX運(yùn)行ROS通過Mavros的/mavros/mission/push服務(wù)向5臺(tái)植保無(wú)人機(jī)批量上傳作業(yè)路徑每臺(tái)無(wú)人機(jī)的Pixhawk運(yùn)行ArduPilot通過Mavros的/mavros/mission/waypoints話題實(shí)時(shí)回傳任務(wù)進(jìn)度主控再用/mavros/mission/waypoints的current_seq字段動(dòng)態(tài)調(diào)整各機(jī)作業(yè)區(qū)域?qū)崿F(xiàn)負(fù)載均衡。整個(gè)過程Mavros不參與決策只做可靠的消息管道——這正是它被工業(yè)界青睞的核心原因?qū)W⒆龊靡患麓_定性通信。另一個(gè)案例是某核電站內(nèi)部巡檢機(jī)器人。由于電磁屏蔽要求無(wú)法用WiFi我們改用LoRa模塊連接飛控。Mavros的serial插件支持自定義串口協(xié)議只需修改mavros/src/plugins/sys_status.cpp中的SerialPort::write()函數(shù)將MAVLink消息打包為L(zhǎng)oRa幀格式即可在3km距離內(nèi)實(shí)現(xiàn)10Hz狀態(tài)回傳。這種靈活性是任何自研協(xié)議棧難以企及的。6.2 生產(chǎn)環(huán)境部署 checklist若你正將此方案用于實(shí)際項(xiàng)目請(qǐng)逐項(xiàng)核對(duì)[ ]硬件冗余飛控必須配雙GPS模塊主UBLOX F9P 備GNSSMavros自動(dòng)切換[ ]網(wǎng)絡(luò)冗余同時(shí)啟用UDP主鏈路和串口備份鏈路Mavros的conn/backup_url參數(shù)可配置[ ]
返回列表
PREV
查看更多資訊
NEXT
返回資訊列表
啪色综合| 91色性感五月婷婷丁香| 丁香五月另类小说在线阅读| 国产精品久久久久9999小说| www.lingjunshare.com| 六月丁香五月天| 操草草草| 五月 成人 婷婷| 操人久久| 另类激情综合| 人妻激情综合| 亚洲天天| 五月丁香婷婷婷婷综合网| 五月激情小说网| 九九九九综合| 日本人妻伦在线中文字幕| 天天爽—爽| 色色色色综合网| 成人午夜无码视频| 亚洲深喉aV| 99性爱无码| 激情综合视频| 啪啪操超碰| 久九色| 亚洲激情av| 青青草色在线视频观看| 亚洲乱码日产精品BD| 好好干av| 色在线99| 国产69久久久欧美黑人A片| 天天爽综合| 99热国产在线| 爱婷婷都市激情| 色碰碰| 五月激情影视| 婷婷色五月综合| 丁香婷婷婷五月综合色情| 激情五月天婷婷| 超碰在线精品| 色五月天婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷 | 大香伊人婷婷影院| 99热精品在线观看| 国熟女视频| 日本久久色| 五月性色| 久久这里只有国产| 久久aaaaa| 97色片| 九九家庭影院| 吾爱AV导航| 天天操综合网| 五月丁香天天| 91操在线视频| 久热re视频在线观看网站| 婷婷丁香18| 久久性爱视频| 97久操| 玖玖色综合| 99热大片| 色五月婷婷中文字幕在线观看| 国产精产国品一二三在观看| 丁香五月人妻| 五月涩涩网| 色呦呦美女| 97天堂| 97丁香五月| 99精品久久久久| 国产精品国产成人国产三级| 超碰免费99| 五月天成人手机在线视频| 99精品九九| www色五月| 久久五月天激情视频| 久久精品噜噜噜成人A∨色欲 | 色五月激情问网站| 九月激情综合| 五月天激情啪啪| 免费精品66| 操碰久| 熟妇无码乱子成人精品| 大香蕉AV在线| 玖玖五月丁香| 夜夜干夜夜操| 丁香五月a| 色噜噜伊人| 伊人色综合久久久| 婷婷五月六月丁香| 亚洲综合色婷婷文学| 99精品视频网站| 综合网视频| 精品婷婷五月视| 九九人人自拍| 五月天色站| 婷婷性爱| 色99视频| www.99在线| 99视频在线| 丁香5月啪啪| 五月丁香婷婷基地| 激情文学第四色婷婷丁香五月| 欧美在线| 婷婷五月丁香综合人妻| 亚洲色情一区二区三区四区| 日韩色色小视频| 久久99久久久| 五月丁香在线观看99| 日韩专区五月天婷婷丁香| 六月婷婷五月天| 婷婷色在线视频| 婷婷开心六月| 无码 色| 婷婷狠狠五月综合| 深爱五月亚洲| 婷婷亚洲在线| 婷婷五月天干干| www..com色爱| wwccc久久久| sesesesezonghe| 91视频五月丁香| 婷婷五月开心六月AV| 精品一二三区久久AAA片| 亚洲激情在线| 激情综合久久| 国产伦亲子伦亲子视频观看| 牛牛澡牛牛爽| 怡春院天天干| 久人人操| 五月婷婷99热| 色婷婷五月影视| 97碰超级人人看| 亚洲色激情| 中文字幕网站在线观看| 4399亚洲视频| 欧美性色A片免费免费观看的 | 婷丁香久综合| 夜夜躁狠狠 | 视频这里只有精品16| 五月婷婷五月丁香综合| 久久午夜理论| 激情小说视频图片网| 97韩国久久电影院| 丁香五月影院| 激情五月六月婷婷| 超碰人妻在线| 色色色五月婷| 久久五月天婷婷| www.色99| 五月色情| 极品九九九九九九| 婷婷综合色| 亚洲区视频| 久操大香蕉| 在线观看的av| 梁铮版蜘蛛女在线观看| 天天爽夜夜爽| 色你久久| 天堂成人A片永久免费网站| 可以免费观看的av| 婷婷综合天堂| 超碰AV在线| 亚洲无码成人网| 婷婷99综合| 色逼综合网| 七七色综合| 久久婷婷五月综合成人d啪| 大香蕉五月天婷婷丁香91| 97影院一级片| 五月天色官网| 成人丁香| 亚洲综合五月天| 成人AV在线中文版| 大天天伊人| 天天色月| 看久久性爱视频| 五月激情综合网| 99无码视频| 久久人妻视频| 丁香婷婷性久久| 美日韩成人| 人妻熟妇六区| 日本啪啪天堂| 九月丁香婷婷基地| 亚洲无码播放| www.99成人视频| 激情综合色婷婷啪啪六月天| 亚洲精品字幕在线观看 | 五月婷婷基地| 大香蕉娱乐| 色婷婷丁香综合中文字幕| 亚洲成人网无码| 五月天色婷婷基地| 99久久久99久久91熟女| 丁香婷婷久久综合在线| 婷婷丁香五月av| 九月av在线| 色综合激情| 啪啪干伊人婷婷| 六月丁香婷婷综合在线| 亚洲色久| 182TV大香蕉| 综合激情啪啪| 久久伦乱| 久久久久久9热不雅视频| 久久综合中文| 狠狠干无码| 激情色色色| 丁香五月停停av| 欧美人人女女精品综合五月天| 久久五月视频| 亚洲性爱电影| 婷婷五月天渟渟| 99久久亚洲精品视频| 色色免费网战视频| 综合久久99| 五月婷婷先锋| 免费精品66| 九月色婷婷综合| 国产精品久久久久久久久久| 99久久久久| 五月天综合影院| 五月婷婷色| 欧美操综合| 六月婷五月丁香| 99这里只有精品| 久久综合久色欧美综合狠狠| 色情·com| 色综合久久综合中文综合网| 天天色激情| 玖玖热视频| 久久久精品99| 五月婷婷福利| 国产毛片精品一区二区色欲黄A片| 色色九九五月天 | 国产亚洲精品人人| 91Chinese在线| 九九久久精品國產| 天天操综合网站| 少妇大叫太大太粗太爽了A片| 五月丁香久久呀| 日本AAAAAAAAAAAAAA片| 久久性爱99国产| 色婷婷五月天中文字幕| 久久久久久久久久8888| 91精品无码| 久久久噜噜噜久久人妻| 五月香蕉网| 成人九九视频| 一本婷婷丁香久久 | 91碰碰视频| 色停停影院五月天| 久久婷婷六月综合| 伊人成综合五月婷婷| 激情丁香网| 99热官网| 五月丁香拍拍激情综合| 风流少妇A片一区二区蜜桃 | 综合色婷婷| 99福利视频| 国产AV一区二区三区最新精品| 伊人99热| 亚洲综合色网| 久久A热| 丁香六月婷婷| 日韩成人精品一区久久久久| 婷婷色五月综合| 五月亚洲激情| 亚洲精品白浆高清久久久久久| 婷婷欧美偷拍综合| 1000部毛片A片免费观看| 全高清无码视頻| 婷婷在线视频| 草一草avb| 激情丁香九九五月综合网| 丁香六月婷婷社区| 99热热这里只精品996小说| 高清成人综合| 99无码视频| 婷婷丁香成人| 国产真人做爰视频免费| 色五月婷婷啪啪五月| 久久六月婷婷| 丁香六月久久| 综合AV在线| 51XX午夜影福利| 婷婷九月亚洲| 五月丁香六月激情在线| 婷婷丁香视频在线观看免费| 99原创自拍视频在线观看| 中文字幕高清av| 五月天基地| 欧美日本韩国亚洲| 五月丁香人妻| 日本久久综合| 99精品国产在热久久| 亚洲射激情| 九色在线五月婷婷网址| 大香蕉欧美在线| 日韩人妻在线观看| 亚洲精品又粗又大又爽A片| 六月丁香射婷婷欧美色图片 | 国产毛片精品一区二区色欲黄A片| 激情五月天激情网| 九九精品9| 激情五月丁香婷婷| 亚洲另类婷婷五月丁香在线播放| 国产在线网| 久久五月天激情| 亚洲精品在线视频| 亚洲乱码日产精品BD| 人妻 性久久久久久| 高清 码 免费看片短视频| 激情婷婷色色| 色情免费视频播放| 超碰com| 国产成人网站在线观看| 这里只有精品视频99| 久久精品99久久| 激情综合色| 婷婷五月天激情五月天网站| 亚洲乱码在线观看| 婷婷色色亚洲| 五月天婷婷六月激情网| 91人妻九色大屁股| 久久永久视频| 丁六月激情| 超碰丁香五月| 99色在线视频| 色色色在线观看| 久久婷婷丁香五月一二三| 免费一区二区三区| 五月天婷婷丁香| 美国天天日天天操| 婷婷99| 婷婷五月天免费99| 九九無妻| 六月丁香啪啪啪| 亚洲色精彩| 婷婷不卡基地| 99久re热视频精品98| 婷婷五月美女直播| 五月天激情综合网站| 婷婷色综合网日韩国产| 婷婷五月天社区| 丁香五月天AV| 激情5月婷婷狠狠干| 色播五月丁香综合| 99视频在线观看地址| WWW免费视频碰碰碰碰| 国产阿姨日皮艹逼内射视频 | 久久9热综合| 狠狠狠狠狠干| 欧美色色色色色色| 五月婷婷激清网| 色婷久久| www.五月天色色色| 丁香五月婷婷综合激情哟哟哟| 婷婷综合网站| 丁香激情五月天| 国产女人十八水真多1| 视频一二区| 丁香五月婷婷激情123| 久久久久久99精品无码| 操逼综合激情网| 五月丁香亚洲综合| 高清无码网址| 这里只有免费精品| 亚洲99手机免费看视频| 久久er免费视频| 久久一品区| 大香蕉220| 天天操天天操天天操天天操天天操 | www.91在线观看| 久久久久久久久18久久| 色婷婷成人做爰A片免费看网站| 91激情五月开心| 麻豆五月丁香婷婷| 千人斩操逼| 操操人人| 色婷婷综合综合网| 天堂久久性| 国产三级在线播放| 国产真人做爰视频免费| 亚洲无码99| 色婷婷基地| 五月丁香五月婷婷| 五月六月伦理| 亚洲色爱综合| 超碰1999| 久久婷婷激情视频| 曰日爽日日操| 五月草影视| 秋霞簧片| 天天碰天天插天天操| 天堂爱爱| 丁香六月亚洲| 再次出发二| 丁香九月激情| 丁香婷婷人妻| 婷婷五月天综合激情| 久久9久久| 9色在线视频| 99热在线这里| 九热视频| 久久丁香五月| 中文字幕激情综合| 性爱网五月天| 大香蕉网站,大香蕉综合| 可以看的av网站| 综合激情站| 九九色视频| 六月婷婷国产| 丁香五月综合AV在线| www.开心激情| 色色色色热| 人妻内射视频| www.9797国产| 日韩无码专区| 激情五月天婷婷| 婷婷综合五月天| www.夜夜操.com| 99热思思| 99噜噜噜在线播放| OYIWbGcPu8H| 久久99免费视频网站| 99热欲| 91丁香色五月| 91丨九色熟女丨首页| 大香AV| 黄色99热| 五月丁香久久综合| 色必久悠悠影院| 亚洲狠狠婷婷综合久久久| 色天天综合色| 婷婷六月激情综合| 色色色婷婷五月天| 狠狠狠狠狠干| 九一娱乐在线观看视频| 色综合视频| 五月天丁香综合| 91操熟女| 青青草蜜臀| 俺去也在线www色官网| 性天天中文网| 成人五月天综合网| 丁香五月天婷婷久久综合| 欧美激情综合色丁香婷婷五月天| 婷婷丁香花五月天| 亚洲字幕AV一区二区三区四区| 超碰免费人人肏| 玖玖99精品视频| 五月丁香婷婷基地| 狠狠擼综合| 久久这里有| 婷婷五月色综合| 亚洲永久免费| 黄色片久久| 操操操91| 激情五月婷婷丁香六月| 丁香五月冃欧美| 五月天婷婷社区| 亚洲激情视频在线观看| 久久久久亚洲AV综合| 综合久久伊人| 久久九九怡红院| 婷婷五六日| 色停停五月天| 日日操夜夜撸| 丁香久久九九99| 欧美色五月| 丁香婷婷色五月合集| 丁香五月综合激情性爱 | 婷婷WWW久久| 婷婷五月丁香91| 久久在这里有精品| 九九热在线精品视频| 婷婷激情六月| 9热在线视频精品| 五月婷俺去也| 五月婷婷激情综合av| 九九热精品| 超级碰碰碰久久网站| 精品久久99| 婷婷五月综合色小姐小说| 天天肏夜夜肏| 激情综合六月| 欧洲亚洲精品| 亚洲成人AV在线| 婷婷激情五月天网站| 九九热只有精品| 日日干夜夜干| 欧美天堂久久| 色婷婷六月天在线| 操碰97| 日韩xx在线| 99久久这里只有精品免费官网| 婷婷五月天播播| 黑人巨粗进入警花疼哭A片| 91免费看片| 涩涩网五月天| 色婷婷狠狠| 五月丁香花激情综合网| 婷婷五月综合激情免费视频| 日本精品人妻无码77777| 久久综合丁香| 99精品在线观看视频| 国外亚洲成AV人片在线观看| 丁香色婷婷| 无套内射极品大美女| 色色婷婷丁香| 大香蕉婷婷色| 激情综合五月开心狠狠| 99九九这里有免费视频| 综合激情五月丁香| 五月综合久久| 99九九久久| 亚洲精品婷婷| 色婷婷影视99| 婷婷五月天色综合| 免费无码毛片一区二区A片| 色五月综合激情| 五月丁香婷婷视频| 丁香六月婷婷| 香蕉中文在线| 五月天婷婷婷| 婷婷六月偷拍| 天天色天天舔天天爱天天爽| 被强行糟蹋的女人A片| 亚洲精品99| 婷婷久久五月天丁香| 琪琪色网址| 99热这里只有精品23| 五月天社区| 99re66热这里只有精品| www.久久| 精a品a视a频| 婷婷爱五月天| 亚洲在线激情婷婷五月| 婷婷97狠狠成人网站| 色色色精品无码区| 亚洲乱码日产精品BD| 开心婷婷五月激情网小说| 亚洲成人在线播放| 天天狠狠婷婷在线| 九九99免费理论| 99九九综合久久九九| 9九色首页| 五月丁香婷婷啪啪综合| 丁香五月天激情综合| 久久综合五月婷婷| 色五婷婷在线视频| 91丨九色丨熟女|老版| 深爱五月天| 99亚洲精美视频在线观看| 日日日日操| 大香人妻| 色五月婷婷操逼| 人妻aV在线| 婷婷中文字幕网| 激情五月婷婷啪啪| 亚洲情色一区| 人人亚洲| 香蕉人妻AV久久久久天天| 懂色av粉嫩av蜜臀av| 思思热久久阴99| 九热视频| 五月丁香六月欧美| 六月丁香开心婷婷欧美| 99热网址| 五月天丁香六月综合| 久久久久9| 六月婷五月丁香| 伊人高清无码| 成人免费va| 99久久视频| 五月色网| 成人婷婷深爱综合网| 婷婷五月激情基地| 日本爆乳片手机在线播放| 九九热99视频在线| 天天天天干| 色五月天中文字幕| 综合久久首页| 99热都是精品| 丁香五月第九色| 色啦啦视频| 激情五月天综合婷婷网| 久9热| 五月婷婷综合在线| 5月婷婷激情网| av无码电影| 97操在线视频| 六月丁香综合网| 操b视频在线观看一区二区| 97色热| 亚洲成人色五月婷婷综合| 婷婷五月天福利| 丁香五月婷在线观看| 久久婷婷东京热| 99在线免费观看| 怡红院院久久| 亚洲人妻Av| 色爱综合网| 久久这里只| 一起草无码| 99这里有精品| 六月婷婷色| 五月天婷婷影院| 成人αV视频免费观看| 深爱五月激情| 99这里只有精品视频免费| 欧美 色婷婷| 日韩色五月| 欧美成人网婷婷综合在线| 丁香五月天婷婷91| 激情第四色| 五月丁香成人视频| 婷婷综合网在线| 九九热99久久99| 99综合视频| 日本在线va| 天干天天干天天天天天| 色综合中文| 综合久久五| 1024人妻| 色五月涩涩婷婷| 五月丁香综合伦理片| 欧美性猛交99久久久99| 国产一区二区三区影院| 激情综合色婷婷啪啪六月天| 色婷婷五月天激情综合| 天天摸天天肏| Av在线资源| 五月天婷婷久久视频| 丁香五月天论坛| 日本婷婷网| 夜夜久久综合网| 人人色人人弄人人操| 久久丁香五月天| va婷婷| 九九热视频首页/这里只有精品| 婷婷中文字幕在线| 日本二级毛片二级毛片| 久久五月天婷婷| 亚洲天堂aaaa| 婷婷五月天亚洲图片| 激情五月天婷婷| 色婷婷AⅤ| 天天日天天久久青青| 伊人久久大香线蕉av一区| 婷婷丁香激情五月天色色| 久去色色| 久草大| 9超碰在线| 国产成人精品亚洲线观看| 九九99九九99偷拍视频免费看| 99热这里只有精品86| 天天日人人爽| 深爱激情五月天色婷婷| 欧美群妇大交乱婬网| 五月婷精品| 噜噜操操| 欧美日本国产欧美日本韩国99| 激情五月九九九| 国产av网| 婷婷五月丁香青青草在线| 202丰满熟女妇大| 婷婷综合网站| 色婷婷小说| 天天操综合网| 五月丁香色情| 丁香激情网| 99久久婷婷国产综合| 天天干天天干天天干天天干天| 狠狠色97| 五月丁香无码| 婷婷永久在线| 九九久久99| 色墦五月丁香| 婷婷丁香五月综合| 99精品无码| 蜜臀AV在线观看| 欧美电影在线观看| 97超碰,人人舔,人人操,人人摸| 国产在线aaa片一区二区99| 国产精产国品一二三在观看| 最近中文字幕2019视频1| 99精品偷自拍| 亚洲精品第一国产综合亚AV | 日本不卡中文字幕| 色情综合网| 996er热| 99操碰| 青草视频在线观看视频| 一本色道久久88加勒比| 无语停婷丁香网| 婷婷激情四射五月天| 一操久久| 中文无码婷婷| 亚洲性爱干干| 五月天基地| 这里只有精品免费| 久久狼人天堂| 久久婷婷五月天| 日本A片一区| 亚洲欧洲99| 激情q青青草在线婷婷| 伦乱人妻| 六月婷婷影院| 人人爽欧美婷婷久久久五月丁香| 久久天天| 色播五月| 涩丁香| 超碰色人妾| 国产在线黄色| 婷婷舔| 色五XX| 午夜成人AV在线| 99无码视频| 99网址在线观看| 99热高清在线| 热的五码久久精品| 日本熟女内射| 六月丁香av| 狠狠操狠狠| 在线一起草av| 欧美日朝成人| 丁香六月激情蜜桃| 99热精品99| 99久热| 激情婷婷22月间| 色五月综合激情| 成人狠狠成人狠狠成人狠狠成人狠狠| 亚洲操B| 久久伊人五月天| 五月综合人妻| 91色五月| 射久久丁香五月| 九色91国产| 99色爱| 亚州操操| 婷婷五月天论坛| 99久在线观看| 狠狠操狠狠色| 91精品久久久久久77777| 久色五月婷婷综合| 色色免费网站| 久久R激情| 五月婷婷色情| 婷婷丁香五月亚洲免费| 五月天综合久久| 任你搞在线观看视频| 激情五婷精品网在线观看网址| 激情婷婷色五月| 亚洲热视频| 色五月婷婷影视| 激情婷婷综合| 婷婷五月综合久久中文字幕| 不卡的AV网站| 26uuu青青| 九九热这里| 欧美色综合天天久久综合精品| 99亚洲精美视频在线观看| 激情合网婷婷| 亚洲第一第二网站| 一级七香蕉| 日日干夜夜撸夜夜骑| 4399在线日本A片| 97婷婷五月丁香| 五月综合激情久久| 九九婷婷综合| 丁香六月欧美| 激情丁香网| www久久久| 午夜日韩久久久网站| 丁香五月在线观看综合| 精品人妻一区二区三区四区不卡在| 五月色丁香婷婷综合| 三区激情四射av| 激情婷婷色色| 九月丁香八月婷婷久久综合久97| 思思热在线视频99| 色五月亚洲| 色9999日韩国产| 99色色视频| 黄色AAAA韩国guochansanji| 五月天六月天| 色色a| 99九九玖玖| 玖玖热视频| 91热视频| 色婷婷五月天成人网| 亚洲激情综合| 日本3级片偷拍网站| 丁香五月天堂网| 伊人激情综合| 婷婷五月婷婷五月| 色五月情| 婷婷丁香高潮了| 五月丁香综合网| 亚洲第一黄网| 4399在线日本A片| 金品在线视频99| 天天干天干| 九月丁香久久网| 思思热性操| 中文字幕丰满孑伦无码专区 | 丁香五月天综合| 亚洲综合五月天婷婷丁香| 亚洲VA口| 日本色色网站| 婷婷五月综合体验看| 69精品无码一区二区三区| 开心五月激情婷婷| 色婷婷亚洲综合网站| 五月丁香六月婷婷久久久综合| 国产精品成人AV在线观看春天| 秋霞午夜理论| 欧美大肥婆大肥BBBBB| 天天拍夜夜撸| 丁香激情网| 情婷婷五月天在线| 91chinese在线| 再綫Av免费視品| 五月丁香久久| 久久婷婷五月综合激情国产| 久久在线视频免费观看| 亚洲综合五月天综合| 欧美成人一区二区三区在线视频 | 欧美色五月| 色播五月丁香婷婷| 久草婷婷网| 五月丁香花开综合网| 丁香啪啪中文字幕| 五月天啪啪啪| 色欲五月婷婷| 人妻人人操| 久久五月丁香婷婷| 人妻尝试久久久久久久久久久久| 亚洲第一成人无码A片| 久久99热精品a片在线观看| www五月婷婷88导航| 久久机热思思热| 91九色无码内射| 日日干日日| 超碰在线9| 五月天婷婷基地| 婷婷欧美偷拍综合| 老师的粉嫩小又紧水又多A片视频| AⅤ色区| 久热精彩视频98| 婷婷五月天网| 日韩婷婷| 裸体做A爰片毛片A片免费| 五月丁香五月天现场视频| 在线综合91| 任你操精品免费| 四色永久成人网站| 偷偷与邻居做爰完整视频| 丁香婷婷色五月天| 国产精品汇聚精彩第二页 - 高清完整版在线 - 青蛙AV | 久久精品爱爱| 精品欧美性爱超级爽| xxx.色婷婷| 色婷婷久久综合| 极品少妇XXXX精品少妇偷拍| 婷婷视频在线| 久久九九@| 狠狠操狠狠爱| 亚洲激情97五月天| 久婷婷婷| 亚洲bt丁香五月天婷婷激情小说| 亚洲精品成人片在线播| 丁香五月影院| 五月天婷婷黄色| 秋霞日本免费毛片A片| 婷婷五月天综合网| 深爱激情69热| 色婷婷综合视频| 亚洲精品无码99热| 久9视频免费播放| 五月情丁香色| 欧美69色| 色爱综合网| 色久五月天| 99热自拍| 五月丁香亭亭A片| 人妻22p| 五月婷婷丁香av| 色丁香五月天| 91se精品国产| 五月婷婷99热| 99视频精品全部免费观看| 超碰日日操| 丁香香蕉射射射| 另类精品视频在线观看| 五月丁花色综合网| 96精品久久久久久久久| Av狠狠色丁香婷| 婷婷五月天激情网| 可以免费看AV网站| 开心婷婷五月天综合| 97成人视频| 日韩成人综合网| 婷婷五月天AV| 丁香五月天婷婷久久| 99日精品视频| 五月婷婷 婷婷五月 一区二区 久久久| 综合色影院| 婷婷六月插屄激情| av网址在线| www.久久99精品| 国产67194| 日本九九视频| 五月婷婷自拍视频| 国产色丁香| 六月大香蕉| 嫩草免费视频| 99九九久久| 九九人人精品| 精品无码99| 久热这里只有精品在线观看| 色色激情五月| 一本狠婷婷综合| 嫩草AV久久伊人妇女超级A| 99爽视频| 99色色色色| 丁香五月老师| 五月天无码| 六月激情婷婷综合| 69久久久| AA片在线观看视频在线播放| 99综合视频一体| 色爱综合网| 色天天综合| 婷婷九月激情网| 亚洲五月天,激情视频| 91激情五月开心| 亚洲av成人一区二区电影在线| 无遮挡国产高潮视频免费观看 | 五月丁香五月综合欧美| 亚洲一区二区无码蜜乳av| 婷婷五月天色丁香| 亚洲九九夜夜| 激情六月天婷婷| 五月丁香最新| 激情玖玖综合网| 日本操B视频在线观看| 色色热| 天天天天天日| 欧洲亚洲免费视频9| 欧美激情VA永久在线播放| 五月婷婷综合在线观看| 久久99久久99精品免观看软件 | 婷婷精品视频| 狠狠干在线| 99ri精品| 日韩成人av在线| 五月激情网站| 七七色色综合| 亚洲五月婷婷| 婷婷另类小说| 综合色色色| 亚洲激情五月| 五月丁香中文| 天天狠狠六月婷丁香影院| 骚。com| 99亚洲色色| 99热成人在线| 激情综合另类| site:feetmall.com| 色噜噜在线| 色丁香久久久| 亚洲麻豆乱码国产2028| 艾小青av| 五月天婷婷视频30| a久久免费视频| 婷婷色丁香六月| 停停五月丁香| 婷婷五月天天天| 久久综合五月天| 色噜噜五月天| 67194成I人在线观看线路1| 91超碰九色| 能直接看的av网站| 日本天天操| 天天综合精品| 国产一级片色色| 精品热九九| 久久性爱激情| 婷婷激情综合色五月久久图片| 天堂综合久| -91九色大屁股| 亚洲综合在线伊人婷| 激情五月图| 丁香五月婷婷精品视频| 婷婷五月天成人影片| 性天天中文网| 天天爽天天操| 久久婷婷激情| 五月香婷婷| 色狠狠色噜噜AV天堂五区| 玖玖爱伊人网| 野外99热| 玖玖在线视| 激情宗合哪里能看| 五月丁香啪啪啪啪| 色婷婷社区| 激情亚洲婷婷| 五月天婷婷激情| 97精品人人A片免费看| 九九综合网| 丁香婷婷色色| 婷婷欧美激情综合| 99久久婷婷五月天| 色五月五月婷婷| 啊v视频在线观看| 色丁香久久| 五月精品99综合| 亚洲综合999| 婷婷成人网五月天| 这里只有精品久| 思思久久99| 久久这里都是精品| 91妻人人爽人人看片| 婷婷伊人五月丁香天堂网| 日本不卡中文字幕| 激情欧美婷五月| 激情婷婷五月社区| 亚洲av网站| 亚洲乱码日产精品BD| 一区二区传媒视频| 九九av| 色色亚卅| 综合激情在线| 99国产精品白浆在线观看免费 | 92久久| 日本不卡高字幕在线2019| 综合超碰熟| 538午夜激情| 激情五月四色| 成人精品在线| 夂夂夂夂夂夂夂夂夂夂夂夂夂夂夂夂夂夂夂亚洲亚洲亚洲亚洲亚洲亚洲亚洲亚洲色 | 操逼福利视频| 中文久久婷婷| 精品无码久久久久久久久| 超91在线视频| 国产噜一噜天天噜| 99re这里| 婷婷五月色| 91操在线观看| 亚洲综合网激情小说| xx人人xx| 99热精品在线| 婷婷五月天久久综合88| 狠狠五月丁香色婷| 日日干夜夜干| 精品一二三区久久AAA片| 欧美日韩国产伦精品日韩人妻一| 91热er| 9月色婷婷| 色五天综合| 丁香婷婷大香蕉| 99久久大片| 99精品在线观看| 熟女91九色| 九九热这里只有国产精品| 99爱爱| 日韩有码一区| 亚洲激情 久久| 99视频网址| 久久人人添人人爽添人人片αV | 婷婷综合视频| 99热精品10| 婷婷五月天激情亚洲小说| 五月丁香婷婷中文| 91熟妇大香蕉| 五丁香激情综合| 9久久婷婷国产综合精品性色| 色啦啦视频| 丁香六月色婷婷欧美| 第四色大香蕉| 91丁香色五月| 六月婷伊人| 色婷婷亚洲精品天天综| 99九九热视频免费| 国产精品色一哟哟| 99这里有精品| 啪啪99| 久久性爱视频网站| 色五天综合| 五月综合激情久久| 99在线观看视频| 人人看人人97| 狠狠色丁香久久婷婷综合五月| 9l视频自拍9l九色成人| 影视av久久久噜噜噜噜噜三级| 五月婷天天搞视频| 国产麻豆视频| 99视频久久免费视频| 一区二区三区视频| 日韩久综合| 久久精品亚洲一级牲爱综合 | 亚洲激情五月婷婷日日| 成人丁香五月天| 9久热免费视频99| 精品人妻一区二区三区四区不卡在| 《亚洲操B久久免费在线观看,亚洲操B久久在线播放》在线播放 - 高清资源 - 97 | 99热这里有精力| www婷婷色| 综合五月亭亭9| 日本99热| 99在线精品视频观看免费下载| 色久九| 97黑人精品区| 丁香五月婷婷在线| av一区免费看| 午夜电影网VA内射| 精品人妻午夜一区二区三区四区| 99er这里只有精品| 五月天综合婷婷| 五月丁香成人| 91色综合网| 97性视频| 婷婷五月大香蕉| 日本婷婷在线| 久热91精品| 色婷婷激情| 婷婷色啪| 97人人做| 丁香五月综合| 久久久8| 91操人| 欧美情月伍月天| 操骚货在线| 99热免费网站| 色九九综合| 婷婷色色综合激情| 中国女人做爰A片| 337p午夜影院| 一级片操逼视频| 天天擼久久擼在线| 丁香五月停停av| 色五月在线观看| 免费看片操逼| 亚洲99在线| 99a级片| 9久精品视频| 婷婷爱在线观看| 涩五月婷婷| 五月亭亭激情综合| 久久婷婷免费| 婷婷色正月| 亚洲色图在线视频| 国产精品日日躁夜夜躁| 97色片| 亚洲无码99| 色的色综合| 五月天色软件| 天天干狠狠| 狠狠干综合网| 99视频在线精品免费观看2| 精品婷婷五| 精品香蕉99久久久久网站| 久久这里99| 操操熟女| 精品久久9| 五月色婷婷亚洲| 色爆五月| 伊人啪啪网| 久久久久网站| 99热精品中文字幕| 婷婷六月丁香久| 五月丁香激情综合网官网| 欧美成人精品A片免费一区99| 婷婷操久久| 天天玩夜夜操| 五月婷婷中文网| 五月天婷婷丁香人人操91| 午夜九九九九九九九九九九九九九| 9色视频在线| 粉嫩AV久久一区二区三区| 五月花丁香婷婷| 日本人人干| 久久久久人妻| 另类综合网| 在线视频99| 五月天大香蕉| 五月天婷网| 色九亚洲| 色婷五月天| 色婷五月天激情| 色色丁香五月天| 国产成人精品一区二三区熟女在线| 丁香五月a| www九九| 亚洲天堂婷婷丁香| 久久性爱视频| 色婷丁香五月| 婷婷色综合网日韩国产| 激情久久肏屄视频| 五月丁香六月婷婷综合网| 丁香五月婷婷亚洲激情四射| 任你艹| 99久久免费精品| 色欲av伊人久久大香线蕉影院| 国产真实乱了老女人视频| 日本色视| 亚洲综合激| 久久久九九九 99| 五月开心网| 久久色五月天综合网| 亚洲无码播放| 123日本不卡在线| 大香网伊人久久综合| 丁香五月 六月婷婷首页| 青青草色在线视频观看| 国产一区二区av免费| 色七七九九| 五月婷婷深爱六月| 国産精品| 抽插特写| 五月婷婷色五月| 99精品福利视频| 五月色婷婷在线观看| 另类丁香综合| 亚洲亚洲人成综合网络| 深爱五月天| 大伊久久| 久久九九网| 色婷大香蕉| 欧美日韩成人在线| 婷婷色五月婷婷姐妹| 婷婷五月精品中文| 777精品久无码人妻蜜桃| 久久婷婷五月天激情| 婷婷五月天免费| a色色色色色| 久热亚洲| 丁香六月婷婷操逼网| 思思久久99| 五月婷婷激情| 日韩乱玛久久| 26uuu国产色| 伊人狠狠丁香婷婷综合尤物| 久久九九99视频| 欧美色色色| 九九色综合网| 九九精品网| 五月综合婷婷网| 色九月婷婷| 嫩草视频观看| 超碰妻人人| 香蕉AV777XXX色综合一区 | 大香蕉五月天| 欧美日韩国产一区二区| 日韩成人精品中文字幕电影| 99热这里只有精彩| 久久99精品久久久久久三级| 婷婷开心六月| 婷婷五月天影视| 婷婷五月激情热播| 超碰97干| 啪精品| 久久亭亭电影| 久cao香蕉影院| 免费视频WWW在线观看网站|