[发明专利]一种移动目标协同定位系统及定位方法

说明书

技术领域

本发明专利涉及一种目标定位系统及方法，特别是一种移动目标协同定位系统及定位方法。

背景技术

目前，移动目标的定位得到了越来越多的关注，其精确定位能够详细说明“在什么时间或什么位置区域，移动目标位置和姿态处于什么状态”，而且随着其定位精度的不断提高，其应用的领域和范围在不断扩展。在面对一些复杂的任务时，如多机作业、工厂物流、智能调度等，移动目标甚至能够按照功能需求移动到预定目的地，因此定位技术为其提供了重要的支持。目前，移动目标定位常用的方法有GPS卫星定位、捷联惯导定位、视觉定位、无线传感器网络定位等方法。

在地面或空中等室外开阔环境下，为移动目标安装GPS接收器，能够实时获得移动目标的动态位置，尽管其定位精度比较低，仍然已经成为一种成熟的方案而受到广泛的应用。但是对于室内、矿井等封闭环境下移动目标定位，受到复杂环境对GPS信号传播的遮挡，从而在封闭环境下无法利用GPS获得移动目标的位置。

捷联惯导定位是利用移动目标在行进过程中自身存在的惯性，选用惯性敏感元件，能够准确输出移动目标的位置和姿态信息，但是存在传感器漂移和累计误差等不足，造成长时间后位置信息严重失信，而且没有地面或空中常用的GPS校准，从而造成无法单独使用捷联惯导进行定位。

视觉定位是利用视觉传感器技术来对目标进行摄像，通过物像特征点匹配、目标识别等方法来实现目标的位置和姿态输出，但是封闭环境下光照不均、图像变形、遮挡干扰等会给位姿解算带来误差，而且对移动目标缺乏快速高效的位姿解算方法，不适合用于移动目标的高精度定位。

无线传感器网络通过信号强度指示、信号到达时间差、到达时间以及到达角度等测距方法解算获得移动目标的位置，由于移动目标为一个空间三维物体，但是常常将其简化为一个质心体从而给定位解算带来较大误差，对于移动目标的实时姿态更是无法输出。

封闭环境下移动目标单独采用以上的定位方法，都无法准确的输出位置和姿态信息。

发明内容

技术问题：本发明的目的是克服已有技术中的不足之处，提出移动目标协同定位系统及定位方法，解决封闭环境下移动目标单独采用以上的定位方法，都无法准确的输出位置和姿态信息的问题。

针对上述问题，本发明提出一种移动目标协同定位系统，在移动目标上安装捷联惯导模块、超宽带无线接收器和协同定位模块，在定位区域内布置超宽带无线发射器；所述的协同定位模块中有捷联惯导参数通讯模块、无线参数通讯模块和协同运算处理单元；捷联惯导参数通讯模块与捷联惯导模块进行通讯，无线参数通讯模块与超宽带无线接收器进行通讯，协同运算处理单元对接收到的信息进行解算；捷联惯导模块测量得到的移动目标的姿态角、加速度、速度和位置运动参数，通过协同定位模块上的惯导参数通讯模块传输给协同运算处理单元；超宽带无线传感器测量得到的无线测距参数，通过协同定位模块上的无线参数通讯模块传输给协同运算处理单元，运动参数与测距参数在协同运算处理单元经数值解算，获得移动目标精确的位置和姿态信息。

一种移动目标协同定位方法，其特征是利用捷联惯导模块和超宽带无线传感器对移动目标的参数进行感知，建立捷联惯导和超宽带无线耦合模型，由捷联惯导模块输出移动目标高精度姿态信息，在捷联惯导模块输出的运动参数补偿下，超宽带无线传感器输出移动目标高精度的位置信息，并对捷联惯导模块输出的位置信息进行校正，从而实现封闭环境下定位区域内移动目标输出位置和姿态信息，包括以下步骤：

步骤1）捷联惯导模块与超宽带无线传感器协同下多源参量的实时感知与测距运算；

步骤2）移动目标的捷联惯导模块下运动参量与超宽带无线传感器无线信号间的误差传递分析与补偿；

步骤3）捷联惯导模块下高频位置信息与超宽带无线传感器下低频位置信息在不同坐标系下的统一变换；

步骤4）捷联惯导模块下姿态、加速度、速度与位置参量与超宽带无线传感器下信号到达时间差、到达角度间的交互耦合；

步骤5）捷联惯导模块与超宽带无线传感器协同下移动目标位置和姿态的解算与校正；

在步骤1）中，所述的捷联惯导模块与超宽带无线传感器协同下多源参量的实时感知与测距运算，具体为：将捷联惯导模块测量的数据通过积分运算得到移动目标粗略的位置和姿态，而将超宽带无线传感器测量的数据经过计算得到移动目标与超宽带无线发射器间的测距信息；