CN112189225B - 车道线信息检测装置、方法以及存储被编程为执行该方法的计算机程序的计算机可读记录介质 - Google Patents
车道线信息检测装置、方法以及存储被编程为执行该方法的计算机程序的计算机可读记录介质 Download PDFInfo
- Publication number
- CN112189225B CN112189225B CN201980035132.9A CN201980035132A CN112189225B CN 112189225 B CN112189225 B CN 112189225B CN 201980035132 A CN201980035132 A CN 201980035132A CN 112189225 B CN112189225 B CN 112189225B
- Authority
- CN
- China
- Prior art keywords
- lane line
- line information
- vehicle
- travel lane
- coordinate system
- 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
- 238000001514 detection method Methods 0.000 title claims abstract description 46
- 238000000034 method Methods 0.000 title claims description 29
- 238000004590 computer program Methods 0.000 title description 8
- 230000004927 fusion Effects 0.000 claims description 33
- 238000006243 chemical reaction Methods 0.000 claims description 16
- 238000005070 sampling Methods 0.000 claims description 5
- 238000013507 mapping Methods 0.000 claims 1
- 239000011159 matrix material Substances 0.000 description 29
- 238000010586 diagram Methods 0.000 description 16
- 238000004891 communication Methods 0.000 description 8
- 238000000611 regression analysis Methods 0.000 description 4
- 230000007613 environmental effect Effects 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 2
- 239000002245 particle Substances 0.000 description 2
- 238000012545 processing Methods 0.000 description 2
- 241001465754 Metazoa Species 0.000 description 1
- 230000015572 biosynthetic process Effects 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 238000012937 correction Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000001914 filtration Methods 0.000 description 1
- 239000002803 fossil fuel Substances 0.000 description 1
- 238000003384 imaging method Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/16—Anti-collision systems
- G08G1/167—Driving aids for lane monitoring, lane changing, e.g. blind spot detection
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
- B60W40/02—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to ambient conditions
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
- B60W40/02—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to ambient conditions
- B60W40/04—Traffic conditions
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
- B60W40/02—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to ambient conditions
- B60W40/06—Road conditions
- B60W40/076—Slope angle of the road
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06V—IMAGE OR VIDEO RECOGNITION OR UNDERSTANDING
- G06V20/00—Scenes; Scene-specific elements
- G06V20/50—Context or environment of the image
- G06V20/56—Context or environment of the image exterior to a vehicle by using sensors mounted on the vehicle
- G06V20/588—Recognition of the road, e.g. of lane markings; Recognition of the vehicle driving pattern in relation to the road
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/16—Anti-collision systems
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2420/00—Indexing codes relating to the type of sensors based on the principle of their operation
- B60W2420/40—Photo or light sensitive means, e.g. infrared sensors
- B60W2420/403—Image sensing, e.g. optical camera
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2552/00—Input parameters relating to infrastructure
- B60W2552/53—Road markings, e.g. lane marker or crosswalk
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2556/00—Input parameters relating to data
- B60W2556/40—High definition maps
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units, or advanced driver assistance systems for ensuring comfort, stability and safety or drive control systems for propelling or retarding the vehicle
- B60W30/10—Path keeping
- B60W30/12—Lane keeping
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
- B60W50/08—Interaction between the driver and the control system
- B60W50/14—Means for informing the driver, warning the driver or prompting a driver intervention
Abstract
根据一实施例的车道线信息检测方法包括:从精密地图获取与车辆的估计位置信息对应的第一行驶车道线信息的步骤;从通过设置在上述车辆上的摄像头拍摄的上述车辆的前方图像获取第二行驶车道线信息的步骤;根据同一坐标系对上述第一行驶车道线信息以及上述第二行驶车道线信息进行转换的步骤;以及对上述转换的第一行驶车道线信息以及上述转换的第二行驶车道线信息进行融合来获取最终行驶车道线信息的步骤。
Description
技术领域
本发明涉及车道线信息检测装置、方法以及存储被编程为执行该方法的计算机程序的计算机可读记录介质。作为参考,本申请主张基于2018年06月26日提交的韩国专利申请(申请号10-2018-0073259号)的优先权。在本申请中作为参考文献引用作为该优先权的基础的对应申请的全部内容。
背景技术
一般情况下,车辆表示以化石燃料、电力等作为动力源在道路或者线路行驶的运输装置。
随着技术的发展,车辆发展成可以给驾驶员提供各种功能。尤其是,随着车辆的电气化趋势,出现了具备主动安全系统(ASS:Active Safety System)的车辆,该主动安全系统在即将事故发生之前或者发生事故的瞬间启动以避免事故。
而且,最近为了减轻驾驶员的负担提高方便性,积极地进行着对于搭载有先进驾驶辅助系统(ADAS:Advanced Driver Assist System)的车辆的研究,该先进驾驶辅助系统主动提供关于车辆状态、驾驶员状态以及周围环境等行驶环境的信息。
先进驾驶辅助系统中的车道偏离预警系统(LDWS:Lane Departure WarningSystem)和车道保持辅助系统(LKAS:Lane Keeping Assist System)可以从车辆的前方图像获取行驶车道线信息,并且利用所获取的行驶车道线信息控制车辆的行驶。
这时,由于天气等环境原因,从前方图像难以获得行驶车道线信息或者实际道路上不存在车道线的一部分时,车道偏离预警系统以及车道保持辅助系统的性能有可能下降。
发明内容
技术问题
本发明要解决的问题是提供比现有技术更加精确地提供行驶车道线信息的技术。
并且,提供即使在由于天气等环境原因从前方图像难以获得行驶车道线信息或者实际道路上不存在车道线的一部分的情况下,也能够精确地检测行驶车道线信息的技术。
而且,将在本发明公开的技术应用于例如搭载有先进驾驶辅助系统的车辆等各种移动手段中。
需要说明的是,本发明要解决的问题并不限定于上述的问题,本发明所属技术领域的技术人员通过下面的说明明确理解未提及的其它要解决的问题。
解决问题的手段
根据一实施例的车道线信息检测方法包括:从精密地图获取与车辆的估计位置信息对应的第一行驶车道线信息的步骤;从通过设置在上述车辆上的摄像头拍摄的上述车辆的前方图像获取第二行驶车道线信息的步骤;根据同一坐标系对上述第一行驶车道线信息以及上述第二行驶车道线信息进行转换的步骤;以及对上述转换的第一行驶车道线信息以及上述转换的第二行驶车道线信息进行融合来获取最终行驶车道线信息的步骤。
根据一实施例的存储被编程为执行车道线信息检测方法的计算机程序的计算机可读记录介质,包括:从精密地图获取与车辆的估计位置信息对应的第一行驶车道线信息的步骤;从通过设置在上述车辆上的摄像头拍摄的上述车辆的前方图像获取第二行驶车道线信息的步骤;根据同一坐标系对上述第一行驶车道线信息以及上述第二行驶车道线信息进行转换的步骤;以及对上述转换的第一行驶车道线信息以及上述转换的第二行驶车道线信息进行融合来获取最终行驶车道线信息的步骤。
根据一实施例的车道线信息检测装置包括:行驶车道线信息获取部,从精密地图获取与车辆的估计位置信息对应的第一行驶车道线信息,从通过设置在上述车辆上的摄像头拍摄的上述车辆的前方图像获取第二行驶车道线信息;坐标系转换部,根据同一坐标系对上述第一行驶车道线信息以及上述第二行驶车道线信息进行转换;以及,车道线融合部,对上述转换的第一行驶车道线信息以及上述转换的第二行驶车道线信息进行融合来获取最终行驶车道线信息。
发明效果
根据一实施例的车道线信息检测装置、方法以及存储被编程为执行该方法的计算机程序的计算机可读记录介质,除了车辆的前方图像之外,还利用精密地图,从而能够检测出更加准确的行驶车道线信息。
并且,将检测到的行驶车道线信息作为车道偏离预警系统和车道保持辅助系统的输入值,从而可以实现更加精确的车辆控制。
附图说明
图1a以及1b是根据各种实施例的车道线信息检测系统的控制框图。
图2是用于说明根据一实施例的车辆和摄像头的坐标系的图。
图3是例示出根据一实施例的前方图像中不存在行驶车道线的一部分的情况的图。
图4是用于说明根据另一实施例的从摄像头朝行驶车道线方向的直线的图。
图5是用于说明根据另一实施例的坐标系转换部将第二行驶车道线信息按照车辆坐标系进行转换的方法的图。
图6是例示出根据一实施例的在精密地图上将第二行驶车道线信息进行匹配的结果的图。
图7是例示出根据一实施例的在精密地图上将第一行驶车道线信息以及第二行驶车道线信息进行匹配的结果的图。
图8a、8b、8c、8d、8e、8f以及8g是用于说明根据一实施例的车道线融合部的动作的图。
图9是根据一实施例的车道线信息检测方法流程图。
具体实施方式
参照与附图一同下面详细说明的实施例即可明确地理解本发明的优点以及特征和实现这些方法。但是,本发明并不限定于下面公开的实施例,还可以以其它各种方式实现,本实施例只是为了完整地公开本发明、向本发明所属技术领域的技术人员完整地告知本发明的保护范围而提供,应该通过权利要求书来定义本发明。
在说明本发明的实施例的过程中,当判断为对于公知功能或者构成的具体说明有可能混淆本发明的宗旨时,省略其详细说明。另外,后面的术语是鉴于在本发明的实施例中的功能定义的术语,可以根据使用者、操作者的意愿或习惯等有所改变。因此,应该基于本说明书的整体内容来加以定义。
图1a以及1b是根据各种实施例的车道线信息检测系统的控制框图,图2是用于说明根据一实施例的车辆和摄像头的坐标系的图,图3是例示出根据一实施例的前方图像中不存在行驶车道线的一部分的情况的图。
参照图1a,根据一实施例的车道线信息检测系统可以以车辆V以及车道线信息检测装置100构成。
车辆V可以表示沿道路或线路行驶,同时可以将人、物体或者动物等从一个位置移动到其它位置的运输手段。根据一实施例的车辆V可以包括三轮或者四轮车辆、摩托车等两轮车辆、工程机械、摩托化自行车、自行车以及沿线路行驶的火车等。
图1a的车辆V具备GPS模块,可以从至少一个GPS(Global Position System:全球定位系统)卫星接收包括导航数据(Navigation Data)在内的卫星信号。车辆V基于卫星信号,可以获取基于GPS的车辆V的当前位置以及车辆V的行进方向等。
并且,图1a的车辆V可以预先存储精密地图。其中,精密地图可以表示为了实现安全且精确的车辆V控制而具有较高的精确性,并且除了道路的平面位置之外,还包括对于高度、斜度、曲率等的信息的地图。
并且,精密地图是至少区分显示车道线的地图,另外,可以包括指示牌、红绿灯、护栏等道路设施等。
精密地图以通过激光扫描仪等扫描道路从而获得的多个点的集合、即点云构成,构成点云的各个点可以具有基准坐标系上的三维空间坐标。通过噪声滤波器对所获取的点云进行滤波,得到有意义的数据,之后对各个点云标记地标(land mark),从而可以构建精密地图。
其中,基准坐标系是指不依赖于装置的正交坐标系,可以包括世界坐标系(WorldCoordinate)。
并且,除了车辆V之外,精密地图还可以存储在后述的车道线信息检测装置100中。
而且,图1a的车辆V中可以搭载有先进驾驶辅助系统(ADAS:Advanced DriverAssistance System)。其中,先进驾驶辅助系统可以表示为了减轻驾驶员的负担并提高方便性从而提供车辆V状态、驾驶员状态、周围环境信息等行驶环境信息或者主动控制车辆V的系统。
例如,车辆V中可以搭载有车道偏离预警系统(LDWS:Lane Departure WarningSystem)以及车道保持辅助系统(LKAS:Lane Keeping Assist System)中的至少一个。需要说明的是,搭载于车辆V的先进驾驶辅助系统并不限定于上述示例。
搭载于车辆V的先进驾驶辅助系统可以包括用于感应车辆V的行驶环境的感应单元。根据一实施例的感应单元可以包括向车辆V周围照射脉冲并接收从位于对应方向的物体反射的回波脉冲从而感应行驶环境的雷达(Radar)、向车辆V周围照射激光并接收从位于对应方向的物体反射的激光的激光雷达(LiDAR)、以及/或者向车辆V周围照射超声波并接收从位于对应方向的物体反射的回波超声波的超声波传感器等。
并且,先进驾驶辅助系统可以包括摄像头C作为感应单元。摄像头C可以设置为朝向车辆V的前方、侧方以及/或者后方,拍摄对应方向的图像。所拍摄的图像通过图像处理过程,可以成为除了获取车辆V周围的物体之外还获取车道线或指示牌等信息的基础。
为了便于说明,下面以摄像头C设置为朝向车辆V的前方从而获取车辆的前方图像的情况为前提进行说明。
另一方面,车辆V可以将通过摄像头C获取的图像信息和按照车辆V内部模块之间的通信方式、即CAN(Controller Area Network)通信方式传输的车轮旋转信息、偏航角速度(Yaw Rate)信息等CAN DATA融合后利用于车辆V控制。这时,通过摄像头C获取的图像可以基于摄像头坐标系,与此不同地CAN DATA可以基于车辆坐标系。
图2是根据一实施例的车辆V的简要平面图,例示出了车辆V的坐标系和设置于车辆V的摄像头C的坐标系。参照图2,车辆V可以具有以OV为原点、由车辆V的行进方向的XV轴、垂直于地面的方向的ZV轴以及与XV轴以及ZV轴垂直的YV轴构成的车辆坐标系。相反,设置于车辆V的摄像头C可以具有以OC为原点、由根据设置位置以及姿态角确定的XC轴、YC轴、ZC轴构成的摄像头坐标系。为了融合这样的不同的坐标系上的两个信息,需要统一坐标系,将其称为摄像头C的标定(CAMERA CALIBRATION)。
为此,在进行车辆V行驶之前,预先可以进行摄像头C标定。具体地,利用设置于车辆V的摄像头C获取对于校正用识别图案的图像,利用该图像可以手动获取摄像头C被安装的角度和位置。作为另外一例,在车辆V行驶过程中,通过摄像头C识别车道线,基于识别到的车道线,确认消失点的位置,从而可以获取摄像头C的姿态角。
与此不同地,还可以在车道线信息检测系统1中的车道线信息检测装置100实时进行摄像头C的标定。在后面说明这一点。
再次参照图1a,根据一实施例的车道线信息检测装置100可以利用从车辆V接收的信息来估计车辆V的位置信息,可以基于估计的车辆V的位置信息来获取车辆V的行驶车道线信息。其中,位置信息可以包括位置以及姿态角,行驶车道线信息可以包括检测到的行驶车道线的曲率微分值、曲率、方向以及偏移(Offset)值。
为了获取行驶车道线信息,车道线信息检测装置100可以以公知的各种通信方法与车辆V进行通行,从而交换信息。根据一实施例的车道线信息检测装置100可以采用CDMA、GSM、W-CDMA、TD-SCDMA、WiBro、LTE、EPC等公知的通信方法经由基站与车辆V进行通信。另外,根据另一实施例的车道线信息检测装置100还可以采用无线局域网(Wireless LAN)、无线保真(Wi-Fi)、蓝牙(Bluetooth)、物联网(Zigbee)、WFD(Wi-Fi Direct:无线网络直接联结)、UWB(Ultra wideband:超宽带)、红外线通讯(IrDA:Infrared Data Association)、BLE(Bluetooth Low Energy:低功耗蓝牙)、NFC(Near Field Communication:近场通信)等通信方法,在预定距离之内,与车辆V进行通信。需要说明的是,通信部与车辆V进行通信的方法并不限定于上述的实施例。
车道线信息检测装置100可以利用从车辆V接收的信息,获取基于精密地图的第一行驶车道线信息和基于车辆的前方图像的第二行驶车道线信息,以车辆坐标系为基准将其融合,从而获取最终行驶车道线信息。
为此,车道线信息检测装置100可以包括获取车辆的估计位置信息的车辆位置估计部110、获取车辆的行驶车道线信息的行驶车道线信息获取部120、将所获取的行驶车道线信息根据车辆坐标系进行转换的坐标系转换部130以及对转换的行驶车道线信息进行融合来获取最终行驶车道线信息的车道线融合部140。
另一方面,在图1a中例示出了车道线信息检测装置100与车辆V分开设置从而构成车道线信息检测系统1的情况,但是,与此不同地还可以包括车道线信息检测装置100作为车辆V的一个结构。
参照图1b,根据另一实施例的车道线信息检测系统1可以以包括车道线信息检测装置100的车辆V构成。需要说明的是,除了设置车道线信息检测装置100的方式之外,图1a的车道线信息检测系统1与图1b的车道线信息检测系统1的动作方式相同。
另一方面,作为用于检测车道线信息的方法的一实施例,可以利用车辆V的前方图像。例如,如果通过设置于车辆V的摄像头C获取前方图像,则将前方图像的中心车道判断为行驶车道,可以将行驶车道的两侧车道线确定为行驶车道线。可以根据车辆坐标系分别转换所确定的行驶车道线,利用其结果获取行驶车道线信息。
参照图3,在通过摄像头C拍摄的前方图像中将中央的车道作为行驶车道时,位于行驶车道的左侧以及右侧的两个车道线可以成为行驶车道线。在图3中例示出了位于行驶车道的左侧的中央线是左侧行驶车道线。
但是,在前方图像中,可以得知行驶车道右侧的车道线、即虚线表示的区域内不存在右侧行驶车道线。作为这种现象的原因,可以例举在通过摄像头C拍摄前方图像的过程中由于天气等环境原因未拍到行驶车道线的一部分或者在实际道路上行驶车道线的一部分被抹掉的情况。
如图3所示,由于存在前方图像上不包括行驶车道线的全部或者一部分的可能性,所以仅利用前方图像获取的行驶车道线信息的准确性有可能较低。因此,根据本发明一实施例的车道线信息检测装置100利用前方图像的同时利用精密地图,从而能够获取更加准确的行驶车道线信息。
再次参照图1a,车辆位置估计部110可以获取车辆V的估计位置信息。为此,车辆位置估计部110将通过摄像头C拍摄的前方图像与精密地图上的地标进行匹配,从而可以估计车辆V的位置信息。为了匹配前方图像与地图,需要准确的摄像头C的位置信息,如上所述,车辆V的坐标系和摄像头C的坐标系有可能被设置为不同,所以需要进行坐标系的转换。并且,如高层建筑密集地区那样基于GPS的车辆V的初始位置信息有可能不准确,所以在估计车辆V的位置之前,首先需要进行摄像头C的标定。
车辆位置估计部110可以利用基于GPS的车辆V的初始位置信息进行摄像头C的标定。首先,车辆位置估计部110可以获取基于卫星信号确定的基于GPS的车辆V的初始位置信息。根据一实施例的车辆位置估计部110可以从车辆V接收基于GPS的车辆V的包括初始位置以及初始姿态角的初始位置信息。与此不同地,根据另一实施例的车辆位置估计部110还可以从车辆V仅接收基于GPS的车辆初始位置,并且利用该初始位置,可以获取包括车辆V的初始姿态角的初始位置信息。
当从车辆V仅接收基于GPS的车辆V的初始位置的情况下,车辆位置估计部110可以利用接收到的基于GPS的车辆V的初始位置,获取车辆V的初始姿态角。具体地,摄像头C的车辆位置估计部110可以基于连续接收到的基于GPS的车辆V的初始位置,获取表示车辆V的行进方向的XV轴,获取与根据精密地图上的车道线确定的地面区域垂直的方向的ZV轴,之后相对于ZV轴进行与XV轴的向量积(Cross Product),从而获取YV轴。而且考虑到由于卫星信号内的误差而上述获取的XV轴和YV轴有可能不垂直,车辆位置估计部110相对于ZV轴进行与YV轴的向量积(Cross Product),从而可以校正XV轴。
由此,车辆位置估计部110可以获取作为摄像头C初始位置的三维坐标以及作为初始姿态角的三维坐标轴。
其次,车辆位置估计部110在精密地图可以根据基于GPS的车辆V的初始位置信息确定第一关注区域。具体地,车辆位置估计部110可以以基于GPS的车辆V的初始位置信息为基准,将第一半径内的区域确定为第一关注区域。
在确定第一关注区域之后,车辆V的车辆位置估计部110可以将对于存在于第一关注区域内的车道线的第一地标与通过摄像头C拍摄的前方图像进行匹配,从而获取摄像头C的初始姿态角。具体地,车辆位置估计部110可以根据数学式1获取基于摄像头C的初始姿态角的旋转矩阵R。
【数学式1】
其中,作为数学式1的解的S*可以表示由对于摄像头C的初始姿态角的旋转矩阵R和对于初始位置的移动矩阵T构成的初始位置信息,Zk表示从图像检测到的车道线的坐标,Pk表示对应于Zk的精密地图上的地标的坐标,Czk和Cpk分别表示示出对于Zk和Pk的误差的协方差,H表示对于函数h()的偏微分(Jacobian)。并且,函数h表示将精密地图上的地标坐标投影到图像的函数,可以根据数学式2定义。
【数学式2】
h(T,R,P)=K(R×P+T)
其中,T可以表示对于摄像头C的初始位置的移动矩阵,R表示对于摄像头C的初始姿态角的旋转矩阵,P表示精密地图上的地标的坐标,K表示用于将基于摄像头C坐标系的坐标投影到通过摄像头C拍摄的图像的摄像头C内部参数矩阵。
为了求出数学式1的解,车辆位置估计部110可以选择公知的算法中的至少一个,例如可以利用高斯牛顿(Gauss Newton)算法或者列文伯格-马夸尔特(Levenberg-Marquardt)算法。
并且,车辆位置估计部110通过将除了车道线之外的第二地标与图像进行匹配,从而可以求出对于摄像头C的初始位置的移动矩阵T。具体地,车辆位置估计部110在精密地图可以根据基于GPS的车辆V的初始位置信息确定第二关注区域。具体地,车辆位置估计部110可以以基于GPS的车辆V的初始位置信息为基准,将第一半径以上的第二半径以内的区域确定为第二关注区域。这是为了因获取了摄像头C初始位置信息中的初始姿态角,所以通过利用更广范围内的地标,准确地获取摄像头C初始位置。
其次,车辆位置估计部110可以以摄像头C的初始姿态角为基准,将存在于第二关注区域内的除了车道线之外的第二地标与图像进行匹配,从而获取摄像头C的初始位置。具体地,车辆位置估计部110将之前获取的对于摄像头C初始姿态角的旋转矩阵R代入数学式1进行运算,从而可以获取对于摄像头C初始位置的移动矩阵T。
这时,可以获取与对于一个摄像头C初始姿态角的旋转矩阵R对应的对于多个摄像头C初始位置的移动矩阵T。
这样获取的包括摄像头C初始位置以及初始姿态角的初始位置信息可以用作后述的用于估计摄像头C位置信息的输入值。
在获取了摄像头C初始位置信息时,车辆位置估计部110可以将摄像头C的初始位置作为输入值来获取摄像头C的估计位置信息。首先,车辆位置估计部110可以在摄像头C的初始位置信息周围采样多个候选位置信息。具体地,车辆位置估计部110可以以摄像头C初始位置信息作为平均,利用通过预先规定的协方差设定误差建模的高斯概率模型进行采样。这时,高斯概率模型可以定义为姿态角具有三自由度、位置具有三自由度的至少六维。
如果摄像头C的初始位置信息为多个,则车辆位置估计部110可以针对每一个摄像头C初始位置信息,根据高斯概率模型进行采样。
其次,车辆位置估计部110可以利用粒子滤波器(Particle Filter)获取摄像头C的估计位置信息。具体地,车辆位置估计部110可以在多个候选位置信息反映车辆V的行驶信息。这时,车辆位置估计部110可以根据数学式3进行处理。
【数学式3】
其中,矩阵[x(k);y(k);θ(k)]可以表示在k时间点的车辆V的位置以及行进方向,Sr表示基于车辆V的右侧车轮速度的移动距离,Sl表示基于车辆V的左侧车轮速度的移动距离。
为此,车辆位置估计部110可以从车辆V接收包括车轮速度信息以及偏航角速度信息的行驶信息。
其次,车辆位置估计部110基于对应于多个候选位置信息每一个的精密地图的地标与图像之间的匹配误差,可以为多个候选位置信息每一个赋予加权值。
为此,车辆位置估计部110可以利用提取出地标的前方图像。这时,车辆位置估计部110可以排除反映行驶信息的结果脱离道路的候选位置信息或者存在于与车辆V的行进方向相反方向的道路上的候选位置信息。
在从前方图像提取出第一地标以及第二地标时,车辆位置估计部110可以将与多个候选位置信息每一个对应的精密地图的地标与图像进行匹配。这时,车辆位置估计部110为了匹配地标而利用数学式2。
车辆位置估计部110确认基于匹配结果的匹配误差,可以获取对应于匹配误差的加权值。该处理可以根据数学式4进行。
【数学式4】
其中,Gσ可以表示加权值,(Δx,Δy)表示图像中的对于x和y的误差,σ表示标准偏差。
其次,车辆位置估计部110为对应的候选位置信息赋予对应的加权值,从而可以反映匹配误差。
在赋予加权值之后,车辆位置估计部110可以利用被赋予加权值的多个候选位置信息重新采样多个候选位置信息。由于基于赋予加权值的结果重新进行采样,所以多个候选位置信息可以收敛于匹配误差较小的候选位置信息周围。
在结束采样之后,车辆位置估计部110可以确认重新采样的多个候选位置信息的标准偏差是否在基准标准偏差以下。其中,基准标准偏差可以表示利用多个候选位置可以获取摄像头C估计位置信息的最大标准偏差。
如果重新采样的多个候选位置信息的标准偏差在基准标准偏差以下,则车辆位置估计部110可以获取重新采样的多个候选位置信息的平均值作为摄像头C的估计位置信息。相反,如果重新采样的多个候选位置信息的标准偏差大于基准标准偏差,则车辆位置估计部110在重新采样的多个候选位置信息反映车辆V的行驶信息,之后可以反复进行上述过程。
如果获取了摄像头C的估计位置信息,则车辆位置估计部110可以基于摄像头C的估计位置信息获取车辆V的估计位置信息。这时,车辆位置估计部110可以利用移动矩阵T以及旋转矩阵R来获取车辆V估计位置信息。
再次参照图1a,行驶车道线信息获取部120在精密地图上匹配车辆V的估计位置,从而可以确定车辆V的行驶车道。并且,行驶车道线信息获取部120可以将所确认的行驶车道两侧的车道线判断为第一行驶车道线,并且获取第一行驶车道线信息。
并且,行驶车道线信息获取部120可以从通过摄像头C拍摄的车辆V的前方图像确认车辆V的行驶车道。具体地,车辆位置估计部110可以基于车辆V内设置摄像头C的位置,确定车辆V的行驶车道。如果摄像头C设置在车辆V的左右宽度方向的中央时,车辆位置估计部110可以将前方图像的中心所在车道确定为车辆V的行驶车道。如果确定了行驶车道,则车辆位置估计部110可以将行驶车道两侧的车道线判断为第二行驶车道线,并且获取第二行驶车道线信息。
如果获取了第一行驶车道线信息以及第二行驶车道线信息,则坐标系转换部130可以根据车辆坐标系转换第一行驶车道线信息以及第二行驶车道线信息。具体地,坐标系转换部130可以基于车辆V的估计位置信息,转换第一行驶车道线信息以及第二行驶车道线信息。
第一行驶车道线信息是从精密地图获取的,所以第一行驶车道线信息的坐标系可以基于精密地图的坐标系、即基准坐标系。因此,坐标系转换部130可以利用车辆V的估计位置信息中的位置所确定的移动矩阵和姿态角所确定的旋转矩阵,以车辆坐标系为基准,转换第一行驶车道线信息。
另一方面,第二行驶车道线信息是从前方图像获取的,所以第二行驶车道线信息可以基于对于前方图像的图像坐标系。因此,坐标系转换部130需要基于三维的车辆坐标系,对基于图像坐标系的第二行驶车道线信息进行转换。
为此,根据一实施例的坐标系转换部130将行驶车道线所在的地面假设为平面,利用车辆V的估计位置信息,可以获取对应于前方图像的顶视图(Top View)图像中的第二行驶车道线信息。其中,顶视图图像可以表示从假设为平面的地面的上部向垂直于地面的方向观察的图像。
根据一实施例的坐标系转换部130可以根据数学式5获取顶视图图像中的第二行驶车道线信息。
【数学式5】
其中,mtop-view可以表示将基于图像坐标系的前方图像的坐标m转换为顶视图图像的坐标的结果,K1表示用于将基于估计摄像头C坐标系的坐标投影到通过摄像头C拍摄的图像的摄像头C内部参数矩阵(3X3),R1表示对于摄像头C的估计姿态角的旋转矩阵。在数学式5中,坐标系转换部130可以将前方图像中的第二行驶车道线信息代入m,从而获取顶视图图像中的第二行驶车道线信息。
其次,坐标系转换部130可以将顶视图图像中的第二行驶车道线信息根据车辆坐标系进行转换。具体地,在掌握车辆V内设置摄像头C的位置的前提下,坐标系转换部130可以基于顶视图图像中的第二行驶车道线与车辆V的距离,根据车辆坐标系转换顶视图图像中的第二行驶车道线信息。
与此不同,考虑到行驶车道线所在的地面的斜度,根据另一实施例的坐标系转换部130可以根据车辆坐标系转换第二行驶车道线信息。下面,参照图4以及5,说明考虑行驶车道线所在的地面的斜度,根据车辆坐标系对第二行驶车道线信息进行转换的实施例。
图4是用于说明根据另一实施例的从摄像头朝行驶车道线方向的直线的图,图5是用于说明根据另一实施例的坐标系转换部将第二行驶车道线信息根据车辆坐标系进行转换的方法的图,图6是例示出根据一实施例的在精密地图上将第二行驶车道线信息进行匹配的结果的图,图7是例示出根据一实施例的在精密地图上将第一行驶车道线信息以及第二行驶车道线信息进行匹配的结果的图。
设置于车辆V的摄像头C通过使被拍摄体成像于与被拍摄体的直线路径上,从而可以获取前方图像。因此,坐标系转换部130求出经过摄像头C和基于前方图像的图像坐标系的第二行驶车道线信息的直线,可以获取该直线与地面接触的点作为根据基准坐标系进行转换后的第二行驶车道线信息。
这时,如图4所示,当地面不是平面时,坐标系转换部130需要考虑地面的斜度。因此,坐标系转换部130在精密地图上可以将摄像头C的估计位置信息周围方格化为多个平面。其次,坐标系转换部130可以求出多个平面每一个的平面方程式,平面方程式基于数学式6。
【数学式6】
ax+by+cz+d=0
其中,a、b、c、d可以表示平面方程式的系数。坐标系转换部130将存在于每一个平面内的至少四个点的位置信息、即构成点云的至少四个点的三维位置坐标x、y、z代入数学式6,从而可以求出平面方程式的系数a、b、c、d。另外,如果在被方格化的多个平面中存在包含少于三个的点的位置信息的平面,则可以利用包含至少四个点的位置信息的相邻平面的平面方程式的系数。
其次,坐标系转换部130可以利用车辆V的估计位置信息,获取从摄像头C坐标系的原点朝向前方图像内的第二行驶车道线信息的向量。参照图5,当前方图像I内的第二行驶车道线中存在一个像素Pimg时,坐标系转换部130可以求出经过Pimg和摄像头C坐标系的原点的向量。具体地,坐标系转换部130根据数学式7,可以求出经过Pimg和摄像头C坐标系的原点的向量Pray。
【数学式7】
其中,Pray可以表示被定义为矩阵[x,y,z]T的向量,R1表示对于摄像头C的估计姿态角的旋转矩阵,K表示用于将基于估计摄像头C坐标系的坐标投影到通过摄像头C拍摄的图像的摄像头C内部参数矩阵(3X3),m表示基于图像坐标系的前方图像I的Pimg坐标,T1表示对于摄像头C的估计位置的移动矩阵。
在图4以及图5中用虚线箭头示出了这样求出的Pray。
求出向量Pray之后,坐标系转换部130求出基于向量Pray的直线的方程式,可以求出所求出的直线的方程式与对于被方格化的多个平面的平面的方程式之间的交点Pw。上述求出的直线的方程式以及平面的方程式基于基准坐标系,所以交点Pw也可以基于基准坐标系。
因此,这样求出的交点Pw可以是与前方图像I的Pimg对应的基于基准坐标系的第二行驶车道线信息。
最后,坐标系转换部130可以基于车辆V的估计位置信息,根据车辆坐标系,对基于基准坐标系的第二行驶车道线信息进行转换。具体地,坐标系转换部130可以利用车辆V的估计位置信息中的位置所对应的移动矩阵以及姿态角所对应的旋转矩阵,对基于基准坐标系的第二行驶车道线信息进行转换。
在图6中虚线表示映射到精密地图上的第二行驶车道线信息。在图6的情况下,所获取的第二行驶车道线信息不包括右侧的行驶车道线信息。这样,有时通过前方图像获取的第二行驶车道线信息与实际行驶车道线不同。因此,需要将从精密地图获取的第一行驶车道线信息与第二行驶车道线信息融合。
参照图7,虚线表示映射到精密地图上的第二行驶车道线信息,粗的直线表示从精密地图获取的第一行驶车道线信息。这样,通过将两个行驶车道线信息融合,从而可以检测出更加精确的行驶车道线。
再次参照图1a,车道线融合部140可以将根据车辆坐标系以及图像坐标系中的至少一个进行转换的第一行驶车道线信息以及第二行驶车道线信息融合,从而获取最终行驶车道线信息。下面,参照图8a、8b、8c、8d、8e、8f以及8g,详细说明将根据车辆坐标系以及图像坐标系中的至少一个进行转换的第一行驶车道线信息以及第二行驶车道线信息融合的方法。
图8a、8b、8c、8d、8e、8f以及8g是用于说明根据一实施例的车道线融合部140的动作的图。虚线表示根据车辆坐标系进行转换的第二行驶车道线信息,粗的直线相当于根据车辆坐标系进行转换的第一行驶车道线信息。
下面,首先参照图8a、8b以及8c,说明基于根据车辆坐标系进行转换的第一行驶车道线信息以及第二行驶车道线信息来获取最终行驶车道线信息的过程。参照图8a、8b以及8c,根据一实施例的车道线融合部140可以将根据车辆坐标系进行转换的第一行驶车道线信息以及第二行驶车道线信息融合,从而获取最终行驶车道线信息。为此,首先,车道线融合部140可以确认根据车辆坐标系进行转换的第一行驶车道线信息与第二行驶车道线信息的重叠区域。在确认到重叠区域时,根据一实施例的车道线融合部140针对重叠区域可以选择根据车辆坐标系进行转换的第一行驶车道线信息和第二行驶车道线信息中的任意一个,从而可以获取融合行驶车道线信息。
例如,在重叠区域中,车道线融合部140可以在从车辆V起基准距离以内时选择第二行驶车道线信息,当超过基准距离时可以选择第一行驶车道线信息。这时,基准距离可以表示前方图像的可信度高于精密地图的可信度的最大距离。
通常,前方图像中存在对于近距离区域的准确性较高而在远距离区域中准确性下降的倾向。因此,车道线融合部140可以在根据基准距离确定的近距离区域中选择根据车辆坐标系进行转换的第二行驶车道线信息,在根据基准距离确定的远距离区域中选择根据车辆坐标系进行转换的第一行驶车道线信息。
相反,根据另一实施例的车道线融合部140对于重叠区域可以获取包括根据车辆坐标系进行转换的第一行驶车道线信息以及第二行驶车道线信息的融合行驶车道线信息。
图8a例示出了通过车道线融合部140获取的融合行驶车道线信息。如果获取了融合行驶车道线信息,则车道线融合部140可以以预先设定的间隔对融合行驶车道线信息进行采样。图8b例示出了采样的融合行驶车道线信息。
其次,车道线融合部140对于采样的融合行驶车道线信息,以多项函数拟合(Fitting),从而可以获取最终行驶车道线信息。这时,车道线融合部140对于采样的融合行驶车道线信息可以进行曲线拟合(Curve Fitting),可以基于数学式8。
【数学式8】
y=ax3+bx2+cx+d
车道线融合部140通过将采样的融合行驶车道线信息针对数学式8进行回归分析,从而可以获取一个直线或者曲线作为最终行驶车道线。在图8c中连接多个点的直线例示出所获取的最终行驶车道线。
并且,车道线融合部140根据作为最终行驶车道线获取的多项函数的系数a,可以获取包括最终行驶车道线的曲率微分值、曲率、方向值以及偏移值的最终行驶车道线信息。具体地,车道线融合部140可以获取6a作为最终行驶车道线的曲率微分值,获取2b作为曲率,获取arctan(c)作为方向值,获取d作为偏移值。
与此不同,根据另一实施例的车道线融合部140还可以融合根据图像坐标系进行转换的第一行驶车道线信息以及第二行驶车道线信息来获取最终行驶车道线信息。下面,参照图8d、8e、8f以及8g,说明融合根据图像坐标系进行转换的第一行驶车道线信息以及第二行驶车道线信息来获取最终行驶车道线信息的方法。
参照图8d,所获取的第二行驶车道线信息有可能仅包括近距离区域的一部分行驶车道线信息。即,由于周围车辆等,通过前方图像获取的第二行驶车道线信息有可能不包括对于远距离区域的行驶车道线信息。为了解决该问题,根据另一实施例的车道线融合部140可以根据图像坐标系对从精密地图获取的第一行驶车道线信息进行转换,并且将其与第二行驶车道线信息融合,从而获取最终行驶车道线信息。
为此,坐标系转换部130可以利用车辆V的估计位置信息,在精密地图上将第一行驶车道线信息转换为图像坐标系。具体地,坐标系转换部130可以根据数学式9求出根据对于前方图像的图像坐标系对于精密地图上的三维车道线的点Pw进行转换后的m’。
【数学式9】
m′=K(R1Pw+T1)
其中,m’可以表示根据图像坐标系对于精密地图上的三维车道线的点Pw进行转换后的点,K表示用于将基于估计摄像头C坐标系的坐标投影到通过摄像头C拍摄的图像的摄像头C内部参数矩阵(3X3),R1表示对于摄像头C的估计姿态角的旋转矩阵,T1表示对于摄像头C的估计位置的移动矩阵。
通过上述过程,根据图像坐标系对第一行驶车道线信息进行转换,并映射到前方图像上,从而车道线融合部140可以获取根据图像坐标系进行转换的第一行驶车道线信息和第二行驶车道线信息融合在前方图像内的融合行驶车道线信息。图8e例示出了在实际前方图像内获取的融合行驶车道线信息。
这时,针对重叠区域,车道线融合部140可以获取包括根据图像坐标系进行转换的第一行驶车道线信息和从前方图像检测到的第二行驶车道线信息的融合行驶车道线信息,针对重叠区域,还可以仅利用第一行驶车道线信息或者第二行驶车道线信息。
并且,通常,前方图像中存在对于近距离区域的准确性较高而在远距离区域中准确性下降的倾向。鉴于该问题,车道线融合部140可以在根据基准距离确定的近距离区域内选择从图像检测到的第二行驶车道线信息,在根据基准距离确定的远距离区域内可以选择根据图像坐标系进行转换的第一行驶车道线信息。
在获取融合行驶车道线信息之后,车道线融合部140通过将采样的融合行驶车道线信息针对数学式8进行回归分析,从而可以获取一个直线或者曲线作为最终行驶车道线。如果如图8f所示地获取了融合行驶车道线信息,则车道线融合部140可以获取如图8g的直线所示的最终行驶车道线信息。
并且,车道线融合部140可以对于在图像坐标系中通过回归分析获取的最终行驶车道线信息再次进行采样,之后根据数学式7,求出经过摄像头C坐标系的原点的向量Pray,求出基于向量Pray的直线的方程式,求出所求出的直线的方程式与对于被方格化的多个平面的平面的方程式之间的交点Pw。这样求出的交点Pw可以是根据基准坐标系对以图像坐标系为基准通过回归分析融合的融合行驶车道线信息进行转换的信息。
最后,坐标系转换部130可以基于车辆V的估计位置信息,根据车辆坐标系,对基于基准坐标系的融合行驶车道线信息进行转换。具体地,坐标系转换部130可以利用车辆V的估计位置信息中的位置所对应的移动矩阵以及姿态角所对应的旋转矩阵,对基于基准坐标系的融合的车道线信息进行转换。
搭载于车辆V的先进驾驶辅助系统(例如,车道偏离预警系统、车道保持辅助系统等)将根据车辆坐标系的值作为输入值,所以上述的车道线信息检测装置100将根据车辆坐标系的最终行驶车道线信息提供给先进驾驶辅助系统,从而能够提供可实现更加精确的车辆V控制的环境。
图9是根据一实施例的车道线信息检测方法的流程图。
首先,车道线信息检测装置100可以从精密地图获取与设置于车辆V的摄像头C的估计位置信息对应的第一行驶车道线信息(S100)。为此,车道线信息检测装置100可以利用车辆V的基于GPS的位置以及精密地图来获取车辆V的估计位置信息。这时,第一行驶车道线信息可以基于精密地图的坐标系、即基准坐标系。
其次,车道线信息检测装置100可以从通过设置于车辆V的摄像头C拍摄的前方图像获取第二行驶车道线信息(S110)。这时,第二行驶车道线信息可以基于前方图像的坐标系、即图像坐标系。
如果获取了第一行驶车道线信息以及第二行驶车道线信息,则车道线信息检测装置100可以根据车辆坐标系对第一行驶车道线信息以及第二行驶车道线信息进行转换(S120)。具体地,车道线信息检测装置100可以利用车辆V的估计位置信息,对第一行驶车道线信息以及第二行驶车道线信息进行转换。
最后,车道线信息检测装置100可以对转换的第一行驶车道线信息以及转换的第二行驶车道线信息进行融合来获取最终行驶车道线信息(S130)。具体地,车道线信息检测装置100选择性或重叠地对转换的第一行驶车道线信息和转换的第二行驶车道线信息进行融合,拟合融合结果,从而可以获取最终行驶车道线信息。
上述的车道线信息检测装置、方法以及存储被编程为执行该方法的计算机程序的计算机可读记录介质利用车辆的前方图像之外,还利用精密地图,从而能够检测出更加准确的行驶车道线信息。
并且,将所检测到的行驶车道线信息用作车道偏离预警系统和车道保持辅助系统的输入值,从而可以实现更加精确的车辆控制。
另一方面,上述的根据一实施例的车道线信息检测方法所包括的各个步骤可以在存储被编程为执行这样的步骤的计算机程序的计算机可读记录介质中实现。
以上说明只是示例性示出了本发明的技术思想,在不脱离本发明的实质性品质的范围内本发明所属技术领域的技术人员可以带来各种修改以及变形。因此,本发明所公开的多个实施例用于说明本发明,并不是限定本发明的技术思想,本发明的保护范围并不限定于这些实施例。应该基于权利要求书来解释本发明的保护范围,与其等同范围内的所有技术思想均包括在本发明的保护范围内。
工业上的可利用性
根据一实施例,上述的车道线信息检测装置、方法以及存储被编程为执行该方法的计算机程序的计算机可读记录介质可以利用于家庭内或者工业现场等各种领域,所以具有工业上的可利用性。
Claims (11)
1.一种车道线信息检测方法,包括:
从精密地图获取与车辆的估计位置信息对应的第一行驶车道线信息的步骤;
从通过设置在上述车辆上的摄像头拍摄的上述车辆的前方图像获取第二行驶车道线信息的步骤;
根据同一坐标系对上述第一行驶车道线信息以及上述第二行驶车道线信息进行转换的步骤;以及
对上述转换的第一行驶车道线信息以及上述转换的第二行驶车道线信息进行融合来获取最终行驶车道线信息的步骤,
在根据同一坐标系对上述第一行驶车道线信息以及上述第二行驶车道线信息进行转换的步骤中,
利用上述车辆的估计位置信息,根据车辆坐标系,对上述第一行驶车道线信息以及上述第二行驶车道线信息进行转换,
根据车辆坐标系对上述第二行驶车道线信息进行转换的步骤包括:
在上述精密地图上,将上述摄像头的估计位置信息的周围方格化为多个平面的步骤;
利用上述车辆的估计位置信息,获取从摄像头坐标系的原点朝向上述前方图像内的上述第二行驶车道线信息的向量的步骤;
基于根据上述获取的向量及多个上述方格化的平面确定的直线,获取该直线与地面接触的点作为基于基准坐标系进行转换后的第二行驶车道线信息的步骤;以及
利用上述车辆的估计位置信息,将基于上述基准坐标系的第二行驶车道线信息转换为基于上述车辆坐标系的第二行驶车道线信息。
2.根据权利要求1所述的车道线信息检测方法,其中,
从精密地图获取上述第一行驶车道线信息的步骤包括:
基于与基于上述摄像头的初始位置采样的多个候选位置信息每一个对应的上述精密地图的地标和上述前方图像之间的匹配误差,获取上述摄像头的估计位置信息的步骤;
基于上述摄像头的估计位置信息,获取上述车辆的估计位置信息的步骤;
基于上述车辆的估计位置信息,确定上述车辆的行驶车道的步骤;以及
从上述精密地图获取上述确定的行驶车道两侧的上述第一行驶车道线信息的步骤。
3.根据权利要求1所述的车道线信息检测方法,其中,
基于基准坐标系获取上述第一行驶车道线信息,
基于对于上述前方图像的图像坐标系获取上述第二行驶车道线信息。
4.根据权利要求1所述的车道线信息检测方法,其中,
根据车辆坐标系对上述第二行驶车道线信息进行转换的步骤包括:
基于上述车辆的估计位置信息,获取与上述前方图像对应的顶视图图像中的上述第二行驶车道线信息的步骤;以及
根据上述车辆坐标系,对上述顶视图图像中的上述第二行驶车道线信息进行转换的步骤。
5.根据权利要求1所述的车道线信息检测方法,其中,
在一个平面内能够获取与至少四个点相关的位置信息的平面被分类为第一平面组,在上述一个平面内能够获取与三个以下的点相关的位置信息的平面被分类为第二平面组,
在上述精密地图上将上述摄像头的估计位置信息的周围方格化为多个平面的步骤包括:
基于上述第一平面组的第一平面上的至少四个点的位置信息,确定与上述第一平面组的上述第一平面相关的平面方程式的步骤;以及
基于属于上述第一平面组且与上述第二平面组的第二平面相邻的平面的平面方程式,确定与上述第二平面组的上述第二平面相关的平面方程式的步骤。
6.根据权利要求1所述的车道线信息检测方法,其中,
获取上述最终行驶车道线信息的步骤包括:
对上述转换的第一行驶车道线信息以及上述转换的第二行驶车道线信息进行融合来获取融合行驶车道线信息的步骤;
对上述获取的融合行驶车道线信息进行采样的步骤;以及
对于上述采样的融合行驶车道线信息,以多项函数进行拟合,获取上述最终行驶车道线信息的步骤。
7.根据权利要求6所述的车道线信息检测方法,其中,
获取上述融合行驶车道线信息的步骤包括:
确认上述转换的第一行驶车道线信息以及上述转换的第二行驶车道线信息的重叠区域的步骤;以及
基于上述车辆的估计位置信息,在上述重叠区域中选择上述转换的第一行驶车道线信息以及上述转换的第二行驶车道线信息中的任意一个来获取上述融合行驶车道线信息的步骤。
8.根据权利要求1所述的车道线信息检测方法,其中,
在根据同一坐标系对上述第一行驶车道线信息以及上述第二行驶车道线信息进行转换的步骤中,
根据对于上述前方图像的图像坐标系对上述第一行驶车道线信息进行转换。
9.根据权利要求8所述的车道线信息检测方法,其中,
获取上述最终行驶车道线信息的步骤包括:
将根据上述图像坐标系进行转换的上述第一行驶车道线信息映射到上述前方图像的步骤;
确认上述前方图像上的上述第一行驶车道线信息与上述第二行驶车道线信息的重叠区域的步骤;
对于上述重叠区域,基于基准距离,选择上述第一行驶车道线信息以及上述第二行驶车道线中的任意一个来获取融合行驶车道线信息的步骤;以及
对上述融合行驶车道线信息进行拟合,获取上述最终行驶车道线信息的步骤。
10.一种计算机可读记录介质,其存储被编程为由处理器执行车道线信息检测方法的指令,其中,
上述车道线信息检测方法包括:
从精密地图获取与车辆的估计位置信息对应的第一行驶车道线信息的步骤;
从通过设置在上述车辆上的摄像头拍摄的上述车辆的前方图像获取第二行驶车道线信息的步骤;
根据同一坐标系对上述第一行驶车道线信息以及上述第二行驶车道线信息进行转换的步骤;以及
对上述转换的第一行驶车道线信息以及上述转换的第二行驶车道线信息进行融合来获取最终行驶车道线信息的步骤,
在根据同一坐标系对上述第一行驶车道线信息以及上述第二行驶车道线信息进行转换的步骤中,
利用上述车辆的估计位置信息,根据车辆坐标系,对上述第一行驶车道线信息以及上述第二行驶车道线信息进行转换,
根据车辆坐标系对上述第二行驶车道线信息进行转换的步骤包括:
在上述精密地图上,将上述摄像头的估计位置信息的周围方格化为多个平面的步骤;
利用上述车辆的估计位置信息,获取从摄像头坐标系的原点朝向上述前方图像内的上述第二行驶车道线信息的向量的步骤;
基于根据上述获取的向量及多个上述方格化的平面确定的直线,获取该直线与地面接触的点作为基于基准坐标系进行转换后的第二行驶车道线信息的步骤;以及
利用上述车辆的估计位置信息,将基于上述基准坐标系的第二行驶车道线信息转换为基于上述车辆坐标系的第二行驶车道线信息。
11.一种车道线信息检测装置,其包括:
行驶车道线信息获取部,从精密地图获取与车辆的估计位置信息对应的第一行驶车道线信息,从通过设置在上述车辆上的摄像头拍摄的上述车辆的前方图像获取第二行驶车道线信息;
坐标系转换部,根据同一坐标系对上述第一行驶车道线信息以及上述第二行驶车道线信息进行转换;以及
车道线融合部,对上述转换的第一行驶车道线信息以及上述转换的第二行驶车道线信息进行融合来获取最终行驶车道线信息,
上述坐标系转换部利用上述车辆的估计位置信息,根据车辆坐标系,对上述第一行驶车道线信息以及上述第二行驶车道线信息进行转换,
上述坐标系转换部在根据车辆坐标系对上述第二行驶车道线信息进行转换时,
在上述精密地图上,将上述摄像头的估计位置信息的周围方格化为多个平面,
利用上述车辆的估计位置信息,获取从摄像头坐标系的原点朝向上述前方图像内的上述第二行驶车道线信息的向量,
基于根据上述获取的向量及多个上述方格化的平面确定的直线,获取该直线与地面接触的点作为基于基准坐标系进行转换后的第二行驶车道线信息,
利用上述车辆的估计位置信息,将基于上述基准坐标系的第二行驶车道线信息转换为基于上述车辆坐标系的第二行驶车道线信息。
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR10-2018-0073259 | 2018-06-26 | ||
KR20180073259 | 2018-06-26 | ||
PCT/KR2019/006278 WO2020004817A1 (ko) | 2018-06-26 | 2019-05-24 | 차선 정보 검출 장치, 방법 및 이러한 방법을 수행하도록 프로그램된 컴퓨 프로그램을 저장하는 컴퓨터 판독가능한 기록매체 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112189225A CN112189225A (zh) | 2021-01-05 |
CN112189225B true CN112189225B (zh) | 2023-03-10 |
Family
ID=68987224
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201980035132.9A Active CN112189225B (zh) | 2018-06-26 | 2019-05-24 | 车道线信息检测装置、方法以及存储被编程为执行该方法的计算机程序的计算机可读记录介质 |
Country Status (4)
Country | Link |
---|---|
US (1) | US11321950B2 (zh) |
KR (1) | KR20200001471A (zh) |
CN (1) | CN112189225B (zh) |
WO (1) | WO2020004817A1 (zh) |
Families Citing this family (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112461257A (zh) * | 2019-09-09 | 2021-03-09 | 华为技术有限公司 | 一种车道线信息的确定方法及装置 |
DE102020202964A1 (de) * | 2020-03-09 | 2021-09-09 | Continental Automotive Gmbh | Die Erfindung betrifft ein Verfahren zur Erhöhung der Sicherheit von Fahrfunktionen. |
US11932245B2 (en) * | 2020-09-01 | 2024-03-19 | Toyota Motor Engineering & Manufacturing North America, Inc. | Systems and methods for improving path selection for automated driving |
KR20220068710A (ko) * | 2020-11-19 | 2022-05-26 | 삼성전자주식회사 | 차량 측위 방법 및 장치 |
KR102431904B1 (ko) * | 2020-12-15 | 2022-08-11 | 충북대학교 산학협력단 | 정밀지도를 이용한 라이다 센서 캘리브레이션 방법 |
US20220306119A1 (en) * | 2021-03-25 | 2022-09-29 | Ford Global Technologies, Llc | Location-based vehicle operation |
CN113378719B (zh) * | 2021-06-11 | 2024-04-05 | 北京清维如风科技有限公司 | 车道线的识别方法、装置、计算机设备和存储介质 |
CN113298026A (zh) * | 2021-06-15 | 2021-08-24 | 蔚来汽车科技(安徽)有限公司 | 车道线确定方法和系统、车辆以及存储介质 |
CN113386771A (zh) * | 2021-07-30 | 2021-09-14 | 蔚来汽车科技(安徽)有限公司 | 道路模型的生成方法及设备 |
CN114347991A (zh) * | 2022-02-07 | 2022-04-15 | 中国第一汽车股份有限公司 | 一种车辆的自动换道方法、装置、存储介质及车辆 |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2007108043A (ja) * | 2005-10-14 | 2007-04-26 | Xanavi Informatics Corp | 位置測位装置、および位置測位方法 |
CN103954275A (zh) * | 2014-04-01 | 2014-07-30 | 西安交通大学 | 基于车道线检测和gis地图信息开发的视觉导航方法 |
CN105676253A (zh) * | 2016-01-15 | 2016-06-15 | 武汉光庭科技有限公司 | 一种自动驾驶中基于城市道路标线地图的纵向定位系统及其方法 |
CN105698812A (zh) * | 2016-01-15 | 2016-06-22 | 武汉光庭科技有限公司 | 一种自动驾驶中基于安全驾驶地图和两侧摄像头的车道线检测系统及其方法 |
CN107045629A (zh) * | 2017-04-19 | 2017-08-15 | 南京理工大学 | 一种多车道线检测方法 |
CN107330376A (zh) * | 2017-06-06 | 2017-11-07 | 广州汽车集团股份有限公司 | 一种车道线识别方法及系统 |
CN107578002A (zh) * | 2017-08-28 | 2018-01-12 | 沈阳中科创达软件有限公司 | 一种车道线识别结果的监测方法、装置、设备和介质 |
JP2018077162A (ja) * | 2016-11-10 | 2018-05-17 | 株式会社デンソーアイティーラボラトリ | 車両位置検出装置、車両位置検出方法及び車両位置検出用コンピュータプログラム |
Family Cites Families (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP4392389B2 (ja) | 2005-06-27 | 2009-12-24 | 本田技研工業株式会社 | 車両及び車線認識装置 |
JP4775658B2 (ja) * | 2006-12-27 | 2011-09-21 | アイシン・エィ・ダブリュ株式会社 | 地物認識装置・自車位置認識装置・ナビゲーション装置・地物認識方法 |
KR100921427B1 (ko) | 2007-12-17 | 2009-10-14 | 한국전자통신연구원 | 영상 기반 내비게이션을 위한 가상차선을 생성하는 방법 및그 장치 |
KR20140071174A (ko) | 2012-12-03 | 2014-06-11 | 현대자동차주식회사 | 차량의 차선 가이드 장치 및 그 방법 |
KR101787996B1 (ko) * | 2013-04-11 | 2017-10-19 | 주식회사 만도 | 차선 추정 장치 및 그 방법 |
KR101582572B1 (ko) | 2013-12-24 | 2016-01-11 | 엘지전자 주식회사 | 차량 운전 보조 장치 및 이를 구비한 차량 |
CN103853155B (zh) * | 2014-03-31 | 2015-04-22 | 李德毅 | 智能车路口通行方法及系统 |
CN110920614B (zh) * | 2019-10-30 | 2021-11-23 | 苏州智加科技有限公司 | 变道控制方法、装置、设备及存储介质 |
-
2019
- 2019-05-24 WO PCT/KR2019/006278 patent/WO2020004817A1/ko active Application Filing
- 2019-05-24 CN CN201980035132.9A patent/CN112189225B/zh active Active
- 2019-05-24 US US17/057,498 patent/US11321950B2/en active Active
- 2019-05-30 KR KR1020190063942A patent/KR20200001471A/ko active Search and Examination
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2007108043A (ja) * | 2005-10-14 | 2007-04-26 | Xanavi Informatics Corp | 位置測位装置、および位置測位方法 |
CN103954275A (zh) * | 2014-04-01 | 2014-07-30 | 西安交通大学 | 基于车道线检测和gis地图信息开发的视觉导航方法 |
CN105676253A (zh) * | 2016-01-15 | 2016-06-15 | 武汉光庭科技有限公司 | 一种自动驾驶中基于城市道路标线地图的纵向定位系统及其方法 |
CN105698812A (zh) * | 2016-01-15 | 2016-06-22 | 武汉光庭科技有限公司 | 一种自动驾驶中基于安全驾驶地图和两侧摄像头的车道线检测系统及其方法 |
JP2018077162A (ja) * | 2016-11-10 | 2018-05-17 | 株式会社デンソーアイティーラボラトリ | 車両位置検出装置、車両位置検出方法及び車両位置検出用コンピュータプログラム |
CN107045629A (zh) * | 2017-04-19 | 2017-08-15 | 南京理工大学 | 一种多车道线检测方法 |
CN107330376A (zh) * | 2017-06-06 | 2017-11-07 | 广州汽车集团股份有限公司 | 一种车道线识别方法及系统 |
CN107578002A (zh) * | 2017-08-28 | 2018-01-12 | 沈阳中科创达软件有限公司 | 一种车道线识别结果的监测方法、装置、设备和介质 |
Also Published As
Publication number | Publication date |
---|---|
KR20200001471A (ko) | 2020-01-06 |
US20210365694A1 (en) | 2021-11-25 |
WO2020004817A1 (ko) | 2020-01-02 |
CN112189225A (zh) | 2021-01-05 |
US11321950B2 (en) | 2022-05-03 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112189225B (zh) | 车道线信息检测装置、方法以及存储被编程为执行该方法的计算机程序的计算机可读记录介质 | |
KR102420476B1 (ko) | 차량의 위치 추정 장치, 차량의 위치 추정 방법, 및 이러한 방법을 수행하도록 프로그램된 컴퓨터 프로그램을 저장하는 컴퓨터 판독가능한 기록매체 | |
JP7301909B2 (ja) | 地図データ、レーザ、およびカメラからのヨー誤差の確定 | |
CN110057373B (zh) | 用于生成高精细语义地图的方法、装置和计算机存储介质 | |
JP6931096B2 (ja) | オンボードセンサの外部パラメータを較正する方法及び装置、並びに関連する車両 | |
JP5157067B2 (ja) | 自動走行用マップ作成装置、及び自動走行装置。 | |
EP3637371B1 (en) | Map data correcting method and device | |
KR101454153B1 (ko) | 가상차선과 센서 융합을 통한 무인 자율주행 자동차의 항법시스템 | |
JP5152244B2 (ja) | 追従対象車特定装置 | |
JP4600357B2 (ja) | 測位装置 | |
US10955857B2 (en) | Stationary camera localization | |
JP2020085886A (ja) | 乗物、乗物測位システム、及び乗物測位方法 | |
KR102071418B1 (ko) | 차량용 카메라 캘리브레이션 장치 및 방법 | |
CN112567264A (zh) | 用于获取坐标变换信息的装置和方法 | |
JP5775965B2 (ja) | ステレオカメラシステム及び移動体 | |
KR102037129B1 (ko) | 차량의 위치 보정 장치 및 방법과 이를 이용한 차량 위치 보정 시스템 및 무인 운행이 가능한 차량 | |
JP5429986B2 (ja) | 移動ロボットの遠方環境認識装置及び方法 | |
US11754415B2 (en) | Sensor localization from external source data | |
KR20200093271A (ko) | 랜드마크 위치 추정 장치와 방법 및 이러한 방법을 수행하도록 프로그램된 컴퓨터 프로그램을 저장하는 컴퓨터 판독 가능한 기록매체 | |
KR20200120402A (ko) | 차량의 추정 위치 획득 장치 및 방법 | |
KR102634443B1 (ko) | 차량용 센서의 보정 정보 획득 장치 및 방법 | |
KR20210051030A (ko) | 센서 바이어스 보정 방법 및 장치 | |
KR20210041969A (ko) | 지도 매칭을 이용한 온라인 카메라 캘리브레이션 장치 및 방법 | |
WO2021145032A1 (ja) | 周辺車両位置推定システム、周辺車両位置推定プログラム | |
US20240071091A1 (en) | Vehicle Control Device and Control Method Thereof |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |