# 无人驾驶之定点停车

## 1.课程内容

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

1.学习小车识别到stop之后做的动作

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

### 2.停车检测

路标检测源码路径：
`/home/jetson/yahboomcar_ros2_ws/yahboomcar_ws/src/auto_drive/auto_drive/yolo_detect.py`

`/home/jetson/yahboomcar_ros2_ws/yahboomcar_ws/src/auto_drive/auto_drive/auto_drive.py`

### 3.程序启动
```启动相机+底盘+路标、车道线
ros2 launch auto_drive auto_drive_bringup.launch.py
```

![](/media/202512/55bd66acacac48ef978026a013c78b006457.png)
程序运行之后会显示yolo识别画面，小车会车道线居中运行，同时会根据行驶过程中识别到的路标做对应的动作。（如果开启程序之后终端没有报错，小车不动，可以运行下面程序来检查参数）

启动动态参数配置节点

```
ros2 run rqt_reconfigure rqt_reconfigure
```

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

![](/media/202512/12e70b67d5c24825bba8f48bcf26764b5871.png)

**如果小车不动检查两个参数，START_AutoDrive 是否勾上了，conbine_nav是否为flase**

☑️ 修改完参数，点击GUI空白处写入参数值。注意只会生效当次启动，永久生效需要将参数修改到源码当中。

### 3.2 识别到停车之后小车的运动

程序识别到停车程序会打印stop

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

小车会定点停止三秒，之后重新沿着线行驶

![](/media/202512/8dc9f37088c9442cb286db56b0623db54927.png)

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

```
def stop(self):
        '''停止 stop'''
        self.turn_action_active = True  # 设置动作标志，暂停车道线控制
        self.__set_current_speed(linear_x=0.0, angular_z=0.0)
        time.sleep(3) 
        self.turn_action_active = False  # 清除动作标志，恢复车道线控制
        self.get_logger().info('Stop action completed') 
```

## 4.源码解析

### 4.1、auto_drive.py

yolo路标消息接收：

```
def sign_callback(self, msg:DetectionObject):
    '''订阅yolo识别结果'''
    class_name = msg.class_name
    object_distance = self._get_distance(msg.ymin)  # 计算距离
    object = Object(msg.class_name, msg.confidence, object_distance)
```
多重过滤机制：主要为了防止一直识别路标并触发，识别到不同路标才会解锁动作。

```
# 1. 检查是否正在执行其他动作
if self.action_runing:
    return

# 2. 检查冷却时间（防重复触发）
current_time = time.time()
if class_name in self.last_processed_time:
    time_diff = current_time - self.last_processed_time[class_name]
    if time_diff < self.cooldown_time:  # 默认3秒冷却
        return

# 3. 检查是否是重复路标
if class_name == self.last_sign:
    return

# 4. 检查该路标是否被使能
if not self.sign_enable_list[对应的索引]:
    return
```

事件队列处理

```
def handle_events(self):
    '''处理目标识别事件'''
    while True:
        if not self.event_queue.empty(): 
            object = self.event_queue.get()
            self.action_runing = True
            current_sign = object.class_name
            
            try:
                # 根据路标类型执行相应动作
                if object.class_name == "straight" and self.sign_enable_list[10]:
                    self.go_straight()
                elif object.class_name == "turnright" and self.sign_enable_list[11]:
                    self.turn('right')
                # ... 其他路标处理
                
            finally:
                # 更新状态记录
                self.last_processed_time[current_sign] = time.time()
                self.last_sign = current_sign
                self.action_runing = False
```

具体动作实现

```
def stop(self):
        '''停止 stop'''
        self.turn_action_active = True  # 设置动作标志，暂停车道线控制
        self.__set_current_speed(linear_x=0.0, angular_z=0.0)
        time.sleep(3) 
        self.turn_action_active = False  # 清除动作标志，恢复车道线控制
        self.get_logger().info('Stop action completed') 
```