KR102545438B1 - 라이다 신호 처리 시스템 및 방법 - Google Patents
라이다 신호 처리 시스템 및 방법 Download PDFInfo
- Publication number
- KR102545438B1 KR102545438B1 KR1020200175390A KR20200175390A KR102545438B1 KR 102545438 B1 KR102545438 B1 KR 102545438B1 KR 1020200175390 A KR1020200175390 A KR 1020200175390A KR 20200175390 A KR20200175390 A KR 20200175390A KR 102545438 B1 KR102545438 B1 KR 102545438B1
- Authority
- KR
- South Korea
- Prior art keywords
- calculated
- control module
- relative speed
- braking parameter
- stored
- Prior art date
Links
- 238000012545 processing Methods 0.000 title claims description 14
- 238000000034 method Methods 0.000 title description 15
- 230000001133 acceleration Effects 0.000 claims description 47
- 238000003672 processing method Methods 0.000 description 12
- 238000004891 communication Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 238000002474 experimental method Methods 0.000 description 2
- 238000004088 simulation Methods 0.000 description 2
- 230000007423 decrease Effects 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- 230000010365 information processing Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 229920001690 polydopamine Polymers 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/88—Lidar systems specially adapted for specific applications
- G01S17/93—Lidar systems specially adapted for specific applications for anti-collision purposes
- G01S17/931—Lidar systems specially adapted for specific applications for anti-collision purposes of land vehicles
-
- 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
- B60W10/00—Conjoint control of vehicle sub-units of different type or different function
- B60W10/18—Conjoint control of vehicle sub-units of different type or different function including control of braking systems
-
- 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
- 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/105—Speed
-
- 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/107—Longitudinal acceleration
-
- 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/02—Systems using the reflection of electromagnetic waves other than radio waves
- G01S17/50—Systems of measurement based on relative movement of target
-
- 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
- G01S7/00—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
- G01S7/48—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S17/00
- G01S7/4808—Evaluating distance, position or velocity data
-
- 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
- G01S7/00—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
- G01S7/48—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S17/00
- G01S7/483—Details of pulse systems
- G01S7/484—Transmitters
-
- 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
- G01S7/00—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
- G01S7/48—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S17/00
- G01S7/483—Details of pulse systems
- G01S7/486—Receivers
- G01S7/4865—Time delay measurement, e.g. time-of-flight measurement, time of arrival measurement or determining the exact position of a peak
-
- 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/0002—Automatic control, details of type of controller or control system architecture
-
- 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
- B60W2420/408—Radar; Laser, e.g. lidar
-
- B60W2420/52—
-
- 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/804—Relative longitudinal speed
-
- 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
- B60W2720/00—Output or target parameters relating to overall vehicle dynamics
- B60W2720/10—Longitudinal speed
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Computer Networks & Wireless Communication (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Mechanical Engineering (AREA)
- Transportation (AREA)
- Mathematical Physics (AREA)
- Automation & Control Theory (AREA)
- Electromagnetism (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Optical Radar Systems And Details Thereof (AREA)
- Traffic Control Systems (AREA)
Abstract
본 발명은 메모리 모듈, 레이저 펄스 신호를 발신하고, 객체에 반사된 레이저 펄스 신호를 수신하는 라이다 센서 모듈, 및 라이다 센서 모듈을 통해 수신된 레이저 펄스 신호의 ToF(Time of Flight)를 산출하고, 산출된 ToF를 메모리 모듈에 저장하고, 메모리 모듈에 저장된 ToF에 기반하여 객체와의 상대 속도를 산출하고, 산출된 상대 속도를 메모리 모듈에 저장하고, 메모리 모듈에 저장된 상대 속도에 기반하여 객체와의 상대 속도 변화율을 산출하고, 산출된 상대 속도 변화율에 기반하여 객체와의 거리를 유지하기 위한 제동 파라미터를 산출하는 제어 모듈을 포함하는 것을 특징으로 한다.
Description
본 발명은 라이다 신호 처리 시스템 및 방법에 관한 것으로, 라이다 신호로부터 객체와의 거리를 유지하기 위한 차량의 제동 파라미터를 산출할 수 있는 라이다 신호 처리 시스템 및 방법에 관한 것이다.
주변에 위치한 상대 차량을 탐지하기 위해 라이다 장치(LiDAR: Light Detec tion And Ranging)가 차량에 탑재되고 있다. 라이다 장치는 차량의 주변으로 레이저 펄스를 발사하고, 발사된 레이저 펄스가 차량 주변에 위치한 상대 차량에 반사되어 돌아오는 것을 수신하며, 발사된 레이저 펄스와 수신된 레이저 펄스의 시간을 체크하여 ToF(Time of Flight)를 계산하고, 계산된 ToF를 상위 제어기로 전달한다.
그러나, 이러한 라이다 장치는 단순히 ToF 정보만을 상위 제어기로 제공하므로, 상위 제어기는 ToF 정보 이외의 정보를 라이다 장치로부터 획득할 수 없고, 이에 따라 해당 정보를 차량의 가속도, 감속도 또는 제동력의 제어에 이용하기 위해 상위 제어기에서 별도의 정보 처리 과정이 수행되어야 하는 문제가 있다.
본 발명의 배경기술은 대한민국 등록특허공보 제10-1998298호(2019.07.03.)의 '카메라 및 라이다 센서를 이용한 차량 자율주행방법'에 개시되어 있다.
본 발명은 전술한 문제점을 해결하기 위해 창안된 것으로, 본 발명의 일 측면에 따른 목적은 라이다 신호로부터 객체와의 거리를 유지하기 위한 차량의 제동 파라미터를 산출할 수 있는 라이다 신호 처리 시스템 및 방법을 제공하는 것이다.
본 발명의 일 측면에 따른 라이다 신호 처리 시스템은 메모리 모듈; 레이저 펄스 신호를 발신하고, 객체에 반사된 상기 레이저 펄스 신호를 수신하는 라이다 센서 모듈; 및 상기 라이다 센서 모듈을 통해 수신된 레이저 펄스 신호의 ToF(Time of Flight)를 산출하고, 상기 산출된 ToF를 상기 메모리 모듈에 저장하고, 상기 메모리 모듈에 저장된 ToF에 기반하여 상기 객체와의 상대 속도를 산출하고, 상기 산출된 상대 속도를 상기 메모리 모듈에 저장하고, 상기 메모리 모듈에 저장된 상대 속도에 기반하여 상기 객체와의 상대 속도 변화율을 산출하고, 상기 산출된 상대 속도 변화율에 기반하여 상기 객체와의 거리를 유지하기 위한 제동 파라미터를 산출하는 제어 모듈;을 포함하는 것을 특징으로 한다.
본 발명에 있어 상기 상대 속도를 산출하는 동작의 적어도 일부로서, 상기 제어 모듈은, 상기 메모리 모듈에 저장된 제1 ToF에 기반하여 상기 객체와의 제1 거리를 산출하고, 상기 제1 ToF 다음에 산출되어 저장된 제2 ToF에 기반하여 상기 객체와의 제2 거리를 산출하고, 상기 제1 거리와 상기 제2 거리 간의 차이에 기반하여 상기 상대 속도를 산출하는 것을 특징으로 한다.
본 발명에 있어 상기 상대 속도 변화율을 산출하는 동작의 적어도 일부로서, 상기 제어 모듈은, 상기 메모리 모듈에 저장된 제1 상대 속도와 상기 제1 상대 속도 다음에 산출되어 저장된 제2 상대 속도 간의 차이에 기반하여 상기 상대 속도 변화율을 산출하는 것을 특징으로 한다.
본 발명에 있어 상기 제동 파라미터를 산출하는 동작의 적어도 일부로서, 상기 제어 모듈은, 상대 속도 변화율과 제동 파라미터가 매칭되어 저장된 룩업 테이블에서 상기 산출된 상대 속도 변화율에 대응하는 제동 파라미터를 검출하고, 상기 검출된 제동 파라미터를 상기 객체와의 거리를 유지하기 위한 제동 파라미터로 산출하는 것을 특징으로 한다.
본 발명에 있어 차량의 속도를 제어하는 상위 제어 모듈;을 더 포함하고, 상기 상위 제어 모듈은, 상기 제어 모듈로부터 상기 산출된 제동 파라미터를 수신하고, 상기 수신된 제동 파라미터에 기반하여 상기 차량의 가속도를 제어하는 것을 특징으로 한다.
본 발명에 있어 상기 상위 제어 모듈은, 제동 파라미터와 가속도가 매칭되어 저장된 룩업 테이블에서 상기 수신된 제동 파라미터에 대응하는 가속도를 검출하고, 상기 검출된 가속도에 기반하여 상기 차량의 가속도를 제어하는 것을 특징으로 한다.
본 발명의 일 측면에 따른 라이다 신호 처리 방법은 제어 모듈이, 라이다 센서 모듈을 통해 수신된 레이저 펄스 신호의 ToF(Time of Flight)를 산출하는 단계; 상기 제어 모듈이, 상기 산출된 ToF를 메모리 모듈에 저장하는 단계; 상기 제어 모듈이, 상기 메모리 모듈에 저장된 ToF에 기반하여 객체와의 상대 속도를 산출하는 단계; 상기 제어 모듈이, 상기 산출된 상대 속도를 상기 메모리 모듈에 저장하는 단계; 상기 제어 모듈이, 상기 메모리 모듈에 저장된 상대 속도에 기반하여 상기 객체와의 상대 속도 변화율을 산출하는 단계; 및 상기 제어 모듈이, 상기 산출된 상대 속도 변화율에 기반하여 상기 객체와의 거리를 유지하기 위한 제동 파라미터를 산출하는 단계;를 포함하는 것을 특징으로 한다.
본 발명의 일 측면에 따르면 라이다 신호로부터 객체와의 거리를 유지하기 위한 차량의 제동 파라미터를 산출할 수 있다.
또한, 본 발명의 다른 측면에 따르면 산출된 제동 파라미터를 토대로 가속도를 산출하고, 산출된 가속도에 기반하여 차량의 가속도를 제어함으로써 객체와의 거리를 일정하게 유지시켜 자율주행 등의 상황에서 주행의 안정도를 향상시킬 수 있다.
도 1은 본 발명의 일 실시예에 따른 라이다 신호 처리 시스템을 설명하기 위한 블록 구성도이다.
도 2는 본 발명의 일 실시예에 따른 라이다 신호 처리 방법을 설명하기 위한 순서도이다.
도 3은 본 발명의 일 실시예에 따른 라이다 신호 처리 방법의 상대 속도를 산출하는 단계를 설명하기 위한 순서도이다.
도 4는 본 발명의 일 실시예에 따른 라이다 신호 처리 방법의 상대 속도 변화율을 산출하는 단계를 설명하기 위한 순서도이다.
도 5는 본 발명의 일 실시예에 따른 라이다 신호 처리 방법의 제동 파라미터를 산출하는 단계를 설명하기 위한 순서도이다.
도 6은 본 발명의 일 실시예에 따른 라이다 신호 처리 방법의 가속도를 제어하는 단계를 설명하기 위한 순서도이다.
도 2는 본 발명의 일 실시예에 따른 라이다 신호 처리 방법을 설명하기 위한 순서도이다.
도 3은 본 발명의 일 실시예에 따른 라이다 신호 처리 방법의 상대 속도를 산출하는 단계를 설명하기 위한 순서도이다.
도 4는 본 발명의 일 실시예에 따른 라이다 신호 처리 방법의 상대 속도 변화율을 산출하는 단계를 설명하기 위한 순서도이다.
도 5는 본 발명의 일 실시예에 따른 라이다 신호 처리 방법의 제동 파라미터를 산출하는 단계를 설명하기 위한 순서도이다.
도 6은 본 발명의 일 실시예에 따른 라이다 신호 처리 방법의 가속도를 제어하는 단계를 설명하기 위한 순서도이다.
이하에서는 본 발명의 실시예에 따른 라이다 신호 처리 시스템 및 방법을 첨부된 도면들을 참조하여 상세하게 설명한다. 이 과정에서 도면에 도시된 선들의 두께나 구성요소의 크기 등은 설명의 명료성과 편의상 과장되게 도시되어 있을 수 있다. 또한, 후술되는 용어들은 본 발명에서의 기능을 고려하여 정의된 용어들로서 이는 사용자, 운용자의 의도 또는 관례에 따라 달라질 수 있다. 그러므로 이러한 용어들에 대한 정의는 본 명세서 전반에 걸친 내용을 토대로 내려져야 할 것이다.
도 1은 본 발명의 일 실시예에 따른 라이다 신호 처리 시스템을 설명하기 위한 블록 구성도이다.
도 1을 참조하면, 본 발명의 일 실시예에 따른 라이다 신호 처리 시스템은 메모리 모듈(100), 라이다 센서 모듈(200), 제어 모듈(300) 및 상위 제어 모듈(400)을 포함할 수 있다. 메모리 모듈(100), 라이다 센서 모듈(200), 제어 모듈(300) 및 상위 제어 모듈(400)은 각각 차량에 구비될 수 있으며, 메모리 모듈(100), 라이다 센서 모듈(200) 및 상위 제어 모듈(400)은 각각 제어 모듈(300)과 연결되어 필요한 데이터를 송수신할 수 있다.
메모리 모듈(100)은 후술하는 제어 모듈(300) 또는 라이다 센서 모듈(200)에 의해 사용되는 다양한 데이터를 저장할 수 있다. 예를 들어, 메모리 모듈(100)에 저장되는 데이터는 제어 모듈(300)을 통해 산출되는 ToF(Time of Flight)에 대한 데이터, 상대 속도에 대한 데이터, 상대 속도 변화율에 대한 데이터, 및 제동 파라미터에 대한 데이터를 포함할 수 있다. 각각의 데이터가 제어 모듈(300)에 의해 산출되어 메모리 모듈(100)에 저장되는 과정은 후술하도록 한다. 한편, 메모리 모듈(100)은, 휘발성 메모리 또는 비휘발성 메모리를 포함할 수 있다.
라이다(LiDAR) 센서 모듈(200)은 레이저 펄스 신호를 발신하고, 객체에 반사된 레이저 펄스 신호를 수신할 수 있다. 여기서, 객체는 라이다 센서 모듈(200)이 구비된 자기 차량의 주변에 위치한 상대 차량을 포함할 수 있다. 예를 들어, 라이다 센서 모듈(200)은 레이저 펄스 신호를 자기 차량의 주변으로 발신하고, 자기 차량의 주변에 위치한 상대 차량에 반사된 레이저 펄스 신호를 수신할 수 있다.
제어 모듈(300)은 라이다 센서 모듈(200)을 통해 수신된 레이저 펄스 신호의 ToF를 산출하고, 산출된 ToF를 상기 메모리 모듈(100)에 저장하고, 메모리 모듈(100)에 저장된 ToF에 기반하여 객체와의 상대 속도를 산출하고, 산출된 상대 속도를 메모리 모듈(100)에 저장하고, 메모리 모듈(100)에 저장된 상대 속도에 기반하여 객체와의 상대 속도 변화율을 산출하고, 산출된 상대 속도 변화율에 기반하여 객체와의 거리를 유지하기 위한 제동 파라미터를 산출할 수 있다. 예를 들어, 제어 모듈(300)은 라이다 센서 모듈(200)을 제어하는 전자 장치(MCU: Micro Control Unit)일 수 있다.
이하에서는 제어 모듈(300)이 라이다 센서 모듈(200)을 통해 수신된 레이저 펄스 신호를 통해 제동 파라미터를 산출하는 과정을 살펴보도록 한다.
먼저, 제어 모듈(300)은 라이다 센서 모듈(200)을 통해 수신된 레이저 펄스 신호의 ToF를 산출할 수 있다.
본 발명의 일 실시예에 따르면, 제어 모듈(300)은 레이저 펄스 신호가 발신된 시간과 레이더 펄스 신호가 수신된 시간을 메모리 모듈(100)에 저장할 수 있으며, 메모리 모듈(100)에 저장된 레이저 펄스 신호가 발신된 시간과 레이더 펄스 신호가 수신된 시간의 차이를 산출함으로써 라이다 센서 모듈(200)을 통해 수신된 레이저 펄스 신호의 ToF를 산출할 수 있다.
이어서, 제어 모듈(300)은 산출된 ToF를 메모리 모듈(100)에 저장할 수 있다.
이어서, 제어 모듈(300)은 메모리 모듈(100)에 저장된 ToF에 기반하여 객체와의 상대 속도를 산출할 수 있다.
본 발명의 일 실시예에 따르면, 제어 모듈(300)은 메모리 모듈(100)에 저장된 제1 ToF에 기반하여 객체와의 제1 거리를 산출하고, 제1 ToF 이전에 산출되어 저장된 제2 ToF에 기반하여 객체와의 제2 거리를 산출하고, 제1 거리와 제2 거리 간의 차이를 계산하고, 계산된 제1 거리와 제2 거리 간의 차이에 기반하여 객체와의 상대 속도를 산출할 수 있다. 즉, 제어 모듈(300)은 임의의 시점에서 객체와의 상대 속도를 산출하기 위해, 임의의 시점에서 산출된 ToF를 통해 산출된 객체와의 거리와, 임의의 시점 이전 시점에서 산출된 ToF를 통해 산출된 객체와의 거리 간의 차이를 계산하고, 계산된 차이를 임의의 시점과 임의의 시점 이전 시점 간의 시간 차이로 나누어줌으로써 객체와의 상대 속도를 산출할 수 있다. 한편, 제어 모듈(300)은 ToF의 1/2에 해당하는 값과 레이저 펄스 신호의 속도를 곱하여 객체와의 거리를 산출할 수 있다.
이어서, 제어 모듈(300)은 산출된 상대 속도를 메모리 모듈(100)에 저장할 수 있다.
이어서, 제어 모듈(300)은 메모리에 저장된 상대 속도에 기반하여 객체와의 상대 속도 변화율을 산출할 수 있다.
본 발명의 일 실시예에 따르면, 제어 모듈(300)은 메모리 모듈(100)에 저장된 제1 상대 속도와 제1 상대 속도 이전에 산출되어 저장된 제2 상대 속도 간의 차이를 계산하고, 계산된 제1 상대 속도와 제2 상대 속도 간의 차이에 기반하여 객체와의 상대 속도 변화율을 산출할 수 있다. 즉, 제어 모듈(300)은 임의의 시점에서 객체와의 상대 속도 변화율을 산출하기 위해, 임의의 시점에서 산출된 객체와의 상대 속도와, 임의의 시점 이전 시점에서 산출된 객체와의 상대 속도 간의 차이를 계산하고, 계산된 차이를 임의의 시점과 임의의 시점 이전 시점 간의 시간 차이로 나누어줌으로써 객체와의 상대 속도 변화율을 산출할 수 있다.
이어서, 제어 모듈(300)은 산출된 상대 속도 변화율에 기반하여 객체와의 거리를 유지하기 위한 제동 파라미터를 산출할 수 있다. 여기서, 제동 파라미터는 객체와의 거리를 일정하기 유지하기 위한 차량의 가속도, 감속도 또는 제동력을 계산하기 위해 요구되는 파라미터일 수 있다.
본 발명의 일 실시예에 따르면, 제어 모듈(300)은 상대 속도 변화율과 제동 파라미터가 매칭되어 저장된 룩업 테이블에서 앞서 산출된 상대 속도 변화율에 대응하는 제동 파라미터를 검출하고, 검출된 제동 파라미터를 객체와의 거리를 유지하기 위한 제동 파라미터로 결정할 수 있다. 상대 속도 변화율에 대응하는 제동 파라미터는 미리 실험 또는 시뮬레이션을 통해 산출될 수 있으며, 산출된 제동 파라미터는 해당 상대 속도 변화율과 룩업 테이블 형태로 매칭되어 메모리 모듈(100)에 저장되어 있을 수 있다.
표 1은 상대 속도 변화율과 제동 파라미터가 매칭되어 저장된 룩업 테이블을 나타내고 있다. 예를 들어, 산출된 상대 속도 변화율의 차이 Level1에 해당하고, 해당 값이 양수인 경우(즉, 객체와의 상대 속도가 이전 시점보다 증가한 경우), 제어 모듈(300)은 A를 제동 파라미터로 결정할 수 있다. 한편, 산출된 상대 속도 변화율의 차이가 Level3에 해당하고, 해당 값이 음수인 경우(즉, 객체와의 상대 속도가 이전 시점보다 감소한 경우), 제어 모듈(300)은 F를 제동파라미터로 결정할 수 있다.
한편, 제어 모듈(300)은 산출된 제동 파라미터를 차량의 속도를 제어하는 상위 제어 모듈(400)로 전송할 수 있다. 이때, 제어 모듈(300)은 제동 파라미터 이외에도 메모리 모듈(100)에 저장된 ToF, 상대 속도 및 상대 속도 변화율 중 적어도 하나를 상위 제어 모듈(400)로 전송할 수도 있다.
이하에서는 상위 제어 모듈(400)이 제동 파라미터에 기반하여 차량의 가속도를 제어하는 과정을 살펴보도록 한다.
상위 제어 모듈(400)은 차량의 속도를 제어할 수 있다. 예를 들어, 상위 제어 모듈(400)은 자율주행을 위해 차량의 속도를 직접적으로 제어하는 전자 장치(MCU: Micro Control Unit)일 수 있다. 한편, 상위 제어 모듈(400)은 제어 모듈(300)로부터 산출된 제동 파라미터를 수신하고, 수신된 제동 파라미터에 기반하여 차량의 가속도를 제어할 수 있다.
본 발명의 일 실시예에 따르면, 상위 제어 모듈(400)은 제동 파라미터와 가속도가 매칭되어 저장된 룩업 테이블에서 수신된 제동 파라미터에 대응하는 가속도를 검출하고, 검출된 가속도에 기반하여 차량의 가속도를 제어할 수 있다. 제동 파라미터에 대응하는 가속도는 미리 실험 또는 시뮬레이션을 통해 산출될 수 있으며, 산출된 가속도는 해당 제동 파라미터와 룩업 테이블 형태로 매칭되어 메모리 모듈(100)에 저장되어 있을 수 있다.
표 2는 제동 파라미터와 가속도가 매칭되어 저장된 룩업 테이블을 나타내고 있다. 예를 들어, 제어 모듈(300)로부터 수신된 제동 파라미터가 A에 해당하는 경우, 상위 제어 모듈(400)은 a만큼 차량의 가속도가 변경되도록 차량의 가속도를 제어할 수 있다. 한편, 제어 모듈(300)로부터 수신된 제동 파라미터가 F에 해당하는 경우, 상위 제어 모듈(400)은 f만큼 차량의 가속도가 변경되도록 차량의 가속도를 제어할 수 있다.
전술한 바와 같이, 본 발명은 라이다 신호로부터 객체와의 거리를 유지하기 위한 차량의 제동 파라미터를 산출할 수 있다. 또한, 본 발명은 제동 파라미터를 토대로 가속도를 산출하고, 산출된 가속도에 기반하여 차량의 가속도를 제어함으로써 객체와의 거리를 일정하게 유지시켜 자율주행 등의 상황에서 주행의 안정도를 향상시킬 수 있다.
도 2는 본 발명의 일 실시예에 따른 라이다 신호 처리 방법을 설명하기 위한 순서도이고, 도 3은 본 발명의 일 실시예에 따른 라이다 신호 처리 방법의 상대 속도를 산출하는 단계를 설명하기 위한 순서도이고, 도 4는 본 발명의 일 실시예에 따른 라이다 신호 처리 방법의 상대 속도 변화율을 산출하는 단계를 설명하기 위한 순서도이고, 도 5는 본 발명의 일 실시예에 따른 라이다 신호 처리 방법의 제동 파라미터를 산출하는 단계를 설명하기 위한 순서도이고, 도 6은 본 발명의 일 실시예에 따른 라이다 신호 처리 방법의 가속도를 산출하는 단계를 설명하기 위한 순서도이다.
이하에서는 도 2 내지 6을 참조하여, 본 발명의 일 실시예에 따른 라이다 신호 처리 방법을 설명하도록 한다.
먼저 도 2를 참고하면, 제어 모듈(300)은 라이다 센서 모듈(200)을 통해 수신된 레이저 펄스 신호의 ToF를 산출할 수 있다.(S100 단계)
이어서, 제어 모듈(300)은 산출된 ToF를 메모리 모듈(100)에 저장할 수 있다.(S200 단계)
이어서, 제어 모듈(300)은 메모리 모듈(100)에 저장된 ToF에 기반하여 객체와의 상대 속도를 산출할 수 있다.(S300 단계)
도 3을 참고하면, 제어 모듈(300)은 메모리 모듈(100)에 저장된 제1 ToF에 기반하여 객체와의 제1 거리를 산출하고(S310 단계), 제1 ToF 이전에 산출되어 저장된 제2 ToF에 기반하여 객체와의 제2 거리를 산출하고(S320 단계), 제1 거리와 제2 거리 간의 차이를 계산하고(S330 단계), 계산된 제1 거리와 제2 거리 간의 차이에 기반하여 객체와의 상대 속도를 산출할 수 있다(S340 단계).
다시 도 2를 참고하면, 제어 모듈(300)은 산출된 상대 속도를 메모리 모듈(100)에 저장할 수 있다.(S400 단계)
이어서, 제어 모듈(300)은 메모리 모듈(100)에 저장된 상대 속도에 기반하여 객체와의 상대 속도 변화율을 산출할 수 있다.(S500 단계)
도 4를 참고하면, 제어 모듈(300)은 메모리 모듈(100)에 저장된 제1 상대 속도와 제1 상대 속도 이전에 산출되어 저장된 제2 상대 속도 간의 차이를 계산하고(S510 단계), 계산된 제1 상대 속도와 제2 상대 속도 간의 차이에 기반하여 객체와의 상대 속도 변화율을 산출할 수 있다(S520 단계).
다시 도 2를 참고하면, 제어 모듈(300)은 산출된 상대 속도 변화율에 기반하여 객체와의 거리를 유지하기 위한 제동 파라미터를 산출할 수 있다.(S600 단계)
도 5를 참고하면, 제어 모듈(300)은 상대 속도 변화율과 제동 파라미터가 매칭되어 저장된 룩업 테이블에서 앞서 산출된 상대 속도 변화율에 대응하는 제동 파라미터를 검출하고(S610 단계), 검출된 제동 파라미터를 객체와의 거리를 유지하기 위한 제동 파라미터로 결정할 수 있다(S620 단계).
다시 도 2를 참고하면, 제어 모듈(300)은 산출된 제동 파라미터를 상위 제어 모듈(400)로 전송할 수 있다.(S700 단계)
이어서, 상위 제어 모듈(400)은 제어 모듈(300)로부터 전송된 제동 파라미터에 기반하여 차량의 가속도를 제어할 수 있다.(S800 단계)
도 6을 참고하면, 상위 제어 모듈(400)은 제동 파라미터와 가속도가 매칭되어 저장된 룩업 테이블에서 수신된 제동 파라미터에 대응하는 가속도를 검출하고(S810 단계), 검출된 가속도에 기반하여 차량의 가속도를 제어할 수 있다(S820 단계).
상술한 바와 같이, 본 발명의 일 실시예에 따른 라이다 신호 처리 시스템 및 방법은 라이다 신호로부터 객체와의 거리를 유지하기 위한 차량의 제동 파라미터를 산출할 수 있다. 또한, 본 발명은 제동 파라미터를 토대로 가속도를 산출하고, 산출된 가속도에 기반하여 차량의 가속도를 제어함으로써 객체와의 거리를 일정하게 유지시켜 자율주행 등의 상황에서 주행의 안정도를 향상시킬 수 있다.
본 명세서에서 설명된 구현은, 예컨대, 방법 또는 프로세스, 장치, 소프트웨어 프로그램, 데이터 스트림 또는 신호로 구현될 수 있다. 단일 형태의 구현의 맥락에서만 논의(예컨대, 방법으로서만 논의)되었더라도, 논의된 특징의 구현은 또한 다른 형태(예컨대, 장치 또는 프로그램)로도 구현될 수 있다. 장치는 적절한 하드웨어, 소프트웨어 및 펌웨어 등으로 구현될 수 있다. 방법은, 예컨대, 컴퓨터, 마이크로프로세서, 집적 회로 또는 프로그래밍가능한 로직 디바이스 등을 포함하는 프로세싱 디바이스를 일반적으로 지칭하는 프로세서 등과 같은 장치에서 구현될 수 있다. 프로세서는 또한 최종-사용자 사이에 정보의 통신을 용이하게 하는 컴퓨터, 셀 폰, 휴대용/개인용 정보 단말기(personal digital assistant: "PDA") 및 다른 디바이스 등과 같은 통신 디바이스를 포함한다.
본 발명은 도면에 도시된 실시예를 참고로 하여 설명되었으나, 이는 예시적인 것에 불과하며 당해 기술이 속하는 기술분야에서 통상의 지식을 가진 자라면 이로부터 다양한 변형 및 균등한 타 실시예가 가능하다는 점을 이해할 것이다. 따라서, 본 발명의 진정한 기술적 보호범위는 아래의 특허청구범위에 의하여 정해져야 할 것이다.
100: 메모리 모듈
200: 라이다 센서 모듈
300: 제어 모듈
400: 상위 제어 모듈
200: 라이다 센서 모듈
300: 제어 모듈
400: 상위 제어 모듈
Claims (7)
- 메모리 모듈;
레이저 펄스 신호를 발신하고, 객체에 반사된 상기 레이저 펄스 신호를 수신하는 라이다 센서 모듈; 및
상기 라이다 센서 모듈을 통해 수신된 레이저 펄스 신호의 ToF(Time of Flight)를 산출하고, 상기 산출된 ToF를 상기 메모리 모듈에 저장하고, 상기 메모리 모듈에 저장된 ToF에 기반하여 상기 객체와의 상대 속도를 산출하고, 상기 산출된 상대 속도를 상기 메모리 모듈에 저장하고, 상기 메모리 모듈에 저장된 상대 속도에 기반하여 상기 객체와의 상대 속도 변화율을 산출하고, 상기 산출된 상대 속도 변화율에 기반하여 상기 객체와의 거리를 유지하기 위한 제동 파라미터를 산출하는 제어 모듈;을 포함하고,
상기 제어 모듈은, 상대 속도 변화율과 제동 파라미터가 매칭되어 저장된 룩업 테이블에서 상기 산출된 상대 속도 변화율에 대응하는 제동 파라미터를 검출하고, 상기 검출된 제동 파라미터를 상기 객체와의 거리를 유지하기 위한 제동 파라미터로 산출하고,
차량의 속도를 제어하는 상위 제어 모듈;을 더 포함하고,
상기 상위 제어 모듈은, 상기 제어 모듈로부터 상기 산출된 제동 파라미터를 수신하고, 상기 수신된 제동 파라미터에 기반하여 상기 차량의 가속도를 제어하고,
상기 상위 제어 모듈은, 제동 파라미터와 가속도가 매칭되어 저장된 룩업 테이블에서 상기 수신된 제동 파라미터에 대응하는 가속도를 검출하고, 상기 검출된 가속도에 기반하여 상기 차량의 가속도를 제어하는 것을 특징으로 하는 라이다 신호 처리 시스템.
- 제 1항에 있어서,
상기 상대 속도를 산출하는 동작의 적어도 일부로서, 상기 제어 모듈은,
상기 메모리 모듈에 저장된 제1 ToF에 기반하여 상기 객체와의 제1 거리를 산출하고, 상기 제1 ToF 다음에 산출되어 저장된 제2 ToF에 기반하여 상기 객체와의 제2 거리를 산출하고, 상기 제1 거리와 상기 제2 거리 간의 차이에 기반하여 상기 상대 속도를 산출하는 것을 특징으로 하는 라이다 신호 처리 시스템.
- 제 1항에 있어서,
상기 상대 속도 변화율을 산출하는 동작의 적어도 일부로서, 상기 제어 모듈은,
상기 메모리 모듈에 저장된 제1 상대 속도와 상기 제1 상대 속도 다음에 산출되어 저장된 제2 상대 속도 간의 차이에 기반하여 상기 상대 속도 변화율을 산출하는 것을 특징으로 하는 라이다 신호 처리 시스템.
- 삭제
- 삭제
- 삭제
- 제어 모듈이, 라이다 센서 모듈을 통해 수신된 레이저 펄스 신호의 ToF(Time of Flight)를 산출하는 단계;
상기 제어 모듈이, 상기 산출된 ToF를 메모리 모듈에 저장하는 단계;
상기 제어 모듈이, 상기 메모리 모듈에 저장된 ToF에 기반하여 객체와의 상대 속도를 산출하는 단계;
상기 제어 모듈이, 상기 산출된 상대 속도를 상기 메모리 모듈에 저장하는 단계;
상기 제어 모듈이, 상기 메모리 모듈에 저장된 상대 속도에 기반하여 상기 객체와의 상대 속도 변화율을 산출하는 단계; 및
상기 제어 모듈이, 상기 산출된 상대 속도 변화율에 기반하여 상기 객체와의 거리를 유지하기 위한 제동 파라미터를 산출하는 단계;를 포함하고,
상기 제동 파라미터를 산출하는 단계에서, 상기 제어 모듈은,
상대 속도 변화율과 제동 파라미터가 매칭되어 저장된 룩업 테이블에서 상기 산출된 상대 속도 변화율에 대응하는 제동 파라미터를 검출하고, 상기 검출된 제동 파라미터를 상기 객체와의 거리를 유지하기 위한 제동 파라미터로 산출하고,
상기 제어 모듈이, 차량의 속도를 제어하는 상위 제어 모듈로 상기 제동 파라미터를 전송하는 단계; 및
상기 상위 제어 모듈이, 상기 제동 파라미터에 기반하여 상기 차량의 가속도를 제어하는 단계;를 더 포함하고,
상기 차량의 가속도를 제어하는 단계에서, 상기 상위 제어 모듈은,
제동 파라미터와 가속도가 매칭되어 저장된 룩업 테이블에서 상기 제동 파라미터에 대응하는 가속도를 검출하고, 상기 검출된 가속도에 기반하여 상기 차량의 가속도를 제어하는 것을 특징으로 하는 라이다 신호 처리 방법.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR1020200175390A KR102545438B1 (ko) | 2020-12-15 | 2020-12-15 | 라이다 신호 처리 시스템 및 방법 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR1020200175390A KR102545438B1 (ko) | 2020-12-15 | 2020-12-15 | 라이다 신호 처리 시스템 및 방법 |
Publications (2)
Publication Number | Publication Date |
---|---|
KR20220085888A KR20220085888A (ko) | 2022-06-23 |
KR102545438B1 true KR102545438B1 (ko) | 2023-06-21 |
Family
ID=82221607
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
KR1020200175390A KR102545438B1 (ko) | 2020-12-15 | 2020-12-15 | 라이다 신호 처리 시스템 및 방법 |
Country Status (1)
Country | Link |
---|---|
KR (1) | KR102545438B1 (ko) |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2021006374A1 (ko) * | 2019-07-08 | 2021-01-14 | 엘지전자 주식회사 | 자율 주행 시스템에서 차량의 브레이크 장치를 모니터링 하는 방법 및 장치 |
KR20190104474A (ko) * | 2019-08-20 | 2019-09-10 | 엘지전자 주식회사 | 차량 주행 제어 장치 및 방법 |
-
2020
- 2020-12-15 KR KR1020200175390A patent/KR102545438B1/ko active IP Right Grant
Also Published As
Publication number | Publication date |
---|---|
KR20220085888A (ko) | 2022-06-23 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US12013694B2 (en) | Operation-security system for an automated vehicle | |
KR102518534B1 (ko) | 차량 위치 인식 장치 및 방법 | |
JP2022051779A (ja) | 制御装置、制御方法、プログラム及び記憶媒体 | |
CN105717498B (zh) | 激光测距仪俯仰角测量与校正系统及方法 | |
KR102539287B1 (ko) | 라이다 센서의 신뢰성에 따른 차량 제어 장치 및 방법 | |
WO2012002099A1 (ja) | 渋滞予測装置 | |
US20150336576A1 (en) | Unmanned vehicle driving apparatus and method for obstacle avoidance | |
JP7147648B2 (ja) | 運転支援装置 | |
US20150083921A1 (en) | Approaching vehicle detection apparatus and method | |
WO2017199333A1 (ja) | 情報出力装置、端末装置、制御方法、プログラム及び記憶媒体 | |
US20210311478A1 (en) | Systems and Methods For Autonomous Navigation To Locate User With Ultra-Wideband Sensing | |
JPH1113507A (ja) | 自動追従走行システム | |
JP2014021709A (ja) | 物体位置検知装置 | |
KR102545438B1 (ko) | 라이다 신호 처리 시스템 및 방법 | |
US11579612B2 (en) | Position and attitude estimation apparatus and position and attitude estimation method | |
CN109945890B (zh) | 多定位系统切换与融合校正方法及其装置 | |
CN112154393A (zh) | 无人飞行器的返航控制方法、用户终端以及无人飞行器 | |
US12085408B2 (en) | Vehicle position estimation device, vehicle position estimation method, and non-transitory recording medium | |
US12091009B2 (en) | Vehicle control device and vehicle control method | |
CN113942506A (zh) | 跟车行驶自动巡航方法及系统 | |
CN112447045B (zh) | 用于运行车辆的方法和设备 | |
KR102429502B1 (ko) | 자율 주행 제어 장치 및 그의 타겟 전환 방법 | |
US11402460B2 (en) | Method and system for processing a signal transmitted to a motor vehicle by a remote communicating entity | |
US20240101152A1 (en) | Mobile object control device, mobile object control method, and program | |
KR20190066953A (ko) | 자율 주행 제어 장치 및 그의 타겟 전환 방법 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
E902 | Notification of reason for refusal | ||
AMND | Amendment | ||
E601 | Decision to refuse application | ||
AMND | Amendment | ||
X701 | Decision to grant (after re-examination) | ||
GRNT | Written decision to grant |