CN113370734B - 基于车前地形的主动悬挂惯性调控方法和控制系统 - Google Patents
基于车前地形的主动悬挂惯性调控方法和控制系统 Download PDFInfo
- Publication number
- CN113370734B CN113370734B CN202110714689.4A CN202110714689A CN113370734B CN 113370734 B CN113370734 B CN 113370734B CN 202110714689 A CN202110714689 A CN 202110714689A CN 113370734 B CN113370734 B CN 113370734B
- Authority
- CN
- China
- Prior art keywords
- vehicle
- suspension
- history
- terrain
- active suspension
- 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
Links
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60G—VEHICLE SUSPENSION ARRANGEMENTS
- B60G17/00—Resilient 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/015—Resilient 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/016—Resilient 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/0165—Resilient 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
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60G—VEHICLE SUSPENSION ARRANGEMENTS
- B60G17/00—Resilient 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/015—Resilient 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
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60G—VEHICLE SUSPENSION ARRANGEMENTS
- B60G17/00—Resilient 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/015—Resilient 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/018—Resilient 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 the use of a specific signal treatment or control method
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60G—VEHICLE SUSPENSION ARRANGEMENTS
- B60G17/00—Resilient 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/015—Resilient 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/018—Resilient 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 the use of a specific signal treatment or control method
- B60G17/0182—Resilient 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 the use of a specific signal treatment or control method involving parameter estimation, e.g. observer, Kalman filter
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60G—VEHICLE SUSPENSION ARRANGEMENTS
- B60G17/00—Resilient 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/015—Resilient 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/019—Resilient 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 the type of sensor or the arrangement thereof
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60G—VEHICLE SUSPENSION ARRANGEMENTS
- B60G2202/00—Indexing codes relating to the type of spring, damper or actuator
- B60G2202/40—Type of actuator
- B60G2202/41—Fluid actuator
- B60G2202/413—Hydraulic actuator
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60G—VEHICLE SUSPENSION ARRANGEMENTS
- B60G2400/00—Indexing codes relating to detected, measured or calculated conditions or factors
- B60G2400/05—Attitude
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60G—VEHICLE SUSPENSION ARRANGEMENTS
- B60G2400/00—Indexing codes relating to detected, measured or calculated conditions or factors
- B60G2400/20—Speed
- B60G2400/204—Vehicle speed
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60G—VEHICLE SUSPENSION ARRANGEMENTS
- B60G2400/00—Indexing codes relating to detected, measured or calculated conditions or factors
- B60G2400/25—Stroke; Height; Displacement
- B60G2400/252—Stroke; Height; Displacement vertical
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60G—VEHICLE SUSPENSION ARRANGEMENTS
- B60G2400/00—Indexing codes relating to detected, measured or calculated conditions or factors
- B60G2400/40—Steering conditions
- B60G2400/41—Steering angle
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60G—VEHICLE SUSPENSION ARRANGEMENTS
- B60G2400/00—Indexing codes relating to detected, measured or calculated conditions or factors
- B60G2400/80—Exterior conditions
- B60G2400/82—Ground surface
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60G—VEHICLE SUSPENSION ARRANGEMENTS
- B60G2400/00—Indexing codes relating to detected, measured or calculated conditions or factors
- B60G2400/80—Exterior conditions
- B60G2400/82—Ground surface
- B60G2400/822—Road friction coefficient determination affecting wheel traction
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60G—VEHICLE SUSPENSION ARRANGEMENTS
- B60G2401/00—Indexing codes relating to the type of sensors based on the principle of their operation
- B60G2401/16—GPS track data
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60G—VEHICLE SUSPENSION ARRANGEMENTS
- B60G2401/00—Indexing codes relating to the type of sensors based on the principle of their operation
- B60G2401/17—Magnetic/Electromagnetic
- B60G2401/174—Radar
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60G—VEHICLE SUSPENSION ARRANGEMENTS
- B60G2401/00—Indexing codes relating to the type of sensors based on the principle of their operation
- B60G2401/21—Laser
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60G—VEHICLE SUSPENSION ARRANGEMENTS
- B60G2500/00—Indexing codes relating to the regulated action or device
- B60G2500/30—Height or ground clearance
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60G—VEHICLE SUSPENSION ARRANGEMENTS
- B60G2600/00—Indexing codes relating to particular elements, systems or processes used on suspension systems or suspension control systems
- B60G2600/09—Feedback signal
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60G—VEHICLE SUSPENSION ARRANGEMENTS
- B60G2600/00—Indexing codes relating to particular elements, systems or processes used on suspension systems or suspension control systems
- B60G2600/17—Proportional control, i.e. gain control
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60G—VEHICLE SUSPENSION ARRANGEMENTS
- B60G2600/00—Indexing codes relating to particular elements, systems or processes used on suspension systems or suspension control systems
- B60G2600/18—Automatic control means
- B60G2600/182—Active control means
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60G—VEHICLE SUSPENSION ARRANGEMENTS
- B60G2600/00—Indexing codes relating to particular elements, systems or processes used on suspension systems or suspension control systems
- B60G2600/18—Automatic control means
- B60G2600/187—Digital Controller Details and Signal Treatment
- B60G2600/1873—Model Following
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60G—VEHICLE SUSPENSION ARRANGEMENTS
- B60G2600/00—Indexing codes relating to particular elements, systems or processes used on suspension systems or suspension control systems
- B60G2600/70—Computer memory; Data storage, e.g. maps for adaptive control
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60G—VEHICLE SUSPENSION ARRANGEMENTS
- B60G2800/00—Indexing 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/87—System configuration based on vehicle type or model
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60G—VEHICLE SUSPENSION ARRANGEMENTS
- B60G2800/00—Indexing 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/90—System Controller type
- B60G2800/91—Suspension Control
- B60G2800/915—Suspension load distribution
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60Y—INDEXING SCHEME RELATING TO ASPECTS CROSS-CUTTING VEHICLE TECHNOLOGY
- B60Y2400/00—Special features of vehicle units
- B60Y2400/86—Suspension systems
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T90/00—Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation
Abstract
本发明公开了一种基于车前地形的主动悬挂惯性调控方法及其控制系统。依据扫描获得的车前地形,计算车辆以被动悬挂驶过车前地形的质心轨迹和姿态历程,对其进行平滑处理后,控制主动悬挂使车辆按平滑后的轨迹行驶。期间,调整平滑系数使各悬挂行程限制在极限行程之内,并依据动力学模型计算出的各主动悬挂的支撑力和行程,对悬挂的作动器进行基于力‑位移的阻抗控制。本发明能显著提高车辆在不平路面行驶的平顺性和操纵稳定性。
Description
技术领域
本发明涉及车辆悬挂领域,尤其是一种基于车前地形的主动悬挂控制方法和控制系统。
背景技术
悬挂系统是车辆底盘的重要组成部分,其性能直接决定着车辆的行驶平顺性和操纵稳定性。传统的车辆大多采用被动悬挂,其悬挂参数根据特定路面条件进行设计,一经选定便难以改变,不能随路面状况、车速等发生变化,因此限制了汽车行驶性能的进一步提高。
主动悬挂是近十几年来发展起来的由电脑控制的一种悬挂方式,主动悬挂可以根据车载质量、路面状况(如颠簸振动情况)、运行工况(如车速、驱/制动、转向)等的变化,自动调整悬挂的刚度与阻尼或悬挂伸缩,以满足汽车行驶平顺性和操纵稳定性等方面的要求。
主动悬挂技术主要包含主动悬挂控制方法和系统两部分。主动悬挂系统包括提供能量的装置和可控制作用力或位移的附加装置。根据能源提供的方式不同又分为液压驱动、气压驱动和电驱动三种,液压驱动悬挂系统因功率密度较高,便于布置安装等优点目前应用较多,气压驱动悬挂系统因为驱动柔和、污染少等优势也得到了一定的应用。即使相同的主动悬挂系统由于采用不同的控制方法,也会产生不同的控制效果。目前的主动悬挂的控制方法主要包括:天棚阻尼控制、最优控制、预瞄控制、自适应控制、模糊控制、神经网络控制、滑模控制、免疫进化控制等。根据文献记载,无论采用何种控制方法,车辆的性能均有不同程度的改善,但也存在一些问题没有得到较好地解决,特别是车辆的姿态调节和行驶平顺性控制是悬挂设计需考虑的两个重要方面,现有研究成果大多是根据不同的需要建立不同的数学模型,各自独立进行设计,并认为车辆的总体性能是二者性能之和;或者对数学模型进行分解,然后再组合起来进行控制。在建立数学模型时没有考虑把姿态控制和行驶平顺性控制同时进行设计,设计过程比较复杂且难以获得较好的控制效果。
发明内容
为了解决前述问题,我们提出了一种新的主动悬挂控制理论——悬挂惯性调控原理。它是基于仿生原理提出的,猎豹之所以能以120km/h的速度在凹凸不平的野外奔跑,主要是因为它可以根据前方地形调节各爪的支撑高度和支撑力,使质心沿一个平滑的曲线运动,且可以保持姿态的相对稳定。基于此原理,本发明提出的基于车前地形的主动悬挂惯性调控方法是,通过激光雷达扫描车前地形,根据车前地形的高程信息和行车参数自主控制各组悬挂的伸缩,使车辆在凹凸不平路面行驶时其质心沿一条相对比较平滑的曲线运动,且车体姿态尽可能地保持平稳变化,从而大幅度降低车辆行驶时车体的颠簸振动,提高车辆在不平路面行驶的速度、行驶平顺性和操纵稳定性。
为了实现上述控制目标,规划出比原被动悬挂车辆行驶时更加平滑的运动轨迹,是本发明要解决的主要问题。实践证明,车辆轨迹的规划不应该是基于几何学的,因几何学所规划的轨迹一般不符合车辆运动学与动力学规律,即由几何学规划出来的车辆轨迹上的各时点的位姿,实际车辆不一定能够实现。所以合理的轨迹规划首先应该符合运动学与动力学规律,其次应该保证轨迹上的各点所对应的所有悬挂行程均应位于极限行程之内。
实际车辆以被动悬挂越过不平路面时,从起点驶向终点的轨迹是一种现实的存在,它无疑具有合理性,即车辆按照这样的轨迹运动不但符合运动学与动力学规律,而且从起点驶向终点各悬挂的行程也一定在其极限行程范围内。更重要的是,车辆以不同性能的悬挂驶过相同的路程时,其轨迹也会有所变化,且各悬挂的行程都在其极限行程范围内。即车辆从起点驶向终点其轨迹可有一定的变化范围,这就为本发明进行主动悬挂车辆的轨迹规划提供了理论依据。
本发明提出的车辆轨迹规划思路是,假设车辆可选择使用被动悬挂或主动悬挂,以被动悬挂驶过不平路面的车辆轨迹作为基础,对其进行平滑处理,使车辆以主动悬挂按平滑后的新轨迹行驶,其各时点悬挂的行程如果能控制在极限行程范围之内,那么这样的主动悬挂控制方法就可以使车辆的行驶平顺性和操控稳定性得到提高。在满足悬挂行程不超过极限行程的条件下,车辆轨迹越平滑,行驶平顺性和操控稳定性就会越好。
基于以上思路,本发明的第一方面是提供一种基于车前地形的主动悬挂惯性调控方法,其包括:
S1:计算车辆驶过车前地形的车轮接地点轨迹和各车轮接地点高程信息。
根据惯性测量单元、双天线GPS定位系统测得的车辆在大地坐标系下的位置坐标、激光雷达扫描得到的车前地形和各车轮转向角,由车辆运动学计算出车辆在车前地形上行驶时各个车轮接地点的轨迹T1、T2、…、Tm,j=1、2、…、m,m为车轮的个数。通过插值算法计算出各车轮接地点轨迹上各规划数据点的高程信息。
S2:计算车辆以被动悬挂驶过车前地形的质心轨迹与姿态历程。
S21:根据车速、转向角、各车轮驱/制动力和车轮在地面的滚动摩擦系数,由车辆的动力学模型计算出车辆以被动悬挂沿步骤S1中车轮接地点轨迹T1、T2、…、Tm行驶时车辆坐标系的6维坐标历程{XiYiZiαiβiγi}T。和车辆的质心轨迹和姿态历程{XWiYWiZWiαWiβWiγWi}T,其中:XWi、YWi、ZWi、αWi、βWi、γWi分别为车辆质心处的三维坐标和三维姿态角,i=0、1、2、…、n,n为规划数据点的个数。
S22:取平滑系数为ξ,对步骤S21中的被动悬挂车辆质心轨迹和姿态历程进行过起点的平滑处理,得到质心轨迹和姿态历程的平滑函数{XW(ti)、YW(ti)、ZW(ti)、αW(ti)、βW(ti)、γW(ti)}T。
S3:基于前述平滑处理后的质心轨迹与姿态历程,计算车辆以主动悬挂驶过车前地形的悬挂行程历程si,j和悬挂支撑力历程Wij。
S32:在与步骤S21相同的车速、转向角、各车轮驱/制动力、地面滚动摩擦系数情况下,依照步骤S31中获得的主动悬挂相对于被动悬挂行程历程和速度历程由动力学模型计算车辆以主动悬挂驶过车前地形的各悬挂相对于中位的行程历程si,j支撑力历程Wij。
S4:依据车辆以主动悬挂驶过车前地形时悬挂相对中位的行程历程si,j和悬挂支撑力历程Wij,对悬挂作动器实施基于力-位移的阻抗控制。
优选的,所述S21、S32中具体的车辆动力学模型及其解法如下:
如图2所示,建立固定坐标系OXYZ,它与地面固连,该坐标系以惯性测量单元基准点O为坐标原点,以车辆的正前方为Y轴正方向,以车辆的右侧方向为X轴正方向,以垂直XOY平面向上的方向为Z轴正方向;为确定车辆在固定坐标系中的位置,再引入车辆坐标系oxyz,它与车体固连。车辆坐标系与固定坐标系在初始位置重合,其在固定坐标系中的定位坐标分别为X、Y、Z、α、β、γ。
为提高计算速度,将车辆看作刚体,设其质量为M,它在车辆坐标系中的坐标为W(xW,yW,zW)。车辆具有m个车轮,对应有m个悬挂。将主动悬挂简化为作动器、弹簧和阻尼器的并联。设对主动悬挂的控制方法为位移控制;各悬挂弹簧的刚度系数分别为KS1、KS2、…、KSm,各悬挂阻尼器的阻尼系数分别为CS1、CS2、…、CSm。将轮胎简化为垂向弹簧与阻尼的并联,忽略轮胎侧向与切向弹性和阻尼对车辆动力学特性的影响。设各轮胎垂向弹簧的刚度系数分别为KW1、KW2、…、KWm,各轮胎垂向阻尼的阻尼系数分别为CW1、CW2、…、CWm。设前述阻尼均为粘性阻尼;前述弹簧均设为非线性弹簧,并以分段线性近似。
以上所建的是主动悬挂车辆的动力学模型,它具有6个自由度。若去掉各悬挂中的作动器,则前述动力学模型就变为被动悬挂车辆的动力学模型。值得一提的是,部分主动悬挂设计时不设悬挂弹簧和阻尼器,此种情况应将上述主动悬挂车辆动力学模型中的悬挂弹簧和阻尼器略去。
通过拉格郎日方程建立该车辆动力学模型的运动微分方程,用矩阵表示如下:
式中:[M6×6]、[C6×6]、[K6×6]分别为质量阵、阻尼阵和刚度阵,均为6×6的对称方阵;{F6}为力矩阵,为6×1的列阵。
取车辆在固定坐标系的位移向量为:
{q6}={X、Y、Z、α、β、γ}T
基于上面的运动微分方程构建动力学矩阵如下:
设状态变量为:
代入动力学矩阵得状态方程式如下:
其中:
上面的状态方程式可通过四阶龙格库塔法求解,得出状态变量{q12}的值。
优选的,所述S21计算车辆以被动悬挂驶过车前地形的质心轨迹和姿态历程的具体方法为:
由动力学模型求得的车辆以被动悬挂驶过车前地形的各时点{q12}i,求得车辆轨迹历程中的与悬挂特性相关的三个坐标为:
上式是假设α、β是微小变量,取cosα≈1,cosβ≈1,sinα≈α,sinβ≈β,并忽略了车身的变形得出的。
①基于S21中求得的车辆以被动悬挂驶过车前地形的车辆坐标系6维坐标历程{XiYiZiαiβiγi}T,由下式求出各悬挂上支撑点Q1、Q2、…、Qm的垂向位移历程为:
式中:bj——编号为j的悬挂上支撑点在oxyz坐标系中的x坐标;
Lj——编号为j的悬挂上支撑点在oxyz坐标系中的y坐标。
则各悬挂上支撑点Q1、Q2、…、Qm的垂向速度历程为:
②根据S22中平滑处理后得到的质心轨迹和姿态历程的函数{XW(ti)、YW(ti)、ZW(ti)、αW(ti)、βW(ti)、γW(ti)}T,反求出车辆坐标系相对固定坐标系三个相关坐标的时间历程函数为:
再由z(ti)、α(ti)、β(ti)求出各悬挂上支撑点Q1、Q2、…、Qm的垂向位移为:
各悬挂上支撑点Q1、Q2、…、Qm的垂向速度为:
优选的,步骤S32中由车辆动力学模型计算以主动悬挂驶过车前地形的车辆各悬挂行程历程si,j和支撑力历程Wij的具体步如下:
根据主动/被动悬挂行程差历程和速度差历程由车辆动力学模型求解得到主动悬挂车辆驶过车前地形的新状态变量{q′12}i,将其中所包括的位移变量z′i,α′i,β′i,代入下式求出各悬挂上支撑点Q1、Q2、…、Qm的垂向位移历程:
w′i,j=z′i-bjβ′i+Ljα′i,i=0、1、2、…、n;j=1、2、…、m
②求各主动悬挂相对于中位的行程历程si,j
因轮胎的垂向变形远小于主动悬挂的行程,这里暂且略去轮胎的垂向变形,轮胎的垂向变形将在S4中的悬挂阻抗控制中得到补偿。则各主动悬挂相对于中位的行程历程等于各主动悬挂上支撑点Q1、Q2、…、Qm的垂向位移历程wi′,j与各车轮接地点R1、R2、…、Rm的垂向位移历程△i,j之差。
si,j=wi′,j-△i,j,i=0、1、2、…、n;j=1、2、…、m
③求各主动悬挂的支撑力历程Wi,j
车辆各主动悬挂的支撑力历程为:
优选的,所述S4对悬挂作动器实施基于力-位移的阻抗控制的具体实现方法如下:
①求解悬挂阻抗控制的位移控制量
式中,M、K和C分别为目标惯性、目标刚度与目标阻尼,分别反映了簧下质量的惯性特性、轮胎接地的刚度特性和阻尼特性。上面的微分方程可用卷积积分方式求解:
上式中的函数hi,j(t)是前式所对应单位脉冲响应函数。
②主动悬挂基于力-位移的阻抗控制
校验式为:
式中:smin——悬挂的下极限位移;
smax——悬挂的上极限位移。
若存在某个悬挂行程超过极限行程,则首先降低对车辆轨迹曲线的平滑度,调整相应的平滑系数ξ,分以下两种情况分别进行处理:
①若平滑系数ξ尚未达到预设的平滑系数极限值,则转到步骤S22。
②若平滑系数ξ已达平滑系数极限值,仍然不能满足全历程内各悬挂行程不超过极限行程的条件,按照出现的时间顺序找到悬挂行程超过极限行程的第一个数据点,设其在步骤S2中规划数据点的编号为iE(1≤iE≤n),则令n=iE,并返回步骤S21。
通过以上处理可使全历程内各悬挂行程均不超过极限行程。
本发明的第二方面是提供一种根据前述的基于车前地形的主动悬挂惯性调控方法的控制系统,如图1所示,系统包括车体及m个车轮、激光雷达、惯性测量单元、双天线GPS定位系统、与车轮相对应的悬挂缸及其位移传感器、支撑力传感器和伺服控制器组、车速传感器、方向盘转角传感器、油门开度传感器、制动力传感器、电控单元;其中,激光雷达、惯性测量单元、双天线GPS定位系统、电控单元以及伺服控制器组固定于车体上,且激光雷达装于车体的前部用于测量车前地形,双天线GPS定位系统的两个天线在空间上隔开一定的距离;所述车轮通过悬挂缸连接于车体下方,位移传感器与支撑力传感器安装于悬挂缸上用于测量悬挂缸的行程和支撑力;方向盘转角传感器、油门开度传感器、制动力传感器用于测量转向角和油门开度与制动强度;所述电控单元分别与惯性测量单元、激光雷达、双天线GPS定位系统、方向盘转角传感器、油门开度传感器、制动力传感器、以及伺服控制器组通讯连接,伺服控制器组与悬挂缸的位移传感器和支撑力传感器通讯连接。
由于采用了上述技术方案,本发明取得的技术进步是:
与现有主动悬挂技术相比,本发明的优势在于,能够将姿态调节控制和行驶平顺性控制统一起来,从而使悬挂性能得到大幅度提高。传统的主动悬挂控制主要是根据车辆的行驶工况对悬挂的刚度与阻尼或悬挂行程进行控制,而不是对车辆位姿进行控制,所以存在行驶时车辆位姿不可控的因素,影响到行驶平顺性、操控稳定性和行驶安全性,特别是在地面凹凸不平和松软程度变化较大的情况下陡增了失控的风险。本发明提出的基于车前地形的主动悬挂惯性调控方法和控制系统,通过控制各组悬挂的伸缩来控制车辆行驶的位姿;通过对悬挂进行力-位移阻抗控制,克服地面软硬程度变化带来的扰动影响,使车辆的质心沿预定的平滑曲线运动且姿态保持基本稳定,从而大幅度提高车辆在非结构化路面行驶的行车速度、行驶平顺性和操纵稳定性。
附图说明
图1是基于车前地形的主动悬挂惯性调控系统结构原理图;
图2是多轴主动悬挂车辆在不平斜坡行驶的动力学模型;
图3是针对悬挂实施的基于力-位移的阻抗控制原理图;
图4是基于车前地形的三轴车辆主动悬挂惯性调控系统结构原理图;
图5是三轴主动悬挂车辆在不平斜坡行驶的动力学模型。
具体实施方式
下面结合实施例对本发明做进一步详细说明:
1.基于车前地形的主动悬挂惯性调控系统
如图1所示,系统包括车前地形1,车体2以及m个车轮3-1、3-2、…、3-m,激光雷达4,惯性测量单元5,双天线GPS定位系统6-1、6-2,车速传感器7,挡位传感器8,方向盘转角传感器9、油门开度传感器10、及制动力传感器11,与车轮相对应的悬挂缸12-1、12-2、…、12-m及其位移传感器13-1、13-2、…、13-m和支撑力传感器14-1、14-2、…、14-m,伺服控制器组15、电控单元16等。其中,激光雷达4、惯性测量单元5、双天线GPS定位系统的两个天线6-1、6-2、电控单元16以及伺服控制器组15固定于车体2上,且激光雷达4装于车体2的前部用于测量车前地形1,双天线GPS定位系统的两个天线6-1、6-2在空间上隔开一定的距离;所述车轮3-1、3-2、…、3-m通过悬挂缸12-1、12-2、…、12-m连接于车体2下方,安装于悬挂缸12-1、12-2、…、12-m上的位移传感器13-1、13-2、…、13-m和支撑力传感器14-1、14-2、…、14-4分别用于测量其行程和支撑力。所述电控单元16分别与激光雷达4、惯性测量单元5、双天线GPS定位系统的两个天线6-1、6-2,车速传感器7,挡位传感器8,方向盘转角传感器9、油门开度传感器10及制动力传感器11,以及伺服控制器组15通讯连接,伺服控制器组15与悬挂缸的位移传感器13-1、13-2、…、13-m和支撑力传感器14-1、14-2、…、14-m通讯连接。
基于车前地形的车辆主动悬挂惯性调控方法分为以下几个步骤。
S1:计算车辆驶过车前地形的车轮接地点轨迹和各车轮接地点高程信息
基于惯性测量单元5和双天线GPS定位系统两个天线6-1、6-2测得的车辆在大地坐标系下的位置坐标,激光雷达4扫描获得的车前地形1和方向盘转角传感器测算出的各车轮转向角θ1、θ2、…、θm,由车辆运动学计算出车辆在车前地形1上行驶时车轮3-1、3-2、…、3-m接地点的轨迹T1、T2、…、Tm,m为车轮数。进一步通过插值算法计算出车轮接地点轨迹上各规划数据点的高程信息。
S2:计算车辆以被动悬挂驶过车前地形的质心轨迹与姿态历程
S21:计算车辆以被动悬挂驶过车前地形的质心轨迹与姿态历程
根据地面地质条件决定的滚动摩擦系数,车速传感器7测得的车速、方向盘转角传感器9测得的转向角,挡位传感器8和油门开度传感器10测得的各车轮驱力,制动力传感器11测得的制动力,由被动悬挂车辆动力学模型计算出车辆以被动悬挂沿步骤S1中规划出的车轮接地点轨迹T1、T2、…、Tm行驶时车辆坐标系的6维坐标历程{XiYiZiαiβiγi}T,和车辆的质心轨迹和姿态历程{XWiYWiZWiαWiβWiγWi}T,其中:XWi、YWi、ZWi、αWi、βWi、γWi分别为车辆质心处的三维坐标和三维姿态角,在时间顺序上分别对应于悬挂控制的各扫描周期节点ti=iΔΤ,i=0、1、2、…、n,ΔΤ为扫描周期,n为规划数据点的个数。
在被动悬挂车辆的动力学模型中,由悬挂的弹簧和阻尼、轮胎的弹簧和阻尼串联而成的各被动悬挂支链的综合刚度系数和综合阻尼系数可用下式计算:
S22:对步骤S21中的车辆质心的轨迹和姿态历程进行平滑处理
取平滑系数为ξ,对步骤S21中的被动悬挂车辆在车前地形行驶的质心轨迹和姿态历程进行平滑处理。为提高处理速度,此种平滑处理不是对6自由度空间曲面进行的平滑处理,而是对6个自由度坐标独立进行的平滑处理。常用的平滑处理方法较多,但适用于本发明的平滑处理方法要求平滑后的曲线必须过数据起点,否则会引起车辆不必要的振动。经过平滑处理后得到的质心轨迹和姿态历程为{xW(ti),yW(ti),zW(ti),αW(ti),βW(ti),γW(ti)}T,i=0、1、2、…、n,其中各分量相互独立,都是时间的函数。
S3:基于平滑处理后的质心轨迹与姿态历程,计算车辆以主动悬挂驶过车前地形的各悬挂的行程历程sij和悬挂支撑力历程Wij。
S32:在与步骤S21相同的车速、转向角、各车轮驱/制动力、地面滚动摩擦系数情况下,依照步骤S31中获得的主动悬挂相对于被动悬挂的行程历程和速度历程由主动悬挂车辆动力学模型计算车辆驶过车前地形的各悬挂相对中位的行程历程sij和支撑力历程Wij,其中i=0、1、2、…、n,j=1、2、…、m。
S4:对主动悬挂车辆实施基于力-位移的阻抗控制
如图3所示,sij是基于步骤S31计算出来的主动悬挂行程,Wij是基于步骤S32计算出来的各悬挂支撑力;与其相对应,是通过位移传感器13-1、13-2、…、13-m测得的实际各悬挂的行程,是通过支撑力传感器14-1、14-2、…、14-m测得的实际各悬挂的支撑力。通过比较各悬挂支撑力的理论值Wij与实测值基于阻抗模型可以求得车辆各悬挂的行程增量δi,j,从而得到校正后的各悬挂理论行程再与实测得到的各悬挂行程对比,根据其差值最后实施对悬挂的位移控制。
下面以三轴车辆为例,参考附图4详细说明本发明的示例性实施例、特征和方法。其它三轮及以上车辆可依据与此例相同的方法来构建。
(一)系统硬件构成
基于车前地形的三轴车辆主动悬挂惯性调控系统如图4所示,系统包括车前地形1,车体2以及6个车轮3-1、3-2、…、3-6,激光雷达4,惯性测量单元5,双天线GPS定位系统的两个天线6-1、6-2,车速传感器7,挡位传感器8,方向盘转角传感器9,油门开度传感器10,及制动力传感器11,与车轮3-1、3-2、…、3-6相对应的悬挂缸12-1、12-2、…、12-6及其位移传感器13-1、13-2、…、13-6和支撑力传感器14-1、14-2、…、14-6,伺服控制器组15,电控单元16等。其中,激光雷达4、惯性测量单元5、双天线GPS定位系统的两个天线6-1、6-2、电控单元16以及伺服控制器组15固定于车体2上,且激光雷达4装于车体2的前部用于测量车前地形1,双天线GPS定位系统的两个天线6-1、6-2在空间上隔开一定的距离;所述车轮3-1、3-2、…、3-6通过悬挂缸12-1、12-2、…、12-6连接于车体2下方,安装于悬挂缸12-1、12-2、…、12-6上的位移传感器13-1、13-2、…、13-6和支撑力传感器14-1、14-2、…、14-6分别用于测量悬挂缸的行程和支撑力。所述电控单元16分别与激光雷达4,惯性测量单元5,双天线GPS定位系统的两个天线6-1、6-2,车速传感器7,挡位传感器8,方向盘转角传感器9,油门开度传感器10,制动力传感器11,以及伺服控制器组15通讯连接。伺服控制器组15与悬挂缸的位移传感器13-1、13-2、…、13-6和支撑力传感器14-1、14-2、…、14-6通讯连接。
(二)三轴车辆的动力学模型及解法示例
1.三轴主动悬挂车辆在不平斜坡行驶的动力学模型
如图5所示,建立固定坐标系OXYZ,它与地面固连,该坐标系以惯性测量单元基准点O为坐标原点,以车辆的右侧方向为X轴正方向,以车辆的正前方为Y轴正方向,以垂直XOY平面向上的方向为Z轴正方向;为确定车辆在固定坐标系中的位置,再引入车辆坐标系oxyz,它与车体固连。车辆坐标系与固定坐标系在初始位置重合,其在固定坐标系中的定位坐标分别为X、Y、Z、α、β、γ。
为提高计算速度,将车辆看作刚体,设其质量为M,它在车辆坐标系中的坐标为W(xW,yW,zW)。三轴车辆具有6个车轮,对应有6个悬挂。将主动悬挂简化为作动器、弹簧和阻尼器的并联。设对主动悬挂的控制方法为位移控制;各悬挂弹簧的刚度系数分别为KS1、KS2、…、KS6,各悬挂阻尼器的阻尼系数分别为CS1、CS2、…、CS6。将轮胎简化为垂向弹簧与阻尼的并联,忽略轮胎侧向与切向弹性和阻尼对车辆动力学特性的影响。设各轮胎垂向弹簧的刚度系数分别为KW1、KW2、…、KW6,各轮胎垂向阻尼的阻尼系数分别为CW1、CW2、…、CW6。设前述阻尼均为粘性阻尼;前述弹簧均设为非线性弹簧,并以分段线性近似。
以上所建的主动悬挂车辆的动力学模型,具有6个自由度。若略去各悬挂中的作动器,则前述动力学模型就变为被动悬挂车辆的动力学模型,此时各被动悬挂支链的综合刚度系数和综合阻尼系数为:
本实例在设计主动悬挂的行程中位时,将其与被动悬挂的平衡位置相对应,这样主动悬挂静止于中位时其作动器的理论支撑力应为零,可最大限度地降低车辆因使用主动悬挂而消耗的能量,同时在主/被动悬挂切换时也可产生较小的冲击。因悬挂作动器采用的是位移控制,本实例中将主动悬挂车辆动力学模型中与作动器并联的悬挂弹簧和阻尼器的作用略去,从而各主动悬挂支链的综合刚度系数和综合阻尼系数为:
因悬挂支链弹簧具有较强的非线性,本实例中以分段线性近似,又因各支链可能处于不同的线性段,所以用KZ1,…,KZ6和CZ1,…,CZ6分别表示各支链垂向的刚度与阻尼。用Δ1(t)、Δ2(t)、…,Δ6(t)和 分别表示路面不平度引起的各车轮接地点R1、R2、…、R6的垂向位移和速度。当某车轮离地时与其相应的悬挂支链的弹性和阻尼均应置零。
因每个扫描周期内α、β是微小变量,则有cosα≈1,cosβ≈1;sinα≈α,sinβ≈β。则车辆质心在固定坐标系OXYZ中的坐标计算公式为:
式中:xW、yW、zW——车辆质心在车辆坐标系oxyz中的坐标。
通过动力学模型和拉格郎日方程建立主动悬挂车辆的运动微分方程,用矩阵表示如下:
式中:[M6×6]、[C6×6]、[K6×6]分别为质量阵、阻尼阵和刚度阵,均为6×6的对称方阵;{F6}为力矩阵,为6×1的列阵;{q6}为需要求解的车辆坐标列向量,为6×1的列阵。其中:
式中:JXX、JYY、JZZ——车辆绕x、y、z轴的惯性矩;
JXY、JYZ、JXZ——车辆对x/y、y/z、x/z轴的惯性积。
式中:KZj——第j个悬挂支链的垂向综合刚度系数;
bj——编号为j的悬挂上支撑点Qj在oxyz坐标系中的x坐标;
Lj——编号为j的悬挂上支撑点Qj在oxyz坐标系中的y坐标。
式中:CZj——第j个悬挂的垂向综合阻尼系数。
式中:r——车轮自由半径;
λ——车前地形的坡度角;
φ——车辆相对斜坡的方位角,即车辆坐标系的x轴与坡度梯度下降方向的夹角;
s0——水平面内被动悬挂车辆从自由状态到重力平衡状态的质心垂向位移量;
△j——路面不平度引起的各轮接地点垂向位移;
Pj——第j个车轮的驱动力;
Fj——第j个车轮的制动力;
θj——第j个车轮的转向角;
g——重力加速度。
2.动力学解法
取车辆坐标系在OXYZ坐标系的位移向量为:
{q6}={x、y、z、α、β、γ}T
基于上面的运动微分方程构建动力学矩阵如下:
设状态变量为:
代入动力学矩阵得状态方程式如下:
其中:
上面的状态方程式可通过四阶龙格库塔法求解,得出状态变量{q12}的值。
(三)基于车前地形的三轴车辆主动悬挂惯性调控方法分为以下几个步骤。
S1:计算车轮接地点轨迹和各接地点高程信息
基于惯性测量单元5和双天线GPS定位系统的两个天线6-1、6-2测得的车辆坐标系oxyz在固定坐标系OXYZ中的位置坐标{x,y,z,α,β,γ}T,激光雷达4扫描并经坐标变换后获得的固定坐标系OXYZ下三维网格车前地形1,和基于方向盘转角传感器9测得的车辆转向角及根据阿克曼转向原理计算得到的各车轮转向角θ1、θ2、…、θ6,由运动学模型计算出车辆在车前地形1上行驶时各车轮3-1、3-2、…、3-6的接地点轨迹T1、T2、…、T6,因斜坡的不平,6条轮迹在空间上全部是曲线。在此基础上,通过插值算法可以计算出每个扫描周期的各车轮接地点R1、R2、…、R6的高程信息。
S2:计算车辆以被动悬挂驶过车前地形的质心轨迹与姿态历程
S21:由地面的地质条件确定的车轮地面滚动摩擦系数f,车速传感器7测得的车速v,方向盘转角传感器9测得的转向角θ和根据阿克曼原理计算得到的各车轮转向角θ1、θ2、…、θ6,挡位传感器8和油门开度传感器10测得的各轮驱动力P1、P2、…、P6,制动力传感器11测得制动力与车轮滚动摩擦力的合力F1、F2、…、F6作为输入,由被动悬挂车辆动力学模型求得车辆按照S1中的车轮接地点轨迹T1、T2、…、T6行驶的轨迹离散点
为规划数据点的个数。基于{q12}i,求得车辆质心轨迹历程中与悬挂特性相关的三个坐标为:
S22:对车辆的行驶轨迹进行平滑处理
对前述被动悬挂车辆质心轨迹和姿态历程中的zWi、αWi、βWi三个变量进行过起点的平滑处理。本实施例的平滑处理方法使用最小二乘多项式拟合。以对zWi的平滑处理方法为例,具体算法如下。
对于给定的数据点(ti,zWi),ti=i×ΔΤ,i=0、1、2、…、n,ΔΤ为悬挂控制的扫描周期。可用下面的ξ阶多项式进行拟合,其中ξ为多项式阶数,可由小到大逐渐增加,初值可取1。
式中:k——多项式幂次;
ak——多项式系数;
ξ——多项式阶数。
以此函数来反映相应数据的变化趋势,并且期望所有数据点上的残差平方和最小。即:
为了使拟合后的多项式函数过起点,在上式中,把[zw(t0)-zw0]2从求和公式中单独列出并乘以较大的系数K0,以加大数据起点的权重。实际应用时,可以根据规划数据点的个数取足够大的K0,使拟合后的多项式函数尽可能地靠近起点,以达到设计者所期望的精度要求。
将上式对a0,…,ak求偏导,可得到关于a0,…,ak的ξ阶方程组,通过克莱姆法则可以解出a0,…,ak的值。
S3:基于平滑处理后的质心轨迹与姿态历程,计算车辆以主动悬挂驶过车前地形的各悬挂的行程历程sij和悬挂支撑力历程Wij。
①基于S21中求得的车辆以被动悬挂驶过车前地形的车辆坐标系6维坐标历程{Xi,Yi,Zi,αi,βi,γi}T,由下式求出各悬挂上支撑点Q1、Q2、…、Q6的垂向位移历程为:
则各悬挂上支撑点Q1、Q2、…、Q6的垂向速度历程为:
②根据S22中平滑处理后得到的质心轨迹和姿态历程的函数{XW(ti),YW(ti),ZW(ti),αW(ti),βW(ti),γW(ti)}T,反求出车辆坐标系相对固定坐标系的三个相关坐标时间历程为:
再由z(ti)、α(ti)、β(ti)求出各悬挂上支撑点Q1、Q2、…、Q6垂向位移为:
各悬挂上支撑点Q1、Q2、…、Q6的垂向速度为:
S32:由车辆动力学模型计算以主动悬挂驶过车前地形的车辆各悬挂行程历程si,j和支撑力历程Wij,具体步如下。
根据主动/被动悬挂行程差历程和速度差历程由车辆动力学模型求解得到主动悬挂车辆驶过车前地形的新状态变量{q′12}i,i=0,1,2,……,n。将其中所包括的位移变量z′i,α′i,β′i,代入下式求出各悬挂上支撑点Q1、Q2、…、Q6的垂向位移历程:
w′i,j=z′i-bjβ′i+Ljα′i,i=0、1、2、…、n;j=1、2、…、6
②求各主动悬挂相对于中位的行程历程si,j
因轮胎的垂向变形远小于主动悬挂的行程,这里暂且略去轮胎的垂向变形,轮胎的垂向变形将在S4中的悬挂阻抗控制中得到补偿。则各主动悬挂相对于中位的行程历程等于各主动悬挂上支撑点Q1、Q2、…、Q6的垂向位移历程w′i,j与各车轮接地点R1、R2、…、R6的垂向位移历程△i,j之差。
si,j=w′i,j-△i,j,i=0、1、2、…、n;j=1、2、…、6
③求各主动悬挂的支撑力历程Wi,j
车辆各主动悬挂的支撑力历程为:
S4:对悬挂作动器实施基于力-位移的阻抗控制,具体实现方法如下:
①求解悬挂阻抗控制的位移控制量
则各主动悬挂的目标位移为:
校验式为:
式中:smin——悬挂的下极限位移;
smax——悬挂的上极限位移。
若存在有的悬挂超过极限行程,则首先降低对车辆轨迹曲线的平滑度,调整相应的平滑系数ξ,分以下两种情况分别进行处理:
①若平滑系数ξ尚未达到预设的平滑系数极限值,则转到步骤S22。
②若平滑系数ξ已达平滑系数极限值,仍然不能满足全历程内各悬挂行程不超过极限行程的条件,按照出现的时间顺序找到悬挂行程超过极限行程的第一个数据点,设其在步骤S2中规划数据点的编号为iE(1≤iE≤n),则令n=iE,并返回步骤S21。
通过以上处理可使全历程内各悬挂行程均不超过极限行程。
③对主动悬挂实施PID位移控制
以上所述的实施例仅仅是对本发明的优选实施方式进行描述,并非对本发明的范围进行限定,在不脱离本发明设计精神的前提下,本领域普通技术人员对本发明的技术方案做出的各种变形和改进,均应落入本发明权利要求书确定的保护范围内。
Claims (7)
1.一种基于车前地形的主动悬挂惯性调控方法,其特征在于包括以下步骤;
S1:计算车辆驶过车前地形的车轮接地点轨迹和各车轮接地点高程信息;
根据惯性测量单元、双天线GPS定位系统测得的车辆在大地坐标系下的位置坐标、激光雷达扫描得到的车前地形和各车轮转向角,由车辆运动学计算出车辆在车前地形上行驶时各个车轮接地点的轨迹T1、T2、…、Tm,j=1、2、…、m,m为车轮的个数;通过插值算法计算出各车轮接地点轨迹上各规划数据点的高程信息;
S2:计算车辆以被动悬挂驶过车前地形的质心轨迹与姿态历程;
S21:根据车速、转向角、各车轮驱/制动力和车轮在地面的滚动摩擦系数,由车辆的动力学模型计算出车辆以被动悬挂沿步骤S1中车轮接地点轨迹T1、T2、…、Tm行驶时车辆坐标系的6维坐标历程{Xi Yi Zi αi βi γi}T,和车辆的质心轨迹和姿态历程{XWi YWi ZWi αWi βWiγWi}T,其中:XWi、YWi、ZWi、αWi、βWi、γWi分别为车辆质心处的三维坐标和三维姿态角,i=0、1、2、…、n,n为规划数据点的个数;
S22:取平滑系数为ξ,对步骤S21中的被动悬挂车辆质心轨迹和姿态历程进行过起点的平滑处理,得到质心轨迹和姿态历程的平滑函数{XW(ti)、YW(ti)、ZW(ti)、αW(ti)、βW(ti)、γW(ti)}T;
S3:基于前述平滑处理后的质心轨迹与姿态历程,计算车辆以主动悬挂驶过车前地形的悬挂行程历程si,j和悬挂支撑力历程Wij;
S32:在与步骤S21相同的车速、转向角、各车轮驱/制动力、地面滚动摩擦系数情况下,依照步骤S31中获得的主动悬挂相对于被动悬挂行程历程和速度历程由动力学模型计算车辆以主动悬挂驶过车前地形的各悬挂相对于中位的行程历程si,j和支撑力历程Wij;
S4:依据车辆以主动悬挂驶过车前地形时悬挂相对中位的行程历程si,j和悬挂支撑力历程Wij,对悬挂作动器实施基于力-位移的阻抗控制;
对悬挂作动器实施基于力-位移的阻抗控制的具体实现方法如下:
①求解悬挂阻抗控制的位移控制量
式中,M、K和C分别为目标惯性、目标刚度与目标阻尼,分别反映了簧下质量的惯性特性、轮胎接地的刚度特性和阻尼特性;上面的微分方程可用卷积积分方式求解:
上式中的函数hi,j(t)是前式所对应单位脉冲响应函数;
②主动悬挂基于力-位移的阻抗控制
2.根据权利要求1所述的基于车前地形的主动悬挂惯性调控方法,其特征在于,在所述步骤S21、S32中,车辆的动力学模型及其解法如下:
建立固定坐标系OXYZ,它与地面固连,该坐标系以惯性测量单元基准点O为坐标原点,以车辆的正前方为Y轴正方向,以车辆的右侧方向为X轴正方向,以垂直XOY平面向上的方向为Z轴正方向;为确定车辆在固定坐标系中的位置,再引入车辆坐标系oxyz,它与车体固连;车辆坐标系与固定坐标系在初始位置重合,其在固定坐标系中的定位坐标分别为X、Y、Z、α、β、γ;
为提高计算速度,将车辆看作刚体,设其质量为M,它在车辆坐标系中的坐标为W(xW,yW,zW);车辆具有m个车轮,对应有m个悬挂;将主动悬挂简化为作动器、弹簧和阻尼器的并联;设对主动悬挂的控制方法为位移控制;各悬挂弹簧的刚度系数分别为KS1、KS2、…、KSm,各悬挂阻尼器的阻尼系数分别为CS1、CS2、…、CSm;将轮胎简化为垂向弹簧与阻尼的并联,忽略轮胎侧向与切向弹性和阻尼对车辆动力学特性的影响;各轮胎垂向弹簧的刚度系数分别为KW1、KW2、…、KWm,各轮胎垂向阻尼的阻尼系数分别为CW1、CW2、…、CWm;设前述阻尼均为粘性阻尼;前述弹簧均设为非线性弹簧,并以分段线性近似;
以上所建的是主动悬挂车辆的动力学模型,它具有6个自由度;若去掉各悬挂中的作动器,则前述动力学模型就变为被动悬挂车辆的动力学模型;当部分主动悬挂设计时不设悬挂弹簧和阻尼器时,应将上述主动悬挂车辆动力学模型中的悬挂弹簧和阻尼器略去;
通过拉格郎日方程建立该车辆动力学模型的运动微分方程,用矩阵表示如下:
式中:[M6×6]、[C6×6]、[K6×6]分别为质量阵、阻尼阵和刚度阵,均为6×6的对称方阵;{F6}为力矩阵,为6×1的列阵;
取车辆在固定坐标系的位移向量为:
{q6}={X、Y、Z、α、β、γ}T
基于上面的运动微分方程构建动力学矩阵如下:
设状态变量为:
代入动力学矩阵得状态方程式如下:
其中:
上面的状态方程式可通过四阶龙格库塔法求解,得出状态变量{q12}的值。
①基于S21中求得的车辆以被动悬挂驶过车前地形的车辆坐标系6维坐标历程{Xi YiZi αi βi γi}T,由下式求出各悬挂上支撑点Q1、Q2、…、Qm的垂向位移历程为:
式中:bj——编号为j的悬挂上支撑点在oxyz坐标系中的x坐标;
Lj——编号为j的悬挂上支撑点在oxyz坐标系中的y坐标;
则各悬挂上支撑点Q1、Q2、…、Qm的垂向速度历程为:
②根据S22中平滑处理后得到的质心轨迹和姿态历程的函数{XW(ti)、YW(ti)、ZW(ti)、αW(ti)、βW(ti)、γW(ti)}T,反求出车辆坐标系相对固定坐标系三个相关坐标的时间历程函数为:
再由z(ti)、α(ti)、β(ti)求出各悬挂上支撑点Q1、Q2、…、Qm的垂向位移为:
各悬挂上支撑点Q1、Q2、…、Qm的垂向速度为:
5.根据权利要求1所述的基于车前地形的主动悬挂惯性调控方法,其特征在于,所述步骤S32中由车辆动力学模型计算以主动悬挂驶过车前地形的车辆各悬挂行程历程si,j和支撑力历程Wij的具体步如下:
根据主动/被动悬挂行程差历程和速度差历程由车辆动力学模型求解得到主动悬挂车辆驶过车前地形的新状态变量{q′12}i,将其中所包括的位移变量z′i,α′i,β′i,代入下式求出各悬挂上支撑点Q1、Q2、…、Qm的垂向位移历程:
w′i,j=z′i-bjβ′i+Ljα′i,i=0、1、2、…、n;j=1、2、…、m
②求各主动悬挂相对于中位的行程历程si,j
因轮胎的垂向变形远小于主动悬挂的行程,这里暂且略去轮胎的垂向变形,轮胎的垂向变形将在S4中的悬挂阻抗控制中得到补偿;则各主动悬挂相对于中位的行程历程等于各主动悬挂上支撑点Q1、Q2、…、Qm的垂向位移历程w′i,j与各车轮接地点R1、R2、…、Rm的垂向位移历程Δi,j之差;
si,j=w′i,j-Δi,j,i=0、1、2、…、n;j=1、2、…、m
③求各主动悬挂的支撑力历程Wi,j
车辆各主动悬挂的支撑力历程为:
校验式为:
式中:smin——悬挂的下极限位移;
smax——悬挂的上极限位移;
若存在某个悬挂行程超过极限行程,则首先降低对车辆轨迹曲线的平滑度,调整相应的平滑系数ξ,分以下两种情况分别进行处理:
①若平滑系数ξ尚未达到预设的平滑系数极限值,则转到步骤S22;
②若平滑系数ξ已达平滑系数极限值,仍然不能满足全历程内各悬挂行程不超过极限行程的条件,按照出现的时间顺序找到悬挂行程超过极限行程的第一个数据点,设其在步骤S2中规划数据点的编号为iE(1≤iE≤n),则令n=iE,并返回步骤S21;
通过以上处理可使全历程内各悬挂行程均不超过极限行程。
7.一种基于权利要求1-6任一项所述的基于车前地形的主动悬挂惯性调控方法的控制系统,其特征在于:系统包括车体及m个车轮、激光雷达、惯性测量单元、双天线GPS定位系统、与车轮相对应的悬挂缸及其位移传感器、支撑力传感器和伺服控制器组、车速传感器、方向盘转角传感器、油门开度传感器、制动力传感器、电控单元;其中,激光雷达、惯性测量单元、双天线GPS定位系统、电控单元以及伺服控制器组固定于车体上,且激光雷达装于车体的前部用于测量车前地形,双天线GPS定位系统的两个天线在空间上隔开一定的距离;所述车轮通过悬挂缸连接于车体下方,位移传感器与支撑力传感器安装于悬挂缸上用于测量悬挂缸的行程和支撑力;方向盘转角传感器、油门开度传感器、制动力传感器用于测量转向角和油门开度与制动强度;所述电控单元分别与惯性测量单元、激光雷达、双天线GPS定位系统、方向盘转角传感器、油门开度传感器、制动力传感器、以及伺服控制器组通讯连接,伺服控制器组与悬挂缸的位移传感器和支撑力传感器通讯连接。
Priority Applications (8)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110714689.4A CN113370734B (zh) | 2021-06-26 | 2021-06-26 | 基于车前地形的主动悬挂惯性调控方法和控制系统 |
CA3190318A CA3190318A1 (en) | 2021-06-26 | 2022-04-07 | Inertial regulation method and control system of active suspensions based on terrain ahead of vehicle |
EP22827123.5A EP4206006A4 (en) | 2021-06-26 | 2022-04-07 | ACTIVE SUSPENSION INERTIA CONTROL METHOD BASED ON THE FRONT TERRAIN OF A VEHICLE AND CONTROL SYSTEM |
JP2023517726A JP7456696B2 (ja) | 2021-06-26 | 2022-04-07 | 車前地形に基づくアクティブサスペンション慣性制御方法及び制御システム |
KR1020237010326A KR20230054727A (ko) | 2021-06-26 | 2022-04-07 | 차량 전방 지형에 기반한 액티브 서스펜션의 관성 조정 방법 및 제어 시스템 |
PCT/CN2022/085565 WO2022267620A1 (zh) | 2021-06-26 | 2022-04-07 | 基于车前地形的主动悬挂惯性调控方法和控制系统 |
AU2022296361A AU2022296361A1 (en) | 2021-06-26 | 2022-04-07 | Active suspension inertia regulation method based on vehicle-front terrain, and control system |
US18/320,228 US11813915B2 (en) | 2021-06-26 | 2023-05-19 | Active suspension inertia regulation method based on vehicle-front terrain, and control system |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110714689.4A CN113370734B (zh) | 2021-06-26 | 2021-06-26 | 基于车前地形的主动悬挂惯性调控方法和控制系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113370734A CN113370734A (zh) | 2021-09-10 |
CN113370734B true CN113370734B (zh) | 2022-02-11 |
Family
ID=77579369
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110714689.4A Active CN113370734B (zh) | 2021-06-26 | 2021-06-26 | 基于车前地形的主动悬挂惯性调控方法和控制系统 |
Country Status (8)
Country | Link |
---|---|
US (1) | US11813915B2 (zh) |
EP (1) | EP4206006A4 (zh) |
JP (1) | JP7456696B2 (zh) |
KR (1) | KR20230054727A (zh) |
CN (1) | CN113370734B (zh) |
AU (1) | AU2022296361A1 (zh) |
CA (1) | CA3190318A1 (zh) |
WO (1) | WO2022267620A1 (zh) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113370734B (zh) | 2021-06-26 | 2022-02-11 | 燕山大学 | 基于车前地形的主动悬挂惯性调控方法和控制系统 |
CN114654955B (zh) * | 2022-03-15 | 2023-11-17 | 燕山大学 | 基于路面等级的救援车辆主动悬架控制方法及系统 |
CN114815601B (zh) * | 2022-03-29 | 2023-11-07 | 北京理工大学 | 一种减少主动悬挂系统时延误差的修正自抗扰控制方法 |
CN116068326B (zh) * | 2023-03-21 | 2023-06-23 | 中国汽车技术研究中心有限公司 | 车辆电磁抗扰度天线控制方法、设备和存储介质 |
CN117521229B (zh) * | 2023-12-27 | 2024-03-19 | 石家庄铁道大学 | 一种路面位移响应检测方法、系统及存储介质 |
Family Cites Families (23)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH02169316A (ja) * | 1988-12-21 | 1990-06-29 | Mazda Motor Corp | 車両のサスペンション装置 |
US7313467B2 (en) | 2000-09-08 | 2007-12-25 | Automotive Technologies International Inc. | System and method for in-vehicle communications |
US7350787B2 (en) | 2001-04-03 | 2008-04-01 | Voss Darrell W | Vehicles and methods using center of gravity and mass shift control system |
JP2005178531A (ja) | 2003-12-18 | 2005-07-07 | Nissan Motor Co Ltd | 路面形状検出装置及び路面形状検出方法 |
CN2707546Y (zh) * | 2004-04-16 | 2005-07-06 | 江苏大学 | 一种馈能型半主动悬架 |
US7826948B2 (en) * | 2004-10-15 | 2010-11-02 | Ford Global Technologies | Vehicle loading based vehicle dynamic and safety related characteristic adjusting system |
US8285447B2 (en) | 2007-03-20 | 2012-10-09 | Enpulz, L.L.C. | Look ahead vehicle suspension system |
JP5675281B2 (ja) | 2010-11-08 | 2015-02-25 | 三菱重工業株式会社 | 車両 |
WO2018039134A1 (en) * | 2016-08-22 | 2018-03-01 | Peloton Technology, Inc. | Automated connected vehicle control system architecture |
CN203902200U (zh) * | 2014-06-18 | 2014-10-29 | 吉林大学 | 一种可变刚度与阻尼的汽车馈能主动悬架系统 |
CA3215609A1 (en) | 2014-09-29 | 2016-04-07 | Soucy International Inc. | Track system having low vibrations |
US10486485B1 (en) * | 2017-04-19 | 2019-11-26 | Zoox, Inc. | Perception based suspension control |
CN108189637A (zh) * | 2017-12-29 | 2018-06-22 | 燕山大学 | 一种应急救援车辆主动悬挂作动器控制量的数据融合方法 |
US11130382B2 (en) * | 2018-04-07 | 2021-09-28 | Nimbus AV Limited Liability Company | Vehicle and methods for improving stability and occupant comfort |
CN110920605B (zh) * | 2018-08-31 | 2021-05-14 | 华为技术有限公司 | 一种车辆控制方法及设备 |
CN109109601A (zh) * | 2018-09-10 | 2019-01-01 | 燕山大学 | 基于车辆位姿偏差的惯性调控主动悬挂控制系统及控制方法 |
DE102018008233A1 (de) * | 2018-10-18 | 2019-04-11 | Daimler Ag | Verfahren zur Ausrichtung eines Sichtkegels eines LIDAR Sensors an einem Fahrzeug |
CN110789288A (zh) * | 2019-10-29 | 2020-02-14 | 燕山大学 | 一种主被动可切换的悬架控制系统及方法 |
CN110877509B (zh) * | 2019-12-11 | 2021-04-30 | 西安科技大学 | 一种基于改进型果蝇算法的主动悬架视觉预瞄控制方法 |
CN111169247B (zh) * | 2020-01-18 | 2021-07-30 | 燕山大学 | 一种基于命令滤波的车辆主动悬架协调抗饱和控制方法 |
CN111780981B (zh) * | 2020-05-21 | 2022-02-18 | 东南大学 | 一种智能车辆编队变道性能测评方法 |
CN112092563A (zh) * | 2020-09-11 | 2020-12-18 | 广州小鹏汽车科技有限公司 | 车辆的控制方法、控制装置、车载终端和车辆 |
CN113370734B (zh) * | 2021-06-26 | 2022-02-11 | 燕山大学 | 基于车前地形的主动悬挂惯性调控方法和控制系统 |
-
2021
- 2021-06-26 CN CN202110714689.4A patent/CN113370734B/zh active Active
-
2022
- 2022-04-07 CA CA3190318A patent/CA3190318A1/en active Pending
- 2022-04-07 JP JP2023517726A patent/JP7456696B2/ja active Active
- 2022-04-07 KR KR1020237010326A patent/KR20230054727A/ko unknown
- 2022-04-07 WO PCT/CN2022/085565 patent/WO2022267620A1/zh active Application Filing
- 2022-04-07 EP EP22827123.5A patent/EP4206006A4/en active Pending
- 2022-04-07 AU AU2022296361A patent/AU2022296361A1/en active Pending
-
2023
- 2023-05-19 US US18/320,228 patent/US11813915B2/en active Active
Also Published As
Publication number | Publication date |
---|---|
JP7456696B2 (ja) | 2024-03-27 |
WO2022267620A1 (zh) | 2022-12-29 |
US20230286347A1 (en) | 2023-09-14 |
EP4206006A1 (en) | 2023-07-05 |
US11813915B2 (en) | 2023-11-14 |
CA3190318A1 (en) | 2022-12-29 |
EP4206006A4 (en) | 2024-04-24 |
KR20230054727A (ko) | 2023-04-25 |
JP2023541310A (ja) | 2023-09-29 |
AU2022296361A1 (en) | 2023-05-04 |
CN113370734A (zh) | 2021-09-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN113370734B (zh) | 基于车前地形的主动悬挂惯性调控方法和控制系统 | |
EP3851302B1 (en) | Vehicle-mounted motion simulation platform based on active suspension, and control method therefor | |
Sreenivasan et al. | Stability and traction control of an actively actuated micro‐rover | |
CN109292019B (zh) | 基于同轴式轮腿结构的全地形车主动车身姿态控制方法 | |
CN111158376B (zh) | 松软崎岖地形中摇杆摇臂式星球车轨迹跟踪协调控制方法 | |
Arslan et al. | Robust motion control of a four wheel drive skid-steered mobile robot | |
CN113433827A (zh) | 一种质心变化喷砂除锈并联机器人移动平台轨迹跟踪控制方法 | |
KR20230054881A (ko) | 휠 지지력에 기반한 차량 액티브 서스펜션의 관성 조정 방법 및 제어 시스템 | |
CN114700955B (zh) | 双轮腿-臂机器人全身运动规划与控制方法 | |
CN114035593B (zh) | 多模式运动的力伺服足式运动控制方法 | |
Yin et al. | Attitude Control of an All-Wheel-Drive Rover with Integrated Active Suspension System | |
CN115291514A (zh) | 多自由度轮式倒立摆类型机器人的二维稳定移动控制方法 | |
Wu et al. | Attitude Tracking Control of All-Terrain Vehicle with Tandem Active–Passive Suspension | |
Ayalew et al. | Minimum Jerk Traction Control of a Wheeled Mobile Robot Moving Over a Hump | |
CN116588221A (zh) | 一种基于跳蛛的仿生机器人的跳跃方法 | |
CN116278570A (zh) | 一种基于数据驱动模型的商用车半自动悬架自适应协同控制系统与方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |