一种自动驾驶方法及系统与流程

文档序号:13344784阅读:179来源:国知局
一种自动驾驶方法及系统与流程
本发明涉及一种自动驾驶方法及系统。具体地说是一种应用于机动车自动驾驶领域的自动驾驶方法及系统。

背景技术:
随着机动车数量的快速增长,城市面临的交通压力也越来越大。但是道路的拓宽受到城市规划和建筑环境的限制,难以跟随机动车增长速度实现线性增长,使得交通拥挤已成为大中城市必然要面对的难题。因此如何在当前道路情况下,提高道路行车容量已成为当前机动车技术和交通发展的重点研究方向。以自动驾驶和智能辅助驾驶技术为基础的机动车列车技术能够有效提高道路机动车容量和流量,进而保障道路的通畅。并且机动车自动驾驶技术对于帮助驾驶员减轻疲劳,提高安全性能也具有明显的实用价值。现有的机动车自动驾驶技术,借助雷达系统、超声波系统和/或摄像头系统来检测机动车前方、后方和两侧的行车环境并计算出车道、道路类型和/或机动车、行人和/或障碍物等信息以及其它与驾驶相关的数据,例如机动车的车道和转向等数据,并将获取的所述与驾驶相关的数据作为机动车自动驾驶过程中的参考数据。但机动车的自动驾驶在直线路径中的实现比较简单,而在复杂路况和道路较拥挤的情况时,机动车经常无法一直保持直线的行驶机动,因此,机动车需要具备自动道路切换、自动超车和自动转向等机动操作功能才能实现机动车在复杂路况下的自动驾驶。公告号为CN103171439A,发明名称为“自动驾驶系统的行为预测”的发明专利申请,公布了一种机动车驾驶员辅助系统,该机动车驾驶员辅助系统借助检测装置来检测机动车周围环境对应的当前环境数据,之后基于当前环境数据规划并执行行驶机动,并将当前所执行的行驶机动通过显示器显示,供机动车驾驶员参考是否可自动由驾驶员辅助系统执行所规划的行驶机动。但该专利申请只是提供了一种机动车自动驾驶中规划出最优机动策略的方法,但如何根据所述最优机动策略来准确规划出机动车行驶的路径轨迹在该专利申请中并未提及。在机动车自动驾驶领域,规划出最优机动策略固然重要,但只有根据最优机动策略准确规划出机动车行驶的路径轨迹,才能实现在复杂路况和道路较拥挤的情况下的真正意义上的自动驾驶。

技术实现要素:
为此,本发明所要解决的技术问题在于在机动车自动驾驶领域,无法根据最优机动策略准确规划出机动车行驶的路径轨迹,从而提供一种能够根据最优机动策略准确规划出机动车行驶的路径轨迹的自动驾驶方法及系统。为解决上述技术问题,本发明的技术方案如下:本发明提供了一种自动驾驶方法,包括如下步骤:获取机动车车体参数、机动车车速与机动车最佳转向角间的对应关系并存储所述对应关系;判断最优机动策略是否为车道切换、超车和转向行驶机动操作,若是,则调整机动车行驶状态至理想状态;获取机动车车速和机动车前后轮轴距;将机动车车速与所述对应关系进行比对,获取机动车最佳转向角;根据机动车最佳转向角和机动车前后轮轴距,获取机动车转弯半径;根据机动车最佳转向角和机动车转弯半径规划出车道切换路径轨迹。本发明所述的自动驾驶方法,所述调整机动车行驶状态至理想状态的步骤包括如下步骤:获取标准车道宽度;根据标准车道宽度将机动车调整至车道中间位置,并保持机动车匀速状态下行驶。本发明所述的自动驾驶方法,还包括如下步骤:生成机动操作命令,控制机动车按照所述车道切换路径轨迹进行车道切换、超车和转向行驶机动操作。本发明所述的自动驾驶方法,还包括如下步骤:检测机动车行车环境并生成相应的环境参数;根据所述环境参数规划出所述最优机动策略。本发明所述的自动驾驶方法,所述检测机动车行车环境并生成相应的环境参数的步骤包括如下步骤:检测道路车道行车边界、机动车行驶方向、车道前后左右的障碍物、机动车和行人的距离和位置、道路类型、交通标志以及交通标志清晰度和气候情况;根据检测结果生成相应的环境参数并输出;所述根据所述环境参数规划出所述最优机动策略的步骤中,当所述环境参数显示适宜进行车道切换、超车和转向行驶机动操作时,所述最优机动策略即为车道切换、超车和转向行驶机动操作;当所述环境参数显示不适宜进行车道切换、超车和转向行驶机动操作时,所述最优机动策略即为直线行驶。本发明所述的自动驾驶方法,还包括如下步骤:当机动车行驶至切换车道的行车边界时,将记录的机动车车体偏移角度与所述最佳转向角进行比对,将机动车进行车道切换、超车和转向行驶机动操作时的行驶路程与所述车道切换路径轨迹进行比对,若所述车体偏移角度大于所述最佳转向角,且所述行驶路程与所述车道切换路径轨迹有偏差时,进行报警提示。本发明所述的自动驾驶方法,还包括如下步骤:当检测的所述环境参数为不可信或不可执行的环境参数时,进行报警提示机动车驾驶员干预行驶机动;当检测到机动车驾驶员疲劳驾驶时,进行报警提示切换到自动驾驶模式。本发明还提供了一种自动驾驶系统,包括:对应关系存储模块,用于获取并存储机动车车体参数、机动车车速与机动车最佳转向角间的对应关系;行驶机动控制模块,用于调整机动车行驶状态,并在最优机动策略为车道切换、超车和转向行驶机动操作时,调整机动车行驶状态至理想状态;车体信息采集模块,用于采集机动车运行状态信息,所述机动车运行状态信息包括机动车车速信息和机动车前后轮轴距;中央处理控制模块,其包括路径轨迹生成单元;所述路径轨迹生成单元,在机动车行驶状态调整至理想状态后,从所述车体信息采集模块获取机动车车速和机动车前后轮轴距;从所述对应关系存储模块获取所述对应关系;所述路径轨迹生成单元将机动车车速与所述对应关系进行比对,获取机动车最佳转向角,根据机动车最佳转向角和机动车前后轮轴距,获取机动车转弯半径,根据机动车最佳转向角和机动车转弯半径规划出车道切换路径轨迹。本发明所述的自动驾驶系统,所述行驶机动控制模块包括信息获取模块和机动控制模块;所述信息获取模块用于获取最优机动策略;所述机动控制模块,从所述信息获取模块获取所述最优机动策略,并在最优机动策略为车道切换、超车和转向行驶机动操作时,获取标准车道宽度,并根据标准车道宽度将机动车调整至车道中间位置,并保持机动车匀速状态下行驶。本发明所述的自动驾驶系统,所述中央处理控制模块还包括命令生成单元,用于根据从所述路径轨迹生成单元获取的所述车道切换路径轨迹,生成相应的机动操作命令;所述信息获取模块还用于从所述命令生成单元获取所述机动操作命令;所述机动控制模块,还用于根据从所述信息获取模块获取的所述机动操作命令控制机动车按照所述车道切换路径轨迹进行车道切换、超车和转向行驶操作。本发明所述的自动驾驶系统,还包括:环境数据检测模块,用于检测机动车行驶环境并根据检测到的机动车行驶环境生成相应的环境参数;所述中央处理控制模块还包括策略生成单元,根据从所述环境数据检测模块获取的所述环境参数以及从所述车体信息采集模块获取的所述机动车运行状态信息规划出最优行驶机动策略。本发明所述的自动驾驶系统,所述环境数据检测模块包括图像获取单元、超声波探测单元以及雷达探测单元;所述图像获取单元,接收安装于机动车的正前方、正后方和左右两侧的多个数字摄像头检测的图像信息,从所述图像信息中提取包括道路车道行车边界、机动车行驶方向、车道前后左右的障碍物、机动车和行人的距离和位置、道路类型、交通标志以及交通标志清晰度和气候情况的信息;所述超声波探测单元接收安装于机动车的正前方、正后方和左右两侧的多个超声波探头探测的信息;所述雷达探测单元接收安装于机动车的正前方、正后方和左右两侧的多个雷达探测的信息;所述超声波探测单元和所述雷达探测单元共同作用,在所述图像获取单元无法检测的区域和无法检测时,对机动车的行驶环境进行检测;所述策略生成单元,当所述环境参数显示适宜进行车道切换、超车和转向行驶机动操作时,生成的所述最优机动策略即为车道切换、超车和转向行驶机动操作;当所述环境参数显示不适宜进行车道切换、超车和转向行驶机动操作时,生成的所述最优机动策略即为直线行驶;所述路径轨迹生成单元,从所述策略生成单元获取所述最优机动策略并将所述最优机动策略传输给所述信息获取模块;并当所述最优机动策略为车道切换、超车和转向行驶机动操作时规划出车道切换路径轨迹,当所述最优机动策略为直线行驶时规划出直线路径轨迹;所述命令生成单元,还用于根据从所述路径轨迹生成单元获取的所述直线路径轨迹,生成相应的直线机动操作命令;所述信息获取模块还用于从所述命令生成单元获取所述直线机动操作命令;所述机动控制模块,还用于根据从所述信息获取模块获取的所述直线机动操作命令控制机动车按照所述直线路径轨迹进行直线行驶。本发明所述的自动驾驶系统,还包括:行驶机动监控模块,其包括车体偏移角度获取单元、路程记录单元和转向报警单元;所述车体偏移角度获取单元,用于获取安装于机动车上的陀螺仪记录的机动车进行车道切换、超车和转向行驶机动操作时的机动车车体偏移角度;所述路程记录单元,用于记录机动车进行车道切换、超车和转向行驶机动操作时的行驶路程;所述转向报警单元,从所述环境数据检测模块获取车道行车边界信息,当机动车行驶至切换车道的行车边界时,将从所述车体偏移角度获取单元获取的所述机动车车体偏移角度和从所述路径轨迹生成单元获取的所述最佳转向角进行比对,将从所述路程记录单元获取的所述行驶路程与所述车道切换路径轨迹进行比对,若所述车体偏移角度大于所述最佳转向角,且所述行驶路程与所述车道切换路径轨迹有偏差时,控制设置于机动车上的第一报警装置进行报警提示。本发明所述的自动驾驶系统,还包括:驾驶员状态检测模块,用于对驾驶员状态进行检测并生成相应的驾驶员状态信息;所述中央处理控制模块还包括第一判断模块和第二判断模块;所述第一判断模块从所述环境数据检测模块获取所述环境参数,并判断所述环境参数是否为不可信或不可执行的环境参数,并将所述环境参数判断结果传输至行车环境报警模块;所述行车环境报警模块,接收所述第一判断模块的所述判断结果,当所述环境参数为不可信或不可执行的环境参数时,控制设置于机动车上的第二报警装置报警提示机动车驾驶员干预行驶机动;所述第二判断模块从所述驾驶员状态检测模块获取所述驾驶员状态信息,并据此判断机动车驾驶员是否为疲劳驾驶,并将所述驾驶员状态信息判断结果传输至驾驶员状态报警模块;所述驾驶员状态报警模块,接收所述第二判断模块的所述判断结果,当机动车驾驶员疲劳驾驶时,控制设置于机动车上的第三报警装置报警,提示切换到自动驾驶模式。本发明的上述技术方案相比现有技术具有以下优点:(1)本发明所述自动驾驶方法及系统,会事先通过实验获取机动车车体参数、机动车车速与机动车最佳转向角间的对应关系并存储所述对应关系,当最优机动策略为车道切换、超车和转向行驶机动操作时,调整机动车行驶状态至理想状态,作为一种可选的实施方式,所述理想状态为机动车匀速在车道中间位置行驶。此时,获取机动车车速和机动车前后轮轴距,将机动车车速与所述事先存储的对应关系进行比对,即可获取机动车最佳转向角,之后根据机动车最佳转向角和机动车前后轮轴距,再结合机动车理想状态下车道切换、超车和转向行驶机动操作时的运动曲线、以及切线的定义、性质定理即可获取机动车转弯半径,根据机动车最佳转向角和机动车转弯半径自然可以规划出车道切换路径轨迹。因此,本发明提供了一种能够根据最优机动策略准确规划出机动车在自动驾驶状态下的车道切换路径轨迹的自动驾驶方法及系统。只有准确规划出机动车的车道切换路径轨迹,才能为机动车在自动驾驶状态下的车道切换、超车和转向行驶机动操作提供最为准确的参考依据。(2)本发明所述自动驾驶方法及系统,通过机动操作命令,控制机动车按照所述车道切换路径轨迹进行车道切换、超车和转向行驶机动操作。因此,本发明提供了一种机动车能够执行的机动操作命令,进而控制机动车能够严格按照规划出的所述车道切换路径轨迹行驶来完成车道切换、超车和转向机动操作,能够最大限度的保证自动驾驶状态下的行车安全。(3)本发明所述自动驾驶方法及系统,通过检测机动车行车环境来获取环境参数,并根据所述环境参数规划出所述最优机动策略,比如当检测机动车行车环境很好,机动车转向安全距离内没有机动车、行人和障碍物,并且后面的机动车也没有开转向灯,即所述环境参数显示适宜进行车道切换、超车和转向行驶机动操作时,所述最优机动策略即为车道切换、超车和转向行驶机动操作;当道路异常拥挤,前后车距很近,转向安全距离内存在机动车、行人或者障碍物或者后面的机动车开了转向灯,即所述环境参数显示不适宜进行车道切换、超车和转向行驶机动操作时,所述最优机动策略即为直线行驶,比如跟随行驶在前方的机动车后面。因此,本发明所述自动驾驶方法及系统,能够提供与机动车行驶环境相适应的最优机动策略。(4)本发明所述自动驾驶方法及系统,当机动车进行车道切换、超车和转向行驶机动操作时,当机动车行驶至切换车道的行车边界时,会将记录的机动车车体偏移角度与所述最佳转向角进行比对,将机动车当前的行驶路程与所述车道切换路径轨迹进行比对,若所述车体偏移角度大于所述最佳转向角,且所述行驶路程与所述车道切换路径轨迹有偏差时,会进行报警提示,提醒机动车驾驶员车道切换、超车和转向行驶机动操作有误,通过报警,机动车驾驶员会根据情况对车道切换、超车和转向行驶机动操作进行干预,及时纠正误差,防止机动车在车道切换、超车和转向行驶机动操作过程中发生意外,保证了行车安全。(5)本发明所述自动驾驶方法及系统,当检测的所述环境参数为不可信或者不可执行的环境参数时,会报警提示机动车驾驶员干预行驶机动,比如在下雨天、雾天或者交通环境比较恶劣时,提示机动车驾驶员干预行驶机动,确保行车安全。并且,本发明所述自动驾驶方法及系统,当检测到机动车驾驶员疲劳驾驶时,进行报警提示切换到自动驾驶模式,这样可以缓解机动车驾驶员的疲劳度,防止出现因为疲劳驾驶引发的恶性事故,最大限度的确保行车安全。(6)本发明所述的自动驾驶系统,所述环境数据检测模块包括图像获取单元、超声波探测单元以及雷达探测单元,并且所述超声波探测单元以及雷达探测单元还可以在所述图像获取单元无法检测的区域和无法检测时,对机动车的行驶环境进行检测。因此,本发明所述的自动驾驶系统,可以实现对机动车行驶环境的无死角检测,确保了环境参数的全面性和真实性,为后期最优机动策略的形成,提供了准确的参考依据,确保了行车的安全。附图说明为了使本发明的内容更容易被清楚的理解,下面根据本发明的具体实施例并结合附图,对本发明作进一步详细的说明,其中图1是本发明所述自动驾驶方法的步骤框图;图2是本发明所述车道切换轨迹的示意图;图3是本发明所述车道切换轨迹的局部示意图;图4是本发明所述显示模块在最优机动策略为直线行驶时所显示图像的示意图;图5是本发明所述显示模块在机动车从左侧车道切换到右侧车道时所显示图像的示意图;图6是本发明所述自动驾驶系统的结构框图。图中附图标记表示为:1-对应关系存储模块,2-行驶机动控制模块,3-车体信息采集模块,4-中央处理控制模块,5-环境数据检测模块,6-行驶机动监控模块,7-行车环境报警模块,8-驾驶员状态报警模块,9-驾驶员状态检测模块,21-信息获取模块,22-机动控制模块,41-路径轨迹生成单元,42-命令生成单元,43-策略生成单元,44-第一判断模块,45-第二判断模块,51-图像获取单元,52-超声波探测单元,雷达探测单元-53,车体偏移角度获取单元-61,路程记录单元-62,63-转向报警单元。具体实施方式实施例1本实施例提供了一种自动驾驶方法,如图1所示,包括如下步骤:获取机动车车体参数、机动车车速与机动车最佳转向角间的对应关系并存储所述对应关系。判断最优机动策略是否为车道切换、超车和转向行驶机动操作,若是,则调整机动车行驶状态至理想状态。获取机动车车速和机动车前后轮轴距。将机动车车速与所述对应关系进行比对,获取机动车最佳转向角。根据机动车最佳转向角和机动车前后轮轴距,获取机动车转弯半径。根据机动车最佳转向角和机动车转弯半径规划出车道切换路径轨迹。所述最优机动策略由机动车当前的行驶环境所决定,包括车道切换、超车和转向行驶机动操作和直线行驶。作为一种可选的实施方式,本实施例所述的自动驾驶方法,所述调整机动车行驶状态至理想状态的步骤包括如下步骤:获取标准车道宽度。根据标准车道宽度将机动车调整至车道中间位置,并保持机动车匀速状态下行驶。作为一种优选的实施方法,本实施例所述的自动驾驶方法,还包括如下步骤:检测机动车行车环境并生成相应的环境参数。根据所述环境参数规划出所述最优机动策略。作为一种优选的实施方式,本实施例所述的自动驾驶方法,所述检测机动车行车环境并生成相应的环境参数的步骤包括如下步骤:检测道路车道行车边界、机动车行驶方向、车道前后左右的障碍物、机动车和行人的距离和位置、道路类型、交通标志以及交通标志清晰度和气候情况。根据检测结果生成相应的环境参数并输出。所述根据所述环境参数规划出所述最优机动策略的步骤中,当所述环境参数显示适宜进行车道切换、超车和转向行驶机动操作时,所述最优机动策略即为车道切换、超车和转向行驶机动操作;当所述环境参数显示不适宜进行车道切换、超车和转向行驶机动操作时,所述最优机动策略即为直线行驶。所述道路类型包括公路、高速公路、市区公路和乡间小路,所述交通提示标志包括路标,红绿灯、公交站等。通过以上环境参数,会判定适宜进行自动驾驶还是手动驾驶,并在选择自动驾驶后,在进行车道切换、超车和转向行驶机动操作时,选择与所述环境参数相适应的机动车速度、最佳转向角和触发条件等。比如在市区公路,机动车速度就会选择比较低的速度,其自动驾驶的触发条件就会比较高,即要求非常好的行车环境。当检测机动车转向安全距离内没有机动车、行人和障碍物,并且后面的机动车也没有开转向灯时,即为所述环境参数显示适宜进行车道切换、超车和转向行驶机动操作,此时所述最优机动策略即为车道切换、超车和转向行驶机动操作;当检测道路异常拥挤,前后车距很近,转向安全距离内存在机动车、行人或者障碍物或者后面的机动车开了转向灯时,即为所述环境参数显示不适宜进行车道切换、超车和转向行驶机动操作,此时,所述最优机动策略,即为直线行驶,比如跟随行驶在前方的机动车后面。因此,本实施例所述自动驾驶方法,能够提供与机动车行驶环境相适应的最优机动策略。本实施例所述的自动驾驶方法,所述机动车车体参数、机动车车速与机动车最佳转向角间的对应关系,是通过实验数据测得的,通过实车实验验证或者实验室验证,可以确定某种特定的车型,其机动车车速与机动车最佳转向角间的对应关系。即针对某一特定的车型,其每一种机动车车速都会有一个机动车最佳转向角与其相对应。所述标准车道宽度,通过检测道路车道行车边界即可获取,当机动车调整至理想状态时,会根据所述标准车道宽度控制机动车在车道中间位置行驶,并保持匀速。此时,获取机动车车速,将机动车车速与所述对应关系进行比对,即可获取与此机动车车速相对应的最佳转向角,之后根据机动车最佳转向角和机动车前后轮轴距,即可获取机动车转弯半径;然后根据机动车最佳转向角和机动车转弯半径即可规划出车道切换路径轨迹。所述车道切换路径轨迹的具体计算方法如下所述:如图2、图3所示,即为机动车自动驾驶状态下,当机动车车道切换、超车和转向行驶机动操作时的车道切换路径轨迹,我们用Llane表示标准车道宽度,用Llength表示机动车前后轮轴距,用α表示最佳转向角,用R表示机动车转弯半径,从图2可以看到,浅黑色虚线BB’为车道中间位置,也即机动车在调整至理想状态时的行驶的车道位置和方向,深黑线是车道行车边界,CC’是机动车右侧车道的中间线,也即机动车换道后的行驶位置和方向标志线,B点为机动车当前的位置,C点为机动车进行车道切换、超车和转向行驶机动操作后的目标位置,而A点为机动车进行车道切换、超车和转向行驶机动操作时将要越过的车道界限。机动车在自动驾驶时会保持在车道的中线位置行驶,假设从B点开始换道,沿着圆弧曲线BA和圆弧曲线AC切换到右侧车道行驶,直到到达终点C位置沿着车道中线CC’线行驶。机动车换道的行驶路径为即为圆弧BA+圆弧AC,因此,曲线BAC即为车道切换路径轨迹;如图2所示,圆弧BA和圆弧AC是一个近似于以坐标点O和坐标点O’为圆心、半径为R的圆的一部分(R为机动车转弯半径)。根据切线的定义、性质定理,可以知道θ角与最佳转向角α相等,因此,若设B点坐标为(0,0),是机动车转向开始的起始位置;则O点坐标为(R,0),是圆弧BA所在圆的圆心位置;C点为机动车的车道切换目的位置,根据正弦定理,可知其坐标是(Llane,R(sinα)),O’点坐标为(Llane-R,2*R*(sinα)),是圆弧AC所在圆的圆心。如图3所示,直线CP是圆弧AC的一条切线,直线AP是圆弧AC的另一条切线,两条切线相较于P点,O’点为圆弧AC所在的圆心,C点和A点为圆弧的切点,且线段AC的长度即为机动车前后轮轴距Llength,根据切线的定义、性质定理,可知:∠APC+∠α=180°,∠APC+∠AO’C=180°;=>∠AO’C=∠α,∠AO’P=α/2;=>tan(α/2)=Llength/R;=>R=Llength/(tan(α/2))因为机动车前后轮轴距Llength是确定的,最佳转向角α也通过获取机动车车速并将机动车车速与所述对应关系进行比对确定了,因此,通过机动车最佳转向角α和机动车前后轮轴距Llength即可确定机动车转弯半径R,而机动车转弯半径R和最佳转向角α确定后,即可确定曲线BAC的长度,具体确定方式如下:因为曲线BAC的长度即为圆弧BA加上圆弧CA的长度,依据弧长计算公式,可知圆弧BA和圆弧CA的长度均为πRα/180,因此,曲线BAC的长度即为2πRα/180=πRα/90。通过曲线BAC的长度,机动车转弯半径R和最佳转向角α,即可准确规划出所述车道切换路径轨迹。综上所述,本实施例提供了一种能够根据最优机动策略准确规划出机动车在自动驾驶状态下的车道切换路径轨迹的自动驾驶方法。只有准确规划出机动车的车道切换路径轨迹,才能为机动车在自动驾驶状态下的车道切换、超车和转向行驶机动操作提供最为准确的参考依据。实施例2在实施例1的基础上,本实施例提供的所述自动驾驶方法,还包括如下步骤:生成机动操作命令,控制机动车按照所述车道切换路径轨迹进行车道切换、超车和转向行驶机动操作。如图2所示,若机动车要从左侧车道切换到右侧车道,在机动车实际自动驾驶过程中,需要打开机动车转向灯,通过所述机动操作命令先将机动车前轮向右偏移α角度,从该时间点起算,当机动车行驶路程为πRα/180,也即机动车沿圆弧BA行驶至A点时,调整机动车前轮向左偏移2α角度,从该时间点起算,当机动车行驶路程为πRα/180,也即机动车沿圆弧AC行驶至C点时,将机动车前轮调整至与机动车后轮同步,此时,机动车即完成了一次车道切换、超车和转向行驶机动操作,从左侧车道切换至右侧车道的中间位置。因此,本实施例提供了一种机动车能够执行的机动操作命令,进而控制机动车能够严格按照规划出的所述车道切换路径轨迹行驶来完成车道切换、超车和转向机动操作,能够最大限度的保证自动驾驶状态下的行车安全。作为一种优选的实施方式,还可以将所述最优机动策略和所述车道切换路径轨迹显示给机动车驾驶员,供机动车驾驶员参考。依据图像处理技术,就可将所述车道切换路径轨迹与机动车当前的行驶环境按照一定的比例显示给机动车驾驶员,所述显示的图像如图4、图5所示,其中图4显示的是最优机动策略为直线行驶时显示模块显示的图像,图5显示的是最优机动策略为车道切换、超车和转向行驶机动操作时显示模块显示的图像,只不过是把机动车行驶的路径轨迹和机动车当前的行驶环境等比例缩小显示给机动车驾驶员而已。因为图像处理技术属于现有技术,此不赘述。作为一种优选的实施方式,本实施例所述的自动驾驶方法,还包括如下步骤:当机动车行驶至切换车道的行车边界时,将记录的机动车车体偏移角度与所述最佳转向角进行比对,将机动车进行车道切换、超车和转向行驶机动操作时的行驶路程与所述车道切换路径轨迹进行比对,若所述车体偏移角度大于所述最佳转向角,且所述行驶路程与所述车道切换路径轨迹有偏差时,进行报警提示。本实施例所述自动驾驶方法,当行驶机动操作有误时通过报警,可以提醒机动车驾驶员车道切换、超车和转向行驶机动操作有误。所述报警方式可以为听觉、视觉或者触觉上的提醒,也可以是上述方式的组合。机动车驾驶员收到报警信息后,会根据情况对车道切换、超车和转向行驶机动操作进行干预,及时纠正误差,防止机动车在车道切换、超车和转向行驶机动操作过程中发生意外,保证了行车安全。作为一种优选的实施方式,本实施例所述的自动驾驶方法,还包括如下步骤:当检测的所述环境参数为不可信或不可执行的环境参数时,进行报警提示机动车驾驶员干预行驶机动。当检测到机动车驾驶员疲劳驾驶时,进行报警提示切换到自动驾驶模式。本实施例所述自动驾驶方法,当检测的所述环境参数为不可信或者不可执行的环境参数时,会报警提示机动车驾驶员干预行驶机动,比如在下雨天、雾天或者交通环境比较恶劣时,提示机动车驾驶员干预行驶机动,确保行车安全。并且,本实施例所述自动驾驶方法,当检测到机动车驾驶员疲劳驾驶时,进行报警提示切换到自动驾驶模式,这样可以缓解机动车驾驶员的疲劳度,防止出现因为疲劳驾驶引发的恶性事故,最大限度的确保行车安全。所述报警方式可以为听觉、视觉或者触觉上的提醒,也可以是上述方式的组合。实施例3本实施例提供了一种自动驾驶系统,如图6所示,包括:对应关系存储模块1,用于获取并存储机动车车体参数、机动车车速与机动车最佳转向角间的对应关系。行驶机动控制模块2,用于调整机动车行驶状态,并在最优机动策略为车道切换、超车和转向行驶机动操作时,调整机动车行驶状态至理想状态。车体信息采集模块3,用于采集机动车运行状态信息且所述机动车运行状态信息包括机动车车速信息和机动车前后轮轴距。中央处理控制模块4,其包括路径轨迹生成单元41。所述路径轨迹生成单元41,在机动车行驶状态调整至理想状态后,从所述车体信息采集模块3获取所述机动车车速和机动车前后轮轴距;从所述对应关系存储模块1获取所述对应关系;所述路径轨迹生成单元41将机动车车速与所述对应关系进行比对,获取机动车最佳转向角,根据机动车最佳转向角和机动车前后轮轴距,获取机动车转弯半径,根据机动车最佳转向角和机动车转弯半径规划出车道切换路径轨迹。在实际应用中,所述对应关系存储模块1可以安装于所述中央处理控制模块4,也可以独立设置。作为一种优选的实施方式,本实施例所述的自动驾驶系统,所述行驶机动控制模块2包括信息获取模块21和机动控制模块22。所述信息获取模块21用于获取最优机动策略。所述机动控制模块22,从所述信息获取模块21获取所述最优机动策略,并在最优机动策略为车道切换、超车和转向行驶机动操作时,获取标准车道宽度,并根据标准车道宽度将机动车调整至车道中间位置,并保持机动车匀速状态下行驶。作为一种优选的实施方式,本实施例所述的自动驾驶系统,还包括:环境数据检测模块5,用于检测机动车行驶环境并根据检测到的机动车行驶环境生成相应的环境参数。所述中央处理控制模块4还包括策略生成单元43,根据从所述环境数据检测模块5获取的所述环境参数以及从所述车体信息采集模块3获取的所述机动车运行状态信息规划出最优行驶机动策略。作为一种优选的实施方式,本实施例所述的自动驾驶系统,所述环境数据检测模块5包括图像获取单元51、超声波探测单元52以及雷达探测单元53。所述图像获取单元51接收安装于机动车的正前方、正后方和左右两侧的多个数字摄像头检测的图像信息,从所述图像信息中提取包括道路车道行车边界、机动车行驶方向、车道前后左右的障碍物、机动车和行人的距离和位置、道路类型、交通标志以及交通标志清晰度和气候情况的信息。所述超声波探测单元52接收安装于机动车的正前方、正后方和左右两侧的多个超声波探头探测的信息;所述雷达探测单元53接收安装于机动车的正前方、正后方和左右两侧的多个雷达探测的信息;所述超声波探测单元52和所述雷达探测单元53共同作用,在所述图像获取单元51无法检测的区域和无法检测时,对机动车的行驶环境进行检测。作为一种优选的实施方式,所述多个数字摄像头、所述多个超声波探头以及所述多个雷达均安装在机动车前、后轮的中间位置。所述策略生成单元43,当所述环境参数显示适宜进行车道切换、超车和转向行驶机动操作时,生成的所述最优机动策略即为车道切换、超车和转向行驶机动操作;当所述环境参数显示不适宜进行车道切换、超车和转向行驶机动操作时,生成的所述最优机动策略即为直线行驶。所述路径轨迹生成单元41,从所述策略生成单元43获取所述最优机动策略并将所述最优机动策略传输给所述信息获取模块21;并当所述最优机动策略为车道切换、超车和转向行驶机动操作时规划出车道切换路径轨迹,当所述最优机动策略为直线行驶时规划出直线路径轨迹。所述命令生成单元42,还用于根据从所述路径轨迹生成单元41获取的所述直线路径轨迹,生成相应的直线机动操作命令。所述信息获取模块21还用于从所述命令生成单元42获取所述直线机动操作命令。所述机动控制模块22,还用于根据从所述信息获取模块21获取的所述直线机动操作命令控制机动车按照所述直线路径轨迹进行直线行驶。本实施例所述的自动驾驶系统,所述机动车车体参数、机动车车速与机动车最佳转向角间的对应关系,是通过实验数据测得的,通过实车实验验证或者实验室验证,可以确定某种特定的车型,其机动车车速与机动车最佳转向角间的对应关系。即针对某一特定的车型,其每一种机动车车速都会有一个机动车最佳转向角与其相对应。所述标准车道宽度,通过环境数据检测模块5检测道路车道行车边界即可获取,当行驶机动控制模块2将机动车调整至理想状态时,会根据所述标准车道宽度控制机动车在车道中间位置行驶,并保持匀速。此时,车体信息采集模块3获取机动车车速,所述路径轨迹生成单元41从所述车体信息采集模块3获取所述机动车车速,并将机动车车速与所述对应关系进行比对,即可获取与此机动车车速相对应的最佳转向角,之后根据机动车最佳转向角和机动车前后轮轴距,即可获取机动车转弯半径;然后根据机动车最佳转向角和机动车转弯半径即可规划出车道切换路径轨迹。本实施例所述的自动驾驶系统,所述超声波探测单元52和所述雷达探测单元53还可以在所述图像获取单元51无法检测的区域和无法检测时,对机动车的行驶环境进行检测。因此,本实施例所述的自动驾驶系统,通过三种不同的手段,检测机动车车体周围不同距离、不同视角的障碍,在数字摄像头无法覆盖的区域和图像无法监测的区域,保证机动车能够在紧急情况下避开危险。实现了对机动车行驶环境的无死角检测,确保了环境参数的全面性和真实性,为后期最优机动策略的形成,提供了准确的参考依据,确保了行车的安全。实施例4在实施例3的基础上,如图6所示,本实施例所述的自动驾驶系统,所述中央处理控制模块4还包括命令生成单元42,用于根据从所述路径轨迹生成单元41获取的所述车道切换路径轨迹,生成相应的机动操作命令。所述信息获取模块21还用于从所述命令生成单元42获取所述机动操作命令。所述机动控制模块22,还用于根据从所述信息获取模块21获取的所述机动操作命令控制机动车按照所述车道切换路径轨迹进行车道切换、超车和转向行驶操作。在机动车实际的自动驾驶过程中,作为一种可选的实施方式,所述机动控制模块22通过控制安装于机动车上的转向舵机进而控制机动车前轮的偏移角度,进而控制机动车按照所述车道切换路径轨迹进行车道切换、超车和转向行驶操作。因此,本实施例命令生成单元42通过生成转向舵机能够执行的机动操作命令,进而控制机动车能够严格按照规划出的所述车道切换路径轨迹行驶来完成车道切换、超车和转向机动操作,能够最大限度的保证自动驾驶状态下的行车安全。作为一种优选的实施方式,本实施例所述的自动驾驶系统,还包括显示模块,通过显示模块将所述最优机动策略和所述车道切换路径轨迹显示给机动车驾驶员,供机动车驾驶员参考。依据图像处理技术,就可将所述车道切换路径轨迹与机动车当前的行驶环境按照一定的比例显示给机动车驾驶员。所述显示模块显示的图像如图4、图5所示,其中图4显示的是最优机动策略为直线行驶时显示模块显示的图像,图5显示的是最优机动策略为车道切换、超车和转向行驶机动操作时显示模块显示的图像,只不过是把机动车的行驶轨迹和机动车当前的行驶环境等比例缩小显示给机动车驾驶员而已。因为图像处理技术属于现有技术,此不赘述。作为一种优选的实施方式,本实施例所述的自动驾驶系统,还包括:行驶机动监控模块6,其包括车体偏移角度获取单元61、路程记录单元62和转向报警单元63。所述车体偏移角度获取单元61,用于获取安装于机动车上的陀螺仪记录的机动车进行车道切换、超车和转向行驶机动操作时的机动车车体偏移角度。所述路程记录单元62,用于记录机动车进行车道切换、超车和转向行驶机动操作时的行驶路程。所述转向报警单元63,从所述环境数据检测模块5获取车道行车边界信息,当机动车行驶至切换车道的行车边界时,将从所述车体偏移角度获取单元61获取的所述机动车车体偏移角度和从所述路径轨迹生成单元41获取的所述最佳转向角进行比对,将从所述路程记录单元62获取的所述行驶路程与所述车道切换路径轨迹进行比对,若所述车体偏移角度大于所述最佳转向角,且所述行驶路程与所述车道切换路径轨迹有偏差时,控制设置于机动车上的第一报警装置进行报警提示。作为一种优选的实施方式,本实施例所述的自动驾驶系统,还包括:驾驶员状态检测模块9,用于对驾驶员状态进行检测并生成相应的驾驶员状态信息。所述中央处理控制模块4还包括第一判断模块44和第二判断模块45。所述第一判断模块44从所述环境数据检测模块5获取所述环境参数,并判断所述环境参数是否为不可信或不可执行的环境参数,并将所述环境参数判断结果传输至所述行车环境报警模块7;所述行车环境报警模块7,接收所述第一判断模块44的所述判断结果,当所述环境参数为不可信或不可执行的环境参数时,控制设置于机动车上的第二报警装置报警提示机动车驾驶员干预行驶机动。所述第二判断模块45从所述驾驶员状态检测模块9获取所述驾驶员状态信息,并据此判断机动车驾驶员是否为疲劳驾驶,并将所述驾驶员状态信息判断结果传输至所述驾驶员状态报警模块8;所述驾驶员状态报警模块8,接收所述第二判断模块45的所述判断结果,当机动车驾驶员疲劳驾驶时,控制设置于机动车上的第三报警装置报警,提示切换到自动驾驶模式。所述驾驶员状态检测模块9属于现有技术,比如公开号为CN103318023A,发明名称为“车载实时智能疲劳监控及辅助装置”,通过影像采集模块采集驾驶员图像,并根据驾驶员图像对驾驶员疲劳状态进行分级并根据其疲劳等级产生干涉指令。在此不再过多介绍。本领域内的技术人员应明白,本发明的实施例可提供为方法、系统、或计算机程序产品。因此,本发明可采用完全硬件实施例、完全软件实施例、或结合软件和硬件方面的实施例的形式。而且,本发明可采用在一个或多个其中包含有计算机可用程序代码的计算机可用存储介质(包括但不限于磁盘存储器、CD-ROM、光学存储器等)上实施的计算机程序产品的形式。本发明是参照根据本发明实施例的方法、设备(系统)、和计算机程序产品的流程图和/或方框图来描述的。应理解可由计算机程序指令实现流程图和/或方框图中的每一流程和/或方框、以及流程图和/或方框图中的流程和/或方框的结合。可提供这些计算机程序指令到通用计算机、专用计算机、嵌入式处理机或其他可编程数据处理设备的处理器以产生一个机器,使得通过计算机或其他可编程数据处理设备的处理器执行的指令产生用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的装置。这些计算机程序指令也可存储在能引导计算机或其他可编程数据处理设备以特定方式工作的计算机可读存储器中,使得存储在该计算机可读存储器中的指令产生包括指令装置的制造品,该指令装置实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能。这些计算机程序指令也可装载到计算机或其他可编程数据处理设备上,使得在计算机或其他可编程设备上执行一系列操作步骤以产生计算机实现的处理,从而在计算机或其他可编程设备上执行的指令提供用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的步骤。尽管已描述了本发明的优选实施例,但本领域内的技术人员一旦得知了基本创造性概念,则可对这些实施例做出另外的变更和修改。所以,所附权利要求意欲解释为包括优选实施例以及落入本发明范围的所有变更和修改。
当前第1页1 2 3 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1