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 PDFInfo
- 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
Links
Images
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
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units, or advanced driver assistance systems for ensuring comfort, stability and safety or drive control systems for propelling or retarding the vehicle
- B60W30/18—Propelling the vehicle
- B60W30/18009—Propelling the vehicle related to particular drive situations
- B60W30/18072—Coasting
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
- B60W40/02—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to ambient conditions
- B60W40/06—Road conditions
- B60W40/076—Slope angle of the road
-
- 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
- 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
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/87—Combinations of systems using electromagnetic waves other than radio waves
- G01S17/875—Combinations of systems using electromagnetic waves other than radio waves for determining attitude
-
- 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
- B60W2520/00—Input parameters relating to overall vehicle dynamics
- B60W2520/14—Yaw
-
- 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
- B60W2520/00—Input parameters relating to overall vehicle dynamics
- B60W2520/16—Pitch
-
- 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
- B60W2520/00—Input parameters relating to overall vehicle dynamics
- B60W2520/18—Roll
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2552/00—Input parameters relating to infrastructure
- B60W2552/15—Road 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
본 발명은 위치 추적 장치 및 방법에 관한 것으로, 보다 상세하게는 도로 경사도에 기반하여 상대 차량의 정확한 위치를 추적하는 기술적 사상에 관한 것이다.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.
본 발명은 자차량 및 상대 차량이 위치한 경사의 경사도를 고려하여 상대 차량의 현재 위치에 대응되는 절대 좌표를 산출할 수 있는 위치 추적 장치 및 방법을 제공하고자 한다. 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 (
이에, 일실시예에 따른 위치 추적 장치는 참조부호 140 내지 150에 도시된 바와 같이, 경사도(θ)를 고려하여 상대 차량의 절대 좌표를 산출하고, 산출된 절대 좌표에 기초하여 상대 차량의 바운딩 박스의 위치를 보정하여 보다 정확하게 안정적으로 상대 차량의 위치를 추적할 수 있다.Accordingly, as shown in
도 2는 일실시예에 따른 위치 추적 장치를 설명하기 위한 도면이다. 2 is a view for explaining a location tracking device according to an embodiment.
도 2를 참조하면, 일실시예에 따른 위치 추적 장치(200)는 자차량 및 상대 차량이 위치한 경사의 경사도를 고려하여 상대 차량의 현재 위치에 대응되는 절대 좌표를 산출할 수 있다.Referring to FIG. 2 , the
또한, 위치 추적 장치(200)는 산출된 상대 차량의 절대 좌표에 기초하여 상대 차량에 대응되는 바운딩 박스의 위치를 보정할 수 있다.Also, the
또한, 위치 추적 장치(200)는 앞뒤, 좌우로 경사가 심한 구간뿐만 아니라 노면이 울퉁불퉁하거나 방지턱을 주행할 때에도 보다 정확하게 안정적으로 상대 차량의 위치를 추적할 수 있다. In addition, the
이를 위해, 위치 추적 장치(200)는 위치 정보 산출부(210), 경사도 산출부(220) 및 절대 좌표 산출부(230)를 포함할 수 있다. To this end, the
이하에서 설명하는, 위치 추적 장치(200)는 자차량에 위치하여 상대 차량의 현재 위치에 대응되는 절대 좌표를 산출할 수 있다. 또한, 위치 추적 장치(200)는 경사에 위치한 상대 차량 이외에도 경사에 위치한 임계 크기 이상의 사물에 대해서도 동일하게 절대 좌표를 산출할 수 있다. The
일실시예에 따른 위치 정보 산출부(210)는 자차량에 대응되는 경사도에 의한 자차량의 기울기 값을 산출할 수 있다. The location
일측에 따르면, 위치 정보 산출부(210)는 자차량의 이동 방향에 대응되는 x축, x축과 직교하는 방향에 대응되는 y축 및 z축 중 적어도 하나의 방향에 대응되는 자차량의 기울기 값을 산출할 수 있다. According to one side, the location
다시 말해, 위치 정보 산출부(210)는 자차량의 진행 방향(x축), 자차량의 좌우 방향(y축) 및 경사도의 높이 방향(z축) 중 적어도 하나의 방향에 대응되는 자차량의 기울기 값을 산출할 수 있다. In other words, the location
일측에 따르면, 위치 정보 산출부(210)는 자차량의 x축 방향 기울기에 대응되는 피치(pitch)값, 자차량의 y축 방향 기울기에 대응되는 롤(roll)값, 및 자차량의 z축 방향 기울기에 대응되는 요(yaw)값 중 적어도 하나의 값을 자차량의 기울기 값으로 산출할 수 있다. According to one side, the location
예를 들면, 위치 정보 산출부(210)는 자차량에 탑재된 관성 측정장치(inertial measurement unit, IMU)를 통해 자차량의 피치값, 롤값 및 요값을 산출할 수 있다.For example, the location
관성 측정장치는 가속도계(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
일측에 따르면, 경사도 산출부(220)는 관성 측정장치 및 상대 차량에 대응되는 촬영 영상 중 적어도 하나에 기초하여 상대 차량에 대응되는 경사도 값을 산출할 수 있다. According to one side, the
구체적으로, 경사도 산출부(220)는 맵(map) 생성에 따른 절대 좌표 변환 시 생성된 xy 평면좌표 및 z좌표에 기초하여 상대 차량에 대응되는 경사도 값을 산출하거나, 관성 측정장치를 이용하여 상대 차량에 대응되는 경사도 값을 산출할 수 있다.Specifically, the
또한, 경사도 산출부(220)는 상대 차량의 촬영 영상 중 현재 시점에 대응되는 프레임(frame)와 이전 시점에 대응되는 프레임간의 차이에 기초하여 상대 차량에 대응되는 경사도 값을 산출할 수도 있다.Also, the
바람직하게는, 경사도 산출부(220)는 자차량 및 상대 차량 사이의 직선 거리값과, 상대 차량의 높이값에 기초한 연산을 통해 상대 차량에 대응되는 경사도 값을 산출할 수 있다. 예를 들면, 경사도 산출부(220)는 자차량에 탑재된 라이다(LiDAR) 센서를 이용하여 상대 차량 사이의 직선 거리값과 상대 차량의 높이 값을 산출할 수 있다. Preferably, the
라이다 센서는 레이저를 목표물에 조사하고, 목표물로 인해 반사된 신호에 기반하여, 목표물까지의 거리, 방향, 속도, 온도, 물질 분포 및 농도 특성 등을 감지하는 센서로, 레이저 송신부, 레이저 검출부 및 신호 수집/처리부를 포함할 수 있다. 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
일측에 따르면, 절대 좌표 산출부(230)는 자차량의 피치값, 자차량의 롤값, 자차량의 요값 및 상대 차량에 대응되는 경사도 값에 기초한 연산을 통해 상대 차량의 절대 좌표를 산출할 수 있다. According to one side, the absolute coordinate
즉, 절대 좌표 산출부(230)는 자차량의 진행 방향(x축)에 대응되는 기울기, 자차량의 좌우 방향(y축)에 대응되는 기울기 및 경사도의 높이 방향(z축)에 대응되는 기울기를 모두 고려하여 보다 정확하게 상대 차량의 절대 좌표를 산출할 수 있다. That is, the absolute coordinate
예를 들면, 절대 좌표 산출부(230)는 xy축 회전행렬에 기초한 연산을 통해 상대 차량의 절대 좌표를 산출할 수 있다. For example, the absolute coordinate
한편, 일실시예에 따른 위치 추적 장치(200)는 산출된 상대 차량의 절대 좌표에 기초하여 상대 차량에 대응되는 바운딩 박스(bounding box)의 위치를 보정하는 위치 보정부를 더 포함할 수 있다. Meanwhile, the
일실시예에 따른 위치 추적 장치(200)는 이후 실시예 도 3을 통해 보다 구체적으로 설명하기로 한다. The
도 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
일측에 따르면, 위치 추적 장치는 자차량(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
다음으로, 위치 추적 장치는 상대 차량(320)에 대응되는 경사도 값(θobj)을 산출할 수 있다.Next, the location tracking device may calculate the inclination value θ obj corresponding to the
일측에 따르면, 위치 추적 장치는 자차량(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
[수학식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
일측에 따르면, 위치 추적 장치는 자차량(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
예를 들면, 위치 추적 장치는 자차량(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
구체적으로, 위치 추적 장치는 상대 차량(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
[수학식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
예를 들면, 위치 추적 장치는 산출된 절대 좌표(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
도 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
일측에 따르면, 410 단계에서 일실시예에 따른 위치 추적 방법은 자차량의 이동 방향에 대응되는 x축, x축과 직교하는 방향에 대응되는 y축 및 z축 중 적어도 하나의 방향에 대응되는 자차량의 기울기 값을 산출할 수 있다.According to one side, in
다시 말해, 410 단계에서 일실시예에 따른 위치 추적 방법은 자차량의 진행 방향(x축), 자차량의 좌우 방향(y축) 및 경사도의 높이 방향(z축) 중 적어도 하나의 방향에 대응되는 자차량의 기울기 값을 산출할 수 있다.In other words, in
일측에 따르면, 410 단계에서 일실시예에 따른 위치 추적 방법은 자차량의 x축 방향 기울기에 대응되는 피치(pitch)값, 자차량의 y축 방향 기울기에 대응되는 롤(roll)값, 및 자차량의 z축 방향 기울기에 대응되는 요(yaw)값 중 적어도 하나의 값을 자차량의 기울기 값으로 산출할 수 있다. According to one side, in
다음으로, 420 단계에서 일실시예에 따른 위치 추적 방법은 경사도 산출부에서 상대 차량에 대응되는 경사도 값을 산출할 수 있다.Next, in
일측에 따르면, 420 단계에서 일실시예에 따른 위치 추적 방법은 관성 측정장치 및 상대 차량에 대응되는 촬영 영상 중 적어도 하나에 기초하여 상대 차량에 대응되는 경사도 값을 산출할 수 있다. According to one side, in
구체적으로, 420 단계에서 일실시예에 따른 위치 추적 방법은 맵(map) 생성에 따른 절대 좌표 변환 시 생성된 xy 평면좌표 및 z좌표에 기초하여 상대 차량에 대응되는 경사도 값을 산출하거나, 관성 측정장치를 이용하여 상대 차량에 대응되는 경사도 값을 산출할 수 있다.Specifically, in
또한, 420 단계에서 일실시예에 따른 위치 추적 방법은 상대 차량의 촬영 영상 중 현재 시점에 대응되는 프레임(frame)와 이전 시점에 대응되는 프레임간의 차이에 기초하여 상대 차량에 대응되는 경사도 값을 산출할 수도 있다. Further, in
바람직하게는, 420 단계에서 일실시예에 따른 위치 추적 방법은 자차량 및 상대 차량 사이의 직선 거리값과, 상대 차량의 높이값에 기초한 연산을 통해 상대 차량에 대응되는 경사도 값을 산출할 수 있다. Preferably, in
다음으로, 430 단계에서 일실시예에 따른 위치 추적 방법은 절대 좌표 산출부에서 자차량의 기울기 값과 상대 차량에 대응되는 경사도 값에 기초하여 상대 차량의 절대 좌표를 산출할 수 있다. Next, in
일측에 따르면, 430 단계에서 일실시예에 따른 위치 추적 방법은 자차량의 피치값, 자차량의 롤값, 자차량의 요값 및 상대 차량에 대응되는 경사도 값에 기초한 연산을 통해 상대 차량의 절대 좌표를 산출할 수 있다. According to one side, in
한편, 일실시예에 따른 위치 추적 방법은 위치 보정부에서 산출된 상대 차량의 절대 좌표에 기초하여 상대 차량에 대응되는 바운딩 박스(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.
상기 경사도 산출부는,
관성 측정장치(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.
상기 경사도 산출부는,
상기 상대 차량에 대한 촬영 영상 중 현재 시점에 대응되는 프레임(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.
상기 경사도 산출부는,
상기 자차량 및 상기 상대 차량 사이의 직선 거리값과, 상기 상대 차량의 높이값에 기초한 연산을 통해 상기 상대 차량에 대응되는 경사도 값을 산출하는
위치 추적 장치.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.
상기 산출된 상대 차량의 절대 좌표에 기초하여 상기 상대 차량에 대응되는 바운딩 박스(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.
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)
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 |
-
2020
- 2020-12-14 KR KR1020200174435A patent/KR102405361B1/en active IP Right Grant
Patent Citations (6)
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 |