CN1928568A - 加速度传感器的偏移检测和导航系统 - Google Patents

加速度传感器的偏移检测和导航系统 Download PDF

Info

Publication number
CN1928568A
CN1928568A CNA2006101269504A CN200610126950A CN1928568A CN 1928568 A CN1928568 A CN 1928568A CN A2006101269504 A CNA2006101269504 A CN A2006101269504A CN 200610126950 A CN200610126950 A CN 200610126950A CN 1928568 A CN1928568 A CN 1928568A
Authority
CN
China
Prior art keywords
acceleration
detected
variable quantity
offset
high variable
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
Application number
CNA2006101269504A
Other languages
English (en)
Other versions
CN1928568B (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.)
Sony Corp
Original Assignee
Sony Corp
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 Sony Corp filed Critical Sony Corp
Publication of CN1928568A publication Critical patent/CN1928568A/zh
Application granted granted Critical
Publication of CN1928568B publication Critical patent/CN1928568B/zh
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01PMEASURING LINEAR OR ANGULAR SPEED, ACCELERATION, DECELERATION, OR SHOCK; INDICATING PRESENCE, ABSENCE, OR DIRECTION, OF MOVEMENT
    • G01P15/00Measuring acceleration; Measuring deceleration; Measuring shock, i.e. sudden change of acceleration
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/26Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
    • G01C21/28Navigation; 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
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01PMEASURING LINEAR OR ANGULAR SPEED, ACCELERATION, DECELERATION, OR SHOCK; INDICATING PRESENCE, ABSENCE, OR DIRECTION, OF MOVEMENT
    • G01P7/00Measuring speed by integrating acceleration

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Navigation (AREA)
  • Position Fixing By Use Of Radio Waves (AREA)

Abstract

本发明提供了加速度传感器的偏移检测和导航系统。本发明的目的在于准确地检测加速度传感器中的零重力偏移。作为本发明的一个实施例,在能够从GPS处理部分获得位置信息PS的情况下,速度检测单元通过利用从加速度传感器实际获得的真实的检测到的加速度αGr、基于位置信息PS的车辆加速度αP、距离Dm、基于压力PR的高度变化量Dh和重力加速度g,执行根据表达式(15)的运算。从而,可以准确地计算偏移加速度αo,并且可以基于用来转换上述偏移加速度αo的零重力偏移值Vzgo将加速度检测信号十分准确地转换到检测到的加速度αG。

Description

加速度传感器的偏移检测和导航系统
技术领域
本发明涉及加速度传感器的偏移检测系统、加速度传感器的偏移检测方法和加速度传感器的偏移检测程序,以及导航系统,并且适用于例如要安装在车辆中的导航系统。
背景技术
迄今为止,下面这种要安装在运动的移动体等中的导航系统已经广泛普及:在这种导航系统中,基于从全球定位系统(GPS)卫星发送的GPS信号计算当前位置,并且将上述移动体的位置和前进方向显示在地图屏幕上。
在这种导航系统中,移动体的速度和前进方向是用加速度传感器和陀螺仪(gyro)传感器(偏航率传感器)来计算的,所述加速度传感器用于检测移动体在前进方向上的加速度,所述陀螺仪传感器用于检测上述移动体在水平方向上的旋转角速度。从而,即使在例如在建筑物阴影或隧道中无法接收到GPS信号的情况下,也能估计移动体的当前位置。
但是,此加速度传感器有这样的问题:在未检测到加速度时的输出电压,即所谓的零重力偏移,由于其温度特性,因而在周围温度、导航系统本身生成的热量等的影响下而发生变化。
于是,已经提出了一些导航系统,在这些导航系统中,利用当车辆行驶在斜坡上时重力加速度的前进方向分量被包括在加速度传感器的检测值中这一事实来计算高度变化量(高度差异),并且基于存储在地图信息等中的高度数据,通过将计算出的高度变化量与已知的高度变化量相比较来计算零重力偏移(加速度误差)(例如参见日本专利早期公开No.2004-233306)。
发明内容
但是,在具有上述配置的导航系统中,存在这样的问题:当不知道正确的高度变化量时,例如当车辆行驶在其高度数据未被包括在地图信息中的地方时,无法计算零重力偏移。
鉴于上述情况,需要提供一种能够准确地检测加速度传感器中的零重力偏移的加速度传感器的偏移检测系统、一种加速度传感器的偏移检测方法、一种加速度传感器的偏移检测程序以及能够显示关于移动体的位置的准确信息的导航系统。
根据本发明的一个实施例,在一种加速度传感器的偏移检测系统、一种加速度传感器的偏移检测方法以及一种加速度传感器的偏移检测程序中,通过加速度传感器获得真实的检测到的加速度,所述真实的检测到的加速度与偏移变动与预定移动体中前进方向上的加速度相加的结果相对应。计算加速度传感器本应正确检测到的待检测加速度。并且基于真实的检测到的加速度和待检测加速度之间的差异,计算偏移变动,偏移变动是由于加速度传感器的特性而引起的真实的检测到的加速度偏离待检测加速度的变化。
从而,可以仅基于真实的检测到的加速度和待检测加速度之间的差异计算偏移变动,并且可以获得其中反映了上述偏移变动的准确的加速度。
此外,根据本发明的导航系统的一个实施例,提供了:当前位置计算部分,用于接收来自预定的卫星定位系统的定位信号,并且计算预定的移动体的当前位置;加速度传感器,用于获得真实的检测到的加速度,真实的检测到的加速度与偏移变动与预定移动体中前进方向上的加速度相加的结果相对应;待检测加速度计算部分,用于计算加速度传感器本应正确检测到的待检测加速度;偏移计算部分,用于基于真实的检测到的加速度和待检测加速度之间的差异,计算偏移变动,偏移变动是由于加速度传感器的特性而引起的真实的检测到的加速度偏离待检测加速度的变化;以及信息显示部分,用于用由偏移计算部分计算出的偏移变动计算加速度,并且基于用加速度计算出的移动体的速度显示关于移动体的位置的信息。
从而,可以仅基于真实的检测到的加速度和待检测加速度之间的差异计算偏移变动,并且可以通过获得其中反映了上述偏移变动的准确的加速度来显示关于移动体的位置的准确信息。
当结合附图理解下面的详细描述时,本发明的性质、原理和用途将会变得更清楚,附图中类似的部件由类似的标号或标记字符指定。
附图说明
在附图中:
图1是示出根据第一实施例的导航系统的电路配置的框图;
图2A至2C是用于说明高度变化量的计算原理的示意图;
图3A和3B是用于说明零重力偏移的变化和转换后参考电势的更新的示意图;
图4是示出根据第一实施例的速度输出处理过程的流程图;
图5是示出偏移加速度计算处理过程的流程图;
图6是示出高度变化量校正处理过程的流程图;
图7是示出速度计算处理过程的流程图;
图8是示出根据第二实施例的导航系统的电路配置的框图;
图9A和9B是用于说明角速度校正的示意图;
图10是示出根据第二实施例的速度输出处理过程的流程图;以及
图11是示出压力和高度之间的关系的示意图。
具体实施方式
现将参考附图描述本发明的优选实施例。
(1)第一实施例
(1-1)导航系统的配置
参考图1,导航系统1被安装在充当移动体的车辆100(图2A)中。车辆100的当前位置是由全球定位系统(GPS)处理部分4基于接收自GPS卫星的GPS信号计算的,显示屏幕数据是由导航单元3通过将指示车辆100的当前位置之类的标记叠加在预定地图数据上来生成的,并且这被发送到显示部分5并且显示屏幕被显示。从而,用户可以在地图上看到车辆100的位置。
GPS处理部分4经由GPS天线6接收来自多个GPS卫星(未示出)的GPS信号,通过基于GPS信号执行预定的位置计算处理来生成位置信息PS,并且将其提供到速度检测单元2中的运算处理块10和导航单元3。
速度检测单元2是以运算处理块10为中心形成的。用于检测作用在车辆100的前进方向上的加速度的加速度传感器11、用于检测周围压力的压力传感器12以及用于检测车辆100在垂直方向上的旋转角速度的偏航率传感器19被连接到上述运算处理块10。
加速度传感器11生成加速度检测信号SA,并将其提供到运算处理块10,在该加速度检测信号SA中,电势相应于作用在车辆100的前进方向上的加速度在0V到5V的范围内变化。就此而言,加速度传感器11被设置为当加速度不作用在车辆100的前进方向上时,加速度检测信号SA的电势变为2.5V(以下将此时加速度检测信号SA的电势称为零重力偏移值Vzgo)。
压力传感器12生成压力检测信号SR,并将其提供到运算处理块10,在该压力检测信号SR中,电势相应于周围压力在预定范围内变化。
偏航率传感器19检测车辆100的垂直方向上(即偏航旋转轴转动)的角速度ф,并将其提供到运算处理块10。
运算处理块10基于与零重力偏移值Vzgo(即2.5V)相同的转换后参考电势Vsc将提供自加速度传感器11的加速度检测信号SA转换成作用在车辆100的前进方向上的检测到的加速度αG,并将提供自压力传感器12的压力检测信号SR转换成代表周围压力的压力值PR。然后,运算处理块10基于提供自GPS处理部分4的位置信息PS和上述检测到的加速度αG和压力PR计算上述车辆100的速度V,并将其发送到导航单元3。
运算处理块10具有未示出的中央处理单元(CPU)配置,并且从未示出的只读存储器(ROM)读取诸如速度计算程序之类的各种应用程序,并且执行该程序。从而,分别实现了诸如以下处理功能:用于计算预定测量时间中车辆100的移动距离的距离计算部分13、用于基于压力PR计算在上述测量时间中上述车辆100的高度变化量的高度变化量计算部分14(后面将描述其细节)、用于确定车辆100是停止还是在行驶的车辆停止确定部分15、用于计算上述车辆100的速度V的速度计算部分16(后面将描述其细节),以及用于计算包括在提供自加速度传感器11的检测到的加速度αG中的零重力偏移ZGO的偏移计算部分17(后面将描述其细节)。
此外,运算处理块10将计算出的速度V和零重力偏移ZGO等存储在作为非易失性存储器的存储器部分18中,或在需要时读取它们。
就此而言,导航系统1不使用在车辆100中生成的并且周期相应于上述车辆100的速度而变化的脉冲形式的车辆速度脉冲信号。从而,将上述导航系统1安装在上述车辆100时的布线处理可以得到简化。
以这种方式,导航系统1的速度检测单元2计算车辆100的速度V,并且还计算包括在提供自加速度传感器11的检测到的加速度αG中的零重力偏移ZGO。
(1-2)本发明的基本原理
现将描述本发明的基本原理。如图2A所示,在这里假定车辆100行驶在斜坡SL上,该斜坡SL具有相对于水平面HZ的斜坡角θ。在这种情况下,由加速度传感器11(图1)检测到的检测到的加速度αG对应于由车辆100的移动引起的主加速度(以下将其称为车辆加速度αP)加上作用在上述车辆100上的重力加速度g的前进方向分量(以下将其称为重力加速度分量gf)的值。即,重力加速度分量gf可以通过检测到的加速度αG和车辆加速度αP之间的差按以下表达式来计算:
gf=αG-αP...(1)
导航系统1的速度检测单元2(图1)可以在基于多段时间的多个位置信息PS计算距离和速度时计算上述车辆加速度αP。
顺便说一下,如图2B和2C所示,在从作为测量开始点的某个时间t0到作为测量结束点的时间t1的测量时间mt(例如一秒)中车辆100在斜坡SL上移动的距离Dm与上述测量时间mt中上述车辆100的高度变化量Dh之比(即sinθ)等于重力加速度分量gf与重力加速度g之比(即sinθ)。因此,满足以下表达式的关系:
gf g = Dh Dm - - - ( 2 )
顺便说一下,根据使用速度和加速度的关于距离的一般表达式,上述距离Dm可用时间t0处车辆100的速度V0和车辆加速度αP来表示,如以下表达式所示:
Dm = V 0 · mt + 1 2 aP · mt 2 - - - ( 3 )
在这里,如果通过代入表达式(1)和(3)来变换表达式(2),则得出下面的表达式:
αP - αG g · ( V 0 · mt + 1 2 αP · mt 2 ) = Dh - - - ( 4 )
(1-2-1)速度的计算
顺便说一下,当在建筑物阴影中、隧道等中GPS天线6无法接收到来自GPS卫星的GPS信号时,导航单元3无法基于来自GPS处理部分4的位置信息PS来计算车辆100的当前位置。因此,导航系统1的速度检测单元2(图1)基于车辆100的水平方向上的角速度ф和速度V估计上述当前位置,并且基于此的地图屏幕被显示在显示部分5中。
但是,由于在GPS天线6中无法接收到GPS信号,因此导航系统1的速度检测单元2(图1)无法使用基于提供自GPS处理部分4的位置信息PS随时间的变化来计算速度V的简单技术。
于是,速度检测单元2的速度计算部分16在不使用位置信息PS的情况下基于时间t0处的速度V0计算时间t1处的速度V1。下面将描述该原理。
首先,如果关于车辆加速度αP重新写上述表达式(4),则获得下面的表达式。
αP = αG 2 - V 0 mt + ( αG 2 + V 0 mt ) 2 - 2 Dh · g mt 2 - - - ( 5 )
在这里,对于时间t1处的速度V1,根据关于速度V的一般物理表达式,满足以下表达式的关系。
V1=V0+αP.mt...(6)
这意味着可以基于速度V0计算速度V1。在这里,通过将表达式(5)代入表达式(6)中,可以获得以下表达式:
V 1 = αG · mt 2 + ( αG · mt 2 + V 0 ) 2 - 2 Dh · g - - - ( 7 )
即,如果可以获得高度变化量Dh,则速度检测单元2可以通过用检测到的加速度αG、测量时间mt、时间t0处的速度V0、重力加速度g以及上述高度变化量Dh来计算时间t1处的速度V1。
在这种情况下,速度检测单元2直接执行表达式(7)的运算。但是,上述表达式(7)是将表达式(5)代入到表达式(6)中得到的表达式。因此,这意味着速度检测单元2间接获得车辆加速度αP,并通过用它从时间t0处的速度V0获取时间t1处的速度V1。
(1-2-2)车辆停止状态的确定
顺便说一下,如表达式(6)所示,速度检测单元2利用时间t0处的速度V0(刚才的速度V0)计算时间t1处的速度V1(即当前的速度V1)。因此,如果速度V错误,则速度V1也会成为错误的值。从而,速度检测单元2有必要稳妥地检测车辆100中的第一速度V,即将车辆停止状态的速度V检测为“零”。
在这里,一般来说,当车辆100在行驶时,速度V根据道路形式和交通状况等而连续变化。因此,上述速度V连续为恒定值的概率是极低的。上述速度V的值具有一定程度的变动。另一方面,当车辆100停止时,速度V并不偏离零而变化,而是恒定的值。从而,即使考虑到检测误差,上述速度V的变动也处于预定范围内。
于是,速度检测单元2通过车辆停止确定部分15计算预定时间范围(例如五秒)中速度V的变动Vvar。如果变动Vvar处于预定范围内,则速度检测单元2确定车辆100停止,并且此时的速度V被校正到零。
从而,速度检测单元2可以正确地确定车辆100是处于行驶状态还是停止状态。当车辆100处于停止状态时,速度V被校正到零,从而之后的速度V可以被正确地计算。
(1-2-3)高度变化量的计算
现将描述速度检测单元2(图1)中对高度变化量的计算处理。如上述表达式(2)中所示,速度检测单元2可以通过用距离Dm、重力加速度分量gf(即检测到的加速度αG-车辆加速度αP)和重力加速度g来计算高度变化量Dh。
在这里,当GPS天线6能够接收到GPS信号时,在速度检测单元2中,车辆100在测量时间mt中移动的距离Dm可以在距离计算部分13中被计算。从而,可以基于上述距离Dm计算车辆100的速度V。此外,可以基于此计算车辆加速度αP。
但是,当GPS天线6无法接收到来自GPS卫星的GPS信号并且在GPS处理部分4中无法生成位置信息PS时,速度检测单元2无法计算距离Dm和车辆加速度αP。因此,无法从表达式(2)中的关系计算高度变化量Dh。
于是,当在GPS处理部分4中无法生成位置信息PS时,速度检测单元2通过利用在压力PR和高度h之间一般存在对应关系这一事实将从压力传感器12获得的压力PR转换为高度h。
实际上,被用来预先将一般压力和高度之间的对应关系制成表格的压力/高度对应表TBL已被存储在存储器部分18中,并且速度检测单元2基于时间t0处的压力PR0和时间t1处的压力PR1从上述压力/高度对应表TBL读取分别与压力PR0和PR1相对应的高度h0和h1。
接下来,速度检测单元2根据以下表达式计算高度变化量Dh,该高度变化量Dh是时间t0处车辆100的高度h0和时间t1处车辆100的高度h1之间的差:
Dh=h1-h0...(8)
在这里,对于高度变化量Dh,如果考虑到一般道路中的斜坡范围和车辆100的行驶性能(即每单位时间的移动距离)等,则可以认为实际上可以取的范围的上限值和下限值是存在的(以下将其称为高度变化范围)。
另一方面,在车辆100实际行驶在道路上的情况下,存在这样的可能:例如,当上述车辆100的窗打开或关闭时,当车辆100进入隧道时,或者当车辆100经过相邻的交通线时,车辆空间中的压力受这些因素而不是高度变化的影响(以下将这些因素称为非高度因素)。
在这种情况下,速度检测单元2基于受到非高度因素影响的压力PR计算出错误的高度h。从而,高度变化量Dh也变成错误的值。
顺便说一下,当车辆100受到这种非高度因素的影响时,认为车辆空间中的压力PR与仅由高度引起的情况相比会突然变化。即,此时高度变化量Dh处于高度变化范围之外的概率较高。
于是,在通过表达式(8)计算的高度变化量Dh处于高度变化范围之外的情况下,认为车辆100受到了非高度因素的影响,并且速度检测单元2校正上述高度变化量Dh。
具体而言,实际上可取的斜坡角θ(图2)的最大值被定义为最大斜坡角θmax(例如0.05πrad之类的),并且速度检测单元2确定是否满足下面的使用计算出的高度变化量Dh和刚才的速度V0的表达式。
|Dh|≤V0·sinθmax...(9)
就此而言,表达式(9)的右侧通过用sin(θmax)乘以刚才的速度V0,从整体上代表了“从刚才的速度V0假定的最大高度差”。
在这里,当满足表达式(9)时,认为通过表达式(8)计算出的高度变化量Dh不受非高度因素的影响,是正确的值,并且速度检测单元2执行下面的处理,而不特别执行校正。
另一方面,如果未满足表达式(9),则认为通过表达式(8)计算出的高度变化量Dh受到了非高度因素的影响,并且速度检测单元2根据以下表达式计算校正后高度变化量Dhc:
Dhc = V 0 · sin ( θ max ) · | Dh | Dh - - - ( 10 )
然后,速度检测单元2通过将此校正后高度变化量Dhc设置为新的高度变化量Dh来执行下面的处理。
在这种情况下,速度检测单元2无法从车辆空间中的压力PR计算正确的高度变化量Dh。因此,作为次优方案,速度检测单元2计算校正后高度变化量Dhc作为可取的最大高度变化量Dh,并用此作为高度变化量Dh。
另一方面,压力一般相应于高度变为不同的值。即使处于相同高度,压力也会由于诸如低压和高压之类的天气影响而缓慢变化。但是,作为速度检测单元2检测压力PR0和PR1的时间差的测量时间mt(约一秒)比起由于天气影响而发生较大压力变化的时间来足够地短。因此,可以认为作为高度h之间的相对差异的高度变化量Dh不受到由天气之类的引起的压力变化的影响。
因此,速度检测单元2可以通过压力/高度对应表TBL和表达式(8)获得十分可靠的高度变化量Dh。从而,计算出的高度变化量Dh可被应用到表达式(7)。
在这种情况下,由于速度检测单元2无法计算正确的车辆加速度αP,因此它无法直接通过表达式(1)中的关系计算包括在检测到的加速度αG中的重力加速度分量gf。但是,通过利用表达式(2)所示的关系,上述重力加速度分量gf可通过高度变化量Dh抵消。因此,不论上述重力加速度分量gf如何,都可以通过表达式(7)十分准确地计算速度V。
(1-2-4)零重力偏移的计算
顺便说一下,在加速度传感器11(图1)中,当在车辆100停止在水平面HZ(图2)上加速度不作用在车辆100的前进方向上时,如图3A所示,从上述加速度传感器11输出的加速度检测信号SA的电势,即零重力偏移值Vzgo,变为2.5V。
但是,在加速度传感器11中,作为其特性,由于周围温度变化之类的影响,零重力偏移值Vzgo有时从2.5V变到2.6V或2.7V之类的(由图3A中的虚线示出)。
此时,在速度检测单元2中,虽然零重力偏移值Vzgo偏离2.5V变化,如图3B所示,但当其在运算处理块10中被从加速度检测信号SA转换到检测到的加速度αG时,转换后参考电势Vsc被设置为变动前的零重力偏移值Vzgo(即2.5V),因此它被转换成错误的检测到的加速度αG。从而,通过上述表达式(7)计算出的速度V也变成错误值。
因此,希望在检测到变动之后的上述零重力偏移值Vzgo时,通过基于零重力偏移值Vzgo更新转换后参考电势Vsc,速度检测单元2将来自加速度传感器11的加速度检测信号SA转换成正确的检测到的加速度αG,。
在这里,对于用来转换输出自加速度传感器11的加速度检测信号SA的实际的检测到的加速度αG(以下将其称为真实的检测到的加速度αGr),满足以下表达式的关系,该表达式使用应当被加速度传感器11首先检测到的检测到的加速度αG(以下将其称为要检测的加速度αGi)和与零重力偏移值Vzgo的变动相对应的加速度(以下将其称为偏移加速度αo)。
αGr=αGi+αo...(11)
通过变换此式,获得以下表达式。
αo=αGr-αGi...(12)
即,可以得知,偏移加速度αo可以按真实的检测到的加速度αGr和要检测的加速度αGi之间的差来计算。
在这里,对于要检测的加速度αGi,可以应用上述表达式(1)中的关系。从而,可以用以下表达式取代表达式(12):
αo=αGr-(αP+gf)...(13)
此外,通过变换上述表达式(2)可以获得以下表达式:
gf = Dh Dm · g - - - ( 14 )
在这里,在速度检测单元2中,如表达式(8)所示,可以基于从压力传感器12(图1)获得的压力PR计算高度变化量Dh。对于测量时间mt中的距离Dm和车辆加速度αP,如上所述,在GPS天线6(图1)能够接收到GPS信号的情况下,上述距离Dm是在距离计算部分13中基于位置信息PS获得的。此外,上述车辆加速度αP可以用此来计算。
即,在GPS天线6能够接收到GPS信号的情况下,速度检测单元2可以通过将真实的检测到的加速度αGr、车辆加速度αP、高度变化量Dh、距离Dm和重力加速度g代入到以下表达式中来计算偏移加速度αo,以下表达式是通过将表达式(14)应用到上述表达式(13)而获得的。
αo = αGr - ( αP + Dh Dm · g ) - - - ( 15 )
此时,速度检测单元2可以通过转换偏移加速度αo来获得最新的零重力偏移值Vzgo。此外,通过将存储在存储器部分18(图1)中的转换后参考电势Vsc更新到与上述零重力偏移值Vzgo相同的值,来自加速度传感器11的加速度检测信号SA可在运算处理块10中被转换成考虑到了零重力偏移值Vzgo的变动的正确的检测到的加速度αG。
就此而言,在GPS天线6能够接收到GPS信号,并且能够从GPS处理部分4获得位置信息PS的情况下,速度检测单元2不时根据表达式(15)计算偏移加速度αo,不时更新转换后参考电势Vsc。在无法接收到上述GPS信号的情况下,速度检测单元2利用基于最新的转换后参考电势Vsc的正确的检测到的加速度αG,即考虑到了零重力偏移值Vzgo的变动的正确的检测到的加速度αG,来根据表达式(7)计算速度V。
(1-3)速度输出处理
接下来,将参考图4的流程图描述当速度检测单元2计算车辆100的速度V并将其输出到导航单元3时的速度输出处理过程。
如果导航系统1的电源被接通,则速度检测单元2的运算处理块10开始速度输出处理过程RT1,并进行到步骤SP1。在步骤SP1,运算处理块10通过车辆停止确定部分15计算为过去的15秒计算的速度V的变动Vvar,以确定车辆100是否处于停止状态,并进行到下一步骤SP2。
在步骤SP2,运算处理块10确定在步骤SP1中通过车辆停止确定部分15计算的速度V的变动Vvar是否处于预定的阈值内。如果在这里获得肯定结果,则意味着由于变动Vvar比较小,因此车辆100处于停止状态的概率非常高。此时,运算处理块10进行到下一步骤SP3。
在步骤SP3,运算处理块10将存储在存储器部分18中的刚才的速度V0校正为零,并进行到下一步骤SP4。
另一方面,如果在步骤SP2中获得否定结果,则意味着由于速度V的变动Vvar在一定程度上较大,因此车辆100处于行驶状态的概率较高。此时,运算处理块10进行到下一步骤SP4,而不特别校正刚才的速度V0。
在步骤SP4,运算处理块10确定是否从GPS处理部分4获得位置信息PS。如果在这里获得肯定结果,这意味着可以基于可从GPS处理部分4获得的位置信息PS计算车辆100的速度。此时,运算处理块10进行到下一子例程SRT1。
在子例程SRT1,运算处理块10通过偏移计算部分17根据上述表达式(15)计算偏移加速度αo,并更新转换后参考电势Vsc(后面将描述其细节),并进行到下一步骤SP5。
就此而言,在子例程SRT1中的用于计算偏移加速度αo的过程中,运算处理块10基于位置信息PS计算当前速度V。
另一方面,如果在步骤SP4中获得否定结果,则这意味着由于无法从GPS处理部分4获得位置信息PS,因而有必要在不使用位置信息PS的情况下计算速度V。此时,运算处理块10进行到下一子例程SRT2。
在子例程SRT2,运算处理块10根据上述表达式(7)通过速度计算部分16计算当前速度V(速度V1)(后面将描述其细节),并进行到下一步骤SP6。
在步骤SP6,运算处理块10将速度V发送到导航单元3,并进行到下一步骤SP6。
在步骤SP6,运算处理块10等待,直到测量时间mt过去,然后再次返回步骤SP1以重复一系列处理。
(1-3-1)偏移加速度计算处理
接下来,将参考图5的流程图描述当运算处理块10通过偏移计算部分17计算偏移加速度αo时的偏移加速度计算处理。注意,在这里,当前时间被假定为时间t1,在上述时间t1之前距离测量时间mt处的时间被假定为时间t0。
运算处理块10响应于来自速度输出处理过程RT1(图4)的调用开始图5所示的偏移加速度计算子例程SRT1,并进行到步骤SP11。在步骤SP11,运算处理块10从加速度传感器11获取当前时间t1处的检测到的加速度αG,从压力传感器12获取压力PR1,并且还从GPS处理部分4获取位置信息PS1,并进行到下一步骤SP12。
在步骤SP12,运算处理块10读取已被预先存储在存储器部分18中的时间t0处的检测到的加速度αG、压力PR0和位置信息PS0,并进行到下一步骤SP13。
在步骤SP13,运算处理块10利用存储在存储器部分18中的压力/高度对应表TBL读取与压力PR0和PR1相对应的高度h0和h1,并根据表达式(8)计算高度变化量Dh,然后进行到接下来的高度变化量校正子例程SRT3(图6)。
运算处理块10进行到步骤SP51以确定高度变化量Dh是否满足表达式(9),即,高度变化量Dh是否受到非高度因素的影响。如果在这里获得肯定的结果,则意味着高度变化量Dh未受非高度因素的影响的概率较高,因而不必要对上述高度变化量Dh进行校正。此时,运算处理块10进行到步骤SP54以结束子例程SRT3,并返回到前一子例程SRT1(图5)。
另一方面,如果在步骤SP51中获得否定结果,则意味着高度变化量Dh受到非高度因素的影响的概率较高,因而应当对上述高度变化量Dh执行校正。此时,运算处理块10进行到下一步骤SP52。
在步骤SP52,运算处理块10根据表达式(10)计算校正后高度变化量Dhc,进行到下一步骤SP53以将上述校正后高度变化量Dhc设置为新的高度变化量Dh,并且进行到下一步骤SP54。
在步骤SP54,运算处理块10完成例程RT3,返回前一子例程SRT1(图5),并且进行到步骤SP14。
在步骤SP14,运算处理块10通过距离计算部分13基于位置信息PS0和PS1计算在测量时间mt中车辆100移动的距离Dm,并且还基于上述距离Dm计算速度V,然后计算车辆加速度αP,并且进行到下一步骤SP15。
在步骤SP15,运算处理块10利用真实的检测到的加速度αGr(在这种情况下是检测到的加速度αG0)、车辆加速度αP、高度变化量Dh、距离Dm和重力加速度g,根据表达式(15)计算偏移加速度αo,并且进行到下一步骤SP16。
在步骤SP16,运算处理块10通过将偏移加速度αo转换为电势来计算零重力偏移值Vzgo,并且将存储在存储器部分18中的转换后参考电势Vsc更新到与上述零重力偏移值Vzgo相同的值,并且进行到下一步骤SP17。
在步骤SP17,运算处理块10将当前时间t1处的检测到的加速度αG1、压力PR1和位置信息PS1存储在存储器部分18中,直到下一次计算偏移加速度αo,进行到下一步骤SP18以结束此偏移加速度计算子例程SRT1,并且返回前面的速度输出处理过程RT1(图4)。
(1-3-2)速度计算处理
接下来,将参考图7的流程图描述在无法从GPS处理部分4获得位置信息PS时,运算处理块10通过速度计算部分16计算速度V时的速度计算处理。注意,在这里,当前时间被假定为时间t1,在上述时间t1之前距离测量时间mt处的时间被假定为时间t0。
运算处理块10响应于来自速度输出处理过程RT1(图4)的调用开始图7所示的速度计算子例程SRT2,并进行到步骤SP21。在步骤SP21,运算处理块10从加速度传感器11获取当前时间t1处的检测到的加速度αG,并且还从压力传感器12获取压力PR1,并进行到下一步骤SP22。
在步骤SP22,运算处理块10读取已被预先存储在存储器部分18中的时间t0处的检测到的加速度αG、压力PR0和速度V0,并进行到下一步骤SP23。
在步骤SP23,与偏移加速度计算子例程SRT1(图4)中的步骤SP13类似,运算处理块10利用存储在存储器部分18中的压力/高度对应表TBL读取与压力PR0和PR1相对应的高度h0和h1,并根据表达式(8)计算高度变化量Dh,然后进行到子例程SRT3(图6)。
在子例程SRT3中,与子例程SRT1的情况类似,运算处理块10利用表达式(9)确定高度变化量Dh是否受到非高度因素的影响。如果受影响,则运算处理块10根据表达式(10)计算校正后高度变化量Dhc,将此设置为新的高度变化量Dh以便校正上述高度变化量Dh,然后返回前一子例程SRT2(图7),并进行到下一步骤SP24。
在步骤SP24,运算处理块10利用检测到的加速度αG0、时间t0处的速度V0、高度变化量Dh、测量时间mt和重力加速度g,根据表达式(7)计算当前时间t1处的速度V1,并且进行到下一步骤SP25。
在步骤SP25,运算处理块10将当前时间t1的检测到的加速度αG1、压力PR1和速度V1存储在存储器部分18中,直到下一次计算速度V,进行到下一步骤SP26以结束此速度计算子例程SRT2,并且返回前面的速度输出处理过程RT1(图4)。
(1-4)运算和效果
根据上述配置,当能够从GPS天线6接收到位置信息PS时,速度检测单元2通过将真实的检测到的加速度αGr、车辆加速度αP、高度变化量Dh、距离Dm和重力加速度g代入表达式(15)中来计算偏移加速度αo。
因此,在能够从GPS处理部分4获得位置信息PS的情况下,速度检测单元2可以通过用从加速度传感器11实际获得的真实的检测到的加速度αGr、基于位置信息PS的车辆加速度αP、距离Dm、基于压力PR的高度变化量Dh和重力加速度g来准确地计算偏移加速度αo。
在这种情况下,速度检测单元2无法直接获得待检测加速度αGi的值。但是,速度检测单元2可以基于从加速度传感器11实际获得的真实的检测到的加速度αGr与基于车辆加速度αP(其基于上述位置信息PS)、高度变化量Dh、距离Dm和重力加速度g(即表达式(15)的()中的项)获得的待检测加速度αGi之间的差异,根据表达式(15)来准确地计算偏移加速度αo。
尤其,由于高度变化量Dh是基于压力PR计算的,因此不必预先通过地图信息之类的获得上述高度变化量Dh。因此,不论是否存在高度数据,速度检测单元2都可以计算待检测加速度αGi。从而,可以计算偏移加速度αo。
此外,由于速度检测单元2可以用预先存储在存储器部分18中的压力/高度对应表TBL将压力PR转换成高度h,因此与根据使用上述压力PR的预定运算处理计算上述高度h的情况相比,可以减少运算处理量。
此外,如果通过使用表达式(9)的确定认为高度变化量Dh受到非高度因素的影响,则速度检测单元2根据表达式(10)计算校正后高度变化量Dhc。从而,速度检测单元2可以将只通过表达式(8)计算出的很可能由于非高度因素而在很大程度上是错误的值的高度变化量Dh校正为校正后高度变化量Dhc,此值事实上是次优值。因此,可以减小上述高度变化量Dh和利用上述高度变化量Dh计算出的速度V的值的错误范围。
此外,速度检测单元2可以在车辆行驶时计算偏移加速度αo。因此,在传统技术中所必需的在静态状态下水平处检测偏移加速度αo的麻烦变得不必要了,因而可以极大地放松上述偏移加速度αo的计算条件。
从而,速度检测单元2可以通过转换上述偏移加速度αo获得最新的零重力偏移值Vzgo。从而,可以基于上述零重力偏移值Vzgo将加速度检测信号SA准确地转换成检测到的加速度αG,而不受加速度传感器11的温度特性的影响。
此外,速度检测单元2可以在每个测量时间mt中计算偏移加速度αo。从而,可以不时地更新由于导航系统1的随时间变化的温度而随时可能变化的偏移加速度αo,因此它几乎始终可被转换成准确的检测到的加速度αG。
根据上述配置,在能够从GPS处理部分4获得位置信息PS的情况下,速度检测单元2可以通过利用从加速度传感器11实际获得的真实的检测到的加速度αGr、基于位置信息PS的车辆加速度αP、距离Dm、基于压力PR的高度变化量Dh和重力加速度g,根据表达式(15)准确地计算偏移加速度αo。从而,速度检测单元2可以基于用来转换上述偏移加速度αo的零重力偏移值Vzgo将加速度检测信号SA准确地校正到检测到的加速度αG。
(2)第二实施例
(2-1)导航系统的配置
如图8所示(其中相同的标号被添加到图1的相应部件),第二实施例中的导航系统20具有与导航系统1(图1)类似的配置,只不过提供了速度检测单元21来取代速度检测单元2。
速度检测单元21具有取代速度检测单元2(图1)中的运算处理块10的运算处理块22。在运算处理块22中,除了运算处理块10的配置之外,还提供了用于执行对提供自偏航率传感器19的角速度ф的校正处理的角速度校正部分23。
如与图2A相对应的图9A所示,假定车辆100在前进方向FW上行驶在具有相对于水平面HZ的斜坡角θ的斜坡SL上。
在这里,如图9B所示,偏航率传感器19检测到的角速度ф代表上述车辆100在斜坡SL上的旋转角速度,该旋转角速度以垂直偏航旋转轴YA为中心。
在这种情况下,由于车辆100行驶在斜坡SL上,因此偏航率传感器19检测到的角速度ф是通过用cosθ乘以车辆100的实际旋转角速度而获得的值。
于是,作为预先准备,运算处理块22的角速度校正部分23(图8)通过用根据表达式(8)计算出的高度变化量Dh和基于根据表达式(7)计算的速度V而获得的移动距离Dm,利用图2C所示的以下表达式的关系,计算sinθ。
Dh=Dm·sinθ...(16)
角速度校正部分23通过以下的基于三角函数的一般特性的表达式用它来计算cosθ。
cos θ = 1 - sin 2 θ - - - ( 17 )
接下来,通过用此cosθ,角速度校正部分23通过以下表达式计算如图9B所示的校正后角速度фc,并将其与基于表达式(7)计算出的速度V一起发送到导航单元3。
φc = φ cos θ - - - ( 18 )
据此,在GPS天线6无法接收到GPS信号,并且无法从GPS处理部分4获得位置信息PS的情况下,导航单元3执行所谓的航位推测(deadreckoning)(航位推测导航),所述航位推测基于GPS信号速度V和校正后角速度фc从刚才车辆100的位置计算车辆100的当前估计位置。
此时,即使车辆100行驶在斜坡SL上并且偏航率传感器19所检测到的角速度ф不同于上述车辆100的正确角速度,导航单元3也可以通过用根据上述斜坡SL的斜坡角θ校正的校正后角速度фc而不是上述角速度ф来十分准确地计算上述车辆100的估计位置。
从而,即使无法识别基于位置信息PS的准确当前位置,导航系统1也可以基于GPS信号速度V和校正后角速度фc将十分准确的估计位置显示在显示屏幕的地图上;用户可以看到车辆100的估计位置。
(2-2)位置输出处理过程
接下来,将参考图10的流程图描述当速度检测单元21计算车辆100的速度V并将其发送到导航单元3时的速度输出处理过程,在图10中,相同的标号被添加到图4中的相应部件。
如果导航系统20的电源被接通,则速度检测单元21的运算处理块22开始速度输出处理过程RT2,并进行到步骤SP1。注意,由于在此速度输出处理过程RT2中,步骤SP1、SP2、SP3、SP4、子例程SRT1、SRT2和SR3与速度输出处理过程RT1(图4)的情况类似,因此省略对它们的描述。
在完成子例程SRT2之后,运算处理块22进行到下一步骤SP31。在步骤SP31,运算处理块22利用根据表达式(8)计算出的高度变化量Dh和基于根据表达式(7)计算出的速度V而获得的移动距离Dm,根据表达式(16)计算sinθ,根据表达式(17)基于此计算cosθ,并且进行到下一步骤SP32。
在步骤SP32,运算处理块22根据表达式(18)计算用来校正角速度ф的校正后角速度фc,并进行到下一步骤SP33。
另一方面,如果运算处理块22结束了子例程SRT1,则它进行到下一步骤SP33。
在步骤SP33,运算处理块22将速度V和校正后角速度фc发送到导航单元3,并进行到下一步骤SP6。
在运算处理块10在步骤SP6中等待直到测量时间mt过去之后,与速度输出处理过程RT1(图4)的情况类似,它再次返回步骤SP1,以重复一系列处理。
(2-3)运算和效果
根据上述配置,与第一实施例中的速度检测单元2类似,当能够通过GPS天线6接收到GPS信号时,速度检测单元21通过将真实的检测到的加速度αGr、车辆加速度αP、高度变化量Dh、距离Dm和重力加速度g代入表达式(15)中来计算偏移加速度αo。
因此,与速度检测单元2类似,在能够从GPS处理部分4获得位置信息PS的情况下,速度检测单元21可以通过用从加速度传感器11实际获得的真实的检测到的加速度αGr、基于位置信息PS的车辆加速度αP、距离Dm、基于压力PR的高度变化量Dh和重力加速度g来准确地计算偏移加速度αo。
此外,在速度检测单元21中,在无法从GPS处理部分4获得位置信息PS的情况下,在不受斜坡角θ影响的情况下根据表达式(7)计算速度V,并且还根据斜坡角θ,根据表达式(18)将角速度ф校正到校正后角速度фc。从而,可以去除由上述斜坡角θ引起的误差。
此时,速度检测单元21可以不时更新偏移加速度αo。因此,即使当车辆100行驶时由于它突然进入隧道或突然隐藏在建筑物阴影中之类的原因而无法从GPS处理部分4获得位置信息PS,也可以用基于最新的偏移加速度αo计算出的速度V和校正后角速度фc来实现准确的航位推测(航位推测导航)。
根据上述配置,与速度检测单元2类似,在能够从GPS处理部分4获得位置信息PS的情况下,速度检测单元21可以通过利用从加速度传感器11实际获得的真实的检测到的加速度αGr、基于位置信息PS的车辆加速度αP、距离Dm、基于压力PR的高度变化量Dh和重力加速度g,根据表达式(15)准确地计算偏移加速度αo。从而,可以基于用来转换上述偏移加速度αo的零重力偏移值Vzgo将加速度检测信号SA准确地转换为检测到的加速度αG。
(3)其他实施例
在上述实施例中,涉及基于提供自GPS处理部分4的位置信息PS计算车辆加速度αP的情况。但是,本发明并不局限于此,而是,例如,可以从车辆100获得作为具有与速度相对应的周期的脉冲信号的车辆速度脉冲信号,并且可以基于此计算上述车辆加速度αP。
在上述实施例中,涉及了基于速度V的变动Vvar确定车辆100的停止状态的情况。但是,本发明并不局限于此,而是,例如,可以计算角速度ф的变动фvar,并且可以基于上述变动фvar确定上述车辆100的停止状态。
此外,在上述实施例中,涉及了在偏移加速度计算子例程SRT1(图5)的步骤SP15中,利用时间t0处的检测到的加速度αG0计算偏移加速度αo的情况。但是,本发明并不局限于此,而是,例如,可以通过用时间t1处的检测到的加速度αG1,或者通过用检测到的加速度αG0和检测到的加速度αG1的平均值,等等,来计算上述偏移加速度αo。
此外,在上述实施例中,涉及了基于周围压力PR的变化量计算高度变化量Dh的情况。但是,本发明并不局限于此,而是,例如,可以提供用于检测垂直方向上的加速度的垂直加速度传感器,并且可以将上述垂直加速度传感器的检测值转换成高度变化量。
此外,在上述实施例中,涉及了根据预先存储在存储器部分18中的压力/高度对应表TBL从压力PR转换到高度h的情况。但是,本发明并不局限于此,而是也可以基于压力PR根据以下表达式来计算高度h。
h = 153.8 × ( t z + 273.2 ) × ( 1 - ( PR PR z ) 0.1902 ) - - - ( 19 )
在这里,tz代表高度h=0m处的温度,PRz代表高度h=0m处的压力。
从而,虽然运算处理量增大了,但是高度h的计算准确度可以得到提高。
此外,在这种情况下,如图示出表达式(19)的图11所示,在高度比较低的部分AR,特性曲线Q可被近似为近似线AL。因此,在已知车辆100的当前位置处的高度比较低的情况下,可以根据以下代表近似线AL的表达式来近似计算高度变化量Dh。
Dh=-8.73×(PR1-PR0)...(20)
从而,与执行表达式(19)的运算的情况相比,运算处理块10和22中的运算处理可以得以简化。
此外,在上述实施例中,涉及了当确定不满足表达式(9)并且高度变化量Dh受非高度因素影响时通过表达式(10)计算的校正后高度变化量Dhc被设置为新的高度变化量Dh的情况。但是,本发明并不局限于此,而是可以通过其他技术计算新的高度变化量Dh,例如将最近的高度变化量Dh按其本来的样子设置为新的高度变化量Dh的技术,或者基于倒数第二近的高度变化量Dh和最近的高度变化量Dh计算此时的高度变化量Dh的预测值并将此设置为新的高度变化量Dh的技术。
此外,在上述实施例中,涉及了利用最大斜坡角θmax通过表达式(9)确定通过表达式(8)计算的高度变化量Dh是否受非高度因素影响的情况。但是,本发明并不局限于此,而是例如可以规定最大高度变化量Dhmax作为高度变化量Dh可以取的最大值,并且可以基于高度变化量Dh的绝对值和最大高度变化量Dhmax之间的比较结果来确定高度变化量Dh是否受非高度因素的影响。
在这里,如果确定高度变化量Dh受到非高度因素的影响,则通过将最大高度变化量Dhmax设置为新的高度变化量Dh来执行下面的处理,将会是有益的。
此外,可以规定斜坡变化率λ作为每单位时间斜坡角θ的变化量,并且可以利用上述斜坡变化率λ来确定高度变化量Dh是否受非高度因素的影响。
例如,作为车辆100正常行驶时斜坡变化率λ可以取的最大值,最大斜坡变化率λ被预先设置。速度检测单元2可以通过利用紧挨t0之前的时间的高度变化量Dh和距离Dm,根据从图2C所示的关系获得的以下表达式计算刚才的斜坡角θ0。
θ = sin - 1 ( Dh Dm ) - - - ( 21 )
并且速度检测单元2可以基于是否满足以下表达式来确定高度变化量Dh是否受到非高度因素的影响。
Dh>V0·sin(-λmax+θ)...(22a)
Dh<V0·sin(λmax+θ)...(22b)
在这里,如果不满足表达式(22a)和(22b),并且确定高度变化量
Dh受到非高度因素的影响,则根据以下表达式计算校正后高度变化量Dhc2并将此设置为高度变化量Dh将会是有益的。
Dhc 2 = V 0 · sin ( λ max + θ ) · | Dh | Dh - - - ( 23 )
此外,可以用在垂直方向施加到车辆100的加速度分量(所谓的垂直G,以下将其称为垂直加速度av)确定高度变化量Dh是否受到非高度因素的影响。
根据一般物理原理,在垂直加速度av和斜坡变化率λ之间满足以下表达式的关系。
λ = αv V 0 - - - ( 24 )
然后,最大垂直加速度avmax可被预先设置为车辆100正常行驶时垂直加速度aV可以取的最大值,并且在速度检测单元2中,可以基于是否满足以下的通过将表达式(24)应用到表达式(22)而获得的表达式来确定高度变化量Dh是否受非高度因素的影响。
Dh > V 0 · sin ( - av max V 0 + θ ) - - - ( 25 a )
Dh < V 0 &CenterDot; sin ( av max V 0 + &theta; ) - - - ( 25 b )
在这里,如果不满足表达式(25a)和(25b)并且确定高度变化量Dh受到非高度因素的影响,则根据以下表达式计算校正后高度变化量Dhc3并将其设置为新的高度变化量Dh将会是有益的。
Dhc 3 = V 0 &CenterDot; sin ( av max V 0 + &theta; ) &CenterDot; | Dh | Dh - - - ( 26 )
此外,在上述实施例中,涉及了由GPS处理部分4基于GPS天线6接收到的GPS信号生成位置信息PS的情况。但是,本发明并不局限于此,而是也可以使用诸如准天顶卫星系统(QZSS)、全球导航卫星系统(GLONASS)和Galileo之类的各种卫星定位系统,接收它们各自的定位信号并执行定位处理,来生成位置信息PS。
此外,在上述实施例中,涉及了本发明被应用到安装在车辆100中的导航系统1和20的情况。但是,本发明并不局限于此,而是可以应用到在不使用车辆速度脉冲信号或与之类似的信号的情况下实现导航功能的各种电子设备,例如便携式导航系统、具有GPS接收功能的PDA、蜂窝电话和个人计算机。在这种情况下,上述电子设备并不局限于车辆100,而是可以安装在船只和飞行器等中,或者它可以单独使用。
此外,在上述实施例中,涉及了充当加速度传感器的偏移检测系统的速度检测单元2和21具有充当加速度传感器的加速度传感器11、充当待检测加速度计算装置的操作处理块10和充当偏移计算装置的偏移计算部分17的情况。但是,本发明并不局限于此,加速度传感器的偏移检测系统也可以包括具有除此之外的各种电路配置的加速度传感器、待检测加速度计算部分和偏移计算部分。
注意,根据本发明的实施例也可以用于具有加速度传感器的各种导航系统中。
根据本发明的实施例,可以实现一种加速度传感器的偏移检测系统、一种加速度传感器的偏移检测方法和一种加速度传感器的偏移检测程序,其中,可以仅基于真实的检测到的加速度和待检测加速度之间的差异来计算偏移变动,并且可以获得其中反映了上述偏移变动的准确的真实的检测到的加速度αGr,从而可以十分准确地检测到加速度传感器中的零重力偏移。
此外,根据本发明的实施例,可以实现一种导航系统,其中,可以仅基于真实的检测到的加速度和待检测加速度之间的差异计算偏移变动,并且可以通过反映上述偏移变动显示关于移动体的位置的准确信息。
虽然已经结合本发明的优选实施例描述了本发明,但是对于本领域的技术人员来说显而易见的是,可以进行所附权利要求中所覆盖的各种变化、修改、组合、子组合和更改,并且所有这种变化和修改都处于本发明的真正精神和范围之内。
本发明包含与分别于2005年9月6日和2006年7月26日向日本专利局递交的日本专利申请JP2005-258169和2006-203555相关的主题,这里通过引用将这些申请的全部内容包含进来。

Claims (18)

1.一种加速度传感器的偏移检测系统,包括:
加速度传感器,用于获得真实的检测到的加速度,所述真实的检测到的加速度与偏移变动与预定移动体中前进方向上的加速度相加的结果相对应;
待检测加速度计算装置,用于计算所述加速度传感器本应正确检测到的待检测加速度;以及
偏移计算装置,用于基于所述真实的检测到的加速度和所述待检测加速度之间的差异,计算所述偏移变动,所述偏移变动是由于所述加速度传感器的特性而引起的所述真实的检测到的加速度偏离所述待检测加速度的变化。
2.根据权利要求1所述的加速度传感器的偏移检测系统,其中:
所述待检测加速度计算装置通过分别计算示出所述移动体本身的加速度的移动体加速度和作用在所述移动体上的重力加速度的所述前进方向的分量并把它们相加,来计算所述待检测加速度。
3.根据权利要求2所述的加速度传感器的偏移检测系统,包括:
压力传感器,用于检测压力;以及
移动距离计算装置,用于计算预定的测量时间中所述移动体的移动距离;
其中所述待检测加速度计算装置基于所述压力传感器检测到的压力计算在所述测量时间中所述移动体的高度变化量,并且使用所述移动距离与所述高度变化量之比以及重力加速度常数计算所述重力加速度的所述前进方向的分量。
4.根据权利要求3所述的加速度传感器的偏移检测系统,其中:
当所述高度变化量不处于预定的高度变化范围内时,所述待检测加速度计算装置将所述高度变化量校正到处于所述高度变化范围内。
5.根据权利要求3所述的加速度传感器的偏移检测系统,其中:
所述待检测加速度计算装置基于最大斜坡角确定所述高度变化量是否处于所述高度变化范围内,所述最大斜坡角是从所述高度变化量获得的斜坡角的最大值。
6.根据权利要求3所述的加速度传感器的偏移检测系统,其中:
所述待检测加速度计算装置基于最大斜坡变化率确定所述高度变化量是否处于所述高度变化范围内,所述最大斜坡变化率是从所述高度变化量获得的斜坡角的每单位时间斜坡变化率的最大值。
7.根据权利要求2所述的加速度传感器的偏移检测系统,其中:
所述移动距离计算装置使用由预定的卫星定位信号接收和定位装置所获得的位置信息或速度信息来计算所述移动距离。
8.一种加速度传感器的偏移检测方法,包括以下步骤:
通过加速度传感器获得真实的检测到的加速度,所述真实的检测到的加速度与偏移变动与预定移动体中前进方向上的加速度相加的结果相对应;
计算所述加速度传感器本应正确检测到的待检测加速度;以及
基于所述真实的检测到的加速度和所述待检测加速度之间的差异,计算所述偏移变动,所述偏移变动是由于所述加速度传感器的特性而引起的所述真实的检测到的加速度偏离所述待检测加速度的变化。
9.一种加速度传感器的偏移检测程序,用于使加速度传感器的偏移检测系统执行以下步骤:
通过加速度传感器获得真实的检测到的加速度,所述真实的检测到的加速度与偏移变动与预定移动体中前进方向上的加速度相加的结果相对应;
计算所述加速度传感器本应正确检测到的待检测加速度;以及
基于所述真实的检测到的加速度和所述待检测加速度之间的差异,计算所述偏移变动,所述偏移变动是由于所述加速度传感器的特性而引起的所述真实的检测到的加速度偏离所述待检测加速度的变化。
10.一种导航系统,包括:
当前位置计算装置,用于接收来自预定的卫星定位系统的定位信号,并且计算预定移动体的当前位置;
加速度传感器,用于获得真实的检测到的加速度,所述真实的检测到的加速度与偏移变动与预定移动体中前进方向上的加速度相加的结果相对应;
待检测加速度计算装置,用于计算所述加速度传感器本应正确检测到的待检测加速度;
偏移计算装置,用于基于所述真实的检测到的加速度和所述待检测加速度之间的差异,计算所述偏移变动,所述偏移变动是由于所述加速度传感器的特性而引起的所述真实的检测到的加速度偏离所述待检测加速度的变化;以及
信息显示装置,用于用由所述偏移计算装置计算出的所述偏移变动计算所述加速度,并且基于用所述加速度计算出的所述移动体的速度显示关于所述移动体的位置的信息。
11.一种加速度传感器的偏移检测系统,包括:
加速度传感器,用于获得真实的检测到的加速度,所述真实的检测到的加速度与偏移变动与预定移动体中前进方向上的加速度相加的结果相对应;
待检测加速度计算部分,用于计算所述加速度传感器本应正确检测到的待检测加速度;以及
偏移计算部分,用于基于所述真实的检测到的加速度和所述待检测加速度之间的差异,计算所述偏移变动,所述偏移变动是由于所述加速度传感器的特性而引起的所述真实的检测到的加速度偏离所述待检测加速度的变化。
12.根据权利要求11所述的加速度传感器的偏移检测系统,其中:
所述待检测加速度计算部分通过分别计算示出所述移动体本身的加速度的移动体加速度和作用在所述移动体上的重力加速度的所述前进方向的分量并把它们相加,来计算所述待检测加速度。
13.根据权利要求12所述的加速度传感器的偏移检测系统,包括:
压力传感器,用于检测压力;以及
移动距离计算部分,用于计算预定的测量时间中所述移动体的移动距离;
其中所述待检测加速度计算部分基于所述压力传感器检测到的压力计算在所述测量时间中所述移动体的高度变化量,并且使用所述移动距离与所述高度变化量之比以及重力加速度常数计算所述重力加速度的所述前进方向的分量。
14.根据权利要求13所述的加速度传感器的偏移检测系统,其中:
当所述高度变化量不处于预定的高度变化范围内时,所述待检测加速度计算部分将所述高度变化量校正到处于所述高度变化范围内。
15.根据权利要求13所述的加速度传感器的偏移检测系统,其中:
所述待检测加速度计算部分基于最大斜坡角确定所述高度变化量是否处于所述高度变化范围内,所述最大斜坡角是从所述高度变化量获得的斜坡角的最大值。
16.根据权利要求13所述的加速度传感器的偏移检测系统,其中:
所述待检测加速度计算部分基于最大斜坡变化率确定所述高度变化量是否处于所述高度变化范围内,所述最大斜坡变化率是从所述高度变化量获得的斜坡角的每单位时间斜坡变化率的最大值。
17.根据权利要求12所述的加速度传感器的偏移检测系统,其中:
所述移动距离计算部分使用由预定的卫星定位信号接收和定位部分所获得的位置信息或速度信息来计算所述移动距离。
18.一种加速度传感器的偏移检测系统,包括:
加速度传感器,用于获得真实的检测到的加速度,所述真实的检测到的加速度与偏移变动与预定移动体中前进方向上的加速度相加的结果相对应;
待检测加速度计算部分,用于计算所述加速度传感器本应正确检测到的待检测加速度;以及
偏移计算部分,用于基于所述真实的检测到的加速度和所述待检测加速度之间的差异,计算所述偏移变动,所述偏移变动是由于所述加速度传感器的特性而引起的所述真实的检测到的加速度偏离所述待检测加速度的变化。
CN2006101269504A 2005-09-06 2006-09-06 加速度传感器的偏移检测和导航系统 Expired - Fee Related CN1928568B (zh)

Applications Claiming Priority (6)

Application Number Priority Date Filing Date Title
JP2005258169 2005-09-06
JP2005258169 2005-09-06
JP2005-258169 2005-09-06
JP2006203555 2006-07-26
JP2006-203555 2006-07-26
JP2006203555A JP4816302B2 (ja) 2005-09-06 2006-07-26 加速度センサのオフセット検出装置、加速度センサのオフセット検出方法及び加速度センサのオフセット検出プログラム並びにナビゲーション装置

Publications (2)

Publication Number Publication Date
CN1928568A true CN1928568A (zh) 2007-03-14
CN1928568B CN1928568B (zh) 2010-08-25

Family

ID=37434785

Family Applications (1)

Application Number Title Priority Date Filing Date
CN2006101269504A Expired - Fee Related CN1928568B (zh) 2005-09-06 2006-09-06 加速度传感器的偏移检测和导航系统

Country Status (5)

Country Link
US (1) US7747383B2 (zh)
EP (1) EP1760475A3 (zh)
JP (1) JP4816302B2 (zh)
KR (1) KR20070027473A (zh)
CN (1) CN1928568B (zh)

Cited By (15)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101638096A (zh) * 2008-08-01 2010-02-03 株式会社电装 车载式装置
CN102083203A (zh) * 2009-11-27 2011-06-01 财团法人资讯工业策进会 用于一移动设备的定位装置及定位方法
CN101470130B (zh) * 2007-12-27 2012-07-04 三星电子株式会社 检测自由下落的方法以及利用该方法检测自由下落的装置
CN102770771A (zh) * 2010-02-10 2012-11-07 丰田自动车株式会社 加减速度检测系统
CN101910795B (zh) * 2007-11-09 2013-01-02 星克跃尔株式会社 用于判断车辆运行状态的装置和方法
CN102980576A (zh) * 2008-06-11 2013-03-20 天宝导航有限公司 倾斜计
US8527234B2 (en) 2009-11-24 2013-09-03 Institute For Information Industry Locating apparatus, locating method and computer program storage product thereof for a mobile device
WO2015081546A1 (zh) * 2013-12-05 2015-06-11 华为终端有限公司 一种确定车辆加速度的方法及装置
CN105225517A (zh) * 2015-10-28 2016-01-06 福建星海通信科技有限公司 一种车辆行驶路线预测方法
CN105774546A (zh) * 2016-05-19 2016-07-20 李洪金 一种车辆定位监控系统
CN106996989A (zh) * 2017-05-09 2017-08-01 北京克路德人工智能科技有限公司 一种机器人壳体碰撞检测方法
CN107054350A (zh) * 2016-02-04 2017-08-18 福特全球技术公司 车辆行驶方向的指示
CN109425753A (zh) * 2017-08-28 2019-03-05 奥的斯电梯公司 用于测量垂直速度的混合式高度计
CN109737953A (zh) * 2019-01-04 2019-05-10 四川虹美智能科技有限公司 一种基于加速度传感器的位移检测方法和装置
CN112526978A (zh) * 2020-12-09 2021-03-19 智道网联科技(北京)有限公司 车辆驾驶性能检测方法及系统、电子设备和存储介质

Families Citing this family (18)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP4556945B2 (ja) * 2006-12-07 2010-10-06 日産自動車株式会社 加速度検出装置および加速度センサのドリフト誤差補正方法ならびにそれを用いたニュートラル制御装置
KR20090001721A (ko) * 2007-05-14 2009-01-09 팅크웨어(주) 맵 매칭 보정 방법 및 상기 방법을 수행하는 내비게이션시스템
US7957897B2 (en) * 2007-06-29 2011-06-07 GM Global Technology Operations LLC GPS-based in-vehicle sensor calibration algorithm
US8108140B2 (en) * 2007-09-25 2012-01-31 Yamaha Corporation Navigation device
KR20090036325A (ko) 2007-10-09 2009-04-14 삼성전자주식회사 네비게이션 장치에서의 이동체의 이동 속도를 측정하는장치 및 방법
JP5057952B2 (ja) * 2007-12-06 2012-10-24 アルパイン株式会社 角速度補正装置及びその補正方法並びにナビゲーション装置
WO2011081467A2 (ko) * 2009-12-30 2011-07-07 (주)마이크로인피니티 차량 항법 시스템
JP2012144053A (ja) * 2011-01-06 2012-08-02 Denso Corp アクセル・ブレーキ踏み間違い判定装置
SE535594C2 (sv) * 2011-02-08 2012-10-09 Scania Cv Ab Anordning och förfarande för kalibrering av en accelerationssensor
JP5724676B2 (ja) * 2011-06-27 2015-05-27 富士通株式会社 携帯端末装置、速度算出方法及び速度算出プログラム
JP5821609B2 (ja) * 2011-12-20 2015-11-24 株式会社Jvcケンウッド 傾斜角算出装置及び傾斜角算出方法
US9121866B2 (en) * 2013-03-15 2015-09-01 Autoliv Asp, Inc. System and method for inertial sensor offset compensation
DE102014211177A1 (de) * 2014-06-11 2015-12-17 Continental Teves Ag & Co. Ohg Verfahren und System zur echtzeitfähigen Bereitstellung von dynamischen Fehlerwerten dynamischer Messwerte
CN104266645B (zh) * 2014-09-23 2017-01-25 东北大学 一种室内人员行为识别及位置跟踪系统及方法
JP6297663B1 (ja) * 2016-12-13 2018-03-20 京セラ株式会社 電子機器、補正制御方法、及び補正制御プログラム
US10496043B2 (en) * 2017-09-08 2019-12-03 Apple Inc. Pressure sensor occlusion mitigation systems and methods
DE112018007442B4 (de) * 2018-05-11 2021-10-14 Mitsubishi Electric Corporation Datensynchronisationsvorrichtung, datensynchronisationsverfahren und datensynchronisationsprogramm
US11281830B2 (en) * 2019-03-11 2022-03-22 Intel Corporation Method and apparatus for performing profile guided optimization for first in first out sizing

Family Cites Families (27)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0694253B2 (ja) * 1986-03-17 1994-11-24 トヨタ自動車株式会社 車輌用ロ−ル制御装置
JPS63177708U (zh) * 1987-05-06 1988-11-17
DE3924691C2 (de) * 1989-07-26 1993-11-04 Daimler Benz Ag Verfahren zur kompensation von fehlern eines beschleunigungsgebers
JPH0833408B2 (ja) * 1990-03-29 1996-03-29 株式会社日立製作所 角度検出装置と並進加速度検出装置並びに自動車制御装置
DE4328893B4 (de) * 1992-08-27 2007-07-05 Hitachi, Ltd. Verfahren und Einrichtung zur Steuerung eines Automatikgetriebes eines Fahrzeugs in Abhängigkeit von einem Gefälle einer Fahrbahn
JP2841028B2 (ja) * 1994-11-25 1998-12-24 ソニー株式会社 角速度検出装置
US6029111A (en) * 1995-12-28 2000-02-22 Magellan Dis, Inc. Vehicle navigation system and method using GPS velocities
JP3536535B2 (ja) * 1996-06-14 2004-06-14 松下電器産業株式会社 ナビゲーション装置
JPH1062194A (ja) * 1996-08-13 1998-03-06 Sony Corp 感度補正方法及びナビゲーシヨン装置並びに車両
US6308134B1 (en) * 1996-12-27 2001-10-23 Magellan Dis, Inc. Vehicle navigation system and method using multiple axes accelerometer
DE69824218T2 (de) * 1997-03-07 2005-06-23 Pioneer Electronic Corp. Navigationsvorrichtung
JP4085463B2 (ja) * 1998-04-10 2008-05-14 ソニー株式会社 速度計測方法および速度計測装置
DE19844540A1 (de) * 1998-09-29 2000-03-30 Bosch Gmbh Robert Anordnungen und Verfahren zur Vermeidung von Überschlägen bei Bremsvorgängen oder Beschleunigungsvorgängen für Kraftfahrzeuge
US6240367B1 (en) * 1998-11-27 2001-05-29 Ching-Fang Lin Full fusion positioning method for vehicle
JP2001108580A (ja) * 1999-10-13 2001-04-20 Horiba Ltd シャシダイナモメータを用いた路上走行シミュレーション試験方法で用いる路面の勾配データの採取方法およびシャシダイナモメータの制御方法
US6282496B1 (en) * 1999-10-29 2001-08-28 Visteon Technologies, Llc Method and apparatus for inertial guidance for an automobile navigation system
US6298287B1 (en) * 2000-07-24 2001-10-02 Litton Systems, Inc. System and method of compensating for pressure sensor errors and noise in inertial vertical loop data
JP2003307524A (ja) * 2002-04-15 2003-10-31 Pioneer Electronic Corp 加速度データの補正装置、その補正方法、その補正プログラム、その補正プログラムを記録した記録媒体、および、ナビゲーション装置
JP2004138553A (ja) * 2002-10-18 2004-05-13 Matsushita Electric Ind Co Ltd 移動体位置検出装置、移動体位置検出方法、プログラムおよび記録媒体
DE10254296B4 (de) * 2002-11-21 2021-01-28 Robert Bosch Gmbh Verfahren und Vorrichtung zur Ermittlung des Offsetwerts eines Längsbeschleunigungssensors
JP2004233306A (ja) 2003-01-31 2004-08-19 Japan Aviation Electronics Industry Ltd 加速度誤差演算装置並びに加速度計出力補正装置および加速度計出力補正方法
JP4126239B2 (ja) * 2003-02-04 2008-07-30 パイオニア株式会社 角速度検出装置
KR100575933B1 (ko) * 2003-12-01 2006-05-02 삼성전자주식회사 가속도계와 경로안내 데이터를 이용한 이동체의속력측정방법 및 그 장치
JP2005227026A (ja) * 2004-02-10 2005-08-25 Matsushita Electric Ind Co Ltd 角速度補正装置
JP2005258169A (ja) 2004-03-12 2005-09-22 Konica Minolta Medical & Graphic Inc 面積階調画像処理方法、面積階調画像形成装置及びプログラム
JP2006203555A (ja) 2005-01-20 2006-08-03 Seiko Epson Corp 画像処理方法、画像処理装置及び画像処理プログラム
JP2007101526A (ja) * 2005-09-06 2007-04-19 Sony Corp 速度検出装置、速度検出方法、速度検出プログラム、位置検出装置、位置検出方法及び位置検出プログラム並びにナビゲーション装置

Cited By (22)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101910795B (zh) * 2007-11-09 2013-01-02 星克跃尔株式会社 用于判断车辆运行状态的装置和方法
CN101470130B (zh) * 2007-12-27 2012-07-04 三星电子株式会社 检测自由下落的方法以及利用该方法检测自由下落的装置
CN102980576B (zh) * 2008-06-11 2015-12-16 天宝导航有限公司 倾斜计
CN102980576A (zh) * 2008-06-11 2013-03-20 天宝导航有限公司 倾斜计
CN102980575A (zh) * 2008-06-11 2013-03-20 天宝导航有限公司 倾斜计
CN102980575B (zh) * 2008-06-11 2015-09-02 天宝导航有限公司 倾斜计
CN101638096B (zh) * 2008-08-01 2013-05-29 株式会社电装 车载式装置
CN101638096A (zh) * 2008-08-01 2010-02-03 株式会社电装 车载式装置
US8527234B2 (en) 2009-11-24 2013-09-03 Institute For Information Industry Locating apparatus, locating method and computer program storage product thereof for a mobile device
CN102083203A (zh) * 2009-11-27 2011-06-01 财团法人资讯工业策进会 用于一移动设备的定位装置及定位方法
CN102770771A (zh) * 2010-02-10 2012-11-07 丰田自动车株式会社 加减速度检测系统
CN102770771B (zh) * 2010-02-10 2015-03-11 丰田自动车株式会社 加减速度检测系统
WO2015081546A1 (zh) * 2013-12-05 2015-06-11 华为终端有限公司 一种确定车辆加速度的方法及装置
US9817022B2 (en) 2013-12-05 2017-11-14 Huawei Device Co., Ltd. Method and apparatus for determining vehicle acceleration
CN105225517A (zh) * 2015-10-28 2016-01-06 福建星海通信科技有限公司 一种车辆行驶路线预测方法
CN107054350A (zh) * 2016-02-04 2017-08-18 福特全球技术公司 车辆行驶方向的指示
CN105774546A (zh) * 2016-05-19 2016-07-20 李洪金 一种车辆定位监控系统
CN106996989A (zh) * 2017-05-09 2017-08-01 北京克路德人工智能科技有限公司 一种机器人壳体碰撞检测方法
CN109425753A (zh) * 2017-08-28 2019-03-05 奥的斯电梯公司 用于测量垂直速度的混合式高度计
CN109425753B (zh) * 2017-08-28 2021-03-30 奥的斯电梯公司 用于测量垂直速度的混合式高度计
CN109737953A (zh) * 2019-01-04 2019-05-10 四川虹美智能科技有限公司 一种基于加速度传感器的位移检测方法和装置
CN112526978A (zh) * 2020-12-09 2021-03-19 智道网联科技(北京)有限公司 车辆驾驶性能检测方法及系统、电子设备和存储介质

Also Published As

Publication number Publication date
US20070067096A1 (en) 2007-03-22
EP1760475A2 (en) 2007-03-07
JP4816302B2 (ja) 2011-11-16
EP1760475A3 (en) 2013-08-07
CN1928568B (zh) 2010-08-25
JP2007101527A (ja) 2007-04-19
KR20070027473A (ko) 2007-03-09
US7747383B2 (en) 2010-06-29

Similar Documents

Publication Publication Date Title
CN1928568A (zh) 加速度传感器的偏移检测和导航系统
CN1928567A (zh) 速度检测、位置检测和导航系统
CN1296680C (zh) 测量装置和方法
CN1229956C (zh) 电子设备
CN1680780A (zh) 利用罗盘确定地磁场及由此确定方位角的方法和装置
CN101046387A (zh) 利用景象匹配提高导航系统精度的方法及组合导航仿真系统
TWI391631B (zh) 利用感測器調整顯示導航方向的方法及使用該方法之導航裝置
CN1815254A (zh) 定位系统、终端装置及终端装置的控制方法
CN1648605A (zh) 道路形状推断装置
US20130311085A1 (en) Satellite navigation/dead-reckoning navigation integrated positioning device
CN1677068A (zh) 具有多轴传感器的力传感器装置及其应力检测方法
US20090259424A1 (en) Parameter estimation for accelerometers, processes, circuits, devices and systems
CN1847789A (zh) 测量位置及姿态的方法和装置
CN1957227A (zh) 移动方位计算装置及方位校正方法
CN1349108A (zh) Gps测位系统及gps测位装置
CN106153001B (zh) 海拔高度计算系统及海拔高度计算方法
CN1957229A (zh) 移动方位计算装置及方位校正方法
CN1605833A (zh) 地图信息处理装置、地图修改信息存储媒体以及生成系统
CN1957228A (zh) 移动方位计算装置及方位校正方法
CN1715834A (zh) 用于测量地磁传感器磁偏的方法与装置以及便携电子装置
CN112504298B (zh) 一种gnss辅助的dvl误差标定方法
CN101029828A (zh) 定位装置及其控制方法、控制程序、计算机可读存储介质
CN101069065A (zh) 导航装置
CN102445700A (zh) Nmea信息的gps高度数据修正系统及方法
CN1957226A (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
C14 Grant of patent or utility model
GR01 Patent grant
CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20100825

Termination date: 20150906

EXPY Termination of patent right or utility model