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

ARTICLE DETAIL

資訊詳情

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

ROS2阿克曼底盤仿真:從運動學(xué)原理到Nav2導(dǎo)航集成實踐

ROS2阿克曼底盤仿真:從運動學(xué)原理到Nav2導(dǎo)航集成實踐 如果你正在學(xué)習(xí)ROS2機器人開發(fā)特別是想實現(xiàn)車輛的自主導(dǎo)航那么搭建一個逼真的仿真環(huán)境可能是你遇到的最大障礙之一。很多教程會教你如何讓一個簡單的差速輪機器人在Gazebo里移動但當(dāng)你真正想測試一個像小米SU7這樣的阿克曼轉(zhuǎn)向車輛時會發(fā)現(xiàn)從模型、控制到導(dǎo)航每一步都充滿“坑”。為什么阿克曼底盤仿真這么重要因為差速輪模型兩個驅(qū)動輪獨立控制轉(zhuǎn)速和汽車的真實運動模型前輪轉(zhuǎn)向后輪驅(qū)動有本質(zhì)區(qū)別。用差速輪模型跑通的導(dǎo)航算法如Nav2直接套用到阿克曼車輛上很可能會看到車輛在原地瘋狂打轉(zhuǎn)或者規(guī)劃出無法執(zhí)行的路徑。仿真環(huán)境與真實物理模型的脫節(jié)是導(dǎo)致算法“實驗室有效實車失效”的關(guān)鍵原因之一。本文要解決的正是這個痛點。我們將從零開始在ROS2 Humble和Gazebo中搭建一個高保真的小米SU7阿克曼底盤仿真模型并集成Nav2導(dǎo)航棧完成從建圖到路徑規(guī)劃的全流程測試。這不是一個簡單的“hello world”示例而是一個接近工程實踐的仿真項目。你會學(xué)到阿克曼運動學(xué)原理與ROS2控制接口ackermann_msgs如何對接。如何用URDF/Xacro和Gazebo插件定義一個帶轉(zhuǎn)向關(guān)節(jié)和驅(qū)動關(guān)節(jié)的真實車輛模型。如何編寫ROS2控制器將標(biāo)準(zhǔn)的cmd_velTwist消息轉(zhuǎn)換為阿克曼車輛能理解的轉(zhuǎn)向角與油門/剎車指令。如何配置Nav2使其適配阿克曼運動模型規(guī)劃出符合車輛轉(zhuǎn)彎半徑的路徑。如何利用仿真環(huán)境安全、高效地測試和調(diào)試你的導(dǎo)航算法。通過本文你將獲得一個可直接復(fù)用的、用于導(dǎo)航算法開發(fā)與測試的仿真平臺跳過從零摸索的漫長過程直擊核心。1. 為什么你需要一個阿克曼底盤仿真模型在機器人學(xué)和自動駕駛開發(fā)中仿真先行是黃金法則。但對于車輛形態(tài)的機器人很多人止步于差速輪模型。這會導(dǎo)致幾個嚴(yán)重問題算法驗證失真差速輪機器人可以原地旋轉(zhuǎn)in-place rotation但阿克曼車輛不行它有最小轉(zhuǎn)彎半徑。如果你的路徑規(guī)劃器不考慮這個約束規(guī)劃出的路徑車輛根本無法跟蹤。控制接口不匹配ROS中常見的geometry_msgs/Twist消息cmd_vel包含線速度和角速度這天然適合差速輪模型。阿克曼車輛需要的是轉(zhuǎn)向角Steering Angle和驅(qū)動速度。直接使用會導(dǎo)致控制邏輯錯誤。傳感器配置差異真實車輛的傳感器如激光雷達(dá)、相機安裝位置、視角和運動畸變與小型差速機器人完全不同。在差速模型上調(diào)試好的感知算法換到車輛上可能完全失效。因此一個高保真的阿克曼底盤仿真模型不僅僅是“讓小車看起來像汽車”它是連接算法仿真與實車應(yīng)用的橋梁。它能讓你在代碼部署到真車前就暴露出絕大多數(shù)與車輛動力學(xué)相關(guān)的邏輯錯誤和參數(shù)問題。我們將以熱門車型小米SU7為外觀參考重點是其尺寸和軸距參數(shù)構(gòu)建仿真模型。選擇它是因為其參數(shù)公開可查且作為轎車模型具有代表性。但核心方法適用于任何阿克曼車輛。2. 核心概念阿克曼轉(zhuǎn)向幾何與ROS2中的實現(xiàn)在深入代碼之前必須理解兩個核心概念。2.1 阿克曼轉(zhuǎn)向幾何原理阿克曼轉(zhuǎn)向設(shè)計的目的是讓車輛在轉(zhuǎn)彎時四個車輪都繞一個共同的圓心滾動減少輪胎磨損。其核心是內(nèi)側(cè)前輪的轉(zhuǎn)向角大于外側(cè)前輪。對于仿真我們通常做簡化處理即只考慮一個“前輪平均轉(zhuǎn)向角”來控制車輛朝向。車輛的運動學(xué)模型可以用“自行車模型”來近似后軸中心為參考點。前輪轉(zhuǎn)向角為δ。軸距前后輪距離為L。后輪速度為v。則車輛的轉(zhuǎn)彎半徑R和角速度ω滿足R L / tan(δ)ω v / R v * tan(δ) / L這意味著在ROS中你需要一個“轉(zhuǎn)換器”將導(dǎo)航系統(tǒng)發(fā)出的cmd_vel(包含v和ω)解算為車輛需要的轉(zhuǎn)向角δ和驅(qū)動速度指令。2.2 ROS2中的相關(guān)工具與消息ackermann_msgs這不是ROS2核心包但是一個廣泛使用的社區(qū)標(biāo)準(zhǔn)。它定義了專門用于阿克曼車輛的消息類型主要是AckermannDriveStamped其中包含steering_angle: 轉(zhuǎn)向角弧度speed: 期望速度米/秒acceleration等可選。gazebo_ros2_control這是連接ROS2控制框架與Gazebo物理仿真的橋梁。它允許你通過ROS2的controller_manager來管理仿真模型中的關(guān)節(jié)如轉(zhuǎn)向關(guān)節(jié)、驅(qū)動關(guān)節(jié)。robot_state_publisher與URDF/Xacro用于定義和發(fā)布車輛的3D模型、關(guān)節(jié)、傳動關(guān)系。Nav2ROS2的官方導(dǎo)航框架。我們需要配置其controller_server中的插件使其能處理阿克曼運動約束。3. 環(huán)境準(zhǔn)備ROS2、Gazebo與必要功能包我們基于ROS2 Humble和Ubuntu 22.04進(jìn)行演示這是目前最穩(wěn)定的LTS組合。3.1 基礎(chǔ)環(huán)境安裝# 1. 設(shè)置ROS2 Humble源 sudo apt update sudo apt install curl gnupg lsb-release sudo curl -sSL https://raw.githubusercontent.com/ros/rosdistro/master/ros.key -o /usr/share/keyrings/ros-archive-keyring.gpg echo deb [arch$(dpkg --print-architecture) signed-by/usr/share/keyrings/ros-archive-keyring.gpg] http://packages.ros.org/ros2/ubuntu $(source /etc/os-release echo $UBUNTU_CODENAME) main | sudo tee /etc/apt/sources.list.d/ros2.list /dev/null # 2. 安裝ROS2 Humble桌面版包含Gazebo sudo apt update sudo apt install ros-humble-desktop # 3. 安裝colcon構(gòu)建工具和必要編譯工具 sudo apt install python3-colcon-common-extensions python3-rosdep2 sudo rosdep init rosdep update # 4. 安裝Gazebo相關(guān)插件非常重要 sudo apt install ros-humble-gazebo-ros-pkgs ros-humble-gazebo-ros2-control3.2 創(chuàng)建工作空間與下載模型資源# 創(chuàng)建工作空間 mkdir -p ~/su7_ws/src cd ~/su7_ws/src # 克隆必要的功能包 # ackermann_msgs (如果官方源沒有可以從GitHub克隆) git clone https://github.com/ros-drivers/ackermann_msgs.git -b ros2 # 一個常用的阿克曼控制器示例包我們將以此為基礎(chǔ)修改 git clone https://github.com/ros-controls/ros2_controllers.git # 我們主要用其中的ackermann_steering_controller但需要適配。 # 克隆一個包含常見機器人模型的倉庫可選用于獲取一些紋理或模型 git clone https://github.com/ros-simulation/gazebo_models.git # 將其中的模型復(fù)制到 ~/.gazebo/models 以便Gazebo全局使用注意ros2_controllers中的阿克曼控制器可能不完全符合我們的需求我們后續(xù)會編寫自己的控制器。這里克隆是為了參考其實現(xiàn)。4. 構(gòu)建小米SU7的仿真模型URDF/Xacro這是最核心的一步。我們在~/su7_ws/src下創(chuàng)建一個新的功能包su7_description。cd ~/su7_ws/src ros2 pkg create --build-type ament_cmake su7_description cd su7_description mkdir -p urdf launch config meshes4.1 創(chuàng)建主URDF文件 (urdf/su7.urdf.xacro)我們使用Xacro宏來使URDF文件更模塊化、可配置。?xml version1.0? robot namesu7 xmlns:xacrohttp://www.ros.org/wiki/xacro !-- 定義常量小米SU7大致參數(shù)單位米 -- xacro:property namebody_length value4.997 / xacro:property namebody_width value1.963 / xacro:property namebody_height value0.456 / !-- 車身高度不含底盤 -- xacro:property namewheelbase value3.000 / !-- 軸距 -- xacro:property nametrack_width value1.660 / !-- 輪距 -- xacro:property namewheel_radius value0.35 / xacro:property namewheel_width value0.245 / xacro:property namesteering_limit value0.5236 / !-- 最大轉(zhuǎn)向角約30度 -- !-- 基礎(chǔ)連桿車體 -- link namebase_link visual geometry box size${body_length} ${body_width} ${body_height}/ /geometry material nameblue color rgba0.1 0.3 0.8 1.0/ /material /visual collision geometry box size${body_length} ${body_width} ${body_height}/ /geometry /collision inertial mass value2000/ !-- 整車質(zhì)量單位kg -- inertia ixx1000 ixy0 ixz0 iyy2000 iyz0 izz1000/ /inertial /link !-- 前輪轉(zhuǎn)向關(guān)節(jié)左 -- joint namefront_left_steering_joint typerevolute parent linkbase_link/ child linkfront_left_steering_link/ origin xyz${wheelbase/2} ${track_width/2} -${body_height/2} rpy0 0 0/ axis xyz0 0 1/ limit lower${-steering_limit} upper${steering_limit} effort1000 velocity1.0/ /joint link namefront_left_steering_link inertial mass value5/ inertia ixx0.1 ixy0 ixz0 iyy0.1 iyz0 izz0.1/ /inertial /link !-- 前輪驅(qū)動關(guān)節(jié)左 -- joint namefront_left_wheel_joint typecontinuous parent linkfront_left_steering_link/ child linkfront_left_wheel_link/ origin xyz0 0 0 rpy${pi/2} 0 0/ axis xyz0 0 1/ /joint link namefront_left_wheel_link visual geometry cylinder radius${wheel_radius} length${wheel_width}/ /geometry material nameblack color rgba0.1 0.1 0.1 1.0/ /material /visual collision geometry cylinder radius${wheel_radius} length${wheel_width}/ /geometry /collision inertial mass value20/ inertia ixx0.5 ixy0 ixz0 iyy0.5 iyz0 izz1.0/ /inertial /link !-- 同理定義 front_right_steering_joint, front_right_wheel_joint, rear_left_wheel_joint, rear_right_wheel_joint -- !-- 后輪沒有轉(zhuǎn)向關(guān)節(jié)直接連接在base_link上 -- !-- 具體定義略結(jié)構(gòu)類似注意origin的xyz坐標(biāo)變化 -- !-- Gazebo插件為整個機器人添加物理和ROS接口 -- gazebo referencebase_link materialGazebo/Blue/material /gazebo !-- ros2_control 系統(tǒng)定義 -- ros2_control namesu7_control typesystem hardware plugingazebo_ros2_control/GazeboSystem/plugin /hardware joint namefront_left_steering_joint command_interface nameposition/ !-- 轉(zhuǎn)向關(guān)節(jié)由位置控制器控制 -- state_interface nameposition/ state_interface namevelocity/ /joint joint namefront_right_steering_joint command_interface nameposition/ state_interface nameposition/ state_interface namevelocity/ /joint joint namefront_left_wheel_joint command_interface namevelocity/ !-- 驅(qū)動關(guān)節(jié)由速度控制器控制 -- state_interface nameposition/ state_interface namevelocity/ /joint !-- 同理定義其他三個輪子的關(guān)節(jié)接口 -- /ros2_control !-- Gazebo插件為每個輪子添加接觸摩擦等物理屬性 -- gazebo referencefront_left_wheel_link mu1 value1.0/ mu2 value1.0/ kp value1000000.0/ kd value1.0/ materialGazebo/Black/material /gazebo !-- 其他輪子類似 -- /robot關(guān)鍵點解析關(guān)節(jié)類型轉(zhuǎn)向關(guān)節(jié)(steering_joint)是revolute旋轉(zhuǎn)有角度限制驅(qū)動關(guān)節(jié)(wheel_joint)是continuous連續(xù)旋轉(zhuǎn)。ros2_control接口轉(zhuǎn)向關(guān)節(jié)暴露position命令接口控制角度驅(qū)動關(guān)節(jié)暴露velocity命令接口控制轉(zhuǎn)速。這是與控制器通信的橋梁。Gazebo物理屬性mu1,mu2定義摩擦系數(shù)kp,kd定義接觸剛度/阻尼對仿真真實性影響很大。4.2 創(chuàng)建啟動文件 (launch/display.launch.py)這個啟動文件用于在Rviz中顯示模型檢查URDF是否正確。# launch/display.launch.py import os from launch import LaunchDescription from launch.actions import DeclareLaunchArgument from launch.substitutions import LaunchConfiguration, PathJoinSubstitution from launch_ros.actions import Node from launch_ros.substitutions import FindPackageShare def generate_launch_description(): pkg_path FindPackageShare(su7_description) default_rviz_config PathJoinSubstitution([pkg_path, config, view_robot.rviz]) default_urdf_model PathJoinSubstitution([pkg_path, urdf, su7.urdf.xacro]) urdf_model DeclareLaunchArgument(nameurdf_model, default_valuedefault_urdf_model, descriptionAbsolute path to robot urdf file) rviz_config DeclareLaunchArgument(namerviz_config, default_valuedefault_rviz_config, descriptionAbsolute path to rviz config file) # 啟動 robot_state_publisher 節(jié)點 robot_state_publisher_node Node( packagerobot_state_publisher, executablerobot_state_publisher, namerobot_state_publisher, outputscreen, parameters[{robot_description: Command([xacro , LaunchConfiguration(urdf_model)])}] ) # 啟動 joint_state_publisher_gui 節(jié)點用于手動調(diào)節(jié)關(guān)節(jié) joint_state_publisher_gui_node Node( packagejoint_state_publisher_gui, executablejoint_state_publisher_gui, namejoint_state_publisher_gui ) # 啟動 rviz2 節(jié)點 rviz_node Node( packagerviz2, executablerviz2, namerviz2, outputscreen, arguments[-d, LaunchConfiguration(rviz_config)], ) return LaunchDescription([ urdf_model, rviz_config, robot_state_publisher_node, joint_state_publisher_gui_node, rviz_node, ])現(xiàn)在你可以編譯并運行來檢查模型cd ~/su7_ws colcon build --packages-select su7_description source install/setup.bash ros2 launch su7_description display.launch.py在打開的Rviz中添加RobotModel和TF顯示你應(yīng)該能看到一個藍(lán)色的盒狀車體和四個輪子。通過joint_state_publisher_gui的滑塊你可以手動調(diào)節(jié)前輪轉(zhuǎn)向角觀察轉(zhuǎn)向效果。5. 編寫阿克曼控制器模型有了下一步是讓它動起來。我們需要一個控制器訂閱標(biāo)準(zhǔn)的/cmd_vel話題并將其轉(zhuǎn)換為四個輪子的轉(zhuǎn)向角指令和驅(qū)動速度指令。在~/su7_ws/src下創(chuàng)建新功能包su7_control。cd ~/su7_ws/src ros2 pkg create --build-type ament_cmake su7_control --dependencies rclcpp geometry_msgs ackermann_msgs sensor_msgs control_msgs controller_interface5.1 核心控制器節(jié)點 (src/ackermann_controller.cpp)這個節(jié)點實現(xiàn)運動學(xué)解算。// src/ackermann_controller.cpp #include rclcpp/rclcpp.hpp #include geometry_msgs/msg/twist.hpp #include ackermann_msgs/msg/ackermann_drive_stamped.hpp #include sensor_msgs/msg/joint_state.hpp #include control_msgs/msg/joint_controller_state.hpp #include memory #include string #include cmath class AckermannController : public rclcpp::Node { public: AckermannController() : Node(ackermann_controller) { // 聲明參數(shù) this-declare_parameter(wheelbase, 3.0); // 軸距 L this-declare_parameter(track_width, 1.66); // 輪距 this-declare_parameter(steering_limit, 0.5236); // 最大轉(zhuǎn)向角 30度 this-declare_parameter(max_speed, 5.0); // 最大速度 m/s this-declare_parameter(max_steering_angle, 0.5236); // 最大轉(zhuǎn)向角 wheelbase_ this-get_parameter(wheelbase).as_double(); track_width_ this-get_parameter(track_width).as_double(); steering_limit_ this-get_parameter(steering_limit).as_double(); max_speed_ this-get_parameter(max_speed).as_double(); // 訂閱標(biāo)準(zhǔn)cmd_vel話題 cmd_vel_sub_ this-create_subscriptiongeometry_msgs::msg::Twist( /cmd_vel, 10, std::bind(AckermannController::cmdVelCallback, this, std::placeholders::_1)); // 發(fā)布阿克曼控制指令 (可以發(fā)布給Gazebo插件或底層控制器) ackermann_cmd_pub_ this-create_publisherackermann_msgs::msg::AckermannDriveStamped( /ackermann_cmd, 10); // 發(fā)布關(guān)節(jié)命令 (這里簡化實際應(yīng)通過controller_manager發(fā)布) // 本例中我們發(fā)布到 /joint_commands 供一個自定義的Gazebo插件監(jiān)聽 joint_cmd_pub_ this-create_publishersensor_msgs::msg::JointState( /joint_commands, 10); RCLCPP_INFO(this-get_logger(), Ackermann Controller started. Wheelbase: %f, wheelbase_); } private: void cmdVelCallback(const geometry_msgs::msg::Twist::SharedPtr msg) { double linear_x msg-linear.x; double angular_z msg-angular.z; // 1. 限幅 linear_x std::clamp(linear_x, -max_speed_, max_speed_); // 2. 計算轉(zhuǎn)向角 (基于自行車模型) double steering_angle 0.0; if (fabs(linear_x) 0.001) { // 避免除零 steering_angle atan2(angular_z * wheelbase_, linear_x); } steering_angle std::clamp(steering_angle, -steering_limit_, steering_limit_); // 3. 發(fā)布阿克曼消息 auto ackermann_msg ackermann_msgs::msg::AckermannDriveStamped(); ackermann_msg.header.stamp this-now(); ackermann_msg.header.frame_id base_link; ackermann_msg.drive.steering_angle steering_angle; ackermann_msg.drive.speed linear_x; ackermann_cmd_pub_-publish(ackermann_msg); // 4. 計算并發(fā)布關(guān)節(jié)命令 (簡化前后輪同速前輪同轉(zhuǎn)向角) // 實際阿克曼幾何需要計算內(nèi)外輪轉(zhuǎn)角差此處簡化處理。 auto joint_msg sensor_msgs::msg::JointState(); joint_msg.header.stamp this-now(); joint_msg.name { front_left_steering_joint, front_right_steering_joint, front_left_wheel_joint, front_right_wheel_joint, rear_left_wheel_joint, rear_right_wheel_joint }; // 轉(zhuǎn)向關(guān)節(jié)位置指令 joint_msg.position {steering_angle, steering_angle, 0.0, 0.0, 0.0, 0.0}; // 驅(qū)動關(guān)節(jié)速度指令 (轉(zhuǎn)速 線速度 / 輪半徑) double wheel_speed linear_x / wheel_radius_; joint_msg.velocity {0.0, 0.0, wheel_speed, wheel_speed, wheel_speed, wheel_speed}; joint_cmd_pub_-publish(joint_msg); } rclcpp::Subscriptiongeometry_msgs::msg::Twist::SharedPtr cmd_vel_sub_; rclcpp::Publisherackermann_msgs::msg::AckermannDriveStamped::SharedPtr ackermann_cmd_pub_; rclcpp::Publishersensor_msgs::msg::JointState::SharedPtr joint_cmd_pub_; double wheelbase_; double track_width_; double steering_limit_; double max_speed_; const double wheel_radius_ 0.35; // 與URDF一致 }; int main(int argc, char** argv) { rclcpp::init(argc, argv); auto node std::make_sharedAckermannController(); rclcpp::spin(node); rclcpp::shutdown(); return 0; }5.2 創(chuàng)建Gazebo插件監(jiān)聽關(guān)節(jié)命令為了讓Gazebo中的模型響應(yīng)我們發(fā)布的/joint_commands我們需要一個簡單的Gazebo ROS插件或者使用gazebo_ros2_control。這里我們采用更直接的方式在URDF中配置gazebo_ros2_control并編寫一個YAML配置文件來加載標(biāo)準(zhǔn)的位置和速度控制器。創(chuàng)建控制器配置文件 (config/su7_controllers.yaml)# config/su7_controllers.yaml controller_manager: ros__parameters: update_rate: 100 # Hz # 聲明我們要使用的控制器 joint_state_broadcaster: type: joint_state_broadcaster/JointStateBroadcaster front_steering_position_controller: type: position_controllers/JointGroupPositionController joints: - front_left_steering_joint - front_right_steering_joint wheel_velocity_controller: type: velocity_controllers/JointGroupVelocityController joints: - front_left_wheel_joint - front_right_wheel_joint - rear_left_wheel_joint - rear_right_wheel_joint然后我們需要另一個節(jié)點或啟動文件來將ackermann_controller計算出的關(guān)節(jié)命令發(fā)送給controller_manager管理的控制器。這可以通過ros2 control的命令接口或編寫一個簡單的轉(zhuǎn)發(fā)節(jié)點實現(xiàn)。為了簡化我們可以在上面的ackermann_controller中直接調(diào)用controller_manager的service來設(shè)置目標(biāo)值但更常見的做法是讓ackermann_controller發(fā)布到/forward_position_controller/commands這類話題??紤]到篇幅和復(fù)雜性一個更工程化的做法是使用ros2_controllers中已有的ackermann_steering_controller并為其配置參數(shù)。但這需要仔細(xì)調(diào)整。對于初次實踐我們可以先用一個簡化方案在Gazebo啟動文件中直接使用libgazebo_ros_diff_drive.so插件經(jīng)過參數(shù)配置可模擬阿克曼行為或者libgazebo_ros_ackermann_drive.so如果找到或自己實現(xiàn)。6. 在Gazebo中啟動仿真世界并測試運動我們創(chuàng)建一個啟動文件將模型加載到Gazebo中并啟動我們的控制器。6.1 創(chuàng)建Gazebo世界啟動文件 (launch/su7_gazebo.launch.py)# launch/su7_gazebo.launch.py import os from launch import LaunchDescription from launch.actions import DeclareLaunchArgument, ExecuteProcess, IncludeLaunchDescription from launch.substitutions import LaunchConfiguration, PathJoinSubstitution, Command from launch_ros.actions import Node from launch_ros.substitutions import FindPackageShare from launch.launch_description_sources import PythonLaunchDescriptionSource def generate_launch_description(): pkg_path FindPackageShare(su7_description) default_urdf_model PathJoinSubstitution([pkg_path, urdf, su7.urdf.xacro]) default_world_file PathJoinSubstitution([pkg_path, worlds, empty.world]) urdf_model DeclareLaunchArgument(nameurdf_model, default_valuedefault_urdf_model) world_file DeclareLaunchArgument(nameworld, default_valuedefault_world_file) use_sim_time DeclareLaunchArgument(nameuse_sim_time, default_valuetrue) # 啟動Gazebo服務(wù)器和客戶端 start_gazebo ExecuteProcess( cmd[gazebo, --verbose, -s, libgazebo_ros_init.so, -s, libgazebo_ros_factory.so, LaunchConfiguration(world)], outputscreen ) # 將URDF模型生成并Spawn到Gazebo中 spawn_entity Node( packagegazebo_ros, executablespawn_entity.py, arguments[-entity, su7, -topic, robot_description], outputscreen ) # 啟動robot_state_publisher robot_state_publisher Node( packagerobot_state_publisher, executablerobot_state_publisher, namerobot_state_publisher, outputscreen, parameters[{robot_description: Command([xacro , LaunchConfiguration(urdf_model)])}] ) # 啟動我們編寫的阿克曼控制器節(jié)點 ackermann_controller Node( packagesu7_control, executableackermann_controller, nameackermann_controller, outputscreen ) # 啟動一個節(jié)點發(fā)布測試用的cmd_vel (可選用于手動測試) test_cmd_vel Node( packagesu7_control, executabletest_cmd_vel_publisher, # 需要另外編寫一個簡單的測試發(fā)布節(jié)點 nametest_cmd_vel_publisher, outputscreen ) return LaunchDescription([ urdf_model, world_file, use_sim_time, start_gazebo, robot_state_publisher, spawn_entity, ackermann_controller, # test_cmd_vel, # 測試時打開 ])6.2 編寫測試速度發(fā)布節(jié)點 (src/test_cmd_vel_publisher.cpp)// src/test_cmd_vel_publisher.cpp #include rclcpp/rclcpp.hpp #include geometry_msgs/msg/twist.hpp #include chrono using namespace std::chrono_literals; class TestCmdVelPublisher : public rclcpp::Node { public: TestCmdVelPublisher() : Node(test_cmd_vel_publisher) { publisher_ this-create_publishergeometry_msgs::msg::Twist(/cmd_vel, 10); timer_ this-create_wall_timer(100ms, std::bind(TestCmdVelPublisher::timer_callback, this)); RCLCPP_INFO(this-get_logger(), Test cmd_vel publisher started.); } private: void timer_callback() { auto message geometry_msgs::msg::Twist(); // 發(fā)布一個恒定的速度例如直線前進(jìn) message.linear.x 1.0; // 1 m/s message.angular.z 0.2; // 緩慢左轉(zhuǎn) publisher_-publish(message); } rclcpp::TimerBase::SharedPtr timer_; rclcpp::Publishergeometry_msgs::msg::Twist::SharedPtr publisher_; }; int main(int argc, char * argv[]) { rclcpp::init(argc, argv); rclcpp::spin(std::make_sharedTestCmdVelPublisher()); rclcpp::shutdown(); return 0; }記得在CMakeLists.txt和package.xml中添加相應(yīng)的依賴和可執(zhí)行文件配置。6.3 編譯與運行測試cd ~/su7_ws colcon build --packages-select su7_description su7_control source install/setup.bash # 啟動Gazebo仿真 ros2 launch su7_description su7_gazebo.launch.py # 在另一個終端啟動測試速度發(fā)布 ros2 run su7_control test_cmd_vel_publisher如果一切順利你應(yīng)該能在Gazebo中看到小米SU7模型開始以1m/s的速度前進(jìn)并緩慢左轉(zhuǎn)。你可以通過rqt_graph查看節(jié)點間的話題連接并通過ros2 topic echo /ackermann_cmd查看解算出的阿克曼指令。7. 集成Nav2進(jìn)行導(dǎo)航測試這是最后一步也是驗證仿真模型實用性的關(guān)鍵。我們需要配置Nav2使其適配阿克曼模型。7.1 安裝Nav2sudo apt install ros-humble-navigation2 ros-humble-nav2-bringup7.2 創(chuàng)建Nav2配置文件在su7_description包下創(chuàng)建config/nav2目錄并放置以下關(guān)鍵配置文件su7_nav2_params.yaml: 主要的Nav2參數(shù)文件。su7_amcl_params.yaml: AMCL定位參數(shù)。map.yaml: 一張預(yù)先錄制或構(gòu)建好的地圖文件需要先有地圖。這里重點修改su7_nav2_params.yaml中與控制相關(guān)的部分# config/nav2_params.yaml (部分關(guān)鍵參數(shù)) controller_server: ros__parameters: controller_frequency: 20.0 min_x_velocity_threshold: 0.001 min_y_velocity_threshold: 0.001 min_theta_velocity_threshold: 0.001 progress_checker_plugin: progress_checker goal_checker_plugin: goal_checker controller_plugins: [FollowPath] # 使用默認(rèn)的路徑跟隨控制器 FollowPath: plugin: dwb_core::DWBLocalPlanner # 使用DWB局部規(guī)劃器它支持自定義運動模型 # 關(guān)鍵指定阿克曼運動模型 # 你需要安裝或編寫一個阿克曼運動模型插件例如 ackermann_kinematics # 這里假設(shè)插件名為 AckermannKinematics kinematic_plugin: ackermann_kinematics/AckermannKinematics # 阿克曼模型參數(shù) ackermann_kinematics: wheelbase: 3.0 min_turning_radius: 1.0 # 最小轉(zhuǎn)彎半徑根據(jù)最大轉(zhuǎn)向角計算 max_steer_angle: 0.5236 # DWB其他參數(shù)速度限制等 max_vel_x: 2.0 min_vel_x: -0.5 max_vel_theta: 0.5 min_vel_theta: -0.5 acc_lim_x: 1.0 acc_lim_theta: 0.5重要Nav2默認(rèn)不包含阿克曼運動學(xué)插件。你需要自己實現(xiàn)或?qū)ふ疑鐓^(qū)插件如nav2_ackermann_kinematics。這是一個進(jìn)階任務(wù)。對于初步測試你可以暫時使用DiffDrive運動模型但將min_radius設(shè)為一個較大的值來模擬阿克曼的轉(zhuǎn)彎約束但這并不精確。7.3 啟動Nav2進(jìn)行測試創(chuàng)建一個啟動文件launch/nav2_bringup.launch.py加載上述配置并啟動Nav2的所有節(jié)點包括AMCL、地圖服務(wù)器、生命周期管理器等。然后通過Rviz2的Nav2 Goal工具點擊目標(biāo)點觀察車輛是否能規(guī)劃出合理的路徑并跟蹤。由于運動模型不匹配你可能會看到路徑可行但跟蹤不佳的情況。這正體現(xiàn)了使用正確運動模型的重要性。8. 常見問題與排查思路問題現(xiàn)象可能原因排查方式解決方案Gazebo中模型加載后掉入虛空模型碰撞體設(shè)置不當(dāng)或重力方向錯誤。檢查URDF中collision幾何體是否與visual匹配檢查inertial質(zhì)量屬性是否合理。確保碰撞體尺寸正確質(zhì)量不為零慣性矩陣合理。在Gazebo中暫停仿真檢查模型姿態(tài)。車輛在Gazebo中不受控制地滑動或翻滾輪子摩擦系數(shù)設(shè)置過小或關(guān)節(jié)約束錯誤。檢查Gazebo插件中mu1,mu2的值建議0.8-1.2。檢查轉(zhuǎn)向關(guān)節(jié)的limit是否生效。增加輪子的摩擦系數(shù)。確保關(guān)節(jié)類型和限制正確。/cmd_vel已發(fā)布但車輛不動控制器節(jié)點未運行或話題名稱不匹配或關(guān)節(jié)命令未發(fā)送到Gazebo。1.ros2 node list查看節(jié)點。2.ros2 topic list和ros2 topic echo /joint_commands查看話題和數(shù)據(jù)。3. 檢查Gazebo中關(guān)節(jié)是否被正確控制查看關(guān)節(jié)狀態(tài)。確??刂破鞴?jié)點已啟動并訂閱了正確的/cmd_vel話題。檢查gazebo_ros2_control配置和控制器加載是否正確。車輛轉(zhuǎn)彎時打滑嚴(yán)重不像汽車使用了差速運動學(xué)模型或轉(zhuǎn)向角計算錯誤。檢查ackermann_controller中的運動學(xué)解算公式。用ros2 topic echo /ackermann_cmd查看計算出的轉(zhuǎn)向角是否合理。確保運動學(xué)模型正確。在低速下測試檢查內(nèi)外輪轉(zhuǎn)角差如果實現(xiàn)了精確阿克曼幾何。Nav2規(guī)劃出的路徑車輛無法執(zhí)行Nav2的局部規(guī)劃器未使用阿克曼運動模型。檢查controller_server的kinematic_plugin參數(shù)。查看DWB規(guī)劃器輸出的速度指令(/cmd_vel)是否包含不合理的角速度。實現(xiàn)或集成一個AckermannKinematics插件到Nav2中。或者調(diào)整DWB參數(shù)嚴(yán)格限制最小轉(zhuǎn)彎半徑。Rviz中模型顯示異常零件分離TF樹錯誤或robot_state_publisher未正確發(fā)布變換。運行ros2 run tf2_tools view_frames生成TF樹圖檢查連接關(guān)系。檢查URDF中關(guān)節(jié)的parent和child鏈接定義是否正確。確保robot_state_publisher節(jié)點在運行。9. 最佳實踐與工程建議分步驗證不要試圖一次性完成所有集成。先讓模型在Rviz中顯示正確再在Gazebo中測試物理和基本運動最后才集成Nav2。參數(shù)化配置將車輛尺寸、輪距、軸距、最大速度、最大轉(zhuǎn)向角等參數(shù)放在URDF的Xacro變量或ROS2參數(shù)文件中便于修改和適配不同車型。使用標(biāo)準(zhǔn)接口盡量使用ackermann_msgs作為控制器間的接口這有利于與其他遵循該標(biāo)準(zhǔn)的模塊如自動駕駛棧集成。實現(xiàn)精確阿克曼幾何本文為簡化使用了相同的前輪轉(zhuǎn)角。對于更高保真度的仿真應(yīng)計算內(nèi)外輪轉(zhuǎn)角差根據(jù)轉(zhuǎn)彎半徑和輪距。這需要在控制器中增加計算。考慮動力學(xué)目前的模型是純運動學(xué)的。對于測試需要動力學(xué)響應(yīng)的算法如緊急制動、ESP需要在Gazebo中為車輛添加更復(fù)雜的動力學(xué)模型或使用專門的車輛動力學(xué)仿真軟件如CARLA、CarSim等與ROS2橋接。傳感器仿真為了完整的導(dǎo)航測試需要在模型上添加激光雷達(dá)、相機、IMU等傳感器的Gazebo插件并發(fā)布相應(yīng)的ROS2話題。版本管理將整個仿真項目URDF、啟動文件、配置、控制器代碼放入Git倉庫進(jìn)行版本管理。搭建一個高保真的阿克曼底盤仿真模型是進(jìn)行車輛自動駕駛算法研發(fā)不可或缺的一環(huán)。本文提供了一個從URDF建模、運動學(xué)解算、Gazebo集成到Nav2適配的完整實踐路徑。雖然其中涉及不少細(xì)節(jié)和潛在問題但一旦跑通你將擁有一個強大、可重復(fù)、低成本的算法測試平臺。真正的挑戰(zhàn)往往在于細(xì)節(jié)關(guān)節(jié)定義的細(xì)微錯誤、物理參數(shù)的微妙調(diào)整、Nav2插件的兼容性。建議你以本文為藍(lán)圖在遇到問題時多查閱gazebo_ros2_control、ros2_controllers和Nav2的官方文檔及社區(qū)資源。這個仿真環(huán)境本身也將成為你深入學(xué)習(xí)ROS2機器人中間件的一個絕佳項目。
返回列表
PREV
查看更多資訊
NEXT
返回資訊列表
99热99思午夜精品| 丁香五月婷婷五月天| 丁香五月六月久久综合| 人妻激情综合| 天堂在线伊久| 天堂无码人妻精品AV一区| 九九亚洲综合| 六月婷婷激情| 五月婷婷片| 婷婷区日本| 婷婷99视频精品| 六月色 亚洲| 国产精产国品一二三在观看| 天天操综合网| 婷婷99狠狠| 婷婷性爱五月天| 色婷婷成人影片| 九月婷婷久久久| 激情丁香五月AV| 婷婷在线中文字幕| 色欲一区二区三区精品A片| 久久久久久久久久8888| 激情综合色图| av在线免费网站| 天天摸色吧天天摸色吧| 婷婷六月色播| 五月天激情小说婷婷基地| 超碰三级秋霞| 久久久这里都是精品| 爆乳熟女一区二区三区爆乳| 午夜成人在线免费视频| 五月婷婷9| 日韩人妻AV在线| 日日夜夜天天| 涩五月婷婷| 婷婷六月久久综合导航| 婷婷色五月天在线| 亚洲综合在线视频| 久久9视频欧美| 野战毛片三一3| 丁香婷婷伊人| 日本欧美国产| 天天日天天日天天搞| 99热在线中文字幕| 色五月婷婷激情五月| 一区二区三区四区五区| 五月激情精品视频| 六月婷伊人| 婷婷色女| 五月色丁香综合| 九九五月天| 午夜九九九九九九九九九九九九九| 九九热99精品| 久久天堂婷婷五月| 九伊人网| 欧美日韩国产一区| 久久精品五月天| 天天操天天曰天天射| 激情五月天色色色| 丁香五月天天| 99玖玖在线视频| 色婷九九九| WWW久久99久久99久久| 激情五月丁香五月色| 成人精品视频99在线观看免费| 97精品综合| 亚洲精品亚洲人成人网| 99免费在线视频| 婷婷五月天av| 丁香六月婷婷久久综合| 国产婷婷色综合AV蜜臀AV | 五月丁香六月激情综合| 4399在线日本A片| 99噜噜| 五月婷婷六月激情| 久久在这里99| 26uuu亚洲| 成人看片网站| 欧美在线干| 婷婷丁香六月| 国产看真人毛片爱做A片| 中字幕视频在线永久在线观看免费| 操操啪| 婷婷五月天激情网| 欧美成人猛片AAAAAAA| 国产精品18久久久| 婷婷五月激情在线| 青青日韩| AV在线大香蕉| 99re最新地址视频| www.夜夜夜| 五月婷婷和六月| 中文aV网| 色欲AV导航| 激情五月婷婷色| 99色色色色| 国产婷婷五月色情综合| 超碰不卡在线| 五月婷av| 日产精品久久久久久久蜜臀 | 亚洲欧洲一二| 国产激情在线| 日日骑夜夜撸| 91视屏在线观看com.wwwvv| 色色色色色色97| 久久精品视频9| www,av好吊操| 久婷久婷| 色情五月综合婷婷| 婷婷五月天性色| 1024操逼| 九九色天堂| 182TV亚洲| 欧洲不卡视频| 色综合色综合色综合高潮| 欧美亚洲婷婷五月| 五月天播播| av色婷婷| 五月激情小说| 五月丁香色色色| 五月丁了香蕉综合| 色区久久| 天天干天天 亚洲| 婷婷中文字暮| 色婷婷天堂| 碰碰91| 婷婷欧美| www,99热在线观看| 五月天婷婷色色网| 激情 五月 婷婷 丁香| 婷婷色色综合激情| 色情五月停停丁香| 日本欧美在线| 国产午夜精品AV一区二区麻豆| 97碰碰叉| 色婷婷www| 久久五月视频| 久久色这里只有精品| 狠狠爱五月婷婷| 国产精品大香蕉| 亚洲爆乳无码精品AAA片蜜桃| 大香伊人久色| 人妻久热| 亚洲五月丁| 99成人免费热视频| 色婷婷亚洲婷婷| 疯狂做受XXXX高潮A片| 丁香色色五月| 国产成人AV在线| 人人舔人人色人人高潮| 色婷婷亚洲精品天天综| 五月丁香婷婷色色| 黄桃AV无码免费一区二区三区| 色yeye欧美| 亚洲欧洲国产精品| 激情 婷婷 插| 人人综合五月人人婷婷| 噜噜狠狠色综无码久久合欧美| 久久99精品九九久久久婷婷| 成人综合视频网址| 国产精品操| 婷婷基地成人五月天| 新激情五月天色播| 激情九月婷婷| 黃色三级三级三级三级 qixing300.shrkbk.com www.jinbozs.com tianmiaosw.com | 99热亚州综合| 深爱五月月天| 丁香五月婷婷激情蜜桃| 色色色com| 99热亚洲只有色| 亚洲乱码日产精品BD| 1囯产午夜仑鲁鲁| 51XX午夜影福利| 婷婷伊人激情婷婷| 婷婷久久精品| 欧美精品在线观看| 玖玖在线视| 五月天婷婷久色| 射久久丁香五月| 婷婷丁香六月| 丁香五月先锋| 襙逼网| 9热在线观看| 丁香五月激情五月| 日韩精品超碰在线观看| 丁香五月综合在线| 日本精品99网站| 精品国产乱码久久久久久免费| 视频1区2区| 亚洲第一色色色| 亚洲国产99| 天天日天天插| 久久图色4| site:jszngf.com| 国产26uuu| 涩综合婷婷| 精品视频网| 婷婷激情四射| 五月在线| 久热一区| 91超级碰碰| 色婷五月天综合网| 九九在线精品| 玖玖99免费视频| 五月婷婷免费| 日韩亚洲视频| 怡红院成人AV| 伊人干练久| 九九这里是免费的视频5| 精品久久久91久久影视网| 男人的天堂五月丁香| 中文aV网| 久久久久这里只有精品| 九月婷婷综合网| 米奇激情婷婷| 五月婷婷,六月丁香| 日本玖玖在线| 五月伊人视频在线看| 欧美日韩成人一区二区| 91丨九色丨国产| 婷婷五月丁香av网站| 日日天天干| 粉嫩AV久久一区二区三区| 婷婷成人AV| 五月婷婷六月奇米网丁香| 色色婷婷丁香| 丁香六月婷婷开心婷婷网| 天天干天天日日| 五月色婷婷影院| 色婷婷综合久久| 九九性视频| 五月天网站免费欧美| www.婷婷六月天| 小色小蛇伊人婷婷色香五月| WWW,婷婷,COM| 国内一级片| 久99| 色婷婷激情四射视频| 韩国中文字幕91| 成片免费观看视频大全| 五月天激情婷婷| 日韩AV在线影片| 五月丁香婷婷爱激情综合网| 97视频.干com| 中文网婷婷字幕婷| 五月婷网站| 丁香五月天啪啪| 色综合久久中文| 色婷婷AV久久久久久久| www免费在线视频| 久久99这里只有精品| 影音先锋天天日| 亚洲xx在线| 思思热久在线观看视频| 亚洲热久久| 欧美性爱日韩性爱| 啪到高潮激情丁香五月| 伊人丁香五月天丁香在线婷| 99热精品10| 殴美激情综合网| 成人精品网站在线观看| 五月丁香伊人网| 亚洲色网址| 99re久热只有精品6在线直播.com| 五月天婷婷婷| av婷婷丁香| 天天干-天天日| 99热这里全都是精品| 天天操中文字幕| 狠狠草狠狠草| 日韩av高清| xxx综合在线| 色99视频| 97碰碰人人| 九九热在线视频| 激情五月婷婷色色| 五月亭亭六月天| 操97在线观看| 99只有这里是精品| 亚洲精品V天堂中文字幕| 婷婷6月综合网| 性一交一乱一交A片久久四色| 97碰在线免费观看| 天天做天天爱天天综合| 99碰碰碰| 久久机热这里只有 | 丁香婷婷色| 9色婷婷| 99热 在线观看| 狠狠搞狠狠操| 99色这里| 久久天天| 99热只有精品在线播放| 天天狠狠夜夜狠狠2023| 综合亚洲六月婷婷在线| 天天操婷婷| 91日本在线| 五月婷婷与六月丁香图片激情| 狠狠色婷婷7777久综合| 噜噜国产| 九热电影av| 久久机热/这里只有精品| 不卡成人免费| 色五月婷婷色五月| 99在线综合视频| 婷婷五月天在线综合| 99国产99| 天堂草在线看www| 碰人人97| 色综合色色色| 97日本在线| 五月婷婷香| 99在线综合视频| 色综合激情| 爱狠射| 99热这里只有精品22| 婷婷丁香色女人| 亚洲丁香五月| 久久久五月天婷婷成人网| 亚洲色无码| 大香蕉视频婷| 五月婷婷av| 涩 五月 婷婷 狠狠| 欧州色色| 骚五月婷婷| 色情久久久| 九九AV在线| 久久婷五月婷| 开心婷婷五月天综合| 五月丁香六月婷婷网| 久久五月天婷婷| 九热视频| 伊人成人宗合网| AA片在线观看视频在线播放| 五月WWW| 一级黄色片看看| 99re热视频这里只精品| 丁乡久久| 五月天激情亚洲| 亚洲区,视频区,视频区免费| 天天综合精品| 久久五月婷天天干| 色婷婷综合在线| 五月婷婷综合网| 91碰碰视频| 九九色婷婷| wWwCom夜操wwW| 日日操天天操| 国色天香伊人狠狠色| 97婷婷丁香五月综合| 五月天婷婷综合免费| 国产激情在线观看| 婷婷亚洲综合| 美女婷婷六月色| 欧美怡红院黄站| 这里只有精品免费观看网占| 婷婷的色色五月天| 日本久久综合| 影音先锋女人av鲁色资源网小说免费| 91无码色色| 天天综合天综合| 九九综合图片网| 亚洲碰碰碰| 丁香五月在线自慰| 五月婷在线| 另类小说五月天激情| 婷婷在线日韩综合| 五月激情小说| 六月丁香花婷婷| 欧美大片免费观看| 天天爽,夜夜爽| 狼人婷婷久久| 婷婷六月色| 色了色综合| 伊人久久综合| 五月天婷婷激情小说电影| 蜜乳.comcom| 97人妻碰碰中文无码久热丝袜| 久久久久久综合88| 99国产精品久久久久久久久久久| 丁香五月停停av| 激情久久 婷婷| 婷婷五月av| 最新激情五月天| 久久99人人| 99re这里只有| 激情丁香婷婷六月天| www.色五月| 欧美激情综合色综合色| 成人电影AV在线观看| 久久婷婷色| 天天综合亚洲综合| 综合色影| 欧美交换配乱吟粗大25P| 天天操综合网站| 久碰婷婷视频| 五月天婷婷激情| 丁香久久久| 免费国产视频| 欧美肉大捧一进一出免费视频| 国产精品热搜丁香五月婷婷| 丁香蜜臀黄色婷婷五月天| 中文字幕网伦射乱中文| 人人干人人操人人摸| 五月停停999| 99这里有精品视频| 亚洲成人五月| wWw色五月| 婷婷酒色网| 欧美成人va| 五月丁香综合啪啪啪啪啪| 久草五月丁香婷婷综合| 五月丁香婷婷色| 五月天成人手机在线视频| 激情碰碰碰| 丁香婷婷网| 六月天六月婷| 思思99久久| 无码日本精品XXXXXXXXX| 九九久热| 五月婷婷黄色| 思思热这里只有精品| 五月丁香六月婷婷久久久综合| 六月婷婷啪啪| 被强行糟蹋的女人A片| 狠狠干五月天| 婷婷激情综合色五月久久,色婷婷丁香花,丁香婷婷五月情天,久久婷婷五月综合色 | 69色婷婷| 中文字幕丰满孑伦无码专区| 九月婷婷色色| 九九草热在线观看| 婷婷午夜精品久久久| 少妇人妻丰满做爰XXX| 色婷五月天| 免费99情趣网视频| 日本黄色在线观看| 610018岁成人视频| 婷婷五月综合社区| 天天天摸夜夜夜玩| 天天综合网、天天综合色| 激情综合九| 婷婷伊人网| 五月丁香亚洲婷婷| 国产伊人五月天| 玖玖综合玖玖| 国产精品18久久久| 五月丁香成人| 丁香九月婷婷色| AV伊人青草丁香六月| 99热人人操人人操| av中文在线| 91色情播放| 婷婷五月在线综合| 成人av观看| 精品成人在线| 深爱激情六月| 丁香五月天色综合| 天堂中文国产| 黄色高清无码| 五月大香蕉| 无码99| 热这里| 国产日产成人亚洲欧美国产VA| 狠狠色婷婷丁香五月| 99热色精品| 天天色粽合合合合合合合| 97色色色色色色色色色色色色色| 9久精品| 99玖玖视频| 亚洲精品又粗又大又爽A片| 狠狠爱五月婷婷| 激情九九综合网| 国产中文亚洲欧美日韩性交| 热九九九九| 无码激情AAAAA片-区区| 色九月婷婷| 激情五月天小说|五月天开心激情网|亚洲精品国产自在现线|黄色五月天 | 精品国产乱码久久久久久免费| 久热 91| 五月丁香六月激情啪| 无码网| 9福利性视频欧美| 西西4r午夜剧场| 婷婷丁香18| 五月天婷婷丁香导航| 日本激情五月| 亚洲AV激情五月综合网| 五月丁香精品| 18久久| 天天色综网| 亚洲国产精品VA在线看黑人| 国产精品国产| 9er热在线精品视频| 99色免费| 丁香五月婷婷操逼| 少妇大叫太大太粗太爽了A片| 99视频久久| 亚城区在线| 婷婷 激情 五月| 亚洲国产婷婷色五月| 色婷婷国产精品综合在线观看| 日本三级第一页| 99色综合| 天天做天天爱| 五月丁香六月婷综合成人综合| 激情婷婷六月天| 五月婷婷综合色啪首页| 婷婷丁香五月激情综合站_久久五月丁香激情综合_开心五月综合激情综合五月_婷 | 99热这只有| 成人丁香五月| 4399亚洲视频| 五月婷久久久| 国精产品一区二区三区| 殴美97色| 99精日本久久| 五月丁久久| 日日操夜夜爽| 人妻无码精品一区| 伊人www22综合色| 五月天播播中文字幕| 婷婷五月天天aV| 丁香综合伊人| 99热色无码| 91玖玖| 玖玖午夜视频| 91精品又长又大又粗又爽又猛| 激情丁香五月| 久婷婷久草| 亚洲狠狠色丁香婷婷综合久久| 国产精自产拍久久久久久蜜| 99精品在线观看| 五月丁香啪啪网| 欧美日韩91| 男人天堂99| 五月天婷婷AV| 97丁香五月| 欧美这里只有精品| 婷婷无码五月天| 欧州色色| 五月婷婷香| 丁香六月婷婷综合在线| 26uuu另类| 色婷婷香蕉丁丁网| 久久久久99精品成人片| 五月婷婷之激情五月| 婷婷五月激情片| site:esunnet.com| 色婷婷在线视频久| 天干天天干天天天天天| 婷婷开心青青草| 激情五月综亚网| 桃色伊人在线| 婷婷美女精品视频| 欧美毛片www| 99秘 在线| 精品99爱免费视频在线观看| 青青热久精品视频在线观看| 天天舔天天摸天天射| 丁香五月网络网络| 插插插丁香五月婷婷| 国产五月丁香在线| ,99视频久久| 亚洲色色爱| 免費亭亭成人| 热热久久久久久久久| 激情综合婷婷| 五月婷婷激清网| 亚州AV超碰人人操| 激情五月天激情综合网| 美女丁香五婷婷| 久久九九色| 婷婷六月色开| 99热精品观看| 国产在线中文字幕| 另类激情综合| 99性视频| 538在线精品| 丁香色婷婷色手机免费在线| 婷久久久| 欧美日韩五月婷婷| 2017狠狠干| 啪啪激情网| 丁香五月综合高清在线| 激情综合五月婷| 激情综合4月| 亚洲综合网激情小说| 丁香五月98| 99国产性感视频| 成人丁香婷婷| 激情综合五月婷婷| 91色五月| 五月天婷婷久久| 97精品人人A片免费看| 激情五月四色| AV在线不卡网站| 婷婷五月天精品| 成人电影AV在线观看| 狠狠干青青草| 亚洲AV网站| 五月丁香啪啪激情| 狠狠色五月激情| 丁香五月综合图片在线观看| 婷婷色情小说| 婷婷激情综合| 日韩综合久久| 99'无码| 丁香六月啪| 激情五月天婷婷免费观看| 亚洲狠狠婷婷综合久久久| 色综合色色色色色| 色五月婷婷老师| 大天天伊人| 亚洲热久久| 538在线精品| 99色综合久久| 九九大香蕉黄色影院| 亚洲AV成人精品日韩在线播放| 激情六月丁香综合| 白天AV月月| 色色综合网络| 99精品久久久| 性一交一乱一交A片久| 好叼操在线观看| 野外99热| 欧美内射AA| 永久99免费视频网站| 丁香五月婷婷欧美成人色图| 免费AV在线| 久热这里| 亚洲九九99精品视频在线播放| 狠狠久久婷婷| 久热精品视频在线观| 激情婷婷人妻| 夜夜骑夜夜撸| 六月丁香激情网| 国产又爽又猛又粗的视频A片 | 人妻有码乱操| 亚洲人妻Av| 色五月婷婷狠狠撸| 亚洲色模骚货| 人妻人人操| 蜜臀AV在线观看| 99久久終合| 97综合在线| 啪啪啪五月天| 色色无码| 久操婷婷| 一片AV片免费播放| 五月香婷婷| 9999热这里只有精品| 丁香久久久| 色99视频| 99啪视频在线观看| 开心五月婷婷五月| 久久精品亚洲一级牲爱综合 | 五月天开心网| 婷婷丁香www视频日本韩国| 丁香五月综合| 丁香五月av在线| 日韩人妻无码精品| 国产欧美性成人精品午夜| 97人人看一| 欧亚洲在线高清视频| 另类图片婷婷五月天| 亭亭色网| 亚洲精品一区无码A片| 《丁香激情综合久久伊人久久》影视在线观看 -高清预告手机免费播放 -三妹影院 | 五月丁香六月色婷婷| 亚洲人成色A777777在线观看| 91狠狠综合久久| 成人免费超碰| 依人大香蕉| 色性日本| 久久五月丁香综合17C| 99精彩视频| 久热超碰| 狠狠爱夜夜| 丁香五月视频在线观看| 亚洲熟妇无码乱子AV电影| 色婷婷成人做爰A片免费看网站 | 99热老网站| 狠狠爱深色婷婷综合| 色情婷婷。| 久久婷婷五月综合激情国产| 婷婷婷久久久| 久久婷婷丁香花综合网| 中文字幕永久免费| 另类激情五月天| 伊人99热| 色色色五月婷| 人妻肉射免费观看| 激情九月综合| 91免费试看| 欧洲永久精品| 99热这里只有精品1| 久久香蕉影院| 国产精品国产| 丁香五月在线观看综合| 久热九九| 日本97在线观看| 无码九九| 五月婷婷深深爱| 亚洲性爱AV在线| 婷婷久久五月天丁香| 五月婷综合网| 婷婷五月天综合网| 综合网啪| 色婷婷五月天小说网| 99精品久久久久| 色色五月婷婷网| 五月婷婷激情网| 另类小说激情五月天| 丁香五月av| 另类精品视频在线观看| 蜜乳中文字| 日本三级日本三级99| 久久婷婷丁香五月宗合| 九九热短视频在线观看| 精品人妻一区| 日韩av网站在线观看| 五月丁香人人婷婷在线观看| 丁香啪啪| 99热第一页| Va另类视频| 99热这里只有精品5| 九九视屏| 婷婷丁香综合| 99热精品在线| 强奸幻女毛片| 婷婷丁香成人网址| 九九色色| 97婷婷狠狠| 丁香婷婷色| 欧美性猛交XXXX乱大交极品| 久久99免费视屏| 看片视频在线免费日产在线看| 一本到不卡高清DVD| 色99视| 97丁香婷婷| 人人叉久| 人妻VideOssS人妻高清| 国产精品日本一区二区在线播放| 天堂AV三级| 激情伊人| 狠狠se| 婷婷播5月| 久久se 综合网 | 99色最新在线视频网站| 性生生活大片又黄又| 婷婷五月天激情四射五月天激情| 久久久香| 久久久久久99精品无码| 九九婷婷五月天| 大香蕉色婷婷伊人在线| www.十八禁不禁AV.com| 九九Av| 91色久| 婷婷色操| 国产肏屄大片| www.99热视频| 婷婷六月香| 丁香五月综合亚洲| 国产偷人爽久久久久久老妇APP| 久久欧洲久久| 色播五月婷婷| 91性高潮久久久久久久久| 久re热视频| 色综合香蕉| 五月天网站亭亭| 97操碰人免费| 婷婷无码视频| 欧州婷婷五月天综合| 十月丁香婷婷| 色综合天天| 五月婷婷激情综合在线| 伊人婷婷五月天| 51XX午夜影福利| 手机旧版看人妻1025| 亚洲AV另类| 狠狠高潮精品亚洲1| 二区成人视频| 日日夜夜小色哥| 99色嘟嘟精品网站| 婷激情五月| 欧美日韩成卜| 五月天婷婷开心| 久草热久草在线视频| 激情五月图| 99热在这里只有精品| 开心婷婷中文字慕| 1024人妻| 91Chinese在线| 激情綜合W W W,激情五月天| 色五月激情网| 久九色| 亚洲精品视频在线播放| 九九激情综合| 婷婷色啪| 欧美在线干| 伊人干综合| AV在线大香蕉| 色婷婷久久| 九九色综合九九色| 久久er这里只有精品| 天天做天天爱| 天天激情综合| 国产99久久久国产精品免费看| 有码人妻久久| 国产精品国产成人国产三级| 五月丁香综合啪啪対白| 乱乱av| 色婷婷影音| 日本波多野结衣视频| 五月天色婷婷伊人网| 啪啪五月婷婷| 婷婷五月天成人网| 丁香婷婷色九月| 国产综合色婷婷精品久久| 五月丁香色情| 激情六月天| 欧洲亚洲免费视频9| 青柠影视免费高清电视剧| 亚洲九九99精品视频在线播放| 大香蕉AV电影在线| 亚洲综合色色色| 六月婷婷网| 婷婷五月色综合| 婷婷亚洲天堂| 亚洲成人网站在线观看| 色。 婷婷婷| 99干免费视频| 五月天国产婷婷精品视频在线| 久草五月婷| AV色婷婷| 91精品丝袜久久久久久| 色色色综合网| 色婷婷五月综合在线| 国产女18毛片多18精品| 五月天俺去也| 67194中文字幕| 精品婷婷| 婷婷在线五月天观看| 少妇伦子伦精品无吗| 久久人妻在线| 十区AV| 91超碰人人操| WWW·天天操·视频?| 成人综合视频网址| 五月婷在线播放| 欧美人人超级碰| 亚洲中文av| tingtingjiqingwuyue| 密着浓厚中出乚交尾GvG935| 婷婷干五月综合在线播放| 五月婷婷九九久久| 91日韩在线| 777.色色| 天天爱天天天射AV| 天天日天天插| 91狠狠综合久久| 另类在线| 狠狠搞亚洲| 3p久久| 五月丁香六月婷| 思思综合热| 欧美婷婷综合| 午夜天堂啪啪| 婷婷天天插天天爱| av在线免费播放观看| 色香久久| 久热这里只有精品6官网亚洲| 最近中文字幕在线中文视频| 综合久久六月| 色欲九区| 欧美性生交XXXXX无码小说| 99综合免费视频| 在线中文亚洲| 婷婷五月在线视频| 色综合色综合网| 亚洲秘 无码一区二区三区妃光/1| 五月丁香六月婷婷久久| 青草视频在线蜜臀| 性爱七区| 五月开心激情| 99视频在线观看视频| 人人叉久| 玖玖热视频| 色婷五月天网站| 97电影99热| 五月天婷婷小说| 天天干天天爽天天操| 久综合九| 97人人操人人干| 欧美婷婷五月丁香| 婷婷永久在线| 黄色三级毛片中字| 可以看的av| 天天开心天天色| 人妻免费网站| 九热精品| 五月婷婷开心激情六月蜜桃| 五月婷婷六月丁香首页| 五月天婷婷成人网| 五月婷精品| 色情综合| 婷婷综合婷婷| 五月丁香久久网| 五月丁香网中文字幕| 91|九色|动漫| 99噜噜噜在线播放| 激情五月天综合| 视频这里只有精品| 五月丁香激情综合网官网| 99热在线精品观看| 激情5月天天天| 91丁香五月| 色色三级视频| 亚洲色图五月丁香| 少妇激情五月婷婷| 很很色丁香久久停停| www久久99| 五月天婷婷综合免费| 五月婷婷激情综合在线| 色呦呦在线| 激情五月婷婷丁香| 99热这里只有是亚洲国产| 99精品在线观看| 五月婷婷综合成人| 九九色影视| 婷婷情色激情| 在线成人网站| 热久免费视频9| 丁香五月电影| 思思久热| 99色区| 婷婷香蕉视频| 亚洲中文字幕在线观看| 激情五月天网| WWW丁香五月| 九九热婷婷| 无码少妇高潮喷水A片免费| 激情五月天啪啪| 亚洲九九九九| 婷婷综合亚洲| 伊人久久婷婷五月综合97色| 伊人久久婷| 婷婷色情五月| 久久机热这里只有精品免费视频| 99免费视频| 婷婷中文字幕| se99在线| 免费黄色片子| 九九色video| 久久久婷| 欧美性爱一区| 色婷婷六月开心中文字| 亚洲另类在线观看| 青青999| 免费看欧美成人A片无码| 五月丁香激情婷婷| 五月丁香六月婷婷综合网缴情| 天搞天天天天天| 久久久婷婷色五月资源网| 99国产精品白浆在线观看免费| 九九热自拍| 天天插天天操| 色9色| 国产成人AV在线播放| 8050一级网| 涩综合婷婷| 天天综合色丁香| 五月婷婷深爱六月| 99色综合网| 婷婷丁香91| 97超碰免费超级在线观看| 99热久| 精品人妻伦一二三区久久| 色婷婷六月开心中文字| 91婷婷| 亚洲色图日韩网址| 99人妻碰碰久久久禁片| 99re热视频这里只精品| 亚洲色五月| 开心五月婷婷99| 小视频在线亚洲| 五月婷啪啪| 亚洲超碰中文字幕| 婷婷97狠狠成人网站| AV在线大香蕉| 色偷偷五月天| 综合网五月天123| 9久久久| 色五月丁香91| 五月丁香啪啪啪| 99久久婷婷国产综合| 婷婷激情社区| 99精品网站| 丁香六月AV| 99久久综合网| 日韩一级网站| 碰人人97| 日本精品人妻无码77777| 五月丁香亭亭| 久热一本| 激情六月婷婷| 99热日韩| 提提热五月天婷婷| 青青操avbb| 国产激情AV| 婷婷内射视频在线| 1024你懂的欧美曰韩| 91av视频| 久久久99精品免费观看| 91久操| 久热大香蕉| 五月开心网| 亚洲激情婷婷| 亚洲精品国产精品乱码不99| 91啪级电影| 凹凸7777操操操| 婷婷开心深爱五月天| 久久五月激情综合| 99热狠狠操| 成人AV片播放| www.97视频| 99精品成人无码A片观看金桔| 人人爱国产| 日本高清久| 激情五月天开心| 五月丁香六月婷婷在线观看| 无月播播激情在线观看视频| 五月丁香婷婷久久| 婷婷成人在线| 人人爱干人人爱草| 国产片天天爽夜夜爽| 亚洲成人在线免费| 美女黄频aⅴ视频| 成人在线视频一区| 人人爽欧美婷婷久久久五月丁香 | 色丁香五月| 九九热在线视频观看免费10| 天天插操| 九九色婷| 国产成人AV不卡| 丰满少妇猛烈A片免费看观看| 欧洲色色| 拍真实国产伦偷精品| 国产毛片精品一区二区色欲黄A片| 婷婷开心激情| 99色在线视频| 亚洲六月色| 丁香九月激情| 欧美日韩成人在线| 操人91| 色婷婷视频| 亭亭色色五月天| 99久久99久久综合| 91热久久| 婷婷色色丁香五月天| xxxx久| 综合网啪| 中文字幕,综合,91| 丁香五月AV| 丁香 久久| WWW.桔色成人.COM| 日本九九网| 少妇性按摩无码中文A片| 91热视频色网站| 婷婷五月色情| 五月玖玖| 1024国产| 欧美成人A片AAA片在线播放 | 操B五月天| 久9久9久9久9久9久9| 亚洲超碰在线| 东京热免费视频| 激情婷婷丁香五月天小说| 五月天狠狠网站| 另类色视频| 久久五月天激情婷婷| 丁香五月视频在线观看| 婷婷激情综合色五月久久,色婷婷丁香花,丁香婷婷五月情天,久久婷婷五月综合色 | 天天色天天| 婷婷五月天色色| 激情色播| 97精品人人A片免费看| av高清无码| 丁香亭亭激情四射| 1024在线视频| 国产一区18| 久草五月天| 久月婷婷| 色色精品色| www.狠狠狠狠| 色高清无码视频| www.五月天社区| 丁香六月在线| 蜜臀av粉嫩av懂色av| 九九精品自拍| 婷婷五月天久久| 婷婷五月色| 久久久久久久11111111111| 久久久久久99日本| HD久久精品视频| 欧美WW在线网| 99操中文视频| 久久九九99| 欧美激情五月天在线观看| 婷婷在线午夜| 丁香五月天在线| 99在线观看精品视频| 久操福利| 99热网站| 青青久在线视频免费观看| 五月丁香六月片| 亚洲第二AV| 大香蕉九九热| 色婷婷五月影视| 性婷婷| 狠狠插日日干撸| 激情六月色| 大香网伊人久久综合| 99色视频| 丁香五月婷婷天激情| 婷婷亚州综合| 伊人网碰碰| 九九热这里只有精品7| 插插插色综合网| 婷婷五月天com| 激情欧美丁香五月| 成人在线日韩欧美| 婷婷香五月天| 国产伦亲子伦亲子视频观看 | 99热9| 亚洲日韩一页精品发布| 狠狠噪| 激情亭亭五月| 99久久久久| 色色色色色级无码| 狠狠色噜噜| 蜜臀99精品| 久久综合五月天| 欧类av怡春院| 五月丁香最新| 综激情网| 五月丁香久久久日婷婷久久婷婷日 | 色情网综合| 亚洲视频1区| 久9视频| 综合逼五月激情婷婷| 成人丁香婷婷| 色色五月天丁香| 精品亚洲国产成人A片在线鸭王 | 思思热在线视频精品| 天天日色情| 人人性久久| 99 热| 五月婷婷激情综合视频| 丁香婷婷六月男男| 噜噜视频| av大片在线| 丁乡久久| 激情五月天在线观看婷婷| 综合视频五月| 天天综合色丁香| 96丁香六月婷婷蜜桃综合久久| 综合久久五| a在线免费v| www.激情五月天.com| 天天天天爽爽天干| 91一起操| 欧美成人精品A片免费一区99| 五月婷婷狠狠久久| 九月婷婷色色| 婷婷综合五月天激情| 人妻精品一区二区三区| 色五月激情婷婷| 91九九九色在| 久青操| 丁香五月AV综合激情| 97热这里只有精品| 亚洲综合婷婷| Av在线资源| 9久久精品| 夜夜爽天天日| 久久婷婷综合基地| 亚洲天堂婷婷丁香| 2022人人操人人看| 亚洲综合激| 丁香婷婷色五月天| 国产精品久久..4399| 五月丁香六月片| 色婷婷天堂| 操逼福利视频| 噜噜狠狠色综合久| 日本不卡高字幕在线2019| 九月大香蕉| 蜜臀av无码久久久久久久久| 99爱在线免费视频| 欧美色婷婷| 91婷婷色五月| 亚洲午夜成人av电影网| 日韩肏屄网| 五月婷婷六月爱| 五月婷视频| 亚洲精品又粗又大又爽A片| 成人免费高清在线播放| 亚洲俩性性爱图片久久第六页| 99爱视频在线观看| 欧美性爱五月天| 久久天堂婷婷五月| av婷婷丁香 六月| 色香欲综合| 色婷婷成人做爰A片免费看网站| 成人在线高清| 丁香婷五月天| 狼人婷婷综合| 免费黄网不卡AV| 九九re精品视频在线观看| 五六月丁香激情视频| 成人网站在线观看视频| 五月天丁香婷婷久久九| 久久性视频| 99青青草| 91热爆在线| 91九色PORNY大屁股| 丁香五月激情宗合网| 五月天成人小说| 120分钟婬片免费看| 草榴视频网| 在线五月色播| 丁香婷婷五月六月久久| 婷婷操无码| 九九热a| 综合五月婷婷| 人人操av| 久久久.COM| 天天干天天射色综合| 99热这里有精力| 熟美女麻豆| 五月丁香婷婷五月色| 日韩狠狠色| 国产高清视频91九九九久久久| 九九熱最新視頻| 涩婷婷五月天在线精品视频| 国产真人做爰视频免费| 色婷婷综合久久久久| 色色网站免费| 99亚洲天堂| 五月婷婷偷拍| 狠狠五月天婷婷激情网。| 久热这里| 丁香五月婷婷欧美激情-中文天堂最新版在线观看| 激情六月五月婷婷综合网| 91成人视频| 狠狠婷婷日韩| 日本熟女三区| 久9视频免费播放| 激情久久伊人| ay2区| www.婷婷六月天| 亚洲av电影在线| 色亚洲视频| 天天操无码| 91精品啪| 五月丁香网中文字幕|