发明内容
为解决在无道路标记的路况下,现有技术的基于标识线的智能驾驶汽车的车道保持方法就会失效,从而造成重大的安全隐患的问题技术问题,本发明提供以下技术方案。
一种智能驾驶汽车的车道保持方法,包括以下步骤:
检测或识别参照物;
根据汽车与所述参照物的距离判断汽车的偏离:根据汽车与所述参照物的距离判断汽车的偏离:某一时刻固定设置在汽车前部的感光设备P与参照物上R上参照点A的直线距离L1、感光设备P到参照点A的仰角α,感光设备P沿汽车行驶方向与参照物R的夹角为β;汽车移动距离S后,感光设备P距离参照点A的距离为L2,H为感光设备P与参照点A的垂直距离,若汽车距离道路边界的距离未发生变化,则以下公式成立:
若实际测得的L′2=L2,则汽车未发生左右偏离;
若实际测得的L′2>L2,则汽车发生了远离参照物一侧的位移;
若实际测得的L′2<L2,则意味着汽车发生了靠近参照物一侧的位移;
根据汽车的偏离调整汽车的行驶方向。
上述的基于参照物的车道保持方法,在所述步骤根据汽车与所述参照物的距离判断汽车的偏离之前还包括:判断或计算汽车与所述参照物的几何距离及位置关系。
上述的车道保持方法,所述根据汽车与参照物的偏离调整汽车的行驶方向的方法为:当汽车与一侧道路边界的距离未发生变化,则不对汽车进行方向调节;若汽车与一侧道路边界的距离发生了变化,则对其行驶方向进行调整。
上述的基于参照物的车道保持方法,所述根据汽车与参照物的偏离调整汽车的行驶方向的方法为:当汽车与一侧道路边界的距离未发生变化,则不对汽车进行方向调节;若汽车与一侧道路边界的距离发生了变化,则对其行驶方向进行调整。
上述的车道保持方法,在根据汽车与所述参照物的距离判断汽车的偏离的步骤中,感光设备P同时检测或识别参照物R上的多个参照点,判断或计算汽车与所述参照物的几何距离和位置关系,再判断汽车与参照物的偏离并调整汽车的行驶方向。
上述的基于参照物的车道保持方法,若汽车与一侧道路边界的距离变大,则做出靠近该侧道路边界方向的方向调整,若汽车与一侧道路边界的距离变小,则做出远离该侧道路边界方向的方向调整。
一种智能驾驶汽车的车道保持的装置,包括:
检测识别单元,检测或识别参照物;
偏离判断单元,根据汽车与检测识别单元检测或识别的参照物的距离判断汽车的偏离;
方向调整单元,根据汽车的偏离调整汽车的行驶方向。
上述的基于参照物的车道保持的装置,所述检测识别单元包括一传感器,所述传感器固定设置在所述汽车的前部,所述传感器实时获取汽车的前方道路及环境信息,某一时刻固定设置在汽车前部的感光设备P与参照物上R上参照点A的直线距离L1、感光设备P到参照点A的仰角α,感光设备P沿汽车行驶方向与参照物R的的夹角为β;汽车移动距离S后,感光设备P距离参照点A的距离为L2,H为感光设备P与参照点A的垂直距离,偏离判断单元计算利用公式
计算得到L2,若测得的L′2=L2,则偏离判断单元判断汽车未发生左右偏离,若测得的L′2>L2,则偏离判断单元判断汽车发生了远离参照物一侧的位移,若测得的L′2<L2,则偏离判断单元判断汽车发生了靠近参照物一侧的位移。
上述的基于参照物的车道保持的装置,当汽车与一侧道路边界的距离未发生变化,所述方向调整单元不对汽车进行方向调节;若汽车与一侧道路边界的距离变大,则所述方向调整单元做出靠近该侧道路边界方向的方向调整,若汽车与一侧道路边界的距离变小,则所述方向调整单元做出远离该侧道路边界方向的方向调整。
一种汽车,包括上述任意一项所述的基于参照物的车道保持的装置。
通过以上方案可知,本申请提供的一种智能驾驶汽车的车道保持方法及其装置,在无车道标志线的道路上行驶,在特定的情况下只能监测到方块面型参照物的时候,根据汽车与参照物的距离判断汽车的偏离,并根据汽车的偏离及时调整汽车的行驶方向,提高了汽车在无车道标志线的道路上行驶时的安全性。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做岀创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
本发明实施例提供的一种基于参照物车道保持方法,应用于汽车的行驶过程中。
优选地,所述参照物可以是具有一定规则形状或者排列的可识别对象。例如车辆周围的环境中的存在物,该存在物可以是运动的,如该交通载具周边的其他交通载具,或者与该交通载具具有一定相对速度的移动物体;该存在物也可以是静止的,如该交通载具周边电线杆、交通指示牌、建筑物等。更为优选地,在本发明的一个实施方式中,所述参照物是道路附近的具有一定形状规则的可识别或者可检测对象。进一步,所述参照物可以是方块面型的对象,例如道路交通标志牌的标志面、广告牌等方块面型物体。
所述基于参照物车道保持方法包括以下步骤:
步骤1,检测或识别所述参照物。
在该步骤中,所述交通载具上具有检测功能的传感器,例如雷达、激光测距仪、红外检测仪、声呐传感器、可见光摄像机或照相机等等。所述传感器可以设置在交通载具的轮廓上或者顶部。如图1和图2所示,图1和图2示出了交通载具为家用轿车的情形,本领域的技术人员应当理解,在更广泛的应用场景中,所述交通载具可以是前述举例中的任意一种。在家用轿车的车身的一侧或者多测可以设置一个或多个传感器。例如在车身的左侧设置一个或多个雷达测距仪,或者激光测距仪。也可以在车身的前部或者右侧或者后侧设置一个或多个雷达测距仪,或者激光测距仪。也可以在车身的一侧或多测设置不同类型的传感器,例如在车身的右侧设置至少一个雷达测距仪以及至少一个摄像机。
在一个优选的实施方式中,所述具有检测功能的传感器为ccd或者cmos或者其他具有感光功能的传感器,或者其他感光元件或者器件,以下统称为感光设备,例如可见光摄像机和/或红外摄像机。所述ccd或者cmos或者其他具有感光功能的传感器安装固定在车身前部位置,安装高度和角度根据车辆自身情况确定,例如安装在车身前脸、车身前顶部等。所述ccd或者cmos或者其他具有感光功能的传感器可以为一个或者多个。
所述感光设备实时获取交通载具前方的可见光和/或红外光信息,并得到不间断的图像或者视频。所述实时获取不间断的图像或者视频可以是通过感光设备以一定的时间间隔获取的一系列的感光信息,例如每间隔1毫秒或者2毫秒或者其他时间间隔所获取的静态图像,或者由所述静态图像生成的动态图像或者视频。
在所述静态或者动态图像中检测或者识别出至少一个参照物,例如通过边缘检测,或者颜色阈值检测,或者边缘检测加霍夫曼变换,或者基于模板识别或者其他人工智能学习等方法识别出具有柱状或者条状的对象作为参照物。具体的参照物的检测方法已经存在于现有技术中,并非本发明的宗旨所在。
步骤2,判断或计算交通载具与所述参照物的几何距离。
在一个应用场景中,假设车辆行驶在直线道路上,如图3所示,感光设备固定设置在交通载具的前部,获取感光设备距离参照物R上的参照点A的距离L1。获取参照点A的方法优选如下:感光设备检测到参照物R,可以在R上选择一个或者多个点作为参考点,例如可以将检测出的方块面型参照物(例如道路交通标志牌)的边缘一点作为参照点,或者选择方块面型参照物上的可以明显检测出来的字作为参照点。获取L1的方法优选如下:获取参照物R在T1时刻在感光设备拍摄的图像中的位置,因在前述步骤中参照物R上的参照点A已经被检测出来,此时,可以获取参照点A在图像中的位置P1,而图像的中心点为摄像机所在的位置P0,计算P1与P0的像素值,而后根据感光设备的分辨率即可换算出P1和P0之间的距离。在更为可靠的方案中,可以沿交通载具中轴线的位置的两侧对称设置两个感光设备,例如两个ccd相机或者cmos相机,如此可以获取双目图像,而后通过分别在每个图像中检测识别出参照物R,而后可以通过双目视觉来实现对参照物R的测距。双目测距的方法有很多,并不在本发明强调之列。例如,首先对相机进行标定,而后进行双目校正,并进行双目匹配,在计算深度信息等方式来实现对目标物的测距。
在另一种更为优选的实施方式中,因在前述步骤中参照物R已经被检测出来,此时可以启动设置在车辆前部的雷达测距仪来测算雷达测距仪与参照物R上的参照点A的初始距离L1以及雷达测距仪到参照点A的仰角α。
在测得初始距离L1之后,可以获得如图3所示的三角形关系,作参照点A与与道路的垂线(记为AE),过感光设备P作垂直AE的直线(记为ME),此时,感光设备P与参照点A的仰角为α,感光设备P沿交通载具行驶方向与AE、ME的交点E的夹角为β;感光设备P与参照点A的水平距离(即ME)为D1,感光设备P与参照点A的垂直距离(即AE)为H,根据三角公式可知,D1=L1·cosα,H=L1·sinα。
当交通载具行驶到T2时刻,如图4所示,可通过以上方式或者以上方式之一测得固定设置在交通载具前部的感光设备P距离参照物R1的距离为L2;T1至T2时刻交通载具行驶的距离为S。S可以通过车辆的里程信息来获得,例如统计T1至T2这段期间轮胎旋转的周数,利用该周数乘以轮胎的周长即可得到S。
步骤3,判断交通载具与参照物的偏离。
以上方式或者以上方式之一测出T1时刻固定设置在交通载具前部的感光设备P与参照物上R上参照点A的直线距离L1、感光设备P到参照点A的仰角α,感光设备P沿交通载具行驶方向与AE、ME的交点E的夹角为β;T1至T2时刻交通载具移动的距离为S,T2时刻感光设备P距离参照点A的距离为L2。
此时,若交通载具距离道路边界的距离未发生变化,则以下公式成立:
假设实际测得的L′2=L2,则意味着交通载具未发生左右偏离;
若实际测得的L′2>L2,则意味着交通载具发生了远离参照物一侧的位移,如图5所示,此时参照物在交通载具的右侧道路边界上,则意味着该交通载具在T2时刻距离右侧道路边界的距离大于T1时刻距离右侧道路边界的距离,即发生了左偏;
反之,若实际测得的L′2<L2,则意味着交通载具发生了靠近参照物一侧的位移,如图6所示,此时参照物在交通载具的右侧道路边界上,则意味着该交通载具在T2时刻距离右侧道路边界的距离小于T1时刻距离右侧道路边界的距离,即发生了右偏。
步骤4,根据交通载具与参照物的偏离调整交通载具的行驶方向。
相对于前一时刻,当交通载具与一侧道路边界的距离未发生变化,则意味着该交通载具处于一个正常的车道保持状态,此时不需要对交通载具进行任何左右方向调节的操作。如前述步骤所述,若交通载具与一侧道路边界的距离发生了变化,则意味着该交通载具已经跑偏,为了保证其行驶安全,则需要对其行驶方向进行调整。具体而言,若交通载具与一侧道路边界的距离变大,则做出靠近该侧道路边界方向的方向调整,例如,该交通载具发生了左跑偏,则调整该交通载具的转向往右转。若交通载具与一侧道路边界的距离变小,则做出远离该侧道路边界方向的方向调整,例如,该交通载具发生了右跑偏,则调整该交通载具的转向往左转。
更优选地,为了更高的容错率,若T2时刻的|L2-L2|<δL,δL是一个预先设置的阈值,例如0.3米,0.2米,0.1米,0.05米等,也可以是这些举例之外的其他数值,此时意味着该交通载具未发生偏离,或者偏离范围在安全范围之内,此时可不对交通载具的转向做出调整。若T2时刻的|L′2-L2|>δL,此时意味着该交通载具发生了重大偏离,或者偏离范围在安全范围之外,此时对交通载具的转向做出调整。
进一步的,为了避免因为连续两个时间段内的δL足够小,比如T1和T2间隔的时间可能是10毫秒,10毫秒内交通载具的偏移值较小,而连续多个时间段内的δL的累加值变大,比如T1和T2间隔的时间为10秒,但这10秒之内又分为多个时间段,可能是1000个时间段,或者10000个时间段等,那么如果实时计算这些小的时间段内的|L′2-L2|可能会小于δL而不对交通载具的转向进行调整,但到了第10秒,初始L2值与第10秒测得的L′2值可能超出了δL,即意味着该交通载具经过长时间行驶后发生了累加跑偏的情况。
此时,更为优选地,T1和T2的时间间隔可以是10毫秒,100毫秒,1秒,5秒,10秒等等。也就是说,不是简单比较时间上相邻的两幅图像之间的|L′2-L2|,同时可以比较比较时间上不相邻的两幅图像之间的|L′2-L2|,如此可以进一步增加交通载具行驶的安全性。
在一个优选的实施例中,进一步的,为了提高容错率,感光设备P同时检测或识别参照物R上的多个参照点,如图7所示,然后判断或计算交通载具与所述参照物的几何距离和位置关系,再判断交通载具与参照物的偏离并调整交通载具的行驶方向。具体的,判断或计算交通载具与所述参照物的几何距离和位置关系的方法与上述感光设备P检测到参照物R上的一个参照点A时的判断或计算方法一致。
更进一步的,感光设备P同时检测交通载具行驶方向上不同的参照物上的参照点,如图8所示,判断或计算交通载具与所述参照物的几何距离和位置关系的方法与上述感光设备P检测到参照物R上的一个参照点A时的判断或计算方法一致。
再进一步的,在另一个实施例中,为了提高容错率,感光设备P同时检测交通载具行驶方向多个参照物上的多个参照点,判断或计算交通载具与所述参照物的几何距离和位置关系的方法与上述感光设备P检测到参照物R上的一个参照点A时的判断或计算方法一致。
更为优选的,与感光设备监测单个参照物的实施例相同,为了更高的容错率,监测多个参照物也设置安全偏离范围。
本发明的另一个实施方式中,提供了一种交通载具控制装置,如图7所示,所述装置包括:
检测识别单元,检测或识别参照物;所述检测识别单元包括一传感器,所述传感器固定设置在所述交通载具的前部,所述传感器实时获取交通载具的前方道路及环境信息;
偏离判断单元,根据交通载具与检测识别单元检测或识别的参照物的距离判断交通载具的偏离;
方向调整单元,根据交通载具的偏离调整交通载具的行驶方向;
优选的,感光设备固定设置在交通载具的前部,某一时刻固定设置在交通载具前部的感光设备P与参照物上R上参照点A的直线距离L1、感光设备P到参照点A的仰角α,感光设备P沿交通载具行驶方向与参照物R的的夹角为β;交通载具移动距离S后,感光设备P距离参照点A的距离为L2,偏离判断单元计算利用计算得到L2,偏离判断单元计算利用公式
计算得到L2,若测得的,则偏离判断单元判断交通载具未发生左右偏离,若测得的,则偏离判断单元判断交通载具发生了远离参照物一侧的位移,若测得的,则偏离判断单元判断交通载具发生了靠近参照物一侧的位移。
当交通载具与一侧道路边界的距离未发生变化,方向调整单元不对交通载具进行方向调节;若交通载具与一侧道路边界的距离变大,则方向调整单元做出靠近该侧道路边界方向的方向调整,若交通载具与一侧道路边界的距离变小,则方向调整单元做出远离该侧道路边界方向的方向调整。
以上只通过说明的方式描述了本发明的某些示范性实施例,毋庸置疑,对于本领域的普通技术人员,在不偏离本发明的精神和范围的情况下,可以用各种不同的方式对所描述的实施例进行修正。因此,上述附图和描述在本质上是说明性的,不应理解为对本发明权利要求保护范围的限制。