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

ARTICLE DETAIL

資訊詳情

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

ROS2常用工具實戰(zhàn):TF坐標(biāo)變換、參數(shù)機(jī)制與Launch文件詳解

ROS2常用工具實戰(zhàn):TF坐標(biāo)變換、參數(shù)機(jī)制與Launch文件詳解 之前有不少同學(xué)在 B 站跟著視頻學(xué)習(xí) ROS2 時看到“TF 坐標(biāo)變換”“參數(shù)機(jī)制”“Launch 文件”這幾個概念常常一頭霧水彈幕里問得最多的就是“這玩意兒到底在實際機(jī)器人里怎么用”如果你正處在這個階段那這篇文章就是為你準(zhǔn)備的。我盡量用最簡單的方式把 ROS2 常用工具的原理講清楚然后帶你把代碼跑起來。本文圍繞具身智能機(jī)器人的開發(fā)場景整理了一份 ROS2 常用工具實戰(zhàn)筆記重點覆蓋三塊內(nèi)容TF 坐標(biāo)變換工具的使用、參數(shù)機(jī)制的配置方法、Launch 文件的編寫技巧。零基礎(chǔ)可以當(dāng)作入門教程有 ROS1 經(jīng)驗的開發(fā)者也可以直接對照差異快速上手先看目錄結(jié)構(gòu)再動手敲代碼每一步都有對應(yīng)說明和運(yùn)行結(jié)果。1. 背景與核心概念1.1 為什么學(xué) ROS2 要先學(xué)這三個工具具身智能機(jī)器人Embodied AI Robot近幾年非?;饛臋C(jī)械臂抓取、移動底盤導(dǎo)航到雙足人形機(jī)器人核心邏輯都離不開“感知—思考—執(zhí)行”這個閉環(huán)。而 ROS2 作為機(jī)器人中間件承擔(dān)著連接傳感器、算法模塊和執(zhí)行機(jī)構(gòu)的重任。無論你用的是開源機(jī)器人還是自研硬件只要涉及多傳感器融合、多節(jié)點協(xié)同就一定會遇到坐標(biāo)管理、參數(shù)配置和節(jié)點啟動的問題。TF 坐標(biāo)變換工具解決的是“機(jī)器人的各個部件在哪里”的問題。參數(shù)機(jī)制解決的是“節(jié)點運(yùn)行時的行為如何配置”的問題。Launch 文件解決的是“整個機(jī)器人系統(tǒng)如何一鍵啟動”的問題。這三個工具相互獨立又經(jīng)常組合使用。比如你要啟動一個帶激光雷達(dá)的移動機(jī)器人需要 Launch 文件同時拉起雷達(dá)驅(qū)動節(jié)點、TF 廣播節(jié)點和導(dǎo)航算法節(jié)點導(dǎo)航算法需要讀取雷達(dá)安裝位置的坐標(biāo)參數(shù)于是參數(shù)機(jī)制就參與進(jìn)來了雷達(dá)數(shù)據(jù)要轉(zhuǎn)換到機(jī)器人基座坐標(biāo)系下這時候 TF 工具就派上了用場。1.2 TF 坐標(biāo)變換工具是什么TFTransform是 ROS 生態(tài)里的坐標(biāo)變換框架在 ROS2 中叫做tf2。它維護(hù)一棵坐標(biāo)樹每個坐標(biāo)系Frame之間通過父子關(guān)系連接起來并且實時發(fā)布它們之間的相對變換關(guān)系。舉個例子移動機(jī)器人底盤中心有一個坐標(biāo)系叫base_link激光雷達(dá)安裝在前方 0.2 米處那就有一個laser_frame坐標(biāo)系它的位置相對于base_link是 (0.2, 0, 0)。TF 工具要做的就是持續(xù)廣播這兩個坐標(biāo)系之間的關(guān)系讓其他模塊隨時可以查詢。在具身智能場景中TF 的作用尤為明顯機(jī)械臂的每個關(guān)節(jié)都有一個坐標(biāo)系TF 記錄從基座到末端執(zhí)行器的姿勢變化。相機(jī)固定在機(jī)械臂末端圖像數(shù)據(jù)要轉(zhuǎn)換到機(jī)器人基座坐標(biāo)需要 TF 計算。移動機(jī)器人里程計坐標(biāo)系、雷達(dá)坐標(biāo)系、世界坐標(biāo)系之間的變換也需要 TF 維護(hù)。一句話總結(jié)TF 是機(jī)器人軟件系統(tǒng)理解空間關(guān)系的“全局坐標(biāo)系通訊錄”。1.3 參數(shù)機(jī)制是什么ROS2 的參數(shù)機(jī)制可以理解為每個節(jié)點自帶的配置文件只是這個配置可以在節(jié)點運(yùn)行時動態(tài)修改。每個節(jié)點都可以聲明若干參數(shù)其他節(jié)點或命令行工具通過參數(shù)名來讀取和修改。比如導(dǎo)航節(jié)點有一個max_velocity參數(shù)運(yùn)行時你可以隨時把最大速度從 0.5 改成 0.3不需要重新編譯代碼。這在調(diào)試機(jī)器人行為時非常方便。ROS2 參數(shù)機(jī)制的特點參數(shù)以鍵值對形式存在值可以是整數(shù)、浮點數(shù)、字符串、布爾值、數(shù)組等。每個節(jié)點擁有獨立的參數(shù)空間??梢酝ㄟ^命令行、代碼、Launch 文件和 YAML 配置文件四種方式設(shè)置參數(shù)。支持參數(shù)回調(diào)可以在參數(shù)變更時觸發(fā)節(jié)點內(nèi)部邏輯。1.4 Launch 文件是什么Launch 文件是 ROS2 的“啟動編排工具”。一個真實機(jī)器人系統(tǒng)往往有幾十個節(jié)點同時運(yùn)行手動一個個敲命令不現(xiàn)實Launch 文件就是把這整套流程寫成腳本一鍵執(zhí)行。ROS2 官方推薦的 Launch 文件格式是Python相比 ROS1 的 XML 格式Python 語法更靈活可以做條件判斷、循環(huán)、變量替換、組合復(fù)用。無論是啟動單個節(jié)點、多個節(jié)點還是加載參數(shù)文件、運(yùn)行命令行都能在 Launch 文件里實現(xiàn)。工具解決的核心問題一句話類比TF 坐標(biāo)變換工具空間位置關(guān)系全局坐標(biāo)系通訊錄參數(shù)機(jī)制節(jié)點運(yùn)行配置可動態(tài)修改的配置文件Launch 文件多節(jié)點啟動編排一鍵啟動腳本2. 環(huán)境準(zhǔn)備與版本說明2.1 操作系統(tǒng)與 ROS2 版本本文示例基于 Ubuntu 22.04 ROS2 Humble 編寫這是目前最穩(wěn)定、學(xué)習(xí)資料最豐富的組合。如果你用的是 Ubuntu 24.04可以對應(yīng)選擇 ROS2 Jazzy大部分 API 是兼容的但安裝命令中的倉庫地址會有區(qū)別。如果你的電腦上還沒有安裝 ROS2推薦兩種方式方式一完全按官方文檔安裝訪問 ROS2 官方文檔選擇對應(yīng) Ubuntu 版本和 ROS2 發(fā)行版按步驟執(zhí)行 apt 安裝。整個過程包括設(shè)置軟件源、添加密鑰、安裝 ros-base 或 desktop 版本、配置環(huán)境變量。方式二使用社區(qū)一鍵安裝腳本國內(nèi)很多開發(fā)者使用“魚香ROS”的一鍵安裝腳本優(yōu)點是速度快、依賴處理自動化適合不想折騰環(huán)境的新手。安裝命令在對應(yīng)開源倉庫可以找到執(zhí)行后腳本會自動識別系統(tǒng)版本并安裝對應(yīng) ROS2。安裝完成后手動 source 環(huán)境即可。不論用哪種方式安裝完成后建議驗證環(huán)境# 檢查環(huán)境變量 printenv | grep ROS_DISTRO # 運(yùn)行小海龜示例驗證安裝 ros2 run turtlesim turtlesim_node ros2 run turtlesim turtle_teleop_key如果小海龜窗口能正常顯示鍵盤方向鍵能控制海龜移動說明 ROS2 安裝成功。2.2 創(chuàng)建工作空間和功能包我們用一個獨立的工作空間來存放本文的練習(xí)代碼避免和系統(tǒng)中的其他功能包混淆。# 創(chuàng)建工作空間目錄 mkdir -p ~/ros2_ws/src cd ~/ros2_ws/src # 創(chuàng)建功能包本文代碼全部使用 Python 編寫 ros2 pkg create robot_tools_demo \ --build-type ament_python \ --dependencies rclpy geometry_msgs tf2_ros tf2_geometry_msgs創(chuàng)建完成后~/ros2_ws/src/robot_tools_demo目錄下會自動生成package.xml、setup.py、setup.cfg和resource文件夾。功能包是 ROS2 代碼組織的基本單位dependencies參數(shù)會自動在package.xml中聲明依賴。2.3 編寫代碼前的目錄規(guī)劃Python 功能包的源碼放在功能包名同名目錄下。我們可以把三個工具分別放入獨立的腳本文件robot_tools_demo/ ├── package.xml ├── setup.py └── robot_tools_demo/ ├── __init__.py ├── tf_broadcaster.py ├── tf_listener.py ├── param_demo.py └── launch_tools_demo.py后續(xù)每個腳本編寫完成后還需要在setup.py的entry_points中注冊對應(yīng)的可執(zhí)行入口這樣才能用ros2 run命令啟動。3. TF 坐標(biāo)變換工具核心解析與實戰(zhàn)3.1 TF2 的核心組件ROS2 的 tf2 庫主要包含以下幾個組件TransformBroadcaster坐標(biāo)變換廣播器節(jié)點用它將一個坐標(biāo)系相對于另一個坐標(biāo)系的變換對外發(fā)布。TransformListener坐標(biāo)變換監(jiān)聽器節(jié)點通過它接收并緩存所有廣播出來的變換。Buffer變換緩沖區(qū)存儲最近一段時間內(nèi)的所有變換關(guān)系支持查詢?nèi)我鈨蓚€坐標(biāo)系之間的變換。TransformStamped坐標(biāo)變換的數(shù)據(jù)結(jié)構(gòu)包含時間戳、父坐標(biāo)系、子坐標(biāo)系以及平移和旋轉(zhuǎn)信息。整個流程可以這樣理解廣播器告訴世界“坐標(biāo)系 A 相對于坐標(biāo)系 B 在哪里”監(jiān)聽器負(fù)責(zé)接收這些信息存到 Buffer 中任何模塊需要時直接從 Buffer 查詢“坐標(biāo)系 A 到坐標(biāo)系 B 的變換關(guān)系”。3.2 發(fā)布靜態(tài)坐標(biāo)變換靜態(tài)坐標(biāo)變換是指變換關(guān)系固定不變的坐標(biāo)系對比如激光雷達(dá)和機(jī)器人基座之間的安裝位置關(guān)系。發(fā)布靜態(tài)變換可以不寫代碼直接用ros2 run命令完成ros2 run tf2_ros static_transform_publisher 0.2 0 0 0 0 0 base_link laser_frame命令的參數(shù)依次是0.2 0 0平移量x、y、z 方向分別偏移 0.2 米、0 米、0 米。0 0 0旋轉(zhuǎn)量分別繞 x、y、z 軸的歐拉角。base_link父坐標(biāo)系名稱。laser_frame子坐標(biāo)系名稱。執(zhí)行命令后可以在另一個終端查看 TF 樹ros2 run tf2_tools view_framesview_frames工具會生成一個 PDF 文件展示當(dāng)前系統(tǒng)中的坐標(biāo)樹結(jié)構(gòu)。如果看到base_link下面掛著laser_frame說明靜態(tài)變換發(fā)布成功。3.3 編寫動態(tài)坐標(biāo)變換發(fā)布器靜態(tài)變換適合固定的安裝關(guān)系但機(jī)器人的關(guān)節(jié)、移動底盤是動態(tài)變化的這時候需要寫代碼實時發(fā)布變換。在robot_tools_demo/tf_broadcaster.py中編寫如下代碼import rclpy from rclpy.node import Node from tf2_ros import TransformBroadcaster from geometry_msgs.msg import TransformStamped import math class DynamicTFBroadcaster(Node): def __init__(self): super().__init__(dynamic_tf_broadcaster) self.broadcaster TransformBroadcaster(self) self.timer self.create_timer(0.1, self.timer_callback) self.step 0 def timer_callback(self): self.step 1 t TransformStamped() # 時間戳必須使用當(dāng)前時刻否則監(jiān)聽端會認(rèn)為數(shù)據(jù)過期 t.header.stamp self.get_clock().now().to_msg() t.header.frame_id odom t.child_frame_id base_link # 讓機(jī)器人基座在 x 軸方向做勻速運(yùn)動 t.transform.translation.x 0.5 * self.step * 0.1 t.transform.translation.y 0.0 t.transform.translation.z 0.0 # 繞 z 軸旋轉(zhuǎn)模擬機(jī)器人轉(zhuǎn)彎 qz math.sin(0.1 * self.step / 2.0) qw math.cos(0.1 * self.step / 2.0) t.transform.rotation.x 0.0 t.transform.rotation.y 0.0 t.transform.rotation.z qz t.transform.rotation.w qw self.broadcaster.sendTransform(t) def main(argsNone): rclpy.init(argsargs) node DynamicTFBroadcaster() try: rclpy.spin(node) except KeyboardInterrupt: pass finally: node.destroy_node() rclpy.shutdown() if __name__ __main__: main()這段代碼的核心邏輯是創(chuàng)建一個 TransformBroadcaster 實例。每次定時器回調(diào)產(chǎn)生一個新的 TransformStamped 消息。平移量隨時間遞增旋轉(zhuǎn)角隨時間改變模擬機(jī)器人運(yùn)動軌跡。sendTransform將變換發(fā)布到系統(tǒng)。注意時間戳字段不能省略否則監(jiān)聽端會因為時間問題無法進(jìn)行變換。3.4 編寫坐標(biāo)變換監(jiān)聽器廣播器發(fā)布坐標(biāo)信息后還需要一個監(jiān)聽器來查詢變換。在robot_tools_demo/tf_listener.py中編寫import rclpy from rclpy.node import Node from tf2_ros import TransformListener, Buffer from tf2_ros import LookupException, ConnectivityException, ExtrapolationException class TFListerner(Node): def __init__(self): super().__init__(tf_listener) # Buffer 用來緩存所有變換數(shù)據(jù) self.buffer Buffer() # TransformListener 自動訂閱 /tf 話題并更新 Buffer self.listener TransformListener(self.buffer, self) self.timer self.create_timer(0.5, self.timer_callback) def timer_callback(self): try: # 查詢從 odom 到 base_link 的當(dāng)前變換 trans self.buffer.lookup_transform( target_frameodom, source_framebase_link, timerclpy.time.Time() ) x trans.transform.translation.x y trans.transform.translation.y self.get_logger().info(fbase_link 在 odom 坐標(biāo)系下的位置: ({x:.3f}, {y:.3f})) except (LookupException, ConnectivityException, ExtrapolationException) as e: self.get_logger().warn(f無法獲取變換: {e}) def main(argsNone): rclpy.init(argsargs) node TFListerner() try: rclpy.spin(node) except KeyboardInterrupt: pass finally: node.destroy_node() rclpy.shutdown() if __name__ __main__: main()lookup_transform是監(jiān)聽器的核心方法傳入目標(biāo)坐標(biāo)系、源坐標(biāo)系和時間參數(shù)返回兩個坐標(biāo)系之間的變換關(guān)系。這里捕獲了三種常見的異常LookupException坐標(biāo)系之間的變換關(guān)系不存在。ConnectivityException兩個坐標(biāo)系不在同一棵 TF 樹上。ExtrapolationException查詢時間超過緩存范圍。3.5 用 rviz2 可視化坐標(biāo)變換光看日志不夠直觀我們可以用 rviz2 可視化整個坐標(biāo)變換過程。運(yùn)行廣播器節(jié)點后再啟動 rviz2# 終端 1運(yùn)行廣播器 cd ~/ros2_ws source install/setup.bash ros2 run robot_tools_demo tf_broadcaster # 終端 2運(yùn)行監(jiān)聽器 cd ~/ros2_ws source install/setup.bash ros2 run robot_tools_demo tf_listener # 終端 3啟動可視化工具 source install/setup.bash ros2 run rviz2 rviz2在 rviz2 界面中點擊左下角 “Add”選擇 “TF”就可以看到odom、base_link坐標(biāo)系的小坐標(biāo)軸。拖動視角能看到base_link坐標(biāo)系隨著時間不斷移動這就是 TF 廣播的效果。rviz2 是 ROS2 中最重要的可視化工具之一調(diào)試 TF 樹、查看傳感器數(shù)據(jù)都離不開它。4. 參數(shù)機(jī)制詳解4.1 參數(shù)機(jī)制的通信原理在 ROS2 中參數(shù)是基于服務(wù)通信實現(xiàn)的。每個節(jié)點啟動時都會創(chuàng)建一個參數(shù)服務(wù)其他工具可以通過該服務(wù)讀取、修改參數(shù)。由于是服務(wù)通信參數(shù)的修改是即時生效的不需要重啟節(jié)點。ROS2 參數(shù)的主要操作命令# 查看節(jié)點列表 ros2 node list # 查看某個節(jié)點的參數(shù)列表 ros2 param list /node_name # 查看某個參數(shù)的當(dāng)前值 ros2 param get /node_name param_name # 設(shè)置某個參數(shù)的當(dāng)前值 ros2 param set /node_name param_name value # 將參數(shù)保存到 YAML 文件 ros2 param dump /node_name # 從 YAML 文件加載參數(shù) ros2 param load /node_name parameter_file.yaml4.2 在代碼中聲明和使用參數(shù)編寫一個參數(shù)示例節(jié)點在robot_tools_demo/param_demo.py中import rclpy from rclpy.node import Node class ParamDemoNode(Node): def __init__(self): super().__init__(param_demo_node) # 聲明參數(shù)并設(shè)置默認(rèn)值 self.declare_parameter(robot_name, default_robot) self.declare_parameter(max_speed, 1.0) self.declare_parameter(enable_debug, False) self.declare_parameter(waypoints, [0.0, 1.0, 2.0]) # 讀取初始參數(shù)值 self.robot_name self.get_parameter(robot_name).get_parameter_value().string_value self.max_speed self.get_parameter(max_speed).get_parameter_value().double_value self.enable_debug self.get_parameter(enable_debug).get_parameter_value().bool_value self.waypoints self.get_parameter(waypoints).get_parameter_value().double_array_value self.get_logger().info(f機(jī)器人名稱: {self.robot_name}) self.get_logger().info(f最大速度: {self.max_speed}) self.get_logger().info(f是否開啟調(diào)試: {self.enable_debug}) self.get_logger().info(f航點列表: {self.waypoints}) # 添加參數(shù)回調(diào)參數(shù)被修改時觸發(fā) self.add_on_set_parameters_callback(self.param_callback) def param_callback(self, params): for param in params: if param.name max_speed: if param.value 0: self.get_logger().warn(max_speed 不能為負(fù)數(shù)拒絕修改) return rclpy.parameter.SetParametersResult(successfulFalse, reason非法速度值) self.max_speed param.value self.get_logger().info(f更新 max_speed 為 {param.value}) return rclpy.parameter.SetParametersResult(successfulTrue) def main(argsNone): rclpy.init(argsargs) node ParamDemoNode() try: rclpy.spin(node) except KeyboardInterrupt: pass finally: node.destroy_node() rclpy.shutdown() if __name__ __main__: main()聲明參數(shù)時默認(rèn)值很重要這樣在參數(shù)沒有被外部設(shè)置時節(jié)點也能正常工作。參數(shù)回調(diào)用來做合法性校驗比如速度不能為負(fù)數(shù)這在實際項目中非常實用。4.3 通過命令行和 YAML 文件設(shè)置參數(shù)啟動節(jié)點時可以直接用命令行設(shè)置參數(shù)cd ~/ros2_ws source install/setup.bash ros2 run robot_tools_demo param_demo \ --ros-args \ -p robot_name:demo_robot \ -p max_speed:2.5如果參數(shù)比較多更推薦使用 YAML 文件。創(chuàng)建config/params.yamlparam_demo_node: ros__parameters: robot_name: yaml_robot max_speed: 1.5 enable_debug: true waypoints: [0.0, 0.5, 1.0, 1.5, 2.0]YAML 文件的第一層是節(jié)點名稱第二層固定寫ros__parameters下面才是具體參數(shù)。加載方式ros2 run robot_tools_demo param_demo \ --ros-args --params-file src/robot_tools_demo/config/params.yaml4.4 參數(shù)機(jī)制的適用場景參數(shù)機(jī)制在具身智能機(jī)器人中的典型應(yīng)用包括傳感器配置雷達(dá)掃描頻率、相機(jī)曝光時間、IMU 零漂值??刂茀?shù)PID 增益、最大速度、加速度。算法參數(shù)目標(biāo)檢測置信度閾值、路徑規(guī)劃最大代價。調(diào)試開關(guān)是否輸出調(diào)試日志、是否運(yùn)行仿真模式。實際項目建議把頻繁調(diào)整的參數(shù)全部聲明為節(jié)點參數(shù)而不是硬編碼在代碼中。這樣每次調(diào)參不需要修改源碼重新編譯只需要修改 YAML 文件或者運(yùn)行ros2 param set命令即可。5. Launch 文件編寫方法5.1 Launch 文件的基本結(jié)構(gòu)ROS2 的 Launch 文件是 Python 腳本核心是一個generate_launch_description()函數(shù)返回一個LaunchDescription對象。最簡單的 Launch 文件如下from launch import LaunchDescription from launch_ros.actions import Node def generate_launch_description(): return LaunchDescription([ Node( packageturtlesim, executableturtlesim_node, nameturtlesim_demo, outputscreen ) ])Node動作的參數(shù)說明package功能包名稱。executable可執(zhí)行文件名稱對應(yīng)setup.py中注冊的程序入口。name覆蓋節(jié)點的默認(rèn)名稱同一節(jié)點多次啟動必須改名。output日志輸出方式screen表示輸出到終端屏幕。parameters參數(shù)列表可以是 YAML 文件路徑或參數(shù)字典。remappings話題重映射列表。5.2 啟動多個節(jié)點并加載參數(shù)把前面寫的 TF 廣播器、TF 監(jiān)聽器、參數(shù)節(jié)點組合到一個 Launch 文件中。創(chuàng)建launch/tools_demo.launch.pyfrom launch import LaunchDescription from launch_ros.actions import Node def generate_launch_description(): return LaunchDescription([ # 啟動動態(tài) TF 廣播器 Node( packagerobot_tools_demo, executabletf_broadcaster, nametf_broadcaster_node, outputscreen ), # 啟動 TF 監(jiān)聽器 Node( packagerobot_tools_demo, executabletf_listener, nametf_listener_node, outputscreen ), # 啟動參數(shù)節(jié)點直接通過字典設(shè)置參數(shù) Node( packagerobot_tools_demo, executableparam_demo, nameparam_demo_node, outputscreen, parameters[{ robot_name: launch_robot, max_speed: 3.0, enable_debug: True, waypoints: [0.0, 1.0, 2.0, 3.0], }] ), ])運(yùn)行方式cd ~/ros2_ws source install/setup.bash ros2 launch robot_tools_demo tools_demo.launch.py5.3 使用參數(shù)文件替換參數(shù)字典參數(shù)字典寫死在 Launch 文件里不夠靈活換成參數(shù)文件路徑更符合實際項目習(xí)慣from launch import LaunchDescription from launch_ros.actions import Node from launch.substitutions import PathJoinSubstitution from launch_ros.substitutions import FindPackageShare def generate_launch_description(): return LaunchDescription([ Node( packagerobot_tools_demo, executableparam_demo, nameparam_demo_node, outputscreen, parameters[ PathJoinSubstitution([ FindPackageShare(robot_tools_demo), config, params.yaml ]) ] ) ])這里的FindPackageShare會在安裝目錄中定位功能包路徑PathJoinSubstitution負(fù)責(zé)拼接完整路徑。這樣即使工作空間換了一臺機(jī)器相對路徑依然有效。5.4 使用 LaunchConfiguration 支持命令行傳參Launch 文件還可以支持命令行參數(shù)比如讓用戶通過命令行指定是否啟用調(diào)試模式from launch import LaunchDescription from launch.actions import DeclareLaunchArgument from launch.substitutions import LaunchConfiguration from launch_ros.actions import Node def generate_launch_description(): # 聲明命令行參數(shù)默認(rèn)值為 false debug_arg DeclareLaunchArgument( debug, default_valuefalse, description是否啟用調(diào)試模式 ) debug_config LaunchConfiguration(debug) return LaunchDescription([ debug_arg, Node( packagerobot_tools_demo, executableparam_demo, nameparam_demo_node, outputscreen, parameters[{ enable_debug: debug_config, }] ) ])啟動時通過以下命令傳入?yún)?shù)ros2 launch robot_tools_demo debug_demo.launch.py debug:trueLaunchConfiguration是 Launch 文件中的變量占位符在運(yùn)行時由用戶輸入或表達(dá)式計算結(jié)果填充。這種方式特別適合需要在不同測試場景間切換的項目。6. 完整實戰(zhàn)案例模擬具身智能機(jī)器人的坐標(biāo)發(fā)布與參數(shù)控制6.1 需求分析為了把 TF、參數(shù)機(jī)制和 Launch 文件串起來我們來做一個綜合案例。假設(shè)我們有一個移動機(jī)器人仿真模型機(jī)器人發(fā)布以下信息機(jī)器人基座base_link在世界坐標(biāo)系map下的實時位置動態(tài) TF。激光雷達(dá)坐標(biāo)系laser_frame相對于base_link的位置靜態(tài) TF。機(jī)器人的速度和調(diào)試開關(guān)作為節(jié)點參數(shù)。有一個監(jiān)控節(jié)點實時輸出機(jī)器人坐標(biāo)和參數(shù)狀態(tài)。最終用 Launch 文件一鍵啟動全部節(jié)點。6.2 創(chuàng)建參數(shù)配置文件創(chuàng)建config/robot_params.yamlrobot_state_node: ros__parameters: robot_name: sim_robot max_speed: 2.0 enable_debug: true radar_offset_x: 0.25 radar_offset_y: 0.06.3 編寫綜合 TF 廣播器創(chuàng)建robot_tools_demo/robot_state_node.py這個節(jié)點同時完成動態(tài) TF 廣播和參數(shù)讀取。import rclpy import math from rclpy.node import Node from tf2_ros import TransformBroadcaster from geometry_msgs.msg import TransformStamped class RobotStateNode(Node): def __init__(self): super().__init__(robot_state_node) # 讀取參數(shù) self.robot_name self.get_parameter(robot_name).get_parameter_value().string_value self.max_speed self.get_parameter(max_speed).get_parameter_value().double_value self.enable_debug self.get_parameter(enable_debug).get_parameter_value().bool_value self.radar_offset_x self.get_parameter(radar_offset_x).get_parameter_value().double_value self.radar_offset_y self.get_parameter(radar_offset_y).get_parameter_value().double_value self.broadcaster TransformBroadcaster(self) self.timer self.create_timer(0.05, self.timer_callback) self.step 0 self.get_logger().info(f機(jī)器人 {self.robot_name} 已啟動) self.get_logger().info(f最大速度: {self.max_speed}, 調(diào)試模式: {self.enable_debug}) def timer_callback(self): self.step 1 # 在 launch 文件中使用 declare_parameter 聲明參數(shù) self.declare_parameter(robot_name, sim_robot) self.declare_parameter(max_speed, 2.0) self.declare_parameter(enable_debug, False) self.declare_parameter(radar_offset_x, 0.25) self.declare_parameter(radar_offset_y, 0.0) # 動態(tài)變換map - base_link t_map_base TransformStamped() t_map_base.header.stamp self.get_clock().now().to_msg() t_map_base.header.frame_id map t_map_base.child_frame_id base_link t_map_base.transform.translation.x 0.1 * self.step * 0.05 t_map_base.transform.translation.y 0.2 * self.step * 0.05 t_map_base.transform.translation.z 0.0 qz math.sin(0.2 * self.step * 0.05 / 2.0) qw math.cos(0.2 * self.step * 0.05 / 2.0) t_map_base.transform.rotation.z qz t_map_base.transform.rotation.w qw self.broadcaster.sendTransform(t_map_base) # 靜態(tài)變換base_link - laser_frame t_base_laser TransformStamped() t_base_laser.header.stamp self.get_clock().now().to_msg() t_base_laser.header.frame_id base_link t_base_laser.child_frame_id laser_frame t_base_laser.transform.translation.x self.radar_offset_x t_base_laser.transform.translation.y self.radar_offset_y t_base_laser.transform.translation.z 0.15 self.broadcaster.sendTransform(t_base_laser) if self.enable_debug and self.step % 10 0: self.get_logger().info( f發(fā)布坐標(biāo): x{t_map_base.transform.translation.x:.3f}, fy{t_map_base.transform.translation.y:.3f} ) def main(argsNone): rclpy.init(argsargs) node RobotStateNode() try: rclpy.spin(node) except KeyboardInterrupt: pass finally: node.destroy_node() rclpy.shutdown() if __name__ __main__: main()這里有個需要提前注意的細(xì)節(jié)參數(shù)聲明必須在節(jié)點初始化時完成不能在定時器回調(diào)里重復(fù)declare_parameter。上面代碼為了保持示例的單文件結(jié)構(gòu)做了一個直觀演示但在工程中一定要把參數(shù)聲明放到__init__里。否則節(jié)點會報參數(shù)重復(fù)聲明的錯誤。6.4 編寫坐標(biāo)監(jiān)控節(jié)點創(chuàng)建robot_tools_demo/monitor_node.py用于查詢 TF 并輸出機(jī)器人坐標(biāo)import rclpy from rclpy.node import Node from tf2_ros import TransformListener, Buffer from tf2_ros import LookupException, ConnectivityException, ExtrapolationException class MonitorNode(Node): def __init__(self): super().__init__(monitor_node) self.buffer Buffer() self.listener TransformListener(self.buffer, self) self.timer self.create_timer(0.2, self.timer_callback) def timer_callback(self): try: trans self.buffer.lookup_transform( target_framemap, source_framelaser_frame, timerclpy.time.Time() ) self.get_logger().info( flaser_frame 在 map 坐標(biāo)系下: fx{trans.transform.translation.x:.3f}, fy{trans.transform.translation.y:.3f} ) except (LookupException, ConnectivityException, ExtrapolationException) as e: self.get_logger().warn(f無法獲取變換: {e}) def main(argsNone): rclpy.init(argsargs) node MonitorNode() try: rclpy.spin(node) except KeyboardInterrupt: pass finally: node.destroy_node() rclpy.shutdown() if __name__ __main__: main()6.5 編寫一鍵啟動 Launch 文件創(chuàng)建launch/robot_demo.launch.pyimport os from launch import LaunchDescription from launch_ros.actions import Node from launch_ros.parameter_descriptions import ParameterFile from launch.substitutions import PathJoinSubstitution from launch_ros.substitutions import FindPackageShare def generate_launch_description(): return LaunchDescription([ # 啟動坐標(biāo)狀態(tài)節(jié)點加載 YAML 參數(shù) Node( packagerobot_tools_demo, executablerobot_state_node, namerobot_state_node, outputscreen, parameters[ PathJoinSubstitution([ FindPackageShare(robot_tools_demo), config, robot_params.yaml ]) ] ), # 啟動監(jiān)控節(jié)點 Node( packagerobot_tools_demo, executablemonitor_node, namemonitor_node, outputscreen ), # 啟動 rviz2 Node( packagerviz2, executablerviz2, namerviz2, outputscreen ) ])6.6 注冊程序入口在setup.py的entry_points中添加entry_points{ console_scripts: [ tf_broadcaster robot_tools_demo.tf_broadcaster:main, tf_listener robot_tools_demo.tf_listener:main, param_demo robot_tools_demo.param_demo:main, robot_state_node robot_tools_demo.robot_state_node:main, monitor_node robot_tools_demo.monitor_node:main, ], },6.7 編譯并運(yùn)行完整案例cd ~/ros2_ws colcon build --symlink-install source install/setup.bash # 一鍵啟動 ros2 launch robot_tools_demo robot_demo.launch.py預(yù)期效果終端中可以看到robot_state_node輸出機(jī)器人啟動日志調(diào)試模式下每 10 個周期輸出一次坐標(biāo)。monitor_node持續(xù)輸出laser_frame在map坐標(biāo)系下的位置。rviz2 窗口中可以看到map、base_link、laser_frame三個坐標(biāo)系的實時位置。在 rviz2 中 Add TF 顯示后你可以觀察坐標(biāo)軸的變化。隨著時間推移base_link會逐漸遠(yuǎn)離map原點laser_frame始終固定在base_link前方偏置位置。7. 常見問題與排查思路7.1 TF 相關(guān)常見報錯問題現(xiàn)象常見原因解決思路監(jiān)聽器一直提示 “frame X does not exist”TF 廣播器沒有啟動或者坐標(biāo)系名稱拼寫不一致先用ros2 run tf2_tools view_frames查看當(dāng)前 TF 樹確認(rèn)坐標(biāo)系是否存在提示 “Lookup would require extrapolation into the past/future”時間戳不一致或監(jiān)聽端緩存時間設(shè)置太短檢查廣播器的時間戳是否使用當(dāng)前時間監(jiān)聽端使用rclpy.time.Time()查詢查詢變換時收到 ConnectivityException兩個坐標(biāo)系不在同一棵 TF 樹上檢查中間坐標(biāo)系是否斷開用 view_frames 查看樹結(jié)構(gòu)rviz2 中看不到坐標(biāo)軸TF 顯示沒有添加或 TF 數(shù)據(jù)頻率太低點擊 Add 添加 TF 顯示檢查廣播器定時器頻率7.2 參數(shù)相關(guān)常見報錯問題現(xiàn)象常見原因解決思路節(jié)點報錯 “parameter xxx not declared”代碼中直接 get_parameter 未聲明參數(shù)在使用前先調(diào)用 declare_parameterYAML 參數(shù)不生效YAML 第一層節(jié)點名與啟動節(jié)點名不一致確認(rèn) YAML 中的節(jié)點名和 launch 中的 name 參數(shù)完全一致參數(shù)回調(diào)不執(zhí)行沒有調(diào)用 add_on_set_parameters_callback檢查代碼是否注冊了回調(diào)函數(shù)啟動后參數(shù)仍為默認(rèn)值Launch 文件加載參數(shù)的方式不對檢查 parameters 列表中是文件路徑還是字典file 路徑要用絕對路徑或 find_package7.3 Launch 文件常見報錯問題現(xiàn)象常見原因解決思路ros2 launch提示找不到功能包沒有 source install/setup.bash先編譯再 source或者使用--symlink-install方式編譯可執(zhí)行文件找不到setup.py 的 entry_points 沒有配置添加后重新 colcon buildLaunch 文件語法錯誤Python 縮進(jìn)或?qū)脲e誤單獨用python3 launch_file.py語法檢查雙節(jié)點同名沖突兩個 Node 的 name 參數(shù)相同給節(jié)點顯式設(shè)置不同名稱8. 最佳實踐與工程建議8.1 TF 使用規(guī)范坐標(biāo)系命名統(tǒng)一項目開始前確定全局坐標(biāo)系命名規(guī)范如map、odom、base_link、laser_frame、camera_link。不要出現(xiàn)lidar和laser混用的歧義。靜態(tài)變換盡量使用 static_transform_publisher像傳感器安裝位置這類固定關(guān)系不要寫在動態(tài)廣播器里否則浪費(fèi)帶寬且增加不穩(wěn)定性。時間戳必須正確維護(hù)TF 數(shù)據(jù)的時間戳是所有變換查詢的基礎(chǔ)廣播端使用當(dāng)前時間監(jiān)聽端查詢時盡量用最新時間。避免 TF 樹出現(xiàn)環(huán)坐標(biāo)系之間的父子關(guān)系必須是一棵樹不能出現(xiàn)循環(huán)依賴否則監(jiān)聽器無法計算變換。8.2 參數(shù)使用規(guī)范所有可調(diào)項都聲明為參數(shù)包括話題名、坐標(biāo)偏移、控制增益、開關(guān)標(biāo)志避免后期調(diào)參重新編譯。參數(shù)校驗一定要做在參數(shù)回調(diào)中檢查范圍、類型和大小寫拒絕非法輸入。參數(shù)文件按場景拆分sim_params.yaml、real_robot_params.yaml、test_params.yaml分開管理配合 Launch 文件的命令行參數(shù)切換。生產(chǎn)環(huán)境限制動態(tài)改參權(quán)限對正在運(yùn)行的機(jī)器人某些核心參數(shù)不建議運(yùn)行時修改需要通過參數(shù)回調(diào)和權(quán)限管理控制。8.3 Launch 文件工程化建議一個 Launch 文件只負(fù)責(zé)一個完整功能導(dǎo)航、建圖、機(jī)械臂控制、傳感器驅(qū)動拆分到不同 Launch 文件再通過總 Launch 文件 include。善用變量和替換用LaunchConfiguration實現(xiàn)命令行傳參用PathJoinSubstitution解析包路徑避免硬編碼絕對路徑。日志輸出設(shè)置為 screen開發(fā)階段便于觀察節(jié)點輸出生產(chǎn)階段可以改為log并使用日志系統(tǒng)。在 CI 中驗證 Launch 文件可以通過ros2 launch --show-args檢查參數(shù)定義再跑一次短時啟動測試確保 launch 文件可重復(fù)執(zhí)行。8.4 具身智能機(jī)器人開發(fā)方向掌握了 TF、參數(shù)和 Launch 文件下一階段可以繼續(xù)深入導(dǎo)航棧Nav2TF 是導(dǎo)航棧的基礎(chǔ)了解代價地圖、AMCL 定位、路徑規(guī)劃都需要 TF。機(jī)械臂運(yùn)動規(guī)劃MoveIt2MoveIt2 大量使用 TF 和參數(shù)機(jī)制學(xué)習(xí)它有助于理解機(jī)械臂控制的坐標(biāo)管理。仿真環(huán)境Gazebo在 Gazebo 中搭建機(jī)器人模型配合 TF 發(fā)布傳感器數(shù)據(jù)可以組成一套完整的仿真調(diào)試環(huán)境。多傳感器融合相機(jī)、激光雷達(dá)、IMU 的位置變換都靠 TF 維護(hù)屬于感知模塊的開發(fā)重點。9. 總結(jié)與學(xué)習(xí)路線到這里ROS2 常用工具的三個核心模塊已經(jīng)全部跑通了TF 坐標(biāo)變換工具掌握了動態(tài)廣播器、靜態(tài)變換、監(jiān)聽器和 rviz2 可視化理解了坐標(biāo)樹的空間關(guān)系模型。參數(shù)機(jī)制學(xué)會了聲明參數(shù)、命令行設(shè)置參數(shù)、YAML 文件加載參數(shù)、參數(shù)回調(diào)校驗知道如何讓節(jié)點配置更靈活。Launch 文件掌握了 Python 版 Launch 文件的基本結(jié)構(gòu)、多節(jié)點啟動、參數(shù)加載、變量替換和命令行傳參。建議你按照下面的順序繼續(xù)鞏固重寫本文案例不要復(fù)制粘貼而是自己手動敲一遍代碼遇到報錯時先看錯誤信息再對照本章常見問題表排查。改造小海龜示例嘗試給小海龜添加自定義 TF 坐標(biāo)系在 rviz2 中觀察坐標(biāo)變化。搭建 Gazebo 仿真機(jī)器人在仿真環(huán)境中給機(jī)器人添加傳感器和 TF 配置體驗更接近真實項目的開發(fā)流程。閱讀官方教程ROS2 官方的 tf2、參數(shù)和 Launch 教程是質(zhì)量最高的學(xué)習(xí)資源可以結(jié)合本文反復(fù)閱讀。學(xué)習(xí)機(jī)器人開發(fā)最重要的是把每個小工具練熟然后再組合使用。TF、參數(shù)、Launch 這三個工具就像積木單獨看都不復(fù)雜組合起來就能支撐起一個完整的機(jī)器人系統(tǒng)。如果你在練習(xí)過程中遇到問題歡迎在評論區(qū)留言我看到后會繼續(xù)補(bǔ)充相關(guān)教程。如果本文對你有幫助可以收藏備用后續(xù)我會繼續(xù)更新 ROS2 導(dǎo)航、MoveIt2 和具身智能相關(guān)的實戰(zhàn)內(nèi)容。
返回列表
PREV
查看更多資訊
NEXT
返回資訊列表
思思热久久阴99| 人妻射精AV| 国产26uuu视频| 嫩草AV久久伊人妇女超级A| 99久re热视频精品98| 色99欧洲色19| 五月丁香在线观看99| 午夜婷婷久久 | 97人妻碰碰碰碰碰久久久久久| 99视频在线观看欧| 黑人无码一区| 色伊人91在线视频| 婷婷久久精品| 少妇婷婷五月天| 最新久久网址| 色人妻五月| 久久久久五月丁香| 欧美成人AAA片一区国产精品 | 欧美日韩日韩成人| 九九色播五月丁香| 91操人人操| 99视频只有这里精品| 五月婷婷婷综合网| av操B网站| 色五月激情五月开心五月| 91丨九色丨熟女|老版| 99自拍视频在线| 五月婷久久在线| 99热99精品| 欧美大肥婆大肥BBBBB| 久久人妻伦理| 99精品在| 精a品a视a频| 久久久精品婷婷五月天| 图片区 小说区 区 亚洲五月| 亚洲热综合| 九九AV| 97色五月丁香婷婷| 一本色综合色| 国产欧美精品AAAAAA片| 色婷婷九月| 色婷婷色五月天| 综合网色| 丁香五月婷婷啪| 超碰99热精品在线| 丰满少妇猛烈A片免费看观看| 激情五月天啪啪| 久久精品小视频| 丁香激情五月| 丁香五月情| 中文字幕人妻一区二区| 好吊兆人妻| 婷婷天堂站| www.俺去也com| 91九色在线| 色射7856五月天激情四射| 亚洲天天操| 五月天六月色| 香蕉人在线香蕉人在线 | 97自拍99| 大香蕉人人人| 第四色五月婷婷| 色色色色欧美| 色色999三级片| 五月天精品| 五月玖玖| 色吧五月婷婷| 九九久久99| 台湾无码A片一区二区| 五月婷婷激情中心| 99热这里只有精品最新| 激情五月婷婷色| 深爱网深爱综合网| 97色婷婷五月天| 色欲五月天| ss五月天激情| 丁香六月婷婷色XXXX| 欧日美女Va| 天天干夜晚夜操| 丁香婷婷五月六月天| 色婷婷影视| 丁香五月天无码AV| 综合五月丁香六月婷婷| 九九99免费视频| 久久色五月| 大香蕉五月| 婷婷玖玖丁香| 色综合久久久久| 色5月婷婷| 激情性爱五月| 怡红院99| 五月婷亚洲精品| 六月婷婷久久大全| 久久婷婷丁香| 丁香成人五月天| 国产激情视频在线观看| 美女久久婷婷| 五月亭亭欧美女人| 99re66热这里只有精品| 只有久久精品免费| 玖玖午夜视频| 91丨九色丨大屁股| 大香伊人婷婷| 无码一区二区日韩| 婷婷5月开心6月| 欧美亚洲操逼| 色情丁香五月婷婷精品| 亚洲三级无码| 婷久久| 五月天婷婷激情网| 伊人五月丁香| 超碰91在线| 狠狠做婷婷| 国产FREESEXVIDEOS性中国| 婷婷五月天黄色网址| 99操久久| 九九99一区| 色色亚洲五月天| 久热综合| 91re色综合视频| 婷婷五月天AV在线| 激情五月深爱五月| 少妇人妻人伦A片| 婷婷五月天亚洲| 99精品国产在热久久| 免费日本aⅴ中文字幕| 丁香五月电影院在线观看| 丁香五月婷婷基地| 丰满少妇乱A片无码| 久热精品在看| 国产精品久久久60086| 激情深爱综合网| 国产 亚洲 在线| 99网| 亚州色婷婷| 色五月天网| 亚洲婷婷激情综合激情999精品| 六月激情综合| www.五月天色色.com| 激情深爱综合| 五月色婷婷中文字幕| 狠狠干狠狠色| 久久久人妻久久久| 开心五月网| 91人人网| www.色五月| 国产精品久久久久久久久久| 91综合国免费久入| 九九热精品| 欧美三级A做爰在线观看| 激情综合网站| 色五月综合激情| 色综合婷婷| 久久天堂女人| 五月丁香无码| 伊人狼人干| 人妻av在线| 亚洲第79页| 天天爽天天操| 亚洲五月丁香综合网| 99网| 岛国在线观看91| 久九色| 丁香五月亚洲| 一区二区你懂的| www。狠狠干。com| 色色婷婷丁香| 婷婷开心青青草| 色婷婷网| 成人五月天在线视频在线观看| 第四色五月婷婷| 亚州欧美黄色电影| 亚洲人成人五月天| 99热99日天天干| 日操| 丰满少妇猛烈A片免费看观看| 大香蕉五月天婷婷| 99性色| 亚洲婷婷基地| 色综合激情| 久久久.COM| av在线免费网站 | 五月天色裸体视频| 婷婷五月日本| 色情五月综合婷婷| 九久9精品| 色99自拍| 五月花婷婷在线精品视频| 91爱啪啪| 天天婷婷天天| 五月丁香六月婷婷激情四射| 午夜微拍福利| 色五月天丁香婷婷| 亚洲啪啪精品| 五月婷色色| 超碰成人免费| 国产人妻777人伦精品HD| 色色99色色| 婷婷伊人| 亚洲天堂aaa| 伊人大香久久| 可以看的AV| 无码激情| 97偷拍对白视频| 天天爽天天日| 九九视频这里是精品五月| 香蕉AV777XXX色综合一区| 五月开心啪啪| 五月开心久久| 99热在线观看| 天天骑天天操| 久热这里只有精品在线观看| 国产女人十八水真多1| 综合成人小说婷婷| 日日操夜夜操狠狠操| 激情内射人妻1区2区3区| 色婷婷九月| 91热手机在线| 久久久WWW| 激情五月婷婷在线区| 日本三级第一页| 91色在线 | 日韩| 九九综合九九| 亚洲99在线| 色域五月丁香| 婷婷丁香久久| 91日日日| 色99欧洲色19| 六月丁香五月激情亚洲AV| 五月婷A V在线| 噜一噜在线| 日本片日本片祼观看网站在线看中文版网页在线看 | 亚洲精品V天堂中文字幕| 激情欧美丁香五月| 丁香五月亚洲无码| 婷婷在线综合| 九一牛视频探花| 丁香色五月 97干| 人人干AV| 激情另类综合| 婷婷丁香五月天影院 | 九九视频在线观看视频6 | 日日操天天爽| 人妻久久久久久久久妻久久久久| 成片免费观看视频大全| 色综合偷拍| 蜜臀AV在线观看| 色婷婷亚洲婷婷| 99热日韩| 九九狠狠干| 五月天丁香| 亚洲激情97五月天| 五月丁综合在线观看| 色玖玖玖| 五月天激情黄色网址| 99热最新网址| 96丁香六月婷婷蜜桃综合久久| 五月天综合久久| 五月开行婷婷色五月| 色碰碰| 大香蕉太香蕉视频97| 26UUU精品一区二区| 色婷婷激情| 激情五月com| 他改变了拜占庭| 996re热精品视频| 色噜噜狠狠色综无码久久合欧美| www狠狠| 色五月av| 色色五月婷婷久久| www.色五月| 色播激情五月天| 婷婷基地五月色| 丁香婷婷五月综合| 超级碰碰碰碰视频| 激情视频综合| 成人五月天丁香婷| 色婷婷久久| 日本人人草草| 91avse| 4438全国最大视频成人网站在线观看 | 天天做天天爽| 丁香五月激情网| 色情五月停停丁香| 激情五月天激情五月天| 国产.亚洲.欧洲视频在线| 色五月天在线观看| 久久婷婷人人| 丁香婷婷九月| 狠狠色狠狠操| 天天想夜夜爽天天爽| 大香蕉婷婷丁香| 97碰人人操| 玖玖在线| 色狠狠狠干| 久久婷婷青草五月天| 丁香五月综合婷婷| 九九热九九热精品| 五月丁香欧美在线| 色七七九九| 任你日视频| 超碰人人射| www久久99| 精品久久久人妻| 五月丁香激情综合网| 99久在线精品99re8热| 五月婷婷六月色| 久草五月天| 天天爽天天日| 91一起操| 综合网网欲色| 蜜臀av无码久久久久久久久| 五月婷婷开心六月激情小说| www夜夜操wwwcon| 色五月婷婷久久大| 欧洲亚洲免费视频9| 综合五月婷婷| 国产99久9在线+|+传媒| 高清 码 免费看片短视频| www.黄色片-久久成人国产精品在线播放-999AV | 开心五月天激情网| 26UUU精品一区二区| 国产SUV精品一区二区6| 欧美激情综合色综合色| 99热色精品| 亚洲无码99| http://www.com久久久精品一区| 日韩AV片| 色在线视频网2025| 午夜丁香婷婷| 99啪视频在线观看| 亚洲综合新99视频| 日本一级特黄大片AAAAA级| 岛国AV网| 久久99视频| 日本色色色色色色色色一色二色| 欧洲S级在线观看| 99久热在线精品| 丁香涩涩五月天| WWW,激情五月天,COM| 天天影视色综合网| 99热首页| 婷婷日韩| 九九热10| 丁香婷婷91在线观看视频| 天天色播| 午夜爱插插| α久久| 性色99| 色五月av| 丁香伊人网| 色噜噜婷婷| 51国精产品自偷自偷综合| 国产精品成人网址| 久久五月天黄色五月天色网址| 日本婷婷色日| 久热99狠| 99热精品在线播放| 亚洲免费电影2| 五月婷婷九九久久| 激情播丁香| 久色激情| 综合九九久久| 欧美成人精品A片免费一区99| 蜜桃人妻无码AV天堂三区| 亚洲AV影片在线观看| 欧美大片免费播放器| 色婷婷在线电影| 久青草大香蕉| 五月激情婷婷开心五月| 激情影院丁香五月| 婷婷五月激情中文字幕| httpwww色com日本| 9久热| 九九爱看亚洲| 色热久| 国产毛片欧美毛片久久久| 香蕉99网| xx综合网| 99热资源在线| 色婷婷中文| 狠狠第四色| 婷婷永久在线| AV在线中文| 蜜臀AV在线观看| 国内久久久精品99| 婷婷丁香成人网址| 99在线观看精品视频| 天天久久婷婷| 久这里只有精品| 五月丁香婷婷免费视频| 97超碰人人操| 国产中文字幕在线视频免费观看| 另类 在线| www.爱操com.| 丁香五月播播| 一起草av在线观看| 五月天天天色| 免费超碰在线观看| 五月丁香六月色婷| 五月天婷婷AV| 日本97人人| 欧美色六月婷婷| 五月婷中文字幕| 高清免费在线视频| 五月丁香婷婷激情在线| 色婷婷丁香五月| 99情色五月天| 久久这里只有精品16| 久久久久人妻| 日韩二区搞逼插逼毛片| 丁香成人综合| 综合激情视频| 丁香六月婷| 日逼免费视频| 欧美顶级少妇做爰HD| 天堂色婷婷| 激情五月天小说|五月天开心激情网|亚洲精品国产自在现线|黄色五月天 | www.激情在线| 久久色情| 色婷婷香蕉| 天天在线XXX| Www.sesese丁香| 国产日韩欧美性生活| 人妻精品在线| 97久人人| 色五狠狠| 99视频热99| 国产日批视频| 丁香久久| 色色激情| 色婷婷六月| 国产1区2区3区| 成人免费高清在线播放| 色情婷| 成人在线日韩欧美| 思思99久久| 久久精品人妻| 国产资源在线视频| 丁香五月六月婷婷综合| 婷婷五月激情综合网| 99热久草| 四季8848精品成人免费网站| 九九这里精品| 婷婷婷婷午夜| 天天久久综合| 97超级碰| 色狠久| 操操熟女| www,超碰| 六月99天天婷婷激情综合| 婷婷五月天视频| 婷婷六月视频| 丁香五月激情五月| 一区二区三区四区五区| 大香焦啪啪啪| 天天爽天天摸| 六月婷婷网| www.9797国产| 91超碰在线观看| 久久久99久久| 蜘蛛女免费观看完整版高清电影| 色五月激情综合网| 丁香五月六月久久综合 | 欧美S码亚洲码精品M码| 天天色色婷婷| 激情婷婷五月社区| 精品婷婷五月天| 强辱丰满人妻HD中文字幕| 另类综合国产| 婷婷综合av| www.99热视频| 五丁香激情综合| 亚洲99精品九九在线| 五月丁香婷婷潮喷中文字幕| 99热新网址| 激情视频网址| 丁香成人色情五月天| 亚洲AV成人一区二区在线观看| 婷婷五月天激情综合深爱激情| 日韩AV中文字幕在线| 九九干视频| 国产免费一区二区三州老师F1F1| 涩五月婷婷| 丁香五月婷婷手机| 丁香婷婷五月六月久久| 成人免费120分钟啪啪| 久久久久久性爱视频| 丁香五月婷婷亚洲色图| 粉嫩AV久久一区二区三区| 亭亭五月天黑人2014| 色综合偷拍| 色吧五月| 久久这里都是精品| 午夜色婷婷| 五月激情影院| 97色在线观看视频| 婷婷久久六月费| 丁香五月婷婷天激情| 国产精品国产VA片国产| 亚洲人妻Av| 久草婷婷| 五月天婷婷色色网| 天堂婷婷五月色| 久久人操-久草婷婷-成人AV| 专区无日本视频高清8| www色综合| 久久激情网| 天天插天天干| 99热免费看| 五月婷婷爽爽爽| 丁香激情五月| 久久狠色噜噜狠狠狠狠97| 国产综合丁香五月天| 丁香六月婷| 五月丁香六月情| 七七九九色色| 亚洲美女裸体被操在线观看| 四月丁香五月婷婷久久| 天天操夜夜玩!| www99久久| 亚洲宗合激情| www.婷婷六月天| 六月丁香啪啪啪| 色五月婷婷视频| 91人人网| 久xxxx| 大香蕉 婷婷| 欧美va在线| 色婷婷婷婷成人网| 亚洲精品国产成人AV在线| 在线日韩av| 成人做爰A片免费看网站找不到了| 亚洲天堂AV免费片| 久久色五月| 在线日韩av| 欧美性生交XXXXX无码小说| 色欲天天综合网| 六月婷婷中文字幕| 五月天婷婷在线播放免费| 6月丁香婷婷激情| av久热| 99热只有精品在线| 99九九99九九九视频精品| 国产精品18久久久| 激情五月天视频| 超碰在线人人| 激情图片婷婷| 99九九视频| www.激情五月天| 蜜臀九九九九| 丁香亭亭久久| 五月开心婷婷网| 九九热99视频在线| 99碰视频| 激情综合99| 97碰碰电影| www99xxxx五月丁| 亚洲啪啪自拍| 在线日韩av| 色啪网| 激情綜合W W W,激情五月天| 丁香五月婷婷视频| 99乱视频| 国产寻花在线| 色高清无码视频| 欧美人人操| 99久久婷| 婷婷中文综合网| 亚洲无码影音| 日碰日| 中国丰满熟女A片免费观| www.超碰在线| 91蜜桃婷婷狠狠久久综合9色| 久久99网站| 九九碰九九爱97超碰| 久久9久| 久久婷网| 亚洲色网络| 可以直接看的av| 激情婷婷| www.狠狠| 92久久久| 久热亚洲| 五月天伊人av| 久久婷婷五月天| 狠狠色色| AV九九| 九九热99热| 99热免费观看| 日本狠狠色| 91九色国产熟女| 4438激情网| 99热这里只有精品8| 激情五月,婷婷五月,丁香五月| 思思热视频在线观看| 亚洲VA欧美VA| 久色国产| 精a品a视a频| 六月婷婷色五月| 狠狠色婷婷7777久| 日韩激情人伦人| 激情婷婷综合| 丁香六月婷婷综合欧美| 五月丁香在线综合| 91精品久久久久久久| 夜夜撸日日操| 久久精品熟女亚洲AV麻豆| 停停综合色色| 激情五月天噢美| 婷婷五月丁香伊人网| 亚洲久久婷婷| 久久999久久999久久999久久| 天堂A∨在线| 成人做爰高潮A片免费视频| 日本玖玖在线| 激情五婷精品网在线观看网址| 热99久久这里只有精品| 国产性爱一级| 婷婷五月丁香亚洲| 五月婷婷深深爱| 七七九九色色| 婷婷五月天播播| 91超碰人人操| 懂色av蜜臀av粉嫩av永陈冠希| 五月天社区| 五月丁香色婷婷熟女| 991精品在线视频| 桃色成人网| 六月婷婷日| 国产1区2区3区在线观| 五月草影视| 女人天堂AV| 亚洲亚洲人成综合网络| 久久久久久久久久久月丁| 久久五月天婷婷视频| 日日做夜夜爱| 久久小视频| 色五月成人| 狠狠色噜噜狠狠狠狠狠色综合久久| 久月婷婷| 激情丁香五月婷婷| 日本黄 色 片| 精品久久二6| 思思热精品在线| www.婷婷| 天天操天天插天天射| 99在线观看亚洲| 九热免费视频| 国产成人亚洲综合亚洲| 丁香婷婷五色月| 色五月av| 五月婷网| 成人AV中文字幕| 日韩成人免费电影| 99九九综合久久九九| 四月婷婷丁香| 极品人妻VIDEOSSS人妻| 色就是色婷婷五月亚洲激情| 99在线视频资源| 六月婷婷日| 色婷激情网| 亚洲va成人va成人va在线观看| 在线观看亚洲AV| 欧美久久婷婷| 五月综合久久| 色婷婷成人丁香| 色五月激情五月天| 丁香六月狠狠干| 丁香桃色网| www.91五月| 五月天色婷婷av| 亚洲精品无码一区二区| 一月婷婷色色| 五月婷婷婷丁香播| 九九99热久久精品66中文字幕| 噜噜噜狠狠色综合| 九九aV| 中文字幕精品在线观看| www.射伊蕉婷婷| 亚洲操B视频| 香蕉AV777XXX色综合一区| 热久综合| 天天日夜夜高潮| 噜噜视频| 五月丁香六月色婷婷综合五月天| 综合久久婷婷| 99国产小视频2013| 337p大胆噜噜噜噜噜91Av| 9精品一区| 激情婷婷22月间| 丁香五月婷婷天| 综合久久激情久久| 婷婷五月天黄色小说| 老师高潮流白浆喷水的A片| 无码se| 91丨九色丨大屁股| 九九视频这里是精品五月| 婷婷五月无码| 综合五月草| 久久久天堂国产精品女人| 日日噜噜久久婷婷五月天| 成人无码髙潮喷水A片| 男女免费视频999| 久久色婷婷| 99综合视频在线| 九九这里只有精品| 欧洲第一久色| 99干99| 内射激情在线| 白度黄视频| 久热这里| 日本色道视频网站| 成人国产欧美大片一区| 精品九九视频| 无码人妻少妇色欲AV一区二区 | 九九这里精品| 五月天综合在线| 亚洲九区| 婷婷五月丁香基| 五月丁香六月在线| 97碰超级人人看| 日本综合久久| 五月丁了香蕉综合| 欧美一级毛卡片无码| 超碰三级片| 思思热久久阴99| 欧洲综合一区| 97碰久久| 九九色色网| 大香蕉综合网| 日韩99色99| 九九亚洲综合| 五月天丁香婷婷久久九| 九热免费视频| 岛国资源网| 色色97丁香婷婷五月天| 日韩精品999| 99re26视频| 色九九九九| 亚洲欧洲自拍图片专区五月天| 亚洲中文字幕在线电影| 色婷婷狠狠18禁| 综合五月天亚洲婷婷| 日韩性爱无码| 9999三级片| 精品九九视频| 九九色播五月丁香| 亚洲深喉aV| 天天久久狠狠色综合| 五月婷婷视频ab| 中文字幕欧美精品久久| 日韩无码色色| 丁香狠狠色婷婷久久无码视频| 狠狠色婷婷在线| 99色综合久久| 丁香五月激情网| 丁香五月天啪啪| 丁香五月六月久久综合| Www.狠狠| 伊人爱爱日本| 99热只有| 超碰91人人操| 夜夜做夜夜愛| 天天插天天插天天操| 天天综合色99| 国产看真人毛片爱做A片| 人妻videos人妻高清| 99riAV成人在线视频| 99精品亚洲| 噜噜噜久久| 婷婷亚洲在线| 婷婷五月电影院| 久久久久97| 色欧美一级| 九月婷婷综合| 激情五月婷婷丁香综合网 | 激情综合色五月六月婷婷| 五月天激情色色| 人人操AV| 亚洲在线操| 人人摸人人澡人人| 播五月丁香六月| 热久69| 六月婷婷AV| 99精品丁香五月| 丁香五月激情五月| 狠狠色噜噜狠狠狠888| 色碰碰| 五月激情婷婷国产精品久久久久久| 亚洲瑟瑟精品在线| 六月丁香啪| 开心五月婷婷五月| 热久91| 狠狠婷婷色综合| 99精品偷自拍| 99视频内射三四| 色五月激情| 欧美成人无码一区二区三区| 久久五月丁香婷婷| 综合色影院| 91中文狠狠综合| 97在线刺激| 激情开心五月天| 激情亚洲网| 狠狠色噜噜| 深情五月天| www.五月瑟| 夜夜撸天天日| 丁香涩涩五月天| 五月丁香六月激情狠狠| 国产免费AV网站| 五月丁香婷色| 久久国产高潮白浆免费观看99| 超碰99热精品在线| 9久热精品在线视频| 嫩草AV久久伊人妇女超级A | 婷婷激情六月中文| 天堂网操| 六月婷婷AV| www.99热精品99.com| 超碰v| 精品香蕉99久久久久网站| .精品久久久麻豆国产精品| 色五月激情五月| 看片视频在线免费日产在线看| 色婷网| 九九九九这里只有精品| 丁香五月伊人| 五月丁香网站| 天堂无码人妻精品AV一区| 国产在线aaa片一区二区99| 婷婷五月色综合| 五月丁香性爱| 五月婷六月| 五月丁香婷婷伊人| 天天干,天天舔| 久久激情综合| 亚洲色情激情丁香五月| 五月天激情婷婷丁香| 亭亭色色五月天| 伊人婷婷青青cao| 日本天天综合| 天天射射夜| 五月色俺婷婷| 天天搞天天色综合| 天天干电影| 色婷视频| 色狠狠色噜噜AV天堂五区| 国产又爽又猛又粗的视频A片| 人人人操| www.狠狠操| 天天肏在线视频| 久激情| 操99| 久久人妻爱爱| 色婷婷丁香AV综合| 99日精品视频| 丁香五月花婷婷开心| 99精品网站| 婷婷综合视频| 人人操AV| 激情综合网婷婷五夜| 亚洲精品视频电影| 五月永久激情| 五月天四色房丁香| 99热这里只有精品国产首页| 九九热99视频| 精品婷婷| 成人 在线观看国产| 狠狠色噜噜狠狠| 天天做天天爱天天日| 日日操天天| 99久久激情视频| www.婷婷五月.com| 久热中文字幕| 五月丁香六月婷婷手机无线| 丁香六月啪啪| 国产精品久久久久9999小说| 五月天社区| 嫩草视频| 五月丁香大相交| 超碰三级秋霞| 婷婷另类小说| 久久精品99国产精品日本| 无码日本精品XXXXXXXXX| 香蕉97碰碰碰超视精品| 五月夜丁香| 91AV婷婷| 亚洲av另类在线观看| 久热超碰| 月婷婷婷婷五月| 欧美激情综合五月色丁香| 91凹凸在线| 国产精品丝| 五月丁香婷婷伊人| 热99这就是精品视频| 97热超碰| 另类图片 五月激情| 超碰久热| 一级韩国产精品毛| 俺五月| 亚洲五月天婷婷| 色五月丁香婷婷| 伊人9草在线观看| 这里只有精品日韩精品| 婷婷五月丁香婷婷| 丁香五月婷婷色| 金品在线视频99| 五月花激情| 婷婷五月天成人| 欧美色久| 色色色.com| 五月天色色网站| 丁香熟女乱| se色99| 亚洲综合五月天| 2050人人操免费工开爱| 色噜噜狠狠色综合伊人| 九热视频| 久久婷婷影院| 婷婷五月天AV| Caoub青青超碰| 99热无码| 99riAV成人在线视频| 亚洲激情色色| ..真实国产乱子伦毛片| 99热最新网址| 91碰人人| 色色AV色色色东莞| 熟女国产在线一区二区三区四区| 婷婷99视频全集高清| 久思思热视频在线观看| 天天综合色| 超碰av在线| 丁香五月久久| 伦乱人妻| 性色视频| 激情性爱婷婷| 有码人妻久久| 亚洲精品字幕| 色色亚洲无码| 久久五月天婷婷| 五月天伊人av| 国产婷婷综合| 久久Xx| 久热69| 99热这里只有精品免费| 9色在线| 日本丁香五月| 婷婷日韩| 五月婷婷六月少妇激情| 爱久久小说下载网| 久久婷婷五月国产激情综合片| 一区二区乱码视频| 精典久久| 人人综合久| 91九色精品| 日本人妻丁香婷婷久久寝取熟女五月| 免费观看的av| 五月婷婷色播| 丁香五月精品视频| 99日在线观看视频| 久久99热 这里有精品| 婷婷五月天影院| 日韩无码一区二区三区四区| 在线观看免费人成视频无码| 噜噜噜噜噜在线| 97人人干| 天天操夜夜爽| 大香蕉娱乐| 五月丁香六月婷婷无码| 亚洲9久久精品| 99只有这里有精品在线视频| 色综合久久综合| 丁香五月人妻| 97色色综合| 婷婷丁香五月综合免费视频百花| www.99久久久久99| 婷婷久久亚洲| 最新日本A片| av国产精品| 日日夜夜狠狠干| 天堂色婷婷| 中文成人在线| 91丨九色丨熟女| 成年AAAA色情| 九九青草热| 激情小说五月天| 天天婷婷天天| 午夜丁香六月婷| 久久久激情| 99爱在线精品视频免费观看| 玖玖五月丁香| 亚洲精品无码99热| 热99在线精品| 丁香五月老师| 色玖玖导航| 日逼影音先锋男人AV资源站| 精品人妻在线| 色性五月天| 国产成人综合网| 99综合成人视频在线观看| 亚洲99综合| 9久热这里只有精品| 激情综合五月丁香| 超碰2021| 色婷婷影院| caop在线视频| 久久小片| 97色色婷婷| 九九精品re免费视频| 国产亚洲精品久久久久苍井松| 婷婷六月综合基地| 天插天啪天啪天啪| 性日本激情| 婷婷亚洲在线| 开心五月婷婷激情| 狠狠摸狠狠摸| 色999;丁香五月| 五月天日日操夜夜操| 婷婷五月激情五月丁香五月| 无码少妇高潮喷水A片免费| 影视av久久久噜噜噜噜噜三级| 一级A片天天操夜夜操| 五月天婷婷黄色视频| 免费看片在线观看| 日本三级第一页| 超碰久热| 亲子乱AV一区二区三区下载| 天天日日综合| 五月天狠狠干| 这里只精品| www.99热日韩.com| www99久久| 亚洲第一影院高清无码网站| 黄桃AV无码免费一区二区三区| 伦乱天堂| 国产免费一区二区三区三州老师F1F1.CC| 精品婷婷五| 99久久久久久| 九九 激情 网| 九九美女视频| 伊人无码高清| 色无码| 草一草avb| 91碰超| 俺去也五月天| 99久久综合| 五月丁香婷婷激激激综合网色播| 99热欧| 婷婷五月天改成什么了| 久久九九怡红院| 99天堂网| 99热思思久| 91欧美| 操操碰| 在线中文字幕视频| www.jiujiujiu| 99在线视频免费| 激情五月婷婷啪啪| 97碰操| 国产资源在线视频| www.97干视频| 金品在线视频99| 婷婷六月色情| 国产4P视频精品五区| 色综合久久久无码中文字幕999| 久久se 综合网 | 久久久8| 碰碰91| 色频玖玖五月天| 婷婷色中文字幕| 99热在线播放| 丁香六月啪啪啪| 另类专区在线观看| 97久久精品| 精品99在线观看| 嫩模aV在线| 狠狠婷婷日韩| 色色色色色色色色色色色色色色,网站| 牛牛澡牛牛爽| 91精品视频男人的天堂| 9久9久| 色五月色五天色情网| 丁香婷婷大香蕉| 婷婷五月中文在线| 久久6这里只有精品| 激情深爱婷婷网| 性爱在线播放av| 五月婷婷婷婷婷| 99热这里只有精品86| 大香蕉99热| 激情五月婷婷| 激情五月天婷婷| 五月丁久久| 亚洲第一成人无码A片| 久久九九激情五月天| 天天干天天操天天射| 日韩欧美成人片| 日本人妻A片成人免费看片| 国产激情视频在线观看| 久久亚洲婷婷综合色五月| 99色播| 有码一区二区三区| 久在热99| 天堂色婷婷| 成人色站,在线视频,看片-SS1AV| 婷婷色色播五月天| 夜夜操天天干| 99久在线视频| 狠狠穞A片一區二區三區| 国产美女无遮挡裸体毛片A片| 五月天婷婷涩涩| 9久精品视频| 色婷婷香蕉丁丁网| 在线只有精品| 第四色五月天| 五月开心播播网| 一区二区乱码视频| a色色片| 99热中文字幕久久| 99自拍视频在线| 日日躁夜夜躁狠狠久久AV| 99热天堂| caobi四区| 丁香婷婷基地| 日韩AAAAA| 婷婷9月天| 久久久久久久久久久44| www色婷婷久久综合久色| 欧美25p| 色丁香五月| 超碰一区二区| 婷婷色在线观看| 天天天天爽爽天干| 99色天堂| Caoub青青超碰| WWW色五月天| 五月丁香六月婷婷网| 99视频只有精品| 婷婷婷五月香蕉| 婷婷月五天在线在线看| 天天爽夜夜爽天天爽夜夜爽| 久久a热| 亚洲a片免费观看| 第二色AⅤ| 日本va欧美va国产激情| 五月丁香网站| 婷婷伊人综合中文字幕| 国产高清RV综合aVa| 亚州色婷婷| 亚洲成人丁香花| 色五月婷婷丁香国产在线| 婷婷六月丁| 99re在线播放| www.婷婷五月| 99热6色| 嫩草AV久久伊人妇女超级A| 婷婷大乡焦噜噜| 99精吕视频在线观看了| 五月花婷婷| 大香蕉伊人99| 色婷婷五月天视频在线| 97干在线视频| 丁香九月婷| 丁香桃色网| 成人 在线观看国产| 久热这里只精品| 婷婷色综合| 亚洲无码免费看| 五月天色婷婷小说| 色五月婷婷网| 久久婷婷六月综合| 婷婷丁香五月网| 中文字幕91,综合| 五月婷婷 六月丁香| 五月停亭六月,六月停亭的英语 | 欧美狠狠草| 成人午夜无码视频| 91亚洲免费片| 综合丁香婷婷五月天| 久久综合影院| 操逼综合激情网| 天天五月情| 国产69久久久欧美黑人A片| 国产视频福利| 夜夜干夜夜操| 久操大屁股女人av| 99色精品视频| 婷婷无码视频| 九九热10| 另类小说五月天| 亚洲美女裸体被操在线观看| 思思久久99热| 欧洲色色| 久久精品国产色| 99热这里只有精品青草| 欧美色色色色色色色| 久久99网| www99xxxx五月丁| 久热这里只有精品99re| 色婷婷综合久久| 综合网五月天123| 韩国真做片在线观看| 丁香五月日啪| 天天操夜夜操| 六月丁香五月激情亚洲AV| 五月天激情视频| 激情婷婷丁香色情五月天| 九九热视频在线观看| 激情五月天久久丁香| 五月丁香狠狠爱| 另类的婷婷| 26uuu国产| 五月天激情小说婷婷| 开心婷婷五月| 欧洲亚洲免费视频区| 91操碰| 五月丁香久久久日婷婷久久婷婷日 | 激情婷婷丁香五月天| 九九热99免费视频| 天堂久久精品| 三级三久久线久久99久目本WW| 天天做天天爱高潮片| 九九热中文| 99久久久久| 天天干天干| 五月天国产成人| 黄色三级毛片中字| 婷婷五月天论坛| 亚洲传媒在线观看| 婷婷五月色播| 99无码视频| 97人人射| 思思热在线视频观看精品| 成人美女网| 色色网站| 国产精品操| 99这里只有精| 99热精品一区| 密视AV综合在线| 日韩在线视频网站| 最新热中文字幕| 欧洲色| 五月婷婷我| 丁香五月激情综合婷综| 亚洲精品亚洲人成人网| 日本久久天堂| 五月天婷婷在线AN| 91精品丝袜久久久久久久久粉嫩| 久色婷婷200| 久久亚洲婷婷| 99爱在线免费视频| 欧美综合激情五月丁香| 综合狠久久| 欧美色婷婷| 天天性视频| 久久您您综合网| 五月丁香六月色| 亚洲AV免费在线| 任我干视频在线观看| 国产婷婷五月中文字幕高清| 亚洲AV日韩在线观看| 久色大| 人人草公开操|