KR102030109B1 - Apparatus and method for calculating distance and angle between vehicles - Google Patents
Apparatus and method for calculating distance and angle between vehicles Download PDFInfo
- Publication number
- KR102030109B1 KR102030109B1 KR1020180014469A KR20180014469A KR102030109B1 KR 102030109 B1 KR102030109 B1 KR 102030109B1 KR 1020180014469 A KR1020180014469 A KR 1020180014469A KR 20180014469 A KR20180014469 A KR 20180014469A KR 102030109 B1 KR102030109 B1 KR 102030109B1
- Authority
- KR
- South Korea
- Prior art keywords
- pattern
- distance
- angle
- preceding vehicle
- interval
- Prior art date
Links
- 238000000034 method Methods 0.000 title claims description 19
- 238000004364 calculation method Methods 0.000 claims abstract description 38
- 239000000284 extract Substances 0.000 claims description 3
- 238000010586 diagram Methods 0.000 description 9
- 230000000694 effects Effects 0.000 description 4
- 238000004891 communication Methods 0.000 description 3
- 238000007792 addition Methods 0.000 description 1
- 238000013459 approach Methods 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 239000000463 material Substances 0.000 description 1
- 230000001151 other effect Effects 0.000 description 1
- 229940061368 sonata Drugs 0.000 description 1
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
- B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
- B60W30/14—Adaptive cruise control
- B60W30/16—Control of distance between vehicles, e.g. keeping a distance to preceding vehicle
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60Q—ARRANGEMENT OF SIGNALLING OR LIGHTING DEVICES, THE MOUNTING OR SUPPORTING THEREOF OR CIRCUITS THEREFOR, FOR VEHICLES IN GENERAL
- B60Q1/00—Arrangement of optical signalling or lighting devices, the mounting or supporting thereof or circuits therefor
- B60Q1/26—Arrangement of optical signalling or lighting devices, the mounting or supporting thereof or circuits therefor the devices being primarily intended to indicate the vehicle, or parts thereof, or to give signals, to other traffic
- B60Q1/30—Arrangement of optical signalling or lighting devices, the mounting or supporting thereof or circuits therefor the devices being primarily intended to indicate the vehicle, or parts thereof, or to give signals, to other traffic for indicating rear of vehicle, e.g. by means of reflecting surfaces
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
- B60W40/02—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to ambient conditions
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W60/00—Drive control systems specially adapted for autonomous road vehicles
- B60W60/001—Planning or execution of driving tasks
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
- B60W2050/0001—Details of the control system
- B60W2050/0019—Control system elements or transfer functions
- B60W2050/0026—Lookup tables or parameter maps
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2420/00—Indexing codes relating to the type of sensors based on the principle of their operation
- B60W2420/40—Photo, light or radio wave sensitive means, e.g. infrared sensors
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2420/00—Indexing codes relating to the type of sensors based on the principle of their operation
- B60W2420/40—Photo, light or radio wave sensitive means, e.g. infrared sensors
- B60W2420/403—Image sensing, e.g. optical camera
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2540/00—Input parameters relating to occupants
- B60W2540/18—Steering angle
-
- B60W2550/308—
-
- 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
- B60W2554/00—Input parameters relating to objects
- B60W2554/80—Spatial relation or speed relative to objects
- B60W2554/802—Longitudinal distance
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2556/00—Input parameters relating to data
- B60W2556/45—External transmission of data to or from the vehicle
- B60W2556/50—External transmission of data to or from the vehicle of positioning data, e.g. GPS [Global Positioning System] data
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Mechanical Engineering (AREA)
- Transportation (AREA)
- Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- Aviation & Aerospace Engineering (AREA)
- General Physics & Mathematics (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- Electromagnetism (AREA)
- Human Computer Interaction (AREA)
- Measurement Of Optical Distance (AREA)
- Traffic Control Systems (AREA)
Abstract
본 발명의 일 실시 예에 따른 차간 거리 및 각도 산출 장치는, 선행 차량에 장착된 제1 발광 모듈이 조사하는 제1 패턴 및 제2 발광 모듈이 조사하며 상기 제1 패턴과 제1 간격 이격된 제2 패턴을 사진 또는 영상으로 촬영하고, 상기 촬영된 사진 또는 영상 내에서 상기 제1 패턴 및 제2 패턴 사이의 제2 간격을 산출하는 패턴 간격 산출부, 상기 제1 간격을 기준으로 상기 제2 간격, 상기 제2 간격에 따른 상기 선행 차량과의 거리의 추정치 및 상기 거리의 추정치를 형성하는 각도의 추정치가 기 저장된 룩업 테이블 저장부 및 상기 패턴 간격 산출부가 산출한 상기 제2 간격에 따라 상기 룩업 테이블 저장부에서 상기 선행 차량과의 거리의 추정치 및 상기 거리의 추정치를 형성하는 각도의 추정치를 발췌하여 상기 선행 차량과의 거리 및 각도를 산출하는 거리 및 각도 산출부를 포함한다. An apparatus for calculating a distance and an angle according to an exemplary embodiment of the present invention may include a first pattern irradiated by a first light emitting module mounted on a preceding vehicle and a second light emitting module irradiated by a first pattern and spaced apart from the first pattern by a first interval. A pattern interval calculator configured to photograph two patterns as a photo or an image and calculate a second interval between the first pattern and the second pattern in the photographed image or the image; the second interval based on the first interval And the lookup table according to the second interval calculated by the lookup table storage unit and the pattern interval calculator which store an estimate of the distance to the preceding vehicle according to the second interval and an estimate of the angle forming the estimate of the distance. A distance from the storage unit for calculating the distance and the angle with the preceding vehicle by extracting an estimate of the distance with the preceding vehicle and an estimate of the angle forming the estimate of the distance. It comprises parts of the angle calculation.
Description
본 발명은 차간 거리 및 각도 산출 장치 및 방법에 관한 것이다. 보다 자세하게는, 후행 차량에서 촬영한 선행 차량의 사진 또는 영상을 기초로 선행 차량과의 거리 및 각도를 산출하는 장치 및 방법에 관한 것이다. The present invention relates to an apparatus and method for calculating a distance and an angle between vehicles. More specifically, the present invention relates to an apparatus and a method for calculating a distance and an angle with a preceding vehicle based on a picture or an image of the preceding vehicle taken by a trailing vehicle.
운전자의 조작 없이도 운행이 가능한 자율 주행 차량에 대한 요구가 증가함에 따라, 최근의 차량들에는 자율 주행 구현을 위한 레이다, 레이저, 라이다 및 스테레오 카메라 등과 같은 센싱 장치들이 장착되고 있으며, 센싱 장치들로부터 수신한 데이터를 기초로 스티어링 휠, 액셀레이터 및 브레이크 등과 같은 조향 및 구동 부품들을 자동으로 제어하는 시도가 개시되고 있다. As the demand for autonomous vehicles capable of driving without driver manipulation increases, recent vehicles are equipped with sensing devices such as radars, lasers, lidars and stereo cameras for autonomous driving. Attempts have been made to automatically control steering and driving components, such as steering wheels, accelerators and brakes, based on the data received.
이러한 센싱 장치들로 인해 차량 전체의 무게가 증가하는 것은 별론으로 하더라도, 센싱 장치들은 그 자체만으로 매우 고가인지라 센싱 장치들이 장착될수록 차량의 가격 역시 상승하게 되며, 이는 차량 판매 감소에 따른 차량 제조사들의 손해로 귀착될 수밖에 없다는 문제점이 있다. Although the weight of the whole vehicle is increased by these sensing devices, the sensing devices are very expensive in themselves, and as the sensing devices are installed, the price of the vehicle also increases, which is the loss of the vehicle manufacturers due to the decrease in vehicle sales. There is a problem that can only result in.
한편, 자율 주행 차량, 더 나아가 완전 자율 주행 차량의 구현에 있어서 가장 중요한 것은 주변 차량과의 거리 및 각도의 산출이며, 주변 차량과의 거리 및 각도가 잘못 산출된다면 차량 간 사고가 발생하게 되며, 소비자들은 자율 주행 차량에 대한 신뢰를 잃어갈 것이다. On the other hand, in the implementation of autonomous vehicles, and even more fully autonomous vehicles, the most important is the calculation of the distance and angle with the surrounding vehicles.If the distance and the angle with the surrounding vehicles are calculated incorrectly, accidents between vehicles will occur. Will lose confidence in autonomous vehicles.
따라서 고가의 센싱 장치들을 사용하지 않으면서 주변 차량과의 거리 및 각도를 정확하게 산출하여 안전한 자율 주행 차량을 구현할 수 있는 새로운 방법이 요구된다. 본 발명은 이와 관련된 것이다. Therefore, there is a need for a new method for realizing a safe autonomous vehicle by accurately calculating distances and angles with surrounding vehicles without using expensive sensing devices. The present invention relates to this.
본 발명이 해결하고자 하는 기술적 과제는 고가의 센싱 장치들을 사용하지 않으면서 주변 차량과의 거리 및 각도를 정확하게 산출하여 안전한 자율 주행 차량을 구현할 수 있는 차간 거리 및 각도 산출 장치와 그 방법을 제공하는 것이다.The technical problem to be solved by the present invention is to provide an inter-vehicle distance and angle calculation device and method that can accurately calculate the distance and angle with surrounding vehicles without using expensive sensing devices to implement a safe autonomous vehicle. .
본 발명의 기술적 과제들은 이상에서 언급한 기술적 과제들로 제한되지 않으며, 언급되지 않은 또 다른 기술적 과제들은 아래의 기재로부터 통상의 기술자에게 명확하게 이해될 수 있을 것이다.The technical problems of the present invention are not limited to the technical problems mentioned above, and other technical problems not mentioned will be clearly understood by those skilled in the art from the following description.
상기 기술적 과제를 달성하기 위한 본 발명의 일 실시 예에 따른 차간 거리 및 각도 산출 장치는, 선행 차량에 장착된 제1 발광 모듈이 조사하는 제1 패턴 및 제2 발광 모듈이 조사하며 상기 제1 패턴과 제1 간격 이격된 제2 패턴을 사진 또는 영상으로 촬영하고, 상기 촬영된 사진 또는 영상 내에서 상기 제1 패턴 및 제2 패턴 사이의 제2 간격을 산출하는 패턴 간격 산출부, 상기 제1 간격을 기준으로 상기 제2 간격, 상기 제2 간격에 따른 상기 선행 차량과의 거리의 추정치 및 상기 거리의 추정치를 형성하는 각도의 추정치가 기 저장된 룩업 테이블 저장부 및 상기 패턴 간격 산출부가 산출한 상기 제2 간격에 따라 상기 룩업 테이블 저장부에서 상기 선행 차량과의 거리의 추정치 및 상기 거리의 추정치를 형성하는 각도의 추정치를 발췌하여 상기 선행 차량과의 거리 및 각도를 산출하는 거리 및 각도 산출부를 포함한다. In accordance with an aspect of the present invention, there is provided a device for calculating a distance and an angle between a first pattern and a second light emitting module irradiated by a first light emitting module mounted on a preceding vehicle. A pattern interval calculating unit configured to photograph a second pattern spaced apart from the first interval by a photo or an image, and calculate a second interval between the first pattern and the second pattern in the photographed photo or image, the first interval The second interval, the lookup table storage unit and the pattern interval calculation unit for storing the second interval, the estimate of the distance to the preceding vehicle according to the second interval and the estimate of the angle forming the estimate of the distance previously stored; The lookup table storage unit extracts an estimate of a distance from the preceding vehicle and an angle of an angle forming the estimate of the distance according to the interval, and the look-up table storage unit extracts the estimated distance from the preceding vehicle. It includes a distance and angle calculation unit for calculating the distance and angle of.
일 실시 예에 따르면, 상기 제1 발광 모듈은, 상기 선행 차량의 좌측 리어 램프 일부에 장착되며, 상기 제2 발광 모듈은, 상기 선행 차량의 우측 리어 램프 일부에 장착될 수 있다. According to an embodiment, the first light emitting module may be mounted to a part of the left rear lamp of the preceding vehicle, and the second light emitting module may be mounted to a part of the right rear lamp of the preceding vehicle.
일 실시 예에 따르면, 상기 제1 발광 모듈은, 상기 선행 차량의 좌측 사이드 미러의 미러부에 창작되며, 상기 제2 발광 모듈은, 상기 선행 차량의 우측 사이드 미러의 미러부에 창작될 수 있다. According to an embodiment, the first light emitting module may be created in the mirror of the left side mirror of the preceding vehicle, and the second light emitting module may be created in the mirror of the right side mirror of the preceding vehicle.
일 실시 예에 따르면, 상기 제1 패턴 및 제2 패턴은, 적외선 패턴이며, 상기 패턴 간격 산출부는, 상기 제1 패턴 및 제2 패턴을 촬영하는 적외선 카메라를 더 포함할 수 있다. According to an embodiment, the first pattern and the second pattern may be infrared patterns, and the pattern interval calculator may further include an infrared camera that captures the first pattern and the second pattern.
일 실시 예에 따르면, 상기 제1 패턴 및 제2 패턴은, 서로 대칭 형상일 수 있다. According to an embodiment, the first pattern and the second pattern may be symmetrical to each other.
일 실시 예에 따르면, 상기 제1 패턴 및 제2 패턴은, 상기 선행 차량의 차종에 따른 고유 패턴일 수 있다. According to an embodiment of the present disclosure, the first pattern and the second pattern may be unique patterns according to vehicle types of the preceding vehicle.
일 실시 예에 따르면, 상기 거리 및 각도 산출부는, 상기 선행 차량에 탑승한 사용자의 V2X 단말을 통해 상기 선행 차량의 내비게이션 맵 데이터, 블랙박스 영상 및 스티어링 앵글 센서의 조향각 신호 중 어느 하나 이상을 수신하고 이를 이용하여 상기 산출한 선행 차량과의 거리 및 각도를 보정할 수 있다. According to an embodiment of the present disclosure, the distance and angle calculator may receive at least one of a navigation map data, a black box image, and a steering angle signal of a steering angle sensor through a V2X terminal of a user in the preceding vehicle. By using this, the calculated distance and angle with the preceding vehicle can be corrected.
일 실시 예에 따르면, 상기 패턴 간격 산출부는, 일정 시간 간격으로 상기 제1 패턴 및 제2 패턴을 사진 또는 영상으로 촬영하고, 상기 일정 시간 간격으로 촬영한 사진 또는 영상 내에서 상기 제1 패턴 및 제2 패턴 중 어느 하나만 식별되게 되는 경우, 상기 식별되게 되는 패턴이 장착된 방향으로 상기 선행 차량이 회전하는 것으로 판단할 수 있다. According to an embodiment of the present disclosure, the pattern interval calculating unit may photograph the first pattern and the second pattern as a photo or an image at a predetermined time interval, and the first pattern and the first pattern within the photograph or image photographed at the predetermined time interval. When only one of the two patterns is to be identified, it may be determined that the preceding vehicle rotates in the direction in which the pattern to be identified is mounted.
일 실시 예에 따르면, 상기 패턴 간격 산출부는, 일정 시간 간격으로 상기 선행 차량의 중심점(Center Point)을 사진 또는 영상으로 촬영하고, 상기 거리 및 각도 산출부는, 상기 촬영한 사진 또는 영상 내에서 상기 중심점의 이동 궤적을 기초로 상기 선행 차량의 회전 반경에 대한 곡률을 산출하고 이를 이용하여 상기 산출한 선행 차량과의 거리 및 각도를 보정할 수 있다. According to an embodiment of the present disclosure, the pattern interval calculating unit photographs a center point of the preceding vehicle at a predetermined time interval as a photo or an image, and the distance and angle calculator is the center point in the photographed image or image. The curvature of the turning radius of the preceding vehicle may be calculated based on the movement trajectory of the vehicle, and the distance and angle with respect to the calculated preceding vehicle may be corrected using the same.
상기 기술적 과제를 달성하기 위한 본 발명의 일 실시 예에 따른 차간 거리 및 각도 산출 방법은 차간 거리 및 각도 산출 장치가 선행 차량에 장착된 제1 발광 모듈이 조사하는 제1 패턴 및 제2 발광 모듈이 조사하며 상기 제1 패턴과 제1 간격 이격된 제2 패턴을 사진 또는 영상으로 촬영하고, 상기 촬영된 사진 또는 영상 내에서 상기 제1 패턴 및 제2 패턴 사이의 제2 간격을 산출하는 단계 및 상기 차간 거리 및 각도 산출 장치가 상기 제1 간격을 기준으로 상기 제2 간격, 상기 제2 간격에 따른 상기 선행 차량과의 거리의 추정치 및 상기 거리의 추정치를 형성하는 각도의 추정치가 기 저장된 룩업 테이블에서 상기 산출한 상기 제2 간격에 따른 상기 선행 차량과의 거리의 추정치 및 상기 거리의 추정치를 형성하는 각도의 추정치를 발췌하여 상기 선행 차량과의 거리 및 각도를 산출하는 단계를 포함한다. In accordance with an aspect of the present invention, there is provided a method of calculating a distance and an angle between a first pattern and a second light emitting module irradiated by a first light emitting module mounted on a preceding vehicle. Illuminating and photographing the first pattern and the second pattern spaced apart from the first interval in a photograph or image, and calculating a second interval between the first pattern and the second pattern in the photographed photo or image; and In the look-up table, the distance and angle calculation apparatus may store the second interval, an estimate of the distance to the preceding vehicle according to the second interval, and an angle to form the estimate of the distance, based on the first interval. The preceding vehicle is extracted by extracting an estimated value of the distance with the preceding vehicle according to the calculated second interval and an estimate of an angle forming the estimated value of the distance. Of a step of calculating the distance and angle.
상기와 같은 본 발명에 따르면, 레이다, 레이저, 라이다 및 스테레오 카메라 등과 같은 고가의 센싱 장치들을 사용하지 않으면서 주변 차량과의 거리 및 각도를 정확하게 산출할 수 있는바, 자율 주행 차량의 가격 상승을 저지할 수 있다는 효과가 있다. According to the present invention as described above, it is possible to accurately calculate the distance and angle with the surrounding vehicles without using expensive sensing devices such as radar, laser, lidar, and stereo camera, so as to increase the price of autonomous vehicles There is an effect that can be stopped.
또한, 주변 차량에 탑승한 사용자의 V2X 단말과 통신을 통해 주변 차량과의 거리 및 각도를 보다 정확하게 보정할 수 있는바, 안전한 자율 주행 차량을 구현할 수 있다는 효과가 있다. In addition, the distance and angle with the surrounding vehicle can be more accurately corrected through communication with the V2X terminal of the user who rides in the surrounding vehicle, so that a safe autonomous vehicle can be realized.
본 발명의 효과들은 이상에서 언급한 효과들로 제한되지 않으며, 언급되지 않은 또 다른 효과들은 아래의 기재로부터 통상의 기술자에게 명확하게 이해 될 수 있을 것이다.Effects of the present invention are not limited to the above-mentioned effects, and other effects not mentioned will be clearly understood by those skilled in the art from the following description.
도 1은 본 발명의 일 실시 예에 따른 차간 거리 및 각도 산출 장치의 구성도를 나타낸 도면이다.
도 2는 본 발명의 일 실시 예에 따른 차간 거리 및 각도 산출 장치를 포함하는 차량의 전방에서 운행하는 선행 차량의 후면부를 나타낸 도면이다.
도 3은 제1 발광 모듈 및 제2 발광 모듈이 장착된 선행 차량의 또 다른 실시 예를 나타낸 도면이다.
도 4는 도 2에 도시된 선행 차량의 후면부에서 제1 패턴 및 제2 패턴이 조사되고 있는 모습을 나타낸 도면이다.
도 5는 패턴 간격 산출부가 촬영한 선행 차량 후면부의 사진을 나타낸 도면이다.
도 6은 예시적인 룩업 테이블을 나타낸 도면이다.
도 7은 본 발명의 일 실시 예에 따른 차간 거리 및 각도 산출 장치를 포함하는 차량이 선행 차량의 바로 뒤에서 운행하고 있는 모습을 나타낸 도면이다.
도 8은 패턴 간격 산출부가 일정 시간 간격으로 촬영한 사진을 나타낸 도면이다.
도 9는 본 발명의 또 다른 실시 예에 따른 차간 거리 및 각도 산출 방법의 대표적인 단계를 나타낸 순서도이다. 1 is a diagram illustrating a configuration of an apparatus for calculating a distance and an angle according to an embodiment of the present invention.
FIG. 2 is a diagram illustrating a rear portion of a preceding vehicle that runs in front of a vehicle including an apparatus for calculating a distance and an angle according to an embodiment of the present disclosure.
3 is a diagram illustrating another embodiment of a preceding vehicle in which a first light emitting module and a second light emitting module are mounted.
4 is a view illustrating a state in which a first pattern and a second pattern are irradiated from the rear portion of the preceding vehicle illustrated in FIG. 2.
5 is a diagram illustrating a photograph of a rear surface of a preceding vehicle photographed by the pattern interval calculator.
6 is a diagram illustrating an exemplary lookup table.
FIG. 7 is a diagram illustrating a vehicle including a vehicle distance and angle calculator according to an embodiment of the present invention running directly behind a preceding vehicle.
8 is a diagram illustrating a photograph taken by the pattern interval calculating unit at a predetermined time interval.
9 is a flowchart illustrating exemplary steps of a method for calculating a distance and an angle between vehicles according to another exemplary embodiment of the present invention.
이하, 첨부된 도면을 참조하여 본 발명의 바람직한 실시 예를 상세히 설명한다. 본 발명의 이점 및 특징, 그리고 그것들을 달성하는 방법은 첨부되는 도면과 함께 상세하게 후술되어 있는 실시 예들을 참조하면 명확해질 것이다. 그러나 본 발명은 이하에서 게시되는 실시 예에 한정되는 것이 아니라 서로 다른 다양한 형태로 구현될 수 있으며, 단지 본 실시 예들은 본 발명의 게시가 완전하도록 하고, 본 발명이 속하는 기술분야에서 통상의 지식을 가진 자에게 발명의 범주를 완전하게 알려주기 위해 제공되는 것이며, 본 발명은 청구항의 범주에 의해 정의될 뿐이다. 명세서 전체에 걸쳐 동일 참조 부호는 동일 구성 요소를 지칭한다.Hereinafter, exemplary embodiments of the present invention will be described in detail with reference to the accompanying drawings. Advantages and features of the present invention, and methods for achieving them will be apparent with reference to the embodiments described below in detail in conjunction with the accompanying drawings. However, the present invention is not limited to the embodiments disclosed below, but can be implemented in various forms, and only the embodiments are intended to complete the disclosure of the present invention, and the general knowledge in the art to which the present invention pertains. It is provided to fully convey the scope of the invention to those skilled in the art, and the present invention is defined only by the scope of the claims. Like reference numerals refer to like elements throughout.
다른 정의가 없다면, 본 명세서에서 사용되는 모든 용어(기술 및 과학적 용어를 포함)는 본 발명이 속하는 기술분야에서 통상의 지식을 가진 자에게 공통적으로 이해될 수 있는 의미로 사용될 수 있을 것이다. Unless otherwise defined, all terms (including technical and scientific terms) used in the present specification may be used in a sense that can be commonly understood by those skilled in the art.
또한, 일반적으로 사용되는 사전에 정의되어 있는 용어들은 명백하게 특별히 정의되어 있지 않는 한 이상적으로 또는 과도하게 해석되지 않는다. 본 명세서에서 사용된 용어는 실시 예들을 설명하기 위한 것이며 본 발명을 제한하고자 하는 것은 아니다. 본 명세서에서, 단수형은 문구에서 특별히 언급하지 않는 한 복수형도 포함한다.In addition, terms that are defined in a commonly used dictionary are not ideally or excessively interpreted unless they are specifically defined clearly. The terminology used herein is for the purpose of describing particular embodiments only and is not intended to be limiting of the invention. In this specification, the singular also includes the plural unless specifically stated otherwise in the phrase.
명세서에서 사용되는 "포함한다 (comprises)" 및/또는 "포함하는 (comprising)"은 언급된 구성 요소, 단계, 동작 및/또는 소자는 하나 이상의 다른 구성 요소, 단계, 동작 및/또는 소자의 존재 또는 추가를 배제하지 않는다.As used herein, “comprises” and / or “comprising” refers to a component, step, operation and / or element that is mentioned in the presence of one or more other components, steps, operations and / or elements. Or does not exclude additions.
이하, 본 발명에 대하여 첨부된 도면에 따라 보다 상세히 설명한다.Hereinafter, the present invention will be described in more detail with reference to the accompanying drawings.
도 1은 본 발명의 일 실시 예에 따른 차간 거리 및 각도 산출 장치(100)의 구성도를 나타낸 도면이며, 도 2는 본 발명의 일 실시 예에 따른 차간 거리 및 각도 산출 장치(100)를 포함하는 차량(5)의 전방에서 운행하는 선행 차량(200)의 후면부를 나타낸 도면이다. 1 is a view showing the configuration of the vehicle distance and
본 발명의 일 실시 예에 따른 차간 거리 및 각도 산출 장치(100)는 패턴 간격 산출부(10), 룩업 테이블 저장부(20) 그리고 거리 및 각도 산출부(30)를 포함하며, 기타 본 발명의 목적을 달성함에 있어서 필요한 부가적인 구성들을 모두 포함할 수 있음은 물론이다. Device for calculating the distance and
패턴 간격 산출부(10)는 선행 차량(200)에 장착된 제1 발광 모듈(212)이 조사하는 제1 패턴(215) 및 제2 발광 모듈(222)이 조사하며, 제1 패턴(215)과 제1 간격 이격된 제2 패턴(225)을 사진 또는 영상으로 촬영하고, 촬영된 사진 또는 영상 내에서 제1 패턴(215) 및 제2 패턴(225) 사이의 제2 간격을 산출한다. The
패턴 간격 산출부(10)는 선행 차량(200)으로부터 조사되는 제1 패턴(215) 및 제2 패턴(225)을 촬영하는바, 카메라(미도시)를 포함할 수 있으며, 이 경우 패턴 간격 산출부(10)는 카메라(미도시)와 사진 또는 영상을 분석하고 연산을 수행하는 프로세서(미도시)로 구현될 수 있다. The
한편, 패턴 간격 산출부(10), 보다 구체적으로 카메라(미도시)는 본 발명의 일 실시 예에 따른 차간 거리 및 각도 산출 장치(100)를 포함하는 차량(5)의 룸미러 반대편이나, 전면 그릴 외부 등과 같이 선행 차량(100)을 촬영함에 있어서 용이한 위치에 설치되는 것이 바람직할 것이다. On the other hand, the pattern
도 2를 참조하면, 선행 차량(200)의 후면부를 확인할 수 있는바, 제1 발광 모듈(212)은 좌측 리어 램프(210)의 일부에 장착되며, 제2 발광 모듈(222)은 우측 리어 램프(220)의 일부에 장착될 수 있다. 여기서 일부에 장착된다는 것은 제1 발광 모듈(212)이 좌측 리어 램프(210)가 포함하는 복수의 발광 모듈 중 어느 하나라는 것을 의미하며, 제2 발광 모듈(222)이 우측 리어 램프(220)가 포함하는 복수의 발광 모듈 중 어느 하나라는 것을 의미한다. 즉, 제1 발광 모듈(212) 및 제2 발광 모듈(222)은 리어 램프 외부로 노출되지 않으며, 이 경우 리어 램프는 일종의 커버와 같은 역할을 수행한다. Referring to FIG. 2, the rear part of the preceding
도 3은 제1 발광 모듈(212) 및 제2 발광 모듈(222)이 장착된 선행 차량(200)의 또 다른 실시 예를 도시한 도면인바, 제1 발광 모듈(212)은 좌측사이드 미러(211)의 미러부에 장착되며, 제2 발광 모듈(222)은 우측 사이드 미러(221)의 미러부에 장착될 수 있다. 이 경우 패턴 간격 산출부(10)는 선행 차량(200)의 사이드 미러를 촬영함으로써 제1 패턴(215) 및 제2 패턴(225)을 인식할 수 있을 것이며, 사이드 미러는 차량의 본체로부터 좌측 및 우측으로 튀어나와있기 때문에 선행 차량(200)의 후면에서 촬영하여도 문제되지 않을 것이다. FIG. 3 is a view illustrating another embodiment of the preceding
한편, 사이드 미러의 미러부는 후방에서 운행하는 차량을 비추는 거울 같은 역할을 수행하는바, 제1 발광 모듈(212) 및 제2 발광 모듈(222)을 미러부 외부로 노출시키는 경우 운전자의 시야를 가릴 가능성이 있다. 이 경우 사이드 미러의 미러부를 제1 발광 모듈(212) 및 제2 발광 모듈(222)이 조사하는 패턴이 통과하여 투사될 수 있는 재질로 구현한다면 운전자의 시야를 가리게 되는 문제점을 해결할 수 있을 것이다. 예를 들어, 최근 상용화된 차량의 기능 중, 사각 지대에 차량이 접근한 경우 사이드 미러 표면에 경고등을 표시하는 것과 같은 방식을 이용할 수 있을 것이다. On the other hand, the mirror unit of the side mirror serves as a mirror for illuminating a vehicle running behind the bar, when exposing the first
제1 발광 모듈(212)이 조사하는 제1 패턴(215)과 제2 발광 모듈(222)이 조사하는 제2 패턴(225)은 적외선 패턴으로 구현함이 바람직하다. 적외선은 운전자의 눈으로 식별이 불가능한 파장의 광선인바, 제1 패턴(215) 및 제2 패턴(225)이 선행 차량(200)의 리어 램프에서 조사되든, 사이드 미러에서 조사되든 운전자의 시야에 방해가 될 수 있는 안전상의 문제가 없기 때문이다. 이 경우, 패턴 간격 산출부(10)가 포함하는 카메라는 적외선 패턴을 촬영할 수 있는 적외선 카메라(미도시) 이어야 할 것이다. The
이하, 제1 패턴(215) 및 제2 패턴(225)에 대하여 보다 구체적으로 설명하기로 한다. Hereinafter, the
도 4는 도 2에 도시된 선행 차량(200)의 후면부에서 제1 패턴(215) 및 제2 패턴(225)이 조사되고 있는 모습을 추가적으로 도시한 도면이다. 도 4에 따르면 제1 패턴(215) 및 제2 패턴(225)은 서로 대칭 형상인 십자가 형상의 패턴으로 도시되어 있으나, 제1 패턴(215) 및 제2 패턴(225)은 대칭 형상이 아니어도 무방하며, 십자가 형상뿐만 아니라 삼각형, 사각형 및 원형 등과 같이 다양한 형상의 패턴으로 구현할 수 있음은 물론이다. 더 나아가, 제1 패턴(215) 및 제2 패턴(225)의 형상을 선행 차량(200)의 차종에 따른 고유 패턴으로 구현한다면 심미적인 요소까지 획득할 수 있을 것이다. 예를 들어, 선행 차량(200)의 차종이 "소나타"인 경우, 제1 패턴(215) 및 제2 패턴(225)의 형상을 "S" 로, 선행 차량의 차종(200)이 "그랜저"인 경우, 제1 패턴(215) 및 제2 패턴(225)의 형상을 "G"와 같이 구현할 수 있을 것이다. FIG. 4 is a diagram illustrating a state in which the
한편, 도 4에는 십자가 형상의 제1 패턴(215)의 중심부터 제2 패턴(225)의 중심 사이의 거리가 100 cm로 표시되어 있는바, 여기서 100 cm가 앞서 언급한 제1 간격에 해당하며, 제1 간격은 선행 차량(100)에서 제1 패턴(215)과 제2 패턴(225) 사이의 실제 거리를 의미한다. Meanwhile, in FIG. 4, the distance between the center of the cross-shaped
제1 간격을 설정하는 기준은 제1 패턴(215)과 제2 패턴(225)의 형상에 따라 상이할 것이나, 제1 패턴(215)과 제2 패턴(225)의 중심을 기준으로 제1 간격을 설정하는 것이 바람직하며, 그에 따라 제1 패턴(215) 및 제2 패턴(225)은 대칭 형상이 아니어도 무방하기는 하나, 제1 간격 설정에 용이한 대칭 형상으로 구현함이 바람직할 것이다. The criterion for setting the first spacing will be different depending on the shape of the
도 5는 패턴 간격 산출부(10)가 촬영한 선행 차량(200) 후면부의 사진을 도시한 도면이다. 도 5에 도시된 선행 차량(200) 후면부의 모습은 도 4에 도시된 것과 동일하나, 차이점은 도 5는 픽셀을 기준으로 촬영된 사진이라는 것이며, 사진이기 때문에 선행 차량(200)뿐만 아니라 선행 차량(200)의 좌측 및 우측 공간의 일부가 사진에 함께 포함되어 있으며, 사진 내에서 선행 차량(200)의 좌측 및 우측 공간의 비중은 선행 차량(200)이 멀리 있을수록 높아질 것이며, 가까이 있을수록 낮아질 것이다. 이는 사진의 원리와 동일하다. FIG. 5 is a diagram illustrating a photograph of a rear portion of the preceding
패턴 간격 산출부(10)는 촬영된 사진 또는 영상 내에서 제1 패턴(215) 및 제2 패턴(225) 사이의 제2 간격을 산출하는바, 제2 간격 산출에 있어서 픽셀의 수를 이용한다. 구체적으로, 패턴 간격 산출부(10)는 사진 또는 영상 내에서 제1 패턴(215) 및 제2 패턴(225)을 1차적으로 인식하고, 기 설정된 제2 간격 설정 기준에 따라 제2 간격을 이루는 픽셀의 수를 카운트한다. 여기서 제2 간격 설정 기준은 앞에서 설명한 제1 간격 설정 기준과 동일한 제1 패턴(215)과 제2 패턴(225)의 중심 사이의 간격일 것임이 일반적이며, 카운트되는 픽셀의 수는 선행 차량(200)이 멀리 있을수록 작아질 것이며, 가까이 있을수록 높아질 것이다. 이 역시 사진의 원리와 동일하다. The pattern
제2 간격을 이루는 픽셀의 수를 카운트 했다면, 1개의 픽셀의 길이와 카운트한 픽셀의 수를 곱하여 제2 간격을 산출하는바, 1개의 픽셀의 길이는 해상도에 따라 상이할 수 있으나, 일반적으로 1픽셀은 약 0.026458333 cm가 된다. 한편, 픽셀은 정사각형 형상이므로, 1개의 픽셀의 길이는 가로 방향의 길이 또는 세로 방향의 길이 어떤 것이든 무관하게 약 0.026458333 cm가 될 것이다. If the number of pixels forming the second interval is counted, the second interval is calculated by multiplying the length of one pixel by the number of counted pixels, and the length of one pixel may vary depending on the resolution, but in general, 1 The pixel is about 0.026458333 cm. On the other hand, since the pixels are square shaped, the length of one pixel will be about 0.026458333 cm regardless of the length in the horizontal direction or the length in the vertical direction.
도면 표현상의 어려움으로 인해 도 5에는 제2 간격을 이루는 픽셀을 일일이 도시하지는 못하였지만, 제2 간격이 86mm로 도시되어 있는바, 패턴 간격 산출부(10)가 약 32500개의 픽셀을 카운트한 것으로 볼 수 있다. Although the pixels forming the second interval are not illustrated in FIG. 5 due to difficulty in the representation of the drawing, the second interval is illustrated as 86 mm, and the
다시 도 1에 대한 설명으로 돌아가도록 한다. Returning to the description of FIG. 1 again.
룩업 테이블 저장부(20)는 제1 간격을 기준으로 제2 간격, 제2 간격에 따른 선행 차량(200)과의 거리의 추정치 및 거리의 추정치를 형성하는 각도의 추정치가 기 저장되어 있다. The lookup
도 6에는 예시적인 룩업 테이블이 도시되어 있는바, 1개의 행에 대하여 설명하도록 한다. An example lookup table is shown in FIG. 6, so that one row will be described.
도 6에 굵은 네모박스로 표시한 행을 살펴보면 제일 좌측 열에 제1 간격이 "100 cm"로 기재되어 있는바, 이는 실제 선행 차량(200)에서 제1 패턴(215) 및 제2 패턴(225) 사이의 간격이 100 cm라는 것이며, 이는 제1 패턴(215) 및 제2 패턴(225)의 형상과 선행 차량(200)의 차종에 따라 상이하다. 따라서 이 경우 룩업 테이블 역시 상이해질 것이다. Referring to the row indicated by the thick square box in FIG. 6, the first interval is described as "100 cm" in the leftmost column, which is the
좌측에서 두 번째 열은 센터점 비교라고 기재되어 있는바, 이는 패턴 간격 산출부(10)가 제1 패턴(215) 및 제2 패턴(225) 사이의 제1 간격에서 중심을 기준으로 제1 패턴(215) 및 제2 패턴(225)을 촬영했는지를 나타내는바, 일반적으로 "일치"라 기재된다. The second column from the left is described as center point comparison, which means that the pattern spacing calculating
좌측에서 세 번째 열은 제2 간격이며, 이는 앞서 설명한 패턴 간격 산출부(10)가 촬영된 사진 또는 영상 내에서 산출한 제2 간격의 길이다. The third column from the left is the second interval, which is the length of the second interval calculated by the
좌측에서 네 번째 열 및 다섯 번째 열은 선행 차량(200)과의 거리의 추정치 및 거리의 추정치를 형성하는 각도의 추정치인바, 이는 제2 간격에 따라 상이하게 기재된다. 여기서, 선행 차량(200)과의 거리의 추정치 및 거리의 추정치를 형성하는 각도의 추정치는 일종의 실험 결과와 같으며, 도 6에 도시된 바와 같이 각도의 추정치가 90°인 경우는 패턴 간격 산출부(10)의 방향과 제1 패턴(215) 및 제2 패턴(225) 사이의 제1 간격의 중심이 정확히 일치하는 경우, 보다 구체적으로 도 7에 도시된 바와 같이 본 발명의 일 실시 예에 따른 차간 거리 및 각도 산출 장치(100)를 포함하는 차량(5)이 선행 차량(200)의 바로 뒤에서 운행하고 있는 경우라 할 것이다. The fourth and fifth columns from the left are estimates of the distance from the preceding
한편, 앞서 제2 간격을 이루는 픽셀의 수의 카운트에 대한 설명에서 카운트되는 픽셀의 수는 선행 차량(200)이 멀리 있을수록 작아질 것이며, 가까이 있을수록 높아질 것이라고 한바, 제2 간격 역시 픽셀의 수에 비례하여 선행 차량(200)이 멀리 있을수록 작아질 것이며, 가까이 있을수록 높아질 것임을 예상할 수 있다. 이는 도 6에서도 확인할 수 있는바, 룩업 테이블의 제일 위의 행에서 아래 행으로 내려갈수록 제2 간격은 작아지며, 그에 따라 선행 차량(200)과의 거리의 추정치는 길어진다. On the other hand, in the above description of the count of the number of pixels forming the second interval, the number of pixels counted will be smaller as the preceding
다시 도 1에 대한 설명으로 돌아가도록 한다. Returning to the description of FIG. 1 again.
거리 및 각도 산출부(30)는 패턴 간격 산출부(10)가 산출한 제2 간격에 따라 룩업 테이블 저장부(20)에서 선행 차량(200)과의 거리의 추정치 및 거리의 추정치를 형성하는 각도의 추정치를 발췌하여 선행 차량(200)과의 거리 및 각도를 산출한다. The distance and
예를 들어, 패턴 간격 산출부(10)가 산출한 제2 간격이 86 mm인 경우, 거리 및 각도 산출부(30)는 도 6에 도시된 룩업 테이블에서 제2 간격이 86 mm인 행을 검색하고, 그에 따른 선행 차량(200)과의 거리의 추정치로 150 cm, 거리의 추정치를 형성하는 각도의 추정치를 90°로 발췌한다. For example, when the second interval calculated by the
지금까지 본 발명의 일 실시 예에 따른 차간 거리 및 각도 산출 장치(100)에 대하여 설명하였다. 설명의 편의상 패턴 간격 산출부(10), 룩업 테이블 저장부(20) 및 거리 및 각도 산출부(30)를 별개의 독립된 구성으로 설정하고 설명하였으나, 이들 모두 하나의 프로세서 내에서 별개의 기능을 수행하도록 구현할 수도 있다. So far, the apparatus for calculating the distance and the
한편, 차간 거리 및 각도 산출 장치(100)가 최종적으로 산출한 선행 차량(200)과의 거리 및 각도는 스티어링 휠(미도시), 액셀레이터(미도시) 및 브레이크(미도시) 등과 같은 조향 및 구동 부품에게 ECU(미도시)를 경유하거나 또는 경유하지 않고 직접 전달되어, 자율 주행을 구현할 수 있다. Meanwhile, the distance and angle with the preceding
더 나아가, 거리 및 각도 산출부(30)가 발췌한 선행 차량(200)과의 거리 및 각도를 보정하여 안전한 자율 주행 차량을 구현할 수 있는바, 거리 및 각도 산출부(30)는 선행 차량(200)에 탑승한 사용자의 V2X 단말(미도시)을 통해 선행 차량(200)의 내비게이션 맵 데이터, 블랙박스 영상 및 스티어링 앵글 센서의 조향각 신호 중 어느 하나 이상을 수신하고, 이를 이용하여 선행 차량과의 거리 및 각도를 보정할 수도 있다. 예를 들어, 내비게이션 맵 데이터를 수신하는 경우 이에 포함된 GPS 데이터까지 함께 수신할 수 있는바, 선행 차량(200)의 실시간 현재 위치를 기초로 선행 차량(200)과의 거리 및 각도를 보정할 수 있으며, 블랙박스 영상을 수신하는 경우 이에 포함된 선행 차량(200)의 속도에 대한 데이터까지 함께 수신할 수 있는바, 선행 차량(200)의 실시간 속도를 기초로 선행 차량(200)과의 거리 및 각도를 보정할 수 있고, 스티어링 앵글 센서의 조향각 신호를 수신하는 경우, 선행 차량(200)의 실시간 회전 반경을 기초로 선행 차량(200)과의 각도를 보정할 수 있다. Furthermore, the autonomous vehicle can be implemented by correcting the distance and angle with the preceding
한편, 선행 차량(200)이 커브길에서 좌회전 또는 우회전을 하는 경우에는 직진하는 경우 다르게, 선행 차량(200)의 거리 및 각도를 정확하게 산출하기 다소 어려운 면이 있다. 선행 차량(200)의 스티어링 앵글 센서의 조향각 신호가 실시간으로 변경되기 때문이며, 이를 위해 앞서 설명한 선행 차량(200)에 탑승한 사용자의 V2X 단말(미도시)을 이용하는 것이다. 그러나 경우에 따라 선행 차량(200)에 탑승한 사용자가 V2X 단말(미도시)을 보유하고 있지 않거나 통신상의 문제가 발생할 수 있으므로, 이런 경우 본 발명의 일 실시 예에 따른 차간 거리 및 각도 산출 장치(100) 자체적으로 해결해야 한다. On the other hand, when the preceding
이 경우, 패턴 간격 산출부(10)는 일정 시간 간격으로 제1 패턴(215) 및 제2 패턴(225)을 사진 또는 영상으로 촬영하고, 일정 시간 간격으로 촬영한 사진 또는 영상 내에서 제1 패턴(215) 및 제2 패턴(225) 중 어느 하나만 식별되게 되는 경우, 식별되게 되는 패턴이 장착된 방향으로 선행 차량(200)이 회전하는 것으로 판단할 수 있다. In this case, the pattern
이는 도 8에서 확인할 수 있는바, 도 8은 패턴 간격 산출부(10)가 일정 시간 간격으로 촬영한 사진을 도시한 도면이다. Ⅰ번 사진부터 Ⅳ번 사진까지 순서대로 확인하면, 제1 패턴(215) 및 제2 패턴(225)이 모두 촬영되다가 Ⅲ번 사진부터 제2 패턴(225)만 촬영되는 것을 확인할 수 있다. 이 경우 선행 차량(200)은 제2 패턴(225)이 장착된 우측 리어 램프(220)의 방향, 즉 우회전하고 있는 것으로 볼 수 있는바, 선행 차량(200)과 본 발명의 일 실시 예에 따른 차간 거리 및 각도 산출 장치(100)를 포함하는 차량(5) 모두 우회전을 하고 있으므로 제1 패턴(225)이 장착된 좌측 리어 램프(210)는 패턴 간격 산출부(10)의 촬영 시야각에서 벗어나 버렸기 때문이다. This can be seen in Figure 8, Figure 8 is a view showing a picture taken by the pattern
더 나아가, 패턴 간격 산출부(10)는 일정 시간 간격으로 선행 차량(200)의 중심점을 사진 또는 영상으로 촬영하고, 거리 및 각도 산출부(30)는 촬영한 사진 또는 영상 내에서 중심점의 이동 궤적을 기초로 선행 차량(200)의 회전 반경에 대한 곡률을 산출하고, 이를 이용하여 산출한 선행 차량(200)과의 거리 및 각도를 보정할 수도 있다. Furthermore, the
지금까지 본 발명의 일 실시 예에 따른 차간 거리 및 각도 산출 장치(100) 그리고 산출한 선행 차량(200)과의 거리 및 각도의 보정 방법에 대하여 설명하였다. 본 발명에 따르면 레이다, 레이저, 라이다 및 스테레오 카메라 등과 같은 고가의 센싱 장치들을 사용하지 않으면서 선행 차량(200)과의 거리 및 각도를 정확하게 산출할 수 있는바, 자율 주행 차량의 가격 상승을 저지할 수 있으며, 선행 차량(200)에 탑승한 사용자의 V2X 단말(미도시)과 통신을 통해 주변 차량과의 거리 및 각도를 보다 정확하게 보정할 수 있는바, 안전한 자율 주행 차량을 구현할 수 있다. So far, the method for correcting the distance and angle between the vehicle distance and
한편, 본 발명의 일 실시 예에 따른 차간 거리 및 각도 산출 장치(100)는 동일한 기술적 특징을 모두 포함하는 차간 거리 및 각도 산출 방법으로 구현할 수도 있다. 이하, 도 9를 참조하며 설명하도록 한다. Meanwhile, the inter-vehicle distance and
도 9는 본 발명의 또 다른 실시 예에 따른 차간 거리 및 각도 산출 방법의 대표적인 단계를 나타낸 순서도이다. 9 is a flowchart illustrating exemplary steps of a method for calculating a distance and an angle between vehicles according to another exemplary embodiment of the present invention.
이는 본 발명의 목적을 달성함에 있어서 바람직한 순서도에 해당하나, 필요에 따라 일부 단계가 추가되거나 삭제될 수 있음은 물론이다. This corresponds to the preferred flow chart in achieving the object of the present invention, of course, some steps may be added or deleted as necessary.
우선, 차간 거리 및 각도 산출 장치(100)가 선행 차량(200)에 장착된 제1 발광 모듈(212)이 조사하는 제1 패턴(215) 및 제2 발광 모듈(222)이 조사하며, 제1 패턴(215)과 제1 간격 이격된 제2 패턴(225)을 사진 또는 영상으로 촬영하고, 촬영된 사진 또는 영상 내에서 제1 패턴(215) 및 제2 패턴(225) 사이의 제2 간격을 산출한다(S910). First, the
이후, 차간 거리 및 각도 산출 장치(100)가 제1 간격을 기준으로 제2 간격, 제2 간격에 따른 선행 차량(200)과의 거리의 추정치 및 거리의 추정치를 형성하는 각도의 추정치가 기 저장된 룩업 테이블에서 S910 단계에서 산출한 제2 간격에 따른 선행 차량(200)과의 거리의 추정치 및 거리의 추정치를 형성하는 각도의 추정치를 발췌하여 선행 차량(200)과의 거리 및 각도를 산출한다(S920). Subsequently, the distance between the vehicle and the
중복 서술을 방지하기 위해 자세히 기재하지는 않았지만, 앞서 설명한 본 발명의 일 실시 예에 따른 차간 거리 및 각도 산출 장치(100)의 모든 기술적 특징은 차간 거리 및 각도 산출 방법에 모두 동일하게 적용될 수 있으며, 그에 따라 동일한 효과를 도출할 수 있다. Although not described in detail in order to avoid duplication, all technical features of the apparatus for calculating the distance and
이상 첨부된 도면을 참조하여 본 발명의 실시 예들을 설명하였지만, 본 발명이 속하는 기술분야에서 통상의 지식을 가진 자는 본 발명이 그 기술적 사상이나 필수적인 특징을 변경하지 않고서 다른 구체적인 형태로 실시될 수 있다는 것을 이해할 수 있을 것이다. 그러므로 이상에서 기술한 실시 예들은 모든 면에서 예시적인 것이며 한정적이 아닌 것으로 이해해야만 한다.Although the embodiments of the present invention have been described above with reference to the accompanying drawings, those skilled in the art to which the present invention pertains may implement the present invention in other specific forms without changing the technical spirit or essential features thereof. I can understand that. Therefore, it should be understood that the embodiments described above are exemplary in all respects and not restrictive.
100: 차간 거리 및 각도 산출 장치
5: 차간 거리 및 각도 산출 장치를 포함하는 차량(후행 차량)
10: 패턴 간격 산출부
20: 룩업 테이블 저장부
30: 거리 및 각도 산출부
200: 선행 차량
210: 좌측 리어 램프
211: 좌측 사이드 미러
212: 제1 발광 모듈
215: 제1 패턴
220: 우측 리어 램프
221: 우측 사이드 미러
222: 제2 발광 모듈
225: 제2 패턴100: inter-vehicle distance and angle calculation device
5: Vehicle including inter-vehicle distance and angle calculation device (following vehicle)
10: pattern interval calculation unit
20: lookup table storage unit
30: distance and angle calculation unit
200: leading vehicle
210: left rear lamp
211: left side mirror
212: first light emitting module
215: first pattern
220: right rear lamp
221: right side mirror
222: second light emitting module
225: second pattern
Claims (10)
상기 제1 간격을 기준으로 상기 제2 간격, 상기 제2 간격에 따른 상기 선행 차량과의 거리의 추정치 및 상기 거리의 추정치를 형성하는 각도의 추정치가 기 저장된 룩업 테이블 저장부; 및
상기 패턴 간격 산출부가 산출한 상기 제2 간격에 따라 상기 룩업 테이블 저장부에서 상기 선행 차량과의 거리의 추정치 및 상기 거리의 추정치를 형성하는 각도의 추정치를 발췌하여 상기 선행 차량과의 거리 및 각도를 산출하는 거리 및 각도 산출부;
를 포함하는 차간 거리 및 각도 산출 장치에 있어서,
상기 거리 및 각도 산출부는,
상기 선행 차량에 탑승한 사용자의 V2X 단말을 통해 상기 선행 차량의 내비게이션 맵 데이터 및 블랙박스 영상 중 어느 하나 이상을 수신하여 상기 산출한 선행 차량과의 거리를 보정하고, 스티어링 앵글 센서의 조향각 신호를 수신하여 상기 산출한 선행 차량과의 각도를 보정하는,
차간 거리 및 각도 산출 장치.The first pattern irradiated by the first light emitting module mounted on the preceding vehicle and the second light emitting module irradiate and photograph the second pattern spaced apart from the first pattern by a photo or an image, and the photographed photo or image A pattern interval calculator configured to calculate a second interval between the first pattern and the second pattern within the apparatus;
A look-up table storage unit in which the second interval, an estimate of the distance to the preceding vehicle according to the second interval, and an estimate of an angle forming the estimate of the distance are previously stored based on the first interval; And
According to the second interval calculated by the pattern interval calculating unit, the lookup table storage unit extracts an estimate of a distance from the preceding vehicle and an angle forming an estimate of the distance, thereby extracting a distance and an angle from the preceding vehicle. A distance and angle calculator for calculating;
In the inter-vehicle distance and angle calculation apparatus comprising:
The distance and angle calculation unit,
Receives one or more of the navigation map data and the black box image of the preceding vehicle through the V2X terminal of the user in the preceding vehicle, corrects the calculated distance from the preceding vehicle, and receives a steering angle signal of the steering angle sensor. To correct the angle with the calculated preceding vehicle,
Inter-vehicle distance and angle calculation device.
상기 제1 발광 모듈은,
상기 선행 차량의 좌측 리어 램프 일부에 장착되며,
상기 제2 발광 모듈은,
상기 선행 차량의 우측 리어 램프 일부에 장착되는,
차간 거리 및 각도 산출 장치. The method of claim 1,
The first light emitting module,
Mounted to a part of the left rear lamp of the preceding vehicle,
The second light emitting module,
Mounted on a part of the right rear lamp of the preceding vehicle,
Inter-vehicle distance and angle calculation device.
상기 제1 발광 모듈은,
상기 선행 차량의 좌측 사이드 미러의 미러부에 창작되며,
상기 제2 발광 모듈은,
상기 선행 차량의 우측 사이드 미러의 미러부에 창작되는,
차간 거리 및 각도 산출 장치. The method of claim 1,
The first light emitting module,
Is created in the mirror portion of the left side mirror of the preceding vehicle,
The second light emitting module,
Created in the mirror portion of the right side mirror of the preceding vehicle,
Inter-vehicle distance and angle calculation device.
상기 제1 패턴 및 제2 패턴은,
적외선 패턴이며,
상기 패턴 간격 산출부는,
상기 제1 패턴 및 제2 패턴을 촬영하는 적외선 카메라;
를 더 포함하는,
차간 거리 및 각도 산출 장치. The method of claim 1,
The first pattern and the second pattern,
Infrared pattern,
The pattern interval calculation unit,
An infrared camera photographing the first pattern and the second pattern;
Further comprising,
Inter-vehicle distance and angle calculation device.
상기 제1 패턴 및 제2 패턴은,
서로 대칭 형상인,
차간 거리 및 각도 산출 장치. The method of claim 1,
The first pattern and the second pattern,
Symmetrical to each other,
Inter-vehicle distance and angle calculation device.
상기 제1 패턴 및 제2 패턴은,
상기 선행 차량의 차종에 따른 고유 패턴인,
차간 거리 및 각도 산출 장치. The method of claim 1,
The first pattern and the second pattern,
It is a unique pattern according to the vehicle model of the preceding vehicle,
Inter-vehicle distance and angle calculation device.
상기 패턴 간격 산출부는,
일정 시간 간격으로 상기 제1 패턴 및 제2 패턴을 사진 또는 영상으로 촬영하고,
상기 일정 시간 간격으로 촬영한 사진 또는 영상 내에서 상기 제1 패턴 및 제2 패턴 중 어느 하나만 식별되게 되는 경우, 상기 식별되게 되는 패턴이 장착된 방향으로 상기 선행 차량이 회전하는 것으로 판단하는,
차간 거리 및 각도 산출 장치. The method of claim 1,
The pattern interval calculation unit,
Taking the first pattern and the second pattern in a photo or video at regular time intervals,
When only one of the first pattern and the second pattern is identified in the photograph or image taken at the predetermined time interval, it is determined that the preceding vehicle rotates in the direction in which the pattern to be identified is mounted.
Inter-vehicle distance and angle calculation device.
상기 패턴 간격 산출부는,
일정 시간 간격으로 상기 선행 차량의 중심점(Center Point)을 사진 또는 영상으로 촬영하고,
상기 거리 및 각도 산출부는,
상기 촬영한 사진 또는 영상 내에서 상기 중심점의 이동 궤적을 기초로 상기 선행 차량의 회전 반경에 대한 곡률을 산출하고 이를 이용하여 상기 산출한 선행 차량과의 거리 및 각도를 보정하는,
차간 거리 및 각도 산출 장치. The method of claim 8,
The pattern interval calculation unit,
Taking a center point (Center Point) of the preceding vehicle at a predetermined time interval as a picture or an image,
The distance and angle calculation unit,
Calculating a curvature of a turning radius of the preceding vehicle based on the movement trajectory of the center point in the photographed picture or image, and correcting the distance and angle with the calculated preceding vehicle by using the same;
Inter-vehicle distance and angle calculation device.
상기 차간 거리 및 각도 산출 장치가 상기 제1 간격을 기준으로 상기 제2 간격, 상기 제2 간격에 따른 상기 선행 차량과의 거리의 추정치 및 상기 거리의 추정치를 형성하는 각도의 추정치가 기 저장된 룩업 테이블에서 상기 산출한 상기 제2 간격에 따른 상기 선행 차량과의 거리의 추정치 및 상기 거리의 추정치를 형성하는 각도의 추정치를 발췌하여 상기 선행 차량과의 거리 및 각도를 산출하는 단계;
를 포함하는 차간 거리 및 각도 산출 방법에 있어서,
상기 선행 차량과의 거리 및 각도를 산출하는 단계 이후에,
상기 차간 거리 및 각도 산출 장치가 선행 차량에 탑승한 사용자의 V2X 단말을 통해 상기 선행 차량의 내비게이션 맵 데이터 및 블랙박스 영상 중 어느 하나 이상을 수신하여 상기 산출한 선행 차량과의 거리를 보정하고, 스티어링 앵글 센서의 조향각 신호를 수신하여 상기 산출한 선행 차량과의 각도를 보정하는 단계;
를 더 포함하는 차간 거리 및 각도 산출 방법.The distance and angle calculating device for the vehicle is radiated by the first pattern and the second light emitting module irradiated by the first light emitting module mounted on the preceding vehicle, and photographs the second pattern spaced apart from the first pattern by a photo or an image. Calculating a second interval between the first pattern and the second pattern in the photographed picture or image; And
A look-up table in which the inter-vehicle distance and angle calculation device previously stored an estimate of the second interval, an estimate of the distance to the preceding vehicle according to the second interval, and an angle forming the estimate of the distance, based on the first interval; Calculating a distance and an angle with the preceding vehicle by extracting an estimated value of the distance with the preceding vehicle and an estimate of an angle forming the estimated value of the distance according to the second interval;
In the inter-vehicle distance and angle calculation method comprising:
After calculating the distance and angle with the preceding vehicle,
The inter-vehicle distance and angle calculating device receives one or more of the navigation map data and the black box image of the preceding vehicle through the V2X terminal of the user who boards the preceding vehicle, corrects the calculated distance from the preceding vehicle, and steering Receiving a steering angle signal of an angle sensor and correcting the calculated angle with the preceding vehicle;
Inter-vehicle distance and angle calculation method further comprising.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR1020180014469A KR102030109B1 (en) | 2018-02-06 | 2018-02-06 | Apparatus and method for calculating distance and angle between vehicles |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR1020180014469A KR102030109B1 (en) | 2018-02-06 | 2018-02-06 | Apparatus and method for calculating distance and angle between vehicles |
Publications (2)
Publication Number | Publication Date |
---|---|
KR20190100501A KR20190100501A (en) | 2019-08-29 |
KR102030109B1 true KR102030109B1 (en) | 2019-10-08 |
Family
ID=67776013
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
KR1020180014469A KR102030109B1 (en) | 2018-02-06 | 2018-02-06 | Apparatus and method for calculating distance and angle between vehicles |
Country Status (1)
Country | Link |
---|---|
KR (1) | KR102030109B1 (en) |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2012238147A (en) * | 2011-05-11 | 2012-12-06 | Suzuki Motor Corp | Drive support device |
JP2013101040A (en) * | 2011-11-08 | 2013-05-23 | Toyota Motor Corp | Distance estimation device |
JP2017047800A (en) * | 2015-09-02 | 2017-03-09 | 富士重工業株式会社 | Drive support apparatus of vehicle |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20150076884A (en) * | 2013-12-27 | 2015-07-07 | 최주희 | Device and method for alarming start of preceding-vehicle to rewarding-vehicle |
KR101647061B1 (en) | 2014-04-02 | 2016-08-10 | 서강대학교산학협력단 | Path Generation Method and apparatus for Unmanned Autonomous Vehicle |
KR102240444B1 (en) * | 2014-10-31 | 2021-04-15 | 현대모비스 주식회사 | Method and apparatus for vehicle lamp control |
-
2018
- 2018-02-06 KR KR1020180014469A patent/KR102030109B1/en active IP Right Grant
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2012238147A (en) * | 2011-05-11 | 2012-12-06 | Suzuki Motor Corp | Drive support device |
JP2013101040A (en) * | 2011-11-08 | 2013-05-23 | Toyota Motor Corp | Distance estimation device |
JP2017047800A (en) * | 2015-09-02 | 2017-03-09 | 富士重工業株式会社 | Drive support apparatus of vehicle |
Also Published As
Publication number | Publication date |
---|---|
KR20190100501A (en) | 2019-08-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6833630B2 (en) | Object detector, object detection method and program | |
CN113998034B (en) | Rider assistance system and method | |
US10643473B2 (en) | Vehicle and method for collision avoidance assistance | |
CN109131067B (en) | Tripod self-propelled vehicle and obstacle avoidance method thereof | |
CN108647638B (en) | Vehicle position detection method and device | |
US9802540B2 (en) | Process for representing vehicle surroundings information of a motor vehicle | |
KR102059244B1 (en) | Apparatus for Light Detection and Ranging | |
US9740942B2 (en) | Moving object location/attitude angle estimation device and moving object location/attitude angle estimation method | |
CN109584306B (en) | Advanced driving auxiliary calibration system and method based on vehicle positioning | |
CN103885573B (en) | The auto-correction method of automobile-used display system and its system | |
JP6930383B2 (en) | Vehicle control device | |
US20120236122A1 (en) | Image processing device, method thereof, and moving body anti-collision device | |
US20180210210A1 (en) | Vehicle display device | |
US11525694B2 (en) | Superimposed-image display device and computer program | |
CN104802710B (en) | A kind of intelligent automobile reversing aid system and householder method | |
JP6683185B2 (en) | Information processing device, driver monitoring system, information processing method, and information processing program | |
KR20180061686A (en) | Method and apparatus for generating autonomous driving route | |
KR20190107283A (en) | Electronic device for vehicle and method for operating the same | |
JP2019526105A (en) | Method for creating a map of a peripheral model, vehicle control system, and corresponding vehicle | |
JP2019526105A5 (en) | ||
KR102450656B1 (en) | Vehicle and method for controlling thereof | |
TWI637092B (en) | Mobile warning triangle and related obstacle avoidance method | |
KR101190789B1 (en) | Apparatus and method for measurementing distance of vehicle | |
KR102030109B1 (en) | Apparatus and method for calculating distance and angle between vehicles | |
KR102335987B1 (en) | Apparatus and method for drive controlling of vehicle |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A201 | Request for examination | ||
E902 | Notification of reason for refusal | ||
E701 | Decision to grant or registration of patent right | ||
GRNT | Written decision to grant |