激光雷达测距算法

好的，激光雷达（LiDAR）的核心功能是测量距离，其测距算法主要基于以下几种原理：

1. 飞行时间法 (Time-of-Flight, ToF) - 最主流方法

原理： 这是最常用和最直观的方法。通过精确测量激光脉冲从发射到被目标反射后再返回到接收器所需的时间 t，利用光速 c（约每秒 30 万公里）来计算距离 d。
公式： d = (c * t) / 2 （除以 2 是因为光走了来回两倍的距离）。
关键挑战：
- 时间测量精度： 因为光速极快，1 纳秒（10^-9 秒）的时间误差就会带来约 15 厘米的距离误差。要实现厘米甚至毫米级精度，需要皮秒级（10^-12 秒）或更高精度的时间测量。
- 脉冲特性： 需要发射短而强的激光脉冲，并准确检测其前沿时刻（通常是主脉冲的前沿）和回波脉冲的前沿时刻。
- 环境噪声： 区分微弱的回波信号和环境光、背景辐射等噪声至关重要。
实现方式：
- 直接时间测量： 使用高性能计时电路，如时间数字转换器（TDC），精确记录发射和接收之间的时间差。
- 相关采样法： 对发射脉冲和接收回波进行高速采样并做互相关运算，找到最大相关点对应的时间差。
应用： 绝大多数自动驾驶汽车激光雷达、地形测绘雷达、机器人导航雷达等都采用ToF原理。可分为脉冲式ToF（发射一个脉冲测量一次时间）和连续波ToF（发射调制连续波，测量相位差间接推算时间）。

2. 相位差/相干测距法 (Phase-Shift / FMCW) - 逐渐发展的重要方法

原理： 发射一束频率经过调制的连续激光（最常见的是线性调频的调频连续波，FMCW）。发射出去的光波与被目标反射回来的光波会存在一个相位差。这个相位差与光波往返目标所需的时间差成正比。测量发射波和反射波之间的相位差 Δφ 或频差，就可以计算出飞行时间 t 和距离 d。
公式推导：
- Δφ = 2π * f_mod * t （其中 f_mod 是调制信号的频率或调制的频偏）
- 代入 t = 2d / c，得到 d = (c * Δφ) / (4π * f_mod)
特点与优势：
- 信噪比高： 连续波比单脉冲能量高，且通过相干探测（将回波与本地振荡器光混合）能显著抑制背景噪声，极大提高信噪比。
- 精度高： 在调制频率和信噪比足够高时，相位测量精度可达毫米甚至微米级。
- 速度测量能力： FMCW能够通过多普勒效应（回波载波频率的微小偏移）同时高精度地测量目标相对于雷达的径向速度（速度分辨率很高）。
- 抗干扰能力强： 其他非相干光源（如太阳光、其他LiDAR）不易干扰相干接收。
关键挑战：
- 系统复杂性： 需要稳定的激光光源、精确的频率调制、复杂的相干光路设计和高速数据采集处理。
- 动态范围与多目标： 处理多个目标或近距离强反射体（如挡风玻璃雨刮器）时的信号分离问题更复杂（需计算二维傅里叶变换）。
应用： 在高精度测绘、工业测量、无人机避障以及对测速有高要求的自动驾驶场景（如高速公路上区分静止和慢速移动目标）中越来越受青睐。尤其适合需要厘米级精度和速度信息的应用。

3. 三角测量法 (Triangulation) - 常用于近距离、低成本场景

原理： 类似于双目视觉。发射固定角度的激光束（点状或线状），激光光斑打在目标上，在另一个位置（与发射点形成固定基线距离 B ）用感光器件（如CCD/CMOS线阵）接收光斑的位置。
计算方式： 目标距离 d 改变时，接收器上光斑的位置 x 也会改变。利用简单的相似三角形几何关系即可计算出距离 d。
公式： d = (B * f) / (x * sin(θ)) （简化示意公式，具体形式取决于光学设计，f 为镜头焦距，θ 为发射光束与基线的夹角）。
特点：
- 成本低： 无需高精度计时电路，感光器件相对便宜。
- 近距离精度高： 在近距离（几厘米到几十米）范围内精度相当不错。
- 视场有限： 通常是线扫式或点式，构建大视场需要复杂扫描或阵列。
- 测程受限： 距离越远，光斑偏移越小，测量精度和范围显著下降（信噪比低）。
应用： 消费级扫地机器人、避障传感器、工业自动化中短距离物料测距/定位、部分手持式三维扫描仪。

算法的重要共同组成部分

无论采用哪种基础原理，现代激光雷达的测距算法通常还包含以下处理步骤：

信号预处理：
- 滤波降噪（时域、频域滤波）。
- 放大（低噪声放大器）。
- 信号整形（对脉冲信号）。
回波检测与时间点提取 (ToF)： 精确判定回波信号的开始时刻（如前沿检测、恒定阈值/可变阈值检测、恒比定时等）。对于FMCW，主要是做数字信号处理提取相位差/频率差信息。
距离计算： 根据基础公式和校准参数计算最终距离值。
多目标处理： 对于同一个接收窗口可能有多个不同距离目标的情况（例如穿透雨雾或植被），算法需要识别和分离多个回波峰值（ToF）或多个频谱峰值（FMCW）。
校准与补偿：
- 时间偏移校准： 校正激光发射时刻到计时电路开始计时之间的固定延时（ToF）。
- 内部光学路径差补偿： 校正发射和接收光路在雷达内部的固有路径差异。
- 环境参数补偿： 修正空气折射率随温度、湿度、压力的变化（影响光速c的值）。
- 镜头畸变校正： 校正接收镜头引入的光斑位置误差（三角法）。
- 姿态校正： 对于安装在移动平台（车、飞机）上的激光雷达，需要结合IMU/GNSS数据进行空间位置和姿态补偿。
点云生成： 将每个测量点的距离值、对应的扫描角度/位置信息、有时还有回波强度信息结合起来，生成三维空间中的点云数据。