# 无人驾驶之减速慢行

## 1.课程内容

**注意：这个程序是在沙盘地图上运行的，个人地图需要自行调整程序**

1.学习小车识别到人行横道之后做的动作

2.学习新出现的关键源码

### 2.路标检测

路标检测源码路径：
/home/jetson/yahboomcar_auto/src/auto_driver/scripts/auto_drive.py

### 3.程序启动
参数配置
参数路径：
/home/jetson/yahboomcar_auto/src/auto_driver/config/auto_drive_node.yaml

```
turn_radius: 0.4
linear_speed: 0.13
angular_speed: -0.55
duration: 2.0
response_distance_1: 2900
response_distance_2: 132
cooldown_time: 0.2
DEBUG_MODE: False
DEBUG_MODE_2: True
START_AutoDrive: True
Kp: -0.62
Ki: 0.0
Kd: -0.1
max_integral: 1000.0
image_size: [640, 480]
```
修改完参数之后重新运行launch文件即可使用上修改后的参数
```启动相机+底盘+自动驾驶节点
roslaunch auto_driver auto_drive.launch
```

![](/media/202512/d37740023983442d9ae881c82e80a8661722.png)

启动成功之后会显示画面不会运动，为了测试路标识别情况。（如果想要运动，将auto_drive_node.yaml的参数START_AutoDrive改成 True）

![](/media/202512/87be3e8128fe4250a074898e8780553b4998.png)

程序运行之后会显示yolo识别画面，小车会车道线居中运行，同时会根据行驶过程中识别到的路标做对应的动作。

### 3.2 识别到人行横道之后小车的运动

程序识别到人行横道程序会减速3秒后回复正常

![image-20251202192749605](/media/202512/b40ebdd9e1fb41b5beedb9f69d4486663568.png)

小车会减速3秒行驶

![image-20251202192807961](/media/202512/d6bd9f27949a4afc9280a3c12983677f3417.png)

定点停车处理函数在auto_drive.py文件下，下面是识别到人行横道之后进入的函数，用户可以自行修改识别到路标之后小车运动。

```
def slow_down(self):
    rospy.loginfo('Slow down')
    self.flag = True  #表示暂停车道线行驶
    self._set_current_speed(linear_x=0.08)
    time.sleep(3.0)
    self.flag = False
```

## 4.源码解析
### 4.1、auto_drive.py
yolo路标消息接收：
```
results = self.sign_detect.get_infer_result(frame, True)
annotated_frame = frame.copy()
```

多重过滤机制：主要为了防止一直识别路标并触发，识别到不同路标才会解锁动作。

```
 # 如果检测到需要冷却的标志，启动冷却
if detected_sign_requires_cooldown:
    self.sign_cooldown = True
    self.last_sign_time = current_time
    rospy.loginfo(f"Sign detected, starting {self.cooldown_duration}s cooldown")
 # 检查是否应该忽略重复路标
should_ignore = False
if obj.class_name == self.last_sign:
        should_ignore = True
```

事件队列处理

```
def _event_handling_worker(self):
        '''事件处理工作线程'''
        # 标志处理映射表
        sign_handlers = {
            "straight": self.go_straight,
            "turnright": lambda: self.turn('right'),
            "turnright_ground": self.do_nothing,
            "honking": self.car_horn,
            "sidewalk": self.slow_down,
            "sidewalk_ground": self.do_nothing,
            "speedlimit": self.slow_down,
            "stop": self.stop,
            "school": self.school,
            "parkA": self.parking_A,
            "parkB": self.parking_A,
            "greenlight": self.go_straight,
            "redlight": self.red_stop,
            "yellowlight": self.stop,
            "out_park": self.out_parking
        }
        
        # 标志启用索引映射
        sign_enable_map = {
            "straight": 10, "turnright": 11, "honking": 1, "sidewalk": 6,
            "sidewalk_ground": 7, "speedlimit": 8, "stop": 9, "school": 5,
            "parkA": 2, "parkB": 3, "greenlight": 0, "redlight": 4, "yellowlight": 13
        }
        
```

具体动作实现

```
def slow_down(self):
    rospy.loginfo('Slow down')
    self.flag = True
    self._set_current_speed(linear_x=0.08)
    time.sleep(3.0)
    self.flag = False
```

无人驾驶减速慢行