一种考虑有色噪声的室内目标组合定位方法及系统

本发明公开了一种考虑有色噪声的室内目标组合定位方法及系统，所述方法包括：基于状态向量，构建卡尔曼滤波算法的原始状态方程；基于惯性导航系统INS测量的当前时刻目标节点与参考节点之间的距离，以及超宽带UWB测量得到的当前时刻目标节点与超宽带UWB参考节点之间的距离，构建卡尔曼滤波算法的原始观测方程；基于卡尔曼滤波算法的原始观测方程，构建新的观测方程；基于新的观测方程和原始状态方程，构建新的状态方程；基于新的观测方程和新的状态方程，采用卡尔曼滤波算法进行数据融合，预估出惯性导航系统INS测量的目标节点位置的误差；基于所述误差和惯性导航系统INS测量的目标节点位置，确定目标节点的最终位置。