CN115342820A - 一种汽车夜间行驶导航定位系统 - Google Patents
一种汽车夜间行驶导航定位系统 Download PDFInfo
- Publication number
- CN115342820A CN115342820A CN202211273810.5A CN202211273810A CN115342820A CN 115342820 A CN115342820 A CN 115342820A CN 202211273810 A CN202211273810 A CN 202211273810A CN 115342820 A CN115342820 A CN 115342820A
- Authority
- CN
- China
- Prior art keywords
- vehicle
- module
- sensor
- navigation
- angular velocity
- 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.)
- Pending
Links
- 230000001133 acceleration Effects 0.000 claims abstract description 74
- 238000001914 filtration Methods 0.000 claims abstract description 57
- 238000012545 processing Methods 0.000 claims abstract description 35
- 238000005259 measurement Methods 0.000 claims description 72
- 238000001514 detection method Methods 0.000 claims description 16
- 238000012986 modification Methods 0.000 claims description 14
- 230000004048 modification Effects 0.000 claims description 14
- 238000010276 construction Methods 0.000 claims description 13
- 239000011159 matrix material Substances 0.000 claims description 12
- 238000004364 calculation method Methods 0.000 claims description 11
- 230000033001 locomotion Effects 0.000 claims description 6
- 230000005540 biological transmission Effects 0.000 claims description 2
- 238000000034 method Methods 0.000 abstract description 5
- 238000005070 sampling Methods 0.000 description 4
- 238000012546 transfer Methods 0.000 description 4
- 238000010586 diagram Methods 0.000 description 2
- 230000003068 static effect Effects 0.000 description 2
- 230000026676 system process Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000012937 correction Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 230000001737 promoting effect Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
- G01C21/28—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network with correlation of data from several navigational instruments
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/165—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
-
- 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
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
- G06F17/10—Complex mathematical operations
- G06F17/11—Complex mathematical operations for solving equations, e.g. nonlinear equations, general mathematical optimization problems
- G06F17/12—Simultaneous equations, e.g. systems of linear equations
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
- G06F17/10—Complex mathematical operations
- G06F17/16—Matrix or vector computation, e.g. matrix-matrix or matrix-vector multiplication, matrix factorization
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
- G06F17/10—Complex mathematical operations
- G06F17/18—Complex mathematical operations for evaluating statistical data, e.g. average values, frequency distributions, probability functions, regression analysis
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- General Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- Mathematical Analysis (AREA)
- Computational Mathematics (AREA)
- Data Mining & Analysis (AREA)
- Mathematical Optimization (AREA)
- Pure & Applied Mathematics (AREA)
- Theoretical Computer Science (AREA)
- Automation & Control Theory (AREA)
- General Engineering & Computer Science (AREA)
- Software Systems (AREA)
- Databases & Information Systems (AREA)
- Algebra (AREA)
- Operations Research (AREA)
- Evolutionary Biology (AREA)
- Probability & Statistics with Applications (AREA)
- Life Sciences & Earth Sciences (AREA)
- Bioinformatics & Cheminformatics (AREA)
- Bioinformatics & Computational Biology (AREA)
- Computer Networks & Wireless Communication (AREA)
- Computing Systems (AREA)
- Navigation (AREA)
Abstract
本发明公开了一种汽车夜间行驶导航定位系统,属于导航领域。一种汽车夜间行驶导航定位系统,包括GPS模块、传感器模块、滤波处理模块和处理器;本发明通过基于角速度传感器和加速度传感器工作过程无需卫星定位,所以处理器能够依据角速度传感器获取车辆的角速度变化量,得到车辆的运行方向,和加速度传感器获取车辆的速度变化量,得到车辆行进的距离,即可实现该系统在无需卫星定位的情况下,仍可以实现对车辆的精准实时导航定位,同时当GPS模块在接收到4颗以上GPS卫星的卫星信号时,GPS模块可与角速度传感器和加速度传感器组成的传感器模块同时配合使用,进一步提高该汽车用导航系统对车辆定位的精确度。
Description
技术领域
本发明涉及导航技术领域,尤其涉及一种汽车夜间行驶导航定位系统。
背景技术
从世界上第一辆汽车的诞生到现在,汽车业界的百花齐放和欣欣向荣,汽车是“改变世界的机器”、推动社会进步的车轮,已经成为人们日常生活中不可或缺的重要组成部分。汽车的普遍使用,将改变经济社会结构,形成一整套新的经济、文化、生活体系,改善人的生活质量,推进社会进步,促进了经济发展,但汽车作为家庭出行的交通工具,给人们的生活带来很大便利的同时,也存在一些的问题,例如在夜间行驶时,因夜间视线不清晰以及驾驶员不熟悉交通路线的情况下,将会给出行带来了不必要的麻烦,甚至存在交通隐患。因此,各种导航系统或导航仪应运而生,并利用车载GPS(全球定位系统)配合电子地图来进行的,它能方便且准确地告诉驾驶者去往目的地的最短或者最快路径,是驾驶员的好帮手。
对于上述现有汽车应用的导航系统或导航仪中的车载GPS导航系统,在工作时必须要同时接收到四颗或是四颗以上的有效卫星信号才能正确定位车辆位置,一旦当车辆行驶在隧道和城市的高楼群之间时,车载GPS导航系统会因为卫星信号的衰减,而很难实现对车辆行驶的位置进行导航精准定位,从而给出行带来了不必要的麻烦,甚至在夜间行驶时,因视线差碰到障碍物时,还会严重造成交通隐患。
为此,本发明提供一种汽车夜间行驶导航定位系统来解决上述问题。
发明内容
本发明的目的是为了解决现有技术中汽车用导航系统中的GPS导航系统定位较差的问题,而提出的一种汽车夜间行驶导航定位系统。
为了实现上述目的,本发明采用了如下技术方案:
一种汽车夜间行驶导航定位系统,包括GPS模块、传感器模块、滤波处理模块和处理器,所述传感器模块与滤波处理模块电连,所述GPS模块、滤波处理模块均与处理器电连;
所述GPS模块,用于接收卫星信号,并采用GPS定位算法计算车辆的当前位置作为实时定位数据;所述传感器模块,用于获取车辆角速度的量测信息和车辆速度的量测信息;所述滤波处理模块,用于对车辆的角速度量测信息和车辆速度的量测信息分别进行卡尔曼滤波,并在线调整卡尔曼滤波器参数得到降噪后的车辆的角速度量测信息和车辆速度的量测信息;所述处理器,用于利用车辆的角速度量测信息和车辆速度的量测信息进行导航解算,输出被测载体的导航信息;
所述滤波处理模块包括构建模块、迭代计算模块和修改模块,其中:
所述构建模块,用于建立关于传感器模块单输入单输出卡尔曼滤波状态观测方程;所述迭代计算模块,用于进行卡尔曼滤波迭代计算,并根据残差2χ检测法得到检测函数值与预先设定的阈值进行比较,得出被测载体的机动变化情况;所述修改模块,用于根据被测载体的机动变化情况调整卡尔曼滤波器的滤波增益矩阵数值和观测噪声方差矩阵的数值,并将调整后的值反馈给迭代计算模块。
优选的,所述传感器模块包括角速度传感器、加速度传感器,其中:
所述角速度传感器,用于获取车辆角速度的量测信息;
所述加速度传感器,用于获取车辆速度的量测信息。
优选的,所述角速度传感器为三轴陀螺仪,所述加速度传感器采用三轴加速度传感器。
优选的,所述三轴陀螺仪是通过测量三维坐标系内陀螺转子的垂直轴与载体之间的夹角,并计算角速度,通过夹角和角速度来判别物体在三维空间的运动状态,同时测定上、下、左、右、前、后六个方向,最终可判断出载体的移动轨迹和加速度。
优选的,所述三轴加速度传感器是感知任意方向上加速度,通过测量载体在某个轴向的受力情况,计算出轴向的加速度大小和方向。
优选的,所述处理器设置DP1.2、PCIeM.2、Type-C、USB3.0数据传输和显示接口,且PCIeM.2为Bkey,用于高速Wi-Fi和SSD存储设备扩展,并支持九类扩展接口。
优选的,还包括存储模块、车载显示屏和喇叭,所述存储模块、车载显示屏、喇叭均与处理器电连;
所述存储模块,用于保存导航引擎、地图数据以及GPS模块计算出的实时位置;
所述车载显示屏,用于显示车辆的当前位置、当前行驶速度、当前时间、离目的地的距离以及需要的时间;
所述喇叭,用于对车辆的行进方向进行提示。
优选的,还包括9V-36V的车载直流电源,所述车载直流电源与处理器电连。
与现有技术相比,本发明提供了一种汽车夜间行驶导航定位系统,具备以下有益效果:
1、该汽车夜间行驶导航定位系统,通过基于角速度传感器和加速度传感器工作过程无需卫星定位,所以处理器能够依据角速度传感器获取车辆的角速度变化量,得到车辆的运行方向,和加速度传感器获取车辆的速度变化量,得到车辆行进的距离,即可实现该系统在无需卫星定位的情况下,仍可以实现对车辆的精准实时导航定位,同时当GPS模块在接收到4颗以上GPS卫星的卫星信号时,GPS模块可与角速度传感器和加速度传感器组成的传感器模块同时配合使用,进一步提高该汽车用导航系统对车辆定位的精确度。
2、该汽车夜间行驶导航定位系统,通过构建模块、迭代计算模块和修改模块构成的滤波处理模块,对角速度传感器和加速度传感器测数据中的随机噪声进行了有效的处理,使角速度传感器对车辆获取的角速度变化量和加速度传感器对车辆获取的速度变化量更为精确,并避免当GPS模块在接收小于4颗GPS卫星的卫星信号或没有时,可通过角速度传感器获取车辆角速度的量测信息和加速度传感器获取车辆速度的量测信息,也能精准实现对车辆的导航定位。
附图说明
图1为本发明提出的一种汽车夜间行驶导航定位系统的原理连接框图;
图2为本发明提出的一种汽车夜间行驶导航定位系统的GPS模块与GPS卫星之间的位置关系示意图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。
在本发明的描述中,需要理解的是,术语“上”、“下”、“前”、“后”、“左”、“右”、“顶”、“底”、“内”、“外”等指示的方位或位置关系为基于附图所示的方位或位置关系,仅是为了便于描述本发明和简化描述,而不是指示或暗示所指的装置或元件必须具有特定的方位、以特定的方位构造和操作,因此不能理解为对本发明的限制。
实施例1:
参照图1-图2,一种汽车夜间行驶导航定位系统,包括GPS模块、传感器模块、滤波处理模块和处理器,传感器模块与滤波处理模块电连,GPS模块、滤波处理模块均与处理器电连;
GPS模块,用于接收卫星信号,并采用GPS定位算法计算车辆的当前位置作为实时定位数据;传感器模块,用于获取车辆角速度的量测信息和车辆速度的量测信息;滤波处理模块,用于对车辆的角速度量测信息和车辆速度的量测信息分别进行卡尔曼滤波,并在线调整卡尔曼滤波器参数得到降噪后的车辆的角速度量测信息和车辆速度的量测信息;处理器,用于利用车辆的角速度量测信息和车辆速度的量测信息进行导航解算,输出被测载体的导航信息;
滤波处理模块包括构建模块、迭代计算模块和修改模块,其中:
构建模块,用于建立关于传感器模块单输入单输出卡尔曼滤波状态观测方程;迭代计算模块,用于进行卡尔曼滤波迭代计算,并根据残差2χ检测法得到检测函数值与预先设定的阈值进行比较,得出被测载体的机动变化情况;修改模块,用于根据被测载体的机动变化情况调整卡尔曼滤波器的滤波增益矩阵数值和观测噪声方差矩阵的数值,并将调整后的值反馈给迭代计算模块。
在一些实施例中,传感器模块包括角速度传感器、加速度传感器,其中:
角速度传感器,用于获取车辆角速度的量测信息;
加速度传感器,用于获取车辆速度的量测信息。
在一些实施例中,角速度传感器为三轴陀螺仪,加速度传感器采用三轴加速度传感器。
在一些实施例中,三轴陀螺仪是通过测量三维坐标系内陀螺转子的垂直轴与载体之间的夹角,并计算角速度,通过夹角和角速度来判别物体在三维空间的运动状态,同时测定上、下、左、右、前、后六个方向,最终可判断出载体的移动轨迹和加速度。
在一些实施例中,三轴加速度传感器是感知任意方向上加速度,通过测量载体在某个轴向的受力情况,计算出轴向的加速度大小和方向。
在一些实施例中,处理器设置DP1.2、PCIeM.2、Type-C、USB3.0数据传输和显示接口,且PCIeM.2为Bkey,用于高速Wi-Fi和SSD存储设备扩展,并支持九类扩展接口。
在一些实施例中,还包括存储模块、车载显示屏和喇叭,存储模块、车载显示屏、喇叭均与处理器电连;
存储模块,用于保存导航引擎、地图数据以及GPS模块计算出的实时位置;
车载显示屏,用于显示车辆的当前位置、当前行驶速度、当前时间、离目的地的距离以及需要的时间;
喇叭,用于对车辆的行进方向进行提示。
在一些实施例中,还包括9V-36V的车载直流电源,车载直流电源与处理器电连。
本实施例中,通过由角速度传感器和加速度传感器构成的传感器模块,是基于GPS模块在接收小于4颗GPS卫星的卫星信号或没有时,为了保证该汽车用导航系统还能对汽车行驶位置进行导航定位,可通过角速度传感器获取车辆的角速度变化量时,处理器根据车辆的角速度变化量能够得出车辆的运行方向,然后再通过加速度传感器获取车辆的速度变化量时,处理器根据车辆的速度变化量能够得出车辆行进的距离,在得到车辆运行方向和车辆行进距离时,并采用距离交会法即可得出车辆经度、纬度、高度和时间修正量这四个参数,实现车载导航系统中的GPS模块在接收不到卫星信号或是在信号质量很差的情况下,仍然可实现对车辆的实时导航定位。
实施例2:
参照图1-图2,一种汽车夜间行驶导航定位系统,包括GPS模块、传感器模块、滤波处理模块和处理器,传感器模块与滤波处理模块电连,GPS模块、滤波处理模块均与处理器电连;
GPS模块,用于接收卫星信号,并采用GPS定位算法计算车辆的当前位置作为实时定位数据;传感器模块,用于获取车辆角速度的量测信息和车辆速度的量测信息;滤波处理模块,用于对车辆的角速度量测信息和车辆速度的量测信息分别进行卡尔曼滤波,并在线调整卡尔曼滤波器参数得到降噪后的车辆的角速度量测信息和车辆速度的量测信息;处理器,用于利用车辆的角速度量测信息和车辆速度的量测信息进行导航解算,输出被测载体的导航信息;
滤波处理模块包括构建模块、迭代计算模块和修改模块,其中:
构建模块,用于建立关于传感器模块单输入单输出卡尔曼滤波状态观测方程;迭代计算模块,用于进行卡尔曼滤波迭代计算,并根据残差2χ检测法得到检测函数值与预先设定的阈值进行比较,得出被测载体的机动变化情况;修改模块,用于根据被测载体的机动变化情况调整卡尔曼滤波器的滤波增益矩阵数值和观测噪声方差矩阵的数值,并将调整后的值反馈给迭代计算模块。
在一些实施例中,传感器模块包括角速度传感器、加速度传感器,其中:
角速度传感器,用于获取车辆角速度的量测信息;
加速度传感器,用于获取车辆速度的量测信息。
在一些实施例中,角速度传感器为三轴陀螺仪,加速度传感器采用三轴加速度传感器。
在一些实施例中,三轴陀螺仪是通过测量三维坐标系内陀螺转子的垂直轴与载体之间的夹角,并计算角速度,通过夹角和角速度来判别物体在三维空间的运动状态,同时测定上、下、左、右、前、后六个方向,最终可判断出载体的移动轨迹和加速度。
在一些实施例中,三轴加速度传感器是感知任意方向上加速度,通过测量载体在某个轴向的受力情况,计算出轴向的加速度大小和方向。
在一些实施例中,处理器设置DP1.2、PCIeM.2、Type-C、USB3.0数据传输和显示接口,且PCIeM.2为Bkey,用于高速Wi-Fi和SSD存储设备扩展,并支持九类扩展接口。
在一些实施例中,还包括存储模块、车载显示屏和喇叭,存储模块、车载显示屏、喇叭均与处理器电连;
存储模块,用于保存导航引擎、地图数据以及GPS模块计算出的实时位置;
车载显示屏,用于显示车辆的当前位置、当前行驶速度、当前时间、离目的地的距离以及需要的时间;
喇叭,用于对车辆的行进方向进行提示。
在一些实施例中,还包括9V-36V的车载直流电源,车载直流电源与处理器电连。
本实施例中的GPS模块采用GPS定位算法计算车辆的当前位置作为实时定位数据,具体如下:
当GPS模块在接收到4颗以上GPS卫星的卫星信号时,可根据这些卫星信号到达被测GPS导航系统的时间,基于GPS定位算法,构建如下方程组:
[(x1-x)2+(y1-y)2+(z1-z)2+(x1-x)]2+(Vt1-Vt0)2=d1
[(x2-x)2+(y2-y)2+(z2-z)2+(x1-x)]2+(Vt2-Vt0)2=d2
[(x3-x)2+(y3-y)2+(z3-z)2+(x1-x)]2+(Vt3-Vt0)2=d3
[(x4-x)2+(y4-y)2+(z4-z)2+(x1-x)]2+(Vt4-Vt0)2=d4
其中,(x,y,z)表示GPS导航系统的坐标,(xi,yi,zi),i=1,2,3,4,分别为卫星1、卫星2、卫星3、卫星4在t时刻的空间直角坐标,可由接收的卫星信号的卫星导航电文求得,di(i=1、2、3、4)分别为卫星1、卫星2、卫星3、卫星4到被测GPS导航系统之间的距离,通过公式di=c△ti求解获得;
其中,c表示GPS信号光速的传播速度,△ti(i=1、2、3、4)分别为卫星1、卫星2、卫星3、卫星4的信号到达被测机所经历的时间,通过测量获得,可具体在卫星广播星历信号时,信号内容含有发射信号时候的星载时钟A,被测机接收到此卫星信号的时候计为B,则卫星的信号到达被测机所经历的时间△t=B-A,Vti(i=1、2、3、4)分别为卫星1、卫星2、卫星3、卫星4的卫星钟的钟差,由卫星星历即卫星导航电文提供,Vt0表示被测GPS导航系统的钟差;
通过上述以上方程组即可求解获得被测GPS导航系统的x、y、z坐标和钟差Vt0,从而获得系统的当前位置,同时对于上述构建的方程组,还需要进一步说明的是,至少要有4颗卫星信号才能组成有效解算被测GPS导航系统位置及钟差的方程组,每多接收一颗可多列一个方程,减少位置计算的误差,实际计算时,接收到的有效卫星信号均被用于进行计算;
当GPS模块在接收小于4颗GPS卫星的卫星信号或没有时,可通过传感器模块中包括的角速度传感器获取车辆角速度的量测信息和加速度传感器获取车辆速度的量测信息,并通过对车辆的角速度变化量的计算得到车辆的运行方向,通过对车辆速度的计算得到车辆行进的距离,如此实现对车辆的导航定位,并有效解决了没有卫星信号的情况下,也能实现对车辆的定位或因大城市中的高楼建筑楼群对GPS信号衰减,而出现的卫星信号质量不稳定的车辆导航定位,并且,当卫星信号接收正常时,GPS模块和传感器模块也可以同时配合使用,从而大大提高对车辆定位的精确度。
实施例3:
参照图1-图2,一种汽车夜间行驶导航定位系统,包括GPS模块、传感器模块、滤波处理模块和处理器,传感器模块与滤波处理模块电连,GPS模块、滤波处理模块均与处理器电连;
GPS模块,用于接收卫星信号,并采用GPS定位算法计算车辆的当前位置作为实时定位数据;传感器模块,用于获取车辆角速度的量测信息和车辆速度的量测信息;滤波处理模块,用于对车辆的角速度量测信息和车辆速度的量测信息分别进行卡尔曼滤波,并在线调整卡尔曼滤波器参数得到降噪后的车辆的角速度量测信息和车辆速度的量测信息;处理器,用于利用车辆的角速度量测信息和车辆速度的量测信息进行导航解算,输出被测载体的导航信息;
滤波处理模块包括构建模块、迭代计算模块和修改模块,其中:
构建模块,用于建立关于传感器模块单输入单输出卡尔曼滤波状态观测方程;迭代计算模块,用于进行卡尔曼滤波迭代计算,并根据残差2χ检测法得到检测函数值与预先设定的阈值进行比较,得出被测载体的机动变化情况;修改模块,用于根据被测载体的机动变化情况调整卡尔曼滤波器的滤波增益矩阵数值和观测噪声方差矩阵的数值,并将调整后的值反馈给迭代计算模块。
在一些实施例中,传感器模块包括角速度传感器、加速度传感器,其中:
角速度传感器,用于获取车辆角速度的量测信息;
加速度传感器,用于获取车辆速度的量测信息。
在一些实施例中,角速度传感器为三轴陀螺仪,加速度传感器采用三轴加速度传感器。
在一些实施例中,三轴陀螺仪是通过测量三维坐标系内陀螺转子的垂直轴与载体之间的夹角,并计算角速度,通过夹角和角速度来判别物体在三维空间的运动状态,同时测定上、下、左、右、前、后六个方向,最终可判断出载体的移动轨迹和加速度。
在一些实施例中,三轴加速度传感器是感知任意方向上加速度,通过测量载体在某个轴向的受力情况,计算出轴向的加速度大小和方向。
在一些实施例中,处理器设置DP1.2、PCIeM.2、Type-C、USB3.0数据传输和显示接口,且PCIeM.2为Bkey,用于高速Wi-Fi和SSD存储设备扩展,并支持九类扩展接口。
在一些实施例中,还包括存储模块、车载显示屏和喇叭,存储模块、车载显示屏、喇叭均与处理器电连;
存储模块,用于保存导航引擎、地图数据以及GPS模块计算出的实时位置;
车载显示屏,用于显示车辆的当前位置、当前行驶速度、当前时间、离目的地的距离以及需要的时间;
喇叭,用于对车辆的行进方向进行提示。
在一些实施例中,还包括9V-36V的车载直流电源,车载直流电源与处理器电连。
本实施例中的构建模块,用于分别建立关于传感器模块中角速度传感器和加速度传感器单输入单输出卡尔曼滤波状态方程和观测方程,具体步骤如下:
对于加速度传感器,假设在一个短暂的采样周期内,载体线速率可表示为一个定值,那么加速度传感器的状态方程和观测方程可以表示为:
Z(t)=[0 1]·X(t)+v(t)=Ca·X(t)+v(t)
然后对加速度传感器的状态方程和观测方程进行离散化处理,
Φa≈I+T·F,Ga≈T·Ba,Ha=Ca
得到离散化后加速度传感器的系统状态方程为:Xk+1=Φa·Xk+Ga·wk
观测方程为:Zk+1=Ha·Xk+1+vk+1
其中,V为线速度,a为线加速度,w(t)为t时刻2×1维的系统过程噪声向量,Z(t)为t时刻加速度传感器的量测信息,v(t)为t时刻1×1的量测噪声向量,T为采样时间间隔;
对于角速度传感器,假设在一个短暂的采样周期内,载体角速率可表示为一个定值,那么角速度传感器的状态方程和观测方程可以表示为:
Z(t)=[1 0]·X(t)+v(t)=Cg·X(t)+v(t)
然后对角速度传感器的状态方程和观测方程进行离散化处理,
Φg≈I+T·F,Gg≈T·Bg,Hg=Cg
得到角速度传感器散化后的系统状态方程为:Xk+1=Φg·Xk+Gg·wk
观测方程为:Zk+1=Hg·Xk+1+vk+1
其中,ω为角速率,ε为角加速度,w(t)为t时刻2×1维的系统过程噪声向量,Z(t)为t时刻角速度传感器的量测信息,v(t)为t时刻1×1的量测噪声,T为采样时间间隔;
本实施例中,通过滤波处理模块中的角速度传感器和加速度传感器的特性分别建立了单输入单输出的卡尔曼滤波状态方程和观测方程,使滤波处理模块将角速度传感器和加速度传感器量测噪声作为卡尔曼滤波系统的观测噪声处理,且利用了卡尔曼的工作特性,从而能够有效降低了角速度传感器和加速度传感器量测数据中的随机噪声,当GPS模块在接收不到卫星信号或是在信号质量很差的情况下,本发明实施例中提供的角速度传感器和加速度传感器在无需卫星定位的情况下,仍可以实现对车辆的精准实时导航定位。
实施例4:
参照图1-图2,一种汽车夜间行驶导航定位系统,包括GPS模块、传感器模块、滤波处理模块和处理器,传感器模块与滤波处理模块电连,GPS模块、滤波处理模块均与处理器电连;
GPS模块,用于接收卫星信号,并采用GPS定位算法计算车辆的当前位置作为实时定位数据;传感器模块,用于获取车辆角速度的量测信息和车辆速度的量测信息;滤波处理模块,用于对车辆的角速度量测信息和车辆速度的量测信息分别进行卡尔曼滤波,并在线调整卡尔曼滤波器参数得到降噪后的车辆的角速度量测信息和车辆速度的量测信息;处理器,用于利用车辆的角速度量测信息和车辆速度的量测信息进行导航解算,输出被测载体的导航信息;
滤波处理模块包括构建模块、迭代计算模块和修改模块,其中:
构建模块,用于建立关于传感器模块单输入单输出卡尔曼滤波状态观测方程;迭代计算模块,用于进行卡尔曼滤波迭代计算,并根据残差2χ检测法得到检测函数值与预先设定的阈值进行比较,得出被测载体的机动变化情况;修改模块,用于根据被测载体的机动变化情况调整卡尔曼滤波器的滤波增益矩阵数值和观测噪声方差矩阵的数值,并将调整后的值反馈给迭代计算模块。
在一些实施例中,传感器模块包括角速度传感器、加速度传感器,其中:
角速度传感器,用于获取车辆角速度的量测信息;
加速度传感器,用于获取车辆速度的量测信息。
在一些实施例中,角速度传感器为三轴陀螺仪,加速度传感器采用三轴加速度传感器。
在一些实施例中,三轴陀螺仪是通过测量三维坐标系内陀螺转子的垂直轴与载体之间的夹角,并计算角速度,通过夹角和角速度来判别物体在三维空间的运动状态,同时测定上、下、左、右、前、后六个方向,最终可判断出载体的移动轨迹和加速度。
在一些实施例中,三轴加速度传感器是感知任意方向上加速度,通过测量载体在某个轴向的受力情况,计算出轴向的加速度大小和方向。
在一些实施例中,处理器设置DP1.2、PCIeM.2、Type-C、USB3.0数据传输和显示接口,且PCIeM.2为Bkey,用于高速Wi-Fi和SSD存储设备扩展,并支持九类扩展接口。
在一些实施例中,还包括存储模块、车载显示屏和喇叭,存储模块、车载显示屏、喇叭均与处理器电连;
存储模块,用于保存导航引擎、地图数据以及GPS模块计算出的实时位置;
车载显示屏,用于显示车辆的当前位置、当前行驶速度、当前时间、离目的地的距离以及需要的时间;
喇叭,用于对车辆的行进方向进行提示。
在一些实施例中,还包括9V-36V的车载直流电源,车载直流电源与处理器电连。
本实施例中,考虑到角速度传感器和加速度传感器一般运用在车辆的动态环境中,为了保证角速度传感器和加速度传感器的量测值,在经滤波后的结果能够实时跟随载体的机动,所以本实施例中设计了迭代计算模块和修改模块,通过迭代计算模块采用残差χ2检测法对载体机动变化情况进行实时监测,当检测函数值大于阈值时,说明系统处于快速机动变化的情况,当检测函数的值小于阈值时,说明系统的机动变化缓慢或者处于静止或匀速运动状态,并利用残差χ2检测法对载体机动变化情况进行实时监测的功能,最后再根据机动情况在线调整卡尔曼滤波的滤波增益阵数值和观测噪声方差阵数值,保证该系统还能够适应车辆动、静态环境下的加速度传感器和角速度传感器的随机噪声处理,进一步提高了角速度传感器对车辆获取角速度变化量和加速度传感器对车辆获取速度变化量数值的准确性。
以上所述,仅为本发明较佳的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明揭露的技术范围内,根据本发明的技术方案及其发明构思加以等同替换或改变,都应涵盖在本发明的保护范围之内。
Claims (8)
1.一种汽车夜间行驶导航定位系统,其特征在于,包括GPS模块、传感器模块、滤波处理模块和处理器,所述传感器模块与滤波处理模块电连,所述GPS模块、滤波处理模块均与处理器电连;
所述GPS模块,用于接收卫星信号,并采用GPS定位算法计算车辆的当前位置作为实时定位数据;所述传感器模块,用于获取车辆角速度的量测信息和车辆速度的量测信息;所述滤波处理模块,用于对车辆的角速度量测信息和车辆速度的量测信息分别进行卡尔曼滤波,并在线调整卡尔曼滤波器参数得到降噪后的车辆的角速度量测信息和车辆速度的量测信息;所述处理器,用于利用车辆的角速度量测信息和车辆速度的量测信息进行导航解算,输出被测载体的导航信息;
所述滤波处理模块包括构建模块、迭代计算模块和修改模块,其中:
所述构建模块,用于建立关于传感器模块单输入单输出卡尔曼滤波状态观测方程;所述迭代计算模块,用于进行卡尔曼滤波迭代计算,并根据残差2χ检测法得到检测函数值与预先设定的阈值进行比较,得出被测载体的机动变化情况;所述修改模块,用于根据被测载体的机动变化情况调整卡尔曼滤波器的滤波增益矩阵数值和观测噪声方差矩阵的数值,并将调整后的值反馈给迭代计算模块。
2.根据权利要求1所述的一种汽车夜间行驶导航定位系统,其特征在于,所述传感器模块包括角速度传感器、加速度传感器,其中:
所述角速度传感器,用于获取车辆角速度的量测信息;
所述加速度传感器,用于获取车辆速度的量测信息。
3.根据权利要求2所述的一种汽车夜间行驶导航定位系统,其特征在于,所述角速度传感器为三轴陀螺仪,所述加速度传感器采用三轴加速度传感器。
4.根据权利要求3所述的一种汽车夜间行驶导航定位系统,其特征在于,所述三轴陀螺仪是通过测量三维坐标系内陀螺转子的垂直轴与载体之间的夹角,并计算角速度,通过夹角和角速度来判别物体在三维空间的运动状态,同时测定上、下、左、右、前、后六个方向,最终可判断出载体的移动轨迹和加速度。
5.根据权利要求3所述的一种汽车夜间行驶导航定位系统,其特征在于,所述三轴加速度传感器是感知任意方向上加速度,通过测量载体在某个轴向的受力情况,计算出轴向的加速度大小和方向。
6.根据权利要求1所述的一种汽车夜间行驶导航定位系统,其特征在于,所述处理器设置DP1.2、PCIeM.2、Type-C、USB3.0数据传输和显示接口,且PCIeM.2为Bkey,用于高速Wi-Fi和SSD存储设备扩展,并支持九类扩展接口。
7.根据权利要求1所述的一种汽车夜间行驶导航定位系统,其特征在于,还包括存储模块、车载显示屏和喇叭,所述存储模块、车载显示屏、喇叭均与处理器电连;
所述存储模块,用于保存导航引擎、地图数据以及GPS模块计算出的实时位置;
所述车载显示屏,用于显示车辆的当前位置、当前行驶速度、当前时间、离目的地的距离以及需要的时间;
所述喇叭,用于对车辆的行进方向进行提示。
8.根据权利要求1所述的一种汽车夜间行驶导航定位系统,其特征在于,还包括9V-36V的车载直流电源,所述车载直流电源与处理器电连。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211273810.5A CN115342820A (zh) | 2022-10-18 | 2022-10-18 | 一种汽车夜间行驶导航定位系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211273810.5A CN115342820A (zh) | 2022-10-18 | 2022-10-18 | 一种汽车夜间行驶导航定位系统 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN115342820A true CN115342820A (zh) | 2022-11-15 |
Family
ID=83957587
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202211273810.5A Pending CN115342820A (zh) | 2022-10-18 | 2022-10-18 | 一种汽车夜间行驶导航定位系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN115342820A (zh) |
Citations (18)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103472459A (zh) * | 2013-08-29 | 2013-12-25 | 镇江青思网络科技有限公司 | 一种基于gps伪距差分的车辆协作定位方法 |
CN104181560A (zh) * | 2013-05-24 | 2014-12-03 | 凹凸电子(武汉)有限公司 | 定位模块、定位装置和卫星定位方法 |
CN104596514A (zh) * | 2015-01-12 | 2015-05-06 | 东南大学 | 加速度计和陀螺仪的实时降噪系统和方法 |
CN106199667A (zh) * | 2016-06-17 | 2016-12-07 | 南京理工大学 | Gps/sins超紧组合导航系统中的快速重定位方法 |
CN106595655A (zh) * | 2016-12-14 | 2017-04-26 | 中国电子科技集团公司第二十研究所 | 一种基于惯性传感器的双星组合定位方法 |
CN106842271A (zh) * | 2015-12-03 | 2017-06-13 | 宁波芯路通讯科技有限公司 | 导航定位方法及装置 |
CN107085232A (zh) * | 2017-03-09 | 2017-08-22 | 广州小鹏汽车科技有限公司 | Gps导航系统及其定位精度测试方法 |
CN107728172A (zh) * | 2017-09-08 | 2018-02-23 | 南京理工大学 | 一种北斗/gps双模星载接收机及其导航定位方法 |
CN110780326A (zh) * | 2019-09-26 | 2020-02-11 | 上海瀚所信息技术有限公司 | 一种车载组合导航系统和定位方法 |
CN111006662A (zh) * | 2019-12-26 | 2020-04-14 | 北京悦航天翼电子信息技术有限公司 | 基于arinc429模拟器的自主导航与定位系统 |
CN111998849A (zh) * | 2020-08-27 | 2020-11-27 | 湘潭大学 | 一种基于惯性导航系统的差分动动定位的方法 |
CN212030555U (zh) * | 2019-12-26 | 2020-11-27 | 北京悦航天翼电子信息技术有限公司 | 基于arinc429模拟器的自主导航与定位系统 |
CN112415551A (zh) * | 2019-08-20 | 2021-02-26 | 青岛北斗天地科技有限公司 | 工程运输车辆在北斗/gps定位下的压缩感知矢量跟踪定位方法 |
CN113203411A (zh) * | 2021-04-23 | 2021-08-03 | 南京理工大学 | 一种弹性嵌入式gnss/惯性组合导航系统及方法 |
CN113984054A (zh) * | 2021-09-17 | 2022-01-28 | 兰州交通大学 | 基于信息异常检测的改进Sage-Husa自适应融合滤波方法及多源信息融合设备 |
CN114370873A (zh) * | 2022-01-19 | 2022-04-19 | 东南大学 | 一种基于改进ukf的星光折射cns/sins组合导航方法 |
CN114396941A (zh) * | 2021-12-20 | 2022-04-26 | 东南大学 | 一种基于强跟踪Kalman滤波的级联式惯性/卫星深组合方法 |
CN114609657A (zh) * | 2022-03-07 | 2022-06-10 | 江西理工大学 | 一种基于信息融合的永磁磁悬浮列车交通定位系统及方法 |
-
2022
- 2022-10-18 CN CN202211273810.5A patent/CN115342820A/zh active Pending
Patent Citations (18)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104181560A (zh) * | 2013-05-24 | 2014-12-03 | 凹凸电子(武汉)有限公司 | 定位模块、定位装置和卫星定位方法 |
CN103472459A (zh) * | 2013-08-29 | 2013-12-25 | 镇江青思网络科技有限公司 | 一种基于gps伪距差分的车辆协作定位方法 |
CN104596514A (zh) * | 2015-01-12 | 2015-05-06 | 东南大学 | 加速度计和陀螺仪的实时降噪系统和方法 |
CN106842271A (zh) * | 2015-12-03 | 2017-06-13 | 宁波芯路通讯科技有限公司 | 导航定位方法及装置 |
CN106199667A (zh) * | 2016-06-17 | 2016-12-07 | 南京理工大学 | Gps/sins超紧组合导航系统中的快速重定位方法 |
CN106595655A (zh) * | 2016-12-14 | 2017-04-26 | 中国电子科技集团公司第二十研究所 | 一种基于惯性传感器的双星组合定位方法 |
CN107085232A (zh) * | 2017-03-09 | 2017-08-22 | 广州小鹏汽车科技有限公司 | Gps导航系统及其定位精度测试方法 |
CN107728172A (zh) * | 2017-09-08 | 2018-02-23 | 南京理工大学 | 一种北斗/gps双模星载接收机及其导航定位方法 |
CN112415551A (zh) * | 2019-08-20 | 2021-02-26 | 青岛北斗天地科技有限公司 | 工程运输车辆在北斗/gps定位下的压缩感知矢量跟踪定位方法 |
CN110780326A (zh) * | 2019-09-26 | 2020-02-11 | 上海瀚所信息技术有限公司 | 一种车载组合导航系统和定位方法 |
CN111006662A (zh) * | 2019-12-26 | 2020-04-14 | 北京悦航天翼电子信息技术有限公司 | 基于arinc429模拟器的自主导航与定位系统 |
CN212030555U (zh) * | 2019-12-26 | 2020-11-27 | 北京悦航天翼电子信息技术有限公司 | 基于arinc429模拟器的自主导航与定位系统 |
CN111998849A (zh) * | 2020-08-27 | 2020-11-27 | 湘潭大学 | 一种基于惯性导航系统的差分动动定位的方法 |
CN113203411A (zh) * | 2021-04-23 | 2021-08-03 | 南京理工大学 | 一种弹性嵌入式gnss/惯性组合导航系统及方法 |
CN113984054A (zh) * | 2021-09-17 | 2022-01-28 | 兰州交通大学 | 基于信息异常检测的改进Sage-Husa自适应融合滤波方法及多源信息融合设备 |
CN114396941A (zh) * | 2021-12-20 | 2022-04-26 | 东南大学 | 一种基于强跟踪Kalman滤波的级联式惯性/卫星深组合方法 |
CN114370873A (zh) * | 2022-01-19 | 2022-04-19 | 东南大学 | 一种基于改进ukf的星光折射cns/sins组合导航方法 |
CN114609657A (zh) * | 2022-03-07 | 2022-06-10 | 江西理工大学 | 一种基于信息融合的永磁磁悬浮列车交通定位系统及方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN101382431B (zh) | 定位系统及其方法 | |
RU2693021C2 (ru) | Точность определения местоположения транспортного средства | |
US6480784B2 (en) | Method and apparatus for applying decimation processing to vehicle position data based upon data accuracy estimation | |
CN108089180A (zh) | 基于uwb传感器作为轨道信标对gps和惯性导航系统矫正的悬挂式轨道车的定位方法 | |
CN102089624A (zh) | 用于建立公路地图和确定车辆位置的方法和系统 | |
CN106842271B (zh) | 导航定位方法及装置 | |
US20230358541A1 (en) | Inertial navigation system capable of dead reckoning in vehicles | |
EP2219044A1 (en) | Navigation method, navigation system, navigation device, vehicle provided therewith and group of vehicles | |
CN102243315A (zh) | 具有辅助定位功能的移动终端及方法 | |
CN109059909A (zh) | 基于神经网络辅助的卫星/惯导列车定位方法与系统 | |
CN104412066A (zh) | 定位装置 | |
CN110823224B (zh) | 一种车辆定位方法及车辆 | |
EP1777541A1 (en) | Telemetry system for vehicles based on position-localization information | |
CN109470276B (zh) | 基于零速修正的里程计标定方法与装置 | |
CN113674551A (zh) | 一种基于车路协同的车辆前向碰撞预警方法与系统 | |
KR20160038319A (ko) | 차량의 위치 표시 방법 | |
JPH10111137A (ja) | Gpsナビゲーション装置 | |
CN111486860A (zh) | 用于确定道路倾斜角的系统和方法 | |
CN101545781B (zh) | 车载组合导航中里程计脉冲当量确定方法 | |
JPH0531924B2 (zh) | ||
CN115342820A (zh) | 一种汽车夜间行驶导航定位系统 | |
JPH0943336A (ja) | 相対位置測定方法 | |
JP2023139091A (ja) | 危険度合い判定装置、危険度合い判定方法および危険度合い判定プログラム | |
CN108718533A (zh) | 具有高程数据输入的无线惯性车辆导航 | |
KR101510190B1 (ko) | 차량의 위치 보정 장치 |
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 | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20221115 |
|
RJ01 | Rejection of invention patent application after publication |