第4章状态机设计模式

4、状态机设计模式：有限状态机（FSM）在LKA中的应用、状态迁移表、代码模板

各位同学，咱们今天聊聊状态机。说实话，在LKA（车道保持辅助）这种实时控制系统中，状态机是绕不开的核心设计模式。我做了这么多年嵌入式，见过太多人把逻辑写得像一团乱麻，最后调试到崩溃。而状态机，就是帮你把这团乱麻理成一根根清晰线条的利器。

4.1 为什么LKA需要状态机？

你想想看，LKA系统不是一直傻乎乎地纠偏的。它得知道当前处于什么“状态”：是正常行驶、正在纠偏、还是驾驶员主动接管了？不同状态下，系统的行为完全不同。如果不用状态机，你就要写一堆if-else嵌套，维护起来简直是噩梦。

我个人习惯，在设计任何控制算法前，先画状态迁移图。把系统可能处于的所有“模式”列出来，再定义清楚什么条件下会从一个模式跳到另一个模式。这样代码写起来，心里特别踏实。

核心思想： 状态机把系统行为分解为“状态”和“事件”。每个状态下，系统只响应特定的事件，执行特定的动作。说白了，就是让系统“知道自己是谁，该干什么”。

4.2 LKA的典型状态定义

以我参与过的一个量产项目为例，LKA系统通常包含以下几个核心状态：

状态名称	状态编号	描述
LKA_OFF	0	系统关闭，不执行任何控制
LKA_STANDBY	1	系统待机，检测到车道线但未激活控制
LKA_ACTIVE	2	系统激活，正在执行纠偏控制
LKA_OVERRIDE	3	驾驶员主动接管，系统暂停控制
LKA_FAILURE	4	系统故障，比如摄像头丢失或信号异常

嗯，这里要注意：OVERRIDE状态特别重要。我曾经见过一个团队，没处理好这个状态，结果驾驶员打方向盘时系统还在较劲，那体验简直糟糕透了。所以，驾驶员意图的检测和状态切换，一定要放在最高优先级。

4.3 状态迁移表：把逻辑画成表格

状态迁移表是状态机设计的“蓝图”。它用表格的形式，清晰地描述了每个状态下，遇到不同事件时，系统该做什么。我个人觉得，写代码前先把这张表画出来，能避免80%的逻辑漏洞。

当前状态	触发事件	动作	下一状态
LKA_OFF	系统上电且自检通过	初始化传感器，加载参数	LKA_STANDBY
LKA_STANDBY	车速 > 60km/h 且车道线清晰	激活控制算法，输出纠偏扭矩	LKA_ACTIVE
LKA_ACTIVE	驾驶员扭矩 > 阈值（3秒）	停止控制输出，标记驾驶员接管	LKA_OVERRIDE
LKA_OVERRIDE	驾驶员扭矩 < 阈值（持续2秒）	恢复控制输出	LKA_ACTIVE
LKA_ACTIVE	车道线丢失 > 5秒	记录故障码，降级处理	LKA_FAILURE
LKA_FAILURE	故障恢复且自检通过	清除故障码，重新初始化	LKA_STANDBY

避坑指南： 我曾经犯过一个错误——只画了正常流程的迁移，忽略了异常情况。结果在路测时，系统进入了一个“死锁状态”，既不在ACTIVE也不在FAILURE，卡在那里不动了。所以，一定要为每个状态定义“兜底”的迁移路径，比如超时自动回到STANDBY。

4.4 代码模板：用C语言实现FSM

好了，理论说完了，咱们直接上代码。我习惯用函数指针表来实现状态机，这样扩展性最好，也最容易维护。你想想看，如果以后要加一个新状态，只需要加一个函数，再更新一下迁移表就行了，完全不用动核心逻辑。

/* ============================================
 * 文件名: lka_fsm.h
 * 描述: LKA有限状态机头文件
 * ============================================ */

#ifndef LKA_FSM_H
#define LKA_FSM_H

#include <stdint.h>

/* 状态枚举 */
typedef enum {
    LKA_STATE_OFF = 0,
    LKA_STATE_STANDBY,
    LKA_STATE_ACTIVE,
    LKA_STATE_OVERRIDE,
    LKA_STATE_FAILURE,
    LKA_STATE_MAX
} LKA_State_t;

/* 事件枚举 */
typedef enum {
    LKA_EVENT_NONE = 0,
    LKA_EVENT_INIT_OK,
    LKA_EVENT_SPEED_READY,
    LKA_EVENT_DRIVER_OVERRIDE,
    LKA_EVENT_DRIVER_RELEASE,
    LKA_EVENT_LANE_LOST,
    LKA_EVENT_FAULT_RECOVER,
    LKA_EVENT_MAX
} LKA_Event_t;

/* 状态机结构体 */
typedef struct {
    LKA_State_t currentState;
    uint32_t    stateTimer;      /* 状态驻留计时器 */
    void        (*entryAction)(void);  /* 进入动作 */
    void        (*exitAction)(void);   /* 退出动作 */
} LKA_FSM_t;

/* 状态处理函数指针类型 */
typedef LKA_State_t (*LKA_StateHandler)(LKA_Event_t event);

/* 函数声明 */
void LKA_FSM_Init(LKA_FSM_t *fsm);
void LKA_FSM_Process(LKA_FSM_t *fsm, LKA_Event_t event);

#endif /* LKA_FSM_H */

这是头文件，定义了状态、事件和状态机结构体。注意我用了stateTimer，这是用来处理超时迁移的。比如在ACTIVE状态下，如果连续5秒没收到车道线，就要切到FAILURE状态。

/* ============================================
 * 文件名: lka_fsm.c
 * 描述: LKA有限状态机实现
 * ============================================ */

#include "lka_fsm.h"
#include <stdio.h>

/* 静态函数声明：每个状态的处理函数 */
static LKA_State_t State_Off_Handler(LKA_Event_t event);
static LKA_State_t State_Standby_Handler(LKA_Event_t event);
static LKA_State_t State_Active_Handler(LKA_Event_t event);
static LKA_State_t State_Override_Handler(LKA_Event_t event);
static LKA_State_t State_Failure_Handler(LKA_Event_t event);

/* 状态迁移表：核心数据结构 */
static const LKA_StateHandler stateTable[LKA_STATE_MAX] = {
    [LKA_STATE_OFF]      = State_Off_Handler,
    [LKA_STATE_STANDBY]  = State_Standby_Handler,
    [LKA_STATE_ACTIVE]   = State_Active_Handler,
    [LKA_STATE_OVERRIDE] = State_Override_Handler,
    [LKA_STATE_FAILURE]  = State_Failure_Handler
};

/* 初始化状态机 */
void LKA_FSM_Init(LKA_FSM_t *fsm) {
    fsm->currentState = LKA_STATE_OFF;
    fsm->stateTimer   = 0;
    fsm->entryAction  = NULL;
    fsm->exitAction   = NULL;
    printf("[FSM] 初始化完成，当前状态: OFF\n");
}

/* 状态机主处理函数 */
void LKA_FSM_Process(LKA_FSM_t *fsm, LKA_Event_t event) {
    LKA_State_t nextState;

    /* 查表：根据当前状态找到对应的处理函数 */
    nextState = stateTable[fsm->currentState](event);

    /* 如果状态发生了变化 */
    if (nextState != fsm->currentState) {
        /* 执行退出动作 */
        if (fsm->exitAction) {
            fsm->exitAction();
        }

        /* 更新状态 */
        fsm->currentState = nextState;
        fsm->stateTimer   = 0;

        /* 执行进入动作 */
        if (fsm->entryAction) {
            fsm->entryAction();
        }

        printf("[FSM] 状态切换: %d\n", nextState);
    } else {
        /* 状态未变，计时器递增 */
        fsm->stateTimer++;
    }
}

/* ========== 各状态处理函数实现 ========== */

static LKA_State_t State_Off_Handler(LKA_Event_t event) {
    switch (event) {
        case LKA_EVENT_INIT_OK:
            printf("  [OFF] 自检通过，进入待机\n");
            return LKA_STATE_STANDBY;
        default:
            return LKA_STATE_OFF;  /* 其他事件忽略 */
    }
}

static LKA_State_t State_Standby_Handler(LKA_Event_t event) {
    switch (event) {
        case LKA_EVENT_SPEED_READY:
            printf("  [STANDBY] 车速达标，激活控制\n");
            return LKA_STATE_ACTIVE;
        case LKA_EVENT_FAULT_RECOVER:
            return LKA_STATE_STANDBY;  /* 保持待机 */
        default:
            return LKA_STATE_STANDBY;
    }
}

static LKA_State_t State_Active_Handler(LKA_Event_t event) {
    switch (event) {
        case LKA_EVENT_DRIVER_OVERRIDE:
            printf("  [ACTIVE] 检测到驾驶员接管\n");
            return LKA_STATE_OVERRIDE;
        case LKA_EVENT_LANE_LOST:
            printf("  [ACTIVE] 车道线丢失，进入故障\n");
            return LKA_STATE_FAILURE;
        default:
            return LKA_STATE_ACTIVE;
    }
}

static LKA_State_t State_Override_Handler(LKA_Event_t event) {
    switch (event) {
        case LKA_EVENT_DRIVER_RELEASE:
            printf("  [OVERRIDE] 驾驶员释放，恢复控制\n");
            return LKA_STATE_ACTIVE;
        default:
            return LKA_STATE_OVERRIDE;
    }
}

static LKA_State_t State_Failure_Handler(LKA_Event_t event) {
    switch (event) {
        case LKA_EVENT_FAULT_RECOVER:
            printf("  [FAILURE] 故障恢复，回到待机\n");
            return LKA_STATE_STANDBY;
        default:
            return LKA_STATE_FAILURE;
    }
}

重要提醒： 这段代码里，我用了stateTable这个函数指针数组。这是整个状态机的“大脑”。你可能会问：为什么不用switch-case？因为用查表法，增加新状态时不需要修改核心处理函数，只需要在数组里加一项。这在项目迭代中太重要了，我吃过亏才明白这个道理。

4.5 实战中的几个关键点

代码写完了，但真正跑起来，还有几个坑要避开。我一个个说：

事件去抖： 传感器信号会有毛刺。比如驾驶员扭矩瞬间超过阈值，但马上又回来了。如果直接响应，系统会在ACTIVE和OVERRIDE之间来回跳。我的做法是加一个3帧的去抖计数器，连续3次检测到同一事件才触发迁移。
超时保护： 每个状态都要有超时处理。比如在OVERRIDE状态下，如果驾驶员一直不释放方向盘，系统不能永远等下去。我一般设一个10秒的超时，超时后自动切到STANDBY并报警。
日志记录： 状态迁移一定要打日志。我在项目调试时，全靠日志回放来复现问题。建议把printf换成正式的日志模块，带上时间戳。

个人经验： 我曾经在一个项目中，状态机跑得好好的，但一上实车就出问题。查了两天，发现是状态迁移的优先级搞反了。比如在ACTIVE状态下，同时收到了“驾驶员接管”和“车道线丢失”两个事件，应该优先处理驾驶员接管。所以，事件处理的优先级一定要在迁移表里明确标出来。

4.6 小结

好了，这一章的内容就到这儿。状态机这东西，说白了就是“把复杂逻辑拆成简单状态”。你只要把状态定义清楚、迁移表画明白、代码模板写规范，LKA的控制逻辑就能做到清晰、可靠、易维护。

下一章，咱们聊聊任务调度与时间触发设计。在实时系统中，什么时候该做什么事，比做什么事本身更重要。到时候见。

📚 课程目录

4、状态机设计模式：有限状态机（FSM）在LKA中的应用、状态迁移表、代码模板

4.1 为什么LKA需要状态机？

4.2 LKA的典型状态定义

4.3 状态迁移表：把逻辑画成表格

4.4 代码模板：用C语言实现FSM

4.5 实战中的几个关键点

4.6 小结