目录
- 1.基础知识
-
- [1.1 ROS2 humble 安装](#1.1 ROS2 humble 安装)
-
- [1.1.1 使用官方源码进行安装](#1.1.1 使用官方源码进行安装)
- [1.1.2 通过fishros一键安装](#1.1.2 通过fishros一键安装)
- [1.2 使用rqt查看节点之间的关系](#1.2 使用rqt查看节点之间的关系)
- [1.3 Linux系统环境变量](#1.3 Linux系统环境变量)
- 2.节点
-
- [2.1 C++节点示例](#2.1 C++节点示例)
- [2.2 使用功能包组织节点](#2.2 使用功能包组织节点)
-
- [2.2.1 Python](#2.2.1 Python)
- [2.2.2 C++](#2.2.2 C++)
- [2.3 多功能包的最佳实践WorkSpace](#2.3 多功能包的最佳实践WorkSpace)
-
- [2.3.1 多个功能包管理](#2.3.1 多个功能包管理)
- [2.3.2 多个功能包的依赖管理](#2.3.2 多个功能包的依赖管理)
- [2.3.3 选择构建指定的功能包](#2.3.3 选择构建指定的功能包)
- [2.4 C++新特性------函数包装器](#2.4 C++新特性——函数包装器)
- [2.5 多线程与回调函数C++示例](#2.5 多线程与回调函数C++示例)
- 3.话题
-
- [3.1 话题通信介绍](#3.1 话题通信介绍)
- [3.2 通过话题发布小说](#3.2 通过话题发布小说)
1.基础知识
1.1 ROS2 humble 安装
1.1.1 使用官方源码进行安装
-
1.ROS2-humble官网
https://docs.ros.org/en/humble/Installation/Ubuntu-Install-Debs.html#
-
2.安装教程
视频教程:https://www.bilibili.com/video/BV1uz4y1T77g/?spm_id_from=333.880.my_history.page.click
按照视频教程来:
①更换ROS2的key :https://pan.baidu.com/s/1PkZ9zMA2N6K2WTzwEvLrYg?pwd=m36k
②换源
③剩下的指令可以对照视频和官网 的安装指南配合使用
下面补充一些官网上没有的指令
bash
apt-cache policy | grep universe
echo "deb [arch=$(dpkg --print-architecture) signed-by=/usr/share/keyrings/ros-archive-keyring.gpg] https://mirrors.aliyun.com/ros2/ubuntu jammy main" | sudo tee /etc/apt/sources.list.d/ros2.list > /dev/null
echo "source /opt/ros/humble/setup.bash" >> ~/.bashrc
# 检查是否成功
printenv | grep -i ROS
# 测试验证
ros2 run demo_nodes_cpp talker
视频的最后少安装了两个
bash
sudo apt install ros-humble-ros-base
sudo apt install ros-dev-tools # 不安装这个没法colcon build
1.1.2 通过fishros一键安装
bash
wget http://fishros.com/install -O fishros && bash fishros
1.2 使用rqt查看节点之间的关系
- 查看小海龟
bash
# 终端一
ros2 run turtlesim turtlesim_node
# 终端二
ros2 run turtlesim turtle_teleop_key
# 终端三
rqt



1.3 Linux系统环境变量
bash
# 查看ROS版本
echo $ROS_VERSION
# 查看ROS发行版
echo $ROS_DISTRO
# 查看所有的环境变量
printenv
# 查看ros的环境变量
printenv | grep AMENT
# AMENT_PREFIX_PATH=/opt/ros/humble
# 可运行节点都在 /opt/ros/humble/lib 目录下
# 修改环境变量的值,如:
export AMENT_PREFIX_PATH=/opt/ros/
# 每次打开终端前会执行相应脚本,在 .bashrc 文件中
2.节点
2.1 C++节点示例
- CMakeLists.txt
powershell
cmake_minimum_required(VERSION 3.16)
project(ros2_cpp)
add_executable(ros2_cpp_node ros2_cpp_node.cpp)
find_package(rclcpp REQUIRED) # 直接查找到对应的头文件和库文件
message(STATUS ${rclcpp_INCLUDE_DIRS}) # 头文件及rclcpp依赖的头文件
message(STATUS ${rclcpp_LIBRARIES}) # 库文件及rclcpp依赖的库文件
target_include_directories(ros2_cpp_node PUBLIC ${rclcpp_INCLUDE_DIRS}) # 头文件包含
target_link_libraries(ros2_cpp_node ${rclcpp_LIBRARIES}) # 库文件链接
- ros2_cpp_node.cpp
cpp
#include <rclcpp/rclcpp.hpp>
int main(int argc, char** argv)
{
rclcpp::init(argc, argv); // 初始化
auto node = std::make_shared<rclcpp::Node>("cpp_node");
RCLCPP_INFO(node->get_logger(), "Hello C++ node !");
rclcpp::spin(node);
rclcpp::shutdown();
return 0;
}
- 运行
bash
cmake .
make
./ros2_cpp_node
bash
boss-dog@boss-dog:~$ ros2 node list
/cpp_node
boss-dog@boss-dog:~$ ros2 node info /cpp_node
/cpp_node
Subscribers:
/parameter_events: rcl_interfaces/msg/ParameterEvent
Publishers:
/parameter_events: rcl_interfaces/msg/ParameterEvent
/rosout: rcl_interfaces/msg/Log
Service Servers:
/cpp_node/describe_parameters: rcl_interfaces/srv/DescribeParameters
/cpp_node/get_parameter_types: rcl_interfaces/srv/GetParameterTypes
/cpp_node/get_parameters: rcl_interfaces/srv/GetParameters
/cpp_node/list_parameters: rcl_interfaces/srv/ListParameters
/cpp_node/set_parameters: rcl_interfaces/srv/SetParameters
/cpp_node/set_parameters_atomically: rcl_interfaces/srv/SetParametersAtomically
Service Clients:
Action Servers:
Action Clients:
2.2 使用功能包组织节点
2.2.1 Python
- 1.创建一个节点
bash
ros2 pkg create --build-type ament_python --license Apache-2.0 demo_python_pkg
# --build-type: 构建类型
# --license: 许可证
# demo_python_pkg: 功能包名称

- 2.编写节点代码
bash
cd demo_python_pkg
touch cpp_node.py
python
import rclpy
from rclpy.node import Node
def main():
rclpy.init()
node = Node('python_node')
node.get_logger().info('Hello Python node!')
node.get_logger().warn('Hello Python node!')
rclpy.spin(node)
rclpy.shutdown()

- 3.修改
setup.py

增加一行:
python
'python_node = demo_python_pkg.python_node:main'
# python_node:节点名称
# demo_python_pkg:功能包名称
# python_node:节点名称
# main:函数名称

- 4.在
package.xml中增加相关依赖
xml
<depend>rclpy</depend>

- 5.构建功能包,在当前目录下输入
colcon build进行构建 - 6.运行节点,在运行之前需要source下当前的环境变量
bash
# 在demo_python_pkg同级目录下看一下当前的环境变量值
printenv | grep PYTHON
# ROS_PYTHON_VERSION=3
# PYTHONPATH=/opt/ros/humble/lib/python3.10/site-packages:/opt/ros/humble/local/lib/python3.10/dist-packages
printenv | grep AMENT
# AMENT_PREFIX_PATH=/opt/ros/humble
source install/setup.
printenv | grep PYTHON
# ROS_PYTHON_VERSION=3
# PYTHONPATH=/home/boss-dog/002delete/demo_python_pkg/install/demo_python_pkg/lib/python3.10/site-packages:/opt/ros/humble/lib/python3.10/site-packages:/opt/ros/humble/local/lib/python3.10/dist-packages
printenv | grep AMENT
# AMENT_PREFIX_PATH=/home/boss-dog/002delete/demo_python_pkg/install/demo_python_pkg:/opt/ros/humble
bash
colcon build
# Starting >>> demo_python_pkg
# Finished <<< demo_python_pkg [0.50s]
# Summary: 1 package finished [0.65s]
source install/setup.bash
run demo_python_pkg python_node
# [INFO] [1738385465.412217649] [python_node]: Hello Python node!
# [WARN] [1738385465.412501947] [python_node]: Hello Python node!
- 功能包结构

2.2.2 C++
- 1.创建一个节点
bash
ros2 pkg create --build-type ament_cmake --license Apache-2.0 demo_cpp_pkg
# --build-type: 构建类型
# --license: 许可证
# demo_cpp_pkg: 功能包名称

- 2.编写节点代码
bash
cd demo_python_pkg/src
touch cpp_node.cpp
cpp
#include <rclcpp/rclcpp.hpp>
int main(int argc, char** argv)
{
rclcpp::init(argc, argv); // 初始化
auto node = std::make_shared<rclcpp::Node>("cpp_node");
RCLCPP_INFO(node->get_logger(), "Hello C++ node !");
rclcpp::spin(node);
rclcpp::shutdown();
return 0;
}

- 3.修改
CMakeLists.txt
powershell
target_include_directories(cpp_node PUBLIC ${rclcpp_INCLUDE_DIRS}) # 头文件包含
target_link_libraries(cpp_node ${rclcpp_LIBRARIES}) # 库文件链接
# 上面两行指令可以用下面这行指令代替
ament_target_dependencies(cpp_node rclcpp)
powershell
# 将cpp_node拷贝到install目录
install(TARGETS cpp_node
DESTINATION lib/${PROJECT_NAME})
powershell
cmake_minimum_required(VERSION 3.8)
project(demo_cpp_pkg)
if(CMAKE_COMPILER_IS_GNUCXX OR CMAKE_CXX_COMPILER_ID MATCHES "Clang")
add_compile_options(-Wall -Wextra -Wpedantic)
endif()
# find dependencies
find_package(ament_cmake REQUIRED)
find_package(rclcpp REQUIRED) # 直接查找到对应的头文件和库文件
# uncomment the following section in order to fill in
# further dependencies manually.
# find_package(<dependency> REQUIRED)
add_executable(cpp_node src/cpp_node.cpp)
message(STATUS ${rclcpp_INCLUDE_DIRS}) # 头文件及rclcpp依赖的头文件
message(STATUS ${rclcpp_LIBRARIES}) # 库文件及rclcpp依赖的库文件
# target_include_directories(cpp_node PUBLIC ${rclcpp_INCLUDE_DIRS}) # 头文件包含
# target_link_libraries(cpp_node ${rclcpp_LIBRARIES}) # 库文件链接
# 上面两行指令可以用下面这行指令代替
ament_target_dependencies(cpp_node rclcpp)
# 将cpp_node拷贝到install目录
install(TARGETS cpp_node
DESTINATION lib/${PROJECT_NAME})
if(BUILD_TESTING)
find_package(ament_lint_auto REQUIRED)
# the following line skips the linter which checks for copyrights
# comment the line when a copyright and license is added to all source files
set(ament_cmake_copyright_FOUND TRUE)
# the following line skips cpplint (only works in a git repo)
# comment the line when this package is in a git repo and when
# a copyright and license is added to all source files
set(ament_cmake_cpplint_FOUND TRUE)
ament_lint_auto_find_test_dependencies()
endif()
ament_package()

- 4.在
package.xml中增加相关依赖
xml
<depend>rclcpp</depend>

- 5.构建功能包,在当前目录下输入
colcon build进行构建 - 6.运行节点,在运行之前需要source下当前的环境变量
bash
colcon build
# Starting >>> demo_cpp_pkg
# Finished <<< demo_cpp_pkg [0.19s]
# Summary: 1 package finished [0.50s]
source install/setup.bash
ros2 run demo_cpp_pkg cpp_node
# [INFO] [1738397791.407144803] [cpp_node]: Hello C++ node !
- 功能包结构

2.3 多功能包的最佳实践WorkSpace
一个完整的机器人项目往往由多个不同的功能模块组成,所以就需要对多个功能包进行组合。
ROS2开发者约定了WorkSpace------即工作空间这一概念。
2.3.1 多个功能包管理
- 新建一个工作空间
bash
mkdir -p demo_ws/src
- 将之前的两个功能包
demo_cpp_pkg和demo_python_pkg拷贝到demo_ws/src目录下

- 在
demo_ws工作空间的同级目录下,构建多个功能包。可以看到,先构建的是demo_cpp_pkg,然后是demo_python_pkg
bash
colcon build
# Starting >>> demo_cpp_pkg
# Starting >>> demo_python_pkg
# Finished <<< demo_python_pkg [0.51s]
# Finished <<< demo_cpp_pkg [2.69s]
# Summary: 2 packages finished [2.84s]
2.3.2 多个功能包的依赖管理
根据上面的构建日志,可以看到先构建的是demo_cpp_pkg,然后是demo_python_pkg,如果demo_cpp_pkg依赖的是demo_python_pkg,就需要先构建demo_python_pkg,然后构建demo_cpp_pkg。
- 通过
package.xml来控制依赖关系
修改demo_cpp_pkg/package.xml,添加需要demo_python_pkg的依赖

再次构建可以发现,先构建的是demo_python_pkg,然后是demo_cpp_pkg
bash
colcon build
# Starting >>> demo_python_pkg
# Finished <<< demo_python_pkg [0.56s]
# Starting >>> demo_cpp_pkg
# Finished <<< demo_cpp_pkg [0.43s]
# Summary: 2 packages finished [1.13s]
2.3.3 选择构建指定的功能包
bash
colcon build --packages-select demo_cpp_pkg
# Starting >>> demo_cpp_pkg
# Finished <<< demo_cpp_pkg [0.56s]
# Summary: 1 package finished [0.73s]
2.4 C++新特性------函数包装器
在ROS2中,经常会把成员函数作为回调函数去使用。通过函数包装器之后,不会拥有类的对象,这样就可以避免操作对象中的其他成员方法。
cpp
#include <iostream>
#include <functional> // 函数包装器头文件
// 1.自由函数
void save_with_free_fun(const std::string &file_name)
{
std::cout << "自由函数:" << file_name << std::endl;
}
// 2.成员函数
class FileSave
{
public:
FileSave() = default;
~FileSave() = default;
void save_with_member_fun(const std::string &file_name) { std::cout << "成员方法:" << file_name << std::endl; }
};
int main(int argc, char **argv)
{
FileSave file_save;
// 3.Lambda函数
auto save_with_lambda_fun = [](const std::string &file_name) -> void {
std::cout << "Lambda 函数:" << file_name << std::endl;
};
save_with_free_fun("file.txt");
file_save.save_with_member_fun("file.txt");
save_with_lambda_fun("file.txt");
std::cout << "========================" << std::endl;
std::function<void(const std::string &)> save1 = save_with_free_fun;
std::function<void(const std::string &)> save2 = save_with_lambda_fun;
// 成员函数,放入包装器
std::function<void(const std::string &)> save3 =
std::bind(&FileSave::save_with_member_fun, &file_save, std::placeholders::_1);
// 统一的调用方法
save1("file.txt");
save2("file.txt");
save3("file.txt");
return 0;
}
2.5 多线程与回调函数C++示例
- 1.启动http服务端
任意一个目录下新建三个txt文件,随意在里面添加内容(不要太多,否则等待时间需要加长),终端输入
bash
python3 -m http.server
# Serving HTTP on 0.0.0.0 port 8000 (http://0.0.0.0:8000/) ...
打开浏览器,输入 http://0.0.0.0:8000/,可以看到三个txt文件已经长传到了服务端上

- 2.下载 C++11 单文件头文件的跨平台 HTTP/HTTPS 库
在原工程下新建一个include文件夹,下载HTTP/HTTPS 库
bash
cd include
git clone https://gitee.com/ohhuo/cpp-httplib.git

在CMakeLists.txt中包含include头文件目录
powershell
include_directories(include) # 包含include头文件目录

- 3.源码
CMakeLists.txt
powershell
cmake_minimum_required(VERSION 3.8)
project(demo_cpp_pkg)
if(CMAKE_COMPILER_IS_GNUCXX OR CMAKE_CXX_COMPILER_ID MATCHES "Clang")
add_compile_options(-Wall -Wextra -Wpedantic)
endif()
# find dependencies
find_package(ament_cmake REQUIRED)
find_package(rclcpp REQUIRED) # 直接查找到对应的头文件和库文件
# uncomment the following section in order to fill in
# further dependencies manually.
# find_package(<dependency> REQUIRED)
include_directories(include) # 包含include头文件目录
add_executable(cpp_node src/cpp_node.cpp)
message(STATUS ${rclcpp_INCLUDE_DIRS}) # 头文件及rclcpp依赖的头文件
message(STATUS ${rclcpp_LIBRARIES}) # 库文件及rclcpp依赖的库文件
# target_include_directories(cpp_node PUBLIC ${rclcpp_INCLUDE_DIRS}) # 头文件包含
# target_link_libraries(cpp_node ${rclcpp_LIBRARIES}) # 库文件链接
# 上面两行指令可以用下面这行指令代替
ament_target_dependencies(cpp_node rclcpp)
# 将cpp_node拷贝到install目录
install(TARGETS cpp_node
DESTINATION lib/${PROJECT_NAME})
if(BUILD_TESTING)
find_package(ament_lint_auto REQUIRED)
# the following line skips the linter which checks for copyrights
# comment the line when a copyright and license is added to all source files
set(ament_cmake_copyright_FOUND TRUE)
# the following line skips cpplint (only works in a git repo)
# comment the line when this package is in a git repo and when
# a copyright and license is added to all source files
set(ament_cmake_cpplint_FOUND TRUE)
ament_lint_auto_find_test_dependencies()
endif()
ament_package()
cpp_node.cpp
cpp
#include <iostream>
#include <string>
#include <thread>
#include <chrono>
#include <functional> // 函数包装器
#include "cpp-httplib/httplib.h"
class Download
{
public:
void download(const std::string &host,
const std::string &path,
const std::function<void(const std::string &, const std::string &)> &callback_word_count)
{
std::cout << "线程 " << std::this_thread::get_id() << std::endl;
httplib::Client client(host);
auto response = client.Get(path);
if (response && response->status == 200) {
callback_word_count(path, response->body);
}
};
void start_download(const std::string &host,
const std::string &path,
const std::function<void(const std::string &, const std::string &)> &callback_word_count)
{
auto download_fun =
std::bind(&Download::download, this, std::placeholders::_1, std::placeholders::_2, std::placeholders::_3);
std::thread thread(download_fun, host, path, callback_word_count);
thread.detach();
};
};
int main()
{
auto d = Download();
auto word_count = [](const std::string &path, const std::string &result) -> void {
std::cout << "下载完成 " << path << ":" << result.length() << "->" << result.substr(0, 9) << std::endl;
};
d.start_download("http://0.0.0.0:8000", "/novel_1.txt", word_count);
d.start_download("http://0.0.0.0:8000", "/novel_2.txt", word_count);
d.start_download("http://0.0.0.0:8000", "/novel_3.txt", word_count);
std::this_thread::sleep_for(std::chrono::milliseconds(1000 * 10));
return 0;
}
运行:
bash
source install/setup.bash
ros2 run demo_cpp_pkg cpp_node
# 线程 130313529329216
# 线程 130313508357696
# 线程 130313518843456
# 下载完成 /novel_1.txt:23->第一章
# 下载完成 /novel_3.txt:27->第三章
# 下载完成 /novel_2.txt:25->第二章
3.话题
3.1 话题通信介绍
这里以小海龟为例:
- 启动
turtlesim_node节点
bash
ros2 run turtlesim turtlesim_node
- 启动另一个终端查看
turtlesim_node的具体信息
bash
$ ros2 node list
/turtlesim
$ ros2 node info /turtlesim
/turtlesim
Subscribers:
/parameter_events: rcl_interfaces/msg/ParameterEvent
/turtle1/cmd_vel: geometry_msgs/msg/Twist # 控制小海龟移动
Publishers:
/parameter_events: rcl_interfaces/msg/ParameterEvent
/rosout: rcl_interfaces/msg/Log
/turtle1/color_sensor: turtlesim/msg/Color
/turtle1/pose: turtlesim/msg/Pose # 小海龟实时位置信息
Service Servers:
/clear: std_srvs/srv/Empty
/kill: turtlesim/srv/Kill
/reset: std_srvs/srv/Empty
/spawn: turtlesim/srv/Spawn
/turtle1/set_pen: turtlesim/srv/SetPen
/turtle1/teleport_absolute: turtlesim/srv/TeleportAbsolute
/turtle1/teleport_relative: turtlesim/srv/TeleportRelative
/turtlesim/describe_parameters: rcl_interfaces/srv/DescribeParameters
/turtlesim/get_parameter_types: rcl_interfaces/srv/GetParameterTypes
/turtlesim/get_parameters: rcl_interfaces/srv/GetParameters
/turtlesim/list_parameters: rcl_interfaces/srv/ListParameters
/turtlesim/set_parameters: rcl_interfaces/srv/SetParameters
/turtlesim/set_parameters_atomically: rcl_interfaces/srv/SetParametersAtomically
Service Clients:
Action Servers:
/turtle1/rotate_absolute: turtlesim/action/RotateAbsolute
Action Clients:
- 实时查看小海龟位置信息的话题信息
bash
$ ros2 topic echo /turtle1/pose
x: 5.544444561004639
y: 5.544444561004639
theta: 0.0 # 角度(弧度),逆时针为正,顺时针为负
linear_velocity: 0.0 # 线速度
angular_velocity: 0.0 # 角速度
- 查看控制小海龟移动的话题信息
bash
$ ros2 topic info /turtle1/cmd_vel -v
Type: geometry_msgs/msg/Twist
Publisher count: 0
Subscription count: 1
Node name: turtlesim
Node namespace: /
Topic type: geometry_msgs/msg/Twist
Endpoint type: SUBSCRIPTION
GID: 01.0f.99.ad.ad.9d.e9.c8.00.00.00.00.00.00.1b.04.00.00.00.00.00.00.00.00
QoS profile:
Reliability: RELIABLE
History (Depth): UNKNOWN
Durability: VOLATILE
Lifespan: Infinite
Deadline: Infinite
Liveliness: AUTOMATIC
Liveliness lease duration: Infinite
- 显示
geometry_msgs/msg/Twist消息的字段定义,包括线性速度和角速度这两个主要参数
ROS2中坐标系,以小海龟为例,遵循右手定则,X轴垂直向上,Y轴水平向左,Z轴由XY平面朝外
bash
$ ros2 interface show geometry_msgs/msg/Twist
# This expresses velocity in free space broken into its linear and angular parts.
Vector3 linear
float64 x
float64 y
float64 z
Vector3 angular
float64 x
float64 y
float64 z
- 发布一个
geometry_msgs/msg/Twist消息到 ROS2 系统中的一个话题/turtle1/cmd_vel,控制小海龟移动
bash
# 控制小海龟在 X 轴上以速度 0.5 向前移动,同时不进行 Y 轴移动或旋转
$ ros2 topic pub /turtle1/cmd_vel geometry_msgs/msg/Twist "{linear: {x: 0.5, y: 0.0} , angular: {z: 0.0}}"
# 顺时针旋转
$ ros2 topic pub /turtle1/cmd_vel geometry_msgs/msg/Twist "{linear: {x: 0.0, y: 0.0} , angulalar: {z: -1.0}}"
# 同时给线速度和角速度,让小海龟画圆
$ ros2 topic pub /turtle1/cmd_vel geometry_msgs/msg/Twist "{linear: {x: 1.0, y: 0.0} , angular: {z: -1.0}}"
$ ros2 topic pub --help