Ranging-aided relative navigation of multi-platforms  

作　　者：Hai-Long PEI Ruican XIA 

机构地区：[1]Key Lab of Autonomous Systems and Networked Control, Ministry of Education, China [2]Unmanned System Engineering Center of Guangdong Province, Guangzhou Guangdong 510640, China [3]School of Automation, South China University of Technology, Guangzhou Guangdong 510640, China

出　　处：《Control Theory and Technology》2018年第2期122-132,共11页控制理论与技术（英文版）

基　　金：This work was supported in part by the Major State Basic Research Development Program of China （No. 2014CB845303）, the National Natural Science Foundation （NNSF） of China （No. 61527810） and the Science and Technology Planning Project of Guangdong, China （No. 2013B020200006）.

摘　　要：This paper proposes a relative attitude and distance estimation algorithm based on pairwise range measurements between vehicles as well as inertial measurement of each platform. The solution of Wahba＇s Problem is introduced to compute the relative attitude between multi-platforms with the sampled pairwise ranges, in which the relative distance estimation is derived and the estimation error distributions are analyzed. An extended Kalman filter is designed to fuse the estimated attitude and distance with the inertial measurement of each platform. The relative poses between platforms are determined without any external aided measurement. To show this novelty, a real testbed is constructed by our research lab. And the experiment results are positive.This paper proposes a relative attitude and distance estimation algorithm based on pairwise range measurements between vehicles as well as inertial measurement of each platform. The solution of Wahba＇s Problem is introduced to compute the relative attitude between multi-platforms with the sampled pairwise ranges, in which the relative distance estimation is derived and the estimation error distributions are analyzed. An extended Kalman filter is designed to fuse the estimated attitude and distance with the inertial measurement of each platform. The relative poses between platforms are determined without any external aided measurement. To show this novelty, a real testbed is constructed by our research lab. And the experiment results are positive.

关 键 词：Multi-vehicles relative navigation Wahba＇s Problem pose estimation extended Kalman filter 

分 类 号：TP274[自动化与计算机技术—检测技术与自动化装置] U675.51[自动化与计算机技术—控制科学与工程]