navgationkit-docs-sphinx/source/user_guide/quick_start/slam_doc.md

# 快速开始

#### 准备工作：

1. AP1 导航机器人
2. 成套键鼠

## 操作步骤

### 一、连接键鼠

鼠标键盘建议使用普通成套的无线键鼠，避免有线和无线混合使用。

### 二、启动系统

打开电源，打开工控机，等待 Autolabor OS 系统启动，输入密码 autolabor，字母全部是小写，回车。

### 三、SLAM建图导航

0. 准备工作：

   1. 将 AP1 控制模式切换到上位机控制，打开急停开关，确保急停开关**没有**被按下
   2. 禁用工控机无线功能
      > 在建图过程中，如果工控机连接了无线网络，当 AP1 走出无线网络的覆盖区域后，网络连接会自动断开，这将导致AP1控制失控，所以在开始建图之前，为了避免失控，需要将工控机的无线网络连接关闭。
   3. 进入桌面 `SLAM建图导航` 文件夹

1. 点击 `开始建图`

2. 操纵机器人行驶

   打开 RVIZ 工具，能够看到地图中的 AP1，使用键盘的上下左右控制 AP1 行走，边走边建图，可以看到环境地图随着 AP1 的行走不断被构建更新。

   地图中，黑色是不可行走区域，白色是可行走区域，灰色是未知区域，红色是激光雷达实时数据。

3. 建图完毕，点击 `保存并停止建图`

4. 点击 `开始导航`

   打开 RVIZ 工具，建好的地图会自动加载。

   接下来这一步请一定不要忘记，按键盘数字键 `0` 关闭键盘控制功能，控制方式将切换至导航程序控制，如不切换机器人接收到目标点命令后将不会自动导航行走。

   点击 `2D Nav Goal`，指定目标位置，拉动鼠标，箭头方向是最终车辆运行至目标的车头朝向，鼠标松开，这样就完成了目标点的指定。

   目标点给定后在地图中我们能看到一条线，这是规划好的路径。根据这个规划好的路径，AP1 向目标点行走。

   当AP1已经到达目标点后，再一次使用 `2D Pose Estimate` 指定初始位置，设置目标位置，AP1 将去到下一个目标点。

5. 点击 `终止导航`，停止导航功能，导航结束。

   之后在同一环境中需要再次使用导航功能时，无须重复建图，点击【开始导航】即可。


#### 常见问题：

##### 建图篇

1. 键盘控制 AP1 行走时，AP1 动作异常，动一下停一下

   可调整显示器的位置，保持接收器不被遮挡，并调整自己的位置，使接收器可以接收到发送的指令信号，建议使用 USB 延长线或 USB-HUB 将接收器放置在架子的高处，无任何遮挡，便于信号传输。

2. 键盘控制，AP1 一动不动

   1. 确认已将 AP1 电源总开关打开，急停开关没有被按下，AP1 处于上位机控制模式

   2. 新开一个 terminal，执行以下命令，打出关系图，查看键盘节点

      ```bash
      $ rosrun rqt_graph rqt_graph
      ```

   3. 执行以下命令，上下左右控制键盘看是否会有数据打出，如没有数据打出，说明 AP1 没有接收到键盘发送的指令

      ```bash
      $ rostopic echo /cmd_vel
      ```

   4. 执行以下命令，确认 event-kbd 的数量，数量大于一个则有问题
      ```bash
      $ ll /dev/input/by-path/
      ```

      ![](imgs/keyboard.png)

   5. 请排查是否有多个键盘设备，键盘驱动查找的是最后一个连接的键盘，需要将其他（显示为）键盘设备找出来，拔掉（可能是鼠标、机械键盘、混装键鼠）

3. AP1 不受键盘控制、失控

   在开始建图前，需要禁用无线功能。如果没有禁用，AP1 在连接了 WIFI 的状态下开始建图，在地图构建过程中，一旦 AP1 离开无线覆盖区域，无线连接断开，ROS 的网络通信中断就会导致 AP1 失去控制。

##### 导航篇

1. 目标点给定后，可能会发生 AP1 不动或原地转圈，控制台显示 `Failed to get a plan`/`不能规划路径` 的红色错误，这可能是有两种原因造成：

   * 目标点选择在了障碍物中
   * 车在地图中所处的位置是在障碍物中 

   那么这样的情况，我们可以先尝试重新给定目标点，或者将车换个位置重新给定初始位置。

2. 在行走的过程中也可能会发生AP1停止不动或原地转圈的现象发生

   这种情况是因为 AP1 在行走过程中，检测到障碍物，无法到达目标点，这个障碍物有可能是真实的障碍物，也有可能是误检，我们可以先等待观察，AP1 会进行自我恢复（不超过一分钟），如果恢复之后 AP1 仍没有行动，导航已自动停止，此时我们需要重新设置目标点。

3. 建图效果不佳/地图构建要点

   在构建地图的过程，以下几点会影响到建图的准确性：

   * 轮胎气不足影响里程计数据
   * 运行速度不宜过快，由于激光扫描有一定的频率，车速低时雷达可以扫描到的点更多，构建的地图会更准确一些
   * 走一个来回，增加激光雷达扫描次数，累计更多的数据
   * 地图构建的质量也受环境限制，请尽量选择特征比较明显的环境，玻璃、镜子、楼道、空旷等场景会影响建图效果
   * 构建完成的地图，会发现有些点会飞出，飞出的点可能是由于物体的表面不平或者有空隙激光直接穿越了过去
   * 当场景很大特征不足的时候，需要规划建图路径时，应先走一个小回环，当回环成功后，可以再多走几圈，消除粒子在这个回环的多样性。接下来走下一个回环，直到把整个地图连通成一个大的回环