CN105415998B - 一种车身姿态预估调平控制方法 - Google Patents

一种车身姿态预估调平控制方法 Download PDF

Info

Publication number
CN105415998B
CN105415998B CN201510901608.6A CN201510901608A CN105415998B CN 105415998 B CN105415998 B CN 105415998B CN 201510901608 A CN201510901608 A CN 201510901608A CN 105415998 B CN105415998 B CN 105415998B
Authority
CN
China
Prior art keywords
leveling
strong point
point
around
vehicle
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
CN201510901608.6A
Other languages
English (en)
Other versions
CN105415998A (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.)
Special Vehicle Technology Center of Hubei Aerospace Technology Research Institute
Original Assignee
Special Vehicle Technology Center of Hubei Aerospace Technology Research Institute
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 Special Vehicle Technology Center of Hubei Aerospace Technology Research Institute filed Critical Special Vehicle Technology Center of Hubei Aerospace Technology Research Institute
Priority to CN201510901608.6A priority Critical patent/CN105415998B/zh
Publication of CN105415998A publication Critical patent/CN105415998A/zh
Application granted granted Critical
Publication of CN105415998B publication Critical patent/CN105415998B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60GVEHICLE SUSPENSION ARRANGEMENTS
    • B60G17/00Resilient suspensions having means for adjusting the spring or vibration-damper characteristics, for regulating the distance between a supporting surface and a sprung part of vehicle or for locking suspension during use to meet varying vehicular or surface conditions, e.g. due to speed or load
    • B60G17/015Resilient suspensions having means for adjusting the spring or vibration-damper characteristics, for regulating the distance between a supporting surface and a sprung part of vehicle or for locking suspension during use to meet varying vehicular or surface conditions, e.g. due to speed or load the regulating means comprising electric or electronic elements
    • B60G17/016Resilient suspensions having means for adjusting the spring or vibration-damper characteristics, for regulating the distance between a supporting surface and a sprung part of vehicle or for locking suspension during use to meet varying vehicular or surface conditions, e.g. due to speed or load the regulating means comprising electric or electronic elements characterised by their responsiveness, when the vehicle is travelling, to specific motion, a specific condition, or driver input
    • B60G17/0165Resilient suspensions having means for adjusting the spring or vibration-damper characteristics, for regulating the distance between a supporting surface and a sprung part of vehicle or for locking suspension during use to meet varying vehicular or surface conditions, e.g. due to speed or load the regulating means comprising electric or electronic elements characterised by their responsiveness, when the vehicle is travelling, to specific motion, a specific condition, or driver input to an external condition, e.g. rough road surface, side wind
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60GVEHICLE SUSPENSION ARRANGEMENTS
    • B60G2400/00Indexing codes relating to detected, measured or calculated conditions or factors
    • B60G2400/05Attitude
    • B60G2400/051Angle
    • B60G2400/0511Roll angle
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60GVEHICLE SUSPENSION ARRANGEMENTS
    • B60G2400/00Indexing codes relating to detected, measured or calculated conditions or factors
    • B60G2400/05Attitude
    • B60G2400/051Angle
    • B60G2400/0512Pitch angle
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60GVEHICLE SUSPENSION ARRANGEMENTS
    • B60G2400/00Indexing codes relating to detected, measured or calculated conditions or factors
    • B60G2400/05Attitude
    • B60G2400/051Angle
    • B60G2400/0513Yaw angle
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60GVEHICLE SUSPENSION ARRANGEMENTS
    • B60G2800/00Indexing codes relating to the type of movement or to the condition of the vehicle and to the end result to be achieved by the control action
    • B60G2800/90System Controller type
    • B60G2800/91Suspension Control
    • B60G2800/912Attitude Control; levelling control

Landscapes

  • Engineering & Computer Science (AREA)
  • Mechanical Engineering (AREA)
  • Vehicle Body Suspensions (AREA)

Abstract

本发明公开了一种车身姿态预估调平控制方法,属于车辆姿态调平技术领域。所述车身姿态预估调平控制方法包括以下步骤:根据支撑点补偿高度算法得到整车最低姿态调平所需的高度值;当前后左右四个支撑点高度值中最大值大于悬架最大行程,进行调平放宽偏差迭代计算,根据调平放宽偏差迭代计算得到的结果进行支撑点补偿高度计算,根据支撑点补偿高度计算得到的结果进行调平。本发明车身姿态预估调平控制方法可以对车身姿态调平进行预估。

Description

一种车身姿态预估调平控制方法
技术领域
本发明涉及车辆姿态调平技术领域,特别涉及一种车身姿态预估调平控制方法
背景技术
在现有技术中,并没有关于车身姿态调平预估算法的相关技术。只有车身快速调平系统等技术,调平算法大都以倾角传感器为依据进行车身姿态的实时反馈调平控制,少部分以车身姿态当前值为参照,计算支撑点需要补偿的高度值进行直接调平,均无法做到预估计算,只能调平后根据倾角传感器判断能否达到使用要求。
发明内容
本发明提供一种车身姿态预估调平控制方法,解决了或部分解决了现有技术中不能对车身姿态调平进行预估的技术问题。
为解决上述技术问题,本发明提供了一种车身姿态预估调平控制方法包括以下步骤:根据倾角传感器X方向值得到车辆调平所需左右支撑点低端补偿高度值,根据倾角传感器Y方向值得到车辆调平所需前后支撑点低端补偿高度值;所述左右支撑点低端补偿高度值和所述前后支撑点低端补偿高度值叠加形成前后左右四个支撑点补偿高度值,所述前后左右四个支撑点补偿高度值加上各自支撑点当前高度值,得出前后左右四个支撑点最终高度值;将所述前后左右四个支撑点最终高度值减去所述前后左右四个支撑点最终高度值中的最小值,获得调平后整车处于最低位前后左右四个支撑点所需的高度值;当前后左右四个支撑点最终高度值中最大值小于或等于悬架最大行程,根据调平后整车处于最低位前后左右四个支撑点所需的高度值进行调平;当所述调平后整车处于最低位前后左右四个支撑点所需的高度值中最大值大于悬架最大行程,进行调平放宽偏差迭代计算,根据所述调平放宽偏差迭代计算得到的结果进行支撑点补偿高度计算,根据支撑点补偿高度计算得到的结果进行调平。
进一步地,所述左右支撑点低端补偿高度值和所述前后支撑点低端补偿高度值叠加形成前后左右四个支撑点补偿高度值,所述前后左右四个支撑点补偿高度值加上各自支撑点当前高度值,得出前后左右四个支撑点最终高度值包括:当车辆停于斜坡,处于左、后低的初始姿态时,前后左右四个支撑点的最终高度值具体为:H1i=sin(X)*W+H1m;H2i=H2m;H3i=sin(X)*W+sin(Y)*L+H3m;H4i=sin(Y)*L+H4m;式中H1i、H2i、H3i、H4i分别为左前支撑点、右前支撑点、左后支撑点、右后支撑点调平后所需高度值;H1m、H2m、H3m、H4m分别为左前支撑点、右前支撑点、左后支撑点、右后支撑点调平前高度值;X、Y分别为横向倾角、纵向倾角;L为整车轴距;W为整车轮距。
进一步地,所述将所述前后左右四个支撑点最终高度值减去所述前后左右四个支撑点最终高度值中的最小值,获得整车最低姿态调平所需前后左右四个支撑点高度值包括:所述调平后整车处于最低位前后左右四个支撑点所需的高度值具体为:H1=H1i-MIN(H1i,H2i,H3i,H4i)=H1i-H2i;H2=H2i-MIN(H1i,H2i,H3i,H4i)=0;H3=H3i-MIN(H1i,H2i,H3i,H4i)=H3i-H2i;H4=H4i-MIN(H1i,H2i,H3i,H4i)=H4i-H2i;式中H1、H2、H3、H4分别为左前支撑点、右前支撑点、左后支撑点、右后支撑点调平后整车处于最低位所需高度值。
进一步地,所述左右支撑点低端补偿高度值和所述前后支撑点低端补偿高度值叠加形成前后左右四个支撑点补偿高度值,所述前后左右四个支撑点补偿高度值加上各自支撑点当前高度值,得出前后左右四个支撑点最终高度值包括:当车辆停于斜坡,处于左、前低的初始姿态,前后左右四个支撑点的最终高度值具体为:H1i=sin(X)*W+sin(Y)*L+H1m;H2i=sin(Y)*L+H2m;H3i=sin(X)*W+H3m;H4i=H4m;式中H1i、H2i、H3i、H4i分别为左前支撑点、右前支撑点、左后支撑点、右后支撑点调平后所需高度值;H1m、H2m、H3m、H4m分别为左前支撑点、右前支撑点、左后支撑点、右后支撑点调平前高度值;X、Y分别为横向倾角、纵向倾角;L为整车轴距;W为整车轮距。
进一步地,所述将所述前后左右四个支撑点最终高度值减去所述前后左右四个支撑点最终高度值中的最小值,获得整车最低姿态调平所需前后左右四个支撑点高度值包括:所述调平后整车处于最低位前后左右四个支撑点所需的高度值具体为:H1=H1i-MIN(H1i,H2i,H3i,H4i)=H1i-H4i;H2=H2i-MIN(H1i,H2i,H3i,H4i)=H2i-H4i;H3=H3i-MIN(H1i,H2i,H3i,H4i)=H3i-H4i;H4=H4i-MIN(H1i,H2i,H3i,H4i)=0;式中H1、H2、H3、H4分别为左前支撑点、右前支撑点、左后支撑点、右后支撑点调平后整车处于最低位所需高度值。
进一步地,所述左右支撑点低端补偿高度值和所述前后支撑点低端补偿高度值叠加形成前后左右四个支撑点补偿高度值,所述前后左右四个支撑点补偿高度值加上各自支撑点当前高度值,得出前后左右四个支撑点最终高度值包括:当车辆停于斜坡,处于右、后低的初始姿态,前后左右四个支撑点的最终高度值具体为:H1i=H1m;H2i=sin(X)*W+H2m;H3i=sin(Y)*L+H3m;H4i=sin(X)*W+sin(Y)*L+H4m;式中H1i、H2i、H3i、H4i分别为左前支撑点、右前支撑点、左后支撑点、右后支撑点调平后所需高度值;H1m、H2m、H3m、H4m分别为左前支撑点、右前支撑点、左后支撑点、右后支撑点调平前高度值;X、Y分别为横向倾角、纵向倾角;L为整车轴距;W为整车轮距。
进一步地,所述将所述前后左右四个支撑点最终高度值减去所述前后左右四个支撑点最终高度值中的最小值,获得整车最低姿态调平所需前后左右四个支撑点高度值包括:所述调平后整车处于最低位前后左右四个支撑点所需的高度值具体为:H1=H1i-MIN(H1i,H2i,H3i,H4i)=0;H2=H2i-MIN(H1i,H2i,H3i,H4i)=H2i-H1i;H3=H3i-MIN(H1i,H2i,H3i,H4i)=H3i-H1i;H4=H4i-MIN(H1i,H2i,H3i,H4i)=H4i-H1i;式中H1、H2、H3、H4分别为左前支撑点、右前支撑点、左后支撑点、右后支撑点调平后整车处于最低位所需高度值。
进一步地,所述左右支撑点低端补偿高度值和所述前后支撑点低端补偿高度值叠加形成前后左右四个支撑点补偿高度值,所述前后左右四个支撑点补偿高度值加上各自支撑点当前高度值,得出前后左右四个支撑点最终高度值包括:当车辆停于斜坡,处于右、前低的初始姿态,前后左右四个支撑点的最终高度值具体为:H1i=sin(Y)*L+H1m;H2i=sin(X)*W+sin(Y)*L+H2m;H3i=H3m;H4i=sin(X)*W+H4m;式中H1i、H2i、H3i、H4i分别为左前支撑点、右前支撑点、左后支撑点、右后支撑点调平后所需高度值;H1m、H2m、H3m、H4m分别为左前支撑点、右前支撑点、左后支撑点、右后支撑点调平前高度值;X、Y分别为横向倾角、纵向倾角;L为整车轴距;W为整车轮距。
进一步地,所述将所述前后左右四个支撑点最终高度值减去所述前后左右四个支撑点最终高度值中的最小值,获得整车最低姿态调平所需前后左右四个支撑点高度值包括:所述调平后整车处于最低位前后左右四个支撑点所需的高度值具体为:H1=H1i-MIN(H1i,H2i,H3i,H4i)=H1i-H3i;H2=H2i-MIN(H1i,H2i,H3i,H4i)=H2i-H3i;H3=H3i-MIN(H1i,H2i,H3i,H4i)=0;H4=H4i-MIN(H1i,H2i,H3i,H4i)=H3i-H3i;式中H1、H2、H3、H4分别为左前支撑点、右前支撑点、左后支撑点、右后支撑点调平后整车处于最低位所需高度值。
进一步地,所述调平放宽偏差迭代计算包括:将X方向放宽调平角度到达第一设定值,调用所述支撑点补偿高度算法进行评判,如果能够调平则直接调平,如果不能调平继续放宽X方向调平角度,进行迭代运算评判,直到X方向放宽调平角度达到第二设定值;如果X方向放宽调平角度达到第二设定值不能调平,则放宽Y方向调平角度到达第三设定值,重新进行迭代运算评判,此刻X方向放宽调平角度最大值将变小,以满足整车平面与地面夹角不大于5.0°要求。
本发明提供的车身姿态预估调平控制方法根据倾角传感器X方向值得到车辆调平所需左右支撑点低端补偿高度值,根据倾角传感器Y方向值得到车辆调平所需前后支撑点低端补偿高度值;所述左右支撑点低端补偿高度值和所述前后支撑点低端补偿高度值叠加形成前后左右四个支撑点补偿高度值,所述前后左右四个支撑点补偿高度值加上各自支撑点当前高度值,得出前后左右四个支撑点最终高度值;将所述前后左右四个支撑点最终高度值减去所述前后左右四个支撑点最终高度值中的最小值,获得调平后整车处于最低位前后左右四个支撑点所需的高度值;当所述前后左右四个支撑点最终高度值中最大值小于或等于悬架最大行程,根据调平后整车处于最低位前后左右四个支撑点所需的高度值进行调平;当所述调平后整车处于最低位前后左右四个支撑点所需的高度值中最大值大于悬架最大行程,进行调平放宽偏差迭代计算,根据所述调平放宽偏差迭代计算得到的结果进行支撑点补偿高度计算,根据支撑点补偿高度计算得到的结果进行调平,可以实现任意斜坡路况下,车身开始姿态调节之前,算出最终能达到的水平姿态,并判断能否满足车身使用要求,如果不能满足要求则提示调平超范围,驾驶员可迅速更换作业地点,避免调节后发现调平结果不满足使用要求的情况发生,如果能够达到使用要求,则直接根据最终计算结果,将补偿高度一次调节到位,减少装备使用时的调平时间,缩短作业准备流程,有利于提高装备的快速响应能力。
附图说明
图1为本发明实施例提供的支撑点补偿高度计算的流程示意图;
图2为本发明实施例提供的调平放宽偏差迭代计算的流程示意图;
图3为本发明实施例提供的X、Y放宽角度对应关系示意图。
具体实施方式
参见图1,本发明实施例提供的一种车身姿态预估调平控制方法包括以下步骤:
步骤1,根据倾角传感器X方向值得到车辆调平所需左右支撑点低端补偿高度值,根据倾角传感器Y方向值得到车辆调平所需前后支撑点低端补偿高度值。
步骤2,所述左右支撑点低端补偿高度值和所述前后支撑点低端补偿高度值叠加形成前后左右四个支撑点补偿高度值,所述前后左右四个支撑点补偿高度值加上各自支撑点当前高度值,得出前后左右四个支撑点最终高度值。
步骤3,将所述前后左右四个支撑点最终高度值减去所述前后左右四个支撑点最终高度值中的最小值,获得调平后整车处于最低位前后左右四个支点所需的高度值。
步骤4,当所述前后左右四个支撑点最终高度值中最大值小于或等于悬架最大行程,根据调平后整车处于最低位前后左右四个支撑点所需的高度值进行调平。
步骤5,当所述调平后整车处于最低位前后左右四个支撑点所需的高度值中最大值大于悬架最大行程,进行调平放宽偏差迭代计算,根据所述调平放宽偏差迭代计算得到的结果进行支撑点补偿高度计算,根据支撑点补偿高度计算得到的结果进行调平。
详细介绍步骤2。
所述左右支撑点低端补偿高度值和所述前后支撑点低端补偿高度值叠加形成前后左右四个支撑点补偿高度值,所述前后左右四个支撑点补偿高度值加上各自支撑点当前高度值,得出前后左右四个支撑点最终高度值包括:
当车辆停于斜坡,处于左、后低的初始姿态时,前后左右四个支撑点的最终高度值具体为:
H1i=sin(X)*W+H1m;
H2i=H2m;
H3i=sin(X)*W+sin(Y)*L+H3m;
H4i=sin(Y)*L+H4m;
式中H1i、H2i、H3i、H4i分别为左前支撑点、右前支撑点、左后支撑点、右后支撑点调平后所需高度值;H1m、H2m、H3m、H4m分别为左前支撑点、右前支撑点、左后支撑点、右后支撑点调平前高度值;X、Y分别为横向倾角、纵向倾角;L为整车轴距;W为整车轮距。
当车辆停于斜坡,处于左、前低的初始姿态,前后左右四个支撑点的最终高度值具体为:
H1i=sin(X)*W+sin(Y)*L+H1m;
H2i=sin(Y)*L+H2m;
H3i=sin(X)*W+H3m;
H4i=H4m;
式中H1i、H2i、H3i、H4i分别为左前支撑点、右前支撑点、左后支撑点、右后支撑点调平后所需高度值;H1m、H2m、H3m、H4m分别为左前支撑点、右前支撑点、左后支撑点、右后支撑点调平前高度值;X、Y分别为横向倾角、纵向倾角;L为整车轴距;W为整车轮距。
当车辆停于斜坡,处于右、后低的初始姿态,前后左右四个支撑点的最终高度值具体为:
H1i=H1m;
H2i=sin(X)*W+H2m;
H3i=sin(Y)*L+H3m;
H4i=sin(X)*W+sin(Y)*L+H4m;
式中H1i、H2i、H3i、H4i分别为左前支撑点、右前支撑点、左后支撑点、右后支撑点调平后所需高度值;H1m、H2m、H3m、H4m分别为左前支撑点、右前支撑点、左后支撑点、右后支撑点调平前高度值;X、Y分别为横向倾角、纵向倾角;L为整车轴距;W为整车轮距。
当车辆停于斜坡,处于右、前低的初始姿态,前后左右四个支撑点的最终高度值具体为:
H1i=sin(Y)*L+H1m;
H2i=sin(X)*W+sin(Y)*L+H2m;
H3i=H3m;
H4i=sin(X)*W+H3m;
式中H1i、H2i、H3i、H4i分别为左前支撑点、右前支撑点、左后支撑点、右后支撑点调平后所需高度值;H1m、H2m、H3m、H4m分别为左前支撑点、右前支撑点、左后支撑点、右后支撑点调平前高度值;X、Y分别为横向倾角、纵向倾角;L为整车轴距;W为整车轮距。
详细介绍步骤3。
所述将所述前后左右四个支撑点最终高度值减去所述前后左右四个支撑点最终高度值中的最小值,获得整车最低姿态调平所需前后左右四个支撑点高度值包括:
当车辆停于斜坡,处于左、后低的初始姿态时,所述调平后整车处于最低位前后左右四个支撑点所需的高度值具体为:
H1=H1i-MIN(H1i,H2i,H3i,H4i)=H1i-H2i;
H2=H2i-MIN(H1i,H2i,H3i,H4i)=0;
H3=H3i-MIN(H1i,H2i,H3i,H4i)=H3i-H2i;
H4=H4i-MIN(H1i,H2i,H3i,H4i)=H4i-H2i;
式中H1、H2、H3、H4分别为左前支撑点、右前支撑点、左后支撑点、右后支撑点调平后整车处于最低位所需高度值。
当车辆停于斜坡,处于左、前低的初始姿态,所述调平后整车处于最低位前后左右四个支撑点所需的高度值具体为:
H1=H1i-MIN(H1i,H2i,H3i,H4i)=H1i-H4i;
H2=H2i-MIN(H1i,H2i,H3i,H4i)=H2i-H4i;
H3=H3i-MIN(H1i,H2i,H3i,H4i)=H3i-H4i;
H4=H4i-MIN(H1i,H2i,H3i,H4i)=0;
式中H1、H2、H3、H4分别为左前支撑点、右前支撑点、左后支撑点、右后支撑点调平后整车处于最低位所需高度值。
当车辆停于斜坡,处于右、后低的初始姿态,所述调平后整车处于最低位前后左右四个支撑点所需的高度值具体为:
H1=H1i-MIN(H1i,H2i,H3i,H4i)=0;
H2=H2i-MIN(H1i,H2i,H3i,H4i)=H2i-H1i;
H3=H3i-MIN(H1i,H2i,H3i,H4i)=H3i-H1i;
H4=H4i-MIN(H1i,H2i,H3i,H4i)=H4i-H1i;
式中H1、H2、H3、H4分别为左前支撑点、右前支撑点、左后支撑点、右后支撑点调平后整车处于最低位所需高度值。
当车辆停于斜坡,处于右、前低的初始姿态,所述调平后整车处于最低位前后左右四个支撑点所需的高度值具体为:
H1=H1i-MIN(H1i,H2i,H3i,H4i)=H1i-H3i;
H2=H2i-MIN(H1i,H2i,H3i,H4i)=H2i-H3i;
H3=H3i-MIN(H1i,H2i,H3i,H4i)=0;
H4=H4i-MIN(H1i,H2i,H3i,H4i)=H3i-H3i;
式中H1、H2、H3、H4分别为左前支撑点、右前支撑点、左后支撑点、右后支撑点调平后整车处于最低位所需高度值。
详细介绍步骤5。
参见图2,所述调平放宽偏差迭代计算包括:
将X方向放宽调平角度到达第一设定值,调用所述支撑点补偿高度算法进行评判,如果能够调平则直接调平,如果不能调平继续放宽X方向调平角度,进行迭代运算评判,直到X方向放宽调平角度达到第二设定值;
如果X方向放宽调平角度达到第二设定值不能调平,则放宽Y方向调平角度到达第三设定值,重新进行迭代运算评判,此刻X方向放宽调平角度最大值将变小,以满足整车平面与地面夹角不大于5.0°要求,参见图3,X方向放宽调平角度与Y方向放宽调平角度值的对应关系为圆形曲线。
当迭代运算到Y方向达到第四设定值,X方向达到2.0°不能调平时,反馈无法调平结果,驾驶员可迅速更换作业地点,避免调节后发现调平结果不满足使用要求的情况发生。
为了更清楚介绍本发明实施例,下面从本发明实施例的使用方法上予以介绍。
根据倾角传感器X方向值得到车辆调平所需左右支撑点低端补偿高度值;当X倾角大于0°时,计算左前支撑点与左后支撑点的补偿高度,当X倾角小于0°时,计算右前支撑点与右后支撑点的补偿高度。根据倾角传感器Y方向值得到车辆调平所需前后支撑点低端补偿高度值;当Y倾角大于0°时,计算左后支撑点与右后支撑点的补偿高度,当Y倾角小于0°时,计算左前支撑点与右前支撑点的补偿高度。两次补偿高度值叠加形成前后左右四个支撑点补偿高度值,并加上各自支撑点当前高度值,得出前后左右四个支撑点最终高度值。得到前后左右四个支撑点最终高度值中的最小值,前后左右四个支撑点最终高度值减去前后左右四个支撑点最终高度值中的最小值,得出整车最低姿态调平所需前后左右四个支撑点高度值。当车辆停于斜坡,处于左、后低的初始姿态,车辆支撑点高度计算如下:H1i=sin(X)*W+H1m;H2i=H2m;H3i=sin(X)*W+sin(Y)*L+H3m;H4i=sin(Y)*L+H4m;式中H1i、H2i、H3i、H4i分别为左前支撑点、右前支撑点、左后支撑点、右后支撑点调平后所需高度值;H1m、H2m、H3m、H4m分别为左前支撑点、右前支撑点、左后支撑点、右后支撑点调平前高度值;X、Y分别为横向倾角、纵向倾角;L为整车轴距;W为整车轮距;求出调平后整车处于最低位前后左右四个支撑点所需的高度值;计算公式如下:H1=H1i-MIN(H1i,H2i,H3i,H4i)=H1i-H2i;H2=H2i-MIN(H1i,H2i,H3i,H4i)=0;H3=H3i-MIN(H1i,H2i,H3i,H4i)=H3i-H2i;H4=H4i-MIN(H1i,H2i,H3i,H4i)=H4i-H2i;式中H1、H2、H3、H4分别为左前支撑点、右前支撑点、左后支撑点、右后支撑点调平后整车处于最低位所需高度值。当车辆停于斜坡,处于左、前低的初始姿态,车辆支撑点高度计算公式如下:H1i=sin(X)*W+sin(Y)*L+H1m;H2i=sin(Y)*L+H2m;H3i=sin(X)*W+H3m;H4i=H4m;式中H1i、H2i、H3i、H4i分别为左前支撑点、右前支撑点、左后支撑点、右后支撑点调平后所需高度值;H1m、H2m、H3m、H4m分别为左前支撑点、右前支撑点、左后支撑点、右后支撑点调平前高度值;X、Y分别为横向倾角、纵向倾角;L为整车轴距;W为整车轮距;求出调平后整车处于最低位前后左右四个支撑点所需的高度值;计算公式如下:H1=H1i-MIN(H1i,H2i,H3i,H4i)=H1i-H4i;H2=H2i-MIN(H1i,H2i,H3i,H4i)=H2i-H4i;H3=H3i-MIN(H1i,H2i,H3i,H4i)=H3i-H4i;H4=H4i-MIN(H1i,H2i,H3i,H4i)=0;式中H1、H2、H3、H4分别为左前支撑点、右前支撑点、左后支撑点、右后支撑点调平后整车处于最低位所需高度值。当车辆停于斜坡,处于右、后低的初始姿态,车辆支撑点高度计算公式如下:H1i=H1m;H2i=sin(X)*W+H2m;H3i=sin(Y)*L+H3m;H4i=sin(X)*W+sin(Y)*L+H4m;式中H1i、H2i、H3i、H4i分别为左前支撑点、右前支撑点、左后支撑点、右后支撑点调平后所需高度值;H1m、H2m、H3m、H4m分别为左前支撑点、右前支撑点、左后支撑点、右后支撑点调平前高度值;X、Y分别为横向倾角、纵向倾角;L为整车轴距;W为整车轮距;求出调平后整车处于最低位前后左右四个支撑点所需的高度值;计算公式如下:H1=H1i-MIN(H1i,H2i,H3i,H4i)=0;H2=H2i-MIN(H1i,H2i,H3i,H4i)=H2i-H1i;H3=H3i-MIN(H1i,H2i,H3i,H4i)=H3i-H1i;H4=H4i-MIN(H1i,H2i,H3i,H4i)=H4i-H1i;式中H1、H2、H3、H4分别为左前支撑点、右前支撑点、左后支撑点、右后支撑点调平后整车处于最低位所需高度值。当车辆停于斜坡,处于右、前低的初始姿态,车辆支撑点高度计算公式如下:H1i=sin(Y)*L+H1m;H2i=sin(X)*W+sin(Y)*L+H2m;H3i=H3m;H4i=sin(X)*W+H4m;式中H1i、H2i、H3i、H4i分别为左前支撑点、右前支撑点、左后支撑点、右后支撑点调平后所需高度值;H1m、H2m、H3m、H4m分别为左前支撑点、右前支撑点、左后支撑点、右后支撑点调平前高度值;X、Y分别为横向倾角、纵向倾角;L为整车轴距;W为整车轮距;求出调平后整车处于最低位前后左右四个支撑点所需的高度值;计算公式如下:H1=H1i-MIN(H1i,H2i,H3i,H4i)=H1i-H3i;H2=H2i-MIN(H1i,H2i,H3i,H4i)=H2i-H3i;H3=H3i-MIN(H1i,H2i,H3i,H4i)=0;H4=H4i-MIN(H1i,H2i,H3i,H4i)=H3i-H3i;式中H1、H2、H3、H4分别为左前支撑点、右前支撑点、左后支撑点、右后支撑点调平后整车处于最低位所需高度值。根据最终H1、H2、H3、H4中最大值是否超过悬架最大行程,判断能否调平,并返回判断结果及前后左右四个支撑点最终高度值。当H1、H2、H3、H4高度值中最大值小于或等于悬架最大行程,根据整车最低姿态调平所需前后左右四个支撑点高度值进行调平。当前后左右四个支撑点高度值中最大值大于悬架最大行程,进行调平放宽偏差迭代计算,根据调平放宽偏差迭代计算得到的结果进行支撑点补偿高度计算,根据支撑点补偿高度计算得到的结果进行调平。
如果支撑点补偿高度计算得到的结果不能进行调平,则X方向放宽调平角度0.5°(该值可设定),再次调用支撑点补偿高度算法进行评判,如果能够调平则直接调平,如果不能调平继续放宽X方向调平角度,进行迭代运算评判,直到X方向放宽调平角度达到4.5°(该值可设定)。如果X方向放宽调平角度达到4.5°不能调平,则放宽Y方向调平角度0.5°,重新迭代运算评判,此刻X方向放宽调平角度最大值将变小,以满足整车平面与地面夹角不大于5.0°要求,参见附图3,X方向放宽调平角度与Y方向放宽调平角度值的对应关系为圆形曲线。当迭代运算到Y方向达到4.5°,X方向达到2.0°也不能调平时,反馈无法调平结果,可以实现任意斜坡路况下,车身开始姿态调节之前,算出最终能达到的水平姿态,并判断能否满足车身使用要求,如果不能满足要求则提示调平超范围,驾驶员可迅速更换作业地点,避免调节后发现调平结果不满足使用要求的情况发生,如果能够达到使用要求,则直接根据最终计算结果,将补偿高度一次调节到位,减少装备使用时的调平时间,缩短作业准备流程,有利于提高装备的快速响应能力。
最后所应说明的是,以上具体实施方式仅用以说明本发明的技术方案而非限制,尽管参照实例对本发明进行了详细说明,本领域的普通技术人员应当理解,可以对本发明的技术方案进行修改或者等同替换,而不脱离本发明技术方案的精神和范围,其均应涵盖在本发明的权利要求范围当中。

Claims (9)

1.一种车身姿态预估调平控制方法,其特征在于,包括以下步骤:
根据倾角传感器X方向值得到车辆调平所需左右支撑点低端补偿高度值,根据倾角传感器Y方向值得到车辆调平所需前后支撑点低端补偿高度值;
所述左右支撑点低端补偿高度值和所述前后支撑点低端补偿高度值叠加形成前后左右四个支撑点补偿高度值,所述前后左右四个支撑点补偿高度值加上各自支撑点当前高度值,得出前后左右四个支撑点最终高度值;
将所述前后左右四个支撑点最终高度值减去所述前后左右四个支撑点最终高度值中的最小值,获得调平后整车处于最低位前后左右四个支撑点所需的高度值;
当所述前后左右四个支撑点所需高度值中最大值小于或等于悬架最大行程,根据调平后整车处于最低位前后左右四个支撑点所需的高度值进行调平;
当所述调平后整车处于最低位前后左右四个支撑点所需的高度值中最大值大于悬架最大行程,进行调平放宽偏差迭代计算,根据所述调平放宽偏差迭代计算得到的结果进行支撑点补偿高度计算,根据支撑点补偿高度计算得到的结果进行调平;
所述调平放宽偏差迭代计算包括:将X方向放宽调平角度到达第一设定值,调用所述支撑点补偿高度算法进行评判,如果能够调平则直接调平,如果不能调平继续放宽X方向调平角度,进行迭代运算评判,直到X方向放宽调平角度达到第二设定值;如果X方向放宽调平角度达到第二设定值不能调平,则放宽Y方向调平角度到达第三设定值,重新进行迭代运算评判,此刻X方向放宽调平角度最大值将变小,以满足整车平面与地面夹角不大于5.0°要求。
2.根据权利要求1所述的车身姿态预估调平控制方法,其特征在于,所述左右支撑点低端补偿高度值和所述前后支撑点低端补偿高度值叠加形成前后左右四个支撑点补偿高度值,所述前后左右四个支撑点补偿高度值加上各自支撑点当前高度值,得出前后左右四个支撑点最终高度值包括:
当车辆停于斜坡,处于左、后低的初始姿态时,前后左右四个支撑点的最终高度值具体为:
H1i=sin(X)*W+H1m;
H2i=H2m;
H3i=sin(X)*W+sin(Y)*L+H3m;
H4i=sin(Y)*L+H4m;
式中H1i、H2i、H3i、H4i分别为左前支撑点、右前支撑点、左后支撑点、右后支撑点调平后所需高度值;H1m、H2m、H3m、H4m分别为左前支撑点、右前支撑点、左后支撑点、右后支撑点调平前高度值;X、Y分别为横向倾角、纵向倾角;L为整车轴距;W为整车轮距。
3.根据权利要求2所述的车身姿态预估调平控制方法,其特征在于,将所述前后左右四个支撑点最终高度值减去所述前后左右四个支撑点最终高度值中的最小值,获得整车最低姿态调平所需前后左右四个支撑点高度值包括:
所述调平后整车处于最低位前后左右四个支撑点所需的高度值具体为:
H1=H1i-MIN(H1i,H2i,H3i,H4i)=H1i-H2i;
H2=H2i-MIN(H1i,H2i,H3i,H4i)=0;
H3=H3i-MIN(H1i,H2i,H3i,H4i)=H3i-H2i;
H4=H4i-MIN(H1i,H2i,H3i,H4i)=H4i-H2i;
式中H1、H2、H3、H4分别为左前支撑点、右前支撑点、左后支撑点、右后支撑点调平后整车处于最低位所需高度值。
4.根据权利要求1所述的车身姿态预估调平控制方法,其特征在于,所述左右支撑点低端补偿高度值和所述前后支撑点低端补偿高度值叠加形成前后左右四个支撑点补偿高度值,所述前后左右四个支撑点补偿高度值加上各自支撑点当前高度值,得出前后左右四个支撑点最终高度值包括:
当车辆停于斜坡,处于左、前低的初始姿态,前后左右四个支撑点的最终高度值具体为:
H1i=sin(X)*W+sin(Y)*L+H1m;
H2i=sin(Y)*L+H2m;
H3i=sin(X)*W+H3m;
H4i=H4m;
式中H1i、H2i、H3i、H4i分别为左前支撑点、右前支撑点、左后支撑点、右后支撑点调平后所需高度值;H1m、H2m、H3m、H4m分别为左前支撑点、右前支撑点、左后支撑点、右后支撑点调平前高度值;X、Y分别为横向倾角、纵向倾角;L为整车轴距;W为整车轮距。
5.根据权利要求4所述的车身姿态预估调平控制方法,其特征在于,将所述前后左右四个支撑点最终高度值减去所述前后左右四个支撑点最终高度值中的最小值,获得整车最低姿态调平所需前后左右四个支撑点高度值包括:
所述调平后整车处于最低位前后左右四个支撑点所需的高度值具体为:
H1=H1i-MIN(H1i,H2i,H3i,H4i)=H1i-H4i;
H2=H2i-MIN(H1i,H2i,H3i,H4i)=H2i-H4i;
H3=H3i-MIN(H1i,H2i,H3i,H4i)=H3i-H4i;
H4=H4i-MIN(H1i,H2i,H3i,H4i)=0;
式中H1、H2、H3、H4分别为左前支撑点、右前支撑点、左后支撑点、右后支撑点调平后整车处于最低位所需高度值。
6.根据权利要求1所述的车身姿态预估调平控制方法,其特征在于,所述左右支撑点低端补偿高度值和所述前后支撑点低端补偿高度值叠加形成前后左右四个支撑点补偿高度值,所述前后左右四个支撑点补偿高度值加上各自支撑点当前高度值,得出前后左右四个支撑点最终高度值包括:
当车辆停于斜坡,处于右、后低的初始姿态,前后左右四个支撑点的最终高度值具体为:
H1i=H1m;
H2i=sin(X)*W+H2m;
H3i=sin(Y)*L+H3m;
H4i=sin(X)*W+sin(Y)*L+H4m;
式中H1i、H2i、H3i、H4i分别为左前支撑点、右前支撑点、左后支撑点、右后支撑点调平后所需高度值;H1m、H2m、H3m、H4m分别为左前支撑点、右前支撑点、左后支撑点、右后支撑点调平前高度值;X、Y分别为横向倾角、纵向倾角;L为整车轴距;W为整车轮距。
7.根据权利要求6所述的车身姿态预估调平控制方法,其特征在于,将所述前后左右四个支撑点最终高度值减去所述前后左右四个支撑点最终高度值中的最小值,获得整车最低姿态调平所需前后左右四个支撑点高度值包括:
所述调平后整车处于最低位前后左右四个支撑点所需的高度值具体为:
H1=H1i-MIN(H1i,H2i,H3i,H4i)=0;
H2=H2i-MIN(H1i,H2i,H3i,H4i)=H2i-H1i;
H3=H3i-MIN(H1i,H2i,H3i,H4i)=H3i-H1i;
H4=H4i-MIN(H1i,H2i,H3i,H4i)=H4i-H1i;
式中H1、H2、H3、H4分别为左前支撑点、右前支撑点、左后支撑点、右后支撑点调平后整车处于最低位所需高度值。
8.根据权利要求1所述的车身姿态预估调平控制方法,其特征在于,所述左右支撑点低端补偿高度值和所述前后支撑点低端补偿高度值叠加形成前后左右四个支撑点补偿高度值,所述前后左右四个支撑点补偿高度值加上各自支撑点当前高度值,得出前后左右四个支撑点最终高度值包括:
当车辆停于斜坡,处于右、前低的初始姿态,前后左右四个支撑点的最终高度值具体为:
H1i=sin(Y)*L+H1m;
H2i=sin(X)*W+sin(Y)*L+H2m;
H3i=H3m;
H4i=sin(X)*W+H4m;
式中H1i、H2i、H3i、H4i分别为左前支撑点、右前支撑点、左后支撑点、右后支撑点调平后所需高度值;H1m、H2m、H3m、H4m分别为左前支撑点、右前支撑点、左后支撑点、右后支撑点调平前高度值;X、Y分别为横向倾角、纵向倾角;L为整车轴距;W为整车轮距。
9.根据权利要求8所述的车身姿态预估调平控制方法,其特征在于,将所述前后左右四个支撑点最终高度值减去所述前后左右四个支撑点最终高度值中的最小值,获得整车最低姿态调平所需前后左右四个支撑点高度值包括:
所述调平后整车处于最低位前后左右四个支撑点所需的高度值具体为:
H1=H1i-MIN(H1i,H2i,H3i,H4i)=H1i-H3i;
H2=H2i-MIN(H1i,H2i,H3i,H4i)=H2i-H3i;
H3=H3i-MIN(H1i,H2i,H3i,H4i)=0;
H4=H4i-MIN(H1i,H2i,H3i,H4i)=H3i-H3i;
式中H1、H2、H3、H4分别为左前支撑点、右前支撑点、左后支撑点、右后支撑点调平后整车处于最低位所需高度值。
CN201510901608.6A 2015-12-08 2015-12-08 一种车身姿态预估调平控制方法 Active CN105415998B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201510901608.6A CN105415998B (zh) 2015-12-08 2015-12-08 一种车身姿态预估调平控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201510901608.6A CN105415998B (zh) 2015-12-08 2015-12-08 一种车身姿态预估调平控制方法

Publications (2)

Publication Number Publication Date
CN105415998A CN105415998A (zh) 2016-03-23
CN105415998B true CN105415998B (zh) 2018-03-30

Family

ID=55494712

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201510901608.6A Active CN105415998B (zh) 2015-12-08 2015-12-08 一种车身姿态预估调平控制方法

Country Status (1)

Country Link
CN (1) CN105415998B (zh)

Families Citing this family (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106080085A (zh) * 2016-07-11 2016-11-09 安庆新景技电子科技有限公司 整车姿态控制方法
CN109094566A (zh) * 2017-06-21 2018-12-28 奥迪股份公司 车辆驾驶辅助系统和方法
CN108437733B (zh) * 2018-03-15 2020-07-24 中国农业大学 高速农用车辆平台预检测主动调平系统及调平方法
CN108363404B (zh) * 2018-03-15 2020-09-29 中国农业大学 高精度农用车辆平台预检测主动调平系统及调平方法
CN109997826B (zh) * 2019-04-11 2021-03-09 湖南农业大学 高地隙植保机的调平控制方法及系统
CN112629459B (zh) * 2021-01-04 2022-08-30 东风华神汽车有限公司 一种用于车身姿态调平的标定方法
CN113184054B (zh) * 2021-05-20 2023-09-15 上海擎朗智能科技有限公司 机器人底盘及机器人底盘控制方法
CN113417106B (zh) * 2021-06-28 2023-11-28 青岛海尔科技有限公司 基于压力传感器的洗衣机平稳运行方法及装置

Family Cites Families (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE3408292A1 (de) * 1984-03-07 1985-08-29 Daimler-Benz Ag, 7000 Stuttgart Aktives federungssystem
JPS60248414A (ja) * 1984-05-22 1985-12-09 Daihatsu Motor Co Ltd 車両の姿勢制御装置
CN100522670C (zh) * 2007-10-09 2009-08-05 张卫东 铁水包车的液压自动调平方法
CN103182916B (zh) * 2011-12-28 2016-11-02 长春孔辉汽车科技股份有限公司 多轴车辆油气悬架调平装置及方法
CN102514551A (zh) * 2011-12-31 2012-06-27 长沙中联消防机械有限公司 车辆支腿调平方法、车辆支腿调平装置和车辆

Also Published As

Publication number Publication date
CN105415998A (zh) 2016-03-23

Similar Documents

Publication Publication Date Title
CN105415998B (zh) 一种车身姿态预估调平控制方法
CN108549237B (zh) 基于深度增强学习的预观控制仿人机器人步态规划方法
KR102245115B1 (ko) 차량 거동 제어 장치
CN111377004B (zh) 一种双足机器人步态控制方法以及双足机器人
US11130234B2 (en) Robot and collision detection method therefor
JP4531520B2 (ja) 脚式移動ロボットの制御装置
CN104217107B (zh) 一种基于多传感器信息仿人机器人跌倒状态检测方法
US20120259536A1 (en) Continuous computation of center of gravity of a vehicle
CN106080085A (zh) 整车姿态控制方法
CN105382843B (zh) 一种抓捕末阶段机械臂与操作平台协调控制方法
KR20200003037A (ko) 작업 기계, 작업 기계를 포함하는 시스템 및 작업 기계의 제어 방법
CN104898672B (zh) 一种仿人机器人行走轨迹的优化控制方法
JP5605624B2 (ja) 歩行ロボットのzmp制御装置
CN115933723B (zh) 一种应用于双足机器人快速行走的全身柔顺控制方法
CN114021376B (zh) 一种四足机器人地形坡度估计方法
CN104252173A (zh) 双足步行机器人的步行控制方法
CN110209183A (zh) 一种基于双阈值法zmp的六足机器人失稳调节算法
CN112644599A (zh) 双足机器人的姿态调整方法、装置、设备及存储介质
CN113064350A (zh) 一种导弹助推段自适应动态面控制方法和装置
JP5616289B2 (ja) 床面推定装置
CN114683289A (zh) 一种四足机器人姿态预适应控制方法
CN109367345A (zh) 整车姿态控制方法
CN105806312A (zh) 基于三条及以上支撑腿的足式机器人地形参数测量方法
CN109324624A (zh) 一种基于可操作度分析的崎岖地形六足机器人操纵方法
JP6408828B2 (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
GR01 Patent grant
GR01 Patent grant