CN102313535B - 坡度检测方法 - Google Patents

坡度检测方法 Download PDF

Info

Publication number
CN102313535B
CN102313535B CN 201110177515 CN201110177515A CN102313535B CN 102313535 B CN102313535 B CN 102313535B CN 201110177515 CN201110177515 CN 201110177515 CN 201110177515 A CN201110177515 A CN 201110177515A CN 102313535 B CN102313535 B CN 102313535B
Authority
CN
China
Prior art keywords
value
acceleration
signal
correction
detection method
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.)
Active
Application number
CN 201110177515
Other languages
English (en)
Other versions
CN102313535A (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.)
Huizhou Desay SV Automotive Co Ltd
Original Assignee
Huizhou Desay SV Automotive Co 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 Huizhou Desay SV Automotive Co Ltd filed Critical Huizhou Desay SV Automotive Co Ltd
Priority to CN 201110177515 priority Critical patent/CN102313535B/zh
Publication of CN102313535A publication Critical patent/CN102313535A/zh
Application granted granted Critical
Publication of CN102313535B publication Critical patent/CN102313535B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Gyroscopes (AREA)
  • Electric Propulsion And Braking For Vehicles (AREA)

Abstract

本发明涉及坡度检测方法,包括步骤:利用加速度传感器得到加速度信号,利用速度信号模块得到速度信号;在速度值达到预设速度时对加速度信号的校正值进行校正;根据速度信号获得机动车加速度值;根据经过校正的校正值、加速度信号、机动车加速度值和地球重力加速度获得坡度值;以及输出坡度值。本发明坡度检测方法能客观精确地测量路面坡度,不受机动车加、减速或是否运动的影响,通过持续不断地对加速度信号的校正值进行校正,能自动适应安装工差、自动适应和处理加速度传感器的温漂效应、中值漂移效应和安装角度偏移效应。本发明可应用于道路坡度数据采集系统、导航仪定位系统等领域。

Description

坡度检测方法
技术领域
本发明涉及检测装置和方法,特别是涉及一种坡度检测方法。
背景技术
目前,机动车驾驶员一般都是依靠经验判断机动车是在上坡还是下坡,然后进行机动车变速操作,非常不方便。申请号为200910103424.x,申请日为2009年3月23日的发明专利申请《机动车用道路坡度检测装置》公开了一种使用霍尔元件与单摆结构的坡度检测装置,它采用霍尔元件以及与之相对并可沿机动车纵向摆动的单摆结构,在机动车上下坡时利用重力分力作用,使单摆结构的磁钢相对霍尔元件摆动,霍尔元件检测磁力变化并将信号传至一个控制单元,控制单元通过计算得出机动车所行驶道路的坡度以及机动车是在上坡还是下坡。但该技术存在以下不足:该装置在静止或平滑路面匀速行驶时检测到的坡度值很准确,在机动车加速或减速时,机动车纵向加速度和重力分量共同作用于单摆结构,造成检测输出的坡度值中包含纵向加速度作用的结果,不准确。在崎岖不平的道路上,机动车的振动对单摆的检测干扰很大,输出的坡度值不准确。另外,该装置没有实施坡度值校正,长时间使用后坡度值可行度低。
发明内容
基于此,有必要提供一种高精度坡度检测方法。
一种高精度坡度检测方法,包括步骤:利用加速度传感器得到加速度信号,利用速度信号模块得到速度信号;在所述速度信号的速度值达到预设速度时对所述加速度信号的校正值进行校正,该校正值代表机动车位于水平地面且静止时加速度传感器输出的信号值;根据所述速度信号获得机动车加速度值;根据经过校正的校正值、加速度信号、机动车加速度值和地球重力加速度获得坡度值;以及输出所述坡度值。
在优选的实施例中,所述对所述校正值进行校正的方法包括:设置一个初始值为0的校正程度指标,所述校正值每被校正一次,所述校正程度指标的值加1;计算设定时间片段的加速度传感器输出的均值                                                
Figure 175473DEST_PATH_IMAGE001
;计算当前校正值与所述均值
Figure 904394DEST_PATH_IMAGE001
之间的偏差量
Figure 609308DEST_PATH_IMAGE002
;根据校正程度指标查询预设容差表获得一个预设容差,所述预设容差表为校正程度指标与预设容差的对应关系表;如果所述偏差量
Figure 107285DEST_PATH_IMAGE002
小于或等于所述预设容差,所述均值
Figure 737986DEST_PATH_IMAGE001
作为校准观测变量,否则丢弃该均值,重新计算另一个设定时间片段的加速度传感器输出的均值
Figure 954204DEST_PATH_IMAGE001
;以及利用一个校正卡尔曼滤波器根据所述校准观测变量和校准过程激励噪声协方差对所述校正值进行校正,其中所述校准过程激励噪声协方差受所述校正程度指标控制。
在优选的实施例中,在所述校正程度指标小于或等于预设值时,所述校准过程激励噪声协方差随校正程度指标值的增大降低。在所述校正程度指标大于预设值时,所述校准过程激励噪声协方差基本保持不变。
在优选的实施例中,在所述校正程度指标小于或等于预设值时,所述预设容差随校正程度指标值的增大降低。在所述校正程度指标大于预设值时,所述预设容差基本保持不变。
在优选的实施例中,利用滤波器对所述加速度传感器和速度信号模块输出的加速度信号和速度信号进行滤波去噪。
在优选的实施例中,所述坡度检测方法还包括步骤:根据加速度传感器水平放置时的信号量及经过校正的校正值获得所述加速度传感器的安装倾角;在所述获得坡度值的步骤中还要考虑所述安装倾角。
在优选的实施例中,所述安装倾角通过如下公式获得:
Figure 836709DEST_PATH_IMAGE003
,其中
Figure 815292DEST_PATH_IMAGE004
为当前校正值,
Figure 757840DEST_PATH_IMAGE005
为加速度传感器水平放置时的信号量。
在优选的实施例中,所述坡度值的获得步骤包括:
计算机动车加速度效应作用于所述加速度传感器上的信号分量
Figure 741026DEST_PATH_IMAGE007
,其中,
Figure 839694DEST_PATH_IMAGE008
为所述机动车加速度,
Figure 687564DEST_PATH_IMAGE009
为经过滤波去噪处理的速度信号,
Figure 612795DEST_PATH_IMAGE010
为所述安装倾角,为加速度与加速器信号间的转换因子;
推算因加速度传感器的检测轴与水平面倾斜所产生的信号分量
Figure 288813DEST_PATH_IMAGE012
,其中为经过滤波去噪处理的加速度信号,为加速度传感器水平放置时的信号量;
计算机动车纵向倾斜角度值,即坡度值
Figure 680425DEST_PATH_IMAGE015
Figure 135677DEST_PATH_IMAGE016
,其中
Figure 661599DEST_PATH_IMAGE017
为地球重力加速度。
在优选的实施例中,所述滤波器为离散卡尔曼滤波器。
在优选的实施例中,所述滤波器的滤波去噪方法包括:
向前推算第k(k为整数)次迭代的先验估计误差协方差
Figure 227709DEST_PATH_IMAGE018
Figure 388432DEST_PATH_IMAGE019
,其中Q为设定的过程激励噪声协方差,
Figure 14586DEST_PATH_IMAGE020
为第k-1次迭代后更新的误差协方差;
计算第k次迭代的卡尔曼增益
Figure 27803DEST_PATH_IMAGE021
Figure 132025DEST_PATH_IMAGE022
,其中R为设定的测量噪声协方差;
计算得到第k次滤波后的输出信号
Figure 412834DEST_PATH_IMAGE023
:
Figure 209889DEST_PATH_IMAGE024
,其中
Figure 818725DEST_PATH_IMAGE025
为第k次输入的校准观测变量,如所述加速度传感器输出的加速度信号或速度信号模块输出的速度信号;以及
更新第k次迭代的误差协方差
Figure 618316DEST_PATH_IMAGE026
Figure 628997DEST_PATH_IMAGE027
利用本发明坡度检测方法能客观精确地测量路面坡度,不受机动车加、减速或是否运动的影响,通过持续不断地对加速度信号的校正值进行校正,能自动适应安装工差、自动适应和处理加速度传感器的温漂效应、中值漂移效应和安装角度偏移效应。本发明为传感器信号推算式发明,通过合理选取相应指标的传感器,能达到相应传感器的最佳检测指标精度。本发明可应用于道路坡度数据采集系统、导航仪定位系统等领域。
附图说明
图1为一实施例的坡度检测系统的原理框图。
图2为一实施例的坡度检测方法的流程图。
图3为校正程度指标
Figure 721587DEST_PATH_IMAGE028
与预设容差
Figure 817719DEST_PATH_IMAGE029
及校准过程激励噪声协方差Q的关系图。
具体实施方式
下面将结合具体实施例及附图对本发明坡度检测方法作进一步详细描述。
本发明坡度检测方法是基于如图1所示的坡度检测系统。该坡度检测系统可设置在道路坡度数据采集系统、导航仪定位系统等需要使用汽车纵向倾斜度检测手段的各种汽车电子仪器中。
该坡度检测系统包括加速度传感器、速度信号模块和处理器模块。其中,加速度传感器用于检测加速度信号,可以是单轴加速度传感器,也可以是多轴加速度传感器。当采用多轴加速度传感器时,可选其中一个轴作为主检测轴,对该主检测轴如单轴加速度传感器的检测轴一样处理。加速度传感器在安装时,其检测轴与机动车纵向轴走向大方向接近,允许有一定的安装倾角,使用十分方便。
速度信号模块用于获得机动车当前的速度值(以下简称速度信号),其可以是现有机动车中各种可获得速度信号的模块。例如,该速度信号可来自机动车的速度脉冲信号线,通过接收速度脉冲计数,然后乘上转换系数即可得机动车的当前速度值。不同的车型,其速度转换因子可能会不一样。该速度信号也可来自汽车CAN总线或MOST总线等汽车总线,机动车的当前速度值可方便地从总线协议中解析和转换得到。而速度脉冲信号线、CAN总线或MOST总线的信号可能来自安装在轮轴上的霍尔传感器:霍尔传感器的霍尔脉冲信号送入ABS(防锁死刹车系统),经ABS处理后,该霍尔脉冲信号有的转换成总线信息(CAN总线、MOST总线等)供需要的电子仪器使用,有的则接到速度脉冲信号线输出速度脉冲。当然,有的速度脉冲信号线可能来自于里程仪。
处理器模块用于根据上述加速度信号、速度信号及设定参数计算坡度及修正系统安装倾斜度及在使用过程中发生的倾斜。处理器模块可包括处理器及其外围电路。整个坡度检测系统体积小巧,较容易整合进汽车电子设备中。
本实施例中,系统模块至少包括以下功能模块:对加速度传感器和速度信号模块输出的加速度信号和速度信号进行滤波去噪处理的滤波器,参数校正模块,用于存储参数和程序的存储模块,加速度传感器的安装倾角推算模块,加速度推算模块,坡度推算模块和显示输出模块。处理器模块在计算坡度值时对速度信号和加速度信号先进行了滤波去噪处理,在计算坡度时还考虑了加速度传感器的安装倾角,具有较高的检测推算精度和实施体积。
请参照图2,一实施例中,坡度检测系统的坡度检测方法包括:
步骤S101,利用滤波器对加速度传感器输出的加速度信号和速度信号模块输出的速度信号进行滤波去噪处理。本实施例中,采用两个离散卡尔曼滤波器分别对速度信号和加速度传感器信号进行滤波去噪,从而得到良好的信号进行后续步骤的校正与推算处理。鉴于这里是分别对加速度信号、速度信号进行噪声滤除的简易目的,设计了原理相同的两个简单的离散卡尔曼滤波器,其滤波去噪过程为:
首先,向前推算第k(k为整数)次迭代的先验估计误差协方差
Figure 889842DEST_PATH_IMAGE018
Figure 20609DEST_PATH_IMAGE019
,其中Q为设定的过程激励噪声协方差,为第k-1次迭代后更新的误差协方差。
然后,计算第k次迭代的卡尔曼增益
Figure 117244DEST_PATH_IMAGE022
,其中R为设定的测量噪声协方差。
然后,计算得到第k次滤波后的输出信号
Figure 728616DEST_PATH_IMAGE023
:
Figure 38375DEST_PATH_IMAGE024
,其中
Figure 109099DEST_PATH_IMAGE025
为第k次输入的观测变量,在此为加速度传感器输出的加速度信号或速度信号模块输出的速度信号。输出信号
Figure 287140DEST_PATH_IMAGE023
为经过滤波去噪处理后的加速度信号或速度信号,在此经过滤波去噪处理后的加速度信号标记为
Figure 126920DEST_PATH_IMAGE014
,经过滤波去噪处理后的速度信号标记为
最后,更新第k次迭代的误差协方差
Figure 526119DEST_PATH_IMAGE026
:,以用于下一次的滤波去噪处理。
步骤S102,在速度信号
Figure DEST_PATH_IMAGE030
的速度值达到预设速度(比如5m/s)时,参数校正模块每隔预设时间段对加速度信号
Figure 202137DEST_PATH_IMAGE014
的校正值进行一次校正。其中,校正值
Figure 525113DEST_PATH_IMAGE004
代表机动车在水平地面且静止时加速度传感器输出的信号值。通过对校正值
Figure 44956DEST_PATH_IMAGE004
进行不断地校正,可使系统中存储的数据更接近真实值。本实施例中,采用离散卡尔曼滤波技术对校正过程进行控制,设计了一个校正卡尔曼滤波器。该校正卡尔曼滤波器的原理与前述用于滤波去噪处理的离散卡尔曼滤波器的原理类似,不同的是,其过程激励噪声协方差Q为变量,不再是预设定值。可按照校准过程的需求,设置校准卡尔曼滤波器的其他参数,在此不再赘述。
为了使坡度检测系统在使用的前期可以以较短的时间得到较好的校准数据、在后期长期使用中可以以轻微的方式影响校正值
Figure 593749DEST_PATH_IMAGE004
,达到在校正过程中校正时间和校正精度之间的平衡,系统引入一个初始值为0的校正程度指标(以下标记为
Figure 681791DEST_PATH_IMAGE028
)。加速度信号每被成功校正一次,校正程度指标
Figure 574923DEST_PATH_IMAGE028
的值加1。在校正程度指标小于一个预设值(例如20)时,系统容许有较大的校正观测变量偏差输入参数校正模块,且使用稍大的校准过程激励噪声协方差Q以达到快速接近真实值的目的,在此称这一阶段为初始校正。当校正程度指标
Figure 301757DEST_PATH_IMAGE028
大于该预设值时,考虑到参数已达到一定的校正程度,系统即降低对校正观测量偏差的容许度,使得对校准观测变量的控制更严格,同时减小校准过程激励噪声协方差Q,以达到更精确地逼近真实值的目的,在此称这一阶段为持续校正。
具体的校正过程为:
首先,计算设定时间片段的加速度信号
Figure 560700DEST_PATH_IMAGE014
的均值
Figure 675548DEST_PATH_IMAGE001
。该设定时间片段优选为进行本次校正之前的一个固定长度时间片段。
再计算当前校正值与该均值
Figure 201525DEST_PATH_IMAGE001
之间的偏差量
Figure 732049DEST_PATH_IMAGE031
然后,根据当前的校正程度指标
Figure 898850DEST_PATH_IMAGE028
查询预设容差表获得一个预设容差
Figure 276742DEST_PATH_IMAGE029
。其中,预设容差表为校正程度指标与预设容差
Figure 465464DEST_PATH_IMAGE029
的对应关系表,该表用曲线表示如图3中实线表示的曲线。可以看出,在校正程度指标
Figure 809858DEST_PATH_IMAGE028
小于或等于预设值N时(初始校正阶段),预设容差随校正程度指标值的增大而降低,在校正程度指标
Figure 679657DEST_PATH_IMAGE028
大于预设值时(持续校正阶段),预设容差
Figure 686796DEST_PATH_IMAGE029
基本保持不变。
然后,比较偏差量
Figure 39280DEST_PATH_IMAGE002
与查询到的预设容差
Figure 342347DEST_PATH_IMAGE029
,如果偏差量小于或等于预设容差
Figure 591112DEST_PATH_IMAGE029
,均值
Figure 798102DEST_PATH_IMAGE001
可以作为校正卡尔曼滤波器的校准观测变量,否则偏差过大,丢弃该均值
Figure 911552DEST_PATH_IMAGE001
,接着继续进行下一个时间片段的均值的计算,再次重复校正过程的相关判断、控制、和校准过程。原因是,在系统刚安装使用、校准执行还不多的阶段,当前校正值
Figure 687189DEST_PATH_IMAGE004
本身就可能与客观真值有较大偏差(初始安装倾斜角偏差所致),因此在校正程度指标
Figure 138899DEST_PATH_IMAGE028
小时可以允许较大的容差。然后随着校正的推进,校正值越来越靠近真实值,因此对输入校正卡尔曼滤波器的均值
Figure 570197DEST_PATH_IMAGE001
的要求增大,即预设容差就要小点,从而另中长期的校正更精确。形象化来说,一开始,包容度大,为了找到方向、找到好的标准,接着,标准的质量提高了,要求严格点,不能偏离标准太远。
最后,利用校正卡尔曼滤波器,将作为校准观测变量的均值
Figure 405878DEST_PATH_IMAGE001
作为输入信号来得到当前的校正值
Figure 985763DEST_PATH_IMAGE004
。该校正卡尔曼滤波器用于控制校准的真值逼近过程,这里通过校正程度指标
Figure 885586DEST_PATH_IMAGE028
控制校准过程激励噪声协方差Q,从而达到控制校准的真值逼近过程的目的。校正程度指标
Figure 451697DEST_PATH_IMAGE028
与校准过程激励噪声协方差Q的一一对应关系如图3中虚线表示的曲线所示。可以看出,在校正程度指标
Figure 113885DEST_PATH_IMAGE028
小于或等于预设值N时(初始校正阶段),校准过程激励噪声协方差Q随校正程度指标
Figure 740038DEST_PATH_IMAGE028
值的增大而降低,在校正程度指标大于预设值时(持续校正阶段),校准过程激励噪声协方差Q基本保持不变。原因是:伴随着校正过程的进行,校正值越来越接近真实值,模型越来越稳定,此时要逐渐降低输入校正卡尔曼滤波器的单次校准观测变量对校正结果的影响程度,通过减小数学模型中的校准过程激励噪声协方差来实现该目的。
本步骤中,校正卡尔曼滤波器输出的结果作为当前的校准值
Figure 138287DEST_PATH_IMAGE004
,并保存在存储模块中。
步骤S103,安装倾角推算模块根据加速度传感器水平放置时的信号量
Figure 935341DEST_PATH_IMAGE005
及当前校准值
Figure 544177DEST_PATH_IMAGE004
获得加速度传感器的安装倾角
Figure 576724DEST_PATH_IMAGE010
。公式表示为:
Figure 587405DEST_PATH_IMAGE003
其中信号量
Figure 181460DEST_PATH_IMAGE005
可通过加速度传感器指标及实际测试综合而得。
步骤S104,加速度推算模块根据经过滤波去噪处理的速度信号
Figure 277592DEST_PATH_IMAGE009
获得机动车加速度值
Figure 989196DEST_PATH_IMAGE008
步骤S105,坡度推算模块根据经过校正的加速度信号
Figure 244597DEST_PATH_IMAGE014
、机动车加速度值、加速度传感器的安装倾角和地球重力加速度
Figure 327402DEST_PATH_IMAGE017
获得坡度值。具体步骤包括:
首先,计算机动车加速度效应作用于所述加速度传感器上的信号分量
Figure 842697DEST_PATH_IMAGE006
Figure 827970DEST_PATH_IMAGE007
。其中,
Figure 262363DEST_PATH_IMAGE011
为加速度与加速器信号间的转换因子,可从加速度传感器的说明书直接得到或推算得到。
然后,推算因加速度传感器的检测轴与水平面倾斜所产生的信号分量
Figure 67508DEST_PATH_IMAGE012
Figure 747013DEST_PATH_IMAGE013
,其中
Figure 586793DEST_PATH_IMAGE005
为加速度传感器水平放置时的信号量。
最后,计算机动车纵向倾斜角度值,即坡度值
Figure 67453DEST_PATH_IMAGE015
Figure 750107DEST_PATH_IMAGE016
步骤S106,利用显示输出模块输出所述坡度值。显示输出模块可包括显示器和音频输出模块,音频输出模块仅在坡度值打到一定值时输出一个提醒信号。
综上,本发明坡度检测方法能客观精确地通过测量机动车纵向倾斜度的方法来测量路面坡度,不受机动车加减速或是否运动的影响;通过校正过程的引入,对加速度传感器的安装倾角进行自动校正,能自动适应安装工差;引入校正程度指标,从校正时间、校正精度两个维度分别把对加速度信号的校正过程划分为两个阶段:初始校正、持续校正;通过持续校正过程,能自动适应和处理加速度传感器的温漂效应、中值漂移效应和安装角度偏移效应;通过合理选取相应指标的传感器,能达到相应传感器的最佳检测指标精度。另外还具有体积小巧,较容易整合进汽车电子设备中的优点。
以上所述实施例仅表达了本发明的几种实施方式,其描述较为具体和详细,但并不能因此而理解为对本发明专利范围的限制。应当指出的是,对于本领域的普通技术人员来说,在不脱离本发明构思的前提下,还可以做出若干变形和改进,这些都属于本发明的保护范围。因此,本发明专利的保护范围应以所附权利要求为准。

Claims (9)

1.一种坡度检测方法,其特征在于:
利用加速度传感器得到加速度信号,利用速度信号模块得到速度信号;
在所述速度信号的速度值达到预设速度时对所述加速度信号的校正值进行校正,该校正值代表机动车位于水平地面且静止时加速度传感器输出的信号值;
根据所述速度信号获得机动车加速度值;
根据经过校正的校正值、加速度信号、机动车加速度值和地球重力加速度获得坡度值;以及输出所述坡度值;
所述对所述校正值进行校正的方法包括:
设置一个初始值为0的校正程度指标,所述校正值每被校正一次,所述校正程度指标的值加1;
计算设定时间片段的加速度传感器输出的均值                                                
Figure 240087DEST_PATH_IMAGE001
计算当前校正值与所述均值之间的偏差量
Figure 706021DEST_PATH_IMAGE002
根据校正程度指标查询预设容差表获得一个预设容差,所述预设容差表为校正程度指标与预设容差的对应关系表;
如果所述偏差量小于或等于所述预设容差,所述均值
Figure 430580DEST_PATH_IMAGE001
作为校准观测变量,否则丢弃该均值,重新计算另一个设定时间片段的加速度传感器输出的均值
Figure 184910DEST_PATH_IMAGE001
;以及
利用一个校正卡尔曼滤波器根据所述校准观测变量和校准过程激励噪声协方差对所述校正值进行校正,其中所述校准过程激励噪声协方差受所述校正程度指标控制。
2.根据权利要求1所述的坡度检测方法,其特征在于,在所述校正程度指标小于或等于预设值时,所述校准过程激励噪声协方差随校正程度指标值的增大降低;在所述校正程度指标大于预设值时,所述校准过程激励噪声协方差基本保持不变。
3.根据权利要求1所述的坡度检测方法,其特征在于,在所述校正程度指标小于或等于预设值时,所述预设容差随校正程度指标值的增大降低;在所述校正程度指标大于预设值时,所述预设容差基本保持不变。
4.根据权利要求1至3项中任意一项所述的坡度检测方法,其特征在于,利用滤波器对所述加速度传感器和速度信号模块输出的加速度信号和速度信号进行滤波去噪。
5.根据权利要求4所述的坡度检测方法,其特征在于,还包括步骤:根据加速度传感器水平放置时的信号量及经过校正的校正值获得所述加速度传感器的安装倾角;在所述获得坡度值的步骤中还要考虑所述安装倾角。
6.根据权利要求5所述的坡度检测方法,其特征在于,所述安装倾角通过如下公式获得:
Figure 921921DEST_PATH_IMAGE003
,其中
Figure 756891DEST_PATH_IMAGE004
为当前校正值,为加速度传感器水平放置时的信号量。
7.根据权利要求6所述的坡度检测方法,其特征在于,所述坡度值的获得步骤包括:
计算机动车加速度效应作用于所述加速度传感器上的信号分量
Figure 703485DEST_PATH_IMAGE007
,其中,为所述机动车加速度,
Figure 744439DEST_PATH_IMAGE009
为经过滤波去噪处理的速度信号,
Figure 473360DEST_PATH_IMAGE010
为所述安装倾角,
Figure 552175DEST_PATH_IMAGE011
为加速度与加速器信号间的转换因子;
推算因加速度传感器的检测轴与水平面倾斜所产生的信号分量
Figure 50152DEST_PATH_IMAGE012
Figure 634848DEST_PATH_IMAGE013
,其中
Figure 585487DEST_PATH_IMAGE014
为经过滤波去噪处理的加速度信号,
Figure 467992DEST_PATH_IMAGE005
为加速度传感器水平放置时的信号量;
计算机动车纵向倾斜角度值,即坡度值
Figure 820476DEST_PATH_IMAGE015
Figure 825341DEST_PATH_IMAGE016
,其中
Figure 263276DEST_PATH_IMAGE017
为地球重力加速度。
8.根据权利要求4所述的坡度检测方法,其特征在于,所述滤波器为离散卡尔曼滤波器。
9.根据权利要求8所述的坡度检测方法,其特征在于,所述滤波器的滤波去噪方法包括:
向前推算第k(k为整数)次迭代的先验估计误差协方差
Figure 683893DEST_PATH_IMAGE018
:
Figure 156463DEST_PATH_IMAGE019
,其中Q为设定的过程激励噪声协方差,
Figure 584426DEST_PATH_IMAGE020
为第k-1次迭代后更新的误差协方差;
计算第k次迭代的卡尔曼增益
Figure 509657DEST_PATH_IMAGE021
Figure 733965DEST_PATH_IMAGE022
,其中R为设定的测量噪声协方差;
计算得到第k次滤波后的输出信号:
Figure 79813DEST_PATH_IMAGE024
,其中
Figure 554656DEST_PATH_IMAGE025
为第k次输入的校准观测变量,如所述加速度传感器输出的加速度信号或速度信号模块输出的速度信号;以及更新第k次迭代的误差协方差:
CN 201110177515 2011-06-29 2011-06-29 坡度检测方法 Active CN102313535B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN 201110177515 CN102313535B (zh) 2011-06-29 2011-06-29 坡度检测方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN 201110177515 CN102313535B (zh) 2011-06-29 2011-06-29 坡度检测方法

Publications (2)

Publication Number Publication Date
CN102313535A CN102313535A (zh) 2012-01-11
CN102313535B true CN102313535B (zh) 2013-08-28

Family

ID=45426918

Family Applications (1)

Application Number Title Priority Date Filing Date
CN 201110177515 Active CN102313535B (zh) 2011-06-29 2011-06-29 坡度检测方法

Country Status (1)

Country Link
CN (1) CN102313535B (zh)

Families Citing this family (15)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102818556A (zh) * 2012-03-19 2012-12-12 一汽解放青岛汽车有限公司 车载道路坡度检测方法及装置
CN103979012B (zh) * 2014-05-08 2017-01-04 金华市金开电子科技有限公司 电动车行驶路面坡度计算方法
CN105203127B (zh) * 2014-06-30 2018-01-12 惠州市德赛西威汽车电子股份有限公司 一种一体化导航产品的测试方法和测试装置
TWI564546B (zh) * 2015-08-14 2017-01-01 Nat Chung-Shan Inst Of Science And Tech On - board Vehicle Navigation System Calibration Method
CN105606072A (zh) * 2016-03-22 2016-05-25 李德军 一种道路坡度的检测方法
CN105973199A (zh) * 2016-05-16 2016-09-28 西南科技大学 一种适于滑坡体深部倾斜度的测量装置及方法
CN105823484B (zh) * 2016-05-26 2017-06-23 清华大学 一种集成式惯性导航测量单元及相应测量方法
CN107462911A (zh) * 2016-06-03 2017-12-12 千寻位置网络有限公司 汽车上下高架的检测方法及其装置
CN107139869A (zh) * 2017-05-18 2017-09-08 鞍山科大物联科技有限公司 一种手动档汽车带档启动检测装置及方法
CN107132377A (zh) * 2017-06-13 2017-09-05 南京越博动力系统股份有限公司 一种车辆加速度及所处坡度的测量装置与计算方法
CN110525442B (zh) * 2018-05-23 2021-10-26 长城汽车股份有限公司 坡度检测方法、系统及车辆
WO2020103029A1 (zh) * 2018-11-21 2020-05-28 深圳市大疆创新科技有限公司 地面坡度计算方法、装置、设备及存储介质
CN109883394B (zh) * 2019-03-04 2021-03-16 吉林大学 一种汽车用道路坡度实时估计方法
CN111391857B (zh) * 2019-12-24 2021-08-06 北京理工大学 一种分布式驱动电动汽车坡度估计方法及系统
CN113792265B (zh) * 2021-09-10 2024-09-17 中国第一汽车股份有限公司 一种坡度估计方法、装置、电子设备以及存储介质

Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101598549A (zh) * 2009-07-06 2009-12-09 北京航空航天大学 一种车辆行驶坡度与相对高度动态估计方法

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP5625293B2 (ja) * 2009-09-14 2014-11-19 ソニー株式会社 速度算出装置、速度算出方法及びナビゲーション装置

Patent Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101598549A (zh) * 2009-07-06 2009-12-09 北京航空航天大学 一种车辆行驶坡度与相对高度动态估计方法

Also Published As

Publication number Publication date
CN102313535A (zh) 2012-01-11

Similar Documents

Publication Publication Date Title
CN102313535B (zh) 坡度检测方法
US20200393491A1 (en) Systems and Methods for 3-Axis Accelerometer Calibration with Vertical Sample Buffers
US7957897B2 (en) GPS-based in-vehicle sensor calibration algorithm
US8195357B2 (en) In-vehicle sensor-based calibration algorithm for yaw rate sensor calibration
KR101741234B1 (ko) 관성 센서 오프셋 보상을 위한 시스템 및 방법
US20100007550A1 (en) Positioning apparatus for a mobile object
US20140236518A1 (en) Systems and Methods for Low Latency 3-Axis Accelerometer Calibration
CN103930312A (zh) 包括用于共同处理信号的融合滤波器的传感器系统
CN109883394B (zh) 一种汽车用道路坡度实时估计方法
US9764737B2 (en) Method and device for calculating vehicle speed
KR101358166B1 (ko) 차량의 가속도 센서의 장기 오프셋 드리프트 결정 방법
KR20140073977A (ko) 차량 요레이트센서의 바이어스 획득방법
CN113607251B (zh) 一种车辆载重测量方法及装置
US20170131107A1 (en) Angular velocity sensor correction device and method for correcting output signal from angular velocity sensor, and direction estimation device and method for estimating direction by correcting output signal from angular velocity sensor
US9605958B2 (en) Method and device for determining the inclined position of a vehicle
CN113810877B (zh) 车辆及其车速确定方法及装置、存储介质、终端
JP6699355B2 (ja) 角速度センサ補正装置および角速度センサ補正方法
JP2010249578A (ja) 変換係数導出装置および変換係数導出方法
KR20180131864A (ko) 자동차용 주행거리계의 오차 보정장치 및 자동차용 주행거리계의 오차 보정방법
JP3581392B2 (ja) 積分型センシング装置
JP3169213B2 (ja) 移動速度検出方法及び装置、車両のすべり角検出装置
CN111060096B (zh) 一种mems-imu模块组合里程计的数据处理方法及系统
JP2020041900A (ja) 慣性センサ出力補正装置及び慣性センサ出力補正方法
CN112525143B (zh) 一种设备安装角的确定方法及车载终端
US20230384341A1 (en) Method for evaluating sensor data, computing unit for evaluating sensor data and sensor system

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
C56 Change in the name or address of the patentee
CP01 Change in the name or title of a patent holder

Address after: 516006 Guangdong province Huizhou Zhongkai hi tech Industrial Development Zone Pearl River Road No. 1

Patentee after: HUIZHOU DESAY SV AUTOMOTIVE CO., LTD.

Address before: 516006 Guangdong province Huizhou Zhongkai hi tech Industrial Development Zone Pearl River Road No. 1

Patentee before: Huizhou Desay SV Auto. Electronics Co., Ltd.