This repository contains the stanley_controller package for ROS2, enabling better control for F1/10 autonomous racing.
sudo apt-get install libeigen3-dev
sudo apt install ros-<ros2-distro>-ackermann-msgsThe Stanley controller, often referred to as a lateral controller. Its primary role is to reduce the cross-track error (the lateral distance between the vehicle's current position and a reference path) as the vehicle progresses forward. By doing so, the Stanley controller ensures that the vehicle follows the desired trajectory as closely as possible. We use the yaw of the path making a subset of interpollated waypoints that are within some lookahead distance from the closest point to the car.
cd ~/ros2_ws
source /opt/ros/foxy/setup.bash #for ros2 foxy
source /opt/ros/humble/setup.bash #for ro2 humble
colcon build --packages-select stanley_node_pkg
source install/setup.bash
ros2 launch stanley_node_pkg stanley_controller.launch.pyBy subscribing to the /scan topic, the node processes sensor_msgs::LaserScan data, identifying clusters (or groups) of points that represent obstacles based on their proximity, and visualizes these obstacles as point clusters using markers in the rviz visualization tool. Also, it computes the size of the cluster and the average distance of points in that cluster. It use the geometry_msgs::msg::Point message to represent a point in a 3D space, with its x, y, and z components, it provides a standard, consistent, and compatible way to represent, process, and visualize the spatial points derived from the LaserScan data.
cd ~/ros2_ws
source /opt/ros/foxy/setup.bash #for ros2 foxy
source /opt/ros/humble/setup.bash #for ro2 humble
colcon build --packages-select obstacle_pkg
source install/setup.bash
ros2 launch obstacle_pkg Obstacles.launch.pycd ~/ros2_ws
source /opt/ros/foxy/setup.bash #for ros2 foxy
source /opt/ros/humble/setup.bash #for ro2 humble
colcon build --packages-select frenet_pkg
source install/setup.bash
ros2 launch frenet_pkg Frenet_frame.launch.pyf1_tenth_ros2/
|-- regulated_pure_pursuit
|-- obstacle_pkg
|-- waypoint_visualizer