滑动模式的行驶路径投票策略模块及驾驶控制系统与方法转让专利

申请号 : CN201310628704.9

文献号 : CN104670222B

文献日 :

基本信息:

PDF:

法律信息:

相似专利:

发明人 : 王通温徐伟峰曾柏凯

申请人 : 财团法人车辆研究测试中心

摘要 :

本发明提供一种滑动模式的行驶路径投票策略模块及驾驶控制系统与方法。滑动模式的行驶路径投票策略模块利用滑动模式控制理论将一反应时间及一煞车距离整合为一障碍物特征滑动平面,并结合模糊理论计算障碍物特征滑动平面及一道路曲率值,借此获得一安全路径方位角。

权利要求 :

1.一种滑动模式的行驶路径投票策略模块,其特征在于,包含:

一模糊化界面,输入一道路曲率信息及一行经道路风险评估信息并根据多个预设归属函数进行模糊化分析;

一模糊化推论界面,依据一滑动模式控制理论整合该道路曲率信息及该行经道路风险评估信息,并针对该道路曲率信息及该行经道路风险评估信息进行模拟运算,以获得一路径投票结果;以及一解模糊化界面,根据一模糊逻辑规则表解模糊化路径投票结果,以获得一安全路径方位角;

其中该滑动模式控制理论是整合该道路曲率信息及该行经道路风险评估信息中的一反应时间及一相对距离为一障碍物特征滑动平面,该障碍物特征滑动平面为Si=sign(Yi)(τi+λdi),其中τ为该反应时间,λ为一障碍物特征常数,d为车辆与一目标障碍物的相对距离,Y为该目标障碍物的横座标位置,下标i为该目标障碍物;该模糊化推论界面是以一道路曲率值及该障碍物特征滑动平面为一模糊化规则前件部,并以该安全路径方位角为一模糊化规则后件部,而该道路曲率值为K=1/r,其中r为一道路曲率半径。

2.根据权利要求1的滑动模式的行驶路径投票策略模块,其特征在于,该道路曲率信息为目标车辆的一横向动态及一纵向动态,该行经道路风险评估信息为一障碍物特性、一道路特性及一人车互动特性。

3.根据权利要求1的滑动模式的行驶路径投票策略模块,其特征在于,所述预设归属函数是采用三角形函数方程。

4.一种滑动模式的驾驶控制系统,其特征在于,包含:

一环境数值信息传感融合单元,获取一目标车辆的若干外部环境数值及若干内部数值;

一驾驶行为侦测单元,获取一目标车辆驾驶行为干扰数据;

一道路曲率产生单元,接收所述外部环境数值及所述内部数值后产生一道路曲率信息;

一行经道路风险评估单元,接收该目标车辆驾驶行为干扰数据、所述外部环境数值及所述内部数值后取得一行经道路风险评估信息;

一行驶路径投票策略单元,以该行经道路风险评估信息及该道路曲率信息进行判断分析,并依据一道路曲率值及一障碍物特征滑动平面计算获得一安全路径方位角;

一驾驶行为命令产生单元,运用该安全路径方位角输出一驾驶行为命令;以及一车载单元,依据该驾驶行为命令自动控制操作该目标车辆;

其中该障碍物特征滑动平面为Si=sign(Yi)(τi+λdi),其中τ为一反应时间,λ为一障碍物特征常数,d为该目标车辆与一目标障碍物的相对距离,Y为该目标障碍物的横座标位置,下标i为该目标障碍物;该行驶路径投票策略单元采一模糊运算分析方式,且该行驶路径投票策略单元以一道路曲率及该障碍物特征滑动平面为一模糊化规则前件部,并以该安全路径方位角为一模糊化规则后件部,而该道路曲率值为K=1/r,其中r为一道路曲率半径。

5.根据权利要求4的滑动模式的驾驶控制系统,其特征在于,该道路曲率信息为该目标车辆的一横向动态及一纵向动态,该行经道路风险评估信息为一障碍物特性、一地图道路特性、一人车互动特性及一行车规定特性。

6.一种滑动模式的驾驶控制方法,其特征在于,包含以下步骤:

取得若干外部环境数值、若干内部数值及一目标车辆驾驶行为干扰数据;

参考所述外部环境数值及所述内部数值产生一道路曲率信息;

利用该目标车辆驾驶行为干扰数据、所述外部环境数值及所述内部数值取得一行经道路风险评估信息;

以一行驶路径投票策略单元进行该行经道路风险评估信息及该道路曲率信息的判断分析,并依据一道路曲率值及一障碍物特征滑动平面获得一安全路径方位角;以及运用该安全路径方位角输出一驾驶行为命令,且依据该驾驶行为命令操作该目标车辆;

其中该障碍物特征滑动平面是以一滑动模式控制理论整合一反应时间及一相对距离而成,该障碍物特征滑动平面为Si=sign(Yi)(τi+λdi),其中τ为该反应时间,λ为一障碍物特征常数,d为车辆与一目标障碍物的相对距离,Y为该目标障碍物的横座标位置,下标i为该目标障碍物;该行驶路径投票策略单元采一模糊运算分析方式,且该行驶路径投票策略单元以一道路曲率值及该障碍物特征滑动平面为一模糊化规则前件部,并以该安全路径方位角为一模糊化规则后件部,而该道路曲率值为K=1/r,其中r为一道路曲率半径。

7.根据权利要求6的滑动模式的驾驶控制方法,其特征在于,该道路曲率信息为该目标车辆的一横向动态及一纵向动态,该行经道路风险评估信息为一障碍物特性、一地图道路特性、一人车互动特性及一行车规定特性。

8.根据权利要求7的滑动模式的驾驶控制方法,其特征在于,其步骤还包含即时储存所述外部环境数值、所述内部数值、该目标车辆驾驶行为干扰数据、该道路曲率信息及该行经道路风险评估信息。

说明书 :

滑动模式的行驶路径投票策略模块及驾驶控制系统与方法

技术领域

[0001] 本发明是有关于一种驾驶控制系统,且特别是有关于一种滑动模式的行驶路径投票策略模块及其驾驶控制系统与方法。

背景技术

[0002] 随着车辆相关技术发展,车辆行驶的安全问题层出不穷,而人们对于行车安全更加重视。因此,随着法规的严格规定及相关报导的呼吁,车辆安全科技为目前研发车辆相关技术首重的课题。
[0003] 车辆安全科技发展之初,一般以被动辅助装置的保护或加固的方式来减轻事故发生后的伤亡,例如安全气囊、安全带、特殊颈椎保护座椅及防撞杆等。然而,事故发生前的主动辅助装置显然更为重要,例如防锁死煞车系统(AnRClock Brake System,ABS)、电子稳定系统(Electronic Stability Program System,ESPS)及牵引控制系统(TracRCon Control System,TCS)等,其能于车子发生撞击前或失速时作动,借此即时控制车子。
[0004] 目前则以整合信息电子及感测技术为主,其不仅可对环境路况进行即时感测,并进一步透过分析及判断来协助驾驶。此外,更可结合自动控制技术微控车子,未来甚至进行摇控驾驶及全自动驾驶。

发明内容

[0005] 因此,本发明的目的是在提供一种滑动模式的行驶路径投票策略模块及其驾驶控制系统、方法,借此完成高安全性的智能驾驶控制系统。
[0006] 依据本发明一实施方式是在提供一种滑动模式的行驶路径投票策略模块,其包含一模糊化界面、一模糊化推论界面以及一解模糊化界面。模糊化界面输入一道路曲率信息及一行经道路风险评估信息并根据多个预设归属函数进行模糊化分析。模糊化推论界面依据一滑动模式控制理论整合道路曲率信息及行经道路风险评估信息,并针对道路曲率信息及行经道路风险评估信息进行模拟运算,用以获得一路径投票结果。解模糊化界面根据一模糊逻辑规则表解模糊化路径投票结果,用以获得一安全路径方位角。
[0007] 依据前述的滑动模式的行驶路径投票策略模块,其中滑动模式控制理论是整合道路曲率信息及行经道路风险评估信息中的一反应时间及一相对距离为一障碍物特征滑动平面,且障碍物特征滑动平面为Si=sign(Yi)(τi+λdi),其中τ为反应时间,λ为一障碍物特征常数,d为相对距离,Y为一目标障碍物的横座标位置,下标i为目标障碍物。反应时间可为驾驶规避一障碍物所花费的时间及目标车辆回应路径投票结果所花费的时间。模糊化推论界面是以一道路曲率值及障碍物特征滑动平面为一模糊化规则前件部,并以安全路径方位角为一模糊化规则后件部,而道路曲率值为K=1/r,其中r为一道路曲率半径。道路曲率信息可为目标车辆的一横向动态及一纵向动态,行经道路风险评估信息可为一障碍物特性、一道路特性及一人车互动特性。预设归属函数可采用三角形函数方程进行分类。
[0008] 依据本发明另一实施方式是在提供一种滑动模式的驾驶控制系统,其包含一环境数值信息传感融合单元、一驾驶行为侦测单元、一行经道路风险评估单元、一行驶路径投票策略单元、一驾驶行为命令产生单元以及一车载单元。环境数值信息传感融合单元获取一目标车辆的若干外部环境数值及若干内部数值。驾驶行为侦测单元获取一车辆驾驶行为干扰数据。道路曲率产生单元接收外部环境数值及内部数值后产生一道路曲率信息。行经道路风险评估单元接收车辆驾驶行为干扰数据、外部环境数值及内部数值后取得一行经道路风险评估信息。行驶路径投票策略单元以行经道路风险评估信息及道路曲率信息进行判断分析,并依据一道路曲率值及一障碍物特征滑动平面计算获得一安全路径方位角。驾驶行为命令产生单元运用安全路径方位角输出一驾驶行为命令。车载单元依据驾驶行为命令自动控制目标车辆。
[0009] 依据前述的滑动模式的驾驶控制系统,其中障碍物特征滑动平面是以一滑动模式控制理论整合一反应时间及一相对距离而成,而障碍物特征滑动平面为Si=sign(Yi)(τi+λdi),其中τ为反应时间,λ为一障碍物特征常数,d为相对距离,Y为目标障碍物的横座标位置,下标i为目标障碍物。反应时间是包含驾驶规避一障碍物所花费的时间或目标车辆回应驾驶行为命令所花费的时间。行驶路径投票策略单元采一模糊运算分析方式,且行驶路径投票策略单元以一道路曲率值及障碍物特征滑动平面为一模糊化规则前件部,并以安全路径方位角为一模糊化规则后件部,而道路曲率值为K=1/r,其中r为一道路曲率半径。道路曲率信息可为目标车辆的一横向动态及一纵向动态,行经道路风险评估信息可为一障碍物特性、一地图道路特性、一人车互动特性及一行车规定特性。滑动模式的驾驶控制系统更可储存外部环境数值、内部数值、车辆驾驶行为干扰数据、道路曲率信息及行经道路风险评估信息。
[0010] 依据本发明再一实施方式是在提供一种滑动模式的驾驶控制方法,其包含以下步骤:取得若干外部环境数值、若干内部数值及一车辆驾驶行为干扰数据。利用上述外部环境数值及内部数值产生一道路曲率信息。利用车辆驾驶行为干扰数据、外部环境数值及内部数值取得一行经道路风险评估信息。以一行驶路径投票策略单元进行行经道路风险评估信息及道路曲率信息的判断分析,并依据一道路曲率值及一障碍物特征滑动平面获得一安全路径方位角。运用安全路径方位角输出一驾驶行为命令,且依据驾驶行为命令操作目标车辆。
[0011] 依据前述的滑动模式的驾驶控制方法,其中障碍物特征滑动平面是以一滑动模式控制理论整合一反应时间及一相对距离而成,而障碍物特征滑动平面为Si=sign(Yi)(τi+λdi),其中τ为反应时间,λ为一障碍物特征常数,d为相对距离,Y为一目标障碍物的横座标位置,下标i为目标障碍物。反应时间可为驾驶规避一障碍物所花费的时间或目标车辆回应驾驶行为命令所花费的时间。行驶路径投票策略单元采一模糊运算分析方式,且行驶路径投票策略单元以一道路曲率值及障碍物特征滑动平面为一模糊化规则前件部,并以安全路径方位角为一模糊化规则后件部,而道路曲率值为K=1/r,其中r为一道路曲率半径。道路曲率信息为目标车辆的一横向动态及一纵向动态,行经道路风险评估信息为一障碍物特性、一地图道路特性、一人车互动特性及一行车规定特性。滑动模式的驾驶控制方法其步骤还包含即时储存外部环境数值、内部数值、车辆驾驶行为干扰数据、道路曲率信息及行经道路风险评估信息。
[0012] 本发明的滑动模式的行驶路径投票策略模块及其驾驶控制系统、方法,其是透过环境数值信息传感融合单元监测车身信号、路面状况、障碍物信息及驾驶状态等监控状态以进行数据搜集,利用行驶路径投票策略单元进一步分析与计算后提供安全路径方位角,将车辆直线或转弯移动状态透过滑动模式控制理论进行处理,获得最佳行驶路径选择后以进行车载单元的驾驶行为命令控制。

附图说明

[0013] 为让本发明的上述和其他目的、特征、优点与实施例能更明显易懂,所附附图的说明如下:
[0014] 图1是是绘示依照本发明一实施方式的一种滑动模式的驾驶控制系统的方块图;
[0015] 图2是绘示依照本发明一实施方式的一种滑动模式的行驶路径票策略单元的示意图;
[0016] 图3是绘示依照应用图1的滑动模式的驾驶控制系统的判断示意图;
[0017] 图4A是绘示依照图2的滑动模式的行驶路径票策略单元的滑动条件示意图;
[0018] 图4B是绘示依照图2的滑动模式的行驶路径票策略单元的道路曲率的归属函数图;
[0019] 图4C是绘示依照图2的滑动模式的行驶路径票策略单元的障碍物特征滑动平面的归属函数图;
[0020] 图4D是绘示依照图2的滑动模式的行驶路径票策略单元的安全路径方位角的示意图。

具体实施方式

[0021] 请参照图1及图2,图1是绘示依照本发明一实施方式的一种滑动模式的驾驶控制系统的方块图,图2是绘示依照本发明一实施方式的一种滑动模式的行驶路径票策略单元的示意图。滑动模式的驾驶控制系统100包含一环境数值信息传感融合单元110、一驾驶行为侦测单元120、一道路曲率产生单元130、一行经道路风险评估单元140、一行驶路径投票策略单元150、一驾驶行为命令产生单元160及一车载单元170。
[0022] 环境数值信息传感融合单元110获取一目标车辆的若干外部环境数值EV及若干内部数值IV,例如以无线雷达(Ladar)、光学雷达(Lidar)及摄影机侦测的周遭环境及障碍物辨识信息、GPS卫星定位侦测的定位信息及惯性感测器感应的目标车辆动态信息等,惯性感测单元意指三轴加速度计、陀螺仪及电子罗盘等。环境数值信息传感融合单元110可将上述数种感应单元或侦测单元的数据融合(fusion),用以作为后续分析判断使用。
[0023] 驾驶行为侦测单元120不仅接收环境数值信息传感融合单元110所侦测的数值,也获取目前一操控目标车辆行为数值DB,将其整合为一车辆驾驶行为干扰数据DD。上述驾驶行为侦测单元120所获取的数值皆为影响后续车辆驾驶行为的数值,例如车辆与障碍物的距离、车道的辨识、车道与车头行径方向夹角、车辆与路面的摩擦阻尼、车辆惯性、车辆重心以及目标车辆目前的油门力道、方向盘角度、煞车力道、轮胎模型等。
[0024] 道路曲率产生单元130接收环境数值信息传感融合单元110的外部环境数值EV后计算产生一道路曲率信息RC,而道路曲率信息RC为目标车辆的行经道路的曲率大小。要强调的是,道路曲率信息RC是以环境数值信息传感融合单元110所感测的数值结合地图信息来加以计算。
[0025] 行经道路风险评估单元140接收驾驶行为侦测单元120的车辆驾驶行为干扰数据DD、环境数值信息传感融合单元110的外部环境数值EV及内部数值IV后取得一行经道路风险评估信息RI。行经道路风险评估信息RI的计算包含一障碍物特性、一道路特性及一人车互动特性。行经道路风险评估信息RI是根据路上的行人、动物、积水、路面特性或其余障碍物的特性,推算闪避障碍物或行经障碍地面可能产生的风险。
[0026] 行驶路径投票策略单元150以行经道路风险评估单元140的行经道路风险评估信息RI及道路曲率产生单元130的道路曲率信息RC进行判断分析,并结合目标车辆的横向动态是以克罗梭曲线法计算可行路线曲率,以及目标车辆的纵向动态,其是以目辆车辆的动态模型、轮胎模型及路面的摩擦系数等,做为和缓转向的物理限制,用以产生最佳化目标车辆可行驶的一安全路径方位角OA。
[0027] 驾驶行为命令产生单元160接收行驶路径投票策略单元150的目标车辆可行驶的一安全路径方位角OA,并借此输出一驾驶行为命令DC。
[0028] 车载单元170依据驾驶行为命令产生单元160的驾驶行为命令DC自动控制目标车辆。车载单元170是用以控制目标车辆的行驶行为,例如油门、剎车及电动转向系统(Energy Power Steering,EPS)等。
[0029] 本实施方式中是以模糊控制理论建构行驶路径投票策略单元150的判断分析工具。行驶路径投票策略单元150包含一模糊化界面151、一模糊化推论界面152、一解模糊化界面153以及一模糊逻辑规则数据库154。模糊化界面151输入道路曲率信息RC及行经道路风险评估信息RI并根据多个预先设定的归属函数进行模糊化的分析归类。模糊化推论界面152则依据滑动模式控制理论整合道路曲率信息RC及行经道路风险评估信息RI,并针对道路曲率信息RC及行经道路风险评估信息RI进行模拟运算,用以获得一路径投票结果PA。解模糊化界面153根据模糊逻辑规则数据库154中的模糊逻辑规则表解模糊化路径投票结果PA,用以获得目标车辆可行驶的一安全路径方位角OA。
[0030] 上述模糊化演算的原理已为已知的技术,各于此不再赘述,本实施方式仅针对模糊化的演算过程及各参数进行举例说明。因此,请再同时参照图3、图4A、图4B、图4C及图4D,图3是绘示依照应用图1的滑动模式的驾驶控制系统的判断示意图,图4A是绘示依照图2的滑动模式的行驶路径投票策略单元的滑动条件示意图,图4B是绘示图2的滑动模式的行驶路径投票策略单元的道路曲率的归属函数图,图4C是绘示依照图2的滑动模式的行驶路径投票策略单元的障碍物特征滑动平面的归属函数图,图4D是绘示依照图2的滑动模式的行驶路径投票策略单元的安全路径方位角的示意图。
[0031] 如图3所绘示,其举例说明目标车辆行驶于一道路上,目标车辆前方具有障碍物,而目标车辆左后方具有另一车辆的情况。通过上述的环境数值信息传感融合单元110所侦测的外部环境数值EV将目标车辆所处周围区域划分,并分别标示为LB、L、LF、F、B、RB、R及RF。首先由滑动模式的驾驶控制系统100的环境数值信息传感融合单元110、驾驶行为侦测单元120接收目标车辆的外部环境数值EV、内部数值IV及操控目标车辆行为数值DB,并输出至道路曲率产生单元130及行经道路风险评估单元140,使其分别产生道路曲率信息RC及行经道路风险评估信息RI。行驶路径投票策略单元150则同时接收道路曲率信息RC及行经道路风险评估信息RI,通过模糊化分析推算出目标车辆可行驶的最佳化的安全路径方位角OA。通过驾驶行为命令产生单元160控制车载单元170的作动,使目标车辆符合安全路径方位角OA。
[0032] 本实施方式的滑动模式的驾驶控制系统100更可将环境数值信息传感融合单元110、驾驶行为侦测单元120、道路曲率产生单元130、行经道路风险评估单元140、行驶路径投票策略单元150及驾驶行为命令产生单元160所传输的信息或数值进行备份,并可配合地图路线进行回忆动作。
[0033] 其中行驶路径投票策略单元150是以一道路曲率值K、一反应时间τ及一相对距离d作为计算出目标车辆可行驶的最佳化的安全路径方位角OA的参数。然而考虑三个输入参数及一个输出参数,则模糊化推论界面152须设定为三个前件部(Antecedent)及一个后件部(Consequent),在此情况下行驶路径投票策略单元150须架设数量庞大的规则数据来进行计算。因此,以滑动模式控制理论来缩减整体架构,其是将滑动模式的驾驶控制系统100的系统状态相关于反应时间τ及相对距离d的滑动平面,故将反应时间τ及相对距离d整合成一障碍物特征滑动平面Si(请参照图4A),则Si=sign(Yi)(τi+λdi),其中Yi表示为一目标障碍物的横座标位置,下标i表示为目标障碍物,λ为一障碍物特征常数。如此一来,行驶路径投票策略单元150缩减为使用两个前件部即可进行计算,即道路曲率值K及障碍物特征滑动平面Si,而道路曲率值K为1/r,其中r为一道路曲率半径,其是根据平面曲线的曲率计算方法推算,在道路上一点P的曲率大小等于一密切圆半径的倒数,而密切圆的半径即为道路曲率半径r,其中C为密切圆圆心(如图3所示)。道路曲率值K的值越小表示路径越直,障碍物特征滑动平面Si的值越小表示行驶越危险。
[0034] 以三角函数方程作为道路曲率值K及障碍物特征滑动平面Si的归属函数(如图4B及图4C),其中道路曲率值K以LL、LM、LS、S、RS、RM及RL表示为模糊变数,障碍物特征滑动平面Si以LD0、LD1、LD2、D3、RD2、RD1及RD0表示为模糊变数(如图4C)。最后以道路曲率值K及障碍物特征滑动平面Si制作模糊逻辑规则表,并找出对应的路径投票结果PA,借此推算出安全路径方位角OA(如图4D)。模糊逻辑规则表表列如下:
[0035]
[0036]
[0037] 对应参照图3所绘示,行驶路径投票策略单元150的计算须同时依据障碍物的信息、道路特性、驾驶行为以及目标车辆的动态信息。举例来说,当障碍物特征滑动平面Si对应模糊变数D3时(危险系数最大时),其比对任何模糊变数的道路曲率值K,其路径投票结果PA皆显示为B,表示执行减速动作。而当道路曲率值K对应模糊变数LL时(曲率最大),其比对障碍物特征滑动平面Si中较高危险系数的模糊变数LD2、D3及RD2时,其路径投票结果PA显示为RB、B及LB,表示进入曲率越大的弯道时,过弯将同时减速。
[0038] 因此,由上述实施方式可知本发明的滑动模式的行驶路径投票策略模块及其驾驶控制系统、方法,其具有以下优点:
[0039] 1.利用滑动模式控制理论缩减行驶路径投票策略单元的计算参数,可大幅减少模糊运算的规则,借此缩短整体系统的运算时间,使整体系统反应更加迅速。
[0040] 2.行驶路径投票策略单元所用以计算的数值不仅包含路面、障碍物、天气及车辆动态的信息等,驾驶的操作信息也将会纳入计算的内容当中,借此提供半/全自动的智能驾驶系统。
[0041] 3.此外,无论环境数值信息传感融合单元、驾驶行为侦测单元、道路曲率产生单元、行经道路风险评估单元、行驶路径投票策略单元及驾驶行为命令产生单元所传输的信息或数值都可额外进行备份,并可配合地图路线进行回忆动作。当目标车辆再次行经同样路线时,滑动模式的驾驶控制系统可应用即时储存单元已储存的数据,而不须花费再次运算的时间。
[0042] 虽然本发明已以实施方式揭露如上,然其并非用以限定本发明,任何熟悉此技艺者,在不脱离本发明的精神和范围内,当可作各种的更动与润饰,因此本发明的保护范围当视所附的权利要求书所界定的范围为准。