如何基于未知安装朝向的IMU原始数据检测航向方向加速度

本方案仅使用基础向量运算与一阶低通滤波实现，无复杂矩阵迭代或优化运算，RAM占用低于1KB，1M主频MCU单次计算耗时小于10us，完全满足嵌入式低算力场景要求。

核心实现逻辑 #

第一步：分离重力分量与线性加速度 #

静止/匀速运动状态下加速度计输出等于重力向量，直接用一阶低通滤波提取慢变重力分量，无需复杂姿态解算：

• 滤波系数α取0.001~0.01，可根据IMU输出帧率调整，帧率越高取值越小
• 重力分量迭代公式：gx = gx * (1-α) + acc_x * α，y、z轴计算逻辑相同
• 线性加速度为当前加速度减去重力分量：lin_acc_x = acc_x - gx，y、z轴计算逻辑相同
  注意：设备上电前2~3秒为滤波收敛期，该阶段不触发检测，避免初始值偏差导致误判

第二步：提取航向方向加速度 #

无需明确航向对应IMU的具体轴，只需维护运动方向的单位向量，计算线性加速度在该方向上的投影即可得到航向加速度：

• 初始化阶段先基于收敛后的重力向量，生成垂直于重力的初始运动方向单位向量
• 每帧计算线性加速度在当前运动方向上的投影值，就是当前的航向加速度
• 当投影值大于设定的小阈值（如0.1m/s²）时，用当前线性加速度更新运动方向向量，再扣除重力方向分量后归一化，保证方向始终贴合实际运动航向

C语言参考实现 #

// 可配置参数，IMU帧率为100Hz时使用以下取值
#define ALPHA_GRAVITY 0.005f
#define ALPHA_VEL_DIR 0.01f
#define DETECT_THRESH 1.0f
#define INIT_FRAME_CNT 300 // 初始化阶段帧数，对应100Hz帧率下3秒

// 全局状态变量，内存占用极低
static float grav[3] = {0, 0, 9.8f}; // 初始重力估计值
static float vel_dir[3] = {1.0f, 0, 0}; // 初始运动方向假设
static uint8_t init_done = 0;
static uint32_t init_cnt = 0;

/**
 * @brief 检测航向加速度是否达到阈值
 * @param acc 加速度计原始值，单位m/s²
 * @param gyro 陀螺仪原始值，单位rad/s，基础功能可暂不使用，高精度场景可补充做方向修正
 * @return 1表示航向加速度≥1m/s²，0表示未达到阈值
 */
uint8_t imu_accel_detect(float acc[3], float gyro[3])
{
    // 上电初始化，收敛重力滤波
    if (!init_done) {
        grav[0] = grav[0] * (1 - ALPHA_GRAVITY) + acc[0] * ALPHA_GRAVITY;
        grav[1] = grav[1] * (1 - ALPHA_GRAVITY) + acc[1] * ALPHA_GRAVITY;
        grav[2] = grav[2] * (1 - ALPHA_GRAVITY) + acc[2] * ALPHA_GRAVITY;
        init_cnt++;
        if (init_cnt > INIT_FRAME_CNT) {
            init_done = 1;
            // 归一化重力向量
            float norm = sqrtf(grav[0]*grav[0] + grav[1]*grav[1] + grav[2]*grav[2]);
            grav[0] /= norm; grav[1] /= norm; grav[2] /= norm;
            // 生成垂直于重力的初始运动方向
            if (fabsf(grav[0]) < 0.9f) {
                vel_dir[0] = -grav[1];
                vel_dir[1] = grav[0];
                vel_dir[2] = 0;
            } else {
                vel_dir[1] = -grav[2];
                vel_dir[2] = grav[1];
                vel_dir[0] = 0;
            }
            // 归一化初始运动方向
            norm = sqrtf(vel_dir[0]*vel_dir[0] + vel_dir[1]*vel_dir[1] + vel_dir[2]*vel_dir[2]);
            vel_dir[0] /= norm; vel_dir[1] /= norm; vel_dir[2] /= norm;
        }
        return 0;
    }

    // 更新重力分量估计
    grav[0] = grav[0] * (1 - ALPHA_GRAVITY) + acc[0] * ALPHA_GRAVITY;
    grav[1] = grav[1] * (1 - ALPHA_GRAVITY) + acc[1] * ALPHA_GRAVITY;
    grav[2] = grav[2] * (1 - ALPHA_GRAVITY) + acc[2] * ALPHA_GRAVITY;

    // 计算去除重力后的线性加速度
    float lin_acc[3];
    lin_acc[0] = acc[0] - grav[0];
    lin_acc[1] = acc[1] - grav[1];
    lin_acc[2] = acc[2] - grav[2];

    // 计算航向方向加速度投影
    float a_proj = lin_acc[0] * vel_dir[0] + lin_acc[1] * vel_dir[1] + lin_acc[2] * vel_dir[2];

    // 更新运动方向向量
    if (fabsf(a_proj) > 0.1f) {
        vel_dir[0] = vel_dir[0] * (1 - ALPHA_VEL_DIR) + lin_acc[0] * ALPHA_VEL_DIR;
        vel_dir[1] = vel_dir[1] * (1 - ALPHA_VEL_DIR) + lin_acc[1] * ALPHA_VEL_DIR;
        vel_dir[2] = vel_dir[2] * (1 - ALPHA_VEL_DIR) + lin_acc[2] * ALPHA_VEL_DIR;
        // 扣除重力方向分量，保证运动方向在水平面
        float dot = vel_dir[0] * grav[0] + vel_dir[1] * grav[1] + vel_dir[2] * grav[2];
        vel_dir[0] -= dot * grav[0];
        vel_dir[1] -= dot * grav[1];
        vel_dir[2] -= dot * grav[2];
        // 归一化方向向量
        float norm = sqrtf(vel_dir[0]*vel_dir[0] + vel_dir[1]*vel_dir[1] + vel_dir[2]*vel_dir[2]);
        if (norm > 0.01f) {
            vel_dir[0] /= norm;
            vel_dir[1] /= norm;
            vel_dir[2] /= norm;
        }
    }

    // 阈值检测，可增加连续多帧检测逻辑滤除噪声误触发
    return (a_proj >= DETECT_THRESH) ? 1 : 0;
}

可选优化点 #

• 无硬件浮点的平台可将所有浮点运算替换为Q16定点数实现，平方根采用快速查表法，运算量可降低60%以上
• 陀螺仪数据可用于修正转向场景下的方向漂移，仅需增加向量旋转运算，无需完整AHRS解算即可大幅提升精度
• 增加连续3~5帧检测到阈值才输出触发信号的逻辑，可滤除瞬时噪声导致的误判

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