CN104635731B - 目标的运动特性判断装置及具备此的行驶路径控制装置 - Google Patents
目标的运动特性判断装置及具备此的行驶路径控制装置 Download PDFInfo
- Publication number
- CN104635731B CN104635731B CN201410333703.6A CN201410333703A CN104635731B CN 104635731 B CN104635731 B CN 104635731B CN 201410333703 A CN201410333703 A CN 201410333703A CN 104635731 B CN104635731 B CN 104635731B
- Authority
- CN
- China
- Prior art keywords
- target
- relative velocity
- longitudinal direction
- transverse direction
- movable body
- 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
- 241000222712 Kinetoplastida Species 0.000 claims description 4
- 230000006870 function Effects 0.000 description 26
- 238000000034 method Methods 0.000 description 11
- 238000010586 diagram Methods 0.000 description 7
- 230000000052 comparative effect Effects 0.000 description 6
- 238000004590 computer program Methods 0.000 description 3
- 235000013399 edible fruits Nutrition 0.000 description 3
- 230000011218 segmentation Effects 0.000 description 3
- WHGYBXFWUBPSRW-FOUAGVGXSA-N beta-cyclodextrin Chemical compound OC[C@H]([C@H]([C@@H]([C@H]1O)O)O[C@H]2O[C@@H]([C@@H](O[C@H]3O[C@H](CO)[C@H]([C@@H]([C@H]3O)O)O[C@H]3O[C@H](CO)[C@H]([C@@H]([C@H]3O)O)O[C@H]3O[C@H](CO)[C@H]([C@@H]([C@H]3O)O)O[C@H]3O[C@H](CO)[C@H]([C@@H]([C@H]3O)O)O3)[C@H](O)[C@H]2O)CO)O[C@@H]1O[C@H]1[C@H](O)[C@@H](O)[C@@H]3O[C@@H]1CO WHGYBXFWUBPSRW-FOUAGVGXSA-N 0.000 description 2
- 238000001514 detection method Methods 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 230000009897 systematic effect Effects 0.000 description 2
- 230000002159 abnormal effect Effects 0.000 description 1
- SAZUGELZHZOXHB-UHFFFAOYSA-N acecarbromal Chemical compound CCC(Br)(CC)C(=O)NC(=O)NC(C)=O SAZUGELZHZOXHB-UHFFFAOYSA-N 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 238000000605 extraction Methods 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
Classifications
-
- 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
- B60W30/08—Active safety systems predicting or avoiding probable or impending collision or attempting to minimise its consequences
- B60W30/095—Predicting travel path or likelihood of collision
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C3/00—Measuring distances in line of sight; Optical rangefinders
- G01C3/10—Measuring distances in line of sight; Optical rangefinders using a parallactic triangle with variable angles and a base of fixed length in the observation station, e.g. in the instrument
- G01C3/14—Measuring distances in line of sight; Optical rangefinders using a parallactic triangle with variable angles and a base of fixed length in the observation station, e.g. in the instrument with binocular observation at a single point, e.g. stereoscopic type
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60R—VEHICLES, VEHICLE FITTINGS, OR VEHICLE PARTS, NOT OTHERWISE PROVIDED FOR
- B60R21/00—Arrangements or fittings on vehicles for protecting or preventing injuries to occupants or pedestrians in case of accidents or other traffic risks
-
- 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
- B60W30/08—Active safety systems predicting or avoiding probable or impending collision or attempting to minimise its consequences
- B60W30/09—Taking automatic action to avoid collision, e.g. braking and steering
-
- 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
- B60W30/10—Path 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
- 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
- B60W30/14—Adaptive cruise control
- B60W30/16—Control of distance between vehicles, e.g. keeping a distance to preceding vehicle
- B60W30/165—Automatically following the path of a preceding lead vehicle, e.g. "electronic tow-bar"
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S13/00—Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
- G01S13/88—Radar or analogous systems specially adapted for specific applications
- G01S13/93—Radar or analogous systems specially adapted for specific applications for anti-collision purposes
- G01S13/931—Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/88—Lidar systems specially adapted for specific applications
- G01S17/93—Lidar systems specially adapted for specific applications for anti-collision purposes
- G01S17/931—Lidar systems specially adapted for specific applications for anti-collision purposes of land vehicles
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
-
- 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, light or radio wave 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
- B60W2420/00—Indexing codes relating to the type of sensors based on the principle of their operation
- B60W2420/40—Photo, light or radio wave sensitive means, e.g. infrared sensors
- B60W2420/408—Radar; Laser, e.g. lidar
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S13/00—Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
- G01S13/88—Radar or analogous systems specially adapted for specific applications
- G01S13/93—Radar or analogous systems specially adapted for specific applications for anti-collision purposes
- G01S13/931—Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles
- G01S2013/9318—Controlling the steering
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- General Physics & Mathematics (AREA)
- Electromagnetism (AREA)
- Automation & Control Theory (AREA)
- Mechanical Engineering (AREA)
- Computer Networks & Wireless Communication (AREA)
- Transportation (AREA)
- Aviation & Aerospace Engineering (AREA)
- Traffic Control Systems (AREA)
Abstract
本发明提供一种目标的运动特性判断装置及具备此的行驶路径控制装置,判断位于自己车辆前方的目标是否为运动体,目标是运动体时,判断目标的移动方向,以该目标的运动特性判断结果为基础,调整自己车辆的行驶路径。根据本发明的行驶路径控制装置包括:存在判断部,判断前方是否存在目标;运动体/移动方向判断部,判断为前方存在目标时,利用目标的相对速度偏差,判断目标是否是运动体以及目标的移动方向;及行驶路径控制部,以目标是否为运动体及目标是运动体时目标的移动方向为基础,控制自己车辆的行驶路径。
Description
技术领域
本发明涉及目标的运动特性判断装置及具备此的行驶路径控制装置,所述目标的运动特性判断装置判断自己车辆的前方是否存在目标并根据对此目标的信息为基础而调整自己车辆的行驶路径。
背景技术
传统车辆具有利用一般摄像机的地图生成功能、利用立体摄像机的地图生成功能、利用3D激光扫描仪的地图生成功能等,利用以此为基础获得的对象信息和汽车导航仪而控制车辆的行驶。
传统车辆利用立体摄像机生成地图时,匹配从立体摄像机获得的连续图片而判断位于外部的对象,利用3D激光扫描仪生成地图时,使外部生成为3维信息而判断对象。
但是,利用一般摄像机时,存在距离信息不正确的问题点,利用立体摄像机时,因根据位置的排列被变更,存在匹配作业较难的问题点。并且,利用3D激光扫描仪时,距离信息的准确度会增加,但需要处理的数据容量会增多,因使用高价的传感器,存在增加制造费用的问题点。
韩国公开专利第2012-0053313号公开了通过感应位于前方的物体并以其感应结果为基础而控制车辆的行驶路径的方法。但是,该方法只感应特定区域是否存在物体,很难根据该物体的运动而主动应对。
发明内容
(要解决的技术问题)
本发明是为了解决所述问题点而提出,其目的在于提供一种目标的运动特性判断装置及具备此的行驶路径控制装置,判断位于自己车辆前方的目标是否为运动体,是运动体时,判断目标的移动方向,以该目标的运动特性判断结果为基础,调整自己车辆的行驶路径。
但是,本发明的目的并不限定于所述涉及的事项,未涉及的其他目的可通过以下记载被本行业从业者所明确理解。
(解决问题的手段)
本发明为达成所述目的而提供一种行驶路径控制装置,其特征在于,包括:存在判断部,判断前方是否存在目标;运动体/移动方向判断部,判断为前方存在所述目标时,利用所述目标的相对速度偏差,判断所述目标是否是运动体以及所述目标的移动方向;及行驶路径控制部,以所述目标是否为运动体及所述目标是运动体时所述目标的移动方向为基础,控制自己车辆的行驶路径。
优选地,所述存在判断部,在预先设定的时间内输入向前方输出的雷达信号时,判断为前方存在所述目标。
优选地,所述运动体/移动方向判断部,包括:第1相对速度推定部,测定所述自己车辆的第1纵方向速度和第1横方向速度,以所述第1纵方向速度和所述第1横方向速度为基础,推定所述目标的第1纵方向相对速度和第1横方向相对速度;第2相对速度推定部,经过预先设定的时间后,测定所述自己车辆的第2纵方向速度和第2横方向速度,以所述第2纵方向速度和所述第2横方向速度为基础,推定所述目标的第2纵方向相对速度和第2横方向相对速度;及相对速度比较部,比较所述第1纵方向相对速度和所述第2纵方向相对速度的结果及比较所述第1横方向相对速度和所述第2横方向相对速度的结果为基础,判断所述目标是否是运动体以及所述目标的移动方向。
优选地,所述相对速度比较部在所述第1纵方向相对速度与所述第2 纵方向相对速度的差值等于所述第1纵方向相对速度,而且所述第1横方向相对速度与所述第2横方向相对速度的差值等于所述第1横方向相对速度时,判断为所述目标不是运动体。
优选地,所述相对速度比较部在所述第1纵方向相对速度与所述第2 纵方向相对速度的差值大于所述第1纵方向相对速度时,判断为道路上的所述自己车辆与所述目标之间的距离在减少;所述第1纵方向相对速度与所述第2纵方向相对速度的差值小于所述第1纵方向相对速度时,判断为道路上的所述自己车辆与所述目标之间的距离在增加;所述第1横方向相对速度与所述第2横方向相对速度的差值大于所述第1横方向相对速度时,判断为所述目标向左侧方向移动;所述第1横方向相对速度与所述第 2横方向相对速度的差值小于所述第1横方向相对速度时,判断为所述目标向右侧方向移动。
优选地,所述行驶路径控制装置还包括:距离测定部,判断为前方存在所述目标时,每隔预先设定的时间,测定与所述目标之间的距离;及距离判断部,判断与所述目标之间的距离是否是基准距离以下;判断为与所述目标之间的距离是基准距离以下时,所述运动体/移动方向判断部判断所述目标是否是运动体以及所述目标的移动方向。
优选地,所述行驶路径控制装置被搭载到无人车辆。
优选地,所述运动体/移动方向判断部判断为前方存在所述目标时,以自己车辆的位置变化量与从所述自己车辆到所述目标的距离变化量为基础,判断所述目标是否是运动体。
优选地,所述运动体/移动方向判断部,包括:第1距离测定部,测定从所述自己车辆到所述目标的第1距离;自车位置推定部,以所述第1距离为基础,推定相对于所述目标的第1位置的所述自己车辆的第1位置;第2距离测定部,经过指定时间后,测定从所述自己车辆到所述目标之间的第2距离;自车位置决定部,经过所述指定时间后,以所述自己车辆的纵方向速度和横方向速度为基础,决定从所述自己车辆的第1位置到所述自己车辆的第2位置;目标位置推定部,以所述第2距离和所述自己车辆的第2位置为基础,推定所述目标的第2位置;及位置比较部,比较所述目标的第1位置和所述目标的第2位置,判断所述目标是否是运动体。
并且本发明提供一种目标的运动特性判断装置,其特征在于,包括:存在判断部,判断前方是否存在目标;及运动体/移动方向判断部,判断为前方存在目标时,利用所述目标的相对速度偏差,判断所述目标是否是运动体以及所述目标的移动方向。
(发明的效果)
本发明通过判断位于自己车辆前方的目标是否为运动体,是运动体时,判断目标的移动方向,以该目标的运动特性判断结果为基础,调整自己车辆的行驶路径,可获得如下效果。
第一、GPS没有/丧失的状况下,以外部物体为中心,将外部物体组织化而生成行驶地图,使无人车辆可行驶,确保无人车辆的强健性。
第二、能够增大车辆的商品性,据此能够增加销售和利润。
附图说明
图1是概略性地图示根据本发明的优选实施例的行驶路径控制装置的框图。
图2是具体图示根据本发明的构成行驶路径控制装置的运动体/移动方向判断部的框图。
图3是概略性地图示根据本发明的一实施例的物体判断系统的框图。
图4是为了说明前方物体中决定控制对象物体的方法的参考图。
图5是为了说明预测控制对象物体的移动方向的方法的参考图。
图6是判断控制对象物体是否为移动物体并判断移动方向的方法的流程图。
具体实施方式
下面,参照附图详细说明本发明的优选实施例。首先,关于为各附图的构成要素附加参照符号,相同的构成要素标示在不同的附图上时,尽可能使用了相同的符号。并且,说明本发明时,判断为相关的公开构成或功能的具体说明有可能会混淆本发明的技术要旨时,省略其详细的说明。并且,以下会说明本发明的优选实施例,但本发明的技术思想并不限定于此或受此限制,从业者可进行变更并以多种形式实施。
图1是概略性地图示根据本发明的优选实施例的行驶路径控制装置的框图。图1中目标的运动特性判断装置200是判断位于自己车辆前方的目标是否是运动体以及目标为运动体时判断目标的移动方向的装置。并且,行驶路径控制装置100是以目标的运动特性判断结果为基础而调整自己车辆的行驶路径的装置。
根据图1,行驶路径控制装置100包括:存在判断部110、运动体/移动方向判断部120、行驶路径控制部130、电源部140及主控制部150。
电源部140执行向构成行驶路径控制装置100的各构成供应电源的功能。主控制部150执行控制构成行驶路径控制装置100的各构成的整体运转的功能。考虑到行驶路径控制装置100能够搭载到控制与车辆行驶相关的功能的ECU,电源部140和主控制部150可不包括到行驶路径控制装置 100。
存在判断部110执行判断自己车辆的前方是否存在目标的功能。当向前方输出的雷达信号在预先设定的时间以内返回而被输入后,存在判断部 110判断为前方存在目标。
运动体/移动方向判断部120当存在判断部110判断为前方存在目标时,利用目标的相对速度偏差,判断目标是否是运动体以及所述目标的移动方向。
图2是具体图示根据本发明的构成行驶路径控制装置的运动体/移动方向判断部的框图。根据图2,运动体/移动方向判断部120可包括:第1 相对速度推定部121、第2相对速度推定部122及相对速度比较部123。
第1相对速度推定部121执行测定自己车辆的第1纵方向速度和第1 横方向速度的功能。并且,第1相对速度推定部121执行以第1纵方向速度和第1横方向速度为基础而推定目标的第1纵方向相对速度和第1横方向相对速度的功能。
第2相对速度推定部122执行经过预先设定的时间后测定自己车辆的第2纵方向速度和第2横方向速度的功能。并且,第2相对速度推定部122 执行以第2纵方向速度和第2横方向速度为基础而推定目标的第2纵方向相对速度和第2横方向相对速度的功能。
相对速度比较部123执行以比较第1纵方向相对速度和第2纵方向相对速度的结果,及比较第1横方向相对速度和第2横方向相对速度的结果为基础,而判断目标是否是运动体以及目标的移动方向的功能。
判断目标是否是运动体时,首先,相对速度比较部123算出第1纵方向相对速度与第2纵方向相对速度的差值(以下定义为纵方向相对速度差值)及第1横方向相对速度与第2横方向相对速度的差值(以下定义为横方向相对速度差值)。之后,相对速度比较部123比较纵方向相对速度差值与第1纵方向相对速度,比较横方向相对速度差值与第1横方向相对速度。比较结果为,纵方向相对速度差值等于第1纵方向相对速度且横方向相对速度差值等于第1横方向相对速度时,相对速度比较部123把目标判断为固定体。反之,若比较结果与所述不同,相对速度比较部123把目标判断为移动体。
另外,目标为运动体时,判断目标的移动方向时,首先相对速度比较部123算出纵方向相对速度差值和横方向相对速度差值。之后,相对速度比较部123比较纵方向相对速度差值与第1纵方向相对速度,比较横方向相对速度差值与第1横方向相对速度。比较结果,若纵方向相对速度差值大于第1纵方向相对速度,相对速度比较部123判断为道路上的自己车辆与目标之间的距离在减少(即,目标靠近自己车辆)。比较结果,纵方向相对速度差值小于第1纵方向相对速度时,相对速度比较部123判断为道路上的自己车辆与目标之间的距离在增加(即,目标远离自己车辆)。比较结果,若横方向相对速度差值大于第1横方向相对速度,相对速度比较部123判断为目标向左侧方向移动。比较结果,若横方向相对速度差值小于第1横方向相对速度,相对速度比较部123判断为目标向右侧方向移动。
再参照图1进行说明。
行驶路径控制部130执行的功能为,以目标是否为运动体及目标为运动体时目标的移动方向为基础而控制自己车辆的行驶路径。
另外,即使是位于前方的对象,运动体/移动方向判断部120只利用符合特定基准的对象为目标。行驶路径控制装置100考虑到此,还可包括距离测定部160和距离判断部170。
距离测定部160执行的功能为,判断为前方存在目标时,每隔预先设定的时间,测定与目标之间的距离。
距离判断部170执行的功能为,比较由距离测定部160测定的与目标之间的距离和基准距离,判断与目标之间的距离是否为基准距离以下。
行驶路径控制装置100若还包括距离测定部160和距离判断部170时,判断为与目标之间的距离是基准距离以下时,运动体/移动方向判断部130 判断该目标是否是运动体以及该目标的移动方向。后面将参照图4进行说明,当与目标之间距离为基准距离以下时,运动体/移动方向判断部130 视为目标从预测空间进入控制空间,从这个时候开始把目标设定为追踪对象。
另外,判断为前方存在目标时,运动体/移动方向判断部120以自己车辆的位置变化量和从自己车辆到目标的距离变化量为基础,判断目标是否是运动体。
考虑到此,运动体/移动方向判断部120可包括:第1距离测定部(未图示)、自车位置推定部(未图示)、第2距离测定部(未图示)、自车位置决定部(未图示)、目标位置推定部(未图示)及位置比较部(未图示)。
第1距离测定部执行的功能为,测定从自己车辆到目标的第1距离。
自车位置推定部执行的功能为,以第1距离为基础,推定相对于目标的第1位置的自己车辆的第1位置。
第2距离测定部执行的功能为,经过指定时间后,测定从自己车辆到目标的第2距离。
自车位置决定部执行的功能为,经过指定时间后,以自己车辆的纵方向速度和横方向速度为基础,通过自己车辆的第1位置决定自己车辆的第 2位置。
目标位置推定部执行的功能为,以第2距离和自己车辆的第2位置为基础,推定目标的第2位置。
位置比较部执行的功能为,比较目标的第1位置和目标的第2位置,判断目标是否是运动体。
以上参照图1和图2说明了根据本发明的优选实施例的行驶路径控制装置100。根据本发明的行驶路径控制装置100是以被搭载到无人车辆而运用为目的而发明的。
以下通过可实施的呈现例,详细说明本发明。图3是概略性地图示根据本发明的一实施例的物体判断系统的框图。
本发明涉及自主行驶车辆中利用距离测定传感器而判别固定物体的方法。
无人驾驶的无人车辆需要利用距离测定传感器而识别外部物体的能力。无人车辆通过这种能力,算出与目标之间的距离,利用该距离就能确认外部物体是移动物体还是固定物体。无人车辆为提取可行驶空间而需知道外部物体的位置和移动路径,这样才能实现安全行驶。
本发明的目的在于,利用距离测定传感器掌握外部物体的位置及移动路径并生成行驶地图而生成无人车辆的行驶路径。并且,本发明的目的在于,行驶车辆中利用距离测定传感器测定的距离信息判别物体的停止/移动而生成行驶地图。
参照图3,物体判断系统包括:物体距离测定部310、区域分割部320、物体匹配部330、物体移动方向预测部340及物体判断部350。
物体距离测定部310的功能为,感应位于外部的物体,测定到该物体为止的距离。
区域分割部320的功能为,以通过物体距离测定部310测定的距离为基础,把车辆前方空间区分为预测空间和控制空间。预测空间和控制空间参照图4。
物体匹配部330的功能为,预测空间中感应到的物体进入控制空间之前,对于外部物体的位置,在演算行驶车速的位置为固定点,匹配预测空间中检测到的物体进入控制空间的时间。这时,物体匹配部330以物体距离测定部310的探测结果为基础,考虑时间延迟(time delay)而执行匹配。
物体移动方向预测部340的功能为,计算匹配后的偏差,预测物体的移动方向。
物体判断部350的功能为,最终判断预测到移动方向的物体。
图4是为了说明前方物体中决定控制对象物体的方法的参考图。详细地说,图4是图示利用行驶中的车辆中感应到的物体(object)的相对速度的对象追踪(ObjectTracking)。
首先,预测空间440中探测到对象420时,追踪该物体420。之后,考虑到自车410的移动速度,把预测空间440的物体420匹配为控制空间 450的控制对象对象即目标430。经过一定时间后,把预测空间440的物体420投射到控制空间450而进行所述匹配。之后,以自车410的速度为基础,演算根据控制空间450的目标430的位置的相对速度。之后,预测目标430的移动方向。
图5是为了说明预测控制对象物体的移动方向的方法的参考图。详细地说,图5图示了利用特征点偏差而预测目标的移动方向。
图5(a)图示以一定周期单位,在控制空间中匹配控制对象物体即目标的图表。若目标为固定物体,如图5(a)的图表中510,原则上位于中心。但是,若目标为移动物体如520,脱离中心而位于特定位置。
图5(b)图示能够判别目标是固定物体还是移动物体的计算式。图5(b) 的Vy0表示从自车的第1纵方向速度所获得的目标的第1纵方向相对速度。并且,Vy1是指从自车的第2纵方向速度所获得的目标的第2纵方向相对速度。所述中第2纵方向速度是测定第1纵方向速度并经过一定时间后测定的自车的纵方向速度。
另外,Vx0是指从自车的第1横方向速度所获得的目标的第1横方向相对速度。并且,Vx1是从自车的第2横方向速度所获得的目标的第2横方向相对速度。所述中第2横方向速度是测定第1横方向速度并经过一定时间后测定的自车的横方向速度。本实施例中第2纵方向速度和第2横方向速度在相同时间内测定。
图5(b)中,若Vx0-Vx1=Vx0,Vy0-Vy1=Vy0,把目标判断为固定物体。除此之外,把目标判断为移动物体,详细如下。
第一、Vx0-Vx1<Vx0时,判断为目标向右侧方向移动。
第二、Vx0-Vx1>Vx0时,判断为目标向左侧方向移动。
第三、Vy0-Vy1<Vy0时,判断为目标向+纵方向移动。即,判断为目标与自车之间的距离变远。
第四、Vy0-Vy1>Vy0时,判断为目标向-纵方向移动。即,判断为目标与自车之间的距离变近。
图6是判断控制对象物体是否为移动物体并判断移动方向的方法的流程图。
首先,探测位于外部的目标,再测定到该目标为止的距离(S605)。之后,把自车的前方空间区域分割为预测空间和控制空间(S610)。之后,追踪位于预测空间的目标(S615),考虑到自车的车速,推定位于预测空间的目标的控制空间进入时点(S620)。之后,确认控制空间进入时点对比偏差 (S625)。偏差通过区分为纵方向成分和横方向成分而确认(S630)。
之后,判断纵方向偏差是否为0(S635)。若纵方向偏差为0,把目标判断为纵方向静止物体(S640)。若纵方向偏差不为0,判断纵方向偏差是否大于0(S645)。若纵方向偏差大于0,把目标判断为相对于自车的低速物体 (S650)。若纵方向偏差不大于0(S655),表示纵方向偏差小于0,因此把目标判断为接近物体(S660)。
另外,判断横方向偏差是否为0(S665)。若横方向偏差为0,把目标判断为横方向静止物体(S670)。若横方向偏差不为0,判断横方向偏差是否等于右侧偏差(S675)。若横方向偏差等于右侧偏差,把目标判断为右侧移动物体(S680)。若横方向偏差不等于右侧偏差(S685),表示横方向偏差等于左侧偏差,因此把目标判断为左侧移动物体(S690)。
通过所述判断过程,若判断为纵方向偏差和横方向偏差都是0,最终把目标判断为固定物体(S695)。
如前述说明,除此之外的情况下,都把目标判断为移动物体(S700),最终决定目标的移动方向(S705)。
以上参照图3至图6,说明了根据本发明的一实施例的物体判断系统。以上说明的物体判断系统的特征整理如下。
第一、无人行驶的车辆中利用测定的物体和车辆之间的距离信息,分割成预测空间和控制空间。
第二、把预测空间中测定的物体1次判断为静止物体,并且考虑到无人车辆的行驶速度而事先预测。
第三、追踪的物体进入控制空间时,计算与所述判断的位置之间的偏差。
第四、利用所述的偏差预测物体的移动方向。
第五、利用物体的预测信息而判断是固定物体还是移动物体。
即使以上说明的构成本发明的实施例的所有构成要素结合为一体或结合而运转,本发明并不限定于这种实施例。即,只要是在本发明的目的范围之内,所有构成要素都可以一个以上选择性地结合而运转。并且,所有构成要素分别体现为一个独立的硬件,但各构成要素的部分或全部被选择性地组合,体现为具有执行一个或多个硬件组合的部分或全部功能的程序模组的计算机程序。并且,这种计算机程序被保存到USB存储器、CD 磁盘、闪存等计算机可读的记录媒介(Computer Readable Media),可被计算机读取并执行,从而体现本发明的实施例。计算机程序的记录媒介有磁记录媒介、光记录媒介、载波记录媒介等。
并且,若对包含技术性或科学性用语的所有用语,未在详细说明中另行定义,与本发明所属技术领域中具有一般知识的人所一般理解的具有相同的意思,与字典中定义的用语相同而一般使用的用语应解释为与相关技术的文脉上的意思一致,只要本发明没有明确定义,不能解释成异常或过度形式化的意思。
上述说明只是例示性地说明了本发明的技术思想,在本发明所属技术领域具有一般知识的人,能够在不脱离本发明本质特性的范围内,可进行多种修改、变更及替换。因此,本发明公开的实施例及附图并不在于限定本发明的技术思想,而是为了说明,本发明的技术思想的范围并不受这种实施例及附图的限定。本发明的保护范围应根据以下的权利要求所解释,与其同等范围内的所有技术思想都包括在本发明的权利范围。
Claims (9)
1.一种行驶路径控制装置,其特征在于,包括:
存在判断部,判断前方是否存在目标;
运动体/移动方向判断部,判断为前方存在所述目标时,利用所述目标的相对速度偏差,判断所述目标是否是运动体以及所述目标的移动方向;及
行驶路径控制部,以所述目标是否为运动体及所述目标是运动体时所述目标的移动方向为基础,控制自己车辆的行驶路径,
所述运动体/移动方向判断部,包括:
第1相对速度推定部,测定所述自己车辆的第1纵方向速度和第1横方向速度,以所述第1纵方向速度和所述第1横方向速度为基础,推定所述目标的第1纵方向相对速度和第1横方向相对速度;
第2相对速度推定部,经过预先设定的时间后,测定所述自己车辆的第2纵方向速度和第2横方向速度,以所述第2纵方向速度和所述第2横方向速度为基础,推定所述目标的第2纵方向相对速度和第2横方向相对速度;及
相对速度比较部,比较所述第1纵方向相对速度和所述第2纵方向相对速度的结果,及比较所述第1横方向相对速度和所述第2横方向相对速度的结果为基础,判断所述目标是否是运动体以及所述目标的移动方向。
2.根据权利要求1所述的行驶路径控制装置,其特征在于,
所述存在判断部,在预先设定的时间内输入向前方输出的雷达信号时,判断为前方存在所述目标。
3.根据权利要求1所述的行驶路径控制装置,其特征在于,
所述相对速度比较部在所述第1纵方向相对速度与所述第2纵方向相对速度的差值等于所述第1纵方向相对速度,而且所述第1横方向相对速度与所述第2横方向相对速度的差值等于所述第1横方向相对速度时,判断为所述目标不是运动体。
4.根据权利要求1所述的行驶路径控制装置,其特征在于,
所述相对速度比较部在所述第1纵方向相对速度与所述第2纵方向相对速度的差值大于所述第1纵方向相对速度时,判断为道路上的所述自己车辆与所述目标之间的距离在减少;所述第1纵方向相对速度与所述第2纵方向相对速度的差值小于所述第1纵方向相对速度时,判断为道路上的所述自己车辆与所述目标之间的距离在增加;所述第1横方向相对速度与所述第2横方向相对速度的差值大于所述第1横方向相对速度时,判断为所述目标向左侧方向移动;所述第1横方向相对速度与所述第2横方向相对速度的差值小于所述第1横方向相对速度时,判断为所述目标向右侧方向移动。
5.根据权利要求1所述的行驶路径控制装置,其特征在于,还包括:
距离测定部,判断为前方存在所述目标时,每隔预先设定的时间,测定与所述目标之间的距离;及
距离判断部,判断与所述目标之间的距离是否是基准距离以下;
判断为与所述目标之间的距离是基准距离以下时,所述运动体/移动方向判断部判断所述目标是否是运动体以及所述目标的移动方向。
6.根据权利要求1所述的行驶路径控制装置,其特征在于,
所述行驶路径控制装置被搭载到无人车辆。
7.根据权利要求1所述的行驶路径控制装置,其特征在于,
所述运动体/移动方向判断部判断为前方存在所述目标时,以自己车辆的位置变化量与从所述自己车辆到所述目标的距离变化量为基础,判断所述目标是否是运动体。
8.根据权利要求7所述的行驶路径控制装置,其特征在于,
所述运动体/移动方向判断部,还包括:
第1距离测定部,测定从所述自己车辆到所述目标的第1距离;
自车位置推定部,以所述第1距离为基础,推定相对于所述目标的第1位置的所述自己车辆的第1位置;
第2距离测定部,经过指定时间后,测定从所述自己车辆到所述目标之间的第2距离;
自车位置决定部,经过所述指定时间后,以所述自己车辆的纵方向速度和横方向速度为基础,决定从所述自己车辆的第1位置到所述自己车辆的第2位置;
目标位置推定部,以所述第2距离和所述自己车辆的第2位置为基础,推定所述目标的第2位置;及
位置比较部,比较所述目标的第1位置和所述目标的第2位置,判断所述目标是否是运动体。
9.一种目标的运动特性判断装置,其特征在于,包括:
存在判断部,判断前方是否存在目标;及
运动体/移动方向判断部,判断为前方存在目标时,利用所述目标的相对速度偏差,判断所述目标是否是运动体以及所述目标的移动方向,
所述运动体/移动方向判断部,包括:
第1相对速度推定部,测定自己车辆的第1纵方向速度和第1横方向速度,以所述第1纵方向速度和所述第1横方向速度为基础,推定所述目标的第1纵方向相对速度和第1横方向相对速度;
第2相对速度推定部,经过预先设定的时间后,测定所述自己车辆的第2纵方向速度和第2横方向速度,以所述第2纵方向速度和所述第2横方向速度为基础,推定所述目标的第2纵方向相对速度和第2横方向相对速度;及
相对速度比较部,比较所述第1纵方向相对速度和所述第2纵方向相对速度的结果,及比较所述第1横方向相对速度和所述第2横方向相对速度的结果为基础,判断所述目标是否是运动体以及所述目标的移动方向。
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR1020130137399A KR20150055271A (ko) | 2013-11-13 | 2013-11-13 | 타겟의 운동 특성 판단 장치 및 이를 구비하는 주행 경로 제어 장치 |
KR10-2013-0137399 | 2013-11-13 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104635731A CN104635731A (zh) | 2015-05-20 |
CN104635731B true CN104635731B (zh) | 2017-12-05 |
Family
ID=53044472
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410333703.6A Active CN104635731B (zh) | 2013-11-13 | 2014-07-14 | 目标的运动特性判断装置及具备此的行驶路径控制装置 |
Country Status (3)
Country | Link |
---|---|
US (1) | US20150134234A1 (zh) |
KR (1) | KR20150055271A (zh) |
CN (1) | CN104635731B (zh) |
Families Citing this family (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP5984154B2 (ja) * | 2014-09-24 | 2016-09-06 | 三菱電機株式会社 | 運転支援装置 |
WO2016104265A1 (ja) * | 2014-12-25 | 2016-06-30 | 株式会社エクォス・リサーチ | 移動体 |
US9707961B1 (en) | 2016-01-29 | 2017-07-18 | Ford Global Technologies, Llc | Tracking objects within a dynamic environment for improved localization |
US9645581B1 (en) * | 2016-02-04 | 2017-05-09 | Zerotech (Shenzhen) Intelligence Robot Co., Ltd | Method and apparatus for navigating unmanned aerial vehicle |
CN111429476B (zh) * | 2019-01-09 | 2023-10-20 | 杭州海康威视系统技术有限公司 | 确定目标人物行动轨迹的方法和装置 |
JP7238670B2 (ja) * | 2019-07-23 | 2023-03-14 | トヨタ自動車株式会社 | 画像表示装置 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS63314620A (ja) * | 1987-06-17 | 1988-12-22 | Nissan Motor Co Ltd | 自律走行車両制御装置 |
JPH0367504A (ja) * | 1989-08-04 | 1991-03-22 | Iseki & Co Ltd | 移動農機の方向制御装置 |
JP2002352399A (ja) * | 2001-05-23 | 2002-12-06 | Mitsubishi Electric Corp | 車両周辺監視装置 |
EP1793204A1 (en) * | 2005-11-30 | 2007-06-06 | Aisin AW Co., Ltd. | System for and method of providing lane guidance |
JP2011204145A (ja) * | 2010-03-26 | 2011-10-13 | Sony Corp | 移動装置、移動方法およびプログラム |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3642547B2 (ja) * | 1997-08-22 | 2005-04-27 | 株式会社小松製作所 | 自走車両の車速制御装置 |
JP3865121B2 (ja) * | 2001-10-31 | 2007-01-10 | 株式会社小松製作所 | 車両の障害物検出装置 |
US8738319B2 (en) * | 2010-10-29 | 2014-05-27 | Ford Global Technologies, Llc | System and method for detecting a turning vehicle |
-
2013
- 2013-11-13 KR KR1020130137399A patent/KR20150055271A/ko not_active Application Discontinuation
-
2014
- 2014-07-14 CN CN201410333703.6A patent/CN104635731B/zh active Active
- 2014-07-16 US US14/333,149 patent/US20150134234A1/en not_active Abandoned
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS63314620A (ja) * | 1987-06-17 | 1988-12-22 | Nissan Motor Co Ltd | 自律走行車両制御装置 |
JPH0367504A (ja) * | 1989-08-04 | 1991-03-22 | Iseki & Co Ltd | 移動農機の方向制御装置 |
JP2002352399A (ja) * | 2001-05-23 | 2002-12-06 | Mitsubishi Electric Corp | 車両周辺監視装置 |
EP1793204A1 (en) * | 2005-11-30 | 2007-06-06 | Aisin AW Co., Ltd. | System for and method of providing lane guidance |
JP2011204145A (ja) * | 2010-03-26 | 2011-10-13 | Sony Corp | 移動装置、移動方法およびプログラム |
Also Published As
Publication number | Publication date |
---|---|
US20150134234A1 (en) | 2015-05-14 |
KR20150055271A (ko) | 2015-05-21 |
CN104635731A (zh) | 2015-05-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104635731B (zh) | 目标的运动特性判断装置及具备此的行驶路径控制装置 | |
KR102453933B1 (ko) | 3차원 공간을 추적하는 차량 및 센싱 장치, 그리고 저장매체에 저장된 컴퓨터 프로그램 | |
KR100854766B1 (ko) | 거리 센서를 이용한 주차 공간 검출 방법 | |
JP5938569B2 (ja) | 方位情報を考慮する高度運転者支援システム、及びその動作方法 | |
EP2600328B1 (en) | Driving assistance device | |
CN104584097B (zh) | 物体检测装置和驾驶辅助装置 | |
CN105182364A (zh) | 狭窄空间中的与静态目标的碰撞避免 | |
US9694851B2 (en) | Apparatus and method of generating travel route of vehicle | |
CN103781685A (zh) | 车辆用自主行驶控制系统 | |
CN104925055A (zh) | 用于检测车辆周围区域中的移动物体的方法和装置 | |
JP2013225295A5 (zh) | ||
US11507101B2 (en) | Vehicle using spatial information acquired using sensor, sensing device using spatial information acquired using sensor, and server | |
CN108027423A (zh) | 矿山用作业机械 | |
CN103827633A (zh) | 用于确定车辆的位置数据的方法 | |
US9550529B2 (en) | Apparatus and method for recognizing driving field of vehicle | |
KR102392999B1 (ko) | 센서의 시야 범위를 조정하는 시스템 및 그 방법 | |
Shin et al. | Occlusion handling and track management method of high-level sensor fusion for robust pedestrian tracking | |
US11971257B2 (en) | Method and apparatus with localization | |
CN110929475A (zh) | 对象的雷达简档的注释 | |
JP2016045767A (ja) | 運動量推定装置及びプログラム | |
KR101965043B1 (ko) | 정밀지도 생성 지역 결정 방법 및 장치 | |
KR20170056789A (ko) | 블랙박스 기능을 갖는 avm 시스템 및 운용 방법 | |
KR102198810B1 (ko) | 오브젝트 추적 장치 및 방법 | |
CN114426030B (zh) | 一种行人穿行意图估计方法、装置、设备和汽车 | |
CN115195773A (zh) | 用于控制车辆驾驶的装置和方法及记录介质 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |