用于电动汽车自动泊车的车速控制方法及系统的制作方法
【专利摘要】本发明公开了用于电动汽车自动泊车的车速控制方法及系统，该系统包括车速传感器模块、超声波传感器、车辆定位模块、泊车控制器和车速控制器，车速传感器模块用于检测电动汽车的运动车速，超声波传感器用于采集电动汽车周围的障碍物信息，车辆定位模块用于采集获得电动汽车的当前位置信息，泊车控制器用于根据采集的障碍物信息、当前位置信息以及预设的泊车轨迹设定理想泊车车速，车速控制器用于根据运动车速和理想泊车车速调节电动汽车的电机扭矩。本发明在低速情况下，可较好的实现泊车速度控制功能，误差较小，响应较快且过程平稳，可广泛应用于自动泊车领域中。
【专利说明】
用于电动汽车自动泊车的车速控制方法及系统
技术领域
[0001 ]本发明涉及电动汽车自动泊车领域，特别是涉及用于电动汽车自动泊车的车速控 制方法及系统。
【背景技术】
[0002] 名字解释：
[0003] PID控制器:比例-积分-微分控制器，是一个在工业控制应用中常见的反馈回路部 件，由比例单元P、积分单元I和微分单元D组成；
[0004] ESC:Electronic Stability Control，车身电子稳定性控制系统。
[0005] 自动泊车系统要求稳定的车辆纵向低速控制，以使车速一般稳定在0.5~1.0米/ 秒范围内。现有在纯电动汽车上的常见做法多为先测量车速，然后采用PID控制器调节电机 扭矩。为处理车辆动态的非线性特性，有些设计采用增益调度PID控制器或模糊PID控制器。 但是PID控制器的设计多依靠人工经验整定，费时费力，有时甚至导致系统在某些情形下出 现震荡等不稳定现象，影响用户体验和安全性。PID控制器的主要缺点包括汽车启动慢，响 应速度不高，控制器参数整定困难等，因而各种改进的PID控制器形式虽有助于改善控制系 统的非线性，但是其设计整定方法更加复杂，往往需要更多的工程经验。因此，PID控制器的 适用范围往往比较局限，在不同的工况下往往需要不同的控制器参数，否则系统的性能甚 至稳定性都会受到影响。综合可知，目前通过PID控制器来实现自动泊车的方法，控制过程 复杂，而且难以稳定地实现自动控制。
【发明内容】
[0006] 为了解决上述的技术问题，本发明的另一目的是提供用于电动汽车自动泊车的车 速控制系统，本发明的目的是提供用于电动汽车自动泊车的车速控制方法。
[0007] 本发明解决其技术问题所采用的技术方案是：
[0008] 用于电动汽车自动泊车的车速控制系统，包括车速传感器模块、超声波传感器、车 辆定位模块、泊车控制器和车速控制器，所述车速传感器模块用于检测电动汽车的运动车 速，所述超声波传感器用于采集电动汽车周围的障碍物信息，所述车辆定位模块用于采集 获得电动汽车的当前位置信息，所述泊车控制器用于根据采集的障碍物信息、当前位置信 息以及预设的泊车轨迹设定理想泊车车速，所述车速控制器用于根据运动车速和理想泊车 车速调节电动汽车的电机扭矩。
[0009] 进一步，所述根据采集的障碍物信息、当前位置信息以及预设的泊车轨迹设定理 想泊车车速的过程，其具体为：
[0010] 将当前位置信息与预设的泊车轨迹进行匹配，同时结合采集的障碍物信息判断电 动汽车当前处于泊车过程状态、泊车完毕状态或泊车障碍状态，进而设定对应的理想泊车 车速。
[0011] 进一步，所述用于根据运动车速和理想泊车车速调节电动汽车的电机扭矩的过 程，其具体为：
[0012] 结合下式，根据运动车速和理想泊车车速计算获得该时刻电动汽车对应的电机扭 矩后，相应调节输出的电机扭矩：
[0013] r^h{i--k + j-]+F,)+k(v^-v)
[0014] 上式中，b表示电动汽车运动模型系数，T表示电机扭矩，Fr表示滚动阻力，Fl表示风 阻，k表示车速控制器的增益， Vs表示理想泊车车速，旯、.歹依次表示采用状态观测器根据 运动车速估算获得的重力分量的估计值和车速估计值。
[0015] 进一步，巧和歹是采用状态观测器根据下式计算获得的： (r = uT -r /*', -f- i\ ) /..,(r-r)
[0016] -
[0017]上式中，a、b分别表示电动汽车运动模型系数且a、b为已知值，为状态观测器 的增益，v表示电动汽车的运动车速。
[0018]进一步，Fl是通过下式计算获得的：
[0019] Fl = 0.5pACxv2；
[0020] Fr是通过下式计算获得的：
[0022] 其中，Fz表示汽车重力，P表示空气密度，A表示迎风面积，Cx表示空气阻力系数，v表 示电动汽车的运动车速，fRQ表示滚动阻力〇阶系数，fRl表示滚动阻力1阶系数，fR2表示滚动 阻力4阶系数，P、A、C x、fRQ、fRl和fR2均为已知参数。
[0023]本发明解决其技术问题所采用的另一技术方案是：
[0024] 用于电动汽车自动泊车的车速控制方法，包括步骤：
[0025] S1、采用车速传感器模块检测电动汽车的运动车速、采用超声波传感器采集电动 汽车周围的障碍物信息以及采用车辆定位模块采集获得电动汽车的当前位置信息；
[0026] S2、根据采集的障碍物信息、当前位置信息以及预设的泊车轨迹设定理想泊车车 速；
[0027] S3、根据运动车速和理想泊车车速调节电动汽车的电机扭矩；
[0028] S4、电机根据车速控制器输出的电机扭矩实时地调整电动汽车的车速。
[0029]进一步，所述步骤S2,其具体为：
[0030]将当前位置信息与预设的泊车轨迹进行匹配，同时结合采集的障碍物信息判断电 动汽车当前处于泊车过程状态、泊车完毕状态或泊车障碍状态，进而设定对应的理想泊车 车速。
[0031]进一步，所述步骤S3,其具体为：
[0032] 结合下式，根据运动车速和理想泊车车速计算获得该时刻电动汽车对应的电机扭 矩后，相应调节输出的电机扭矩：
[0033] T = + Fs) + k(v^-v)
[0034] 上式中，b表示电动汽车运动模型系数，T表示电机扭矩，Fr表示滚动阻力，Fl表示风 阻，k表示车速控制器的增益，^表示理想泊车车速，，57依次表示采用状态观测器根据 运动车速估算获得的重力分量的估计值和车速估计值。
[0035] 进一步，所述巧和V是采用状态观测器根据下式计算获得的： \v=aT- b(FR + +Fs) + L1(v- v)
[0036] 二 _ |/ s. v)
[0037]上式中，a、b分别表示电动汽车运动模型系数且a、b为已知值，为状态观测器 的增益，v表示电动汽车的运动车速。
[0038]进一步，所述Fl是通过下式计算获得的：
[0039] Fl = 0.5pACxv2；
[0040] Fr是通过下式计算获得的：
[0042] 其中，Fz表示汽车重力，P表示空气密度，A表示迎风面积，Cx表示空气阻力系数，v表 示电动汽车的运动车速，fRQ表示滚动阻力〇阶系数，fRl表示滚动阻力1阶系数，fR2表示滚动 阻力4阶系数，P、A、C x、fRQ、fRl和fR2均为已知参数。
[0043] 本发明的有益效果是:本发明的用于电动汽车自动泊车的车速控制系统，包括车 速传感器模块、超声波传感器、车辆定位模块、泊车控制器和车速控制器，所述车速传感器 模块用于检测电动汽车的运动车速，所述超声波传感器用于采集电动汽车周围的障碍物信 息，所述车辆定位模块用于采集获得电动汽车的当前位置信息，所述泊车控制器用于根据 采集的障碍物信息、当前位置信息以及预设的泊车轨迹设定理想泊车车速，所述车速控制 器用于根据运动车速和理想泊车车速调节电动汽车的电机扭矩。本车速控制系统在低速情 况下，可较好的实现泊车速度控制功能，误差较小，响应较快且过程平稳。
[0044] 本发明的另一有益效果是:本发明的用于电动汽车自动泊车的车速控制方法，包 括步骤:S1、采用车速传感器模块检测电动汽车的运动车速、采用超声波传感器采集电动汽 车周围的障碍物信息以及采用车辆定位模块采集获得电动汽车的当前位置信息；S2、根据 采集的障碍物信息、当前位置信息以及预设的泊车轨迹设定理想泊车车速;S3、根据运动车 速和理想泊车车速调节电动汽车的电机扭矩;S4、电机根据车速控制器输出的电机扭矩实 时地调整电动汽车的车速。本车速控制方法在低速情况下，可较好的实现泊车速度控制，误 差较小，响应较快且过程平稳。
【附图说明】
[0045]下面结合附图和实施例对本发明作进一步说明。
[0046] 图1是本发明的用于电动汽车自动泊车的车速控制系统的结构框图；
[0047] 图2是本发明的用于电动汽车自动泊车的车速控制系统的车辆定位模块获取车辆 位置信息的示意图；
[0048] 图3是本发明的用于电动汽车自动泊车的车速控制系统的具体实施例一中的一种 实现方式的结构框图；
[0049] 图4是本发明的用于电动汽车自动泊车的车速控制系统的实施例三中对工况一进 行泊车测试的控制结果示意图；
[0050] 图5是本发明的用于电动汽车自动泊车的车速控制系统的实施例三中对工况二进 行泊车测试的控制结果示意图；
[0051 ]图6是本发明的用于电动汽车自动泊车的车速控制系统的实施例三中对工况三进 行泊车测试的控制结果示意图；
[0052]图7是本发明的用于电动汽车自动泊车的车速控制系统的实施例三中对工况四进 行泊车测试的控制结果示意图；
[0053]图8是本发明的用于电动汽车自动泊车的车速控制系统的实施例三中对工况五进 行泊车测试的控制结果示意图。
【具体实施方式】
[0054] 参照图1，本发明提供了一种用于电动汽车自动泊车的车速控制系统，包括车速传 感器模块、超声波传感器、车辆定位模块、泊车控制器和车速控制器，所述车速传感器模块 用于检测电动汽车的运动车速，所述超声波传感器用于采集电动汽车周围的障碍物信息， 所述车辆定位模块用于采集获得电动汽车的当前位置信息，所述泊车控制器用于根据采集 的障碍物信息、当前位置信息以及预设的泊车轨迹设定理想泊车车速，所述车速控制器用 于根据运动车速和理想泊车车速调节电动汽车的电机扭矩。
[0055] 进一步作为优选的实施方式，所述根据采集的障碍物信息、当前位置信息以及预 设的泊车轨迹设定理想泊车车速的过程，其具体为：
[0056] 将当前位置信息与预设的泊车轨迹进行匹配，同时结合采集的障碍物信息判断电 动汽车当前处于泊车过程状态、泊车完毕状态或泊车障碍状态，进而设定对应的理想泊车 车速。
[0057] 进一步作为优选的实施方式，所述用于根据运动车速和理想泊车车速调节电动汽 车的电机扭矩的过程，其具体为：
[0058]结合下式，根据运动车速和理想泊车车速计算获得该时刻电动汽车对应的电机扭 矩后，相应调节输出的电机扭矩：
[0059] T = h( + +F\) + k{-^-V)
[0060] 上式中，b表示电动汽车运动模型系数，T表示电机扭矩，Fr表示滚动阻力，Fl表示风 阻，k表示车速控制器的增益，Vs表示理想泊车车速，旯、V依次表示采用状态观测器根据 运动车速估算获得的重力分量的估计值和车速估计值。
[0061] 进一步作为优选的实施方式，巧和歹是采用状态观测器根据下式计算获得的： (V = uT - /)(/'" + !', + Fs) +- L, (v~r)
[0062] 二 一
[Fs =i2(v~v)
[0063]上式中，a、b分别表示电动汽车运动模型系数且a、b为已知值，为状态观测器 的增益，v表示电动汽车的运动车速。
[0064] 进一步作为优选的实施方式，Fl是通过下式计算获得的：
[0065] Fl = 0.5pACxv2；
[0066] Fr是通过下式计算获得的：
[0068] 其中，Fz表示汽车重力，P表示空气密度，A表示迎风面积，Cx表示空气阻力系数，v表 示电动汽车的运动车速，fRQ表示滚动阻力〇阶系数，fRl表示滚动阻力1阶系数，fR2表示滚动 阻力4阶系数，P、A、C x、fRQ、fRl和fR2均为已知参数。
[0069] 本发明还提供了一种用于电动汽车自动泊车的车速控制方法，包括步骤：
[0070] S1、采用车速传感器模块检测电动汽车的运动车速、采用超声波传感器采集电动 汽车周围的障碍物信息以及采用车辆定位模块采集获得电动汽车的当前位置信息；
[0071] S2、根据采集的障碍物信息、当前位置信息以及预设的泊车轨迹设定理想泊车车 速；
[0072] S3、根据运动车速和理想泊车车速调节电动汽车的电机扭矩；
[0073 ] S4、电机根据车速控制器输出的电机扭矩实时地调整电动汽车的车速。
[0074]进一步作为优选的实施方式，所述步骤S2，其具体为：
[0075]将当前位置信息与预设的泊车轨迹进行匹配，同时结合采集的障碍物信息判断电 动汽车当前处于泊车过程状态、泊车完毕状态或泊车障碍状态，进而设定对应的理想泊车 车速。
[0076]进一步作为优选的实施方式，所述步骤S3，其具体为：
[0077] 结合下式，根据运动车速和理想泊车车速计算获得该时刻电动汽车对应的电机扭 矩后，相应调节输出的电机扭矩：
[0078] T = h(!] +F,)+k(^-v)
[0079] 上式中，b表示电动汽车运动模型系数，T表示电机扭矩，Fr表示滚动阻力，Fl表示风 阻，k表示车速控制器的增益，Vs表示理想泊车车速，Fs、F依次表示采用状态观测器根据 运动车速估算获得的重力分量的估计值和车速估计值。
[0080]进一步作为优选的实施方式，所述忍和V是采用状态观测器根据下式计算获得的： p W - /，（/、+ /?..十 /'.) + L, (_ T7) _]二 ' 1厂、=Mv.'-F)
[0082]上式中，a、b分别表示电动汽车运动模型系数且a、b为已知值，为状态观测器 的增益，v表示电动汽车的运动车速。
[0083]进一步作为优选的实施方式，所述Fl是通过下式计算获得的：
[0084] Fl = 0.5pACxv2；
[0085] Fr是通过下式计算获得的：
[0087] 其中，Fz表示汽车重力，P表示空气密度，A表示迎风面积，Cx表示空气阻力系数，v表 示电动汽车的运动车速，fRQ表示滚动阻力〇阶系数，fRl表示滚动阻力1阶系数，fR2表示滚动 阻力4阶系数，P、A、Cx、fRQ、fRl和fR2均为已知参数。
[0088] 以下结合具体实施例对本发明做详细说明。
[0089] 实施例一
[0090] 参照图1，一种用于电动汽车自动泊车的车速控制系统，包括车速传感器模块、超 声波传感器、车辆定位模块、泊车控制器和车速控制器，车速传感器模块用于检测电动汽车 的运动车速，超声波传感器用于采集电动汽车周围的障碍物信息，车辆定位模块用于采集 获得电动汽车的当前位置信息，泊车控制器用于根据采集的障碍物信息、当前位置信息以 及预设的泊车轨迹设定理想泊车车速，车速控制器用于根据运动车速和理想泊车车速调节 电动汽车的电机扭矩。本实施例中，超声波传感器的数量共12个，分别安装于电动汽车四 周，可以检测电动汽车周围的障碍物信息。车辆定位模块用于采集获得电动汽车的当前位 置信息，具体的，如图2所示，图2中虚线框表示目标停车车位，图2中xy坐标系是以目标停车 车位的后轴中心为〇点的，实线框表示待泊车的电动汽车，后轴中心坐标(xc^y。)表示电动汽 车的位置，角度9表示电动汽车的朝向，车辆定位系统用于提供电动汽车的实时的(1，7。，9) 的值，该值也称电动汽车的当前位置信息。具体如何获取当前位置信息是现有技术中比较 成熟的内容，可以通过图像处理等方式获得，本申请不再赘述。
[0091 ]另外，因为各种传感器信号存在噪声，因此速度信号要首先经过滤波信号处理后， 例如通过限幅滤波器或线性滤波器后，再输出到对应的控制器。本实施例中，选择的滤波器 的截止频率可选在2Hz~5Hz之间。
[0092] 泊车控制器根据采集的障碍物信息、当前位置信息以及预设的泊车轨迹设定理想 泊车车速的过程，其具体为：
[0093] 将当前位置信息与预设的泊车轨迹进行匹配，同时结合采集的障碍物信息判断电 动汽车当前处于泊车过程状态、泊车完毕状态或泊车障碍状态，进而设定对应的理想泊车 车速。例如，泊车过程状态的理想泊车车速可以设定为0.5m/s或1. Om/s，泊车完毕状态下， 将理想泊车车速设定为〇m/s，泊车障碍状态可能会有碰撞危险，因此将理想泊车车速设定 为Om/s，也可以设定反向的理想泊车车速，避免发生碰撞。将当前位置信息与预设的泊车轨 迹进行匹配，同时结合采集的障碍物信息来判断电动汽车的状态，例如，当前位置信息与预 设的泊车轨迹进行匹配后，判断电动汽车位于轨迹跟踪状态，而且判断电动汽车在预设的 距离内没有障碍物，则判定电动汽车当前处于泊车过程状态;而当匹配判断电动汽车行驶 到目标停车车位后，则判定电动汽车当前处于泊车完毕状态;而当判断电动汽车在预设的 距离内没有障碍物，则表示存在碰撞危险，判定电动汽车当前处于泊车障碍状态。
[0094] 车速控制器用于根据运动车速和理想泊车车速调节电动汽车的电机扭矩的过程， 其具体为：
[0095] 结合下式，根据运动车速和理想泊车车速计算获得该时刻电动汽车对应的电机扭 矩后，相应调节输出的电机扭矩：
[0096] T 二 b(PR + 'FL + Fs:)'+ kfys'-V).
[0097] 上式中，b表示电动汽车运动模型系数，T表示电机扭矩，Fr表示滚动阻力，Fl表示风 阻，k表示车速控制器的增益，Vs表示理想泊车车速，巧、V依次表示采用状态观测器根据 运动车速估算获得的重力分量的估计值和车速估计值。电机系统接收车速控制器发出的扭 矩命令并执行。同时如果需要刹车，则控制系统发出制动压强命令，ESC系统接收并执行制 动压强命令。例如理想泊车车速为〇m/s时，输出的电机扭矩为ONm，ESC系统输出一定的制动 压强，若经过一段时间后，电动汽车的车速仍未减小至〇m/s，则增大制动压强辅助将电动汽 车的车速减小至〇m/s。
[0098]其中，旯和17是采用状态观测器根据下式计算获得的： \v=aT-h(ri/+Fl +/-；.)H-L,(v-r)
[0099] " I/?；. == L(v-v)
[0100] 上式中，a、b分别表示电动汽车运动模型系数且a、b为已知值，为状态观测器 的增益，v表示电动汽车的运动车速。
[0101] Fl和Fr分别通过下式计算获得的：
[0102] Fl = 0.5pACxv2；
[0104] 其中，Fz表示汽车重力，P表示空气密度，A表示迎风面积，Cx表示空气阻力系数，v表 示电动汽车的运动车速，fRQ表示滚动阻力〇阶系数，fRl表示滚动阻力1阶系数，fR2表示滚动 阻力4阶系数，P、A、Cx、fRQ、fRl和fR2均为已知参数。
[0105]本实施例的计算模型是通过以下方式获得的：
[0106] 首先，因为本发明的目的是使得泊车过程中电动汽车的车速维持在设定车速，而 泊车过程只考虑汽车的低速运动，因此，获得如下的简化的汽车运动模型：
[0107] v = aT-h{i-), + !) +i-\)
[0108] 上式中，v表示电动汽车的运动车速汴表示v的微分，T表示电机扭矩，a、b分别表示 电动汽车运动模型系数，a和b的值通过模型辨识技术获得，Fr表示滚动阻力，Fl表示风阻，Fs 表示重力沿路面坡度的分量。
[0109] Fr和Fl依次按照以下近似公式估算：
[0110] Fl = 0.5pACxv2；
[0112] 其中，Fz表示汽车重力，P表示空气密度，A表示迎风面积，Cx表示空气阻力系数，v表 示电动汽车的运动车速，fRQ表示滚动阻力〇阶系数，fRl表示滚动阻力1阶系数，fR2表示滚动 阻力4阶系数，P、A、C x、fRQ、fRl和fR2均为已知参数。
[0113] Fs可以通过坡度传感器(一般采用惯性加速度)获得，这里我们采用状态观测器的 方式来估计坡度的影响。电动汽车的运动车速的动态可以采用如下2阶系统表示：
[0114] \ . -
[0115] 其中，/V表示Fs的微分。
[0116] 状态观测器可采用Luenberger观测器或Kalman滤波器的设计方法设计，状态观测 器的动态如下式：
[0117] |"喝+々项+秘，
[i|. = Z,,(v-V)
[0118]其中，巧、F依次表示采用状态观测器根据运动车速估算获得的重力分量的估计 值和车速估计值，息、t依次表示巧、歹的微分，U、L2为状态观测器的增益，U、L2的选取 需保证状态观测器的收敛性。
[0119] 车速控制器的设计采用如下形式：
[0120] r = b(FR +Fl+Fs) + k(vs -v)
[0121]其中k为控制器的增益，k的选择需保证闭环系统的稳定性。上述的本车速控制系 统，状态观测器可以是车速控制器的一部分，也可以是单独的一个部件，则通过设定状态观 测器来辅助车速控制器来实现对电动汽车的控制，这种情况下车速控制系统的结构框图如 图3所示。
[0122] 本实施例通过以上公式计算车速控制器实时输出的电机扭矩后对电机进行控制， 从而可以简单、快速地控制泊车速度，而且跟随电动汽车的运动车速进行控制，可以使得泊 车速度稳定在设定的理想泊车速度附近，工作稳定性高。另外，在扭矩变化很快时，可能会 对电动汽车冲击过大，造成汽车零部件的损害，影响乘车体验，因此在扭矩控制过程中，可 以设定每一采样周期内扭矩变化的大小，从而平滑地改变扭矩输出，使得泊车过程更为平 稳安全。
[0123] 实施例二
[0124] 本实施例是基于实施例一的一种用于电动汽车自动泊车的车速控制方法，包括步 骤：
[0125] S1、采用车速传感器模块检测电动汽车的运动车速、采用超声波传感器采集电动 汽车周围的障碍物信息以及采用车辆定位模块采集获得电动汽车的当前位置信息；
[0126] S2、根据采集的障碍物信息、当前位置信息以及预设的泊车轨迹设定理想泊车车 速；
[0127] S3、根据运动车速和理想泊车车速调节电动汽车的电机扭矩；
[0128] S4、电机根据车速控制器输出的电机扭矩实时地调整电动汽车的车速。
[0129] 其中，步骤S2具体为：
[0130] 将当前位置信息与预设的泊车轨迹进行匹配，同时结合采集的障碍物信息判断电 动汽车当前处于泊车过程状态、泊车完毕状态或泊车障碍状态，进而设定对应的理想泊车 车速。
[0131] 步骤S3,其具体为：
[0132] 结合下式，根据运动车速和理想泊车车速计算获得该时刻电动汽车对应的电机扭 矩后，相应调节输出的电机扭矩：
[0133] T^b(FR+FL^Fs) + k(vs-v)
[0134] 上式中，b表示电动汽车运动模型系数，T表示电机扭矩，Fr表示滚动阻力，Fl表示风 阻，k表示车速控制器的增益，v s表示理想泊车车速，RW依次表示采用状态观测器根据 运动车速估算获得的重力分量的估计值和车速估计值。
[0135] 其中，丨和￥是采用状态观测器根据下式计算获得的： (F = aT-b{FR+ Fl +Fs) + L, (v - v)
[0136] {. ' Ir)
[0137] 上式中，a、b分别表示电动汽车运动模型系数且a、b为已知值，为状态观测器 的增益，v表示电动汽车的运动车速。
[0138] Fl是通过下式计算获得的：
[0139] Fl = 0.5pACxv2；
[0140] Fr是通过下式计算获得的：
[0142] 其中，Fz表示汽车重力，P表示空气密度，A表示迎风面积，Cx表示空气阻力系数，v表 示电动汽车的运动车速，fRQ表示滚动阻力〇阶系数，fRl表示滚动阻力1阶系数，fR2表示滚动 阻力4阶系数，P、A、C x、fRQ、fRl和fR2均为已知参数。
[0143] 实施例三
[0144] 本实施例应用实施例一的车速控制系统对某电动汽车进行不同工况下的泊车测 试。主要分了以下五种工况进行测试:工况一、沥青道路，无明显坡度;工况二、沙石道路，无 明显坡度;工况三、沥青道路，坡度约10度;工况四、水泥道路，无坡度，测试过程中人为不停 地调整方向盘转角进行干预测试;工况五、雨后在有积水且略有泥泞的道路。五种工况均在 不同的载人情况下（1~5人)进行测试后获得的平均的车速控制结果依次如图4、图5、图6、 图7和图8所示。图4、图5、图6、图7和图8中，测量车速指检测获得的电动汽车的运动车速，设 定速度指设定的理想泊车车速，综合结果显示，本发明所设计的速度控制系统在低速情况 下，可较好的实现速度控制功能，误差较小，响应较快且过程平稳，无冲击震荡等引起乘客 不适的感觉，可应用于自动泊车系统。
[0145] 以上是对本发明的较佳实施进行了具体说明，但本发明创造并不限于实施例，熟 悉本领域的技术人员在不违背本发明精神的前提下还可做出种种的等同变形或替换，这些 等同的变型或替换均包含在本申请权利要求所限定的范围内。
【主权项】
1. 用于电动汽车自动泊车的车速控制系统，其特征在于，包括车速传感器模块、超声波 传感器、车辆定位模块、泊车控制器和车速控制器，所述车速传感器模块用于检测电动汽车 的运动车速，所述超声波传感器用于采集电动汽车周围的障碍物信息，所述车辆定位模块 用于采集获得电动汽车的当前位置信息，所述泊车控制器用于根据采集的障碍物信息、当 前位置信息以及预设的泊车轨迹设定理想泊车车速，所述车速控制器用于根据运动车速和 理想泊车车速调节电动汽车的电机扭矩。2. 根据权利要求1所述的用于电动汽车自动泊车的车速控制系统，其特征在于，所述根 据采集的障碍物信息、当前位置信息以及预设的泊车轨迹设定理想泊车车速的过程，其具 体为： 将当前位置信息与预设的泊车轨迹进行匹配，同时结合采集的障碍物信息判断电动汽 车当前处于泊车过程状态、泊车完毕状态或泊车障碍状态，进而设定对应的理想泊车车速。3. 根据权利要求1所述的用于电动汽车自动泊车的车速控制系统，其特征在于，所述用 于根据运动车速和理想泊车车速调节电动汽车的电机扭矩的过程，其具体为： 结合下式，根据运动车速和理想泊车车速计算获得该时刻电动汽车对应的电机扭矩 后，相应调节输出的电机扭矩：上式中，b表示电动汽车运动模型系数，T表示电机扭矩，Fr表示滚动阻力，R表示风阻，k 表示车速控制器的增益，Vs表示理想泊车车速，g、V依次表示采用状态观测器根据运动 车速估算获得的重力分量的估计值和车速估计值。4. 根据权利要求3所述的用于电动汽车自动泊车的车速控制系统，其特征在于，巧和V 是采用状态观测器根据下式计算获得的：上式中，a、b分别表示电动汽车运动模型系数且a、b为已知值，L^L2为状态观测器的增 益，V表示电动汽车的运动车速。5. 根据权利要求3所述的用于电动汽车自动泊车的车速控制系统，其特征在于，R是通 过下式计算获得的： Fl = 0.5pACxV2； Fr是通过下式计算获得的：其中，Fz表示汽车重力，P表示空气密度，A表示迎风面积，Cx表示空气阻力系数，V表示电 动汽车的运动车速，fRO表示滚动阻力〇阶系数，fRl表示滚动阻力1阶系数，fR2表示滚动阻力4 阶系数，P、A、Cx、fRQ、fRl和fR2均为已知参数。6. 用于电动汽车自动泊车的车速控制方法，其特征在于，包括步骤： 51、 采用车速传感器模块检测电动汽车的运动车速、采用超声波传感器采集电动汽车 周围的障碍物信息以及采用车辆定位模块采集获得电动汽车的当前位置信息； 52、 根据采集的障碍物信息、当前位置信息以及预设的泊车轨迹设定理想泊车车速； 53、 根据运动车速和理想泊车车速调节电动汽车的电机扭矩； 54、 电机根据车速控制器输出的电机扭矩实时地调整电动汽车的车速。7. 根据权利要求6所述的用于电动汽车自动泊车的车速控制方法，其特征在于，所述步 骤S2,其具体为： 将当前位置信息与预设的泊车轨迹进行匹配，同时结合采集的障碍物信息判断电动汽 车当前处于泊车过程状态、泊车完毕状态或泊车障碍状态，进而设定对应的理想泊车车速。8. 根据权利要求6所述的用于电动汽车自动泊车的车速控制方法，其特征在于，所述步 骤S3,其具体为： 结合下式，根据运动车速和理想泊车车速计算获得该时刻电动汽车对应的电机扭矩 后，相应调节输出的电机扭矩：上式中，b表示电动汽车运动模型系数，T表示电机扭矩，Fr表示滚动阻力，R表示风阻，k 表示车速控制器的增益，Vs表示理想泊车车速，g、F依次表示采用状态观测器根据运动 车速估算获得的重力分量的估计值和车速估计值。9. 根据权利要求8所述的用于电动汽车自动泊车的车速控制方法，其特征在于，所述巧 和歹是采用状态观测器根据下式计算获得的：上式中，a、b分别表示电动汽车运动模型系数且a、b为已知值，L^L2为状态观测器的增 益，V表示电动汽车的运动车速。10. 根据权利要求8所述的用于电动汽车自动泊车的车速控制方法，其特征在于，所述R 是通过下式计算获得的： Fl = 0.5pACxV2； Fr是通过下式计算获得的：其中，Fz表示汽车重力，P表示空气密度，A表示迎风面积，Cx表示空气阻力系数，V表示电 动汽车的运动车速，表示滚动阻力〇阶系数，fRl表示滚动阻力1阶系数，fR2表示滚动阻力4 阶系数，P、A、Cx、fRQ、fRl和fR2均为已知参数。
【文档编号】B60L15/20GK106004515SQ201610318536
【公开日】2016年10月12日
【申请日】2016年5月12日
【发明人】苏阳, 张善乐, 陈盛军, 赖健明, 闫雪, 罗伟健, 何涛, 肖志光
【申请人】广州橙行智动汽车科技有限公司