CN106030681A - 自身位置计算装置以及自身位置计算方法 - Google Patents

自身位置计算装置以及自身位置计算方法 Download PDF

Info

Publication number
CN106030681A
CN106030681A CN201480076278.5A CN201480076278A CN106030681A CN 106030681 A CN106030681 A CN 106030681A CN 201480076278 A CN201480076278 A CN 201480076278A CN 106030681 A CN106030681 A CN 106030681A
Authority
CN
China
Prior art keywords
vehicle
attitude angle
self
image
road surface
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.)
Granted
Application number
CN201480076278.5A
Other languages
English (en)
Other versions
CN106030681B (zh
Inventor
山口郎
山口一郎
西内秀和
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Nissan Motor Co Ltd
Original Assignee
Nissan Motor Co Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Nissan Motor Co Ltd filed Critical Nissan Motor Co Ltd
Publication of CN106030681A publication Critical patent/CN106030681A/zh
Application granted granted Critical
Publication of CN106030681B publication Critical patent/CN106030681B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

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
    • 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/10—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 vehicle motion
    • B60W40/11—Pitch movement
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60K—ARRANGEMENT OR MOUNTING OF PROPULSION UNITS OR OF TRANSMISSIONS IN VEHICLES; ARRANGEMENT OR MOUNTING OF PLURAL DIVERSE PRIME-MOVERS IN VEHICLES; AUXILIARY DRIVES FOR VEHICLES; INSTRUMENTATION OR DASHBOARDS FOR VEHICLES; ARRANGEMENTS IN CONNECTION WITH COOLING, AIR INTAKE, GAS EXHAUST OR FUEL SUPPLY OF PROPULSION UNITS IN VEHICLES
    • B60K31/00—Vehicle fittings, acting on a single sub-unit only, for automatically controlling vehicle speed, i.e. preventing speed from exceeding an arbitrarily established velocity or maintaining speed at a particular velocity, as selected by the vehicle operator
    • 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/10—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 vehicle motion
    • B60W40/112—Roll movement
    • 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/10—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 vehicle motion
    • B60W40/114—Yaw movement
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
    • G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
    • G01C21/165—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
    • G01C21/1656—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments with passive imaging devices, e.g. cameras
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
    • 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
    • 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
    • B60Y—INDEXING SCHEME RELATING TO ASPECTS CROSS-CUTTING VEHICLE TECHNOLOGY
    • B60Y2400/00—Special features of vehicle units
    • B60Y2400/30—Sensors
    • B60Y2400/301—Sensors for position or displacement
    • B60Y2400/3015—Optical cameras
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
    • G01C21/28—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network with correlation of data from several navigational instruments
    • G—PHYSICS
    • G08—SIGNALLING
    • G08G—TRAFFIC CONTROL SYSTEMS
    • G08G1/00—Traffic control systems for road vehicles
    • G08G1/16—Anti-collision systems

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Mathematical Physics (AREA)
  • General Physics & Mathematics (AREA)
  • Combustion & Propulsion (AREA)
  • Chemical & Material Sciences (AREA)
  • Theoretical Computer Science (AREA)
  • Multimedia (AREA)
  • Length Measuring Devices By Optical Means (AREA)
  • Image Processing (AREA)
  • Navigation (AREA)
  • Traffic Control Systems (AREA)

Abstract

本发明的自身位置计算装置向车辆周围的路面投光图案光，拍摄车辆周围的路面而获取图像。然后，在检测车辆的行驶状态，判定为车辆处于行驶稳定状态的情况下，自身位置计算装置对规定的初始姿态角加上姿态变化量，计算车辆的当前位置以及姿态角。

Description

自身位置计算装置以及自身位置计算方法
技术领域
本发明涉及自身位置计算装置以及自身位置计算方法。
背景技术
已知通过车辆上安装的摄像机拍摄并获取车辆近旁的图像，根据该图像的变化求车辆的移动量的技术(参照专利文献1)。在专利文献1中，为了即使在车辆低速且微妙地移动了的情况下也高精度地求得移动量，从图像中检测特征点，求该特征点的位置，根据特征点的移动方向以及移动距离(移动量)求车辆的移动量。
现有技术文献
专利文献
专利文献1:日本特开2008－175717号公报
发明内容
但是，在上述的以往的技术中，如果在车辆的行为不稳定时重置用于求车辆的移动量的起点，则存在不能高精度地估计车辆的移动量的问题。
因此，本发明是鉴于上述的实际情况而提出的，目的是提供可以在车辆的行为稳定时重置用于计算车辆的自身位置的起点，高精度地计算车辆的自身位置的自身位置计算装置及其方法。
为了解决上述的课题，本发明的一个方式的自身位置计算装置拍摄被投光了图案光的车辆周围的路面，获取图像，由该图像中的图案光的位置计算车辆相对于路面的姿态角。然后，自身位置计算装置，根据获取的图像中的路面上的多个特征点的时间变化计算车辆的姿态变化量，通过对车辆的初始位置以及姿态角加上姿态变化量，计算车辆的当前位置以及姿态角。然后，在判定为车辆处于行驶稳定状态的情况下，自身位置计算装置对规定的初始距离以及初始姿态角加上姿态变化量，计算车辆的当前位置以及姿态角。
附图说明
图1是表示第1实施方式的自身位置计算装置的整体结构的方框图。
图2是表示一例将投光器以及摄像机安装在车辆上的方法的外观图。
图3(a)是表示使用投光器和摄像机计算亮点光在被照射的路面上的位置的状况的图，图3(b)是表示根据在与被照射了图案光的区域不同的区域中检测到的特征点的时间变化求摄像机的移动方向的状况的图。
图4是表示对摄像机获取的图像实施二值化处理后的图案光的图像的图，图4(a)是表示图案光整体的图，图4(b)是表示将一个亮点光扩大表示的图，图4(c)是表示亮点光的重心位置的图。
图5是用于说明计算距离以及姿态角的变化量的方法的示意图。
图6是表示在图像上检测到的特征点的图，图6(a)是表示在时刻t获取的第1帧(图像)的图，图6(b)是表示在时刻t+Δt获取的第2帧的图。
图7是表示第1实施方式的自身位置计算装置进行的根据是否为行驶稳定状态来重置车辆的距离以及姿态角的处理的定时图。
图8是表示第1实施方式的自身位置计算装置进行的自身位置计算处理的处理步骤的流程图。
图9是表示第1实施方式的自身位置计算装置进行的图8的步骤S09的详细的处理步骤的流程图。
图10是表示第2实施方式的自身位置计算装置进行的图8的步骤S09的详细的处理步骤的流程图。
具体实施方式
以下，参照附图说明适用了本发明的第1实施方式以及第2实施方式。
[第1实施方式]
[硬件结构]
首先，参照图1，说明第1实施方式的自身位置计算装置的硬件结构。自身位置计算装置包括：投光器11；摄像机12；以及发动机控制单元(ECU)13。投光器11被安装在车辆上，对车辆周围的路面投光图案光。摄像机12是被安装在车辆上、拍摄包含被投光了图案光的区域的车辆周围的路面，获取图像的摄像单元的一个例子。ECU13是控制投光器11，并且执行由摄像机12获取的图像计算车辆的自身位置的一连串的信息处理循环的控制单元的一个例子。
摄像机12是使用了固体摄像元件，例如CCD以及CMOS的数字摄像机，获取可进行图像处理的数字图像。摄像机12的摄像对象是车辆周围的路面，在车辆周围的路面中，包含车辆的前部、后部、侧部、车辆底部的路面。例如，如图2所示，摄像机12可以安装在车辆10的前部，具体地说安装在前保险杠上。调整摄像机12所设置的高度以及朝向，并且，自动调整摄像机12具有的镜头的焦距以及光圈，以便可以拍摄车辆10的前方的路面31上的特征点(纹理)以及由投光器11投光的图案光32b。摄像机12每隔规定的时间间隔反复进行摄像，获取一连串的图像(帧)群。由摄像机12获取的图像数据在每次拍摄时被转发至ECU13，存储在ECU13具有的存储器中。
如图2所示，投光器11朝向摄像机12的摄像范围内的路面31，投光具有包含正方形或长方形的栅格像的规定形状的图案光32b。摄像机12拍摄被照射到路面31的图案光。投光器11例如具有激光指示器以及衍射光栅。通过以衍射光栅衍射从激光指示器射出的激光，如图2～图4所示，投光器11生成由栅格像或者排列为矩阵状的多个亮点光Sp构成的图案光(32b，32a)。在图3以及图4所示的例子中，生成5×7的亮点光Sp构成的图案光32a。
返回图1，ECU13由具有CPU、存储器、以及输入输出单元的微控制器构成，通过执行预先安装的计算机程序，构成作为自身位置计算装置起作用的多个信息处理单元。ECU13对每图像(帧)反复执行根据由摄像机12获取的图像来计算车辆的当前位置的一连串的信息处理循环。ECU13也可以与车辆10有关的其它控制中使用的ECU兼用。
这里，在多个信息处理单元中包括：图案光提取单元21；姿态角计算单元22；特征点检测单元23；姿态变化量计算单元24；自身位置计算单元26；图案光控制单元27；以及行驶状态判断单元30。在姿态变化量计算单元24中包含特征点检测单元23。
图案光提取单元21从存储器读入由摄像机12获取的图像，从该图像提取图案光的位置。如图3(a)所示，例如，投光器11向路面31投光被排列为矩阵状的多个亮点光构成的图案光32a，用摄像机12检测被路面31反射的图案光32a。如图4(a)以及图4(b)所示，图案光提取单元21通过对由摄像机12获取的图像实施二值化处理，仅提取亮点光Sp的图像。如图4(c)所示，图案光提取单元21通过计算各亮点光Sp的重心的位置He，即亮点光Sp在图像上的坐标(Uj，Vj)，提取图案光32a的位置。坐标在以摄像机12的摄像元件的像素为单位，5×7的亮点光Sp的情况下，“j”为1以上35以下的自然数。亮点光Sp的图像上的坐标(Uj，Vj)作为表示图案光32a的位置的数据，存储在存储器中。
姿态角计算单元22从存储器读入表示图案光32a的位置的数据，根据由摄像机12获取的图像中的图案光32a的位置，计算车辆10对于路面31的距离以及姿态角。例如，如图3(a)所示，根据投光器11与摄像机12之间的基线长Lb和各亮点光在图像上的坐标(Uj，Vj)，使用三角测量的原理，计算各亮点光在所照射的路面31上的位置，作为对于摄像机12的相对位置。然后，姿态角计算单元22根据各亮点光对于摄像机12的相对位置，计算投光了图案光32a的路面31的平面式，即，摄像机12对于路面31的距离以及姿态角(法线向量)。
而且，由于摄像机12对于车辆10的安装位置以及摄像方向已知，所以在实施方式中，作为车辆10对于路面31的距离以及姿态角的一个例子，计算摄像机12对于路面31的距离以及姿态角。换言之，通过计算摄像机12相对路面31的距离以及姿态角，可以求出路面31和车辆10之间的距离、以及车辆10对于路面31的姿态角。
具体地说，由于摄像机12以及投光器11被分别固定在车辆10上，所以图案光32a的照射方向、摄像机12和投光器11的距离(基线长Lb)是已知的。因此，姿态角计算单元22使用三角测量的原理，可以从各亮点光在图像上的坐标(Uj，Vj)求各亮点光在被照射时的路面31上的位置，作为对于摄像机12的相对位置(Xj，Yj，Zj)。以后，将摄像机12对于路面31的距离以及姿态角简称为“距离以及姿态角”。由姿态角计算单元22算出的距离以及姿态角被存储在存储器中。
而且，各亮点光对于摄像机12的相对位置(Xj，Yj，Zj)不存在于同一平面上的情况较多。这是因为，与路面31上表露出的沥青的凹凸相应，各亮点光的相对位置产生变化。因此，也可以使用最小二乘法，求与各亮点光的距离误差的平方和最小的平面式。在图1所示的自身位置计算单元26中使用这样算出的距离以及姿态角的数据。
特征点检测单元23从存储器读入由摄像机12获取的图像，根据从存储器读入的图像，检测路面31上的特征点。特征点检测单元23为了检测路面31上的特征点，例如，可以使用“D.G.Lowe，“Distinctive Image Features from Scale-Invariant Keypoints,”Int.J.Comput.Vis.,vol.60,no.2,pp.91-110,Nov.200”中记载的方法。或者，特征点检测单元23也可以使用“金澤靖,金谷健一,“コンピュータビジョンのための画像の特徴点抽出,”信学誌,vol.87,no.12,pp.1043-1048,Dec.2004”中记载的方法。
具体地说，特征点检测单元23例如使用哈里斯(Harris)运算符或者SUSAN算符，检测物体的顶点那样与周围相比亮度值较大地变化的点作为特征点。或者，特征点检测单元23也可以使用SIFT(Scale-Invariant Feature Transform，尺度不变特征变换)特征量，检测在其周围亮度值按照某个规则性变化的点作为特征点。然后，特征点检测单元23对从一个图像检测到的特征点的总数N进行计数，对各特征点附加识别号(i(1≦i≦N))。各特征点在图像上的位置(Ui，Vi)被存储在ECU13内的存储器中。图6(a)以及图6(b)表示从摄像机12获取的图像检测到的特征点Te的例子。进而，将各特征点Te的变化方向以及变化量作为向量Dte表示。
而且，实施方式中，路面31上的特征点主要设想大小为1cm以上2cm以下的沥青混合物的颗粒。为了检测该特征点，摄像机12的分辨率为VGA(约30万像素)。而且，摄像机12对于路面31的距离约为70cm。进而，摄像机12的摄像方向从水平面约45度(deg)向路面31倾斜。而且，将摄像机12获取的图像转发至ECU13时的亮度数值为0～255(0：最暗，255：最亮)的范围内。
姿态变化量计算单元24从存储器读入在每个固定的信息处理循环中拍摄的各帧的图像中、前次帧图像中包含的多个特征点在图像上的位置(Ui，Vi)，进而，从存储器读入本次(时刻t+Δt)的帧的图像中包含的多个特征点在图像上的位置(Ui，Vi)。然后，姿态变化量计算单元24根据多个特征点在图像上的随时间的位置变化，求车辆的姿态变化量。这里，所谓“车辆的姿态变化量”包含车辆对于路面的“距离以及姿态角”的变化量，以及路面上的“车辆的移动量”双方。以下，说明“距离以及姿态角的变化量”以及“车辆的移动量”的计算方法。
例如可以如下那样求距离以及姿态角的变化量。图6(a)是表示在时刻t获取的第1帧(图像)38(图5)的一例。如图5或者图6(a)所示，考虑在第1帧38中，例如分别计算三个特征点Te1、Te2、Te3的相对位置(Xi，Yi，Zi)的情况。在该情况下，可以将由特征点Te1、Te2、Te3确定的平面G视为路面。由此，姿态变化量计算单元24可以根据各特征点的相对位置(Xi，Yi，Zi)，求摄像机12对于路面(平面G)的距离以及姿态角(法线向量)。进而，姿态变化量计算单元24可以通过已知的摄像机模型，求各特征点Te1、Te2、Te3之间的距离(l1，l2，l3)以及连结各个特征点Te1、Te2、Te3的直线所成的角度。图5的摄像机12表示拍摄第1帧38时的摄像机的位置。
而且，在图5中，作为表示特征点对于摄像机12的相对位置的3维坐标(Xi，Yi，Zi)，将摄像机12的摄像方向设定为Z轴，在以摄像方向为法线并且包含摄像机12的平面内，设定相互正交的X轴以及Y轴。另一方面，作为图像38上的坐标，将水平方向以及垂直方向分别设定为V轴以及U轴。
图6(b)表示在从时刻t经过了时间Δt的时刻(t+Δt)获取的第2帧38’。图5的摄像机12’表示拍摄第2帧38’时的摄像机的位置。如图5或者图6(b)所示，在第2帧38’中，摄像机12’拍摄特征点Te1、Te2、Te3，特征点检测单元23检测特征点Te1、Te2、Te3。在该情况下，姿态变化量计算单元24可以由时刻t的各特征点Te1～Te3的相对位置(Xi，Yi，Zi)、各特征点在第2帧38’上的位置P1(Ui，Vi)、和摄像机12的摄像机模型，计算时间Δt的摄像机12的移动量ΔL。因此，进而可以计算车辆的移动量。例如，通过解以下的式(1)～(4)构成的联立方程式，姿态变化量计算单元24可以计算摄像机12(车辆)的移动量(ΔL)以及距离以及姿态角的变化量。而且，下述式(1)是摄像机12作为没有失真和光轴偏差的理想的针孔摄像机进行了模型化所得的式子，λi是常数，f是焦点距离。摄像机模型的参数只要预先校准即可。
λ i u i v i 1 = f 0 0 0 f 0 0 0 1 x i y i z i ... ( 1 )
(x1-x2)2+(y1-y2)2+(z1-z2)2＝l1 2 …(2)
(x3-x2)2+(y3-y2)2+(z3-z2)2＝l2 2 …(3)
(x1-x3)2+(y1-y3)2+(z1-z3)2＝l3 2 …(4)
而且，姿态变化量计算单元24也可以不使用在时刻t和时刻t+Δt检测出的各图像中算出相对位置的全部特征点，而根据特征点之间的位置关系选定最佳的特征点。作为选定方法，例如，可以使用对极几何(对极极线几何，R.I.Hartley:“A linear method forreconstruction from lines and points,”Proc.5th International Conference onComputer Vision,Cambridge,Massachusetts,pp.882-887(1995))。
这样，在特征点检测单元23从时刻t+Δt的帧图像38’也检测到了在时刻t的帧图像38中算出了相对位置(Xi，Yi，Zi)的特征点Te1，Te2，Te3的情况下，姿态变化量计算单元24由路面上的多个特征点的相对位置(Xi，Yi，Zi)与特征点在图像上的位置(Ui，Vi)的时间变化，可以计算“车辆的姿态角变化量”。进而，可以计算车辆的移动量。
即，只要可以继续检测在前次帧和本次帧之间取得对应关系的3点以上的特征点，则可以通过继续加上距离以及姿态角的变化量的处理(积分运算)，不使用图案光32a而继续更新距离或姿态角。其中，在最初的信息处理循环中，也可以使用利用图案光32a算出的距离以及姿态角，或者规定的初始距离以及初始姿态角。即，成为积分运算的起点的距离以及姿态角既可以使用图案光32a计算，或者，也可以使用规定的初始距离及初始姿态角。优选规定的初始距离以及初始姿态角是至少考虑了至车辆10的乘员以及装载物的距离以及姿态角。例如，在车辆10的点火开关为接通状态，并且档位从泊车档移动到了其它的档位时，投光图案光32a，并使用从图案光32a算出的距离以及姿态角作为规定的初始位置以及初始姿态角即可。由此，可以求出在没有发生车辆10的旋转或加减速导致的摇摆(roll)运动或者俯仰(pitch)运动时的距离和姿态角。
为了将前后帧之间将特征点相对应，例如可以预先将检测到的特征点的周边的小区域的图像记录在存储器中，由亮度或颜色信息的类似度进行判断。具体地说，ECU13在存储器中记录以检测到的特征点为中心的相当于5×5(水平×垂直)像素的图像。例如，若亮度信息在20像素以上、收敛在误差1％以下，则姿态变化量计算单元24判断为其是在前后帧之间取得对应关系的特征点。然后，在后级的自身位置计算单元26中计算车辆的自身位置时使用在上述的处理中获取的姿态变化量。
自身位置计算单元26根据由姿态变化量计算单元24算出的“距离以及姿态角的变化量”计算车辆的当前的距离以及姿态角。进而，根据由姿态变化量计算单元24算出的“车辆的移动量”计算车辆的自身位置。
具体地说，对设定由姿态角计算单元22算出的距离以及姿态角(使用图案光算出的距离以及姿态角)作为起点的情况进行说明。在该情况下，对于该起点(距离以及姿态角)，自身位置计算单元26逐次加上由姿态变化量计算单元24算出的各帧的每一帧的距离以及姿态角的变化量(进行积分运算)，将距离以及姿态角更新为最新的数值。而且，自身位置计算单元26将由姿态角计算单元22算出距离以及姿态角时的车辆位置设为起点(车辆的初始位置)，逐次加上从该初始位置起的车辆的移动量(进行积分运算)，计算车辆的自身位置。例如，通过设定与地图上的位置核对后的起点(车辆的初始位置)，可以逐次计算地图上的车辆的当前位置。
因此，姿态变化量计算单元24通过求出时间Δt期间的摄像机12的移动量(ΔL)，可以计算车辆的自身位置。进而，由于还可以同时计算距离以及姿态角的变化量，所以姿态变化量计算单元24可以考虑车辆的距离以及姿态角的变化量，高精度地计算6自由度(前后，左右，上下，偏摆，俯仰，摇摆)的移动量(ΔL)。即，即使由于车辆10的旋转或加减速导致的摇摆运动或者俯仰运动，距离或姿态角变化，也可以抑制移动量(ΔL)的估计误差。
而且，在本实施方式中，通过计算距离以及姿态角的变化量，更新距离以及姿态角，计算摄像机12的移动量(ΔL)，但是也可以仅将摄像机12对于路面31的姿态角作为变化量计算以及更新的对象。在该情况下，只要路面31和摄像机12之间的距离假定为固定即可。由此，考虑姿态角的变化量，抑制移动量(ΔL)的估计误差，减轻ECU13的运算负载，并且还可以使运算速度提高。
图案光控制单元27控制投光器11进行的图案光32a的投光。例如，在车辆10的点火开关为接通状态，自身位置计算装置起动的同时，图案光控制单元27开始图案光32a的投光。之后，在自身位置计算装置停止之前，图案光控制单元27连续地投光图案光32a。或者，也可以每隔规定的时间间隔，反复进行投光的接通/关断。
行驶状态判定单元30检测车辆10的行驶状态，判定车辆10是否为行驶稳定状态。然后，在判断为车辆10处于行驶稳定状态的情况下，自身位置计算单元26设定车辆10处于行驶稳定状态的位置以及规定的初始距离以及初始姿态角，作为用于计算自身位置的起点。由此，自身位置计算单元26对车辆10处于行驶稳定状态的位置以及规定的初始距离以及初始姿态角加上姿态变化量，计算当前的车辆10的当前位置、对于路面的距离以及姿态角。
另一方面，在判定为车辆10不处于行驶稳定状态的情况下，行驶状态判定单元30判定是否通过姿态角计算单元22在本次的信息处理循环中由图案光32a计算出车辆10的距离以及姿态角。然后，在姿态角计算单元22算出车辆10的距离以及姿态角的情况下，自身位置计算单元26设定本次的信息处理循环中算出的车辆10的当前位置、对于路面的距离以及姿态角作为用于计算自身位置的起点。
而且，在通过姿态角计算单元22未在本次的信息处理循环中计算出车辆10的距离以及姿态角的情况下，自身位置计算单元26设定在前次的信息处理循环中算出的车辆10的当前位置、对于路面的距离以及姿态角作为用于计算自身位置的起点。
这里，对判定车辆10的行驶状态是否处于行驶稳定状态的方法进行说明。在本实施方式中，在满足车辆10在停车的情况、车辆10的速度固定的情况、车辆10在直行的情况的其中一个、或者任意多个、或者全部的情况下，判定为车辆10处于行驶稳定状态。
作为车辆10是否在停车的判定方法，在车辆10中安装的车轮速传感器的值为0的情况下，判定为车辆10在停车。
而且，车辆10的速度是否为固定的判定方法是，在车辆10中安装的加速度传感器的前后方向的加速度为阈值以下的情况下，判定为车辆10的速度固定。作为阈值，与车辆10静止的状态进行比较，预先求出俯仰角变化0.01[rad]≒0.57[deg]的前后方向的加速度Xg，设定为该值。由此，可以将计算车辆10的移动量时的误差抑制为1％以下。而且，在车辆10中未安装加速度传感器的情况下，既可以将车轮速传感器的值进行微分而求加速度，也可以将姿态变化量计算单元24算出的移动量进行时间微分而求加速度。
进而，车辆10是否在直行的判定方法是，在车辆10中安装的加速度传感器的车宽方向的加速度为阈值以下的情况下，判断为车辆10在直行。作为阈值，例如，与车辆10静止的状态进行比较，预先求出滚动角变化0.01[rad]≒0.57[deg]的车宽方向的加速度Yg，设定为该值。由此，可以将计算车辆10的移动量时的误差抑制到1％以下。
而且，既可以将与车宽方向的加速度为Yg的车速V相应的偏摆率γ[rad/s](Yg≒V×γ)设为阈值，也可以将方向盘转向角设为阈值。而且，在车辆10中未安装加速度传感器或偏摆率传感器的情况下，也可以将姿态变化量计算单元24算出的移动量进行时间微分，求加速度。
这样，通过行驶状态判定单元30判定车辆10是否为行驶稳定状态，在判定为行驶稳定状态时，自身位置计算单元26对车辆10处于行驶稳定状态的位置以及规定的初始距离以及初始姿态角加上姿态变化量，计算当前的车辆10的当前位置、对于路面的距离以及姿态角。这里，作为规定的初始距离以及初始姿态角，使用车辆10的点火开关被接通时的车辆10对于路面的距离以及姿态角。
例如，如图7所示，在对行驶状态判定单元30监视着车辆10的前后方向的加速度的情况进行说明时，阈值被设定为俯仰角变化0.01[rad]的加速度Xg。在该情况下，在时刻t1车辆10的点火开关被接通时，姿态角计算标记被打开(ON)，在该定时照射图案光32a。然后，姿态角计算单元22由图案光32a的位置计算车辆10的距离以及姿态角，存储在存储器中。此后，在时刻t2，因为车辆10的前后方向的加速度为阈值Xg以下，所以行驶状态判定单元30判断为行驶稳定状态，将重置标记设定为打开。因此，自身位置计算单元26重置用于计算自身位置的起点，使用规定的初始距离以及初始姿态角，即点火开关被接通时的车辆10的当前位置、对于路面的距离以及姿态角作为起点。
但是，在时刻t3时，车辆10的前后方向的加速度超过阈值Xg，所以行驶状态判定单元30判断为不处于行驶稳定状态，将重置标记设定为关闭。因此，自身位置计算单元26中止使用规定的初始距离以及初始姿态角作为引用计算自身位置的起点。此后，在时刻t4时，由于车辆10的前后方向的加速度再次成为阈值Xg以下，所以判定为处于行驶稳定状态，重置标记打开，自身位置计算单元26使用规定的初始距离以及初始姿态角作为起点。
这样，在本实施方式中，在判断为车辆10为行驶稳定状态的情况下，将用于计算自身位置的起点设定为规定的初始距离以及初始姿态角。由此，由于在车辆10的行为稳定时，可以重置用于计算自身位置的起点，所以可以高精度地计算车辆10的自身位置。
[信息处理循环]
接着，参照图8以及图9，说明通过ECU13被反复执行的信息处理循环。该信息处理循环是由摄像机12获取的图像38计算车辆10的自身位置的自身位置计算方法的一个例子。
图8的流程图所示的信息处理循环与车辆10的点火开关为接通状态、自身位置计算装置起动的同时开始，直至自身位置计算装置停止被反复执行。
在图8的步骤S01中，图案光控制单元27控制投光器11，对车辆周围的路面31投光图案光32a。
进至步骤S03，ECU13控制摄像机12，拍摄包含被投光了图案光32a的区域的车辆周围的路面31，获取图像38。ECU13将由摄像机12获取的图像数据存储在存储器中。
而且，ECU13可以自动控制摄像机12的光圈。也可以由前一个信息处理循环中获取的图像38的平均亮度反馈控制摄像机12的光圈，以使其成为亮度值的最大值和最小值的中间值。而且，因为被投光了图案光32a的区域亮度值高，所以ECU13也可以从除去了提取了图案光32a的部分的区域，求平均亮度值。
进至步骤S05，首先，图案光提取单元21从存储器读入由摄像机12获取的图像38，如图4(c)所示，从图像38提取图案光32a的位置。图案光提取单元21将作为表示图案光32a的位置的数据算出的亮点光Sp在图像上的坐标(Uj，Vj)存储在存储器中。
进而，在步骤S05中，姿态角计算单元22从存储器读入表示图案光32a的位置的数据，由图案光32a的位置计算车辆10对于路面31的距离以及姿态角，存储在存储器中。
进至步骤S07，ECU13从图像38检测特征点，提取在前后的信息处理循环之间取得对应关系的特征点，由特征点在图像上的位置(Ui，Vi)计算距离以及姿态角的变化量，进而计算车辆的移动量。
具体地说，首先，特征点检测单元23从存储器读入由摄像机12获取的图像38，从图像38检测路面31上的特征点，将各特征点在图像上的位置(Ui，Vi)存储在存储器中。
姿态变化量计算单元24从存储器读入各特征点在图像上的位置(Ui，Vi)，由姿态角计算单元22算出的距离以及姿态角和特征点在图像上的位置(Ui，Vi)，计算特征点对于摄像机12的相对位置(Xi，Yi，Zi)。而且，姿态变化量计算单元24使用在前一个信息处理循环的步骤S09中设定的距离以及姿态角。然后，姿态变化量计算单元24将特征点对于摄像机12的相对位置(Xi，Yi，Zi)存储在存储器中。
此后，姿态变化量计算单元24从存储器读入特征点在图像上的位置(Ui，Vi)，以及在前一个信息处理循环的步骤S07中算出的特征点的相对位置(Xi，Yi，Zi)。姿态变化量计算单元24使用在前后的信息处理循环之间取得对应关系的特征点的相对位置(Xi，Yi，Zi)以及图像上的位置(Ui，Vi)，计算距离以及姿态角的变化量。进而，姿态变化量计算单元24由前一次信息处理循环中的特征点的相对位置(Xi，Yi，Zi)和本次信息处理循环中的特征点的相对位置(Xi，Yi，Zi)，计算车辆的移动量，存储在存储器中。步骤S07中算出的“距离以及姿态角的变化量”以及“车辆的移动量”，在步骤S11的处理中被使用。
进至步骤S09，ECU13根据车辆的行驶状态，设定用于计算自身位置的积分运算的起点。细节参照图9，如后所述。
进至步骤S11，自身位置计算单元26由步骤S09的处理中设定的积分运算的起点、以及步骤S07的处理中算出的车辆10的距离以及姿态角的变化量，计算车辆10的自身位置。
这样，本实施方式的自身位置计算装置通过反复执行上述的一连串的信息处理循环，累计车辆10的移动量，可以计算车辆10的自身位置。
[步骤S09的处理]
接着，参照图9的流程图，说明图8的步骤S09的详细的步骤。如图9所示，在步骤S101中，行驶状态判定单元30检测车辆10的行驶状态。具体地说，一边通过车轮速传感器检测车辆10的速度，一边通过加速度传感器检测车辆10的前后方向和车宽方向的加速度。而且，也可以通过偏摆率传感器检测车辆10的偏摆率。
接着，步骤S103中，行驶状态判定单元30判定车辆10是否处于行驶稳定状态。具体地说，行驶状态判定单元30在车辆10停车的情况下判断为处于行驶稳定状态。在该情况下，在车辆10中安装的车轮速传感器的值为0时，判断车辆10已停车，判定为处于行驶稳定状态。
而且，行驶状态判定单元30在车辆10的速度固定的情况下判断为行驶稳定状态。在该情况下，在由车辆10上安装的加速度传感器检测的前后方向的加速度为阈值以下时，判断为车辆10的速度固定，判定为处于行驶稳定状态。
进而，行驶状态判定单元30在车辆10直行的情况下判定为行驶稳定状态。在该情况下，在由车辆10上安装的加速度传感器检测的车宽方向的加速度为阈值以下时，判断车辆10在直行，判定为处于行驶稳定状态。
这样，在进行车辆10是否处于行驶稳定状态的判定，行驶状态判定单元30判定为处于行驶稳定状态的情况下(步骤S103中“是”)进至步骤S105。而且，在行驶状态判定单元30判定为不处于行驶稳定状态的情况下(步骤S103中“否”)进至步骤S107。
在步骤S105中，自身位置计算单元26设定规定的初始距离以及初始姿态角，作为积分运算的起点。例如，在本实施方式中，设定车辆10的点火开关被接通时的车辆10对于路面的距离以及姿态角，作为规定的初始距离以及初始姿态角。
在步骤S107中，行驶状态判定单元30判定是否通过姿态角计算单元22由图案光32a计算了距离以及姿态角。然后，在本次的信息处理循环的步骤S05中，在姿态角计算单元22计算了距离以及姿态角的情况下(步骤S107中“是”)，进至步骤S109。另一方面，在本次的信息处理循环的步骤S05中，姿态角计算单元22未计算距离以及姿态角的情况下(步骤S107中“否”)，进至步骤S111。
在步骤S109中，作为积分运算的起点，自身位置计算单元26设定在本次的信息处理循环的步骤S05中由图案光32a算出的距离以及姿态角。而且，自身位置计算单元26设定在本次的信息处理循环中算出距离以及姿态角时的车辆位置作为积分运算的起点(车辆的初始位置)。
在步骤S111中，自身位置计算单元26设定在前次的信息处理循环的步骤S05中由图案光32a算出的距离以及姿态角，作为积分运算的起点。而且，自身位置计算单元26设定在前次的信息处理循环中算出了距离以及姿态角时的车辆位置，作为积分运算的起点(车辆的初始位置)。
这样，若积分运算的起点被设定，则步骤S09的处理结束，进至图8的步骤S11。
[第1实施方式的效果]
如以上详细地说明的那样，在本实施方式的自身位置计算装置中，在判定为车辆10处于行驶稳定状态的情况下，对规定的初始距离以及初始姿态角加上姿态变化量，计算当前的车辆10的当前位置、对于路面的距离以及姿态角。由此，在车辆10的行为稳定时，可以将用于计算车辆10的自身位置的起点重置为初始距离以及初始姿态角，所以可以高精度地计算车辆10的自身位置。进而，由于可以定期地将用于计算车辆10的自身位置的起点重置为初始距离以及初始姿态角，所以可以防止误差扩大。
而且，在本实施方式的自身位置计算装置中，在车辆10停车时判定为处于行驶稳定状态，所以可以确实地检测车辆10的行为稳定的状态，由此可以高精度地计算车辆10的自身位置。
进而，在本实施方式的自身位置计算装置中，由于在车辆10的速度固定时判定为处于行驶稳定状态，所以可以确实地检测车辆10的行为稳定的状态，由此可以高精度地计算车辆10的自身位置。
而且，在本实施方式的自身位置计算装置中，在车辆10直行时判定为处于行驶稳定状态，所以可以确实地检测车辆10的行为稳定的状态，由此可以高精度地计算车辆10的自身位置。
进而，在本实施方式的自身位置计算装置中，使用车辆10的点火开关接通时的车辆10对于路面的距离以及姿态角作为规定的初始距离以及初始姿态角。由此，由于可以将反映了车辆10的乘员数和载重量的值设为初始距离以及初始姿态角，所以可以更正确地计算车辆10的自身位置。
[第2实施方式]
接着，参照附图说明本发明的第2实施方式的自身位置计算装置。其中，本实施方式的自身位置计算装置的结构与图1所示的第1实施方式相同，所以省略详细的说明。
[信息处理循环]
基于本实施方式的自身位置计算装置的信息处理循环与图8所示的第1实施方式相同，所以省略详细的说明。在本实施方式中，设定图8的步骤S09的积分运算的起点的处理与第1实施方式不同。
[步骤S09的处理]
接着，参照图10的流程图，说明图8的步骤S09的详细的步骤。在上述的第1实施方式中，在步骤S103中判定了车辆10是否处于行驶稳定状态之后，在步骤S107中判定了是否由图案光32a计算距离以及姿态角。但是，在本实施方式中，在图10所示步骤S203中判定了是否由图案光32a计算距离以及姿态角之后，在步骤S205中判定车辆10是否处于行驶稳定状态。
对于除此之外的步骤S201、S207～S211的处理，分别与图9的步骤S101、S105，S109，S111的处理相同，所以省略详细的说明。
[第2实施方式的效果]
如上所述，在本实施方式的自身位置计算装置中，限于在本次的信息处理循环中不能由图案光32a计算车辆10的距离以及姿态角的情况，判定车辆10是否处于行驶稳定状态。由此，因为可以减少进行判定车辆是否处于行驶稳定状态的处理的频度，所以可以减轻ECU13的运算负担，并且使运算速度提高。
而且，上述的实施方式是本发明的一个例子。因此，本发明不限于上述的实施方式，即使是该实施方式以外的方式，只要是不脱离本发明的技术的思想的范围，则当然可以根据设计等存在各种变更。
标号说明
10 车辆
11 投光器
12 摄像机(摄像单元)
13 ECU
21 图案光提取单元
22 姿态角计算单元
23 特征点检测单元
24 姿态变化量计算单元
26 自身位置计算单元
27 图案光控制单元
30 行驶状态判定单元
31 路面
32a，32b 图案光
Te 特征点

Claims (6)

1.一种自身位置计算装置，其特征在于，包括：
投光器，对车辆周围的路面投光图案光；
摄像单元，被安装在所述车辆上，拍摄包含被投光了所述图案光的区域的车辆周围的路面，获取图像；
姿态角计算单元，由所述摄像单元获取的图像中的所述图案光的位置，计算车辆对于所述路面的姿态角；
姿态变化量计算单元，根据所述摄像单元获取的图像中的所述路面上的多个特征点的时间变化，计算所述车辆的姿态变化量；
自身位置计算单元，通过对所述车辆的初始位置以及姿态角不断加上所述姿态变化量，计算所述车辆的当前位置以及姿态角；以及
行驶状态判定单元，检测所述车辆的行驶状态，判定所述车辆是否处于行驶稳定状态，
在通过所述行驶状态判定单元判定为所述车辆处于行驶稳定状态的情况下，所述自身位置计算单元对所述车辆处于行驶稳定状态时的所述车辆的当前位置以及规定的初始姿态角加上所述姿态变化量，计算所述车辆的当前位置以及姿态角。
2.如权利要求1所述的自身位置计算装置，其特征在于，
在所述车辆停车时，所述行驶状态判定单元判定为处于行驶稳定状态。
3.如权利要求1或2所述的自身位置计算装置，其特征在于，
在所述车辆的速度固定时，所述行驶状态判定单元判定为处于行驶稳定状态。
4.如权利要求1至3的任意一项所述的自身位置计算装置，其特征在于，
在所述车辆直行时，所述行驶状态判定单元判定为处于行驶稳定状态。
5.如权利要求1至4的任意一项所述的自身位置计算装置，其特征在于，
所述自身位置计算单元使用所述车辆的点火开关被接通时的所述车辆的当前位置以及姿态角，作为所述规定的初始姿态角。
6.一种自身位置计算方法，其特征在于，包括：
对车辆周围的路面投光图案光的步骤；
拍摄包含被投光了所述图案光的区域的车辆周围的路面，获取图像的步骤；
由所述图像中的所述图案光的位置，计算车辆对于所述路面的姿态角的步骤；
根据所述图像中的所述路面上的多个特征点的时间变化，计算所述车辆的姿态变化量的步骤；
通过对所述车辆的初始位置以及姿态角不断加上所述姿态变化量，计算所述车辆的当前位置以及姿态角的自身位置计算步骤；以及
检测所述车辆的行驶状态，判定所述车辆是否处于行驶稳定状态的行驶状态判定步骤，
在通过所述行驶状态判定步骤判定为所述车辆处于行驶稳定状态的情况下，在所述自身位置计算步骤中对所述车辆处于行驶稳定状态时的所述车辆的当前位置以及规定的初始姿态角加上所述姿态变化量，计算所述车辆的当前位置以及姿态角。
CN201480076278.5A 2014-02-24 2014-02-24 自身位置计算装置以及自身位置计算方法 Active CN106030681B (zh)

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/JP2014/054315 WO2015125299A1 (ja) 2014-02-24 2014-02-24 自己位置算出装置及び自己位置算出方法

Publications (2)

Publication Number Publication Date
CN106030681A true CN106030681A (zh) 2016-10-12
CN106030681B CN106030681B (zh) 2017-09-05

Family

ID=53877832

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201480076278.5A Active CN106030681B (zh) 2014-02-24 2014-02-24 自身位置计算装置以及自身位置计算方法

Country Status (8)

Country Link
US (1) US9684837B2 (zh)
EP (1) EP3113147B1 (zh)
JP (1) JP6176387B2 (zh)
CN (1) CN106030681B (zh)
BR (1) BR112016019589B1 (zh)
MX (1) MX349227B (zh)
RU (1) RU2628420C1 (zh)
WO (1) WO2015125299A1 (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110231826A (zh) * 2019-06-25 2019-09-13 苏州佳世达光电有限公司 运输车控制方法、系统及应用其的运输车

Families Citing this family (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP6532229B2 (ja) * 2014-12-18 2019-06-19 株式会社デンソーテン 物体検出装置、物体検出システム、物体検出方法及びプログラム
US10783382B2 (en) * 2016-04-06 2020-09-22 Semiconductor Components Industries, Llc Systems and methods for buffer-free lane detection
WO2018216342A1 (ja) * 2017-05-24 2018-11-29 ソニー株式会社 情報処理装置、情報処理方法、及びプログラム
US10580299B2 (en) * 2017-10-13 2020-03-03 Waymo Llc Lane change notification
KR102639078B1 (ko) * 2018-08-07 2024-02-22 현대자동차주식회사 노면상으로 정보를 표시하는 자동차 및 그 제어 방법
US11681297B2 (en) * 2021-03-02 2023-06-20 Southwest Research Institute Autonomous vehicle and self-location estimating method in autonomous vehicle
EP4134625A1 (en) * 2021-08-11 2023-02-15 Hitachi Astemo, Ltd. Drive device, vehicle, and method for automated driving and/or assisted driving
US20230176216A1 (en) * 2021-12-03 2023-06-08 Argo AI, LLC Automatic bootstrap for autonomous vehicle localization

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH06325298A (ja) * 1993-05-13 1994-11-25 Yazaki Corp 車両周辺監視装置
JP2007256090A (ja) * 2006-03-23 2007-10-04 Nissan Motor Co Ltd 車両用環境認識装置及び車両用環境認識方法
JP2007278951A (ja) * 2006-04-10 2007-10-25 Alpine Electronics Inc 車体挙動測定装置
JP2008175717A (ja) * 2007-01-19 2008-07-31 Xanavi Informatics Corp 現在位置算出装置、現在位置算出方法
JP2010101683A (ja) * 2008-10-22 2010-05-06 Nissan Motor Co Ltd 距離計測装置および距離計測方法
CN103154666A (zh) * 2011-06-14 2013-06-12 日产自动车株式会社 距离测量装置以及环境地图生成装置
JP2013147114A (ja) * 2012-01-18 2013-08-01 Toyota Motor Corp 周辺環境取得装置およびサスペンション制御装置
JP2013187862A (ja) * 2012-03-09 2013-09-19 Topcon Corp 画像データ処理装置、画像データ処理方法および画像データ処理用のプログラム

Family Cites Families (19)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2901112B2 (ja) * 1991-09-19 1999-06-07 矢崎総業株式会社 車両周辺監視装置
JP4161584B2 (ja) * 2002-02-07 2008-10-08 トヨタ自動車株式会社 移動体用安全装置
KR100556612B1 (ko) * 2002-06-29 2006-03-06 삼성전자주식회사 레이저를 이용한 위치 측정 장치 및 방법
JP2004198211A (ja) * 2002-12-18 2004-07-15 Aisin Seiki Co Ltd 移動体周辺監視装置
JP2004198212A (ja) * 2002-12-18 2004-07-15 Aisin Seiki Co Ltd 移動体周辺監視装置
JP4258413B2 (ja) * 2004-03-26 2009-04-30 三菱ふそうトラック・バス株式会社 車両走行状態判定装置
AU2006327353B2 (en) * 2005-12-23 2011-11-24 Gcoder Systems Ab Positioning pattern
DE102007022524A1 (de) * 2007-05-14 2008-11-20 Bayerische Motoren Werke Aktiengesellschaft Kraftfahrzeug
US9491451B2 (en) * 2011-11-15 2016-11-08 Magna Electronics Inc. Calibration system and method for vehicular surround vision system
JP2013196353A (ja) * 2012-03-19 2013-09-30 Sharp Corp 周辺情報生成装置、乗物、周辺情報生成方法、周辺情報生成プログラム、コンピュータ読み取り可能な記録媒体
CN104541128B (zh) * 2012-08-02 2017-10-17 丰田自动车株式会社 路面状态取得装置及悬架系统
US9349058B2 (en) * 2012-10-31 2016-05-24 Tk Holdings, Inc. Vehicular path sensing system and method
US20160176343A1 (en) * 2013-08-30 2016-06-23 Clarion Co., Ltd. Camera Calibration Device, Camera Calibration System, and Camera Calibration Method
EP2851870B1 (en) * 2013-09-20 2019-01-23 Application Solutions (Electronics and Vision) Limited Method for estimating ego motion of an object
JP2015111090A (ja) * 2013-11-05 2015-06-18 株式会社リコー 物体検出装置
JP6395393B2 (ja) * 2014-02-13 2018-09-26 株式会社小糸製作所 車両の運転支援装置
BR112016019519B1 (pt) * 2014-02-24 2022-07-26 Nissan Motor Co. Ltd Aparelho e método de cálculo de auto-posição para calcular uma auto-posição de um veículo
MX349024B (es) * 2014-02-24 2017-07-07 Nissan Motor Dispositivo de calculo de la ubicacion propia y metodo de calculo de la ubicacion propia.
BR112016019494B1 (pt) * 2014-02-24 2022-01-04 Nissan Motor Co. Ltd Aparelho de cálculo de autoposição e método de cálculo de autoposição

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH06325298A (ja) * 1993-05-13 1994-11-25 Yazaki Corp 車両周辺監視装置
JP2007256090A (ja) * 2006-03-23 2007-10-04 Nissan Motor Co Ltd 車両用環境認識装置及び車両用環境認識方法
JP2007278951A (ja) * 2006-04-10 2007-10-25 Alpine Electronics Inc 車体挙動測定装置
JP2008175717A (ja) * 2007-01-19 2008-07-31 Xanavi Informatics Corp 現在位置算出装置、現在位置算出方法
JP2010101683A (ja) * 2008-10-22 2010-05-06 Nissan Motor Co Ltd 距離計測装置および距離計測方法
CN103154666A (zh) * 2011-06-14 2013-06-12 日产自动车株式会社 距离测量装置以及环境地图生成装置
JP2013147114A (ja) * 2012-01-18 2013-08-01 Toyota Motor Corp 周辺環境取得装置およびサスペンション制御装置
JP2013187862A (ja) * 2012-03-09 2013-09-19 Topcon Corp 画像データ処理装置、画像データ処理方法および画像データ処理用のプログラム

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110231826A (zh) * 2019-06-25 2019-09-13 苏州佳世达光电有限公司 运输车控制方法、系统及应用其的运输车

Also Published As

Publication number Publication date
BR112016019589B1 (pt) 2022-06-14
BR112016019589A2 (zh) 2017-08-15
JP6176387B2 (ja) 2017-08-09
CN106030681B (zh) 2017-09-05
EP3113147A4 (en) 2017-03-22
MX2016010744A (es) 2016-10-26
MX349227B (es) 2017-07-19
US9684837B2 (en) 2017-06-20
EP3113147A1 (en) 2017-01-04
JPWO2015125299A1 (ja) 2017-03-30
WO2015125299A1 (ja) 2015-08-27
RU2628420C1 (ru) 2017-08-16
EP3113147B1 (en) 2018-11-28
US20170011269A1 (en) 2017-01-12

Similar Documents

Publication Publication Date Title
CN105993041B (zh) 自身位置计算装置以及自身位置计算方法
CN106030681A (zh) 自身位置计算装置以及自身位置计算方法
CN106030680B (zh) 自身位置计算装置以及自身位置计算方法
CN105993042B (zh) 自身位置计算装置以及自身位置计算方法
CN105981086B (zh) 自身位置计算装置以及自身位置计算方法
BR112017002129B1 (pt) Aparelho de cálculo de autoposição e método de cálculo de autoposição
US9251587B2 (en) Motion estimation utilizing range detection-enhanced visual odometry
US9449397B2 (en) Real-time visual odometry system for determining motion of a machine with a range detection unit
CN106062849B (zh) 自己位置计算装置及自己位置计算方法
Nienaber et al. A comparison of low-cost monocular vision techniques for pothole distance estimation
JP2016183890A (ja) 自己位置算出装置及び自己位置算出方法
JP6299319B2 (ja) 自己位置算出装置及び自己位置算出方法
JP2015158418A (ja) 自己位置算出装置及び自己位置算出方法
JP6369897B2 (ja) 自己位置算出装置及び自己位置算出方法
JP6398217B2 (ja) 自己位置算出装置及び自己位置算出方法
JP6492974B2 (ja) 自己位置算出装置及び自己位置算出方法
JP2007241326A (ja) 移動体動き算出装置
JP7256659B2 (ja) 路面計測装置、路面計測方法、及び路面計測システム
JP6398219B2 (ja) 自己位置算出装置及び自己位置算出方法
US20210404843A1 (en) Information processing apparatus, control method for information processing apparatus, and storage medium
JP6369898B2 (ja) 自己位置算出装置及び自己位置算出方法

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