Positioning

在蓝牙5.1规范中引入的到达角（AoA）与离开角（AoD）技术，为室内定位提供了一种厘米级精度的方案。相比基于RSSI的指纹定位，AoA/AoD利用天线阵列的相位差计算信号入射方向，理论上可实现0.1°至1°的角度分辨率。然而，实际部署中，嵌入式天线阵列的互耦效应、PCB走线延迟以及温度漂移会造成严重的相位误差，必须通过精心设计的校准算法予以补偿。本文从天线阵列设计、相位数据采集到嵌入式校准算法，深入剖析实现一个稳定AoA定位系统的技术要点。

1. 天线阵列设计：从偶极子到贴片阵列

嵌入式系统中，PCB集成贴片天线是首选，因其低剖面、易共形且成本可控。但AoA定位对天线间的相位一致性要求极高。设计时需关注三个核心参数：

• 阵元间距：为避免栅瓣，间距d需满足d ≤ λ/2。对于2.4GHz蓝牙，λ≈12.5cm，故d ≤ 6.25cm。实际工程常取5.5cm以平衡尺寸与角度分辨率。
• 阵列拓扑：线性阵列（ULA）只能解算一维角度，而平面阵列（UPA）如2x4或3x3可提供方位角和俯仰角。推荐使用2x4矩形阵列，在嵌入式MCU的内存与计算能力下，MUSIC算法仍可实时运行。
• 馈电网络：必须使用等长微带线，确保各天线到射频开关的电气长度一致。差1mm走线在2.4GHz下会产生约2.9°的相位偏移，这直接破坏AoA解算。

下图展示了一个典型的2x4贴片天线阵列布局，采用50Ω微带馈电，中心频率2.45GHz，带宽80MHz。

2. 相位数据采集：蓝牙CTE包与IQ样本

蓝牙5.1 AoA依赖Constant Tone Extension（CTE）包。发射端在数据包尾部发送一段未调制的单音信号，接收端通过切换天线阵列，依次采样各天线上的IQ数据。以下代码展示了在Nordic nRF52840平台上配置CTE接收并采集IQ样本的关键流程：

// 初始化AoA天线切换
nrf_radio_ble_aoa_init(NRF_RADIO_BLE_AOA_MODE_AOA_RX);

// 配置天线阵列切换序列（8个天线，每个采样2us）
uint8_t antenna_pattern[8] = {0,1,2,3,4,5,6,7};
nrf_radio_ble_aoa_antenna_pattern_set(antenna_pattern, 8);

// 启动接收并等待CTE
nrf_radio_packet_rx_start();
while (!nrf_radio_ble_aoa_cte_detect()) {
    // 等待CTE起始
}

// 采集IQ样本（每天线8个样本，共64个）
int16_t i_samples[64], q_samples[64];
for (int i = 0; i < 64; i++) {
    nrf_radio_ble_aoa_iq_sample_get(&i_samples[i], &q_samples[i]);
}

// 原始相位计算
float phase_rad[8];
for (int ant = 0; ant < 8; ant++) {
    // 取每个天线的平均IQ
    int32_t sum_i = 0, sum_q = 0;
    for (int s = 0; s < 8; s++) {
        int idx = ant * 8 + s;
        sum_i += i_samples[idx];
        sum_q += q_samples[idx];
    }
    phase_rad[ant] = atan2f(sum_q, sum_i);
}

注意：实际中需滤除CTE起始阶段的前4μs数据，因AGC和DC偏移尚未稳定。此外，IQ样本的精度直接受限于ADC位数（nRF52840为12位），量化噪声在信噪比低于20dB时会引入约0.5°的随机相位抖动。

3. 相位校准：矢量网络分析仪与嵌入式自校准

由于PCB制造公差、焊接寄生电容以及天线互耦，各通道的固有相移偏差可达±30°。校准的核心是测量并补偿每个天线相对于参考天线的相位偏移。最精确的方法是使用矢量网络分析仪（VNA）在消声室中测量S21参数。但量产中更实用的是嵌入式自校准方案：

• 近场耦合校准：在阵列上方固定一个已知位置的发射源（如标准全向天线），采集所有天线对同一信号的相位。假设发射源在阵列正上方（θ=0°, φ=0°），理论上所有天线相位应一致，实测相位差即为通道误差。
• 相位偏移矩阵计算：设第i个天线的实测相位为φ_i，参考天线为φ_0，则校准系数C_i = φ_0 - φ_i。在后续AoA解算中，需从实测相位中减去C_i。

以下为嵌入式校准系数存储与应用的伪代码：

// 校准系数（从EEPROM读取）
float cal_phase_offset[8] = {0.0, -12.3, 8.7, -5.1, 15.2, -9.8, 4.6, -2.1};

// 应用校准
float corrected_phase[8];
for (int i = 0; i < 8; i++) {
    corrected_phase[i] = fmodf(phase_rad[i] - deg_to_rad(cal_phase_offset[i]), 2*M_PI);
}

// 执行MUSIC算法解算AoA
float doa_azimuth, doa_elevation;
music_2d_doa(corrected_phase, array_geometry, &doa_azimuth, &doa_elevation);

需要强调的是，校准系数并非一成不变。温度每变化10°C，FR4基板的介电常数变化约0.5%，导致相位漂移1°-2°。因此，高端系统会集成温度传感器，根据查表实时更新校准系数。

4. 性能分析：误差源与系统级精度

经过校准后，AoA定位系统的典型性能如下：

• 角度误差：在信噪比30dB、静态条件下，方位角误差<1°（RMS），俯仰角误差<2°（RMS）。对应在5米距离上，位置误差约8-17cm。
• 多径影响：室内反射会引入相关干扰。实验表明，当直达路径与反射路径功率差<6dB时，角度误差会恶化至5°以上。采用空间平滑技术（如前后向平滑）可将误差降低50%。
• 计算延迟：在Cortex-M4（120MHz）上运行2x8天线MUSIC算法，单次解算耗时约3.5ms，配合20Hz的CTE包刷新率（每包50ms），可实现实时跟踪。

最后，必须指出一个常见陷阱：天线阵列的相位中心偏移。贴片天线的相位中心会随频率和极化方向变化，导致校准系数在信道边缘（2402MHz vs 2480MHz）差异可达5°。因此，建议针对蓝牙的37个数据信道分别进行校准，或使用宽带天线设计（如Vivaldi天线）以减小频率敏感性。

综上所述，基于蓝牙AoA/AoD的室内定位系统，其精度高度依赖于天线阵列的硬件一致性和相位校准的精细程度。通过合理的阵列布局、精确的IQ采样以及动态温度补偿，嵌入式开发者完全可以在低成本MCU上实现亚米级定位，为仓储机器人、AR交互和智慧医疗提供可靠的底层定位能力。

💬 欢迎到论坛参与讨论： 点击这里分享您的见解或提问