欧美成人午夜精品久久久,国产?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
返回資訊列表
五月丁香亭亭A片| 免费黄网不卡AV| 日本97在线| 亚洲综合无码| 五月丁香 啪啪啪| 啪啪视频99| 欧美 日韩 成人| 精品99这里有| 97欧美在线| 夜夜操夜夜操| 激情五月婷婷| 亚洲精品色色色| 婷婷99狠狠躁天天躁中文| 26uuu国产| 99re思思精品在线观看| 日本色婷婷| 丁香婷婷六月婷婷六月婷婷六月婷婷| 少妇人妻丰满做爰XXX| 热99只有里视频| 91人人澡人人爽人人看| 91seAV| 欧美 日韩 成人 在线| 六月丁婷婷| 五月婷婷激情日本| 九九九AAA热视频| www.久久久.com| 丁香婷婷色五月合集| 九热精品| 97色欧美| www99在线观看视频| 99在线观看精品视频| 丁香六月婷婷综合网| 婷婷99中文字幕| 免费无码毛片一区二区A片| www.com五月天| www.五月激情.com| 成人婷婷桔色| AV伊人青草丁香六月| www.99热这里精品| 婷丁香五月天| 99久久99视频| 日本黄色在线观看| 99.N在线视频| 婷婷五月天在线综合| 这里只有精品视频222| 91人人人人人人人| 丁香五月激情五月| 久久日婷婷| 午夜丁香婷婷| 男同91| 色九九九九| 亚洲丁香五月| 开心五月网 | 日日爽夜夜爽| 欧美日韩999| 九九热re99re6在线精品| 情婷婷五月天| 婷婷色狠狠| 色A网| 九九婷婷五月天| 久久丁香综合| 五月丁香综合中文| 亚洲欧美成人在线| 99精品在线播放| 99九九在线| 五月综合久久| 激情图片五月天| 激情久久久久久| www.色婷婷| 婷婷五月丁香四射| 超碰AV成人| WWW色色色COM| 久久久久亚洲AV成人无码电影| 色综合久久88| 亚洲成人av在线| 色婷婷激情Av久久久| 中文字幕丰满孑伦无码专区| 99精品丰满| 婷婷五月欧美| 天天激情5月天亚洲| 久久五月激情| 颜射 精品性爱av| 这里只有精品99www| 超碰1999| 开心激情五月天网| 色色色色网| 日韩中文欧美| jiuse91在线| 99热色婷婷| 97碰人人操| 99热老网站| 他改变了拜占庭| www.婷婷五月天.com| 色色色999| 亚洲精品操一操、噜一噜、摸一摸、爽| 人人操操97| 99在线资源视频| 欧美激情-区二区三区| 五月天婷婷视频30| 在线播放 精品| se色婷婷视频| 怡春院久操| 五月丁香色| 婷婷五月天在线综合导航| 天天插综合在线| 欧美亚洲999| 青青草原99热| 国产成人高清| 91国产精品视频播放| 国产亚洲成人综合| 日韩狠狠色婷婷| 亚洲欧美999| 激情久久久久久| 六月婷婷五月丁香| 超碰在线人妻| 26uuu欧美| 丁香色婷婷| 99久久精品免费精品国产_国产精品久久久久久_国产在线|日韩_久久国产精品电影 | 五月天色综合| 久久区区一二三av| 开心五月丁香啪| 亚洲五月天色色| 91色色色视频| 99热久草| 粉嫩av蜜桃av蜜臀av| 久久黄A片| 五月天色五月天| 丁香五月婷婷视频| 亚洲成人在线观看网址| 颜射 精品性爱av| 看全色黄大色大片| 久久婷婷一级片| 日韩成人AV在线| 激情WWW| 97人人操在线| 五月天婷婷情色| 五月婷色丁香| 色色亚洲| 激情图片婷婷丁香五月| 99热99热不卡| 色www久视频| 六月丁香啪啪啪| 五月激情婷婷图片基地| 丁香五月天综合| 91热久| 日韩黄黄| 极品人妻VideOssS人妻| 欧美日朝成人| 色欲丁香| 狠狠丁香| 丁香六月激情四射| 色色五月天婷婷丁香| 超极99精品| 日韩砖区| 狠狠操综合| 色五月色图| 精品五月天| 久久小说网| 久鲁鲁色网| 99久久综合| 九伊人网| 99精品大片| 综合色、色综合| 五月色婷婷在线观看| 91色吧网| 日韩色色色色色| 亚洲人人操| 91丁香色五月| 亚洲无码99| 免看黄大片AA | 丁香九月综合| 人妻体体内射精一区二区 | 97伦乱| 六月天无码网址| 午夜少妇在线观看视频| 天天舔天天摸视频| 伊人9在线| 激情综合99| 色天使色婷婷| 婷婷六月综合在线| 日日操,夜夜撸| 97人妻碰碰中文无码久热丝袜| 亚洲无aV在线中文字幕| 精品色| 9er热在线精品视频| 免费观看的av| 婷婷五月图片小说视频| 激情六月丁香| 99综合97| 婷婷五月电影院| 日本久久人| 亚州第一黄网| 欧美性猛交 XXXX 乱大交| 五月天播播综合| 九九色欲网| 精品亚洲日韩99欧美片| 激情五月天久久| 亚洲第一黄网| 九九av在线| 激情五月婷婷伊人| 超碰免费电影| 99免费青青蜜臀| 婷婷瑟五月天久久综合| 91丨九色丨丰满人妖| www.99精品日操伊人乱碰在线| 色婷婷丁香五月在线| www.天天干| 色一情一乱一乱91Av| 99国产这里只有精品| 任你躁XXXXX麻豆精品| 第五婷婷伊人丁香| 日日撸夜夜操| 五月天激情影院| 五月婷婷之综合激情| 亚洲天堂碰碰婷婷| 五月婷婷天| 婷婷五月天国产传媒| 99操碰| 婷婷午夜天| 色色色五月天激情资源| 欧美私人家庭影院| 婷婷五月综合在线视频| 丁香社92视频| 日本激情91| 色五月婷婷自拍| 丁香 亚洲 久久| 人妻性操逼中文字幕 国产| 久久这里有精品| 亚洲小说欧美激情| 亚洲免费99| 色99久草在线| 日日操天天操| 91色逼| 丁香五月婷婷激情123| 4399在线日本A片| 久热精品免费视频4| 日本久久性| 婷婷五月成人色综合| 久久久人人操A V| 激情五月丁香五月| 丁香激情网| 婷婷五月天美女视频| av久热| 天天操天天插天天射| 五月丁香在线观看| 97人人操| 97色婷婷在线观看| 婷婷丁香激情五月天色色色| 国外亚洲成AV人片在线观看| AA丁香综合激情| 久碰视频| 双性美人被调教到喷水A片| 久久深爱激情网| 亚洲天堂久久| 色婷婷五月综合在线| 丁香五月婷婷欧美激情-中文天堂最新版在线观看| 五月丁香六月激情在线| 午夜婷婷久久 | 伊人网碰碰| 色原狠狠综合| 丁香五月婷婷操逼| 新激情综合| 日韩av网站在线观看| 久久久99精品免费观看| 婷婷五月超碰| 久久免费干| 久热99热| 色色com| 99丁香五月婷| 久久xxxx| 天天做天天爱| 岛国AAAV| 99色在线观看视频者| 爽tv | 又大又粗九一在线| 最新高清无码专区| 青青草99re| 国产色香蕉精品五夜婷| 五月天婷婷香蕉狠狠超碰综合| 色九九七七| 欧美天堂久久| 99热99网| 另类激情五月在线视频欧美| 婷婷婷婷婷婷婷婷| 日韩啪啪视频| 538在线精品| 久久亭亭电影| www.99色| 五月草视频| 久久婷婷六月综合综合色| 九热视频| AV九九| 激情亚洲五月| 超碰av天堂| 26UUU一区二区| 青青草蜜臀| 色婷婷九月| 久婷久婷| 五月花激情| www.91五月| 丁香五月综合久久| hd五月婷婷在线| 岛国av电影网站| 色色a| 人人草人人爱| 99ER热精品视频| 五月丁香久久婷| 五月婷五月婷伊人伊人五月婷| 五月婷婷啪啪网| 丁香花五月天激情| 六月婷基地| 呦呦v线| 色色综合激情| 69凹凸成人综合网| 99re在线精品视频| 97人人射| 奇米网大香蕉| 五月天激情无码| 少妇综合网| 99色精品| 91九色小视频| 六月丁香五月天| 欧美黄色一级录像| 婷婷丁香五月激情图片| 97干在线| 五月天激情黄色小说在线观看| 九九这里有精品| 天天射综合网站| 大香蕉丁香| 五月婷婷六月丁| 另类专区在线观看| 五月婷婷人人人操| 婷婷在线精品| 丁香婷婷精品视频| 久久综合九九| 欧美一级色| 日日操,天天操| 午夜丁香婷婷| 77799热| 欧美搡BBBBB摔BBBBB| 日本精品。999| 丁香六月婷婷久久综合| 99视频色在线观看| 日日色综合| 人操人| 婷婷五月天堂网| 婷婷五月天av| 亚洲狠狠操| 狠狠狠狠狠操| 久久久宗合视频88| 欧美日比视频| 成人永久免费视频在线观看| 五月天婷综合| 五月丁香影院| 国产99久| 免费精品99| 99啪在线| 久碰视频| 九九机热| 日本婷婷激情四射中文字幕在线观看| 日日夜夜天天爽| 我爱大香蕉| 欧美狠狠草| 色色色色综合网| VA国产在线综合网站| 99热老网站| 伊人婷婷青青cao| 亚洲精品无码一区二区| 夜夜夜叫天天天做| 九热视频精品| 婷婷久草| 5月丁香六月婷婷| 99热超| 亚州色婷婷| 婷婷AV丁香| 夜夜AVV| 色私五月婷婷| 天天日人人| 五月婷婷婷| 99性视频| 六月婷婷色色色| 五月花综合网| 久久免费干| 人妻久热| 99re视频精品| 久久大香蕉| www.久99| 99操视频| 99在线热| 深爱激情五月网| 婷丁香五月天| www.cao.com久久| 99色色热热| 综合色色五月| 97色干| 另类小说激情五月天| 99九九热视频| 9l视频自拍九色9l视频在线观看| 婷婷六月成人| 九九热九九| 99九色视频在线观看| 色婷五月| 另类小说婷婷色| 六月婷婷激情| 成人五月天丁香| 日日操夜夜操中国无码| 色99热| 激情五月天小说| 五月丁香另类图片| 天天激情视频| 狠狠干在线视频| 丁香久久AV| 丁香五月婷婷色偷偷| 亚洲乱码日产精品BD| 婷婷色综合| 精品人妻一区二区三区四区不卡在| 亚洲综合成人网| 在线中文亚洲| 99热在线极品极品| 色www.con| 就去色色五月丁香婷婷久久久| 精国产品一区二区三区A片| 国产精品久久久久久久久久| 欧美大肥婆大肥BBBBB| 亚洲操b| 欧美激情综合色综合啪啪五月| 国产精品VA在线| 天天色天天色天天色天天色天天色| 亚洲另类婷婷五月综合| 久久 视频这里只有精总| 五月婷婷色激情| 色99自拍| 五月激情婷婷丁香| 亚洲激情视频网| 丁香五月网在线观看| 五月丁香久久呀| 色色色热热热| 亚洲视频色婷婷| 婷婷99| 丁香五月天网站| 操操综合网婷婷| AV九九| 最新无毒无码AV| 婷婷五月激情四射手| 99久精品视频| 亚洲激情亚洲激情| 日韩在线婷婷五月天综合| 国産精品| 色日本网| 丁香五月综合在线视频| 久操热| 婷婷五月在线观看| 丁香六月婷婷开心| 久热免费视频| 国产在线激情视频| 综合激情深爱| 六月狠狠综合| 人人摸人人干| 色色图五月天| 五月精品免费XXX| 俺去也五月天婷婷| 9999久久久久| 九九综合九九| 99在线视频免费| 乱精品一区字幕二区| 狠狠色噜噜色狠狠狠综合色 | 六月丁香视频网站| 999九九九久久久99HD| 黄色片区子| 五月丁香在线综合| 噼里啪啦在线观看免费完整版视频 | 亚洲十月婷婷综合| 超碰免费人妻| 色99视频| WWW、99热| 婷婷六月色| 97色色网| 婷婷色在线视频| 天天热夜夜操| 欧美高潮9| 婷婷五月天国产精品| www.色五月| 热久久99热欧美国产亚洲| 极品另类| www久| 亚洲色网络| 色婷婷激情Av久久久| 五月天婷婷av| 丁香五月天狠狠| 国产精品一区在线观看你懂的| www。五月天激情| 99热| 五月天合网| pacopacomama 070722_670 素人奥様初撮りドキュメント 103 大久保純子 | 日韩爱操视频| 色图亚洲91| www激情网| 欧洲第一无人区观看| 五月婷婷在线网站| 日韩无码亚欧无码| 九九99热| 日本99视频| 五月天开心色情网| 亚洲成人免费在线| 久草热8精品视频在线观看| 色婷婷综合中心| 国产在线网址1| 狠狠色激情综合| 搡BBBB搡BBB搡18| 欧美日本一区二区三区| 99色综合久久| 日韩在线视频网站| 9久久久久久久久久久| 99久久网站| 九九色综合| 亚洲精品视频在线播放| 成人五月天在线视频在线观看 | 可以观看的AV| 久/久精品99看9| 色色色色综合网| 亭亭五月激情亚洲在线| 九九九AAA热视频| 岛国AV网| 色色色色欧洲| 中文字幕成人日韩| 人人干av| 最新热中文字幕| 五月天婷婷涩涩| 99综合| 精品五月丁香| 9 大屁股在线视频精品| 91操操| 中文字幕丰满乱孑伦无码专区| 99九九视频| 色狠狠狠干| 日本大人久久| 亚洲成人网在线观看| 天天做天天摸| 狠狠色丁香婷婷基地| 91九色小视频| 99热网站| 久久五月丁香| 日日夜夜久| 天天摸天天舔天天爽| 牛色色碰| 日本九九视频| 2025色婷婷| 人人爱干人人爱草| 99人人操人人操人人精| 丁香五月婷婷国产av| 无码人妻AV久久久一区二区三区 | 九九热视频免费的| 日韩啪啪视频| 色99自拍| 亚洲综合无码| 日本3级片一区2区| 十区AV| 国产人妻777人伦精品HD| 欧美人人超级碰| 97人人草| 成人AV在线电影| 亚洲国产成人在线| 婷婷五月天天aV| 五月婷婷免费| 国产一区男女| 六月丁香成人网| 婷婷五月深爱五月| 国产日韩欧美| 色婷婷色五月综合| 五月天激情中文字幕| 99精品视频在线免费观看| 综合色五月天| 亚洲精品亚洲人成人网| 热99国产精品| 九九热视频精品2| 久热黄色| 色五月激情网| 亚洲色9| 六月亚洲婷婷6月中文字幕| 色射影院| 婷婷六月网| 九九九精品视频免费观看| 狠狠色丁香五月婷巨| 色五月婷婷AV| 国产精品日日躁夜夜躁| 五月六月播婷婷| 婷婷色五月激情| 婷婷精品在线| 亚洲天堂热| 九九这里只有精品在线视频| 啪啪综合| 开心色播色五月婷婷| 久久性操| 嫩草AV久久伊人妇女超级A| 婷五月天影院| 玖玖婷婷五月天| 婷婷色播综合五月| 丁香五月婷婷大香蕉| 91色噜噜狠狠狠狠色综合| WWW,五月| 五月停停直播| 91色色色18| 激情开心五月亚洲| 五月丁香综合啪啪| 99热8在线| 九九热这里只有国产精品| 九九精品片一| 日韩在线9| www.天天干| 大香蕉太香蕉视频97| 操操操操操操婷婷五月天| 色狠狠色噜噜AV天堂五区消防| 狠狠五月天| 五月天堂婷婷| 婷婷色在线视频| 欧美成人网婷婷综合在线| 99在线精品免费视频| 九热精品| 丁香婷婷影院| caopeng97日韩| 久机视频这只有精品| 久久在线92| 丁香五月成人论坛| 99色在线视频| 久久欧洲久久| 久久婷婷色色| 五月天AV大香蕉| 玖玖福利视频资源| 国产这里只有精品| 偷拍91九色| 婷婷香五月| a久久| 月丁香久久久| 精品久久久人妻| 激情五月,深深爱五月| 少妇高潮A片无套内谢麻豆传| 色婷婷啪啪啪啪啪啪| 婷婷五月丁香91| 大香蕉五月天| 亚洲无码另类| 婷婷午夜精品久久久| 黄色精品五月婷婷| pacopacomama 070722_670 素人奥様初撮りドキュメント 103 大久保純子 | 亚艹艹| 99精品久久| 五月天社区婷婷丁香社区| 这里只有精品免费观看网占| 亚洲人操亚洲人| 日韩视频99| 久久激情五月网| 99爱视频在线播放| 亚洲色区17| 99久久综合| 中文字幕精品推荐免费在线观| www,99热| 欧美69色| 欧美成人色婷婷| 九九操操| 久久女伦| 婷婷丁香五月综合激情小说| 91精品刘玥| 99爱视频| 丁香六月天婷婷色| 激情久久网| 丁香五月欧美激情| 婷婷五月天亚洲天堂| 67194中文在线| 久久xx| 麻豆123区| 99久热视频在线| 婷婷五月香蕉| 国产热精品| 欧美六月| 99热色婷婷| 九月丁香久久网| 玖玖精品视频99| 色色热日| 婷婷午夜丁香| 狠狠色综合久久| 综合99视频| 亚洲欧洲中文日韩久久AV乱码| 99爱免费在线视频| 成人av在线网站| 91碰碰视频在线观看| 狠狠色97| 色五月婷婷视频| 亚洲成人AV在线观看| 免看黄大片AA | 97资源欧美日韩大香蕉超碰一区| 888精品福利地址| 五月丁香花成人社区| 99热精品在线播放| 日韩av网址大全| 亚洲综合视频天天精品| 九九超日本| 免费无码毛片一区二区A片| 日韩99视频| 婷婷五月天激情综合网| 俺去婷婷 丁香| 狠狠综合网| 五月丁香成人| 丁香婷婷色九月| 少妇人妻人伦A片| 五月丁香直播| 99久久99视频| 影音先锋91资源站| 香蕉大综综综合久久| 色五月激情五月| 五月婷婷啪啪| 99综合自拍| 五月丁香亭亭| 嫩草视频在线观看| 成人av在线网址| 99激情| www.成人婷婷综合| 五月丁香婷婷成人综合网| 亚洲精品色色| 日本一级特黄大片AAAAA级| 日本黄色在线观看| 成人电影一区| 特级西西4444www无码| 香蕉久久国产AV一区二区| 免费AV在线| 五月天综合| 99色在线视频| 91操片| 丁香婷婷激情| 激情五月丁香婷婷| 5月丁香婷婷激情网| 五月婷婷六月婷| 欧洲综合视频在线观看。欧洲,亚洲综合食品在线观看。 | 最近中文字幕大全免费版在线| 99热精品在线| AA片在线观看视频在线播放| 五月天开心色色网| 国产亚洲精品久久久久久郑州| 日本九九九九| 91高潮喷水久久久久久久久 | 久久亚洲婷婷综合色五月| 激情小说婷婷小说| 色。 日日日| 丁香五月人妻熟女| 色五婷婷| 亚洲AV成人无码电影| 五月丁香花激情综合网| aaaa.黄| 久久女伦| 婷婷激情五月天激情在线| 婷婷丁香综合成人| 99久久er| 激情五月综合婷婷| 激情丁香五月AV| 婷婷视频网| 黄色99网| 天天操天天操天天操天天操天天操| 99久久久99久久91熟女| 免费看片在线观看| 色播五月婷婷| 99亚洲色色| 亚洲色无码A片一区二区麻豆| 婷婷亚洲在线| 色综合爽| 婷婷六月丁香欧美视频在线| 国产成人精品一区二三区熟女在线| 中文字幕+中文在线| 五月婷婷干| 久热无码| 激情婷婷五月天丁香| 色欲操| 五月天桃色深爱网| 五月激情婷婷偷拍| 亚洲avjiujiur91| 九九99热| 九月婷婷人人操人人舔人人爱| 九九热这里有精品视频| 色六月婷婷| 五月激情综合婷婷| www,五月天激情| 直接看的AV| 亚洲乱码日产精品BD| 综合一区二区三区| 大香蕉久久婷婷精品综合| a免费在线| 天天日人人爽| 日韩免费视频| 这里只有精品69| 亚洲午夜在线视频| 激情五月激情综合网一级丸片| 五月丁香久久网| av色婷婷| 日良久久| AV色五月婷婷| 思思久久精品| 国产激情久久久| 99热这里只有精品青草| 操逼国产91| 激情五月婷婷色综合| 天天日中文| WWW.开心五月天.COM| 超碰97在线操| 开心婷婷中文字幕| 五月婷婷色啪| 五月婷婷之综合激情| 99精品高潮| 丁香五月天狠狠| 亚洲性爱电影| 久久婷婷激情| 1024手机在线观看看片_日韩精品| 婷婷五月,偷窥偷拍网| 91凹凸在线| 五月丁香六月色| 日本丁香五月婷婷| 97人人干人人操| 久草热在线视频| 日韩高清成人| 碰99在线| 超碰人人干| 热成人网| 九日日夜夜69| 久热只有精品| 五月丁香激情综合啪| 色色色1网址| 日韩无码成人电影| 丁香婷婷中文字幕| 人妻激情网| 久久这里只有精品99| 白天AV月月| 99玖玖视频| 久久精品国产一区二区三区四区| 99热日韩这里只有精品| 91呦呦呦| 思思re99视频在线观看| 成人中文字幕在线| 羞羞嫩草视频| 天天干天天干天天干| 五月开心深爱激情网| 五月丁香综合啪啪| av免费在线观看0| 成人无码精品1区2区3区免费看| 亚美欧色影院| 五月婷婷深深的爱| 91超碰在线观看| 五月天开心色色网| 欧美色色色色色色色| 日日操天天爽| 日本色色网站| 丁香五月社区| 亚洲色久| 色偷偷五月天| 99热久| 成人AV在线中文版| 婷婷五月视频| www.五月天婷婷姐姐| 成人丁香五月| 99热这里有精品首页10| 久久99精品久| 激情五月婷婷综合网| 91viP在线看| 亚洲另类av| 1024欧美看片| 热99热久| 色吊操色妞| 久久婷婷五月天大香蕉| 久久久五月天| 久久ri精品| 99精品成人无码A片观看金桔| www.久久爱.com| 亚洲色色色色| 久久五月天激情视频| 啪啪激情综合| 五月婷婷五月天| 五月天色色激情综合| 91丨九色丨东北熟女| 国产片天天爽夜夜爽| 色五月视频无码播放| 另类天堂| 成人国产欧美大片一区| 伊人在线视频| 亚洲成人在线观看av| 五月天婷婷网站| 久久免费9| 五月丁香六月婷婷,婷| 午夜理论片最新午夜理论剧| 久久久99免费视频| 色亚洲无码| 天天摸夜夜爽天天做| 色人妻五月| 久久多色| 国产成人精品一区二三区熟女在线| 超碰在线综合| 韩国97天堂| 婷婷综合在线网| 激情精品久久| 中文字幕丰满乱孑伦无码专区| 九九亚洲综合| 丁香五月 综合| 深爱激情网五月天| 超碰成人在线观看| 婷婷在线中文字幕| 大香蕉75线| 丁香五月性爱| 成人九九视频| 天天综合精品| 四季日韩AV无码综合| 丁香午月AV中文字幕| 久久人妻伊人| www色婷婷| 久久999久久999久久999久久| 色情综合网| 99精品久久久久| 亚洲妇女熟BBW| 9久热在线精品| 久久有码| 九九热av| 黄色av高清| 久久资源网五月婷| 丁香婷婷九月| 婷婷久久色| 国产精品-第3页-91JQ就要激情网91JQ5.JQJQ926.XYZ | 婷婷九月丁香| 在线视频九色97| 六月婷婷色五月| 色色五月天婷婷| 激情五月天婷婷色色色色色色色色色色色| 丁香婷婷偷拍| 久热这里只有| 97操视频| 视色综合| 噜噜狠狠| 亚洲综合99| 久碰久| wwwC0maV五月花| 99亚洲精品| 草综合网| 亚洲色综合| 亚洲六月色婷婷| 婷婷五月,偷窥偷拍网| 97涩婷婷| 婷婷亚洲色| 大地9中文在线观看免费高清| 在线中文字幕av| 99爱视频| 日韩综合天堂| 99色色视频| 一级精品999WWW| 久久精品人妻| 婷婷五月天AV在线| 91久操| 蜜臀A∨在线水帘洞| 五月综合激情网| 九热久| 五月色网| 色五月六月婷婷| 日韩av网站在线观看| 婷婷五月天激情文学| 六月婷婷天天操夜夜爽视频| 精品久久99| 丁香五月激情六月欧亚激情综合导航| 久久婷色| 亚洲综合网激情小说| 丁香五月婷婷图片综合| 亚洲啪啪网| 深夜男女福利刺激影院一区完整| 激情影院丁香五月| 久久狠色噜噜狠狠狠狠97| 99热这里是精品| 欧美视频在线观看噜噜| 婷婷丁香社区| 婷婷五月花| 99热这里有精品| 激情网五夜婷婷| 在线中文AV| 天天色丁香| 夜夜躁狠狠| www.99热在线| 丁香伍月婷电影全集| 婷婷99热| 高清无码一区二区三区四区| 99色这里| 五月花婷婷| 婷婷午夜| 亚洲男女激情| 26uuu欧美激情另类| 97人人干| 久久大香免费| 激情深爱五月天| 久久人妻伦理| 五月视频日本免费观看| 五月亭亭色| 中文成人在线| 中文字幕在线观看视频www| 五月草影视| www.婷婷五月天.com| 97在线干| 99在线精品免费视频| 97se视频在线| 免费视频99| 成人婷99最新| 亚洲区在线| 丁香六月综合激情| 成人做爰高潮A片免费视频| 日日杆天天| 日韩在线观看亚洲| 色域五月婷婷丁香| 六月丁香激情网| 亚洲色五月| 午夜激情婷婷| 久久精品系列| 激情人妻综合| 久久小视频| 欧洲日韩一区二区三区| 色五月婷婷综合在线| 影音先锋男人av资源站| 精品99*| 欧美性爱丁香五月| av免费在线看不卡无毒| 国产XXXX搡XXXXX搡麻豆| 免费国产视频| 99色热| 色五月天丁香婷婷| 丁香桃色网| 成人性爱无码| 5月婷婷6月六月丁香| 五月婷婷六月激情| av在线激情| 日本在线免费中文com.| 六月激情婷婷色| 九九sese| 婷婷射图五月天| 亚洲激情免费视频观看| 激情综合网色播五月| 91人人操.COM| 久久精品A片777777| 天天久久婷婷| 五月丁香成年黄色| 色玖玖导航| 色婷婷XXXXX| 婷婷欧美激情综合| 好吊丝aV| 婷婷五月天免费视频在线观看| 丁香六月久久| 天堂久久婷婷| 日本九九九九| 超碰在线看| 色婷婷精| 久久精品爱爱| 五月丁香婷婷AV| 婷婷五月花| 国产婷婷五月天| 69激情小说| 99热这里只有精品青草| 国外亚洲成AV人片在线观看| 亚洲传媒在线观看| 五月婷婷六月丁香综合| 99re热视频| 色婷婷综合影院| 少妇人妻人伦A片| 婷婷综合久久| 色情播放| 久久伊人五月天| 色色a| 久99在线| 久久久er热| 人妻久久人妻久久第一区| 天天爽天天| 9在线9在线婷婷在线国产| 五月天无码视屏播放| 日本色婷婷| 丁香网站| 丁香五月天无码| 97在线精品| 精品99视频| 九九九九九九九热| 国产精品美女久久久久AV超清| 99ri国产| 五月丁香久久综合| 黄色91在线观看| 天天摸人人摸| 亚洲男女激情| 综合在线观看99| 五月天俺去也| 亚洲无码 图片区| 欧美日韩大黄| 亲子乱AV一区二区三区下载| 五月天AV大香蕉| 亚洲第79页| 99久久综合狠狠综合久久| 天天日,夜夜爽| 99综合97| 婷婷五月天com| 九九视频在线观看视频6 | 67194中文字幕| 婷婷丁香97| 五月丁香猫咪久久婷婷综合视频激情四射网入口 | 高清国产AV| 五月婷婷六月丁香激情综合网| 日韩啪啪视频| 综合久| 日本久久精品| 五月丁香六月婷婷色| 玖玖婷婷五月天毛片| 另类综合色| 99情色五月天| 婷婷综合一二三| 9色免费网| 超碰在线精品| 亚洲欧洲色色| 丁香五月天堂网| 五月丁香色婷| 在线观看日韩12345区| 亚洲第一精品成人999久久精品| 日本97在线观看| 91超级碰碰| 久久精品视频99| 久久综合站| 五月天婷婷在线AN| 丁香五月停停av| 久久天堂加勒比| 亭亭色色五月天| 久久久区区一久久久久久| 亚洲操女| 色婷婷色99国产综合精品| 天天碰天天插天天操| 色九月国产| 色欲婷婷五月天| 久久五月天黄色五月天色网址| 久久33视频| 婷婷五月天视频| 99热这里只有精品16| 五月天伊人综合| 另类在线| 91九色精品女同系列| 九九成人精品免费视频| 日日夜夜天天| 色九九综合| 天天狠狠插| 欧美日朝成人| 最新久久99视频网站| 婷婷操逼| 丁香五月成人| www.狠狠操.com| 九九色热| 精品成人在线观看| 九九十99视频| 国产三级在线播放| 色色热| 激情婷婷五月| 激情五月综合亚洲另类| 五月深爱激情网| 色,激情五月天| 亚洲成人九九九| 超极99精品| 九月婷婷综合| 日本啪啪网| 丁香五月偷拍| 少妇人妻综合色6699| 激情婷婷五月天。| 成人网在线视频| 亚洲视频码| 99精品九九| 色综色网| 日韩AV在线电影| 99草视频在线观看| 婷婷五月天成人视频| 中文中文在线| www色色com| 天天干,天天日| 激情五月天在线免费美女视频| 99热这里只有精品中文字幕| 色播播之激情五月婷婷| 人妻videos人妻高清| 色五月涩涩婷婷蜜桃| 九九热只有这里精品| 天天爽爽日日做做| 4399在线观看免费毛片| 色天堂操| 九月婷婷在线观看| 91人无码久久久久久| 欧美日韩中文国产一区发布| 五月婷婷黄色网址| 四季AV综合网| 久久网址99热| 日韩免费99| 91久操| 日本超碰在线| 美女100%露全身无挡网站| 五月做爱| 开心五月婷婷激情| 《战争与艾拉》完整版| 天天操中文字幕| 99色激| 丁香五月婷婷动漫视频| 青草激情在线| 六月丁香婷| 六月色丁香婷婷| 丁香婷婷五月人体| 激情五月婷婷| 加勒比色色| 人人操人人爰人人一天天碰夜夜拍夜夜爽-中国A级毛片天天看天天谢… | 色五月色五天免费视频| 激情五月婷婷网| 亚洲传媒在线观看| 在线看av| 五月亭亭六月色| 九九视频这里只有精品| 思思热视频在线观看| 婷婷五月丁香五月基地| 国产午夜精品一区二区| 26uuu激情五月天| 婷婷四色五月| 九月丁香很很色| 超碰免费人人| 丁香五月开心五月激情| 五月婷婷视频在线观看| www.夜夜操| 91九色熟女| 天天干 夜夜爽| 亚洲六月色婷婷| 婷婷综合视频| 99综合| 五月丁香色色网| 亚洲成人在线在线| 91人人操人人爱| 丁香五月婷在线观看| 日日.c| 性高潮久久久久久-九九九九九九九九九九热-成人AV | 久久精品国产精品| 国产五月天婷婷| 色婷婷久久综合丁香五月| 欧美人与性动交CCOO| 色婷婷成人丁香| 91丨九色丨43老版熟女| 久久久久9| 婷婷五月天av| 小色小蛇伊人婷婷色香五月| 国产性爱一级| 99偷拍视频在线日本| 五月天天爱| 综合色色五月| 99热精品网| 久久久久人妻| 五月综合激情久久| 欧美丰满熟妇BBB久久久| 丁香五月日啪| 日本高清久| 97碰久久| 色噜噜狠狠色综合日日| 五月婷婷 六月丁香| 成人综合视频网址| 天天天天爽爽天干| 五月天另类小说久久小说网| 碰碰91| 色色婷婷五月天| 六月婷婷av| 五月婷婷综合在线| 99re在线这里只有精品视频首页| 久久久8| 天堂久久婷婷| 欧美在线97| 中文字幕在线不卡| 亚洲成av人影院| 欧美色性色好| 99热99网| 丁香深五月婷婷| 97影院一级片| 久久免费精品小视频|