CN106004515B - 用于电动汽车自动泊车的车速控制方法及*** - Google Patents
用于电动汽车自动泊车的车速控制方法及*** Download PDFInfo
- Publication number
- CN106004515B CN106004515B CN201610318536.7A CN201610318536A CN106004515B CN 106004515 B CN106004515 B CN 106004515B CN 201610318536 A CN201610318536 A CN 201610318536A CN 106004515 B CN106004515 B CN 106004515B
- Authority
- CN
- China
- Prior art keywords
- msub
- parking
- mover
- speed
- mrow
- 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
- 238000000034 method Methods 0.000 title claims abstract description 45
- 238000005096 rolling process Methods 0.000 claims description 36
- 230000005484 gravity Effects 0.000 claims description 18
- 230000004807 localization Effects 0.000 abstract 2
- 238000010586 diagram Methods 0.000 description 9
- 230000004888 barrier function Effects 0.000 description 4
- 239000010426 asphalt Substances 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 2
- 230000001133 acceleration Effects 0.000 description 1
- 239000004568 cement Substances 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 230000004069 differentiation Effects 0.000 description 1
- 238000001914 filtration Methods 0.000 description 1
- 230000010354 integration Effects 0.000 description 1
- 230000010355 oscillation Effects 0.000 description 1
- 239000004576 sand Substances 0.000 description 1
- 230000035939 shock Effects 0.000 description 1
- 239000007787 solid Substances 0.000 description 1
- 239000004575 stone Substances 0.000 description 1
- 238000010998 test method Methods 0.000 description 1
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 description 1
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60L—PROPULSION 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/00—Methods, circuits, or devices for controlling the traction-motor speed of electrically-propelled vehicles
- B60L15/20—Methods, circuits, or devices for controlling the traction-motor speed of electrically-propelled vehicles for control of the vehicle or its driving motor to achieve a desired performance, e.g. speed, torque, programmed variation of speed
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60L—PROPULSION 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/00—Control parameters of input or output; Target parameters
- B60L2240/10—Vehicle control parameters
- B60L2240/12—Speed
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60L—PROPULSION 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/00—Control parameters of input or output; Target parameters
- B60L2240/40—Drive Train control parameters
- B60L2240/42—Drive Train control parameters related to electric machines
- B60L2240/423—Torque
-
- 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
- Y02T10/00—Road transport of goods or passengers
- Y02T10/60—Other road transportation technologies with climate change mitigation effect
- Y02T10/72—Electric energy management in electromobility
Landscapes
- Engineering & Computer Science (AREA)
- Power Engineering (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
- Traffic Control Systems (AREA)
Abstract
本发明公开了用于电动汽车自动泊车的车速控制方法及***,该***包括车速传感器模块、超声波传感器、车辆定位模块、泊车控制器和车速控制器,车速传感器模块用于检测电动汽车的运动车速,超声波传感器用于采集电动汽车周围的障碍物信息,车辆定位模块用于采集获得电动汽车的当前位置信息,泊车控制器用于根据采集的障碍物信息、当前位置信息以及预设的泊车轨迹设定理想泊车车速,车速控制器用于根据运动车速和理想泊车车速调节电动汽车的电机扭矩。本发明在低速情况下,可较好的实现泊车速度控制功能,误差较小,响应较快且过程平稳,可广泛应用于自动泊车领域中。
Description
技术领域
本发明涉及电动汽车自动泊车领域,特别是涉及用于电动汽车自动泊车的车速控制方法及***。
背景技术
名字解释:
PID控制器:比例-积分-微分控制器,是一个在工业控制应用中常见的反馈回路部件,由比例单元P、积分单元I和微分单元D组成;
ESC:Electronic Stability Control,车身电子稳定性控制***。
自动泊车***要求稳定的车辆纵向低速控制,以使车速一般稳定在0.5~1.0米/秒范围内。现有在纯电动汽车上的常见做法多为先测量车速,然后采用PID控制器调节电机扭矩。为处理车辆动态的非线性特性,有些设计采用增益调度PID控制器或模糊PID控制器。但是PID控制器的设计多依靠人工经验整定,费时费力,有时甚至导致***在某些情形下出现震荡等不稳定现象,影响用户体验和安全性。PID控制器的主要缺点包括汽车启动慢,响应速度不高,控制器参数整定困难等,因而各种改进的PID控制器形式虽有助于改善控制***的非线性,但是其设计整定方法更加复杂,往往需要更多的工程经验。因此,PID控制器的适用范围往往比较局限,在不同的工况下往往需要不同的控制器参数,否则***的性能甚至稳定性都会受到影响。综合可知,目前通过PID控制器来实现自动泊车的方法,控制过程复杂,而且难以稳定地实现自动控制。
发明内容
为了解决上述的技术问题,本发明的另一目的是提供用于电动汽车自动泊车的车速控制***,本发明的目的是提供用于电动汽车自动泊车的车速控制方法。
本发明解决其技术问题所采用的技术方案是:
用于电动汽车自动泊车的车速控制***,包括车速传感器模块、超声波传感器、车辆定位模块、泊车控制器和车速控制器,所述车速传感器模块用于检测电动汽车的运动车速,所述超声波传感器用于采集电动汽车周围的障碍物信息,所述车辆定位模块用于采集获得电动汽车的当前位置信息,所述泊车控制器用于根据采集的障碍物信息、当前位置信息以及预设的泊车轨迹设定理想泊车车速,所述车速控制器用于根据运动车速和理想泊车车速调节电动汽车的电机扭矩。
进一步,所述根据采集的障碍物信息、当前位置信息以及预设的泊车轨迹设定理想泊车车速的过程,其具体为:
将当前位置信息与预设的泊车轨迹进行匹配,同时结合采集的障碍物信息判断电动汽车当前处于泊车过程状态、泊车完毕状态或泊车障碍状态,进而设定对应的理想泊车车速。
进一步,所述用于根据运动车速和理想泊车车速调节电动汽车的电机扭矩的过程,其具体为:
结合下式,根据运动车速和理想泊车车速计算获得该时刻电动汽车对应的电机扭矩后,相应调节输出的电机扭矩:
上式中,b表示电动汽车运动模型系数,T表示电机扭矩,FR表示滚动阻力,FL表示风阻,k表示车速控制器的增益,vs表示理想泊车车速,依次表示采用状态观测器根据运动车速估算获得的重力分量的估计值和车速估计值。
进一步,和是采用状态观测器根据下式计算获得的:
上式中,a、b分别表示电动汽车运动模型系数且a、b为已知值,L1、L2为状态观测器的增益,v表示电动汽车的运动车速。
进一步,FL是通过下式计算获得的:
FL=0.5ρACxv2;
FR是通过下式计算获得的:
其中,FZ表示汽车重力,ρ表示空气密度,A表示迎风面积,Cx表示空气阻力系数,v表示电动汽车的运动车速,fR0表示滚动阻力0阶系数,fR1表示滚动阻力1阶系数,fR2表示滚动阻力4阶系数,ρ、A、Cx、fR0、fR1和fR2均为已知参数。
本发明解决其技术问题所采用的另一技术方案是:
用于电动汽车自动泊车的车速控制方法,包括步骤:
S1、采用车速传感器模块检测电动汽车的运动车速、采用超声波传感器采集电动汽车周围的障碍物信息以及采用车辆定位模块采集获得电动汽车的当前位置信息;
S2、根据采集的障碍物信息、当前位置信息以及预设的泊车轨迹设定理想泊车车速;
S3、根据运动车速和理想泊车车速调节电动汽车的电机扭矩;
S4、电机根据车速控制器输出的电机扭矩实时地调整电动汽车的车速。
进一步,所述步骤S2,其具体为:
将当前位置信息与预设的泊车轨迹进行匹配,同时结合采集的障碍物信息判断电动汽车当前处于泊车过程状态、泊车完毕状态或泊车障碍状态,进而设定对应的理想泊车车速。
进一步,所述步骤S3,其具体为:
结合下式,根据运动车速和理想泊车车速计算获得该时刻电动汽车对应的电机扭矩后,相应调节输出的电机扭矩:
上式中,b表示电动汽车运动模型系数,T表示电机扭矩,FR表示滚动阻力,FL表示风阻,k表示车速控制器的增益,vs表示理想泊车车速,依次表示采用状态观测器根据运动车速估算获得的重力分量的估计值和车速估计值。
进一步,所述和是采用状态观测器根据下式计算获得的:
上式中,a、b分别表示电动汽车运动模型系数且a、b为已知值,L1、L2为状态观测器的增益,v表示电动汽车的运动车速。
进一步,所述FL是通过下式计算获得的:
FL=0.5ρACxv2;
FR是通过下式计算获得的:
其中,FZ表示汽车重力,ρ表示空气密度,A表示迎风面积,Cx表示空气阻力系数,v表示电动汽车的运动车速,fR0表示滚动阻力0阶系数,fR1表示滚动阻力1阶系数,fR2表示滚动阻力4阶系数,ρ、A、Cx、fR0、fR1和fR2均为已知参数。
本发明的有益效果是:本发明的用于电动汽车自动泊车的车速控制***,包括车速传感器模块、超声波传感器、车辆定位模块、泊车控制器和车速控制器,所述车速传感器模块用于检测电动汽车的运动车速,所述超声波传感器用于采集电动汽车周围的障碍物信息,所述车辆定位模块用于采集获得电动汽车的当前位置信息,所述泊车控制器用于根据采集的障碍物信息、当前位置信息以及预设的泊车轨迹设定理想泊车车速,所述车速控制器用于根据运动车速和理想泊车车速调节电动汽车的电机扭矩。本车速控制***在低速情况下,可较好的实现泊车速度控制功能,误差较小,响应较快且过程平稳。
本发明的另一有益效果是:本发明的用于电动汽车自动泊车的车速控制方法,包括步骤:S1、采用车速传感器模块检测电动汽车的运动车速、采用超声波传感器采集电动汽车周围的障碍物信息以及采用车辆定位模块采集获得电动汽车的当前位置信息;S2、根据采集的障碍物信息、当前位置信息以及预设的泊车轨迹设定理想泊车车速;S3、根据运动车速和理想泊车车速调节电动汽车的电机扭矩;S4、电机根据车速控制器输出的电机扭矩实时地调整电动汽车的车速。本车速控制方法在低速情况下,可较好的实现泊车速度控制,误差较小,响应较快且过程平稳。
附图说明
下面结合附图和实施例对本发明作进一步说明。
图1是本发明的用于电动汽车自动泊车的车速控制***的结构框图;
图2是本发明的用于电动汽车自动泊车的车速控制***的车辆定位模块获取车辆位置信息的示意图;
图3是本发明的用于电动汽车自动泊车的车速控制***的具体实施例一中的一种实现方式的结构框图;
图4是本发明的用于电动汽车自动泊车的车速控制***的实施例三中对工况一进行泊车测试的控制结果示意图;
图5是本发明的用于电动汽车自动泊车的车速控制***的实施例三中对工况二进行泊车测试的控制结果示意图;
图6是本发明的用于电动汽车自动泊车的车速控制***的实施例三中对工况三进行泊车测试的控制结果示意图;
图7是本发明的用于电动汽车自动泊车的车速控制***的实施例三中对工况四进行泊车测试的控制结果示意图;
图8是本发明的用于电动汽车自动泊车的车速控制***的实施例三中对工况五进行泊车测试的控制结果示意图。
具体实施方式
参照图1,本发明提供了一种用于电动汽车自动泊车的车速控制***,包括车速传感器模块、超声波传感器、车辆定位模块、泊车控制器和车速控制器,所述车速传感器模块用于检测电动汽车的运动车速,所述超声波传感器用于采集电动汽车周围的障碍物信息,所述车辆定位模块用于采集获得电动汽车的当前位置信息,所述泊车控制器用于根据采集的障碍物信息、当前位置信息以及预设的泊车轨迹设定理想泊车车速,所述车速控制器用于根据运动车速和理想泊车车速调节电动汽车的电机扭矩。
进一步作为优选的实施方式,所述根据采集的障碍物信息、当前位置信息以及预设的泊车轨迹设定理想泊车车速的过程,其具体为:
将当前位置信息与预设的泊车轨迹进行匹配,同时结合采集的障碍物信息判断电动汽车当前处于泊车过程状态、泊车完毕状态或泊车障碍状态,进而设定对应的理想泊车车速。
进一步作为优选的实施方式,所述用于根据运动车速和理想泊车车速调节电动汽车的电机扭矩的过程,其具体为:
结合下式,根据运动车速和理想泊车车速计算获得该时刻电动汽车对应的电机扭矩后,相应调节输出的电机扭矩:
上式中,b表示电动汽车运动模型系数,T表示电机扭矩,FR表示滚动阻力,FL表示风阻,k表示车速控制器的增益,vs表示理想泊车车速,依次表示采用状态观测器根据运动车速估算获得的重力分量的估计值和车速估计值。
进一步作为优选的实施方式,和是采用状态观测器根据下式计算获得的:
上式中,a、b分别表示电动汽车运动模型系数且a、b为已知值,L1、L2为状态观测器的增益,v表示电动汽车的运动车速。
进一步作为优选的实施方式,FL是通过下式计算获得的:
FL=0.5ρACxv2;
FR是通过下式计算获得的:
其中,FZ表示汽车重力,ρ表示空气密度,A表示迎风面积,Cx表示空气阻力系数,v表示电动汽车的运动车速,fR0表示滚动阻力0阶系数,fR1表示滚动阻力1阶系数,fR2表示滚动阻力4阶系数,ρ、A、Cx、fR0、fR1和fR2均为已知参数。
本发明还提供了一种用于电动汽车自动泊车的车速控制方法,包括步骤:
S1、采用车速传感器模块检测电动汽车的运动车速、采用超声波传感器采集电动汽车周围的障碍物信息以及采用车辆定位模块采集获得电动汽车的当前位置信息;
S2、根据采集的障碍物信息、当前位置信息以及预设的泊车轨迹设定理想泊车车速;
S3、根据运动车速和理想泊车车速调节电动汽车的电机扭矩;
S4、电机根据车速控制器输出的电机扭矩实时地调整电动汽车的车速。
进一步作为优选的实施方式,所述步骤S2,其具体为:
将当前位置信息与预设的泊车轨迹进行匹配,同时结合采集的障碍物信息判断电动汽车当前处于泊车过程状态、泊车完毕状态或泊车障碍状态,进而设定对应的理想泊车车速。
进一步作为优选的实施方式,所述步骤S3,其具体为:
结合下式,根据运动车速和理想泊车车速计算获得该时刻电动汽车对应的电机扭矩后,相应调节输出的电机扭矩:
上式中,b表示电动汽车运动模型系数,T表示电机扭矩,FR表示滚动阻力,FL表示风阻,k表示车速控制器的增益,vs表示理想泊车车速,依次表示采用状态观测器根据运动车速估算获得的重力分量的估计值和车速估计值。
进一步作为优选的实施方式,所述和是采用状态观测器根据下式计算获得的:
上式中,a、b分别表示电动汽车运动模型系数且a、b为已知值,L1、L2为状态观测器的增益,v表示电动汽车的运动车速。
进一步作为优选的实施方式,所述FL是通过下式计算获得的:
FL=0.5ρACxv2;
FR是通过下式计算获得的:
其中,FZ表示汽车重力,ρ表示空气密度,A表示迎风面积,Cx表示空气阻力系数,v表示电动汽车的运动车速,fR0表示滚动阻力0阶系数,fR1表示滚动阻力1阶系数,fR2表示滚动阻力4阶系数,ρ、A、Cx、fR0、fR1和fR2均为已知参数。
以下结合具体实施例对本发明做详细说明。
实施例一
参照图1,一种用于电动汽车自动泊车的车速控制***,包括车速传感器模块、超声波传感器、车辆定位模块、泊车控制器和车速控制器,车速传感器模块用于检测电动汽车的运动车速,超声波传感器用于采集电动汽车周围的障碍物信息,车辆定位模块用于采集获得电动汽车的当前位置信息,泊车控制器用于根据采集的障碍物信息、当前位置信息以及预设的泊车轨迹设定理想泊车车速,车速控制器用于根据运动车速和理想泊车车速调节电动汽车的电机扭矩。本实施例中,超声波传感器的数量共12个,分别安装于电动汽车四周,可以检测电动汽车周围的障碍物信息。车辆定位模块用于采集获得电动汽车的当前位置信息,具体的,如图2所示,图2中虚线框表示目标停车车位,图2中xy坐标系是以目标停车车位的后轴中心为0点的,实线框表示待泊车的电动汽车,后轴中心坐标(xc,yc)表示电动汽车的位置,角度θ表示电动汽车的朝向,车辆定位***用于提供电动汽车的实时的(xc,yc,θ)的值,该值也称电动汽车的当前位置信息。具体如何获取当前位置信息是现有技术中比较成熟的内容,可以通过图像处理等方式获得,本申请不再赘述。
另外,因为各种传感器信号存在噪声,因此速度信号要首先经过滤波信号处理后,例如通过限幅滤波器或线性滤波器后,再输出到对应的控制器。本实施例中,选择的滤波器的截止频率可选在2Hz~5Hz之间。
泊车控制器根据采集的障碍物信息、当前位置信息以及预设的泊车轨迹设定理想泊车车速的过程,其具体为:
将当前位置信息与预设的泊车轨迹进行匹配,同时结合采集的障碍物信息判断电动汽车当前处于泊车过程状态、泊车完毕状态或泊车障碍状态,进而设定对应的理想泊车车速。例如,泊车过程状态的理想泊车车速可以设定为0.5m/s或1.0m/s,泊车完毕状态下,将理想泊车车速设定为0m/s,泊车障碍状态可能会有碰撞危险,因此将理想泊车车速设定为0m/s,也可以设定反向的理想泊车车速,避免发生碰撞。将当前位置信息与预设的泊车轨迹进行匹配,同时结合采集的障碍物信息来判断电动汽车的状态,例如,当前位置信息与预设的泊车轨迹进行匹配后,判断电动汽车位于轨迹跟踪状态,而且判断电动汽车在预设的距离内没有障碍物,则判定电动汽车当前处于泊车过程状态;而当匹配判断电动汽车行驶到目标停车车位后,则判定电动汽车当前处于泊车完毕状态;而当判断电动汽车在预设的距离内没有障碍物,则表示存在碰撞危险,判定电动汽车当前处于泊车障碍状态。
车速控制器用于根据运动车速和理想泊车车速调节电动汽车的电机扭矩的过程,其具体为:
结合下式,根据运动车速和理想泊车车速计算获得该时刻电动汽车对应的电机扭矩后,相应调节输出的电机扭矩:
上式中,b表示电动汽车运动模型系数,T表示电机扭矩,FR表示滚动阻力,FL表示风阻,k表示车速控制器的增益,vs表示理想泊车车速,依次表示采用状态观测器根据运动车速估算获得的重力分量的估计值和车速估计值。电机***接收车速控制器发出的扭矩命令并执行。同时如果需要刹车,则控制***发出制动压强命令,ESC***接收并执行制动压强命令。例如理想泊车车速为0m/s时,输出的电机扭矩为0Nm,ESC***输出一定的制动压强,若经过一段时间后,电动汽车的车速仍未减小至0m/s,则增大制动压强辅助将电动汽车的车速减小至0m/s。
其中,和是采用状态观测器根据下式计算获得的:
上式中,a、b分别表示电动汽车运动模型系数且a、b为已知值,L1、L2为状态观测器的增益,v表示电动汽车的运动车速。
FL和FR分别通过下式计算获得的:
FL=0.5ρACxv2;
其中,FZ表示汽车重力,ρ表示空气密度,A表示迎风面积,Cx表示空气阻力系数,v表示电动汽车的运动车速,fR0表示滚动阻力0阶系数,fR1表示滚动阻力1阶系数,fR2表示滚动阻力4阶系数,ρ、A、Cx、fR0、fR1和fR2均为已知参数。
本实施例的计算模型是通过以下方式获得的:
首先,因为本发明的目的是使得泊车过程中电动汽车的车速维持在设定车速,而泊车过程只考虑汽车的低速运动,因此,获得如下的简化的汽车运动模型:
上式中,v表示电动汽车的运动车速,表示v的微分,T表示电机扭矩,a、b分别表示电动汽车运动模型系数,a和b的值通过模型辨识技术获得,FR表示滚动阻力,FL表示风阻,FS表示重力沿路面坡度的分量。
FR和FL依次按照以下近似公式估算:
FL=0.5ρACxv2;
其中,FZ表示汽车重力,ρ表示空气密度,A表示迎风面积,Cx表示空气阻力系数,v表示电动汽车的运动车速,fR0表示滚动阻力0阶系数,fR1表示滚动阻力1阶系数,fR2表示滚动阻力4阶系数,ρ、A、Cx、fR0、fR1和fR2均为已知参数。
FS可以通过坡度传感器(一般采用惯性加速度)获得,这里我们采用状态观测器的方式来估计坡度的影响。电动汽车的运动车速的动态可以采用如下2阶***表示:
其中,表示FS的微分。
状态观测器可采用Luenberger观测器或Kalman滤波器的设计方法设计,状态观测器的动态如下式:
其中,依次表示采用状态观测器根据运动车速估算获得的重力分量的估计值和车速估计值,依次表示的微分,L1、L2为状态观测器的增益,L1、L2的选取需保证状态观测器的收敛性。
车速控制器的设计采用如下形式:
其中k为控制器的增益,k的选择需保证闭环***的稳定性。上述的本车速控制***,状态观测器可以是车速控制器的一部分,也可以是单独的一个部件,则通过设定状态观测器来辅助车速控制器来实现对电动汽车的控制,这种情况下车速控制***的结构框图如图3所示。
本实施例通过以上公式计算车速控制器实时输出的电机扭矩后对电机进行控制,从而可以简单、快速地控制泊车速度,而且跟随电动汽车的运动车速进行控制,可以使得泊车速度稳定在设定的理想泊车速度附近,工作稳定性高。另外,在扭矩变化很快时,可能会对电动汽车冲击过大,造成汽车零部件的损害,影响乘车体验,因此在扭矩控制过程中,可以设定每一采样周期内扭矩变化的大小,从而平滑地改变扭矩输出,使得泊车过程更为平稳安全。
实施例二
本实施例是基于实施例一的一种用于电动汽车自动泊车的车速控制方法,包括步骤:
S1、采用车速传感器模块检测电动汽车的运动车速、采用超声波传感器采集电动汽车周围的障碍物信息以及采用车辆定位模块采集获得电动汽车的当前位置信息;
S2、根据采集的障碍物信息、当前位置信息以及预设的泊车轨迹设定理想泊车车速;
S3、根据运动车速和理想泊车车速调节电动汽车的电机扭矩;
S4、电机根据车速控制器输出的电机扭矩实时地调整电动汽车的车速。
其中,步骤S2具体为:
将当前位置信息与预设的泊车轨迹进行匹配,同时结合采集的障碍物信息判断电动汽车当前处于泊车过程状态、泊车完毕状态或泊车障碍状态,进而设定对应的理想泊车车速。
步骤S3,其具体为:
结合下式,根据运动车速和理想泊车车速计算获得该时刻电动汽车对应的电机扭矩后,相应调节输出的电机扭矩:
上式中,b表示电动汽车运动模型系数,T表示电机扭矩,FR表示滚动阻力,FL表示风阻,k表示车速控制器的增益,vs表示理想泊车车速,依次表示采用状态观测器根据运动车速估算获得的重力分量的估计值和车速估计值。
其中,和是采用状态观测器根据下式计算获得的:
上式中,a、b分别表示电动汽车运动模型系数且a、b为已知值,L1、L2为状态观测器的增益,v表示电动汽车的运动车速。
FL是通过下式计算获得的:
FL=0.5ρACxv2;
FR是通过下式计算获得的:
其中,FZ表示汽车重力,ρ表示空气密度,A表示迎风面积,Cx表示空气阻力系数,v表示电动汽车的运动车速,fR0表示滚动阻力0阶系数,fR1表示滚动阻力1阶系数,fR2表示滚动阻力4阶系数,ρ、A、Cx、fR0、fR1和fR2均为已知参数。
实施例三
本实施例应用实施例一的车速控制***对某电动汽车进行不同工况下的泊车测试。主要分了以下五种工况进行测试:工况一、沥青道路,无明显坡度;工况二、沙石道路,无明显坡度;工况三、沥青道路,坡度约10度;工况四、水泥道路,无坡度,测试过程中人为不停地调整方向盘转角进行干预测试;工况五、雨后在有积水且略有泥泞的道路。五种工况均在不同的载人情况下(1~5人)进行测试后获得的平均的车速控制结果依次如图4、图5、图6、图7和图8所示。图4、图5、图6、图7和图8中,测量车速指检测获得的电动汽车的运动车速,设定速度指设定的理想泊车车速,综合结果显示,本发明所设计的速度控制***在低速情况下,可较好的实现速度控制功能,误差较小,响应较快且过程平稳,无冲击震荡等引起乘客不适的感觉,可应用于自动泊车***。
以上是对本发明的较佳实施进行了具体说明,但本发明创造并不限于实施例,熟悉本领域的技术人员在不违背本发明精神的前提下还可做出种种的等同变形或替换,这些等同的变型或替换均包含在本申请权利要求所限定的范围内。
Claims (8)
1.用于电动汽车自动泊车的车速控制***,其特征在于,包括车速传感器模块、超声波传感器、车辆定位模块、泊车控制器和车速控制器,所述车速传感器模块用于检测电动汽车的运动车速,所述超声波传感器用于采集电动汽车周围的障碍物信息,所述车辆定位模块用于采集获得电动汽车的当前位置信息,所述泊车控制器用于根据采集的障碍物信息、当前位置信息以及预设的泊车轨迹设定理想泊车车速,所述车速控制器用于根据运动车速和理想泊车车速调节电动汽车的电机扭矩;
所述用于根据运动车速和理想泊车车速调节电动汽车的电机扭矩的过程,其具体为:
结合下式,根据运动车速和理想泊车车速计算获得该时刻电动汽车对应的电机扭矩后,相应调节输出的电机扭矩:
<mrow>
<mi>T</mi>
<mo>=</mo>
<mi>b</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>F</mi>
<mi>R</mi>
</msub>
<mo>+</mo>
<msub>
<mi>F</mi>
<mi>L</mi>
</msub>
<mo>+</mo>
<msub>
<mover>
<mi>F</mi>
<mo>&OverBar;</mo>
</mover>
<mi>S</mi>
</msub>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mi>k</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>v</mi>
<mi>s</mi>
</msub>
<mo>-</mo>
<mover>
<mi>v</mi>
<mo>&OverBar;</mo>
</mover>
<mo>)</mo>
</mrow>
</mrow>
上式中,b表示电动汽车运动模型系数,T表示电机扭矩,FR表示滚动阻力,FL表示风阻,k表示车速控制器的增益,vs表示理想泊车车速,依次表示采用状态观测器根据运动车速估算获得的重力分量的估计值和车速估计值。
2.根据权利要求1所述的用于电动汽车自动泊车的车速控制***,其特征在于,所述根据采集的障碍物信息、当前位置信息以及预设的泊车轨迹设定理想泊车车速的过程,其具体为:
将当前位置信息与预设的泊车轨迹进行匹配,同时结合采集的障碍物信息判断电动汽车当前处于泊车过程状态、泊车完毕状态或泊车障碍状态,进而设定对应的理想泊车车速。
3.根据权利要求1所述的用于电动汽车自动泊车的车速控制***,其特征在于,和是采用状态观测器根据下式计算获得的:
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mover>
<mover>
<mi>v</mi>
<mo>&OverBar;</mo>
</mover>
<mo>&CenterDot;</mo>
</mover>
<mo>=</mo>
<mi>a</mi>
<mi>T</mi>
<mo>-</mo>
<mi>b</mi>
<mo>(</mo>
<msub>
<mi>F</mi>
<mi>R</mi>
</msub>
<mo>+</mo>
<msub>
<mi>F</mi>
<mi>L</mi>
</msub>
<mo>+</mo>
<msub>
<mover>
<mi>F</mi>
<mo>&OverBar;</mo>
</mover>
<mi>S</mi>
</msub>
<mo>)</mo>
<mo>+</mo>
<msub>
<mi>L</mi>
<mn>1</mn>
</msub>
<mo>(</mo>
<mi>v</mi>
<mo>-</mo>
<mover>
<mi>v</mi>
<mo>&OverBar;</mo>
</mover>
<mo>)</mo>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mover>
<mover>
<mi>F</mi>
<mo>&OverBar;</mo>
</mover>
<mo>&CenterDot;</mo>
</mover>
<mi>S</mi>
</msub>
<mo>=</mo>
<msub>
<mi>L</mi>
<mn>2</mn>
</msub>
<mo>(</mo>
<mi>v</mi>
<mo>-</mo>
<mover>
<mi>v</mi>
<mo>&OverBar;</mo>
</mover>
<mo>)</mo>
</mtd>
</mtr>
</mtable>
</mfenced>
上式中,a、b分别表示电动汽车运动模型系数且a、b为已知值,L1、L2为状态观测器的增益,v表示电动汽车的运动车速。
4.根据权利要求1所述的用于电动汽车自动泊车的车速控制***,其特征在于,FL是通过下式计算获得的:
FL=0.5ρACxv2;
FR是通过下式计算获得的:
<mrow>
<msub>
<mi>F</mi>
<mi>R</mi>
</msub>
<mo>=</mo>
<msub>
<mi>F</mi>
<mi>Z</mi>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mi>f</mi>
<mrow>
<mi>R</mi>
<mn>0</mn>
</mrow>
</msub>
<mo>+</mo>
<msub>
<mi>f</mi>
<mrow>
<mi>R</mi>
<mn>1</mn>
</mrow>
</msub>
<mfrac>
<mi>v</mi>
<mn>30</mn>
</mfrac>
<mo>+</mo>
<msub>
<mi>f</mi>
<mrow>
<mi>R</mi>
<mn>2</mn>
</mrow>
</msub>
<mfrac>
<msup>
<mi>v</mi>
<mn>4</mn>
</msup>
<msup>
<mn>30</mn>
<mn>4</mn>
</msup>
</mfrac>
<mo>)</mo>
</mrow>
<mo>;</mo>
</mrow>
其中,FZ表示汽车重力,ρ表示空气密度,A表示迎风面积,Cx表示空气阻力系数,v表示电动汽车的运动车速,fR0表示滚动阻力0阶系数,fR1表示滚动阻力1阶系数,fR2表示滚动阻力4阶系数,ρ、A、Cx、fR0、fR1和fR2均为已知参数。
5.用于电动汽车自动泊车的车速控制方法,其特征在于,包括步骤:
S1、采用车速传感器模块检测电动汽车的运动车速、采用超声波传感器采集电动汽车周围的障碍物信息以及采用车辆定位模块采集获得电动汽车的当前位置信息;
S2、根据采集的障碍物信息、当前位置信息以及预设的泊车轨迹设定理想泊车车速;
S3、根据运动车速和理想泊车车速调节电动汽车的电机扭矩;
S4、电机根据车速控制器输出的电机扭矩实时地调整电动汽车的车速;
所述步骤S3,其具体为:
结合下式,根据运动车速和理想泊车车速计算获得该时刻电动汽车对应的电机扭矩后,相应调节输出的电机扭矩:
<mrow>
<mi>T</mi>
<mo>=</mo>
<mi>b</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>F</mi>
<mi>R</mi>
</msub>
<mo>+</mo>
<msub>
<mi>F</mi>
<mi>L</mi>
</msub>
<mo>+</mo>
<msub>
<mover>
<mi>F</mi>
<mo>&OverBar;</mo>
</mover>
<mi>S</mi>
</msub>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mi>k</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>v</mi>
<mi>s</mi>
</msub>
<mo>-</mo>
<mover>
<mi>v</mi>
<mo>&OverBar;</mo>
</mover>
<mo>)</mo>
</mrow>
</mrow>
上式中,b表示电动汽车运动模型系数,T表示电机扭矩,FR表示滚动阻力,FL表示风阻,k表示车速控制器的增益,vs表示理想泊车车速,依次表示采用状态观测器根据运动车速估算获得的重力分量的估计值和车速估计值。
6.根据权利要求5所述的用于电动汽车自动泊车的车速控制方法,其特征在于,所述步骤S2,其具体为:
将当前位置信息与预设的泊车轨迹进行匹配,同时结合采集的障碍物信息判断电动汽车当前处于泊车过程状态、泊车完毕状态或泊车障碍状态,进而设定对应的理想泊车车速。
7.根据权利要求5所述的用于电动汽车自动泊车的车速控制方法,其特征在于,所述和是采用状态观测器根据下式计算获得的:
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mover>
<mover>
<mi>v</mi>
<mo>&OverBar;</mo>
</mover>
<mo>&CenterDot;</mo>
</mover>
<mo>=</mo>
<mi>a</mi>
<mi>T</mi>
<mo>-</mo>
<mi>b</mi>
<mo>(</mo>
<msub>
<mi>F</mi>
<mi>R</mi>
</msub>
<mo>+</mo>
<msub>
<mi>F</mi>
<mi>L</mi>
</msub>
<mo>+</mo>
<msub>
<mover>
<mi>F</mi>
<mo>&OverBar;</mo>
</mover>
<mi>S</mi>
</msub>
<mo>)</mo>
<mo>+</mo>
<msub>
<mi>L</mi>
<mn>1</mn>
</msub>
<mo>(</mo>
<mi>v</mi>
<mo>-</mo>
<mover>
<mi>v</mi>
<mo>&OverBar;</mo>
</mover>
<mo>)</mo>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mover>
<mover>
<mi>F</mi>
<mo>&OverBar;</mo>
</mover>
<mo>&CenterDot;</mo>
</mover>
<mi>S</mi>
</msub>
<mo>=</mo>
<msub>
<mi>L</mi>
<mn>2</mn>
</msub>
<mo>(</mo>
<mi>v</mi>
<mo>-</mo>
<mover>
<mi>v</mi>
<mo>&OverBar;</mo>
</mover>
<mo>)</mo>
</mtd>
</mtr>
</mtable>
</mfenced>
上式中,a、b分别表示电动汽车运动模型系数且a、b为已知值,L1、L2为状态观测器的增益,v表示电动汽车的运动车速。
8.根据权利要求5所述的用于电动汽车自动泊车的车速控制方法,其特征在于,所述FL是通过下式计算获得的:
FL=0.5ρACxv2;
FR是通过下式计算获得的:
<mrow>
<msub>
<mi>F</mi>
<mi>R</mi>
</msub>
<mo>=</mo>
<msub>
<mi>F</mi>
<mi>Z</mi>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mi>f</mi>
<mrow>
<mi>R</mi>
<mn>0</mn>
</mrow>
</msub>
<mo>+</mo>
<msub>
<mi>f</mi>
<mrow>
<mi>R</mi>
<mn>1</mn>
</mrow>
</msub>
<mfrac>
<mi>v</mi>
<mn>30</mn>
</mfrac>
<mo>+</mo>
<msub>
<mi>f</mi>
<mrow>
<mi>R</mi>
<mn>2</mn>
</mrow>
</msub>
<mfrac>
<msup>
<mi>v</mi>
<mn>4</mn>
</msup>
<msup>
<mn>30</mn>
<mn>4</mn>
</msup>
</mfrac>
<mo>)</mo>
</mrow>
<mo>;</mo>
</mrow>
其中,FZ表示汽车重力,ρ表示空气密度,A表示迎风面积,Cx表示空气阻力系数,v表示电动汽车的运动车速,fR0表示滚动阻力0阶系数,fR1表示滚动阻力1阶系数,fR2表示滚动阻力4阶系数,ρ、A、Cx、fR0、fR1和fR2均为已知参数。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610318536.7A CN106004515B (zh) | 2016-05-12 | 2016-05-12 | 用于电动汽车自动泊车的车速控制方法及*** |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610318536.7A CN106004515B (zh) | 2016-05-12 | 2016-05-12 | 用于电动汽车自动泊车的车速控制方法及*** |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106004515A CN106004515A (zh) | 2016-10-12 |
CN106004515B true CN106004515B (zh) | 2018-04-10 |
Family
ID=57099933
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610318536.7A Active CN106004515B (zh) | 2016-05-12 | 2016-05-12 | 用于电动汽车自动泊车的车速控制方法及*** |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106004515B (zh) |
Families Citing this family (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106781693A (zh) * | 2016-12-26 | 2017-05-31 | 上海蔚来汽车有限公司 | 倒车控制方法 |
CN107891780B (zh) * | 2017-10-26 | 2019-06-25 | 广州汽车集团零部件有限公司 | 基于车速扭矩控制的电动汽车自动泊车*** |
CN109102714B (zh) | 2017-12-15 | 2021-03-23 | 上海蔚来汽车有限公司 | 自动泊车的方法和设备、智能汽车以及计算机存储介质 |
CN108569280B (zh) | 2017-12-15 | 2020-03-24 | 上海蔚来汽车有限公司 | 自动泊车的方法和设备、智能汽车以及计算机存储介质 |
CN109131319B (zh) * | 2018-10-19 | 2020-11-03 | 北京经纬恒润科技有限公司 | 一种自动泊车扭矩控制方法和装置 |
CN110631598A (zh) * | 2019-08-06 | 2019-12-31 | 北京百度网讯科技有限公司 | 车辆定位精度的评测方法、装置、设备及计算机可读存储介质 |
CN110782029B (zh) * | 2019-10-25 | 2022-11-22 | 阿波罗智能技术(北京)有限公司 | 神经网络预测方法、装置、电子设备和自动驾驶*** |
CN111791881B (zh) * | 2020-07-17 | 2021-09-21 | 上海汽车集团股份有限公司 | 一种自动泊车方法及装置 |
CN112037265B (zh) * | 2020-11-04 | 2021-02-02 | 天津天瞳威势电子科技有限公司 | 一种库位跟踪方法及装置 |
CN112455429B (zh) * | 2020-11-30 | 2022-05-13 | 广州小鹏自动驾驶科技有限公司 | 一种泊车控制方法、装置、车辆和可读存储介质 |
CN113212421B (zh) * | 2021-05-14 | 2023-01-17 | 东风汽车集团股份有限公司 | 钥匙定位自动泊车方法、装置、设备及存储介质 |
CN113335269A (zh) * | 2021-06-02 | 2021-09-03 | 上海追势科技有限公司 | 一种自主泊车坡路车速控制方法 |
CN113200040B (zh) * | 2021-06-17 | 2022-08-16 | 广州小鹏自动驾驶科技有限公司 | 一种自动泊车的方法和装置 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101898559A (zh) * | 2009-02-09 | 2010-12-01 | 通用汽车环球科技运作公司 | 用于自动泊车的路径规划 |
CN103921788A (zh) * | 2014-04-02 | 2014-07-16 | 奇瑞汽车股份有限公司 | 一种汽车行驶控制***及方法 |
JP2014180988A (ja) * | 2013-03-21 | 2014-09-29 | Aisin Seiki Co Ltd | ハイブリッド車両用駆動装置 |
CN204821553U (zh) * | 2015-07-27 | 2015-12-02 | 江苏大学 | 一种电动汽车全自动泊车过程中的车速控制*** |
-
2016
- 2016-05-12 CN CN201610318536.7A patent/CN106004515B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101898559A (zh) * | 2009-02-09 | 2010-12-01 | 通用汽车环球科技运作公司 | 用于自动泊车的路径规划 |
JP2014180988A (ja) * | 2013-03-21 | 2014-09-29 | Aisin Seiki Co Ltd | ハイブリッド車両用駆動装置 |
CN103921788A (zh) * | 2014-04-02 | 2014-07-16 | 奇瑞汽车股份有限公司 | 一种汽车行驶控制***及方法 |
CN204821553U (zh) * | 2015-07-27 | 2015-12-02 | 江苏大学 | 一种电动汽车全自动泊车过程中的车速控制*** |
Also Published As
Publication number | Publication date |
---|---|
CN106004515A (zh) | 2016-10-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106004515B (zh) | 用于电动汽车自动泊车的车速控制方法及*** | |
CN108032858B (zh) | 基于旁车行驶路径预测的自适应巡航控制方法及*** | |
CN105329238B (zh) | 一种基于单目视觉的自动驾驶汽车换道控制方法 | |
JP5130638B2 (ja) | 回避操作算出装置、回避制御装置、各装置を備える車両、回避操作算出方法および回避制御方法 | |
CN107792062B (zh) | 一种自动泊车控制*** | |
JP6237256B2 (ja) | 車速制御装置 | |
US6567748B2 (en) | Motion control system for vehicle | |
JP4997065B2 (ja) | 車両制御装置 | |
KR102362212B1 (ko) | 자동차 주차 보조 방법 및 시스템 | |
EP2712780B1 (en) | Method and apparatus for performing driving assistance | |
JP5023869B2 (ja) | 車両用運転操作支援装置、および車両用運転操作支援方法 | |
CN107697065B (zh) | 一种面向一般停车场景的自动泊车控制方法 | |
CN107264617A (zh) | 车辆的车道保持控制装置 | |
CN107010066A (zh) | 车辆的行驶控制装置 | |
US9914453B2 (en) | Method for predicting the travel path of a motor vehicle and prediction apparatus | |
JP7152906B2 (ja) | 操舵制御装置、操舵制御方法、及び操舵制御システム | |
WO2006121221A1 (ja) | 車線追従制御装置および車線追従制御方法 | |
CN115214616A (zh) | 行驶控制***和行驶控制方法 | |
JP5386132B2 (ja) | 操舵支援装置 | |
CN115243951A (zh) | 用于控制车辆的方法 | |
JP5203865B2 (ja) | 操舵支援装置 | |
CN114291071B (zh) | 一种车辆稳定性控制主动介入时机的判定方法、***、可读存储介质及车辆 | |
JP4483426B2 (ja) | 車両のレーン走行支援装置 | |
JP5544435B2 (ja) | 操舵支援装置 | |
JP4614976B2 (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 |