CN104007459B - 一种车载组合定位装置 - Google Patents

一种车载组合定位装置 Download PDF

Info

Publication number
CN104007459B
CN104007459B CN201410240140.6A CN201410240140A CN104007459B CN 104007459 B CN104007459 B CN 104007459B CN 201410240140 A CN201410240140 A CN 201410240140A CN 104007459 B CN104007459 B CN 104007459B
Authority
CN
China
Prior art keywords
mtd
msub
mrow
mtr
mfrac
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.)
Expired - Fee Related
Application number
CN201410240140.6A
Other languages
English (en)
Other versions
CN104007459A (zh
Inventor
王博
李冰
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Beijing Is Melted Chile And Is Reached Science And Technology Ltd
Original Assignee
Beijing Is Melted Chile And Is Reached Science And Technology Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Beijing Is Melted Chile And Is Reached Science And Technology Ltd filed Critical Beijing Is Melted Chile And Is Reached Science And Technology Ltd
Priority to CN201410240140.6A priority Critical patent/CN104007459B/zh
Publication of CN104007459A publication Critical patent/CN104007459A/zh
Application granted granted Critical
Publication of CN104007459B publication Critical patent/CN104007459B/zh
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39Determining 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/42Determining position
    • G01S19/48Determining position by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system

Abstract

本发明提供了一种车载组合定位装置,设置在移动的车辆上,包括卫星导航单元,还包括RFID定位单元和中心处理单元;中心处理单元分别与卫星导航单元和RFID定位单元连接;卫星导航单元接收导航卫星信号并输出第一当前位置信息到中心处理单元;RFID定位单元中设置有阅读器,阅读器识别预先设置在车辆经过的路径的应答器,并根据应答器对应的位置信息解读出第二当前位置信息;中心处理单元对接收到的第一当前位置信息、第二当前位置信息进行综合得到车辆的当前位置信息。本发明应用于车辆导航领域。

Description

一种车载组合定位装置
技术领域
本发明涉及一种组合定位装置,特别是一种设置在移动的车辆上的车载组合定位装置。
背景技术
现在,在汽车上装载卫星导航定位装置非常普遍,为驾驶者提供了极大的便利,特别是在陌生环境驾驶,这种便利更加有益。
但卫星导航定位装置存在的一个问题是:在不能接收到卫星信号的地域,例如隧道、高楼密集的地方卫星导航定位装置会失效。在现代城市,这种不易接收到卫星信号的地域越来越广,以至于驾驶者无法依赖卫星导航定位装置进行导航。
人们开发出多种技术以解决上述问题,例如在卫星导航装置上引入惯性导航设备,在失去卫星信号时依赖惯性导航设备提供的导航信息进行弥补。出于成本考虑,惯性导航设备难以采用高精度的惯性导航系统,其精度较低,这在一定程度上降低了导航系统的准确性。
发明内容
为了解决卫星导航定位装置在不能接收卫星信号的情况下仍能提供高精度的导航信息,本发明提供了一种车载组合定位装置。
本发明的技术方案如下:
一种车载组合定位装置,设置在移动的车辆上,包括卫星导航单元,还包括RFID定位单元和中心处理单元;所述中心处理单元分别与所述卫星导航单元和所述RFID定位单元连接;
所述卫星导航单元接收导航卫星信号并输出第一当前位置信息到所述中心处理单元;
所述RFID定位单元中设置有阅读器,所述阅读器识别预先设置在所述车辆经过的路径的应答器,并根据所述应答器对应的位置信息解读出第二当前位置信息;
所述中心处理单元对接收到的所述第一当前位置信息、所述第二当前位置信息进行综合得到所述车辆的当前位置信息。
所述车载组合定位装置还包括与所述中心处理单元连接的地图信息单元;所述地图信息单元以所述第一当前位置信息作为输入,根据存储的地图信息进行校正,获取第三当前位置信息;所述中心处理单元接收所述第三当前位置信息进行数据融合得到所述车辆的当前位置信息。
所述车载组合定位装置还包括与所述中心处理单元连接的传感器单元;所述传感器单元包括陀螺仪和加速度计;所述传感器单元根据事先装订的初始位置信息,及所述陀螺仪和所述加速度计输出的数据计算出第四当前位置信息;所述中心处理单元接收所述第四当前位置信息并进行数据融合得到所述车辆的当前位置信息。
所述中心处理单元先判断卫星导航单元是否获取到卫星定位信号,如果没获取所述卫星定位信号,则采集所述第四当前位置信息、所述第三当前位置信息和所述第二当前位置信息进行所述数据融合。
所述数据融合的方法包括卡尔曼滤波。
所述卡尔曼滤波的状态方程为:
其中,为所述传感器单元的状态量,δLI、δλI分别为纬度误差和经度误差,δVE、δVN分别为东向和北向速度误差,φE、φN、φU为东向、北向和高度方向三个方向的失准角,为所述加速度计的等效零偏,εx、εy、εz为所述陀螺仪的等效零偏,WI=[wax way wgx wgy wgz]为所述加速度计和所述陀螺仪的噪声,其中wax和way为加速度计噪声,wgx、wgy和wgz为陀螺仪噪声;
ωie为地球自转角速度,VE、VN分别为所述车辆的东向速度和北向速度,L为当地纬度,R为地球半径;fU为天向加速度计输出比力,fN为北向加速度计输出比力,fE为东向加速度计输出比力;c11,c22,c33,c12,c21,c31,c13,c23,c32为坐标转换矩阵中的项;XR=[δLR δλR]为所述第二当前位置信息与所述第三当前位置信息的误差,该误差表示为:
其中τLR和τλR为相关时间常数,wLR和wλR为零均值高斯白噪声,
观测方程:
其中HIR=[I2×2 02×10 -I2×2]为观测方程系数矩阵,vL和vλ为观测量中的零均值高斯白噪声。
所述卫星导航单元包括北斗导航接收机和GPS接收机。
所述RFID定位单元根据对应的应答器获取该应答器的绝对位置信息,同时根据该应答器发出信号的强度计算出所述RFID定位单元与该应答器的相对位置,从而解读出所述第二当前位置信息。
或者所述地图信息单元以所述车辆的当前位置信息作为所述输入。
本发明的技术效果:
RFID(Radio Frequency Identification)技术,又称无线射频识别,是一种通信技术,可通过无线电讯号识别特定目标并读写相关数据,而无需识别系统与特定目标之间建立机械或光学接触。具体的是RFID的阅读器通过天线与RFID的应答器进行上述无线通信。
在本发明的车载组合定位装置中,除了常规的卫星导航单元通过接收卫星信号进行导航定位外,还设置了RFID定位单元。RFID定位单元利用前述RFID技术获取车载组合定位装置(即所在的车辆)的当前位置。这需要预先在不易接收卫星信号的道路旁设置好RFID的应答器,该应答器与其所在位置的位置信息对应。RFID定位单元的阅读器与该应答器建立通信联系后,识别该应答器及其对应的位置信息,于是,RFID定位单元即可得到需要的位置信息。此时如果卫星信号接收不畅,卫星导航定位单元不能输出当前位置信息,而RFID定位单元能够给出当前位置信息。RFID定位单元给出的当前位置信息是基于所述应答器对应的位置信息,且应答器安装位置可以精确控制,因此,RFID定位单元给出的位置信息精度高,实现了本发明的目的。
另外,本发明采用RFID技术对车辆进行导航,RFID硬件成本低廉,采用本发明的技术,对现有车辆导航系统的技术改进成本也低,因此可以广泛布置,利于为车辆导航进行广泛应用。
附图说明
图1为本发明车载组合定位装置的第一个实施例的原理图。
图2为本发明车载组合定位装置的第二个实施例的原理图。
图3为图2中RFID定位单元的流程图。
图4为图2中传感器单元的流程图。
图5为图2中地图信息单元的流程图。
图6为图2中中心处理单元的流程图。
具体实施方式
在对本发明的技术方案进行详细说明之前,为避免歧义,对采用的一些措辞进行统一说明,如果没有特别说明,所涉及的措辞含义均以本部分说明为准。
当前位置信息:由于本发明的车载组合定位装置是装载在可移动的车辆上,其(或其中的某个单元)输出的当前位置信息均是指所述车辆当前所处位置的信息,例如经度、纬度。
车辆:装载本发明车载组合定位装置的车辆。
车辆的当前位置信息:如果没有特别说明,是指中心处理单元进行处理后得到的车辆的当前位置信息。
以下结合附图对本发明的技术方案进行详细说明。
图1显示了本发明的第一个实例。图1所示的车载组合定位装置包括卫星导航单元、RFID定位单元和中心处理单元。中心处理单元分别与卫星导航单元和RFID定位单元连接。
其中,卫星导航单元属于已有技术,通过与卫星进行通讯以确定当前位置,并输出当前位置信息(为了与后面提及的其他单元输出的当前位置信息区别,卫星导航单元输出的信息命名为第一当前位置信息)。卫星导航单元包括例如北斗导航接收机或GPS接收机,这意味着可以采用北斗导航卫星系统或GPS(全球定位系统,Global Positioning System的简称)卫星系统进行定位。
RFID定位单元采用RFID技术进行定位,在卫星导航单元由于失去卫星信号不能工作时进行弥补,以期能够持续得到当前位置信息。具体的,在车辆经过的不能接收卫星信号的位置预先设置RFID的应答器(或称为智能标签),而在RFID定位单元上设置阅读器。所述应答器具有唯一标识属性(在RFID技术中这是常识性知识),将该唯一标识与其所在的位置进行对应。所述阅读器与所述应答器建立通讯联系后,或者在应答器传送来的信息中就包含了应答器所在位置信息,或者阅读器在识别该应答器后,通过后台数据库得到该应答器所在位置信息。由于阅读器与应答器在相距一定距离时上述通讯就已建立,因此,还需要进一步换算才能得到当前位置信息。在本发明中,根据阅读器从应答器接收到的信号的强弱即可推算出两者之间的距离,从而换算出当前位置信息(命名为第二当前位置信息)。
中心处理单元接收第一当前位置信息和第二当前位置信息。当无法获取第一当前位置信息,则将第二当前位置信息作为车辆的当前位置信息(最终输出结果)。当然,图1所示实例的基础上,可以增加与中心处理单元连接的提供方向信息的单元(例如电子罗盘单元,由其中的电子罗盘提供方向信息)以提供更多的定位依据。在图1所示实例的基础上可以组合加入多种测量定位单元以形成多种技术方案,均属于利用本发明的思想衍生出来的方案,可以在无法获取卫星定位信号的环境下仍能为车辆提供定位信息。
图2显示了本发明车载组合定位装置的第二个实例。与图1显示的车载组合定位装置不同之处在于:增加了传感器单元和地图信息单元,传感器单元和地图信息单元分别与中心处理单元连接。
地图信息单元存储地图信息,以第一当前位置信息作为输入,根据存储的地图信息进行校正。这里所说的校正过程如下:当第一当前位置信息偏离了地图信息中的道路,则将将当前位置校正到最近的道路上。这一校正过程基于这样的事实:车辆应当行驶在道路上,如果第一当前位置信息偏离了道路,则一定是测量出现了误差,因此通过地图信息单元校正到最近的道路上是合理的纠偏方式。校正后,地图信息单元输出一个当前位置信息(第三当前位置信息)给中心处理单元。当第一当前位置信息失效时,则地图信息单元将中心处理单元最近一次得到的车辆的当前位置信息作为输入。
传感器单元包括陀螺仪和加速度计。传感器单元预先装订车辆的位置、速度和姿态信息,然后采集所述陀螺仪和加速度计的输出数据,通过解算得到车辆的当前位置信息(第四当前位置信息)并传送给中心处理单元。
中心处理单元接收第一当前位置信息、第二当前位置信息、第三当前位置信息和第四当前位置信息,利用数据融合方法对接收到的数据进行处理,得到最终车辆的当前位置信息。即利用RFID定位单元、地图信息单元、传感器单元对卫星导航单元进行补充与修正,然后由中心处理单元利用数据融合方法对这些单元的输出数据进行优化处理得到最终优化的结果(最终车辆的当前位置信息)。当然,本领域技术人员能够通过对图1和图2所示实施例的基础上,结合本发明的思想设计出其他类似的技术方案,例如在图1所示车载组合定位装置上仅增加地图信息单元或传感器单元,同时对中心处理单元的数据融合方法进行适应性修正即可。
在本实施例中,数据融合的方法采用卡尔曼滤波。卡尔曼滤波的状态方程为:
其中,为所述传感器单元的状态量,δLI、δλI分别为纬度误差和经度误差,δVE、δVN分别为东向和北向速度误差,φE、φN、φU为东向、北向和高度方向三个方向的失准角,为所述加速度计的等效零偏,εx、εy、εz为所述陀螺仪的等效零偏,WI=[wax way wgx wgy wgz]为所述加速度计和所述陀螺仪的噪声;
ωie为地球自转角速度,VE、VN分别为车辆的东向速度和北向速度,L为当地纬度,R为地球半径;XR=[δLR δλR]为所述第二当前位置信息与所述第三当前位置信息的误差,该误差表示为:
其中τLR和τλR为相关时间常数,wLR和wλR为零均值高斯白噪声,
观测方程:
其中HIR=[I2×2 02×10 -I2×2]为观测方程系数矩阵,vL和vλ为观测量中的零均值高斯白噪声。
图3显示了RFID定位单元的工作流程。以下对图3中各步骤进行说明。
RFID定位单元通过发出信号(发送读RFID请求)查看是否有应答器响应来判断周围是否放置了应答器。如果没有“收到响应”,则继续发出信号查看;如果“收到响应”,则可以通过阅读器读取应答器反馈的位置坐标(读取位置信息)。进一步的,RFID定位单元通过响应信号的强度计算阅读器与应答器两者的相对位置(计算相对位置),综合形成所述第二当前位置信息,并把第二当前位置信息输出到中心处理单元(发送位置信息到中心处理单元)。然后,RFID定位单元重新回到发送读RFID请求,并重复以上步骤。RFID应答器是安装在道路上的,其位置信息是可以事先精确测量的,即RFID应答器对应一个精确的位置信息。当RFID阅读器识别出RFID应答器时,根据相互通讯的信号强度就计算出与RFID应答器之间的距离。由于道路是已知的,因此将RFID应答器的位置与RFID应答器到RFID阅读器的距离进行计算,就能够得到RFID阅读器的位置信息(即车辆的位置信息)。
图4显示了传感器单元的工作流程。以下对图4中各步骤进行说明。
首先,传感器单元需要“装订初始信息”。所谓装订是指将车辆的位置、速度和姿态信息等初始信息输入传感器单元。然后传感器单元“读取陀螺仪和加速度计数据”,即采集陀螺仪和加速度计的输出数据(例如车辆的加速度和角速度数据)。接下来的“解算得到位置信息”步骤是指传感器单元通过四元数法或旋转矢量法解算得到车辆的当前位置信息(第四当前位置信息)。“发送位置信息到中心处理单元”步骤即第四当前位置信息被传输到中心处理单元。然后,重新回到“读取陀螺仪和加速度计数据”步骤开始重复进行上述步骤。
图5显示了地图信息单元的工作流程。以下对图5中各步骤进行说明。
地图信息单元首先要“获取位置信息”。这一步骤是指地图信息单元以第一当前位置信息或最近一次得到的车辆的当前位置信息作为输入(后一种情况是卫星信号不良,卫星导航单元无法获取第一当前位置信息)。
“获取道路位置信息”是指:地图信息单元根据存储的地图信息与获取的位置信息进行匹配,利用地图匹配算法得到第三当前位置信息。
“发送位置信息到中心处理单元”是指:将第三当前位置信息传输给中心处理单元,由中心处理单元进行数据融合处理。
图6显示了中心处理单元的工作流程。以下对图6中各步骤进行说明。
“卫星信号良好”:本步骤判断卫星信号是否接收正常。如果卫星信号接收正常,则以卫星导航单元输出的第一当前位置信息作为最终的车辆的当前位置信息(即直接执行“得到车辆的当前位置信息”步骤)。如果卫星信号不能正常接收,则执行“获取传感器单元数据”步骤。
“获取传感器单元数据”:是指中心处理单元从传感器单元获取第四当前位置信息。
“获取地图信息单元数据”:是指中心处理单元从地图信息单元获取第三当前位置信息。
“有RFID信号”:在此步骤,通过RFID定位单元判断是否存在RFID信号。如果没有RFID信号,则执行“数据融合”步骤。如果有RFID信号,则执行“获取RFID定位单元数据”步骤。
“获取RFID定位单元数据”:是指中心处理单元从RFID定位单元获取第二当前位置信息。
“数据融合”:是指中心处理单元将接收到的信息通过数据融合方法进行处理(例如前述卡尔曼滤波方法),得到最终的车辆的当前位置信息(即“得到车辆的当前位置信息”步骤)。
以上仅是本发明的较佳实施例,但本发明并不限于以上描述,对于本领域技术人员而言,任何对该系统进行的等同修改和替代也都在本发明的范畴之中。因此,凡在本发明的精神和原则之内所做的任何修改、等同替换和改进等,均应包含在本发明的保护范围之内。

Claims (4)

1.一种车载组合定位装置,设置在移动的车辆上,包括卫星导航单元,其特征在于:还包括RFID定位单元和中心处理单元;所述中心处理单元分别与所述卫星导航单元和所述RFID定位单元连接;
所述卫星导航单元接收导航卫星信号并输出第一当前位置信息到所述中心处理单元;
所述RFID定位单元中设置有阅读器,所述阅读器识别预先设置在所述车辆经过的路径的应答器,并根据所述应答器对应的位置信息解读出第二当前位置信息;
所述中心处理单元对接收到的所述第一当前位置信息、所述第二当前位置信息进行综合得到所述车辆的当前位置信息;
还包括与所述中心处理单元连接的地图信息单元;所述地图信息单元以所述第一当前位置信息作为输入,根据存储的地图信息进行校正,获取第三当前位置信息;所述中心处理单元接收所述第三当前位置信息进行数据融合得到所述车辆的当前位置信息;
还包括与所述中心处理单元连接的传感器单元;所述传感器单元包括陀螺仪和加速度计;所述传感器单元根据事先装订的初始位置信息,及所述陀螺仪和所述加速度计输出的数据计算出第四当前位置信息;所述中心处理单元接收所述第四当前位置信息并进行数据融合得到所述车辆的当前位置信息;
所述中心处理单元先判断卫星导航单元是否获取到卫星定位信号,如果没获取所述卫星定位信号,则采集所述第四当前位置信息、所述第三当前位置信息和所述第二当前位置信息进行所述数据融合;
所述数据融合的方法包括卡尔曼滤波;
所述卡尔曼滤波的状态方程为:
<mrow> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msub> <mover> <mi>X</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>I</mi> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mover> <mi>X</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>R</mi> </msub> </mtd> </mtr> </mtable> </mfenced> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msub> <mi>F</mi> <mi>I</mi> </msub> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <msub> <mi>F</mi> <mi>R</mi> </msub> </mtd> </mtr> </mtable> </mfenced> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msub> <mi>X</mi> <mi>I</mi> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>X</mi> <mi>R</mi> </msub> </mtd> </mtr> </mtable> </mfenced> <mo>+</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msub> <mi>G</mi> <mi>I</mi> </msub> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <msub> <mi>I</mi> <mrow> <mn>2</mn> <mo>&amp;times;</mo> <mn>2</mn> </mrow> </msub> </mtd> </mtr> </mtable> </mfenced> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msub> <mi>W</mi> <mi>I</mi> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>W</mi> <mi>R</mi> </msub> </mtd> </mtr> </mtable> </mfenced> </mrow>
其中,为所述传感器单元的状态量,δLI、δλI分别为纬度误差和经度误差,δVE、δVN分别为东向和北向速度误差,φE、φN、φU为东向、北向和高度方向三个方向的失准角,为所述加速度计的等效零偏,εx、εy、εz为所述陀螺仪的等效零偏,WI=[wax way wgx wgy wgz]为所述加速度计和所述陀螺仪的噪声,其中wax和way为加速度计噪声,wgx、wgy和wgz为陀螺仪噪声;
<mrow> <msub> <mi>G</mi> <mi>I</mi> </msub> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msub> <mn>0</mn> <mrow> <mn>2</mn> <mo>&amp;times;</mo> <mn>5</mn> </mrow> </msub> </mtd> </mtr> <mtr> <mtd> <mtable> <mtr> <mtd> <msub> <mi>c</mi> <mn>11</mn> </msub> </mtd> <mtd> <msub> <mi>c</mi> <mn>21</mn> </msub> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <msub> <mi>c</mi> <mn>12</mn> </msub> </mtd> <mtd> <msub> <mi>c</mi> <mn>22</mn> </msub> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <msub> <mi>c</mi> <mn>11</mn> </msub> </mtd> <mtd> <msub> <mi>c</mi> <mn>21</mn> </msub> </mtd> <mtd> <msub> <mi>c</mi> <mn>31</mn> </msub> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <msub> <mi>c</mi> <mn>12</mn> </msub> </mtd> <mtd> <msub> <mi>c</mi> <mn>22</mn> </msub> </mtd> <mtd> <msub> <mi>c</mi> <mn>32</mn> </msub> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <msub> <mi>c</mi> <mn>13</mn> </msub> </mtd> <mtd> <msub> <mi>c</mi> <mn>23</mn> </msub> </mtd> <mtd> <msub> <mi>c</mi> <mn>33</mn> </msub> </mtd> </mtr> </mtable> </mtd> </mtr> <mtr> <mtd> <msub> <mn>0</mn> <mrow> <mn>2</mn> <mo>&amp;times;</mo> <mn>5</mn> </mrow> </msub> </mtd> </mtr> </mtable> </mfenced> </mrow>
<mfenced open = "" close = ""> <mtable> <mtr> <mtd> <mrow> <msub> <mi>F</mi> <mi>I</mi> </msub> <mo>=</mo> <mfenced open = "[" close = ""> <mtable> <mtr> <mtd> <mtable> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mfrac> <mn>1</mn> <mi>R</mi> </mfrac> </mtd> </mtr> <mtr> <mtd> <mfrac> <mrow> <msub> <mi>V</mi> <mi>E</mi> </msub> <mi>tan</mi> <mi> </mi> <mi>L</mi> <mi> </mi> <mi>sec</mi> <mi> </mi> <mi>L</mi> </mrow> <mi>R</mi> </mfrac> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mfrac> <mrow> <mi>sec</mi> <mi> </mi> <mi>L</mi> </mrow> <mi>R</mi> </mfrac> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mrow> <mn>2</mn> <msub> <mi>V</mi> <mi>N</mi> </msub> <msub> <mi>&amp;omega;</mi> <mrow> <mi>i</mi> <mi>e</mi> </mrow> </msub> <mi>cos</mi> <mi> </mi> <mi>L</mi> <mo>+</mo> <mfrac> <mrow> <msub> <mi>V</mi> <mi>E</mi> </msub> <msub> <mi>V</mi> <mi>N</mi> </msub> <msup> <mi>sec</mi> <mn>2</mn> </msup> <mi>L</mi> </mrow> <mi>R</mi> </mfrac> </mrow> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mfrac> <mrow> <msub> <mi>V</mi> <mi>N</mi> </msub> <mi>tan</mi> <mi> </mi> <mi>L</mi> </mrow> <mi>R</mi> </mfrac> </mtd> <mtd> <mrow> <mn>2</mn> <msub> <mi>&amp;omega;</mi> <mrow> <mi>i</mi> <mi>e</mi> </mrow> </msub> <mi>sin</mi> <mi> </mi> <mi>L</mi> <mo>+</mo> <mfrac> <mrow> <msub> <mi>V</mi> <mi>E</mi> </msub> <mi>tan</mi> <mi> </mi> <mi>L</mi> </mrow> <mi>R</mi> </mfrac> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>-</mo> <mn>2</mn> <msub> <mi>V</mi> <mi>E</mi> </msub> <msub> <mi>&amp;omega;</mi> <mrow> <mi>i</mi> <mi>e</mi> </mrow> </msub> <mi>cos</mi> <mi> </mi> <mi>L</mi> <mo>-</mo> <mfrac> <mrow> <msubsup> <mi>V</mi> <mi>E</mi> <mn>2</mn> </msubsup> <msup> <mi>sec</mi> <mn>2</mn> </msup> <mi>L</mi> </mrow> <mi>R</mi> </mfrac> </mrow> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <mo>-</mo> <mn>2</mn> <msub> <mi>&amp;omega;</mi> <mrow> <mi>i</mi> <mi>e</mi> </mrow> </msub> <mi>sin</mi> <mi> </mi> <mi>L</mi> <mo>-</mo> <mfrac> <mrow> <mn>2</mn> <msub> <mi>V</mi> <mi>E</mi> </msub> <mi>tan</mi> <mi> </mi> <mi>L</mi> </mrow> <mi>R</mi> </mfrac> </mrow> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <mo>-</mo> <mfrac> <mn>1</mn> <mi>R</mi> </mfrac> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>-</mo> <msub> <mi>&amp;omega;</mi> <mrow> <mi>i</mi> <mi>e</mi> </mrow> </msub> <mi>sin</mi> <mi> </mi> <mi>L</mi> </mrow> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mfrac> <mn>1</mn> <mi>R</mi> </mfrac> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>&amp;omega;</mi> <mrow> <mi>i</mi> <mi>e</mi> </mrow> </msub> <mi>cos</mi> <mi> </mi> <mi>L</mi> <mo>+</mo> <mfrac> <mrow> <msub> <mi>V</mi> <mi>E</mi> </msub> <msup> <mi>sec</mi> <mn>2</mn> </msup> <mi>L</mi> </mrow> <mi>R</mi> </mfrac> </mrow> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mfrac> <mrow> <mi>tan</mi> <mi> </mi> <mi>L</mi> </mrow> <mi>R</mi> </mfrac> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> </mtable> </mtd> </mtr> <mtr> <mtd> <msub> <mn>0</mn> <mrow> <mn>5</mn> <mo>&amp;times;</mo> <mn>4</mn> </mrow> </msub> </mtd> </mtr> </mtable> </mfenced> </mrow> </mtd> </mtr> <mtr> <mtd> <mfenced open = "" close = "]"> <mtable> <mtr> <mtd> <mtable> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <mo>-</mo> <msub> <mi>f</mi> <mi>U</mi> </msub> </mrow> </mtd> <mtd> <msub> <mi>f</mi> <mi>N</mi> </msub> </mtd> <mtd> <msub> <mi>c</mi> <mn>11</mn> </msub> </mtd> <mtd> <msub> <mi>c</mi> <mn>21</mn> </msub> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <msub> <mi>f</mi> <mi>U</mi> </msub> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <mo>-</mo> <msub> <mi>f</mi> <mi>E</mi> </msub> </mrow> </mtd> <mtd> <msub> <mi>c</mi> <mn>12</mn> </msub> </mtd> <mtd> <msub> <mi>c</mi> <mn>22</mn> </msub> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <msub> <mi>&amp;omega;</mi> <mrow> <mi>i</mi> <mi>e</mi> </mrow> </msub> <mi>sin</mi> <mi> </mi> <mi>L</mi> <mo>+</mo> <mfrac> <msub> <mi>V</mi> <mi>E</mi> </msub> <mi>R</mi> </mfrac> <mi>tan</mi> <mi> </mi> <mi>L</mi> </mrow> </mtd> <mtd> <mrow> <mo>-</mo> <msub> <mi>&amp;omega;</mi> <mrow> <mi>i</mi> <mi>e</mi> </mrow> </msub> <mi>cos</mi> <mi> </mi> <mi>L</mi> <mo>-</mo> <mfrac> <msub> <mi>V</mi> <mi>E</mi> </msub> <mi>R</mi> </mfrac> </mrow> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <msub> <mi>c</mi> <mn>11</mn> </msub> </mtd> <mtd> <msub> <mi>c</mi> <mn>21</mn> </msub> </mtd> <mtd> <msub> <mi>c</mi> <mn>31</mn> </msub> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>-</mo> <msub> <mi>&amp;omega;</mi> <mrow> <mi>i</mi> <mi>e</mi> </mrow> </msub> <mi>sin</mi> <mi> </mi> <mi>L</mi> <mo>-</mo> <mfrac> <msub> <mi>V</mi> <mi>E</mi> </msub> <mi>R</mi> </mfrac> <mi>tan</mi> <mi> </mi> <mi>L</mi> </mrow> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <mo>-</mo> <mfrac> <msub> <mi>V</mi> <mi>N</mi> </msub> <mi>R</mi> </mfrac> </mrow> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <msub> <mi>c</mi> <mn>12</mn> </msub> </mtd> <mtd> <msub> <mi>c</mi> <mn>22</mn> </msub> </mtd> <mtd> <msub> <mi>c</mi> <mn>32</mn> </msub> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>&amp;omega;</mi> <mrow> <mi>i</mi> <mi>e</mi> </mrow> </msub> <mi>cos</mi> <mi> </mi> <mi>L</mi> <mo>+</mo> <mfrac> <msub> <mi>V</mi> <mi>E</mi> </msub> <mi>R</mi> </mfrac> </mrow> </mtd> <mtd> <mfrac> <msub> <mi>V</mi> <mi>N</mi> </msub> <mi>R</mi> </mfrac> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <msub> <mi>c</mi> <mn>13</mn> </msub> </mtd> <mtd> <msub> <mi>c</mi> <mn>23</mn> </msub> </mtd> <mtd> <msub> <mi>c</mi> <mn>33</mn> </msub> </mtd> </mtr> </mtable> </mtd> </mtr> <mtr> <mtd> <msub> <mn>0</mn> <mrow> <mn>5</mn> <mo>&amp;times;</mo> <mn>8</mn> </mrow> </msub> </mtd> </mtr> </mtable> </mfenced> </mtd> </mtr> </mtable> </mfenced>
ωie为地球自转角速度,VE、VN分别为所述车辆的东向速度和北向速度,L为当地纬度,R为地球半径;fU为天向加速度计输出比力,fN为北向加速度计输出比力,fE为东向加速度计输出比力;c11,c22,c33,c12,c21,c31,c13,c23,c32为坐标转换矩阵中的项;XR=[δLR δλR]为所述第二当前位置信息与所述第三当前位置信息的误差,该误差表示为:
<mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <mi>&amp;delta;</mi> <msub> <mover> <mi>L</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>R</mi> </msub> <mo>=</mo> <mo>-</mo> <mfrac> <mrow> <msub> <mi>&amp;delta;L</mi> <mi>R</mi> </msub> </mrow> <msub> <mi>&amp;tau;</mi> <mrow> <mi>L</mi> <mi>R</mi> </mrow> </msub> </mfrac> <mo>+</mo> <msub> <mi>w</mi> <mrow> <mi>L</mi> <mi>R</mi> </mrow> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mi>&amp;delta;</mi> <msub> <mover> <mi>&amp;lambda;</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>R</mi> </msub> <mo>=</mo> <mo>-</mo> <mfrac> <mrow> <msub> <mi>&amp;delta;&amp;lambda;</mi> <mi>R</mi> </msub> </mrow> <msub> <mi>&amp;tau;</mi> <mrow> <mi>&amp;lambda;</mi> <mi>R</mi> </mrow> </msub> </mfrac> <mo>+</mo> <msub> <mi>w</mi> <mrow> <mi>&amp;lambda;</mi> <mi>R</mi> </mrow> </msub> </mrow> </mtd> </mtr> </mtable> </mfenced>
其中τLR和τλR为相关时间常数,wLR和wλR为零均值高斯白噪声,
观测方程:
<mrow> <msub> <mi>Z</mi> <mrow> <mi>I</mi> <mi>R</mi> </mrow> </msub> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mi>&amp;delta;</mi> <msub> <mi>L</mi> <mi>I</mi> </msub> <mo>-</mo> <mi>&amp;delta;</mi> <msub> <mi>L</mi> <mi>R</mi> </msub> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>&amp;delta;&amp;lambda;</mi> <mi>I</mi> </msub> <mo>-</mo> <msub> <mi>&amp;delta;&amp;lambda;</mi> <mi>R</mi> </msub> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>+</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msub> <mi>v</mi> <mi>L</mi> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>v</mi> <mi>&amp;lambda;</mi> </msub> </mtd> </mtr> </mtable> </mfenced> <mo>=</mo> <msub> <mi>H</mi> <mrow> <mi>I</mi> <mi>R</mi> </mrow> </msub> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msub> <mi>X</mi> <mi>I</mi> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>X</mi> <mi>R</mi> </msub> </mtd> </mtr> </mtable> </mfenced> <mo>+</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msub> <mi>v</mi> <mi>L</mi> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>v</mi> <mi>&amp;lambda;</mi> </msub> </mtd> </mtr> </mtable> </mfenced> <mo>,</mo> </mrow>
其中HIR=[I2×2 02×10 -I2×2]为观测方程系数矩阵,vL和vλ为观测量中的零均值高斯白噪声。
2.根据权利要求1所述车载组合定位装置,其特征在于:所述卫星导航单元包括北斗导航接收机和GPS接收机。
3.根据利要求1所述车载组合定位装置,其特征在于:所述RFID定位单元根据对应的应答器获取该应答器的绝对位置信息,同时根据该应答器发出信号的强度计算出所述RFID定位单元与该应答器的相对位置,从而解读出所述第二当前位置信息。
4.根据利要求1所述车载组合定位装置,其特征在于:或者所述地图信息单元以所述车辆的当前位置信息作为所述输入。
CN201410240140.6A 2014-05-30 2014-05-30 一种车载组合定位装置 Expired - Fee Related CN104007459B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201410240140.6A CN104007459B (zh) 2014-05-30 2014-05-30 一种车载组合定位装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201410240140.6A CN104007459B (zh) 2014-05-30 2014-05-30 一种车载组合定位装置

Publications (2)

Publication Number Publication Date
CN104007459A CN104007459A (zh) 2014-08-27
CN104007459B true CN104007459B (zh) 2018-01-05

Family

ID=51368203

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201410240140.6A Expired - Fee Related CN104007459B (zh) 2014-05-30 2014-05-30 一种车载组合定位装置

Country Status (1)

Country Link
CN (1) CN104007459B (zh)

Families Citing this family (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104376106B (zh) * 2014-11-27 2018-10-30 重庆智韬信息技术中心 通过车载智能终端获取周边信息的方法
CN105857340A (zh) * 2016-04-01 2016-08-17 郑君伟 基于组合导航的轨道检测系统及方法
CN106101269A (zh) * 2016-08-04 2016-11-09 神州优车(福建)信息技术有限公司 车辆位置获取方法及装置
CN107063301A (zh) * 2017-03-02 2017-08-18 合肥极友软件开发有限公司 一种车载卫星定位的自动位置纠正系统
DE112017007937B4 (de) * 2017-10-23 2022-03-03 Mitsubishi Electric Corporation Kommunikationseinrichtung, Steuerungsverfahren und Steuerungsprogramm
CN107870343A (zh) * 2017-10-31 2018-04-03 平潭诚信智创科技有限公司 一种基于rfid的立交桥智能导航装置及导航系统
CN112019999A (zh) * 2020-08-25 2020-12-01 南京航空航天大学 一种轨道交通无线网络的干扰检测与定位方法
CN112362052B (zh) * 2020-10-27 2022-09-16 中国科学院计算技术研究所 一种融合定位方法及系统
CN112904389A (zh) * 2020-12-29 2021-06-04 上海富欣智能交通控制有限公司 有轨车辆定位系统及方法

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101641610A (zh) * 2007-02-21 2010-02-03 电子地图北美公司 用于包含绝对及相对坐标的车辆导航及领航的系统及方法
CN101952688A (zh) * 2008-02-04 2011-01-19 电子地图北美公司 用于与传感器检测到的对象进行地图匹配的方法
WO2011103612A1 (en) * 2010-02-23 2011-09-01 Khalil Ahmad Al-Manasir Traffic management system
CN102223597A (zh) * 2010-04-15 2011-10-19 上海启电信息科技有限公司 一种移动定位装置

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN202631740U (zh) * 2012-06-11 2012-12-26 福建师范大学 一种基于rfid和gps的车辆定位装置
CN103499350B (zh) * 2013-09-28 2016-01-27 长安大学 Gps盲区下融合多源信息的车辆高精度定位方法及装置

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101641610A (zh) * 2007-02-21 2010-02-03 电子地图北美公司 用于包含绝对及相对坐标的车辆导航及领航的系统及方法
CN101952688A (zh) * 2008-02-04 2011-01-19 电子地图北美公司 用于与传感器检测到的对象进行地图匹配的方法
WO2011103612A1 (en) * 2010-02-23 2011-09-01 Khalil Ahmad Al-Manasir Traffic management system
CN102223597A (zh) * 2010-04-15 2011-10-19 上海启电信息科技有限公司 一种移动定位装置

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
车辆GPS/SINS组合导航系统设计与实现;罗涛;《中国优秀硕士学位论文全文数据库》;20140515;正文第2,26-30页 *

Also Published As

Publication number Publication date
CN104007459A (zh) 2014-08-27

Similar Documents

Publication Publication Date Title
CN104007459B (zh) 一种车载组合定位装置
CN102648394B (zh) 惯性测量单元(imu)的空间对准确定
CN102176041B (zh) 一种基于gnss/sins组合的车辆导航监控系统
US8548731B2 (en) Navigation method, navigation system, navigation device, vehicle provided therewith and group of vehicles
CN107121141A (zh) 一种适用于定位导航授时微系统的数据融合方法
CN107389064A (zh) 一种基于惯性导航的无人车变道控制方法
US20060047423A1 (en) Navigation system and method for detecting deviation of mobile objects from route using same
Bevly et al. GNSS for vehicle control
CN106255065A (zh) 智能手机和移动终端室内外无缝定位系统及其方法
CN103389092B (zh) 一种系留飞艇姿态测量装置及测量方法
KR20110043538A (ko) 영상 지도의 구축 및 차량 위치 결정을 위한 방법 및 시스템
JP4652097B2 (ja) 高度算出装置及びナビゲーション装置
JP4090852B2 (ja) Gps測位による列車走行情報検出装置及びその列車走行情報検出方法
Niu et al. Using inertial sensors of iPhone 4 for car navigation
CN107247275A (zh) 基于公交车的城市gnss脆弱性监测系统及其方法
CN102645665A (zh) 基于bd、gps和dr的定位信息处理方法及装置
KR100526571B1 (ko) 오프-보드 네비게이션 시스템 및 그의 오차 보정 방법
CN106093992A (zh) 一种基于cors的亚米级组合定位导航系统及导航方法
CN104864874A (zh) 一种低成本单陀螺航位推算导航方法及系统
Geng et al. Accuracy analysis of DVL/IMU/magnetometer integrated navigation system using different IMUs in AUV
CN205958758U (zh) 一种车载全程亚米级定位系统
CN110209188A (zh) 一种控制无人机飞行的方法及系统、无人机
US7832111B2 (en) Magnetic sensing device for navigation and detecting inclination
CN202649469U (zh) 有效全球卫星定位系统所在位置判断的定位装置
CN106646569A (zh) 一种导航定位方法及设备

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant
CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20180105

CF01 Termination of patent right due to non-payment of annual fee