CN104097641A - 用于估计道路坡度的*** - Google Patents
用于估计道路坡度的*** Download PDFInfo
- Publication number
- CN104097641A CN104097641A CN201310418591.XA CN201310418591A CN104097641A CN 104097641 A CN104097641 A CN 104097641A CN 201310418591 A CN201310418591 A CN 201310418591A CN 104097641 A CN104097641 A CN 104097641A
- Authority
- CN
- China
- Prior art keywords
- angle
- vehicle
- roll
- pitch
- acceleration
- 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
Classifications
-
- 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
- B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
- B60W40/02—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to ambient conditions
- B60W40/06—Road conditions
- B60W40/076—Slope angle of the road
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C9/00—Measuring inclination, e.g. by clinometers, by levels
- G01C9/02—Details
-
- 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
- B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
- B60W40/02—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to ambient conditions
-
- 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
- B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
- B60W40/02—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to ambient conditions
- B60W40/06—Road conditions
-
- 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
- B60W2510/00—Input parameters relating to a particular sub-units
- B60W2510/22—Suspension systems
-
- 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/10—Longitudinal speed
-
- 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/10—Longitudinal speed
- B60W2520/105—Longitudinal acceleration
-
- 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/12—Lateral speed
- B60W2520/125—Lateral acceleration
-
- 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
-
- 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/16—Pitch
-
- 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/18—Roll
-
- 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/28—Wheel speed
-
- 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
- B60W2540/00—Input parameters relating to occupants
- B60W2540/18—Steering angle
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C9/00—Measuring inclination, e.g. by clinometers, by levels
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Mathematical Physics (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
Abstract
用于估计道路坡度的***包括:信号处理器,接收原始信号,该原始信号包括从6自由度(6DOF)惯性传感器传送的关于加速度和旋转速度的信息;车辆运动估计器,基于来自6DOF惯性传感器的经信号处理器滤波的信号和从车辆传感器传送的车辆测量信息,计算车辆的整体角度。该***还包括:车辆悬架角度估计器,基于来自6DOF惯性传感器的信号和车辆测量信息计算车辆悬架角;以及道路坡度估计器,确定车辆整体角度与车辆悬架角之间的差值以便计算道路坡度。
Description
相关申请的交叉参考
本申请要求2013年4月15日向韩国知识产权局提交的韩国专利申请第10-2013-0040864号的优先权和权益,其公开内容全部引入本文以供参考。
技术领域
本公开涉及用于估计道路坡度的***。
背景技术
通常,车辆稳定性控制装置基于利用二自由度(DOF)惯性传感器的横向加速度和横摆角速度,或基于利用3DOF惯性传感器的纵向加速度、横向加速度、和横摆角速度来估计道路坡度。
在这些情形下,仅在有限条件下例如当车辆在一般条件下转弯(corner)时,可有效地计算道路的横向坡角。然而,当车辆在横向坡角急剧变化的情况下转弯时,难于精确估计横向坡角。
进一步,上述方法很大程度受车辆参数例如质量、轮胎、以及道路摩擦系数的变化的影响,因为其取决于车辆的物理模型。
发明内容
因此,作出本公开以解决现有技术中出现的上述问题,同时现有技术实现的优点保持不变。
本公开提供通过利用6DOF惯性传感器来实时估计道路坡角的***。
本公开的一方面是用于估计道路坡度的***,包括接收原始信号并对其执行滤波的信号处理器,该原始信号包括从6自由度(6DOF)惯性传感器传送的关于加速度和旋转速度的信息。车辆运动估计器基于来自6DOF惯性传感器的经信号处理器滤波的信号并基于从车辆传感器传送的车辆测量信息来计算车辆的整体角度。车辆悬架角估计器基于来自6DOF惯性传感器的信号和车辆测量信息计算车辆悬架角。道路坡度估计器确定车辆的整体角度与车辆悬架角之间的差值,从而计算道路坡度。
车辆传感器可包括转向角传感器和轮速传感器。车辆测量信息可包括转向角测量信息和车速测量信息。
信号处理器可包括偏移补偿器,其对车辆的旋转速度和加速度进行偏移补偿。非对准误差补偿器补偿6DOF惯性传感器自身的误差。
偏移补偿器可使用式1执行车辆的旋转速度校正,并使用等式2执行车辆的加速度校正,
【等式1】
其中ωx、ωy、和ωz分别表示侧倾角速度(roll rate)、俯仰角速度(pitch rate)、以及横摆角速度(yaw rate),
【等式2】
其中αx、αy、和αz分别表示纵向加速度、横向加速度和垂直加速度。
非对准误差补偿器可补偿制造6DOF惯性传感器时的正交误差、6DOF惯性传感器自身的灵敏度误差、以及横轴灵敏度。
车辆运动估计器可包括:使用预定的加速度等式计算车辆的静态侧倾角和俯仰角的静态侧倾/俯仰计算器,以及确定车辆在静态(处于静止状态)时的车辆的初始侧倾角和俯仰角的初始侧倾/俯仰计算器。侧倾/俯仰增益计算器基于车辆测量信息计算侧倾角和俯仰角的加权增益值。整体车辆侧倾/俯仰估计器基于由静态侧倾/俯仰计算器、初始侧倾/俯仰计算器、以及侧倾/俯仰增益计算器所计算的信息来计算车辆的整体侧倾角和俯仰角。
侧倾/俯仰增益计算器通过将来自6DOF惯性传感器的信号和车辆测量信息与俯仰角查询表和侧倾角查询表进行比较,可将权重分配给静态侧倾角和俯仰角。
侧倾/俯仰增益计算器可包括俯仰角权重确定器,其确定纵向加速度、俯仰角速度、后轮的横向滑动角以及横摆角速度的信号水平是否等于或高于参考水平的动态条件。基于俯仰角查询表,静态俯仰角增益值被调节为较小值。侧倾角权重确定器确定转向角的变化率、横向加速度、伪车辆侧倾、以及后轮横向滑动角信号的信号水平是否等于或高于参考水平的动态条件。基于侧倾角查询表,静态侧倾角增益值被调节为较小值。
在通过将纵向加速度、俯仰角速度、后轮的横向滑动角、以及横摆角速度的信号应用到预定的陀螺积分方程而计算的值增加时,俯仰角权重确定器可将静态俯仰角增益值调节为相对小的值。
在通过将转向角的变化率、横向速度、伪车辆侧倾、以及后轮的横向滑动角的信号应用到预定的陀螺积分方程而计算的值增加时,侧倾角权重确定器可将静态侧倾角增益值调节为相对小的值。
参考附图从下面的描述中会更加认识到本公开的各种特征和优点。
附图说明
根据以下结合附图的具体实施方式,本公开的上述和其它目的、特征和优点将更明显,其中:
图1是示出根据本公开实施方式的用于估计道路坡度的***的配置的框图;
图2是详细示出图1中信号处理器的配置的框图;
图3是详细示出图1中车辆运动估计器的配置的框图;并且
图4是详细示出图3中侧倾/俯仰增益计算器的配置的框图。
附图中每个元素的标记
110:信号处理单元
111:偏移补偿单元
113:非对准误差补偿单元
130:车辆运动估计单元
131:静态侧倾/俯仰计算单元
133:初始侧倾/俯仰计算单元
135:侧倾/俯仰增益计算单元
137:整体车辆侧倾/俯仰估计单元
141:俯仰角权重确定单元
143:侧倾角权重确定单元
150:车辆悬架角估计单元
170:道路坡度估计单元
200:6DOF传感器
300:车辆传感器
具体实施方式
根据以下结合附图的具体实施方式,可更清楚地理解本公开的上述和其它目的、特征和优点。须注意不同附图中出现的相同的元件会具有相同的附图标记。进一步,在描述本公开时,可能省略已知特征的描述,以便不使本公开的主旨模糊。下面将参考附图详细描述本公开的实施方式。
参考图1,用于估计道路坡度的***100可包括信号处理器110、车辆运动估计器130、车辆悬架角估计器150、以及道路坡度估计器170。
具体地,信号处理器110可接收原始信号以便执行滤波,该原始信号包括从6自由度(6DOF)惯性传感器200传送的关于加速度和旋转速度的信息。
6DOF惯性传感器200是指能够测量绕三个轴的平移和旋转运动的传感器。
如图2所示,信号处理器110可包括补偿车辆的旋转速度和加速度的偏移(offset)补偿器111,以及补偿由6DOF惯性传感器200自身引起的误差的非对准误差补偿器113。
偏移补偿器111执行陀螺传感器偏移补偿和加速度传感器偏移补偿。陀螺传感器偏移补偿在车辆为静态(处于静止状态)且速度(角速度)在某个值之下时将偏移限定为某个时间段的平均值。加速度传感器偏移补偿在车辆为静态(处于静止状态)且加速度在某个值之下时将偏移限定为某个时间段的平均值。
具体地,偏移补偿器111可使用等式1执行车辆的旋转速度校正,并可使用等式2执行车辆的加速度校正。
【等式1】
ωx、ωy、和ωz分别表示侧倾角速度、俯仰角速度、以及横摆角速度。
【等式2】
αx、αy、和αz分别表示纵向加速度、横向加速度和垂直加速度。
非对准误差补偿器113可补偿制造6DOF惯性传感器200时的正交误差、6DOF惯性传感器自身的灵敏度误差、以及横轴灵敏度。
此处,非对准误差补偿器113可补偿来自6DOF惯性传感器200的信号,偏移补偿器111已经从该信号中除去偏移。
上述非对准误差补偿器113可使用等式3和4补偿6DOF惯性传感器200自身的误差,以使由传感器测量的值的可靠性可以进一步增加。
【等式3】
ωx、ωy、和ωz分别表示侧倾角速度、俯仰角速度、以及横摆角速度。
【等式4】
αx、αy、和αz分别表示纵向加速度、横向加速度和垂直加速度。
车辆运动估计器130可基于来自6DOF惯性传感器的经信号处理器110滤波的信号和从车辆传感器300传送的车辆测量信息计算车辆的整体角度。
车辆传感器300可包括转向角传感器和轮速传感器,因此车辆测量信息可包括转向角测量信息和车速测量信息。
转向角传感器(SAS)用于确定转向、角度、速度并将其输送到车辆动态控制器(VDC)和电子控制单元(ECU)。各自安装于四个车轮中的各个的轮速传感器用于基于音轮(tone wheel)和传感器中磁场线的变化而感测车轮旋转速度。感测的信息被输入到计算机,从而在快速制动时或在滑路上制动时控制液压制动器的压力,以便将车辆保持于控制下并缩短制动距离。
参考图3,车辆运动估计器130可包括静态侧倾/俯仰计算器131、初始侧倾/俯仰计算器133、侧倾/俯仰增益计算器135、以及整体车辆侧倾/俯仰估计器137。
具体地,静态侧倾/俯仰计算器131可使用预定的加速度等式计算静态侧倾角和俯仰角。
更具体地,静态侧倾/俯仰计算器131可基于加速度传感器使用等式5计算静态侧倾角和俯仰角。
【等式5】
ωx、ωy、和ωz分别表示侧倾角速度、俯仰角速度、以及横摆角速度,而αx、αy、和αz分别表示纵向加速度、横向加速度和垂直加速度。
初始侧倾/俯仰计算器133可确定车辆在静态时的初始侧倾角和俯仰角。例如,初始侧倾/俯仰计算器133在车辆开始行驶之前确定初始侧倾角和俯仰角。
侧倾/俯仰增益计算器135可基于车辆测量信息计算侧倾角和俯仰角的加权增益值。此处,加权增益值是指用于确定给定物理量中待反映的静态侧倾角和俯仰角部分的值。也就是说,加权增益值越高,在确定整体侧倾角和俯仰角时反映的静态侧倾角和俯仰角越多。如果加权增益值变得较小,则在确定整体侧倾角和俯仰角时较少地反映静态侧倾角和俯仰角,且陀螺积分方程部分相对增加。
此处,侧倾/俯仰增益计算器135通过将来自6DOF惯性传感器的信号和车辆测量信息与俯仰角查询表和侧倾角查询表进行比较,可将权重分配给静态侧倾角和俯仰角。
也就是说,当车辆处于动态行驶条件时,侧倾/俯仰增益计算器135将更高的权重分配给从陀螺积分方程获得的角度估计,并当车辆处于静态行驶条件时,将更高的权重分配给从加速度传感器获得的角度估计。通过这样做,道路坡度值的计算被更精确地划分。
如图4所示,侧倾/俯仰增益计算器135可包括俯仰角权重确定器141和侧倾角权重确定器143。
俯仰角权重确定器141可考虑纵向加速度、俯仰角速度、后轮的横向滑动角以及横摆角速度的信号,并确定信号水平是否增加到参考水平或更高的动态条件以便基于俯仰角查询表减小静态俯仰角增益值。
此处,在通过将纵向加速度、俯仰角速度、后轮的横向滑动角以及横摆角速度的信号应用到预定陀螺积分方程而计算的值增加时,俯仰角权重确定器141可将静态俯仰角增益值调节为相对小的值。
此处,侧倾角权重确定器143考虑转向角的变化率、横向加速度、伪车辆侧倾和后轮的横向滑动角的信号,并且如果这些信号水平高于参考水平则确定车辆处于动态条件,以使侧倾角权重确定器143可基于侧倾角查询表将静态侧倾角增益值调节为相对小的值。
此处,在通过将转向角的变化率、横向速度、伪车辆侧倾、以及后轮的横向滑动角的信号应用到预定陀螺积分方程而计算的值增加时,侧倾角权重确定器143可将静态侧倾角增益值调节为相对小的值。
伪车辆侧倾意味着横向加速度-纵向速度*横摆角速度-横向速度Vy的时间导数。
整体车辆侧倾/俯仰估计器137可基于由静态侧倾/俯仰计算器131、初始侧倾/俯仰计算器133和侧倾/俯仰增益计算器135计算的信息来计算整体车辆侧倾角和俯仰角。
具体地,整体车辆侧倾/俯仰估计器137可使用等式6计算整体车辆侧倾角和俯仰角。
【等式6】
ωx、ωy、和ωz分别表示侧倾角速度、俯仰角速度、以及横摆角速度,而αx、αy、和αz分别表示纵向加速度、横向加速度和垂直加速度。
进一步,表示静态侧倾角和俯仰角,k侧倾表示侧倾角增益值,k俯仰表示俯仰角增益值,且 表示侧倾角、俯仰角和横摆角。
此外,车辆悬架角估计器150可基于来自6DOF惯性传感器的信号和车辆测量信息计算车辆悬架角。
具体地,车辆悬架角估计器150可使用等式7计算车辆悬架角。
【等式7】
表示车辆悬架侧倾角,θsus_俯仰表示车辆悬架俯仰角,T表示常数,且Ksus表示增益值。
道路坡度估计器170可确定整体车辆角度与车辆悬架角之间的差值,从而计算道路坡度。道路坡度估计器170可通过从由车辆运动估计器130估计的整体车辆角度中减去由车辆悬架角估计器150估计的车辆悬架角来计算道路坡度。
根据本公开的实施方式,在车辆悬架侧倾角和道路横向坡角都存在的情形中,其可被彼此独立地正确估计。
此外,道路坡度估计***100可改善安装在车辆上的多种部件,因此改善适销性,并提供更好的驾驶体验。例如,借助道路坡度估计***100,安装在车辆中的电子防滑控制器(ESC)可实现灵敏度控制劣化的改进和对横向倾斜道路的控制,电动机驱动的动力转向器(MDPS)可减小横向倾斜道路上的倾斜,车道保持辅助***(LKAS)可改善横向倾斜道路上的车道保持转向体验,且智能巡航控制器(SCC)可改善纵向倾斜道路上的车速控制一致性体验。
如上所述,可通过利用6DOF惯性传感器以及转向车轮传感器和轮速传感器来实时地估计车辆的侧倾/俯仰角和道路的纵向/横向坡度。
进一步,实时彼此独立地估计车辆的侧倾/俯仰角和道路的坡角,且根据驾驶条件将权重可变地分配给车辆中的部件,从而改善分析的道路坡度的可靠性。
尽管为了示例说明的目的公开了本公开的实施方式,但可以理解,本公开不限于这些,且本领域技术人员将理解可以进行各种修改、添加和替换,而不偏离本公开的范围和精神。
因此,任何和所有修改、变化或等效布置都应视作落入本公开的范围内,且本公开的范围仅由权利要求限定。
Claims (10)
1.一种用于估计道路坡度的***,包括:
信号处理器,接收原始信号并对其执行滤波,所述原始信号包括从6自由度(6DOF)惯性传感器传送的关于加速度和旋转速度的信息;
车辆运动估计器,基于来自所述6DOF惯性传感器的经所述信号处理器滤波的信号并基于从车辆传感器传送的车辆测量信息,计算车辆整体角度;
车辆悬架角估计器,基于来自所述6DOF惯性传感器的信号和所述车辆测量信息,计算车辆悬架角;以及
道路坡度估计器,确定所述车辆整体角度和所述车辆悬架角之间的差值以便计算道路坡度。
2.根据权利要求1所述的***,其中所述车辆传感器包括转向角传感器和轮速传感器;并且
所述车辆测量信息包括转向角测量信息和车速测量信息。
3.根据权利要求1所述的***,其中所述信号处理器包括:
偏移补偿器,对车辆的所述旋转速度和所述加速度进行偏移补偿;以及
非对准误差补偿器,补偿所述6DOF惯性传感器自身的误差。
4.根据权利要求3所述的***,其中所述偏移补偿器使用等式1执行车辆的旋转速度校正,并使用等式2执行车辆的加速度校正:
【等式1】
其中ωx、ωy、和ωz分别表示侧倾角速度、俯仰角速度、以及横摆角速度;并且
【等式2】
其中αx、αy、和αz分别表示纵向加速度、横向加速度和垂直加速度。
5.根据权利要求3所述的***,其中所述非对准误差补偿器补偿制造所述6DOF惯性传感器时的正交误差、所述6DOF惯性传感器自身的灵敏度误差、以及横轴灵敏度。
6.根据权利要求1所述的***,其中所述车辆运动估计器包括:
静态侧倾/俯仰计算器,使用预定的加速度等式计算车辆的静态侧倾角和俯仰角;
初始侧倾/俯仰计算器,确定车辆在静态时的车辆的初始侧倾角和俯仰角;
侧倾/俯仰增益计算器,基于所述车辆测量信息计算所述侧倾角和俯仰角的加权增益值;以及
整体车辆侧倾/俯仰估计器,基于由所述静态侧倾/俯仰计算器、所述初始侧倾/俯仰计算器、以及所述侧倾/俯仰增益计算器计算的信息,计算车辆的整体侧倾角和俯仰角。
7.根据权利要求6所述的***,其中所述侧倾/俯仰增益计算器通过将来自所述6DOF惯性传感器的信号和所述车辆测量信息与俯仰角查询表和侧倾角查询表进行比较,将权重分配给所述静态侧倾角和俯仰角。
8.根据权利要求7所述的***,其中所述侧倾/俯仰增益计算器包括:
俯仰角权重确定器,确定纵向加速度、俯仰角速度、后轮的横向滑动角以及横摆角速度的信号水平是否等于或高于参考水平的动态条件,并基于所述俯仰角查询表将静态俯仰角增益值调节为较小值;以及
侧倾角权重确定器,确定转向角的变化率、横向加速度、伪车辆侧倾、以及后轮的横向滑动角信号的信号水平是否等于或高于参考水平的动态条件,并基于所述侧倾角查询表将静态侧倾角增益值调节为较小值。
9.根据权利要求8所述的***,其中在通过将所述纵向加速度、所述俯仰角速度、所述后轮的横向滑动角、以及所述横摆角速度的信号应用到预定的陀螺积分方程而计算的值增加时,所述俯仰角权重确定器将所述静态俯仰角增益值调节为相对小的值。
10.根据权利要求8所述的***,其中在通过将所述转向角的变化率、所述横向加速度、所述伪车辆侧倾、以及所述后轮的横向滑动角的信号应用到预定的陀螺积分方程而计算的值增加时,所述侧倾角权重确定器将所述静态侧倾角增益值调节为相对小的值。
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR10-2013-0040864 | 2013-04-15 | ||
KR1020130040864A KR101500070B1 (ko) | 2013-04-15 | 2013-04-15 | 도로경사 추정 시스템 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN104097641A true CN104097641A (zh) | 2014-10-15 |
Family
ID=51666291
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201310418591.XA Pending CN104097641A (zh) | 2013-04-15 | 2013-09-13 | 用于估计道路坡度的*** |
Country Status (3)
Country | Link |
---|---|
US (1) | US20140309803A1 (zh) |
KR (1) | KR101500070B1 (zh) |
CN (1) | CN104097641A (zh) |
Cited By (18)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105711590A (zh) * | 2016-05-03 | 2016-06-29 | 重庆长安汽车股份有限公司 | 一种坡道起步辅助控制方法和装置 |
CN106004830A (zh) * | 2016-07-20 | 2016-10-12 | 中车青岛四方机车车辆股份有限公司 | 轨道车辆自适应坡度制动控制方法及*** |
CN106143494A (zh) * | 2015-05-14 | 2016-11-23 | 现代自动车株式会社 | 使用重力加速度传感器估算道路坡度的装置和方法 |
CN106643802A (zh) * | 2016-12-28 | 2017-05-10 | 北京奇艺世纪科技有限公司 | 一种陀螺仪漂移校正方法及装置 |
CN107257748A (zh) * | 2015-02-28 | 2017-10-17 | 奥迪股份公司 | 用于补偿倾斜度的方法 |
CN107933564A (zh) * | 2017-11-16 | 2018-04-20 | 盯盯拍(深圳)技术股份有限公司 | 道路坡度估算方法、道路坡度估算装置、终端设备以及计算机可读存储介质 |
CN109154981A (zh) * | 2016-03-15 | 2019-01-04 | 无比视视觉技术有限公司 | 带有横向坡度的道路平面输出 |
CN109839122A (zh) * | 2017-11-29 | 2019-06-04 | 高德信息技术有限公司 | 一种车辆行驶状态的确定方法和装置 |
CN110155074A (zh) * | 2018-02-14 | 2019-08-23 | 艾默林***公司 | 用于确定机动车辆的整体俯仰度的自主方法和装置 |
CN110386143A (zh) * | 2018-04-18 | 2019-10-29 | 比亚迪股份有限公司 | 道路横坡角检测方法和装置、车辆控制方法和装置、车辆 |
CN111038519A (zh) * | 2019-12-26 | 2020-04-21 | 一汽解放汽车有限公司 | 一种车载道路坡度实时估计方法 |
CN111486860A (zh) * | 2019-01-29 | 2020-08-04 | 通用汽车环球科技运作有限责任公司 | 用于确定道路倾斜角的***和方法 |
WO2021036862A1 (zh) * | 2019-08-30 | 2021-03-04 | 华为技术有限公司 | 车辆控制方法、相关设备及计算机存储介质 |
CN112537320A (zh) * | 2019-09-23 | 2021-03-23 | 通用汽车环球科技运作有限责任公司 | 使用俯仰和侧倾模型的悬架故障诊断和预测 |
CN112572413A (zh) * | 2019-09-29 | 2021-03-30 | 广州汽车集团股份有限公司 | 车辆制动控制方法、装置、计算机设备及存储介质 |
CN113071502A (zh) * | 2019-12-18 | 2021-07-06 | 现代摩比斯株式会社 | 使用摄像机信息的道路坡度补偿***及其方法 |
WO2022011499A1 (en) * | 2020-07-13 | 2022-01-20 | Gudsen Engineering, Inc. | Vehicle sensors arrangement and method for mapping road profiles |
WO2023138480A1 (zh) * | 2022-01-18 | 2023-07-27 | 三一汽车制造有限公司 | 作业机械的轮胎离地检测方法、装置及作业机械 |
Families Citing this family (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP5846401B2 (ja) * | 2012-10-31 | 2016-01-20 | トヨタ自動車株式会社 | 車両の走行制御装置 |
KR101601104B1 (ko) * | 2014-09-22 | 2016-03-08 | 현대자동차주식회사 | G센서를 이용한 도로 구배 연산 장치 및 방법 |
DE102015002601A1 (de) * | 2015-02-28 | 2016-09-01 | Audi Ag | Verfahren zum Erfassen einer Neigung einer Fahrbahn |
CN105329238B (zh) * | 2015-12-04 | 2017-08-08 | 北京航空航天大学 | 一种基于单目视觉的自动驾驶汽车换道控制方法 |
KR20170084830A (ko) | 2016-01-13 | 2017-07-21 | 현대자동차주식회사 | 현가장치를 이용한 차량의 요(yaw) 운동 제어 방법 및 장치 |
JP6547065B2 (ja) * | 2016-04-06 | 2019-07-17 | ヤマハ発動機株式会社 | 姿勢推定装置及び輸送機器 |
CN107679496B (zh) * | 2017-10-10 | 2020-11-10 | 深圳地平线机器人科技有限公司 | 控制车辆的方法和装置以及包括该装置的车辆 |
KR101977749B1 (ko) | 2017-11-21 | 2019-08-28 | 현대오트론 주식회사 | 노면 기울기를 이용한 차량 위치 추정 장치 및 그것의 위치 추정 방법 |
CN108297872B (zh) * | 2018-03-08 | 2023-05-05 | 中国第一汽车股份有限公司 | 全工况车载路面坡度估算装置和方法 |
EP3782895B1 (de) * | 2019-08-20 | 2022-06-08 | Amprio GmbH | Elektrofahrrad |
KR20220023910A (ko) * | 2020-08-21 | 2022-03-03 | 현대자동차주식회사 | 차량의 경사각 측정 방법 및 그 측정 장치 |
CN113085875B (zh) * | 2021-03-23 | 2022-12-27 | 浙江吉利控股集团有限公司 | 基于俯仰角与纵向坡度角确定纵向加速度方法及装置 |
KR20220141413A (ko) * | 2021-04-13 | 2022-10-20 | 현대자동차주식회사 | 도로 상태 감지 방법 및 그 방법을 제공하는 자동차 시스템 |
CN113799783B (zh) * | 2021-10-09 | 2023-08-22 | 摩登汽车有限公司 | 应用于车辆的道路横向坡度测量方法及*** |
CN113942518B (zh) * | 2021-11-30 | 2023-07-14 | 北京经纬恒润科技股份有限公司 | 一种路面纵向坡度计算方法和装置 |
CN115655270B (zh) * | 2022-11-30 | 2024-04-19 | 湖南航天机电设备与特种材料研究所 | 一种惯组等效零位偏移误差补偿方法及*** |
Family Cites Families (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6324446B1 (en) * | 1999-12-21 | 2001-11-27 | Ford Global Technologies, Inc. | Roll over stability control for an automotive vehicle |
US6834218B2 (en) * | 2001-11-05 | 2004-12-21 | Ford Global Technologies, Llc | Roll over stability control for an automotive vehicle |
US6263261B1 (en) * | 1999-12-21 | 2001-07-17 | Ford Global Technologies, Inc. | Roll over stability control for an automotive vehicle |
US7676307B2 (en) * | 2001-11-05 | 2010-03-09 | Ford Global Technologies | System and method for controlling a safety system of a vehicle in response to conditions sensed by tire sensors related applications |
US6718248B2 (en) * | 2002-06-19 | 2004-04-06 | Ford Global Technologies, Llc | System for detecting surface profile of a driving road |
US6684140B2 (en) * | 2002-06-19 | 2004-01-27 | Ford Global Technologies, Llc | System for sensing vehicle global and relative attitudes using suspension height sensors |
US6941205B2 (en) * | 2002-08-01 | 2005-09-06 | Ford Global Technologies, Llc. | System and method for deteching roll rate sensor fault |
US7222007B2 (en) * | 2004-01-07 | 2007-05-22 | Ford Global Technologies, Llc | Attitude sensing system for an automotive vehicle relative to the road |
JP5393432B2 (ja) * | 2009-12-21 | 2014-01-22 | ヤマハ発動機株式会社 | ロール角推定装置および輸送機器 |
KR20110077454A (ko) * | 2009-12-30 | 2011-07-07 | (주)마이크로인피니티 | 이동체의 위치 및 자세를 결정하는 시스템 및 방법 |
JP5794624B2 (ja) * | 2011-07-26 | 2015-10-14 | 本田技研工業株式会社 | 自動二輪車のピッチ角推定装置及びピッチ角推定プログラム |
-
2013
- 2013-04-15 KR KR1020130040864A patent/KR101500070B1/ko active IP Right Grant
- 2013-08-28 US US14/012,716 patent/US20140309803A1/en not_active Abandoned
- 2013-09-13 CN CN201310418591.XA patent/CN104097641A/zh active Pending
Cited By (29)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107257748A (zh) * | 2015-02-28 | 2017-10-17 | 奥迪股份公司 | 用于补偿倾斜度的方法 |
CN107257748B (zh) * | 2015-02-28 | 2019-07-19 | 奥迪股份公司 | 用于补偿倾斜度的方法 |
CN106143494A (zh) * | 2015-05-14 | 2016-11-23 | 现代自动车株式会社 | 使用重力加速度传感器估算道路坡度的装置和方法 |
CN109154981B (zh) * | 2016-03-15 | 2022-04-05 | 无比视视觉技术有限公司 | 处理道路表面视觉数据的方法、***及存储介质 |
CN109154981A (zh) * | 2016-03-15 | 2019-01-04 | 无比视视觉技术有限公司 | 带有横向坡度的道路平面输出 |
US11651595B2 (en) | 2016-03-15 | 2023-05-16 | Mobileye Vision Technologies Ltd. | Road plane output with lateral slope |
CN105711590A (zh) * | 2016-05-03 | 2016-06-29 | 重庆长安汽车股份有限公司 | 一种坡道起步辅助控制方法和装置 |
CN106004830B (zh) * | 2016-07-20 | 2018-11-27 | 中车青岛四方机车车辆股份有限公司 | 轨道车辆自适应坡度制动控制方法及*** |
CN106004830A (zh) * | 2016-07-20 | 2016-10-12 | 中车青岛四方机车车辆股份有限公司 | 轨道车辆自适应坡度制动控制方法及*** |
CN106643802A (zh) * | 2016-12-28 | 2017-05-10 | 北京奇艺世纪科技有限公司 | 一种陀螺仪漂移校正方法及装置 |
CN107933564B (zh) * | 2017-11-16 | 2020-11-13 | 盯盯拍(深圳)技术股份有限公司 | 道路坡度估算方法、道路坡度估算装置、终端设备以及计算机可读存储介质 |
CN107933564A (zh) * | 2017-11-16 | 2018-04-20 | 盯盯拍(深圳)技术股份有限公司 | 道路坡度估算方法、道路坡度估算装置、终端设备以及计算机可读存储介质 |
CN109839122A (zh) * | 2017-11-29 | 2019-06-04 | 高德信息技术有限公司 | 一种车辆行驶状态的确定方法和装置 |
CN110155074A (zh) * | 2018-02-14 | 2019-08-23 | 艾默林***公司 | 用于确定机动车辆的整体俯仰度的自主方法和装置 |
CN110155074B (zh) * | 2018-02-14 | 2024-04-16 | 艾默林***公司 | 用于确定机动车辆的整体俯仰度的自主方法和装置 |
CN110386143A (zh) * | 2018-04-18 | 2019-10-29 | 比亚迪股份有限公司 | 道路横坡角检测方法和装置、车辆控制方法和装置、车辆 |
CN110386143B (zh) * | 2018-04-18 | 2021-02-23 | 比亚迪股份有限公司 | 道路横坡角检测方法和装置、车辆控制方法和装置、车辆 |
CN111486860B (zh) * | 2019-01-29 | 2024-04-26 | 通用汽车环球科技运作有限责任公司 | 用于确定道路倾斜角的***和方法 |
CN111486860A (zh) * | 2019-01-29 | 2020-08-04 | 通用汽车环球科技运作有限责任公司 | 用于确定道路倾斜角的***和方法 |
WO2021036862A1 (zh) * | 2019-08-30 | 2021-03-04 | 华为技术有限公司 | 车辆控制方法、相关设备及计算机存储介质 |
CN112537320A (zh) * | 2019-09-23 | 2021-03-23 | 通用汽车环球科技运作有限责任公司 | 使用俯仰和侧倾模型的悬架故障诊断和预测 |
CN112572413A (zh) * | 2019-09-29 | 2021-03-30 | 广州汽车集团股份有限公司 | 车辆制动控制方法、装置、计算机设备及存储介质 |
US11691671B2 (en) | 2019-12-18 | 2023-07-04 | Hyundai Mobis Co., Ltd. | System for road slope compensation using camera information and method thereof |
CN113071502B (zh) * | 2019-12-18 | 2023-12-01 | 现代摩比斯株式会社 | 使用摄像机信息的道路坡度补偿***及其方法 |
CN113071502A (zh) * | 2019-12-18 | 2021-07-06 | 现代摩比斯株式会社 | 使用摄像机信息的道路坡度补偿***及其方法 |
CN111038519A (zh) * | 2019-12-26 | 2020-04-21 | 一汽解放汽车有限公司 | 一种车载道路坡度实时估计方法 |
US11884278B2 (en) | 2020-07-13 | 2024-01-30 | Shenzhen Gudsen Technology Co., Ltd | Vehicle sensors arrangement and method for mapping the road profiles |
WO2022011499A1 (en) * | 2020-07-13 | 2022-01-20 | Gudsen Engineering, Inc. | Vehicle sensors arrangement and method for mapping road profiles |
WO2023138480A1 (zh) * | 2022-01-18 | 2023-07-27 | 三一汽车制造有限公司 | 作业机械的轮胎离地检测方法、装置及作业机械 |
Also Published As
Publication number | Publication date |
---|---|
KR20140123708A (ko) | 2014-10-23 |
US20140309803A1 (en) | 2014-10-16 |
KR101500070B1 (ko) | 2015-03-06 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104097641A (zh) | 用于估计道路坡度的*** | |
CN105842684B (zh) | 采用雷达数据的车辆运动估计增强 | |
US8280586B2 (en) | Determination of the actual yaw angle and the actual slip angle of a land vehicle | |
CN106004994B (zh) | 基于eps和车辆模型的表面摩擦系数的连续估算 | |
US9020680B2 (en) | Travel direction determination method and system | |
JP4161923B2 (ja) | 車両安定化制御システム | |
EP3178724B1 (en) | Vehicle steering arrangement, autonomous vehicle steering arrangement, a vehicle, and a method of steering a vehicle | |
Park et al. | Integrated observer approach using in-vehicle sensors and GPS for vehicle state estimation | |
CN103608229B (zh) | 用于调节车辆行驶动态的装置和方法及带这种装置的车辆 | |
CN103832435B (zh) | 车道保持控制装置 | |
US20150251664A1 (en) | Method to control a vehicle path during autonomous braking | |
CN101837781A (zh) | 用于自动车道对正或换道的控制***的基于模型的预测控制 | |
US10668928B2 (en) | Method and device for estimating the friction values of a wheel of a vehicle against a substrate | |
CN105073526A (zh) | 车辆参考速度确定方法和利用这种方法的车辆控制装置 | |
CN103796885A (zh) | 用于评估车辆的轮胎参数的方法 | |
US20080228329A1 (en) | Methods and systems for friction detection and slippage control | |
US9534891B2 (en) | Method and system of angle estimation | |
CN109677415B (zh) | 用于估计车辆的曲率半径的装置和方法 | |
US8594887B1 (en) | Method and system for measuring tilt angle during turn of vehicle | |
JP5955465B2 (ja) | 車両のステアリングコラムの操舵角を求める自動車、システム及び方法 | |
CN106232446A (zh) | 用于确定惯性传感器的误差的方法 | |
US11002539B2 (en) | Method for detecting a slope of a road | |
KR101208369B1 (ko) | 차량 경로 예측 장치 및 그 방법 | |
KR102303230B1 (ko) | 차량의 곡률 반경 추정장치 및 그 방법 | |
US8532878B2 (en) | Method and device for detecting and compensating for a transverse inclination of a roadway on which a vehicle is traveling |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C02 | Deemed withdrawal of patent application after publication (patent law 2001) | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20141015 |