基于复合地标导航的动平台四旋翼飞行器自主优化降落技术

针对四旋翼飞行器在依靠地标导航完成动平台自主降落任务中存在的目标易丢失、地标定位死区大和降落可靠性差等问题,设计了一种基于复合地标导航的动平台四旋翼飞行器自主优化降落系统。该系统以圆环地标和二维码构成复合地标来解决仅用单一地标定位时存在的定位死区大和定位范围小等问题。针对地标识别丢失、动平台车轮打滑和码盘标定不精确等问题,建立动平台的精确运动模型同时考虑码盘包含未知测量偏差,基于扩展卡尔曼滤波器实现了对动平台连续位姿的在线估计。最终,基于动平台位姿估计结果以最小Jerk指标设计降落轨迹和降落策略,实现了四旋翼飞行器在动平台上高效平稳的降落。为验证所提系统的有效性,设计了仿真和实际降落实验,验证了所提复合地标实现摄像头距离在0.5~6.0 m内的综合完整定位;所设计的动平台状态估计器能在码盘存在未知测量偏差的情况下准确估计出平台的实时位姿,同时所提自主优化降落策略和轨迹规划算法保证了可靠的动平台降落。     

IMM estimator with out-of-sequence measurements

In multisensor tracking systems that operate in a centralized information processing architecture, measurements from the same target obtained by different sensors can arrive at the processing center out of sequence. In order to avoid either a delay in the output or the need for reordering and reprocessing an entire sequence of measurements, such measurements have to be processed as out-of-sequence measurements (OOSMs). Recent work developed procedures for incorporating OOSMs into a Kalman filter (KF). Since the state of the art tracker for real (maneuvering) targets is the interacting multiple model (IMM) estimator, the algorithm for incorporating OOSMs into an IMM estimator is presented here. Both data association and estimation are considered. Simulation results are presented for two realistic problems using measurements from two airborne GMTI sensors. It is shown that the proposed algorithm for incorporating OOSMs into an IMM estimator yields practically the same performance as the reordering and in-sequence reprocessing of the measurements. Also, it is shown how the range rate from a GMTI sensor can be used as a linear velocity measurement in the tracking filter.     

基于最大似然估计的TDOA/FDOA无源定位偏差补偿算法

在到达时差/到达频差(TDOA/FDOA)无源定位系统中,定位问题的非线性使得定位的结果存在偏差,特别是在噪声较大或者接收站布站不合理的情况下,定位的偏差尤其显著。针对这一问题,提出了一种基于最大似然估计的偏差补偿算法。该方法分为3步:首先,利用最大似然估计器对目标的位置和速度进行求解;其次,通过利用目标定位的估计值和含噪的测量值,对目标的位置和速度偏差值进行理论分析和推导;最后,将最大似然估计解减去理论偏差值,得到经过偏差补偿的新的目标定位解。理论分析和实验仿真证明,在一定噪声的情况下,所推导的目标位置和速度的理论偏差值与实际偏差值相符,并且经过偏差补偿后的定位算法,在保持目标定位的均方根误差(RMSE)与原最大似然算法一致的情况下,目标的位置和速度偏差值远远小于原最大似然算法的偏差值,目标定位精度得到了有效的提高。     

利用集群内测距和对目标测向的协同定位方法

当多个飞行器间相对位置测量精度显著高于飞行器绝对定位精度时，在飞行器间增加相对测量，对各飞行器的定位测量协同处理，能提高绝对定位精度。本文针对集群飞行器对非合作目标不能测距而仅能测向的情况，通过在集群飞行器间引入相互测距，来提高集群飞行器自身和对非合作目标的定位精度。对于这种不完整相对测量情况，给出了能提高定位精度的协同定位求解方法，包括非线性静态优化估计和线性化后最小二乘估计方法。这种协同定位方案，不需要进行完整的相对位置测量，对测距和测向在群体相对测量中进行合理分解，降低了飞行器测量设备配置的要求。通过仿真验证了该方法的有效性。     

Approximate Maximum Likelihood Algorithm for Moving Source Localization Using TDOA and FDOA Measurements

 A closed-form approximate maximum likelihood (AML) algorithm for estimating the position and velocity of a moving source is proposed by utilizing the time difference of arrival (TDOA) and frequency difference of arrival (FDOA) measurements of a signal received at a number of receivers. The maximum likelihood (ML) technique is a powerful tool to solve this problem. But a direct approach that uses the ML estimator to solve the localization problem is exhaustive search in the solution space, and it is very computationally expensive, and prohibits real-time processing. On the basis of ML function, a closed-form approximate solution to the ML equations can be obtained, which can allow real-time implementation as well as global convergence. Simulation results show that the proposed estimator achieves better performance than the two-step weighted least squares (WLS) approach, which makes it possible to attain the Cram閞-Rao lower bound (CRLB) at a sufficiently high noise level before the threshold effect occurs.     

A measurement-driven adaptive probability hypothesis density filter for multitarget tracking

This paper studies the dynamic estimation problem for multitarget tracking. A novel gating strategy that is based on the measurement likelihood of the target state space is proposed to improve the overall effectiveness of the probability hypothesis density(PHD) filter. Firstly, a measurement-driven mechanism based on this gating technique is designed to classify the measurements. In this mechanism, only the measurements for the existing targets are considered in the update step of the existing targets while the measurements of newborn targets are used for exploring newborn targets. Secondly, the gating strategy enables the development of a heuristic state estimation algorithm when sequential Monte Carlo(SMC) implementation of the PHD filter is investigated, where the measurements are used to drive the particle clustering within the space gate.The resulting PHD filter can achieve a more robust and accurate estimation of the existing targets by reducing the interference from clutter. Moreover, the target birth intensity can be adaptive to detect newborn targets, which is in accordance with the birth measurements. Simulation results demonstrate the computational efficiency and tracking performance of the proposed algorithm.     

基于序列图像的航天器自主导航降维滤波方法

非合作目标的运动感知与状态估计,是太空领域技术发展的重要组成部分。非合作目标相对状态的精确估计是相对导航的难点问题。传统的非合作目标扩展卡尔曼滤波算法需要结合非合作目标的质心位置,增加了状态变量的维数,提高了系统不确定性,从而会影响状态扩展卡尔曼滤波的收敛速度。提出了一种基于序列图像的非合作目标相对导航方法,该方法在不对质心进行估计的情况下首先对非合作目标姿态进行估计,在完成非合作目标姿态估计后再对其质心进行估计。本文推导了光学相机测量值与目标真实姿态的关系,构建了基于序列图像的测量模型,分别建立了不含有非合作目标质心位置的状态方程和基于非合作目标位置、速度矢量的状态方程,设计了适用于非合作目标状态估计的扩展卡尔曼滤波算法。仿真实验表明该方法可在10 Hz采样频率下经过50次采样（即5 s）内快速收敛,从而有利于空间飞行器的在轨服务与维护。     

传感器位置误差条件下的约束总体最小二乘时差定位算法

 现代定位系统中,传感器往往被安放在运动平台上,其位置无法精确得知,存在估计误差,将严重影响对目标的定位精度。针对这一问题,提出基于约束总体最小二乘(CTLS)的到达时差(TDOA)定位算法。首先通过引入中间变量,将非线性TDOA定位方程转化为伪线性方程,再利用CTLS技术,全面考虑伪线性方程所有系数中的噪声。在此基础上推导了定位方程的目标函数,再根据牛顿迭代方法,进行数值迭代,快速得到精确解。采用一阶小噪声扰动分析方法,对该算法的理论性能进行了分析,证明了算法的无偏性和逼近克拉美-罗下限(CRLB)。仿真实验表明,该算法克服了现有总体最小二乘(TLS)算法不能达到CRLB、两步加权最小二乘(two-step WLS)算法在较高噪声时性能发散的缺陷,在较高噪声时定位精度仍然能达到CRLB。     

Fusion of distributed extended forgetting factor RLS state estimators

For single-target multisensor systems, two fusion methods are presented for distributed recursive state estimation of dynamic systems without knowledge of noise covariances. The estimator at every local sensor embeds the dynamics and the forgetting factor into the recursive least squares (RLS) method to remedy the lack of knowledge of noise statistics, developed before as the extended forgetting factor recursive least squares (EFRLS) estimator. It is proved that the two fusion methods are equivalent to the centralized EFRLS that uses all measurements from local sensors directly and their good performance is shown by simulation examples.     

Suboptimal filter design with pseudomeasurements for targettracking

A suboptimal Kalman filter design method is presented for the problem of tracking a maneuvering target. The design method is essentially based on linear target dynamics and linear-like structured measurements called pseudomeasurements. The pseudomeasurements are obtained by manipulating the original nonlinear measurements algebraically. The resulting filter has computational advantages over other filters with similar performance. Also, a variant of the Berg model is proposed as a target acceleration model under the assumption of a coordinated turn maneuver. The proposed model is consistent with the underlying assumption. Monte Carlo computer simulation results are included to demonstrate the effectiveness of the proposed suboptimal filter associated with the target acceleration model     

Low observable target motion analysis using amplitude information

In conventional passive and active sonar system, target amplitude information (AI) at the output of the signal processor is used only to declare detections and provide measurements. We show that the AI can be used in passive sonar system, with or without frequency measurements, in the estimation process itself to enhance the performance in the presence of clutter where the target-originated measurements cannot be identified with certainty, i.e., for “low observable” or “dim” (low signal-to-noise ratio (SNR)) targets. A probabilistic data association (PDA) based maximum likelihood (ML) estimator for target motion analysis (TMA) that uses amplitude information is derived. A track formation algorithm and the Cramer-Rao lower bound (CRLB) in the presence of false measurements, which is met by the estimator even under low SNR conditions, are also given. The CRLB is met by the proposed estimator even at 6 dB in a cell (which corresponds to 0 dB for 1 Hz bandwidth in the case of a 0.25 Hz frequency cell) whereas the estimator without AI works only down to 9 dB. Results demonstrate improved accuracy and superior global convergence when compared with the estimator without AI. The same methodology can be used for bistatic radar     

基于双视线测量的相对导航方法

对非合作目标自主交会中的中远程相对导航问题进行研究.首先,给出二阶近似的航天器相对轨道动力学方程,并对视线(LOS)导航方法的可观测性进行了分析.然后,提出基于双视线测量的相对导航方案.该导航方案中,系统过程噪声模型采用适用于航天器远距离相对运动的轨道动力学方程;量测量包括目标对两个追踪航天器的视线角和追踪航天器之间的...     

双星编队对空间非合作目标的仅测角跟踪方法

针对单星仅测角对目标跟踪误差较大和不良测量条件下跟踪精度下降的问题,提出利用编队卫星对非合作目标进行联合跟踪的方法。采用考虑地球非球形J2引力摄动的轨道动力学模型,建立多视线测量模型,融合编队卫星对目标的观测数据。然后,基于新息设计增益调节矩阵提高滤波器在测量故障条件下的鲁棒性。最后,建立仿真模型进行验证。仿真结果表明,相比单星跟踪,该方法的位置误差和速度误差分别减少了27.06%和26.96%。在系统存在异常量测时,相比常规滤波,该方法也具有更高的精确性和更好的鲁棒性。     

基于自适应联邦滤波的相对导航信息融合

针对基于GPS/MV组合导航方式的无人机空中加油问题,分析了对接阶段GPS及视觉传感器存在的条件约束。在建立导航传感器非线性相对位置测量模型的基础上,设计了基于扩展卡尔曼滤波的自适应联邦滤波器,并与集中式滤波进行了对比仿真。结果表明,提出的算法保证了部分传感器失效时导航数据输出的平稳性和容错性,滤波精度完全满足无人机空中加油相对导航系统要求。     

自主多无人机的分散化协同控制

协同前提是无人机(UAV)平台间的通信和信息共享,无人机平台之间信息和计算是高度分布的,无人机平台的运动以及通信拓扑的变化,使得集中式协调控制结构很难实现。以最小通信量为基础的分散协同控制具有可扩展性、异构性和动态可重构性等特点,可靠性和鲁棒性较好。针对多无人机平台分散化协同的特点和要求,建立了集中和分散相结合的多无人机平台协同控制系统结构,集中式任务管理系统主要完成目标分配、通信管理和编队管理功能,分散式协同部分主要实现局部任务规划、协调策略及协调控制等功能。分别以多机协同目标跟踪、多机和多编队一致性协调、多机协同编队控制与重构等多无人机平台分散化协同控制技术为应用对象,探讨了分散化协调机制、策略、控制及其与信息之间关系。给出了部分算法的仿真结果。     

Tracking multitarget in cluttered environment

A method for multitarget tracking and initiating tracking in a cluttered environment is proposed. The algorithm uses a sliding window of length uT (T is the sampling time) to keep the measurement sequence at time k. Instead of solving a large problem, the entire set of targets and measurements is divided into several clusters so that a number of smaller problems are solved independently. When a set of measurements is received, a new set of data-association hypotheses is formed for all the measurements lying in the validation gates within each cluster from time K-u+1 to K. The probability of each track history is computed, and, choosing the largest of these histories, the target measurement is updated with an adaptive state estimator. A covariance-matching technique is used to improve the accuracy of the adaptive state estimator. In several examples, the algorithm successfully tracks targets over a wide range of conditions     

空间绳系机器人逼近目标协调控制方法

 为了节省空间绳系机器人的末端执行装置在逼近目标卫星过程中推力器所使用的燃料,本文提出一种利用推力器、反作用轮及空间系绳的协调控制方法。首先利用二次型最优控制器(LQR)算法计算出末端执行装置逼近目标所需的理想轨道控制力,然后利用模拟退火算法将所需轨道控制力优化分配到推力器及空间系绳,同时利用时间延迟算法通过反作用轮补偿空间系绳产生的姿态干扰力矩。仿真结果表明,利用该协调控制方法能显著节省末端执行装置上推力器的燃料消耗,有效抑制空间系绳协调控制力产生的姿态干扰,使末端执行装置保持相对稳定的姿态。     

Singularity analysis for single gimbal control moment gyroscope system using space expansion method

Control Moment Gyroscope (CMG) is an effective candidate for agile satellites and large spacecraft attitude control because of its powerful torque amplification capability. The most serious situation, however, in using CMG is the inherent geometric singularity problem, where there’s no torque output along a particular direction. Space expansion method has been proposed in this work for the singularity analysis. Based on inverse mapping transformation, an expanded Jacobian matrix which is a full rank square matrix is obtained. The singular angle sets of the 3-parallel cluster and pyramid cluster are distinguished using space expansion method. An effective hybrid steering strategy, able to deal with the elliptic singularity, is further proposed. Simulation results demonstrate the excellent performance of the proposed steering logic compared to the generalized singular robust logic and pseudo inverse logic in terms of energy consumption and torque error.     

基于MLR的机动平台传感器误差配准算法

 基于固定平台传感器误差极大似然配准(MLR)算法,针对机动平台存在姿态角系统误差的问题,提出了对机动平台传感器系统误差和目标状态进行批处理离线估计的机动极大似然配准(MLRM)算法.该算法利用所有传感器对目标的量测值,通过把传感器量测向目标状态进行投影、对传感器系统误差和目标状态进行期望最大化迭代以及对目标的状态进行融合估计,最终实现量测、姿态角系统误差和目标状态的有效估计.仿真结果表明,该算法迭代收敛速度快,对系统误差估计精度高,对系统误差可观测性较低的配准环境的适应性强并且对传感器姿态角的相关性不敏感,具有很强的工程实用性.     

基于相对导航的多平台INS误差联合修正方法

在机群协同编队飞行中,编队成员仅装载惯性导航系统(INS)的方式具有隐蔽、抗干扰等明显的优势,但随着航时的增加,INS误差将不断累积.使导航系统失效,为此,提出基于相对导航的多平台INS误差联合修正方法.首先,建立了编队成员相对导航运动模型及非线性观测模型,采用量测重构技术构造了伪线性观测模型并推导了观测噪声协方差矩阵...