CN111077556A - 融合北斗与多传感器的机场行李牵引车定位装置与方法 - Google Patents
融合北斗与多传感器的机场行李牵引车定位装置与方法 Download PDFInfo
- Publication number
- CN111077556A CN111077556A CN202010000620.0A CN202010000620A CN111077556A CN 111077556 A CN111077556 A CN 111077556A CN 202010000620 A CN202010000620 A CN 202010000620A CN 111077556 A CN111077556 A CN 111077556A
- Authority
- CN
- China
- Prior art keywords
- positioning
- beidou
- information
- map
- imu
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 26
- 238000003860 storage Methods 0.000 claims abstract description 27
- 238000004891 communication Methods 0.000 claims abstract description 22
- 238000005259 measurement Methods 0.000 claims abstract description 20
- 230000004927 fusion Effects 0.000 claims abstract description 4
- 230000001133 acceleration Effects 0.000 claims description 30
- 238000012937 correction Methods 0.000 claims description 22
- 239000011159 matrix material Substances 0.000 claims description 20
- DMBHHRLKUKUOEG-UHFFFAOYSA-N diphenylamine Chemical compound C=1C=CC=CC=1NC1=CC=CC=C1 DMBHHRLKUKUOEG-UHFFFAOYSA-N 0.000 claims description 11
- 230000009977 dual effect Effects 0.000 claims description 10
- 238000001914 filtration Methods 0.000 claims description 10
- 238000012545 processing Methods 0.000 claims description 9
- 230000000007 visual effect Effects 0.000 claims description 5
- 230000010354 integration Effects 0.000 claims description 4
- 230000003416 augmentation Effects 0.000 claims description 3
- 230000008859 change Effects 0.000 claims description 3
- 238000009795 derivation Methods 0.000 claims description 3
- 238000006073 displacement reaction Methods 0.000 claims description 3
- 238000007667 floating Methods 0.000 claims description 3
- 230000007704 transition Effects 0.000 claims description 3
- 238000005516 engineering process Methods 0.000 description 12
- 238000005457 optimization Methods 0.000 description 5
- 230000008901 benefit Effects 0.000 description 4
- 238000011161 development Methods 0.000 description 4
- 238000010276 construction Methods 0.000 description 3
- 230000000694 effects Effects 0.000 description 2
- 230000006872 improvement Effects 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 238000013473 artificial intelligence Methods 0.000 description 1
- 230000001413 cellular effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000005265 energy consumption Methods 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 230000003137 locomotive effect Effects 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 230000001737 promoting effect Effects 0.000 description 1
- 238000004062 sedimentation Methods 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 230000001360 synchronised effect Effects 0.000 description 1
- 238000002054 transplantation Methods 0.000 description 1
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/42—Determining position
- G01S19/45—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement
- G01S19/46—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement the supplementary measurement being of a radio-wave signal type
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/42—Determining position
- G01S19/45—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement
- G01S19/47—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement the supplementary measurement being an inertial measurement, e.g. tightly coupled inertial
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Computer Networks & Wireless Communication (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Navigation (AREA)
Abstract
本发明公开了一种融合北斗与多传感器的机场行李牵引车定位装置，包括北斗基准站、北斗双天线定位定向系统、IMU惯导测量单元、双目相机测量单元、地图存储单元、通讯模块和处理器。本发明还公开了一种融合北斗与多传感器的机场行李牵引车定位方法，本发明室外环境下，利用北斗双天线/IMU松组合进行定位与测姿，并利用双目相机对三维地图进行更新；室内环境下，将结合双目相机/IMU/地图匹配进行定位与测姿以及三维地图的更新；多传感器数据融合通过自适应Kalman滤波器建立函数模型误差的拟合模型，使其适应行李牵引车特殊场景和相应传感器，得到位置与姿态信息的最优解，从而实现行李牵引车连续、高精度、高可靠性的室内外无缝定位。
Description
技术领域
本发明涉及车辆高精度定位技术领域，特别是一种融合北斗与多传感器的机场行李牵引车定位装置与方法。
背景技术
随着“工业4.0时代”的到来，数字信息化、智能化技术、云计算、大数据、人工智能等信息技术谋求发展空间，支撑行业运行安全、优化能源消耗、方便旅客出行的理念已逐步成为行业共识。在此背景下，2018年民航局提出实施新时代民航高质量发展战略，加快推进以“平安机场、绿色机场、智慧机场、人文机场”为核心的“四型机场”建设，着力打造运营集内在品质和外在品位于一体的现代化民用机场，要求我们从过去注重数量、总量、增量的量优式发展，转向注重质量、效率、效益的质优式发展；其中，智慧机场正是推进“四型机场”建设的关键支撑和实施路径。
根据《2018年民航机场生产统计公报》数据显示：2018年我国机场全年旅客运输量超过12亿人次，比上年增长10.2％，完成货邮运输量1674万吨，比上年增长3.5％。随着航空运输业务量的不断增长，我国大部分枢纽机场和干线机场保障能力面临着越来越大的压力，造成机场时隙资源使用紧张，空中交通拥堵，航班延误严重，服务质量下降。据不完全统计，每年中国航班延误直接损失超过500亿元。影响航班延误的可控因素中，存在着机场地面保障服务不力、机场服务能力急需提升等问题。这主要是由于机场拥有的特种车辆数较少，特种车辆定位精度低，特种车辆服务调度不佳等原因造成的。
机车地勤特种车辆的精确调度对提高航班正点率、保障飞行安全、提高民航服务质量和经济效益至关重要。精确定位技术是地勤特种车辆的精确调度的关键技术之一，是实现车辆安全通行的重要保障。虽然不同的特种车辆对定位精度要求不同，但定位的连续性是地勤特种车辆业务安全可靠的必要前提，考虑到环境(遮挡、光线、天气)、成本以及稳定性等因素，单纯采用某一种定位技术并不能满足地勤特种车辆的精确调度业务的定位需求。通常需要通过多种技术的融合来实现精准定位，包括GNSS、无线电(例如蜂窝网、局域网等)、惯性测量单元(Inertial Measurement Unit,IMU)、传感器以及高精度地图。其中，GNSS或其差分补偿RTK(Real-time Kinematic)，是最基本的定位方法。考虑到GNSS技术在遮挡场景、隧道以及室内的不稳定(或不可用)，其应用场景受限于室外环境。通常，GNSS或传感器等单一技术难以满足现实复杂环境中车辆高精度定位的要求，无法保证行李牵引车定位的连续性和稳定性。
发明内容
本发明所要解决的技术问题是克服现有技术的不足而提供一种北斗与多传感器融合的机场行李牵引车定位装置与方法，实现对行李牵引车的高精度定位。
本发明为解决上述技术问题采用以下技术方案：
根据本发明提出的一种融合北斗与多传感器的机场行李牵引车定位装置，包括北斗基准站、北斗双天线定位定向系统、惯导测量单元IMU、双目相机测量单元、通讯模块、地图存储单元和处理器；其中，
北斗基准站，安置于室外空旷环境，用于接收北斗卫星信号，输出差分改正信息通过通讯模块输出至北斗双天线定位定向系统；
北斗双天线定位定向系统，用于在室外环境时，将收到的差分改正信息和采集到的北斗卫星信号处理得到行李牵引车的位置、航向和俯仰角度经通讯模块输出至处理器；
惯导测量单元，用于将测量出的加速度值和角速度值经通讯模块输出至处理器；
双目相机测量单元，用于采集图片并处理得到颜色和距离信息经通讯模块输出至处理器；
地图存储单元，用于存储事先得到行李牵引车行驶环境的三维地图，地图存储单元存储于处理器中；
处理器，用于将收到的加速度值和角速度值进行处理，从而得到位置与姿态信息；用于调用地图存储单元的三维地图；用于将收到的颜色和距离信息结合三维地图进行匹配，得到位置信息，并根据实测信息，对地图进行更新；用于接收北斗双天线定位定向系统输出的位置、航向和俯仰角度；用于将接收到的各类信息通过自适应Kalman滤波器建立函数模型误差的拟合模型，从而得到位置与姿态信息的最优解。
作为本发明所述的一种融合北斗与多传感器的机场行李牵引车定位装置进一步优化方案，北斗基准站布设在机场周围空旷、地面基础设施沉降稳定的环境下，通过前期与IGS站点联测，并采用GAMIT软件进行求解，得到坐标；北斗基准站用于接收北斗卫星信号，并根据坐标计算差分改正数；机场周围是指离机场中心距离小于10km。
作为本发明所述的一种融合北斗与多传感器的机场行李牵引车定位装置进一步优化方案，北斗双天线定位定向系统为双天线模式，用于实现实时定位和定向功能；在室外环境下，主天线与主接收机利用差分改正数求解得到主天线的位置信息，此位置信息即为行李牵引车的位置信息，副天线与副接收机利用差分改正数求解得到副天线的位置信息，根据主、副天线的向量关系，从而得到行李牵引车航向和俯仰角度。
作为本发明所述的一种融合北斗与多传感器的机场行李牵引车定位装置进一步优化方案，地图存储单元包括两类信息：第一类是道路数据，道路数据包括车道线的位置、类型、宽度、坡度和曲率；第二类是车道周边的固定对象信息，具体包括交通标志、交通信号灯、车道限高、下水道口、障碍物、高架物体、防护栏、数目、道路边缘类型、路边地标；利用地图匹配将车辆位置定位在车道上。
作为本发明所述的一种融合北斗与多传感器的机场行李牵引车定位装置进一步优化方案，处理器用于存储事先测定的三维地图以及物体属性；处理器用于多传感器的数据融合，并解算行李牵引车的位置和姿态信息；室外环境下，室外环境且北斗卫星可见数超过3颗，处理器将选择利用北斗双天线定位定向系统所输出的位置、航向角和俯仰角与IMU所输出的加速度和角速度信息进行松组合定位，经自适应Kalman滤波求解出行李牵引车的最优解，双目相机根据自身位置计算拍摄到的物体在视觉空间中的位置，并结合地图存储单元对地图进行实时更新，并对IMU仪器误差进行校正；室内环境下或北斗卫星可见数小于4颗的室外环境，处理器将选择利用双目相机拍摄到的图像进行得到自身的位置信息与利用IMU所输出的加速度和角速度信息以及地图匹配，并经自适应Kalman滤波求解出行李牵引车的最优解。
一种融合北斗与多传感器的机场行李牵引车定位方法，包括如下步骤：
步骤1、室外环境下且北斗卫星可见数超过3颗，利用主天线和副天线以及北斗基准站输入的差分改正数进行主天线和副天线的定位，定位方程为：
式中：λ为波长，
为载波模糊度，LP、LΦ分别伪距双差、载波宽巷双差与几何距离双差之差，I为单位阵，VP、VΦ分别为伪距和载波残差，ΔX为坐标增量，A为坐标增量的系数矩阵；
将
浮点解及其协方差阵代入LAMBDA方法求解到达
固定解，进而得到主天线和副天线的坐标增量参数；
将主天线得到的位置信息作为行李牵引车的位置信息，以主天线为原点建立站心坐标系，根据主天线和副天线的基线向量信息，解算出副天线在该站心坐标系下的坐标(e,n,u)，e、n、u分别为站心坐标系下东、北、天方向上的坐标分量，解算出行李牵引车航向角y和俯仰角p:
y＝-arctan(e/n)
步骤2、将北斗双天线定位得到的位置与航向角y和俯仰角p，与IMU所得到的加速度与角速度信息进行松组合；其中，系统状态选取位置误差、速度误差和姿态误差，加速度器件误差和陀螺仪器件误差也被选取作为增广状态量，用于在线标定和补偿IMU误差；松组合kalman滤波器为：
式中：X(t)表示系统误差向量，
为X(t)的导数；F(t)表示系统的状态转移矩阵；w(t)表示系统噪声矩阵；G(t)表示系统噪声的驱动阵；
系统的观测方程表示为：
Z(t)＝H(t)X(t)+V(t)
式中：Z(t)为观测量，包括IMU通过加速度所得到的位置信息和北斗双天线所得到的位置信息之差，包括IMU通过加速度所得到的速度信息和北斗双天线所得到的位置求导得到的速度信息之差，还包括IMU通过角速度所得到的姿态信息与北斗双天线所得到的姿态信息之差；H(t)为系数矩阵；V(t)为观测噪声矩阵；
利用自适应kalman滤波方法，求解出行李牵引车的位置与姿态信息的最优解，并根据解算结果，对IMU仪器误差进行校正；
步骤3、双目相机根据已得到自身位置信息，对同一物体进行拍摄，然后通过同一物体在不同图像中的视差，计算出物体在实际空间中的位置，并与地图存储单元相对比，更新地图；
步骤4、双目相机根据已得到自身位置信息，对同一物体进行拍摄，然后通过同一物体在不同图像中的视差，计算出物体在实际空间中的位置，并与地图存储单元相对比，更新地图；
步骤5、室内环境下或北斗卫星可见数小于4颗的室外环境，IMU是配合双目相机，并利用地图进行匹配定位；通过IMU得到的载体位姿，为图片姿态提供定位，经过传感器间的外部标定，将对应的信息投射到全局三维坐标系；双目相机与地图匹配获取行李牵引车在其运动范围下的全局初始位置，该位置作为初始时刻IMU定位的初始位置，并初始行李牵引车的姿态信息；IMU对所测得的角速度进行积分得到行李牵引车转动的角度，并结合行李牵引车的初始姿态获得运动坐标系下行李牵引车各个方向上的加速度信息；对运动坐标系下行李牵引车各个方向上的加速度进行积分获得行李牵引车的位置变化；将IMU初始位置加上位置位移，获得行李牵引车相邻两时刻之间的实时位置；将当前时刻的视觉定位下行李牵引车的位置信息和IMU定位下行李牵引车的位置信息以及三维地图进行融合，利用自适应kalman滤波方法，求解出行李牵引车的位置与姿态信息的最优解，并更新IMU的初始位置；双目相机根据已得到自身位置信息，结合所拍摄的图片，计算出物体在实际空间中的位置，并与地图存储单元相对比，更新地图。
作为本发明所述的一种融合北斗与多传感器的机场行李牵引车定位方法进一步优化方案，双目相机在室外环境下且北斗卫星可见数超过3颗，是利用拍摄的图片对地图进行更新；双目相机在室内环境下或北斗卫星可见数小于4颗的室外环境，是融合IMU和地图匹配进行定位，辅助功能是利用拍摄的图片计算其空间位置，以实现对地图进行更新。
本发明采用以上技术方案与现有技术相比，具有以下技术效果：
(1)相对于现有的技术而言，本发明通过行李牵引车车载的北斗双天线测量其位置和姿态信息，IMU惯导测量单元通过测量的加速度值和角速度值计算行李牵引车的位置和姿态信息，双目相机利用所获得的两幅图像直接计算出物体深度值，并与高精度地图匹配得到行李牵引车的位置信息。在对各传感器函数模型误差充分识别的基础上，通过自适应Kalman滤波器建立函数模型误差的拟合模型，并实时或准实时地修改原有的函数模型，使其适应行李牵引车特殊场景和相应传感器，得到位置与姿态信息的最优解，从而实现行李牵引车连续、高精度、高可靠性的室内外无缝定位；
(2)本发明采用车载北斗双天线定位定向、IMU惯性测量单元、双目相机及高精度地图相结合的方式进行行李牵引车的定位定向，最主要的优势在于：①实现了室内、室外的无缝高精度定位与测姿；②IMU数据与其他传感器相结合能提高整体定位精度和连续性；③双目相机和高精度地图的引入，不仅可以解决行李牵引车的定位问题，还可以根据双目相机观测到的物体的位置信息，对高精度地图进行实时更新；
(3)本发明专利旨在研究机场行李牵引车室内外无缝高精度定位技术，提出基于北斗+多传感器的车辆高精度定位装置及相应关键技术，为纯室内和纯室外运行的其他车辆，如航站楼内应急车、巡逻车、摆渡车、飞机牵引车、清水车、飞机专用除冰车、消防救援车等地勤车的精确定位提供技术移植；将为“四型机场”的实现提供基础技术支撑，同时，这也是“智慧机场”、“平安机场”建设的主要组成部分。
附图说明
图1是本发明行李牵引车的车载定位装置实时例的结构示意图。
图2是本发明行李牵引车的车载定位装置处于工作状态时，车载定位装置的安装示意图。
图3是本发明行李牵引车的车载定位算法流程图。
具体实施方式
为了使本发明的目的，技术方案和优点更加清楚，下面结合附图对本发明的技术方案做进一步的详细说明：
参照图1，图1是本发明行李牵引车的车载定位装置实时例的结构示意图，包括：北斗基准站、北斗双天线定位定向系统、IMU惯导测量单元、双目相机测量单元、通讯模块、地图存储单元和处理器。
其中，北斗基准站，安置于室外空旷环境，用于接收北斗卫星信号，输出差分改正数通过通讯模块输出至北斗双天线定位定向系统；
北斗双天线定位定向系统，用于室外环境，将收到的差分改正信息和采集到的北斗卫星信号处理得到行李牵引车的位置、航向和俯仰角度经通讯模块输出至处理器；
IMU惯导测量单元，用于将测量出的加速度值和角速度值经通讯模块输出至处理器；
双目相机测量单元，用于采集图片并处理得到颜色和距离信息经通讯模块输出至处理器；
地图存储单元，用于存储事先得到行李牵引车行驶环境的三维地图，并存储于处理器；
处理器，用于将收到的加速度值和角速度值进行处理，从而得到位置与姿态信息；用于调用地图存储单元的三维地图；用于将收到的颜色和距离信息结合三维地图进行匹配，得到位置信息，并根据实测信息，对地图进行更新；用于接收北斗双天线定位定向系统输出的位置和姿态信息；用于将接收到的各类信息通过自适应Kalman滤波器建立函数模型误差的拟合模型，使其适应行李牵引车特殊场景和相应传感器，得到位置与姿态信息的最优解，从而得到连续、高精度、高可靠行李牵引车的位置与姿态信息。
参照图2所示，将车载定位装置中的各结构部件正确的安装。北斗基准站通过通讯模块向北斗双天线定位定向系统发送差分改正数，北斗双天线定位定向系统、IMU惯导测量单元、双目相机通过数据线分别与通讯模块相连接，地图存储单元存储于处理器，通讯模块和处理器可实现双向通讯，处理器对各传感器所输出的数据进行融合，最终实现行李牵引车的定位与测姿以及对三维地图的更新；
参照图3，图3是本发明行李牵引车的车载定位算法流程图。本发明还公开了一种机场行李牵引车精确定位方法的实施例。该方法基于行李牵引车精确定位装置，装置包括：北斗基准站、北斗双天线定位定向系统、IMU惯导测量单元、双目相机测量单元、地图存储单元、通讯模块和处理器；该方法得实施包括如下步骤：
步骤1：室外环境下(北斗卫星可见数超过3颗)，利用主天线和副天线以及北斗基准站通过通讯模块输入的差分改正数进行主天线和副天线的定位，定位方程为：
式中：λ为波长；
为载波模糊度；LP、LΦ分别伪距双差、载波宽巷双差与几何距离双差之差；I为单位阵；VP、VΦ分别为伪距和载波残差；ΔX为坐标增量；A为坐标增量的系数矩阵。
将
浮点解及其协方差阵代入LAMBDA方法求解到达
固定解，进而得到主天线和副天线的坐标增量参数。
将主天线得到的位置信息作为行李牵引车的位置信息，以主天线为原点建立站心坐标系，根据主天线和副天线的基线向量信息，可以解算出副天线在该站心坐标系下的坐标(e,n,u)，e、n、u分别为站心坐标系下东、北、天方向上的坐标分量，可以解算出行李牵引车航向角y和俯仰角p:
y＝-arctan(e/n)
步骤2：将北斗双天线定位得到的位置与航向角y和俯仰角p，与IMU所得到的加速度与角速度信息进行松组合。其中，系统状态选取位置误差、速度误差和姿态误差，加速度器件误差和陀螺仪器件误差也被选取作为增广状态量，用于在线标定和补偿IMU误差。松组合kalman滤波器为：
式中：X(t)表示系统误差向量，
为X(t)的导数；F(t)表示系统的状态转移矩阵；w(t)表示系统噪声矩阵；G(t)表示系统噪声的驱动阵。
系统的观测方程可表示为：
Z(t)＝H(t)X(t)+V(t)
式中：Z(t)为观测量，包括IMU通过加速度所得到的位置信息和北斗双天线所得到的位置信息之差，包括IMU通过加速度所得到的速度信息和北斗双天线所得到的位置求导得到的速度信息之差，还包括IMU通过角速度所得到的姿态信息与北斗双天线所得到的姿态信息之差；H(t)为系数矩阵；V(t)为观测噪声矩阵。
利用自适应kalman滤波方法，求解出行李牵引车的位置与姿态信息的最优解，从而提高车辆定位和定向的精度，并根据解算结果，对IMU仪器误差进行校正。
步骤3：双目相机根据已得到自身位置信息，对同一物体进行拍摄，然后通过同一物体在不同图像中的视差，计算出物体在实际空间中的位置，并与地图存储单元相对比，更新地图。
步骤4：双目相机根据已得到自身位置信息，对同一物体进行拍摄，然后通过同一物体在不同图像中的视差，计算出物体在实际空间中的位置，并与地图存储单元相对比，更新地图。
步骤5：室内环境下(也包括北斗卫星可见数小于4颗的室外环境)，IMU惯导测量单元是配合双目相机，并利用地图进行匹配定位。通过IMU惯导测量单元得到的载体位姿，可为图片姿态提供高精度高频定位，经过传感器间的外部标定，将对应的信息投射到全局三维坐标系。双目相机与地图匹配获取行李牵引车在其运动范围下的全局初始位置，该位置作为初始时刻IMU定位的初始位置，并初始行李牵引车的姿态信息；IMU对所测得的角速度进行积分得到行李牵引车转动的角度，并结合行李牵引车的初始姿态可以获得运动坐标系下行李牵引车各个方向上的加速度信息；对运动坐标系下行李牵引车各个方向上的加速度进行积分可以获得行李牵引车的位置变化；把IMU初始位置加上位置位移，就可以获得行李牵引车相邻两时刻之间的实时位置；将当前时刻的视觉定位下行李牵引车的位置信息和IMU定位下行李牵引车的位置信息以及三维地图进行融合，利用自适应kalman滤波方法，求解出行李牵引车的位置与姿态信息的最优解，并更新IMU的初始位置。双目相机根据已得到自身位置信息，结合所拍摄的图片，计算出物体在实际空间中的位置，并与地图存储单元相对比，更新地图。
影响本实时例定位精度的主要因素如下：
1、北斗接收机硬件指标，此硬件指标越高，定位精度越高。例如，硬件指标较低的低成本的接收机，在静止状态下，其数据完整率、卫星可见数、信噪比、多路径效应、周跳发生率以及伪距和载波相位噪声等均低于硬件指标较高的接收机。
2、北斗差分改正数据的接收，此改正数据精度越高，定位精度越高。例如，无改正数据的情况下，北斗伪距单点定位精度为3-10m；只包括伪距差分改正数的情况下，北斗伪距差分定位(RTD)精度为亚米级～分米级；既有伪距差分改正数又有载波差分改正数的情况下，北斗载波差分定位(RTK)精度为厘米级～分米级。
3、地图的精度，此地图精度越高，定位精度越高。例如，常规的地图精度为米级，双目相机的定位精度为厘米级，而匹配的定位精度仅能实现米级的定位。
4、IMU的测量精度，此测量精度越高，测姿精度越高。姿态不准导致重力影响去除不了，误差不断累积；器件本身漂移不能去除，如加速度计从静止到运动再到静止，加速度积分得到的速度应该为0，而实际不为0。
5、多传感器的时钟同步精度，此精度越高，定位精度越高。高精度定位系统的同步精度每降低3ns就会引入1米左右的测距误差，因此时钟同步性能成为高精度同步技术的关键指标，地面定位网元节点间的高精度同步技术是这个领域研究的关键。
以上所述，仅为本发明的具体实施方式，但本发明的保护范围并不局限于此，任何熟悉本技术领域的技术人员在本发明揭露的技术范围内，可轻易想到的变化或替换，都应涵盖在本发明的保护范围内。
Claims (7)
1.一种融合北斗与多传感器的机场行李牵引车定位装置，其特征在于，包括北斗基准站、北斗双天线定位定向系统、惯导测量单元IMU、双目相机测量单元、通讯模块、地图存储单元和处理器；其中，
北斗基准站，安置于室外空旷环境，用于接收北斗卫星信号，输出差分改正信息通过通讯模块输出至北斗双天线定位定向系统；
北斗双天线定位定向系统，用于在室外环境时，将收到的差分改正信息和采集到的北斗卫星信号处理得到行李牵引车的位置、航向和俯仰角度经通讯模块输出至处理器；
惯导测量单元，用于将测量出的加速度值和角速度值经通讯模块输出至处理器；
双目相机测量单元，用于采集图片并处理得到颜色和距离信息经通讯模块输出至处理器；
地图存储单元，用于存储事先得到行李牵引车行驶环境的三维地图，地图存储单元存储于处理器中；
处理器，用于将收到的加速度值和角速度值进行处理，从而得到位置与姿态信息；用于调用地图存储单元的三维地图；用于将收到的颜色和距离信息结合三维地图进行匹配，得到位置信息，并根据实测信息，对地图进行更新；用于接收北斗双天线定位定向系统输出的位置、航向和俯仰角度；用于将接收到的各类信息通过自适应Kalman滤波器建立函数模型误差的拟合模型，从而得到位置与姿态信息的最优解。
2.根据权利要求1所述的一种融合北斗与多传感器的机场行李牵引车定位装置，其特征在于，北斗基准站布设在机场周围空旷、地面基础设施沉降稳定的环境下，通过前期与IGS站点联测，并采用GAMIT软件进行求解，得到坐标；北斗基准站用于接收北斗卫星信号，并根据坐标计算差分改正数；机场周围是指离机场中心距离小于10km。
3.根据权利要求1所述的一种融合北斗与多传感器的机场行李牵引车定位装置，其特征在于，北斗双天线定位定向系统为双天线模式，用于实现实时定位和定向功能；在室外环境下，主天线与主接收机利用差分改正数求解得到主天线的位置信息，此位置信息即为行李牵引车的位置信息，副天线与副接收机利用差分改正数求解得到副天线的位置信息，根据主、副天线的向量关系，从而得到行李牵引车航向和俯仰角度。
4.根据权利要求1所述的一种融合北斗与多传感器的机场行李牵引车定位装置，其特征在于，地图存储单元包括两类信息：第一类是道路数据，道路数据包括车道线的位置、类型、宽度、坡度和曲率；第二类是车道周边的固定对象信息，具体包括交通标志、交通信号灯、车道限高、下水道口、障碍物、高架物体、防护栏、数目、道路边缘类型、路边地标；利用地图匹配将车辆位置定位在车道上。
5.根据权利要求1所述的一种融合北斗与多传感器的机场行李牵引车定位装置，其特征在于，处理器用于存储事先测定的三维地图以及物体属性；处理器用于多传感器的数据融合，并解算行李牵引车的位置和姿态信息；室外环境下，室外环境且北斗卫星可见数超过3颗，处理器将选择利用北斗双天线定位定向系统所输出的位置、航向角和俯仰角与IMU所输出的加速度和角速度信息进行松组合定位，经自适应Kalman滤波求解出行李牵引车的最优解，双目相机根据自身位置计算拍摄到的物体在视觉空间中的位置，并结合地图存储单元对地图进行实时更新，并对IMU仪器误差进行校正；室内环境下或北斗卫星可见数小于4颗的室外环境，处理器将选择利用双目相机拍摄到的图像进行得到自身的位置信息与利用IMU所输出的加速度和角速度信息以及地图匹配，并经自适应Kalman滤波求解出行李牵引车的最优解。
6.一种融合北斗与多传感器的机场行李牵引车定位方法，其特征在于，包括如下步骤：
步骤1、室外环境下且北斗卫星可见数超过3颗，利用主天线和副天线以及北斗基准站输入的差分改正数进行主天线和副天线的定位，定位方程为：
式中：λ为波长，▽ΔN为载波模糊度，LP、LΦ分别伪距双差、载波宽巷双差与几何距离双差之差，I为单位阵，VP、VΦ分别为伪距和载波残差，ΔX为坐标增量，A为坐标增量的系数矩阵；
将▽ΔN浮点解及其协方差阵代入LAMBDA方法求解到达▽ΔN固定解，进而得到主天线和副天线的坐标增量参数；
将主天线得到的位置信息作为行李牵引车的位置信息，以主天线为原点建立站心坐标系，根据主天线和副天线的基线向量信息，解算出副天线在该站心坐标系下的坐标(e,n,u)，e、n、u分别为站心坐标系下东、北、天方向上的坐标分量，解算出行李牵引车航向角y和俯仰角p:
y＝-arctan(e/n)
步骤2、将北斗双天线定位得到的位置与航向角y和俯仰角p，与IMU所得到的加速度与角速度信息进行松组合；其中，系统状态选取位置误差、速度误差和姿态误差，加速度器件误差和陀螺仪器件误差也被选取作为增广状态量，用于在线标定和补偿IMU误差；松组合kalman滤波器为：
式中：X(t)表示系统误差向量，
为X(t)的导数；F(t)表示系统的状态转移矩阵；w(t)表示系统噪声矩阵；G(t)表示系统噪声的驱动阵；
系统的观测方程表示为：
Z(t)＝H(t)X(t)+V(t)
式中：Z(t)为观测量，包括IMU通过加速度所得到的位置信息和北斗双天线所得到的位置信息之差，包括IMU通过加速度所得到的速度信息和北斗双天线所得到的位置求导得到的速度信息之差，还包括IMU通过角速度所得到的姿态信息与北斗双天线所得到的姿态信息之差；H(t)为系数矩阵；V(t)为观测噪声矩阵；
利用自适应kalman滤波方法，求解出行李牵引车的位置与姿态信息的最优解，并根据解算结果，对IMU仪器误差进行校正；
步骤3、双目相机根据已得到自身位置信息，对同一物体进行拍摄，然后通过同一物体在不同图像中的视差，计算出物体在实际空间中的位置，并与地图存储单元相对比，更新地图；
步骤4、双目相机根据已得到自身位置信息，对同一物体进行拍摄，然后通过同一物体在不同图像中的视差，计算出物体在实际空间中的位置，并与地图存储单元相对比，更新地图；
步骤5、室内环境下或北斗卫星可见数小于4颗的室外环境，IMU是配合双目相机，并利用地图进行匹配定位；通过IMU得到的载体位姿，为图片姿态提供定位，经过传感器间的外部标定，将对应的信息投射到全局三维坐标系；双目相机与地图匹配获取行李牵引车在其运动范围下的全局初始位置，该位置作为初始时刻IMU定位的初始位置，并初始行李牵引车的姿态信息；IMU对所测得的角速度进行积分得到行李牵引车转动的角度，并结合行李牵引车的初始姿态获得运动坐标系下行李牵引车各个方向上的加速度信息；对运动坐标系下行李牵引车各个方向上的加速度进行积分获得行李牵引车的位置变化；将IMU初始位置加上位置位移，获得行李牵引车相邻两时刻之间的实时位置；将当前时刻的视觉定位下行李牵引车的位置信息和IMU定位下行李牵引车的位置信息以及三维地图进行融合，利用自适应kalman滤波方法，求解出行李牵引车的位置与姿态信息的最优解，并更新IMU的初始位置；双目相机根据已得到自身位置信息，结合所拍摄的图片，计算出物体在实际空间中的位置，并与地图存储单元相对比，更新地图。
7.根据权利要求6所述的一种融合北斗与多传感器的机场行李牵引车定位方法，其特征在于，双目相机在室外环境下且北斗卫星可见数超过3颗，是利用拍摄的图片对地图进行更新；双目相机在室内环境下或北斗卫星可见数小于4颗的室外环境，是融合IMU和地图匹配进行定位，辅助功能是利用拍摄的图片计算其空间位置，以实现对地图进行更新。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202010000620.0A CN111077556B (zh) | 2020-01-02 | 2020-01-02 | 融合北斗与多传感器的机场行李牵引车定位装置与方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202010000620.0A CN111077556B (zh) | 2020-01-02 | 2020-01-02 | 融合北斗与多传感器的机场行李牵引车定位装置与方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN111077556A true CN111077556A (zh) | 2020-04-28 |
| CN111077556B CN111077556B (zh) | 2022-04-15 |
Family
ID=70321640
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202010000620.0A Active CN111077556B (zh) | 2020-01-02 | 2020-01-02 | 融合北斗与多传感器的机场行李牵引车定位装置与方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN111077556B (zh) |
Cited By (12)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN111702763A (zh) * | 2020-06-28 | 2020-09-25 | 国网四川省电力公司电力科学研究院 | 一种基于北斗系统的变电站巡检机器人重定位系统及方法 |
| CN111707256A (zh) * | 2020-05-13 | 2020-09-25 | 苏州天炯信息科技有限公司 | 一种助航灯快速布置特种车辆的综合定位导航设备 |
| CN112672282A (zh) * | 2020-12-25 | 2021-04-16 | 山东建筑大学 | 基于imu的地排车输送窑车用实时定位系统及方法 |
| CN112711055A (zh) * | 2020-12-08 | 2021-04-27 | 重庆邮电大学 | 一种基于边缘计算的室内外无缝定位系统及方法 |
| CN113029130A (zh) * | 2021-05-27 | 2021-06-25 | 腾讯科技（深圳）有限公司 | 数据处理方法、装置、计算机设备和存储介质 |
| CN113124919A (zh) * | 2021-04-09 | 2021-07-16 | 中移(上海)信息通信科技有限公司 | 参考站的异常监测方法、装置及相关设备 |
| CN113341444A (zh) * | 2021-06-30 | 2021-09-03 | 中国船舶重工集团公司第七一三研究所 | 一种机场行李智能全向输转平台定位导航系统和方法 |
| CN113721279A (zh) * | 2021-08-31 | 2021-11-30 | 中铝视拓智能科技有限公司 | 一种室内外场景切换定位装置及方法 |
| CN114185071A (zh) * | 2021-12-10 | 2022-03-15 | 武汉市虎联智能科技有限公司 | 一种基于物体识别和空间位置感知的定位系统及方法 |
| CN114396943A (zh) * | 2022-01-12 | 2022-04-26 | 国家电网有限公司 | 一种融合定位方法与终端 |
| CN115797913A (zh) * | 2023-01-30 | 2023-03-14 | 江苏天一航空工业股份有限公司 | 一种物流行李牵引车自动驾驶交通信号灯识别系统 |
| CN116858276A (zh) * | 2023-06-14 | 2023-10-10 | 武汉大学 | 一种地图辅助的多传感器融合定位方法及计算机可读介质 |
Citations (8)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN205103405U (zh) * | 2015-10-28 | 2016-03-23 | 上海安悦四维信息技术有限公司 | 一种基于北斗导航定位模块的车载终端 |
| CN106941395A (zh) * | 2017-03-06 | 2017-07-11 | 东南大学 | 一种车载定位装置及定位方法 |
| CN107238384A (zh) * | 2017-05-26 | 2017-10-10 | 高武保 | 一种基于多模式协同的军民两用智能导航系统 |
| CN108051837A (zh) * | 2017-11-30 | 2018-05-18 | 武汉大学 | 多传感器集成室内外移动测绘装置及自动三维建模方法 |
| CN108196285A (zh) * | 2017-11-30 | 2018-06-22 | 中山大学 | 一种基于多传感器融合的精确定位系统 |
| CN108303721A (zh) * | 2018-02-12 | 2018-07-20 | 北京经纬恒润科技有限公司 | 一种车辆定位方法及系统 |
| CN108458746A (zh) * | 2017-12-23 | 2018-08-28 | 天津国科嘉业医疗科技发展有限公司 | 一种基于多类型传感器自适应融合方法 |
| CN108802786A (zh) * | 2018-07-20 | 2018-11-13 | 北斗星通（重庆）汽车电子有限公司 | 一种车载定位方法 |
-
2020
- 2020-01-02 CN CN202010000620.0A patent/CN111077556B/zh active Active
Patent Citations (8)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN205103405U (zh) * | 2015-10-28 | 2016-03-23 | 上海安悦四维信息技术有限公司 | 一种基于北斗导航定位模块的车载终端 |
| CN106941395A (zh) * | 2017-03-06 | 2017-07-11 | 东南大学 | 一种车载定位装置及定位方法 |
| CN107238384A (zh) * | 2017-05-26 | 2017-10-10 | 高武保 | 一种基于多模式协同的军民两用智能导航系统 |
| CN108051837A (zh) * | 2017-11-30 | 2018-05-18 | 武汉大学 | 多传感器集成室内外移动测绘装置及自动三维建模方法 |
| CN108196285A (zh) * | 2017-11-30 | 2018-06-22 | 中山大学 | 一种基于多传感器融合的精确定位系统 |
| CN108458746A (zh) * | 2017-12-23 | 2018-08-28 | 天津国科嘉业医疗科技发展有限公司 | 一种基于多类型传感器自适应融合方法 |
| CN108303721A (zh) * | 2018-02-12 | 2018-07-20 | 北京经纬恒润科技有限公司 | 一种车辆定位方法及系统 |
| CN108802786A (zh) * | 2018-07-20 | 2018-11-13 | 北斗星通（重庆）汽车电子有限公司 | 一种车载定位方法 |
Cited By (16)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN111707256A (zh) * | 2020-05-13 | 2020-09-25 | 苏州天炯信息科技有限公司 | 一种助航灯快速布置特种车辆的综合定位导航设备 |
| CN111702763A (zh) * | 2020-06-28 | 2020-09-25 | 国网四川省电力公司电力科学研究院 | 一种基于北斗系统的变电站巡检机器人重定位系统及方法 |
| CN112711055B (zh) * | 2020-12-08 | 2024-03-19 | 重庆邮电大学 | 一种基于边缘计算的室内外无缝定位系统及方法 |
| CN112711055A (zh) * | 2020-12-08 | 2021-04-27 | 重庆邮电大学 | 一种基于边缘计算的室内外无缝定位系统及方法 |
| CN112672282A (zh) * | 2020-12-25 | 2021-04-16 | 山东建筑大学 | 基于imu的地排车输送窑车用实时定位系统及方法 |
| CN113124919A (zh) * | 2021-04-09 | 2021-07-16 | 中移(上海)信息通信科技有限公司 | 参考站的异常监测方法、装置及相关设备 |
| CN113124919B (zh) * | 2021-04-09 | 2021-12-07 | 中移(上海)信息通信科技有限公司 | 参考站的异常监测方法、装置及相关设备 |
| CN113029130A (zh) * | 2021-05-27 | 2021-06-25 | 腾讯科技（深圳）有限公司 | 数据处理方法、装置、计算机设备和存储介质 |
| CN113029130B (zh) * | 2021-05-27 | 2021-08-27 | 腾讯科技（深圳）有限公司 | 数据处理方法、装置、计算机设备和存储介质 |
| CN113341444A (zh) * | 2021-06-30 | 2021-09-03 | 中国船舶重工集团公司第七一三研究所 | 一种机场行李智能全向输转平台定位导航系统和方法 |
| CN113721279A (zh) * | 2021-08-31 | 2021-11-30 | 中铝视拓智能科技有限公司 | 一种室内外场景切换定位装置及方法 |
| CN114185071A (zh) * | 2021-12-10 | 2022-03-15 | 武汉市虎联智能科技有限公司 | 一种基于物体识别和空间位置感知的定位系统及方法 |
| CN114396943A (zh) * | 2022-01-12 | 2022-04-26 | 国家电网有限公司 | 一种融合定位方法与终端 |
| CN115797913A (zh) * | 2023-01-30 | 2023-03-14 | 江苏天一航空工业股份有限公司 | 一种物流行李牵引车自动驾驶交通信号灯识别系统 |
| CN116858276A (zh) * | 2023-06-14 | 2023-10-10 | 武汉大学 | 一种地图辅助的多传感器融合定位方法及计算机可读介质 |
| CN116858276B (zh) * | 2023-06-14 | 2024-05-28 | 武汉大学 | 一种地图辅助的多传感器融合定位方法及计算机可读介质 |
Also Published As
| Publication number | Publication date |
|---|---|
| CN111077556B (zh) | 2022-04-15 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN111077556B (zh) | 融合北斗与多传感器的机场行李牵引车定位装置与方法 | |
| CN110926474B (zh) | 卫星/视觉/激光组合的城市峡谷环境uav定位导航方法 | |
| CN110274588B (zh) | 基于无人机集群信息的双层嵌套因子图多源融合导航方法 | |
| CN103822635B (zh) | 基于视觉信息的无人机飞行中空间位置实时计算方法 | |
| US7805244B2 (en) | Attitude correction apparatus and method for inertial navigation system using camera-type solar sensor | |
| CN102353377B (zh) | 一种高空长航时无人机组合导航系统及其导航定位方法 | |
| CN103822631B (zh) | 一种面向旋翼的卫星和光流场视觉结合的定位方法与装置 | |
| CN112066979B (zh) | 一种基于偏振位姿信息耦合迭代自主导航定位方法 | |
| CN111649737B (zh) | 一种面向飞机精密进近着陆的视觉-惯性组合导航方法 | |
| CN101270993A (zh) | 一种远程高精度自主组合导航定位方法 | |
| CN104360362B (zh) | 利用飞行器对观测目标进行定位的方法及系统 | |
| CN110186468B (zh) | 用于自动驾驶的高精度地图制作方法和制作装置 | |
| CN109506660B (zh) | 一种用于仿生导航的姿态最优化解算方法 | |
| WO2020124624A1 (zh) | 一种紧耦合的自动驾驶感知方法及系统 | |
| CN111426320A (zh) | 一种基于图像匹配/惯导/里程计的车辆自主导航方法 | |
| CN113419235A (zh) | 一种基于毫米波雷达的无人机定位方法 | |
| KR100556104B1 (ko) | Ｇｐｓ／ｉｎｓ 비행선을 이용한 항공측량방법 | |
| CN110968113B (zh) | 一种无人机自主跟踪起降系统及跟踪定位方法 | |
| CN109596127A (zh) | 一种无线电辅助航位推算的导航方法 | |
| Xiang et al. | A SINS/GNSS/2D-LDV integrated navigation scheme for unmanned ground vehicles | |
| CN115202383B (zh) | 一种无人机多维航迹表达及生成方法 | |
| CN115542363B (zh) | 一种适用于垂直下视航空吊舱的姿态测量方法 | |
| CN113156366B (zh) | 一种嘈杂电磁环境下集群无人机的空间定位方法 | |
| CN115479605A (zh) | 基于空间目标定向观测的高空长航时无人机自主导航方法 | |
| CN110887475B (zh) | 一种基于偏振北极点及偏振太阳矢量的静基座粗对准方法 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| PB01 | Publication | ||
| PB01 | Publication | ||
| SE01 | Entry into force of request for substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| GR01 | Patent grant | ||
| GR01 | Patent grant |