计算杠杆臂

所有杠杆臂均在载体坐标系中考虑，并测量从 IMU 到目标点的距离。 下图为 GNSS 天线杠杆臂测量示例：