分享自:

基于可见光定位与惯性融合的鲁棒机器人定位

期刊:IEEE Sensors JournalDOI:10.1109/JSEN.2021.3053342

这篇文档属于类型a,即报告了一项原创性研究。以下是针对该研究的学术报告:


一、作者及发表信息

本研究由Weipeng Guan(香港科技大学电子与计算机工程系博士生)、Linyi Huang(华南理工大学自动化科学与工程学院)、Babar HussainC. Patrick Yue(IEEE Fellow,香港科技大学电子与计算机工程系教授)合作完成,发表于IEEE Sensors Journal 2022年3月15日第22卷第6期,标题为《Robust Robotic Localization Using Visible Light Positioning and Inertial Fusion》。研究得到香港研究资助局(GRF项目16215620)和香港科技大学-Qualcomm联合创新实验室的支持。


二、学术背景

科学领域:本研究属于室内定位技术与机器人导航的交叉领域,聚焦可见光定位(Visible Light Positioning, VLP)与惯性传感器的融合。

研究动机
1. 需求背景:GPS在室内因穿透性差和多径效应失效,而传统射频定位技术(如Wi-Fi、UWB)存在精度低、硬件成本高、电磁干扰等问题。VLP利用现有照明LED(发光二极管)通过高频调制光强传输位置信息,兼具照明与定位功能,且抗多径干扰、无电磁污染,适用于医院、飞机等敏感场景。
2. 技术瓶颈:现有VLP系统依赖多个LED锚点(anchor)实现高精度定位,但实际部署中常因LED密度不足、视线遮挡(LOS blockage)或相机视场(FOV)限制导致定位失败。

研究目标:提出一种松耦合的VLP-惯性融合方法,通过单LED锚点结合惯性测量单元(IMU)和卷帘快门相机(rolling shutter camera),提升LED短缺或中断时的定位鲁棒性。


三、研究流程与方法

1. 单LED-VLP与里程计融合算法(SLO-VLP)开发

  • LED信号处理
    • LED-ROI提取:从相机图像中识别LED的条纹模式(由高频调制光强生成),通过低复杂度算法提取LED区域(ROI)并计算其质心像素坐标(图1)。
    • LED-ID解码:通过条纹宽度解析LED的唯一ID,关联其预设的世界坐标。实验显示在2.7米高度下解码成功率>95%(图4)。
  • 定位计算
    • 坐标系转换:基于针孔相机模型,将LED的世界坐标($Pi$)转换到相机坐标系($P{ci}$),结合里程计提供的偏航角($\gamma$)计算机器人位姿(式1-12)。
    • 高度估计:通过LED的物理直径与成像像素比例推算垂直距离(式9),避免依赖多LED几何特征。

2. 扩展卡尔曼滤波(EKF)融合框架

  • 状态预测(IMU)
    • 机器人状态定义为4D位姿($x,y,z,\delta$)和速度($\dot{x},\dot{y}$),通过IMU的线加速度($a_x,a_y$)和角速度($w_y$)预测位姿(式16-17)。
    • 动态调整过程噪声协方差($Q_t$)以降低累积误差(式25)。
  • 测量更新(VLP)
    • 当SLO-VLP可用时,以位姿观测值($z_t$)修正状态估计,通过卡尔曼增益($K_t$)自适应调整VLP权重(式29-32)。
    • 测量噪声协方差($R_t$)实时更新,抑制图像传感器和里程计噪声(式33)。

3. 实验验证

  • 平台搭建:在7.0×3.8×2.7m³实验室内部署3个LED,使用TurtleBot 3移动机器人(搭载Raspberry Pi 3B、MindVision UB-300相机和MPU9250 IMU)。
  • 测试场景
    • 静态定位:325个随机位置测试,平均精度2.1 cm(最大误差6.8 cm)。
    • 动态定位:机器人以0.22 m/s移动,轨迹估计误差接近静态精度(图9)。
    • 极端条件:LED中断、背景光干扰、交接(handover)场景下仍保持定位连续性。

四、主要结果

  1. SLO-VLP性能
    • 静态定位误差服从高斯分布(图6),$x$、$y$轴误差标准差分别为0.72 cm和1.18 cm,$z$轴因距离变化波动较大(9.06 cm)。
    • 计算耗时195 ms(Raspberry Pi平台),通过优化可提升至33 ms(表I)。
  2. 融合系统优势
    • 鲁棒性:在LED不可用时,仅依赖IMU短期预测(秒)仍维持定位;VLP观测可校正IMU累积误差(图8)。
    • 覆盖范围:3个LED即可覆盖9.1×4.0×2.7m³区域,远低于文献[27]需23个LED的部署密度。

五、结论与价值

科学价值
- 提出首个基于单LED的3D定位算法(SLO-VLP),突破传统VLP需多锚点的限制。
- 设计动态噪声调整的EKF框架,实现VLP与IMU的松耦合高精度融合,为资源受限平台(如移动机器人)提供轻量级解决方案。

应用价值
- 适用于仓储物流、服务机器人等需要高精度室内定位的场景,尤其在LED部署稀疏或动态遮挡环境中表现优异。
- 硬件兼容性强,可直接复用现有照明设施和低成本传感器(如树莓派)。


六、研究亮点

  1. 创新算法:SLO-VLP首次实现单LED锚点的3D定位,结合里程计补偿缺失的姿态信息。
  2. 动态噪声处理:通过实时更新$Q_t$和$R_t$,显著降低传感器噪声和IMU漂移的影响。
  3. 极端场景验证:在LED中断、强光干扰等挑战下仍保持厘米级精度(视频演示见补充材料)。

七、其他价值

  • 开源潜力:算法基于ROS(Robot Operating System)框架开发,便于社区集成与扩展。
  • 跨领域应用:可扩展至AR/VR、智能手机定位等领域,推动可见光通信(VLC)的产业化。

(注:专业术语如“rolling shutter camera”首次出现时标注英文,后续使用中文表述。)

上述解读依据用户上传的学术文献,如有不准确或可能侵权之处请联系本站站长:admin@fmread.com