欧美成人午夜精品久久久,国产?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干在线| xx久久| 五月天大香蕉视频| 日本丁香五月| 五月天天堂久久| 久久九九@| 丁香五月婷婷99| 99久在线精品99re8热| 日韩成人精品中文字幕| 天天色天天爱天天爽| 日韩丁香涩| 91久久婷婷人人澡草| 果冻传媒A片一二三区| 另类五月婷婷| 丁香五月伊人| 久久婷丁香五月| 99精品国产在热久久婷婷| www.婷婷五月| 亚州精品色情无码A片| 婷婷五月色| 熟女激情五月天| yazhochengrenavwang| m色激情网| 日本片日本片祼观看网站在线看中文版网页在线看 | 欧美成人精品老美女噜噜噜| 超级碰碰视频无码| 色婷婷超碰| 狠狠干在线视频| 五月天综合视频| 51XX嘿嘿午夜无码| 婷婷久久天堂网| 精品国产va久久久久| 色五月丁香网| 五月丁香婷婷深深爱| XX久久| 啪啪操超碰| 丁香六月婷婷综合| 五月天婷婷影院影院| 五月丁香六月停停停| 99色| 青草热视频这里只有精品| 麻豆123区| 婷婷久久大香蕉| 九九热免费观看视频| 97超碰免费超级在线观看| 人人摸人人干人人做| av无码电影| 精品婷婷| 六月婷婷五月丁香| 五月花婷婷最新| 久久玖玖99| 蜜桃人妻无码AV天堂三区| 亚洲中文av| 国产偷人爽久久久久久老妇APP| 天天插天天插天天插| 大香蕉人在线65| 婷婷成人五月天| 五月激情综合深爱| WWW,激情五月天,COM| 思思9久久| 国产成人AV在线播放| 亚洲精品国产成人AV在线| 亚洲妇女熟BBW| 五月激情五月婷婷五月天在线| 色呦呦美女| 婷婷丁香六月天| www色五月| 99久热这里有精品| 97碰久久| 99资源在线| 亚洲激情五月| 在线观看亚洲AV| 久久伊人日日夜夜| 人人色婷婷五月天| 51成人| 七月丁香婷婷 色色| 国产精品成人AV在线| 婷婷操逼网| 直接看的av| 九九热在视频| www激情| 日韩欧美成人网| 久久久久久久97| 亚州视频九九99| 99亚洲精品视频| 激情图片亚洲| 五月丁香| 九九视频在线观看视频6 | 天天综合色| 六月色色婷婷| 日日天天操| 色色爽爽天天| 国内久久婷婷| 色婷婷激情Av久久久| 亚洲av日韩无码| 青青草原福利在线| www.日日日.com| 9久久久久久久久久久| 伊人久久丁香狠狠婷婷综合香蕉 | 亚洲综合丁香婷婷六月天| 国产成人AV在线播放| 国产精产国品一二三在观看| 久99| 久热大香蕉| 色婷婷久久| 开心五月综合| 婷婷五月天日本无码| 26uuu淫色| 九月丁香婷婷| 久久综合九九| 激情婷婷久久| 六月婷婷综合激情| 91黄操| 亚洲人人艹| 99视频热99| 亚洲精品V天堂中文字幕| 亚洲中文av| 日本色99| 六月激情婷婷| Av九九| 很很干夜夜干| 亚洲日韩欧美综合VA| 色射婷婷五月天| 色婷婷激情小说网| 人人干人人操人人摸人人做| 五月丁香六月激情狠狠| 狠狠狠五月婷婷六月丁香| 日韩丰满少妇无码内射| 欧美三级A做爰在线观看| 日日爽日日| 丁香五月婷婷亚洲综合精品| 久草五月| 五月天丁香| 天天草天天爽| 99九九久久| 色色色色色色色色五月先| 婷婷六月视频| 色情成人五月天| 色播五月| 久九色| 亚洲AV网站| 国产精品久久..4399| 猫咪伊人久久| www.超碰在线| 九九XX视频| 欧美电影在线播放| 97干资源在线观看| 欧美在线操| 婷婷人人操| 久久性刺激| 九九re视频在线视频| 一起草av在线观看| 久久曰曰| 色婷婷五月天堂资源| 热久久视频99| 色婷婷五月天久久| 另类小说五月天| 99热超碰| www,婷婷,com| 免费亚洲成人电影AV| 99玖玖在线视频| 国产永久一黄| 亚洲精品国产成人AV在线| 只有精品视频在线观看| 丁香婷婷射| 人人操人人爱丁香五月| 婷婷少妇激情| 亚洲色无码A片一区二区麻豆| 久久这里只有精品视频15| 色吊丝99| 91久热| 五月天无码| 激情欧美婷五月| 天天操夜夜爽歪歪| 九九热免费| 成AV人片一区二区三区久久| 亚洲日比视频| 日本综合久久| 爱之国产色情综合| 久久婷婷视频| 国产做爰视频免费播放| 五月丁香六月婷婷综合| 五月丁香综合啪啪| 五月婷婷中文| 五月丁香婷婷色| 色五月婷婷777| 人妻操日日| 五月色网| 怡红院一二三| 激情五月综合网| 丁香五月www| 在线日韩视频| 精品久久艹| 色婷婷基地| 国产性爱在线| 在线播放成人网站| 五月丁香婷爱在线| 五月天综合| 婷久久高清| 日本WWW九九九| 亚洲美女婷婷五月天| 丁香婷婷色五月天| 天天综合色| 久久婷婷五月激情综合| 五月花成人网| 99九九精品| 日韩av免费版| 少妇日麻屄| 天天做天天爱综合| 色婷婷色久综| 思思视频精品| Av中文在线| 91精品久久久久久综合五月天| 久草a片| 麻豆AV一区二区三区| 99人碰碰碰| 69人妻人人澡人人爽久久| 天天摸天天舔| 99精品热视频| 涩玖玖免费视频| 色999;丁香五月| 久久久人妻门| 色噜噜狠狠色综无码久久合欧美| 中文字幕成人影视| 久热视频这里只有精品| 熟女人妻一区二区三区免费看| 婷婷五月天成人视频| 色婷婷黄色网络| 亚洲激情五月天| 亚洲 在线 另类| 神马欧美精| 9999色色色色| 天堂成人A片永久免费网站 | 激情小说视频图片网| 五月丁香综合激情网| 久久网婷婷| 干婷婷五月天| 91碰碰| yellow视频在线观看91| 亚洲色五月天| 9久热在线精品| 五月丁香婷婷五月色| 99精品视频免费观看| 日本少妇裸体做爰高潮片 | 79成人网| 天天日天天插| 婷婷六月色丁香视频在线观看| 九九综合九九| 大香蕉五月天婷婷丁香91| 婷婷五月情天| 亚洲天堂碰碰婷婷| 伊人在线视频| 九九五月天| jiZZdr| 久久黄色免费视频| 久久er免费视频| 亚洲丁香五月深爱五月| 九九伊人网| 久热欧美| 国产无套精品一区二区| AV在线免费播放| 婷婷五月天国产| 曰本aaaaaa丈片| 激情婷婷狠狠干| 国产精品天天狠天天看| 亚洲五月天伊人| 久久久婷婷婷| 国产精品久久99| 激情五月综合亚洲另类| A在线观看| 五月婷婷五月天| 欧美婷婷丁香五月| 激情五月天 婷婷| 五月丁香色停停啪啪啪| 欧美日韩AAA| 伊人久久丁香狠狠婷婷综合香蕉| 狠狠操婷婷| 极品精品一区二区三区在线| 激情综合五月色丁香婷婷 | 看久久性爱视频| 91午夜婷婷狠狠久久综合9色| 熟女激情网| 午夜丁香| 五月婷婷之六月丁香| 国外亚洲成AV人片在线观看| 六月婷婷激情小说网| 五月丁香婷婷五月色| 99爱视频在线免费观看| 久久九九99.www| 性色五月天| 男人視頻站| 人人爱摸视频| 玖玖婷婷五月天| 性色五月天| 梁铮版《蜘蛛女侠》在线| 99色在线| 成人丁香婷婷五月天| 久久五月天 91| 色中色综合| 国产超碰人人| 婷婷久久网| 天天激情夜夜干| 激情九月婷婷九月| 婷婷深爱五月| 91操碰| 色婷婷成人做爰A片免费看网站| www.日日夜夜| 99久久新视频| 综合激情五月天| 婷婷五月天性| 超级碰碰碰97免费| 国产AV一区二区三区最新精品| 淫荡综合网| 国产AV一区二区三区最新精品 | 丁香花综合永久入口| 五月天四色房丁香| 欧美性久| 91精品久久久久久久久久| 日日噜狠狠色| 丁香五月天婷婷在线视频| 日日夜夜干| 婷婷五月深深爱| 综合色影院| 五月天色五月| 人人爽天天爽| 包操45分钟网站| 色丁香五月综合网| 欧美图片丁香五月天| 亚洲va综合va国产va中文| 婷婷色丁香五月| 四月婷婷五月丁香| 专区无日本视频高清8| 女高怪谈在线观看| 五月丁香色色综合| 9999热在线观看| 另类小说五月天| 狠狠色噜噜狠狠| 亚洲成人影视在线观看| 91狼友视频网页更新| 狠狠操狠狠操AV| 天天拍夜夜撸| 26.uuu丁香五月婷婷| 国产古装妇女野外A片| 婷婷爱五月| 五月天无码视屏播放| 性爱人人网| 99热伊人| 婷婷九九| 欧洲第一久色| 狠狠色丁婷婷日日,伊人激情综合网| 国产综合A片| 深爱婷婷网| 五月天色社区| 亚洲综合婷婷五月| 欧日美女Va| 中文字幕 中文字幕明步| 五月丁香婷婷综合久久| 五月丁六月香| 亚洲女婷婷五月基地综合久久久| 伊九九三级区| 91丁香婷婷综合资源| 婷婷六月天| 色婷婷a v| 丁香六月视频免费观看| 99色热视频| 伊人大香蕉毛片| 91久热| 夜色综合网| 天天肏天天爽夜夜爽| 五六月婷婷| 99热热这里只精品996小说| 久久您您综合网| 高清无码入口| 色婷婷久久综合| 涩涩涩.com| 玖玖色资源站| 久久视这里只有精品| 色五月婷婷青娱乐| 九九热99久久99| 一级黄在线| 99热这里只有精品在线免费| 第四色激情网| 色五月成人| av最新在线| 另类婷婷五月天啪帕帕| 99久久精品免费精品国产_国产精品久久久久久_国产在线|日韩_久久国产精品电影 | 丁香五月天精品| 深爱五月激情综合| 五月激情综合网| 精品久久婷婷| 丁香久月婷| 五月综合激情久久| 国产毛片欧美毛片久久久| 色婷婷狠狠| 99久精品视频| 婷婷综合色图| 五月丁香色色网| 婷婷成人视频| 人妻久久久| 五月天俺去也| 婷婷综合精品视频97| 成人性爱精品视频| 99r这里只有精品在线观看| 五月丁香久久激情网| 久久五月丁香激情综合| 99热这里只有精品69| www。88热在线视频免费观看| 99色激| 99操中文视频| 最新色色五月天| 一区二区三区XXXXXX| 五月综合人妻| 国产亚洲99久久精品熟女| 丁香五月色情av| 人人摸人人干| 狠干综合| 亚洲视频国产一区| 91seav| 亚洲综合视频网| 日本44久久在线| 2025超碰| 一区中文字幕电影| 欧美乱码国产一级A片| 婷婷七月丁香色色| 婷婷五月色情天| 97碰久久| 九九热视频精品| 色色热| 五月综合久久| 91久女| 综合另类激情| 中文AV在线观看| 九九九九综合| 色色五月天丁香| 九九色精品| 最新日本A片| 亚洲精品乱码久久久久久综合| 色青青五月| 亭亭五月激情亚洲在线| 五月丁香啪啪啪| 丁香六月婷婷开心| 久久a热| 中文字幕日产A片在线看| 色婷婷免费视频| 婷婷五月天成人在线视频| 99色人| 天天色域综合网| 69精品无码一区二区三区| 久久婷婷五月天激情四射| 99热线观看9| 色五月播五月| 337p大胆噜噜噜噜噜91Av| 日本不卡高字幕在线2019| 99热有精品在线观看| 久久婷婷成人| 色婷婷狠狠爱| 无码G高清天| 日本在线免费中文com.| 日韩色五月| www.狠狠操| 99热91| 国产性爱在线| 六月久久狠狠| 精品九九视频| 五月激情啪啪| 日日激情网| 囯产精品久久欠久久久久久九大| 久久这里有精品| 99在线资源视频| 99热线观看9| 这里只有精彩小视频视频网站| 99热这里只有精品69| 欧美狠狠色| 天天日天天色| 69精品人人人人人人| 91Chinese在线| 99热这里只有精品23| 久草热视频在线观看| www.黄色片-久久成人国产精品在线播放-999AV | 久9热在线免费观看| av在线中文| 亚洲第一色网站| 五月天婷婷久色| 51国精产品自偷自偷综合| 97干在线视频| 操比激情五月| 五月香婷婷| 久热这里只有精品99re| 天天综合色| www亚洲无码| 婷婷五月天激情文学小说| 思思re99视频在线观看| 99热在线播放| 九九碰九九爱97超| 亚洲无码成人性爰网| 丁香婷婷色情| 亚洲123区高清入口| 九九热自拍| 美英法精品无码免费视频| 99热这里只有精品50| 丁香五月天啪啪| 一级性感毛片| 天天 青草 丝袜制服 在线| 五月丁香色情| 丁香五月激情月| 99热这里只有精品13| 在线观看的av| www.99免费视频| 囯产精品一品二区三区| 亚洲AV免费在线| www.com.色色| 五月天社区狠狠| 伊人婷婷五月天| 六月丁香婷婷大香蕉| WWW色五月天| 狠狠高潮精品亚洲1| 成人在线观看精品| 千人斩操逼| 99热在线播放| 亚洲欧洲中文日韩久久AV乱码| 九色91国产| 婷婷丁香成人网址| 色伦专区97中文字幕| 9.1综合网| 久久 婷婷 五月天| 人妻操日日| 五月永久激情| 五月天开心网| 电影蜘蛛女| 丁香五月婷久久| 97婷婷狠狠久久综合9色| 五月丁香在线偷拍视频| 午夜天堂一区人妻| 久久久婷婷婷| 性爱综合网| 中美日韩成人在线| 在线中文字幕视频| 婷婷九九| 成人片在线播放| 狠狠人妻色综合| 亚洲五月花| 无毒黄色网址| 婷婷五月18永久免费视频| 久久综合26p| 玖玖精品资源| 色色欧美色色色| 激情婷婷狠狠干| 极品人妻VIDEOSSS人妻| www.狠狠操.com| 日日干日日| WWW夜夜| 婷婷精品| 激情q青青草在线婷婷| 丁香激情网| 99re热99| 婷婷六月综合基地| 久久综合色五月| 天天爽天天摸人妻综合网| 91狼友视频在线观看| 插插插色综合网| 九九精品热| 综合久久丁香婷婷,五月婷婷六月丁香,开心激情综合网,六月丁香在线观看,婷婷丁 | 玖玖99婷婷| 色婷婷丁香中文在线播放| 99re6在线视频精品免费| 六月丁香婷婷视频综合在线观看| 色99视频| 五月天伊人日日噜影片AV| 色色操| 欧美黑人巨大猛烈cuckold| 91操人视频| 噜综合| 嫩草AV久久伊人妇女超级A | 97人人干人人操| 激情五月激情综合俺也去婷婷小说| 六月丁丁香| 欧美丁香六月在线观看视频| 久久九九99视频| 天天爽夜夜爽夜夜爽精品视频| 日韩在线观看亚洲| 可以免费观看的AV| 涩综合在线| 天天爽天天爽| 久久99成人性爱高清视频| 久久这里只有精品视频15 | 久热A| 91精品视频男人的天堂| 玖玖综合网| 五月婷婷伦理| 99久久婷婷国产综合亚洲| 婷婷成人五月天| 99re在线观看| 国产AV一区二区三区最新精品| 九热在线这里有精品6| 99ER热精品视频| 啪啪干伊人婷婷| 九九99视频精品| 九九人人精品| 五月天色婷婷av| 九九99偷拍视频| 色色激情五月| 激情亚洲五月| 91九色中文| 激情99| 婷婷五月永远18免费久久久| 伊人五月婷婷国产视频| 色99视频| 丁香五月亚综合图片| 91超碰在线播放| 亚洲欧美在线观看| 五月丁香综合| 五月天激情网图片 - 百度| 五月刺激丁香月综合| 人人97碰| 久久99久久99精品免观看软件| 色欲婷婷五月天丁香| 亚洲九区| 九九热在线视频观看| 天天插天天插天天操| 免费一区二区三区| 五月天色婷婷综合| 日本色视| 丁香九月久久| 日本欧美成人片AAAA| 婷婷五月天免费视频| 91精产一区三区免费观看| 色99色| 九九热99热| 亚洲亚洲激情| 综合激情在线| 操日本99| 91久热| 欧美色爱五月天| 99啪啪视频| 日本熟女啪啪| 婷婷丁香色五月| 99热99热在线| 另类图片五月天婷婷| 一区二区免费看| 日韩一级一片内射视频4K| 五月婷婷影院| 99福利视频| 99热99ai| 五月婷婷啪啪啪| 99热在线极品极品| 日本丁香五月| 色久丁香五| 9这里只有精品| 色五月琪琪| 日本激情综合| 一本色道久久88综合日韩精品| 91在线日| 天天插天天爽| 久久人妻在线| 五月天a婷婷伊人| 婷婷五月天成人在线视频| 色欧美日| 国产肥白大熟妇BBBB视频| 五月天大香蕉| 婷婷五月综激情| 久久婷婷五月综合伊人| 99热这里只有精品69| 色一区高清| 激情九月天天天天婷婷| 激情五月婷婷色色| 婷婷综合| 97色婷婷成人综合在线观看| 激情六月日韩| 狠婷婷五月| 婷婷开心青青草| 日本在线视频www色| 激情 婷婷 插| 初夜av| av色婷婷| 六月婷婷av| www.99热在线| 热婷婷av| 99re8热精品免费视频| 男男野外做爰全过程69| 国产精品久久久久久久久久久久 | 黄色片久久| 欧美美女视频| 久久只有18视频| 亚州操操| 看久久性爱99视频| 青草激情在线| 99福利视频| 五月天婷婷色播综合在线| 开心六月丁香五月婷婷| eeuss人妻| 天天爽爽日日做做| 丁香五月 无码| 奇米影视在线视频| 激情婷婷丁香色五月| 碰超亚洲| 色图亚洲91| 情婷婷五月天| 丁香五月天BBw| 婷婷五月精品中文字幕| 99精品免费欧美小视频| 日日爱激情| 色色AV色色色东莞| 五月婷婷真爱激情网| 26uuu亚洲| 日日干日日| www.天天干| 97色永久免费视频| 99碰网站| 97色婷婷| 五月丁香激情综合网| 五月天激情视频| 亚洲亚洲人成综合网络| 午夜无码熟熟妇丰满人妻| 婷婷D区| 亚洲正能量欧美| 超碰一区二区| 五月亭亭色| 97色97干| www999日韩精品| 超碰九色| 五月丁香婷婷色| www.玖玖婷婷在线| 成人电影AV在线观看| 欧美日韩成人在线网站| 九热...av| 六月丁婷婷| 天天射夜夜骑| 五月天久久婷婷| 丁香婷婷性爱| 年轻的妺妺伦理HD中文| 久久思思热| 五月婷婷香蕉| 九月婷婷色色| 九九视频这里是精品五月| 丁香五月婷婷欧美成人色图| 色婷婷a| 99热啪啪| 国产片XXXXA片国语对白| 92久久久| 婷婷啪啪| 99热精品综合| 天天草天天日| 五月丁香婷婷导航视频| 五月天六月色| 91丨九色丨首页| 九九综合色综合| 99久久黄色顶级视频| 亚洲欧美999| 9+1视频网址| 久久婷婷丁香花综合网| 色综合九九色综合88| 婷婷六月丁香久| www.五月.com| 久久综合干| 国产在线网| 久久婷婷国产| 思思99精品视频| 五月天综合视频网| 99精品免费| 亚洲综合视频八| 色婷婷瘦婷婷日韩| 久久女婷| 吾爱AV导航| 国产成人AV人人爽人人澡Va| 亚洲五月丁| 五月婷婷激情性爱| 欧美色激情四射| 成人在线免费网址| 夜夜躁狠狠| 婷婷五月天高清无码| 色婷婷丁香五月| 色婷婷AV在线观看| 99久久国产成人精品| 婷婷五月色天| 欧美成人猛片AAAAAAA| 97人人搞| 欧美啪啪网| 夜夜操少妇| 另类小说五月天| 五月天婷婷久草丁香| 色色影院aaaav| 成人色图情色成人网 www.5b5b5bcom 五月天| 野战J办公桌椅H| 色情五月天小说| 九九99热久久精品66中文字幕| 色色网站| 婷婷色九月| 五月久久丁香| 国产一区男女| 欧美日韩91| 奇米影视777在线_在线观看午夜_h小视频在线观看_岛国大片 | 午夜理论片最新午夜理论剧| 亚洲国产无线乱码在线观看| 免费操超碰| 五月丁香激情片| 思思热久久爱| 伊人在线视频| 开心五月婷婷在线| 中文字幕乱码亚洲精品一区| 久久99久久99精品免观看软件| www.狠狠操| 亚洲综合视频网| www久热com| 婷婷色色网站| 99精品在线| 五月六月激情| 在线中文av| 丁香五月影院| 华人在线免费| 五月婷婷影视| 五月天久久婷婷| 激情丁香久久久久久| 色综合色综合色综合色综合| 99热在线观看免费| 国产精品五月天婷婷| www.9操| 爱久综合| 第四色大香蕉| 久久天堂女人| 狠狠舔| 亚洲成人网站在线观看| 99九九热在线观看| www.jiujiujiu| 婷婷大乡焦噜噜| 天天干天天色综合| 亚洲AVwwwwwww| 久久机热/这里只有精品| 91碰免费视频| 99热99干| 日韩久操婷婷| 亚洲成人噜噜| 亚洲天堂有码| 人人操人人爱丁香五月| 无码成人播放器| 五月天中文网| 99热这里只有精品9| 五月天婷婷一起草| 天天干天天干天天干| 日韩无码专区| 婷婷五月天777| 五月婷网| 日本99久久| 日本三级韩三级99久久| 色欲操| 老妇六区| 五月丁香在线婷婷美女| 99热精品在线观看| 狠狠色狠狠色综合日日91| 婷婷五月综合国产精品| 婷婷五月噜噜| www. 五月. com| 香蕉人在线香蕉人在线 | 91久久五月天| 人人爱国产| 色网站99| 影音先锋五月婷婷| 狠狠色综合网站久久久久| 99视频91| 婷婷五月天AV| 久久婷婷夜| 日韩人妻无码专区| 91九色熟女| 婷婷射丁香| 秋霞AV淫| 亚洲操操操| 精品成人在线| www色综合| 婷婷五月天丁香社区| 久久综合激情| 久久婷婷丁香五月一二三| XX色综合| 久久av电影| 婷婷丁香色女人| 久草久青福利| 骚逼视频一区2区| 亚洲va综合va国产va中文| 九九色人| AA片在线观看视频在线播放| 五月色精品| 人橾人| 激情综合婷婷| 激情婷婷丁香五月| 久久精品日| 成片免费播放| 蜘蛛女免费观看完整版高清电影| 91大屁股在线| 天天操B| 综合久久丁香婷婷,五月婷婷六月丁香,开心激情综合网,六月丁香在线观看,婷婷丁 | 中文字幕网伦射乱中文| 色九月激情综合网| 综合网啪| 99热超碰在线| 五月开心色| 九九久久99| 狼人伊人天堂| 亚洲啪啪网| 亚洲第一色色色色| 9 9热这里有精品| 婷婷深爱五月| 久热播这里只有精品| 国产精品成人AV在线观看春天 | www.五月天| 九九免费视频| 丁香五月婷婷久久综合激情网 | 色色色色色色色色综合网| 婷婷五月天堂| 999热视频精品99免费在线| 久久综合影院| 情五月亚洲婷婷| 婷婷丁香五月天大香蕉| 开心激情网在线| 日韩色色视频www| 91精品无码| 性爱网五月婷婷| 久久人妻人人| 日本婷婷丁香五月| 97人人看一| 91久久久久久久久18| 天天色天天爱天天爱天天爱y| 99碰碰| 日韩av高清| 91精品久久久久久77777| 六月丁香综合| 亚洲视频在线观看99| 日韩综合久| http://www.com久久久精品一区| 婷婷六月啪啪| 激情五月婷在线精品| 激情黄色小说色五月| 五月激情综合婷婷| 五月色网| 久久九九99字幕| 综合色播| 五月丁香影视| 色综合日日| 久久Xx| 黄色av网站在线免费播放| 东京热免费视频| 丁香5月婷婷| site:wpjngj.com| 97碰超级人人看| 日韩久久成人| 欧美色五月| www.99精品在线| 色狠久| 99丁香五月婷| 4399成人黄A片| 激情四射婷婷色色色| 久久免费少妇高潮99精品| 五月婷婷影院| 久久激情五月婷婷| 六月婷婷开心| 日日夜夜综合| 3p日韩网站视频| 开心五月激情| 色吧综合网| 久久精品日| 婷婷五月天97干| 欧美交换配乱吟粗大25P| 99热免费| 亚洲精品国产精品乱码视99| 激情综合另类| 99热热九九| 伊人婷婷青青cao| 欧美日韩123| AAA久久久AAA久久久AAA| 九九色网| 99久久国产宗和精品1上映| 人人爱人人草| 五月天色色色| 玖玖在线视频| 久久9视频| 在线网黄| 97超碰在线免费观看| 五月婷婷综合丁香视频| 五月丁香六月婷婷久久| 五月丁香花免费视频| 婷婷五月天综合蜜桃| 大香蕉久操| 久久久久久久久久91| 欧美网站视频4399| 日韩在线成人电影| 欧美日韩成人在线免费| 日本97在线看片| 伊人狼人干| 亚洲第一成人AV| 人人操9| 婷婷99综合| 五月丁香六月激情| 九月丁香久久网| 色婷网站| 九九九九九九热| 久久ri精品视频| 色久一| 亚洲黄3级片网站欧美| 九九九九九九综合| 色五月自偷自拍婷婷婷婷| 成片免费观看大全| www.99热精品| 91青娱乐青青草| av最新在线| 色五月中文字幕| 97五月婷婷| av在线观看网站| 久久婷婷五月天激情四射| 久久久久久久久久91| 日本不卡中文字幕| www久久久| 丁香六月av| 久er7久热| 色大综合| 桔色成人官方网站| 亚洲国产网址| 亚洲成人av在线播放| 欧美日本黄色| 五月色综合| 久久6这里只有精品| 丁香婷停五月激情综合深爱| 婷婷六月视频| 婷婷丁香色无五月| 五月婷婷六月丁香玖玖玫瑰91| aa久久| 99ri国产| 亚洲操操操| 99欧美精品99日本精品| 久久玖玖99| 手机在线日韩视频中文字幕| 99在线视频精品| www.av视频xx999.com| 色视五月天婷婷| 少妇人妻综合色6699| 精品国产人人爱人人| 色婷五月丁香久亚洲| 97色色在线视频| 夜夜大香蕉婷婷丁香| 久热这里只有| 香蕉婷婷五月| 97日日碰碰| 性一交一乱一交A片久久四色| 国产 A片 自拍| 五月开心深深爱激情综合| 麻豆雪千夏| 丁香五月成人| 久久久久久五月天| 色婷婷在线影院| 97干视频| 天天天摸夜夜夜玩| 99re视频在线播放| 亚洲乱码日产精品BD| 人妻日日日| 日韩精品成人在线| 九九sese| 天天天天天久久久久久| 超碰免费人妻| 高清资源站日A美A欧亚…| 六月婷婷综合久久| 六月婷五月丁香| 99热这里只有精品4| 日本久久人人| 亚洲婷婷五月天| 久久婷婷艹| 国产精品久久久久久白浆色欲| 色高清无码视频| 99精品在这里| 99视频只有精品| 9久9久| 久久五月丁香婷婷| 婷婷五月天在婷| 97操操| 99视频日韩| 天天操夜夜爽天天操| 深夜A片| 色五月激情五月开心五月| 极品少妇XXXX精品少妇偷拍| 激情五月天小说网| 日本少妇裸体做爰高潮片| 久久激情天堂| 色宗合久久五月婷婷| 99啪| 五月刺激丁香月综合| 99re热视频这里只有综合亚洲| 五月婷婷第四色| 九月婷婷| 激情视频91| 深爱五月天 开心网| 人人摸人人操人人爽| 五月美女婷婷风骚| 女同激情久久av久久| 狠狠色狠狠色综合日日91| 激情五月久久| 色五月,com| 久久精品五月天| 亚洲人成人五月天| 色色操| 色九月婷婷综合| 亚洲午夜Av| 亚洲久久日| 五月丁香网av| 26uuu欧美激情另类| 五月天综合在线观看| 久久人妻视频| 可以免费观看的av| 乱精品一区字幕二区| 男同色五月开心五月激情五月| 久久婷婷午夜| 欧洲S级在线观看| 久久九九99| 91窝窝| 色小说婷婷五月天天天| 无码色| 91 久热| 色婷婷丁香五月丁香| 天堂在线9| 婷婷五月激情视频网| 丁香网五月天激情| 国产肥白大熟妇BBBB视频| 天天久久66xxx| 9l视频自拍9l视频自拍九色学生| www.婷婷| 五月婷婷在线丁香| 综合激情在线视频| 婷婷综合六| 色五月天在线观看| 玖玖99精品视频| 六月婷婷久久| 丁香五月婷婷社区| 五月丁香六月婷婷免费| 色色吧综合| 色色婷婷色色| 久色资源网| 色欲久久99精品久久久久久| 亚洲色情激情丁香五月| 五月天激情四射| 五月天色导航婷婷资源婷婷| 狠狠色综合网站| 99热免费| 国产精品国产| 婷婷六月激情| 五月丁香综合久久夜夜| 五月天深爱激情网| 日韩在线视频9色| 色色婷婷五月| 色五月播五月| 色婷婷狠狠爱| 亚洲AV网站| 日本综合久久| 98色花堂98t.R| 五月丁香久久呀| 婷婷五月天综合网| 熟女少妇内射日韩亚洲| 五月丁香综合色婷婷| 69久久99精品久久久久| 九九视频网| 婷婷五月天丁香| 91狠狠综合久久久| 欧洲亚洲精品| 思思热国产视频| 97婷婷色| 丁香伊人综合| 国产AV影片| 人妻久久久久久久久久| 另类少妇人与禽zOZZ0性伦| 亚洲五月天天| 另类在线免费视频| 人人操91| 久热九九| 亚洲欧洲色色| 久久caop| 开心婷婷五| 第四色在线观看| 六月亭亭久久综合激情| 婷婷狠狠香蕉综合| 日本婷婷| 五月天婷婷社区久久综合| 日本精品99网站| 性韩日色婷婷五月天激情啪啪XXX| 国产成人AV在线| 精品国产va久久久久| 美女婷婷激情亚洲| 丁香色综合| 五月婷婷色啪| 婷婷97碰碰| 婷婷八月激情| 97色干在线观看| 婷婷瑟瑟五月天| 任你日视频| 丁香五月婷久久| 激情色中文| 大香伊人久色| 丁香五月天综合| 婷婷五月天色| 精品人妻午夜一区二区三区四区 | 色综合久久88色综合天天| 《久久综合九色综合97婷婷| 五月激情站| 噜噜噜噜在线| 久久青青日本视频| 99热精品6| 99热综合色图| 色色无码| 天天草天天日| 大香av| 色色色激情| 黄色av高清| 人妻久久婷婷| 日本丁香五月婷婷| 五月丁香婷婷狠狠操| 日韩高清成人| 欧美丁香六月在线观看视频| 五月婷婷狠狠久久| 久久婷婷丁香六月天| 久久五月天网| 大香蕉久| 亚洲99热| 五月婷婷丁香啪啪| 狠狠爱丁香婷| 婷婷操逼| 婷婷五月激情在线| 丁香五月黄色| 久久免费精彩视频| 色色色无码| 99免费热在线精品| 五月黄色婷婷| Va另类视频| 成人综合视频在线| 99热66| 99热视精品| 久久久大香蕉| 狠狠穞A片一區二區三區| 天天爽天天摸| 人人看人人97| 日韩成人精品中文字幕| av性爱在线| 五月天激情综合网俺也去| yw国产AV| 影音先锋色婷婷| 激情网第四色| www.com.色色| 国产69久久久欧美黑人A片| 丁香婷婷婷五月| 六月婷婷色色色| 亚洲乱码日产精品BD| 日韩AV片| 久久婷五月综合色| se.久久视频在线观看| 四月婷婷五月丁香| 丁香五月综合福利视频导航| 亚洲天堂AV综合网| 婷婷五月激情中文字幕| 久热九九| 墨西哥毛片内射精| 九九热在线99| 亚洲色激情| 日本精品。999| 成人av中文字幕| 五月天开心色色网| 深爱五月激情五月| 五月婷婷六月情| 色青五月天| 26uuu欧美日韩| 成人中文字幕在线| 久久综合26p| 免费观看18视频网站| 久色大|