类GPS超声定位系统中自主导引小车动态定位算法

针对自主导引小车(AGV)常规超声波局部定位系统的缺陷,提出了类GPS超声定位系统并阐述了其工作原理。研究了小车动态情况下与定位基站的距离估计问题,在获得AGV与定位基站的观测距离后可通过Gauss-Newton迭代定位算法获得小车空间位置的粗估计值。仿真结果表明,将上述获得的粗估计值序列经过卡尔曼滤波器进一步处理后,可提高AGV动态定位精度和速度的估计精度。

A dynamic location algorithm for autonomous guide vehicle in Quasi-GPS ultrasonic location system

In view of the deficiencies of the conventional ultrasonic location system, a Quasi-GPS ultrasonic location system for Autonomous Guide Vehicle is presented and its working principle is introduced in this article. The dynamic distance estimation problem between the AGV and location base-station is studied. Coarse estimation value of AGV coordinate can be obtained by the Gauss-Newton Iteration location algorithm from the observed distances among the AGV and the location base-stations. It is shown by simulation that location and velocity estimation precision can be augmented if the above coarse estimation values are processed by Kalman filter.