PX4位置速度估计技术详解(四):LPE 激光雷达高度融合的实现错误核心结论:LPE 的 lidarCorrect() 和 sonarCorrect() 不是标准 EKF,也不是合格的近似 EKF。它在 lidarMeasure() 中把原始斜距测量通过三角函数转换成垂直高度,然后在 lidarCorrect() 中用线性矩阵做卡尔曼更新。这不是"工程简化",是实现错误——它把非线性观测强行变成线性观测,却未正确处理噪声方差的坐标系转换,导致卡尔曼增益计算错误。本文逐行分析错误机理,给出正确的标准 EKF 实现。