00c18932-581b-4473-a8f4-6b717984c08e-image.png

bd258953-bc17-4c7c-99d7-f890a20f049c-图片.png

使用ROS2 humble开发机器人导航系统，主控机除了接入底盘STM32外，还接入了雷达和IMU。
请问我该选择树莓派4B还是5B？

运行如下代码时，如果使用fish的源码会出现的问题，
a5b2f5c7-de48-4b96-b3e4-db418b84034e.png
有:
50a0e1bb-a315-4de2-b706-004f298f95f7.png
就是时间戳的问题，因为我增大过slam_toolbox的online_async这个文件的配置文件的栈的大小和保存数据的时间但是都没有效果,也不是网络问题，然后就发现了只可能是时间戳的问题。电脑有自己的时钟，小车也是，就发现了odom2tf.cpp文件里面的一个地方出现了问题，时间戳应该都要用电脑的时间戳，不能两者混在一起。
具体的解释你们可以把代码发给AI问一下，我可能说的不清除，但是一定能解决。
只要按照下面的方法把时间戳统一到电脑的就完美解决问题了,
找到odom2tf.cpp文件，按照下面的改:
de71100b-d44d-4862-a5cb-bec133d9c35f.png
😊 😊 😊 😊

报错代码如下

Processing featheresp32 (platform: espressif32; board: featheresp32; framework: arduino) -------------------------------------------------------------------------------- Tool Manager: Installing espressif/toolchain-xtensa-esp32 @ 8.4.0+2021r2-patch5 Tool Manager: Error: Please read https://bit.ly/package-manager-ioerror Tool Manager: Warning! Package Mirror: HTTPSConnectionPool(host='dl.registry.ns3.platformio.org', port=443): Max retries exceeded with url: /tools/58/c9/d6f867f93b6e55491c200cb539274c8ae3dccf76daf29428aa64dd54d727/toolchain-xtensa-esp32-linux_x86_64-8.4.0+2021r2-patch5.tar.gz (Caused by ProxyError('Unable to connect to proxy', ConnectTimeoutError(<urllib3.connection.HTTPSConnection object at 0x7cf79f596140>, 'Connection to fishros.org timed out. (connect timeout=10)')))

是跟镜像问题相关吗？我在安装PlateformIO MicroROS开发环境前已经用一键安装命令更换了系统镜像源，并且根据视频教程【《ROS 2机器人开发从入门到实践》9.2.1开发平台介绍与安装】 https://www.bilibili.com/video/BV1pLf2YxEzv/?share_source=copy_web&vd_source=b55b762ce28a6ddb1537f871dc7d4a1d 配置完platformio.ini文件后，用

pio run

编译运行时下载速度也特别慢。求各位大佬指点下解决方法。

如题，我自己整了个YDLIDAR X2激光雷达，用wifi发给电脑能收到，但是小鱼的雷达驱动的tcp通信无法解析，我想知道通信协议。

在该链接查看解决方法链接文本

76162e46-9d64-41e1-985a-481507dcac80-image.png
12824ad3-3f06-4c5d-a064-4c1e9540beb4-0029b53689dcd18093659ce8cf1be40d_720.jpg
93c4400b-db9b-4cae-9b8d-977c5173c47e-71e7b2a5d6f139a4972d6c06b4d669bd_720.jpg
鱼哥，wifi连接正常，雷达模式调到了WiFi模式，小车和虚拟机都连接到了一个WiFi，但是接收不到雷达数据，请问是什么原因呢

虚拟机使用VM，系统乌班图22.04
d05a7d8c-33b3-4f47-b9c4-22b0e579be28-image.png
ub@ub-virtual-machine:~/chapt6/chapt6_ws$ ros2 launch fishbot_description gazebo_sim.launch.py
[INFO] [launch]: All log files can be found below /home/ub/.ros/log/2025-07-16-20-10-55-594522-ub-virtual-machine-4590
[INFO] [launch]: Default logging verbosity is set to INFO
[INFO] [robot_state_publisher-1]: process started with pid [4595]
[INFO] [gzserver-2]: process started with pid [4597]
[INFO] [gzclient-3]: process started with pid [4599]
[INFO] [spawn_entity.py-4]: process started with pid [4601]
[robot_state_publisher-1] [INFO] [1752667856.267970093] [robot_state_publisher]: got segment back_caster_link
[robot_state_publisher-1] [INFO] [1752667856.268156632] [robot_state_publisher]: got segment base_footprint
[robot_state_publisher-1] [INFO] [1752667856.268172869] [robot_state_publisher]: got segment base_link
[robot_state_publisher-1] [INFO] [1752667856.268181356] [robot_state_publisher]: got segment camera_link
[robot_state_publisher-1] [INFO] [1752667856.268188438] [robot_state_publisher]: got segment camera_optical_link
[robot_state_publisher-1] [INFO] [1752667856.268195597] [robot_state_publisher]: got segment front_caster_link
[robot_state_publisher-1] [INFO] [1752667856.268202887] [robot_state_publisher]: got segment imu_link
[robot_state_publisher-1] [INFO] [1752667856.268209962] [robot_state_publisher]: got segment laser_cylinder_link
[robot_state_publisher-1] [INFO] [1752667856.268216871] [robot_state_publisher]: got segment laser_link
[robot_state_publisher-1] [INFO] [1752667856.268223440] [robot_state_publisher]: got segment left_wheel_link
[robot_state_publisher-1] [INFO] [1752667856.268230619] [robot_state_publisher]: got segment right_wheel_link
[gzclient-3] Gazebo multi-robot simulator, version 11.10.2
[gzclient-3] Copyright (C) 2012 Open Source Robotics Foundation.
[gzclient-3] Released under the Apache 2 License.
[gzclient-3] http://gazebosim.org
[gzclient-3]
[gzserver-2] Gazebo multi-robot simulator, version 11.10.2
[gzserver-2] Copyright (C) 2012 Open Source Robotics Foundation.
[gzserver-2] Released under the Apache 2 License.
[gzserver-2] http://gazebosim.org
[gzserver-2]
[spawn_entity.py-4] [INFO] [1752667856.804856341] [spawn_entity]: Spawn Entity started
[spawn_entity.py-4] [INFO] [1752667856.805229257] [spawn_entity]: Loading entity published on topic /robot_description
[spawn_entity.py-4] [INFO] [1752667856.807024211] [spawn_entity]: Waiting for entity xml on /robot_description
[gzserver-2] [Wrn] [gazebo_ros_init.cpp:178]
[gzserver-2] # # ####### ####### ### ##### #######
[gzserver-2] ## # # # # # # # #
[gzserver-2] # # # # # # # # #
[gzserver-2] # # # # # # # # #####
[gzserver-2] # # # # # # # # #
[gzserver-2] # ## # # # # # # #
[gzserver-2] # # ####### # ### ##### #######
[gzserver-2]
[gzserver-2] This version of Gazebo, now called Gazebo classic, reaches end-of-life
[gzserver-2] in January 2025. Users are highly encouraged to migrate to the new Gazebo
[gzserver-2] using our migration guides (https://gazebosim.org/docs/latest/gazebo_classic_migration?utm_source=gazebo_ros_pkgs&utm_medium=cli)
[gzserver-2]
[gzserver-2]
[spawn_entity.py-4] [INFO] [1752667856.911160252] [spawn_entity]: Waiting for service /spawn_entity, timeout = 30
[spawn_entity.py-4] [INFO] [1752667856.911831738] [spawn_entity]: Waiting for service /spawn_entity
[gzserver-2] [Msg] Waiting for master.
[gzserver-2] [Msg] Connected to gazebo master @ http://127.0.0.1:11345
[gzserver-2] [Msg] Publicized address: 192.168.28.130
[gzserver-2] [Err] [RTShaderSystem.cc:480] Unable to find shader lib. Shader generating will fail. Your GAZEBO_RESOURCE_PATH is probably improperly set. Have you sourced <prefix>/share/gazebo/setup.bash?
[gzclient-3] [Msg] Waiting for master.
[gzclient-3] [Msg] Connected to gazebo master @ http://127.0.0.1:11345
[gzclient-3] [Msg] Publicized address: 192.168.28.130
[gzclient-3] [Err] [RTShaderSystem.cc:480] Unable to find shader lib. Shader generating will fail. Your GAZEBO_RESOURCE_PATH is probably improperly set. Have you sourced <prefix>/share/gazebo/setup.bash?
[gzclient-3] [Wrn] [GuiIface.cc:120] Could not find the Qt platform plugin "wayland" in ""
[spawn_entity.py-4] [INFO] [1752667857.956423711] [spawn_entity]: Calling service /spawn_entity
[gzserver-2] [Msg] Loading world file [/home/ub/chapt6/chapt6_ws/install/fishbot_description/share/fishbot_description/world/custom_room.world]
[gzserver-2] [Err] [RenderEngine.cc:197] Failed to initialize scene
[gzserver-2] gzserver: /usr/include/boost/smart_ptr/shared_ptr.hpp:728: typename boost::detail::sp_member_access<T>::type boost::shared_ptr<T>::operator->() const [with T = gazebo::rendering::Scene; typename boost::detail::sp_member_access<T>::type = gazebo::rendering::Scene*]: Assertion `px != 0' failed.
[ERROR] [gzserver-2]: process has died [pid 4597, exit code -6, cmd 'gzserver /home/ub/chapt6/chapt6_ws/install/fishbot_description/share/fishbot_description/world/custom_room.world --verbose -slibgazebo_ros_init.so -slibgazebo_ros_factory.so -slibgazebo_ros_force_system.so'].
[gzserver-2]
[gzclient-3] [Err] [Scene.cc:227] Service call[/shadow_caster_material_name] timed out
[gzclient-3] [Err] [Scene.cc:249] Service call[/shadow_caster_render_back_faces] timed out
[gzclient-3] [Err] [RenderEngine.cc:197] Failed to initialize scene
[gzclient-3] [Err] [GLWidget.cc:177] GLWidget could not create a scene. This will likely result in a blank screen.
[gzclient-3] gzclient: /usr/include/boost/smart_ptr/shared_ptr.hpp:728: typename boost::detail::sp_member_access<T>::type boost::shared_ptr<T>::operator->() const [with T = gazebo::rendering::Camera; typename boost::detail::sp_member_access<T>::type = gazebo::rendering::Camera*]: 断言 "px != 0" 失败。
[ERROR] [gzclient-3]: process has died [pid 4599, exit code -6, cmd 'gzclient --gui-client-plugin=libgazebo_ros_eol_gui.so --verbose'].
[gzclient-3]
^C[WARNING] [launch]: user interrupted with ctrl-c (SIGINT)
[robot_state_publisher-1] [INFO] [1752667879.936981925] [rclcpp]: signal_handler(signum=2)
[spawn_entity.py-4] Traceback (most recent call last):
[spawn_entity.py-4] File "/opt/ros/humble/lib/gazebo_ros/spawn_entity.py", line 372, in <module>
[spawn_entity.py-4] main()
[spawn_entity.py-4] File "/opt/ros/humble/lib/gazebo_ros/spawn_entity.py", line 367, in main
[spawn_entity.py-4] exit_code = spawn_entity_node.run()
[spawn_entity.py-4] File "/opt/ros/humble/lib/gazebo_ros/spawn_entity.py", line 228, in run
[spawn_entity.py-4] success = self._spawn_entity(entity_xml, initial_pose, spawn_service_timeout)
[spawn_entity.py-4] File "/opt/ros/humble/lib/gazebo_ros/spawn_entity.py", line 290, in _spawn_entity
[spawn_entity.py-4] rclpy.spin_once(self)
[spawn_entity.py-4] File "/opt/ros/humble/local/lib/python3.10/dist-packages/rclpy/init.py", line 206, in spin_once
[spawn_entity.py-4] executor.spin_once(timeout_sec=timeout_sec)
[spawn_entity.py-4] File "/opt/ros/humble/local/lib/python3.10/dist-packages/rclpy/executors.py", line 751, in spin_once
[spawn_entity.py-4] self._spin_once_impl(timeout_sec)
[spawn_entity.py-4] File "/opt/ros/humble/local/lib/python3.10/dist-packages/rclpy/executors.py", line 740, in _spin_once_impl
[spawn_entity.py-4] handler, entity, node = self.wait_for_ready_callbacks(timeout_sec=timeout_sec)
[spawn_entity.py-4] File "/opt/ros/humble/local/lib/python3.10/dist-packages/rclpy/executors.py", line 723, in wait_for_ready_callbacks
[spawn_entity.py-4] return next(self._cb_iter)
[spawn_entity.py-4] File "/opt/ros/humble/local/lib/python3.10/dist-packages/rclpy/executors.py", line 620, in _wait_for_ready_callbacks
[spawn_entity.py-4] wait_set.wait(timeout_nsec)
[spawn_entity.py-4] KeyboardInterrupt
[ERROR] [spawn_entity.py-4]: process has died [pid 4601, exit code -2, cmd '/opt/ros/humble/lib/gazebo_ros/spawn_entity.py -topic /robot_description -entity fishbot --ros-args'].
[INFO] [robot_state_publisher-1]: process has finished cleanly [pid 4595]

shaannj@shaannj-virtual-machine:~$ sudo apt install ros-humble-tf-transformations
[sudo] shaannj 的密码：
正在读取软件包列表... 完成
正在分析软件包的依赖关系树... 完成
正在读取状态信息... 完成
下列【新】软件包将被安装：
ros-humble-tf-transformations
升级了 0 个软件包，新安装了 1 个软件包，要卸载 0 个软件包，有 276 个软件包未被升级。
需要下载 19.6 kB 的归档。
解压缩后会消耗 110 kB 的额外空间。
错误:1 http://mirrors.tuna.tsinghua.edu.cn/ros2/ubuntu jammy/main amd64 ros-humble-tf-transformations amd64 1.1.0-1jammy.20250325.170033
404 Not Found [IP: 2402:f000:1:400::2 80]
E: 无法下载 http://mirrors.tuna.tsinghua.edu.cn/ros2/ubuntu/pool/main/r/ros-humble-tf-transformations/ros-humble-tf-transformations_1.1.0-1jammy.20250325.170033_amd64.deb 404 Not Found [IP: 2402:f000:1:400::2 80]
E: 有几个软件包无法下载，要不运行 apt-get update 或者加上 --fix-missing 的选项再试试？

如题，楼主的ubuntu安装在win11的wsl2上，
numpy是安装在win系统中的，
但是根据AI，一般来说ros2调用numpy，会直接链接到ubuntu之外的numpy即win上的那个。
然后楼主根据AI的建议，重新设置了这个链接。

楼主问AI结果如下：
708ffdef-2232-49d7-a35f-c289188fd931-image.png

重新设置的代码如下。
555e9364-eba2-492b-b4f1-f627cc0fbbd8-image.png

起因：楼主正在学小鱼教程里手搓python节点的练习，colcon和source都正常，也已经安装了numpy，但是ros2 run 的时候报错。报错内容如下。

ros2 run village_li li4_node
Traceback (most recent call last):
File "/root/town_ws/install/village_li/lib/village_li/li4_node", line 33, in <module>
sys.exit(load_entry_point('village_li==0.0.0', 'console_scripts', 'li4_node')())
^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^
File "/root/town_ws/install/village_li/lib/python3.12/site-packages/village_li/li4.py", line 7, in main
li4_node = Node('li4') # 创建节点
^^^^^^^^^^^
File "/opt/ros/jazzy/lib/python3.12/site-packages/rclpy/node.py", line 240, in init
self._parameter_service = ParameterService(self)
^^^^^^^^^^^^^^^^^^^^^^
File "/opt/ros/jazzy/lib/python3.12/site-packages/rclpy/parameter_service.py", line 35, in init
node.create_service(
File "/opt/ros/jazzy/lib/python3.12/site-packages/rclpy/node.py", line 1725, in create_service
check_is_valid_srv_type(srv_type)
File "/opt/ros/jazzy/lib/python3.12/site-packages/rclpy/type_support.py", line 51, in check_is_valid_srv_type
check_for_type_support(srv_type)
File "/opt/ros/jazzy/lib/python3.12/site-packages/rclpy/type_support.py", line 29, in check_for_type_support
msg_or_srv_type.class.import_type_support()
File "/opt/ros/jazzy/lib/python3.12/site-packages/rcl_interfaces/srv/_describe_parameters.py", line 527, in import_type_support
_describe_parameters.Metaclass_DescribeParameters_Event.import_type_support()
File "/opt/ros/jazzy/lib/python3.12/site-packages/rcl_interfaces/srv/_describe_parameters.py", line 341, in import_type_support
from service_msgs.msg import ServiceEventInfo
File "/opt/ros/jazzy/lib/python3.12/site-packages/service_msgs/msg/init.py", line 1, in <module>
from service_msgs.msg._service_event_info import ServiceEventInfo # noqa: F401
^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^
File "/opt/ros/jazzy/lib/python3.12/site-packages/service_msgs/msg/_service_event_info.py", line 18, in <module>
import numpy # noqa: E402, I100
^^^^^^^^^^^^
ModuleNotFoundError: No module named 'numpy'
[ros2run]: Process exited with failure 1

希望各位大神帮帮忙呀！小仙什么都会做的（跪

我在编译一个gazebo仿真项目的时候出现缺少包的情况，这个开源项目的环境是ros2Humble与我的系统环境一致，并且这个项目在intel的NUC工控机上能成功编译并且运行，但是在我自己的电脑上编译出现问题

项目地址：https://github.com/robomaster-oss/rmoss_gazebo.git

系统环境：
Ubuntu22.04
Ros2Humble
笔记本双系统，非ARM架构

spaaaaace@spaaaaace-DRA-XX:~/Code/HBUT2025_rm_vision/lc_navigation/lc_navigation_2025/simulation_ws$ colcon build Starting >>> rmoss_interfaces Starting >>> rmoss_gz_resources Starting >>> rmoss_gz_plugins Starting >>> rmoss_projectile_motion Starting >>> sdformat_tools Finished <<< rmoss_gz_resources [0.23s] Finished <<< rmoss_gz_plugins [0.25s] Finished <<< rmoss_projectile_motion [0.25s] Finished <<< sdformat_tools [0.62s] Starting >>> pb2025_robot_description Finished <<< pb2025_robot_description [0.06s] Finished <<< rmoss_interfaces [0.89s] Starting >>> rmoss_util Starting >>> rmoss_base Starting >>> rmoss_gz_base Starting >>> rmoss_gz_bridge Starting >>> rmoss_gz_cam Finished <<< rmoss_util [0.13s] Starting >>> rmoss_cam Finished <<< rmoss_base [0.13s] --- stderr: rmoss_gz_cam CMake Error at CMakeLists.txt:19 (find_package): By not providing "Findros_gz_bridge.cmake" in CMAKE_MODULE_PATH this project has asked CMake to find a package configuration file provided by "ros_gz_bridge", but CMake did not find one. Could not find a package configuration file provided by "ros_gz_bridge" with any of the following names: ros_gz_bridgeConfig.cmake ros_gz_bridge-config.cmake Add the installation prefix of "ros_gz_bridge" to CMAKE_PREFIX_PATH or set "ros_gz_bridge_DIR" to a directory containing one of the above files. If "ros_gz_bridge" provides a separate development package or SDK, be sure it has been installed. --- Failed <<< rmoss_gz_cam [0.36s, exited with code 1] Aborted <<< rmoss_gz_base [0.41s] Aborted <<< rmoss_gz_bridge [0.42s] Aborted <<< rmoss_cam [0.40s] Summary: 8 packages finished [1.59s] 1 package failed: rmoss_gz_cam 3 packages aborted: rmoss_cam rmoss_gz_base rmoss_gz_bridge 4 packages had stderr output: rmoss_cam rmoss_gz_base rmoss_gz_bridge rmoss_gz_cam 2 packages not processed

缺少ros_gz_bridge这个包，尝试通过apt安装：sudo apt install ros-humble-ros-gz-bridge
报错

spaaaaace@spaaaaace-DRA-XX:~/Code/HBUT2025_rm_vision/lc_navigation/lc_navigation_2025/simulation_ws$ sudo apt install ros-humble-ros-gz-bridge 正在读取软件包列表... 完成 正在分析软件包的依赖关系树... 完成 正在读取状态信息... 完成 没有可用的软件包 ros-humble-ros-gz-bridge，但是它被其它的软件包引用了。 这可能意味着这个缺失的软件包可能已被废弃， 或者只能在其他发布源中找到 E: 软件包 ros-humble-ros-gz-bridge 没有可安装候选

查看官网的文档，使用官方的推荐ROS2Humble下载方法：sudo apt-get install ros-${ROS_DISTRO}-ros-gz还是出现同样的报错

spaaaaace@spaaaaace-DRA-XX:~/Code/HBUT2025_rm_vision/lc_navigation/lc_navigation_2025/simulation_ws$ sudo apt-get install ros-${ROS_DISTRO}-ros-gz 正在读取软件包列表... 完成 正在分析软件包的依赖关系树... 完成 正在读取状态信息... 完成 没有可用的软件包 ros-humble-ros-gz，但是它被其它的软件包引用了。 这可能意味着这个缺失的软件包可能已被废弃， 或者只能在其他发布源中找到 E: 软件包 ros-humble-ros-gz 没有可安装候选

尝试过换源，无果，求助

一、手动切换模式

配置好雷达的wifi_ssid、wifi_pswd、server_ip,net_mode为默认的tcp
将跳帽修改到串口模式，跳帽接法如下图所示

8246065e-2fc2-4743-a448-47e4948113d9-图片.png

二、启动服务

重新拉取docker镜像并启动服务

xhost + && sudo docker run -it --rm -p 8889:8889 -p 8889:8889/udp --privileged -v /dev:/dev -v /tmp/.X11-unix:/tmp/.X11-unix --device /dev/snd -e DISPLAY=unix$DISPLAY registry.cn-hangzhou.aliyuncs.com/fishros/fishbot_laser

启动完成后，可以看到如下界面

ef868a6c-a4fa-4053-ab72-79538b7c20fd-图片.png

三、驱动雷达

保证雷达板在通电状态，
选择1驱动雷达，回车，
选择3有线串口，回车，
接着选择1 /dev/ttyUSB0。我们尝试驱动雷达

25d915a2-b360-4cab-9c6f-88a7d68c5561-图片.png

等待雷达连接，未连接成功请先检查跳线帽是否更换到串口模式

驱动成功后，我们可以打开一个新的终端，输入ros2 topic list，查看是否有scan话题。

ros2 topic list

3fdbe9e5-f359-4ba2-8f79-48cecdb14cb6-图片.png

此时在终端中打开rviz2,

7b15222c-c0e4-4784-8b50-4760957a6e15-图片.png

修改fixed frame为laser_frame，左下角点击add---by topic，添加LaserScan，
cfc168a2-1435-4d0e-8e3c-de655e0c6a84-图片.png

接着修改Qos为Best Effort，接着就能看到雷达的点云数据了
移动雷达，观察点云的变化

2b11e0a1-dafc-4c29-b667-23621795211a-图片.png

四、手动建图测试

使用Crtl+C，打断驱动的运行，回车，
选择4返回上级
选择2建图测试
选择3有线串口
选择1/dev/ttyUSB0

c6ff60e9-e0ff-43aa-8095-8119ed160de2-图片.png

等待片刻，你应该可以直接看到一张地图出现

ae323491-a053-42a4-89de-c5f51db9cb2b-图片.png

你可以将FishBot放到地上，或者用手拿着fishbot，慢慢走一圈，观察地图的变化，也可以直接用键盘控制节点（需要根据上节教程个启动Agent）控制fishbot走一圈，看看能否得到完整的地图。
d0503e59-b7f1-4b8e-8cdb-aa08b452b9b8-图片.png

五、保存地图

我们需要使用一个叫做nav2_map_server的工具。
安装nav2_map_server

sudo apt install ros-$ROS_DISTRO-nav2-map-server

保存地图

ros2 run nav2_map_server map_saver_cli --help

可以看到有下面的用法

Usage: map_saver_cli [arguments] [--ros-args ROS remapping args] Arguments: -h/--help -t <map_topic> -f <mapname> --occ <threshold_occupied> --free <threshold_free> --fmt <image_format> --mode trinary(default)/scale/raw NOTE: --ros-args should be passed at the end of command line

我们的地图话题为map，文件名字我们用fishbot_map,所以有下面这个这样写的命令行。
ros2 run nav2_map_server map_saver_cli -t map -f fishbot_map
接着我们就可以得到下面的两个文件

. ├── fishbot_map.pgm └── fishbot_map.yaml 0 directories, 2 files

这两个文件就是对当前地图保存下来的文件，其中.pgm是地图的数据文件，.yaml后缀的是地图的描述文件。

一、打开配置助手，修改net_mode

跳帽在flash模式下，扫描配置，修改net_mode为udp，针对建图卡顿网络问题优化，udp对网络差的环境有更好的兼容性
82d83fa2-6063-4ba9-b445-aac19b873472-图片.png

二、手动切换模式

配置完成后，将跳线帽调整到WIFI模式

cdfb78a8-adeb-45d1-9949-c11d9d45b756-图片.png

三、启动服务

重新拉取docker镜像并运行：

xhost + && sudo docker run -it --rm -p 8889:8889 -p 8889:8889/udp -v /dev:/dev -v /tmp/.X11-unix:/tmp/.X11-unix --device /dev/snd -e DISPLAY=unix$DISPLAY registry.cn-hangzhou.aliyuncs.com/fishros/fishbot_laser

启动完成后，可以看到如下页面

cc346c82-58de-441c-b770-9936d52d3b10-图片.png

四、驱动测试

保证雷达板在通电状态
选择1驱动雷达，回车
选择2无线udp，回车，我们尝试驱动雷达

0bb1f40f-b525-455e-aa19-62b992e68ebb-图片.png

等待激光雷达udp连接
如果未连接成功，请检查是否符合下述现象和问题：

蓝色LED灯长亮，表示此时在配置模式，请将跳线帽调整至运行模式，LED闪烁表示在运行模式 出现timout count提示，表示雷达板没有数据发送到的电脑，此时应该检查跳线帽是否在WIFI模式，并确定连接了雷达。
驱动成功后，我们可以打开一个新的终端，输入ros2 topic list，查看是否有/scan话题。 ros2 topic list

此时在终端中打开rviz2,修改fixed frame为laser_frame，左下角点击add---by topic，添加LaserScan，

c6ea58a3-0aab-4a9e-8a0f-bb00e894bea8-图片.png

接着修改Qos为Best Effort，接着就能看到雷达的点云数据了
移动雷达，观察点云的变化

f0e48929-c362-43bc-9909-5df28d01c4d2-图片.png

五、手动建图测试

使用Crtl+C，打断驱动的运行，回车，
选择4返回上级
选择2建图测试
选择2无线udp

ae1b462f-0fe0-441e-91f1-86ba5a29567f-图片.png

等待片刻，你应该可以直接看到一张地图出现

a5cdca2e-f532-4a26-a6be-19c964720650-图片.png

你可以将FishBot放到地上，或者用手拿着fishbot，慢慢走一圈，观察地图的变化，也可以直接用键盘控制节点（需要根据上节教程个启动Agent）控制fishbot走一圈，看看能否得到完整的地图。

22bde3c5-5fee-4397-b669-1be9897ce4d3-图片.png

六、保存地图

我们需要使用一个叫做nav2_map_server的工具。
安装nav2_map_server

sudo apt install ros-$ROS_DISTRO-nav2-map-server

保存地图

ros2 run nav2_map_server map_saver_cli --help

可以看到有下面的用法

Usage: map_saver_cli [arguments] [--ros-args ROS remapping args] Arguments: -h/--help -t <map_topic> -f <mapname> --occ <threshold_occupied> --free <threshold_free> --fmt <image_format> --mode trinary(default)/scale/raw NOTE: --ros-args should be passed at the end of command line

我们的地图话题为map，文件名字我们用fishbot_map,所以有下面这个这样写的命令行。
ros2 run nav2_map_server map_saver_cli -t map -f fishbot_map
接着我们就可以得到下面的两个文件

. ├── fishbot_map.pgm └── fishbot_map.yaml 0 directories, 2 files

这两个文件就是对当前地图保存下来的文件，其中.pgm是地图的数据文件，.yaml后缀的是地图的描述文件。

一、手动切换模式

配置助手配置雷达时net_mode默认为tcp
当配置完成后，需要将跳线帽调整到WIFI模式，这样雷达板将会把来自雷达的数据通过wifi转发给tcp服务。
0f1cc291-deda-42eb-a52c-46c6e30836d7-图片.png

调整完后，跳线帽接法如上图所示。

二、启动服务

打开电脑，输入下面的指令，我们使用docker来下载雷达相关的驱动。

xhost + && sudo docker run -it --rm -p 8889:8889 -p 8889:8889/udp -v /dev:/dev -v /tmp/.X11-unix:/tmp/.X11-unix --device /dev/snd -e DISPLAY=unix$DISPLAY registry.cn-hangzhou.aliyuncs.com/fishros/fishbot_laser

下载完成后，你可以看到下面的界面
0c4c4005-51ee-422b-8f56-2711b4433c4b-图片.png

三、驱动测试

保持雷达板在通电状态，输入1，回车，选择1无线tcp，我们尝试驱动雷达
b808fcb5-5643-486f-95a5-3a2b57ecec37-图片.png

看到上述界面，表示驱动成功。
如果没有看到上述界面，请检查是否符合下述现象和问题：

蓝色LED灯长亮，表示此时在配置模式，请将跳线帽调整至运行模式，LED闪烁表示在运行模式 出现timout count提示，表示雷达板没有数据发送到的电脑，此时应该检查跳线帽是否在WIFI模式，并确定连接了雷达。
驱动成功后，我们可以打开一个新的终端，输入ros2 topic list，查看是否有scan话题。 ros2 topic list

5426580f-7835-43ed-86cc-71c6362c61b6-图片.png

在rviz中可视化点云数据：
此时打开rviz2，左下角点击add---by topic，添加LaserScan，并修改fixed frame为laser_frame
96f93e0e-75cb-481e-8ee6-7ad521fa8b87-图片.png

修改Qos为Best Effort，接着就能看到雷达的点云数据了
移动雷达，观察点云的变化
f69d084e-b2d7-45f4-9fd5-83e2835a60bf-图片.png

四、手动建图测试

使用Crtl+C，打断驱动的运行，回车，
选择4返回上级
选择2建图测试
选择1无线tcp
52ade1bc-f6d6-4bc7-ba28-2602093c240c-图片.png

等待片刻，你应该可以直接看到一张地图出现
f3cf1f46-c483-4c2e-8890-569c22f0ee3b-图片.png

你可以将FishBot放到地上，或者用手拿着fishbot，慢慢走一圈，观察地图的变化，也可以直接用键盘控制节点（需要根据上节教程个启动Agent）控制fishbot走一圈，看看能否得到完整的地图。
ef03f587-7142-4062-b0c0-ddb76fddc692-图片.png

五、保存地图

我们需要使用一个叫做nav2_map_server的工具。
安装nav2_map_server

sudo apt install ros-$ROS_DISTRO-nav2-map-server

保存地图

ros2 run nav2_map_server map_saver_cli --help

可以看到有下面的用法

Usage: map_saver_cli [arguments] [--ros-args ROS remapping args] Arguments: -h/--help -t <map_topic> -f <mapname> --occ <threshold_occupied> --free <threshold_free> --fmt <image_format> --mode trinary(default)/scale/raw NOTE: --ros-args should be passed at the end of command line

我们的地图话题为map，文件名字我们用fishbot_map,所以有下面这个这样写的命令行。
ros2 run nav2_map_server map_saver_cli -t map -f fishbot_map
接着我们就可以得到下面的两个文件

. ├── fishbot_map.pgm └── fishbot_map.yaml 0 directories, 2 files

这两个文件就是对当前地图保存下来的文件，其中.pgm是地图的数据文件，.yaml后缀的是地图的描述文件。

e509d2e7-d36f-4582-98f3-e057062825a2-图片.png
为什么下面一直在等待？

源码
import rclpy
from rclpy.node import Node
from chapt4_interfaces.srv import FaceDetector
import face_recognition
import cv2
from ament_index_python.packages import get_package_share_directory #获取功能包share目录绝对路径
import os
from cv_bridge import CvBridge
import time

class FaceDetectNode(Node):
def init(self):
super().init('face_detect_node')
self.service_ = self.create_service(FaceDetector,'face_detect',self.detect_face_callback)
self.bridge = CvBridge()
self.number_of_times_to_upsample = 1
self.model = 'hog'
self.default_image_path = os.path.join(get_package_share_directory('demo_python_service') ,'resource/default.jpeg')
self.get_logger().info("人脸检测服务已经启动！")

def detect_face_callback(self, request, response): if request.image.data: cv_image = self.bridge.imgmsg_to_cv2(request.image) else: cv_image = cv2.imread(self.default_image_path) self.get_logger().info(f"传入图像为空，使用默认图像") #cv_image 已经是一个opencv格式的图像了 start_time = time.time() self.get_logger().info(f"加载完成图像，开始识别") #检测人脸 face_locations = face_recognition.face_locations(cv_image, number_of_times_to_upsample=self.number_of_times_to_upsample,model=self.model) response.use_time = time.time() - start_time response.number = len(face_locations) self.get_logger().info(f"识别完成，耗时：{response.use_time}!秒") for top,right,bottom,left in face_locations: response.top.append(top) response.right.append(right) response.bottom.append(bottom) response.left.append(left) return response #返回【reponse

def main():
rclpy.init()
node = FaceDetectNode()
rclpy.spin(node)
rclpy.shutdown()

ls@ls-OMEN-Gaming-Laptop-16-ae0xxx:~/chapter6/chapter6_ws$ ros2 launch fishbot_description display_robot.launch.py
[INFO] [launch]: All log files can be found below /home/ls/.ros/log/2025-07-14-22-50-13-406014-ls-OMEN-Gaming-Laptop-16-ae0xxx-7918
[INFO] [launch]: Default logging verbosity is set to INFO
[INFO] [robot_state_publisher-1]: process started with pid [7920]
[INFO] [joint_state_publisher-2]: process started with pid [7922]
[INFO] [rviz2-3]: process started with pid [7924]
[robot_state_publisher-1] [INFO] [1752504613.535700714] [robot_state_publisher]: got segment back_caster_link
[robot_state_publisher-1] [INFO] [1752504613.535768118] [robot_state_publisher]: got segment base_footprint
[robot_state_publisher-1] [INFO] [1752504613.535774413] [robot_state_publisher]: got segment base_link
[robot_state_publisher-1] [INFO] [1752504613.535777807] [robot_state_publisher]: got segment camera_link
[robot_state_publisher-1] [INFO] [1752504613.535781003] [robot_state_publisher]: got segment front_caster_link
[robot_state_publisher-1] [INFO] [1752504613.535784553] [robot_state_publisher]: got segment imu_link
[robot_state_publisher-1] [INFO] [1752504613.535787920] [robot_state_publisher]: got segment laser_cylinder_link
[robot_state_publisher-1] [INFO] [1752504613.535791156] [robot_state_publisher]: got segment laser_link
[robot_state_publisher-1] [INFO] [1752504613.535794234] [robot_state_publisher]: got segment left_wheel_link
[robot_state_publisher-1] [INFO] [1752504613.535797336] [robot_state_publisher]: got segment right_wheel_link
[rviz2-3] /opt/ros/humble/lib/rviz2/rviz2: symbol lookup error: /snap/core20/current/lib/x86_64-linux-gnu/libpthread.so.0: undefined symbol: __libc_pthread_init, version GLIBC_PRIVATE
[ERROR] [rviz2-3]: process has died [pid 7924, exit code 127, cmd '/opt/ros/humble/lib/rviz2/rviz2 -d /home/ls/chapter6/chapter6_ws/install/fishbot_description/share/fishbot_description/config/rviz/display_model.rviz --ros-args'].
[joint_state_publisher-2] [INFO] [1752504613.756091603] [joint_state_publisher]: Waiting for robot_description to be published on the robot_description topic...
^C[WARNING] [launch]: user interrupted with ctrl-c (SIGINT)
[robot_state_publisher-1] [INFO] [1752504624.928440216] [rclcpp]: signal_handler(signum=2)
[INFO] [robot_state_publisher-1]: process has finished cleanly [pid 7920]
[INFO] [joint_state_publisher-2]: process has finished cleanly [pid 7922]

本人C++和python都会一点，不知道需不需要掌握两种语言的写法，就是ROS2的课程

ad3381ef-2366-4abc-9798-645de4ee123f-image.png
256985dd-084c-4c91-ada2-5aa90d9aa1b2-image.png
589e1f14-d6b7-43e2-97f2-d41befc2b719-image.png
这里有什么需要配置的吗

ls@ls-OMEN-Gaming-Laptop-16-ae0xxx:~/chapter6/chapter6_ws$ ros2 launch fishbot_description gazebo_sim.launch.py
[INFO] [launch]: All log files can be found below /home/ls/.ros/log/2025-07-14-19-31-02-736177-ls-OMEN-Gaming-Laptop-16-ae0xxx-43738
[INFO] [launch]: Default logging verbosity is set to INFO
[INFO] [robot_state_publisher-1]: process started with pid [43741]
[INFO] [gzserver-2]: process started with pid [43743]
[INFO] [gzclient-3]: process started with pid [43745]
[INFO] [spawn_entity.py-4]: process started with pid [43747]
[robot_state_publisher-1] [INFO] [1752492663.155872124] [robot_state_publisher]: got segment back_caster_link
[robot_state_publisher-1] [INFO] [1752492663.155987358] [robot_state_publisher]: got segment back_wheel_link
[robot_state_publisher-1] [INFO] [1752492663.156001201] [robot_state_publisher]: got segment base_footprint
[robot_state_publisher-1] [INFO] [1752492663.156010853] [robot_state_publisher]: got segment base_link
[robot_state_publisher-1] [INFO] [1752492663.156019436] [robot_state_publisher]: got segment camera_link
[robot_state_publisher-1] [INFO] [1752492663.156027798] [robot_state_publisher]: got segment front_caster_link
[robot_state_publisher-1] [INFO] [1752492663.156036241] [robot_state_publisher]: got segment imu_link
[robot_state_publisher-1] [INFO] [1752492663.156044576] [robot_state_publisher]: got segment laser_cylinder_link
[robot_state_publisher-1] [INFO] [1752492663.156052841] [robot_state_publisher]: got segment laser_link
[robot_state_publisher-1] [INFO] [1752492663.156060997] [robot_state_publisher]: got segment left_wheel_link
[gzclient-3] Gazebo multi-robot simulator, version 11.10.2
[gzclient-3] Copyright (C) 2012 Open Source Robotics Foundation.
[gzclient-3] Released under the Apache 2 License.
[gzclient-3] http://gazebosim.org
[gzclient-3]
[spawn_entity.py-4] Traceback (most recent call last):
[spawn_entity.py-4] File "/opt/ros/humble/lib/gazebo_ros/spawn_entity.py", line 31, in <module>
[spawn_entity.py-4] from lxml import etree as ElementTree
[spawn_entity.py-4] ModuleNotFoundError: No module named 'lxml'
[gzserver-2] Gazebo multi-robot simulator, version 11.10.2
[gzserver-2] Copyright (C) 2012 Open Source Robotics Foundation.
[gzserver-2] Released under the Apache 2 License.
[gzserver-2] http://gazebosim.org
[gzserver-2]
[ERROR] [spawn_entity.py-4]: process has died [pid 43747, exit code 1, cmd '/opt/ros/humble/lib/gazebo_ros/spawn_entity.py -topic /robot_description -entity fishbot --ros-args'].
[gzserver-2] [Wrn] [gazebo_ros_init.cpp:178]
[gzserver-2] # # ####### ####### ### ##### #######
[gzserver-2] ## # # # # # # # #
[gzserver-2] # # # # # # # # #
[gzserver-2] # # # # # # # # #####
[gzserver-2] # # # # # # # # #
[gzserver-2] # ## # # # # # # #
[gzserver-2] # # ####### # ### ##### #######
[gzserver-2]
[gzserver-2] This version of Gazebo, now called Gazebo classic, reaches end-of-life
[gzserver-2] in January 2025. Users are highly encouraged to migrate to the new Gazebo
[gzserver-2] using our migration guides (https://gazebosim.org/docs/latest/gazebo_classic_migration?utm_source=gazebo_ros_pkgs&utm_medium=cli)
[gzserver-2]
[gzserver-2]
[gzclient-3] [Msg] Waiting for master.
[gzclient-3] [Msg] Connected to gazebo master @ http://127.0.0.1:11345
[gzclient-3] [Msg] Publicized address: 10.197.145.93
[gzclient-3] [Err] [InsertModelWidget.cc:403] Missing model.config for model "/home/ls/Desktop/Optical_flow"
[gzclient-3] [Err] [InsertModelWidget.cc:403] Missing model.config for model "/home/ls/Desktop/Sunflower"
[gzclient-3] [Err] [InsertModelWidget.cc:403] Missing model.config for model "/home/ls/Desktop/TensorRT"
[gzclient-3] [Err] [InsertModelWidget.cc:403] Missing model.config for model "/home/ls/Desktop/Test"
[gzclient-3] [Err] [InsertModelWidget.cc:403] Missing model.config for model "/home/ls/Desktop/YOLO"
[gzclient-3] [Err] [InsertModelWidget.cc:403] Missing model.config for model "/home/ls/Desktop/cartographer"
[gzclient-3] [Err] [InsertModelWidget.cc:403] Missing model.config for model "/home/ls/Desktop/define"
[gzclient-3] [Err] [InsertModelWidget.cc:403] Missing model.config for model "/home/ls/Desktop/final_reference"
[gzclient-3] [Err] [InsertModelWidget.cc:403] Missing model.config for model "/home/ls/Desktop/lidarteachws"
[gzclient-3] [Err] [InsertModelWidget.cc:403] Missing model.config for model "/home/ls/Desktop/omniverse"
[gzclient-3] [Err] [InsertModelWidget.cc:403] Missing model.config for model "/home/ls/Desktop/robotcontrol"
[gzclient-3] [Wrn] [Event.cc:61] Warning: Deleting a connection right after creation. Make sure to save the ConnectionPtr from a Connect call
[gzclient-3] [Wrn] [Publisher.cc:135] Queue limit reached for topic /gazebo/default/user_camera/pose, deleting message. This warning is printed only once.
^C[WARNING] [launch]: user interrupted with ctrl-c (SIGINT)
[gzclient-3] [Wrn] [Event.cc:61] Warning: Deleting a connection right after creation. Make sure to save the ConnectionPtr from a Connect call
[robot_state_publisher-1] [INFO] [1752492883.290270574] [rclcpp]: signal_handler(signum=2)
[gzserver-2] [Msg] Waiting for master.
[gzserver-2] [Msg] Connected to gazebo master @ http://127.0.0.1:11345
[gzserver-2] [Msg] Publicized address: 10.197.145.93
[gzserver-2] [Msg] Loading world file [/home/ls/chapter6/chapter6_ws/install/fishbot_description/share/fishbot_description/world/custom_room.world]
[INFO] [robot_state_publisher-1]: process has finished cleanly [pid 43741]
[INFO] [gzserver-2]: process has finished cleanly [pid 43743]
[gzserver-2]
[gzserver-2]
[INFO] [gzclient-3]: process has finished cleanly [pid 43745]
[gzclient-3]
[gzclient-3]