# Mono-VSLAM
Source: [https://docs.qualcomm.com/doc/80-70015-265Y/topic/mono-vslam_5_3_3.html](https://docs.qualcomm.com/doc/80-70015-265Y/topic/mono-vslam_5_3_3.html)
mono-vslam 示例可在机器人移动时实现机器人定位。它可以使用mono摄像头、IMU 和轮式里程计作为输入，连续生成里程计数据。里程计数据来自您的机器人。
图中显示了 mono-vslam 示例的 pipeline。Mono-vslam 示例融合了来自 RealSense RGB 摄像头的 RGB 图像、来自 ICM42688 的 IMU 数据以及来自机器人的里程计数据，然后输出姿态和里程计数据。mono-vslam 示例支持目标模式和无目标模式。
Figure : mono-vslam pipeline
有关 pipeline 流程中使用的 ROS 节点和主题的信息，参见 [Mono-VSLAM 的 pipeline 流程](https://docs.qualcomm.com/doc/80-70015-265Y/topic/mono-vslam_5_3_3.html#ID-concept-d32488e6582__section_axw_3qz_vbc)。
## 用例
**前提条件：**
- QIRP SDK 和依赖项已安装，参见[编译软件](https://docs.qualcomm.com/doc/80-70015-265Y/topic/build-the-software_4_1.html)和[刷写和安装](https://docs.qualcomm.com/doc/80-70015-265Y/topic/flash-and-install_4_3.html)。
- `SSH` 在 "Permissive" 模式下按照[使用 SSH](https://docs.qualcomm.com/bundle/publicresource/topics/80-70015-254/how_to.html#use-ssh)
中介绍的步骤启用。
- RealSense D455 摄像头已部署。
**用例 1：运行开箱即用的 mono-VSLAM**
**步骤：**
该示例遵循以下节点序列。
realsense2-camera in RGB mode
qti-robot-amr-ctrl
mono-vslam
qti-robot-keyboardCopy to clipboard
1. 连接 RealSense D455 摄像头并启动机器人。
2. 启动五个终端，并在每个终端运行以下命令，从而在设备上搭建 QIRP SDK 和 ROS2 环境。
`ROS_DOMAIN_ID` 的取值范围：[0, 232]
ssh root@[ip-addr]
(ssh) export HOME=/opt
(ssh) source /opt/qcom/qirp-sdk/qirp-setup.sh
(ssh) source /usr/bin/ros_setup.bash
(ssh) export ROS_DOMAIN_ID=xxCopy to clipboard
注释： 在接下来的步骤 3 到 7 中，每一步都在此步骤中部署的单独终端窗口中运行。
3. 在终端 1，以单目模式启动 `realsense2_camera`。
(ssh) ros2 launch realsense2_camera rs_launch.py enable_depth:=false rgb_camera.profile:=848x480x30
Copy to clipboard
4. 在终端 2，启动 `qti_robot_amr_ctrl`。
(ssh) ros2 launch qti_robot_amr_ctrl qti_robot_amr_ctrl.launch.py
Copy to clipboard
注释： 将此步骤替换为您的机器人启动命令。
5. 在终端 3，运行 `mono-vslam`。
(ssh) export FASTRTPS_DEFAULT_PROFILES_FILE=/opt/qcom/qirp-sdk/data/misc/vwslam/Configuration/vslam-node_profile.xml
(ssh) cd /opt/qcom/qirp-sdk/usr/lib/mono-vslam/
(ssh) chmod 777 mono-vslam
(ssh) ./mono-vslam
Copy to clipboard
终端中显示以下日志。
6. 在终端 4，运行 `qti_robot_keyboard`。
(ssh) ros2 run qti_robot_keyboard qti_keyboard
Copy to clipboard
注释： 将此步骤替换为您的键盘命令。
7. 在终端 5，可以通过运行此命令来观察输出结果。
(ssh) ros2 topic echo /robot_odom
(ssh) ros2 topic echo /vslam_odom_rawCopy to clipboard
8. 要在 Ubuntu PC 上的 Rviz2 中显示结果，执行以下配置。
1. 按照 [安装 Rviz2](https://docs.qualcomm.com/doc/80-70015-265Y/topic/install-rviz2_5_1_3.html) 的说明安装 Rviz2。
2. 选择 `/odom` 帧。
3. 按显示类型添加 `TF`、 `Grid`。
4. 按主题添加 `odom`、 `robot_odom` 和 `vslam/labeled_img`。
Table : Mono-vslam 的默认配置和输出文件
| 文件 | 默认路径 | 说明 |
| --- | --- | --- |
| 配置文件 | /opt/qcom/qirf-sdk/data/misc/vwslam/Configuration/monoSlam.cfg
/opt/qcom/qirf-sdk/data/misc/vwslam/vslam.cfgCopy to clipboard |
monoSlam.cfg 文件配置了 mono-vslam 算法的参数，例如初始化模式。
vslam.cfg 文件配置了 mono-vslam 的硬件参数，例如摄像头参数。
|
| 输出文件 | /opt/qcom/qirf-sdk/data/vwslam/fusion_output.csv Copy to clipboard | `.csv` 文件包含基础链接的姿态。 |
**用例 2：编译并运行 mono-VSLAM**
**步骤：**
1. 在主机上编译由 QIRP SDK 提供的 `mono-vslam`。
cd
source setup.sh
cd sample-code/qirp_nodes/navigation_nodes/vslam/mono-vslam/
export AMENT_PREFIX_PATH="${OECORE_TARGET_SYSROOT}/usr;${OECORE_NATIVE_SYSROOT}/usr"
export PYTHONPATH=${PYTHONPATH}:${OECORE_TARGET_SYSROOT}/usr/lib/python3.10/site-packages
colcon build --continue-on-error --cmake-args \
-DCMAKE_TOOLCHAIN_FILE=${OE_CMAKE_TOOLCHAIN_FILE} \
-DPYTHON_EXECUTABLE=${OECORE_NATIVE_SYSROOT}/usr/bin/python3 \
-DPython3_NumPy_INCLUDE_DIR=${OECORE_NATIVE_SYSROOT}/usr/lib/python3.10/site-packages/numpy/core/include \
-DSYSROOT_LIBDIR=${OECORE_TARGET_SYSROOT}/usr/lib \
-DSYSROOT_INCDIR=${OECORE_TARGET_SYSROOT}/usr/include \
-DCMAKE_MAKE_PROGRAM=/usr/bin/make \
-DBUILD_TESTING=OFF
Copy to clipboard
2. 将 `mono-vslam` 推送至设备。
注释： 确保设备上已安装 QIRP SDK。
cd sample-code/qirp_nodes/navigation_nodes/vslam/mono-vslam/install/mono-vslam
tar czvf mono_vslam.tar.gz lib share
scp mono_vslam.tar.gz root@[ip-addr]:/opt/
ssh root@[ip-addr]
(ssh) tar -zxf /opt/mono_vslam.tar.gz -C /opt/qcom/qirp-sdk/usr/Copy to clipboard
3. 在设备上运行 `mono-vslam`，参考[用例 1：运行开箱即用的
mono-VSLAM](https://docs.qualcomm.com/doc/80-70015-265Y/topic/mono-vslam_5_3_3.html#ID-concept-d32488e6582__ID-Hx-d50489e1)。
## Mono-VSLAM 的 pipeline 流程
Table : Mono-vslam pipeline 中使用的 ROS 节点
| ROS 节点 | 说明 |
| --- | --- |
| qti-robot-amr-ctrlCopy to clipboard | 发布 `/cmd_vel` 和 `/odom` ROS 主题。 |
| realsense2-cameraCopy to clipboard | 发布 `/camera_info` 和 `/image_raw` ROS 主题。 |
Table : Mono-vslam pipeline 中使用的 ROS 主题
| ROS 主题 | 类型 | 说明 |
| --- | --- | --- |
| robot_odomCopy to clipboard | Copy to clipboard | 由 `mono-vslam` 节点发布。 |
| vslam_odom_rawCopy to clipboard | Copy to clipboard | 由 `mono-vslam` 节点发布。 |
| vslam/labeled_imgCopy to clipboard | Copy to clipboard | 由 `mono-vslam` 节点发布。 |
| sensor_imuCopy to clipboard | Copy to clipboard | 由 `mono-vslam` 节点发布。 |
| /camera/color/image_rawCopy to clipboard | Copy to clipboard | 由 `realsense2-camera` 节点发布，并由 `mono-vslam` 节点订阅。 |
| /camera/color/camera_infoCopy to clipboard | Copy to clipboard | 由 `realsense2-camera` 节点发布，并由 `mono-vslam` 节点订阅。 |
| odomCopy to clipboard | Copy to clipboard | 由您的机器人启动节点发布，并由 `mono-vslam` 节点订阅。 |
**上一级主题：** [专有示例](https://docs.qualcomm.com/doc/80-70015-265Y/topic/proprietary-samples_5_3.html)
Last Published: Dec 05, 2024
[Previous Topic
Voxel-map](https://docs.qualcomm.com/bundle/publicresource/80-70015-265Y/topics/voxel-map_5_3_2.md) [Next Topic
Depth-VSLAM](https://docs.qualcomm.com/bundle/publicresource/80-70015-265Y/topics/depth-vslam_5_3_4.md)