手把手教你学Simulink--决策规划场景实例：基于Simulink的智能车辆行为决策仿真（十字路口场景）

手把手教你学Simulink

一、引言：为什么“智能汽车需要行为决策”？

二、系统架构总览

输入（感知信息）：

输出（行为指令）：

三、十字路口场景建模（Simulink）

1. 创建自车模型

2. 他车与行人建模

3. 交通信号灯

四、关键规则定义（交规 + 安全逻辑）

五、行为决策 FSM 设计（Stateflow 核心）

状态定义：

转移条件（部分示例）：

六、Simulink 建模全流程

第一步：搭建场景环境

第二步：构建感知接口

第三步：Stateflow 行为决策机

第四步：行为到控制的映射

第五步：设置仿真工况

七、仿真结果与分析

关键波形：

八、工程实践要点

1. 可解释性 vs 复杂性

2. 传感器噪声处理

3. 与轨迹规划协同

九、扩展方向

1. V2X 协同决策

2. 多目标优化

3. 异常处理

十、总结

核心价值：

附录：所需工具箱

手把手教你学Simulink--决策规划场景实例：基于Simulink的智能车辆行为决策仿真（十字路口场景）

手把手教你学Simulink

——决策规划场景实例：基于Simulink的智能车辆行为决策仿真（十字路口场景）

一、引言：为什么“智能汽车需要行为决策”？

自动驾驶系统架构：
- 感知层：摄像头、雷达 → 检测车辆、行人、信号灯 ✅
- 定位层：GNSS+IMU → 确定自车位置 ✅
- 规划层：行为决策 + 轨迹规划→ “该做什么？” ❓
十字路口挑战：
- 多交通参与者交互（直行、左转、右转）
- 交通规则复杂（红绿灯、让行规则）
- 安全与效率需平衡（激进 vs 保守）

“看得清、定得准，不如‘想得对’。”

✅解决方案：基于有限状态机（FSM）

核心思想：将驾驶任务分解为离散行为状态（如“等待”、“通过”、“避让”），根据环境输入自动切换，实现可解释、可靠、符合交规的决策。

🎯本文目标：手把手教你使用 Simulink + Stateflow 搭建智能车辆在十字路口的行为决策系统，涵盖：
十字路口场景建模（含信号灯、他车、行人）
自车状态感知（位置、速度、信号灯相位）
基于规则的有限状态机（FSM）设计
行为输出（加速/减速/停车/让行）
最终实现：在红灯、绿灯、黄灯及有冲突交通参与者场景下，车辆能安全、合规、高效通过十字路口。

二、系统架构总览

text

编辑

[环境感知模块] ──► [行为决策 FSM] ──► [行为指令] ▲ │ │ ▼ [十字路口场景] ◄── [自车状态反馈]

输入（感知信息）：

自车状态：位置 x,y、速度 v、航向 ψ
交通灯状态：红/黄/绿 + 倒计时
他车状态：位置、速度、意图（直行/左转）
行人状态：是否在斑马线上

输出（行为指令）：

STOP：完全停车
YIELD：减速让行
GO_STRAIGHT：直行通过
TURN_LEFT：左转（需确认安全）

三、十字路口场景建模（Simulink）

1. 创建自车模型

使用Vehicle Body 3DOF（Simscape Driveline）或简化为Integrator（速度→位置）
设置初始位置：距停止线 50 m
控制输入：加速度 a（由行为指令映射）

2. 他车与行人建模

他车：用Constant+Integrator模拟匀速运动车辆
- 直行车：从左侧驶入
- 左转车：从对向驶来，意图左转
行人：用Step信号模拟“在 t=8s 进入斑马线”

3. 交通信号灯

使用Stateflow或Signal Builder生成周期信号：
- 绿灯：0–30 s
- 黄灯：30–33 s
- 红灯：33–60 s（循环）

💡 所有对象位置用全局坐标系（x-y）表示

四、关键规则定义（交规 + 安全逻辑）

场景	决策规则
红灯	必须在停止线前停车（`STOP`）
黄灯	若距停止线 > 刹车距离 → 停车；否则通过
绿灯 + 无冲突	直行通过（`GO_STRAIGHT`）
绿灯 + 对向左转车	直行车有路权 → 继续通过
绿灯 + 同向右转车	右转让直行 → 自车优先
行人过街	必须停车让行（即使绿灯！）
他车闯红灯	紧急制动（`STOP`）

⚠️安全第一：任何潜在碰撞风险 → 降级为YIELD或STOP

五、行为决策 FSM 设计（Stateflow 核心）

状态定义：

APPROACH：接近路口（>30 m）
WAIT_RED：红灯等待
CHECK_CLEAR：绿灯/黄灯时检查冲突
CROSS：通过路口
YIELD_TO_PEDESTRIAN：让行行人
EMERGENCY_STOP：紧急停车

转移条件（部分示例）：

text

编辑

[APPROACH] |-- 距停止线 < 30m --> [CHECK_LIGHT] [CHECK_LIGHT] |-- 信号灯 == RED --> [WAIT_RED] |-- 信号灯 == GREEN --> [CHECK_CONFLICT] |-- 信号灯 == YELLOW & 能安全停下 --> [WAIT_RED] |-- 信号灯 == YELLOW & 无法停下 --> [CROSS] [CHECK_CONFLICT] |-- 有行人 in 斑马线 --> [YIELD_TO_PEDESTRIAN] |-- 他车闯红灯 --> [EMERGENCY_STOP] |-- 无冲突 --> [CROSS] [YIELD_TO_PEDESTRIAN] |-- 行人离开斑马线 --> [CHECK_CONFLICT]

✅Stateflow 优势：图形化、可读性强、支持层次状态

六、Simulink 建模全流程

第一步：搭建场景环境

自车动力学：

matlab

编辑

% 简化模型：v = ∫a dt, x = ∫v dt Acceleration → Integrator → Velocity → Integrator → Position

他车/行人位置：
- 他车A（直行）：x_ego = 50 - v*t
- 行人：in_crosswalk = (t >= 8) && (t <= 12)
信号灯状态：
- 使用Repeating Sequence Stair模块生成 [0:绿, 1:黄, 2:红]

第二步：构建感知接口

创建“环境评估”子系统，输出布尔信号：

is_red_light
pedestrian_in_crosswalk
oncoming_car_turning_left
distance_to_stop_line

使用Relational Operator,Logical Operator实现

第三步：Stateflow 行为决策机

新建Stateflow Chart
定义状态与转移（如上）

输出行为指令（枚举类型）： c

编辑

enum Behavior { STOP, YIELD, GO_STRAIGHT, TURN_LEFT }

连接感知信号作为输入