C语言机器人开发中替代冗长else if分支的优化算法咨询

核心思路：状态编码+查找表映射 #

你现在的逻辑是5个障碍传感器的状态组合对应不同的执行动作，刚好可以把离散的状态组合转换成唯一的整数索引，再通过数组查表直接拿到对应的动作参数，完全替代整串else if判断。

具体实现步骤 #

步骤1：将传感器状态编码为整数掩码 #

5个传感器每个的状态只有两种，刚好可以拼成一个5位的二进制数，每个位对应一个传感器的状态：

// 生成传感器状态掩码，每位对应一个传感器的障碍状态：1=有障碍，0=无障碍
uint8_t sensor_mask = 0;
sensor_mask |= (state0 == BARRIER) ? (1 << 0) : 0;
sensor_mask |= (state1 == BARRIER) ? (1 << 1) : 0;
sensor_mask |= (state2 == BARRIER) ? (1 << 2) : 0;
sensor_mask |= (state3 == BARRIER) ? (1 << 3) : 0;
sensor_mask |= (state4 == BARRIER) ? (1 << 4) : 0;

比如全没有障碍的状态对应掩码0b00000（十进制0），只有sensor0有障碍对应0b00001（十进制1），sensor0和sensor1都有障碍对应0b00011（十进制3），每个状态组合对应唯一的0~31范围内的整数。

步骤2：定义动作结构体和查找表 #

把每个状态对应的动作参数存在数组里，下标就是上面生成的掩码：

// 定义动作参数结构体
typedef struct {
    int left_spd;
    int right_spd;
    uint8_t need_stop;  // 1表示需要先调用copro_stop()
    uint8_t special_type; // 0=普通直接设速度，1=中间三传感器触发逻辑，2=全传感器触发逻辑
} ActionConfig;

// 初始化查找表，总共32个位置，未用到的状态可以先填默认值
const ActionConfig action_table[32] = {
    // 掩码0b00000：全无障碍
    {23, 23, 1, 0},
    // 掩码0b00001：仅sensor0有障碍
    {9, 15, 1, 0},
    // 掩码0b00011：sensor0、1有障碍
    {5, 15, 1, 0},
    // 掩码0b10111：sensor0、1、2、4有障碍
    {-5, 15, 1, 0},
    // 掩码0b00111：sensor0、1、2有障碍
    {-1, 15, 1, 0},
    // 掩码0b01111：sensor0、1、2、3有障碍
    {-17, 15, 1, 0},
    // 掩码0b10000：仅sensor4有障碍
    {15, 8, 1, 0},
    // 掩码0b11000：sensor3、4有障碍
    {15, 3, 1, 0},
    // 掩码0b11100：sensor2、3、4有障碍
    {15, -1, 1, 0},
    // 掩码0b11101：sensor0、2、3、4有障碍
    {15, -5, 1, 0},
    // 掩码0b11110：sensor1、2、3、4有障碍
    {15, -17, 1, 0},
    // 掩码0b10001：sensor0、4有障碍
    {15, 15, 0, 0},
    // 掩码0b01110：sensor1、2、3有障碍
    {0, 0, 0, 1},
    // 掩码0b11011：sensor0、1、3、4有障碍
    {12, 12, 1, 0},
    // 掩码0b11111：全传感器有障碍
    {0, 0, 0, 2},
    // 剩余未定义的状态可以统一填默认动作，比如直接停车
    [14 ... 30] = {0, 0, 1, 0}
};

步骤3：查表执行逻辑 #

拿到掩码后直接索引数组，按参数执行对应动作即可：

ActionConfig cfg = action_table[sensor_mask];

if (cfg.need_stop) {
    copro_stop();
}

if (cfg.special_type == 0) {
    copro_setSpeed(cfg.left_spd, cfg.right_spd);
} else if (cfg.special_type == 1 || cfg.special_type == 2) {
    // 执行距离判断的转向逻辑
    int left_cnt = (copro_distance[0]/256 >25) + (copro_distance[1]/256 >25);
    int right_cnt = (copro_distance[4]/256 >25) + (copro_distance[3]/256 >25);
    if (left_cnt > right_cnt) {
        copro_setSpeed(40, -40);
    } else {
        copro_setSpeed(-40, 40);
    }
}

方案优势 #

• 完全消除了长串else if，代码逻辑清晰易懂
• 后续新增状态只需要在查找表里加对应配置，不需要修改执行逻辑，维护成本极低
• 执行效率远高于逐个条件判断，适合嵌入式机器人这类对性能有要求的场景
• 不容易出现条件写漏、写反的低级错误

内容的提问来源于stack exchange，提问作者Ramas