机器人航向旋转角度与转向方向计算方案优化咨询

核心思路 #

原代码通过多重条件分支处理航向差值，逻辑冗余繁琐。优化核心是先将航向差值归一化到-180°~180°范围，再通过差值的正负直接判定转向方向，取绝对值即可得到最小旋转角度，大幅简化分支逻辑。

优化后代码实现 #

#include <stdlib.h> // 用于abs函数

typedef struct {
    int rotation_angle;  // 最小旋转角度（度）
    char turn_direction; // 转向方向：P=左舷，S=右舷，N=无需转向
} SteeringResult;

SteeringResult CalculateSteering(int current_heading, int new_heading) {
    SteeringResult result;
    int diff = current_heading - new_heading;

    // 将差值归一化到-180°至180°范围
    diff = ((diff % 360) + 360) % 360; // 先转为0°~360°
    if (diff > 180) {
        diff -= 360;
    }

    result.rotation_angle = abs(diff);
    if (diff > 0) {
        result.turn_direction = 'P';
    } else if (diff < 0) {
        result.turn_direction = 'S';
    } else {
        result.turn_direction = 'N'; // 航向一致，无需转向
    }

    return result;
}

优化点说明 #

• 简化分支逻辑：仅用两次条件判断完成归一化和方向判定，替代原代码的多重分支，逻辑更直观
• 统一边界处理：通过模运算自动处理0°/360°等边界航向值，无需额外判断
• 修复返回问题：原函数为void类型无法返回计算结果，优化后使用结构体封装角度和方向，符合工程实际需求
• 可维护性提升：归一化逻辑集中处理，方向判定直接基于差值正负，易于理解和修改

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