CN101118248A - 角速度计算装置 - Google Patents
角速度计算装置 Download PDFInfo
- Publication number
- CN101118248A CN101118248A CNA2007101287263A CN200710128726A CN101118248A CN 101118248 A CN101118248 A CN 101118248A CN A2007101287263 A CNA2007101287263 A CN A2007101287263A CN 200710128726 A CN200710128726 A CN 200710128726A CN 101118248 A CN101118248 A CN 101118248A
- Authority
- CN
- China
- Prior art keywords
- angular velocity
- mentioned
- signal
- parking
- gyro
- 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
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C19/00—Gyroscopes; Turn-sensitive devices using vibrating masses; Turn-sensitive devices without moving masses; Measuring angular rate using gyroscopic effects
- G01C19/02—Rotary gyroscopes
- G01C19/42—Rotary gyroscopes for indicating rate of turn; for integrating rate of turn
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2520/00—Input parameters relating to overall vehicle dynamics
- B60W2520/14—Yaw
Landscapes
- Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Gyroscopes (AREA)
- Navigation (AREA)
Abstract
提供一种不会输出错误的偏移值的“角速度计算装置及其偏移量决定方法、以及车辆停车检测装置”。检测出停车时的陀螺的角速度信号的最小值和最大值,设定视为停车的角速度信号的范围(TH1~TH2),在陀螺的角速度信号超过该范围时判断为行驶开始,将与行驶开始时刻(tS)相比在设定时间(Ta)以内的偏移值(X标记)舍弃,将在设定时间(Ta)前计算并保存的平均角速度信号(ΩOFF)作为偏移值输出。即使在不具有车速传感器的情况下也能够根据陀螺的输出信号正确地检测停车、行驶开始、并且计算正确的偏移值。
Description
技术领域
本发明涉及角速度计算装置及其偏移量决定方法、以及车辆停车检测装置,特别涉及将停车中的陀螺的角速度信号平均化而计算偏移量、从行驶中的角速度信号将偏移值消除而输出角速度的角速度计算装置及其偏移量决定方法、以及车辆停车检测装置。
背景技术
有一种角速度计算装置,利用对应于从安装在车辆中的陀螺输出的角速度的信号,计算车辆的旋转角度。在该角速度计算装置中,如图12(a)所示,即使在车辆正在停车时从陀螺输出的信号也不为0,而包括偏移电压(Ωoff)。因此,即使停车旋转角度也不为零,而是如图12(b)所示那样增大。因此,提出了将停车中的陀螺的角速度信号平均来计算偏移值、从行驶中的角速度信号中将偏移值消除而输出角速度的角速度计算装置(专利文献1)。在该角速度计算装置中,在停车时需要正确地测量偏移值。另外,车辆是否处于停车中,通常是在车辆中安装每规定行驶距离发出脉冲的车速传感器、并根据该车速脉冲的发出间隔来检测。
但是,现有技术中,在停车时有不能正确地测量偏移值的情况。例如在打了方向盘的状态下开始行驶的情况。如果在打了方向盘的状态下开始行驶,则如图13(a)所示,到发出最初的车速脉冲P而检测到行驶开始为止,行驶了约40~80cm。在此期间,如图13(b)所示那样输出微小的角速度Ω,现有技术会根据该角速度将错误的偏移值作为零点取入。所以,提出了在停车时以规定时间间隔将陀螺输出信号平均而计算偏移值(参照黑点),在检测到车速行驶时,不使用紧挨着该时刻之前的偏移量A,而将比该时刻早规定时间Ta的偏移量B作为偏移量取入的方法(专利文献2)。根据该第2现有方法,能够得到精度较高的偏移值。
但是,第2现有技术有不能防止在车辆低速行驶时的错误偏移值的取入、以及在转台(turn table)旋转中的错误偏移值的取入的问题。
如果车辆以低速缓慢地旋转,则陀螺输出微小的角速度信号。但是,在使用低速度区域中有不灵敏区的车速传感器的车辆中,在1~2km/h的低速行驶时车速传感器不发出车速脉冲,所以角速度计算装置判断为停车中,利用该微小的角速度信号来计算偏移值。因此,角速度计算装置在车辆行驶时利用错误的偏移值进行本车方位的测量,所以不能进行正确的方位测量。例如,在行驶开始时,有如图14所示那样,速度暂时提高一些而发出车速脉冲后、低速行驶的情况。在这种情况下,在第2现有技术中不能进行正确的方位测量。
此外,在带转台的停车场中,如果如图15中所示那样转台平滑地旋转,则以一定的角速度稳定几秒钟,所以判断为停车状态而计算错误的偏移值,不能进行正确的方位测量。
此外,第2现有技术是使用车速传感器检测车辆的停车、行驶的方法,有不能应用到不具有车速传感器的车辆、或在低速区域中不发出车速脉冲的车辆的问题。在欧洲车中不能将车速脉冲物理地取出的车辆并不少。此外,能够取出车速脉冲的车辆也在ABS(防抱死制动系统)下使用的情况较多,存在如果在时速4~5km以下的低速区域中行驶,则不能检测车速脉冲的车辆。所以,考虑根据陀螺的输出信号的噪音水平检测车辆的停车、行驶(专利文献3)、来应用第2现有技术的方法。但是,第3现有技术有不能检测正确的车辆的停车、行驶、不能取得精度较高的偏移值的问题。以下说明其理由。
在停车时,作为叠加在陀螺输出信号中的噪音,有(1)陀螺单体噪音、(2)从车辆侧的发动机或变速器、车体的组合发出的噪音、(3)从导航装置发出的噪音。(1)的噪音如图14(a)、图14(b)所示,陀螺的个体差较大,此外,(2)的噪音根据车种类不同产生状况不同,根据齿轮是空档的状态还是驱动的状态而产生状况不同。根据以上,在第3现有技术中,如图15所示,对照噪音水平较大的个体及最差噪音状态,将视为停车中的偏差幅度、即停车范围TH1、TH2较大地设定。但是,在该停车范围设定方法中,不能检测正确的行驶开始,在行驶开始时的车辆的微小旋转中取入错误的偏移量A或B,结果在行驶中发生本车方位的测量误差,会发生在导航控制的地图匹配时进行错误匹配、或车辆标志从道路偏离的情况。另外,在偏移量误差为5mV时,相当于0.2[deg/s],所以在5分钟内成为0.2×5×60=60[deg]的角度误差。
【专利文献1】日本特开平5-306936号公报
【专利文献2】日本特开平5-52578号公报
【专利文献3】日本特开2000-65849号公报
发明内容
根据以上,本发明的目的是,在使用低速区域中有不灵敏区的车速传感器的车辆的低速行驶时防止错误的偏移值的取入。
本发明的另一个目的是在转台旋转中防止错误的偏移量的取入。
本发明的另一个目的是即使在不具有车速传感器的情况下也能够根据陀螺的输出信号正确地检测停车、行驶开始,并且计算正确的偏移值。
·角速度计算装置
本发明是将停车中的陀螺的角速度信号平均化而计算偏移值,并从行驶中的角速度信号中将偏移值消除来输出角速度的角速度计算装置。
作为本发明的第1技术方案的角速度计算装置具备:停车范围决定部,检测停车时、规定时间(T1)中的角速度信号的最小值与最大值,决定视为停车的角速度信号的范围;停车行驶判断部,在陀螺的角速度信号超过该范围时判断为行驶开始,在该范围内时判断为停车中;角速度平均化部,以规定时间间隔计算陀螺的角速度信号的平均值;角速度保存部,保存从角速度平均化部输出的平均角速度;以及偏移值决定部,将比由上述停车行驶判断部检测到的行驶开始检测时刻早设定时间的上述保存的角速度决定为偏移值。
作为第1技术方案的角速度计算装置具备角速度信号输出部,该角速度信号输出部每规定时间对从陀螺输出的电压信号进行取样而求出旋转角度,并将规定取样次数的旋转角度合计来输出角速度信号。
作为第1技术方案的角速度计算装置的上述停车范围决定部以比上述规定时间(T1)短的时间(T2)的间隔,决定并更新上述视为停车的角速度信号的范围。在此情况下,停车范围决定部,使上述视为停车的范围幅度,比由上述最小值、最大值决定的范围幅度增大规定比例。
作为本发明的第2技术方案的角速度计算装置具备:停车判断部,根据从车速传感器产生的车速脉冲判断是否是停车中;角速度平均化部,以规定时间间隔计算根据陀螺的输出信号求出的角速度信号的平均值;以及偏移量取入部,在平均角速度的偏差在设定范围内、且为停车中、而且距离上次取入的偏移值的变动量存在于容许范围内时,将从上述角速度平均化部输出的角速度作为偏移值取入并输出。
作为第2技术方案的角速度计算装置具备角速度信号输出部,该角速度信号输出部每规定时间对从陀螺输出的电压信号进行取样而求出旋转角度,并将规定取样次数的旋转角度合计来输出上述角速度信号。
作为第2技术方案的角速度计算装置还具备:对应表保持部,存储从上次的偏移量取入时刻起的经过时间与上述容许范围的对应关系;经过时间监视部,监视上述经过时间;以及容许范围决定部,将对应于上述经过时间的容许范围输入到上述偏移量取入部。
·车辆停车检测装置
本发明是检测车辆的停车的车辆停车检测装置,具备:陀螺,输出车辆的角速度信号;停车范围决定部,检测停车时、规定时间(T1)中的角速度信号的最小值与最大值,决定视为停车的角速度信号的范围;停车行驶判断部,在陀螺的角速度信号超过该范围时判断为行驶开始,在该范围内时判断为停车中。
本发明的车辆停车检测装置还具备角速度信号输出部,该角速度信号输出部每规定时间对从陀螺输出的电压信号进行取样而求出旋转角度,并将规定取样次数的旋转角度合计来输出角速度信号。
上述停车范围决定部以比上述规定时间(T1)短的时间(T2)的间隔,决定并更新上述视为停车的角速度信号的范围。在此情况下,停车范围决定部,使上述视为停车的范围幅度,比由上述最小值、最大值决定的范围幅度增大规定比例。
·偏移量决定方法
本发明是将停车中的陀螺的角速度信号平均化而计算偏移值、从行驶中的角速度信号中将偏移值消除来输出角速度的角速度计算装置的偏移量决定方法。
作为本发明的第1技术方案的偏移量决定方法具有:检测停车时、规定时间(T1)中的角速度信号的最小值与最大值,决定视为停车的角速度信号的范围的步骤;在陀螺的角速度信号超过该范围时判断为行驶开始,在该范围内时判断为停车中的步骤;以规定时间间隔计算陀螺的角速度信号的平均值并保存的步骤;以及将比行驶开始检测时刻早设定时间的上述保存的角速度决定为偏移值的步骤。
作为本发明的第1技术方案的偏移量决定方法还具有每规定时间对从陀螺输出的电压信号进行取样而求出旋转角度,并将规定取样次数的旋转角度合计来输出角速度信号的步骤。
作为本发明的第2技术方案的偏移量决定方法具有:根据从车速传感器产生的车速脉冲判断是否是停车中的步骤;以规定时间间隔计算根据陀螺的输出信号求出的角速度信号的平均值的步骤;以及在平均角速度的偏差在设定范围内、且为停车中、而且距离上次取入的偏移值的变动量存在于容许范围内时,将上述平均角速度信号作为偏移值取入并输出的步骤。
作为本发明的第2技术方案的偏移量决定方法还具有每规定时间对从陀螺输出的电压信号进行取样而求出旋转角度,并将规定取样次数的旋转角度合计来输出上述角速度信号的步骤。
作为本发明的第2技术方案的偏移量决定方法还具有保持存储从上次的偏移量取入时刻起的经过时间与上述容许范围的对应关系的对应表、监视上述经过时间、根据上述对应表求出对应于上述经过时间的容许范围的步骤。
根据本发明,检测停车时的陀螺的角速度信号的最小值和最大值,设定视为停车的角速度信号的范围,在陀螺的角速度信号超过该范围时判断为行驶开始,将比行驶开始时刻早设定时间计算并保存的平均角速度信号作为偏移值输出,所以,即使在不具有车速传感器的情况下也能够根据陀螺的输出信号正确地检测停车、行驶开始,并且计算正确的偏移值。
根据本发明,在平均角速度的偏差在设定范围内、且为停车中、而且距离上次取入的偏移值的变动量存在于容许范围内时,计算平均角速度而决定为偏移值,所以,在使用低速区域中有不灵敏区的车速传感器的车辆的低速行驶时上述变动量超过容许范围,所以能够不更新偏移量,此外,在转台旋转中上述变动量也超过容许范围,所以能够不更新偏移量,能够防止错误的偏移量的取入。
附图说明
图1是本发明的第1实施例的原理说明图。
图2是第1实施例的角速度计算装置的结构图。
图3是角速度数据变换部的结构图。
图4是偏移量计算部的结构图。
图5是角速度保存部的角速度数据保存法的说明图。
图6是平均角速度计算的结构图。
图7是第2实施例的角速度计算装置的结构图。
图8是第2实施例的偏移量计算部(其一)的结构图。
图9是第2实施例的偏移量计算部(其二)的结构图。
图10是陀螺输出电压与经过时间的关系特性。
图11是经过时间t与容许阈值ΩTHL的对应说明图。
图12是陀螺的偏移电压(Ωoff)说明图。
图13是在停车时不能正确地测量偏移值的情况的说明图。
图14是在低速行驶时将偏移量弄错的情况的说明图。
图15是在转台上旋转时弄错偏移量的情况的说明图。
图16是在停车时在陀螺的输出信号中叠加了噪音的情况的波形图。
图17是视为停车中的偏差幅度(停车范围)说明图。
标号说明
11陀螺
12A/D变换器
13角速度数据变换部
14偏移量计算部
15角速度计算部
21角速度取入部
22角速度保存部
23平均角速度计算部
24定时器
25平均角速度保存部
26角速度偏差范围测量部
27停车范围保存部
28停车判断部
29偏移量决定部
具体实施方式
(A)第1实施例
图1是本发明的第1实施例的原理说明图,是不具有车速传感器的情况的实施例。
在停车时,如图1(a)所示,检测规定时间T1(例如3秒钟)的陀螺的角速度信号的最小值ΩMIN、和最大值ΩMAX,决定视为停车的角速度信号的范围TH1、TH2。其中,在考虑余量而将最小值ΩMIN的减少20%的值设为TH1、将最大值ΩMAX的增加20%的值设为TH2时,将范围TH1~TH2作为视为停车的角速度信号的范围。与以上并行,以规定时间T2间隔(例如1秒钟)计算陀螺的角速度信号的平均值并保存(图1(a)、图1(b)中的黑点)。并且,如图1(b)所示,将陀螺的角速度信号超过上述范围TH1~TH2的时刻tS作为行驶开始时刻而检测出来,将与该行驶开始检测时刻tS相比在设定时间Ta以内的偏移量(×标记)舍弃,将在设定时间Ta前保存的平均角速度信号ΩOFF作为偏移值取入并输出。
根据以上,能够对每个陀螺适当地决定停车范围TH1~TH2,能够正确地检测行驶开始、停车。此外,将从行驶开始规定时间Ta前的平均角速度信号ΩOFF决定为偏移值,因此即使在打了方向盘的状态下开始行驶、或在以低速一边微小地旋转一边行驶的情况下,由于不使用该期间的偏移值,所以也能够提高偏移值的可靠度,能够在行驶时进行正确的方位检测。
另外,以上对根据角速度信号的最小值、最大值决定视为停车的角速度信号的范围TH1、TH2的情况进行了说明,但也可以将陀螺输出电压信号看作角速度信号而进行同样的处理。
图2是第1实施例的角速度计算装置的结构图。
安装在车辆中的陀螺11输出对应于车辆等的角速度的信号,A/D变换部12将从陀螺11输出的信号从模拟变换为数字,角速度数据变换部13通过将从A/D变换部12输出的角速度数据多次取样而平均化,将该平均化后的角速度数据输出给偏移量计算部16及角速度计算部17。陀螺11每1deg/sec(度/秒)角速度发出25mv的电压信号,零点的电压(偏移电压)在规格中规定为2.5V±300mV。A/D变换部12以5msec周期将从陀螺11输出的电压信号(角速度信号)取样而进行AD变换,将数字值输入到角速度数据变换部13中。
图3是角速度数据变换部13的结构图,取入部13a取入AD变换输入,电压角度变换部13b将电压数据变换为旋转角度,累积部13c将n次、例如8次取样的角度累积而输入到角速度计算部13d中,角速度计算部13d根据输入的40msec(=5×8msec)的旋转角度,计算角速度Ω(deg/sec),输出给偏移量计算部14及角速度计算部15。
偏移量计算部14在停车时利用从角速度数据变换部13输出的角速度数据求出偏移值(ΩOFF),输入到角速度计算部15中。角速度计算部15在车辆行驶时,将从角速度数据变换部13输出的角速度数据(Ω)中消除了偏移值(ΩOFF)而得到的角速度输入到角度计算部16中。角度计算部16通过将从角速度计算部15输入的角速度积分来计算旋转角度。
图4是偏移量计算部14的结构图,角速度取入部21将从角速度数据变换部13每40msec输入的角速度数据取入而输入到角速度保存部22中。角速度保存部22如图5所示,具备保存最新的3秒钟的角速度数据的区域1~75,在箭头方向上依次将75个角速度数据循环地保存。平均角速度计算部23根据来自定时器24的定时信号,以1秒间隔计算最新的3秒钟的75个角速度数据的平均值并输出。图6是平均角速度计算的说明图,在时刻t0时,计算最新的3秒钟的75个角速度数据的平均值Ω10并输出,在1秒后的时刻(t0+1)时,计算最新的3秒钟的75个角速度数据的平均值Ω11并输出,在又1秒后的时刻(t0+2)时,计算最新的3秒钟的75个角速度数据的平均值Ω12并输出。以后,同样以1秒间隔计算最新的3秒钟的75个角速度数据的平均值并输出。平均角速度保存部25依次保存由平均角速度计算部23计算出的最新的m个(在图中为3个)平均角速度Ω10、Ω11、Ω12。
角速度偏差范围测量部26如图1中说明那样,在停车时每1秒分别求出过去3秒的75样本值中的最小值ΩMIN和最大值ΩMAX,将最小值的减少20%后的值作为TH1,将最大值的增加20%后的值作为TH2,将TH1~TH2的范围作为视为停车的角速度范围而保存在停车范围保存部27中。在停车范围保存部27中作为初始值而设定了较大的角速度范围,但每当计算了角速度范围TH1~TH2时进行更新。
停车判断部28,如果从角速度数据变换部13取入的角速度信号在保存于停车范围保存部27中的停车范围内,则输出停车中信号,如果超过停车范围则发出行驶开始信号。偏移量决定部29,如果发出了行驶开始信号,则将在比该发出时刻tS早规定时间Ta(例如2秒)计算并保存在平均角速度保存部25中的平均角速度Ω03作为偏移值ΩOFF取入并输出(参照图1),并且将该平均角速度保存部的存储内容清空。
根据第1实施例,即使在不具有车速传感器的情况下也能够根据陀螺的输出信号正确地检测停车、行驶开始,并且能够计算正确的偏移值。
(B)第2实施例
第2实施例是具有车速传感器的实施例,如果规定时间(例如1.2秒)以上没有从车速传感器发出车速脉冲,则判断为停车。
在第2实施例中,根据从车速传感器51发出的车速脉冲判断是否是停车中,在平均角速度的偏差在设定范围内并且是停车中、而且距离上述取入的偏移值的变动量存在于容许范围内时,将最新的平均角速度作为偏移值采用。
图7是第2实施例的角速度计算装置的结构图,对于与图2的第1实施例相同的部分赋予相同的标号。不同点是设有车速传感器51这一点以及偏移量计算部52的结构,角速度数据变换部13具有与第1实施例相同的结构。
图8及图9是第2实施例的偏移量计算部52的结构图,对于与图4的第1实施例的偏移量计算部相同的部分赋予相同的标号。角速度取入部21将从角速度数据变换部13每40msec输入的角速度数据取入而输入到角速度保存部22中。角速度保存部22如图5所示,具备保存最新的3秒钟的角速度数据的区域1~75,在箭头方向上依次将75个角速度数据循环地保存。平均角速度计算部23根据来自定时器24的定时信号,每1秒钟计算过去3秒钟的75个角速度数据的平均值并输出(参照图6)。平均角速度保存部25依次保存由平均角速度计算部23计算出的最新的m个(在图中为3个)平均角速度Ω10、Ω11、Ω12和平均角速度计算时刻。角速度偏差计算部61求出保存在平均角速度保存部25中的过去3秒钟的平均角速度Ω10、Ω11、Ω12和此次的平均角速度Ω13的最大变动,判断该最大变动是否为设定值、例如0.5deg/sec以下,如果是0.5deg/sec以下则输出角速度稳定信号,如果是0.5deg/sec以上则输出角速度不稳定信号。
车速检测部62检测从车速传感器51输入的车速脉冲,车速脉冲间隔测量部63测量车速脉冲间隔,车辆停止判断部64如果车速脉冲间隔为设定值、例如1.2秒以上则判断为车辆停止中,输出停止中信号。
第1偏移量取入部65在车辆为停车中、且输出了角速度稳定信号时,将由平均角速度计算部23计算出的平均角速度Ω13作为偏移值的候补输出。第2偏移量取入部66(图9),如果从第1偏移量取入部65输出的平均角速度信号Ω13与上次取入的偏移值ΩOFF之间的差(变动量)为容许阈值ΩTHL以下,则将该平均角速度信号Ω13作为新的偏移值ΩOFF取入,输入到偏移量保持部67中。偏移量保持部67保持该新偏移值ΩOFF并输出。
容许阈值ΩTHL是根据陀螺的规格或陀螺所具有的能力而决定的值,如果是停车中则变动量不会为该容许阈值ΩTHL以上,如果为容许阈值ΩTHL以上则可视为不是停车中。图10是对几个陀螺测量停车时的陀螺输出电压与经过时间的关系而得到的特性。由此,将从上次的偏移量取入时刻起的经过时间t与容许阈值ΩTHL的对应如图11所示那样设定,设定在t-ΩTHL表保持部68中。在图11的表中,在300秒以上设为没有限制的理由是因为,即使因温度变动等而偏移量变动量变大,也能够在下次的车辆停车时可靠地计算新的偏移值而输出。
偏移量取入时刻保持部69存储第2偏移量取入部66将平均角速度信号作为偏移值ΩOFF取入的时刻,经过时间计算部71计算出从上次的偏移量取入时刻到平均角速度信号Ω13的计算时刻为止的经过时间t,容许阈值决定部72从表保持部68求出对应于经过时间t的容许阈值ΩTHL,输入到第2偏移量取入部66中。第2偏移量取入部66如上所述,如果从第1偏移量取入部65输出的平均角速度信号Ω13与上次取入的偏移值ΩOFF的差(变动量)为容许阈值ΩTHL以上,则不将平均角速度信号Ω13作为偏移量取入而将其舍弃。另一方面,如果与偏移值ΩOFF之间的差(变动量)为容许阈值ΩTHL以下,则将该平均角速度信号Ω13作为新的偏移量ΩOFF取入,输入到偏移量保持部67中。
根据第2实施例,即使在图16的行驶开始后的低速状态下不发出车辆脉冲而视为停车状态、并且平均角度速的最大变动为设定值(例如0.5deg/sec)以下、稳定的情况下,此时的偏移值Ω13与上次的偏移值ΩOFF之间的差会超过容许阈值ΩTHL,将该偏移值Ω13舍弃,不会输出错误的偏移值。
此外,根据第2实施例,在图17的转台上的旋转状态下,即使在不发出车辆脉冲而视为停车状态、并且平均角度速的最大变动为设定值(例如0.5deg/sec)以下、稳定的情况下,此时的偏移值Ω13与在转台上旋转之前计算出的偏移值ΩOFF之间的差会超过容许阈值ΩTHL,将该偏移值Ω13舍弃,不会输出错误的偏移值。
根据第2实施例,在使用在低速区域中有不灵敏区的车速传感器的车辆的低速行驶时能够不更新偏移值,此外,在转台旋转中能够不更新偏移值,能够防止错误的偏移值的产生。
Claims (8)
1.一种角速度计算装置,将停车中的陀螺的角速度信号平均化而计算偏移值,从行驶中的角速度信号中将偏移值消除来输出角速度,其特征在于,具备:
停车范围决定部,检测停车时、规定时间(T1)中的角速度信号的最小值与最大值,决定视为停车的角速度信号的范围;
停车行驶判断部,在陀螺的角速度信号超过该范围时判断为行驶开始,在该范围内时判断为停车中;
角速度平均化部,以规定时间间隔计算陀螺的角速度信号的平均值;
角速度保存部,保存从角速度平均化部输出的平均角速度;以及
偏移值决定部,将比由上述停车行驶判断部检测到的行驶开始检测时刻早设定时间的上述保存的角速度决定为偏移值。
2.如权利要求1所述的角速度计算装置,其特征在于,
具备角速度信号输出部,该角速度信号输出部每规定时间对从陀螺输出的电压信号进行取样而求出旋转角度,并将规定取样次数的旋转角度合计来输出角速度信号。
3.如权利要求1所述的角速度计算装置,其特征在于,
上述停车范围决定部以比上述规定时间(T1)短的时间(T2)的间隔,决定并更新上述视为停车的角速度信号的范围。
4.如权利要求1所述的角速度计算装置,其特征在于,
上述视为停车的范围幅度,比由上述最小值、最大值决定的范围幅度增大规定比例。
5.如权利要求1所述的角速度计算装置,其特征在于,具备:
停车判断部,根据从车速传感器产生的车速脉冲判断是否是停车中;以及
偏移量取入部,在平均角速度的偏差在设定范围内、且为停车中、而且距离上次取入的偏移值的变动量存在于容许范围内时,将从上述角速度平均化部输出的角速度作为偏移值取入并输出。
6.如权利要求5所述的角速度计算装置,其特征在于,
具备角速度信号输出部,该角速度信号输出部每规定时间对从陀螺输出的电压信号进行取样而求出旋转角度,并将规定取样次数的旋转角度合计来输出上述角速度信号。
7.如权利要求5所述的角速度计算装置,其特征在于,具备:
对应表保持部,存储从上次的偏移量取入时刻起的经过时间与上述容许范围的对应关系;
经过时间监视部,监视上述经过时间;以及
容许范围决定部,将对应于上述经过时间的容许范围输入到上述偏移量取入部。
8.如权利要求5所述的角速度计算装置,其特征在于,
上述对应表考虑陀螺的时间输出电压特性而决定。
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP207619/2006 | 2006-07-31 | ||
JP2006207619A JP2008032591A (ja) | 2006-07-31 | 2006-07-31 | 角速度算出装置およびそのオフセット決定方法並びに車両停車検出装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN101118248A true CN101118248A (zh) | 2008-02-06 |
CN101118248B CN101118248B (zh) | 2011-06-15 |
Family
ID=38722625
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN2007101287263A Expired - Fee Related CN101118248B (zh) | 2006-07-31 | 2007-07-12 | 角速度计算装置 |
Country Status (4)
Country | Link |
---|---|
US (1) | US8131418B2 (zh) |
EP (1) | EP1884782B1 (zh) |
JP (1) | JP2008032591A (zh) |
CN (1) | CN101118248B (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104169690A (zh) * | 2012-03-13 | 2014-11-26 | 西门子公司 | 用于调节检测器的方法 |
CN104915564A (zh) * | 2015-06-16 | 2015-09-16 | 深圳市腾讯计算机系统有限公司 | 实现虚拟角色转弯的方法和装置 |
CN108733047A (zh) * | 2017-04-21 | 2018-11-02 | 丹佛斯动力系统公司 | 机器稳定性控制系统 |
CN110831236A (zh) * | 2018-08-09 | 2020-02-21 | 华为技术有限公司 | 随机接入的方法和装置 |
Families Citing this family (19)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20090215387A1 (en) * | 2008-01-16 | 2009-08-27 | Brennan Joseph P | In-vehicle cellular device blocker to restrict cellular use for operator |
FR2926902B1 (fr) * | 2008-01-24 | 2012-05-04 | Peugeot Citroen Automobiles Sa | Dispositif et procede de detection d'un etat particulier de vehicule. |
US9520004B2 (en) * | 2008-06-27 | 2016-12-13 | Bent Neubauer Holding Aps | Electronic parking disc |
JP5245637B2 (ja) * | 2008-08-19 | 2013-07-24 | トヨタ自動車株式会社 | 車載角速度検出装置 |
JP4780168B2 (ja) * | 2008-09-29 | 2011-09-28 | 日本ビクター株式会社 | 角速度センサ補正装置および角速度センサ補正方法 |
JP4780174B2 (ja) * | 2008-10-24 | 2011-09-28 | 日本ビクター株式会社 | 角速度センサ補正装置、角速度算出装置、角速度センサ補正方法、角速度算出方法 |
US20110065456A1 (en) * | 2009-04-20 | 2011-03-17 | Brennan Joseph P | Cellular device deactivation system |
NZ596948A (en) | 2009-05-08 | 2014-05-30 | Obdedge Llc | Systems, methods, and devices for policy-based control and monitoring of use of mobile devices by vehicle operators |
JP5545663B2 (ja) * | 2010-12-28 | 2014-07-09 | アルパイン株式会社 | ジャイロ用ゼロ点補正方法及び装置 |
JP5743838B2 (ja) * | 2011-10-13 | 2015-07-01 | キヤノン株式会社 | 像ブレ補正装置、光学機器および像ブレ補正方法 |
JP5644836B2 (ja) * | 2012-11-12 | 2014-12-24 | トヨタ自動車株式会社 | 操舵装置 |
DE102013202240A1 (de) * | 2013-02-12 | 2014-08-14 | Continental Automotive Gmbh | Verfahren und Vorrichtung zur Ermittlung eines Bewegungszustands eines Fahrzeugs mittels eines Drehratensensors |
JP5890488B1 (ja) | 2014-08-05 | 2016-03-22 | ファナック株式会社 | ツールをワークに押付けて作業を行うロボットの制御装置 |
JP6481660B2 (ja) * | 2016-06-09 | 2019-03-13 | トヨタ自動車株式会社 | 車両用挙動制御装置 |
US11485331B2 (en) * | 2019-10-13 | 2022-11-01 | National Chung-Shan Institute Of Science And Technology | Surface adaptation method and surface adaptation device thereof |
DE102021107520A1 (de) * | 2021-03-25 | 2022-09-29 | Valeo Schalter Und Sensoren Gmbh | Verfahren zum Ermitteln eines Gierraten-Offsetwertes |
JP2022179154A (ja) | 2021-05-21 | 2022-12-02 | スタンレー電気株式会社 | 車両状態特定装置並びに同方法、車両用灯具の光軸制御装置並びに同方法、車両用灯具システム |
DE102021208202A1 (de) | 2021-07-29 | 2023-02-02 | Robert Bosch Gesellschaft mit beschränkter Haftung | Verfahren zur Ermittlung eines Bewegungszustands eines Kraftfahrzeugs |
DE102022210212A1 (de) | 2022-09-27 | 2024-03-28 | Robert Bosch Gesellschaft mit beschränkter Haftung | Verfahren zur Bestimmung eines Drehwinkels eines Drehgelenks einer Arbeitsmaschine |
Family Cites Families (26)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0392713A (ja) * | 1989-09-04 | 1991-04-17 | Sumitomo Electric Ind Ltd | ジヤイロオフセツト除去法 |
JP2734150B2 (ja) * | 1989-12-21 | 1998-03-30 | 住友電気工業株式会社 | オフセット補正装置 |
JPH03209124A (ja) * | 1990-01-11 | 1991-09-12 | Sumitomo Electric Ind Ltd | オフセット補正機能を有する方位検出装置 |
JP2711746B2 (ja) * | 1990-03-31 | 1998-02-10 | 日本電気ホームエレクトロニクス株式会社 | 角速度計測装置 |
JP3018497B2 (ja) * | 1990-11-30 | 2000-03-13 | 住友電気工業株式会社 | 旋回角速度センサのオフセット補正装置 |
JP2798815B2 (ja) | 1991-04-17 | 1998-09-17 | アルパイン株式会社 | 角度算出装置 |
JPH0552578A (ja) | 1991-08-22 | 1993-03-02 | Toshiba Corp | 車両用走行方位検出装置 |
JPH05157572A (ja) * | 1991-12-10 | 1993-06-22 | Pioneer Electron Corp | ナビゲーション装置 |
US5390123A (en) * | 1992-06-09 | 1995-02-14 | Zexel Corporation Daihatsu-Nissay | Navigation system with accurate determination of angular velocity |
JPH07218276A (ja) * | 1994-02-03 | 1995-08-18 | Zanabui Informatics:Kk | 車両用ナビゲーション装置 |
JP3423418B2 (ja) * | 1994-06-30 | 2003-07-07 | 松下電器産業株式会社 | 移動体旋回角度算出装置 |
US5935191A (en) | 1994-11-08 | 1999-08-10 | Matsushita Electric Industrial Co., Ltd. | Navigation apparatus for a vehicle |
JP3783257B2 (ja) * | 1994-11-08 | 2006-06-07 | 松下電器産業株式会社 | ナビゲーション装置 |
JPH08178687A (ja) * | 1994-12-26 | 1996-07-12 | Pioneer Electron Corp | 姿勢検出方法及び装置 |
JP3165045B2 (ja) * | 1996-10-31 | 2001-05-14 | 株式会社データ・テック | 角速度データ補正装置 |
JPH10253359A (ja) * | 1997-03-06 | 1998-09-25 | Murata Mfg Co Ltd | センサの信号処理方法及び信号処理装置 |
JP3975416B2 (ja) * | 1998-03-12 | 2007-09-12 | ソニー株式会社 | 航法装置、センサ出力較正方法及び航法処理プログラム |
US6147626A (en) * | 1998-08-11 | 2000-11-14 | Visteon Technologies, Llc | Determination of zero-angular-velocity output level for angular velocity sensor |
JP3407689B2 (ja) * | 1999-04-22 | 2003-05-19 | 株式会社村田製作所 | 振動ジャイロ |
CN1253694C (zh) * | 1999-10-12 | 2006-04-26 | 数据技术株式会社 | 分析移动物体操作倾向的方法,操作管理系统及其构成装置,和存储媒体 |
DE10018558A1 (de) * | 2000-04-14 | 2001-10-18 | Bosch Gmbh Robert | Verfahren zur Regelung der Geschwindigkeit eines Fahrzeugs |
JP3751513B2 (ja) * | 2000-09-08 | 2006-03-01 | 三菱電機株式会社 | ロケータ装置 |
JP2002333321A (ja) * | 2001-05-07 | 2002-11-22 | Pioneer Electronic Corp | 角速度検出方法及び装置、角度検出方法及び装置、ナビゲーションシステム及びコンピュータプログラム |
JP3991978B2 (ja) * | 2003-12-12 | 2007-10-17 | 株式会社デンソー | 車両用角速度センサの補正診断装置 |
JP4074598B2 (ja) * | 2004-03-23 | 2008-04-09 | 株式会社ザナヴィ・インフォマティクス | ナビゲーション装置、及び現在位置算出方法 |
KR100651397B1 (ko) * | 2004-10-12 | 2006-11-29 | 삼성전자주식회사 | 자이로스코프 영점 설정 장치 및 방법 |
-
2006
- 2006-07-31 JP JP2006207619A patent/JP2008032591A/ja active Pending
-
2007
- 2007-06-01 US US11/756,950 patent/US8131418B2/en active Active
- 2007-07-12 CN CN2007101287263A patent/CN101118248B/zh not_active Expired - Fee Related
- 2007-07-30 EP EP07014943.0A patent/EP1884782B1/en not_active Expired - Fee Related
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104169690A (zh) * | 2012-03-13 | 2014-11-26 | 西门子公司 | 用于调节检测器的方法 |
CN104169690B (zh) * | 2012-03-13 | 2016-10-19 | 西门子公司 | 用于调节检测器的方法 |
CN104915564A (zh) * | 2015-06-16 | 2015-09-16 | 深圳市腾讯计算机系统有限公司 | 实现虚拟角色转弯的方法和装置 |
CN104915564B (zh) * | 2015-06-16 | 2017-03-22 | 深圳市腾讯计算机系统有限公司 | 实现虚拟角色转弯的方法和装置 |
US10204399B2 (en) | 2015-06-16 | 2019-02-12 | Tencent Technology (Shenzhen) Company Limited | Method and terminal for implementing turning of virtual character |
CN108733047A (zh) * | 2017-04-21 | 2018-11-02 | 丹佛斯动力系统公司 | 机器稳定性控制系统 |
CN110831236A (zh) * | 2018-08-09 | 2020-02-21 | 华为技术有限公司 | 随机接入的方法和装置 |
Also Published As
Publication number | Publication date |
---|---|
EP1884782A2 (en) | 2008-02-06 |
EP1884782A3 (en) | 2013-03-27 |
US8131418B2 (en) | 2012-03-06 |
CN101118248B (zh) | 2011-06-15 |
US20080027601A1 (en) | 2008-01-31 |
JP2008032591A (ja) | 2008-02-14 |
EP1884782B1 (en) | 2017-10-25 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN101118248B (zh) | 角速度计算装置 | |
US8326491B2 (en) | Method and device for determining an absolute value of a variable | |
US7684945B2 (en) | Method for the calibration of a yaw rate measurement | |
US7487670B2 (en) | Methods for determining the direction of rotation of rotating bodies | |
CA1325904C (en) | Method of correcting zero point of gyro and apparatus therefor | |
JPH10506468A (ja) | 車両走行メーター | |
KR20130132415A (ko) | 자동차의 스티어링 각도의 결정 | |
RU2640313C2 (ru) | Способ оценки скорости железнодорожного транспортного средства | |
EP2507101B1 (fr) | Procede de determination de l'inclinaison d'une route | |
US20030236607A1 (en) | Movement condition computing device, movement condition computing method, movement condition computing program, recording medium recording said program, and navigation device | |
JPH1194874A (ja) | ヨーレートセンサの較正方法 | |
JP5484669B2 (ja) | タイヤに備え付けられたセンサの注目に値する角度位置を計時する方法 | |
JPH03172768A (ja) | 自動車の横方向加速度検出方法 | |
KR101150209B1 (ko) | 차량의 종 가속도 오프셋 보정 방법 | |
JP2003004758A (ja) | 車両速度計測装置および車両速度計測方法 | |
JPH07229754A (ja) | 電気車の走行距離演算装置 | |
JP2002131077A (ja) | 移動体の停止判定方法及び停止判定装置ならびに停止判定プログラムを記録した記憶媒体 | |
JPH1090036A (ja) | 自動車の燃費算出システム | |
JP3679450B2 (ja) | 現在位置算出装置および現在位置算出方法 | |
EP3622260A1 (en) | A processing device for a weighing scale and methods thereof | |
KR0138712Y1 (ko) | 자동차의 이동 궤적 검출 장치 | |
US6625571B1 (en) | Method for evaluating signals with the aid of a timer and an overrun counter | |
JPH10206453A (ja) | ヨー角速度検出装置 | |
JPH09311036A (ja) | 車両用操舵角検出装置 | |
JP3244619B2 (ja) | 移動体の状態判定装置 |
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 | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20110615 Termination date: 20210712 |