KR102405361B1 - Apparatus and method for tracking position of moving object based on slop of road - Google Patents

Apparatus and method for tracking position of moving object based on slop of road Download PDF

Info

Publication number
KR102405361B1
KR102405361B1 KR1020200174435A KR20200174435A KR102405361B1 KR 102405361 B1 KR102405361 B1 KR 102405361B1 KR 1020200174435 A KR1020200174435 A KR 1020200174435A KR 20200174435 A KR20200174435 A KR 20200174435A KR 102405361 B1 KR102405361 B1 KR 102405361B1
Authority
KR
South Korea
Prior art keywords
vehicle
value
inclination
counterpart
host vehicle
Prior art date
Application number
KR1020200174435A
Other languages
Korean (ko)
Inventor
이진희
황종락
권순
김제석
박재형
Original Assignee
재단법인대구경북과학기술원
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 재단법인대구경북과학기술원 filed Critical 재단법인대구경북과학기술원
Priority to KR1020200174435A priority Critical patent/KR102405361B1/en
Application granted granted Critical
Publication of KR102405361B1 publication Critical patent/KR102405361B1/en

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Estimation 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/10Estimation 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
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Purposes 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/18Propelling the vehicle
    • B60W30/18009Propelling the vehicle related to particular drive situations
    • B60W30/18072Coasting
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Estimation 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/02Estimation 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/06Road conditions
    • B60W40/076Slope angle of the road
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Estimation 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/10Estimation 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/11Pitch movement
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Estimation 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/10Estimation 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/112Roll movement
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Estimation 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/10Estimation 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/114Yaw movement
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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/00Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/87Combinations of systems using electromagnetic waves other than radio waves
    • G01S17/875Combinations of systems using electromagnetic waves other than radio waves for determining attitude
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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
    • B60W2520/00Input parameters relating to overall vehicle dynamics
    • B60W2520/14Yaw
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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
    • B60W2520/00Input parameters relating to overall vehicle dynamics
    • B60W2520/16Pitch
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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
    • B60W2520/00Input parameters relating to overall vehicle dynamics
    • B60W2520/18Roll
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Input parameters relating to infrastructure
    • B60W2552/15Road slope

Abstract

본 발명은 도로 경사도에 기반한 이동체의 위치 추적 장치 및 방법에 관한 것으로, 일실시예에 따른 위치 추적 장치는 자차량에 대응되는 경사도에 의한 상기 자차량의 기울기 값을 산출하는 위치 정보 산출부와, 상대 차량에 대응되는 경사도 값을 산출하는 경사도 산출부 및 상기 자차량의 기울기 값과 상대 차량에 대응되는 경사도 값에 기초하여 상기 상대 차량의 절대 좌표를 산출하는 절대 좌표 산출부를 포함한다.The present invention relates to an apparatus and method for tracking a location of a moving object based on a road inclination, and the location tracking apparatus according to an embodiment comprises: a location information calculating unit for calculating a slope value of the own vehicle based on a slope corresponding to the own vehicle; and a gradient calculator configured to calculate a gradient value corresponding to the counterpart vehicle, and an absolute coordinate calculator configured to calculate absolute coordinates of the counterpart vehicle based on the inclination value of the host vehicle and the gradient value corresponding to the counterpart vehicle.

Description

도로 경사도에 기반한 이동체의 위치 추적 장치 및 방법{APPARATUS AND METHOD FOR TRACKING POSITION OF MOVING OBJECT BASED ON SLOP OF ROAD}Apparatus and method for tracking the position of a moving object based on road inclination

본 발명은 위치 추적 장치 및 방법에 관한 것으로, 보다 상세하게는 도로 경사도에 기반하여 상대 차량의 정확한 위치를 추적하는 기술적 사상에 관한 것이다.The present invention relates to an apparatus and method for tracking a location, and more particularly, to a technical idea of tracking an exact location of a vehicle based on a road inclination.

최근 차량에는 어라운드 뷰 모니터링(around view monitoring, AVM) 시스템이 탑재되어 있다. 어라운드 뷰 모니터링 시스템은 차량의 전면, 양쪽 사이드 미러, 트렁크 등에 각각 설치된 4개의 카메라로부터 획득한 영상들을 합성하여, 차량 주변을 위에서 바라보는 탑-뷰(top-view) 형태로 디스플레이하는 어라운드 뷰 영상을 제공한다.Recently, vehicles are equipped with an around view monitoring (AVM) system. The around-view monitoring system synthesizes images obtained from four cameras installed on the front, side mirrors, and trunk of the vehicle, respectively, and displays the around-view image in a top-view form looking around the vehicle from above. to provide.

기존 어라운드 뷰 모니터링 시스템은 탑-뷰로 디스플레할 때, 트래킹 알고리즘(tracking algorithm)을 이용하여 주변 사물(일례로, 주변 차량 등)에 각각 대응되는 바운딩 박스(bounding box)를 출력하는데, 경사가 심한 구간에서는 바운딩 박스의 위치가 부정확하게 출력되는 문제가 있다.The existing around-view monitoring system outputs bounding boxes corresponding to surrounding objects (for example, surrounding vehicles, etc.) using a tracking algorithm when displaying in top-view, a section with a steep slope. There is a problem in that the position of the bounding box is output incorrectly.

한국공개특허 제10-2016-0120467호, "차량용 2차원 레이더의 방위각 보정 장치 및 방법"Korean Patent Laid-Open Patent No. 10-2016-0120467, "Azimuth angle correction apparatus and method for 2D radar for vehicle" 한국등록특허 제10-0575933호, "가속도계와 경로안내 데이터를 이용한 이동체의속력측정방법 및 그 장치"Korean Patent No. 10-0575933, "Method for measuring speed of moving object using accelerometer and route guidance data and device therefor" 한국공개특허 제10-2014-0080874호, "조향 보조 파킹 가이드 장치 및 방법"Korean Patent Laid-Open Patent No. 10-2014-0080874, "Steering Assist Parking Guide Device and Method"

본 발명은 자차량 및 상대 차량이 위치한 경사의 경사도를 고려하여 상대 차량의 현재 위치에 대응되는 절대 좌표를 산출할 수 있는 위치 추적 장치 및 방법을 제공하고자 한다. An object of the present invention is to provide a location tracking apparatus and method capable of calculating absolute coordinates corresponding to the current location of the counterpart vehicle in consideration of the inclination of the inclination on which the host vehicle and the counterpart vehicle are located.

또한, 본 발명은 산출된 상대 차량의 절대 좌표에 기초하여 상대 차량에 대응되는 바운딩 박스의 위치를 보정할 수 있는 위치 추적 장치 및 방법을 제공하고자 한다.Another object of the present invention is to provide a position tracking apparatus and method capable of correcting the position of a bounding box corresponding to the relative vehicle based on the calculated absolute coordinates of the relative vehicle.

또한, 본 발명은 앞뒤, 좌우로 경사가 심한 구간뿐만 아니라 노면이 울퉁불퉁하거나 방지턱을 주행할 때에도 보다 정확하게 안정적으로 상대 차량의 위치를 추적할 수 있는 위치 추적 장치 및 방법을 제공하고자 한다.In addition, an object of the present invention is to provide a location tracking device and method capable of more accurately and stably tracking the position of an opponent vehicle, not only in a section with a steep front, back, left and right slope, but also when driving on a bumpy or bumpy road surface.

본 발명의 일실시예에 따른 위치 추적 장치는 자차량에 대응되는 경사도에 의한 상기 자차량의 기울기 값을 산출하는 위치 정보 산출부와, 상대 차량에 대응되는 경사도 값을 산출하는 경사도 산출부 및 상기 자차량의 기울기 값과 상대 차량에 대응되는 경사도 값에 기초하여 상기 상대 차량의 절대 좌표를 산출하는 절대 좌표 산출부를 포함할 수 있다. A location tracking apparatus according to an embodiment of the present invention includes a location information calculator for calculating a gradient value of the host vehicle based on a gradient corresponding to the own vehicle, a gradient calculator for calculating a gradient value corresponding to the counterpart vehicle, and the and an absolute coordinate calculator for calculating absolute coordinates of the counterpart vehicle based on the inclination value of the host vehicle and the inclination value corresponding to the counterpart vehicle.

일측에 따르면, 상기 위치 정보 산출부는 상기 자차량의 이동 방향에 대응되는 x축, 상기 x축과 직교하는 방향에 대응되는 y축 및 z축 중 적어도 하나의 방향에 대응되는 상기 자차량의 기울기 값을 산출할 수 있다.According to one side, the location information calculating unit is the inclination value of the host vehicle corresponding to at least one of an x-axis corresponding to the moving direction of the host vehicle, a y-axis corresponding to a direction orthogonal to the x-axis, and a z-axis. can be calculated.

일측에 따르면, 상기 위치 정보 산출부는 상기 자차량의 x축 방향 기울기에 대응되는 피치(pitch)값, 상기 자차량의 y축 방향 기울기에 대응되는 롤(roll)값, 및 상기 자차량의 z축 방향 기울기에 대응되는 요(yaw)값 중 적어도 하나의 값을 산출할 수 있다. According to one side, the location information calculator includes a pitch value corresponding to the inclination of the host vehicle in the x-axis direction, a roll value corresponding to the inclination in the y-axis direction of the host vehicle, and the z-axis of the host vehicle. At least one value among yaw values corresponding to the direction gradient may be calculated.

일측에 따르면, 상기 절대 좌표 산출부는 상기 자차량의 피치값, 상기 자차량의 롤값, 상기 자차량의 요값 및 상기 상대 차량에 대응되는 경사도 값에 기초한 연산을 통해 상기 상대 차량의 절대 좌표를 산출할 수 있다. According to one side, the absolute coordinate calculating unit calculates the absolute coordinates of the relative vehicle through an operation based on the pitch value of the own vehicle, the roll value of the own vehicle, the yaw value of the own vehicle, and the inclination value corresponding to the counterpart vehicle. can

일측에 따르면, 상기 경사도 산출부는 관성 측정장치(inertial measurement unit, IMU) 및 상기 상대 차량에 대한 촬영 영상 중 적어도 하나에 기초하여 상기 상대 차량에 대응되는 경사도 값을 산출할 수 있다. According to one side, the gradient calculator may calculate a gradient value corresponding to the counterpart vehicle based on at least one of an inertial measurement unit (IMU) and a captured image of the counterpart vehicle.

일측에 따르면, 상기 경사도 산출부는 상기 상대 차량에 대한 촬영 영상 중 현재 시점에 대응되는 프레임(frame)과 이전 시점에 대응되는 프레임간의 차이에 기초하여 상기 상대 차량에 대응되는 경사도 값을 산출할 수 있다. According to one side, the gradient calculator may calculate a gradient value corresponding to the counterpart vehicle based on a difference between a frame corresponding to a current time point and a frame corresponding to a previous time point in the captured image of the counterpart vehicle. .

일측에 따르면, 상기 경사도 산출부는 상기 자차량 및 상기 상대 차량 사이의 직선 거리값과, 상기 상대 차량의 높이값에 기초한 연산을 통해 상기 상대 차량에 대응되는 경사도 값을 산출할 수 있다. According to one side, the gradient calculator may calculate a gradient value corresponding to the counterpart vehicle through an operation based on a linear distance value between the host vehicle and the counterpart vehicle and a height value of the counterpart vehicle.

일측에 따르면, 위치 추적 장치는 상기 산출된 상대 차량의 절대 좌표에 기초하여 상기 상대 차량에 대응되는 바운딩 박스(bounding box)의 위치를 보정하는 위치 보정부를 더 포함할 수 있다.According to one side, the position tracking apparatus may further include a position correcting unit for correcting a position of a bounding box corresponding to the relative vehicle based on the calculated absolute coordinates of the relative vehicle.

본 발명의 일실시예에 따른 위치 추적 방법은 위치 정보 산출부에서 자차량에 대응되는 경사도에 의한 상기 자차량의 기울기 값을 산출하는 단계와, 경사도 산출부에서 상대 차량에 대응되는 경사도 값을 산출하는 단계 및 절대 좌표 산출부에서, 상기 자차량의 기울기 값과 상대 차량에 대응되는 경사도 값에 기초하여 상기 상대 차량의 절대 좌표를 산출하는 단계를 포함할 수 있다. A location tracking method according to an embodiment of the present invention comprises the steps of calculating a slope value of the host vehicle according to the slope corresponding to the own vehicle in a location information calculating unit, and calculating a slope value corresponding to the counterpart vehicle in the slope calculating unit and calculating, in the absolute coordinate calculator, the absolute coordinates of the relative vehicle based on the inclination value of the host vehicle and the inclination value corresponding to the counterpart vehicle.

일측에 따르면, 상기 자차량의 기울기 값을 산출하는 단계는 상기 자차량의 이동 방향에 대응되는 x축, 상기 x축과 직교하는 방향에 대응되는 y축 및 z축 중 적어도 하나의 방향에 대응되는 상기 자차량의 기울기 값을 산출할 수 있다. According to one side, the calculating of the inclination value of the host vehicle corresponds to at least one of an x-axis corresponding to a moving direction of the host vehicle, a y-axis corresponding to a direction orthogonal to the x-axis, and a z-axis. The inclination value of the host vehicle may be calculated.

일측에 따르면, 상기 자차량의 기울기 값을 산출하는 단계는 상기 자차량의 x축 방향 기울기에 대응되는 피치(pitch)값, 상기 자차량의 y축 방향 기울기에 대응되는 롤(roll)값, 및 상기 자차량의 z축 방향 기울기에 대응되는 요(yaw)값 중 적어도 하나의 값을 산출할 수 있다. According to one side, the calculating of the inclination value of the host vehicle includes a pitch value corresponding to the inclination of the host vehicle in the x-axis direction, a roll value corresponding to the inclination in the y-axis direction of the host vehicle, and At least one value of yaw values corresponding to the z-axis direction inclination of the host vehicle may be calculated.

일측에 따르면, 상기 상대 차량의 절대 좌표를 산출하는 단계는 상기 자차량의 피치값, 상기 자차량의 롤값, 상기 자차량의 요값 및 상기 상대 차량에 대응되는 경사도 값에 기초한 연산을 통해 상기 상대 차량의 절대 좌표를 산출할 수 있다.According to one side, the calculating of the absolute coordinates of the counterpart vehicle may include calculating a pitch value of the own vehicle, a roll value of the own vehicle, a yaw value of the own vehicle, and a slope value corresponding to the counterpart vehicle through an operation. The absolute coordinates of can be calculated.

일실시예에 따르면, 본 발명은 자차량 및 상대 차량이 위치한 경사의 경사도를 고려하여 상대 차량의 현재 위치에 대응되는 절대 좌표를 산출할 수 있다. According to one embodiment, the present invention may calculate absolute coordinates corresponding to the current location of the counterpart vehicle in consideration of the inclination of the inclination on which the host vehicle and the counterpart vehicle are located.

또한, 본 발명은 산출된 상대 차량의 절대 좌표에 기초하여 상대 차량에 대응되는 바운딩 박스의 위치를 보정할 수 있다.In addition, the present invention may correct the position of the bounding box corresponding to the relative vehicle based on the calculated absolute coordinates of the relative vehicle.

또한, 본 발명은 앞뒤, 좌우로 경사가 심한 구간뿐만 아니라 노면이 울퉁불퉁하거나 방지턱을 주행할 때에도 보다 정확하게 안정적으로 상대 차량의 위치를 추적할 수 있다.In addition, according to the present invention, it is possible to more accurately and stably track the position of the other vehicle even when the road surface is bumpy or when driving on a bump as well as a section with a steep slope in front, back, left and right.

도 1a 내지 도 1e은 탑-뷰 이미지에서 발생되는 바운딩 박스의 밀림 현상을 설명하기 위한 도면이다.
도 2는 일실시예에 따른 위치 추적 장치를 설명하기 위한 도면이다.
도 3은 일실시예에 따른 위치 추적 장치를 이용하여 상대 차량의 절대 좌표를 산출하는 예시를 설명하기 위한 도면이다.
도 4는 일실시예에 따른 위치 추적 방법을 설명하기 위한 도면이다.
1A to 1E are diagrams for explaining a pushing phenomenon of a bounding box occurring in a top-view image.
2 is a view for explaining a location tracking device according to an embodiment.
3 is a view for explaining an example of calculating the absolute coordinates of the relative vehicle using the location tracking device according to an embodiment.
4 is a view for explaining a location tracking method according to an embodiment.

이하, 본 문서의 다양한 실시 예들이 첨부된 도면을 참조하여 기재된다.Hereinafter, various embodiments of the present document will be described with reference to the accompanying drawings.

실시 예 및 이에 사용된 용어들은 본 문서에 기재된 기술을 특정한 실시 형태에 대해 한정하려는 것이 아니며, 해당 실시 예의 다양한 변경, 균등물, 및/또는 대체물을 포함하는 것으로 이해되어야 한다.Examples and terms used therein are not intended to limit the technology described in this document to a specific embodiment, but it should be understood to include various modifications, equivalents, and/or substitutions of the embodiments.

하기에서 다양한 실시 예들을 설명에 있어 관련된 공지 기능 또는 구성에 대한 구체적인 설명이 발명의 요지를 불필요하게 흐릴 수 있다고 판단되는 경우에는 그 상세한 설명을 생략할 것이다.In the following, when it is determined that a detailed description of a known function or configuration related to various embodiments may unnecessarily obscure the gist of the present invention, a detailed description thereof will be omitted.

그리고 후술되는 용어들은 다양한 실시 예들에서의 기능을 고려하여 정의된 용어들로서 이는 사용자, 운용자의 의도 또는 관례 등에 따라 달라질 수 있다. 그러므로 그 정의는 본 명세서 전반에 걸친 내용을 토대로 내려져야 할 것이다.In addition, the terms to be described later are terms defined in consideration of functions in various embodiments, which may vary according to intentions or customs of users and operators. Therefore, the definition should be made based on the content throughout this specification.

도면의 설명과 관련하여, 유사한 구성요소에 대해서는 유사한 참조 부호가 사용될 수 있다.In connection with the description of the drawings, like reference numerals may be used for like components.

단수의 표현은 문맥상 명백하게 다르게 뜻하지 않는 한, 복수의 표현을 포함할 수 있다.The singular expression may include the plural expression unless the context clearly dictates otherwise.

본 문서에서, "A 또는 B" 또는 "A 및/또는 B 중 적어도 하나" 등의 표현은 함께 나열된 항목들의 모든 가능한 조합을 포함할 수 있다.In this document, expressions such as “A or B” or “at least one of A and/or B” may include all possible combinations of items listed together.

"제1," "제2," "첫째," 또는 "둘째," 등의 표현들은 해당 구성요소들을, 순서 또는 중요도에 상관없이 수식할 수 있고, 한 구성요소를 다른 구성요소와 구분하기 위해 사용될 뿐 해당 구성요소들을 한정하지 않는다.Expressions such as "first," "second," "first," or "second," can modify the corresponding elements regardless of order or importance, and to distinguish one element from another element. It is used only and does not limit the corresponding components.

어떤(예: 제1) 구성요소가 다른(예: 제2) 구성요소에 "(기능적으로 또는 통신적으로) 연결되어" 있다거나 "접속되어" 있다고 언급된 때에는, 어떤 구성요소가 다른 구성요소에 직접적으로 연결되거나, 다른 구성요소(예: 제3 구성요소)를 통하여 연결될 수 있다.When an (eg first) component is referred to as being “connected (functionally or communicatively)” or “connected” to another (eg, second) component, one component is the other component. may be directly connected to, or may be connected through another component (eg, a third component).

본 명세서에서, "~하도록 구성된(또는 설정된)(configured to)"은 상황에 따라, 예를 들면, 하드웨어적 또는 소프트웨어적으로 "~에 적합한," "~하는 능력을 가지는," "~하도록 변경된," "~하도록 만들어진," "~를 할 수 있는," 또는 "~하도록 설계된"과 상호 호환적으로(interchangeably) 사용될 수 있다.As used herein, "configured to (or configured to)" according to the context, for example, hardware or software "suitable for," "having the ability to," "modified to ," "made to," "capable of," or "designed to" may be used interchangeably.

어떤 상황에서는, "~하도록 구성된 장치"라는 표현은, 그 장치가 다른 장치 또는 부품들과 함께 "~할 수 있는" 것을 의미할 수 있다.In some circumstances, the expression “a device configured to” may mean that the device is “capable of” with other devices or parts.

예를 들면, 문구 "A, B, 및 C를 수행하도록 구성된(또는 설정된) 프로세서"는 해당 동작을 수행하기 위한 전용 프로세서(예: 임베디드 프로세서), 또는 메모리 장치에 저장된 하나 이상의 소프트웨어 프로그램들을 실행함으로써, 해당 동작들을 수행할 수 있는 범용 프로세서(예: CPU 또는 application processor)를 의미할 수 있다.For example, the phrase "a processor configured (or configured to perform) A, B, and C" refers to a dedicated processor (eg, an embedded processor) for performing the corresponding operations, or by executing one or more software programs stored in a memory device. , may refer to a general-purpose processor (eg, a CPU or an application processor) capable of performing corresponding operations.

또한, '또는' 이라는 용어는 배타적 논리합 'exclusive or' 이기보다는 포함적인 논리합 'inclusive or' 를 의미한다.Also, the term 'or' means 'inclusive or' rather than 'exclusive or'.

즉, 달리 언급되지 않는 한 또는 문맥으로부터 명확하지 않는 한, 'x가 a 또는 b를 이용한다' 라는 표현은 포함적인 자연 순열들(natural inclusive permutations) 중 어느 하나를 의미한다.That is, unless stated otherwise or clear from context, the expression 'x employs a or b' means any one of natural inclusive permutations.

상술한 구체적인 실시예들에서, 발명에 포함되는 구성 요소는 제시된 구체적인 실시 예에 따라 단수 또는 복수로 표현되었다.In the above-described specific embodiments, elements included in the invention are expressed in the singular or plural according to the specific embodiments presented.

그러나, 단수 또는 복수의 표현은 설명의 편의를 위해 제시한 상황에 적합하게 선택된 것으로서, 상술한 실시 예들이 단수 또는 복수의 구성 요소에 제한되는 것은 아니며, 복수로 표현된 구성 요소라 하더라도 단수로 구성되거나, 단수로 표현된 구성 요소라 하더라도 복수로 구성될 수 있다.However, the singular or plural expression is appropriately selected for the situation presented for convenience of description, and the above-described embodiments are not limited to the singular or plural component, and even if the component is expressed in plural, it is composed of a singular or , even a component expressed in the singular may be composed of a plural.

한편 발명의 설명에서는 구체적인 실시 예에 관해 설명하였으나, 다양한 실시 예들이 내포하는 기술적 사상의 범위에서 벗어나지 않는 한도 내에서 여러 가지 변형이 가능함은 물론이다.On the other hand, although specific embodiments have been described in the description of the invention, various modifications are possible without departing from the scope of the technical idea contained in the various embodiments.

그러므로 본 발명의 범위는 설명된 실시 예에 국한되어 정해져서는 아니되며 후술하는 청구범위뿐만 아니라 이 청구범위와 균등한 것들에 의해 정해져야 한다.Therefore, the scope of the present invention should not be limited to the described embodiments, but should be defined by the claims described below as well as the claims and equivalents.

도 1a 내지 도 1e은 탑-뷰 이미지에서 발생되는 바운딩 박스의 밀림 현상을 설명하기 위한 도면이다.1A to 1E are diagrams for explaining a pushing phenomenon of a bounding box occurring in a top-view image.

도 1a 내지 도 1e를 참조하면, 자차량과 상대 차량이 일반 평지 구간을 주행하고 있는 경우(참조부호 110)에는 탑-뷰로 디스플레이되는 상대 차량의 바운딩 박스가 정확한 위치에서 디스플레이 되는 것을 확인할 수 있다.Referring to FIGS. 1A to 1E , when the host vehicle and the other vehicle are traveling on a general flat section (reference numeral 110), it can be confirmed that the other vehicle's bounding box displayed in the top-view is displayed at the correct position.

그러나, 자차량 및 상대 차량이 임계 경사도 이상의 경사도(θ)를 갖는 오르막길 또는 내리막길을 주행하고 있는 경우(참조부호 120 내지 130)에는 탑-뷰로 디스플레이되는 상대 차량의 바운딩 박스가 상대 차량의 전면 방향으로 밀려서 출력되는 것을 확인할 수 있다.However, when the host vehicle and the other vehicle are traveling on an uphill road or a downhill road having an inclination θ greater than or equal to a threshold inclination (reference numerals 120 to 130), the other vehicle's bounding box displayed as a top-view is displayed in the front direction of the opposite vehicle. It can be seen that the output is pushed to .

이에, 일실시예에 따른 위치 추적 장치는 참조부호 140 내지 150에 도시된 바와 같이, 경사도(θ)를 고려하여 상대 차량의 절대 좌표를 산출하고, 산출된 절대 좌표에 기초하여 상대 차량의 바운딩 박스의 위치를 보정하여 보다 정확하게 안정적으로 상대 차량의 위치를 추적할 수 있다.Accordingly, as shown in reference numerals 140 to 150, the location tracking apparatus according to an embodiment calculates the absolute coordinates of the relative vehicle in consideration of the inclination θ, and based on the calculated absolute coordinates, the relative vehicle's bounding box By correcting the position of the vehicle, it is possible to track the position of the other vehicle more accurately and stably.

도 2는 일실시예에 따른 위치 추적 장치를 설명하기 위한 도면이다. 2 is a view for explaining a location tracking device according to an embodiment.

도 2를 참조하면, 일실시예에 따른 위치 추적 장치(200)는 자차량 및 상대 차량이 위치한 경사의 경사도를 고려하여 상대 차량의 현재 위치에 대응되는 절대 좌표를 산출할 수 있다.Referring to FIG. 2 , the location tracking apparatus 200 according to an embodiment may calculate absolute coordinates corresponding to the current location of the counterpart vehicle in consideration of the inclination of the inclination on which the own vehicle and the counterpart vehicle are located.

또한, 위치 추적 장치(200)는 산출된 상대 차량의 절대 좌표에 기초하여 상대 차량에 대응되는 바운딩 박스의 위치를 보정할 수 있다.Also, the position tracking apparatus 200 may correct the position of the bounding box corresponding to the counterpart vehicle based on the calculated absolute coordinates of the counterpart vehicle.

또한, 위치 추적 장치(200)는 앞뒤, 좌우로 경사가 심한 구간뿐만 아니라 노면이 울퉁불퉁하거나 방지턱을 주행할 때에도 보다 정확하게 안정적으로 상대 차량의 위치를 추적할 수 있다. In addition, the location tracking device 200 can more accurately and stably track the location of the other vehicle even when the road surface is bumpy or when driving on a bump as well as a section with a steep slope in front, back, left and right.

이를 위해, 위치 추적 장치(200)는 위치 정보 산출부(210), 경사도 산출부(220) 및 절대 좌표 산출부(230)를 포함할 수 있다. To this end, the location tracking apparatus 200 may include a location information calculator 210 , a gradient calculator 220 , and an absolute coordinate calculator 230 .

이하에서 설명하는, 위치 추적 장치(200)는 자차량에 위치하여 상대 차량의 현재 위치에 대응되는 절대 좌표를 산출할 수 있다. 또한, 위치 추적 장치(200)는 경사에 위치한 상대 차량 이외에도 경사에 위치한 임계 크기 이상의 사물에 대해서도 동일하게 절대 좌표를 산출할 수 있다. The location tracking apparatus 200, which will be described below, is located in the own vehicle and may calculate absolute coordinates corresponding to the current location of the other vehicle. In addition, the location tracking apparatus 200 may calculate absolute coordinates for an object having a threshold size or larger located on an incline in addition to the relative vehicle located on the incline.

일실시예에 따른 위치 정보 산출부(210)는 자차량에 대응되는 경사도에 의한 자차량의 기울기 값을 산출할 수 있다. The location information calculating unit 210 according to an exemplary embodiment may calculate a slope value of the own vehicle based on the slope corresponding to the own vehicle.

일측에 따르면, 위치 정보 산출부(210)는 자차량의 이동 방향에 대응되는 x축, x축과 직교하는 방향에 대응되는 y축 및 z축 중 적어도 하나의 방향에 대응되는 자차량의 기울기 값을 산출할 수 있다. According to one side, the location information calculating unit 210 is the inclination value of the own vehicle corresponding to at least one of the x-axis corresponding to the moving direction of the host vehicle, the y-axis and the z-axis corresponding to a direction orthogonal to the x-axis. can be calculated.

다시 말해, 위치 정보 산출부(210)는 자차량의 진행 방향(x축), 자차량의 좌우 방향(y축) 및 경사도의 높이 방향(z축) 중 적어도 하나의 방향에 대응되는 자차량의 기울기 값을 산출할 수 있다. In other words, the location information calculating unit 210 calculates the value of the host vehicle corresponding to at least one of the traveling direction (x-axis) of the own vehicle, the left-right direction (y-axis) of the own vehicle, and the height direction (z-axis) of the inclination. The slope value can be calculated.

일측에 따르면, 위치 정보 산출부(210)는 자차량의 x축 방향 기울기에 대응되는 피치(pitch)값, 자차량의 y축 방향 기울기에 대응되는 롤(roll)값, 및 자차량의 z축 방향 기울기에 대응되는 요(yaw)값 중 적어도 하나의 값을 자차량의 기울기 값으로 산출할 수 있다. According to one side, the location information calculating unit 210 is a pitch value corresponding to the inclination in the x-axis direction of the host vehicle, a roll value corresponding to the inclination in the y-axis direction of the host vehicle, and the z-axis of the own vehicle At least one value among yaw values corresponding to the direction inclination may be calculated as the inclination value of the host vehicle.

예를 들면, 위치 정보 산출부(210)는 자차량에 탑재된 관성 측정장치(inertial measurement unit, IMU)를 통해 자차량의 피치값, 롤값 및 요값을 산출할 수 있다.For example, the location information calculating unit 210 may calculate a pitch value, a roll value, and a yaw value of the own vehicle through an inertial measurement unit (IMU) mounted on the own vehicle.

관성 측정장치는 가속도계(accelerometer)와 회전 속도계 또는 자력계의 조합을 사용하여 특정한 힘, 각도 비율 및/또는 본체를 둘러싼 자기장을 측정하는 센서로, 하나 이상의 가속도계를 사용하여 선형 가속도를 감지하고 하나 이상의 자이로스코프를 사용하여 회전 속도를 감지하여 동작할 수 있다. An inertial measurement device is a sensor that uses a combination of an accelerometer and a tachometer or magnetometer to measure a specific force, angular rate, and/or magnetic field surrounding a body, using one or more accelerometers to sense linear acceleration and one or more gyro The scope can be used to sense the rotational speed and operate.

또한, 관성 측정장치는 차량의 각 축에 각각 배치되는 가속도계, 자이로스코프 센서 및 자기 측정기를 이용하여 차량에 대한 피치값, 롤값 및 요값을 산출할 수 있다. In addition, the inertial measurement apparatus may calculate a pitch value, a roll value, and a yaw value for the vehicle using an accelerometer, a gyroscope sensor, and a magnetic measurement device respectively disposed on each axis of the vehicle.

일실시예에 따른 경사도 산출부(220)는 상대 차량에 대응되는 경사도 값을 산출할 수 있다. The gradient calculator 220 according to an exemplary embodiment may calculate a gradient value corresponding to the counterpart vehicle.

일측에 따르면, 경사도 산출부(220)는 관성 측정장치 및 상대 차량에 대응되는 촬영 영상 중 적어도 하나에 기초하여 상대 차량에 대응되는 경사도 값을 산출할 수 있다. According to one side, the gradient calculator 220 may calculate a gradient value corresponding to the counterpart vehicle based on at least one of the inertia measuring device and a captured image corresponding to the counterpart vehicle.

구체적으로, 경사도 산출부(220)는 맵(map) 생성에 따른 절대 좌표 변환 시 생성된 xy 평면좌표 및 z좌표에 기초하여 상대 차량에 대응되는 경사도 값을 산출하거나, 관성 측정장치를 이용하여 상대 차량에 대응되는 경사도 값을 산출할 수 있다.Specifically, the gradient calculating unit 220 calculates a gradient value corresponding to the relative vehicle based on the xy plane coordinates and z coordinates generated during absolute coordinate transformation according to the map generation, or uses an inertia measurement device to calculate the relative gradient. A gradient value corresponding to the vehicle may be calculated.

또한, 경사도 산출부(220)는 상대 차량의 촬영 영상 중 현재 시점에 대응되는 프레임(frame)와 이전 시점에 대응되는 프레임간의 차이에 기초하여 상대 차량에 대응되는 경사도 값을 산출할 수도 있다.Also, the gradient calculator 220 may calculate a gradient value corresponding to the counterpart vehicle based on a difference between a frame corresponding to the current view and a frame corresponding to a previous view among images captured by the other vehicle.

바람직하게는, 경사도 산출부(220)는 자차량 및 상대 차량 사이의 직선 거리값과, 상대 차량의 높이값에 기초한 연산을 통해 상대 차량에 대응되는 경사도 값을 산출할 수 있다. 예를 들면, 경사도 산출부(220)는 자차량에 탑재된 라이다(LiDAR) 센서를 이용하여 상대 차량 사이의 직선 거리값과 상대 차량의 높이 값을 산출할 수 있다. Preferably, the gradient calculator 220 may calculate a gradient value corresponding to the counterpart vehicle through an operation based on a linear distance value between the host vehicle and the counterpart vehicle and a height value of the counterpart vehicle. For example, the inclination calculating unit 220 may calculate a linear distance value between opposing vehicles and a height value of the opposing vehicle by using a LiDAR sensor mounted on the own vehicle.

라이다 센서는 레이저를 목표물에 조사하고, 목표물로 인해 반사된 신호에 기반하여, 목표물까지의 거리, 방향, 속도, 온도, 물질 분포 및 농도 특성 등을 감지하는 센서로, 레이저 송신부, 레이저 검출부 및 신호 수집/처리부를 포함할 수 있다. The lidar sensor is a sensor that irradiates a laser onto a target and detects the distance to the target, direction, speed, temperature, material distribution and concentration characteristics, etc. based on the signal reflected by the target. It may include a signal collection/processing unit.

예를 들면, 라이다 센서는 기계식 라이다 센서 및 고정형 라이다 센서 중 어느 하나를 포함할 수 있고, 고정형 라이다 센서는 MEMS 라이다 센서, 플래시 라이다 센서, OPA(optical phase array) 라이다 센서 및 FMCW(frequency-modulated continuous wave) 라이다 센서 중 어느 하나를 포함할 수 있다. For example, the lidar sensor may include any one of a mechanical lidar sensor and a fixed lidar sensor, and the fixed lidar sensor includes a MEMS lidar sensor, a flash lidar sensor, and an optical phase array (OPA) lidar sensor. and a frequency-modulated continuous wave (FMCW) lidar sensor.

구체적으로, 기계식 라이다 센서는 고급 광학 컴포넌트이나 회전 어셈블리를 이용하여 와이드(일례로, 360도)의 FOV(field of view)를 구현할 수 있는 센서로, 와이드 FOV 이상으로 높은 SNR(signal-to-noise ratio)을 구현할 수 있다. Specifically, a mechanical lidar sensor is a sensor that can realize a wide (for example, 360 degrees) field of view (FOV) using advanced optical components or rotating assemblies. noise ratio) can be implemented.

고정형 라이다 센서는 기계식 컴포넌트들이 없어 가격이 저렴한 센서로, 차량의 전방과 후방, 측면의 여러 채널들을 이용해 그 데이터들을 융합하여 기계식 라이다 센서와 유사한 FOV를 구현할 수 있다. The fixed lidar sensor is a low-cost sensor that does not have mechanical components, and can implement a FOV similar to that of a mechanical lidar sensor by fusing the data using various channels on the front, rear, and side of the vehicle.

MEMS 라이다 센서는 전압과 같은 전기적 자극이 적용되면 기울기 각이 달라지는 작은 미러를 이용하는 센서로, 기계식 스캐닝 하드웨어를 전자 기계식으로 대체할 수 있다. MEMS 라이다 센서는 수신 SNR을 결정하는 리시버 집광 조리개가 몇 mm로 일반적으로 매우 작게 구현되어, 전체적인 센서 사이즈를 감소 시킬 수 있다. A MEMS lidar sensor is a sensor that uses a small mirror whose tilt angle changes when an electrical stimulus such as a voltage is applied, and can replace mechanical scanning hardware with an electromechanical one. The MEMS lidar sensor has a receiver condensing aperture of several mm, which determines the reception SNR, and is implemented very small, which can reduce the overall sensor size.

플래시 라이다 센서는 동작이 광학 플래시를 사용하는 표준 디지털 카메라와 매우 유사하게 동작하는 센서로, 한 개의 대면적 레이저 펄스가 전방 환경에 빛을 비추고 그 레이저에 가까이 위치한 광검출기의 초점면 어레이가 후방산란 광을 포착하여 동작할 수 있다. A flash lidar sensor is a sensor that behaves very similarly to a standard digital camera using an optical flash, in which a single large-area laser pulse illuminates the environment in front and an array of focal planes of photodetectors located close to the laser in the rear. It can operate by capturing scattered light.

플래시 라이다 센서는 기계식 레이저 스캐닝 방식 대비 단일 이미지로 전체 장면을 포착함으로써 데이터 포착 속도를 향상시킬 수 있으며, 전체 이미지가 단일의 플래시에 포착되기 때문에 이미지를 왜곡시킬 수 있는 진동 효과에 영향을 최소화할 수 있다. The flash lidar sensor can improve data capture speed by capturing the entire scene in a single image compared to mechanical laser scanning, and since the entire image is captured by a single flash, it can minimize the effect of vibration effects that can distort the image. can

OPA 라이다 센서는 위상 어레이 레이더와 같이 광학 위상 모듈레이터가 렌즈를 통과하는 빛의 속도를 제어하는 센서로, 빛의 속도를 제어하면 광학 파면 형상을 제어할 수 있다. The OPA lidar sensor is a sensor that controls the speed of light passing through a lens by an optical phase modulator like a phased array radar. By controlling the speed of light, the shape of the optical wavefront can be controlled.

OPA 라이다 센서는 상단의 빔은 지체되지 않지만, 중간과 아래의 빔은 양을 늘리면서 지체 되도록 제어함으로써, 레이저 빔을 여러 방향으로 겨누도록 조향할 수 있다. The OPA LiDAR sensor can steer the laser beam in multiple directions by controlling the top beam to be retarded, but not retarded, but the middle and lower beams to be retarded in increasing amounts.

FMCW 라이다 센서는 가간섭성 방식을 이용해 짧은 처프의 주파수 변조 레이저 광을 만들어 내는 센서로, 되돌아온 처프의 위상과 주파수를 측정하여 거리와 속도를 모두 측정할 수 있으며, 계산량과 광학이 훨씬 단순하게 구현될 수 있다.The FMCW lidar sensor is a sensor that generates short chirped frequency-modulated laser light using a coherent method. It can measure both distance and speed by measuring the phase and frequency of the returned chirp. can be implemented.

일실시예에 따른 절대 좌표 산출부(230)는 자차량의 기울기 값과 상대 차량에 대응되는 경사도 값에 기초하여 상대 차량의 절대 좌표를 산출할 수 있다. The absolute coordinate calculator 230 according to an embodiment may calculate the absolute coordinates of the counterpart vehicle based on the inclination value of the own vehicle and the inclination value corresponding to the counterpart vehicle.

일측에 따르면, 절대 좌표 산출부(230)는 자차량의 피치값, 자차량의 롤값, 자차량의 요값 및 상대 차량에 대응되는 경사도 값에 기초한 연산을 통해 상대 차량의 절대 좌표를 산출할 수 있다. According to one side, the absolute coordinate calculator 230 may calculate the absolute coordinates of the counterpart vehicle through calculations based on the pitch value of the own vehicle, the roll value of the own vehicle, the yaw value of the own vehicle, and the inclination value corresponding to the counterpart vehicle. .

즉, 절대 좌표 산출부(230)는 자차량의 진행 방향(x축)에 대응되는 기울기, 자차량의 좌우 방향(y축)에 대응되는 기울기 및 경사도의 높이 방향(z축)에 대응되는 기울기를 모두 고려하여 보다 정확하게 상대 차량의 절대 좌표를 산출할 수 있다. That is, the absolute coordinate calculator 230 calculates a slope corresponding to the traveling direction (x-axis) of the host vehicle, a slope corresponding to the left-right direction (y-axis) of the host vehicle, and a slope corresponding to the height direction (z-axis) of the inclination It is possible to more accurately calculate the absolute coordinates of the relative vehicle by considering all of them.

예를 들면, 절대 좌표 산출부(230)는 xy축 회전행렬에 기초한 연산을 통해 상대 차량의 절대 좌표를 산출할 수 있다. For example, the absolute coordinate calculator 230 may calculate the absolute coordinates of the relative vehicle through an operation based on the xy-axis rotation matrix.

한편, 일실시예에 따른 위치 추적 장치(200)는 산출된 상대 차량의 절대 좌표에 기초하여 상대 차량에 대응되는 바운딩 박스(bounding box)의 위치를 보정하는 위치 보정부를 더 포함할 수 있다. Meanwhile, the location tracking apparatus 200 according to an embodiment may further include a location correcting unit for correcting the location of a bounding box corresponding to the counterpart vehicle based on the calculated absolute coordinates of the counterpart vehicle.

일실시예에 따른 위치 추적 장치(200)는 이후 실시예 도 3을 통해 보다 구체적으로 설명하기로 한다. The location tracking apparatus 200 according to an embodiment will be described in more detail with reference to FIG. 3 in the following embodiment.

도 3은 일실시예에 따른 위치 추적 장치를 이용하여 상대 차량의 절대 좌표를 산출하는 예시를 설명하기 위한 도면이다.3 is a view for explaining an example of calculating the absolute coordinates of the relative vehicle using the location tracking device according to an embodiment.

도 3을 참조하면, 자차량(310)에 구비된 일실시예에 따른 위치 추적 장치는 자차량에 대응되는 경사도(θcur)에 의한 자차량(310)의 기울기 값을 산출할 수 있다.Referring to FIG. 3 , the location tracking device according to an embodiment provided in the own vehicle 310 may calculate the inclination value of the own vehicle 310 by the inclination θ cur corresponding to the own vehicle.

일측에 따르면, 위치 추적 장치는 자차량(310)의 x축 방향 기울기에 대응되는 피치값(θcur _x), 자차량의 y축 방향 기울기에 대응되는 롤값(θcur _y), 및 자차량의 z축 방향 기울기에 대응되는 요값(θcur _z) 중 적어도 하나의 값을 자차량(310)의 기울기 값으로 산출할 수 있다.According to one side, the location tracking device includes a pitch value (θ cur _x ) corresponding to the inclination in the x-axis direction of the host vehicle 310 , a roll value (θ cur _y ) corresponding to the inclination in the y-axis direction of the host vehicle, and At least one of the yaw values θ cur _z corresponding to the inclination in the z-axis direction may be calculated as the inclination value of the host vehicle 310 .

다음으로, 위치 추적 장치는 상대 차량(320)에 대응되는 경사도 값(θobj)을 산출할 수 있다.Next, the location tracking device may calculate the inclination value θ obj corresponding to the counterpart vehicle 320 .

일측에 따르면, 위치 추적 장치는 자차량(310) 및 상대 차량(320) 사이의 직선 거리값(l)과, 상대 차량(320)의 높이값(h)에 기초한 하기 수학식1을 통해 상대 차량(320)에 대응되는 경사도 값(θobj)을 산출할 수 있다. 예를 들면, 경사도 산출부(220)는 자차량에 탑재된 라이다(LiDAR) 센서를 이용하여 상대 차량 사이(320)의 직선 거리값(l)과 상대 차량(320)의 높이 값(h)을 산출할 수 있다.According to one side, the location tracking device is the opposite vehicle through Equation 1 based on the linear distance value l between the own vehicle 310 and the counterpart vehicle 320 and the height value h of the counterpart vehicle 320 . A gradient value θ obj corresponding to (320) may be calculated. For example, the inclination calculating unit 220 uses a LiDAR sensor mounted on the own vehicle to determine the linear distance value l between the opposing vehicles 320 and the height value h of the opposing vehicle 320 . can be calculated.

[수학식1][Equation 1]

θobj = arcsin(h/l)θ obj = arcsin(h/l)

다음으로, 위치 추적 장치는 자차량(310)의 기울기 값과 상대 차량(320)에 대응되는 경사도 값(θobj)에 기초하여 상대 차량(320)의 절대 좌표(Xobj _g, Yobj _g)를 산출할 수 있다.Next, the position tracking device determines the absolute coordinates (X obj _g, Y obj _g ) of the counterpart vehicle 320 based on the inclination value of the own vehicle 310 and the inclination value θ obj corresponding to the counterpart vehicle 320 . can be calculated.

일측에 따르면, 위치 추적 장치는 자차량(310)의 피치값(θcur _x), 자차량(310)의 롤값(θcur _y), 자차량(310)의 요값(θcur _z), 상대 차량(320)에 대응되는 상대 좌표의 x-좌표값(xobj), y-좌표값(yobj) 및 상대 차량(320)에 대응되는 경사도 값(θobj)에 기초한 연산을 통해 상대 차량(320)의 절대 좌표(Xobj _g, Yobj _g)를 산출할 수 있다.According to one side, the location tracking device includes a pitch value θ cur _x of the own vehicle 310 , a roll value θ cur _y of the own vehicle 310 , a yaw value θ cur _z of the own vehicle 310 , and a counterpart vehicle. The relative vehicle 320 through an operation based on the x-coordinate value (x obj ), the y-coordinate value (y obj ) of the relative coordinate corresponding to 320 , and the inclination value (θ obj ) corresponding to the counterpart vehicle 320 . ) of the absolute coordinates (X obj _g, Y obj _g ) can be calculated.

예를 들면, 위치 추적 장치는 자차량(310)에 탑재된 라이다 센서를 이용하여 상대 차량(320)에 대응되는 x 좌표값(xobj) 및 y 좌표값(yobj)을 산출할 수 있다. For example, the location tracking device may calculate an x-coordinate value (x obj ) and a y-coordinate value (y obj ) corresponding to the counterpart vehicle 320 by using a lidar sensor mounted on the own vehicle 310 . .

구체적으로, 위치 추적 장치는 상대 차량(320)의 x-좌표값(xobj)에 자차량(310)의 피치값 및 상대 차량(320)에 대응되는 경사도 값을 합산한 값(θcur _x + θobj)과 자차량(310)의 요값(θcur_z)을 반영한 값에서, 상대 차량(320)의 y-좌표값(yobj)에 자차량(310)의 롤값 및 상대 차량(320)에 대응되는 경사도 값을 합산한 값(θcur_y + θobj)과 자차량(310)의 요값(θcur_z)을 반영한 값을 차분하는 하기 수학식2를 통해 상대 차량(320)의 절대 좌표(Xobj_g, Yobj_g)를 산출할 수 있다. Specifically, the location tracking device is a value obtained by adding the pitch value of the host vehicle 310 to the x-coordinate value (x obj ) of the counterpart vehicle 320 and the inclination value corresponding to the counterpart vehicle 320 (θ cur _x + θ obj ) and the yaw value (θ cur_z ) of the host vehicle 310 are reflected, and the y-coordinate value (y obj ) of the other vehicle 320 corresponds to the roll value of the own vehicle 310 and the counterpart vehicle 320 . The absolute coordinates (X obj_g , X obj_g , Y obj_g ) can be calculated.

[수학식2][Equation 2]

Xobj _g = xobj * cos(θcur _x + θobj) * cos(θcur _z) - yobj * cos(θcur _y + θobj) * sin(θcur_z)X obj _g = x obj * cos(θ cur _x + θ obj ) * cos(θ cur _z ) - y obj * cos(θ cur _y + θ obj ) * sin(θ cur_z )

Yobj _g = xobj * cos(θcur _x + θobj) * sin(θcur _z) + yobj * cos(θcur _y + θobj) * cos(θcur_z)Y obj _g = x obj * cos(θ cur _x + θ obj ) * sin(θ cur _z ) + y obj * cos(θ cur _y + θ obj ) * cos(θ cur_z )

한편, 위치 추적 장치는 수학식2를 통해 산출된 절대 좌표(Xobj _g, Yobj _g)에 기초하여, 탑-뷰 이미지에서 상대 차량(320)에 대응되는 바운딩 박스의 위치를 보정할 수 있다. On the other hand, the position tracking device may correct the position of the bounding box corresponding to the relative vehicle 320 in the top-view image based on the absolute coordinates (X obj _g, Y obj _g ) calculated through Equation 2 .

예를 들면, 위치 추적 장치는 산출된 절대 좌표(Xobj _g, Yobj _g)를 상대 차량(320)에 대응되는 바운딩 박스의 중심점으로 설정하여 바운딩 박스의 위치를 보정할 수 있다.For example, the position tracking apparatus may correct the position of the bounding box by setting the calculated absolute coordinates (X obj _g, Y obj _g ) as the center point of the bounding box corresponding to the counterpart vehicle 320 .

도 4는 일실시예에 따른 위치 추적 방법을 설명하기 위한 도면이다. 4 is a view for explaining a location tracking method according to an embodiment.

다시 말해, 도 4는 도 1a 내지 도 3을 통해 설명한 일실시예에 따른 위치 추적 장치의 동작 방법을 설명하기 위한 도면으로, 이후 도 4를 통해 설명하는 내용 중 도 1a 내지 도 3을 통해 설명하는 내용과 중복되는 설명은 생략하기로 한다. In other words, FIG. 4 is a view for explaining an operation method of the location tracking apparatus according to an embodiment described with reference to FIGS. 1A to 3 , and among the contents described with reference to FIG. 4 , it will be described with reference to FIGS. 1A to 3 . A description that overlaps with the content will be omitted.

도 4를 참조하면, 410 단계에서 일실시예에 따른 위치 추적 방법은 위치 정보 산출부에서 자차량에 대응되는 경사도에 의한 자차량의 기울기 값을 산출할 수 있다. Referring to FIG. 4 , in step 410 , in the location tracking method according to an embodiment, the location information calculating unit may calculate the inclination value of the own vehicle according to the inclination corresponding to the own vehicle.

일측에 따르면, 410 단계에서 일실시예에 따른 위치 추적 방법은 자차량의 이동 방향에 대응되는 x축, x축과 직교하는 방향에 대응되는 y축 및 z축 중 적어도 하나의 방향에 대응되는 자차량의 기울기 값을 산출할 수 있다.According to one side, in step 410, the location tracking method according to an embodiment includes a ruler corresponding to at least one of an x-axis corresponding to the moving direction of the own vehicle, a y-axis corresponding to a direction orthogonal to the x-axis, and a z-axis. It is possible to calculate the inclination value of the vehicle.

다시 말해, 410 단계에서 일실시예에 따른 위치 추적 방법은 자차량의 진행 방향(x축), 자차량의 좌우 방향(y축) 및 경사도의 높이 방향(z축) 중 적어도 하나의 방향에 대응되는 자차량의 기울기 값을 산출할 수 있다.In other words, in step 410 , the location tracking method according to the embodiment corresponds to at least one of the traveling direction (x-axis) of the own vehicle, the left-right direction (y-axis) of the own vehicle, and the height direction (z-axis) of the inclination. It is possible to calculate the inclination value of the host vehicle.

일측에 따르면, 410 단계에서 일실시예에 따른 위치 추적 방법은 자차량의 x축 방향 기울기에 대응되는 피치(pitch)값, 자차량의 y축 방향 기울기에 대응되는 롤(roll)값, 및 자차량의 z축 방향 기울기에 대응되는 요(yaw)값 중 적어도 하나의 값을 자차량의 기울기 값으로 산출할 수 있다. According to one side, in step 410, the location tracking method according to an embodiment includes a pitch value corresponding to the inclination in the x-axis direction of the own vehicle, a roll value corresponding to the inclination in the y-axis direction of the own vehicle, and a ruler At least one of yaw values corresponding to the inclination of the vehicle in the z-axis direction may be calculated as the inclination value of the host vehicle.

다음으로, 420 단계에서 일실시예에 따른 위치 추적 방법은 경사도 산출부에서 상대 차량에 대응되는 경사도 값을 산출할 수 있다.Next, in step 420 , in the location tracking method according to an embodiment, the gradient calculator may calculate a gradient value corresponding to the opposite vehicle.

일측에 따르면, 420 단계에서 일실시예에 따른 위치 추적 방법은 관성 측정장치 및 상대 차량에 대응되는 촬영 영상 중 적어도 하나에 기초하여 상대 차량에 대응되는 경사도 값을 산출할 수 있다. According to one side, in step 420 , the location tracking method according to an embodiment may calculate a gradient value corresponding to the counterpart vehicle based on at least one of the inertia measuring apparatus and a captured image corresponding to the counterpart vehicle.

구체적으로, 420 단계에서 일실시예에 따른 위치 추적 방법은 맵(map) 생성에 따른 절대 좌표 변환 시 생성된 xy 평면좌표 및 z좌표에 기초하여 상대 차량에 대응되는 경사도 값을 산출하거나, 관성 측정장치를 이용하여 상대 차량에 대응되는 경사도 값을 산출할 수 있다.Specifically, in step 420, the location tracking method according to an embodiment calculates an inclination value corresponding to a relative vehicle based on the xy plane coordinates and z coordinates generated during absolute coordinate transformation according to map generation, or measures inertia The device may be used to calculate a gradient value corresponding to the other vehicle.

또한, 420 단계에서 일실시예에 따른 위치 추적 방법은 상대 차량의 촬영 영상 중 현재 시점에 대응되는 프레임(frame)와 이전 시점에 대응되는 프레임간의 차이에 기초하여 상대 차량에 대응되는 경사도 값을 산출할 수도 있다. Further, in step 420, the location tracking method according to an embodiment calculates a gradient value corresponding to the counterpart vehicle based on a difference between a frame corresponding to the current time point and a frame corresponding to a previous time point among the captured images of the other vehicle. You may.

바람직하게는, 420 단계에서 일실시예에 따른 위치 추적 방법은 자차량 및 상대 차량 사이의 직선 거리값과, 상대 차량의 높이값에 기초한 연산을 통해 상대 차량에 대응되는 경사도 값을 산출할 수 있다. Preferably, in step 420 , the location tracking method according to an embodiment may calculate a gradient value corresponding to the counterpart vehicle through calculation based on a linear distance value between the own vehicle and the counterpart vehicle and a height value of the counterpart vehicle. .

다음으로, 430 단계에서 일실시예에 따른 위치 추적 방법은 절대 좌표 산출부에서 자차량의 기울기 값과 상대 차량에 대응되는 경사도 값에 기초하여 상대 차량의 절대 좌표를 산출할 수 있다. Next, in step 430 , the location tracking method according to the embodiment may calculate the absolute coordinates of the counterpart vehicle based on the inclination value of the own vehicle and the inclination value corresponding to the counterpart vehicle in the absolute coordinate calculator.

일측에 따르면, 430 단계에서 일실시예에 따른 위치 추적 방법은 자차량의 피치값, 자차량의 롤값, 자차량의 요값 및 상대 차량에 대응되는 경사도 값에 기초한 연산을 통해 상대 차량의 절대 좌표를 산출할 수 있다. According to one side, in step 430, the location tracking method according to an embodiment determines the absolute coordinates of the counterpart vehicle through calculations based on the pitch value of the own vehicle, the roll value of the own vehicle, the yaw value of the own vehicle, and the inclination value corresponding to the counterpart vehicle. can be calculated.

한편, 일실시예에 따른 위치 추적 방법은 위치 보정부에서 산출된 상대 차량의 절대 좌표에 기초하여 상대 차량에 대응되는 바운딩 박스(bounding box)의 위치를 보정하는 단계를 더 포함할 수 있다. Meanwhile, the location tracking method according to an embodiment may further include correcting the position of a bounding box corresponding to the counterpart vehicle based on the absolute coordinates of the counterpart vehicle calculated by the position corrector.

결국, 본 발명을 이용하면, 자차량 및 상대 차량이 위치한 경사의 경사도를 고려하여 상대 차량의 현재 위치에 대응되는 절대 좌표를 산출할 수 있다.As a result, by using the present invention, absolute coordinates corresponding to the current position of the counterpart vehicle can be calculated in consideration of the inclination of the inclination on which the host vehicle and the counterpart vehicle are located.

또한, 산출된 상대 차량의 절대 좌표에 기초하여 상대 차량에 대응되는 바운딩 박스의 위치를 보정할 수 있다.Also, the position of the bounding box corresponding to the counterpart vehicle may be corrected based on the calculated absolute coordinates of the counterpart vehicle.

또한, 앞뒤, 좌우로 경사가 심한 구간뿐만 아니라 노면이 울퉁불퉁하거나 방지턱을 주행할 때에도 보다 정확하게 안정적으로 상대 차량의 위치를 추적할 수 있다.In addition, it is possible to track the position of the other vehicle more accurately and stably, not only in sections with a steep front, back, left and right slope, but also when driving on a bumpy or bumpy road surface.

이상과 같이 실시예들이 비록 한정된 도면에 의해 설명되었으나, 해당 기술분야에서 통상의 지식을 가진 자라면 상기의 기재로부터 다양한 수정 및 변형이 가능하다. 예를 들어, 설명된 기술들이 설명된 방법과 다른 순서로 수행되거나, 및/또는 설명된 시스템, 구조, 장치, 회로 등의 구성요소들이 설명된 방법과 다른 형태로 결합 또는 조합되거나, 다른 구성요소 또는 균등물에 의하여 대치되거나 치환되더라도 적절한 결과가 달성될 수 있다.As described above, although the embodiments have been described with reference to the limited drawings, various modifications and variations are possible by those skilled in the art from the above description. For example, the described techniques are performed in an order different from the described method, and/or the described components of the system, structure, apparatus, circuit, etc. are combined or combined in a different form than the described method, or other components Or substituted or substituted by equivalents may achieve an appropriate result.

그러므로, 다른 구현들, 다른 실시예들 및 특허청구범위와 균등한 것들도 후술하는 특허청구범위의 범위에 속한다.Therefore, other implementations, other embodiments, and equivalents to the claims are also within the scope of the following claims.

200: 위치 추적 장치 210: 위치 정보 산출부
220: 경사도 산출부 230: 절대 좌표 산출부
200: location tracking device 210: location information calculator
220: slope calculation unit 230: absolute coordinate calculation unit

Claims (12)

자차량에 대응되는 경사도에 의한 상기 자차량의 기울기 값을 산출하는 위치 정보 산출부;
상대 차량에 대응되는 경사도 값을 산출하는 경사도 산출부 및
상기 자차량의 기울기 값과 상대 차량에 대응되는 경사도 값에 기초하여 상기 상대 차량의 절대 좌표를 산출하는 절대 좌표 산출부
를 포함하고,
상기 자차량의 기울기 값은,
상기 자차량의 이동 방향에 대응되는 x축, 상기 x축과 직교하는 방향에 대응되는 y축 및 z축 중 적어도 하나의 방향에 대응되는 기울기 값을 포함하며,
상기 위치 정보 산출부는,
상기 자차량의 x축 방향 기울기에 대응되는 피치(pitch)값, 상기 자차량의 y축 방향 기울기에 대응되는 롤(roll)값, 및 상기 자차량의 z축 방향 기울기에 대응되는 요(yaw)값 중 적어도 하나의 값을 산출하고,
상기 절대 좌표 산출부는,
상기 자차량의 피치값, 상기 자차량의 롤값, 상기 자차량의 요값 및 상기 상대 차량에 대응되는 경사도 값에 기초한 연산을 통해 상기 상대 차량의 절대 좌표를 산출하는
위치 추적 장치.
a location information calculator configured to calculate a slope value of the host vehicle based on a slope corresponding to the host vehicle;
a gradient calculator for calculating a gradient value corresponding to the other vehicle; and
Absolute coordinate calculation unit for calculating absolute coordinates of the counterpart vehicle based on the inclination value of the host vehicle and the inclination value corresponding to the counterpart vehicle
including,
The inclination value of the host vehicle is,
and an inclination value corresponding to at least one of an x-axis corresponding to the moving direction of the host vehicle, a y-axis corresponding to a direction orthogonal to the x-axis, and a z-axis,
The location information calculation unit,
A pitch value corresponding to the inclination in the x-axis direction of the host vehicle, a roll value corresponding to the inclination in the y-axis direction of the host vehicle, and a yaw corresponding to the inclination in the z-axis direction of the host vehicle Calculate at least one of the values,
The absolute coordinate calculation unit,
Calculating the absolute coordinates of the relative vehicle through an operation based on a pitch value of the own vehicle, a roll value of the own vehicle, a yaw value of the own vehicle, and a slope value corresponding to the counterpart vehicle
location tracking device.
삭제delete 삭제delete 삭제delete 제1항에 있어서,
상기 경사도 산출부는,
관성 측정장치(inertial measurement unit, IMU) 및 상기 상대 차량에 대한 촬영 영상 중 적어도 하나에 기초하여 상기 상대 차량에 대응되는 경사도 값을 산출하는
위치 추적 장치.
According to claim 1,
The slope calculation unit,
calculating an inclination value corresponding to the counterpart vehicle based on at least one of an inertial measurement unit (IMU) and a captured image of the counterpart vehicle;
location tracking device.
제5항에 있어서,
상기 경사도 산출부는,
상기 상대 차량에 대한 촬영 영상 중 현재 시점에 대응되는 프레임(frame)과 이전 시점에 대응되는 프레임간의 차이에 기초하여 상기 상대 차량에 대응되는 경사도 값을 산출하는
위치 추적 장치.
6. The method of claim 5,
The slope calculation unit,
Calculating a gradient value corresponding to the counterpart vehicle based on a difference between a frame corresponding to a current time point and a frame corresponding to a previous time point among the captured images of the counterpart vehicle;
location tracking device.
제1항에 있어서,
상기 경사도 산출부는,
상기 자차량 및 상기 상대 차량 사이의 직선 거리값과, 상기 상대 차량의 높이값에 기초한 연산을 통해 상기 상대 차량에 대응되는 경사도 값을 산출하는
위치 추적 장치.
According to claim 1,
The slope calculation unit,
calculating a gradient value corresponding to the counterpart vehicle through calculation based on a linear distance value between the host vehicle and the counterpart vehicle and a height value of the counterpart vehicle
location tracking device.
제1항에 있어서,
상기 산출된 상대 차량의 절대 좌표에 기초하여 상기 상대 차량에 대응되는 바운딩 박스(bounding box)의 위치를 보정하는 위치 보정부
를 더 포함하는 위치 추적 장치.
According to claim 1,
A position correcting unit correcting a position of a bounding box corresponding to the relative vehicle based on the calculated absolute coordinates of the relative vehicle
A location tracking device further comprising a.
위치 정보 산출부에서, 자차량에 대응되는 경사도에 의한 상기 자차량의 기울기 값을 산출하는 단계;
경사도 산출부에서, 상대 차량에 대응되는 경사도 값을 산출하는 단계 및
절대 좌표 산출부에서, 상기 자차량의 기울기 값과 상대 차량에 대응되는 경사도 값에 기초하여 상기 상대 차량의 절대 좌표를 산출하는 단계
를 포함하고,
상기 자차량의 기울기 값은,
상기 자차량의 이동 방향에 대응되는 x축, 상기 x축과 직교하는 방향에 대응되는 y축 및 z축 중 적어도 하나의 방향에 대응되는 기울기 값을 포함하며,
상기 자차량의 기울기 값을 산출하는 단계는,
상기 자차량의 x축 방향 기울기에 대응되는 피치(pitch)값, 상기 자차량의 y축 방향 기울기에 대응되는 롤(roll)값, 및 상기 자차량의 z축 방향 기울기에 대응되는 요(yaw)값 중 적어도 하나의 값을 산출하고,
상기 상대 차량의 절대 좌표를 산출하는 단계는,
상기 자차량의 피치값, 상기 자차량의 롤값, 상기 자차량의 요값 및 상기 상대 차량에 대응되는 경사도 값에 기초한 연산을 통해 상기 상대 차량의 절대 좌표를 산출하는
위치 추적 방법.
calculating, by the location information calculating unit, a slope value of the host vehicle based on a slope corresponding to the host vehicle;
calculating, by the gradient calculator, a gradient value corresponding to the other vehicle; and
Calculating the absolute coordinates of the relative vehicle based on the inclination value of the host vehicle and the inclination value corresponding to the counterpart vehicle, in the absolute coordinate calculator
including,
The inclination value of the host vehicle is,
and a slope value corresponding to at least one of an x-axis corresponding to the moving direction of the host vehicle, a y-axis corresponding to a direction orthogonal to the x-axis, and a z-axis,
Calculating the inclination value of the host vehicle comprises:
A pitch value corresponding to the inclination in the x-axis direction of the host vehicle, a roll value corresponding to the inclination in the y-axis direction of the host vehicle, and a yaw corresponding to the inclination in the z-axis direction of the host vehicle Calculate at least one of the values,
Calculating the absolute coordinates of the relative vehicle comprises:
Calculating the absolute coordinates of the relative vehicle through an operation based on a pitch value of the own vehicle, a roll value of the own vehicle, a yaw value of the own vehicle, and a slope value corresponding to the counterpart vehicle
How to track location.
삭제delete 삭제delete 삭제delete
KR1020200174435A 2020-12-14 2020-12-14 Apparatus and method for tracking position of moving object based on slop of road KR102405361B1 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
KR1020200174435A KR102405361B1 (en) 2020-12-14 2020-12-14 Apparatus and method for tracking position of moving object based on slop of road

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
KR1020200174435A KR102405361B1 (en) 2020-12-14 2020-12-14 Apparatus and method for tracking position of moving object based on slop of road

Publications (1)

Publication Number Publication Date
KR102405361B1 true KR102405361B1 (en) 2022-06-08

Family

ID=81981610

Family Applications (1)

Application Number Title Priority Date Filing Date
KR1020200174435A KR102405361B1 (en) 2020-12-14 2020-12-14 Apparatus and method for tracking position of moving object based on slop of road

Country Status (1)

Country Link
KR (1) KR102405361B1 (en)

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR100575933B1 (en) 2003-12-01 2006-05-02 삼성전자주식회사 Method and apparatus for measuring speed of land vehicle using accelerometer and route guidance information data
KR20140080874A (en) 2012-12-20 2014-07-01 현대오트론 주식회사 Apparatus and method for guiding parking with steering assist
KR20150017365A (en) * 2012-05-31 2015-02-16 가부시키가이샤 리코 Road surface slope-identifying device, method of identifying road surface slope, and computer program for causing computer to execute road surface slope identification
KR20160120467A (en) 2015-04-08 2016-10-18 국방과학연구소 Azimuth correction apparatus and method of 2-dimensional radar for vehicle
US20180017391A1 (en) * 2016-06-30 2018-01-18 U-Blox Ag System for and method of determining angular position of a vehicle
US20190001978A1 (en) * 2017-06-29 2019-01-03 Denso Corporation Vehicle control method and apparatus

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR100575933B1 (en) 2003-12-01 2006-05-02 삼성전자주식회사 Method and apparatus for measuring speed of land vehicle using accelerometer and route guidance information data
KR20150017365A (en) * 2012-05-31 2015-02-16 가부시키가이샤 리코 Road surface slope-identifying device, method of identifying road surface slope, and computer program for causing computer to execute road surface slope identification
KR20140080874A (en) 2012-12-20 2014-07-01 현대오트론 주식회사 Apparatus and method for guiding parking with steering assist
KR20160120467A (en) 2015-04-08 2016-10-18 국방과학연구소 Azimuth correction apparatus and method of 2-dimensional radar for vehicle
US20180017391A1 (en) * 2016-06-30 2018-01-18 U-Blox Ag System for and method of determining angular position of a vehicle
US20190001978A1 (en) * 2017-06-29 2019-01-03 Denso Corporation Vehicle control method and apparatus

Similar Documents

Publication Publication Date Title
US10976413B2 (en) LIDAR system with synchronized MEMS mirrors
US10739441B2 (en) System and method for adjusting a LiDAR system
US10260889B2 (en) Position estimation device and position estimation method
US9187051B2 (en) Method for detecting an imminent rollover of a vehicle
JP4738472B2 (en) Mobility control device having obstacle avoidance function
KR101909953B1 (en) Method for vehicle pose estimation using LiDAR
JP2021105726A (en) Image forming system, image correction system, image display system, image forming method, and program
US11604260B2 (en) LIDAR device with polygon-shape mirror and prism for autonomous driving vehicles
US10802275B2 (en) Head-up display, head-up display method and vehicle
KR20200028648A (en) Method for adjusting an alignment model for sensors and an electronic device performing the method
KR20160120467A (en) Azimuth correction apparatus and method of 2-dimensional radar for vehicle
CN110163047A (en) A kind of method and device detecting lane line
JP2011134226A (en) Method and device for recognizing remote environment of mobile robot
WO2021206888A1 (en) Vision-cued random-access lidar system and method for localization and navigation of a moving platform
KR102405361B1 (en) Apparatus and method for tracking position of moving object based on slop of road
US11607999B2 (en) Method and apparatus for invisible vehicle underbody view
USRE45122E1 (en) Non-contact passive ranging system
CN105137468A (en) Photoelectric type automobile continuous navigation data acquiring device and method in GPS blind area environment
KR102493994B1 (en) Digital image recorder for automotive with image stabilization function
US20200133270A1 (en) Lidar device with cylindrical lens for autonomous driving vehicles
JP7056379B2 (en) Vehicle driving control device
EP4261499A1 (en) Distance measurement device and moving body
JP7347301B2 (en) Track generation device, method and program
JP2009008649A (en) Wheel-carriage robot
JP2011055342A (en) Imaging apparatus for vehicle

Legal Events

Date Code Title Description
E701 Decision to grant or registration of patent right
GRNT Written decision to grant