CN111806427B - 一种四轮毂电机驱动车辆的综合控制方法 - Google Patents

一种四轮毂电机驱动车辆的综合控制方法 Download PDF

Info

Publication number
CN111806427B
CN111806427B CN202010514532.2A CN202010514532A CN111806427B CN 111806427 B CN111806427 B CN 111806427B CN 202010514532 A CN202010514532 A CN 202010514532A CN 111806427 B CN111806427 B CN 111806427B
Authority
CN
China
Prior art keywords
control
vehicle
longitudinal
wheel
following
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
CN202010514532.2A
Other languages
English (en)
Other versions
CN111806427A (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.)
Beijing Institute of Technology BIT
Original Assignee
Beijing Institute of Technology BIT
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 Beijing Institute of Technology BIT filed Critical Beijing Institute of Technology BIT
Priority to CN202010514532.2A priority Critical patent/CN111806427B/zh
Publication of CN111806427A publication Critical patent/CN111806427A/zh
Application granted granted Critical
Publication of CN111806427B publication Critical patent/CN111806427B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • 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
    • B60W30/00Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
    • B60W30/02Control of vehicle driving stability
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60LPROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
    • B60L15/00Methods, circuits, or devices for controlling the traction-motor speed of electrically-propelled vehicles
    • B60L15/32Control or regulation of multiple-unit electrically-propelled vehicles
    • 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
    • B60W50/00Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60LPROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
    • B60L2240/00Control parameters of input or output; Target parameters
    • B60L2240/40Drive Train control parameters
    • B60L2240/42Drive Train control parameters related to electric machines
    • B60L2240/423Torque
    • 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
    • B60W50/00Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
    • B60W2050/0001Details of the control system
    • B60W2050/0002Automatic control, details of type of controller or control system architecture
    • B60W2050/0008Feedback, closed loop systems or details of feedback error signal
    • B60W2050/0011Proportional Integral Differential [PID] controller
    • 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
    • B60W50/00Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
    • B60W2050/0001Details of the control system
    • B60W2050/0019Control system elements or transfer functions
    • B60W2050/0028Mathematical models, e.g. for simulation
    • B60W2050/0031Mathematical model of the vehicle
    • 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
    • B60W2710/00Output or target parameters relating to a particular sub-units
    • B60W2710/08Electric propulsion units
    • B60W2710/083Torque

Landscapes

  • Engineering & Computer Science (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Automation & Control Theory (AREA)
  • Power Engineering (AREA)
  • Human Computer Interaction (AREA)
  • Steering Control In Accordance With Driving Conditions (AREA)
  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)

Abstract

一种四轮毂电机驱动车辆的综合控制方法,其结合了变预瞄距离运动学模型获取当前状态与期望轨迹的航向角偏差与侧向位移偏差,建立模型预测控制器状态方程,使被控车辆的运动状态更符合实际驾驶员操纵特性,提高轨迹跟踪的鲁棒性。在转向过程中,能够实现对横摆角速度以及质心侧偏角的控制,以及操纵稳定性与轨迹跟踪的综合控制。得到期望纵向力与期望额外横摆力矩,进而通过转矩分配算法得到四轮毂电机转矩最优控制序列。考虑底层力矩分配算法,对分布式驱动车辆轨迹跟踪与操纵稳定性相关执行器进行控制,提高了控制的准确性与鲁棒性,并实现了纵横向耦合控制。

Description

一种四轮毂电机驱动车辆的综合控制方法
技术领域
本发明涉及分布式驱动车辆控制领域,具体涉及一种四轮毂电机驱动车辆的综合控制方法,用于实现操纵稳定性与轨迹跟踪的纵横向综合控制。
背景技术
四轮毂电机驱动车辆四个驱动轮的驱动/制动转矩可以独立控制,其驱动冗余相对于现有技术更有利于实现转向过程中的操纵稳定性控制。目前对于轮毂电机驱动车辆的稳定性控制多采用模型预测控制的方式,其可以考虑非线性动力学模型并预测未来一段时间内系统的输出,通过滚动解决带约束的多目标最优问题使得系统在满足多目标跟踪精度的同时满足约束条件。然而,现有的轨迹跟踪模型预测控制还主要存在以下几个问题:
1、大部分轨迹跟踪控制并未考虑底层力矩分配算法,将底层视为理想转向模型,未考虑具体执行器,这与实车路径跟踪情况不符;2、大部分轨迹跟踪控制未对横摆角速度、质心侧偏角设置参考值并进行控制,仅对动力学参数进行约束,并未实现对横摆角速度、质心侧偏角的准确控制;3、大部分轨迹跟踪模型预测控制采用补偿模型或者固定预瞄距离的单点预瞄模型建立车辆—道路误差模型。在车速期望轨迹曲率变化的工况下,控制效果有所降低,且与驾驶员预瞄机制不符,不符合实际驾驶员操纵行为;4、车辆的路径跟踪控制由纵向控制与横向控制共同决定,纵向速度作为横向控制算法中的状态参数对控制效果有一定影响,大部分方法未考虑速度变化下的轨迹跟踪效果,或将横向与纵向解耦控制,降低算法精度使得控制偏差较大。
发明内容
为克服上述现有技术中所存在的技术问题,本发明提供了一种四轮毂电机驱动车辆的综合控制方法,具体包括以下步骤:
步骤一、针对四轮毂电机驱动车辆,建立轨迹跟踪变预瞄距离运动学模型与三自由度动力学模型;
步骤二、确定待跟踪的期望轨迹上的状态量:航向角偏差,侧向偏差,质心侧偏角以及横摆角速度,并设置所述各状态量的参考值;
步骤三、确定由步骤一中所建立的两个模型共同组成的四轮毂驱动电机驱动车辆的模型预测控制器状态方程;
步骤四、基于步骤三中所建立的状态方程确定预测输出方程,根据预测输出量与期望输出量参考值建立多目标优化函数,设置满足机械限制、控制平顺性、操纵稳定性的相关控制量约束条件,实时滚动优化获得前轮转角与额外横摆力矩的最优控制量;
步骤五、根据实际纵向车速vx与纵向车速参考值vxr的偏差,用PID控制方法得到期望车辆总纵向驱动力Fx-des,满足车辆对纵向车速参考值的跟踪;
步骤六、进行底层力矩分配,根据期望纵向驱动力以及期望额外横摆力矩得到期望四轮转矩,将指令分配到四个电机控制器,实现对四轮毂电机驱动车辆的直接控制。
进一步地,所述步骤一中所建立的轨迹跟踪变预瞄距离运动学模型,采用以下形式:
Figure BDA0002529690070000021
其中,
Figure BDA0002529690070000022
为侧向偏差变化率,
Figure BDA0002529690070000023
为航向角偏差变化率,ψe为航向角偏差,vx为纵向速度,Td为预瞄时间,β为质心侧偏角,ω为横摆角速度,ρ为预瞄点处期望轨迹曲率,预瞄距离随车速变化,能够提高跟踪精度与鲁棒性;
所述三自由度动力学模型,包括纵向、侧向、横摆三个自由度,对车辆进行动力学分析,可以得到以下方程:
Figure BDA0002529690070000024
其中,m为整车质量,Iz为车辆横摆转动惯量,vx、vy分别为车辆的纵向和侧向速度,
Figure BDA0002529690070000025
分别为车辆的纵向和侧向加速度,ω为车辆的横摆角速度,
Figure BDA0002529690070000026
为车辆的横摆角加速度,Cd为空气阻力系数,A为车身横截面积;Fxij和Fyij分别是相应车轮所受的纵向力和侧向力,其中i∈{f,r},j∈{l,r},分别代表前后、左右;
其中,系数矩阵Bx和By为:
Figure BDA0002529690070000027
Figure BDA0002529690070000031
其中,lf和lr分别表示重心和前桥与后桥之间的距离,d为轮距的一半;δf和δt分别为前后轮转角。
进一步地,所述步骤二中对于横摆角速度以及质心侧偏角这两个状态量的参考值,基于在所述三自由度动力学模型中去除纵向自由度得到的简化二自由度模型来计算,具有以下关系:
Figure BDA0002529690070000032
其中,Mz为横摆力矩,
Figure BDA0002529690070000033
为额外横摆力矩;
将轮胎力线性描述为:
Figure BDA0002529690070000034
其中,Cf、Cr为前后轮侧偏刚度,αf、αr为前后轮侧偏角,则有如下关系:
Figure BDA0002529690070000035
由此,各状态量及参考值具体为:
Figure BDA0002529690070000036
其中,
Figure BDA0002529690070000037
ye为侧向偏差,ψe为航向角偏差,l为轴长,状态量的下标r均表示参考值。
进一步地,所述步骤三中建立的模型预测控制器状态方程,具有以下形式:
其中,
Figure BDA0002529690070000041
为质心侧偏角变化率;
写成状态空间的形式,x、y、
Figure BDA0002529690070000042
分别为状态量、输出量、状态量变化率:
Figure BDA0002529690070000043
其中,下标des表示期望值
Figure BDA0002529690070000044
Figure BDA0002529690070000045
状态量x=[yee,β,ω]T,控制量
Figure BDA0002529690070000046
Figure BDA0002529690070000047
为额外横摆力矩的期望值,扰动量w=ρ。
进一步地,所述步骤四中建立多目标优化函数具体包括以下步骤:
为获得预测输出方程,先将状态空间方程离散化,则有:
Figure BDA0002529690070000048
其中,Ak,t=eAT
Figure BDA0002529690070000049
Ck,t=C,T为采样时间,e为自然常数;
为减小计算量,提高模型预测控制器的计算效率,做如下简化:
Figure BDA00025296900700000410
其中,Np为预测时域,Nc为控制时域;
则预测输出方程为:
Figure BDA00025296900700000411
其中,
Figure BDA00025296900700000412
Figure BDA0002529690070000051
Figure BDA0002529690070000052
Figure BDA0002529690070000053
Y(t)=[y(t+1|t)T…y(t+Np|t)T]T,ΔU(t)=[Δu(t|t)T…Δu(t+Nc-1|t)T]T
W(t)=[w(t|t)T…w(t+Np-1|t)T]T
根据预测输出量与期望输出量参考值设置目标函数:
Figure BDA0002529690070000054
其中,Yref为期望输出量参考值,Q,R为权重矩阵,σ为权重系数,ε为松弛因子;
利用二次规划算法对目标函数进行求解,可得到最优控制增量序列ΔU(t),选取序列第一项与当前控制量的和作为下一步长的控制量;
对相关控制量的约束条件,通过以下方式设置:
为满足机械限制,需要对控制量的大小进行限制,即对前轮转角与额外横摆力矩设置最大最小值:
δfmin≤δf≤δfmax
Figure BDA0002529690070000055
其中,δfmax、δfmin分别表示前轮转角的最大和最小值,
Figure BDA0002529690070000056
分别表示额外横摆力矩的最大和最小值;
为了保持控制平顺性,防止控制量发生突变,对控制增量设置约束:
Δδfmin≤Δδf≤Δδfmax
Figure BDA0002529690070000057
其中,Δδfmax、Δδfmin分别表示前轮转角增量的最大和最小值,
Figure BDA0002529690070000058
Figure BDA0002529690070000059
分别表示额外横摆力矩增量的最大和最小值;
考虑到操纵稳定性,对横摆角速度与质心侧偏角设置约束:
βmin≤β≤βmax
ωmin≤ω≤ωmax
其中,βmax、βmin分别表示质心侧偏角的最大和最小值,ωmax、ωmin分别表示横摆角速度的最大和最小值;
通过求解带约束的多目标优化问题,实时获得最优控制序列,实现滚动优化。
进一步地,步骤六中进行底层力矩分配基于以下关系:
η=Λχ
其中,η=[Tfl Tfr Trl Trr]T,Tfl、Tfr、Trl、Trr分别表示左右前轮和左右后轮,Λ为系数矩阵,
Figure BDA0002529690070000061
其中,Fx_des为期望纵向驱动力,Rc为车轮滚动半径;
设置目标函数:
Figure BDA0002529690070000062
其中,S为权重矩阵;
Fzij代表车轮所受的垂向载荷,μij为车轮处的路面附着系数,车轮所受来自地面的纵向力Fxij与施加在车轮上的转矩Tij有如下关系:
Figure BDA0002529690070000063
其中,
Figure BDA0002529690070000064
Jc分别代表车轮转动角加速度、转动惯量,Mfij为车轮受到的滚动阻力矩;车轮所受来自地面的侧向力Fyij可由简化的轮胎模型进行计算:
Figure BDA0002529690070000065
其中,
Figure BDA0002529690070000066
αij和为轮胎的侧偏角Cij为轮胎侧偏刚度;
轮胎附着利用率可如下计算:
Figure BDA0002529690070000067
各轮胎附着利用率之和最小则车辆的操纵稳定性越好,而四个车轮的附着条件并非完全相同,为考虑四个车轮对操纵稳定性的影响,设置目标函数:
Figure BDA0002529690070000068
其中,W为权重矩阵,
Figure BDA0002529690070000071
则总目标函数为:
Figure BDA0002529690070000072
根据路面附着条件设置摩擦椭圆约束:
Figure BDA0002529690070000073
根据机械约束,对四轮毂电机转矩设置约束:
ηmin≤η≤ηmax
其中,η、ηmax、ηmin分别为四轮毂电机转矩及其最大最小值;
求解带约束的优化函数即得到四轮毂电机转矩最优控制序列。
上述本发明所提供的方法,相对于现有技术至少具有以下有益效果:
(1).本发明结合了变预瞄距离运动学模型获取当前状态与期望轨迹的航向角偏差与侧向位移偏差,建立模型预测控制器状态方程,使被控车辆的运动状态更符合实际驾驶员操纵特性,提高轨迹跟踪的鲁棒性;
(2).在转向过程中,根据车辆动力学模型设定了横摆角速度与质心侧偏角参考值,实现对横摆角速度以及质心侧偏角的控制,在对期望轨迹位置点跟踪的同时保证了转向可控性,实现了操纵稳定性与轨迹跟踪的综合控制。
(3).得到期望纵向力与期望额外横摆力矩,进而通过转矩分配算法得到四轮毂电机转矩最优控制序列。考虑底层力矩分配算法,对分布式驱动车辆轨迹跟踪与操纵稳定性相关执行器进行控制,提高了控制的准确性与鲁棒性,并实现了纵横向耦合控制。
附图说明
图1为本发明所提供方法的执行过程框图;
图2为本发明所提供方法中的变预瞄距离运动学模型示意图;
图3为四轮毂电机驱动车辆三自由度动力学模型示意图;
图4为四轮毂电机驱动车辆二自由度动力学模型示意图。
具体实施方式
下面将结合附图对本发明的技术方案进行清楚、完整地描述,显然,所描述的实施例是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
本发明所提供的一种四轮毂电机驱动车辆的综合控制方法,如图1所示,具体包括以下步骤:
步骤一、针对四轮毂电机驱动车辆,建立轨迹跟踪变预瞄距离运动学模型与三自由度动力学模型;
步骤二、确定待跟踪的期望轨迹上的状态量:航向角偏差,侧向偏差,质心侧偏角以及横摆角速度,并设置所述各状态量的参考值;
步骤三、确定由步骤一中所建立的两个模型共同组成的四轮毂驱动电机驱动车辆的模型预测控制器状态方程;
步骤四、基于步骤三中所建立的状态方程确定预测输出方程,根据预测输出量与期望输出量参考值建立多目标优化函数,设置满足机械限制、控制平顺性、操纵稳定性的相关控制量约束条件,实时滚动优化获得前轮转角与额外横摆力矩的最优控制量;
步骤五、根据实际纵向车速vx与纵向车速参考值vxr的偏差,用PID控制方法得到期望车辆总纵向驱动力Fx-des,满足车辆对纵向车速参考值的跟踪;
步骤六、进行底层力矩分配,根据期望纵向驱动力以及期望额外横摆力矩得到期望四轮转矩,将指令分配到四个电机控制器,实现对四轮毂电机驱动车辆的直接控制。
在本发明的一个优选实施方式中,所述步骤一中所建立的轨迹跟踪变预瞄距离运动学模型,如图2所示,可采用以下形式:
Figure BDA0002529690070000081
其中,
Figure BDA0002529690070000082
为侧向偏差变化率,
Figure BDA0002529690070000083
为航向角偏差变化率,ψe为航向角偏差,vx为纵向速度,Td为预瞄时间,β为质心侧偏角,ω为横摆角速度,ρ为预瞄点处期望轨迹曲率,预瞄距离随车速变化,能够提高跟踪精度与鲁棒性;
所述三自由度动力学模型,如图3所示,包括纵向、侧向、横摆三个自由度,对车辆进行动力学分析,可以得到以下方程:
Figure BDA0002529690070000084
其中,m为整车质量,Iz为车辆横摆转动惯量,vx、vy分别为车辆的纵向和侧向速度,
Figure BDA0002529690070000085
分别为车辆的纵向和侧向加速度,ω为车辆的横摆角速度,
Figure BDA0002529690070000086
为车辆的横摆角加速度,Cd为空气阻力系数,A为车身横截面积;Fxij和Fyij分别是相应车轮所受的纵向力和侧向力,其中i∈{f,r},j∈{l,r},分别代表前后、左右;
其中,系数矩阵Bx和By为:
Figure BDA0002529690070000091
Figure BDA0002529690070000092
其中,lf和lr分别表示重心和前桥与后桥之间的距离,d为轮距的一半;δf和δt分别为前后轮转角。
在本发明的一个优选实施方式中,所述步骤二中对于横摆角速度以及质心侧偏角这两个状态量的参考值,基于在所述三自由度动力学模型中去除纵向自由度得到的如图4所示的简化二自由度模型来计算,具有以下关系:
Figure BDA0002529690070000093
其中,Mz为横摆力矩,
Figure BDA0002529690070000094
为额外横摆力矩;
将轮胎力线性描述为:
Figure BDA0002529690070000095
其中,Cf、Cr为前后轮侧偏刚度,αf、αr为前后轮侧偏角,则有如下关系:
Figure BDA0002529690070000096
由此,各状态量及参考值具体为:
Figure BDA0002529690070000097
其中,
Figure BDA0002529690070000101
ye为侧向偏差,ψe为航向角偏差,l为轴长,状态量的下标r均表示参考值。
在本发明的一个优选实施方式中,所述步骤三中建立的模型预测控制器状态方程,具有以下形式:
Figure BDA0002529690070000102
其中,
Figure BDA0002529690070000103
为质心侧偏角变化率;
写成状态空间的形式,x、y、
Figure BDA0002529690070000104
分别为状态量、输出量、状态量变化率:
Figure BDA0002529690070000105
其中,下标des表示期望值
Figure BDA0002529690070000106
Figure BDA0002529690070000107
状态量x=[yee,β,ω]T,控制量
Figure BDA0002529690070000108
Figure BDA0002529690070000109
为额外横摆力矩的期望值,扰动量w=ρ。
在本发明的一个优选实施方式中,所述步骤四中建立多目标优化函数具体包括以下步骤:
为获得预测输出方程,先将状态空间方程离散化,则有:
Figure BDA00025296900700001010
其中,Ak,t=eAT
Figure BDA0002529690070000111
Ck,t=C,T为采样时间,e为自然常数;
为减小计算量,提高模型预测控制器的计算效率,做如下简化:
Figure BDA0002529690070000112
其中,Np为预测时域,Nc为控制时域;
则预测输出方程为:
Figure BDA0002529690070000113
其中,
Figure BDA0002529690070000114
Figure BDA0002529690070000115
Figure BDA0002529690070000116
Figure BDA0002529690070000117
Y(t)=[y(t+1|t)T…y(t+Np|t)T]T,ΔU(t)=[Δu(t|t)T…Δu(t+Nc-1|t)T]T
W(t)=[w(t|t)T…w(t+Np-1|t)T]T
根据预测输出量与期望输出量参考值设置目标函数:
Figure BDA0002529690070000118
其中,Yref为期望输出量参考值,Q,R为权重矩阵,σ为权重系数,ε为松弛因子;
利用二次规划算法对目标函数进行求解,可得到最优控制增量序列ΔU(t),选取序列第一项与当前控制量的和作为下一步长的控制量;
对相关控制量约束条件,通过以下方式设置:
为满足机械限制,需要对控制量的大小进行限制,即对前轮转角与额外横摆力矩设置最大最小值:
δfmin≤δf≤δfmax
Figure BDA0002529690070000121
其中,δfmax、δfmin分别表示前轮转角的最大和最小值,
Figure BDA0002529690070000122
分别表示额外横摆力矩的最大和最小值;
为了保持控制平顺性,防止控制量发生突变,对控制增量设置约束:
Δδfmin≤Δδf≤Δδfmax
Figure BDA0002529690070000123
其中,Δδfmax、Δδfmin分别表示前轮转角增量的最大和最小值,
Figure BDA0002529690070000124
Figure BDA0002529690070000125
分别表示额外横摆力矩增量的最大和最小值;
考虑到操纵稳定性,对横摆角速度与质心侧偏角设置约束:
βmin≤β≤βmax
ωmin≤ω≤ωmax
其中,βmax、βmin分别表示质心侧偏角的最大和最小值,ωmax、ωmin分别表示横摆角速度的最大和最小值;
通过求解带约束的多目标优化问题,实时获得最优控制序列,实现滚动优化。
在本发明的一个优选实施方式中,步骤六中进行底层力矩分配基于以下关系:
η=Λχ
其中,η=[Tfl Tfr Trl Trr]T,Tfl、Tfr、Trl、Trr分别表示左右前轮和左右后轮,Λ为系数矩阵,
Figure BDA0002529690070000126
其中,Fx_des为期望纵向驱动力,Rc为车轮滚动半径;
设置目标函数:
Figure BDA0002529690070000127
其中,S为权重矩阵;
Fzij代表车轮所受的垂向载荷,μij为车轮处的路面附着系数,车轮所受来自地面的纵向力Fxij与施加在车轮上的转矩Tij有如下关系:
Figure BDA0002529690070000128
其中,
Figure BDA0002529690070000129
Jc分别代表车轮转动角加速度和转动惯量,Mfij为车轮受到的滚动阻力矩;车轮所受来自地面的侧向力Fyij可由简化的轮胎模型进行计算:
Figure BDA0002529690070000131
其中,
Figure BDA0002529690070000132
αij和为轮胎的侧偏角Cij为轮胎侧偏刚度;
轮胎附着利用率可如下计算:
Figure BDA0002529690070000133
各轮胎附着利用率之和最小则车辆的操纵稳定性越好,而四个车轮的附着条件并非完全相同,为考虑四个车轮对操纵稳定性的影响,设置目标函数:
Figure BDA0002529690070000134
其中,W为权重矩阵,
Figure BDA0002529690070000135
则总目标函数为:
Figure BDA0002529690070000136
根据路面附着条件设置摩擦椭圆约束:
Figure BDA0002529690070000137
根据机械约束,对四轮毂电机转矩设置约束:
ηmin≤η≤ηmax
其中,η、ηmax、ηmin分别为四轮毂电机转矩及其最大最小值;
求解带约束的优化函数即得到四轮毂电机转矩最优控制序列。
应理解,本发明实施例中各步骤的序号的大小并不意味着执行顺序的先后,各过程的执行顺序应以其功能和内在逻辑确定,而不应对本发明实施例的实施过程构成任何限定。
尽管已经示出和描述了本发明的实施例,对于本领域的普通技术人员而言,可以理解在不脱离本发明的原理和精神的情况下可以对这些实施例进行多种变化、修改、替换和变型,本发明的范围由所附权利要求及其等同物限定。

Claims (6)

1.一种四轮毂电机驱动车辆的综合控制方法,其特征在于:具体包括以下步骤:
步骤一、针对四轮毂电机驱动车辆,建立轨迹跟踪变预瞄距离运动学模型与三自由度动力学模型;
步骤二、确定待跟踪的期望轨迹上的状态量:航向角偏差,侧向偏差,质心侧偏角以及横摆角速度,并设置各状态量的参考值;
步骤三、确定由步骤一中所建立的两个模型共同组成的四轮毂驱动电机驱动车辆的模型预测控制器状态方程;
步骤四、基于步骤三中所建立的状态方程确定预测输出方程,根据预测输出量与期望输出量参考值建立多目标优化函数,设置满足机械限制、控制平顺性、操纵稳定性的相关控制量约束条件,实时滚动优化获得前轮转角与额外横摆力矩的最优控制量;
步骤五、根据实际纵向车速vx与纵向车速参考值vxr的偏差,用PID控制方法得到期望车辆总纵向驱动力Fx-des,满足车辆对纵向车速参考值的跟踪;
步骤六、进行底层力矩分配,根据期望纵向驱动力以及期望额外横摆力矩得到期望四轮转矩,将指令分配到四个电机控制器,实现对四轮毂电机驱动车辆的直接控制。
2.如权利要求1所述的方法,其特征在于:所述步骤一中所建立的轨迹跟踪变预瞄距离运动学模型,采用以下形式:
Figure FDA0002994370140000011
其中,
Figure FDA0002994370140000012
为侧向偏差变化率,
Figure FDA0002994370140000013
为航向角偏差变化率,ψe为航向角偏差,vx为纵向速度,Td为预瞄时间,β为质心侧偏角,ω为横摆角速度,ρ为预瞄点处期望轨迹曲率;
所述三自由度动力学模型,包括纵向、侧向、横摆三个自由度,对车辆进行动力学分析,得到以下方程:
Figure FDA0002994370140000014
其中,m为整车质量,Iz为车辆横摆转动惯量,vx、vy分别为车辆的纵向和侧向速度,
Figure FDA0002994370140000015
分别为车辆的纵向和侧向加速度,ω为车辆的横摆角速度,
Figure FDA0002994370140000016
为车辆的横摆角加速度,Cd为空气阻力系数,A为车身横截面积;Fxij和Fyij分别是相应车轮所受的纵向力和侧向力,其中i∈{f,r},j∈{l,r},分别代表前后、左右;
其中,系数矩阵Bx和By为:
Figure FDA0002994370140000021
Figure FDA0002994370140000022
其中,lf和lr分别表示重心和前桥与后桥之间的距离,d为轮距的一半;δf和δt分别为前后轮转角。
3.如权利要求2所述的方法,其特征在于:所述步骤二中对于横摆角速度以及质心侧偏角这两个状态量的参考值,基于在所述三自由度动力学模型中去除纵向自由度得到的简化二自由度模型来计算,具有以下关系:
Figure FDA0002994370140000023
其中,Mz为横摆力矩,
Figure FDA0002994370140000024
为额外横摆力矩;
将轮胎力线性描述为:
Figure FDA0002994370140000025
其中,Cf、Cr为前后轮侧偏刚度,αf、αr为前后轮侧偏角,则有如下关系:
Figure FDA0002994370140000026
由此,各状态量及参考值具体为:
Figure FDA0002994370140000027
其中,
Figure FDA0002994370140000031
ye为侧向偏差,ψe为航向角偏差,l为轴长,状态量的下标r均表示参考值。
4.如权利要求3所述的方法,其特征在于:所述步骤三中建立的模型预测控制器状态方程,具有以下形式:
Figure FDA0002994370140000032
其中,
Figure FDA0002994370140000033
为质心侧偏角变化率;
写成状态空间的形式,x、y、
Figure FDA0002994370140000034
分别为状态量、输出量、状态量变化率:
Figure FDA0002994370140000035
其中,下标des表示期望值
Figure FDA0002994370140000036
Figure FDA0002994370140000037
状态量x=[yee,β,ω]T,控制量
Figure FDA0002994370140000038
Figure FDA0002994370140000039
为额外横摆力矩的期望值,扰动量w=ρ。
5.如权利要求4所述的方法,其特征在于:所述步骤四中建立多目标优化函数具体包括以下步骤:
为获得预测输出方程,先将状态空间方程离散化,则有:
Figure FDA00029943701400000310
其中,Ak,t=eAT
Figure FDA0002994370140000041
Ck,t=C,T为采样时间,e为自然常数;
为减小计算量,提高模型预测控制器的计算效率,做如下简化:
Figure FDA0002994370140000042
其中,Np为预测时域,Nc为控制时域;
则预测输出方程为:
Figure FDA0002994370140000043
其中,
Figure FDA0002994370140000044
Figure FDA0002994370140000045
Figure FDA0002994370140000046
Y(t)=[y(t+1|t)T…y(t+Np|t)T]T,ΔU(t)=[Δu(t|t)T…Δu(t+Nc-1|t)T]T,W(t)=[w(t|t)T…w(t+Np-1|t)T]T
根据预测输出量与期望输出量参考值设置目标函数:
Figure FDA0002994370140000047
其中,Yref为期望输出量参考值,Q,R为权重矩阵,σ为权重系数,ε为松弛因子;
利用二次规划算法对目标函数进行求解,可得到最优控制增量序列ΔU(t),选取序列第一项与当前控制量的和作为下一步长的控制量;
对相关控制量的约束条件,通过以下方式设置:
为满足机械限制,需要对控制量的大小进行限制,即对前轮转角与额外横摆力矩设置最大最小值:
δfmin≤δf≤δfmax
Figure FDA0002994370140000048
其中,δfmax、δfmin分别表示前轮转角的最大和最小值,
Figure FDA0002994370140000049
分别表示额外横摆力矩的最大和最小值;
为了保持控制平顺性,防止控制量发生突变,对控制增量设置约束:
Δδfmin≤Δδf≤Δδfmax
Figure FDA0002994370140000051
其中,Δδfmax、Δδfmin分别表示前轮转角增量的最大和最小值,
Figure FDA0002994370140000052
分别表示额外横摆力矩增量的最大和最小值;
考虑到操纵稳定性,对横摆角速度与质心侧偏角设置约束:
βmin≤β≤βmax
ωmin≤ω≤ωmax
其中,βmax、βmin分别表示质心侧偏角的最大和最小值,ωmax、ωmin分别表示横摆角速度的最大和最小值;
通过求解带约束的多目标优化问题,实时获得最优控制序列,实现滚动优化。
6.如权利要求4所述的方法,其特征在于:步骤六中进行底层力矩分配基于以下关系:
η=Λχ
其中,η=[Tfl Tfr Trl Trr]T,Tfl、Tfr、Trl、Trr分别表示左右前轮和左右后轮,Λ为系数矩阵,
Figure FDA0002994370140000053
其中,Fx_des为期望纵向驱动力,Rc为车轮滚动半径;
设置目标函数:
Figure FDA0002994370140000054
其中,S为权重矩阵;
Fzij代表车轮所受的垂向载荷,μij为车轮处的路面附着系数,车轮所受来自地面的纵向力Fxij与施加在车轮上的转矩Tij有如下关系:
Figure FDA0002994370140000055
其中,
Figure FDA0002994370140000056
Jc分别代表车轮转动角加速度和转动惯量,Mfij为车轮受到的滚动阻力矩;车轮所受来自地面的侧向力Fyij可由简化的轮胎模型进行计算:
Figure FDA0002994370140000057
其中,
Figure FDA0002994370140000061
αij和为轮胎的侧偏角Cij为轮胎侧偏刚度;
轮胎附着利用率可如下计算:
Figure FDA0002994370140000062
各轮胎附着利用率之和最小则车辆的操纵稳定性越好,而四个车轮的附着条件并非完全相同,为考虑四个车轮对操纵稳定性的影响,设置目标函数:
Figure FDA0002994370140000063
其中,W为权重矩阵,
Figure FDA0002994370140000064
则总目标函数为:
Figure FDA0002994370140000065
根据路面附着条件设置摩擦椭圆约束:
Figure FDA0002994370140000066
根据机械约束,对四轮毂电机转矩设置约束:
ηmin≤η≤ηmax
其中,η、ηmax、ηmin分别为四轮毂电机转矩及其最大最小值;
求解带约束的优化函数即得到四轮毂电机转矩最优控制序列。
CN202010514532.2A 2020-06-08 2020-06-08 一种四轮毂电机驱动车辆的综合控制方法 Active CN111806427B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202010514532.2A CN111806427B (zh) 2020-06-08 2020-06-08 一种四轮毂电机驱动车辆的综合控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202010514532.2A CN111806427B (zh) 2020-06-08 2020-06-08 一种四轮毂电机驱动车辆的综合控制方法

Publications (2)

Publication Number Publication Date
CN111806427A CN111806427A (zh) 2020-10-23
CN111806427B true CN111806427B (zh) 2021-10-08

Family

ID=72844703

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202010514532.2A Active CN111806427B (zh) 2020-06-08 2020-06-08 一种四轮毂电机驱动车辆的综合控制方法

Country Status (1)

Country Link
CN (1) CN111806427B (zh)

Families Citing this family (24)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112319236B (zh) * 2020-10-26 2022-04-22 广州视源电子科技股份有限公司 移动机器人底盘的运动控制方法以及移动机器人底盘
CN112622875B (zh) * 2020-11-04 2022-07-19 北京理工大学 一种四轮毂电机驱动车辆的下层力矩分配控制方法
CN112394734A (zh) * 2020-11-27 2021-02-23 苏州感测通信息科技有限公司 一种基于线性模型预测控制算法的车辆轨迹跟踪控制方法
CN113759707B (zh) * 2020-12-10 2024-06-18 北京京东乾石科技有限公司 用于自动驾驶车辆的预测控制优化方法和装置
CN112660107B (zh) * 2020-12-21 2022-03-25 浙江天尚元科技有限公司 一种改善分布式电驱动底盘功率循环的转矩分配方法
CN112829766B (zh) * 2021-02-07 2022-05-17 西南大学 一种基于分布式驱动电动车辆的自适应路径跟踪方法
CN112937571B (zh) * 2021-03-12 2022-01-07 北京理工大学 一种智能汽车轨迹跟踪控制方法及系统
CN113076596B (zh) * 2021-03-31 2023-03-28 同济大学 融合车辆模型和轮胎力曲线的轨迹跟随并行预测方法
CN113386781B (zh) * 2021-05-24 2024-05-24 江苏大学 一种基于数据驱动车辆动力学模型的智能车辆轨迹跟踪控制方法
CN113359477B (zh) * 2021-07-13 2021-12-21 吉林大学 一种车辆纵侧向耦合轨迹跟踪控制器设计方法
CN113246749B (zh) * 2021-07-14 2021-11-05 北京理工大学 一种多轮/多轴独立驱动电动汽车多目标动力学控制方法
CN113467470B (zh) * 2021-07-23 2023-03-03 西安理工大学 一种无人自主小车的轨迹跟踪控制方法
CN113525366A (zh) * 2021-07-28 2021-10-22 日照公路建设有限公司 一种针对钢轮压路机液压横向控制器的横向控制方法
CN113985868B (zh) * 2021-10-09 2023-08-08 北京科技大学 一种轮式移动机器人分层路径跟踪控制实现方法
CN114326709A (zh) * 2021-12-03 2022-04-12 成都信息工程大学 一种基于模型预测控制的具有预览特性的智能车辆路径跟踪方法
CN114148411B (zh) * 2021-12-16 2022-12-13 北京理工大学 一种轮式无人平台的漂移控制方法
CN114044003B (zh) * 2021-12-21 2024-01-23 吉林大学 前后双轴转向车辆的循迹控制方法
CN114506388B (zh) * 2021-12-27 2023-04-07 广东机电职业技术学院 一种车辆转向控制方法、装置、计算机设备和存储介质
CN114291117B (zh) * 2022-01-25 2023-05-09 中山大学 一种四轮转向无人车辆轨迹跟踪控制方法
CN114859733B (zh) * 2022-05-23 2023-03-14 南京林业大学 一种差动转向无人车轨迹跟踪及姿态控制方法
CN114987604B (zh) * 2022-06-07 2023-04-04 南京航空航天大学 一种多源耦合滑板底盘系统及其多目标集成控制方法
CN117400944B (zh) * 2023-12-15 2024-03-08 北京理工大学 一种轮腿式车辆速差转向控制方法、系统及电子设备
CN117622125A (zh) * 2024-01-12 2024-03-01 杭州世宝汽车方向机有限公司 基于差动转向的路径跟踪控制方法
CN118061984A (zh) * 2024-04-22 2024-05-24 北京理工大学前沿技术研究院 一种无人驾驶车辆多级横摆运动控制方法、系统和设备

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105109477A (zh) * 2015-09-09 2015-12-02 北京理工大学 一种轮毂电机驱动车辆的转矩分配方法
DE102014211061A1 (de) * 2014-06-11 2016-01-21 Continental Teves Ag & Co. Ohg Verfahren und Vorrichtung zur Regelung der Fahrstabilität eines Fahrzeuges
CN108454623A (zh) * 2018-01-22 2018-08-28 大连理工大学 一种四轮独立驱动无人驾驶电动车辆轨迹跟踪控制方法
WO2019053680A1 (en) * 2017-09-15 2019-03-21 Detroit Electric Ev Technologies (Zhejiang) Limited SPIN CONTROL SYSTEM AND METHOD FOR REALIZING SPIN CONTROL FOR ELECTRIC VEHICLES
CN109774791A (zh) * 2019-01-22 2019-05-21 南京航空航天大学 一种线控四轮主动转向电动轮系统及其转向容错控制方法
CN110228462A (zh) * 2019-05-17 2019-09-13 吉林大学 四轮轮毂电机驱动电动汽车横摆稳定性控制方法

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE102014211061A1 (de) * 2014-06-11 2016-01-21 Continental Teves Ag & Co. Ohg Verfahren und Vorrichtung zur Regelung der Fahrstabilität eines Fahrzeuges
CN105109477A (zh) * 2015-09-09 2015-12-02 北京理工大学 一种轮毂电机驱动车辆的转矩分配方法
WO2019053680A1 (en) * 2017-09-15 2019-03-21 Detroit Electric Ev Technologies (Zhejiang) Limited SPIN CONTROL SYSTEM AND METHOD FOR REALIZING SPIN CONTROL FOR ELECTRIC VEHICLES
CN108454623A (zh) * 2018-01-22 2018-08-28 大连理工大学 一种四轮独立驱动无人驾驶电动车辆轨迹跟踪控制方法
CN109774791A (zh) * 2019-01-22 2019-05-21 南京航空航天大学 一种线控四轮主动转向电动轮系统及其转向容错控制方法
CN110228462A (zh) * 2019-05-17 2019-09-13 吉林大学 四轮轮毂电机驱动电动汽车横摆稳定性控制方法

Also Published As

Publication number Publication date
CN111806427A (zh) 2020-10-23

Similar Documents

Publication Publication Date Title
CN111806427B (zh) 一种四轮毂电机驱动车辆的综合控制方法
CN111890951B (zh) 智能电动汽车轨迹跟踪与运动控制方法
CN110356404B (zh) 一种具有自主换道功能并提高侧向安全性的智能驾驶系统
CN109204317B (zh) 轮毂驱动电动汽车纵、横和垂向力集成控制优化方法
CN109849899B (zh) 一种电动轮汽车电液复合车身稳定控制系统及方法
CN107561942B (zh) 基于模型补偿的智能车辆轨迹跟踪模型预测控制方法
CN109263716B (zh) 一种四轮毂电机驱动车辆转向的控制方法
CN111873985B (zh) 一种四轮驱动电动汽车的集成底盘控制方法
CN108177692B (zh) 一种电动轮驱动汽车差动助力转向与稳定性协调控制方法
CN109291932B (zh) 基于反馈的电动汽车横摆稳定性实时控制装置及方法
CN111923908A (zh) 一种融合稳定性的智能汽车路径跟踪控制方法
CN112373459B (zh) 一种四轮毂电机驱动车辆上层运动状态控制方法
CN112829766B (zh) 一种基于分布式驱动电动车辆的自适应路径跟踪方法
CN111152834A (zh) 一种基于阿克曼转向修正的电动汽车电子差速控制方法
CN113753080A (zh) 一种自动驾驶汽车横向运动自适应参数控制方法
CN112622875B (zh) 一种四轮毂电机驱动车辆的下层力矩分配控制方法
CN113978263A (zh) 一种驱动轮防滑与转矩优化融合的电动汽车稳定性控制方法
CN109017804B (zh) 力矩分配控制器为车辆各轮毂电机分配驱动力矩的方法
CN113221257A (zh) 考虑控制区域的极限工况下车辆横纵向稳定控制方法
CN114987537A (zh) 基于神经网络动力学的自动驾驶车辆道路自适应漂移控制系统与方法
CN109017447B (zh) 无人驾驶车辆总的驱动力矩输出方法
CN113147736A (zh) 基于独立轮系的电动车辆稳定性控制方法
CN110162045B (zh) 一种基于自适应三步法的卡车编队行驶跟随车控制方法
CN115933662A (zh) 一种基于自适应模型预测控制的智能汽车轨迹跟踪和稳定性控制系统及方法
CN115848162A (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