CN105291958A - 基于车辆相对于道路的倾斜角来控制机电系统的方法和设备 - Google Patents

基于车辆相对于道路的倾斜角来控制机电系统的方法和设备 Download PDF

Info

Publication number
CN105291958A
CN105291958A CN201510383493.6A CN201510383493A CN105291958A CN 105291958 A CN105291958 A CN 105291958A CN 201510383493 A CN201510383493 A CN 201510383493A CN 105291958 A CN105291958 A CN 105291958A
Authority
CN
China
Prior art keywords
data sample
vehicle
accel
suspension
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.)
Granted
Application number
CN201510383493.6A
Other languages
English (en)
Other versions
CN105291958B (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.)
Meixin Semiconductor Wuxi Co Ltd
Memsic Inc
Original Assignee
Meixin Semiconductor Wuxi 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 Meixin Semiconductor Wuxi Co Ltd filed Critical Meixin Semiconductor Wuxi Co Ltd
Publication of CN105291958A publication Critical patent/CN105291958A/zh
Application granted granted Critical
Publication of CN105291958B publication Critical patent/CN105291958B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60QARRANGEMENT OF SIGNALLING OR LIGHTING DEVICES, THE MOUNTING OR SUPPORTING THEREOF OR CIRCUITS THEREFOR, FOR VEHICLES IN GENERAL
    • B60Q1/00Arrangement of optical signalling or lighting devices, the mounting or supporting thereof or circuits therefor
    • B60Q1/02Arrangement of optical signalling or lighting devices, the mounting or supporting thereof or circuits therefor the devices being primarily intended to illuminate the way ahead or to illuminate other areas of way or environments
    • B60Q1/04Arrangement of optical signalling or lighting devices, the mounting or supporting thereof or circuits therefor the devices being primarily intended to illuminate the way ahead or to illuminate other areas of way or environments the devices being headlights
    • B60Q1/06Arrangement of optical signalling or lighting devices, the mounting or supporting thereof or circuits therefor the devices being primarily intended to illuminate the way ahead or to illuminate other areas of way or environments the devices being headlights adjustable, e.g. remotely-controlled from inside vehicle
    • B60Q1/08Arrangement of optical signalling or lighting devices, the mounting or supporting thereof or circuits therefor the devices being primarily intended to illuminate the way ahead or to illuminate other areas of way or environments the devices being headlights adjustable, e.g. remotely-controlled from inside vehicle automatically
    • B60Q1/10Arrangement of optical signalling or lighting devices, the mounting or supporting thereof or circuits therefor the devices being primarily intended to illuminate the way ahead or to illuminate other areas of way or environments the devices being headlights adjustable, e.g. remotely-controlled from inside vehicle automatically due to vehicle inclination, e.g. due to load distribution
    • B60Q1/115Arrangement of optical signalling or lighting devices, the mounting or supporting thereof or circuits therefor the devices being primarily intended to illuminate the way ahead or to illuminate other areas of way or environments the devices being headlights adjustable, e.g. remotely-controlled from inside vehicle automatically due to vehicle inclination, e.g. due to load distribution by electric means
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60QARRANGEMENT OF SIGNALLING OR LIGHTING DEVICES, THE MOUNTING OR SUPPORTING THEREOF OR CIRCUITS THEREFOR, FOR VEHICLES IN GENERAL
    • B60Q1/00Arrangement of optical signalling or lighting devices, the mounting or supporting thereof or circuits therefor
    • B60Q1/0017Devices integrating an element dedicated to another function
    • B60Q1/0023Devices integrating an element dedicated to another function the element being a sensor, e.g. distance sensor, camera
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Estimation 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/10Estimation 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 vehicle motion
    • B60W40/11Pitch movement
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C9/00Measuring inclination, e.g. by clinometers, by levels
    • G01C9/02Details
    • G01C9/08Means for compensating acceleration forces due to movement of instrument
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60QARRANGEMENT OF SIGNALLING OR LIGHTING DEVICES, THE MOUNTING OR SUPPORTING THEREOF OR CIRCUITS THEREFOR, FOR VEHICLES IN GENERAL
    • B60Q2300/00Indexing codes for automatically adjustable headlamps or automatically dimmable headlamps
    • B60Q2300/10Indexing codes relating to particular vehicle conditions
    • B60Q2300/13Attitude of the vehicle body
    • B60Q2300/132Pitch

Landscapes

  • Engineering & Computer Science (AREA)
  • Mechanical Engineering (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Automation & Control Theory (AREA)
  • Mathematical Physics (AREA)
  • Transportation (AREA)
  • Lighting Device Outwards From Vehicle And Optical Signal (AREA)
  • Vehicle Body Suspensions (AREA)
  • General Engineering & Computer Science (AREA)

Abstract

本发明涉及一种方法和系统,所述方法和系统用于通过2轴或3轴加速计、倾斜仪等确定移动车辆的悬置部相对于道路的倾斜角,以用于控制依赖于倾斜的系统或装置。所述方法和系统提供了对车辆的悬置部相对于车辆的非悬置部的倾斜角度的确定。由于车辆的纵向(x轴)和/或纬向(y轴)加速度,所述倾斜角度源自对沿着与车辆垂直的轴线(z轴)的加速度的依赖性。

Description

基于车辆相对于道路的倾斜角来控制机电系统的方法和设备
技术领域
本发明总体涉及控制车辆的机电系统技术,尤其涉及基于车辆相对于道路的倾斜角来控制机电系统的方法和设备。
背景技术
当车辆静止时,通过使用2轴或3轴加速计,可以确定车辆在俯仰和滚转(θT、ρT)方面的总倾斜,以通过使用三角函数来确定相对于轴的重力矢量的方向。例如,由于θT=arcsine(沿着x轴的加速度)以及ρT=arcsine(沿着y轴的加速度),所以可以通过设置在与车辆的纵轴和纬轴θT和ρT平行的平面中的2轴加速计提供的加速度数据来计算θT和ρT。对于设置在与车辆(该车辆的x轴与车辆的纵轴对准)垂直的平面中的2轴加速计,θT作为沿着x轴的加速度与沿着z轴的加速度之比的反正切而计算。添加正交的第三轴允许通过使用反正切方法进行俯仰和滚转的计算。然而,在正常运行期间,车辆会经历沿着多个轴的加速度,由于重力的影响,这些轴的加速度的幅度相似。低通滤波可以去除大多数干扰加速度,但是不能去除与道路倾斜变化相关联的慢变加速度。
利用加速计或倾斜仪在车辆处于运动时测量车辆的悬置部相对于车辆的非悬置部的倾斜角(θv)以用于确定车辆的加载状况。通常,车辆加载状况在车辆处于运动时不会改变,因此,θv不会改变。道路倾斜变化和与移动车辆相关联的法向加速度的幅度比与车辆悬置系统的姿势变化相关联的加速度变化大得多。道路倾斜可以改变大约±15度,而车辆的悬置部相对于车辆的非悬置部仅改变接近±1.5度。
需要具有一种能够不依赖有助于控制车前灯调平系统或可替代地其他机电或电子控制系统的道路倾斜(θr)而高准确度地计算倾斜角度θv的方法和系统。
发明内容
根据本发明,公开了一种不依赖道路倾斜获取对移动车辆的悬置部相对于非悬置部的倾斜测量的系统和方法。通过检测与车辆的悬置部垂直的加速度(z轴)相对于车辆的悬置部的纬向加速度(x轴)的依赖性,来获取该测量。在一个实施例中,从加速度测量装置,诸如加速计,收集与两个或两个以上的轴相对应的加速度数据。滤波装置对加速度数据进行滤波以提供滤波后的加速度数据,并且将滤波后的加速度数据存储在存储器中。处理器生成最小二乘最佳拟合线性回归并且通过该最小二乘最佳拟合线性回归计算斜率,该最小二乘最佳拟合线性回归与车辆相对于道路的倾斜角度相对应。在一个实施例中,系统产生指示车辆悬置部相对于道路的倾斜角的输出,该输出用于控制机电系统,诸如车前灯调平系统。
结合附图,基于对下述其实施例的详细描述的审查,本发明的其它目标、特征和优点将是显而易见的。
附图说明
通过下述结合附图的详细描述,本发明将易于理解,其中类似的附图标记指示类似的结构元件,并且其中:
图1A图示了在车辆的悬置部与车辆的非悬置部对准的正常条件下在车辆加速度和减速度矢量与加速度测量矢量之间的关系的示意图;
图1B图示了在车辆的悬置部与车辆的非悬置部未对准的条件下在车辆加速度和减速度矢量与加速度测量矢量之间的关系的示意图;
图2A和图2B是在车辆处于加载状况1下进行路测得到的时间序列加速度数据;
图3A和图3B是在车辆处于加载状况1下进行路测得到的滤波后的时间序列加速度数据;
图4A和图4B是z加速度对x加速度的散布图和计算得到的分别在(图2A和图2B)和(图3A和图3B)中的数据的线性回归线;
图5A和图5B是在车辆处于加载状况2下进行路测得到的时间序列加速度数据;
图6A和图6B是在车辆处于加载状况2下进行路测得到的滤波后的时间序列加速度数据;
图7A和图7B是z加速度对x加速度的散布图和计算得到的分别在(图5A和图5B)和(图6A和图6B)中的数据的线性回归线;
图8A是根据本发明的倾斜计算系统的框图;
图8B是图示了根据本发明的信号处理的示意图;以及
图9是图示了根据本发明的示例性方法的流程图。
具体实施方式
美国临时专利申请62/020,704及其公开的全部内容以引用的方式并入本文。
下面从车辆的悬置部相对于道路或车辆的非悬置部的倾斜角的测量方面对本发明的方法和系统进行描述。以下说明和示例是对本发明的实施例的图示,并且不应认为是对本发明的范围的限制。
在图中:
θv是车辆的悬置部参照道路和车辆的非悬置部的倾斜角;即,之间的角度;
θr=道路倾斜相对于水平地面的角度;
g=由于重力产生的加速度的幅度。
图1A图示了在车辆的悬置部与车辆的非悬置部对准的正常条件下在车辆100加速度和减速度矢量与加速度测量矢量之间的关系。图1B图示了在车辆的悬置部与车辆的非悬置部未对准的条件下在车辆100加速度和减速度矢量与加速度测量矢量之间的关系。加速度测量轴相对于车辆加速度和减速度轴的角度变化为θv。通常,当车辆处于运动中时,在图1A和图1B中在上测得的加速度的幅度是凸起与道路噪声生成的加速度Az_road、道路相对于与地面平行的水平面的倾斜角θr、以及车辆的悬置部相对于道路或车辆的非悬置部的倾斜角θv(如图1A和1B所示)的函数。
Az=f(Az_road,θv,θr)[1]
以及,更加具体地:
A z = ( A z _ r o a d * c o s ( θ v ) + g * cos ( θ r + θ v ) + A x cosθ v * sinθ v ) - - - [ 2 ]
当θv=0,在等式1和2中的最后一项变为0,以及Az不依赖于
当θv≠0,Az依赖于并且将随着而改变。换言之,当θv不等于0时,对于任何给定的道路倾斜,变化都会产生幅度等于的Az变化。
通过使用z和x而非Az和Ax,对Az与Ax求微分,得到:
d [ z ] d x = tanθ v - - - [ 3 ]
θ v = tan - 1 [ d [ z ] d x ] - - - [ 4 ]
图2A和图2B分别是在加载状况1下在约8分钟行车期间每秒32个样本记录的Az和Ax加速度测量。加载状况1具有-1.89度的倾斜角θv。在图2A中的Az加速度可以看出:
1、平均值接近1g,这是因为其几乎与车辆的悬置部垂直,因此与重力矢量紧密对准;
2、由于道路中的凸起和道路噪声,存在明显加速度,该加速度大约为±0.4g;以及
3、大加速度行程持续较短。
在图2B中的Ax加速度可以看出:
1、平均值接近0g,这是因为其几乎与车辆的悬置部平行,因此与重力矢量几乎正交;
2、存在与改变车辆速度相关联的明显加速度,该加速度的幅度大约为±0.4g;以及
3、相较于Az加速度时间序列,大加速度行程持续得更久。
图4A是图2A和2B中的数据的Az加速度对Ax加速度的散布图和计算得到的最小二乘最佳拟合线性回归线(leastsquaresbestfitlinearregressionline)。计算得到的回归线的斜率为0.0268。该线的斜率接近Tan(θv)。对该斜率求反正切得到1.54度的倾斜角。由于在路测期间车辆中的轴的设置,符号需要反过来。所以,测量计算得到的有效倾斜角为-1.54度。该结果与加载状况1设置的-1.89度具有-0.35度的误差。
图3A和图3B是如图2A和图2B中的但是利用32个样本固定窗口平均值处理之后的数据集,产生1Hz的有效采样率。从图3A中的Az加速度可以看出:
1、平均值仍然接近1g;以及
2、短期内道路噪声得到明显衰减,所以数据范围现在小于平均值±0.03g。
从图3B中的Ax加速度可以看出:
1、平均值仍然接近0g;以及
2、车辆加速度(Ax)未明显衰减,加速度维持在大于±0.3g。
图4B是图3A和3B中的处理后的数据的Az加速度对Ax加速度的散布图和计算得到的最小二乘最佳拟合线性回归线。该线的斜率为0.0331。该线的斜率现在更加接近Tan(θv)。在符号反转之后,对该斜率求反正切得到-1.90度的倾斜角度。该结果与加载状况1设置的-1.89度的误差小于0.01度。
改变加载状况(加载状况2),有效的倾斜角θv为2.16度。在图5A和图5B中示出了在路测期间记录的Az和Ax加速度时间序列数据。图7A示出了图5A和图5B中数据的Az加速度对Ax加速度的散布图和计算得到的线性回归线。该线的斜率为-0.0339,以及,在改变符号之后,由此计算得到的倾斜角θv为1.94度。与加载状况2设置的2.16度的误差为0.22度。
图6A和图6B是在图5A和图5B中的利用32个样本固定窗口平均值处理之后的数据集,产生1Hz的有效采样率。图7B示出了图6A和图6B中处理后的数据的Az加速度对Ax加速度的散布图和计算得到的线性回归线。该线的斜率为-0.0372,以及,在改变符号之后,由此计算得到的倾斜角度θv为2.13度。与加载状况2设置的2.16度的误差小于0.03度。
上面详细说明的适用于在多次行车期间收集的加速度数据的方法在确定车辆的悬置部相对于车辆的非悬置部的倾斜角θv方面已经展示出好过0.1度的准确度。
本文中详细说明的实施例仅使用z和x加速度数据和简单的固定窗口平均值作为滤波方法来图示本技术和可实现的结果,但是不应该认为是排除了其他加速度轴或更高级的滤波技术、有效的采样率等。
在图8A中图示了一个框图,该框图图示了当前所公开的系统的一个实施例。该系统包括联接至存储器202的处理器150。处理器150执行来自存储器202的程序指令,以执行当前在本文中所描述的功能。处理器从第一加速计200a接收x和z轴加速度数据进行用于俯仰角确定,该第一加速计200a定向在与车辆垂直的平面中,该车辆的x轴与车辆的纵轴对准。可以经由第二加速计200b向处理器150提供加速度数据,该第二加速计200b定向为提供与x和z轴正交的y轴加速度数据。可以可选地提供GPS传感器200c、一个或多个陀螺仪200d、一个或多个轮速传感器200e和发动机荷载传感器200f,以用于随后描述的所公开的系统中。在示例性实施例中,处理器150产生输出,该输出联接至车前灯定向控制组件204以控制车前灯调平。
参考图8B,通过低通和/或带通滤波器201对来自加速度传感器200或倾斜仪的数据进行滤波,以去除或衰减由于道路噪声和/或道路倾斜变化导致的加速度。实际的滤波技术可以有所不同,并且可以针对具体的车辆类型和类别而确定,以优化该车辆类型和类别的特性性能。可以采用模拟或数字滤波方法来对加速度数据进行滤波。举例说明,但不限于,可以执行数字滤波,包括低通或带通滤波,如在Smith,StephenW.于2003年发表的“DigitalSignalProcessing”(美国马萨诸塞州,伯灵顿:Newnes出版社(Elsevier公司))第14-21章中所公开的(以引用的方式并入本文),或者经由现有技术中已知的任何其他合适的技术。
由于数据被收集和处理,所以将数据存储在存储器202中进行处理。存储器阵列的实际大小可以有所不同,并且可以针对具体的车辆类型和类别而确定,以优化该车辆类型和类别的特性性能。
一旦已经收集到预定量的所需数据,在203处根据数据集计算最小二乘最佳拟合线性回归线。所需数据的量根据车辆类型和类别而有所不同。下面在流程中描述了一种通过实验确定针对特定车辆类型和类别待收集的所需数据的量的方式。
1、确定既定应用所需要的θv的准确度。
2、从多次不同类型的行车收集数据集。
3、对数据集进行滤波。
4、针对从10个数据点开始增加到11、12、13个数据点等的每个数据集,计算最小二乘最佳拟合线性回归线的斜率,直到使用了每个数据集中的所有数据进行斜率计算。
5、对每一个计算得到的斜率求反正切,来计算θv对时间(θvversus时间)。
6、将计算得到的针对每次行车的θv对时间绘制在相同的表上。
7、将所有的从多次行车计算得到的θv都处于在步骤1中识别出的准确度在容差内的点识别在该制图中。
8、确定在步骤7中在制图中识别出的点处的计算使用的数据点的数量。该数量是在进行该计算的数据集中实现在步骤1中识别出的准确度所需的最小数量的点。
在204对计算得到的线性回归线的斜率求反正切,以确定车辆的悬置部相对于车辆的非悬置部的倾斜。可以按照任何方式实现实施方式的分隔,通过针对每个功能块使用离散系统或者部分地或整体地将功能块集成在一起以实现相同的最终结果。
从功能流程角度看,在步骤300,按照至少等于或大于所涉最高频率分量的两倍的频率,从(多个)加速度传感器200收集加速度数据,直到收集到预定数量的样本,如步骤302所图示的。采样频率取决于所使用的传感器和该传感器的位置。如果传感器元件具有低通响应,-3dB带宽为20Hz,那么采样频率需要为至少40Hz,以防止混叠。此外,如果在一定频率存在幅度较大的振动能量,在该频率时传感器的衰减未将幅度降低到几毫g下,那么采样频率必须是该频率的至少2倍,从而可以平均掉振动能量。举例说明,将-3dB带宽为25Hz且滚降为20分贝/十倍频程的传感器安装于50Hz(300RPM)的具有振动加速度为0.1g的位置处。该传感器会将50Hz信号衰减因子2(6分贝/十倍频程)。由此导致的振动加速度将为0.05g。在这种情况下,应该将采样频率增加到至少100Hz,从而可以平均或滤波掉由振动产生的能量,以避免造成θv计算误差。
然后,通过使用如步骤304中描绘的低通滤波器对样本进行滤波,所期望达成的效果是在最小较低频车辆加速度和减速度衰减下实现与加速度相关联的较高频道路噪声的衰减。举例说明,低通滤波器可以提供1Hz的截止频率来衰减该不需要的高频道路噪声。可替换地,可以使用带通滤波器来去除与缓慢变化的道路倾斜相关联的超低频加速度以及与道路噪声相关联的较高频加速度,而使与车辆加速度和减速度相关联的加速度通过。举例说明,但不限于,带通滤波器可以具有分别为1Hz和0.1Hz的上截止频率和下截止频率,以提供所需的滤波处理。
如步骤306所图示的,将滤波后的数据集存储在存储器中,以及如步骤308所示图示的,将存储器增量到存储器阵列202中的下一个可用存储器位置。一旦已经收集到能够实现斜率的准确计算(如在判断步骤310中确定的)的预定数量的滤波后的数据点,例如,按照先前描述的方式,检查所述数据集看看是否存在预定数量的Ax加速度,该预定数量的Ax加速度会确保Az对Ax的依赖性可以如步骤312中描绘的那样准确地建立。一旦满足这些条件,可以如步骤314中图示的,对存储器阵列202中的数据进行另外地滤波。举例说明,如果选择用于滤波所述加速度数据的滤波器为低通滤波器,并且车辆在行驶几分钟之后正处于静止状态,那么可以利用恒定的加速度值来填写数据阵列,这样不能确定z加速度对x加速度的依赖性。可以使用着眼于z加速度值的范围大于一些合理限度的简单测试来确保在阵列中的数据能够建立z对x的依赖性。正常的车辆加速度和减速度在0g至±0.4g范围内(0.8g范围内)。因此,可以将x加速度数据的最小范围的最小限度设置为接近0.05g。
可以通过使用其他可选的传感器或判决技术来实现使放入阵列中的数据的限制以确保存在适当的x加速度范围。只有当车辆处于运动中时方可将数据存储在阵列中。举例说明,这可以通过使用来自GPS传感器200d的GPS数据、轮速传感器200e、或来自一个或多个陀螺仪200f的陀螺信息来实现。可以将连续的Ax加速度数据点进行比较,以及,只有当Az、Ax数据对与先前的Az加速度值不同时方可存储。
对于处理后的数据集,如在步骤316中图示的,确定最小二乘最佳拟合线性回归线,以及如在步骤318中示出的,通过对先前计算得到的线性回归线球反正切来计算θv。如在步骤320中图示的,检查存储器指针看看是否其已经到达存储器阵列的末尾,以及,如在步骤322中示出的,如果其已经到达了存储器阵列的末尾,那么将其重置到存储器阵列的开始,以便用较新的数据重写较旧的数据。然后,处理在步骤300处重现开始。可以计算最小二乘最佳拟合线性回归来找出滤波后的Az对Ax加速度数据对的斜率,如在Bevington,PhilipR.,Robinson,KeithD.于2003年发表的“DataReductionandErrorAnalysisforthePhysicalSciences”修订版3(美国纽约州,纽约:McGrawHill出版社)第6章中所公开的(以引用的方式并入本文),或者经由现有技术中已知的任何其他合适的技术。
此外,一旦第一次成功计算得到θv,可以将其存储在单独的存储区段中,以及可选地,可以滚动的方式为生成的每个新数据点计算新的θv值。
也可以使用补充传感器数据和GPS数据来建立另外的信心和信用检查。例如,GPS位置数据结合针对给定位置已知的道路倾斜可以为车辆的非悬置部建立参考倾斜θr。可以通过从瞬时总倾斜角度θT减去θr来进一步计算并且检查θv。可以通过使用相同的处理后的加速度数据并且简单地对(Ax/Az)求反正切来计算θT
也可以使用轮速传感器200e和来自发动机荷载传感器200f的发动机加载信息来确定θr和θv,也可以如上所述的按照与计算θT相同的方式来计算θr和θv。另外,由于Ax加速度必须存在,所以,可以使用轮速和发动机加载的变化来限定好的数据,因此为确定Az对Ax加速度的依赖性提供好的候选。
可以使用俯仰陀螺信息来监测θr的变化。当检测到θr快速变化时,可以对数据进行标记以便进行另外的处理或部分地或全部地不理会。
通过使用计算装置来实施上述方法,该计算装置执行来自存储器的程序步骤以提供本文所述的功能操作。可以经由现有技术中已知的模拟或数字滤波技术来实现上述的数据滤波处理。
一旦已经根据当前描述的方法确定了车辆的悬置部相对于道路的倾斜,该系统便提供指示该倾斜的输出信号,该输出信号用于生成至少一个控制信号,该控制信号被提供至机电或电子控制系统。在图示的实施例中,该至少一个控制信号可以用于控制车前灯调平系统,例如,诸如在美国已发布申请2012/0310486中所公开的(以引用的方式并入本文),或如现有技术中已知的响应于控制信号实现车前灯调平的任何其他车灯组件。应该理解,可替代地,该至少一个输出信号可以用于对装置或系统进行控制,以实现车辆电子稳定性控制、车辆油位监测倾斜校正、车辆坡道起步辅助、挂车制动、卡车荷载监测以便进行刻度校正、悬置调节以便调节荷载振动和其他应用之目的,其中,电气、电子或机电装置或系统的运行至少部分地基于车辆的悬置部相对于道路的倾斜。
虽然在一个实施例中,基于计算得到的车辆的悬置部相对于车辆的非悬置部的倾斜角度,已经相对于对车前灯调平系统的控制对所公开的系统进行了描述,但是,要了解,确定出来的物体的一个部分(诸如,移动物体的悬置部)相对于该移动物体的非悬置部或参照平面的倾斜角度可以用于生成控制信号,该控制信号又可以用作至机电或电子控制子系统的输入。由此,虽然已经就在移动车辆中的应用对所公开的技术进行了描述,但是其也适用于其他移动物体。

Claims (18)

1.一种基于车辆的悬置部相对于道路的倾斜来控制机电系统的方法,所述方法包括:
从联接至所述车辆的所述悬置部的至少一个传感器获取分别代表z轴和x轴加速度的第一信号和第二信号;
对所述第一信号和第二信号进行滤波以衰减其中的高频分量以产生滤波后的第一信号和第二信号;
使用滤波后的第一信号和第二信号来计算最小二乘最佳拟合线性回归对应的斜率;
通过计算确定的所述斜率的反正切来生成所述车辆的所述悬置部的倾斜角θv;
基于所述车辆的所述悬置部的所述倾斜角来生成至少一个控制信号;以及
将所述至少一个控制信号提供至所述机电系统。
2.根据权利要求1所述的方法,其中,所述机电系统是车前灯调平系统,以及所述至少一个控制信号用于提供对所述车辆的所述车前灯相对于所述道路的倾斜角的控制。
3.根据权利要求1所述的方法,其中:
获取所述第一信号和第二信号包括:以预定采样频率从联接至所述车辆的所述悬置部的至少一个传感器获取分别与z轴和x轴加速度相对应的预定数量的第一数据样本和第二数据样本;
对所述第一信号和第二信号进行滤波包括:对第一数据样本和第二数据样本进行滤波以衰减其中的高频分量以产生滤波后的第一数据样本和第二数据样本,并且将滤波后的第一数据样本和第二数据样本存储在存储器中;以及
通过使用滤波后的第一信号和第二信号来计算最小二乘最佳拟合线性回归相对应的斜率包括:通过使用滤波后的第一数据样本和第二数据样本来计算最小二乘最佳拟合线性回归相对应的斜率。
4.根据权利要求3所述的方法,其中,所述机电系统是车前灯调平系统,以及所述至少一个控制信号用于提供对所述车辆的所述车前灯相对于所述道路的倾斜角的控制。
5.根据权利要求3所述的方法,其进一步包括:检查滤波后的数据样本以验证x轴加速度的值的范围超过了预定限度,以便确保准确地建立所述z轴加速度。
6.根据权利要求5所述的方法,其中,所述预定限度为0.05g。
7.根据权利要求3所述的方法,其中,所述滤波的步骤包括:对存储的第一数据样本和第二数据样本执行低通数字滤波以衰减高频道路噪声。
8.根据权利要求3所述的方法,其中,所述滤波的步骤包括:对存储的第一数据样本和第二数据样本执行带通数字滤波以衰减高频道路噪声和与缓慢变化的道路倾斜相关联的超低频率。
9.根据权利要求1所述的方法,其进一步包括:响应于获取到的每一对z轴和x轴加速度,以滚动的方式计算倾斜角θv。
10.根据权利要求1所述的方法,其中,所述至少一个传感器包括至少一个加速计。
11.根据权利要求10所述的方法,其进一步包括:选择自陀螺仪、轮速传感器和GPS传感器中的另一个传感器,所述方法包括:通过所述至少另一个传感器产生的数据来验证在确定所述车辆的所述悬置部的所述倾斜角时使用的第一信号和第二信号。
12.一种基于车辆的悬置部相对于道路的倾斜来控制机电系统的设备,所述设备包括:
处理器;
与所述处理器通信的至少一个存储器,所述至少一个存储器包含存储在其中的计算机程序,所述处理器在执行所述计算机程序时用于:
以预定采样频率从联接至所述车辆的所述悬置部的至少一个传感器获取分别与z轴和x轴加速度相对应的预定数量的第一数据样本和第二数据样本;
对第一数据样本和第二数据样本进行滤波以衰减高频分量以产生滤波后的第一数据样本和第二数据样本,并且将滤波后的第一数据样本和第二数据样本存储在所述至少一个存储器中;
通过使用滤波后的第一数据样本和第二数据样本来计算最小二乘最佳拟合线性回归相对应的斜率;
通过计算确定的所述斜率的反正切来生成所述车辆的所述悬置部的倾斜角θv;
基于所述车辆的所述悬置部的所述倾斜角来生成至少一个控制信号;以及
将所述至少一个控制信号提供至所述机电系统。
13.根据权利要求12所述的设备,其中,所述机电系统是车前灯调平系统,以及所述至少一个控制信号用于提供对所述车辆的所述车前灯相对于所述道路的倾斜角的控制。
14.根据权利要求12所述的设备,其中,所述至少一个传感器包括至少一个加速计。
15.根据权利要求12所述的设备,其中,所述处理器用于对滤波后的第一数据样本和第二数据样本执行低通滤波以衰减高频道路噪声。
16.根据权利要求12所述的设备,其中,所述处理器用于对存储的第一数据样本和第二数据样本执行带通数字滤波以衰减高频道路噪声和与缓慢变化的道路倾斜相关联的超低频率。
17.根据权利要求12所述的设备,其中,所述处理器用于验证x轴加速度的值的范围超过了预定限度,以便确保准确地建立所述z轴加速度。
18.根据权利要求17所述的设备,其中,所述预定限度为0.05g。
CN201510383493.6A 2014-07-03 2015-07-02 基于车辆相对于道路的倾斜角来控制机电系统的方法和设备 Active CN105291958B (zh)

Applications Claiming Priority (4)

Application Number Priority Date Filing Date Title
US201462020704P 2014-07-03 2014-07-03
US62/020,704 2014-07-03
US14/753,182 2015-06-29
US14/753,182 US20160001695A1 (en) 2014-07-03 2015-06-29 Method and apparatus for determining the inclination of a moving vehicle with respect to the road and for performing dynamic headlight leveling

Publications (2)

Publication Number Publication Date
CN105291958A true CN105291958A (zh) 2016-02-03
CN105291958B CN105291958B (zh) 2017-08-25

Family

ID=53540616

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201510383493.6A Active CN105291958B (zh) 2014-07-03 2015-07-02 基于车辆相对于道路的倾斜角来控制机电系统的方法和设备

Country Status (5)

Country Link
US (1) US20160001695A1 (zh)
EP (1) EP2963385A1 (zh)
JP (1) JP2016026953A (zh)
KR (1) KR20200067960A (zh)
CN (1) CN105291958B (zh)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106250880A (zh) * 2016-08-23 2016-12-21 广西科技大学 一种车辆上坡前道路坡度视觉检测方法
CN111486860A (zh) * 2019-01-29 2020-08-04 通用汽车环球科技运作有限责任公司 用于确定道路倾斜角的系统和方法
CN112238804A (zh) * 2020-09-09 2021-01-19 华人运通(上海)云计算科技有限公司 车灯控制方法、装置、设备及车辆

Families Citing this family (15)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
FR3021605B1 (fr) * 2014-06-03 2016-05-27 Valeo Vision Procede et systeme de correction de l’orientation des projecteurs d’un vehicule a moteur
US9751454B2 (en) * 2016-01-29 2017-09-05 Toyota Motor Engineering & Manufacturing North America, Inc. Control of vehicle exterior lights based on vehicle location and/or planned route information
US10002469B2 (en) * 2016-09-09 2018-06-19 The University Of Hong Kong Inclinometer methods and systems for generating and calibrating an in-vehicle inclination angle
DE102016122066A1 (de) * 2016-11-16 2018-05-17 Automotive Lighting Reutlingen Gmbh Verfahren zur Einstellung der Winkellage der optischen Achse eines Scheinwerfers eines Kraftfahrzeugs und Beleuchtungseinrichtung des Kraftfahrzeugs
JP6936624B2 (ja) * 2017-05-19 2021-09-15 スタンレー電気株式会社 車両用灯具の制御装置および車両用灯具システム
JP6981795B2 (ja) 2017-07-10 2021-12-17 スタンレー電気株式会社 車両用灯具の制御装置および車両用灯具システム
DE102017216945A1 (de) * 2017-09-25 2019-03-28 Robert Bosch Gmbh Verfahren und System zum automatischen Einstellen eines Neigungswinkels eines Fahrzeugscheinwerfers
KR101977750B1 (ko) * 2017-11-24 2019-05-13 현대오트론 주식회사 가속도 센서를 이용한 차량 기울기 각도 산출 장치 및 그것의 동작 방법
US10953787B2 (en) 2017-11-30 2021-03-23 Ford Global Technologies, Llc Headlamp leveling system and method
FR3077792B1 (fr) * 2018-02-14 2020-10-02 Aml Systems Procede et dispositif autonomes de determination d’une assiette d’un vehicule automobile.
DE102019102326A1 (de) * 2019-01-30 2020-07-30 Automotive Lighting Reutlingen Gmbh Kraftfahrzeugscheinwerfer und Verfahren zum Betreiben eines Kraftfahrzeugscheinwerfers
JP6873347B2 (ja) * 2019-03-08 2021-05-19 三菱電機株式会社 光軸制御装置
EP4183629B1 (en) 2021-11-23 2024-02-14 C.R.F. Società Consortile per Azioni System and method for adjusting the emission direction of a motor-vehicle headlight unit
IT202200008477A1 (it) 2022-04-28 2023-10-28 Fiat Ricerche "Sistema e procedimento per regolare la direzione di emissione di un gruppo proiettore di autoveicolo"
WO2024006943A1 (en) * 2022-07-01 2024-01-04 Tesla, Inc. Dynamically determining vehicle pitch

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20040246731A1 (en) * 2003-03-18 2004-12-09 Mitsubishi Fuso Truck And Bus Corporation Light axis adjusting apparatus for vehicle headlamp
US20080013790A1 (en) * 2006-07-13 2008-01-17 Toru Ihara Moving-state determining device
EP1930690A1 (en) * 2006-12-07 2008-06-11 Continental Automotive GmbH Method and device for dynamically determining a slope of a road
JP2009126268A (ja) * 2007-11-21 2009-06-11 Panasonic Corp 車体の前後方向の傾き検出装置およびこれを用いた車両の光軸方向調整装置
CN103702884A (zh) * 2011-08-12 2014-04-02 迪尔公司 用于确定车辆倾角的方法和系统
CN103847617A (zh) * 2012-11-30 2014-06-11 株式会社小糸制作所 车辆用灯具的控制装置和控制方法及车辆用灯具系统

Family Cites Families (28)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE69705921T2 (de) * 1996-12-13 2001-12-06 Denso Corp Einrichtung zur Regelung der Leuchtweite von Scheinwerfern von Fahrzeugen
EP1889747B1 (en) * 1998-06-16 2009-11-18 Denso Corporation System for automatically adjusting optical axis direction of vehicle headlight
JP3782619B2 (ja) * 1999-09-09 2006-06-07 株式会社小糸製作所 自動車用ヘッドランプのオートレベリング装置
JP2001347882A (ja) * 2000-04-03 2001-12-18 Denso Corp 車両用前照灯光軸方向自動調整装置
JP4593034B2 (ja) * 2001-08-31 2010-12-08 株式会社デンソー 車両用前照灯光軸方向自動調整装置
JP2004168130A (ja) * 2002-11-19 2004-06-17 Koito Mfg Co Ltd 車両用前照灯の照射方向制御装置
JP2004168179A (ja) * 2002-11-20 2004-06-17 Koito Mfg Co Ltd 車両用前照灯の照射方向制御装置
JP4353768B2 (ja) * 2003-02-17 2009-10-28 株式会社デンソー 車両用前照灯光軸方向自動調整装置
JP2004276824A (ja) * 2003-03-18 2004-10-07 Mitsubishi Fuso Truck & Bus Corp 車両用ヘッドランプの光軸調整装置
US7477976B2 (en) * 2003-07-28 2009-01-13 Denso Corporation Automatic optical axis direction adjusting apparatus for vehicles
JP4158664B2 (ja) * 2003-09-25 2008-10-01 三菱ふそうトラック・バス株式会社 車両用ヘッドランプの光軸制御装置
JP4552750B2 (ja) * 2004-08-06 2010-09-29 株式会社デンソー 車両用前照灯装置
US7660654B2 (en) * 2004-12-13 2010-02-09 Ford Global Technologies, Llc System for dynamically determining vehicle rear/trunk loading for use in a vehicle control system
EP1757486B1 (en) * 2005-08-26 2014-04-30 Nissan Motor Co., Ltd. Device and method for controlling vehicle headlamps
FR2908705B1 (fr) * 2006-11-17 2009-07-17 Valeo Vision Sa Procede d'adaptation automatique d'un faisceau lumineux de dispositif projecteur.
KR101438814B1 (ko) * 2007-03-16 2014-09-17 엘지이노텍 주식회사 헤드램프 제어 장치 및 방법
JP5053881B2 (ja) * 2008-02-13 2012-10-24 株式会社小糸製作所 車両用ランプ制御システム及び制御方法
EP2116421B1 (en) * 2008-05-08 2017-11-08 Koito Manufacturing Co., Ltd. Automotive headlamp apparatus
JP4840486B2 (ja) * 2009-08-07 2011-12-21 株式会社デンソー ライト制御装置
JP5405247B2 (ja) * 2009-09-14 2014-02-05 株式会社小糸製作所 車両用ヘッドランプシステム
JP5787649B2 (ja) * 2010-10-26 2015-09-30 株式会社小糸製作所 車両用灯具の制御装置および車両用灯具システム
JP5749081B2 (ja) * 2011-05-27 2015-07-15 株式会社小糸製作所 車両用灯具の制御装置および車両用灯具システム
JP5780839B2 (ja) * 2011-06-03 2015-09-16 株式会社小糸製作所 車両用灯具の制御装置および車両用灯具システム
JP5678873B2 (ja) * 2011-11-30 2015-03-04 株式会社デンソー 車両用前照灯制御装置
JP6177105B2 (ja) * 2013-11-20 2017-08-09 株式会社小糸製作所 車両用灯具の制御装置
JP2015151046A (ja) * 2014-02-17 2015-08-24 株式会社デンソー 軸方向制御装置、および軸方向制御プログラム
JP6285261B2 (ja) * 2014-04-14 2018-02-28 株式会社小糸製作所 車両用灯具の制御装置
US9527430B2 (en) * 2014-08-11 2016-12-27 Toyota Motor Engineering & Manufacturing North America, Inc. Vehicle headlight leveling control

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20040246731A1 (en) * 2003-03-18 2004-12-09 Mitsubishi Fuso Truck And Bus Corporation Light axis adjusting apparatus for vehicle headlamp
US20080013790A1 (en) * 2006-07-13 2008-01-17 Toru Ihara Moving-state determining device
EP1930690A1 (en) * 2006-12-07 2008-06-11 Continental Automotive GmbH Method and device for dynamically determining a slope of a road
JP2009126268A (ja) * 2007-11-21 2009-06-11 Panasonic Corp 車体の前後方向の傾き検出装置およびこれを用いた車両の光軸方向調整装置
CN103702884A (zh) * 2011-08-12 2014-04-02 迪尔公司 用于确定车辆倾角的方法和系统
CN103847617A (zh) * 2012-11-30 2014-06-11 株式会社小糸制作所 车辆用灯具的控制装置和控制方法及车辆用灯具系统

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106250880A (zh) * 2016-08-23 2016-12-21 广西科技大学 一种车辆上坡前道路坡度视觉检测方法
CN106250880B (zh) * 2016-08-23 2020-12-04 广西科技大学 一种车辆上坡前道路坡度视觉检测方法
CN111486860A (zh) * 2019-01-29 2020-08-04 通用汽车环球科技运作有限责任公司 用于确定道路倾斜角的系统和方法
CN111486860B (zh) * 2019-01-29 2024-04-26 通用汽车环球科技运作有限责任公司 用于确定道路倾斜角的系统和方法
CN112238804A (zh) * 2020-09-09 2021-01-19 华人运通(上海)云计算科技有限公司 车灯控制方法、装置、设备及车辆
CN112238804B (zh) * 2020-09-09 2022-03-29 华人运通(上海)云计算科技有限公司 车灯控制方法、装置、设备及车辆

Also Published As

Publication number Publication date
US20160001695A1 (en) 2016-01-07
CN105291958B (zh) 2017-08-25
JP2016026953A (ja) 2016-02-18
KR20200067960A (ko) 2020-06-15
EP2963385A1 (en) 2016-01-06

Similar Documents

Publication Publication Date Title
CN105291958A (zh) 基于车辆相对于道路的倾斜角来控制机电系统的方法和设备
US7463953B1 (en) Method for determining a tilt angle of a vehicle
EP2295989B1 (en) Velocity calculating device, velocity calculating method, and navigation device
EP2472225A2 (en) Method and system for initial quaternion and attitude estimation
EP2161582A2 (en) Velocity calculation device,velocity calculation method, and navigation device
CN1174144A (zh) 车辆驾驶记录仪、车辆行使分析仪及其存储介质
JP6078722B2 (ja) 路面性状計測装置
US8020442B2 (en) High bandwidth inertial measurement unit
US9222237B1 (en) Earthmoving machine comprising weighted state estimator
KR100834723B1 (ko) 센서를 이용한 수직적 주행상태 판단 방법 및 장치
CN108519085B (zh) 导航路径获取方法、装置、系统及其存储介质
CN104290755A (zh) 一种汽车行驶状态预警方法
US10126130B2 (en) Device for detecting the attitude of motor vehicles
CN106274862A (zh) 一种倾斜坡面的自动驾驶方法、装置以及车辆
JP2016102730A (ja) 車両重量監視システム、車両重量算出方法、車両重量算出サーバ
US7032450B2 (en) Method and apparatus for measuring speed of land vehicle using accelerometer
EP0170314B1 (en) Arrangement for determining the instantaneous angular position of a moving object
CN113661109B (zh) 用于确定指示支撑车辆的地面段的承载能力的值的控制单元和方法
JP5866502B2 (ja) 車重算出装置、波状路、および車重算出方法
CN113635907A (zh) 一种驾驶行为的检测方法、装置、电子设备及其存储介质
JP2021060332A (ja) 速度計測装置、地上走行体
EP2290373A1 (en) Velocity calculation device, velocity calculation method and associated navigation device
EP0576070A1 (en) Error correction device for vehicle odometer
CN108507529A (zh) 一种桥接坡沉降自动检测装置及车辆
RU2162202C1 (ru) Способ определения уклонов, кривизны, неровности и коэффициента сцепления дорожного покрытия и устройство для его осуществления

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant