基于位置观测的激光多普勒测速仪在线标定方法和装置
Method and apparatus for online calibration of laser Doppler velocimeter based on position observation

Abstract

本申请涉及一种基于位置观测的激光多普勒测速仪在线标定方法和装置。所述方法将标定过程分为粗标定和精标定两个阶段。在粗标定阶段采用解析法，在精标定阶段首先设计了一个鲁棒卡尔曼滤波器来获得精确的载体姿态，速度和位置信息，然后，利用基于位置观测的激光多普勒测速仪误差传播模型设计了另一个卡尔曼滤波器，进一步标定激光多普勒测速仪。为了减小车辆转弯时非完整性约束被违反给标定结果带来的影响，利用天向陀螺的输出和激光多普勒测速仪的输出速度输出来对车辆是否变向进行辨别，并对车辆变向时对激光多普勒测速仪在自身坐标系下的速度进行横向速度补偿。本方法极大的提高了激光多普勒测速仪在标定过程中的鲁棒性。