add readme.md

include/sweet_webots_robot/PathVisualizer.hpp

@@ -9,6 +9,7 @@
 #include <iostream>
 #include <string>
 #include <vector>
+#include <algorithm>
 #include "geometry_msgs/msg/twist.hpp"
 #include "rclcpp/rclcpp.hpp"
 #include "nav_msgs/msg/odometry.hpp"
@@ -58,8 +59,9 @@ private:
     // 定位订阅
     rclcpp::Subscription<geometry_msgs::msg::Pose>::SharedPtr odom_sub_;
     rclcpp::TimerBase::SharedPtr timer_;
-    //
-    std::unique_ptr<tf2_ros::TransformBroadcaster> tf_broadcaster_;
+    
+    // 坐标转换broadcaster
+    std::unique_ptr<tf2_ros::TransformBroadcaster> tf_broadcaster_; // odom -> baselink
 
 private:
     // odom path info 

readme.md

@@ -0,0 +1,13 @@
+/***************************Webots simulation*************************/
+This repository contains the simulation code based on Webots2023a.
+And it is communcatied by ros2 foxy, visualized by rviz2.
+
+Package name: sweet_webots_robot
+Communication Schematic diagram：
+    ![通信示意图](./src/sweet_webots_robot/whiteboard_exported_image.png)  
+1. rm -rf build install log
+2. colcon build
+3. source install/setup.bash
+4. ros2 launch sweet_webots_robot sweet_webots_robot.launch.py
+5. ros2 run sweet_webots_robot path_visualizer
+

src/PathVisualizer.cpp

@@ -639,9 +639,6 @@ void PathVisualizer::publishVehicleTF()
 
     tf_broadcaster_->sendTransform(transform);
 }
-#include <vector>
-#include <cmath>
-#include <algorithm>
 
 void PathVisualizer::densifyPath(double interval)
 {